fix object avoidance, log all imu data, object avoidance fix in robot control, if speed controller disconnect return 1