Some changes to robot and sensor_control