[发明专利]定位方法及装置、设备、存储介质有效
申请号: | 202111154872.X | 申请日: | 2021-09-29 |
公开(公告)号: | CN113899364B | 公开(公告)日: | 2022-12-27 |
发明(设计)人: | 陈丹鹏;王楠 | 申请(专利权)人: | 深圳市慧鲤科技有限公司 |
主分类号: | G01C21/16 | 分类号: | G01C21/16;G01C21/20;G06T7/70 |
代理公司: | 深圳市威世博知识产权代理事务所(普通合伙) 44280 | 代理人: | 何倚雯 |
地址: | 518000 广东省深圳市前海深港合作区前*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 定位 方法 装置 设备 存储 介质 | ||
1.一种定位方法,其特征在于,包括:
获取第一历史图像帧的拍摄时间至目标图像帧的拍摄时间的拍摄期间测量得到的若干惯性测量数据;
基于所述若干惯性测量数据进行定位处理,得到所述第一历史图像帧与所述目标图像帧之间的位姿变化信息;
基于所述位姿变化信息以及至少一个参考因子,确定所述目标图像帧的位姿,其中,所述至少一个参考因子包括所述若干惯性测量数据;
其中,所述基于所述位姿变化信息以及至少一个参考因子,确定所述目标图像帧的位姿,包括:
基于所述位姿变化信息,确定所述目标图像帧的第一位姿;以及,
利用所述位姿变化信息以及所述至少一个参考因子,构建本次定位对应的总能量关系,其中,本次定位对应的总能量关系用于确定所述目标图像帧的需优化的位姿偏差;
利用本次定位对应的总能量关系,对所述第一位姿进行优化,得到所述目标图像帧的位姿;
其中,所述利用所述位姿变化信息以及所述至少一个参考因子,构建本次定位对应的总能量关系,包括:
分别利用每个所述参考因子,确定所述参考因子对应的测量能量关系,以及,
利用所述位姿变化信息确定运动先验能量关系;
基于所述运动先验能量关系以及每个所述参考因子对应的测量能量关系,构建本次定位对应的总能量关系。
2.根据权利要求1所述的方法,其特征在于,所述至少一个参考因子还包括关于所述目标图像帧和第一历史图像帧的图像信息。
3.根据权利要求 1所述的方法,其特征在于,所述分别利用每个所述参考因子,确定所述参考因子对应的测量能量关系,包括:
获取所述若干惯性测量数据的预积分信息;
利用所述若干惯性测量数据的预积分信息,构建惯性测量能量关系。
4.根据权利要求1所述的方法,其特征在于,所述位姿变化信息包括至少一种位姿变化量,所述至少一种位姿变化量包括位置变化量和/或姿态变化量;所述利用所述位姿变化信息确定运动先验能量关系,包括:
利用至少一次定位对应的若干参数,确定运动先验能量关系,其中,所述至少一次定位包括本次定位,每次所述定位对应的若干参数包括所述定位过程中得到的所述位姿变化量、所述定位过程中采用的所述若干惯性测量数据的起始测量时刻和结束测量时刻的位置差、以及所述起始测量时刻对应的起始姿态信息。
5.根据权利要求4所述的方法,其特征在于,所述位姿变化信息还包括所述位姿变化量的确定度表征信息;所述利用至少一次定位对应的若干参数,确定运动先验能量关系,包括:
基于每次定位过程中得到的所述确定度表征信息,得到对应次定位的权重;
利用所述至少一次定位的权重以及所述若干参数,确定运动先验能量关系;
和/或,所述至少一次定位为多次定位,所述利用至少一次定位对应的若干参数,确定运动先验能量关系,包括:
从所述多次定位中,剔除满足去除条件的定位;其中,所述去除条件为所述定位对应的位姿变化量以及所述位姿变化量的确定度表征信息之间的预设处理结果满足第一预设要求;
利用经剔除后的剩余次定位对应的若干参数,确定运动先验能量关系。
6.根据权利要求4所述的方法,其特征在于,所述起始姿态信息包括偏航角信息;
和/或,每次定位对应的所述第一历史图像帧与所述目标图像帧中,拍摄最早的图像帧为起始图像帧,拍摄最晚的图像帧为结束图像帧;在所述利用至少一次定位对应的若干参数,确定运动先验能量关系之前,所述方法还包括:
将所述至少一次定位中的每次定位作为目标定位,基于所述目标定位对应的若干惯性测量数据的预积分信息、起始图像帧的位姿和所述结束图像帧的位姿,确定所述目标定位对应的所述起始姿态信息、所述起始测量时刻的位置和所述结束测量时刻的位置。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳市慧鲤科技有限公司,未经深圳市慧鲤科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111154872.X/1.html,转载请声明来源钻瓜专利网。