public void updateCursor(TuioCursor cursor)
{
if (!activeEvents.ContainsKey(cursor.getSessionID())) return;
mtCntrEvent anEvent = activeEvents[cursor.getSessionID()];
anEvent.eventState = mtEventState.Moved;
if(cursor.getContour() != null)
{
List<TuioPoint> contr = cursor.getContour();
List<Vector3> cntrPoints = new List<Vector3>();
foreach(TuioPoint pnt in contr)
{
float xC = pnt.getX();
float yC = pnt.getY();
cntrPoints.Add(new Vector3(xC * cameraPixelWidth, (1.0f - yC ) * cameraPixelHeight, 0));
}
anEvent.contour = cntrPoints.ToArray();
//calibrate and CoM (center of mass)
float xCoM = 0.0F;
float yCoM = 0.0F;
Matrix mat = Matrix.Translate(xTCalib, yTCalib, 0.0F);
for(int i=0; i<anEvent.contour.Length; i++)
{
anEvent.contour[i] = mat.TransformVector( anEvent.contour[i] );
xCoM += anEvent.contour[i].x;
yCoM += anEvent.contour[i].y;
}
xCoM /= anEvent.contour.Length;
yCoM /= anEvent.contour.Length;
//translate to 0
for(int i=0; i<anEvent.contour.Length; i++)
{
anEvent.contour[i].x -= xCoM;
anEvent.contour[i].y -= yCoM;
}
anEvent.lastScreenPosition = anEvent.screenPosition;
anEvent.screenPosition = new Vector3(xCoM, 0, yCoM);
/*
anEvent.lastTime = anEvent.currentTime;
anEvent.currentTime = Time.time;
float dt = anEvent.currentTime - anEvent.lastTime; //delta time
if(dt > 0)
{
float dx = anEvent.lastScreenPosition.x - anEvent.screenPosition.x;
float dy = anEvent.lastScreenPosition.z - anEvent.screenPosition.z;
float distance = (float)Mathf.Sqrt(dx*dx+dy*dy);
float lastMspeed = anEvent.mAccel;
anEvent.x_speed = dx / dt; // delta x / delta time = velocity x
anEvent.y_speed = dy / dt; // -||-
anEvent.mSpeed = distance / dt;
anEvent.mAccel = (anEvent.mSpeed - lastMspeed) / dt;
}
*/
}
lock (eventQueueLock) eventQueue.Add(anEvent);
didChange = true;
}
public void updateCursor(TuioCursor cursor)
{
if (!activeEvents.ContainsKey(cursor.getSessionID())) return;
mtCntrEvent anEvent = activeEvents[cursor.getSessionID()];
anEvent.eventState = mtEventState.Moved;
if(cursor.getContour() != null)
{
List<TuioPoint> contr = cursor.getContour();
List<Vector3> cntrPoints = new List<Vector3>();
foreach(TuioPoint pnt in contr)
{
float xC = pnt.getX();
float yC = pnt.getY();
cntrPoints.Add(new Vector3(xC * cameraPixelWidth, 0, (1.0f - yC ) * cameraPixelHeight));
}
anEvent.contour = cntrPoints.ToArray();
//calibrate and CoM (center of mass)
float xCoM = 0.0F;
float yCoM = 0.0F;
Matrix mat = Matrix.Translate(xTCalib, yTCalib, 0.0F);
for(int i=0; i<anEvent.contour.Length; i++)
{
anEvent.contour[i] = mat.TransformVector( anEvent.contour[i] );
xCoM += anEvent.contour[i].x;
yCoM += anEvent.contour[i].y;
}
xCoM /= anEvent.contour.Length;
yCoM /= anEvent.contour.Length;
//translate to 0
for(int i=0; i<anEvent.contour.Length; i++)
{
anEvent.contour[i].x -= xCoM;
anEvent.contour[i].y -= yCoM;
}
anEvent.lastScreenPosition = anEvent.screenPosition;
anEvent.screenPosition = new Vector3(xCoM, 0, yCoM);
}
lock (eventQueueLock) eventQueue.Add(anEvent);
didChange = true;
}
/**
* The OSC callback method where all TUIO messages are received and decoded
* and where the TUIO event callbacks are dispatched
*
* @param message the received OSC message
*/
private void processMessage(OSCMessage message)
{
string address = message.Address;
ArrayList args = message.Values;
string command = (string)args[0];
if (address == "/tuio/2Dobj")
{
if (command == "set")
{
long s_id = (int)args[1];
int f_id = (int)args[2];
float xpos = (float)args[3];
float ypos = (float)args[4];
float angle = (float)args[5];
float xspeed = (float)args[6];
float yspeed = (float)args[7];
float rspeed = (float)args[8];
float maccel = (float)args[9];
float raccel = (float)args[10];
lock (objectSync) {
if (!objectList.ContainsKey(s_id))
{
TuioObject addObject = new TuioObject(s_id, f_id, xpos, ypos, angle);
frameObjects.Add(addObject);
}
else
{
TuioObject tobj = objectList[s_id];
if (tobj == null)
{
return;
}
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(s_id, f_id, xpos, ypos, angle);
updateObject.update(xpos, ypos, angle, xspeed, yspeed, rspeed, maccel, raccel);
frameObjects.Add(updateObject);
}
}
}
}
else if (command == "alive")
{
newObjectList.Clear();
for (int i = 1; i < args.Count; i++)
{
// get the message content
long s_id = (int)args[i];
newObjectList.Add(s_id);
// reduce the object list to the lost objects
if (aliveObjectList.Contains(s_id))
{
aliveObjectList.Remove(s_id);
}
}
// remove the remaining objects
lock (objectSync) {
for (int i = 0; i < aliveObjectList.Count; i++)
{
long s_id = aliveObjectList[i];
TuioObject removeObject = objectList[s_id];
removeObject.remove(currentTime);
frameObjects.Add(removeObject);
}
}
}
else if (command == "fseq")
{
int fseq = (int)args[1];
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)
{
IEnumerator <TuioObject> frameEnum = frameObjects.GetEnumerator();
while (frameEnum.MoveNext())
{
TuioObject tobj = frameEnum.Current;
switch (tobj.getTuioState())
{
case TuioObject.TUIO_REMOVED:
TuioObject removeObject = tobj;
removeObject.remove(currentTime);
for (int i = 0; i < listenerList.Count; i++)
{
TuioListener listener = (TuioListener)listenerList[i];
if (listener != null)
{
listener.removeTuioObject(removeObject);
}
}
lock (objectSync) {
objectList.Remove(removeObject.getSessionID());
}
break;
case TuioObject.TUIO_ADDED:
TuioObject addObject = new TuioObject(currentTime, tobj.getSessionID(), tobj.getSymbolID(), tobj.getX(), tobj.getY(), tobj.getAngle());
lock (objectSync) {
objectList.Add(addObject.getSessionID(), addObject);
}
for (int i = 0; i < listenerList.Count; i++)
{
TuioListener listener = (TuioListener)listenerList[i];
if (listener != null)
{
listener.addTuioObject(addObject);
}
}
break;
default:
TuioObject updateObject = getTuioObject(tobj.getSessionID());
if ((tobj.getX() != updateObject.getX() && tobj.getXSpeed() == 0) || (tobj.getY() != updateObject.getY() && tobj.getYSpeed() == 0))
{
updateObject.update(currentTime, tobj.getX(), tobj.getY(), tobj.getAngle());
}
else
{
updateObject.update(currentTime, tobj.getX(), tobj.getY(), tobj.getAngle(), tobj.getXSpeed(), tobj.getYSpeed(), tobj.getRotationSpeed(), tobj.getMotionAccel(), tobj.getRotationAccel());
}
for (int i = 0; i < listenerList.Count; i++)
{
TuioListener listener = (TuioListener)listenerList[i];
if (listener != null)
{
listener.updateTuioObject(updateObject);
}
}
break;
}
}
for (int i = 0; i < listenerList.Count; i++)
{
TuioListener listener = (TuioListener)listenerList[i];
if (listener != null)
{
listener.refresh(new TuioTime(currentTime));
}
}
List <long> buffer = aliveObjectList;
aliveObjectList = newObjectList;
// recycling the List
newObjectList = buffer;
}
frameObjects.Clear();
}
}
else if (address == "/tuio/2Dcur" || address == "/tuio/2Dcur source ccv@localhost")
{
if (command == "set")
{
long s_id = (int)args[1];
float xpos = (float)args[2];
float ypos = (float)args[3];
float xspeed = (float)args[4];
float yspeed = (float)args[5];
float maccel = (float)args[6];
//~ Debug.Log("Cursor - id: " + s_id);
lock (cursorList) {
if (!cursorList.ContainsKey(s_id))
{
TuioCursor addCursor = new TuioCursor(s_id, -1, xpos, ypos);
frameCursors.Add(addCursor);
}
else
{
TuioCursor tcur = (TuioCursor)cursorList[s_id];
if (tcur == null)
{
return;
}
if ((tcur.getX() != xpos) || (tcur.getY() != ypos) || (tcur.getXSpeed() != xspeed) || (tcur.getYSpeed() != yspeed) || (tcur.getMotionAccel() != maccel))
{
TuioCursor updateCursor = new TuioCursor(s_id, tcur.getCursorID(), xpos, ypos);
updateCursor.update(xpos, ypos, xspeed, yspeed, maccel);
frameCursors.Add(updateCursor);
}
}
}
//experimental contour data (by Rasmus H. - www.schnitzel.dk)
}
else if (command == "contour")
{
long s_id = (int)args[1];
int m_length = (int)args[2];
//~ Debug.Log("Contour - id: " + s_id + " Lenght: " + m_length);
if (m_length > 0)
{
lock (cursorList) {
List <TuioPoint> contr = new List <TuioPoint>();
for (int i = 3; i + 2 <= m_length + 3; i += 2)
{
float xpos = (float)args[i];
float ypos = (float)args[i + 1];
contr.Add(new TuioPoint(xpos, ypos));
}
if (!cursorList.ContainsKey(s_id))
{
//no cursor with that id so we return
return;
}
else
{
TuioCursor tcur = (TuioCursor)cursorList[s_id];
if (tcur == null)
{
return;
}
TuioCursor updateCursor = new TuioCursor(tcur);
updateCursor.update(tcur, contr);
frameCursors.Add(updateCursor);
}
}
}
//experimental height data (by Rasmus H. - www.schnitzel.dk)
}
else if (command == "height")
{
long s_id = (int)args[1];
float xpos = (float)args[2];
float ypos = (float)args[3];
int xwidth = (int)args[4];
int yheight = (int)args[5];
int hpoints = (int)args[6];
//Debug.Log("Contour - id: " + s_id + " x: " + xpos + " y: " + ypos + " width: " + xwidth + " height: " + yheight + " hpoints: " + hpoints );
lock (cursorList) {
List <float> heightp = new List <float>();
for (int i = 7; i < hpoints + 7; i++)
{
heightp.Add((float)args[i]);
}
if (!cursorList.ContainsKey(s_id))
{
//no cursor with that id so we return
return;
}
else
{
TuioCursor tcur = (TuioCursor)cursorList[s_id];
if (tcur == null)
{
return;
}
TuioCursor updateCursor = new TuioCursor(tcur);
updateCursor.update(tcur, xpos, ypos, xwidth, yheight, heightp);
frameCursors.Add(updateCursor);
}
}
}
else if (command == "alive")
{
newCursorList.Clear();
for (int i = 1; i < args.Count; i++)
{
// get the message content
long s_id = (int)args[i];
newCursorList.Add(s_id);
// reduce the cursor list to the lost cursors
if (aliveCursorList.Contains(s_id))
{
aliveCursorList.Remove(s_id);
}
}
// remove the remaining cursors
lock (cursorSync) {
for (int i = 0; i < aliveCursorList.Count; i++)
{
long s_id = aliveCursorList[i];
if (!cursorList.ContainsKey(s_id))
{
continue;
}
TuioCursor removeCursor = cursorList[s_id];
removeCursor.remove(currentTime);
frameCursors.Add(removeCursor);
}
}
}
else if (command == "fseq")
{
int fseq = (int)args[1];
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)
{
IEnumerator <TuioCursor> frameEnum = frameCursors.GetEnumerator();
while (frameEnum.MoveNext())
{
TuioCursor tcur = frameEnum.Current;
switch (tcur.getTuioState())
{
case TuioCursor.TUIO_REMOVED:
TuioCursor removeCursor = tcur;
removeCursor.remove(currentTime);
for (int i = 0; i < listenerList.Count; i++)
{
TuioListener listener = (TuioListener)listenerList[i];
if (listener != null)
{
listener.removeTuioCursor(removeCursor);
}
}
lock (cursorSync) {
cursorList.Remove(removeCursor.getSessionID());
if (removeCursor.getCursorID() == maxCursorID)
{
maxCursorID = -1;
if (cursorList.Count > 0)
{
IEnumerator <KeyValuePair <long, TuioCursor> > clist = cursorList.GetEnumerator();
while (clist.MoveNext())
{
int f_id = clist.Current.Value.getCursorID();
if (f_id > maxCursorID)
{
maxCursorID = f_id;
}
}
List <TuioCursor> freeCursorBuffer = new List <TuioCursor>();
IEnumerator <TuioCursor> flist = freeCursorList.GetEnumerator();
while (flist.MoveNext())
{
TuioCursor testCursor = flist.Current;
if (testCursor.getCursorID() < maxCursorID)
{
freeCursorBuffer.Add(testCursor);
}
}
freeCursorList = freeCursorBuffer;
}
else
{
freeCursorList.Clear();
}
}
else if (removeCursor.getCursorID() < maxCursorID)
{
freeCursorList.Add(removeCursor);
}
}
break;
case TuioCursor.TUIO_ADDED:
TuioCursor addCursor;
lock (cursorSync) {
int c_id = cursorList.Count;
if ((cursorList.Count <= maxCursorID) && (freeCursorList.Count > 0))
{
TuioCursor closestCursor = freeCursorList[0];
IEnumerator <TuioCursor> testList = freeCursorList.GetEnumerator();
while (testList.MoveNext())
{
TuioCursor testCursor = testList.Current;
if (testCursor.getDistance(tcur) < closestCursor.getDistance(tcur))
{
closestCursor = testCursor;
}
}
c_id = closestCursor.getCursorID();
freeCursorList.Remove(closestCursor);
}
else
{
maxCursorID = c_id;
}
addCursor = new TuioCursor(currentTime, tcur.getSessionID(), c_id, tcur.getX(), tcur.getY());
cursorList.Add(addCursor.getSessionID(), addCursor);
}
for (int i = 0; i < listenerList.Count; i++)
{
TuioListener listener = (TuioListener)listenerList[i];
if (listener != null)
{
listener.addTuioCursor(addCursor);
}
}
break;
default:
TuioCursor updateCursor = getTuioCursor(tcur.getSessionID());
if ((tcur.getX() != updateCursor.getX() && tcur.getXSpeed() == 0) || (tcur.getY() != updateCursor.getY() && tcur.getYSpeed() == 0))
{
updateCursor.update(currentTime, tcur.getX(), tcur.getY());
}
else
{
updateCursor.update(currentTime, tcur.getX(), tcur.getY(), tcur.getXSpeed(), tcur.getYSpeed(), tcur.getMotionAccel());
}
//rasmus edit
if (tcur.getContour() != null)
{
updateCursor.update(updateCursor, tcur.getContour());
}
if (tcur.getHeightPoints() != null)
{
updateCursor.update(updateCursor, tcur.getHXpos(), tcur.getHYpos(), tcur.getWidth(), tcur.getHeight(), tcur.getHeightPoints());
}
for (int i = 0; i < listenerList.Count; i++)
{
TuioListener listener = (TuioListener)listenerList[i];
if (listener != null)
{
listener.updateTuioCursor(updateCursor);
}
}
break;
}
}
for (int i = 0; i < listenerList.Count; i++)
{
TuioListener listener = (TuioListener)listenerList[i];
if (listener != null)
{
listener.refresh(new TuioTime(currentTime));
}
}
List <long> buffer = aliveCursorList;
aliveCursorList = newCursorList;
// recycling the List
newCursorList = buffer;
}
frameCursors.Clear();
}
}
}