UndistortKeyPoints(); ComputeStereoFromRGBD(imDepth); mvpMapPoints = vector<MapPoint*>(N,static_cast<MapPoint*>(NULL)); mvbOutlier = vector<bool>(N,false); // This is done only for the first Frame (or after a change in the calibration) if(mbInitialComputations) { ComputeImageBounds(imGray); mfGridElementWidthInv=static_cast<float>(FRAME_GRID_COLS)/static_cast<float>(mnMaxX-mnMinX); mfGridElementHeightInv=static_cast<float>(FRAME_GRID_ROWS)/static_cast<float>(mnMaxY-mnMinY); fx = K.at<float>(0,0); fy = K.at<float>(1,1); cx = K.at<float>(0,2); cy = K.at<float>(1,2); invfx = 1.0f/fx; invfy = 1.0f/fy; mbInitialComputations=false; } mb = mbf/fx; AssignFeaturesToGrid();
时间: 2024-04-03 15:37:19 浏览: 149
MapPoint:交互式在线地图查找附近的设施和街景拍摄-开源
这段代码看起来像是一个SLAM系统中的一部分,有一些计算机视觉相关的操作,比如去畸变、计算深度图、找到特征点,并将它们分配到一个网格中。其中,计算图像畸变的函数是UndistortKeyPoints(),计算深度图的函数是ComputeStereoFromRGBD()。还有一些变量的定义和初始化,比如相机内参fx、fy、cx、cy等。不过,我无法判断这段代码的具体功能和意义,需要更多上下文信息才能给出更准确的解释。
阅读全文