PWM implemented, needs oscilloscope testing.