PWM-Control-Test: Cleaned up code and added functioning PWM. Maybe we'll get the motor to move this time...