本文整理汇总了C++中Sensor::getNormalizedRayMap方法的典型用法代码示例。如果您正苦于以下问题：C++ Sensor::getNormalizedRayMap方法的具体用法？C++ Sensor::getNormalizedRayMap怎么用？C++ Sensor::getNormalizedRayMap使用的例子？那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类Sensor的用法示例。
在下文中一共展示了Sensor::getNormalizedRayMap方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: main
int main(int argc, char* argv[])
{
if(argc<2)
{
cout << "usage: " << argv[0] << " <sensor>" << endl;
cout << " sensor: 0=Laser scanner, 1=Kinect" << endl;
exit(1);
}
int sensortype = atoi(argv[1]);
unsigned int subsamplingW = 1;
unsigned int subsamplingH = 1;
double factorStart = 0.8;
double factorEnd = 1.0;
Sensor* sensor;
if(sensortype==KINECT)
{
// Projection matrix (needs to be determined by calibration)
// ------------------------------------------------------------------
double Pdata[12] = {585.05108211, 0.0, 315.83800193, 0.0, 0.0, 585.05108211, 242.94140713, 0., 0.0, 0.0, 1.0, 0.0};
Matrix P(3, 4, Pdata);
unsigned int cols = 640;
unsigned int rows = 480;
sensor = new SensorProjective3D(cols, rows, Pdata);
subsamplingW = 64;
subsamplingH = 48;
}
else
{
double thetaRes = deg2rad(0.25);
double thetaMin = deg2rad(-135.0);
double phiRes = deg2rad(1.0);
sensor = new SensorPolar3D(1081, thetaRes, thetaMin, phiRes);
subsamplingH = 24;
subsamplingW = 72;
}
unsigned int width = sensor->getWidth();
unsigned int height = sensor->getHeight();
cout << "Sensor width: " << width << ", height: " << height << endl;
double** coordsStart;
double** coordsEnd;
System<double>::allocate(width*height, 3, coordsStart);
System<double>::allocate(width*height, 3, coordsEnd);
Matrix* R = sensor->getNormalizedRayMap(1.0);
unsigned int size = 0;
for(unsigned int h=0; h<height; h+=subsamplingH)
for(unsigned int w=0; w<width; w+=subsamplingW)
{
double ray[3];
unsigned int idx = h*width + w;
ray[0] = (*R)(0, idx);
ray[1] = (*R)(1, idx);
ray[2] = (*R)(2, idx);
double fStart = factorStart;
double fEnd = factorEnd;
if(sensortype==KINECT)
{
fStart *= 1.0 / ray[2];
fEnd *= 1.0 / ray[2];
}
coordsStart[size][0] = ray[0] * fStart;
coordsStart[size][1] = ray[1] * fStart;
coordsStart[size][2] = ray[2] * fStart;
coordsEnd[size][0] = ray[0] * fEnd;
coordsEnd[size][1] = ray[1] * fEnd;
coordsEnd[size][2] = ray[2] * fEnd;
size++;
}
// Displaying stuff
// ------------------------------------------------------------------
double bg[3] = {1.0, 1.0, 1.0};
Obvious3D viewer3D("Visualize ray casting for kinect", 1024, 768, 0, 0, bg);
viewer3D.addLines(coordsStart, coordsEnd, size);
if(sensortype==KINECT)
{
double** projectionPlane;
System<double>::allocate(4, 3, projectionPlane);
unsigned int idx = 0;
projectionPlane[0][0] = (*R)(0, idx); projectionPlane[0][1] = (*R)(1, idx); projectionPlane[0][2] = (*R)(2, idx);
idx = (height-subsamplingH) * width;
projectionPlane[1][0] = (*R)(0, idx); projectionPlane[1][1] = (*R)(1, idx); projectionPlane[1][2] = (*R)(2, idx);
idx = (height-subsamplingH) * width + width-subsamplingW;
projectionPlane[2][0] = (*R)(0, idx); projectionPlane[2][1] = (*R)(1, idx); projectionPlane[2][2] = (*R)(2, idx);
idx = width-subsamplingW;
projectionPlane[3][0] = (*R)(0, idx); projectionPlane[3][1] = (*R)(1, idx); projectionPlane[3][2] = (*R)(2, idx);
for(unsigned int i=0; i<3; i++)
{
projectionPlane[0][i] /= (projectionPlane[0][2]/(factorStart-0.01));
projectionPlane[1][i] /= (projectionPlane[1][2]/(factorStart-0.01));
//.........这里部分代码省略.........