Better arm logging

This commit is contained in:
Austen Adler 2016-09-22 10:27:41 -04:00
parent 2d5b3699b6
commit 5aa7e83bfa
No known key found for this signature in database
GPG Key ID: 7ECEE590CCDFE3F1

View File

@ -25,6 +25,8 @@ public class AutoSetArmPosition extends CommandBase {
protected boolean isFinished() {
// Stop when either limit switch is hit
System.out.println("AutoSetArmPosition.isFinished(): " + (Math.abs(pos - mainArm.getDegrees()) <= 1));
System.out.println(" pos : " + pos);
System.out.println(" mainArm.getDegrees() : " + mainArm.getDegrees())
return Math.abs(pos - mainArm.getDegrees()) <= 1;
}
// Called once after isFinished returns true