dshot bidir

paparazzi · Mar 19, 2024 · 024d589 · 024d589
1 parent 60b3d4a
commit 024d589
Show file tree

Hide file tree

Showing 19 changed files with 4,486 additions and 282 deletions.
diff --git a/conf/modules/actuators_dshot.xml b/conf/modules/actuators_dshot.xml
@@ -9,6 +9,7 @@
       It might be required to disable by hand some PWM output to avoid conflicts when they are activated by default on a board.
       Currently only implemented over ChibiOS.
     </description>
+    <configure name="DSHOT_BIDIR" value="FALSE" description="Bidirectionnal DSHOT for fast rpm feedback"/>
     <define name="DSHOT_SPEED" value="600" description="DSHOT speed (150,300,600,1200)"/>
   </doc>
   <dep>
@@ -19,8 +20,15 @@
     <file name="actuators_dshot.h"/>
   </header>
   <makefile>
+    <configure name="DSHOT_BIDIR" default="FALSE"/>
+    <define name="DSHOT_BIDIR" value="$(DSHOT_BIDIR)"/>
+    <define name="USE_GPT7" value="TRUE" cond="ifeq ($(DSHOT_BIDIR),TRUE)"/>
     <file_arch name="actuators_dshot_arch.c"/>
     <file_arch name="esc_dshot.c" cond="ifeq ($(RTOS),chibios)"/>
+    <file_arch name="dshot_rpmCapture.c" cond="ifeq ($(DSHOT_BIDIR),TRUE)"/>
+    <file_arch name="dshot_erps.c" cond="ifeq ($(DSHOT_BIDIR),TRUE)"/>
+    <file_arch name="inputCapture.c" cond="ifeq ($(DSHOT_BIDIR),TRUE)"/>
+    <file_arch name="timerDmaCache.c" cond="ifeq ($(DSHOT_BIDIR),TRUE)"/>
     <file_arch name="hal_stm32_dma.c" dir="mcu_periph" cond="ifeq ($(RTOS),chibios)"/>
     <test/>
   </makefile>

diff --git a/sw/airborne/arch/chibios/mcu_periph/gpio_arch.c b/sw/airborne/arch/chibios/mcu_periph/gpio_arch.c
@@ -58,6 +58,10 @@ void gpio_setup_input_pulldown(ioportid_t port, uint16_t gpios)
   chSysUnlock();
 }
 
+void gpio_setup_pin_af_pullup(ioportid_t port, uint16_t pin, uint8_t af) {
+  palSetPadMode(port, pin, PAL_MODE_ALTERNATE(af) | PAL_STM32_PUPDR_PULLUP);
+}
+
 void gpio_setup_pin_af(ioportid_t port, uint16_t pin, uint8_t af, bool is_output)
 {
   chSysLock();

diff --git a/sw/airborne/arch/chibios/mcu_periph/gpio_arch.h b/sw/airborne/arch/chibios/mcu_periph/gpio_arch.h
@@ -72,6 +72,12 @@ extern void gpio_setup_input_pulldown(ioportid_t port, uint16_t gpios);
  */
 extern void gpio_setup_pin_af(ioportid_t port, uint16_t pin, uint8_t af, bool is_output);
 
+/**
+ * Setup a gpio for input pullup with alternate function.
+ * This is an STM32 specific helper funtion and should only be used in stm32 code.
+*/
+void gpio_setup_pin_af_pullup(ioportid_t port, uint16_t pin, uint8_t af);
+
 /**
  * Setup a gpio for analog use.
  * @param[in] port