All low gear PIDs WORKY, test auto command WORKY

This commit is contained in:
Aarav Shah
2020-02-28 17:38:15 -07:00
parent 08b8797152
commit c572182678
6 changed files with 26 additions and 24 deletions
@@ -58,7 +58,7 @@ public class DriveStraightToPositionPID extends CommandBase {
// Returns true when the command should end.
@Override
public boolean isFinished() {
if (Math.abs((int)m_drive.m_rightFrontMotor.getSelectedSensorVelocity(DriveConstants.PID_PRIMARY)) < 5 && i > 5){
if (Math.abs((int)m_drive.m_rightFrontMotor.getSelectedSensorVelocity(DriveConstants.PID_PRIMARY)) < 5 && i > 10){
return true;
} else {
i++;