view of/testApp.cpp @ 45:763d56955d10

taken tim's code inside the of patch

#include "testApp.h"

//--------------------------------------------------------------
void testApp::setup(){
	drawIt=false;
	// load the default ofxOpenNI config settings
	// see bin/data/openni/config/ofxopenni_config.xml
	context.setupUsingXMLFile();
	
	// uncomment this to see what open ni is doing inside
	//context.enableLogging(OF_LOG_VERBOSE);
	
	// setup resources
	depth.setup(&context);
	image.setup(&context);
	user.setup(&context, &depth);
//	Davy.loadImage("images/davy.jpg");
   ofEnableSmoothing();
   ofSetBackgroundAuto(false);
   ofBackground(238,238,224);
  // 	ofEnableAlphaBlending();
   ofSetLineWidth(12);


	for (int y = 0;y < NUMBER_OF_USERS;y++){
		typeOfFaceToUse[y] = y%2;
	}
	
	anubis.loadImage("images/anubis-wall-mask.gif");
	
	franklinBook.loadFont("frabk.ttf", 32);

	sender.setup( HOST, PORT );
	stopSender.setup( STOPHOST, STOPPORT );
	heresySender.setup(HERESY_HOST, HERESY_PORT);
	
	
	maxTorsoValues[0] = 0;
	maxTorsoValues[1] = 0;
	maxTorsoValues[2] = 0;
	double timeNow = ofGetElapsedTimeMillis();
	for (int user = 0;user < NUMBER_OF_USERS;user++)
	lastRecordedTime[user] = timeNow;
}

//--------------------------------------------------------------
void testApp::update(){
	
	// update the open ni context and user tracker
	context.update();
	user.update();

	
}


void testApp::getCoordinates(int userID){
	//tracked = user.getTrackedUser(i);
	ofxTrackedUser* tracked = user.getTrackedUser(userID);
	

	double timeNow = ofGetElapsedTimeMillis();

		
		
		
		if ((fabs(torso[userID][0] - tracked->left_upper_torso.end.x) + fabs(torso[userID][1] - tracked->left_upper_torso.end.y) > 0.1 && tracked->left_upper_torso.end.x > 0 )){
			//printf("tracking time %d and last recorded %d\n", timeNow, lastRecordedTime[userID]);
		userPresent[userID] = true;
		lastRecordedTime[userID] = timeNow ;

		torso[userID][0] = tracked->left_upper_torso.end.x;
		torso[userID][1] = tracked->left_upper_torso.end.y;
		torso[userID][2] = tracked->left_upper_torso.end.z;
			
		leftHandPosition[userID][0] = tracked->left_lower_arm.end.x;	
		leftHandPosition[userID][1] = tracked->left_lower_arm.end.y;	
		leftHandPosition[userID][2] = tracked->left_lower_arm.end.z;	

		rightHandPosition[userID][0] = tracked->right_lower_arm.end.x;	
		rightHandPosition[userID][1] = tracked->right_lower_arm.end.y;	
		rightHandPosition[userID][2] = tracked->right_lower_arm.end.z;		
			
		checkTorsoMaxima(userID);
		
		//recent track, low distance but do nothing yet
	}
	else if(userPresent[userID] && 	(timeNow - lastRecordedTime[userID]) > 500 ){
		//not recent track => stopped
		userPresent[userID] = false;
		printf("user %i has STOPPED!\n", userID);
		torso[userID][0] = tracked->left_upper_torso.end.x;
		torso[userID][1] = tracked->left_upper_torso.end.y;
		torso[userID][2] = tracked->left_upper_torso.end.z;
		
		sendStopMessageForUser(userID);

	}
	ofSetColor(0x00FF00);
	outputString = "HeadX : ";
	outputString += ofToString(torso[0][0]);
	franklinBook.drawString(outputString, 100,600);

}

void testApp::checkTorsoMaxima(int id){
	for (int h = 0; h < 3;h++){
	if (torso[id][h] > maxTorsoValues[h])
		maxTorsoValues[h] = torso[id][h];
	}
}

void testApp::sendDataViaOSC(int userID){

	ofxOscMessage m;
	m.setAddress( "/person" );
	m.addIntArg( userID );
	m.addFloatArg( torso[userID][0]/maxTorsoValues[0] );
	m.addFloatArg( torso[userID][1] /maxTorsoValues[1]);
	m.addFloatArg( torso[userID][2] /maxTorsoValues[2]);
	sender.sendMessage( m );

}

void testApp::sendStopMessageForUser(int userID){
	ofxOscMessage m;
	m.setAddress( "/stopperson" );
	m.addIntArg( userID );
	m.addFloatArg( torso[userID][0]/maxTorsoValues[0] );
	m.addFloatArg( torso[userID][1] /maxTorsoValues[1]);
	m.addFloatArg( torso[userID][2] /maxTorsoValues[2]);
	stopSender.sendMessage( m );
	
	
	ofxOscMessage newMess;
	newMess.setAddress( "/stopperson" );
	newMess.addIntArg( userID );
	sender.sendMessage( newMess );
}


