Create setAbsoluteTurnPID

This commit is contained in:
Keenan D. Buckley
2019-03-07 18:46:38 -07:00
parent 5ec1f70f43
commit 45dda45878
@@ -452,6 +452,13 @@ public class Drive extends Subsystem implements ControlLoopable
pidTurnController.setPIDTurnTarget(relativeTurnAngleDeg + getGyroAngleDeg(), maxError, maxPrevError, turnType);
setControlMode(DriveControlMode.PID_TURN);
}
public void setAbsoluteTurnPID(double absoluteTurnAngleDeg, double maxError, double maxPrevError, MPSoftwareTurnType turnType) {
this.targetPIDAngle = absoluteTurnAngleDeg;
pidTurnController.setPIDTurnTarget(absoluteTurnAngleDeg, maxError, maxPrevError, turnType);
setControlMode(DriveControlMode.PID_TURN);
}
/*
public void setPathMP(PathGenerator path) {
mpPathController.setPID(mpPathPIDParams);