public void calMove() { m_Head = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.Head], skel_last.Joints[JointType.Head]); m_SC = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.ShoulderCenter], skel_last.Joints[JointType.ShoulderCenter]); m_SL = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.ShoulderLeft], skel_last.Joints[JointType.ShoulderLeft]); m_SR = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.ShoulderRight], skel_last.Joints[JointType.ShoulderRight]); m_EL = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.ElbowLeft], skel_last.Joints[JointType.ElbowLeft]); m_ER = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.ElbowRight], skel_last.Joints[JointType.ElbowRight]); m_WL = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.WristLeft], skel_last.Joints[JointType.WristLeft]); m_WR = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.WristRight], skel_last.Joints[JointType.WristRight]); m_HL = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.HandLeft], skel_last.Joints[JointType.HandLeft]); m_HR = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.HandRight], skel_last.Joints[JointType.HandRight]); m_Sp = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.Spine], skel_last.Joints[JointType.Spine]); m_HpC = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.HipCenter], skel_last.Joints[JointType.HipCenter]); m_HpL = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.HipLeft], skel_last.Joints[JointType.HipLeft]); m_HpR = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.HipRight], skel_last.Joints[JointType.HipRight]); m_KL = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.KneeLeft], skel_last.Joints[JointType.KneeLeft]); m_KR = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.KneeRight], skel_last.Joints[JointType.KneeRight]); m_AL = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.AnkleLeft], skel_last.Joints[JointType.AnkleLeft]); m_AR = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.AnkleRight], skel_last.Joints[JointType.AnkleRight]); m_FL = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.FootLeft], skel_last.Joints[JointType.FootLeft]); m_FR = TheTool.calEuclidian_2Joint(skel_current.Joints[JointType.FootRight], skel_last.Joints[JointType.FootRight]); }
double getDist(JointType j1, JointType j2) { return(TheTool.calEuclidian_2Joint(posture_current.Joints[j1], posture_current.Joints[j2])); }