speed kartculator

2023-09-01 16:37:46 +02:00 · 2023-09-01 16:37:46 +02:00 · 9b304aec93
commit 9b304aec93
parent 863977e20f
1 changed files with 9 additions and 1 deletions
--- a/306-controller_interface.X/app/kartculator.c
+++ b/306-controller_interface.X/app/kartculator.c
@ -21,7 +21,15 @@ void calcPosition(uint8_t joy_pos){
 }

 void calcSpeed(int32_t rpm) {
-    
+    int32_t calcSpeed;
+    if(rpm>=0){
+        calcSpeed = rpm;
+    } else {
+        calcSpeed = -rpm;
+    }
+    calcSpeed *= 1000;
+    calcSpeed /= KART_CST.CONTROL_SPEED_FACTOR;
+    eKart.speed = (uint8_t) calcSpeed;
 }

 int16_t getTorque() {