PWM working - Needs calculations and timings