Odometry fixes (but not really)

- Seems to only work on the left motor in low gear...no idea why
This commit is contained in:
Keenan D. Buckley
2020-02-25 17:47:47 -07:00
parent ac82fdad12
commit 0541a2463c
4 changed files with 29 additions and 13 deletions
@@ -52,8 +52,10 @@ public class DriveWithJoystick extends CommandBase {
double deadzone = .2;
if (steerInput > 0){
steerOutput = -cosMultiplier*Math.cos(1.571*steerInput)+(cosMultiplier+deadzone);
} else {
} else if (steerInput < 0) {
steerOutput = cosMultiplier*Math.cos(1.571*steerInput)-(cosMultiplier+deadzone);
} else {
steerOutput = 0;
}
m_drive.driveWithInput(moveOutput, steerOutput);