Quicker speed decay when slowing down

dzid26 · Nov 11, 2023 · ca636cf · ca636cf
1 parent c49b0a5
commit ca636cf
Showing 1 changed file with 8 additions and 0 deletions.
diff --git a/src/controller/motor.c b/src/controller/motor.c
@@ -891,6 +891,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
@@ -943,6 +947,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