PWM change
Motor driving done, added handling of negative force values.