Esempio n. 1
0
        private static void DrawBone(IBody body, BitmapContext context, BoneTypeEx bone, Color color)
        {
            var startJoint = body.Joints[bone.StartJoint];
            var endJoint   = body.Joints[bone.EndJoint];

            // If we can't find either of these joints, exit
            if (startJoint.TrackingState == TrackingState.NotTracked ||
                endJoint.TrackingState == TrackingState.NotTracked)
            {
                return;
            }

            // Don't draw if both points are inferred
            if (startJoint.TrackingState == TrackingState.Inferred &&
                endJoint.TrackingState == TrackingState.Inferred)
            {
                return;
            }

            // If either isn't tracked, it is "inferred"
            if (startJoint.TrackingState != TrackingState.Tracked || endJoint.TrackingState != TrackingState.Tracked)
            {
                color.A = 192;
            }

            var startPoint = GetDepthSpacePoint(startJoint, body.HasMappedDepthPositions);
            var endPoint   = GetDepthSpacePoint(endJoint, body.HasMappedDepthPositions);

            context.WriteableBitmap.DrawLineAa(
                (int)startPoint.X,
                (int)startPoint.Y,
                (int)endPoint.X,
                (int)endPoint.Y,
                color);
        }
Esempio n. 2
0
 /// <summary>
 /// Returns the angle (in degrees) between the two specified
 /// <c>BoneTypeEx</c> values. Optionally allows for either or
 /// both bones to be inverted to achieve the desired orientation.
 /// </summary>
 public static double GetAngleBetween(this IBody body,
                                      BoneTypeEx boneTypeA,
                                      BoneTypeEx boneTypeB,
                                      bool invertBoneA = false,
                                      bool invertBoneB = false)
 {
     return(AngleBetween(body.GetVector(boneTypeA, invertBoneA), body.GetVector(boneTypeB, invertBoneB)));
 }
Esempio n. 3
0
 /// <summary>
 /// Returns the angle (in degrees) between the two specified
 /// <c>BoneTypeEx</c> values. Optionally allows for either or
 /// both bones to be inverted to achieve the desired orientation.
 /// </summary>
 public static double GetAngleBetween(this Body body,
                                      BoneTypeEx boneTypeA,
                                      BoneTypeEx boneTypeB,
                                      bool invertBoneA = false,
                                      bool invertBoneB = false)
 {
     return(((KinectBody)body).GetAngleBetween(boneTypeA, boneTypeB, invertBoneA, invertBoneB));
 }
Esempio n. 4
0
 /// <summary>
 /// Get a <c>Vector3</c> (SharpDX / DirectX) object representing the vector
 /// between the joints of the specified <c>BoneTypeEx</c> value. Optionally
 /// allows for the bone to be inverted to achieve the desired orientation.
 /// </summary>
 public static Vector3 GetVector(this IBody body, BoneTypeEx boneType, bool invert = false)
 {
     if (invert)
     {
         return(body.GetVector(boneType.EndJoint, boneType.StartJoint));
     }
     else
     {
         return(body.GetVector(boneType.StartJoint, boneType.EndJoint));
     }
 }
