《一种基于激光陀螺捷联惯组的车载定位设备.pdf》由会员分享,可在线阅读,更多相关《一种基于激光陀螺捷联惯组的车载定位设备.pdf(19页珍藏版)》请在专利查询网上搜索。
1、10申请公布号CN104154916A43申请公布日20141119CN104154916A21申请号201410424446722申请日20140826201320539746020130830CNG01C21/18200601G01C21/2020060171申请人北京航天发射技术研究所地址100076北京市丰台区南大红门路1号申请人中国运载火箭技术研究院72发明人李宏李海洲孙谦山昆慕德74专利代理机构北京双收知识产权代理有限公司11241代理人李云鹏54发明名称一种基于激光陀螺捷联惯组的车载定位设备57摘要本发明为了增强武器系统的快速机动能力和目标命中精度,满足系统对车载导航设备的反应快。
2、、精度高、自主性强、可靠性好的要求,提出了一种基于激光陀螺捷联惯组的车载定位设备,包括采用激光陀螺的激光捷联惯组,还包括里程计组件测量车辆在地面行驶速度和距离;高程计组件测量车辆所在水平面的气压获取高度;兼容单天线和双天线的多模卫星系统;显控器组件将车载导航设备的定位信息与路网电子地图进行智能匹配。本发明利用激光陀螺精度高、性能稳定、动态范围宽、反应时间短、可靠性高等优点,基于数字滤波器的陀螺解调技术、多信息融合技术等方法,实现了高精度、自主性强、可靠性好的定位、定向功能。66本国优先权数据51INTCL权利要求书4页说明书11页附图3页19中华人民共和国国家知识产权局12发明专利申请权利要求。
3、书4页说明书11页附图3页10申请公布号CN104154916ACN104154916A1/4页21一种基于激光陀螺捷联惯组的车载定位设备,包括采用激光陀螺的激光捷联惯组,其特征在于,还包括里程计组件测量车辆在地面行驶速度和距离;高程计组件测量车辆所在水平面的气压获取高度;兼容单天线和双天线的多模卫星系统;显控器组件将车载导航设备的定位信息与路网电子地图进行智能匹配。2根据权利要求2的基于激光陀螺捷联惯组的车载定位设备,其特征在于,车载定位设备还包括导航处理单元,其利用零速修正原理和信息相似性原理,设计渐消记忆最小二乘滤波器和位置跟踪积分器,对激光捷联惯组在车辆上的安装误差角、里程计刻度系数误。
4、差进行在线辨识和修正。3根据权利要求14之一的基于激光陀螺捷联惯组的车载定位设备,其特征在于,电源模块包括二次电源,该二次电源接收外部供电单元提供的2030V直流电。4根据权利要求14之一的基于激光陀螺捷联惯组的车载定位设备,其特征在于,加表组件、陀螺组件和减震器分别与捷联惯组的本体连接。5根据权利要求14之一的基于激光陀螺捷联惯组的车载定位设备,其特征在于,激光捷联惯组包括依次连接的电源模块、减震器、加表组件、陀螺组件、I/F板、主控板、导航处理单元、多模卫星接收板;导航处理单元分别接收里程计组件和高程计组件的测量结果,并与上位机和显控器组件通信;多模卫星接收板与多模卫星天线连接。6根据权利。
5、要求14之一的基于激光陀螺捷联惯组的车载定位设备,其特征在于,里程计组件包括滤波和识别子单元,其将获得的车辆在地面行驶速度和距离信息进行智能识别和速度滤波;判别子单元,其对上述滤波和识别子单元的输出信号进行零速判别;捷联解算子单元,其与上述判别子单元的输出端连接,并利用捷联惯组的制导和导航信息共同进行捷联解算;航位推算子单元,其与上述捷联解算子单元的输出端相连接,获得将得到的姿态矩阵,以及获得经过上述捷联解算子单元输出的速度矩阵连同里程计组件测量结果经过智能识别和速度滤波得到的信息共同经过安装误差、刻度因子在线识别和修正后得到的信息,将上述各矩阵和在线识别和修正后得到的信息进行导航推算;坐标系。
6、转换子单元,其与上述航位推算子单元的输出端连接,利用航位推算子单元的输出信息与经过智能识别得到的定位、速度和北向角信息被传递经过扩展卡尔曼滤波,依次对该滤波器的输出结果进行地图匹配和坐标系转换,最终实现定位数据的输出。7一种利用权利要求16之一的车载定位设备的抖动解调方法,其特征在于,包括1获得激光陀螺的原始数据;2鉴相倍频;3进行高频采样;4采样结果输入IIR陷波器和FIR滤波器进行滤波;5将滤波结果输出以供导航使用。8根据权利要求7的车载定位设备的抖动解调方法,其特征在于,在步骤4之后还包权利要求书CN104154916A2/4页3括对惯组在车辆上的安装误差角、里程计刻度系数误差进行在线辨。
7、识和修正。9根据权利要求8的车载定位设备的抖动解调方法,其特征在于,所述IIR陷波器和FIR滤波器的定义分别为,其中FS为信号采样频率1IIR陷波器WPWP1WP2;WSWS1WS2;N,WNBUTTORDWP,WS,RP,RS;B,ABUTTERN,WN,STOP;上式中,WP表示通带截止频率,WP1和WP2分别为WP的起始值和终止值,WS表示阻带截止频率,WS1和WS2分别为WS的起始值和终止值,RP表示通带纹波系数DB,RS表示阻带纹波系数DB,N表示巴特沃思的最小阶次,WN表示截止频率,STOP表示带阻滤波,BUTER为巴特沃思函数;求出极点B和零点A后,建立系统差分方程如下上式中AK。
8、,K1,N,BK,K0,M是方程的系数,分别表示零点和极点,N和M表示自然数;给定激光陀螺输出值XN及系统的初始条件,就可以用上述差分方程的解YN得到初步解抖后的信号输出;2FIR滤波器DEV10RP/201/10RP/20110RS/20;N,FO,AO,WREMEZORDF,A,DEV,FSBREMEZN,FO,AO,W3式中F表示通带截止频率;A是向量,其元素用于指定过渡带频率段的理想滤波器幅度值,;DEV也是向量,其元素为各通带和阻带内允许的幅度最大误差;返回值FO为频率向量,AO为幅度向量,W为归一化截止频率,在01之间取值;REMEZORD和REMEZ为最佳滤波器的MATLAB函数。
9、;N代表阶数;求出极点B后,建立系统差分方程如下,式中参数意义同式2基于式4的线性相位型的结构,利用滤波器脉冲响应得对称关系,即HNHMNN0,1,M5可以将式4进行改进为式68,将原来的乘法计算量缩减一半当M为偶数时,权利要求书CN104154916A3/4页4当M为奇数时,该FIR滤波器的指标精度均匀地分布在整个通带和阻带内,有效的衰减剩余的陀螺抖动信号和其他高频噪声,留下真实的有用信号,从而保证了激光陀螺的高精度输出。10根据权利要求8或9的车载定位设备的抖动解调方法,其特征在于,所述对惯组在车辆上的安装误差角、里程计刻度系数误差进行在线辨识和修正包括设捷联惯导的速度误差变化方程式中,表。
10、示速度误差变化、F是加表输出的比力测量,是载体坐标系和导航坐标系的坐标转换姿态矩阵,分别为地心坐标系相对惯性坐标系、导航系相对地心坐标系的旋转角矢量,G是重力矢量在导航系下的分解;上述为基于多准则融合和DS证据组合规则的算法;根据上式,分析出满足舒拉周期的载车低动态条件下,速度误差变化具有缓变特性,所以设定短时间间隔T内的速度误差变化VTTVT很小时,参照信息相似原理,可以将惯导的速度变化作为里程计速度变化的观测量,设计衰减记忆递推滤波器和位置跟踪积分器,在线修正里程计刻度因子,提高系统定位误差;假设里程计刻度因数为K,计数误差是N,车载捷联惯导系统处于导航状态,惯导输出的车体方向速度为VT,。
11、里程计单位时间内计数脉冲为NT,那么TT时刻VTTVTKNTTNTKNTTNTVTTVT10式6中,VT为导航速度误差,短时间内,VTTVT,所以VTTVT0,且里程计计数误差NTTNT可视为白噪声,所以假设YTVTTVT、XTNTTNT,那么上式可以表示为YTKXT11其中表示白噪声;综合导航时间内的惯导、里程计信息得到离散的Y1、Y2YN,X1、X2XN,根据线性回归方程,设计衰减最小二乘记忆法,用衰减因子01限制记忆的长度,对每个数据按照指数加权,旧的数据所加的权按照指数衰减,辨别最佳刻度因子K如下KXTX1XTY12取刻度因子在线修正中的短时间间隔TI和TI1,则第I1时刻的速度差信息。
12、分别为YI1VI1VI,XI1NI1NI,方差阵为PI,衰减因子为,则在线修正里程计刻度因子为KI1KIKKI1YI1KIXI113KKI1PIXI12XI1PIXI1T114权利要求书CN104154916A4/4页5在考虑里程计微分速度瞬时噪声较大的前提下,对捷联惯组的速度输出值进行平滑滤波式16,并将速度沿载体坐标系转换为里程计坐标系后,设计位置跟踪积分器式17,最后采用衰减记忆的递推估计法辨识里程计刻度系数参数,假设导航周期为1S,捷联惯组输出周期为200MS,积分获取捷联惯组的位置变化量,具体计算方法如下IX,Y,Z,分别沿载体坐标系的三个方向16选取直线段车辆数据,避免车辆机动引入。
13、的里程计测量误差。权利要求书CN104154916A1/11页6一种基于激光陀螺捷联惯组的车载定位设备技术领域0001本发明属于车载导航定位技术领域,涉及一种车载定位系统;更具体地,涉及一种基于激光陀螺捷联惯组的车载定位设备。背景技术0002现代先进的陆地作战车辆,如自行火炮、远程火箭炮、射击指挥车、导弹发射车等,一般都配备有先进的导航定位设备,用来在车辆行驶过程中提供其精确的地理位置。为保证和增强武器系统作战的快速性和精确性,要求定位设备具有快速反应、高精度、高可靠、自主性强等特点。000320世纪70年代末,最初的车载定位系统通常由里程表、磁罗盘、速率陀螺仪及微处理器组成,这种车载定位系统。
14、定位精度低,使车载定位系统的实用性受到了限制。其后,随着GPS技术的飞速发展,GPS定位得到广泛应用,但是,由于GPS定位精度受周围环境影响较大,抗干扰性差,常见的高大建筑物、林荫道、立交桥等都会造成定位设备工作异常。所以,单纯的车载GPS定位系统存在可靠性低等缺点。0004为解决这一问题,国外开始了组合导航技术的应用研究利用GPS的位置、速度信息校正惯导系统的累积误差,标定惯性器件,甚至在GPS辅助下,实现动基座寻北;同时,当GPS信号中断时,惯导系统仍能继续工作,提供高精度的导航信息,改善GPS在信号干扰或遮挡时的适应能力。这种组合导航以其精度高、可靠性好、成本低、适用性强、反应快等优点成。
15、为国外军用车辆导航系统的主要发展方向,例如法国的CARMINAT车辆组合导航和信息系统、德国和意大利开发的EUROLIT导航系统、法国的“SIGMA30”系统等。0005在国内,从20世纪80年代左右开始,清华大学、国防科大、航空618所等单位先后研制了基于液浮陀螺和挠性陀螺的平台式惯导定位系统,定位精度高,水平误差优于02D。又例如,申请号为CN2013100787690的中国发明专利申请公开了一种移动目标协同定位系统。定位系统包括三轴激光陀螺仪、三轴光纤加速度传感器、数据处理器、惯导参数通讯模块、超宽带无线接收器、超宽带无线发射器、无线参数通讯模块和协同运算处理单元。采用数据处理器采集移动。
16、目标的姿态角、加速度参数,然后超宽带无线接收器接收到移动目标与超宽带无线发射器间的信号到达时间差和到达角度参数,将多传感器参量通过对应的串口通信模块传输到协同运算处理单元,解算输出得到移动目标的位置和姿态。但是,体积大、器件可靠性低、实用寿命短、初始准备时间长、造价高等缺点制约了这些定位设备的应用。发明内容0006针对现有技术中的上述问题,本发明提出了一种基于激光陀螺捷联惯组的车载定位设备。本发明的所要解决的技术问题包括增强武器系统的快速机动能力和目标命中精度,满足系统对车载导航设备的反应快、精度高、自主性强、可靠性好的要求;设计一种以激光陀螺捷联惯组为核心的车载定位设备,实现车辆静止或行驶时。
17、,精确输出所在位置的地说明书CN104154916A2/11页7理坐标包括经纬度、高程、北向方位和姿态角功能;使车载定位设备能够适应军用车辆导航领域,对我国的船舰导航、导弹导航同样具有借鉴意义。0007本发明提出的基于激光陀螺捷联惯组的车载定位设备包括采用激光陀螺的激光捷联惯组,还包括0008里程计组件测量车辆在地面行驶速度和距离;0009高程计组件测量车辆所在水平面的气压获取高度;0010兼容单天线和双天线的多模卫星系统;0011显控器组件将车载导航设备的定位信息与路网电子地图进行智能匹配。0012进一步地,车载定位设备还包括导航处理单元,其利用零速修正原理和信息相似性原理,设计渐消记忆最小。
18、二乘滤波器和位置跟踪积分器,对激光捷联惯组在车辆上的安装误差角、里程计刻度系数误差进行在线辨识和修正。0013进一步地,电源模块包括二次电源,该二次电源接收外部供电单元提供的2030V直流电。0014进一步地,加表组件、陀螺组件和减震器分别与捷联惯组的本体连接。0015进一步地,激光捷联惯组包括依次连接的电源模块、减震器、加表组件、陀螺组件、I/F板、主控板、导航处理单元、多模卫星接收板;导航处理单元分别接收里程计组件和高程计组件的测量结果,并与上位机和显控器组件通信;多模卫星接收板与多模卫星天线连接。0016进一步地,里程计组件包括0017滤波和识别子单元,其将获得的车辆在地面行驶速度和距离。
19、信息进行智能识别和速度滤波;0018判别子单元,其对上述滤波和识别子单元的输出信号进行零速判别;0019捷联解算子单元,其与上述判别子单元的输出端连接,并利用捷联惯组的制导和导航信息共同进行捷联解算;0020航位推算子单元,其与上述捷联解算子单元的输出端相连接,获得将得到的姿态矩阵,以及获得经过上述捷联解算子单元输出的速度矩阵连同里程计组件测量结果经过智能识别和速度滤波得到的信息共同经过安装误差、刻度因子在线识别和修正后得到的信息,将上述各矩阵和在线识别和修正后得到的信息进行导航推算;0021坐标系转换子单元,其与上述航位推算子单元的输出端连接,利用航位推算子单元的输出信息与经过智能识别得到的。
20、定位、速度和北向角信息被传递经过扩展卡尔曼滤波,依次对该滤波器的输出结果进行地图匹配和坐标系转换,最终实现定位数据的输出。0022进一步地,包括00231获得激光陀螺的原始数据;00242鉴相倍频;00253进行高频采样;00264采样结果输入IIR陷波器和FIR滤波器进行滤波;00275将滤波结果输出以供导航使用。0028进一步地,在步骤4之后还包括对惯组在车辆上的安装误差角、里程计刻度系数误差进行在线辨识和修正。说明书CN104154916A3/11页80029进一步地,所述IIR陷波器和FIR滤波器的定义分别为,其中FS为信号采样频率00301IIR陷波器0031WPWP1WP2;003。
21、2WSWS1WS2;0033N,WNBUTTORDWP,WS,RP,RS;0034B,ABUTTERN,WN,STOP;0035上式中,WP表示通带截止频率,WP1和WP2分别为WP的起始值和终止值,WS表示阻带截止频率,WS1和WS2分别为WS的起始值和终止值,RP表示通带纹波系数DB,RS表示阻带纹波系数DB,N表示巴特沃思的最小阶次,WN表示截止频率,STOP表示带阻滤波,BUTER为巴特沃思函数;0036求出极点B和零点A后,建立系统差分方程如下003720038上式中AK,K1,N,BK,K0,M是方程的系数,分别表示零点和极点,N和M表示自然数;给定激光陀螺输出值XN及系统的初始条。
22、件,就可以用上述差分方程的解YN得到初步解抖后的信号输出;00392FIR滤波器0040DEV10RP/201/10RP/20110RS/20;0041N,FO,AO,WREMEZORDF,A,DEV,FS0042BREMEZN,FO,AO,W30043式中F表示通带截止频率;A是向量,其元素用于指定过渡带频率段的理想滤波器幅度值,;DEV也是向量,其元素为各通带和阻带内允许的幅度最大误差;返回值FO为频率向量,AO为幅度向量,W为归一化截止频率,在01之间取值;REMEZORD和REMEZ为最佳滤波器的MATLAB函数;N代表阶数;0044求出极点B后,建立系统差分方程如下,式中参数意义同式。
23、2004540046基于式4的线性相位型的结构,利用滤波器脉冲响应得对称关系,即0047HNHMNN0,1,M50048可以将式4进行改进为式68,将原来的乘法计算量缩减一半004960050当M为偶数时,70051当M为奇数时,80052该FIR滤波器的指标精度均匀地分布在整个通带和阻带内,有效的衰减剩余的陀螺抖动信号和其他高频噪声,留下真实的有用信号,从而保证了激光陀螺的高精度输出。0053进一步地,所述对惯组在车辆上的安装误差角、里程计刻度系数误差进行在线辨识和修正包括0054设捷联惯导的速度误差变化方程005590056式中,表示速度误差变化、F是加表输出的比力测量,是载体坐标系和导航。
24、坐标系的坐标转换姿态矩阵,、分别为地心坐标系相对惯性坐标系、导航系相对地心坐标系的旋转说明书CN104154916A4/11页9角矢量,G是重力矢量在导航系下的分解;上述为基于多准则融合和DS证据组合规则的算法;0057根据上式,分析出满足舒拉周期的载车低动态条件下,速度误差变化具有缓变特性,所以设定短时间间隔内的速度误差变化很小时,参照信息相似原理,可以将惯导的速度变化作为里程计速度变化的观测量,设计衰减记忆递推滤波器和位置跟踪积分器,在线修正里程计刻度因子,提高系统定位误差;0058假设里程计刻度因数为,计数误差是,车载捷联惯导系统处于导航状态,惯导输出的车体方向速度为,里程计单位时间内计。
25、数脉冲为,那么时刻0059100060式6中,为导航速度误差,短时间内,所以,且里程计计数误差可视为白噪声,所以假设、,那么上式可以表示为0061110062其中表示白噪声;0063综合导航时间内的惯导、里程计信息得到离散的Y1、Y2YN,X1、X2XN,根据线性回归方程,设计衰减最小二乘记忆法,用衰减因子01限制记忆的长度,对每个数据按照指数加权,旧的数据所加的权按照指数衰减,辨别最佳刻度因子K如下0064120065取刻度因子在线修正中的短时间间隔,则第I1时刻的速度差信息分别为,方差阵为PI,衰减因子为,则在线修正里程计刻度因子为0066130067140068150069在考虑里程计微。
26、分速度瞬时噪声较大的前提下,对捷联惯组的速度输出值进行平滑滤波式16,并将速度沿载体坐标系转换为里程计坐标系后,设计位置跟踪积分器式17,最后采用衰减记忆的递推估计法辨识里程计刻度系数参数,假设导航周期为1S,捷联惯组输出周期为200MS,积分获取捷联惯组的位置变化量,具体计算方法如下0070160071170072选取直线段车辆数据,避免车辆机动引入的里程计测量误差。0073为实现高精度、反应快、维护简单、自主性强的定位,本发明的车载定位设备还采用了如下的信号处理方式00741对激光陀螺进行机械抖动偏频。这样能够消除闭锁效应,即通过加入交变的正弦机械抖动,使其大部分时间工作在锁区之外。加入机。
27、械抖动后,陀螺输出信号不仅包括载体输入角速率信息,还包括抖动信号的角速率信号,因此必须对激光陀螺进行抖动解调。采用高频采样和基于数字滤波器的FIR和IIR双级滤波,在保持有用信号不失真和延迟较小的前提下,有效去除激光陀螺残余的抖动信号、随机干扰和其它因素引起的高频噪声,获得载体的真实有用的角速率信号,提高角速度精度。00752当系统为单天线卫星模式时,以位置、速度为观测量,当系统为双天线卫星模式时,以位置、速度、航向为观测量;根据信息智能融合设计扩展的卡尔曼滤波器和航位推算说明书CN104154916A5/11页10积分器,实现SINS/DR/卫星/高程计组合系统的高精度、自主定位功能。007。
28、63利用参数的在线辨识算法对定位误差源,如惯组在车辆上的安装误差角、里程计刻度系数误差等进行实时修正,提高系统的定位精度和鲁棒性;利用零速修正原理和信息相似性原理,设计渐消记忆最小二乘滤波器和位置跟踪积分器,对惯组在车辆上的安装误差角、里程计刻度系数误差进行在线辨识和修正。00774进行多种坐标系转换,以满足用户对1954北京坐标系、1980线坐标系、2000国家大地坐标系、WGS84坐标系等的需求,高精度的坐标转换保证定位信息的准确性。00785利用卫星信号良好时输出的高精度北向角、位置和速度信息,不定期地校正激光捷联惯组关键器件陀螺和加速度计的零偏漂移。0079本发明具有如下有益效果008。
29、01本发明的基于激光陀螺捷联惯组的车载定位设备融合里程计、高程计、多模卫星系统和地图信息,实现全温域4060产品定位定向精度。所实现的精度主要如下00811卫星信号良好时,设备水平定位误差10MCEP95,卫星信号受遮挡或不可用时,设备水平定位误差015DD为行驶里程,CEP75。00822有初始点坐标输入的前提下,设备高程误差PE10M。00833静止或动基座条件下,设备北向角精度1MIL1,姿态角精度0016MIL100842本发明采用了基于数字滤波器的陀螺解调技术、里程计刻度因子在线修正技术、多信息融合技术等方法,实现了高精度、自主性强、可靠性好的定位、定向功能,不仅提高了设备的抗外界干。
30、扰能力,同时抑制了惯性系统定位误差随时间、随车辆行驶距离发散的缺点。00853激光陀螺以其精度高、性能稳定、动态范围宽、反应时间短、可靠性高等优点,在航空、航天、地面车辆等诸多领域均能得到广泛运用,是当前高精度捷联惯性导航系统的理想传感器。00864本发明基于激光陀螺捷联惯组的定位设备更以其体积小、精度高、性能稳定、抗干扰能力强、动态范围宽、启动快、寿命长、成本低等优点,已经或准备应用在新型及改进型的多类武器装备中。00875定位设备采用了基于激光捷联惯组的多信息融合模式,设备中采用了特有的滤波器组合设计方案去除激光陀螺机械抖动,降低了系统对陀螺的精度要求,采用了里程计刻度因子在线修正算法,提。
31、高了系统定位精度和鲁棒性,具体问题我已经在文件中描述,只是较为分散。附图说明0088图1示出了本发明的定位设备组成框图;0089图2示出了本发明的定位设备的电路框图;0090图3示出了本发明的定位设备工作原理图;0091图4示出了高精度激光陀螺抖动解调流程图;0092图5示出了本发明的定位设备自主定位原理图;说明书CN104154916A106/11页110093图6示出了本发明的定位设备航位推算DR计算图;具体实施方式0094下面将结合附图12详细说明本发明的具体实施方式。0095图1示出了根据本发明的一个实施例的基于激光陀螺捷联惯组的车载定位设备的组成框图,包括采用激光陀螺的激光捷联惯组,。
32、还包括里程计组件、高程计组件、兼容单天线和双天线的多模卫星系统、显控器组件,以及多模卫星定位定向组件。0096所述激光捷联惯组包括依次连接的电源模块、减震器、加表组件、陀螺组件、I/F板、主控板、导航计算机板、多模卫星接收板;所述导航计算机分别接收所述里程计组件和所述高程计组件的测量结果,并与上位机和所述显控器组件通信;所述多模卫星接收板与所述多模卫星天线连接。所述电源模块包括二次电源,该二次电源接收外部供电单元提供的2030V直流电。所述高程计采用气压传感器,例如由太航公司设计定型的气压传感器。所述加表组件、陀螺组件和减震器分别与捷联惯组的本体连接。0097里程计组件里程计组件用于测量车辆在。
33、地面行驶速度和距离,结合激光捷联惯组输出的方位和姿态信息,进行航位推算,获取高精度的水平定位数据;同时对里程计速度进行智能辨识和滤波,作为车辆零速判别准则,实现停车时的定位零速修正。0098里程计设计兼容软轴和霍尔两种模式,借助车轮的转动测量车辆在地面行驶的路程,获得车辆里程和速度信息,由于车辆行驶时,车轮存在侧滑、弹跳和空转的可能,所以系统实时采集里程计一段时间的数据,进行梯度变化、方差变化、绝对值等综合智能识别算法,诊断和剔除里程计的故障信息,获取车辆真实的路程变化,同时对噪声较大的速度进行滤波,作为车辆零速判别准则,在车辆零速时补偿激光捷联惯组的速度误差,抑制了惯性系统速度、位置随时间、。
34、随车辆行驶距离发散的缺点。0099高程计组件高程计组件测量车辆所在水平面的气压获取高度,以弥补激光捷联惯组高度发散的不足,提高系统的高程精度。0100显控器组件显控器组件将车载导航设备的定位信息与路网电子地图进行智能匹配。基于多准则融合和DS证据组合规则的算法,实现较高的匹配精度,完成地图导航、人工改航和选择航线,提高系统定位精度。显控器组件具有设计良好的人机交互界面,实时显示和保存激光捷联惯组、里程计、高程计、DR和地图的信息及状态,同时结合内部存储的电子地图数据库,实现最优地图匹配功能。0101所述多模卫星包括GPS、GLONASS、北斗中的至少两种。多模卫星定位定向组件兼容单天线卫星接收。
35、模式和双天线卫星接收模式。前者可以在卫星信号良好时,提供高精度的定位数据和纳秒级的授时精度;后者除同等精度的定位和授时功能外,还可以实现静止或行进间对准功能。兼容单天线和双天线的多模卫星系统实现了车载定位设备的静止或行进间寻北、卫星或自主高精度定位和高精度授时功能。0102激光陀螺采用机械抖动偏频方案。该方案能消除闭锁效应,即通过加入交变的正弦机械抖动,使其大部分时间工作在锁区之外。加入机械抖动后,陀螺输出信号不仅包括载体输入角速率信息,还包括抖动信号的角速率信号,因此必须对激光陀螺进行抖动解调采用高频采样和基于数字滤波器的FIR和IIR双级滤波,在保持有用信号不失真和延迟较小的前提下,有效去。
36、除激光陀螺残余的抖动信号、随机干扰和其它因素引起的高频噪声,获得说明书CN104154916A117/11页12载体的真实有用的角速率信号。0103本发明提供的基于激光陀螺捷联惯组的车载定位设备的电路框图参见图2。激光陀螺输出含正弦机械抖动和车载角速度的脉冲信号,加表测量车载加速度,以电流信号传给IF板,由IF板进行电流至频率的转换后,同样以脉冲形式输出,测温板采集激光陀螺和加表内部的温度信号,通过RS422串口发送给主控板,主控板对激光陀螺和加表的脉冲信号进行计数、标定和温度补偿后,进行寻北和惯性导航,并将激光捷联惯组的导航数据通过主RS422串口发送给导航计算机板,由导航计算机板将高程计、。
37、卫星天线、里程计、惯性导航数据进行多信息融合,并将最终解算结果实时发送给显控器和上位机。0104本发明提供的基于激光陀螺捷联惯组的车载定位设备的工作原理参见图3。卫星单元通过多模卫星天线智能识别出不同天线模式下的定位等信息。卫星系统兼容单天线和双天线两种模式对于单天线,以定位信息和速度信息为观测量;对于双天线,以定位信息、速度信息和航向信息例如北向角信息为观测量,提高设备误差的估计精度。高程计组件获得车辆的高度信息,然后将经过误差修正以后的高度信息传递给航位推算DR单元。0105其中,里程计组件包括0106滤波和识别子单元,其将获得的车辆在地面行驶速度和距离信息进行智能识别和速度滤波;0107。
38、判别子单元,其对上述滤波和识别子单元的输出信号进行零速判别;0108捷联解算子单元DR,其与上述判别子单元的输出端连接,并利用捷联惯组制导和导航信息共同进行捷联解算;0109航位推算子单元,其与上述捷联解算子单元的输出端相连接,获得将得到的姿态矩阵,以及获得经过上述捷联解算子单元输出的速度矩阵连同里程计组件测量结果经过智能识别和速度滤波得到的信息共同经过安装误差、刻度因子在线识别和修正后得到的信息,将上述各矩阵和在线识别和修正后得到的信息进行导航推算;0110坐标系转换子单元,其与上述航位推算子单元的输出端连接,利用航位推算子单元的输出信息与经过智能识别得到的定位、速度和北向角信息被传递经过扩。
39、展卡尔曼滤波,依次对该滤波器的输出结果进行地图匹配和坐标系转换,最终实现定位数据的输出。0111本发明提供的基于激光陀螺捷联惯组的车载定位设备的抖动解调方法流程参见图4。激光陀螺抖动频率是相对固定的,基本在300HZ700HZ之间,根据信号原理,为获得较好的解调效果,要求采用610倍以上的频率采样,然后进行相应的数字滤波解调处理。在定位设备中,采用了最高抖动频率约730HZ的陀螺,所以设计信号的采样频率为5000HZ。0112处理平台除了利用硬件电路的模式以外,还可以选用“FGPADSP”模式。硬件电路模式的方式其连线较为复杂,但属于本领域技术人员基于现有技术应当理解和能够实现的。“FGPAD。
40、SP”模式中,上述FPGA还可以通过VHDL硬件逻辑编程语言实现激光陀螺原始数据的鉴相、倍频、计数和数据传输,上述DSP还可以通过C语言实现激光陀螺预处理后数据的高频采样,获取鉴相倍频后的陀螺和加速度计信号。为消除陀螺的自振抖动信号,捷联解算子单元设计FIR低通滤波器前,串连一个时延很小但衰减显著,具有精度高、稳定、灵活、不要求阻抗匹配等众多优点的巴特沃思带阻陷波器带阻IIR陷波器;以抖频为599HZ的说明书CN104154916A128/11页13激光陀螺为例,设计陷波器的参数如下0113通带截止频率为599205798HZ和6201HZ,阻带截止频率为5939HZ和6061HZ,阶数为2阶。
41、,通带内纹波RP小于3DB,阻带内幅值衰减大于20DB,信号采样频率为5000HZ。0114解算IIR陷波器的极点和零点的一个是实施例的算法如下0115WP15798/2500;0116WP26201/2500;0117WS15939/2500;0118WS26061/2500;0119WPWP1WP2;0120WSWS1WS2;0121RP3;0122RS20;0123N,WNBUTTORDWP,WS,RP,RS;0124B,ABUTTERN,WN,STOP;10125式中,WP表示通带截止频率,WS表示阻带截止频率,RP表示通带纹波系数DB,RS表示阻带纹波系数DB,N表示巴特沃思的最小阶。
42、次,WN表示截止频率,STOP表示带阻滤波,BUTER为MATALAB的巴特沃思函数。0126求出极点B和零点A后,建立系统差分方程如下01270128式中AK,K1,N,BK,K0,M是方程的系数,分别表示零点和极点,N和M表示自然数。给定激光陀螺输出值XN及系统的初始条件,就可以用上述差分方程的解YN得到初步解抖后的信号输出。0129通过以上滤波器的形式,实现阻带内幅值衰减大于20DB的预滤波,然后再利用低阶FIR滤波器的线性相位响应特性,设计采用REMEZ交换算法和切比雪夫逼近算法相结合的等纹滤波器,设计滤波器参数如下0130通带截止频率F1为100HZ,阻带截止频率F2300HZ,阶数。
43、N为20阶定阶,通带内纹波RP小于3DB,阻带内幅值衰减RS大于20DB,信号采样频率FS为5000HZ。解算FIR低通波器的极点和零点的一个实施例的算法如下0131RP3;0132RS20;0133FS5000;0134F100300;0135A10;0136DEV10RP/201/10RP/20110RS/20;0137N,FO,AO,WREMEZORDF,A,DEV,FS0138BREMEZN,FO,AO,W30139式中A是向量,其元素用于指定过渡带通带或阻带频率段的理想滤波器幅度说明书CN104154916A139/11页14值,在通带内其元素值取1,阻带内取0,DEV也是向量,其元。
44、素为各通带和阻带内允许的幅度最大误差,返回值FO为频率向量,AO为幅度向量,W为归一化截止频率,在01之间取值。REMEZORD和REMEZ为最佳滤波器的MATLAB函数。0140求出极点B后,建立系统差分方程如下,式中参数意义同式201410142基于式4的线性相位型的结构,利用滤波器脉冲响应得对称关系,即0143HNHMNN0,1,M50144可以将式4进行改进为式68,将原来的乘法计算量缩减一半01450146当M为偶数时,0147当M为奇数时,0148通过以上滤波器的形式,20阶FIR滤波器的指标精度均匀地分布在整个通带和阻带内,有效的衰减剩余的陀螺抖动信号和其他高频噪声,留下真实的有。
45、用信号,从而保证了激光陀螺的高精度输出。0149此外,本发明还利用零速修正原理和信息相似性原理,设计渐消记忆最小二乘滤波器和位置跟踪积分器,对惯组在车辆上的安装误差角、里程计刻度系数误差进行在线辨识和修正。0150如式9所示捷联惯导的速度误差变化方程01510152式中,表示速度误差变化、F是加表输出的比力测量,是载体坐标系和导航坐标系的坐标转换姿态矩阵,分别为地心坐标系相对惯性坐标系、导航系相对地心坐标系的旋转角矢量,G是重力矢量在导航系下的分解。0153根据上式,不难分析出载车低动态条件下,速度误差变化具有缓变特性,满足舒拉周期的变化,所以设定短时间间隔T内的速度误差变化VTTVT很小时,。
46、参照信息相似原理,可以将惯导的速度变化作为里程计速度变化的观测量,设计衰减记忆递推滤波器和位置跟踪积分器,在线修正里程计刻度因子,提高系统定位误差。0154假设里程计刻度因数为K,计数误差是N,车载捷联惯导系统处于导航状态,惯导输出的车体方向速度为VT,里程计单位时间内计数脉冲为NT,那么TT时刻0155VTTVTKNTTNTKNTTNTVTTVT10说明书CN104154916A1410/11页150156式6中,VT为导航速度误差,短时间内,VTTVT,所以VTTVT0,且里程计计数误差NTTNT可视为白噪声,所以假设YTVTTVT、XTNTTNT,那么上式可以表示为0157YTKXT11。
47、0158其中表示白噪声。0159在实际应用中,由于工作环境和使用条件的变化,里程计输出信号噪声存在不确定性因素,如果采用事先必须准确知道噪声统计特性的传统卡尔曼滤波器,滤波进行一段时间后,计算的协方差逐渐趋于零时,太依赖过去数据的状态估计会使滤波器发散,所以针对该问题,综合导航时间内的惯导、里程计信息得到离散的Y1、Y2YN,X1、X2XN,根据线性回归方程,设计衰减最小二乘记忆法,用衰减因子01限制记忆的长度,对每个数据按照指数加权,旧的数据所加的权按照指数衰减,辨别最佳刻度因子K如下0160KXTX1XTY120161取刻度因子在线修正中的短时间间隔TI和TI1,则第I1时刻的速度差信息分。
48、别为YI1VI1VI,XI1NI1NI,方差阵为PI,衰减因子为,则在线修正里程计刻度因子为0162KI1KIKKI1YI1KIXI1130163KKI1PIXI12XI1PIXI1T11401640165分析车载定位设备实际进行里程计刻度因子在线修正时,里程计直接给出的是累计脉冲,是速度的积分,而捷联惯组解算的速度,短时间内近似是里程的微分,两种信息物理概念不统一,所以从工程实用性出发,在考虑里程计微分速度瞬时噪声较大的前提下,对捷联惯组的速度输出值进行平滑滤波式16,并将速度沿载体坐标系转换为里程计坐标系后,设计位置跟踪积分器式17,最后采用衰减记忆的递推估计法辨识里程计刻度系数参数,假设。
49、导航周期为1S,捷联惯组输出周期为200MS,积分获取捷联惯组的位置变化量,具体计算方法如下0166IX,Y,Z,分别沿载体坐标系的三个方向1601670168由于里程计测量车辆轮胎的转动,在车辆转弯时,轮胎与接触地面之间会发生相对滑动,且捷联惯导输出的速度方向短时间内不在同一方向上,无法进行平滑滤波,所以在辨识里程计刻度系数时,应选取直线段车辆数据,避免车辆机动引入的里程计测量误差。0169导航计算机板同时采集上述激光捷联惯导的姿态信息包括北向夹角、经过误差补偿的里程计的路程信息和高程计的高度信息,采用航位推算技术和坐标系转换技术,获取高精度的水平定位信息,图5和图6分别为定位设备自主定位原理图和航位推算DR的计算图。图5中所示的定位设备自主定位原理为将高程计组件的输出值经过误差修正说明书CN104154916A1511/11页16后传递到航位推算DR单元,里程计组件将获得的车辆在地面行驶速度和距离信息进行智能识别和速度滤波,然。