diff -r 10d5199d9874 -r 4b78f179e7ce middleware/src/Tracking/Gestures/PushDetector.cs
--- a/middleware/src/Tracking/Gestures/PushDetector.cs Fri Mar 30 11:14:14 2012 +0200
+++ /dev/null Thu Jan 01 00:00:00 1970 +0000
@@ -1,218 +0,0 @@
-/*
-* This file is part of the TraKERS\Middleware package.
-*
-* (c) IRI
-*
-* For the full copyright and license information, please view the LICENSE_MIDDLEWARE
-* file that was distributed with this source code.
-*/
-
-/*
- * Projet : TraKERS
- * Module : MIDDLEWARE
- * Sous-Module : Tracking/Gestures
- * Classe : PushDetector
- *
- * Auteur : alexandre.bastien@iri.centrepompidou.fr
- *
- * Fonctionnalités : Permet de détecter si l'utilisateur a effectué un Push, 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;
-using Microsoft.Kinect;
-
-namespace Trakers.Tracking.Gestures
-{
- public class PushDetector : GestureDetector
- {
- public enum Direction { PUSH, PULL };
- public enum Hand { LEFT, RIGHT, BOTH, NONE };
-
- Debug.DebugWindow debug;
-
- public PushDetector(Debug.DebugWindow _d) : base()
- {
- debug = _d;
- gesturePeriod = (float)0.3;
- indexesPerSecond = 30;
- indexesToCheck = (int)(gesturePeriod * indexesPerSecond);
- }
-
- /*
- * Lit les noeuds de l'historique du squelette afin de détecter un Push.
- * Règles :
- * Se fait avec une main (gauche ou droite).
- * Chaque nouvelle position de la main doit être plus profonde que la précédente.
- * Chaque nouvelle position de la main ne doit pas dévier trop de l'axe perpendiculaire au plan (X, Y).
- * Le geste doit mesurer en profondeur une certaine distance.
- */
- public Hand CheckForPush()
- {
- //Crée un historique de squelette local, puisque l'historique est mis à jour toutes les ~1/30 s.
- List> localHistory = new List>(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 Hand.NONE;
-
- //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][(int)JointType.Spine].Position.Y - localHistory[0][(int)JointType.ShoulderCenter].Position.Y);
- //On commence la position pour les indexesToCheck dernières postures (celle à l'index 0 étant la dernière).
- SkeletonPoint startPointLeft = localHistory[localHistory.Count - indexesToCheck][(int)JointType.HandLeft].Position;
- SkeletonPoint startPointRight = localHistory[localHistory.Count - indexesToCheck][(int)JointType.HandRight].Position;
-
- //Booléens indiquant si le mouvement serait valide pour la main gauche ou droite.
- bool leftHandOK = true, rightHandOK = true;
-
- //De la position p1 à pn, on suit l'algorithme.
- for (int i = localHistory.Count - indexesToCheck + 1; i < localHistory.Count; i++)
- {
- //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 Z de la main est moins profonde que la précédente
- //OU si la nouvelle position X de la main est plus éloignée de la distance N par rapport à la première position X
- //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 la main en question ne fait pas de push.
- if (localHistory[i][(int)JointType.HandLeft].Position.Y < localHistory[i][(int)JointType.Head].Position.Y ||
- localHistory[i][(int)JointType.HandLeft].Position.Y > localHistory[i][(int)JointType.HipCenter].Position.Y ||
- localHistory[i][(int)JointType.HandLeft].Position.Z > localHistory[i - 1][(int)JointType.HandLeft].Position.Z ||
- Math.Abs(localHistory[i][(int)JointType.HandLeft].Position.X - startPointLeft.X) > refDistance / 5 ||
- Math.Abs(localHistory[i][(int)JointType.HandLeft].Position.Y - startPointLeft.Y) > refDistance / 5)
- leftHandOK = false;
- if (localHistory[i][(int)JointType.HandRight].Position.Y < localHistory[i][(int)JointType.Head].Position.Y ||
- localHistory[i][(int)JointType.HandRight].Position.Y > localHistory[i][(int)JointType.HipCenter].Position.Y ||
- localHistory[i][(int)JointType.HandRight].Position.Z > localHistory[i - 1][(int)JointType.HandRight].Position.Z ||
- Math.Abs(localHistory[i][(int)JointType.HandRight].Position.X - startPointRight.X) > refDistance / 5 ||
- Math.Abs(localHistory[i][(int)JointType.HandRight].Position.Y - startPointRight.Y) > refDistance / 5)
- rightHandOK = false;
-
- if (!leftHandOK && !rightHandOK)
- return Hand.NONE;
- }
-
- //Si la distance en Z du geste a été plus courte que la distance N
- //Alors on retourne faux.
- if (Math.Abs(localHistory[localHistory.Count - 1][(int)JointType.HandLeft].Position.Z - localHistory[localHistory.Count - indexesToCheck][(int)JointType.HandLeft].Position.Z) * 100 < 20)
- leftHandOK = false;
- if (Math.Abs(localHistory[localHistory.Count - 1][(int)JointType.HandRight].Position.Z - localHistory[localHistory.Count - indexesToCheck][(int)JointType.HandRight].Position.Z) * 100 < 20)
- rightHandOK = false;
-
- //Si la dernière position de la main droite/gauche est sur le côté gauche/droit du corps
- //OU si la première position calculée de la main droite/gauche est sur le côté gauche/droit du corps
- //Alors on retourne faux.
- if (localHistory[localHistory.Count - 1][(int)JointType.HandLeft].Position.X > localHistory[localHistory.Count - 1][(int)JointType.HipCenter].Position.X ||
- localHistory[localHistory.Count - indexesToCheck][(int)JointType.HandLeft].Position.X > localHistory[localHistory.Count - 1][(int)JointType.HipCenter].Position.X)
- leftHandOK = false;
- if (localHistory[localHistory.Count - 1][(int)JointType.HandRight].Position.X < localHistory[localHistory.Count - 1][(int)JointType.HipCenter].Position.X ||
- localHistory[localHistory.Count - indexesToCheck][(int)JointType.HandRight].Position.X < localHistory[localHistory.Count - 1][(int)JointType.HipCenter].Position.X)
- rightHandOK = false;
-
- if (!leftHandOK && !rightHandOK)
- return Hand.NONE;
-
- //On supprime l'historique local.
- localHistory.Clear();
-
- //Si on est arrivé jusqu'ici, toutes les conditions pour un push ont été remplies.
-
- if (leftHandOK && rightHandOK)
- return Hand.BOTH;
- else if (leftHandOK)
- return Hand.LEFT;
- else if (rightHandOK)
- return Hand.RIGHT;
-
- return Hand.NONE;
- }
-
- /*
- * Lit les noeuds de l'historique du squelette afin de détecter un Pull.
- * Règles :
- * Se fait avec une main.
- * Chaque nouvelle position de la main doit être moins profonde que la précédente.
- * Chaque nouvelle position de la main ne doit pas dévier trop de l'axe perpendiculaire au plan (X, Y).
- * Le geste doit mesurer en profondeur une certaine distance.
- */
- public Hand CheckForPull()
- {
- //Crée un historique de squelette local, puisque l'historique est mis à jour toutes les ~1/30 s.
- List> localHistory = new List>(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 Hand.NONE;
-
- //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][(int)JointType.Spine].Position.Y - localHistory[0][(int)JointType.ShoulderCenter].Position.Y);
- //On commence la position pour les indexesToCheck dernières postures (celle à l'index 0 étant la dernière).
- SkeletonPoint startPointLeft = localHistory[localHistory.Count - indexesToCheck][(int)JointType.HandLeft].Position;
- SkeletonPoint startPointRight = localHistory[localHistory.Count - indexesToCheck][(int)JointType.HandRight].Position;
-
- //Booléens indiquant si le mouvement serait valide pour la main gauche ou droite.
- bool leftHandOK = true, rightHandOK = true;
-
- //De la position p1 à pn, on suit l'algorithme.
- for (int i = localHistory.Count - indexesToCheck + 1; i < localHistory.Count; i++)
- {
- //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 Z de la main est plus profonde que la précédente
- //OU si la nouvelle position X de la main est plus éloignée de la distance N par rapport à la première position X
- //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 la main en question ne fait pas de push.
- if (localHistory[i][(int)JointType.HandLeft].Position.Y < localHistory[i][(int)JointType.Head].Position.Y ||
- localHistory[i][(int)JointType.HandLeft].Position.Y > localHistory[i][(int)JointType.HipCenter].Position.Y ||
- localHistory[i][(int)JointType.HandLeft].Position.Z < localHistory[i - 1][(int)JointType.HandLeft].Position.Z ||
- Math.Abs(localHistory[i][(int)JointType.HandLeft].Position.X - startPointLeft.X) > refDistance / 5 ||
- Math.Abs(localHistory[i][(int)JointType.HandLeft].Position.Y - startPointLeft.Y) > refDistance / 5)
- leftHandOK = false;
- if (localHistory[i][(int)JointType.HandRight].Position.Y < localHistory[i][(int)JointType.Head].Position.Y ||
- localHistory[i][(int)JointType.HandRight].Position.Y > localHistory[i][(int)JointType.HipCenter].Position.Y ||
- localHistory[i][(int)JointType.HandRight].Position.Z < localHistory[i - 1][(int)JointType.HandRight].Position.Z ||
- Math.Abs(localHistory[i][(int)JointType.HandRight].Position.X - startPointRight.X) > refDistance / 5 ||
- Math.Abs(localHistory[i][(int)JointType.HandRight].Position.Y - startPointRight.Y) > refDistance / 5)
- rightHandOK = false;
-
- if (!leftHandOK && !rightHandOK)
- return Hand.NONE;
- }
-
- //Si la distance en Z du geste a été plus courte que la distance N
- //Alors on retourne faux.
- if (Math.Abs(localHistory[localHistory.Count - 1][(int)JointType.HandLeft].Position.Z - localHistory[localHistory.Count - indexesToCheck][(int)JointType.HandLeft].Position.Z) * 100 < 20)
- leftHandOK = false;
- if (Math.Abs(localHistory[localHistory.Count - 1][(int)JointType.HandRight].Position.Z - localHistory[localHistory.Count - indexesToCheck][(int)JointType.HandRight].Position.Z) * 100 < 20)
- rightHandOK = false;
-
- //Si la dernière position de la main droite/gauche est sur le côté gauche/droit du corps
- //OU si la première position calculée de la main droite/gauche est sur le côté gauche/droit du corps
- //Alors on retourne faux.
- if (localHistory[localHistory.Count - 1][(int)JointType.HandLeft].Position.X > localHistory[localHistory.Count - 1][(int)JointType.HipCenter].Position.X ||
- localHistory[localHistory.Count - indexesToCheck][(int)JointType.HandLeft].Position.X > localHistory[localHistory.Count - 1][(int)JointType.HipCenter].Position.X)
- leftHandOK = false;
- if (localHistory[localHistory.Count - 1][(int)JointType.HandRight].Position.X < localHistory[localHistory.Count - 1][(int)JointType.HipCenter].Position.X ||
- localHistory[localHistory.Count - indexesToCheck][(int)JointType.HandRight].Position.X < localHistory[localHistory.Count - 1][(int)JointType.HipCenter].Position.X)
- rightHandOK = false;
-
- if (!leftHandOK && !rightHandOK)
- return Hand.NONE;
-
- //On supprime l'historique local.
- localHistory.Clear();
-
- //Si on est arrivé jusqu'ici, toutes les conditions pour un push ont été remplies.
- if (leftHandOK && rightHandOK)
- return Hand.BOTH;
- else if (leftHandOK)
- return Hand.LEFT;
- else if (rightHandOK)
- return Hand.RIGHT;
-
- return Hand.NONE;
- }
- }
-}