fork download

copy

/*
 *  JointHitDetector.cpp
 *  emptyExample
 *
 *  Created by Ryan Challinor on 5/17/11.
 *  Copyright 2011 aww bees. All rights reserved.
 *
 */
 
#include "JointHitDetector.h"
#include "ofxVec2f.h"
//#include "ActiveSkeleton.h"
//#include "UDPMessenger.h"
 
static float _hitAreaDisplayTime = .25f;
#define KEEPALIVE_TIME 3.1f
 
JointHitDetector::JointHitDetector(XnSkeletonJoint joint, XnSkeletonJoint refJoint, string name, float requiredLength)
   : mPointHistorySize(5)
   , mRequiredLength(requiredLength)
   , mMessageWorldJointPos(0)
   , mMessageBodyJointPos(0)
   , mMessageScreenJointPos(0)
   , mJoint(joint)
   , mRefJoint(refJoint)
   , mName(name)
{
   for (int i=0; i<kNumHitDirections; ++i)
      mHitAreaDisplay[i] = 0;
   //output
   TheMessenger->AddListener(this, mName+"_requiredlength");
   TheMessenger->AddListener(this, mName+"_pointhistorysize");
   TheMessenger->AddListener(this, mName+"_trackjointpos");
   TheMessenger->AddListener(this, mName+"_gettuninginfo");
 
   BroadcastTuningInfo();
}
 
JointHitDetector::~JointHitDetector()
{
   TheMessenger->RemoveListener(this);
}
 
void JointHitDetector::Poll(float dt)
{
   if (TheActiveSkeleton->IsTracked())
   {
      float confidence, refConfidence;
      ofxVec3f vJoint = TheActiveSkeleton->GetRealWorldPos(mJoint, confidence);
      ofxVec3f vRefJoint = TheActiveSkeleton->GetRealWorldPos(mRefJoint, refConfidence);
 
      ofxVec3f vRefToJoint = vJoint - vRefJoint;
      //use ref joint as anchor, unless vJoint and vRefJoint are the same
      if (vRefToJoint.lengthSquared() != 0)
         mPoints.push_back(vRefToJoint);
      else
         mPoints.push_back(vJoint);
      //limit to kPointHistorySize
      while (mPoints.size() > mPointHistorySize)
         mPoints.erase(mPoints.begin());      
 
      if (mMessageWorldJointPos > 0)
         TheMessenger->SendVectorMessage(mName+"_pos_world", vJoint);
      if (mMessageBodyJointPos > 0)
         TheMessenger->SendVectorMessage(mName+"_pos_body", vRefToJoint);
      if (mMessageScreenJointPos > 0)
      {
         ofxVec3f vScreen = TheActiveSkeleton->GetProjectivePos(mJoint);
         TheMessenger->SendVectorMessage(mName+"_pos_screen", vScreen);
      }
 
      mMessageWorldJointPos = MAX(0, mMessageWorldJointPos - dt);
      mMessageBodyJointPos = MAX(0, mMessageBodyJointPos - dt);
      mMessageScreenJointPos = MAX(0, mMessageScreenJointPos - dt);
 
      float refDist = vRefToJoint.length();
      if (refDist != 0)
         vRefToJoint /= refDist;
 
      for (int i=0; i<kNumHitDirections; ++i)
         mHitAreaDisplay[i] = MAX(0, mHitAreaDisplay[i] - dt);
 
      ofxVec3f vDir;
      const ofxVec3f vUp(0,1,0);
      const ofxVec3f vDown(0,-1,0);
      const ofxVec3f vLeft(-1,0,0);
      const ofxVec3f vRight(1,0,0);
      const ofxVec3f vBack(0,0,1);
      const ofxVec3f vForward(0,0,-1);
      if (DetectHit(vDir) && (refDist > 300 || !NeedDistFromRef()) && confidence > .3f)
      {
         vDir.normalize();
         if (MatchesDir(vUp, vDir, vRefToJoint))
         {
            TheMessenger->SendStringMessage(mName, "up");
            mHitAreaDisplay[kHitUp] = _hitAreaDisplayTime;
         }
         else if (MatchesDir(vDown, vDir, vRefToJoint))
         {
            TheMessenger->SendStringMessage(mName, "down");
            mHitAreaDisplay[kHitDown] = _hitAreaDisplayTime;
         }
         else if (MatchesDir(vRight, vDir, vRefToJoint))
         {
            TheMessenger->SendStringMessage(mName, "right");
            mHitAreaDisplay[kHitRight] = _hitAreaDisplayTime;
         }
         else if (MatchesDir(vForward, vDir, vRefToJoint))
         {
            TheMessenger->SendStringMessage(mName, "forward");
            mHitAreaDisplay[kHitForward] = _hitAreaDisplayTime;
         }
         else if (MatchesDir(vLeft, vDir, vRefToJoint))
         {
            TheMessenger->SendStringMessage(mName, "left");
            mHitAreaDisplay[kHitLeft] = _hitAreaDisplayTime;
         }
         else if (MatchesDir(vBack, vDir, vRefToJoint))
         {
            TheMessenger->SendStringMessage(mName, "back");
            mHitAreaDisplay[kHitBack] = _hitAreaDisplayTime;
         }
      }
   }
}
 
