《一种实时在线评估导航系统精确度和完好性的方法.pdf》由会员分享,可在线阅读,更多相关《一种实时在线评估导航系统精确度和完好性的方法.pdf(15页珍藏版)》请在专利查询网上搜索。
1、10申请公布号CN104050389A43申请公布日20140917CN104050389A21申请号201410307317X22申请日20140630G06F19/00201101G01C25/0020060171申请人中国航空无线电电子研究所地址200233上海市徐汇区桂平路432号72发明人王丹马航帅孙晓敏74专利代理机构上海和跃知识产权代理事务所普通合伙31239代理人杨慧54发明名称一种实时在线评估导航系统精确度和完好性的方法57摘要本发明公开了一种实时在线评估导航系统精确度和完好性的方法,本发明针对导航系统信息融合的特点,基于协方差矩阵的多维高斯概率分布特性和包容半径阈值的瑞利概。
2、率分布特性,通过概率转换,能够实现对导航系统实际导航精确度和完好性的实时在线估计。本发明方法简便,充分利用组合导航的滤波信息,大大提升了运算速度,满足导航系统性能监视的实时性需求,并确保足够的置信度。该发明是一种易于工程实现的方法,对于大型飞机在民用领域飞行,满足各航段的所需导航性能要求具有重要的现实应用意义。51INTCL权利要求书3页说明书9页附图2页19中华人民共和国国家知识产权局12发明专利申请权利要求书3页说明书9页附图2页10申请公布号CN104050389ACN104050389A1/3页21一种实时在线评估导航系统精确度和完好性的方法,包含以下步骤一、由惯性导航系统IRS和全球。
3、定位系统GPS采集所需参数;二、根据获取的参数建立卡尔曼滤波器的状态方程和量测方程,对状态方程和量测方程进行离散化操作并时间更新和量测更新,获得卡尔曼滤波器KF的协方差矩阵PK,并获得导航参数的估计;三、根据多元高斯分布的特性,分割卡尔曼滤波器KF的协方差矩阵,获得IRS/GPS组合导航系统的位置误差矩阵,求取IRS/GPS组合导航系统的位置标准差,实现IRS/GPS导航系统实际导航性能ANP精确度的估计;四、根据包容半径阈值的瑞利概率分布特性,以95的包容半径为参考值,根据不同包容概率所对应的不同倍率,进行概率转换,求取不同包容概率要求下的包容半径,实现导航系统实际导航完好性的估计。2根据权。
4、利要求1所述的一种实时在线评估导航系统精确度和完好性的方法,其特征在于所述参数包括11以周期T读取惯性导航系统IRS输出的三个姿态角、三个位置、三个速度信息、三个角速度信息和三个线加速度信息,三个姿态角信息分别为俯仰角、横滚角、偏航角;三个位置信息分别为经度L、纬度、高度H;三个速度信息分别为地理坐标系下的东向速度VE、北向速度VN、天向速度VU,三个角速度信息为机体坐标系相对于惯性空间的角速度在机体系下的分量三个线加速度信息为机体系下比力信息FB,其中机体坐标系的X轴、Y轴和Z轴的指向分别为向右、向前、向下;12以周期T读取全球定位系统GPS输出的伪距G信息。3根据权利要求1所述的一种实时在。
5、线评估导航系统精确度和完好性的方法,其特征在于所述步骤二具体包含以下步骤21以惯性导航系统IRS为主导航系统,以全球定位系统GPS为辅助导航系统,选取惯性导航系统IRS的姿态角误差、速度误差、位置误差、惯性仪表误差和全球定位系统GPS时钟误差为状态量,建立卡尔曼滤波器的状态方程式中WKF为系统白噪声,其中权利要求书CN104050389A2/3页3为机体系到地理系的姿态矩阵,FB为比力,为指令角速度,为地球自转角速度在地理系下的分量,为地理系相对于地球系角速度在地理系下的投影,和均可根据姿态矩阵、位置信息和进行求取,VN为地理坐标系下速度矢量,RM和RN分别为子午圈曲率半径和卯酉圈曲率半径,表。
6、示叉乘运算;22选取全球定位系统GPS伪距信息和根据惯性导航系统IRS信息计算的伪距之差作为量测量,建立卡尔曼滤波器的量测方程ZKFHKFXKFVKF,其中HKF为量测阵,VKF为伪距信息的量测噪声;23将状态方程和量测方程ZKFHKFXKFVKF进行离散化,得到如下形式其中XK为TK时刻的状态值,K,K1为TK1到TK的一步转移矩阵,WK1为系统噪声阵,ZK为TK时刻的量测值,HK为量测阵,VK为量测噪声;24进行IRS/GPS滤波更新,具体为时间更新量测更新PKIKKHKPK|K1,其中,TK为当前滤波时刻,为TK1时刻的状态最优滤波值,为TK时刻状态量的一步预测值,PK|K1为TK时刻的。
7、状态一步预测的方差阵,KK为TK时刻的滤波增益矩阵,为TK时刻的状态最优滤波值,其滤波误差方差阵为PK,QK1和RK分别为系统噪声WK1和量测噪声VK的方差阵;25根据步骤一中获取的IRS信息和获取的GPS信息,通过滤波方程的时间更新和量测更新,进而得到以IRS为主导航系统的状态量的最优估计即4根据权利要求1所述的一种实时在线评估导航系统精确度和完好性的方法,其特征权利要求书CN104050389A3/3页4在于所述步骤三的具体步骤是31根据多元高斯分布的特性,分割卡尔曼滤波器的协方差矩阵PK,获得位置估计误差在水平面内的分量,即经度误差和纬度误差;32将经纬度误差转化为水平面内的直线误差X,。
8、Y,其中R为地球半径,为飞机所在纬度;33记水平面内位置误差EPOSXY,构建IRS/GPS组合导航系统的位置误差矩阵PPOS,PPOSCOVEPOS;34求取位置误差矩阵PPOS的2个特征值1,2,其中1,2分别为1误差椭圆的长半轴MAJOR和短半轴MINOR;35根据1误差椭圆的长半轴MAJOR,求取实际导航性能ANP精度ANP245MAJOR;36当实际导航性能ANP精度超过所需导航性能RNP精度时,机载导航系统发出告警信息,提示导航精度不满足要求。5如权利要求1所述的一种实时在线评估导航系统精确度和完好性的方法,其特征在于所述步骤四的具体步骤是41估计95的包容半径RACC24505M。
9、AJORMINOR;42根据倍率因子X与包容概率P之间的对应关系,求取不同包容概率要求下的包容半径RCSXRACC;43当包容半径RCS大于包容限值2RNP时,机载导航系统发出告警,提示导航完好性不满足要求。权利要求书CN104050389A1/9页5一种实时在线评估导航系统精确度和完好性的方法技术领域0001本发明涉及导航系统性能评估和监视技术领域。背景技术0002飞行管理系统是大型飞机航电系统的核心设备,它通过提供基于多传感器的综合导航功能、性能管理功能、飞行计划管理功能和飞行制导功能,综合其他系统,诸如导航系统、显示系统、自动驾驶仪和自动油门系统,在整个飞行进程中,辅助机组实现飞行任务的。
10、自动化控制,确保飞机沿着预期的计划自动飞行,并且满足运营要求的飞行性能。0003导航功能是飞行管理系统的基本功能,它为飞机提供飞机当前状态的最佳估计。FMS运用传感器精度数据、传感器原始数据以及当前条件信息,选出定位传感器的最佳组合以减少位置测定误差,提供估计飞机位置和速度的最佳解决方案,最终满足区域导航所需的导航性能。0004为了确保导航系统性能满足所需性能要求,有两个关键,一是在设计阶段的所需导航性能指标的预算,另一个是实时的实际导航性能的评估。对于新航行系统,实际导航性能由导航系统实时计算,它包含对当前飞管计算位置的精确度和相关完好性的评估。0005美国的霍尼韦尔公司、柯林斯公司、GE公。
11、司以及法国的泰勒斯公司垄断了支线、干线及商务飞机的航电产品市场,掌握着飞行管理系统的核心技术及其发展,在空客、波音等机型上早已实现了导航性能的实时计算、监视和告警。我们国内与国外的差距较大,虽然目前还没有一个成形的货架产品,但国内各大高校、院所一直在追赶国外技术发展的步伐,开展了一系列确保导航系统精度和可靠性的方法研究。但对于如何结合导航所需性能要求,对导航系统的实际导航精确度及其相关完好性进行实时在线评估,国内相关研究甚少。专利CN103557872对一种RNP中的综合系统误差实时计算方法进行了描述,但仅仅是涉及导航精度的一种计算方法,并没有提及导航系统的完好性,更没有给出实时在线评估导航系。
12、统的完好性是否满足要求的方法。发明内容0006为了解决现有导航系统缺乏导航精确度和完好性实时在线计算和告警能力的问题,本发明的发明目的在于提供一种实时在线评估导航系统精确度和完好性的方法,通过概率转换实现导航系统实际精确度和完好性的实时在线评估,为民用飞机运行满足各航段所需导航性能需求提供技术保障。0007本发明的发明目的通过以下技术方案实现0008一种实时在线评估导航系统精确度和完好性的方法,包含以下步骤0009一、由惯性导航系统IRS和全球定位系统GPS采集所需参数;0010二、根据获取的参数建立卡尔曼滤波器的状态方程和量测方程,对状态方程和量测方程进行离散化操作并时间更新和量测更新,获得。
13、卡尔曼滤波器的协方差矩阵PK,并获得导航参数的估计;说明书CN104050389A2/9页60011三、根据多元高斯分布的特性,分割卡尔曼滤波器的协方差矩阵,获得IRS/GPS组合导航系统的位置误差矩阵,求取IRS/GPS组合导航系统的位置标准差,实现IRS/GPS导航系统实际导航性能ANP精确度的估计;0012四、根据包容半径阈值的瑞利概率分布特性,以95的包容半径为参考值,根据不同包容概率所对应的不同倍率,进行概率转换,求取不同包容概率要求下的包容半径,实现导航系统实际导航完好性的估计。0013依据上述特征,所述参数包括001411以周期T读取惯性导航系统IRS输出的三个姿态角、三个位置、。
14、三个速度信息、三个角速度信息和三个线加速度信息,三个姿态角信息分别为俯仰角、横滚角、偏航角;三个位置信息分别为经度L、纬度、高度H;三个速度信息分别为地理坐标系下的东向速度VE、北向速度VN、天向速度VU,三个角速度信息为机体坐标系相对于惯性空间的角速度在机体系下的分量三个线加速度信息为机体系下比力信息FB,其中机体坐标系的X轴、Y轴和Z轴的指向分别为向右、向前、向下;001512以周期T读取全球定位系统GPS输出的伪距G信息。0016依据上述特征,所述步骤二具体包含以下步骤001721以惯性导航系统IRS为主导航系统,以全球定位系统GPS为辅助导航系统,选取惯性导航系统IRS的姿态角误差、速。
15、度误差、位置误差、惯性仪表误差和全球定位系统GPS时钟误差为状态量,建立卡尔曼滤波器的状态方程00180019式中WKF为系统白噪声,其中0020说明书CN104050389A3/9页70021为机体系到地理系的姿态矩阵,FB为比力,为指令角速度,为地球自转角速度在地理系下的分量,为地理系相对于地球系角速度在地理系下的投影,和均可根据姿态矩阵、位置信息和进行求取,VN为地理坐标系下速度矢量,RM和RN分别为子午圈曲率半径和卯酉圈曲率半径,表示叉乘运算;002222选取全球定位系统GPS伪距信息和根据惯性导航系统IRS信息计算的伪距之差作为量测量,建立卡尔曼滤波器的量测方程0023ZKFHKFX。
16、KFVKF,0024其中HKF为量测阵,VKF为伪距信息的量测噪声;002523将状态方程和量测方程ZKFHKFXKFVKF进行离散化,得到如下形式0026其中XK为TK时刻的状态值,K,K1为TK1到TK的一步转移矩阵,WK1为系统噪声阵,ZK为TK时刻的量测值,HK为量测阵,VK为量测噪声;002724进行IRS/GPS滤波更新,具体为0028时间更新002900300031量测更新003200330034PKIKKHKPK|K10035其中,TK为当前滤波时刻,为TK1时刻的状态最优滤波值,为TK时刻状态量的一步预测值,PK|K1为TK时刻的状态一步预测的方差阵,KK为TK时刻的滤波增益。
17、矩阵,为TK时刻的状态最优滤波值,其滤波误差方差阵为PK,QK1和RK分别为系统噪声WK1和量测噪声VK的方差阵;003625根据步骤一中获取的IRS信息和获取的GPS信息,通过滤波方程的时间更新和量测更新,进而得到以IRS为主导航系统的状态量的最优估计即说明书CN104050389A4/9页80037依据上述特征,所述步骤三的具体步骤是003831根据多元高斯分布的特性,分割卡尔曼滤波器的协方差矩阵PK,获得位置估计误差在水平面内的分量,即经度误差和纬度误差;003932将经纬度误差转化为水平面内的直线误差X,Y,其中R为地球半径,为飞机所在纬度;004033记水平面内位置误差EPOSXY,。
18、构建IRS/GPS组合导航系统的位置误差矩阵PPOS,PPOSCOVEPOS;004134求取位置误差矩阵PPOS的2个特征值1,2,其中1,2分别为1误差椭圆的长半轴MAJOR和短半轴MINOR;004235根据1误差椭圆的长半轴MAJOR,求取实际导航性能ANP精度ANP245MAJOR;004336当实际导航性能ANP精度超过所需导航性能RNP精度时,机载导航系统发出告警信息,提示导航精度不满足要求。0044依据上述特征,所述步骤四的具体步骤是004541估计95的包容半径RACC24505MAJORMINOR;004642根据倍率因子X与包容概率P之间的对应关系,求取不同包容概率要求下。
19、的包容半径RCSXRACC;004743当包容半径RCS大于包容限值2RNP时,机载导航系统发出告警,提示导航完好性不满足要求。0048本发明的优点及显著效果本发明针对惯性/GPS信息融合的特点,设计了一种基于卡尔曼滤波的惯性/GPS更新架构,基于协方差矩阵的多维高斯概率分布特性和包容半径阈值的瑞利概率分布特性,通过概率转换,能够实现对导航系统实际导航精确度和完好性的实时在线估计。本发明方法简便,充分利用惯性/GPS组合的滤波信息,大大提升了运算速度,满足导航系统性能监视的实时性需求,并确保足够的置信度。该发明方法是一种易于工程实现的方法,对于大型飞机在民用领域飞行,满足各航段的所需导航性能要。
20、求具有重要的现实应用意义。附图说明0049图1是本发明方法的工作流程示意图;0050图2是本发明方法中ANP精确度评估流程;0051图3是本发明方法中ANP完好性评估流程。具体实施方式说明书CN104050389A5/9页90052下面结合附图对本发明的技术方案进行详细说明0053本发明针对惯性/GPS信息融合的特点,设计了一种基于卡尔曼滤波的惯性/GPS更新架构,基于协方差矩阵的多维高斯概率分布特性和包容半径阈值的瑞利概率分布特性,通过概率转换,能够实现对导航系统实际导航精确度和完好性的实时在线估计。具体包括以下步骤0054一、由惯性导航系统IRS和全球定位系统GPS采集所需参数005511。
21、以周期T读取惯性导航系统IRS输出的三个姿态角、三个位置、三个速度信息、三个角速度信息和三个线加速度信息,三个姿态角信息分别为俯仰角、横滚角、偏航角;三个位置信息分别为经度L、纬度、高度H;三个速度信息分别为地理坐标系下的东向速度VE、北向速度VN、天向速度VU,三个角速度信息为机体坐标系相对于惯性空间的角速度在机体系下的分量三个线加速度信息为机体系下比力信息FB,其中机体坐标系的X轴、Y轴和Z轴的指向分别为向右、向前、向下。005612以周期T读取全球定位系统GPS输出的伪距G信息。0057二、利用卡尔曼滤波器实现IRS/GPS组合导航参数的最优估计步骤0058以IRS为主导航系统,以GPS。
22、为辅助导航系统,选取IRS的姿态角误差、速度误差、位置误差、惯性仪表误差和GPS时钟误差为状态量,建立卡尔曼滤波的状态方程,选取GPS测量伪距和根据IRS信息计算的伪距之差作为量测量,建立卡尔曼滤波器的量测方差,从而构建IRS/GPS相组合的卡尔曼滤波器KF;根据步骤一中获取的IRS信息和获取的GPS信息,得到导航参数的最优估计0059所述步骤二的卡尔曼滤波器具体包括以下步骤006021IRS/GPS滤波状态方程的建立0061构造卡尔曼滤波器KF的17维状态量XKFXNAV;XIMU;XGPS,其由三部分组成,包括IRS导航参数误差惯性仪表误差以及GPS时钟误差XGPSTUTRUT,其中,N为。
23、IRS的三个姿态角误差、VN为IRS的地理系下三个方向的速度误差、L为IRS的纬度误差、为IRS的纬度误差、H为IRS的高度误差、为IRS的陀螺的在机体系下三个轴向的常值漂移、为IRS的加速度计在机体系下三个轴向的常值偏置误差、TU为GPS的等效时钟误差、TRU为GPS的等效时钟频率误差;0062进而建立KF的状态方程0063说明书CN104050389A6/9页100064式中WKF为系统白噪声,其中00650066为机体系到地理系的姿态矩阵,FB为比力,为指令角速度,为地球自转角速度在地理系下的分量,为地理系相对于地球系角速度在地理系下的投影,和均可根据姿态矩阵、位置信息和进行求取,VN为。
24、地理坐标系下速度矢量,RM和RN分别为子午圈曲率半径和卯酉圈曲率半径,表示叉乘运算;006722IRS/GPS滤波量测方程的建立0068将GPS测量伪距信息G和利用IRS信息计算出的伪距信息I之差作为量测量ZKFGI,进而建立卡尔曼滤波器KF的量测状态方程ZKFHKFXKFVKF,其中HKF为量测阵,VKF为伪距信息的量测噪声。006923IRS/GPS滤波方程离散化0070将状态方程和量测方程ZKFHKFXKFVKF进行离散化,得到如下形式说明书CN104050389A107/9页110071其中XK为TK时刻的状态值,K,K1为TK1到TK的一步转移矩阵,WK1为系统噪声阵,ZK为TK时刻。
25、的量测值,HK为量测阵,VK为量测噪声。007224IRS/GPS滤波更新0073时间更新007400750076量测更新007700780079PKIKKHKPK|K10080其中,TK为当前滤波时刻,为TK1时刻的状态最优滤波值,为TK时刻状态量的一步预测值,PK|K1为TK时刻的状态一步预测的方差阵,KK为TK时刻的滤波增益矩阵,为TK时刻的状态最优滤波值,其滤波误差方差阵为PK,QK1和RK分别为系统噪声WK1和量测噪声VK的方差阵。0081根据步骤一中获取的IRS信息和获取的GPS信息,通过滤波方程的时间更新和量测更新,进而得到以IRS为主导航系统的状态量的最优估计即0082三、基于。
26、多元高斯分布特性实现实际导航性能ANP精确度估计的步骤0083根据多元高斯分布的特性,分割卡尔曼滤波器的协方差矩阵PK,获得IRS/GPS组合导航系统的位置误差矩阵PPOS,求取IRS/GPS组合导航系统的位置标准差1,2,从而实现IRS/GPS导航系统实际导航精确度ANP的估计,根据所需导航性能RNP的要求,评估精确度是否满足要求。0084所述步骤三的ANP精确度估计具体包括以下步骤008531分割IRS/GPS滤波协方差矩阵0086分割卡尔曼滤波器的协方差矩阵PK,获得位置估计误差在水平面内的分量,即经度误差和纬度误差;008732转换经纬度误差0088将经纬度误差转化为水平面内的直线误差。
27、X,Y,其中R为地球半径,为飞机所在纬度;008933构建位置误差矩阵0090记水平面内位置误差EPOSXY,构建IRS/GPS组合导航系统的位置误差矩阵PPOS,PPOSCOVEPOS;009134求取误差矩阵的特征值说明书CN104050389A118/9页120092求取位置误差矩阵PPOS的2个特征值1,2,其中1,2分别为1误差椭圆的长半轴MAJOR和短半轴MINOR;009335求取ANP精确度0094根据1误差椭圆的长半轴MAJOR,求取ANP,ANP245MAJOR;009536导航系统精确度告警0096当ANP超过RNP时,机载导航系统发出告警信息,提示导航精度不满足要求。0。
28、097四、基于包容半径阈值的瑞利概率分布特性实现ANP完好性估计的步骤0098根据包容半径阈值的瑞利概率分布特性,以95的包容半径为参考值,根据不同包容概率所对应的RACC不同倍率,进行概率转换,求取不同包容概率要求下的包容半径,实现导航系统实际导航完好性的估计,根据包容限值要求,评估完好性是否满足要求。0099所述步骤四的ANP完好性估计具体包括以下步骤010041求取95的包容半径0101估计95的包容半径RACC24505MAJORMINOR;010242求取不同包容概率要求下的包容半径0103根据倍率因子X与包容概率P之间的对应关系表1,求取不同包容概率要求下的包容半径RCSXRACC;0104倍率X概率P240999999968232099999992150999999200099999375196099999175099991520999124099100095088090105表1010643导航系统完好性告警0107当包容半径RCS大于包容限值2RNP时,机载导航系统发出告警,提示导航完好说明书CN104050389A129/9页13性不满足要求。说明书CN104050389A131/2页14图1图2说明书附图CN104050389A142/2页15图3说明书附图CN104050389A15。