forked from EFeru/hoverboard-firmware-hack-FOC
Update util.c
This commit is contained in:
10
Src/util.c
10
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)
|
||||
|
Reference in New Issue
Block a user