From 29535a26e67bac30b05edd1244414c8d01f78524 Mon Sep 17 00:00:00 2001 From: Candas1 Date: Mon, 25 Apr 2022 21:31:14 +0200 Subject: [PATCH] Update util.c --- Src/util.c | 10 ---------- 1 file changed, 10 deletions(-) diff --git a/Src/util.c b/Src/util.c index 419acfc..cf46bff 100644 --- a/Src/util.c +++ b/Src/util.c @@ -459,16 +459,6 @@ void beepShortMany(uint8_t cnt, int8_t dir) { void calcAvgSpeed(void) { // Calculate measured average speed. The minus sign (-) is because motors spin in opposite directions - #if !defined(INVERT_L_DIRECTION) && !defined(INVERT_R_DIRECTION) - speedAvg = ( rtY_Left.n_mot - rtY_Right.n_mot); - #elif !defined(INVERT_L_DIRECTION) && defined(INVERT_R_DIRECTION) - speedAvg = ( rtY_Left.n_mot + rtY_Right.n_mot); - #elif defined(INVERT_L_DIRECTION) && !defined(INVERT_R_DIRECTION) - speedAvg = (-rtY_Left.n_mot - rtY_Right.n_mot); - #elif defined(INVERT_L_DIRECTION) && defined(INVERT_R_DIRECTION) - speedAvg = (-rtY_Left.n_mot + rtY_Right.n_mot); - #endif - speedAvg = 0; #if defined(MOTOR_LEFT_ENA) #if defined(INVERT_L_DIRECTION)