一种改善航姿系统航向精度和动态特性的方法
【技术领域】
[0001 ] 本发明涉及一种改善航姿系统航向精度和动态特性的方法。
【背景技术】
[0002] 航姿系统为飞机提供飞行姿态和航向信息，在飞机长航时飞行过程中，航姿系统 的航向误差随着时间积累，不能满足飞机精确着陆的要求；磁传感器作为航向传感器，其精 度较为稳定，不随时间积累，但是其逐次误差较大，也不能满足飞机的实际使用要求。可通 过航姿系统短期航向精度高的有点对磁传感器的逐次误差进行校正，利用磁传感器长期精 度稳定的特点对航姿系统的航向陀螺漂移进行校正，有效地提高航姿系统的航向精度，从 而满足飞机长航时的使用要求。
【发明内容】
[0003] 本发明的目的是提出一种改善航姿系统航向精度和动态特性的方法，解决航姿系 统长航时飞行情况下航向误差较大的难题。
[0004] 本发明采取的技术方案为一种改善航姿系统航向精度和动态特性的方法，其特征 在于通过航姿系统短期航向精度高的有点对磁传感器的逐次误差进行校正，利用磁传感器 长期精度稳定的特点对航姿系统的航向陀螺漂移进行校正，包括：
[0005] 1)计算航向校准磁传感器的逐次启动误差
[0006] 计算周期Ts，共计算Μ次。
[0007] Δ Ψ[?] = ￥ins[i]-￥nag[i]
[0008] Δ Ψ [i] = (1-α ) X Δ Ψ [i] + a X Δ Ψ [?-1]
[0009] Δ Ψ [i-Ι] =Δ Ψ [?]
[0010]其中，
[0011] Vins[i]为每Ts计算得到的航姿系统航向，单位rad;
[0012] Vmg[i]为每Ts计算得到的磁航向，单位rad ;
[0013] Λ Ψ [i]为每Ts计算得到的磁航向的逐次启动修正量，单位rad，Λ Ψ [i]的初值 取 0,即：Λ Ψ [0] = 0 ;
[0014] α为计算参数；
[0015] i = l，2,3...M〇
[0016] 2)利用磁传感器输出的航向校准航姿系统的航向陀螺漂移误差，计算公式如下：
[0017] δ ψ = ψ-ψ〇
[0018] δ Ψη = δ ￥-(an !+bn ! · η · Tc) 2δψη
[0019] an. = a η_λ --- η t ; βδψ,,
[0020] b0 - bn_x + -~~-
[0021] an 1 = an
[0022] bn ! = bn
[0023] 其中：
[0024] Ψ。为开始估算航向陀螺漂移误差时刻的航姿系统航向角，单位rad ;
[0025] Ψ为当前时刻的航姿系统航向角，单位rad ;
[0026] bn为航姿系统的航向陀螺漂移误差，单位rad/s ;
[0027] 3"1、匕1初值为0;
[0028] Tc为计算周期，单位s ;
[0029] η = 1，2，…N，N为计算次数。
[0030] 本发明具有的优点和有益效果：本发明是一种改善航姿系统航向精度和动态特性 的方法。本发明通过航姿系统短期航向精度高的有点对磁传感器的逐次误差进行校正，利 用磁传感器长期精度稳定的特点对航姿系统的航向陀螺漂移进行校正，提高了航姿系统在 飞行过程中的航向精度，计算方法简单可靠，具有较好的工程适用性。
【附图说明】
[0031] 图1是按照本发明的方法进行航姿系统航向修正的流程图。
【具体实施方式】
[0032] 下面结合说明书附图对本发明做详细说明，
[0033] 本发明是一种改善航姿系统航向精度和动态特性的方法，如图1所示，包括： [0034] 步骤1、在飞机地面对准阶段，航姿系统通过外部航向基准获得初始航向；；
[0035] 步骤2、在飞机爬升阶段，利用航姿系统的航向校准磁传感器的逐次启动误差；
[0036] 步骤3、在飞机巡航和任务段，利用磁传感器输出的航向校准航姿系统的航向陀螺 漂移误差；
[0037] 步骤4、在飞机进近着陆段，航姿系统提供高精度航向引导飞机着陆。
[0038] 具体的，步骤2中利用航姿系统的航向校准磁传感器的逐次启动误差，计算的步 骤包括：
[0039] 计算周期Ts，共计算Μ次。
[0040] Δ Ψ [i] = ￥ins[i]-￥nag[i]
[0041] Δ Ψ [i] = (1-α ) X Δ Ψ [i] + a X Δ Ψ [?-1]
[0042] Δ Ψ [i-Ι] =Δ Ψ [?]
[0043] 其中，
[0044] Vins[i]为每Ts计算得到的航姿系统航向，单位rad ;
[0045] ￥mag[i]为每Ts计算得至lj的磁航向，单位rad ;
[0046] Λ Ψ [i]为每Ts计算得到的磁航向的逐次启动修正量，单位rad，Λ Ψ [i]的初值 取 0,即：Λ Ψ [0] = 0 ;
[0047] α为计算参数；α = 〇· 85 ;
[0048] i = 1，2, 3...M，Μ = 100。
[0049] 具体的，步骤3中利用磁传感器输出的航向校准航姿系统的航向陀螺漂移误差， 计算的步骤包括：
[0050] δ ψ = ψ - ψ 〇
[0051] δ ψη = δ ￥-(an !+bn j · n · Tc) 2δψ
[0052] an = an_, n , , 6d>"
[0053] b" =bM +-~ -- (n+ 1)-/2-7,
[0054] an i = an
[0055] bn ! = bn
[0056] 其中：
[0057] Ψ。为开始估算航向陀螺漂移误差时刻的航姿系统航向角，单位rad ;
[0058] Ψ为当前时刻的航姿系统航向角，单位rad ;
[0059] bn为航姿系统的航向陀螺漂移误差，单位rad/s ;
[0060] an !、bn 1 初值为 0 ;
[0061] Tc为计算周期，单位s ;
[0062] η = 1，2，…N，N 为计算次数，N = 100。
【主权项】
1. 一种改善航姿系统航向精度和动态特性的方法，其特征在于，包括： 1) 计算航向校准磁传感器的逐次启动误差 计算周期Ts,共计算M次。 A ￥ [1] = ￥ms[i]-V"ag[i] A ￥ 山=(1-a ) X A W 山 + a X A W [i-1] A W [i-1] = A W 山 其中， V[i]为每L计算得到的航姿系统航向，单位rad ; Vm巧。]为每Ts计算得到的磁航向，单位rad; A ￥山为每L计算得到的磁航向的逐次启动修正量，单位rad, A W山的初值取0， 目P ; A W [0] = 0 ; a为计算参数； i = 1, 2, 3. . . M。 2) 利用磁传感器输出的航向校准航姿系统的航向巧螺漂移误差，计算公式如下：其中： V。为开始估算航向巧螺漂移误差时刻的航姿系统航向角，单位rad ; V为当前时刻的航姿系统航向角，单位rad; b。为航姿系统的航向巧螺漂移误差，单位rad/s ; 曰。1、6。1初值为〇; Tc为计算周期，单位S ; n = 1，2，…N，N为计算次数。2. 如权利要求1所述的一种改善航姿系统航向精度和动态特性的方法，其特征在于： 201、 在飞机地面对准阶段，航姿系统通过外部航向基准获得初始航向，计算公式如 下： Vins = Vo 其中， V为航姿系统航向，单位rad ; V。为外部输入的基准航向，单位rad。 202、 在飞机爬升阶段，利用航姿系统的航向校准磁传感器的逐次启动误差，计算公式 如下： a) 误差估计 计算航向校准磁传感器的逐次启动误差，计算周期L，共计算M次。 A V 山=￥ins[i]-Vmag[i] A ￥ 山=(1-a ) X A W 山 + a X A W [i-1] A W [i-1] = A W 山 其中， V[i]为每L计算得到的航姿系统航向，单位rad ; Vm巧。]为每Ts计算得到的磁航向，单位rad; A ￥山为每L计算得到的磁航向的逐次启动修正量，单位rad, A W山的初值取0， 目P ; A W [0] = 0 ; a为计算参数； i = 1, 2, 3. . . M。 b) 误差修正 利用航向校准磁传感器的逐次启动误差修正磁传感器航向的实时输出量，计算公式如 下：其中， 为磁传感器航向的实时测量值，单位rad ; Wmag修正后为磁传感器航向的实时输出值，单位rad ; A ￥为磁航向的逐次启动修正量，单位rad。 203、在飞机巡航和任务段，利用磁传感器输出的航向校准航姿系统的航向巧螺漂移误 差，计算公式如下： a)误差估计 利用磁传感器输出的航向校准航姿系统的航向巧螺漂移误差，计算公式如下：其中： V。为开始估算航向巧螺漂移误差时刻的航姿系统航向角，单位rad ; V为当前时刻的航姿系统航向角，单位rad; b。为航姿系统的航向巧螺漂移误差，单位rad/s ; 曰n l、bn 1初值为0 ; Tc为计算周期，单位S ; n = 1，2，…N，N为计算次数。 b)误差修正 利用航向巧螺漂移误差修正航姿系统的巧螺漂移，计算公式如下： 其中，Dz为修正前航姿系统的航向巧螺漂移，单位rad/s ; 为修正后的航姿系统的航向巧螺漂移，单位rad/s ; bw为航姿系统的航向巧螺漂移误差，单位rad/so
【专利摘要】本发明涉及一种改善航姿系统航向精度和动态特性的方法。本发明采取的方案为：首先，在飞机地面对准阶段，航姿系统通过外部航向基准获得初始航向；其次，在飞机爬升阶段，利用航姿系统的航向校准磁传感器的逐次启动误差；然后，在飞机巡航和任务段，航姿系统利用磁传感器输出的航向校准航姿系统的航向陀螺漂移误差；最后，在飞机进近着陆段，航姿系统提供高精度航向引导飞机着陆。本发明改善了航姿系统航向精度，既保证了航姿系统航向输出的精度，又保证了航向输出的实时性，计算方法简单可靠，具有较好的工程适用性。
【IPC分类】G01C25/00
【公开号】CN105651307
【申请号】
【发明人】魏学东, 张晓琳, 张乐, 谭宏光
【申请人】中国航空工业第六一八研究所
【公开日】2016年6月8日
【申请日】2014年11月14日