Quicker speed decay when slowing down

emmebrusa · Oct 27, 2023 · 24fe1ba · 24fe1ba
1 parent cf69065
commit 24fe1ba
Showing 1 changed file with 8 additions and 0 deletions.
diff --git a/src/controller/motor.c b/src/controller/motor.c
@@ -893,6 +893,10 @@ void TIM1_CAP_COM_IRQHandler(void) __interrupt(TIM1_CAP_COM_IRQHANDLER)
             // save current PAS state
             ui8_pas_state_old = ui8_pas_state;
         }
+        if (ui16_cadence_calc_counter > ui16_cadence_sensor_ticks) {
+                // next pulse later than previous - start decaying the speed
+                ui16_cadence_sensor_ticks = ui16_cadence_calc_counter;
+        }
 
         if (++ui16_cadence_stop_counter > ui16_cadence_sensor_ticks_counter_min) {
             // pedals stop detected
@@ -944,6 +948,10 @@ void TIM1_CAP_COM_IRQHandler(void) __interrupt(TIM1_CAP_COM_IRQHANDLER)
 					}
 				}
 			}
+            if (ui16_wheel_speed_sensor_ticks_counter > ui16_wheel_speed_sensor_ticks) {
+                //strat decaying the speed if thte pulse is coming later than last time
+                ui16_wheel_speed_sensor_ticks = ui16_wheel_speed_sensor_ticks_counter;
+            }
 		}
 
         // increment and also limit the ticks counter