middleware/Tracking/Gestures/JumpDetector.cs
author bastiena
Thu, 21 Jun 2012 17:13:40 +0200
changeset 39 15b11d291417
parent 37 37ebedd84755
permissions -rw-r--r--
MID : Formatting the newest classes
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
39
bastiena
parents: 37
diff changeset
     1
/*
15
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
     2
* This file is part of the TraKERS\Middleware package.
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
     3
*
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
     4
* (c) IRI <http://www.iri.centrepompidou.fr/>
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
     5
*
27
6c08d4d7219e Middleware :
bastiena
parents: 17
diff changeset
     6
* For the full copyright and license information, please view the LICENSE
15
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
     7
* file that was distributed with this source code.
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
     8
*/
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
     9
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    10
/*
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    11
 * Projet : TraKERS
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    12
 * Module : MIDDLEWARE
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    13
 * Sous-Module : Tracking/Gestures
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    14
 * Classe : JumpDetector
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    15
 * 
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    16
 * Auteur : alexandre.bastien@iri.centrepompidou.fr
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    17
 * 
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    18
 * Fonctionnalités : Permet de détecter si l'utilisateur a sauté, en se basant sur
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    19
 * des règles appliquées à la positions des noeuds dans le temps.
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    20
 */
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    21
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    22
using System;
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    23
using System.Collections.Generic;
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    24
using System.Linq;
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    25
using System.Text;
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    26
using Microsoft.Kinect;
17
fda26bfcabef Middleware :
bastiena
parents: 15
diff changeset
    27
using Trakers.Debug;
15
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    28
17
fda26bfcabef Middleware :
bastiena
parents: 15
diff changeset
    29
namespace Trakers.Tracking.Gestures
15
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    30
{
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    31
    public class JumpDetector : GestureDetector
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    32
    {
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    33
        static int n = 0;
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    34
17
fda26bfcabef Middleware :
bastiena
parents: 15
diff changeset
    35
        public JumpDetector(DebugWindow _debug) : base(_debug)
15
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    36
        {
37
bastiena
parents: 27
diff changeset
    37
            gesturePeriod = (float)1.5;
15
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    38
            indexesPerSecond = 30;
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    39
            indexesToCheck = (int)(gesturePeriod * indexesPerSecond);
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    40
        }
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    41
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    42
        /*
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    43
         * Lit les noeuds de l'historique du squelette afin de détecter un Jump.
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    44
         * Règles :
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    45
         * .
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    46
         */
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    47
        public bool CheckForJump()
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    48
        {
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    49
            //Crée un historique de squelette local, puisque l'historique est mis à jour toutes les ~1/30 s.
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    50
            List<List<Joint>> localHistory = new List<List<Joint>>(history);
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    51
            
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    52
            //Si il n'y a pas assez de positions dans l'historique local pour vérifier le geste.
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    53
            if (localHistory.Count < indexesToCheck)
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    54
                return false;
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    55
37
bastiena
parents: 27
diff changeset
    56
            //La distance de référence est ici la distance entre les épaules et les hanches.
bastiena
parents: 27
diff changeset
    57
            refDistance = Math.Abs(localHistory[0][(int)JointType.ShoulderCenter].Position.Y - localHistory[0][(int)JointType.HipCenter].Position.Y);
15
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    58
            //On commence la position pour les indexesToCheck dernières postures (celle à l'index 0 étant la dernière).
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    59
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    60
            int beginIdx = localHistory.Count - indexesToCheck + 1;
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    61
37
bastiena
parents: 27
diff changeset
    62
            int middleIdx = 0;
bastiena
parents: 27
diff changeset
    63
            int endIdx = 0;
15
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    64
            bool topOfJump = false;
37
bastiena
parents: 27
diff changeset
    65
            bool probableJump = false;
15
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    66
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    67
            //De la position p1 à pn, on suit l'algorithme.
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    68
            for (int i = beginIdx ; i < localHistory.Count ; i++)
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    69
            {
37
bastiena
parents: 27
diff changeset
    70
                if (localHistory[i][(int)JointType.Spine].Position.Y + refDistance / 2 < localHistory[beginIdx][(int)JointType.Spine].Position.Y)
15
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    71
                {
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
    72
                    topOfJump = true;
37
bastiena
parents: 27
diff changeset
    73
                    middleIdx = i;
bastiena
parents: 27
diff changeset
    74
                }
bastiena
parents: 27
diff changeset
    75
            }
bastiena
parents: 27
diff changeset
    76
bastiena
parents: 27
diff changeset
    77
            if (topOfJump)
bastiena
parents: 27
diff changeset
    78
            {
bastiena
parents: 27
diff changeset
    79
                for (int i = middleIdx; i < localHistory.Count; i++)
bastiena
parents: 27
diff changeset
    80
                {
bastiena
parents: 27
diff changeset
    81
                    if (Math.Abs(localHistory[beginIdx][(int)JointType.Spine].Position.Y - localHistory[i][(int)JointType.Spine].Position.Y) < refDistance / 5 ||
bastiena
parents: 27
diff changeset
    82
                        localHistory[beginIdx][(int)JointType.Spine].Position.Y < localHistory[i][(int)JointType.Spine].Position.Y)
bastiena
parents: 27
diff changeset
    83
                    {
bastiena
parents: 27
diff changeset
    84
                        probableJump = true;
bastiena
parents: 27
diff changeset
    85
                        endIdx = i;
bastiena
parents: 27
diff changeset
    86
                    }
bastiena
parents: 27
diff changeset
    87
                }
bastiena
parents: 27
diff changeset
    88
            }
bastiena
parents: 27
diff changeset
    89
            else
bastiena
parents: 27
diff changeset
    90
            {
39
bastiena
parents: 37
diff changeset
    91
                //On supprime l'historique local.
bastiena
parents: 37
diff changeset
    92
                localHistory.Clear();
37
bastiena
parents: 27
diff changeset
    93
                return false;
bastiena
parents: 27
diff changeset
    94
            }
bastiena
parents: 27
diff changeset
    95
bastiena
parents: 27
diff changeset
    96
            if (probableJump)
bastiena
parents: 27
diff changeset
    97
            {
bastiena
parents: 27
diff changeset
    98
                if (Math.Abs(localHistory[beginIdx][(int)JointType.Spine].Position.Z - localHistory[endIdx][(int)JointType.Spine].Position.Z) < 0.10)
bastiena
parents: 27
diff changeset
    99
                {
39
bastiena
parents: 37
diff changeset
   100
                    //On supprime l'historique local.
bastiena
parents: 37
diff changeset
   101
                    localHistory.Clear();
37
bastiena
parents: 27
diff changeset
   102
                    return true;
bastiena
parents: 27
diff changeset
   103
                }
bastiena
parents: 27
diff changeset
   104
            }
bastiena
parents: 27
diff changeset
   105
            else
bastiena
parents: 27
diff changeset
   106
            {
39
bastiena
parents: 37
diff changeset
   107
                //On supprime l'historique local.
bastiena
parents: 37
diff changeset
   108
                localHistory.Clear();
37
bastiena
parents: 27
diff changeset
   109
                return false;
bastiena
parents: 27
diff changeset
   110
            }
15
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
   111
            
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
   112
            //On supprime l'historique local.
39
bastiena
parents: 37
diff changeset
   113
            localHistory.Clear();
15
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
   114
            return false;
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
   115
        }
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
   116
    }
4b78f179e7ce Middleware :
bastiena
parents:
diff changeset
   117
}