add a P-gain for graceful stop

[padhupradheep]

Though the undocking vel is 0.1 m/s, it would be better if there is a P-Gain, so that the robot decelerates accordingly.