Enabling fast PWM / phase-correct PWM on pin 5 correctly?