Implemented control of the lever arm and the gate servo.
Wrote calibration routine that allows ideal servo positions to be found.
Moved VPS point locator routine to a file under calibrations.
Added middle state for the lever arm where it can trip the mine lever without going all the way up.