Updated PID

I changed the PWM to the digitalWrite like Palmeri's note said