【技术实现步骤摘要】
一种智能车GPS信号丢失情况下的多IMU定位方法
[0001]本专利技术涉及智能网联汽车定位
,具体为一种智能车GPS信号丢失情况下的多IMU定位方法。
技术介绍
[0002]智能网联汽车是指采用各种传感器和人工智能的手段达到自动驾驶、避障、规划路线等,综合了感知、定位、决策、控制技术,形成的技术原理先进、具有新技术、新结构的汽车。
[0003]发展智能网联汽车是我国从汽车大国迈向汽车强国的必由之路。是应对道路拥堵,避免交通事故的战略举措,已成为当前世界各国争相发展的重点。智能网联汽车具有共享性、开放性和智能性等优点,是最具有发展前途和潜力的汽车发展的必由之路。定位是其实现车联网以及做出各种规划决策方案的前提之一,会直接影响智能网联汽车的决策正确性和安全性,而实际驾驶中,各个道路并不是都能完全被卫星覆盖,GPS信号丢失情况下定位的安全性和准确性就大大降低,因此针对GPS信号丢失情况下的定位精确性需要进一步提高,以保证汽行驶的安全性。
技术实现思路
[0004]本专利技术提供了一种智能车GPS信号丢失情况下的多IMU定位方法,具备针对GPS信号丢失情况下的提供定位的精确性及保证汽行驶安全性的优点,解决了GPS信号丢失下对智能汽车实现更高精度的定位,降低在价格上,和算法上的消耗,为大众解决实际中GPS信号丢失情况下的汽车定位难的问题。
[0005]为实现以上目的,本专利技术提供如下技术方案予以实现:一种智能车GPS信号丢失情况下的多IMU定位方法,首先通过卫星的伪距信息和星历信息针对 ...
【技术保护点】
【技术特征摘要】
1.一种智能车GPS信号丢失情况下的多IMU定位方法,其特征在于:首先通过卫星的伪距信息和星历信息针对GPS采用伪距法定位并用扩展卡尔曼滤波对其进行预测输出一个位置信息(x
G
,y
G
,z
G
);同时,对多个IMU进行虚拟融合,在与GPS融合前,先对多个IMU的加速度和角速度进行融合,融合后将其利用旋转矩阵实现IMU的坐标变化,然后对IMU进行自适应扩展卡尔曼滤波预测,输出多IMU下的位置信息(x
I
,y
I
,z
I
);最后将GPS和IMU利用最大相关熵卡尔曼滤波进行融合,输出位置信息(x,y,z)。2.根据权利要求1所述的一种智能车GPS信号丢失情况下的多IMU定位方法,其特征在于:包括以下步骤:S1:同时获取GPS的伪距信息和星历信息,融合多个IMU转换为虚拟IMU;S2:对GPS进行扩展卡尔曼滤波位置估计,输出GPS坐标下的位置信息;对虚拟IMU进行自适应扩展卡尔曼滤波位置估计,获得虚拟IMU下的位置信息;S3:利用最大相关熵卡尔曼滤波融合GPS和虚拟IMU获得最终位置。3.根据权利要求2所述的一种智能车GPS信号丢失情况下的多IMU定位方法,其特征在于:S1中星历信息和伪距的获取设计为:从车辆GPS原始数据中直接提取星历信息和伪距信息,对S1中多个IMU融合成一个虚拟IMU:对S1中多个IMU融合成一个虚拟IMU:对S1中多个IMU融合成一个虚拟IMU:n其中,T
*
表示DCM旋转矩阵,θ,φ,ψ为单个IMU输出的欧拉角,ω
m
是对每个IMU输出角速读融合后的方差,a
m
是对多个加速度融合后的方差。4.根据权利要求2所述的一种智能车GPS信号丢失情况下的多IMU定位方法,其特征在于:对S2中GPS扩展卡尔曼滤波方案设计为:状态方程和观测方程设计为:扩展卡尔曼滤波预测方程设计为:扩展卡尔曼滤波预测方程设计为:扩展卡尔曼滤波更新方程设计为:
其中,是k时刻的GPS输出的位置;A是状态方程的雅克比行列式;C是观测ρ的雅克比行列式,R是测量噪声v
k
的协方差,根据经验设定;K
k
表示(R,P<...
【专利技术属性】
技术研发人员:付主木,刘雨轩,司鹏举,陶发展,马浩翔,王楠,朱龙龙,王永强,冀保峰,张中才,唐小林,
申请(专利权)人:河南科技大学,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。