Update Drive.java

Added method turnToAngle
This commit is contained in:
nathanrsxtn
2019-03-07 15:31:07 -08:00
parent cfcbf2ce4a
commit 96d59feb5d
@@ -910,5 +910,8 @@ public class Drive extends Subsystem implements ControlLoopable
}
SmartDashboard.putNumber("Update Period (ms)", lastControlLoopUpdatePeriod * 1000.0);
}
}
public void turnToAngle(double targetAngle, double maxError, double maxPrevError, MPSoftwareTurnType turnType) {
setRelativeTurnPID(targetAngle - getGyroAngleDeg(), maxError, maxPrevError, turnType);
}
}