I want to control the robot using a Kinect sensor. I get the coordinates of the right hand joints and calculate the angle. This angle is applied to the robot and it squats. But