一种融合定位方法、电子设备、存储介质及程序产品与流程
本发明涉及导航定位,尤其涉及一种融合定位方法、电子设备、存储介质及程序产品。
背景技术:
1、随着科技技术的发展,导航定位在生活中变的越来越普及。例如,车辆定位导航或者机器人定位导航等中。在导航定位中,定位场景由单一室内场景或单一室外场景,逐步扩展至室内外连续的跨场景作业环境。例如,物流配送机器人、应急救援机器人、巡检机器人及服务机器人等,往往需要在建筑物内部、半开放空间以及室外道路之间连续运行,对定位系统在不同环境下的精度、稳定性和连续性提出了更高要求。
2、在现有定位技术中,激光定位和卫星定位(global navigation satellitesystem,gnss)分别在室内和室外环境中具有不可替代的技术优势。但是,两者的环境适应性不同,坐标系也不同。
3、例如,在室内环境下,由于建筑结构复杂、钢筋混凝土和金属设施密集,卫星信号易受到严重遮挡和多路径效应影响,gnss信号强度大幅衰减甚至完全丢失,无法提供连续、可靠的定位信息。在此类环境下,激光定位通过感知墙体、柱体、设备等稳定的几何结构特征,并利用点云匹配算法与预先构建的高精度地图进行比对,可在无卫星信号条件下实现厘米级定位精度,且不受电磁干扰影响,定位稳定性高,特别适用于室内、地下及半封闭空间。因此,在室内场景中,激光定位具有不可替代性,是实现高精度机器人自主导航与控制的关键基础。
4、在室外场景中,环境特征发生显著变化,室外场景中存在大范围开阔区域、植被覆盖、路面反射变化以及大量动态目标,激光雷达可感知的稳定几何特征相对减少,且点云分布随光照、季节和环境变化明显,容易出现特征退化问题。在此情况下,基于激光点云的匹配算法容易发生收敛不稳定、匹配误差增大甚至匹配失败,导致定位结果波动甚至轨迹漂移。相比之下,gnss定位在室外开阔环境中能够提供稳定的绝对地理位置信息,不依赖环境几何特征、覆盖范围广、长期稳定性好,尤其在大尺度场景下具有明显优势。
5、因此,现有技术中通常在室内定位中采用激光定位,在室外定位中采用gnss定位。而在跨场景中,如由室内进入室外场景或由室外进入室内场景中,通常难以实现连续的准确定位。因此,亟待提供一种融合定位方法实现多场景切换时的平滑定位,避免定位结果的瞬时跳变,从而引发物体如机器人的急停或偏航等问题。
技术实现思路
1、本发明提供了一种融合定位方法、电子设备、存储介质及程序产品,以实现多场景切换时的平滑、连续、准确定位。
2、根据本发明的一方面,提供了一种融合定位方法,该方法包括:
3、获取物体在卫星定位与激光定位中进行坐标系对齐时的坐标系转换关系;
4、根据所述坐标系转换关系,将物体当前时刻的卫星定位数据与激光定位数据转换至统一坐标系下,得到物体当前时刻的观测位姿坐标;
5、根据物体采用卫星定位时的参数信息确定卫星定位结果的置信度,并根据物体采用激光定位时的参数信息确定激光定位结果的置信度;
6、根据所述卫星定位结果的置信度、所述激光定位结果的置信度、激光测量噪声、以及卫星测量噪声,确定观测融合噪声;
7、根据所述观测融合噪声、物体定位的状态协方差矩阵、所述观测位姿坐标以及预测位姿坐标,确定物体当前时刻的融合位姿坐标。
8、根据本发明的另一方面,提供了一种融合定位装置,该装置包括:
9、坐标系转换关系获取模块,用于获取物体在卫星定位与激光定位中进行坐标系对齐时的坐标系转换关系;
10、观测位姿坐标确定模块,用于根据所述坐标系转换关系,将物体当前时刻的卫星定位数据与激光定位数据转换至统一坐标系下,得到物体当前时刻的观测位姿坐标;
11、定位结果的置信度确定模块,用于根据物体采用卫星定位时的参数信息确定卫星定位结果的置信度,并根据物体采用激光定位时的参数信息确定激光定位结果的置信度;
12、观测融合噪声确定模块,用于根据所述卫星定位结果的置信度、所述激光定位结果的置信度、激光测量噪声、以及卫星测量噪声,确定观测融合噪声;
13、融合位姿坐标确定模块,用于根据所述观测融合噪声、物体定位的状态协方差矩阵、所述观测位姿坐标以及预测位姿坐标,确定物体当前时刻的融合位姿坐标。
14、根据本发明的另一方面,提供了一种电子设备,所述电子设备包括:
15、至少一个处理器;以及与所述至少一个处理器通信连接的存储器;其中,
16、所述存储器存储有可被所述至少一个处理器执行的计算机程序,所述计算机程序被所述至少一个处理器执行,以使所述至少一个处理器能够执行本发明任一实施例所述的融合定位方法。
17、根据本发明的另一方面,提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机指令,所述计算机指令用于使处理器执行时实现本发明任一实施例所述的融合定位方法。
18、根据本发明的另一方面,提供了一种计算机程序产品,包括计算机程序,所述计算机程序在被处理器执行时实现本发明任一实施例所述的融合定位方法。
19、本发明实施例的技术方案,通过获取物体在卫星定位与激光定位中进行坐标系对齐时的坐标系转换关系;根据坐标系转换关系将物体当前时刻的卫星定位数据与激光定位数据转换至统一坐标系下,得到物体当前时刻的观测位姿坐标;根据物体采用卫星定位时的参数信息确定卫星定位结果的置信度,根据物体采用激光定位时的参数信息确定激光定位结果的置信度;根据卫星定位结果的置信度、激光定位结果的置信度、激光测量噪声及卫星测量噪声,确定观测融合噪声;根据观测融合噪声、物体定位的状态协方差矩阵、观测位姿坐标及预测位姿坐标,确定物体当前时刻的融合位姿坐标,解决了跨场景定位时定位不准确的问题,通过在定位融合中考虑坐标系统一、定位结果的置信度以及测量误差融合,实现物体准确连续定位,提升多场景切换时的定位平滑度。
20、应当理解,本部分所描述的内容并非旨在标识本发明的实施例的关键或重要特征,也不用于限制本发明的范围。本发明的其它特征将通过以下的说明书而变得容易理解。
1.一种融合定位方法,其特征在于,包括:
2.根据权利要求1所述的方法,其特征在于,获取物体在卫星定位与激光定位中进行坐标系对齐时的坐标系转换关系,包括:
3.根据权利要求2所述的方法,其特征在于,获取物体采用卫星定位时的卫星位姿数据以及采用激光定位时的激光位姿数据,并形成一一对应的目标空间坐标对,包括:
4.根据权利要求2所述的方法,其特征在于,在对所述协方差矩阵进行奇异值分解得到旋转矩阵和平移向量之后,还包括:
5.根据权利要求1所述的方法,其特征在于,根据物体采用卫星定位时的参数信息确定卫星定位结果的置信度,并根据物体采用激光定位时的参数信息确定激光定位结果的置信度,包括:
6.根据权利要求1所述的方法,其特征在于,根据所述卫星定位结果的置信度、所述激光定位结果的置信度、激光测量噪声、以及卫星测量噪声,确定观测融合噪声,包括:
7.根据权利要求1所述的方法,其特征在于,根据所述观测融合噪声、物体定位的状态协方差矩阵、所述观测位姿坐标以及预测位姿坐标,确定物体当前时刻的融合位姿坐标,包括:
8.一种电子设备,其特征在于,所述电子设备包括:
9.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机指令,所述计算机指令用于使处理器执行时实现权利要求1-7中任一项所述的融合定位方法。
10.一种计算机程序产品,其特征在于,所述计算机程序产品包括计算机程序,所述计算机程序在被处理器执行时实现根据权利要求1-7中任一项所述的融合定位方法。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com