2. 程式人生 > >kinect 學習筆記二（深度影象的利用--摳取使用者軀體）

kinect 學習筆記二（深度影象的利用--摳取使用者軀體）

阿新 • • 發佈：2019-01-27

今天主要把深度資料和骨骼還有視訊資料同步起來。算是上一次的三個的組合吧。期間遇到點白痴的問題整治了一下午：帶ID的資料的ID是否準確。而且差點把自己的質疑給發到部落格上來，竟然是自己程式碼的錯誤。傷心傷心。。。

直接把程式碼貼出來吧，也許有人覺得貼程式碼沒水平，嗨，給自己留個小版本說不定以後還用得著，而且自信自己程式碼寫的還算是規範，方便後來人嘛。再有一點，那個getTheContour函式畫蛇添足了，實際直接利用深度資料的ID就可以摳出任務的區域。

先上實驗結果：這是實時影象


然後是深度影象、骨骼影象和摳出的人體區域

這是程式碼，希望可以幫助到大家，當然，如果有錯誤歡迎指正：

#include <iostream>
#include <fstream>
#include  "math.h"
#include "Windows.h"    
#include "MSR_NuiApi.h"    
#include "cv.h"    
#include "highgui.h" 

using namespace std;

bool tracked[NUI_SKELETON_COUNT]={FALSE};
CvPoint skeletonPoint[NUI_SKELETON_COUNT][NUI_SKELETON_POSITION_COUNT]={cvPoint(0,0)};
CvPoint colorPoint[NUI_SKELETON_COUNT][NUI_SKELETON_POSITION_COUNT]={cvPoint(0,0)};

void getColorImage(HANDLE &colorEvent, HANDLE &colorStreamHandle, IplImage *colorImage);
void getDepthImage(HANDLE &depthEvent, HANDLE &depthStreamHandle, IplImage *depthImage);
void getSkeletonImage(HANDLE &skeletonEvent, IplImage *skeletonImage, IplImage *colorImage, IplImage *depthImage);
void drawSkeleton(IplImage *image, CvPoint pointSet[], int witchone);
void getTheContour(IplImage *image, int whichone, IplImage *mask);//得到各個人物的輪廓

