[发明专利]组合导航方法、电子设备及存储介质有效
申请号: | 202111375138.6 | 申请日: | 2021-11-19 |
公开(公告)号: | CN113804202B | 公开(公告)日: | 2022-02-22 |
发明(设计)人: | 宋振伟;张海强;李成军 | 申请(专利权)人: | 智道网联科技(北京)有限公司 |
主分类号: | G01C21/28 | 分类号: | G01C21/28;G01C21/20;G06K9/62 |
代理公司: | 北京中知君达知识产权代理有限公司 11769 | 代理人: | 张迪 |
地址: | 100013 北京市东*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 组合 导航 方法 电子设备 存储 介质 | ||
本申请是关于一种组合导航方法、电子设备及存储介质。所述组合导航基于轮速传感器,以及至少一种其他类别传感器实现组合导航,该方法包括:获取所述轮速传感器测得车辆某一时刻速度的速度绝对值;根据所述速度绝对值按照预设的规则获得所述轮速传感器以及其他类别传感器在卡尔曼滤波器中量测噪声被赋予的量测噪声影响因子;利用所述卡尔曼滤波器对所述轮速传感器以及其他类别传感器数据进行滤波融合,其中,滤波融合时的所述轮速传感器以及其他类别传感器数据中至少一者的量测噪声被赋予对应的所述量测噪声影响因子。本申请提供的方案,有利于组合导航中各传感器数据的融合,提升滤波收敛的速度。
技术领域
本申请涉及计算机技术领域,尤其涉及一种组合导航方法、电子设备及存储介质。
背景技术
随着人工智能、自动驾驶等技术的发展,高精度定位技术成为实现自动驾驶的至关重要的部分。一般情况下,为了实现高精度定位会采用在车辆上设置具有不同种类的传感器组成的组合导航。要想在现实复杂的环境中获得精确的定位,需要利用卡尔曼滤波算法对组合导航中的各数据进行融合,但是组合导航中各传感器受环境中噪声的影响程度不同,具有一定的差异性,不利于各传感器数据的融合。
发明内容
为解决或部分解决相关技术中存在的问题,本申请提供一种组合导航方法、电子设备及存储介质,该方法及相关装置有利于组合导航中各传感器数据的融合,提升滤波收敛的速度。
本申请第一方面提供一种组合导航方法,所述组合导航基于轮速传感器,以及至少一种其他类别传感器实现组合导航,包括:
获取所述轮速传感器测得车辆某一时刻速度的速度绝对值;
根据所述速度绝对值按照预设的规则获得所述轮速传感器以及其他类别传感器在卡尔曼滤波器中量测噪声被赋予的量测噪声影响因子;
利用所述卡尔曼滤波器对所述轮速传感器以及其他类别传感器数据进行滤波融合,其中,滤波融合时的所述轮速传感器以及其他类别传感器数据中至少一者的量测噪声被赋予对应的所述量测噪声影响因子。
在一种实施方式中,所述根据所述速度绝对值按照预设的规则获得所述轮速传感器以及其他类别传感器在卡尔曼滤波器中量测噪声被赋予的量测噪声影响因子,包括:
在同一时刻,根据获取车辆速度的所述速度绝对值,所述其他类别传感器所获得的在所述卡尔曼滤波器中量测噪声被赋予的量测噪声影响因子相同,或者,所述其他类别传感器所获得的在所述卡尔曼滤波器中量测噪声被赋予的量测噪声影响因子不同。
在一种实施方式中,所述其他类别传感器包括激光雷达传感器和卫星导航传感器,所述根据所述速度绝对值按照预设的规则获得所述其他类别传感器在卡尔曼滤波器中量测噪声被赋予的量测噪声影响因子,包括:
在同一时刻,根据获取车辆速度的所述速度绝对值,所述激光雷达传感器与所述卫星导航传感器所获得的在所述卡尔曼滤波器中量测噪声被赋予的量测噪声影响因子相同。
在一种实施方式中,所述预设的规则包括:预先建立所述速度绝对值与所述量测噪声影响因子取值相关的算法,按照所述算法将所述速度绝对值作为变量带入计算。
在一种实施方式中,所述预先建立所述速度绝对值与所述量测噪声影响因子取值相关的算法,按照所述算法将所述速度绝对值作为变量带入计算,包括:
获取所述其他类别传感器在卡尔曼滤波器中第一时刻的初始量测噪声和偏移角;
根据所述轮速传感器在所述第一时刻的速度绝对值获取车辆在该时刻前进的最大距离;
根据所述最大距离以及所述偏移角得到相对第一时刻的下一时刻车辆前进的估算误差;
基于所述初始量测噪声和所述估算误差获得所述下一时刻的量测噪声影响因子。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于智道网联科技(北京)有限公司,未经智道网联科技(北京)有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111375138.6/2.html,转载请声明来源钻瓜专利网。