void testApp::sendInformationToHeresy(int userID){
	
	//map to pitches interpolation
	double zVal = torso[userID][2] /maxTorsoValues[2];
	int pitch;
	if (zVal < 1)
		pitch = (int)(16 * zVal);
	else 
		pitch = 15;

	double leftHand, rightHand;
	leftHand = leftHandPosition[userID][2]/maxTorsoValues[2];//i.e. z position but 0 to 1
	rightHand = rightHandPosition[userID][2]/maxTorsoValues[2];//same for right
	
	
	if (userID == 0){
		//i.e. monophonic
		
	if (pitch != pitchPlaying[userID]){
		//then we have a change
		//send note off
		sendNoteMessageToHeresy(pitchPlaying[userID], 0, 0, userID);
		sendNoteMessageToHeresy(pitch, 1, 127, userID);// int channel){
		pitchPlaying[userID] = pitch;
		
	//the	send control change for the hands XXX TO DO
		
		}
	}
	else{
		//i.e. channel for user 2 and 3
			double minimum = min(leftHand, rightHand);
			double maximum = max(leftHand, rightHand);
			int minPitch = (int) (16 * minimum);
			int maxPitch = (int) (16 * maximum);
			minMaxValues[userID][0] = minPitch;
			minMaxValues[userID][1] = maxPitch;
			if (maxPitch > 15)
				maxPitch = 15;
		
			printf("user %i min %i max %i\n", userID, minPitch, maxPitch);
		for (int p = 0;p < 16;p++){
				
				if (p < minPitch || p > maxPitch){
					//sendNoteMessageToHeresy(p, 0, 0, userID);
					nowPlaying[userID][p] = false;
				}
				else{
					nowPlaying[userID][p] = true;
				}
				
				
				if (nowPlaying[userID][p] != lastPlaying[userID][p]){
					if (nowPlaying[userID][p])
					{
						sendNoteMessageToHeresy(p, 1, 127, userID);
						lastPlaying[userID][p] = true;
					}
					else {
						sendNoteMessageToHeresy(p, 0, 0, userID);
						lastPlaying[userID][p] = false;
					}
				}
			}//edn for
			
	}
			
			
	

			
	//x and y get sent to max after being mapped 0 to 127
	//these are control change messages
	//cvan be sent straight to max
	int xVal, yVal;
	xVal = (int)(127 * torso[userID][0]/maxTorsoValues[0] );
	yVal = (int)(127 * torso[userID][1]/maxTorsoValues[1] );
	
	

}

void testApp::sendNoteMessageToHeresy(int noteNumber, int onOrOff, int velocity, int channel){
	channel++;
	
	ofxOscMessage m;
	m.setAddress( "/test" );
	m.addStringArg("note");
	m.addIntArg( noteNumber );
	m.addIntArg( onOrOff );
	m.addIntArg( velocity );
	m.addIntArg( channel );
	heresySender.sendMessage( m );
	
	
}


//--------------------------------------------------------------
void testApp::draw(){
		ofBackground(238,238,224);
	
	// draw depth and rgb images
	//depth.draw();
if (drawIt != true)	{
image.draw();
user.draw();	
}
	// draw all the users automatically?

	
	
	
	stringstream info;
	info << "number of tracked users: " << user.getNumTrackedUsers() << endl;
	
	// draw the neck positions of each user
	for(int i = 0; i < user.getNumTrackedUsers(); ++i) {
		ofxTrackedUser* tracked = user.getTrackedUser(i);
		if(tracked != NULL) {

			
		
		//andrews code
			int userID = i;

			if (userID < 6){
			
				getCoordinates(userID);
				

				if (userPresent[userID]){
				sendDataViaOSC(userID);
				sendInformationToHeresy(userID);
				
				ofSetColor(0x000000);
				outputString = "Us ";
				outputString += ofToString(userID);
				outputString += "  ";	
				outputString += ofToString(userPresent[userID]);	
				outputString += "HeadX : ";
				outputString += ofToString(torso[userID][0], 2);
				outputString += "  HeadY : ";
				outputString += ofToString(torso[userID][1], 2);
				outputString += "  HeadZ : ";
				outputString += ofToString(torso[userID][2], 2);
				
				franklinBook.drawString(outputString, 100,600+userID*40);
				
				ofSetColor(0,0,255);
				ofCircle(tracked->neck.begin.x, tracked->neck.begin.y , 40);
	

					
				}
				
				ofSetColor(255,255,255);
				anubis.draw(tracked->neck.begin.x- anubis.width/2,tracked->neck.begin.y - anubis.height/2);
				
			}
			
			//end andrew

			info << i << " neck pos: "
				 << tracked->left_lower_arm.end.x << " " 
				 << tracked->left_lower_arm.end.y << " "
				 << tracked->neck.begin.z << endl; 

			
			if (tracked->neck.begin.x != 0)


			ofSetColor(139,0,0,100);
            
			ofNoFill();
			float w = ofGetWidth();
			float h = ofGetHeight();

			/*
			if (typeOfFaceToUse[userID] == 1)
			bezierFunctionStuff(userID);
			else 
			drawAcidSmiley(userID);
			 */
			}
	}

	
	//faint rectangle?
	ofFill();
	ofSetColor(238,238,224,20);
//	ofRect(0,0,ofGetWidth(),ofGetHeight()); blurring
	ofDrawBitmapString(info.str(), 10, 500);
		
}

