Refactor code so that each roboclaw is on its own UART