state machine

incorporate state machine for robot control options teleop, emergency, and autonomous