PWM now works. Need testing on robot