/
MovimentadorBracoEsquerdo.cpp
85 lines (74 loc) · 2.25 KB
/
MovimentadorBracoEsquerdo.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
#include "stdafx.h"
#include "MovimentadorBracoEsquerdo.h"
#include "CalculosUteis.h"
MovimentadorBracoEsquerdo::~MovimentadorBracoEsquerdo(void)
{
}
MovimentadorBracoEsquerdo::MovimentadorBracoEsquerdo(vector<MarcadorPedra *> marcadores):marcadores(marcadores),indiceAnterior(-1),indiceAtual(-1),terminado(false){}
void MovimentadorBracoEsquerdo::mover(irr::scene::IAnimatedMeshSceneNode * node,tipos::Esqueleto esqueleto)
{
std::string ombro_esquerdo_bone = "UpArm_L";
std::string braco_esquerdo_bone = "LoArm_L";
std::string mao_esquerda_bone = "Index_L";
float anguloOmbroEsquerdo = getAnguloBraco(esqueleto.ombro_esquerdo,esqueleto.cotovelo_esquerdo);
setarAnguloBone(node,ombro_esquerdo_bone,-anguloOmbroEsquerdo);
float anguloMaoEsquerda = CalculosUteis::anguloEntrePontos(esqueleto.cotovelo_esquerdo,esqueleto.ombro_esquerdo,esqueleto.mao_esquerda);
if(esqueleto.cotovelo_esquerdo.y < esqueleto.mao_esquerda.y)
anguloMaoEsquerda = - anguloMaoEsquerda;
if(!_isnan(anguloMaoEsquerda))
setarAnguloBone(node,braco_esquerdo_bone,anguloMaoEsquerda);
IBoneSceneNode * mao = node->getJointNode(mao_esquerda_bone.c_str());
pos = Vetor(
mao->getAbsolutePosition().X,
mao->getAbsolutePosition().Y,
mao->getAbsolutePosition().Z);
//teste
/*
bool tem = false;
for(int i=0;i<marcadores.size();i++)
{
if(marcadores[i]->pontoDentroMarcador(pos) && i!=indiceAnterior)
{
if(!cronometro.iniciado())
{
cronometro.iniciarContagem();
}
tem = true;
indiceAtual = i;
}
}
if(!tem)
{
cronometro.pararContagem();
}
*/
}
bool MovimentadorBracoEsquerdo::terminou()
{
/*
if( cronometro.getTempoCorridoSegundos()>=3 )
{
cronometro.pararContagem();
indiceAnterior = indiceAtual;
return true;
}
return false;
*/
// return cronometro.getTempoCorridoSegundos() >= 3;
if(!cronometro.iniciado())
cronometro.iniciarContagem();
if(cronometro.getTempoCorridoSegundos()>=5)
{
if(verificaMembroMarcador(pos,marcadores))
return true;
else
{
cronometro.reiniciarContagem();
}
}
return false;
}
void MovimentadorBracoEsquerdo::reset()
{
cronometro.pararContagem();
}