setup code to fix broken dead assist

This commit is contained in:
ryan123rudder
2020-02-13 17:08:41 -07:00
parent 3e248bd186
commit 9014d00798
2 changed files with 13 additions and 1 deletions
@@ -86,21 +86,32 @@ public class DriveWithJoystickUsingDeadAssistPID extends CommandBase {
steerOutput = cosMultiplier*Math.cos(1.571*steerInput)-(cosMultiplier+deadzone);
}
m_drive.driveWithInput(moveOutput, steerOutput);
System.out.println("Driving With Input");
isAuxPIDEnabled = false;
}
/* If only the move stick is being used */
else {
m_drive.driveWithInputAux(moveOutput, m_targetGyro);
System.out.println("Driving with Input Aux with Target: " + m_targetGyro);
isAuxPIDEnabled = true;
}
}
/* If the move stick is not being used */
else {
m_drive.runDriveStraightVelocityPID(0, m_targetGyro);
System.out.println("Driving with Velocity PID with Target: " + m_targetGyro);
isAuxPIDEnabled = true;
}
}
private void updateGyroTarget() {
}
private void resetGyroTarget() {
}
// Called once the command ends or is interrupted.
@Override
public void end(boolean interrupted) {