Adding Ethan's additional teleop program

Ethan, *please* try something a litte more organized next time. Maybe
some #defines and #ifdefs?
Please?
One file?