diff --git a/src/jsd_egd.c b/src/jsd_egd.c index 5077d99..462642d 100644 --- a/src/jsd_egd.c +++ b/src/jsd_egd.c @@ -1267,7 +1267,6 @@ void jsd_egd_process_state_machine(jsd_t* self, uint16_t slave_id) { // to READY_TO_SWITCH_ON break; case JSD_ELMO_STATE_MACHINE_STATE_READY_TO_SWITCH_ON: - MSG("Transitioning to SWITCHED ON!!!\n\n"); set_controlword(self, slave_id, JSD_EGD_STATE_MACHINE_CONTROLWORD_SWITCH_ON); // to SWITCHED_ON @@ -1276,7 +1275,6 @@ void jsd_egd_process_state_machine(jsd_t* self, uint16_t slave_id) { // STO drops us here // Handle reset if (state->new_reset) { - MSG("There was a new_reset!!!\n\n"); set_controlword(self, slave_id, JSD_EGD_STATE_MACHINE_CONTROLWORD_ENABLE_OPERATION); @@ -1290,14 +1288,12 @@ void jsd_egd_process_state_machine(jsd_t* self, uint16_t slave_id) { } break; case JSD_ELMO_STATE_MACHINE_STATE_OPERATION_ENABLED: - MSG("Operation is enabled now!!!\n\n"); state->enabling_operation = false; state->pub.fault_code = JSD_EGD_FAULT_OKAY; state->pub.emcy_error_code = 0; // Handle halt if (state->new_halt_command){ - MSG("There is a new_halt_command so new_reset is false!!!\n\n"); state->new_reset = false; uint16_t cw = get_controlword(self, slave_id); cw &= ~(0x01 << 2); // Quickstop @@ -1313,16 +1309,12 @@ void jsd_egd_process_state_machine(jsd_t* self, uint16_t slave_id) { break; case JSD_ELMO_STATE_MACHINE_STATE_QUICK_STOP_ACTIVE: - MSG("TRANSITIONED TO JSD_ELMO_STATE_MACHINE_STATE_QUICK_STOP_ACTIVE!!!\n\n"); - break; case JSD_ELMO_STATE_MACHINE_STATE_FAULT_REACTION_ACTIVE: - MSG("TRANSITIONED TO JSD_ELMO_STATE_MACHINE_STATE_FAULT_REACTION_ACTIVE!!!\n\n"); set_controlword(self, slave_id, JSD_EGD_STATE_MACHINE_CONTROLWORD_FAULT_RESET); break; case JSD_ELMO_STATE_MACHINE_STATE_FAULT: - MSG("TRANSITIONED TO JSD_ELMO_STATE_MACHINE_STATE_FAULT!!!\n\n"); // Only transition once the EMCY code can be extracted from the // error list if(jsd_error_cirq_pop(error_cirq, &error)) {