OpenCV C++调用triangulatePoints时KeyPoint转cv::Mat报错问题
三角化断言错误修正方案
错误根因
该断言来自cv::sfm::triangulatePoints对输入2D点矩阵的格式校验:要求每个视图对应的2D点矩阵必须是2行N列结构(第一行存储所有点的x坐标,第二行存储所有点的y坐标),且数据类型为双精度浮点CV_64F。
当前实现存在3处不符合要求的问题:
- 用
std::vector<cv::Point2f>构造的Mat默认是N行2列结构(每行对应一个点的(x,y)坐标),行列维度完全颠倒 - 默认构造的Mat数据类型为
CV_32F,不符合SfM模块的精度要求 - 输出参数类型错误:该函数输出为单个
cv::Mat,而非std::vector<cv::Mat>
具体修正步骤
修正2D点矩阵的构造逻辑
原有的Point坐标提取逻辑无需改动,只需对构造好的原始Mat做转置和类型转换,两个视图的点都按此处理:// 第一个视图点矩阵修正 std::vector<cv::Point2f> points_1; // ... 原有的遍历keypoints提取pt的逻辑保持不变 cv::Mat pointmatrix1_raw(points_1); cv::Mat pointmatrix1 = pointmatrix1_raw.t(); // 转置为2行N列 pointmatrix1.convertTo(pointmatrix1, CV_64F); // 转换为双精度浮点 // 第二个视图点矩阵修正 std::vector<cv::Point2f> points_2; // ... 原有的遍历keypoints提取pt的逻辑保持不变 cv::Mat pointmatrix2_raw(points_2); cv::Mat pointmatrix2 = pointmatrix2_raw.t(); pointmatrix2.convertTo(pointmatrix2, CV_64F);校验并修正投影矩阵格式
输入的投影矩阵Proj_matrices也需要满足3行4列、CV_64F的要求,若原有投影矩阵是单精度或维度不符,需统一转换:std::vector<cv::Mat> Proj_matrices_correct; for (const auto& P : Proj_matrices) { CV_Assert(P.rows == 3 && P.cols == 4); // 校验投影矩阵维度是否为3×4 cv::Mat P_correct; P.convertTo(P_correct, CV_64F); Proj_matrices_correct.push_back(P_correct); }修正输出参数声明
三角化输出为4行N列的齐次坐标格式Mat,替换原有的vector类型输出声明:cv::Mat points3D; // 输出为单个Mat,维度为4×N std::vector<cv::Mat> points_all = {pointmatrix1, pointmatrix2}; cv::sfm::triangulatePoints(points_all, Proj_matrices_correct, points3D);
后续坐标转换说明
三角化得到的points3D是齐次坐标,若需要转为常规欧氏3D坐标,可执行归一化:
cv::Mat points3D_euclidean; // 先转置为N行4列的齐次点,再转换为N行3列的欧氏坐标 cv::convertPointsFromHomogeneous(points3D.t(), points3D_euclidean);
内容的提问来源于stack exchange,提问作者Stark
相关产品推荐
相关产品推荐