int main()
{
	IplImage *colorImage = cvCreateImage(cvSize(640, 480), 8, 3);
	IplImage *depthImage = cvCreateImage(cvSize(320, 240), 8, 3);
	IplImage *skeletonImage = cvCreateImage(cvSize(320, 240), 8, 3);
	IplImage *mask = cvCreateImage(cvSize(320, 240), 8, 3);

	HANDLE colorEvent = CreateEvent( NULL, TRUE, FALSE, NULL );
	HANDLE depthEvent = CreateEvent( NULL, TRUE, FALSE, NULL );
	HANDLE skeletonEvent = CreateEvent( NULL, TRUE, FALSE, NULL );

	HANDLE colorStreamHandle = NULL;
	HANDLE depthStreamHandle = NULL;

	HRESULT hr = NuiInitialize(NUI_INITIALIZE_FLAG_USES_COLOR | NUI_INITIALIZE_FLAG_USES_DEPTH_AND_PLAYER_INDEX | NUI_INITIALIZE_FLAG_USES_SKELETON);  
	if( hr != S_OK )  
	{  
		cout<<"NuiInitialize failed"<<endl;  
		return hr;  
	}

	hr = NuiImageStreamOpen(NUI_IMAGE_TYPE_COLOR, NUI_IMAGE_RESOLUTION_640x480, NULL, 4, colorEvent, &colorStreamHandle);
	if( hr != S_OK )  
	{  
		cout<<"Open the color Stream failed"<<endl;
		NuiShutdown();
		return hr;  
	}
	hr = NuiImageStreamOpen(NUI_IMAGE_TYPE_DEPTH_AND_PLAYER_INDEX, NUI_IMAGE_RESOLUTION_320x240, NULL, 2, depthEvent, &depthStreamHandle);
	if( hr != S_OK )  
	{  
		cout<<"Open the depth Stream failed"<<endl;
		NuiShutdown();
		return hr;  
	}
	hr = NuiSkeletonTrackingEnable( skeletonEvent, 0 );//開啟骨骼跟蹤事件  
	if( hr != S_OK )  
	{  
		cout << "NuiSkeletonTrackingEnable failed" << endl;  
		NuiShutdown();
		return hr;  
	}

	//HANDLE hEvents[3];
	//int nEventIdx;
	//hEvents[0] = colorEvent;
	//hEvents[1] = depthEvent;
	//hEvents[2] = skeletonEvent;
	int a=0;
	while (1)
	{
		//剛開始想用WaitForMultipleObjects，但是怎麼調都是值顯示視訊，深度很少顯示，骨骼直接不顯示。
		//自己理解不深入，只能臨時用WaitForSingleObject這樣了。
		//nEventIdx = WaitForMultipleObjects(sizeof(hEvents)/sizeof(hEvents[0]), hEvents, FALSE, 10);
		////cout << nEventIdx << endl;

		//switch(nEventIdx)
		//{
		//case 0:
		//	//if(WaitForSingleObject(colorEvent, 0)==0)
		//	getColorImage(colorEvent, colorStreamHandle, colorImage);
		//	break;
		//case 1:
		//	//if(WaitForSingleObject(depthEvent, 0)==0)
		//	getDepthImage(depthEvent, depthStreamHandle, depthImage);
		//	break;
		//case 2:
		//	//if(WaitForSingleObject(skeletonEvent, 0)==0)
		//	getSkeletonImage(skeletonEvent, skeletonImage);
		//	break;
		//}

		if(WaitForSingleObject(colorEvent, 0)==0)
			getColorImage(colorEvent, colorStreamHandle, colorImage);
		if(WaitForSingleObject(depthEvent, 0)==0)
			getDepthImage(depthEvent, depthStreamHandle, depthImage);
		if(WaitForSingleObject(skeletonEvent, INFINITE)==0)//這裡使用INFINITE是為了避免沒有啟用skeletonEvent而跳過此程式碼出現colorimage頻閃的現象
			getSkeletonImage(skeletonEvent, skeletonImage, colorImage, depthImage);

		
		for (int i=0; i<6; i++)
		{
			if(tracked[i] == TRUE)
			{
				cvZero(mask);
				getTheContour(depthImage, i, mask);
				tracked[i] = FALSE;
				break;
			}
		}

		cvShowImage("mask", mask);
		cvShowImage("colorImage", colorImage);
		cvShowImage("depthImage", depthImage);
		cvShowImage("skeletonImage", skeletonImage);

		if(cvWaitKey(20)==27)
		{
			cvReleaseImage(&colorImage);
			cvReleaseImage(&depthImage);
			cvReleaseImage(&skeletonImage);
			break;
		}
	}

	NuiShutdown();
	return 0;
}

void getColorImage(HANDLE &colorEvent, HANDLE &colorStreamHandle, IplImage *colorImage)
{
	const NUI_IMAGE_FRAME *colorFrame = NULL;

	NuiImageStreamGetNextFrame(colorStreamHandle, 0, &colorFrame);
	NuiImageBuffer *pTexture = colorFrame->pFrameTexture;  

	KINECT_LOCKED_RECT LockedRect;
	pTexture->LockRect(0, &LockedRect, NULL, 0);  

	if( LockedRect.Pitch != 0 )  
	{  
		//cvZero(colorImage);
		for (int i=0; i<480; i++)  
		{  
			uchar* ptr = (uchar*)(colorImage->imageData+i*colorImage->widthStep);  
			BYTE * pBuffer = (BYTE*)(LockedRect.pBits)+i*LockedRect.Pitch;//每個位元組代表一個顏色資訊，直接使用BYTE  
			for (int j=0; j<640; j++)  
			{  
				ptr[3*j] = pBuffer[4*j];//內部資料是4個位元組，0-1-2是BGR，第4個現在未使用  
				ptr[3*j+1] = pBuffer[4*j+1];  
				ptr[3*j+2] = pBuffer[4*j+2];  
			}  
		}  

		//cvShowImage("colorImage", colorImage);//顯示影象
		//cvWaitKey(1);

	}  
	else  
	{  
		cout<<"捕捉視訊幀時發生錯誤"<<endl;  
	}  
	
	NuiImageStreamReleaseFrame( colorStreamHandle, colorFrame );  
}

