TODO fix exeption
the robot has been converted to PWM. Updated my debug program to mirror that