Currently if the robot isn't powered up correctly, the extender goes out.
Need to add an initialize state that retracts the extender until the limit switch is tripped. This should be the first state run (could even always run it in AutonInit and TeleopInit).
Auton Primitive (resetPosition could even automatically call the initialize state)
Thus, we know zero is always hit. Could add a failsafe for the limit switch to see if the motor is stalled and if it is, treat it as if the limit switch is tripped.
Currently if the robot isn't powered up correctly, the extender goes out.
Need to add an initialize state that retracts the extender until the limit switch is tripped. This should be the first state run (could even always run it in AutonInit and TeleopInit).
Auton Primitive (resetPosition could even automatically call the initialize state)
Thus, we know zero is always hit. Could add a failsafe for the limit switch to see if the motor is stalled and if it is, treat it as if the limit switch is tripped.