Added PWM
Improved E-stop