Remove reference code that was not supposed to be used
Fix missing imports and syntax errors
Fix a few bugs with process robot data
Extend teleop cli to handle other robot methods