reduced velocity gain to 1.5 and max speed is now 1.5m/s as compared to the previous 2m/s.

Still need to refine gripper. remove toggle.