middleware/src/Tracking/Gestures/SwipeDetector.cs
changeset 3 92f19af39024
parent 0 6fefd4afe506
child 5 d40f84d77db4
--- a/middleware/src/Tracking/Gestures/SwipeDetector.cs	Fri Mar 09 18:15:12 2012 +0100
+++ b/middleware/src/Tracking/Gestures/SwipeDetector.cs	Thu Mar 15 13:33:21 2012 +0100
@@ -1,4 +1,16 @@
-using System;
+/*
+ * Projet : TraKERS
+ * Module : MIDDLEWARE
+ * Sous-Module : Tracking/Gestures
+ * Classe : SwipeDetector
+ * 
+ * Auteur : alexandre.bastien@iri.centrepompidou.fr
+ * 
+ * Fonctionnalités : Permet de détecter si l'utilisateur a effectué un Swipe, en se basant sur
+ * des règles appliquées à la positions des noeuds dans le temps.
+ */
+
+using System;
 using System.Collections.Generic;
 using System.Linq;
 using System.Text;
@@ -10,8 +22,11 @@
     {
         public enum Direction {LEFT, RIGHT, TOP, DOWN};
 
-        public SwipeDetector() : base()
+        Debug.DebugWindow debug;
+
+        public SwipeDetector(Debug.DebugWindow _d) : base()
         {
+            debug = _d;
             gesturePeriod = (float)0.5;
             indexesPerSecond = 30;
             indexesToCheck = (int)(gesturePeriod * indexesPerSecond);
@@ -28,57 +43,150 @@
         public bool CheckForSwipeLeft()
         {
             //Crée un historique de squelette local, puisque l'historique est mis à jour toutes les ~1/30 s.
-            //List<Skeleton> history = new List<Skeleton>(history);
-
-            /*for (int i = 0; i < history.Count; i++)
-                System.Console.Out.WriteLine(history[i].Joints.ElementAt(handRightID).Position.X);
-            System.Console.Out.WriteLine("========================");*/
+            List<List<Joint>> localHistory = new List<List<Joint>>(history);
 
             //Si il n'y a pas assez de positions dans l'historique local pour vérifier le geste.
-            if (history.Count < indexesToCheck+1)
+            if (localHistory.Count < indexesToCheck+1)
                 return false;
-            //Console.ReadLine();
-
+            
             //La distance de référence est ici la distance entre le milieu du dos et le milieu des épaules.
-            refDistance = Math.Abs(history[0][spineID].Position.Y - history[0][shoulderCenterID].Position.Y);
+            refDistance = Math.Abs(localHistory[0][spineID].Position.Y - localHistory[0][shoulderCenterID].Position.Y);
             //On commence la position pour les indexesToCheck dernières postures (celle à l'index 0 étant la dernière).
-            startPoint = history[history.Count - indexesToCheck][handRightID].Position;
+            startPoint = localHistory[localHistory.Count - indexesToCheck][handRightID].Position;
 
             //De la position p1 à pn, on suit l'algorithme.
-            Console.Out.WriteLine("=================================");
-            for (int i = history.Count - indexesToCheck + 1; i < history.Count; i++)
+            for (int i = localHistory.Count - indexesToCheck + 1; i < localHistory.Count; i++)
             {
-                System.Console.Out.WriteLine("hand:head " + history[i][handRightID].Position.Y + " <= " + history[i][headID].Position.Y + " && "
-                + "hand:hip " + history[i][handRightID].Position.Y + " >= " + history[i][hipCenterID].Position.Y + " && "
-                + "handX:handX-1 " + history[i][handRightID].Position.X + " <= " + history[i - 1][handRightID].Position.X + " && "
-                + "hand0:handN " + Math.Abs(history[i][handRightID].Position.Y - startPoint.Y) + " <= " + refDistance / 2);
+                //Debug temporaire pour vérifier la validité de certaines contraintes durant la gesture.
+               /*if (localHistory[i][handRightID].Position.Y > localHistory[i][headID].Position.Y)
+                    debug.R1.Fill = System.Windows.Media.Brushes.Blue;
+                else
+                    debug.R1.Fill = System.Windows.Media.Brushes.DarkGray;
+
+                if(localHistory[i][handRightID].Position.Y < localHistory[i][hipCenterID].Position.Y)
+                    debug.R2.Fill = System.Windows.Media.Brushes.Blue;
+                else
+                    debug.R2.Fill = System.Windows.Media.Brushes.DarkGray;
 
-                //Si la position Y de la main est supérieure à celle de l'épaule
-                //OU si la position Y de la main est inférieure à celle de la hanche
+                if(localHistory[i][handRightID].Position.X < localHistory[i - 1][handRightID].Position.X)
+                    debug.R3.Fill = System.Windows.Media.Brushes.Blue;
+                else
+                    debug.R3.Fill = System.Windows.Media.Brushes.DarkGray;
+
+                if(Math.Abs(localHistory[i][handRightID].Position.Y - startPoint.Y) < refDistance/2)
+                    debug.R4.Fill = System.Windows.Media.Brushes.Blue;
+                else
+                    debug.R4.Fill = System.Windows.Media.Brushes.DarkGray;*/
+
+                //Si la position Y de la main est plus haute que la tête
+                //OU si la position Y de la main est plus basse que la hanche
                 //OU si la nouvelle position X de la main est à droite de la précédente
                 //OU si la nouvelle position Y de la main est plus éloignée de la distance N par rapport à la première position Y
                 //Alors on retourne faux.
-                if (history[i][handRightID].Position.Y > history[i][headID].Position.Y ||
-                history[i][handRightID].Position.Y < history[i][hipCenterID].Position.Y ||
-                history[i][handRightID].Position.X > history[i - 1][handRightID].Position.X ||
-                Math.Abs(history[i][handRightID].Position.Y - startPoint.Y) > refDistance/2)
+                if (localHistory[i][handRightID].Position.Y < localHistory[i][headID].Position.Y ||
+                localHistory[i][handRightID].Position.Y > localHistory[i][hipCenterID].Position.Y ||
+                localHistory[i][handRightID].Position.X > localHistory[i - 1][handRightID].Position.X ||
+                Math.Abs(localHistory[i][handRightID].Position.Y - startPoint.Y) > refDistance/2)
                     return false;
             }
-            Console.Out.WriteLine("=================================");
-            Console.ReadLine();
+
             //Si la distance horizontale du geste a été plus courte que la distance N
             //Alors on retourne faux.
-            float dist = (history[history.Count - 1][handRightID].Position.X - history[history.Count - indexesToCheck][handRightID].Position.X);
+            //float dist = (localHistory[localHistory.Count - 1][handRightID].Position.X - localHistory[localHistory.Count - indexesToCheck][handRightID].Position.X);
             
-            //System.Console.Out.WriteLine(history[0].Joints.ElementAt(handRightID).Position.X + " " + history[1].Joints.ElementAt(handRightID).Position.X + " " + history[2].Joints.ElementAt(handRightID).Position.X);
-            //System.Console.Out.WriteLine(history[0].Joints.ElementAt(handRightID).Position.X + " " + history[1].Joints.ElementAt(handRightID).Position.X + " " + history[2].Joints.ElementAt(handRightID).Position.X);
-            System.Console.Out.WriteLine(Math.Abs(history[0][handRightID].Position.X - history[history.Count - indexesToCheck][handRightID].Position.X) + " < " + refDistance*1.5);
-            if (Math.Abs(history[0][handRightID].Position.X - history[history.Count - indexesToCheck][handRightID].Position.X) < refDistance*1.5)
+            if (Math.Abs(localHistory[0][handRightID].Position.X - localHistory[localHistory.Count - indexesToCheck][handRightID].Position.X) < refDistance/2)
+                return false;
+
+            //Si la dernière position de la main droite est sur le côté droit du corps
+            //OU si la première position calculée de la main droite est sur le côté gauche du corps
+            //Alors on retourne faux.
+            if(localHistory[localHistory.Count - 1][handRightID].Position.X > localHistory[localHistory.Count - 1][hipCenterID].Position.X ||
+               localHistory[localHistory.Count - indexesToCheck][handRightID].Position.X < localHistory[localHistory.Count - 1][hipCenterID].Position.X)
+                return false;
+
+            //System.Console.Out.WriteLine(Math.Abs(localHistory[0][handRightID].Position.X - localHistory[localHistory.Count - indexesToCheck][handRightID].Position.X) + " < " + refDistance/2);
+            //On supprime l'historique local.
+            localHistory.Clear();
+            //Si on est arrivé jusqu'ici, toutes les conditions pour un swipe left ont été remplies.
+            return true;
+        }
+
+        /*
+         * Lit les noeuds de l'historique du squelette afin de détecter un Swipe right.
+         * Règles :
+         * Se fait avec la main gauche.
+         * Chaque nouvelle position de la main doit être à la droite de la précédente.
+         * Chaque nouvelle position de la main ne doit pas s'éloigner verticalement de plus d'une certaine distance.
+         * Le geste doit mesurer horizontalement une certaine distance.
+         */
+        public bool CheckForSwipeRight()
+        {
+            //Crée un historique de squelette local, puisque l'historique est mis à jour toutes les ~1/30 s.
+            List<List<Joint>> localHistory = new List<List<Joint>>(history);
+
+            //Si il n'y a pas assez de positions dans l'historique local pour vérifier le geste.
+            if (localHistory.Count < indexesToCheck + 1)
                 return false;
 
-            history.Clear();
-            Console.Out.WriteLine("SWIPE LEF");
-            Console.ReadLine();
+            //La distance de référence est ici la distance entre le milieu du dos et le milieu des épaules.
+            refDistance = Math.Abs(localHistory[0][spineID].Position.Y - localHistory[0][shoulderCenterID].Position.Y);
+            //On commence la position pour les indexesToCheck dernières postures (celle à l'index 0 étant la dernière).
+            startPoint = localHistory[localHistory.Count - indexesToCheck][handLeftID].Position;
+
+            //De la position p1 à pn, on suit l'algorithme.
+            for (int i = localHistory.Count - indexesToCheck + 1; i < localHistory.Count; i++)
+            {
+                //Debug temporaire pour vérifier la validité de certaines contraintes durant la gesture.
+                /*if (localHistory[i][handLeftID].Position.Y > localHistory[i][headID].Position.Y)
+                    debug.R1.Fill = System.Windows.Media.Brushes.Cyan;
+                else
+                    debug.R1.Fill = System.Windows.Media.Brushes.DarkGray;
+
+                if (localHistory[i][handLeftID].Position.Y < localHistory[i][hipCenterID].Position.Y)
+                    debug.R2.Fill = System.Windows.Media.Brushes.Cyan;
+                else
+                    debug.R2.Fill = System.Windows.Media.Brushes.DarkGray;
+
+                if (localHistory[i][handLeftID].Position.X > localHistory[i - 1][handLeftID].Position.X)
+                    debug.R3.Fill = System.Windows.Media.Brushes.Cyan;
+                else
+                    debug.R3.Fill = System.Windows.Media.Brushes.DarkGray;
+
+                if (Math.Abs(localHistory[i][handLeftID].Position.Y - startPoint.Y) < refDistance / 2)
+                    debug.R4.Fill = System.Windows.Media.Brushes.Cyan;
+                else
+                    debug.R4.Fill = System.Windows.Media.Brushes.DarkGray;*/
+
+                //Si la position Y de la main est plus haute que la tête
+                //OU si la position Y de la main est plus basse que la hanche
+                //OU si la nouvelle position X de la main est à gauche de la précédente
+                //OU si la nouvelle position Y de la main est plus éloignée de la distance N par rapport à la première position Y
+                //Alors on retourne faux.
+                if (localHistory[i][handLeftID].Position.Y < localHistory[i][headID].Position.Y ||
+                localHistory[i][handLeftID].Position.Y > localHistory[i][hipCenterID].Position.Y ||
+                localHistory[i][handLeftID].Position.X < localHistory[i - 1][handLeftID].Position.X ||
+                Math.Abs(localHistory[i][handLeftID].Position.Y - startPoint.Y) > refDistance / 2)
+                    return false;
+            }
+
+            //Si la distance horizontale du geste a été plus courte que la distance N
+            //Alors on retourne faux.
+            //float dist = (localHistory[localHistory.Count - 1][handLeftID].Position.X - localHistory[localHistory.Count - indexesToCheck][handLeftID].Position.X);
+
+            if (Math.Abs(localHistory[0][handLeftID].Position.X - localHistory[localHistory.Count - indexesToCheck][handLeftID].Position.X) < refDistance / 2)
+                return false;
+
+            //Si la dernière position de la main droite est sur le côté gauche du corps
+            //OU si la première position calculée de la main droite est sur le côté droit du corps
+            //Alors on retourne faux.
+            if (localHistory[localHistory.Count - 1][handLeftID].Position.X < localHistory[localHistory.Count - 1][hipCenterID].Position.X ||
+               localHistory[localHistory.Count - indexesToCheck][handLeftID].Position.X > localHistory[localHistory.Count - 1][hipCenterID].Position.X)
+                return false;
+
+            //System.Console.Out.WriteLine(Math.Abs(localHistory[0][handLeftID].Position.X - localHistory[localHistory.Count - indexesToCheck][handLeftID].Position.X) + " < " + refDistance / 2);
+            //On supprime l'historique local.
+            localHistory.Clear();
+            //Si on est arrivé jusqu'ici, toutes les conditions pour un swipe right ont été remplies.
             return true;
         }
     }