Exemplo n.º 1
0
void form::setIndex(msa::physics::Particle3D *_p, ofPolyline &_master, ofPolyline &_slave, int _ind) {
    unsigned int mind = 0;
    unsigned int sind = 0;
    ofPoint mcpt = _master.getClosestPoint(_p->getPosition(), &mind);
    ofPoint scpt = _slave.getClosestPoint(_p->getPosition(), &sind);
    float mdist = mcpt.distance(_p->getPosition());
    float sdist = scpt.distance(_p->getPosition());
    
    //if (mdist < sdist) {
    if (mdist < mTol) {
        mMasterEdgeParticles.push_back(new part_and_index(_p,mind, _ind));
    }
    //} else {
    if (sdist < mTol) {
        mSlaveEdgeParticles.push_back(new part_and_index(_p,sind, _ind));
    }
    //}
    
}
//============================================================
void HandMeshBuilder::buildMesh (ofPolyline &handContour, ofVec3f &handCentroid, Handmark *hmarks){
	
	// Check to make sure the contour contains data
	int nContourPoints = handContour.size();
	if (nContourPoints > 0){
		
		// Check to make sure all indices are legal
		bool bAllHandmarkIndicesValid = true;
		for (int i=0; i<N_HANDMARKS; i++){
			Handmarks[i] = hmarks[i];
			if ((Handmarks[i].index < 0) || (Handmarks[i].index >= nContourPoints)){
				bAllHandmarkIndicesValid = false;
				printf ("problem with handmark %d: %d\n", i, Handmarks[i].index);
			}
		}
		if (bAllHandmarkIndicesValid){
			
			handMesh.clear();
			handMesh.setupIndicesAuto();
			handMesh.setMode( OF_PRIMITIVE_TRIANGLES );
			
			// Add triangles for each finger to handMesh:
			for (int f=0; f<5; f++){
				
				int f0 = (fingerTipIndices[f] - 1 + N_HANDMARKS) % N_HANDMARKS;
				int f1 = (fingerTipIndices[f]     + N_HANDMARKS) % N_HANDMARKS;
				int f2 = (fingerTipIndices[f] + 1 + N_HANDMARKS) % N_HANDMARKS;
				
				int contourIndex0 = Handmarks[f0].index;
				int contourIndex1 = Handmarks[f1].index;
				int contourIndex2 = Handmarks[f2].index;
				
				// Collect the first side of the finger, from contourIndex0 up to contourIndex1
				ofPolyline poly01;
				poly01.clear();
				int contourIndex1a = contourIndex1;
				if (contourIndex1a < contourIndex0) {
					contourIndex1a += nContourPoints;
				}
				for (int i=contourIndex0; i<=contourIndex1a; i++){
					int indexSafe = (i+nContourPoints)%nContourPoints;
					ofVec3f pointi = handContour[indexSafe];
					poly01.addVertex(pointi.x, pointi.y, pointi.z);
				}
				// Collect the reverse side of the finger, from contourIndex2 down to contourIndex1
				ofPolyline poly21;
				poly21.clear();
				int contourIndex1b = contourIndex1;
				if (contourIndex1b > contourIndex2) {
					contourIndex2 += nContourPoints;
				}
				for (int i=contourIndex2; i>=contourIndex1b; i--){
					int indexSafe = (i+nContourPoints)%nContourPoints;
					ofVec3f pointi = handContour[indexSafe];
					poly21.addVertex(pointi.x, pointi.y, pointi.z);
				}
				
				
				//-----------------------
				// Resample the finger's two sides.
				// Note: ofxPolyline.getResampledByCount() does not return a consistent number of points. Do it my damn self.
				
				ofPolyline poly01RS;
				poly01RS.clear();
				int poly01size = poly01.size();
				for (int i=0; i<=N_FINGER_LENGTH_SAMPLES; i++){
					// int poly01index = (int)ofMap((float)i,0,N_FINGER_LENGTH_SAMPLES, 0,poly01size-1);
					float indexf = ofMap((float)i,0,N_FINGER_LENGTH_SAMPLES, 0,poly01size-1);
					int poly01index = (int)((i==N_FINGER_LENGTH_SAMPLES) ? floorf(indexf) : roundf(indexf));
					ofVec3f pointi = poly01[poly01index];
					poly01RS.addVertex(pointi.x, pointi.y, pointi.z);
				}
				ofPolyline poly21RS;
				poly21RS.clear();
				int poly21size = poly21.size();
				for (int i=0; i<=N_FINGER_LENGTH_SAMPLES; i++){
					float indexf = ofMap((float)i,0,N_FINGER_LENGTH_SAMPLES, 0,poly21size-1);
					int poly21index = (int)((i==N_FINGER_LENGTH_SAMPLES) ? floorf(indexf) : roundf(indexf));
					ofVec3f pointi = poly21[poly21index];
					poly21RS.addVertex(pointi.x, pointi.y, pointi.z);
				}
				
				//-----------------------
				// Render the two finger sides.
				bool bRenderFingerEdgePolylines = true;
				if (bRenderFingerEdgePolylines){
					ofNoFill();
					ofSetColor(0,200,100);
					poly01RS.draw();
					ofSetColor(200,100,0);
					poly21RS.draw();
				}
				
				bool bDrawContourTexPoints = false;
				if (bDrawContourTexPoints){
					ofSetColor(0,200,250);
					vector<ofPoint> poly01RSpts = poly01RS.getVertices();
					int nPoly01RSpts = poly01RSpts.size();
					for (int i=0; i<nPoly01RSpts; i++){
						float ex = poly01RSpts[i].x;
						float ey = poly01RSpts[i].y;
						ofEllipse (ex, ey, 6, 6);
					}
					ofSetColor(250,200,0);
					vector<ofPoint> poly21RSpts = poly21RS.getVertices();
					int nPoly21RSpts = poly21RSpts.size();
					for (int i=0; i<nPoly21RSpts; i++){
						float ex = poly21RSpts[i].x;
						float ey = poly21RSpts[i].y;
						ofEllipse (ex, ey, 9, 9);
					}
				}
				
				//---------------
				// ADD VERTICES TO THE MESH.
				vector<ofPoint> poly01RSpts = poly01RS.getVertices();
				vector<ofPoint> poly21RSpts = poly21RS.getVertices();
				int nPoly01RSpts = poly01RSpts.size();
				int nPoly21RSpts = poly21RSpts.size();

				
				if ((nPoly01RSpts == nPoly21RSpts) &&
					(nPoly01RSpts == (N_FINGER_LENGTH_SAMPLES+1))){
					
					for (int i=0; i<=N_FINGER_LENGTH_SAMPLES; i++){
						float px01 = poly01RSpts[i].x;
						float py01 = poly01RSpts[i].y;
						float px21 = poly21RSpts[i].x;
						float py21 = poly21RSpts[i].y;
						
						if (i == N_FINGER_LENGTH_SAMPLES){
							// Special case for the tip.
							// N.B., px01 and px21 are the same point
							
							float qx01 = (poly01RSpts[N_FINGER_LENGTH_SAMPLES-1].x + px01)/2.0;
							float qy01 = (poly01RSpts[N_FINGER_LENGTH_SAMPLES-1].y + py01)/2.0;
							ofPoint q01 = ofPoint(qx01, qy01);
							
							float qx21 = (poly21RSpts[N_FINGER_LENGTH_SAMPLES-1].x + px21)/2.0;
							float qy21 = (poly21RSpts[N_FINGER_LENGTH_SAMPLES-1].y + py21)/2.0;
							ofPoint q21 = ofPoint(qx21, qy21);
							
							ofPoint QA = handContour.getClosestPoint(q01);
							ofPoint QB = handContour.getClosestPoint(q21);
							
							ofEllipse(QA.x, QA.y,  2, 2);
							ofEllipse(px01, py01,  2, 2);
							ofEllipse(QB.x, QB.y,  2, 2);
							
							handMesh.addVertex(ofPoint(QA.x, QA.y,0));
							handMesh.addVertex(ofPoint(px01, py01,0));
							handMesh.addVertex(ofPoint(QB.x, QB.y,0));
							
							
						} else {
							// The usual case, up the sides of the finger.
							if (f < 2){
								for (int j=0; j<N_FINGER_WIDTH_SAMPLES; j++){
									float ex = ofMap(j, 0,N_FINGER_WIDTH_SAMPLES-1, px01,px21);
									float ey = ofMap(j, 0,N_FINGER_WIDTH_SAMPLES-1, py01,py21);
									ofEllipse(ex,ey, 2, 2);
									handMesh.addVertex(ofPoint(ex,ey,0));
								}
							} else {
								// skip the 0th point for fingers 2,3,4,
								// because these are shared vertices with points we've already laid.
								for (int j=0; j<N_FINGER_WIDTH_SAMPLES; j++){
									float ex = ofMap(j, 0,N_FINGER_WIDTH_SAMPLES-1, px01,px21);
									float ey = ofMap(j, 0,N_FINGER_WIDTH_SAMPLES-1, py01,py21);
									ofEllipse(ex,ey, 2, 2);
									if ((j==0) && (i==0)){
										;
									} else {
										handMesh.addVertex(ofPoint(ex,ey,0));
									}
								}
								
							}
						}
					}
					
					//---------------
					// ADD TRIANGLES TO THE MESH.
					// add the triangles on the interior of the finger.
					int vertexIndex = f * (N_FINGER_WIDTH_SAMPLES * N_FINGER_LENGTH_SAMPLES + 3);
					int NW = N_FINGER_WIDTH_SAMPLES;
					
					if (f >= 2){
						// Because we skip the 0th point for fingers 2,3,4
						// (Because the start point for a finger is coincident with the end point
						// for the previous finger)...
						vertexIndex -= (f-1);
						
						for (int i=0; i<(N_FINGER_LENGTH_SAMPLES-1); i++){
							int row = vertexIndex + i*N_FINGER_WIDTH_SAMPLES;
							for (int j=0; j<(N_FINGER_WIDTH_SAMPLES-1); j++){
								
								if ((i==0) && (j==0)){
									int screwCase = row - (11*5 + 3 - 5);
									handMesh.addTriangle(screwCase, row+j+1,  row+j+NW);
									handMesh.addTriangle(row+j+1, row+j+1+NW, row+j+NW);
								} else {
									handMesh.addTriangle(row+j  , row+j+1,    row+j+NW);
									handMesh.addTriangle(row+j+1, row+j+1+NW, row+j+NW);
								}
							}
						}
						// add triangles at fingertip.
						int row = vertexIndex + (N_FINGER_LENGTH_SAMPLES-1)*N_FINGER_WIDTH_SAMPLES;
						handMesh.addTriangle(row+0, row+1, row+NW);
						handMesh.addTriangle(row+1, row+2, row+NW);
						handMesh.addTriangle(row+2, row+6, row+NW);
						handMesh.addTriangle(row+2, row+7, row+1+NW);
						handMesh.addTriangle(row+2, row+3, row+2+NW);
						handMesh.addTriangle(row+3, row+4, row+2+NW);
						
						
					} else {
						// The simple cases, thumb and pinky.
						for (int i=0; i<(N_FINGER_LENGTH_SAMPLES-1); i++){
							int row = vertexIndex + i*N_FINGER_WIDTH_SAMPLES;
							for (int j=0; j<(N_FINGER_WIDTH_SAMPLES-1); j++){
								handMesh.addTriangle(row+j  , row+j+1,    row+j+NW);
								handMesh.addTriangle(row+j+1, row+j+1+NW, row+j+NW);
							}
						}
						// add triangles at fingertip.
						int row = vertexIndex + (N_FINGER_LENGTH_SAMPLES-1)*N_FINGER_WIDTH_SAMPLES;
						handMesh.addTriangle(row+0, row+1, row+NW);
						handMesh.addTriangle(row+1, row+2, row+NW);
						handMesh.addTriangle(row+2, row+6, row+NW);
						handMesh.addTriangle(row+2, row+7, row+1+NW);
						handMesh.addTriangle(row+2, row+3, row+2+NW);
						handMesh.addTriangle(row+3, row+4, row+2+NW);
					}
				}
			}
			
			//----------------------------------------------------
			// Add vertices for the knuckles.
			// TRIAGE: START USING SPECIFIC INDICES (rather than computed indices) to build the rest of the mesh.
			// 60 = N_FINGER_LENGTH_SAMPLES*N_FINGER_WIDTH_SAMPLES + 3, then +2 more into the finger, etc.
			//
			int fingerBaseMiddleIndices[] = {60, 117, 174, 231};
			for (int i=0; i<4; i++){
				int fingerBaseMiddle0 = fingerBaseMiddleIndices[i];
				int fingerBaseMiddle1 = fingerBaseMiddle0 + N_FINGER_WIDTH_SAMPLES;
				ofVec3f P0 = handMesh.getVertex(fingerBaseMiddle0);
				ofVec3f P1 = handMesh.getVertex(fingerBaseMiddle1);
				ofVec3f Pk = P0 - 1.25*(P1 - P0);
				
				// move it slightly toward the hand centroid
				ofVec3f Pc = ofVec3f(handCentroid.x, handCentroid.y, 0);
				float amountToMoveKnucklesTowardCentroid = 0.25;
				Pk = Pk - amountToMoveKnucklesTowardCentroid*(Pk - Pc);
				ofEllipse(Pk.x,Pk.y, 2, 2);
				handMesh.addVertex(Pk);
				
				int nv = handMesh.getNumVertices();
				for (int j=0; j<4; j++){
					if (i==0){
						int fi0 = fingerBaseMiddle0 + j - 2;
						int fi1 = fingerBaseMiddle0 + j - 1;
						handMesh.addTriangle(nv-1, fi1, fi0);
					} else {
						int fi0 = fingerBaseMiddle0 + j - 2;
						if (j == 0) { fi0 = fingerBaseMiddleIndices[i-1] + 2; }
						int fi1 = fingerBaseMiddle0 + j - 1;
						handMesh.addTriangle(nv-1, fi1, fi0);
					}
				}
			}
			
			//----------------------------------------------------
			// Add vertices for the wrist.
			
			int wristIndex0 = Handmarks[HANDMARK_THUMB_BASE      ].index;
			int wristIndex1 = Handmarks[HANDMARK_THUMBSIDE_WRIST ].index;
			int wristIndex2 = Handmarks[HANDMARK_PINKYSIDE_WRIST ].index;
			int wristIndex3 = Handmarks[HANDMARK_PALM_BASE       ].index;
			
			ofVec2f wristP0 = handContour[wristIndex0];
			ofVec2f wristP1 = handContour[wristIndex1];
			ofVec2f wristP2 = handContour[wristIndex2];
			ofVec2f wristP3 = handContour[wristIndex3];
			
			vector<ofPoint> wSide01;
			vector<ofPoint> wSide32;
			vector<ofPoint> wSide12;
			
			for (int i=0; i<=4; i++){
				ofVec2f whcn = ((4.0 - (float)i)*wristP0 + ((float)i)*wristP1)/4.0;
				ofPoint wristP_hcn = handContour.getClosestPoint(whcn);
				wSide01.push_back (wristP_hcn);
			}
			for (int i=0; i<=4; i++){
				ofVec2f whcn = ((4.0 - (float)i)*wristP3 + ((float)i)*wristP2)/4.0;
				ofPoint wristP_hcn = handContour.getClosestPoint(whcn);
				wSide32.push_back (wristP_hcn);
			}
			for (int i=0; i<=4; i++){
				ofVec2f whcn = ((4.0 - (float)i)*wristP1 + ((float)i)*wristP2)/4.0;
				ofPoint wristP_hcn = handContour.getClosestPoint(whcn);
				wSide12.push_back (wristP_hcn);
			}
			
			int nvBeforeWrist = handMesh.getNumVertices();
			for (int wy=0; wy<=4; wy++){
				ofVec2f pL = wSide01[wy];
				ofVec2f pR = wSide32[wy];
				if (wy < 4){
					for (int wx=4; wx>=0; wx--){
						ofVec2f wp = ((4.0 - (float)wx)*pL + ((float)wx)*pR)/4.0;
						ofEllipse(wp.x,wp.y, 2, 2);
						handMesh.addVertex(ofPoint(wp.x,wp.y,0));
					}
				} else {
					for (int wx=4; wx>=0; wx--){
						ofVec2f wp = wSide12[wx];
						ofEllipse(wp.x,wp.y, 2, 2);
						handMesh.addVertex(ofPoint(wp.x,wp.y,0));
					}
				}
			}
			
			int nvb = nvBeforeWrist;
			for (int wy=0; wy<4; wy++){
				for (int wx=0; wx<4; wx++){
					handMesh.addTriangle(nvb+wx,   nvb+wx+5, nvb+wx+1);
					handMesh.addTriangle(nvb+wx+1, nvb+wx+5, nvb+wx+6);
				}
				nvb += 5;
			}
			
			
			//----------------------------------------------------
			// Add vertices for the thumb base.
			
			// 0,1,2,3,4, 295
			
			// Get interpolated values on the outside contour:
			int thumbBaseIndex0 = Handmarks[HANDMARK_THUMB_KNUCKLE ].index;
			int thumbBaseIndex1 = Handmarks[HANDMARK_THUMB_BASE    ].index;
			
			ofVec2f thumbBaseHcn0 = handContour[thumbBaseIndex0];
			ofVec2f thumbBaseHcn1 = handContour[thumbBaseIndex1];
			
			// create a polyline copy of the handContourNice sub-section between the 2 indices
			ofPolyline thumbCurve;
			if (thumbBaseIndex0 < thumbBaseIndex1){
				for (int i=thumbBaseIndex0; i<=thumbBaseIndex1; i++){
					ofPoint tpoint = handContour[i];
					thumbCurve.addVertex(tpoint);
				}
			} else {
				// don't want to deal with an unlikely situation
				thumbCurve = handContour;
			}
			
			vector<ofPoint> thumbBaseSide;
			for (int i=0; i<=4; i++){
				ofVec2f hcn = ((4.0 - (float)i)*thumbBaseHcn0 + ((float)i)*thumbBaseHcn1)/4.0;
				ofPoint Phcn = thumbCurve.getClosestPoint(hcn);
				thumbBaseSide.push_back (Phcn);
				//ofEllipse(Phcn.x,Phcn.y, 10, 10);
				// n.b., we will not use points i=0 & i=4 because they are already stored as handMesh vertices 4 & 295
			}
			
			vector<ofPoint> thumbBaseHypotenuse;
			ofVec2f thumbBaseP0 = ofVec2f(handMesh.getVertex(0).x, handMesh.getVertex(0).y);
			for (int i=0; i<=4; i++){
				ofVec2f hcn = ((4.0 - (float)i)*thumbBaseP0 + ((float)i)*thumbBaseHcn1)/4.0;
				thumbBaseHypotenuse.push_back (hcn);
				//ofEllipse(hcn.x,hcn.y, 10, 10);
				// n.b., we will not use points i=0 & i=4 because they are already stored as handMesh vertices 0 & 295
			}
			int nvBeforeThumbBase = handMesh.getNumVertices();
			for (int y=1; y<4; y++){ // skipping y=0 and y=4 because those vertices already exist in handMesh.
				int topx = 4-y;
				for (int x=0; x<=topx; x++){
					ofPoint T0 = thumbBaseHypotenuse[y];
					ofPoint T1 = thumbBaseSide[y];
					ofPoint Tinterp = ((topx-x)*T0 + (x)*T1) / (float)topx;
					handMesh.addVertex(ofPoint(Tinterp.x,Tinterp.y,0));
					ofEllipse(Tinterp.x,Tinterp.y, 2, 2);
				}
			}
			
			// clockwise triangles
			int ti = nvBeforeThumbBase;
			for (int y=0; y<1; y++){ // y == 0 case
				int topx = 4-y;
				for (int x=0; x<topx; x++){
					if (x == 0){
						handMesh.addTriangle(x, ti+x, x+1);
					} else {
						handMesh.addTriangle(x, ti+(x-1), ti+x);
						handMesh.addTriangle(x, ti+x, x+1);
					}
				}
			}
			
			int thumbBaseVertexIndex = 295;
			for (int y=1; y<4; y++){
				int topx = 4-y;
				for (int x=0; x<topx; x++){
					if (x == 0){
						int tj = ti+x+topx+1;
						if (y == 3){ tj = thumbBaseVertexIndex; }
						handMesh.addTriangle(ti+x,   tj, ti+x+1);
					} else {
						handMesh.addTriangle(ti+x,   ti+x+topx+1,     ti+x+1);
						handMesh.addTriangle(ti+x,   ti+x+topx  ,     ti+x+topx+1 );
					}	
				}
				ti += topx+1;
			}
			
			//----------------------------------------------------
			// Add vertices for the thumb webbing.
			
			// Get interpolated values on the outside contour:
			int thumbWebIndex0 = Handmarks[HANDMARK_POINTER_SIDE ].index;
			int thumbWebIndex1 = Handmarks[HANDMARK_IT_CROTCH    ].index;
			
			ofVec2f thumbWebHcn0 = handContour[thumbWebIndex0];
			ofVec2f thumbWebHcn1 = handContour[thumbWebIndex1];
			
			// create a polyline copy of the handContourNice sub-section between the 2 indices
			ofPolyline thumbWebCurve;
			if (thumbWebIndex0 < thumbWebIndex1){
				for (int i=thumbWebIndex0; i<=thumbWebIndex1; i++){
					ofPoint tpoint = handContour[i];
					thumbWebCurve.addVertex(tpoint);
				}
			} else {
				// don't want to deal with an unlikely situation
				thumbWebCurve = handContour;
			}
			
			// vector of interpolated points along top edge
			vector<ofPoint> thumbWebSide1;
			for (int i=0; i<=4; i++){
				ofVec2f hcn = ((4.0 - (float)i)*thumbWebHcn0 + ((float)i)*thumbWebHcn1)/4.0;
				ofPoint Phcn = thumbWebCurve.getClosestPoint(hcn);
				thumbWebSide1.push_back (Phcn);
				// ofEllipse(Phcn.x,Phcn.y, 10, 10);
				// n.b., we will not use points i=0 & i=4, becasue they are handMesh vertices 0 and 233
			}
			
			vector<ofPoint> thumbWebHypotenuse;
			ofVec2f thumbWebP0 = ofVec2f(handMesh.getVertex(233).x, handMesh.getVertex(233).y);
			ofVec2f thumbWebP1 = ofVec2f(handMesh.getVertex(thumbBaseVertexIndex).x, handMesh.getVertex(thumbBaseVertexIndex).y);
			int nWebHypSamps = 8;
			for (int i=0; i<=nWebHypSamps; i++){
				ofVec2f hcn = ((nWebHypSamps - (float)i)*thumbWebP0 + ((float)i)*thumbWebP1)/(float)nWebHypSamps;
				thumbWebHypotenuse.push_back (hcn);
				// ofEllipse(hcn.x,hcn.y, 10, 10);
				// n.b., we will not use points i=0 & i=4 because they are already stored as handMesh vertices 233 & 295
			}
			
			int nvBeforeThumbWeb = handMesh.getNumVertices();
			for (int y=1; y<4; y++){ // skipping y=0 and y=4 because those vertices already exist in handMesh.
				int topx = 4-y;
				for (int x=0; x<=topx; x++){
					ofPoint T0 = thumbWebHypotenuse[8-(y*2)];
					ofPoint T1 = thumbWebSide1[4-y];
					ofPoint Tinterp = ((topx-x)*T0 + (x)*T1) / (float)topx;
					handMesh.addVertex(ofPoint(Tinterp.x,Tinterp.y,0));
					ofEllipse(Tinterp.x,Tinterp.y, 2, 2);
				}
			}
			for (int i=7; i>=1; i-=2){
				handMesh.addVertex( thumbWebHypotenuse[i] );
				ofEllipse(thumbWebHypotenuse[i].x,thumbWebHypotenuse[i].y, 2, 2);
			}
			
			
			int thumbWebSideIndices[] = {0, 316, 320, 323, 295};
			
			int wi = nvBeforeThumbWeb;
			// handMesh.addTriangle(thumbWebSideIndices[4-0], thumbWebSideIndices[4-1], wi+0); // replace with 2 triangles
			handMesh.addTriangle(thumbWebSideIndices[4-0],    thumbWebSideIndices[4-1], wi+9);
			handMesh.addTriangle(thumbWebSideIndices[4-1],    wi+0, wi+9);
			handMesh.addTriangle(thumbWebSideIndices[4-1], thumbWebSideIndices[4-2], wi+0);
			handMesh.addTriangle(thumbWebSideIndices[4-2], wi+1, wi+0);
			handMesh.addTriangle(thumbWebSideIndices[4-2], thumbWebSideIndices[4-3], wi+1);
			handMesh.addTriangle(thumbWebSideIndices[4-3], wi+2, wi+1);
			handMesh.addTriangle(thumbWebSideIndices[4-3], thumbWebSideIndices[4-4], wi+2);
			handMesh.addTriangle(thumbWebSideIndices[4-4], wi+3, wi+2);
			
			// handMesh.addTriangle(wi+0, wi+1, wi+4); // replace with 2 triangles, as follows:
			handMesh.addTriangle(wi+0, wi+1, wi+10);
			handMesh.addTriangle(wi+1, wi+4, wi+10);
			handMesh.addTriangle(wi+1, wi+2, wi+4);
			handMesh.addTriangle(wi+2, wi+5, wi+4);
			handMesh.addTriangle(wi+2, wi+3, wi+5);
			handMesh.addTriangle(wi+3, wi+6, wi+5);
			
			// handMesh.addTriangle(wi+4, wi+5, wi+7); // replace with 2 triangles, as follows:
			handMesh.addTriangle(wi+4, wi+5, wi+11);
			handMesh.addTriangle(wi+5, wi+7, wi+11);
			handMesh.addTriangle(wi+5, wi+6, wi+7);
			handMesh.addTriangle(wi+6, wi+8, wi+7);
			
			// handMesh.addTriangle(wi+7, wi+8, 233 ); // replace with 2 triangles, as follows:
			handMesh.addTriangle(wi+7, wi+8, wi+12 );
			handMesh.addTriangle(wi+8, 233,  wi+12 );
			
			//----------------------------------------------------
			// Mesh the palm.
			
			// Get interpolated values on the outside contour:
			int palmContourIndex0 = Handmarks[HANDMARK_PALM_BASE     ].index;
			int palmContourIndex1 = Handmarks[HANDMARK_PINKY_SIDE    ].index;
			
			ofPolyline palmSideContour;
			ofPolyline palmSideContourResampled;
			bool bGotPalmSideContour = true;
			if (palmContourIndex0 < palmContourIndex1){
				for (int i=palmContourIndex0; i<=palmContourIndex1; i++){
					ofPoint cpt = handContour[i];
					palmSideContour.addVertex( cpt );
				}
				
				int nDesiredResampledPoints = 9;
				palmSideContourResampled.clear();
				int palmSideContourSize = palmSideContour.size();
				int nDesiredSamples = nDesiredResampledPoints-1;
				for (int i=0; i<nDesiredSamples; i++){
					float indexf = ofMap((float)i,0,nDesiredSamples-1, 0,palmSideContourSize-1);
					int outindex = (int)((i==(nDesiredSamples-1)) ? floorf(indexf) : roundf(indexf));
					ofVec3f pointi = palmSideContour[outindex];
					palmSideContourResampled.addVertex(pointi.x, pointi.y, pointi.z);
				}
				ofPoint cpt = handContour[palmContourIndex1];
				palmSideContourResampled.addVertex( cpt.x, cpt.y );
				
				
			} else {
				// hopefully this is really unlikely.
				// but, it happens for all left hands facing down, or right hands facing up :)
				bGotPalmSideContour = false;
				printf("Problem meshing palm side.\n");
			}
			
			if (bGotPalmSideContour){
				
				int nPalmSideResampledContourPoints = palmSideContourResampled.size();
				for (int i=1; i<(nPalmSideResampledContourPoints-1); i++){
					ofPoint cpt = palmSideContourResampled[i];
					handMesh.addVertex (cpt);
					ofEllipse(cpt.x, cpt.y, 2,2);
				}
				
				handMesh.addTriangle (344, 287, 58);
				handMesh.addTriangle (287, 288, 62);
				handMesh.addTriangle (288, 289, 119);
				handMesh.addTriangle (289, 290, 176);
				handMesh.addTriangle (290, 337, 233);
				
				int wristPointMeshIndex = 293;
				int wristPointMeshIndices[]    = {292, 293,293,293,293, 294};
				int knuckleMeshIndices[]       = {344, 287,288,289,290, 337, 337};
				int thumbSidePalmMeshIndices[] = {295, 334, 325, 335, 329, 336, 332, 337, 233};
				
				for (int k=0; k<6; k++){
					float wx = handMesh.getVertex(wristPointMeshIndices[k]).x;
					float wy = handMesh.getVertex(wristPointMeshIndices[k]).y;
					float kx = handMesh.getVertex(knuckleMeshIndices[k]).x;
					float ky = handMesh.getVertex(knuckleMeshIndices[k]).y;
					for (int i=1; i<7; i++){
						float frac = (float)i/7.0;
						float px = (1-frac)*wx + frac*kx;
						float py = (1-frac)*wy + frac*ky;
						handMesh.addVertex( ofVec3f (px,py, 0));
						ofEllipse(px, py, 2,2);
					}
				}
				
				int starti = 338;
				for (int j=0; j<=6; j++){
					
					int dn = 6;
					if (j==0){
						dn = 7;
					}
					
					if (j == 6){
						
						for (int i=0; i<=5; i++){
							int a = starti + i;
							int b = thumbSidePalmMeshIndices[i+1];
							int c = starti + i + 1;
							int d = thumbSidePalmMeshIndices[i+2];
							
							if (i==5){
								c = 337;
								handMesh.addTriangle (a, b, c);
							} else {
								handMesh.addTriangle (a, b, c);
								handMesh.addTriangle (c, b, d);
							}
						}
						
					} else {
						if ((j>=1) && (j < 5)){
							int a = starti;
							int b = wristPointMeshIndex;
							int c = starti + dn;
							handMesh.addTriangle (a, b, c);
						}
						
						for (int i=0; i<=5; i++){
							int a = starti + i;
							int b = starti + i + dn;
							int c = starti + i + 1;
							int d = starti + i + dn+1;
							
							if (i==5){
								if (j > 0){
									c = knuckleMeshIndices[j-1];
									d = knuckleMeshIndices[j  ];
									handMesh.addTriangle (a, b, c);
									handMesh.addTriangle (c, b, d);
								}
							} else {
								handMesh.addTriangle (a, b, c);
								handMesh.addTriangle (c, b, d);
							}
						}
					}
					
					starti += dn;
				}
				
				
				handMesh.addTriangle (344, 343, 350);
				handMesh.addTriangle (291, 292, 338);
				handMesh.addTriangle (292, 345, 338);
				handMesh.addTriangle (292, 293, 345);
				handMesh.addTriangle (293, 294, 369);
				handMesh.addTriangle (294, 375, 369);
				handMesh.addTriangle (294, 295, 375);
				handMesh.addTriangle (295, 334, 375);
				
			}
			
			//----------------------------------------------------
			// ofEnableAlphaBlending();
			ofSetColor(255,100,100, 70);
			handMesh.draw();
			ofSetColor(255,255,255,140); //255,120,120, 50);
			handMesh.drawWireframe();
			//ofDisableAlphaBlending();
			
			
		
		
		}
	}
}
Exemplo n.º 3
0
//--------------------------------------------------------------
void ofApp::draw(){
    if(poly.size() < 2) return;
    
    ofPushMatrix();
    ofTranslate(ofGetWidth()/2, ofGetHeight()/2);
    ofRotateY(rotAngle);
    
    ofSetColor(255, 255, 255);
    poly.draw();
    
    ofSetColor(0, 255, 0);
    ofSetRectMode(OF_RECTMODE_CENTER);
    glPointSize(5);
    glBegin(GL_POINTS);
    for(int i=0; i<poly.size(); i++) {
        ofPoint p = poly[i];
        glVertex3f(p.x, p.y, p.z);
    }
    glEnd();
    
    for(int i=0; i<poly.size(); i++) {
        ofPoint p = poly[i];
        ofSetColor(255, 0, 0);
        ofLine(p, p + poly.getTangentAtIndex(i) * 20);
        
        ofSetColor(0, 255, 0);
        ofLine(p, p + poly.getNormalAtIndex(i) * 20);
        
        ofSetColor(0, 128, 255);
        ofLine(p, p + poly.getRotationAtIndex(i) * 20);
    }
    
    
    
    float totalLength = poly.getPerimeter();
    float totalArea = poly.getArea();
    ofPoint nearestPoint = poly.getClosestPoint(ofPoint(mouseX-ofGetWidth()/2, mouseY-ofGetHeight()/2), &nearestIndex);
    ofPoint nearestDataPoint = poly[nearestIndex];
    float lengthAtIndex = poly.getLengthAtIndex(nearestIndex);
    ofPoint pointAtIndex = poly.getPointAtIndexInterpolated(nearestIndex);
    ofPoint pointAtLength = poly.getPointAtLength(lengthAtIndex);
    ofPoint pointAtPercent = poly.getPointAtPercent(lengthAtIndex / totalLength);
    float indexAtLength = poly.getIndexAtLength(lengthAtIndex);
    
    float sinTime = ofMap(sin(ofGetElapsedTimef() * 0.5), -1, 1, 0, 1);
    float sinIndex = sinTime * (poly.isClosed() ? poly.size() : (poly.size()-1));  // sinTime mapped to indices direct
    float sinIndexLength = poly.getIndexAtPercent(sinTime); // sinTime mapped to indices based on length
    
    float lengthAtIndexSin = poly.getLengthAtIndexInterpolated(sinIndex);
    ofPoint pointAtIndexSin = poly.getPointAtIndexInterpolated(sinIndex);
    ofPoint pointAtPercentSin = poly.getPointAtPercent(sinTime);
    
    float angleAtIndex = poly.getAngleAtIndex(nearestIndex);
    float angleAtIndexSin = poly.getAngleAtIndexInterpolated(sinIndex);
    
    ofVec3f rotAtIndex = poly.getRotationAtIndex(nearestIndex);
    ofVec3f rotAtIndexSin = poly.getRotationAtIndexInterpolated(sinIndex);
    
    float rotMagAtIndex = rotAtIndex.length();
    float rotMagAtIndexSin = rotAtIndexSin.length();
    
    ofVec3f normalAtIndex = poly.getNormalAtIndex(nearestIndex);
    
    ofVec3f tangentAtIndexSin = poly.getTangentAtIndexInterpolated(sinIndex);
    ofVec3f normalAtIndexSin = poly.getNormalAtIndexInterpolated(sinIndex);
    ofVec3f rotationAtIndexSin = poly.getRotationAtIndexInterpolated(sinIndex);
    
    
    ofNoFill();
    ofSetLineWidth(2);
    
    ofSetColor(255, 0, 0);
    ofCircle(nearestPoint, 5);
    
    ofSetColor(255, 255, 0);
    ofCircle(nearestDataPoint, 7);
    
    // interpolating on indices
    {
        ofPoint p = poly.getPointAtIndexInterpolated(sinIndex);

        ofSetColor(0, 255, 255);
        ofCircle(p, 10);
        
        ofSetColor(255, 0, 0);
        ofLine(p, p + poly.getTangentAtIndexInterpolated(sinIndex) * 60);
        
        ofSetColor(0, 255, 0);
        ofLine(p, p + poly.getNormalAtIndexInterpolated(sinIndex) * 60);
        
        ofSetColor(0, 128, 255);
        ofLine(p, p + poly.getRotationAtIndexInterpolated(sinIndex) * 60);
    }
    
    // interpolating on length percentages
    {
        ofPoint p = poly.getPointAtIndexInterpolated(sinIndexLength);
        
        ofSetColor(255, 0, 255);
        ofCircle(p, 10);
        
        ofSetColor(255, 0, 0);
        ofLine(p, p + poly.getTangentAtIndexInterpolated(sinIndexLength) * 60);
        
        ofSetColor(0, 255, 0);
        ofLine(p, p + poly.getNormalAtIndexInterpolated(sinIndexLength) * 60);
        
        ofSetColor(0, 128, 255);
        ofLine(p, p + poly.getRotationAtIndexInterpolated(sinIndexLength) * 60);
    }
    
    
    ofSetColor(255, 255, 255);
    ofCircle(poly.getCentroid2D(), 20);
    
    ofPopMatrix();
    
    
    stringstream s;
    s << "Number of points: " << poly.size() << endl;
    s << "totalLength: " << totalLength << endl;
    
    s << endl;
    s << "nearestIndex: " << nearestIndex << endl;
    s << "nearestPoint: " << nearestPoint << endl;
    s << "nearestDataPoint: " << nearestDataPoint << endl;
    
    s << endl;
    s << "lengthAtIndex: " << lengthAtIndex << endl;
    s << "pointAtIndex: " << pointAtIndex << endl;
    
    s << endl;
    s << "pointAtLength: " << pointAtLength << endl;
    s << "pointAtPercent: " << pointAtPercent << endl;
    
    s << endl;
    s << "indexAtLength: " << indexAtLength << endl;
    
    
    s << endl;
    s << "sinTime: " << sinTime << endl;
    s << "sinIndex: " << sinIndex << endl;
    s << "sinIndexLength: " << sinIndexLength << endl;
    
    s << endl;
    s << "lengthAtIndexSin: " << lengthAtIndexSin << endl;
    s << "pointAtIndexSin: " << pointAtIndexSin << endl;
    s << "pointAtPercentSin: " << pointAtPercentSin << endl;
    
    s << endl;
    s << "angleAtIndex: " << angleAtIndex << endl;
    s << "angleAtIndexSin: " << angleAtIndexSin << endl;
    
    s << endl;
    s << "rotAtIndex: " << rotAtIndex << endl;
    s << "rotAtIndexSin: " << rotAtIndexSin << endl;
    
    s << endl;
    s << "rotMagAtIndex: " << rotMagAtIndex << endl;
    s << "rotMagAtIndexSin: " << rotMagAtIndexSin << endl;
    
    s << endl;
    s << "normalAtIndex: " << normalAtIndex << endl;
    s << "normalAtIndexSin: " << normalAtIndexSin << endl;
    
    ofSetColor(255);
    ofDrawBitmapString(s.str(), 10, 30);
}