/*

	TUIO C++ Library - part of the reacTIVision project

	http://reactivision.sourceforge.net/

	Copyright (c) 2005-2008 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"

#ifndef WIN32

static void* ThreadFunc( void* obj )

#else

static DWORD WINAPI ThreadFunc( LPVOID obj )

#endif

{

	static_cast<TuioClient*>(obj)->socket->Run();

	return 0;

};

TuioClient::TuioClient() {

	TuioClient(3333);

}

TuioClient::TuioClient(int port) {

	try {

		socket = new UdpListeningReceiveSocket(IpEndpointName( IpEndpointName::ANY_ADDRESS, port ), this );

	} catch (std::exception &e) { 

		std::cout << "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;

	}

	locked = false;

	running = false;

}

TuioClient::~TuioClient() {

	delete socket;

}

void TuioClient::ProcessBundle( const ReceivedBundle& b, const IpEndpointName& remoteEndpoint) {

	for( ReceivedBundle::const_iterator i = b.ElementsBegin(); i != b.ElementsEnd(); ++i ){

		if( i->IsBundle() )

			ProcessBundle( ReceivedBundle(*i), remoteEndpoint);

		else

			ProcessMessage( ReceivedMessage(*i), remoteEndpoint);

	}

}

		ReceivedMessageArgumentStream args = msg.ArgumentStream();

		ReceivedMessage::const_iterator arg = msg.ArgumentsBegin();

			const char* cmd;

			args >> cmd;

				if ((currentFrame<lastFrame) && (currentFrame>0)) return;

				int32 s_id, f_id;

				float xpos, ypos, angle, xspeed, yspeed, rspeed, maccel, raccel;

				args >> s_id >> f_id >> xpos >> ypos >> angle >> xspeed >> yspeed >> rspeed >> maccel >> raccel >> EndMessage;

				std::list<TuioObject*>::iterator tobj;

				for (tobj=objectList.begin(); tobj!= objectList.end(); tobj++)

					if((*tobj)->getSessionID()==(long)s_id) break;

					TuioObject *addObject = new TuioObject((long)s_id,(int)f_id,xpos,ypos,angle);

					objectList.push_back(addObject);

					for (std::list<TuioListener*>::iterator listener=listenerList.begin(); listener != listenerList.end(); listener++)

						(*listener)->addTuioObject(addObject);

					(*tobj)->update(xpos,ypos,angle,xspeed,yspeed,rspeed,maccel,raccel);

					for (std::list<TuioListener*>::iterator listener=listenerList.begin(); listener != listenerList.end(); listener++)

						(*listener)->updateTuioObject((*tobj));

				}

				if ((currentFrame<lastFrame) && (currentFrame>0)) return;

				int32 s_id;

					args >> s_id;

					objectBuffer.push_back((long)s_id);

					std::list<long>::iterator iter;

					iter = find(aliveObjectList.begin(), aliveObjectList.end(), (long)s_id); 

					if (iter != aliveObjectList.end()) aliveObjectList.erase(iter);

				}

				args >> EndMessage;

				std::list<long>::iterator alive_iter;

					std::list<TuioObject*>::iterator tobj;

						TuioObject *deleteObject = (*tobj);

							deleteObject->remove();

							for (std::list<TuioListener*>::iterator listener=listenerList.begin(); listener != listenerList.end(); listener++)

								(*listener)->removeTuioObject(deleteObject);

							objectList.erase(tobj);

							delete deleteObject;

							break;

						}

					}

				}

				aliveObjectList = objectBuffer;

				objectBuffer.clear();

				if(currentFrame>0) lastFrame = currentFrame;

				args >> currentFrame  >> EndMessage;

					long currentTime = lastTime;

						currentTime = getCurrentTime()-startTime;

						lastTime = currentTime;

					}

					for (std::list<TuioObject*>::iterator refreshObject=objectList.begin(); refreshObject!=objectList.end(); refreshObject++)

						if ((*refreshObject)->getUpdateTime()==TUIO_UNDEFINED) (*refreshObject)->setUpdateTime(currentTime);

					for (std::list<TuioListener*>::iterator listener=listenerList.begin(); listener!=listenerList.end(); listener++)

						(*listener)->refresh(currentTime);

				}

			}

			const char* cmd;

			args >> cmd;

				if ((currentFrame<lastFrame) && (currentFrame>0)) return;

				int32 s_id;

				float xpos, ypos, zpos, xspeed, yspeed, maccel;

				//Modifi� par alexandre.bastien@iri.centrepompidou.fr

				args >> s_id >> xpos >> ypos >> zpos >> xspeed >> yspeed >> maccel >> EndMessage;

				std::list<TuioCursor*>::iterator tcur;

				for (tcur=cursorList.begin(); tcur != cursorList.end(); tcur++)

					if((*tcur)->getSessionID()==(long)s_id) break;

					int f_id = (int)cursorList.size();

						std::list<TuioCursor*>::iterator closestCursor = freeCursorList.begin();

						//Modifi� par alexandre.bastien@iri.centrepompidou.fr

							if((*testCursor)->getDistance(xpos,ypos,zpos)<(*closestCursor)->getDistance(xpos,ypos,zpos)) closestCursor = testCursor;

						}

						f_id = (*closestCursor)->getFingerID();

						freeCursorList.erase(closestCursor);

						delete *closestCursor;

					//Modifi� par alexandre.bastien@iri.centrepompidou.fr

					TuioCursor *addCursor = new TuioCursor((long)s_id,f_id,xpos,ypos,zpos);

					cursorList.push_back(addCursor);

					for (std::list<TuioListener*>::iterator listener=listenerList.begin(); listener != listenerList.end(); listener++)

						(*listener)->addTuioCursor(addCursor);

				//Modifi� par alexandre.bastien@iri.centrepompidou.fr

					(*tcur)->update(xpos,ypos,zpos,xspeed,yspeed,maccel);

					for (std::list<TuioListener*>::iterator listener=listenerList.begin(); listener != listenerList.end(); listener++)

						(*listener)->updateTuioCursor((*tcur));

				}

				if ((currentFrame<lastFrame) && (currentFrame>0)) return;

				int32 s_id;

					args >> s_id;

					cursorBuffer.push_back((long)s_id);

					std::list<long>::iterator iter;

					iter = find(aliveCursorList.begin(), aliveCursorList.end(), (long)s_id); 

					if (iter != aliveCursorList.end()) aliveCursorList.erase(iter);

				}

				args >> EndMessage;

				std::list<long>::iterator alive_iter;

					std::list<TuioCursor*>::iterator tcur;

						TuioCursor *deleteCursor = (*tcur);

							cursorList.erase(tcur);

							deleteCursor->remove();

							for (std::list<TuioListener*>::iterator listener=listenerList.begin(); listener != listenerList.end(); listener++)

								(*listener)->removeTuioCursor(deleteCursor);

								maxFingerID = -1;

								delete deleteCursor;

									std::list<TuioCursor*>::iterator clist;

										int f_id = (*clist)->getFingerID();

										if (f_id>maxFingerID) maxFingerID=f_id;

									}

									std::list<TuioCursor*>::iterator flist;

										TuioCursor *freeCursor = (*flist);

										if (freeCursor->getFingerID()>maxFingerID) delete freeCursor;

										else freeCursorBuffer.push_back(freeCursor);

									}

									freeCursorList = freeCursorBuffer;

									freeCursorBuffer.clear();

							break;

						}

					}

				}

				aliveCursorList = cursorBuffer;

				cursorBuffer.clear();

				if(currentFrame>0) lastFrame = currentFrame;

				args >> currentFrame  >> EndMessage;

					long currentTime = lastTime;

						currentTime = getCurrentTime()-startTime;

						lastTime = currentTime;

					}

					for (std::list<TuioCursor*>::iterator refreshCursor=cursorList.begin(); refreshCursor!=cursorList.end(); refreshCursor++)

						if ((*refreshCursor)->getUpdateTime()==TUIO_UNDEFINED) (*refreshCursor)->setUpdateTime(currentTime);

					for (std::list<TuioListener*>::iterator listener=listenerList.begin(); listener != listenerList.end(); listener++)

						(*listener)->refresh(currentTime);

				}

			}

		}