Added State Switching and Cleaned up Tape Following Code

Allows switching between different States of the Robot. This is the
final run function