[发明专利]基于机器学习的车载导航方法、装置和计算机设备在审
申请号: | 202011339096.6 | 申请日: | 2020-11-25 |
公开(公告)号: | CN112595313A | 公开(公告)日: | 2021-04-02 |
发明(设计)人: | 韩厚增;廖建平;余绪庆;陈伟;李昕;刘神;柳絮;程鑫 | 申请(专利权)人: | 北京海达星宇导航技术有限公司;广州中海达卫星导航技术股份有限公司 |
主分类号: | G01C21/16 | 分类号: | G01C21/16;G01C21/26;G01S19/47;G06N3/04;G06N3/08 |
代理公司: | 广州华进联合专利商标代理有限公司 44224 | 代理人: | 杜娟娟 |
地址: | 100089 北京市海*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 基于 机器 学习 车载 导航 方法 装置 计算机 设备 | ||
1.一种基于机器学习的车载导航方法,其特征在于,所述方法包括:
(1)建立VDM辅助的IMU误差修正模型;
(2)建立BDS/IMU/VDM组合导航模型;
(3)当BDS处于正常导航状态时,建立机器学习训练模型,得到训练后的机器学习模型;其中,将IMU经过力学编排及VDM修正得到的位置和速度作为训练输入样本,BDS/IMU/VDM组合滤波输出作为输出样本;
(4)当BDS处于失锁状态时,基于所述训练后的机器学习模型预测滤波输出值,修正IMU/VDM解算的位置和速度信息。
2.根据权利要求1所述的方法,其特征在于,所述VDM辅助的IMU误差修正模型包括:
采用15维状态参数的状态方程:
式中:δrN,δrE,δrD,δvN,δvE,δvD,δψN,δψE,δψD为位置、速度、姿态在三个方向上的误差;为加速度计在三个方向上的零偏;εbx,εby,εbz为陀螺在三个方向上的零偏;
对应的第k时刻的状态方程离散化表达式为:
xk=Φk,k+1xk-1+wk,wk~N(0,Qk)
式中,N是wk服从(0,Qk)分布的专用符号,Φk,k+1为误差量的状态转移矩阵,Qk为状态方程的噪声方差阵;
车辆动力学模型提供车辆位置和行驶方向的速度,当轮胎不发生侧滑时,与车辆行驶方向的垂直方向速度与噪声的关系用非完整性约束模型表示为:
式中,Vby,Vbz为车辆在载体坐标系中垂直于车辆行驶方向的速度分量,vy,vz均为对应的高斯白噪声,则根据车辆动力学模型得到的速度观测量表示为:
Vbx为载体坐标系下X方向速度分量;为载体系b到导航系n的方向余弦矩阵;
动力学辅助的IMU误差修正模型的观测量表示如下:
式中,PINS与VINS分别表示经IMU计算的位置和速度信息,PVDM,VVDM分别表示经VDM计算的位置和速度信息;
对应的观测方程离散化表达式为:
zk=Hkzk+vk
式中,Hk为观测系数矩阵,vk为观测噪声系数。
3.根据权利要求2所述的方法,其特征在于,所述方法还包括:
基于所述状态方程和所述观测方程,构建卡尔曼滤波,预测过程表示如下:
式中,表示k时刻的状态先验估值,表示k-1时刻的状态估值,与分别为与的方差阵,Φk,k+1为k时刻的误差量的状态转移矩阵,Qk-1为k-1时刻的状态方程的噪声方差阵;相应的量测更新过程表示为:
其中,Kk为滤波增益矩阵,Rk为测量噪声协方差阵,Hk为观测系数矩阵,经过上述卡尔曼滤波过程,获取误差状态的最优估值,修正IMU的各项状态参数。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京海达星宇导航技术有限公司;广州中海达卫星导航技术股份有限公司,未经北京海达星宇导航技术有限公司;广州中海达卫星导航技术股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011339096.6/1.html,转载请声明来源钻瓜专利网。