Work on Broken PIDs

This commit is contained in:
Aarav Shah
2020-02-26 20:29:01 -07:00
parent afaae3ca1d
commit 3a3d10a382
7 changed files with 31 additions and 29 deletions
@@ -64,7 +64,7 @@ public class TurnDegrees extends CommandBase {
// Returns true when the command should end.
@Override
public boolean isFinished() {
if ((Math.abs(m_drive.getTurnRate()) < 1) && (i > 5)) {
if ((Math.abs(m_drive.getTurnRate()) < 1) && (Math.abs(m_currentYawInTicks - m_targetAngleTicksOut) < 70)) {
return true;
}
return false;