Refactor robot control program to use StateMachine library (instead of duplicating the code) #13

Closed daniel-packard closed 2 years ago