From 0c4d8050547364ca2051cbb92ddff5b7d79a3354 Mon Sep 17 00:00:00 2001
From: Fisch <interfisch@gmx.net>
Date: Sat, 29 May 2021 12:20:55 +0200
Subject: [PATCH] fix meanrpm calculation

---
 controller_teensy/src/main.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/controller_teensy/src/main.cpp b/controller_teensy/src/main.cpp
index eeca269..0b81873 100644
--- a/controller_teensy/src/main.cpp
+++ b/controller_teensy/src/main.cpp
@@ -315,7 +315,7 @@ void loop() {
     sendCMD();    
 
     //Update speed and trip
-    float _meanRPM=FeedbackFront.speedL_meas-FeedbackFront.speedR_meas+FeedbackRear.speedL_meas-FeedbackRear.speedR_meas;
+    float _meanRPM=(FeedbackFront.speedL_meas-FeedbackFront.speedR_meas+FeedbackRear.speedL_meas-FeedbackRear.speedR_meas)/4.0;
     meanSpeedms=_meanRPM*wheelcircumference/60.0;   // Units: 1/min * m / 60s
     trip+=abs(meanSpeedms)* (SENDPERIOD/1000.0);