Create the lifter subsystem with the following directives
Normal mode:
Calibrate
Go to a given height (invalid if not calibrated, invalid if in low gearn)
Set the lifter to low gear
Set the lifter to high gear
Set lifter motor to given duty cycle (if in low gear, invalidates calibration)
Climb Mode:
Hold the current position (encoder ticks based)
Set lifter motor to given duty cycle
Create the lifter subsystem with the following directives
Normal mode: Calibrate Go to a given height (invalid if not calibrated, invalid if in low gearn) Set the lifter to low gear Set the lifter to high gear Set lifter motor to given duty cycle (if in low gear, invalidates calibration)
Climb Mode: Hold the current position (encoder ticks based) Set lifter motor to given duty cycle