From d11bed13114e5219ac91d0f84f9c685c641a328c Mon Sep 17 00:00:00 2001
From: Tove Rumar <tove@bitcraze.io>
Date: Mon, 12 Aug 2024 14:41:58 +0200
Subject: [PATCH] Add define to configure motor spin

Define if they should spin and at what speed
---
 src/deck/drivers/src/test/radiotest.c | 14 +++++++++++++-
 1 file changed, 13 insertions(+), 1 deletion(-)

diff --git a/src/deck/drivers/src/test/radiotest.c b/src/deck/drivers/src/test/radiotest.c
index 8de2bfb4b..1b777a5b8 100644
--- 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;
 }