void JointHitDetector::SetJoint(XnSkeletonJoint joint)
{
   if (mJoint != joint)
   {
      mJoint = joint;
      mPoints.clear();
   }
}
 
void JointHitDetector::BroadcastTuningInfo()
{
   TheMessenger->SendFloatMessage(mName+"_requiredlength", mRequiredLength);
   TheMessenger->SendIntMessage(mName+"_pointhistorysize", mPointHistorySize);
}
 
bool JointHitDetector::MatchesDir(const ofxVec3f& vMatchDir, const ofxVec3f& vCheckDir, const ofxVec3f& vRefDir) const
{
   const float cos45 = 0.707106781f;
   return vMatchDir.dot(vCheckDir) > cos45 && (vMatchDir.dot(vRefDir) > .3f || !NeedDistFromRef());
}
 
bool JointHitDetector::DetectHit(ofxVec3f& vDir)
{
	int numTrackedPoints = mPoints.size();
	if (numTrackedPoints < 3)
		return false;
 
	ofxVec3f A = mPoints[1] - mPoints[0];
	ofxVec3f B = mPoints[2] - mPoints[1];
 
	for (int i=2; i<=numTrackedPoints; ++i)
	{
      //printf("*** i = %i\n", i);
      //printf("A = (%f,%f,%f)   B = (%f,%f,%f)\n", A.x, A.y, A.z, B.x, B.y, B.z);
		ofxVec3f C = mPoints[numTrackedPoints > i ? i : i-1] - mPoints[i-1];
      ofxVec3f normA = A.getNormalized();
      ofxVec3f normB = B.getNormalized();
 
      static float _shortEnough = 30.0f;
      if (LongEnough(A) && (normA.dot(normB) < .1f || B.length() < _shortEnough))
      {
         vDir = A;
         for (int j=0; j<i; ++j) //erase the A part, keep the B
            mPoints.erase(mPoints.begin());
         return true;
      }
		else if (normA.dot(normB) > .8f || (LongEnough(A) && normA.dot(normB) > .4f))
		{
			A = A+B; B = C;
		}
		else
		{
			A = B; B = C;
		}
	}
 
	return false;
}
 
bool JointHitDetector::LongEnough(const ofxVec3f& vec) const
{
   return vec.lengthSquared() > mRequiredLength * mRequiredLength;
}
 
void JointHitDetector::Draw() const
{
   for (int i=1; i<mPoints.size(); ++i)
   {
      glPushMatrix();
		glLineWidth(3);
		glColor3f(0,0,1);
		glBegin(GL_LINES);
      glVertex2f(320 + mPoints[i-1].x * .5f, 240 - mPoints[i-1].y * .5f);
      glVertex2f(320 + mPoints[i].x * .5f, 240 - mPoints[i].y * .5f);
		glEnd();
		glPopMatrix();
   }
 
   for (int i=0; i<kNumHitDirections; ++i)
      DrawHitDirection((HitDirection)i);
}
 
