Implementing motor control
Smooth action
Adjusted the integral constant