将kinect深度图像转换为真实世界尺寸

时间:2014-04-05 02:17:21

标签: c++ opencv kinect depth

我正在开发一个项目,使用kinect来避免障碍我正在使用Visual Studio C ++,OpenCV库和代码实验室驱动程序(CL NUI平台)。我想将深度图像转换为真实世界的尺寸。< / p>

提前致谢 这是我的代码:

#include "stdafx.h"
#include <opencv/cv.h>
#include <opencv/cxcore.h>
#include <opencv/highgui.h>
#include <CLNUIDevice.h>
using namespace std;
void displayKinectImage();
int _tmain(int argc, _TCHAR* argv[])
{
displayKinectImage();
}

void displayKinectImage() {
PDWORD rgb32_data = (PDWORD)malloc(640 * 480 * 4);
PDWORD depth32_data = (PDWORD)malloc(640 * 480 * 4);

CLNUICamera cam = CreateNUICamera(GetNUIDeviceSerial(0));
CLNUIMotor motor = CreateNUIMotor(GetNUIDeviceSerial(0));

StartNUICamera(cam);

cvNamedWindow("Image", CV_WINDOW_AUTOSIZE);
cvNamedWindow("Depth", CV_WINDOW_AUTOSIZE);
cvNamedWindow("Grey", CV_WINDOW_AUTOSIZE);

IplImage *rgb32 = cvCreateImageHeader(cvSize(640, 480), 8, 4);
IplImage *grey;
IplImage *depth32 = cvCreateImageHeader(cvSize(640, 480), 8, 4);;

do {
    GetNUICameraColorFrameRGB32(cam, rgb32_data);
    GetNUICameraDepthFrameRGB32(cam, depth32_data);

    rgb32 = cvCreateImageHeader(cvSize(640, 480), 8, 4);
    grey = cvCreateImage(cvSize(640, 480), 8, 1);
    depth32 = cvCreateImageHeader(cvSize(640, 480), 8, 4);

    cvSetData(rgb32, rgb32_data, rgb32->widthStep);
    cvSetData(depth32, depth32_data, depth32->widthStep);

    // Convert RGB32 to greyscale
    cvCvtColor(depth32, grey, CV_RGB2GRAY);

    cvShowImage("Image", rgb32);
    cvShowImage("Grey", grey);
    cvShowImage("Depth", depth32);

    cvReleaseImageHeader(&rgb32);
    cvReleaseImage(&grey);
    cvReleaseImageHeader(&depth32);

    cvWaitKey(1);

} while (!GetAsyncKeyState(0x50));


free(rgb32_data);
free(depth32_data);

}

1 个答案:

答案 0 :(得分:1)

您可以使用

获取与像素(j,i)对应的3D点
constexpr int WIDTH = 640;
constexpr int HEIGHT = 480;
constexpr float DEPTH_TO_M = 0.001f;
constexpr float SCL = 1.0f / 520.0f;

float z = static_cast<float>(depth)*DEPTH_TO_M; 
float x = staitc_cast<float>(j - WIDTH/2)*z*SCL;
float y = staitc_cast<float>(i - HEIGHT/2)*z*SCL;

常量DEPTH_TO_MSCL是近似值。如果你想要准确的结果,那么你需要校准你的相机,但这是一个科学问题,超出了堆栈溢出的范围。