void getDepthImage(HANDLE &depthEvent, HANDLE &depthStreamHandle, IplImage *depthImage)
{
	const NUI_IMAGE_FRAME *depthFrame = NULL;

	NuiImageStreamGetNextFrame(depthStreamHandle, 0, &depthFrame);
	NuiImageBuffer *pTexture = depthFrame->pFrameTexture;  

	KINECT_LOCKED_RECT LockedRect;
	pTexture->LockRect(0, &LockedRect, NULL, 0);  

	RGBQUAD q;
	//q.rgbBlue = q.rgbGreen = q.rgbRed = 0;
	//cvZero(depthImage);
	if( LockedRect.Pitch != 0 )
	{
		for (int i=0; i<240; i++)
		{
			uchar *ptr = (uchar*)(depthImage->imageData+i*depthImage->widthStep);
			BYTE *buffer = (BYTE*)(LockedRect.pBits)+i*LockedRect.Pitch;
			USHORT *bufferRun = (USHORT*)buffer;
			for (int j=0; j<320; j++)
			{
				int player = bufferRun[j]&7;
				int data = (bufferRun[j]&0xfff8) >> 3;
				
				uchar imageData = 255-(uchar)(256*data/0x0fff);
				q.rgbBlue = q.rgbGreen = q.rgbRed = 0;

				switch(player)
				{
				case 0:  
					q.rgbRed = imageData / 2;  
					q.rgbBlue = imageData / 2;  
					q.rgbGreen = imageData / 2;  
					break;  
				case 1:  
					q.rgbRed = imageData;  
					break;  
				case 2:  
					q.rgbGreen = imageData;  
					break;  
				case 3:  
					q.rgbRed = imageData / 4;  
					q.rgbGreen = q.rgbRed*4;  //這裡利用乘的方法，而不用原來的方法可以避免不整除的情況
					q.rgbBlue = q.rgbRed*4;  //可以在後面的getTheContour()中配合使用，避免遺漏一些情況
					break;  
				case 4:  
					q.rgbBlue = imageData / 4; 
					q.rgbRed = q.rgbBlue*4;  
					q.rgbGreen = q.rgbBlue*4;  
					break;  
				case 5:  
					q.rgbGreen = imageData / 4; 
					q.rgbRed = q.rgbGreen*4;  
					q.rgbBlue = q.rgbGreen*4;  
					break;  
				case 6:  
					q.rgbRed = imageData / 2;  
					q.rgbGreen = imageData / 2;  
					q.rgbBlue = q.rgbGreen*2;  
					break;  
				case 7:  
					q.rgbRed = 255 - ( imageData / 2 );  
					q.rgbGreen = 255 - ( imageData / 2 );  
					q.rgbBlue = 255 - ( imageData / 2 );
				}

				ptr[3*j] = q.rgbBlue;
				ptr[3*j+1] = q.rgbGreen;
				ptr[3*j+2] = q.rgbRed;
			}
		}

		//cvShowImage("depthImage", depthImage);
		//cvWaitKey(1);
	}
	else
	{
		cout << "捕捉深度影象出現錯誤" << endl;
	}

	NuiImageStreamReleaseFrame(depthStreamHandle, depthFrame);

}

