middleware/src/Tracking/Gestures/SwipeDetector.cs
author bastiena
Fri, 09 Mar 2012 14:52:11 +0100
changeset 0 6fefd4afe506
child 3 92f19af39024
permissions -rw-r--r--
First Import
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
0
6fefd4afe506 First Import
bastiena
parents:
diff changeset
     1
using System;
6fefd4afe506 First Import
bastiena
parents:
diff changeset
     2
using System.Collections.Generic;
6fefd4afe506 First Import
bastiena
parents:
diff changeset
     3
using System.Linq;
6fefd4afe506 First Import
bastiena
parents:
diff changeset
     4
using System.Text;
6fefd4afe506 First Import
bastiena
parents:
diff changeset
     5
using Microsoft.Kinect;
6fefd4afe506 First Import
bastiena
parents:
diff changeset
     6
6fefd4afe506 First Import
bastiena
parents:
diff changeset
     7
namespace Trakers.Tracking.Gestures
6fefd4afe506 First Import
bastiena
parents:
diff changeset
     8
{
6fefd4afe506 First Import
bastiena
parents:
diff changeset
     9
    public class SwipeDetector : GestureDetector
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    10
    {
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    11
        public enum Direction {LEFT, RIGHT, TOP, DOWN};
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    12
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    13
        public SwipeDetector() : base()
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    14
        {
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    15
            gesturePeriod = (float)0.5;
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    16
            indexesPerSecond = 30;
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    17
            indexesToCheck = (int)(gesturePeriod * indexesPerSecond);
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    18
        }
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    19
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    20
        /*
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    21
         * Lit les noeuds de l'historique du squelette afin de détecter un Swipe left.
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    22
         * Règles :
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    23
         * Se fait avec la main droite.
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    24
         * Chaque nouvelle position de la main doit être à la gauche de la précédente.
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    25
         * Chaque nouvelle position de la main ne doit pas s'éloigner verticalement de plus d'une certaine distance.
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    26
         * Le geste doit mesurer horizontalement une certaine distance.
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    27
         */
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    28
        public bool CheckForSwipeLeft()
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    29
        {
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    30
            //Crée un historique de squelette local, puisque l'historique est mis à jour toutes les ~1/30 s.
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    31
            //List<Skeleton> history = new List<Skeleton>(history);
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    32
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    33
            /*for (int i = 0; i < history.Count; i++)
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    34
                System.Console.Out.WriteLine(history[i].Joints.ElementAt(handRightID).Position.X);
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    35
            System.Console.Out.WriteLine("========================");*/
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    36
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    37
            //Si il n'y a pas assez de positions dans l'historique local pour vérifier le geste.
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    38
            if (history.Count < indexesToCheck+1)
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    39
                return false;
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    40
            //Console.ReadLine();
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    41
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    42
            //La distance de référence est ici la distance entre le milieu du dos et le milieu des épaules.
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    43
            refDistance = Math.Abs(history[0][spineID].Position.Y - history[0][shoulderCenterID].Position.Y);
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    44
            //On commence la position pour les indexesToCheck dernières postures (celle à l'index 0 étant la dernière).
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    45
            startPoint = history[history.Count - indexesToCheck][handRightID].Position;
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    46
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    47
            //De la position p1 à pn, on suit l'algorithme.
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    48
            Console.Out.WriteLine("=================================");
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    49
            for (int i = history.Count - indexesToCheck + 1; i < history.Count; i++)
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    50
            {
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    51
                System.Console.Out.WriteLine("hand:head " + history[i][handRightID].Position.Y + " <= " + history[i][headID].Position.Y + " && "
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    52
                + "hand:hip " + history[i][handRightID].Position.Y + " >= " + history[i][hipCenterID].Position.Y + " && "
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    53
                + "handX:handX-1 " + history[i][handRightID].Position.X + " <= " + history[i - 1][handRightID].Position.X + " && "
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    54
                + "hand0:handN " + Math.Abs(history[i][handRightID].Position.Y - startPoint.Y) + " <= " + refDistance / 2);
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    55
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    56
                //Si la position Y de la main est supérieure à celle de l'épaule
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    57
                //OU si la position Y de la main est inférieure à celle de la hanche
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    58
                //OU si la nouvelle position X de la main est à droite de la précédente
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    59
                //OU si la nouvelle position Y de la main est plus éloignée de la distance N par rapport à la première position Y
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    60
                //Alors on retourne faux.
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    61
                if (history[i][handRightID].Position.Y > history[i][headID].Position.Y ||
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    62
                history[i][handRightID].Position.Y < history[i][hipCenterID].Position.Y ||
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    63
                history[i][handRightID].Position.X > history[i - 1][handRightID].Position.X ||
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    64
                Math.Abs(history[i][handRightID].Position.Y - startPoint.Y) > refDistance/2)
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    65
                    return false;
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    66
            }
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    67
            Console.Out.WriteLine("=================================");
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    68
            Console.ReadLine();
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    69
            //Si la distance horizontale du geste a été plus courte que la distance N
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    70
            //Alors on retourne faux.
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    71
            float dist = (history[history.Count - 1][handRightID].Position.X - history[history.Count - indexesToCheck][handRightID].Position.X);
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    72
            
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    73
            //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);
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    74
            //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);
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    75
            System.Console.Out.WriteLine(Math.Abs(history[0][handRightID].Position.X - history[history.Count - indexesToCheck][handRightID].Position.X) + " < " + refDistance*1.5);
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    76
            if (Math.Abs(history[0][handRightID].Position.X - history[history.Count - indexesToCheck][handRightID].Position.X) < refDistance*1.5)
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    77
                return false;
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    78
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    79
            history.Clear();
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    80
            Console.Out.WriteLine("SWIPE LEF");
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    81
            Console.ReadLine();
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    82
            return true;
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    83
        }
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    84
    }
6fefd4afe506 First Import
bastiena
parents:
diff changeset
    85
}