1kHz PWM work.
Little cleanup