Add define to configure motor spin

Define if they should spin and at what speed
bitcraze · Aug 12, 2024 · d11bed1 · d11bed1
1 parent 63494a7
commit d11bed1
Showing 1 changed file with 13 additions and 1 deletion.
diff --git a/src/deck/drivers/src/test/radiotest.c b/src/deck/drivers/src/test/radiotest.c
@@ -39,6 +39,16 @@
 #include "param.h"
 #include "platform_defaults.h"
 
+
+#define SHOULD_SPIN_MOTORS 0
+
+#ifdef CONFIG_MOTORS_DEFAULT_IDLE_THRUST
+#define MOTOR_SPEED = CONFIG_MOTORS_DEFAULT_IDLE_THRUST
+#else
+#define MOTOR_SPEED = 7000
+#endif
+
+
 //Hardware configuration
 static bool isInit;
 static uint8_t channel = 80;
@@ -106,7 +116,9 @@ static void radiotestInit(DeckInfo *info)
     return;
 
   xTaskCreate(radiotestTask, "RADIOTEST", configMINIMAL_STACK_SIZE, NULL, 1, NULL);
-  xTaskCreate(spinMotorsTask, "spinMotors", configMINIMAL_STACK_SIZE, NULL, 1, NULL);
+  if (SHOULD_SPIN_MOTORS) {
+    xTaskCreate(spinMotorsTask, "spinMotors", configMINIMAL_STACK_SIZE, NULL, 1, NULL);
+  }
   isInit = true;
 }