Now a p-controller is used to control the speed of the robot according to the distance between the hand and the robot