void getSkeletonImage(HANDLE &skeletonEvent, IplImage *skeletonImage, IplImage *colorImage, IplImage *depthImage)
{
	/*兩者效果竟然不一樣。奇怪
	NUI_SKELETON_FRAME *skeletonFrame = NULL;
	NUI_SKELETON_FRAME skeletonFrame;*/

	NUI_SKELETON_FRAME skeletonFrame;
	bool bFoundSkeleton = false; 

	if(NuiSkeletonGetNextFrame( 0, &skeletonFrame ) == S_OK )  
	{  
		for( int i = 0 ; i < NUI_SKELETON_COUNT ; i++ )  
		{  
			if( skeletonFrame.SkeletonData[i].eTrackingState == NUI_SKELETON_TRACKED )
			{  
				bFoundSkeleton = true;  
				//cout << "ok" << endl;
				break;
			}  
		}  
	}
	else
	{
		cout << "沒有找到合適的骨骼幀" << endl;
		return; 
	}

	if( !bFoundSkeleton )  
	{  
		return; 
	}  

	NuiTransformSmooth(&skeletonFrame,NULL);//平滑骨骼幀,消除抖動  

	cvZero(skeletonImage);  
	for( int i = 0 ; i < NUI_SKELETON_COUNT ; i++ )  
	{  
		if( skeletonFrame.SkeletonData[i].eTrackingState == NUI_SKELETON_TRACKED &&  
			skeletonFrame.SkeletonData[i].eSkeletonPositionTrackingState[NUI_SKELETON_POSITION_SHOULDER_CENTER] != NUI_SKELETON_POSITION_NOT_TRACKED)  
		{  
			float fx, fy;  

			for (int j = 0; j < NUI_SKELETON_POSITION_COUNT; j++)//所有的座標轉化為深度圖的座標  
			{  
				NuiTransformSkeletonToDepthImageF(skeletonFrame.SkeletonData[i].SkeletonPositions[j], &fx, &fy );  
				skeletonPoint[i][j].x = (int)(fx*320+0.5f);  
				skeletonPoint[i][j].y = (int)(fy*240+0.5f);  
			}  

			for (int j=0; j<NUI_SKELETON_POSITION_COUNT ; j++)  
			{  
				if (skeletonFrame.SkeletonData[i].eSkeletonPositionTrackingState[j] != NUI_SKELETON_POSITION_NOT_TRACKED)//跟蹤點一用有三種狀態：1沒有被跟蹤到，2跟蹤到，3根據跟蹤到的估計到  
				{  
					LONG colorx, colory;
					NuiImageGetColorPixelCoordinatesFromDepthPixel(NUI_IMAGE_RESOLUTION_640x480, 0, 
						skeletonPoint[i][j].x, skeletonPoint[i][j].y, 0,&colorx, &colory);
					colorPoint[i][j].x = int(colorx);colorPoint[i][j].y = int(colory);//儲存座標點
					cvCircle(colorImage, colorPoint[i][j], 4, cvScalar(0, 255, 255), -1, 8, 0);
					//cvCircle(depthImage, skeletonPoint[i][j], 3, cvScalar(0, 255, 255), -1, 8, 0);
					cvCircle(skeletonImage, skeletonPoint[i][j], 3, cvScalar(0, 255, 255), -1, 8, 0);

					tracked[i] = TRUE;
				}
			}

			drawSkeleton(colorImage, colorPoint[i], i);
			//drawSkeleton(depthImage, skeletonPoint[i], i);
			drawSkeleton(skeletonImage, skeletonPoint[i], i);
		}
	}  

	//cvShowImage("skeletonImage", skeletonImage);  
	//cvShowImage("skeletsdfonImage", colorImage);  
	//cvWaitKey(1);  
}

