Increased PWM frequency and fixed FET switch off
Moved enabling the FET to a more sensible place
Change speed and FET management