Esempio n. 5
0
        /// <summary>
        /// Initializes the <see cref="BoneTypeEx"/> class.
        /// </summary>
        static BoneTypeEx()
        {
            HipLeft = new BoneTypeEx()
            {
                Name = "HipLeft", DisplayName = "Left Hip", StartJoint = JointTypeEx.SpineBase, EndJoint = JointTypeEx.HipLeft
            };
            HipRight = new BoneTypeEx()
            {
                Name = "HipRight", DisplayName = "Right Hip", StartJoint = JointTypeEx.SpineBase, EndJoint = JointTypeEx.HipRight
            };
            LegUpperLeft = new BoneTypeEx()
            {
                Name = "LegUpperLeft", DisplayName = "Upper Left Leg", StartJoint = JointTypeEx.HipLeft, EndJoint = JointTypeEx.KneeLeft
            };
            LegUpperRight = new BoneTypeEx()
            {
                Name = "LegUpperRight", DisplayName = "Upper Right Leg", StartJoint = JointTypeEx.HipRight, EndJoint = JointTypeEx.KneeRight
            };
            LegLowerLeft = new BoneTypeEx()
            {
                Name = "LegLowerLeft", DisplayName = "Lower Left Leg", StartJoint = JointTypeEx.KneeLeft, EndJoint = JointTypeEx.AnkleLeft
            };
            LegLowerRight = new BoneTypeEx()
            {
                Name = "LegLowerRight", DisplayName = "Lower Right Leg", StartJoint = JointTypeEx.KneeRight, EndJoint = JointTypeEx.AnkleRight
            };
            FootLeft = new BoneTypeEx()
            {
                Name = "FootLeft", DisplayName = "Left Foot", StartJoint = JointTypeEx.AnkleLeft, EndJoint = JointTypeEx.FootLeft
            };
            FootRight = new BoneTypeEx()
            {
                Name = "FootRight", DisplayName = "Right Foot", StartJoint = JointTypeEx.AnkleRight, EndJoint = JointTypeEx.FootRight
            };
            SpineLower = new BoneTypeEx()
            {
                Name = "SpineLower", DisplayName = "Lower Spine", StartJoint = JointTypeEx.SpineBase, EndJoint = JointTypeEx.SpineMid
            };
            SpineUpper = new BoneTypeEx()
            {
                Name = "SpineUpper", DisplayName = "Upper Spine", StartJoint = JointTypeEx.SpineMid, EndJoint = JointTypeEx.SpineShoulder
            };
            ShoulderLeft = new BoneTypeEx()
            {
                Name = "ShoulderLeft", DisplayName = "Left Shoulder", StartJoint = JointTypeEx.SpineShoulder, EndJoint = JointTypeEx.ShoulderLeft
            };
            ShoulderRight = new BoneTypeEx()
            {
                Name = "ShoulderRight", DisplayName = "Right Shoulder", StartJoint = JointTypeEx.SpineShoulder, EndJoint = JointTypeEx.ShoulderRight
            };
            ArmUpperLeft = new BoneTypeEx()
            {
                Name = "ArmUpperLeft", DisplayName = "Upper Left Arm", StartJoint = JointTypeEx.ShoulderLeft, EndJoint = JointTypeEx.ElbowLeft
            };
            ArmUpperRight = new BoneTypeEx()
            {
                Name = "ArmUpperRight", DisplayName = "Upper Right Arm", StartJoint = JointTypeEx.ShoulderRight, EndJoint = JointTypeEx.ElbowRight
            };
            ArmLowerLeft = new BoneTypeEx()
            {
                Name = "ArmLowerLeft", DisplayName = "Lower Left Arm", StartJoint = JointTypeEx.ElbowLeft, EndJoint = JointTypeEx.WristLeft
            };
            ArmLowerRight = new BoneTypeEx()
            {
                Name = "ArmLowerRight", DisplayName = "Lower Right Arm", StartJoint = JointTypeEx.ElbowRight, EndJoint = JointTypeEx.WristRight
            };
            HandLeft = new BoneTypeEx()
            {
                Name = "HandLeft", DisplayName = "Left Hand", StartJoint = JointTypeEx.WristLeft, EndJoint = JointTypeEx.HandLeft
            };
            HandRight = new BoneTypeEx()
            {
                Name = "HandRight", DisplayName = "Right Hand", StartJoint = JointTypeEx.WristRight, EndJoint = JointTypeEx.HandRight
            };
            Head = new BoneTypeEx()
            {
                Name = "Head", DisplayName = "Head", StartJoint = JointTypeEx.SpineShoulder, EndJoint = JointTypeEx.Head
            };
            HipFull = new BoneTypeEx()
            {
                Name = "HipFull", DisplayName = "Full Hip", StartJoint = JointTypeEx.HipLeft, EndJoint = JointTypeEx.HipRight
            };
            ShoulderFull = new BoneTypeEx()
            {
                Name = "ShoulderFull", DisplayName = "Full Shoulders", StartJoint = JointTypeEx.ShoulderLeft, EndJoint = JointTypeEx.ShoulderRight
            };

            DrawnBones = new List <BoneTypeEx>()
            {
                HipLeft,
                HipRight,
                LegUpperLeft,
                LegUpperRight,
                LegLowerLeft,
                LegLowerRight,
                FootLeft,
                FootRight,
                SpineLower,
                SpineUpper,
                ShoulderLeft,
                ShoulderRight,
                ArmUpperLeft,
                ArmUpperRight,
                ArmLowerLeft,
                ArmLowerRight,
                HandLeft,
                HandRight,
                Head
            };

            AllBones = DrawnBones.ToList();
            AllBones.Add(HipFull);
            AllBones.Add(ShoulderFull);

            MirroredBones = new Dictionary <BoneTypeEx, BoneTypeEx>();
            MirroredBones.Add(HipLeft, HipRight);
            MirroredBones.Add(HipRight, HipLeft);
            MirroredBones.Add(LegUpperLeft, LegUpperRight);
            MirroredBones.Add(LegUpperRight, LegUpperLeft);
            MirroredBones.Add(LegLowerLeft, LegLowerRight);
            MirroredBones.Add(LegLowerRight, LegLowerLeft);
            MirroredBones.Add(FootLeft, FootRight);
            MirroredBones.Add(FootRight, FootLeft);
            MirroredBones.Add(SpineLower, SpineLower);
            MirroredBones.Add(SpineUpper, SpineUpper);
            MirroredBones.Add(ShoulderLeft, ShoulderRight);
            MirroredBones.Add(ShoulderRight, ShoulderLeft);
            MirroredBones.Add(ArmUpperLeft, ArmUpperRight);
            MirroredBones.Add(ArmUpperRight, ArmUpperLeft);
            MirroredBones.Add(ArmLowerLeft, ArmLowerRight);
            MirroredBones.Add(ArmLowerRight, ArmLowerLeft);
            MirroredBones.Add(HandLeft, HandRight);
            MirroredBones.Add(HandRight, HandLeft);
            MirroredBones.Add(Head, Head);
            MirroredBones.Add(HipFull, HipFull);
            MirroredBones.Add(ShoulderFull, ShoulderFull);

            ByName = new Dictionary <string, BoneTypeEx>();
            foreach (var bone in AllBones)
            {
                ByName.Add(bone.Name, bone);
            }
        }
