Gutted the last program, completely rewrote the FSM into the file robot1.py instead of robot0.py. This file actually works pretty well, it handles user commands easily and now I just need to get the vision control states to work and we will be done with lab #4