[发明专利]位姿确定方法及装置、电子设备和存储介质有效
申请号: | 202010826704.X | 申请日: | 2020-08-17 |
公开(公告)号: | CN111983635B | 公开(公告)日: | 2022-03-29 |
发明(设计)人: | 刘浩敏;杭蒙;张壮;章国锋 | 申请(专利权)人: | 浙江商汤科技开发有限公司 |
主分类号: | G01S17/89 | 分类号: | G01S17/89;G01S17/86;G01C21/16 |
代理公司: | 北京林达刘知识产权代理事务所(普通合伙) 11277 | 代理人: | 刘新宇 |
地址: | 311215 浙江省杭州市萧*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 确定 方法 装置 电子设备 存储 介质 | ||
1.一种位姿确定方法,其特征在于,所述方法包括:
获取目标场景中的第一终端采集的采集数据;
获取包含所述目标场景的全局地图,其中,所述全局地图基于第二终端对包含所述目标场景的全局场景进行数据采集所获得的地图数据生成,且所述全局地图满足精度条件;
根据所述采集数据以及所述全局地图之间的特征对应关系,确定所述第一终端在采集过程中的至少一个第一位姿;
其中,所述地图数据包括:所述全局场景中的激光点云、第二采集图像以及第二IMU数据;
所述方法还包括:
获取通过第二终端采集的所述全局场景的地图数据;
根据所述地图数据,对所述全局场景进行离线重建,生成所述全局场景的全局地图。
2.根据权利要求1所述的方法,其特征在于,所述全局地图包括至少一帧视觉点云,所述视觉点云包括所述全局场景中的至少一个三维特征点;所述采集数据包括第一采集图像;
所述根据所述采集数据以及所述全局地图之间的特征对应关系,确定所述第一终端在采集过程中的至少一个第一位姿,包括:
将所述第一采集图像与所述至少一帧视觉点云进行特征匹配,得到全局特征匹配结果;
根据所述全局特征匹配结果,确定所述第一终端在采集过程中的至少一个第一位姿。
3.根据权利要求1或2所述的方法,其特征在于,所述全局地图包括所述目标场景中的至少一帧视觉点云;所述采集数据包括至少两帧第一采集图像;
所述根据所述采集数据以及所述全局地图之间的特征对应关系,确定所述第一终端在采集过程中的至少一个第一位姿,包括:
将所述第一采集图像与所述至少一帧视觉点云进行特征匹配,得到全局特征匹配结果;
根据所述至少两帧第一采集图像,进行特征匹配,得到本地特征匹配结果;
根据所述全局特征匹配结果和所述本地特征匹配结果,确定所述第一终端在采集过程中的至少一个第一位姿。
4.根据权利要求3所述的方法,其特征在于,所述采集数据还包括第一惯性测量IMU数据;
所述根据所述全局特征匹配结果和所述本地特征匹配结果,确定所述第一终端在采集过程中的至少一个第一位姿,包括:
根据所述全局特征匹配结果和/或所述本地特征匹配结果,获取第一约束信息;
根据所述第一IMU数据,获取第二约束信息;
根据所述第一约束信息和所述第二约束信息中的至少一种,对所述全局特征匹配结果和所述本地特征匹配结果进行处理,得到所述第一终端在采集过程中的至少一个第一位姿;
其中,所述第一约束信息为视觉约束,所述第二约束信息为IMU约束。
5.根据权利要求4所述的方法,其特征在于,所述对所述全局特征匹配结果和所述本地特征匹配结果进行处理,包括:
通过光束法平差对所述全局特征匹配结果和所述本地特征匹配结果进行处理。
6.根据权利要求2所述的方法,其特征在于,所述将所述第一采集图像与所述至少一帧视觉点云进行特征匹配,得到全局特征匹配结果,包括:
将所述第一采集图像中的二维特征点,与所述至少一帧视觉点云包括的三维特征点进行匹配,得到全局特征匹配结果。
7.根据权利要求1或2所述的方法,其特征在于,所述方法还包括:
根据所述第一终端在采集过程中的至少一个第一位姿,确定运动真值数据。
8.根据权利要求7所述的方法,其特征在于,所述根据所述第一终端在采集过程中的至少一个第一位姿,确定运动真值数据,包括:
将所述第一终端在采集过程中的至少一个第一位姿作为所述运动真值数据;和/或,
将所述采集数据中的至少一种,以及所述第一终端在采集过程中的至少一个第一位姿,作为所述运动真值数据,其中,所述采集数据包括:
无线网络WiFi数据、蓝牙数据、地磁数据、超宽带UWB数据、第一采集图像以及第一IMU数据中的一种或多种。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于浙江商汤科技开发有限公司,未经浙江商汤科技开发有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010826704.X/1.html,转载请声明来源钻瓜专利网。