Esempio n. 6
0
        private static void DrawBone(IBody body, BitmapContext context, BoneTypeEx bone, Color color)
        {
            var startJoint = body.Joints[bone.StartJoint];
            var endJoint = body.Joints[bone.EndJoint];

            // If we can't find either of these joints, exit
            if (startJoint.TrackingState == TrackingState.NotTracked ||
                endJoint.TrackingState == TrackingState.NotTracked)
            {
                return;
            }

            // Don't draw if both points are inferred
            if (startJoint.TrackingState == TrackingState.Inferred &&
                endJoint.TrackingState == TrackingState.Inferred)
            {
                return;
            }

            // If either isn't tracked, it is "inferred"
            if (startJoint.TrackingState != TrackingState.Tracked || endJoint.TrackingState != TrackingState.Tracked)
            {
                color.A = 192;
            }

            var startPoint = GetDepthSpacePoint(startJoint, body.HasMappedDepthPositions);
            var endPoint = GetDepthSpacePoint(endJoint, body.HasMappedDepthPositions);

            context.WriteableBitmap.DrawLineAa(
                (int)startPoint.X,
                (int)startPoint.Y,
                (int)endPoint.X,
                (int)endPoint.Y,
                color);
        }
Esempio n. 7
0
 /// <summary>
 /// Gets a <c>Bone</c> structure containing the two <c>IJoint</c> values
 /// that constitute the start and end of the specified <c>BoneTypeEx</c>.
 /// </summary>
 public static Bone GetBone(this Body body, BoneTypeEx boneType)
 {
     return(((KinectBody)body).GetBone(boneType));
 }
