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
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
|
/****************************************************************************
* *
* OpenNI 1.x Alpha *
* Copyright (C) 2011 PrimeSense Ltd. *
* *
* This file is part of OpenNI. *
* *
* OpenNI is free software: you can redistribute it and/or modify *
* it under the terms of the GNU Lesser General Public License as published *
* by the Free Software Foundation, either version 3 of the License, or *
* (at your option) any later version. *
* *
* OpenNI is distributed in the hope that it will be useful, *
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
* GNU Lesser General Public License for more details. *
* *
* You should have received a copy of the GNU Lesser General Public License *
* along with OpenNI. If not, see <http://www.gnu.org/licenses/>. *
* *
****************************************************************************/
//---------------------------------------------------------------------------
// Includes
//---------------------------------------------------------------------------
#include "PoseUserSelector.h"
#define POSE_LIST_NUM_POSES 20
#define POSE_LIST_STRING_LENGTH 50
#define VALIDATE(cond, errorMsg) \
if(!(cond)) \
{ \
printf("PoseUserSelector creation failed: %s\n",errorMsg); \
m_bValid=FALSE; \
return; \
} \
#define VALIDATE_WITH_ACTION(cond, errorMsg, actionToDo) \
if(!(cond)) \
{ \
printf("PoseUserSelector creation failed: %s\n",errorMsg); \
actionToDo; \
m_bValid=FALSE; \
return; \
} \
//---------------------------------------------------------------------------
// Code
//---------------------------------------------------------------------------
PoseUserSelector::PoseUserSelector(xn::UserGenerator* pUserGenerator,
TrackingInitializer* pTrackingInitializer,
const char* poseToTrack) :
UserSelector(pUserGenerator),
m_pTrackingInitializer(pTrackingInitializer),
m_strPoseToTrack(NULL),
m_hPoseDetectCallback(NULL),
m_hPoseInProgressCallback(NULL)
{
VALIDATE(m_bValid , "UserSelector was not initialized properly");
VALIDATE(pTrackingInitializer != NULL , "NULL tracking initializer supplied");
VALIDATE(pTrackingInitializer->IsValid() , "tracking initializer supplied is invalid");
VALIDATE(m_pUserGenerator != NULL,"NULL user generator supplied");
VALIDATE(m_pUserGenerator->IsCapabilitySupported(XN_CAPABILITY_POSE_DETECTION) , "User generator supplied does not support pose capability");
VALIDATE(poseToTrack != NULL , "NULL pose provided");
VALIDATE(m_pUserGenerator->GetPoseDetectionCap().IsPoseSupported(poseToTrack) , "Pose detection capability does not support requested pose");
XnStatus nRetVal = m_pUserGenerator->GetPoseDetectionCap().RegisterToPoseDetected(PoseDetectedCallback,this,m_hPoseDetectCallback);
VALIDATE_WITH_ACTION(nRetVal == XN_STATUS_OK,"Failed to register to pose detection",m_hPoseDetectCallback = NULL);
nRetVal = m_pUserGenerator->GetPoseDetectionCap().RegisterToPoseInProgress(PoseInProgressCallback,this,m_hPoseInProgressCallback);
VALIDATE_WITH_ACTION(nRetVal == XN_STATUS_OK,"Failed to register to pose in progress",m_hPoseInProgressCallback = NULL);
int len = (int)strlen(poseToTrack)+1;
m_strPoseToTrack=XN_NEW_ARR(char, len); // the length is +1 to accommodate the null terminator
xnOSStrCopy(m_strPoseToTrack,poseToTrack,len);
}
PoseUserSelector::~PoseUserSelector()
{
m_pTrackingInitializer = NULL;
if(m_pUserGenerator != NULL)
{
if(m_pUserGenerator->IsCapabilitySupported(XN_CAPABILITY_POSE_DETECTION))
{
for(UserStateHash::Iterator iter = m_hUsersState.Begin(); iter != m_hUsersState.End(); ++iter)
{
m_pUserGenerator->GetPoseDetectionCap().StopPoseDetection(iter->Key());
}
if(m_hPoseDetectCallback != NULL)
{
m_pUserGenerator->GetPoseDetectionCap().UnregisterFromPoseDetected(m_hPoseDetectCallback);
m_hPoseDetectCallback = NULL;
}
if(m_hPoseInProgressCallback != NULL)
{
m_pUserGenerator->GetPoseDetectionCap().UnregisterFromPoseInProgress(m_hPoseInProgressCallback);
m_hPoseInProgressCallback = NULL;
}
}
m_pUserGenerator = NULL;
}
if(m_strPoseToTrack != NULL)
{
XN_DELETE_ARR(m_strPoseToTrack);
m_strPoseToTrack = NULL;
}
}
XnStatus PoseUserSelector::StartTracking(XnUserID nUserId)
{
UserSelectionState* pState;
XnStatus nRetVal=m_hUsersState.Get(nUserId, pState);
if(nRetVal != XN_STATUS_OK)
{
return nRetVal; // we don't have such user ready
}
if(pState->m_eState != XN_SELECTION_UNSELECTED)
{
return XN_STATUS_ERROR; // the user is in the wrong state.
}
nRetVal=UpdateUserSelectionState(nUserId, XN_SELECTION_SELECTED, 0);
if(nRetVal!=XN_STATUS_OK)
{
return nRetVal; // we can't continue because we can't update the state!
}
return m_pTrackingInitializer->StartTracking(nUserId,FALSE);
}
XnStatus PoseUserSelector::AddNewUser(XnUserID nUserId)
{
UserSelector::AddNewUser(nUserId);
return m_pUserGenerator->GetPoseDetectionCap().StartPoseDetection(m_strPoseToTrack,nUserId);
}
XnStatus PoseUserSelector::RemoveUser(XnUserID nUserId)
{
UserSelector::RemoveUser(nUserId);
return m_pUserGenerator->GetPoseDetectionCap().StopPoseDetection(nUserId);
}
XnStatus PoseUserSelector::UpdatePoseProgress(XnUserID nUserId, XnPoseDetectionStatus ePoseError)
{
UserSelectionState* pState;
XnStatus nRetVal=m_hUsersState.Get(nUserId, pState);
if(nRetVal != XN_STATUS_OK)
{
return nRetVal;
}
if(pState->m_eState != XN_SELECTION_UNSELECTED)
{
return XN_STATUS_ERROR; // the user is in the wrong state.
}
return UpdateUserSelectionState(nUserId,pState->m_eState, ePoseError);
}
XnStatus PoseUserSelector::DetectPose(XnUserID nUserId)
{
return StartTracking(nUserId);
}
void XN_CALLBACK_TYPE PoseUserSelector::PoseInProgressCallback(xn::PoseDetectionCapability& /*capability*/, const XnChar* strPose, XnUserID nUserId, XnPoseDetectionStatus ePoseError, void* pCookie)
{
PoseUserSelector* pPoseUserSelector = (PoseUserSelector *)pCookie;
if(xnOSStrCmp(strPose,pPoseUserSelector->m_strPoseToTrack)!=0)
{
return; // this is not the pose we are looking for.
}
pPoseUserSelector->UpdatePoseProgress(nUserId,ePoseError);
}
void XN_CALLBACK_TYPE PoseUserSelector::PoseDetectedCallback(xn::PoseDetectionCapability& /*capability*/, const XnChar* strPose, XnUserID nUserId, void* pCookie)
{
PoseUserSelector* pPoseUserSelector = (PoseUserSelector *)pCookie;
if(xnOSStrCmp(strPose,pPoseUserSelector->m_strPoseToTrack)!=0)
{
return; // this is not the pose we are looking for.
}
pPoseUserSelector->DetectPose(nUserId);
}
const XnChar* PoseUserSelector::GetPoseErrorString(XnPoseDetectionStatus error)
{
switch (error)
{
case XN_POSE_DETECTION_STATUS_OK:
return "OK";
case XN_POSE_DETECTION_STATUS_NO_USER:
return "NoUser";
case XN_POSE_DETECTION_STATUS_TOP_FOV:
return "Top FOV";
case XN_POSE_DETECTION_STATUS_SIDE_FOV:
return "Side FOV";
case XN_POSE_DETECTION_STATUS_ERROR:
return "General error";
default:
return "Unknown";
}
}
|
