Created start for manual wrist movement

This is unfinished code
This commit is contained in:
mayabartels
2019-01-25 16:27:42 -08:00
parent cc4ff1a22b
commit 747e1eee79
@@ -77,6 +77,30 @@ public class Wrist extends Subsystem
}
}
public void manualWristMove()
{
double wristJoystickInput;
boolean manualOverride;
wristJoystickInput = Robot.oi.getOperatorController().getLeftYAxis();
manualOverride = Robot.oi.getOperatorJoystick().getRawButton(XboxController.A_BUTTON);
if(manualOverride == true)
{
setWristControlMode(wristControlMode.JOYSTICK_MANUAL);
}
else if(manualOverride == false)
{
setWristControlMode(wristControlMode.PID);
}
while(getWristControlMode() == wristControlMode.JOYSTICK_MANUAL)
{
wristRight.set(wristJoystickInput);
}
}
/*
public double armAngle(double encoderValue)
{
@@ -96,7 +120,7 @@ public class Wrist extends Subsystem
private synchronized WristControlMode getWristControlMode()
{
return this.wristControlMode;
}
}
public void setSpeed(double speed)
{