void drawSkeleton(IplImage *image, CvPoint pointSet[], int witchone)
{
	CvScalar color;
	switch(witchone)//跟蹤不同的人顯示不同的顏色
	{
	case 0:
		color = cvScalar(255);
		break;
	case 1:
		color = cvScalar(0,255);
		break;
	case 2:
		color = cvScalar(0, 0, 255);
		break;
	case 3:
		color = cvScalar(255, 255, 0);
		break;
	case 4:
		color = cvScalar(255, 0, 255);
		break;
	case 5:
		color = cvScalar(0, 255, 255);
		break;
	}

	if((pointSet[NUI_SKELETON_POSITION_HEAD].x!=0 || pointSet[NUI_SKELETON_POSITION_HEAD].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_SHOULDER_CENTER].x!=0 || pointSet[NUI_SKELETON_POSITION_SHOULDER_CENTER].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_HEAD], pointSet[NUI_SKELETON_POSITION_SHOULDER_CENTER], color, 2);
	if((pointSet[NUI_SKELETON_POSITION_SHOULDER_CENTER].x!=0 || pointSet[NUI_SKELETON_POSITION_SHOULDER_CENTER].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_SPINE].x!=0 || pointSet[NUI_SKELETON_POSITION_SPINE].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_SHOULDER_CENTER], pointSet[NUI_SKELETON_POSITION_SPINE], color, 2);
	if((pointSet[NUI_SKELETON_POSITION_SPINE].x!=0 || pointSet[NUI_SKELETON_POSITION_SPINE].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_HIP_CENTER].x!=0 || pointSet[NUI_SKELETON_POSITION_HIP_CENTER].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_SPINE], pointSet[NUI_SKELETON_POSITION_HIP_CENTER], color, 2);

	//左上肢
	if((pointSet[NUI_SKELETON_POSITION_SHOULDER_CENTER].x!=0 || pointSet[NUI_SKELETON_POSITION_SHOULDER_CENTER].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_SHOULDER_LEFT].x!=0 || pointSet[NUI_SKELETON_POSITION_SHOULDER_LEFT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_SHOULDER_CENTER], pointSet[NUI_SKELETON_POSITION_SHOULDER_LEFT], color, 2);
	if((pointSet[NUI_SKELETON_POSITION_SHOULDER_LEFT].x!=0 || pointSet[NUI_SKELETON_POSITION_SHOULDER_LEFT].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_ELBOW_LEFT].x!=0 || pointSet[NUI_SKELETON_POSITION_ELBOW_LEFT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_SHOULDER_LEFT], pointSet[NUI_SKELETON_POSITION_ELBOW_LEFT], color, 2);
	if((pointSet[NUI_SKELETON_POSITION_ELBOW_LEFT].x!=0 || pointSet[NUI_SKELETON_POSITION_ELBOW_LEFT].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_WRIST_LEFT].x!=0 || pointSet[NUI_SKELETON_POSITION_WRIST_LEFT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_ELBOW_LEFT], pointSet[NUI_SKELETON_POSITION_WRIST_LEFT], color, 2);
	if((pointSet[NUI_SKELETON_POSITION_WRIST_LEFT].x!=0 || pointSet[NUI_SKELETON_POSITION_WRIST_LEFT].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_HAND_LEFT].x!=0 || pointSet[NUI_SKELETON_POSITION_HAND_LEFT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_WRIST_LEFT], pointSet[NUI_SKELETON_POSITION_HAND_LEFT], color, 2);

	//右上肢
	if((pointSet[NUI_SKELETON_POSITION_SHOULDER_CENTER].x!=0 || pointSet[NUI_SKELETON_POSITION_SHOULDER_CENTER].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_SHOULDER_RIGHT].x!=0 || pointSet[NUI_SKELETON_POSITION_SHOULDER_RIGHT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_SHOULDER_CENTER], pointSet[NUI_SKELETON_POSITION_SHOULDER_RIGHT], color, 2);
	if((pointSet[NUI_SKELETON_POSITION_SHOULDER_RIGHT].x!=0 || pointSet[NUI_SKELETON_POSITION_SHOULDER_RIGHT].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_ELBOW_RIGHT].x!=0 || pointSet[NUI_SKELETON_POSITION_ELBOW_RIGHT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_SHOULDER_RIGHT], pointSet[NUI_SKELETON_POSITION_ELBOW_RIGHT], color, 2);
	if((pointSet[NUI_SKELETON_POSITION_ELBOW_RIGHT].x!=0 || pointSet[NUI_SKELETON_POSITION_ELBOW_RIGHT].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_WRIST_RIGHT].x!=0 || pointSet[NUI_SKELETON_POSITION_WRIST_RIGHT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_ELBOW_RIGHT], pointSet[NUI_SKELETON_POSITION_WRIST_RIGHT], color, 2);
	if((pointSet[NUI_SKELETON_POSITION_WRIST_RIGHT].x!=0 || pointSet[NUI_SKELETON_POSITION_WRIST_RIGHT].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_HAND_RIGHT].x!=0 || pointSet[NUI_SKELETON_POSITION_HAND_RIGHT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_WRIST_RIGHT], pointSet[NUI_SKELETON_POSITION_HAND_RIGHT], color, 2);

	//左下肢
	if((pointSet[NUI_SKELETON_POSITION_HIP_CENTER].x!=0 || pointSet[NUI_SKELETON_POSITION_HIP_CENTER].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_HIP_LEFT].x!=0 || pointSet[NUI_SKELETON_POSITION_HIP_LEFT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_HIP_CENTER], pointSet[NUI_SKELETON_POSITION_HIP_LEFT], color, 2);
	if((pointSet[NUI_SKELETON_POSITION_HIP_LEFT].x!=0 || pointSet[NUI_SKELETON_POSITION_HIP_LEFT].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_KNEE_LEFT].x!=0 || pointSet[NUI_SKELETON_POSITION_KNEE_LEFT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_HIP_LEFT], pointSet[NUI_SKELETON_POSITION_KNEE_LEFT], color, 2);
	if((pointSet[NUI_SKELETON_POSITION_KNEE_LEFT].x!=0 || pointSet[NUI_SKELETON_POSITION_KNEE_LEFT].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_ANKLE_LEFT].x!=0 || pointSet[NUI_SKELETON_POSITION_ANKLE_LEFT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_KNEE_LEFT], pointSet[NUI_SKELETON_POSITION_ANKLE_LEFT], color, 2);
	if((pointSet[NUI_SKELETON_POSITION_ANKLE_LEFT].x!=0 || pointSet[NUI_SKELETON_POSITION_ANKLE_LEFT].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_FOOT_LEFT].x!=0 || pointSet[NUI_SKELETON_POSITION_FOOT_LEFT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_ANKLE_LEFT], pointSet[NUI_SKELETON_POSITION_FOOT_LEFT], color, 2);

	//右下肢
	if((pointSet[NUI_SKELETON_POSITION_HIP_CENTER].x!=0 || pointSet[NUI_SKELETON_POSITION_HIP_CENTER].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_HIP_RIGHT].x!=0 || pointSet[NUI_SKELETON_POSITION_HIP_RIGHT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_HIP_CENTER], pointSet[NUI_SKELETON_POSITION_HIP_RIGHT], color, 2);
	if((pointSet[NUI_SKELETON_POSITION_HIP_RIGHT].x!=0 || pointSet[NUI_SKELETON_POSITION_HIP_RIGHT].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_KNEE_RIGHT].x!=0 || pointSet[NUI_SKELETON_POSITION_KNEE_RIGHT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_HIP_RIGHT], pointSet[NUI_SKELETON_POSITION_KNEE_RIGHT],color, 2);
	if((pointSet[NUI_SKELETON_POSITION_KNEE_RIGHT].x!=0 || pointSet[NUI_SKELETON_POSITION_KNEE_RIGHT].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_ANKLE_RIGHT].x!=0 || pointSet[NUI_SKELETON_POSITION_ANKLE_RIGHT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_KNEE_RIGHT], pointSet[NUI_SKELETON_POSITION_ANKLE_RIGHT], color, 2);
	if((pointSet[NUI_SKELETON_POSITION_ANKLE_RIGHT].x!=0 || pointSet[NUI_SKELETON_POSITION_ANKLE_RIGHT].y!=0) &&
		(pointSet[NUI_SKELETON_POSITION_FOOT_RIGHT].x!=0 || pointSet[NUI_SKELETON_POSITION_FOOT_RIGHT].y!=0))
		cvLine(image, pointSet[NUI_SKELETON_POSITION_ANKLE_RIGHT], pointSet[NUI_SKELETON_POSITION_FOOT_RIGHT], color, 2);
}


