为什么QueryVertices的所有坐标都为零?

时间:2017-05-22 23:53:22

标签: c++ camera camera-calibration realsense

以下代码:

Reads the depth data from the sensor and fills in the matrix
***/
void SR300Camera::fillInZCoords()
{
    Image::ImageData depthImage;
    Image *depthMap = sample->depth;
    depthMap->AcquireAccess(Image::ACCESS_READ, &depthImage);
    Image::ImageInfo imgInfo = depthMap->QueryInfo();
    int depth_stride = depthImage.pitches[0] / sizeof(pxcU16);
    Projection * projection = device->CreateProjection();
    unsigned int wxhDepth = depth_width * depth_height;
    Point3DF32* vertices = new Point3DF32[wxhDepth];
    projection->QueryVertices(depthMap, vertices);
    pxcU16 *dpixels = (pxcU16*)depthImage.planes[0];
    unsigned int dpitch = depthImage.pitches[0] / sizeof(pxcU16); /* aligned width */

    for (int k = 0; k < wxhDepth; k++) {
        cout << "xx is " << vertices[k].x << endl;
        cout << "yy is " << vertices[k].y << endl;
        cout << "zz is " << vertices[k].z << endl;
    }

}

我打印的所有内容都为零。在SDK文档中告知,以mm为单位将深度图像UV-map坐标转换为realworld的xyz-map QueryVertices。然而,对我来说它只返回0.我得到彩色和深度图像,我不知道出了什么问题。 以下是调试代码的更多信息:enter image description here

*

-       vertices    0x00000261e4934040 {x=0.000000000 y=0.000000000 z=0.000000000 } Intel::RealSense::Point3DF32 *
        wxhDepth    307200  unsigned int
-       depthImage.pitches  0x00000075a2da9de0 {1280, 0, 0, 0}  int[4]
-       planes  0x00000075a2da9df0 {0x00000261e7542000 "", 0x0000000000000000 <NULL>, 0x0000000000000000 <NULL>, 0x0000000000000000 <NULL>} unsigned char *[4]
+       reserved    0x00000075a2da9dd4 {0, 0, 0}    int[3]
        format  PIXEL_FORMAT_DEPTH (131072) Intel::RealSense::Image::PixelFormat

*

1 个答案:

答案 0 :(得分:0)

这是从深度图像UVmap获取xyzMap的正确答案:

PXCImage::ImageData depthImage;
depthMap->AcquireAccess(PXCImage::ACCESS_READ, &depthImage);
PXCImage::ImageInfo imgInfo = depthMap->QueryInfo();
depth_width = imgInfo.width;
depth_height = imgInfo.height;
num_pixels = depth_width * depth_height;
PXCProjection * projection = device->CreateProjection();
PXCPoint3DF32 *pos3D = new PXCPoint3DF32[num_pixels];
sts = projection->QueryVertices(depthMap, &pos3D[0]);
if (sts < Status::STATUS_NO_ERROR) {
    wprintf_s(L"Projection was unsuccessful! \n");
    sm->Close();
}