Work on AVR PWM, rework libraries to reduce overhead