Clean up RobotControl and improve comments