Ignore commands when kill switch is active

Author: vedderb

conf_general.h

@@ -24,7 +24,7 @@
 #define FW_VERSION_MAJOR			5
 #define FW_VERSION_MINOR			03
 // Set to 0 for building a release and iterate during beta test builds
-#define FW_TEST_VERSION_NUMBER		40
+#define FW_TEST_VERSION_NUMBER		41
 
 #include "datatypes.h"
 

timeout.c

@@ -218,7 +218,9 @@ static THD_FUNCTION(timeout_thread, arg) {
 			mc_interface_select_motor_thread(2);
 			mc_interface_set_brake_current(timeout_brake_current);
 
-			if (!kill_sw) {
+			if (kill_sw) {
+				mc_interface_ignore_input_both(20);
+			} else {
 				has_timeout = true;
 			}
 		} else {