diff --git a/controller_teensy/src/main.cpp b/controller_teensy/src/main.cpp
index 1c01163..e189588 100644
--- a/controller_teensy/src/main.cpp
+++ b/controller_teensy/src/main.cpp
@@ -295,7 +295,7 @@ void loop() {
 
   if (newData2 || newData3) { //when new data arrived from one controller
     float _meanRPM=FeedbackFront.speedL_meas-FeedbackFront.speedR_meas+FeedbackRear.speedL_meas-FeedbackRear.speedR_meas;
-    float meanSpeedms=_meanRPM*wheelcircumference/60.0;   // Units: 1/min * m / 60s
+    meanSpeedms=_meanRPM*wheelcircumference/60.0;   // Units: 1/min * m / 60s
     trip+=abs(meanSpeedms)* (millis()-last_feedback) / 1000.0;    
     last_feedback=millis();
   }