void JointHitDetector::DrawHitDirection(HitDirection hitDirection) const
{
   ofxVec2f vDisplayPoint;
 
   switch(hitDirection)
   {
      case kHitUp:
         vDisplayPoint.x = 0;
         vDisplayPoint.y = -20;
         break;
      case kHitRight:
         vDisplayPoint.x = 20;
         vDisplayPoint.y = 0;
         break;
      case kHitLeft:
         vDisplayPoint.x = -20;
         vDisplayPoint.y = 0;
         break;
      case kHitDown:
         vDisplayPoint.x = 0;
         vDisplayPoint.y = 20;
         break;
      case kHitForward:
         vDisplayPoint.x = 0;
         vDisplayPoint.y = -5;
         break;
      case kHitBack:
         vDisplayPoint.x = 0;
         vDisplayPoint.y = 5;
         break;
   }
 
   ofxVec3f vPos = TheActiveSkeleton->GetProjectivePos(mJoint);
 
   glPushMatrix();
   glLineWidth(10);
   glColor3f(0,mHitAreaDisplay[hitDirection]/_hitAreaDisplayTime,0);
   glBegin(GL_LINES);
   glVertex2f(vPos.x + vDisplayPoint.x - 10, vPos.y + vDisplayPoint.y);
   glVertex2f(vPos.x + vDisplayPoint.x + 10, vPos.y + vDisplayPoint.y);
   glEnd();
   glPopMatrix();
}
 
void JointHitDetector::OnMessage(const ofxOscMessage& msg)
{
   if (msg.getAddress() == mName+"_requiredlength")
   {
      assert(msg.getNumArgs() == 1);
      assert(msg.getArgType(0) == OFXOSC_TYPE_FLOAT);
      mRequiredLength = msg.getArgAsFloat(0);
   }
   if (msg.getAddress() == mName+"_pointhistorysize")
   {
      assert(msg.getNumArgs() == 1);
      assert(msg.getArgType(0) == OFXOSC_TYPE_INT32);
      mPointHistorySize = msg.getArgAsInt32(0);
   }
   if (msg.getAddress() == mName+"_trackjointpos")
   {
      assert(msg.getNumArgs() == 1);
      assert(msg.getArgType(0) == OFXOSC_TYPE_INT32);
      switch(msg.getArgAsInt32(0))
      {
         case 1:
            mMessageBodyJointPos = KEEPALIVE_TIME;
            break;
         case 2:
            mMessageWorldJointPos = KEEPALIVE_TIME;
            break;
         case 3:
            mMessageScreenJointPos = KEEPALIVE_TIME;
            break;
      }
   }
   if (msg.getAddress() == mName+"_gettuninginfo")
   {
      BroadcastTuningInfo();
   }
}
 