void getTheContour(IplImage *image, int whichone, IplImage *mask)//根據給定的深度資料的關係（在getDepthImage()中的）確定不同的跟蹤目標
{
	for (int i=0; i<240; i++)
	{
		uchar *ptr = (uchar*)(image->imageData+i*image->widthStep);
		uchar *ptrmask = (uchar*)(mask->imageData+i*mask->widthStep);
		for (int j=0; j<320; j++)
		{
			if (ptr[3*j]==0 && ptr[3*j+1]==0 && ptr[3*j+2]==0)//都為0的時候予以忽略
			{
				ptrmask[3*j]=ptrmask[3*j+1]=ptrmask[3*j+2]=0;
			}else if(ptr[3*j]==0 && ptr[3*j+1]==0 && ptr[3*j+2]!=0)//ID為1的時候，顯示綠色
			{
				ptrmask[3*j] = 0;
				ptrmask[3*j+1] = 255;
				ptrmask[3*j+2] = 0;
			}else if (ptr[3*j]==0 && ptr[3*j+1]!=0 && ptr[3*j+2]==0)//ID為2的時候，顯示紅色
			{
				ptrmask[3*j] = 0;
				ptrmask[3*j+1] = 0;
				ptrmask[3*j+2] = 255;
			}else if (ptr[3*j]==ptr[3*j+1] && ptr[3*j]==4*ptr[3*j+2])//ID為3的時候
			{
				ptrmask[3*j] = 255;
				ptrmask[3*j+1] = 255;
				ptrmask[3*j+2] = 0;
			}else if (4*ptr[3*j]==ptr[3*j+1] && ptr[3*j+1]==ptr[3*j+2])//ID為4的時候
			{
				ptrmask[3*j] = 255;
				ptrmask[3*j+1] = 0;
				ptrmask[3*j+2] = 255;
			}else if (ptr[3*j]==4*ptr[3*j+1] && ptr[3*j]==ptr[3*j+2])//ID為5的時候
			{
				ptrmask[3*j] = 0;
				ptrmask[3*j+1] = 255;
				ptrmask[3*j+2] = 255;
			}else if (ptr[3*j]==2*ptr[3*j+1] && ptr[3*j+1]==ptr[3*j+2])//ID為6的時候
			{
				ptrmask[3*j] = 255;
				ptrmask[3*j+1] = 255;
				ptrmask[3*j+2] = 255;
			}else if (ptr[3*j]==ptr[3*j+1] && ptr[3*j]==ptr[3*j+2])//ID為7的時候或者ID為0的時候，顯示藍色
			{
				ptrmask[3*j] = 255;
				ptrmask[3*j+1] = 0;
				ptrmask[3*j+2] = 0;
			}else
			{
				cout <<"如果輸出這段程式碼，說明有遺漏的情況，請查詢getTheContour函式" << endl;
			}
		}
	}
}


