Revert "Merge request for changes to robot driver, teleop code and inter...

Reverts jhu-lcsr-forks/universal_robot#1 performed without review.