private bool IsPose(Skeleton skeleton, Pose pose)
{
bool isPose = true;
double angle;
double poseAngle;
double poseThreshold;
double loAngle;
double hiAngle;
for (int i = 0; i < pose.Angles.Length && isPose; i++)
{
poseAngle = pose.Angles[i].Angle;
poseThreshold = pose.Angles[i].Threshold;
angle = GetJointAngle(skeleton.Joints[pose.Angles[i].CenterJoint], skeleton.Joints[pose.Angles[i].AngleJoint]);
hiAngle = poseAngle + poseThreshold;
loAngle = poseAngle - poseThreshold;
if (hiAngle >= 360 || loAngle < 0)
{
loAngle = (loAngle < 0) ? 360 + loAngle : loAngle;
hiAngle = hiAngle % 360;
isPose = !(loAngle > angle && angle > hiAngle);
}
else
{
isPose = (loAngle <= angle && hiAngle >= angle);
}
}
return isPose;
}
public void createTpose()
{
Tpose = new Pose();
Tpose.Title = "T";
Tpose.Angles = new PoseAngle[4];
Tpose.Angles[0] = new PoseAngle(JointType.ShoulderLeft, JointType.ElbowLeft, 180, 20);
Tpose.Angles[1] = new PoseAngle(JointType.ElbowLeft, JointType.WristLeft, 180, 20);
Tpose.Angles[2] = new PoseAngle(JointType.ShoulderRight, JointType.ElbowRight, 0, 20);
Tpose.Angles[3] = new PoseAngle(JointType.ElbowRight, JointType.WristRight, 0, 20);
}
