mirror of
https://github.com/EFeru/hoverboard-firmware-hack-FOC.git
synced 2025-07-29 23:27:14 +02:00
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) {
|
void calcAvgSpeed(void) {
|
||||||
// Calculate measured average speed. The minus sign (-) is because motors spin in opposite directions
|
// 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;
|
speedAvg = 0;
|
||||||
#if defined(MOTOR_LEFT_ENA)
|
#if defined(MOTOR_LEFT_ENA)
|
||||||
#if defined(INVERT_L_DIRECTION)
|
#if defined(INVERT_L_DIRECTION)
|
||||||
|
Reference in New Issue
Block a user