相關推薦

kinect 學習筆記二（深度影象的利用--摳取使用者軀體）

今天主要把深度資料和骨骼還有視訊資料同步起來。算是上一次的三個的組合吧。期間遇到點白痴的問題整治了一下午：帶ID的資料的ID是否準確。而且差點把自己的質疑給發到部落格上來，竟然是自己程式碼的錯誤。傷心傷心。。。 直接把程式碼貼出來吧，也許有人覺得貼程式碼沒水平，嗨，給自己

機器人作業系統（ROS）淺析（肖軍浩 博士 譯） 學習筆記二（第六章到第十章）

第 6 章 啟動檔案  利用啟動檔案一次性配置和執行多個節點 。  roslaunch ：這是一個自適應工具，如果啟動多節點時沒有節點管理器執行，它會自動啟動節點管理器；如果已經有一個節點 管理器在執行，則會使用已有的。     利用啟動檔案一次性配

Maven學習筆記二（配置本地倉庫）

maven學習筆記 Maven的默認本地倉庫在： ${user.home}/.m2/repository; 如果需要自定義倉庫路徑，可以找到maven文件夾下的conf下的setting.xml文件進行修改， 以下自定義倉庫路徑為E:\java\Maven\apache-maven-3

OpenCv學習筆記(二)--Mat矩陣(影象容器)的建立及CV_8UC1,CV_8UC2等引數詳解

（一）Mat矩陣(影象容器)建立時CV_8UC1,CV_8UC2等引數詳解 1--Mat不但是一個非常有用的影象容器類,同時也是一個通用的矩陣類 2--建立一個Mat物件的方法很多,我們現在先看一下Mat矩陣/影象容器類在OpenCv中的有關原始碼: 1 2

python 學習筆記二 （列表推導式）

  2018年年初寫了第一篇部落格，說要做一個認真的技術人 https://www.cnblogs.com/yingchen/p/8455507.html 今天已經是11月19日了，這是第二篇部落格，看來堅持確實是個好難的東西。雖然沒寫筆記，今年一年對python的使用還是可以的， 今天繼續：

微信小程式學習筆記二（持續更新）---小程式網路請求封裝

寫小程式的你是否已經厭倦了傳送網路請求的wx.request？接著看吧。。。 一、目錄結構 在專案同級目錄下utils資料夾裡新建一個fetch.js檔案，(名字看自己喜好) 二、直接上程式碼 // 定義網路請求API地址 const baseURL = 'h

資料庫系統實現學習筆記二（資料庫關係建模）--by穆晨

前言         ER建模環節完成後，需求就被描述成了ER圖。之後，便可根據這個ER圖設計相應的關係表了。         但從ER圖到具體關係表的建立還需要經過兩個步驟： 邏輯模型設計：將ER圖對映為邏輯意義上的

springMVC學習筆記二（獲取引數，返回Model資料）

Controller如何獲取引數            1利用原有的Servlet方法，使用HttpServletRequest 2利用@RequestParam註解 @RequestParam("username")String name，當username在reques

DeepLearning基礎學習筆記二（決策樹演算法DecisionTree）

