Fixed a bug where CDONE checks did not use UART_to_motor_id[]