Cleaned up some type errors

Rewrote base robot class to use perfect localization