Now it uses a class instead of a global variable to control the movement of the robot
Now a p-controller is used to control the speed of the robot according to the distance between the hand and the robot
p value changed. It was excesevely too low