Added calculation of:
 * position of hand
 * calculation of pitch, yaw and roll angles