Fixed issues with communication and writing to motors.