//--------------------------------------------------------------
void testApp::keyPressed(int key){
	ofSetColor(238,238,224);
	ofRect(0,0,ofGetWidth(),ofGetHeight());
//	drawIt =!drawIt;
  ofToggleFullscreen();
	
	sendDataViaOSC(0);
}

//--------------------------------------------------------------
void testApp::keyReleased(int key){

}

//--------------------------------------------------------------
void testApp::mouseMoved(int x, int y ){

}

//--------------------------------------------------------------
void testApp::mouseDragged(int x, int y, int button){

}

//--------------------------------------------------------------
void testApp::mousePressed(int x, int y, int button){
	ofSetColor(238,238,224);
	ofFill();
	ofRect(0,0,ofGetWidth(),ofGetHeight());
	
	int pitch = (int) ofRandom(0, 15);
	sendNoteMessageToHeresy(pitch, 1, 127, 1);
}

//--------------------------------------------------------------
void testApp::mouseReleased(int x, int y, int button){

}

//--------------------------------------------------------------
void testApp::windowResized(int w, int h){

}


void testApp::bezierFunctionStuff(int i){

	ofxTrackedUser* tracked = user.getTrackedUser(i);
	float w = ofGetWidth();
	float h = ofGetHeight();
	
	ofFill();
	
	ofBezier(tracked->neck.begin.x,
			 tracked->neck.begin.y,
			 tracked->neck.end.x,
			 tracked->neck.end.y,
			 tracked->left_lower_arm.begin.x,
			 tracked->left_lower_arm.begin.y,
			 tracked->left_lower_arm.end.x,
			 /*tracked->left_lower_arm.end.y*/ w);
	
	ofBezier(tracked->neck.begin.x,
			 tracked->neck.begin.y,
			 tracked->neck.end.x,
			 tracked->neck.end.y,
			 tracked->right_lower_arm.begin.x,
			 tracked->right_lower_arm.begin.y,
			 tracked->right_lower_arm.end.x,
			 /*tracked->right_lower_arm.end.y*/ w);
	
	ofBezier(tracked->neck.begin.x,
			 tracked->neck.begin.y,
			 tracked->neck.end.x,
			 tracked->neck.end.y,
			 tracked->left_lower_leg.begin.x,
			 tracked->left_lower_leg.begin.y,
			 tracked->left_lower_leg.end.x,
			 /*tracked->left_lower_leg.end.y*/ h);
	
	ofBezier(tracked->neck.begin.x,
			 tracked->neck.begin.y,
			 tracked->neck.end.x,
			 tracked->neck.end.y,
			 tracked->right_lower_leg.begin.x,
			 tracked->right_lower_leg.begin.y,
			 tracked->right_lower_leg.end.x,
			 /*tracked->right_lower_leg.end.y*/ h);
	
	
	ofBezier(tracked->neck.begin.x,tracked->neck.begin.y,tracked->neck.end.x,tracked->neck.end.y,tracked->left_lower_arm.begin.x,tracked->left_lower_arm.begin.y,tracked->left_lower_arm.end.x,/*tracked->left_lower_arm.end.y*/ w);
	ofBezier(tracked->neck.begin.x,tracked->neck.begin.y,tracked->neck.end.x,tracked->neck.end.y,tracked->right_lower_arm.begin.x,tracked->right_lower_arm.begin.y,tracked->right_lower_arm.end.x,/*tracked->right_lower_arm.end.y*/ w);
	ofBezier(tracked->neck.begin.x,tracked->neck.begin.y,tracked->neck.end.x,tracked->neck.end.y,tracked->left_lower_leg.begin.x,tracked->left_lower_leg.begin.y,tracked->left_lower_leg.end.x,/*tracked->left_lower_leg.end.y*/ h);
	ofBezier(tracked->neck.begin.x,tracked->neck.begin.y,tracked->neck.end.x,tracked->neck.end.y,tracked->right_lower_leg.begin.x,tracked->right_lower_leg.begin.y,tracked->right_lower_leg.end.x,/*tracked->right_lower_leg.end.y*/ h);
	
	
}

void testApp::drawAcidSmiley(int i){
	//acid smiley
	
	ofxTrackedUser* tracked = user.getTrackedUser(i);
	float w = ofGetWidth();
	float h = ofGetHeight();
	
	
	ofFill();
	
	ofSetColor(255,255,100);
	ofCircle(tracked->neck.begin.x,tracked->neck.begin.y,30);
	ofSetColor(0);
	ofCircle(tracked->neck.begin.x,tracked->neck.begin.y,35);
	ofSetColor(255,255,100);
	ofCircle(tracked->neck.begin.x,tracked->neck.begin.y,30);
	ofSetColor(0);
	ofCircle(tracked->neck.begin.x+10.0f,tracked->neck.begin.y,6);
	ofCircle(tracked->neck.begin.x-10.0f,tracked->neck.begin.y,6);
	
	
	
}