Control Method Change

It’s been discovered that the quaternions calculated by the kinect do not translate well to the Nao angle space. With this being said a new method of calculating the angles will be used. Vectors will be drawn from a joint to its parent and child joint, and trigonometry will be used to find the pitch and roll angles.