Robert Walter的kinect 手指识别代码

/* TUIO C++ Library - part of the reacTIVision project http://reactivision.sourceforge.net/ Copyright (c) 2005-2009 Martin Kaltenbrunner <mkalten@iua.upf.edu> This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program 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 General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA */ #include "TuioClient.h" using namespace TUIO; using namespace osc; #ifndef WIN32 static void* ClientThreadFunc( void* obj ) #else static DWORD WINAPI ClientThreadFunc( LPVOID obj ) #endif { static_cast<TuioClient*>(obj)->socket->Run(); return 0; }; void TuioClient::lockObjectList() { if(!connected) return; #ifndef WIN32 pthread_mutex_lock(&objectMutex); #else WaitForSingleObject(objectMutex, INFINITE); #endif } void TuioClient::unlockObjectList() { if(!connected) return; #ifndef WIN32 pthread_mutex_unlock(&objectMutex); #else ReleaseMutex(objectMutex); #endif } void TuioClient::lockCursorList() { if(!connected) return; #ifndef WIN32 pthread_mutex_lock(&cursorMutex); #else WaitForSingleObject(cursorMutex, INFINITE); #endif } void TuioClient::unlockCursorList() { if(!connected) return; #ifndef WIN32 pthread_mutex_unlock(&cursorMutex); #else ReleaseMutex(cursorMutex); #endif } TuioClient::TuioClient(int port, bool mode3d) : socket (NULL) , currentFrame(-1) , maxCursorID (-1) , thread (NULL) , locked (false) , connected (false) { this->mode3d = mode3d; try { socket = new UdpListeningReceiveSocket(IpEndpointName( IpEndpointName::ANY_ADDRESS, port ), this ); } catch (std::exception &e) { std::cerr << "could not bind to UDP port " << port << std::endl; socket = NULL; } if (socket!=NULL) { if (!socket->IsBound()) { delete socket; socket = NULL; } else std::cout << "listening to TUIO messages on UDP port " << port << std::endl; } } TuioClient::~TuioClient() { delete socket; } void TuioClient::ProcessBundle( const ReceivedBundle& b, const IpEndpointName& remoteEndpoint) { try { for( ReceivedBundle::const_iterator i = b.ElementsBegin(); i != b.ElementsEnd(); ++i ){ if( i->IsBundle() ) ProcessBundle( ReceivedBundle(*i), remoteEndpoint); else ProcessMessage( ReceivedMessage(*i), remoteEndpoint); } } catch (MalformedBundleException& e) { std::cerr << "malformed OSC bundle: " << e.what() << std::endl; } } void TuioClient::ProcessMessage( const ReceivedMessage& msg, const IpEndpointName& remoteEndpoint) { try { ReceivedMessageArgumentStream args = msg.ArgumentStream(); ReceivedMessage::const_iterator arg = msg.ArgumentsBegin(); if( strcmp( msg.AddressPattern(), "/tuio/2Dobj" ) == 0 ){ const char* cmd; args >> cmd; if (strcmp(cmd,"set")==0) { int32 s_id, c_id; float xpos, ypos, angle, xspeed, yspeed, rspeed, maccel, raccel; args >> s_id >> c_id >> xpos >> ypos >> angle >> xspeed >> yspeed >> rspeed >> maccel >> raccel; lockObjectList(); std::list<TuioObject*>::iterator tobj; for (tobj=objectList.begin(); tobj!= objectList.end(); tobj++) if((*tobj)->getSessionID()==(long)s_id) break; if (tobj == objectList.end()) { TuioObject *addObject = new TuioObject((long)s_id,(int)c_id,xpos,ypos,angle); frameObjects.push_back(addObject); } else if ( ((*tobj)->getX()!=xpos) || ((*tobj)->getY()!=ypos) || ((*tobj)->getAngle()!=angle) || ((*tobj)->getXSpeed()!=xspeed) || ((*tobj)->getYSpeed()!=yspeed) || ((*tobj)->getRotationSpeed()!=rspeed) || ((*tobj)->getMotionAccel()!=maccel) || ((*tobj)->getRotationAccel()!=raccel) ) { TuioObject *updateObject = new TuioObject((long)s_id,(*tobj)->getSymbolID(),xpos,ypos,angle); updateObject->update(xpos,ypos,angle,xspeed,yspeed,rspeed,maccel,raccel); frameObjects.push_back(updateObject); } unlockObjectList(); } else if (strcmp(cmd,"alive")==0) { int32 s_id; aliveObjectList.clear(); while(!args.Eos()) { args >> s_id; aliveObjectList.push_back((long)s_id); } } else if (strcmp(cmd,"fseq")==0) { int32 fseq; args >> fseq; bool lateFrame = false; if (fseq>0) { if (fseq>currentFrame) currentTime = TuioTime::getSessionTime(); if ((fseq>=currentFrame) || ((currentFrame-fseq)>100)) currentFrame = fseq; else lateFrame = true; } else if ((TuioTime::getSessionTime().getTotalMilliseconds()-currentTime.getTotalMilliseconds())>100) { currentTime = TuioTime::getSessionTime(); } if (!lateFrame) { lockObjectList(); //find the removed objects first for (std::list<TuioObject*>::iterator tobj=objectList.begin(); tobj != objectList.end(); tobj++) { std::list<long>::iterator iter = find(aliveObjectList.begin(), aliveObjectList.end(), (*tobj)->getSessionID()); if (iter == aliveObjectList.end()) { (*tobj)->remove(currentTime); frameObjects.push_back(*tobj); } } unlockObjectList(); for (std::list<TuioObject*>::iterator iter=frameObjects.begin(); iter != frameObjects.end(); iter++) { TuioObject *tobj = (*iter); TuioObject *frameObject = NULL; switch (tobj->getTuioState()) { case TUIO_REMOVED: frameObject = tobj; frameObject->remove(currentTime); for (std::list<TuioListener*>::iterator listener=listenerList.begin(); listener != listenerList.end(); listener++) (*listener)->removeTuioObject(frameObject); lockObjectList(); for (std::list<TuioObject*>::iterator delobj=objectList.begin(); delobj!=objectList.end(); delobj++) { if((*delobj)->getSessionID()==frameObject->getSessionID()) { objectList.erase(delobj); break; } } unlockObjectList(); break; case TUIO_ADDED: lockObjectList(); frameObject = new TuioObject(currentTime,tobj->getSessionID(),tobj->getSymbolID(),tobj->getX(),tobj->getY(),tobj->getAngle()); objectList.push_back(frameObject); unlockObjectList(); for (std::list<TuioListener*>::iterator listener=listenerList.begin(); listener != listenerList.end(); listener++) (*listener)->addTuioObject(frameObject); break; default: lockObjectList(); std::list<TuioObject*>::iterator iter; for (iter=objectList.begin(); iter != objectList.end(); iter++) { if((*iter)->getSessionID()==tobj->getSessionID()) { frameObject = (*iter); break; } } if(iter==objectList.end()) break; if ( (tobj->getX()!=frameObject->getX() && tobj->getXSpeed()==0) || (tobj->getY()!=frameObject->getY() && tobj->getYSpeed()==0) ) frameObject->update(currentTime,tobj->getX(),tobj->getY(),tobj->getAngle()); else frameObject->update(currentTime,tobj->getX(),tobj->getY(),tobj->getAngle(),tobj->getXSpeed(),tobj->getYSpeed(),tobj->getRotationSpeed(),tobj->getMotionAccel(),tobj->getRotationAccel()); unlockObjectList(); for (std::list<TuioListener*>::iterator listener=listenerList.begin(); listener != listenerList.end(); listener++) (*listener)->updateTuioObject(frameObject); } delete tobj; } for (std::list<TuioListener*>::iterator listener=listenerList.begin(); listener != listenerList.end(); listener++) (*listener)->refre