Shauns Motor Driver code

PWM is working