Kinect的RGB和Depth數據融合

#include "stdafx.h"
#include "kinect.h"

#include <iostream>
#include <opencv2\opencv.hpp>
#include <opencv2/highgui/highgui.hpp>
#include <opencv2/imgproc/imgproc.hpp>
#include <time.h>
#include <opencv2/core/core.hpp>  
#include <thread>
#include <mutex>
//#include "PracticalSocket.h"
#include <queue>

using namespace cv;
using namespace std;
template<class Interface>      //函數模板
inline void SafeRelease(Interface *& pInterfaceToRelease)
{
	if (pInterfaceToRelease != NULL)
	{
		pInterfaceToRelease->Release();
		pInterfaceToRelease = NULL;
	}
}
int main()
{

	setUseOptimized(true);
	int depthWidth = 512;
	int depthHeight = 424;

	
	HRESULT hResult = S_OK;
	
	//ColorSpacePoint* pointsCloud = nullptr;
	IKinectSensor* pSensor;
	ICoordinateMapper* pCoordinateMapper;
	hResult = GetDefaultKinectSensor(&pSensor);
	if (FAILED(hResult)) { cerr << "Error:GetDefaultKinectSensor" << endl; return -1; }