CN114935345B 一种基于模式识别的车载惯导安装角误差补偿方法 (浙江工业大学)_第1页
CN114935345B 一种基于模式识别的车载惯导安装角误差补偿方法 (浙江工业大学)_第2页
CN114935345B 一种基于模式识别的车载惯导安装角误差补偿方法 (浙江工业大学)_第3页
CN114935345B 一种基于模式识别的车载惯导安装角误差补偿方法 (浙江工业大学)_第4页
CN114935345B 一种基于模式识别的车载惯导安装角误差补偿方法 (浙江工业大学)_第5页
已阅读5页,还剩19页未读 继续免费阅读

下载本文档

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

一种基于模式识别的车载惯导安装角误差本发明提供一种基于模式识别的车载惯导陀螺仪z轴输出值投影在车体系上得到车体横摆2步骤S4、利用惯导设备系与车身坐标系的转换矩阵将陀螺仪z轴输出值投影在车体系步骤S7、通过CAN接收车速信息,利用车体横摆角速度其中,IMUarw和IMUvrw为陀螺的随机游走系数和加速度计的随机游走系数,IMUgpsd和3err由安装角误差角和车速尺度因子组成;量Xprior进行量测更新得到后验误差状态向步骤S6-4、对步骤S5中捷联惯导更新得到的姿态位置pIMU和速度vIMU减去后验误差状态向量Xpost中的姿态误差iqn.post、位置误差δpn_post和速度误差δvn_post:度wbzv_filtered和CAN车速v步骤S7-2、当vfiltered大于车速第一阈值,wbzv_filtered4在高速直行运动状态下,选择组合导航的速度估计结果与加入尺度因子的CAN车速的ins为步骤S6中组合导航速度估计结果,是一个在其他运动状态下,选择组合导航的速度估计结果与不加入尺度因子的CAN车速的差DCMi-为上一时刻的惯导设备系与车身坐标系的转换矩阵。5[0003]组合导航应用在车载环境时,惯性导航设备安装时无法与车身坐标系完全对齐,将θrp和θy通过欧拉角转姿态阵公6[0028]其中,vgnss为GNSS输出的三维速度,vIMU为步骤S5中捷联惯导更新输出的三维速gnss为GNSS输出的位置(包括经纬高信息),pIMU步骤S5中捷联惯导更新输出的位置(包7[0035]步骤S6-4、对步骤S5中捷联惯导更新得到的姿态pimu位置pIMU和速度vIMU减去后验状态量Xpost中的姿态误差iqn.post、位置误差δpn_post和速度误差δvn_post。通过卡尔曼滤波器进行惯导安装角误差和CAN车速尺度误差估计。而在其他运动状态下,[0047]在高速直行运动状态下,选择组合导航的速度估计结果与加入尺度因子的CAN车就是pins,对应到旋转矩阵即为与组合导航姿态估计结果pins实质上相同。8惯导设备航向角安装角误差修正当前CAN车速尺9速度计速度abxyz进行滑动窗口均值预将θrp和θy通过欧拉角转姿态阵公式计算出惯性导航设备系与车体系之间的姿态转换矩阵DCMg。在本实施例中,安装角通过卡尔曼滤波器进行惯导安装角误差和CAN车速尺度误差估计。而在其他运动状态下,[0109]在高速直行运动状态下,选择组合导航的速度估计结果与CA

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

评论

0/150

提交评论