From 5f063a0bb64a90f7c435f55c6ed0a66c9e4863c4 Mon Sep 17 00:00:00 2001
From: Fisch <interfisch@gmx.net>
Date: Thu, 2 Jan 2020 19:36:11 +0100
Subject: [PATCH] fix speed calculation. should fix low voltage poweroff while
 driving

---
 Src/main.c | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/Src/main.c b/Src/main.c
index b714bf2..96150d2 100644
--- a/Src/main.c
+++ b/Src/main.c
@@ -408,7 +408,7 @@ int main(void) {
     speedL = speedLeftFixdt >> 4;  // convert fixed-point to integer
     speedR = speedRightFixdt >> 4;  // convert fixed-point to integer
 
-    speed = (speedL+speedR)/2;
+    speed = (abs(speedL)+abs(speedR))/2;
 
     // ####### MIXER #######
     // speedR = CLAMP((int)(speed * SPEED_COEFFICIENT -  steer * STEER_COEFFICIENT), -1000, 1000);