public bool isValid(coord[] _player, double _variance = 0)
        {
            bool retval = true;
            SetPlayer(_player);

            //Convert to radians
            _variance = _variance * Math.PI / 180;
            CalculateTheta(ref player);
            CalculateTheta(ref simon);
            if (!(retval && Math.Abs(player[(int)KSSJoint.relbow].theta - simon[(int)KSSJoint.relbow].theta) <= _variance))
                retval = false;
            if (!(retval && Math.Abs(player[(int)KSSJoint.rhand].theta - simon[(int)KSSJoint.rhand].theta) <= _variance))
                retval = false;
            if (!(retval && Math.Abs(player[(int)KSSJoint.lelbow].theta - simon[(int)KSSJoint.lelbow].theta) <= _variance))
                retval = false;
            if (!(retval && Math.Abs(player[(int)KSSJoint.rknee].theta - simon[(int)KSSJoint.rknee].theta) <= _variance))
                retval = false;
            if (!(retval && Math.Abs(player[(int)KSSJoint.rfoot].theta - simon[(int)KSSJoint.rfoot].theta) <= _variance))
                retval = false;
            if (!(retval && Math.Abs(player[(int)KSSJoint.lhand].theta - simon[(int)KSSJoint.lhand].theta) <= _variance))
                retval = false;
            if (!(retval && Math.Abs(player[(int)KSSJoint.lknee].theta - simon[(int)KSSJoint.lknee].theta) <= _variance))
                retval = false;
            if (!(retval && Math.Abs(player[(int)KSSJoint.lfoot].theta - simon[(int)KSSJoint.lfoot].theta) <= _variance))
                retval = false;

            return retval;
        }
 private void fillList(ref List<coord[]> EmptyList)
 {
     if (System.IO.File.Exists("PoseData.xml"))
     {
         XmlNodeList xmlnodes;
         XmlDocument xmldoc = new XmlDocument();
         xmldoc.Load("PoseData.xml");
         xmlnodes = xmldoc.SelectNodes("//Positions/Pose");
         foreach (XmlNode node in xmlnodes)
         {
             coord[] coords = new coord[11];
             fillCoords(ref coords, KSSJoint.head, "head", node);
             fillCoords(ref coords, KSSJoint.shoulder, "shoulder", node);
             fillCoords(ref coords, KSSJoint.hip, "hip", node);
             fillCoords(ref coords, KSSJoint.relbow, "relbow", node);
             fillCoords(ref coords, KSSJoint.rhand, "rhand", node);
             fillCoords(ref coords, KSSJoint.lelbow, "lelbow", node);
             fillCoords(ref coords, KSSJoint.lhand, "lhand", node);
             fillCoords(ref coords, KSSJoint.rknee, "rknee", node);
             fillCoords(ref coords, KSSJoint.rfoot, "rfoot", node);
             fillCoords(ref coords, KSSJoint.lknee, "lknee", node);
             fillCoords(ref coords, KSSJoint.lfoot, "lfoot", node);
             EmptyList.Add(coords);
         }
     }
 }
 private void SetEllipsePosition(FrameworkElement ellipse, coord joint)
 {
     Canvas.SetLeft(ellipse, joint.x);
     Canvas.SetTop(ellipse, joint.y);
 }
 public Point UseSkeleton(coord[] skeletonCoords, ref Canvas SimonSaysPoseCanvas, ref Canvas PlayerPoseCanvas)
 {
     if (skeletonCoords != null)
     {
         KinectPose.drawPose(SimonSaysPoseCanvas.Children, KinectPose.GetSimon(), Colors.Black);
         if (skeletonCoords[(int)KSSJoint.head].x > 0)//this makes a big green blob if it isn't here.. odd
         {
             KinectPose.drawPose(PlayerPoseCanvas.Children, skeletonCoords, Colors.Green);
             KinectPose.SetPlayer(skeletonCoords);
         }
     }
     return (new Point(skeletonCoords[(int)KSSJoint.rhand].x, skeletonCoords[(int)KSSJoint.rhand].y));
 }
 public void SetPlayer(coord[] _player)
 {
     player = _player;
 }
 private void fillCoords(ref coord[] _coords, KSSJoint _joint, string nodename, XmlNode node)
 {
     _coords[(int)_joint].x = (float)XmlConvert.ToDecimal(node[nodename]["x"].InnerText);
     _coords[(int)_joint].y = (float)XmlConvert.ToDecimal(node[nodename]["y"].InnerText);
     _coords[(int)_joint].theta = (float)XmlConvert.ToDecimal(node[nodename]["theta"].InnerText);
 }
 public void drawPose(UIElementCollection _children, coord[] _pose, Color _color)
 {
     _children.Clear();
     _children.Add(getImage(_pose, _color));
 }
 public void SetSimon(coord[] newSimon)
 {
     simon = newSimon;
 }
 private LineGeometry getLine(KSSJoint _start, KSSJoint _end, coord[] _pose)
 {
     return new LineGeometry(new Point(_pose[(int)_start].x, _pose[(int)_start].y), new Point(_pose[(int)_end].x, _pose[(int)_end].y));
 }
