Robot moves, Teleop from FSM works!

The while loop in wall_follow isn't running continuously or is waiting on something. :(