prog.cpp:10:30: error: JointHitDetector.h: No such file or directory
prog.cpp:11:22: error: ofxVec2f.h: No such file or directory
prog.cpp:18: error: ‘JointHitDetector’ has not been declared
prog.cpp:18: error: expected constructor, destructor, or type conversion before ‘(’ token
prog.cpp:39: error: expected constructor, destructor, or type conversion before ‘::’ token
prog.cpp:44: error: ‘JointHitDetector’ has not been declared
prog.cpp: In function ‘void Poll(float)’:
prog.cpp:46: error: ‘TheActiveSkeleton’ was not declared in this scope
prog.cpp:49: error: ‘ofxVec3f’ was not declared in this scope
prog.cpp:49: error: expected `;' before ‘vJoint’
prog.cpp:50: error: expected `;' before ‘vRefJoint’
prog.cpp:52: error: expected `;' before ‘vRefToJoint’
prog.cpp:54: error: ‘vRefToJoint’ was not declared in this scope
prog.cpp:55: error: ‘mPoints’ was not declared in this scope
prog.cpp:57: error: ‘mPoints’ was not declared in this scope
prog.cpp:57: error: ‘vJoint’ was not declared in this scope
prog.cpp:59: error: ‘mPoints’ was not declared in this scope
prog.cpp:59: error: ‘mPointHistorySize’ was not declared in this scope
prog.cpp:62: error: ‘mMessageWorldJointPos’ was not declared in this scope
prog.cpp:63: error: ‘TheMessenger’ was not declared in this scope
prog.cpp:63: error: ‘mName’ was not declared in this scope
prog.cpp:63: error: ‘vJoint’ was not declared in this scope
prog.cpp:64: error: ‘mMessageBodyJointPos’ was not declared in this scope
prog.cpp:65: error: ‘TheMessenger’ was not declared in this scope
prog.cpp:65: error: ‘mName’ was not declared in this scope
prog.cpp:65: error: ‘vRefToJoint’ was not declared in this scope
prog.cpp:66: error: ‘mMessageScreenJointPos’ was not declared in this scope
prog.cpp:68: error: expected `;' before ‘vScreen’
prog.cpp:69: error: ‘TheMessenger’ was not declared in this scope
prog.cpp:69: error: ‘mName’ was not declared in this scope
prog.cpp:69: error: ‘vScreen’ was not declared in this scope
prog.cpp:72: error: ‘mMessageWorldJointPos’ was not declared in this scope
prog.cpp:72: error: ‘MAX’ was not declared in this scope
prog.cpp:73: error: ‘mMessageBodyJointPos’ was not declared in this scope
prog.cpp:74: error: ‘mMessageScreenJointPos’ was not declared in this scope
prog.cpp:76: error: ‘vRefToJoint’ was not declared in this scope
prog.cpp:80: error: ‘kNumHitDirections’ was not declared in this scope
prog.cpp:81: error: ‘mHitAreaDisplay’ was not declared in this scope
prog.cpp:83: error: expected `;' before ‘vDir’
prog.cpp:84: error: ‘ofxVec3f’ does not name a type
prog.cpp:85: error: ‘ofxVec3f’ does not name a type
prog.cpp:86: error: ‘ofxVec3f’ does not name a type
prog.cpp:87: error: ‘ofxVec3f’ does not name a type
prog.cpp:88: error: ‘ofxVec3f’ does not name a type
prog.cpp:89: error: ‘ofxVec3f’ does not name a type
prog.cpp:90: error: ‘vDir’ was not declared in this scope
prog.cpp:90: error: ‘DetectHit’ was not declared in this scope
prog.cpp:90: error: ‘NeedDistFromRef’ was not declared in this scope
prog.cpp:93: error: ‘vUp’ was not declared in this scope
prog.cpp:93: error: ‘MatchesDir’ was not declared in this scope
prog.cpp:95: error: ‘TheMessenger’ was not declared in this scope
prog.cpp:95: error: ‘mName’ was not declared in this scope
prog.cpp:96: error: ‘mHitAreaDisplay’ was not declared in this scope
prog.cpp:96: error: ‘kHitUp’ was not declared in this scope
prog.cpp:98: error: ‘vDown’ was not declared in this scope
prog.cpp:100: error: ‘TheMessenger’ was not declared in this scope
prog.cpp:100: error: ‘mName’ was not declared in this scope
prog.cpp:101: error: ‘mHitAreaDisplay’ was not declared in this scope
prog.cpp:101: error: ‘kHitDown’ was not declared in this scope
prog.cpp:103: error: ‘vRight’ was not declared in this scope
prog.cpp:105: error: ‘TheMessenger’ was not declared in this scope
prog.cpp:105: error: ‘mName’ was not declared in this scope
prog.cpp:106: error: ‘mHitAreaDisplay’ was not declared in this scope
prog.cpp:106: error: ‘kHitRight’ was not declared in this scope
prog.cpp:108: error: ‘vForward’ was not declared in this scope
prog.cpp:110: error: ‘TheMessenger’ was not declared in this scope
prog.cpp:110: error: ‘mName’ was not declared in this scope
prog.cpp:111: error: ‘mHitAreaDisplay’ was not declared in this scope
prog.cpp:111: error: ‘kHitForward’ was not declared in this scope
prog.cpp:113: error: ‘vLeft’ was not declared in this scope
prog.cpp:115: error: ‘TheMessenger’ was not declared in this scope
prog.cpp:115: error: ‘mName’ was not declared in this scope
prog.cpp:116: error: ‘mHitAreaDisplay’ was not declared in this scope
prog.cpp:116: error: ‘kHitLeft’ was not declared in this scope
prog.cpp:118: error: ‘vBack’ was not declared in this scope
prog.cpp:120: error: ‘TheMessenger’ was not declared in this scope
prog.cpp:120: error: ‘mName’ was not declared in this scope
prog.cpp:121: error: ‘mHitAreaDisplay’ was not declared in this scope
prog.cpp:121: error: ‘kHitBack’ was not declared in this scope
prog.cpp:48: warning: unused variable ‘refConfidence’
prog.cpp: At global scope:
prog.cpp:127: error: ‘JointHitDetector’ has not been declared
prog.cpp:127: error: variable or field ‘SetJoint’ declared void
prog.cpp:127: error: ‘XnSkeletonJoint’ was not declared in this scope

Standard output is empty