Esempio n. 8
0
 /// <summary>
 /// Get a <c>Vector3</c> (SharpDX / DirectX) object representing the vector
 /// between the joints of the specified <c>BoneTypeEx</c> value. Optionally
 /// allows for the bone to be inverted to achieve the desired orientation.
 /// </summary>
 public static Vector3 GetVector(this Body body, BoneTypeEx boneType, bool invert = false)
 {
     return(((KinectBody)body).GetVector(boneType, invert));
 }
Esempio n. 9
0
 /// <summary>
 /// Gets a <c>Bone</c> structure containing the two <c>IJoint</c> values
 /// that constitute the start and end of the specified <c>BoneTypeEx</c>.
 /// </summary>
 public static Bone GetBone(this IBody body, BoneTypeEx boneType)
 {
     return(new Bone(boneType, body.Joints[boneType.StartJoint], body.Joints[boneType.EndJoint]));
 }
Esempio n. 10
0
        /// <summary>
        /// Initializes the <see cref="BoneTypeEx"/> class.
        /// </summary>
        static BoneTypeEx()
        {
            HipLeft = new BoneTypeEx() { Name = "HipLeft", DisplayName = "Left Hip", StartJoint = JointTypeEx.SpineBase, EndJoint = JointTypeEx.HipLeft };
            HipRight = new BoneTypeEx() { Name = "HipRight", DisplayName = "Right Hip", StartJoint = JointTypeEx.SpineBase, EndJoint = JointTypeEx.HipRight };
            LegUpperLeft = new BoneTypeEx() { Name = "LegUpperLeft", DisplayName = "Upper Left Leg", StartJoint = JointTypeEx.HipLeft, EndJoint = JointTypeEx.KneeLeft };
            LegUpperRight = new BoneTypeEx() { Name = "LegUpperRight", DisplayName = "Upper Right Leg", StartJoint = JointTypeEx.HipRight, EndJoint = JointTypeEx.KneeRight };
            LegLowerLeft = new BoneTypeEx() { Name = "LegLowerLeft", DisplayName = "Lower Left Leg", StartJoint = JointTypeEx.KneeLeft, EndJoint = JointTypeEx.AnkleLeft };
            LegLowerRight = new BoneTypeEx() { Name = "LegLowerRight", DisplayName = "Lower Right Leg", StartJoint = JointTypeEx.KneeRight, EndJoint = JointTypeEx.AnkleRight };
            FootLeft = new BoneTypeEx() { Name = "FootLeft", DisplayName = "Left Foot", StartJoint = JointTypeEx.AnkleLeft, EndJoint = JointTypeEx.FootLeft };
            FootRight = new BoneTypeEx() { Name = "FootRight", DisplayName = "Right Foot", StartJoint = JointTypeEx.AnkleRight, EndJoint = JointTypeEx.FootRight };
            SpineLower = new BoneTypeEx() { Name = "SpineLower", DisplayName = "Lower Spine", StartJoint = JointTypeEx.SpineBase, EndJoint = JointTypeEx.SpineMid };
            SpineUpper = new BoneTypeEx() { Name = "SpineUpper", DisplayName = "Upper Spine", StartJoint = JointTypeEx.SpineMid, EndJoint = JointTypeEx.SpineShoulder };
            ShoulderLeft = new BoneTypeEx() { Name = "ShoulderLeft", DisplayName = "Left Shoulder", StartJoint = JointTypeEx.SpineShoulder, EndJoint = JointTypeEx.ShoulderLeft };
            ShoulderRight = new BoneTypeEx() { Name = "ShoulderRight", DisplayName = "Right Shoulder", StartJoint = JointTypeEx.SpineShoulder, EndJoint = JointTypeEx.ShoulderRight };
            ArmUpperLeft = new BoneTypeEx() { Name = "ArmUpperLeft", DisplayName = "Upper Left Arm", StartJoint = JointTypeEx.ShoulderLeft, EndJoint = JointTypeEx.ElbowLeft };
            ArmUpperRight = new BoneTypeEx() { Name = "ArmUpperRight", DisplayName = "Upper Right Arm", StartJoint = JointTypeEx.ShoulderRight, EndJoint = JointTypeEx.ElbowRight };
            ArmLowerLeft = new BoneTypeEx() { Name = "ArmLowerLeft", DisplayName = "Lower Left Arm", StartJoint = JointTypeEx.ElbowLeft, EndJoint = JointTypeEx.WristLeft };
            ArmLowerRight = new BoneTypeEx() { Name = "ArmLowerRight", DisplayName = "Lower Right Arm", StartJoint = JointTypeEx.ElbowRight, EndJoint = JointTypeEx.WristRight };
            HandLeft = new BoneTypeEx() { Name = "HandLeft", DisplayName = "Left Hand", StartJoint = JointTypeEx.WristLeft, EndJoint = JointTypeEx.HandLeft };
            HandRight = new BoneTypeEx() { Name = "HandRight", DisplayName = "Right Hand", StartJoint = JointTypeEx.WristRight, EndJoint = JointTypeEx.HandRight };
            Head = new BoneTypeEx() { Name = "Head", DisplayName = "Head", StartJoint = JointTypeEx.SpineShoulder, EndJoint = JointTypeEx.Head };
            HipFull = new BoneTypeEx() { Name = "HipFull", DisplayName = "Full Hip", StartJoint = JointTypeEx.HipLeft, EndJoint = JointTypeEx.HipRight };
            ShoulderFull = new BoneTypeEx() { Name = "ShoulderFull", DisplayName = "Full Shoulders", StartJoint = JointTypeEx.ShoulderLeft, EndJoint = JointTypeEx.ShoulderRight };

            DrawnBones = new List<BoneTypeEx>()
            {
                HipLeft,
                HipRight,
                LegUpperLeft,
                LegUpperRight,
                LegLowerLeft,
                LegLowerRight,
                FootLeft,
                FootRight,
                SpineLower,
                SpineUpper,
                ShoulderLeft,
                ShoulderRight,
                ArmUpperLeft,
                ArmUpperRight,
                ArmLowerLeft,
                ArmLowerRight,
                HandLeft,
                HandRight,
                Head
            };

            AllBones = DrawnBones.ToList();
            AllBones.Add(HipFull);
            AllBones.Add(ShoulderFull);

            MirroredBones = new Dictionary<BoneTypeEx, BoneTypeEx>();
            MirroredBones.Add(HipLeft, HipRight);
            MirroredBones.Add(HipRight, HipLeft);
            MirroredBones.Add(LegUpperLeft, LegUpperRight);
            MirroredBones.Add(LegUpperRight, LegUpperLeft);
            MirroredBones.Add(LegLowerLeft, LegLowerRight);
            MirroredBones.Add(LegLowerRight, LegLowerLeft);
            MirroredBones.Add(FootLeft, FootRight);
            MirroredBones.Add(FootRight, FootLeft);
            MirroredBones.Add(SpineLower, SpineLower);
            MirroredBones.Add(SpineUpper, SpineUpper);
            MirroredBones.Add(ShoulderLeft, ShoulderRight);
            MirroredBones.Add(ShoulderRight, ShoulderLeft);
            MirroredBones.Add(ArmUpperLeft, ArmUpperRight);
            MirroredBones.Add(ArmUpperRight, ArmUpperLeft);
            MirroredBones.Add(ArmLowerLeft, ArmLowerRight);
            MirroredBones.Add(ArmLowerRight, ArmLowerLeft);
            MirroredBones.Add(HandLeft, HandRight);
            MirroredBones.Add(HandRight, HandLeft);
            MirroredBones.Add(Head, Head);
            MirroredBones.Add(HipFull, HipFull);
            MirroredBones.Add(ShoulderFull, ShoulderFull);

            ByName = new Dictionary<string, BoneTypeEx>();
            foreach (var bone in AllBones)
            {
                ByName.Add(bone.Name, bone);
            }
        }