概念 決策樹是一個類似於流程圖的樹結構，可用於資料預測，其中每個內部節點表示在一個屬性上的測試，每個分枝代表一個屬性輸出，而每個樹葉節點代表類或類分佈。樹的最頂層為根結點，結構圖如下： 其中某一個數據實例包含特徵[A,B,C,Boolean],以A為根結點判斷

OpenGL學習筆記二（著色器）

OpenGL的著色器語言（GLSL) 在說OpenGL的著色器語言之前先來介紹一下著色器到底是個什麼東西。 在學unity3d的時候就聽說有人說能寫shader和做圖形渲染優化的人都是大神，當時沒學過著色器一聽就感覺不明覺厲啊，先送上膝蓋再說。現在學

python學習筆記二（pandas基礎）

大寫的吐槽：暑假提前結束，實驗室專案越來越緊，略煩躁（不喜歡做的專案），沒啥自由學習的時間了。只有抽些零散的時間去準備資料探勘比賽相關的東西。最近關注的大神 wepon,bryan的部落格，乾貨多多！ PS: 實驗室師兄們找工作也是壓力山大，祝他們好運！

《重構：改善既有程式碼的設計》-學習筆記二（+實戰解析）

我不是個偉大的程式設計師；我只是個有著一些優秀習慣的好程式設計師而己本人比較直接，不說虛的，直接上乾貨。 目錄　　Long Parameter List（過長引數列）　　Divergent Change（發散式變化）　　Shotgun Surgery（散彈式修改）　　Feat

Linux學習筆記二（艱辛的wxWidgets環境搭建）

     十分鐘前我的第一個wxWidgets程式終於在Linux上現身了，雖然只是一個小小的測試窗體程式，但是。他的出現確實讓我驚喜重重，因為在環境搭建的過程中真的是走了很多彎路。現在把正確的搭建過程記錄下來。真的很感謝wxforum.shadonet.com以及www.codeproject.com兩個

西門子PLC學習筆記二-（工作記錄）

今天師傅給講了講做自動化控制的整體的思路，特進行一下記錄，做個備忘。 1.需求分析 本次的專案是對樓宇迴圈供水的控制，整個專案需要完成壓力、壓差、溫度等的獲取及顯示、同時完成電機的控制。 2.設計 使用西門子的Step7工具進行梯形圖程式設計，完成自動化控制。 使用西門子的

SVN 學習筆記二（一口氣學會SVN）

我打算一口氣講完SVN的使用，所以，在看之前呢，請先深深的吸一口氣（怎麼聽著像黑龍公主），當然吸完後還是要撥出來的。不要憋著了。 我們可能希望一來就直接操作。列出一堆命令。詳細的命令引數等資訊，我們都可以加入 --help 選項獲取，下面不會詳細介紹。除非必要。現在先看下

Go學習筆記二（函式）

函式 函式作用域 在 Go 中，定義在函式外的變數是全域性的，那些定義在函式內部的變數，對於函式來說是區域性的。 區域性 變數 僅僅 在執行定義它的函式時有效。 package main import "fmt" var a int

2016-8-2 Unity學習筆記二（第一人稱扔球）

以下學習內容根據 極客學院 所授內容學習並記錄 一、首先建立第一人稱 *1.在專案中引入包：Characters *2.然後將在FirstPersonCharactor中Prefabs裡面的FPSController拖到Hierarchy中，這時候建立了

C#學習筆記二 （資源托管，泛型，數組和元組，運算符和類型強制轉換）

方法 約束 資源 實例 對象 where 學習筆記 如果 數據庫連接 1.托管資源是指GC管理的內存空間，非托管資源是指文件句柄，網絡連接，數據庫連接等。 2.方法中臨時申請的變量，被存放在棧中。棧存儲非對象成員的值數據。例如在方法中有B b=new B(); b的

Java學習筆記16（面向對象九：補充內容）

nal ati 接收 pri version prot sys add [] 總是看到四種權限，這裏做一個介紹： 最大權限是public，後面依次是protected，default，private private修飾的只在本類可以使用 public是最大權限，可以跨包使用

Java學習筆記30（集合框架四：List接口）

package int 集合框架 初始 tro color arraylist 原理 void List接口繼承自Collection接口 具有重要的三大特點： 1.有序集合：存入和取出的順序一致 2.此接口的用戶可以對列表中每個元素插入位置精確的控制：可以通過索引操作 3