middleware/Tracking/Postures/FallDetector.cs
author bastiena
Thu, 21 Jun 2012 16:52:56 +0200
changeset 37 37ebedd84755
child 39 15b11d291417
permissions -rw-r--r--
MID : 2 new gestures : fall & jump config in a txt file
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
37
bastiena
parents:
diff changeset
     1
/*
bastiena
parents:
diff changeset
     2
* This file is part of the TraKERS\Middleware package.
bastiena
parents:
diff changeset
     3
*
bastiena
parents:
diff changeset
     4
* (c) IRI <http://www.iri.centrepompidou.fr/>
bastiena
parents:
diff changeset
     5
*
bastiena
parents:
diff changeset
     6
* For the full copyright and license information, please view the LICENSE
bastiena
parents:
diff changeset
     7
* file that was distributed with this source code.
bastiena
parents:
diff changeset
     8
*/
bastiena
parents:
diff changeset
     9
bastiena
parents:
diff changeset
    10
/*
bastiena
parents:
diff changeset
    11
 * Projet : TraKERS
bastiena
parents:
diff changeset
    12
 * Module : MIDDLEWARE
bastiena
parents:
diff changeset
    13
 * Sous-Module : Tracking/Gestures
bastiena
parents:
diff changeset
    14
 * Classe : JumpDetector
bastiena
parents:
diff changeset
    15
 * 
bastiena
parents:
diff changeset
    16
 * Auteur : alexandre.bastien@iri.centrepompidou.fr
bastiena
parents:
diff changeset
    17
 * 
bastiena
parents:
diff changeset
    18
 * Fonctionnalités : Permet de détecter si l'utilisateur a sauté, en se basant sur
bastiena
parents:
diff changeset
    19
 * des règles appliquées à la positions des noeuds dans le temps.
bastiena
parents:
diff changeset
    20
 * 
bastiena
parents:
diff changeset
    21
 * P.S : Cette partie est encore en développement.
bastiena
parents:
diff changeset
    22
 */
bastiena
parents:
diff changeset
    23
bastiena
parents:
diff changeset
    24
using System;
bastiena
parents:
diff changeset
    25
using System.Collections.Generic;
bastiena
parents:
diff changeset
    26
using System.Linq;
bastiena
parents:
diff changeset
    27
using System.Text;
bastiena
parents:
diff changeset
    28
using Microsoft.Kinect;
bastiena
parents:
diff changeset
    29
using Trakers.Debug;
bastiena
parents:
diff changeset
    30
bastiena
parents:
diff changeset
    31
namespace Trakers.Tracking.Postures
bastiena
parents:
diff changeset
    32
{
bastiena
parents:
diff changeset
    33
    public class FallDetector : PostureDetector
bastiena
parents:
diff changeset
    34
    {
bastiena
parents:
diff changeset
    35
        static int n = 0;
bastiena
parents:
diff changeset
    36
bastiena
parents:
diff changeset
    37
        public FallDetector(DebugWindow _debug)
bastiena
parents:
diff changeset
    38
            : base(_debug)
bastiena
parents:
diff changeset
    39
        {
bastiena
parents:
diff changeset
    40
        }
bastiena
parents:
diff changeset
    41
bastiena
parents:
diff changeset
    42
        /*
bastiena
parents:
diff changeset
    43
         * Méthode de détection du fall.
bastiena
parents:
diff changeset
    44
         */
bastiena
parents:
diff changeset
    45
        public bool CheckForFall()
bastiena
parents:
diff changeset
    46
        {
bastiena
parents:
diff changeset
    47
            //Crée un état local afin de pouvoir analyser s'il y a une posture.
bastiena
parents:
diff changeset
    48
            List<Joint> localState = new List<Joint>(currentState);
bastiena
parents:
diff changeset
    49
bastiena
parents:
diff changeset
    50
            /*if (localState[(int)JointType.KneeLeft].Position.Z + 0.10 < localState[(int)JointType.HipCenter].Position.Z)
bastiena
parents:
diff changeset
    51
                debug.onR0(true);
bastiena
parents:
diff changeset
    52
            else
bastiena
parents:
diff changeset
    53
                debug.onR0(false);
bastiena
parents:
diff changeset
    54
            if(localState[(int)JointType.KneeRight].Position.Z + 0.10 < localState[(int)JointType.HipCenter].Position.Z)
bastiena
parents:
diff changeset
    55
                debug.onR1(true);
bastiena
parents:
diff changeset
    56
            else
bastiena
parents:
diff changeset
    57
                debug.onR1(false);
bastiena
parents:
diff changeset
    58
            if (Math.Abs(localState[(int)JointType.HipCenter].Position.Z - localState[(int)JointType.Head].Position.Z) <= 0.20)
bastiena
parents:
diff changeset
    59
                debug.onR2(true);
bastiena
parents:
diff changeset
    60
            else
bastiena
parents:
diff changeset
    61
                debug.onR2(false);*/
bastiena
parents:
diff changeset
    62
bastiena
parents:
diff changeset
    63
            //Si les genoux ne sont pas éloignés d'au moins 20cm vers l'avant par rapport aux hanches
bastiena
parents:
diff changeset
    64
            //OU si les hanches et la tête ne sont pas au même niveau avec 20 cm d'erreur.
bastiena
parents:
diff changeset
    65
            //Alors on ne fait pas un fall.
bastiena
parents:
diff changeset
    66
            if (localState[(int)JointType.KneeLeft].Position.Z + 0.15 >= localState[(int)JointType.HipCenter].Position.Z ||
bastiena
parents:
diff changeset
    67
                localState[(int)JointType.KneeRight].Position.Z + 0.15 >= localState[(int)JointType.HipCenter].Position.Z ||
bastiena
parents:
diff changeset
    68
                //||
bastiena
parents:
diff changeset
    69
                Math.Abs(localState[(int)JointType.HipCenter].Position.Z - localState[(int)JointType.Head].Position.Z) > 0.20)
bastiena
parents:
diff changeset
    70
                return false;
bastiena
parents:
diff changeset
    71
            return true;
bastiena
parents:
diff changeset
    72
        }
bastiena
parents:
diff changeset
    73
    }
bastiena
parents:
diff changeset
    74
}