diff --git a/common/Motion/motion_common.h b/common/Motion/motion_common.h index 2200f96..8ffcf24 100644 --- a/common/Motion/motion_common.h +++ b/common/Motion/motion_common.h @@ -120,13 +120,11 @@ BOOL publishState(const char* system_state_addr) } void my_interrupt_handler(int s){ - printf("Caught signal %d\n",s); + printf("Caught signal %d, stopping robot\n",s); gData.mutex.try_lock(); gData.mutex.unlock(); - printf("stopMotion\n"); stopMotion(); - printf("sendShutdown\n"); - sendShutdown(); + //sendShutdown(); exit(1); }