Finished 1st version of psm code
-implemented functions to turn, move forward, backward
-state machine used after system updates
-Need to add the JUMP to any address command
-Need to add to the LED function
comments

-added to explain how to revert to proj1demo as this won't run properly yet