slam十四讲中遇到的小问题,关于keypoints类和matches类:keypoints_1[m.queryIdx]

代码如下:

vector<KeyPoint> keypoints_1, keypoints_2;
vector<DMatch> matches;
find_feature_matches ( img_1, img_2, keypoints_1, keypoints_2, matches );
cout<<"一共找到了"<<matches.size() <<"组匹配点"<<endl;
for ( DMatch m:matches )
{
        //提取特征点的深度值:
        //很奇怪,下面代码得出的y,x是小数点的,要用int强制类型转换
        //cout << "y=" << keypoints_1[m.queryIdx].pt.y << "x=" << keypoints_1[m.queryIdx].pt.x <<endl ;
        ushort d = d1.ptr<unsigned short> ( int( keypoints_1[m.queryIdx].pt.y )) [ int ( keypoints_1[m.queryIdx].pt.x ) ];
	    if ( d == 0 )   // bad depth
            continue;
        
        float dd = d/5000.0; //dd就是相机坐标系下的z坐标,这就是所谓深度的概念?
        Point2d p1 = pixel2cam ( keypoints_1[m.queryIdx].pt, K ); //像素坐标转相机归一化坐标
        pts_3d.push_back ( Point3f ( p1.x*dd, p1.y*dd, dd ) );//dd就是相机坐标系下的z坐标,
  • 4
    点赞
  • 11
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值