Remove everything except the motor control code to test the Motor Controllers.