1
Je ne suis pas sûr pourquoi toutes les valeurs x, y, z se trouvent être zéro dans pos3d dans le code suivant. S'il vous plaît suggérer des corrections:ProjectDepthToCamera renvoie 0 pour tous les xyz de pos3d
/***
Reads the depth data from the sensor and fills in the matrix
***/
void SR300Camera::fillInZCoords()
{
PXCImage::ImageData depthImage;
PXCImage *depthMap = sample->depth;
depthMap->AcquireAccess(PXCImage::ACCESS_READ, &depthImage);
PXCImage::ImageInfo imgInfo = depthMap->QueryInfo();
cout << "inImg->QueryInfo() " << depthImage.format << endl;
PXCPoint3DF32 * pos2d = new PXCPoint3DF32[depth_width*depth_height];
int depth_stride = depthImage.pitches[0]/sizeof(pxcU16);
for (int y = 0, k = 0; y < depth_height; y++) {
for (int x = 0; x < depth_width; x++, k++) {
pos2d[k].x = (pxcF32)x;
pos2d[k].y = (pxcF32)y;
pos2d[k].z = ((short *)depthImage.planes[0])[y* depth_stride + x];
}
}
//Point3DF32 * pos3d = NULL;
PXCPoint3DF32 * pos3d = new Point3DF32[depth_width*depth_height];
PXCPoint3DF32 * vertices = new PXCPoint3DF32[depth_width * depth_height];
Projection * projection = device->CreateProjection();
projection->ProjectDepthToCamera(depth_width*depth_height, pos2d, pos3d);
cout << "x is " << pos3d->x*1000 << endl;
cout << "y is " << pos3d->y*1000 << endl;
cout << "z is " << pos3d->z*1000 << endl;
}