First hack at some mode/state/error handling. Still a big mess.
Added limit switch LEDs and hal connections
Added jog and increment starter code