/**
* Uses the PID controller that is enabled/disabled in the main class to move to an upright
* position
*/
public void moveToUprightPos() {
vm.autoUpright = true;
stopJawPistons();
neckControl.setSetpoint(vm.JAW_UPRIGHT_POS);
// activate autoneck control if not within 5 ticks of upright position
if (!(sFunctions.getNeckPot() == vm.JAW_UPRIGHT_POS)) {
vm.autoUpright = true;
} else {
vm.autoUpright = false;
}
}
