Added two timers for dual PWM. Not quite working.
Caught edge cases, badly.