Exemplo n.º 10
0
        private Image getImage(coord[] _pose, Color _color)
        {
            Image image = new Image();
            DrawingImage myDrawingImage = new DrawingImage();
            DrawingGroup myDrawingGroup = new DrawingGroup();
            GeometryDrawing myGeometryDrawing = new GeometryDrawing();
            GeometryGroup myGeometryGroup = new GeometryGroup();

            myGeometryGroup.Children.Add(getLine(KSSJoint.head, KSSJoint.shoulder, _pose));
            myGeometryGroup.Children.Add(getLine(KSSJoint.shoulder, KSSJoint.relbow, _pose));
            myGeometryGroup.Children.Add(getLine(KSSJoint.shoulder, KSSJoint.lelbow, _pose));
            myGeometryGroup.Children.Add(getLine(KSSJoint.relbow, KSSJoint.rhand, _pose));
            myGeometryGroup.Children.Add(getLine(KSSJoint.lelbow, KSSJoint.lhand, _pose));
            myGeometryGroup.Children.Add(getLine(KSSJoint.shoulder, KSSJoint.hip, _pose));
            myGeometryGroup.Children.Add(getLine(KSSJoint.hip, KSSJoint.rknee, _pose));
            myGeometryGroup.Children.Add(getLine(KSSJoint.hip, KSSJoint.lknee, _pose));
            myGeometryGroup.Children.Add(getLine(KSSJoint.rknee, KSSJoint.rfoot, _pose));
            myGeometryGroup.Children.Add(getLine(KSSJoint.lknee, KSSJoint.lfoot, _pose));

            Pen myPen = new Pen();
            myGeometryDrawing.Geometry = myGeometryGroup;
            myPen.Thickness = 10;
            myPen.LineJoin = PenLineJoin.Round;
            myPen.EndLineCap = PenLineCap.Round;
            myPen.StartLineCap = PenLineCap.Round;

            myPen.Brush = new SolidColorBrush(_color);
            myGeometryDrawing.Pen = myPen;
            myDrawingGroup.Children.Add(myGeometryDrawing);
            myDrawingImage.Drawing = myDrawingGroup;
            image.Name = "simonImage";
            image.Stretch = Stretch.Uniform;
            image.HorizontalAlignment = HorizontalAlignment.Stretch;
            image.VerticalAlignment = VerticalAlignment.Stretch;
            image.MaxHeight = 289;
            image.MaxWidth = 777;
            image.Width = 777;
            image.Source = myDrawingImage;

            return image;
        }
Exemplo n.º 11
0
        public void RecordNewPose(coord[] _player)
        {
            SetPlayer(_player);
            CalculateTheta(ref player);
            if (!System.IO.File.Exists("PoseData.xml"))
            {
                XmlTextWriter Writer = new XmlTextWriter("PoseData.xml", null);
                Writer.WriteStartDocument();
                Writer.WriteStartElement("Positions");
                Writer.WriteEndElement();
                Writer.Close();
            }

            XmlDocument xmlDoc = new XmlDocument();
            xmlDoc.Load("PoseData.xml");
            XmlElement subRoot = xmlDoc.CreateElement("Pose");
            subRoot.AppendChild(PoseElement("head", KSSJoint.head, xmlDoc));
            subRoot.AppendChild(PoseElement("shoulder", KSSJoint.shoulder, xmlDoc));
            subRoot.AppendChild(PoseElement("hip", KSSJoint.hip, xmlDoc));
            subRoot.AppendChild(PoseElement("relbow", KSSJoint.relbow, xmlDoc));
            subRoot.AppendChild(PoseElement("rhand", KSSJoint.rhand, xmlDoc));
            subRoot.AppendChild(PoseElement("lelbow", KSSJoint.lelbow, xmlDoc));
            subRoot.AppendChild(PoseElement("lhand", KSSJoint.lhand, xmlDoc));
            subRoot.AppendChild(PoseElement("rknee", KSSJoint.rknee, xmlDoc));
            subRoot.AppendChild(PoseElement("rfoot", KSSJoint.rfoot, xmlDoc));
            subRoot.AppendChild(PoseElement("lknee", KSSJoint.lknee, xmlDoc));
            subRoot.AppendChild(PoseElement("lfoot", KSSJoint.lfoot, xmlDoc));
            xmlDoc.DocumentElement.AppendChild(subRoot);
            //save document
            xmlDoc.Save("PoseData.xml");
        }
Exemplo n.º 12
0
 private float CalculateTheta(float _x, float _y, KSSJoint _joint, ref coord[] _coords)
 {
     float theta;
     theta = (float)Math.Atan2((double)(_y - _coords[(int)_joint].y), (double)(_coords[(int)_joint].x - _x));
     return theta;
 }
Exemplo n.º 13
0
        private void CalculateTheta(ref coord[] _coords)
        {
            float shoulderx = _coords[(int)KSSJoint.shoulder].x;
            float shouldery = _coords[(int)KSSJoint.shoulder].y;
            float hipx = _coords[(int)KSSJoint.hip].x;
            float hipy = _coords[(int)KSSJoint.hip].y;

            //upperbody
            _coords[(int)KSSJoint.relbow].theta = CalculateTheta(shoulderx, shouldery, KSSJoint.relbow, ref _coords);
            _coords[(int)KSSJoint.rhand].theta = CalculateTheta(shoulderx, shouldery, KSSJoint.rhand, ref _coords);
            _coords[(int)KSSJoint.lelbow].theta = CalculateTheta(shoulderx, shouldery, KSSJoint.lelbow, ref _coords);
            _coords[(int)KSSJoint.lhand].theta = CalculateTheta(shoulderx, shouldery, KSSJoint.lhand, ref _coords);
            //lowerbody
            _coords[(int)KSSJoint.rknee].theta = CalculateTheta(hipx, hipy, KSSJoint.rknee, ref _coords);
            _coords[(int)KSSJoint.rfoot].theta = CalculateTheta(hipx, hipy, KSSJoint.rfoot, ref _coords);
            _coords[(int)KSSJoint.lknee].theta = CalculateTheta(hipx, hipy, KSSJoint.lknee, ref _coords);
            _coords[(int)KSSJoint.lfoot].theta = CalculateTheta(hipx, hipy, KSSJoint.lfoot, ref _coords);
        }