cleaned up robot_controller and added a test.