基于SINS速度信息的里程计参数快速标定方法.pdf
《基于SINS速度信息的里程计参数快速标定方法.pdf》由会员分享,可在线阅读,更多相关《基于SINS速度信息的里程计参数快速标定方法.pdf(7页珍藏版)》请在咨信网上搜索。
1、文章编号:0258-2724(2024)02-0431-07DOI:10.3969/j.issn.0258-2724.20210956基于 SINS 速度信息的里程计参数快速标定方法周召发1,梁哲1,徐志浩1,常振军1,陈河2,赵芝谦1(1.火箭军工程大学导弹工程学院,陕西西安710025;2.火箭军研究院,北京100094)摘要:针对里程计标度因数误差和安装误差对捷联惯导/里程计组合导航精度的显著影响,提出一种基于短时捷联惯导系统(strapdowninertialnavigationsystem,SINS)速度信息的里程计参数标定方法.通过建立航位推算误差模型,构建惯性测量单元(inert
2、ialmeasurementunit,IMU)坐标系内惯导系统输出速度与里程计输出之间的关系式,得到里程计参数的计算公式;利用最小二乘法对里程计标度因数和安装误差进行标定.该方法只利用了捷联惯导信息,在 1min 内就可实现里程计参数的初次标定,不需要相关参数误差值为小量的假设,并可以忽略杆臂效应对标定效果的影响.试验结果表明:当车辆行驶 30min 后,利用该方法标定后的水平航位推算精度比传统标定方法定位精度高 92.3%.关键词:车辆里程计;标度因数;安装误差;捷联惯导;最小二乘中图分类号:TN96文献标志码:AFast Calibration Method of Odometer Par
3、ameters Based onSpeed Information of Strapdown Inertial Navigation SystemZHOU Zhaofa1,LIANG Zhe1,XU Zhihao1,CHANG Zhenjun1,CHEN He2,ZHAO Zhiqian1(1.MissileEngineeringInstitute,RocketForceUniversityofEngineering,Xian710025,China;2.AcademicoftheRocketForce,Beijing100094,China)Abstract:To solve the pro
4、blem that the scale factor error and installation error of odometers have a greatinfluence on the accuracy of strapdown inertial navigation/odometer integrated navigation,a fast calibrationmethodbasedonshort-termSINS(strapdowninertialnavigationsystem)informationisproposedforodometerparameters.By est
5、ablishing a dead-reckoning error model,the relationship between the output speed of theinertialnavigationsystemandtheoutputoftheodometerintheinertialmeasurementunit(IMU)coordinatesystemisconstructed,andtheformulaofcalculatingtheodometerparametersisobtained.Theleastsquaresmethodisutilizedtocalibratet
6、heodometerscalefactorandinstallationerror.Thismethodonlyusesstrap-downinertialnavigationinformationtoachievetheinitialcalibrationoftheodometerparameterswithin1min.Itdoesnotrequiretheassumptionthattheerrorvalueoftherelevantparametersissmall,andignorestheinfluenceoftheleverarmeffectonthecalibrationeff
7、ect.Thetestresultsshowthat,whenthevehiclehasbeenrunningfor30min,theaccuracyofthehorizontaldead-reckoningmethodcalibratedbythismethodis92.3%higherthanthatofthetraditionalcalibrationmethod.Key words:odometer;scalefactor;installationerror;SINS;leastsquaresmethod捷 联 惯 导 系 统(strapdown inertial navigation
8、system,SINS)具有自主性强、隐蔽性好等突出优点,因此被广泛应用于军事导航系统中.然而,SINS 误差会随时间积累1-2,为提高长时间系统定位精度,收稿日期:2021-11-12修回日期:2022-04-18网络首发日期:2022-05-20基金项目:航空科学基金(201808U8004)第一作者:周召发(1973),男,教授,博士,研究方向为组合导航,E-mail:引文格式:周召发,梁哲,徐志浩,等.基于 SINS 速度信息的里程计参数快速标定方法J.西南交通大学学报,2024,59(2):431-437ZHOUZhaofa,LIANGZhe,XUZhihao,etal.Fastca
9、librationmethodofodometerparametersbasedonspeedinformationofstrapdowninertialnavigationsystemJ.JournalofSouthwestJiaotongUniversity,2024,59(2):431-437第59卷第2期西南交通大学学报Vol.59No.22024年4月JOURNALOFSOUTHWESTJIAOTONGUNIVERSITYApr.2024通常需要与其他传感器进行互补工作,如全球导航卫星系统(globalnavigationsatellitesystem,GNSS)3.但在军事应用等特
10、殊环境下可能无法接收到卫星信号,而里程计(odometer,OD)可以在 GNSS 不可用时有效减小车辆导航误差漂移.因此,捷联惯导/里程计组合导航技术具有重要意义4-5,受到了国内外广泛的关注.当前,武器装备对导航精度的要求越来越高,这就需要对各种参数进行更为准确和高效的标定6-8.在使用里程计前,需要对里程计标度因数、安装矩阵和杆臂参数进行标定9,可采用在线和离线标定方法对其定期重新标定4-10.文献11基于车辆的运动约束,利用卡尔曼滤波对标度因数误差进行最优估计,但需要事先对里程计安装误差进行标定;文献12通过建立航位推算误差模型,对参数进行在线辨识,提高了导航精度,但需要依靠 GNSS
11、 信息;文献13-14将航位推算的位置信息作为量测,对参数进行在线标定;文献15基于运动学非完整约束将加速度和速度作为量测,对里程计参数进行辨识;文献16设计了一个两级式卡尔曼滤波器,对里程计参数进行了最优估计;文献17利用扩展卡尔曼滤波器对里程计误差进行在线估计和补偿.上述文献以及传统基于地标点的里程计参数标定方法都需要较长的时间,且大多未考虑杆臂效应对标定精度的影响,并要求相关参数误差值为小量,但初次标定时,可能难以满足该要求.针对上述不足,本文提出一种基于短时 SINS速度信息的里程计参数标定方法,仅依靠 SINS,标定时间短且不要求相关参数误差值为小量,并可以忽略杆臂效应对标定效果的影
12、响,既可用于相关参数完全未知情况下的初次标定,也可用于定期维护标定.1 航位推算误差模型里程计和惯性测量单元(inertialmeasurementunit,IMU)在车辆上的安装关系如图 1 所示.图中:O 为 IMU 中心,P 为里程计测量点,L 为点 P 相对点 O 的杆臂.定义 IMU 坐标系为 s 系,惯性坐标系为 i 系,载体坐标系为 b 系,东北天(ENU)坐标系为导航坐标系 n 系,地球坐标系为 e 系.VOD设点 P 的前向速度大小为 v,里程计测量点的对地速度为,里程计标度因数为 KOD,结合车辆正常行驶时横向和天向速度为 0 的运动约束条件,可得Sbj=0Sj0T=0KO
13、DNj0T,(1)VbOD=0v0T=Sbjt,(2)NjtSjt式中:为第 j 个里程计脉冲输出,j=1,2,;为采样间隔;为时间内的里程增量;上标 b 为坐标 b 系变量,其他坐标系类似.ysIMUOPzbybzsL图1里程计和 IMU 安装关系示意Fig.1SchematicofinstallationconnectionforodometerandIMU考虑到里程计存在标度因数误差,则Sbj=(1+KOD)Sbj,(3)VbOD=Sbjt=VbOD+KODVbOD,(4)()()式中:为对应物理量的误差,为对应物理量的实际测量值,下文类似.VsSINS设 IMU 中心对地速度为,根据图
14、 1 有VsOD=VsSINS+sebLs=VsSINS+VsL,(5)ebVL式中:为 b 系相对 e 系的转速,为由杆臂 L 引起的杆臂速度.由里程计测量结果得到点 O 的速度为VsDR=CsbVbOD sebLs,(6)Csb式中:为 s 系和 b 系之间坐标变换矩阵的标定值,是 IMU 安装矩阵.CsbCsbCsb=Csb(I+)设与之间的失准角为,满足,代入式(6),保留一阶小量,整理可得VsDR=CsbVbOD sebLs VsSINS+KODVsODCsb(VbOD)sebLs+Lsseb.(7)seb考察,有 seb=sib sie=sib+sCsnCneeie,(8)sib
15、siesCneCsn式中:为陀螺仪测量的角速度值在 s 系下的投影;为地球自转角速度在 s 系下的投影;为陀螺漂移在 s 系下的投影;为 n 系相对于 e 系的姿态矩阵,如式(9)所示;为 SINS 输出的 IMU 姿态432西南交通大学学报第59卷eie矩阵;为地球的理论自转角速度.Cne=(In)Cne,=Lcos Lsin L=Mp,(9)Cnep=LhTM=1000cos L00sin L0式中:为 n 系相对于 e 系的姿态矩阵理想值,L、h 分别为纬度、经度、高程,.Csn=Csn(I+)根据 SINS 姿态失准角的定义有.将式(9)代入式(8),保留一阶小量,整理可得seb=s+
16、Csn(nie)Csn(nie)Mp.(10)p考虑到地球自转角速度、失准角和位置误差可视为小量,略去乘积项可得seb s.(11)将式(11)代入式(7),由于陀螺漂移非常小,忽略陀螺漂移和杆臂矢量的乘积项,可得里程计测速模型为VsDR=VsSINS+KODVsODCsb(VbOD)sebLs,(12)则误差模型为VsDR=KODVsODCsb(VbOD)sebLs.(13)由式(13)可知,为保证导航精度,应事先通过标定尽可能提高里程计标度因数、安装矩阵和杆臂的标定精度.2 里程计参数标定方法、Cbs设 s 系与 b 系之间存在俯仰安装角、横滚安装角和方位安装角.定义 b 系相对 s 系抬
17、头时为正,右倾时为正,右转时为正(即 b 系由s 系按照“312”依次旋转欧拉角得到),则可表示为Cbs=cos cos+sin sin sin cos sin+sin cos sin sin cos sin cos cos cos sin sin cos cos sin sin sin sin cos cos sin cos cos.(14)由式(1)、(2)、(5)、(14)可得VsSINS,k=VsOD,kseb,kLs=sin cos cos cos sin KODNktseb,kLs,(15)VsSINS,kVsOD,kseb,kVsSINS、VsOD、seb式中:、分别为的第k 个
18、解算速度,k=1,2,m.式(15)可变为VsSINS,kt=xNkseb,kLst,(16)x=KODsin cos cos cos sin=x1x2x3T式中:.则式(16)可等价为Mk xLsT=Yk,(17)Mk=NkIt(seb,k)Yk=VsSINS,kt式中:,.若在一段时间内共测量到 m 组数据,则有M xLsT=Y,(18)M=MT1MT2 MTmT,Y=YT1YT2 YTmT式中:.xLs x理论上,通过最小二乘法可以基于式(17)求得和.由可得=tan1 x1 x2,=sin1 x3,KOD=x.(19)90 9090 90 x1 x2利用导航级 SINS 进行短时间导航
19、可以获得较高精度速度,从而确保式(19)的计算精度.需要注意的是,采用式(19)计算和的前提是,.一般在 0附近才满足该要求,但有可能超出该范围,此时,需要根据、的符号对计算结果进行调整,具体过程比较简单,这里不再赘述.MMsebseb=sen+snb=Csnnen+snbsennensnbnennen6.25106rad/ssensebsnbsnbM此外,式(19)有唯一最小二乘解的条件是的列满秩,即为 6,这就要求其各列线性无关.考察矩阵可知,其前 3 列线性无关,后 3 列线性无关与否取决于的变化情况.其中,.为 n 系相对 e 系的旋转角速度在s 系的投影;为 n 系相对于 e 系的旋
20、转角速度在n 系下的投影,其值与车辆速度有关;为 b 系相对于 n 系的旋转角速度在 n 系下的投影,其值与车辆的姿态变化有关.由于地球半径很大,车辆速度引起的一般很小.例如,如果设车辆速度为 40m/s(144km/h),带来的最大为.可见,对车辆而言,近似为 0,主要取决于,即载体的姿态变化情况.若车辆作直线运动,即载体无转弯、上下坡等运动时,姿态不发生改变,近似为 0,则的后 3 列往往是相关的,无法准确标定出杆臂误差.若要标定出杆臂误差,则应合理设计车辆第2期周召发,等:基于 SINS 速度信息的里程计参数快速标定方法433M的转弯和上下坡运动,从而使满秩.实际上,若里程计安装在车辆前
21、轮部分,则在转弯和上下坡时会引入额外的测速误差,从而降低标定精度.考虑到杆臂误差对组合导航精度的影响较小,在组合导航时进行在线标定即可,而里程计标度因数误差和安装矩阵标定误差的影响较大,需要进行事先标定.因此,可使车辆大体沿直线行驶,只对里程计标度因数和安装矩阵标定误差进行标定,此时可忽略里程计杆臂的影响,对式(16)求和可得mk=1VsSINS,kt=sin cos cos cos sin KODmk=1Nk=mk=1Nkx.(20)由式(20)可得 x=mk=1VsSINS,ktmk=1Nk,KOD=?mk=1VsSINS,kt?mk=1Nk.(21)实际应用中,若只有 SINS 速度信息
22、可供利用,为保证速度精度,标定时间不宜太长;若还有 GPS信息可用,则可以采用 SINS/GPS 组合导航提供高精度的 SINS 速度信息.此外,采用基于 SINS 速度信息的标定方案,不需要相关参数误差为小量的假设,可用于相关参数完全未知情况下的初次标定,也可用于定期维护标定.3 车载试验为验证本文所述算法的有效性,设计了跑车试验,如图 2 所示.相关设备参数如下:惯组采样频率 200Hz;激光陀螺常值漂移分别为 0.015、0.025、0.099/h;加速度计零偏分别为 1498、589、278g;GPS 导航轨迹为航位推算的位置参考基准,GPS 接收机定位精度 5m,输出频率 1Hz;里
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 SINS 速度 信息 里程计 参数 快速 标定 方法
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,个别因单元格分列造成显示页码不一将协商解决,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【自信****多点】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【自信****多点】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。