/**
* This constructor takes the atttibutes of the provided TuioObject
* and assigs these values to the newly created TuioObject.
*
* @param tobj the TuioObject to assign
*/
public TuioObject(TuioObject tobj) : base(tobj)
{
symbol_id = tobj.getSymbolID();
angle = tobj.getAngle();
rotation_speed = 0.0f;
rotation_accel = 0.0f;
}
/**
* This constructor takes the atttibutes of the provided TuioObject
* and assigs these values to the newly created TuioObject.
*
* @param tobj the TuioObject to assign
*/
public TuioObject(TuioObject tobj)
: base(tobj)
{
symbol_id = tobj.getSymbolID();
angle = tobj.getAngle();
rotation_speed = 0.0f;
rotation_accel = 0.0f;
}
public void updateTuioObject(TuioObject o)
{
lock(objectSync) {
objectList[o.getSessionID()].update(o);
}
if (verbose) Console.WriteLine("set obj "+o.getSymbolID()+" "+o.getSessionID()+" "+o.getX()+" "+o.getY()+" "+o.getAngle()+" "+o.getMotionSpeed()+" "+o.getRotationSpeed()+" "+o.getMotionAccel()+" "+o.getRotationAccel());
}
/**
* 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")
{
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];
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);
}
}
}
}
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());
}
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();
}
}
}
public void addTuioObject(TuioObject o)
{
lock(objectSync) {
objectList.Add(o.getSessionID(),new TuioDemoObject(o));
} if (verbose) Console.WriteLine("add obj "+o.getSymbolID()+" ("+o.getSessionID()+") "+o.getX()+" "+o.getY()+" "+o.getAngle());
}
public void removeTuioObject(TuioObject o)
{
lock(objectSync) {
objectList.Remove(o.getSessionID());
}
if (verbose) Console.WriteLine("del obj "+o.getSymbolID()+" ("+o.getSessionID()+")");
}
// an object was removed from the table
public void removeTuioObject(TuioObject tobj)
{
if (readyForInput)
{
//Debug.WriteLine("Object removed!");
TuioObject dummy;
//if (USE_FIDUCIALS) // Use symbol ID's from fiducials instead of session ID's
//{
// tuioObjects.TryRemove(tobj.getSymbolID(), out dummy);
//}
//else
//{
// tuioObjects.TryRemove(tobj.getSessionID(), out dummy);
//}
tuioObjects.TryRemove(tobj.getSymbolID(), out dummy);
}
}
public void updateTuioObject(TuioObject tobj)
{
if (readyForInput)
{
// If using calibration values, modify TuioObject using calibration values before passing it on
if (Settings.INPUT_USE_FIDUCIALS && Settings.USE_INDIVIDUAL_CALIBRATION)
ApplyIndividualCalibrations(tobj);
tuioObjects.AddOrUpdate(tobj.getSymbolID(), tobj, updateTObj);
/*
// Only accept updates if coordinates are within movieDestination
if (movieDestination.Contains(tobj.getScreenX(Settings.RESOLUTION_X), tobj.getScreenY(Settings.RESOLUTION_Y) - 1))
{
//Debug.WriteLine("Object update!, x=" + tobj.getScreenX(RESOLUTION_X) + ", y=" + tobj.getScreenY(RESOLUTION_Y) + ", speed=" + tobj.getMotionSpeed() + ", accel=" + tobj.getMotionAccel() + ", angle=" + tobj.getAngleDegrees() + ", symbolID=" + tobj.getSymbolID() + ", sessionID=" + tobj.getSessionID() + ", gameTime=" + gameTime.TotalGameTime.TotalMilliseconds);
//Debug.WriteLine("Oject velocity: " + tobj.getVelocityFromPath(RESOLUTION_X,RESOLUTION_Y));
//if (USE_FIDUCIALS) // Use symbol ID's from fiducials instead of session ID's
//{
// //if (!USE_CALIBRATION || (USE_CALIBRATION && tobj.getSymbolID() < 10))
// tuioObjects.AddOrUpdate(tobj.getSymbolID(), tobj, updateTObj);
//}
//else
//{
// tuioObjects.AddOrUpdate(tobj.getSessionID(), tobj, updateTObj);
//}
if (Settings.INPUT_USE_GLOBAL_CALIBRATION)
tobj.update(((tobj.getX() * Settings.RESOLUTION_X + Settings.INPUT_GLOBAL_X_SHIFT) / (float)Settings.RESOLUTION_X), ((tobj.getY() * Settings.RESOLUTION_Y + Settings.INPUT_GLOBAL_Y_SHIFT) / (float)Settings.RESOLUTION_Y));
if (zoomedCircles.ContainsKey(tobj.getSymbolID()))
{
// If this is an update, smooth motion by ignoring small changes
ZoomCircle oldZoomCircle = zoomedCircles[tobj.getSymbolID()];
Vector2 oldPosition = oldZoomCircle.position;
//Debug.WriteLine(oldPosition.X + ", " + oldPosition.Y + "\t" + tobj.getScreenX(RESOLUTION_X) + ", " + tobj.getScreenY(RESOLUTION_Y));
//Debug.WriteLineIf((Math.Abs(oldZoomCircle.position.X - tobj.getScreenX(RESOLUTION_X)) > 0), Math.Abs(oldZoomCircle.position.X - tobj.getScreenX(RESOLUTION_X)));
//Debug.WriteLine(oldPosition.X + ", " + oldPosition.Y + "\t" + tobj.getScreenX(RESOLUTION_X) + ", " + tobj.getScreenY(RESOLUTION_Y));
List<TuioPoint> path = tobj.getPath();
int pathCount = path.Count;
if (pathCount >= 10)
{
List<TuioPoint> lastPoints = path.GetRange(pathCount - 10, 10);
float yDiff = 0f;
float xDiff = 0f;
foreach (TuioPoint tpoint in lastPoints)
{
xDiff += Math.Abs(tpoint.getX() * Settings.RESOLUTION_X - oldPosition.X);
yDiff += Math.Abs(tpoint.getY() * Settings.RESOLUTION_Y - oldPosition.Y);
}
if (xDiff < 10f * Settings.CIRCLE_POSITION_CHANGE_THRESHOLD || yDiff < 10f * Settings.CIRCLE_POSITION_CHANGE_THRESHOLD)
{
tobj.update(oldPosition.X / (float)Settings.RESOLUTION_X, oldPosition.Y / (float)Settings.RESOLUTION_Y);
}
else
{
tuioObjects.AddOrUpdate(tobj.getSymbolID(), tobj, updateTObj);
}
//if ((Math.Abs(oldPosition.X - tobj.getScreenX(RESOLUTION_X)) < CIRCLE_POSITION_CHANGE_THRESHOLD) ||
// (Math.Abs(oldPosition.Y - tobj.getScreenY(RESOLUTION_Y)) < CIRCLE_POSITION_CHANGE_THRESHOLD))
//{
// tobj.update(oldPosition.X / RESOLUTION_X, oldPosition.Y / RESOLUTION_Y);
//}
//else
//{
// tuioObjects.AddOrUpdate(tobj.getSymbolID(), tobj, updateTObj);
//}
}
else
{
tuioObjects.AddOrUpdate(tobj.getSymbolID(), tobj, updateTObj);
}
}
else
{
// Otherwise just add it
tuioObjects.AddOrUpdate(tobj.getSymbolID(), tobj, updateTObj);
}
}
*/
// Measure how many total updates / second we're getting
//if ((int)gameTime.TotalGameTime.TotalSeconds > secondsRunning)
//{
// Debug.WriteLine("Object updates per second:" + updatesCount);
// secondsRunning = (int)gameTime.TotalGameTime.TotalSeconds;
// updatesCount = 0;
//}
//else
//{
// updatesCount++;
//}
}
}
private static void ApplyIndividualCalibrations(TuioObject tobj)
{
if (Settings.USE_INDIVIDUAL_CALIBRATION) // Modify object using calibration values before passing it on
{
int symbolID = tobj.getSymbolID();
// ERICSOCO ADDED
if (symbolID > 4095)
{
throw new ArgumentOutOfRangeException();
}
// Retrieve calibration values for this object
float calA1 = MathHelper.ToRadians(Settings.CALIBRATIONS[symbolID, 0]);
float calD = (float)Settings.CALIBRATIONS[symbolID, 1];
float calA2 = MathHelper.ToRadians(Settings.CALIBRATIONS[symbolID, 2]);
// Assume that the tuioObject is the origin, and that its orientation vector points up (along the y-axis).
// Create a position vector based on the calibration information that is offset from the tuioObject/origin.
Vector2 offsetVector = new Vector2((float)Math.Cos(calA1), (float)Math.Sin(calA1));
offsetVector = Vector2.Multiply(offsetVector, calD);
// Rotate vector around the origin by the TUIO object's orientation.
Matrix tMatrix = Matrix.CreateRotationZ(tobj.getAngle());
// Translate vector by the TUIO object's position.
tMatrix *= Matrix.CreateTranslation(tobj.getScreenX(Settings.RESOLUTION_X), tobj.getScreenY(Settings.RESOLUTION_Y), 0f);
// Apply matrix transforms.
offsetVector = Vector2.Transform(offsetVector, tMatrix);
// Normalize to screen resolution.
float offsetX = offsetVector.X / Settings.RESOLUTION_X;
float offsetY = offsetVector.Y / Settings.RESOLUTION_Y;
// Add other calibration angle to tuioObject angle.
float offsetA = tobj.getAngle() + calA2;
// Update the TUIO object.
tobj.update(tobj.getTuioTime(), offsetX, offsetY, offsetA);
/*
// Add offset angle to tuioObject's rotation
float offsetA = tobj.getAngle() + calA1;
Vector2 offsetV = new Vector2((float)Math.Cos(offsetA), (float)Math.Sin(offsetA));
// Move fiducial point to data point
// offsetV.Normalize();
Vector2 dataPoint = Vector2.Multiply(offsetV, calD);
tobj.update(tobj.getTuioTime(), tobj.getX() + dataPoint.X / RESOLUTION_X, tobj.getY() + dataPoint.Y / RESOLUTION_Y, tobj.getAngle() + calA2);
*/
}
}
private void InitializeCircles()
{
freeObjects = new ConcurrentDictionary<long, TuioObject>();
draggedObjects = new ConcurrentDictionary<long, TuioObject>();
zoomedCircles = new ConcurrentDictionary<long, ZoomCircle>();
tuioObjects.Clear();
// If touch_only, add 3 tuio objects that will stay forever
if (Settings.TOUCHONLY)
{
for (int i = 0; i < 3; i++)
{
TuioObject tobj = new TuioObject(new TuioTime(), rand.Next(), i, (float)rand.Next(movieDestination.Left, movieDestination.Right) / Settings.RESOLUTION_X, (float)rand.Next(movieDestination.Top, movieDestination.Bottom) / Settings.RESOLUTION_Y, 0f);
this.addTuioObject(tobj);
if (!freeObjects.TryAdd(tobj.getSymbolID(), tobj))
{
Debug.WriteLine("Failed to add to freeObjects in InitializeCircles()");
};
}
}
}
public void updateTuioObject(TuioObject tobj)
{
Console.WriteLine("set obj "+tobj.getSymbolID()+" "+tobj.getSessionID()+" "+tobj.getX()+" "+tobj.getY()+" "+tobj.getAngle()+" "+tobj.getMotionSpeed()+" "+tobj.getRotationSpeed()+" "+tobj.getMotionAccel()+" "+tobj.getRotationAccel());
}
public void removeTuioObject(TuioObject tobj)
{
Console.WriteLine("del obj "+tobj.getSymbolID()+" "+tobj.getSessionID());
}
public void addTuioObject(TuioObject tobj)
{
Console.WriteLine("add obj "+tobj.getSymbolID()+" "+tobj.getSessionID()+" "+tobj.getX()+" "+tobj.getY()+" "+tobj.getAngle());
}
/**
* 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")
{
if (currentTime.getTotalMilliseconds() == 0)
{
currentTime = TuioTime.getSessionTime();
}
long s_id = (int)args[1];
int f_id = (int)args[2];
float x = (float)args[3];
float y = (float)args[4];
float a = (float)args[5];
float X = (float)args[6];
float Y = (float)args[7];
float A = (float)args[8];
float m = (float)args[9];
float r = (float)args[10];
if (!objectList.ContainsKey(s_id))
{
TuioObject addObject = new TuioObject(currentTime, s_id, f_id, x, y, a);
objectList.Add(s_id, addObject);
for (int i = 0; i < listenerList.Count; i++)
{
TuioListener listener = (TuioListener)listenerList[i];
if (listener != null)
{
listener.addTuioObject(addObject);
}
}
}
else
{
TuioObject updateObject = objectList[s_id];
if ((updateObject.getX() != x) || (updateObject.getY() != y) || (updateObject.getAngle() != a))
{
TuioObject tobj = new TuioObject(currentTime, s_id, updateObject.getSymbolID(), x, y, a);
tobj.update(currentTime, x, y, a, X, Y, A, m, r);
frameObjects.Add(tobj);
/*updateObject.update(currentTime,x,y,a,X,Y,A,m,r);
* for (int i=0;i<listenerList.Count;i++) {
* TuioListener listener = (TuioListener)listenerList[i];
* if (listener!=null) listener.updateTuioObject(updateObject);
* }*/
//objectList[s_id] = tobj;
}
}
}
else if (command == "alive")
{
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
for (int i = 0; i < aliveObjectList.Count; i++)
{
long s_id = aliveObjectList[i];
TuioObject removeObject = objectList[s_id];
removeObject.remove(currentTime);
objectList.Remove(s_id);
for (int j = 0; j < listenerList.Count; j++)
{
TuioListener listener = (TuioListener)listenerList[j];
if (listener != null)
{
listener.removeTuioObject(removeObject);
}
}
}
List <long> buffer = aliveObjectList;
aliveObjectList = newObjectList;
// recycling of the List
newObjectList = buffer;
newObjectList.Clear();
}
else if (command == "fseq")
{
int fseq = (int)args[1];
bool lateFrame = false;
if (fseq > 0)
{
if ((fseq >= currentFrame) || ((currentFrame - fseq) > 100))
{
currentFrame = fseq;
}
else
{
lateFrame = true;
}
}
if (!lateFrame)
{
IEnumerator <TuioObject> frameEnum = frameObjects.GetEnumerator();
while (frameEnum.MoveNext())
{
TuioObject tobj = frameEnum.Current;
TuioObject updateObject = getTuioObject(tobj.getSessionID());
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);
}
}
}
for (int i = 0; i < listenerList.Count; i++)
{
TuioListener listener = (TuioListener)listenerList[i];
if (listener != null)
{
listener.refresh(currentTime);
}
}
if (fseq > 0)
{
currentTime.reset();
}
}
frameObjects.Clear();
}
}
else if (address == "/tuio/2Dcur")
{
if (command == "set")
{
if (currentTime.getTotalMilliseconds() == 0)
{
currentTime = TuioTime.getSessionTime();
}
long s_id = (int)args[1];
float x = (float)args[2];
float y = (float)args[3];
float X = (float)args[4];
float Y = (float)args[5];
float m = (float)args[6];
if (!cursorList.ContainsKey(s_id))
{
int f_id = cursorList.Count;
if (cursorList.Count <= maxFingerID)
{
TuioCursor closestCursor = freeCursorList[0];
IEnumerator <TuioCursor> testList = freeCursorList.GetEnumerator();
while (testList.MoveNext())
{
TuioCursor testCursor = testList.Current;
if (testCursor.getDistance(x, y) < closestCursor.getDistance(x, y))
{
closestCursor = testCursor;
}
}
f_id = closestCursor.getCursorID();
freeCursorList.Remove(closestCursor);
}
else
{
maxFingerID = f_id;
}
TuioCursor addCursor = new TuioCursor(currentTime, s_id, f_id, x, y);
cursorList.Add(s_id, addCursor);
for (int i = 0; i < listenerList.Count; i++)
{
TuioListener listener = (TuioListener)listenerList[i];
if (listener != null)
{
listener.addTuioCursor(addCursor);
}
}
}
else
{
TuioCursor updateCursor = (TuioCursor)cursorList[s_id];
if ((updateCursor.getX() != x) || (updateCursor.getY() != y))
{
TuioCursor tcur = new TuioCursor(currentTime, s_id, updateCursor.getCursorID(), x, y);
tcur.update(currentTime, x, y, X, Y, m);
frameCursors.Add(tcur);
/*updateCursor.update(currentTime,x,y,X,Y,m);
* for (int i=0;i<listenerList.Count;i++) {
* TuioListener listener = (TuioListener)listenerList[i];
* if (listener!=null) listener.updateTuioCursor(updateCursor);
* }*/
//cursorList[s_id] = tcur;
}
}
}
else if (command == "alive")
{
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
for (int i = 0; i < aliveCursorList.Count; i++)
{
long s_id = aliveCursorList[i];
if (!cursorList.ContainsKey(s_id))
{
continue;
}
TuioCursor removeCursor = cursorList[s_id];
int c_id = removeCursor.getCursorID();
cursorList.Remove(s_id);
removeCursor.remove(currentTime);
if (c_id == maxFingerID)
{
maxFingerID = -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 > maxFingerID)
{
maxFingerID = f_id;
}
}
List <TuioCursor> freeCursorBuffer = new List <TuioCursor>();
IEnumerator <TuioCursor> flist = freeCursorList.GetEnumerator();
while (flist.MoveNext())
{
TuioCursor testCursor = flist.Current;
if (testCursor.getCursorID() < maxFingerID)
{
freeCursorBuffer.Add(testCursor);
}
}
freeCursorList = freeCursorBuffer;
}
}
else if (c_id < maxFingerID)
{
freeCursorList.Add(removeCursor);
}
for (int j = 0; j < listenerList.Count; j++)
{
TuioListener listener = (TuioListener)listenerList[j];
if (listener != null)
{
listener.removeTuioCursor(removeCursor);
}
}
}
List <long> buffer = aliveCursorList;
aliveCursorList = newCursorList;
// recycling of the List
newCursorList = buffer;
newCursorList.Clear();
}
else if (command == "fseq")
{
int fseq = (int)args[1];
bool lateFrame = false;
if (fseq > 0)
{
if ((fseq >= currentFrame) || ((currentFrame - fseq) > 100))
{
currentFrame = fseq;
}
else
{
lateFrame = true;
}
}
if (!lateFrame)
{
IEnumerator <TuioCursor> frameEnum = frameCursors.GetEnumerator();
while (frameEnum.MoveNext())
{
TuioCursor tcur = frameEnum.Current;
TuioCursor updateCursor = getTuioCursor(tcur.getSessionID());
updateCursor.update(currentTime, tcur.getX(), tcur.getY(), tcur.getXSpeed(), tcur.getYSpeed(), tcur.getMotionAccel());
for (int i = 0; i < listenerList.Count; i++)
{
TuioListener listener = (TuioListener)listenerList[i];
if (listener != null)
{
listener.updateTuioCursor(updateCursor);
}
}
}
for (int i = 0; i < listenerList.Count; i++)
{
TuioListener listener = (TuioListener)listenerList[i];
if (listener != null)
{
listener.refresh(currentTime);
}
}
if (fseq > 0)
{
currentTime.reset();
}
}
frameCursors.Clear();
}
}
}
/**
* 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();
}
}
}