[发明专利]一种基于双解算程序的光纤陀螺常值误差标定方法

权利要求书

1.一种基于双解算程序的光纤陀螺常值误差标定方法，具体包括如下步骤：

步骤1：将捷联惯导系统中的惯性组件，陀螺仪和加速度计安装在三轴转台上；

步骤2：三轴转台带动惯性组件旋转至与当地东北天地理坐标系一致的位置，设该位置为位置A，停留时间大于两小时；在位置A处，陀螺仪沿导航系z轴的输出误差为：

ϵzAn=ϵz0+δKgzωz---(1)]]>

其中，表示在位置A处陀螺仪沿导航系z轴的输出误差；ε_z0、δK_gz分别表示方位轴陀螺仪的常值漂移和刻度因数误差；ω_z表示方位轴陀螺仪敏感角速度信息，Ω表示地球自转角速度，表示载体所在地理纬度；

步骤3：在位置A的停留时间内，通过导航解算程序1进行导航解算，利用惯性组件测量信息解算载体姿态信息，具体过程如下：

首先更新角速度：

ωnss=ωiss-(Cs(A)n)T(ωien+ωenn)-(Cs(A)n)Tωcn---(2)]]>

其中，i表示地心惯性系，e表示地球坐标系，s表示IMU坐标系，n表示导航坐标系，表示位置A处s系到n系转换矩阵；·^T表示矩阵转置；为控制角速率在n系上的投影；表示IMU相对导航系旋转角速度在IMU系投影；表示由于载体运动导致导航系变化角速度在导航系投影；为地球自转角速度在n系投影；

地球自转角速度在导航系投影更新：

其中：v_x＝δv_x，v_y＝δv_y，v_j、δv_j分别表示惯导系统解算速度和速度误差，j＝x,y；

更新过程为：

其中，R表示地球半径；

控制角速率在导航坐标系ox_n轴、oy_n轴、oz_n轴上的分量和更新为：

其中，k₁＝k₂＝2ξ₁ω_n1、k₁、k₂、k_E、k_N、k_U为在导航解算程序1的罗经参数，ξ₁、ω_n1表示导航参数，取值范围分别为ξ₁∈(0,1)、ω_n1∈(0,1)；s表示复数域参变量；g表示重力加速度；

采用更新四元数法更新捷联矩阵

设载体坐标系相对导航坐标系的转动四元数Q为：

Q＝q₀+q₁i_b+q₂j_b+q₃k_b             （6）

其中，q₀、q₁、q₂和q₃为四元数的四个实数；i_b、j_b和k_b分别表示ox_s轴、oy_s轴和oz_s轴上的单位方向向量；

四元数Q的及时修正：

q.0q.1q.2q.3=120-ωnsxs-ωnsys-ωnszsωnsxs0ωnszs-ωnsysωnsys-ωnszs0ωnsxsωnszsωnsys-ωnsxs0q0q1q2q3---(7)]]>

其中，表示IMU系相对导航坐标系的旋转角速度在载体坐标系ox_s轴、oy_s轴、oz_s轴上的分量；分别表示q₀、q₁、q₂、q₃的微分量；

通过（7）式，利用陀螺仪测量值间接计算得到的求解微分方程，得到四元数q₀、q₁、q₂、q₃更新结果；更新捷联矩阵

Cs(A)n=q02+q12-q22-q322(q1q2-q0q3)2(q1q3+q0q2)2(q1q2+q0q3)q02-q12+q22-q322(q2q3-q0q1)2(q1q3-q0q2)2(q2q3+q0q1)q02-q12-q22+q32---(8)]]>

更新载体姿态信息：

θA1=arcsin(c33)φA1=arctan(c32/c31)ψA1=arctan(c13/c23)---(9)]]>

其中，θ_A1、φ_A1、ψ_A1为导航程序1解算载体的纵摇角、横滚角、航向角；c_ij表示中第i行第j列矩阵元素，i,j＝1,2,3；

利用加速度计测量比力通过矩阵转换：

fn=Cs(A)nfs---(10)]]>

其中，fⁿ、f^s分别表示加速度计测量比力在n系和s系投影；

利用下列微分方程求解载体运动速度：

v·xv·yv·z=fxnfynfzn-00g+02ωiezn-(2ωieyn+ωenyn)-ωiezn02ωiexn+ωenxn2ωieyn+ωenyn-(2ωiexn+ωenxn)0vxvyvz---(11)]]>

其中，分别表示加速度计测量比力在导航坐标系ox_n轴、oy_n轴、oz_n轴上的分量；g为重力加速度；和分别表示地球自转角速度在导航坐标系ox_n轴、oy_n轴、oz_n轴上的分量；分别表示由于载体运动导致导航坐标系相对地球坐标系变化的旋转角速度在导航坐标系ox_n轴、oy_n轴上的投影；分别表示v_x、v_y、v_z的微分量；

步骤4：同样在位置A的停留时间内，利用与步骤3相同的计算方法，通过导航解算程序2进行导航解算，其中导航参数设置不同，其中：

角速度更新为：

ωns′s=ωiss-(Cs(A)′n)T(ωien+ωenn)-(Cs(A)′n)Tωc′n---(11)]]>

其中，表示位置A处导航解算程序2中解算s系到n系转换矩阵；为导航解算程序2中解算控制角速率在n系上的投影；为导航解算程序2中IMU相对导航系旋转角速度在IMU系投影的计算值；

（11）式中，更新过程与步骤3中相同；控制角速率更新过程与步骤3中有所区别，更新过程为：

其中，

k₁′＝k₂′＝2ξ₂ω_n2

其中，ξ₂、ω_n2为导航解算程序2中的导航参数；k′₁、k₂′、k′_E、k′_N、k′_U为在导航解算程序2的罗经参数；

更新捷联矩阵修正四元数：

q·0′q·1′q·2′q·3′=120-ωnsx′s-ωnsy′s-ωnsz′sωnsx′s0ωnsz′s-ωnsy′sωnsy′s-ωnsz′s0ωnsx′sωnsz′sωnsy′s-ωnsx′s0q0′q1′q2′q3′---(14)]]>

其中，表示导航解算程序2中，IMU系相对导航坐标系的旋转角速度在载体坐标系投影的计算值；q′_k为导航解算程序2中解算四元数，为q′_k的微分量，k＝1,2,3,4；

通过（14）式，利用陀螺仪测量值间接计算得到的求解微分方程，得到四元数q₀′、q₁′、q₂′、q₃′更新结果；

更新捷联矩阵

Cs(A)′n=q0′2+q1′2-q2′2-q3′22(q1′q2′-q0′q3′)2(q1′q3′+q0′q2′)2(q1′q2′+q0′q3′)q0′2-q1′2+q2′2-q3′22(q2′q3′-q0′q1′)2(q1′q3′-q0′q2′)2(q2′q3′+q0′q1′)q0′2-q1′2-q2′2+q3′2---(15)]]>

更新载体姿态信息：

θA2=arcsin(c33′)φA2=arctan(c32′/c31′)ψA2=arctan(c13′/c23′)---(16)]]>

其中，θ_A2、φ_A2、ψ_A2为导航程序2解算载体的纵摇角、横滚角、航向角；c′_ij表示中第i行第j列矩阵元素；

步骤5：利用步骤3与步骤4得到的两组姿态信息，进行耦合运算，计算方式如下：

式中，表示位置A处陀螺仪沿oz_n轴输出误差，Ω表示地球自转角速度，表示位置A的地理纬度；

结合（1）式可知，利用（17）式计算得到的项包含ε_z0和δK_gz；

步骤6：相对于位置A，旋转机构带动惯性组件绕ox_s轴旋转180°，其中，顺时针旋转为正，使oz_s轴陀螺仪沿导航系-oz_n方向，设该位置为位置B，停留时间大于两小时；其中，s表示IMU坐标系，ox_s表示沿s系ox轴方向；

此时陀螺仪沿导航系z轴的输出误差为

ϵzBn=-ϵz0+δKgzωz---(18)]]>

其中，表示在位置B处陀螺仪沿导航系z轴的输出误差；

步骤7：在位置B的停留时间内，重复步骤3-步骤5；

IMU停留在位置B处以一组惯性组件的输出同时进行两组导航程序解算，解算姿态耦合运算，得到捷联惯导旋转至位置B处陀螺仪沿oz_n轴输出误差为：

其中，下角标B1和B2分别表示在位置B处导航计算机中导航解算程序1、导航解算程序2解算姿态信息；

结合（18）式可知，利用（19）式计算得到的包含-ε_z0和δK_gz项；

步骤8：根据步骤5与步骤7得到两组陀螺仪沿oz_n轴输出误差和结合（1）式、（18）式，得到方位陀螺仪的常值漂移和刻度因数误差；

至此，通过步骤2-步骤8，估算出方位轴陀螺仪的常值漂移和刻度因数误差；

步骤9：相对于位置B，旋转机构带动惯性组件绕oy_s轴旋转-90°，使ox_s轴陀螺仪沿导航系oz_n方向，设该位置为位置C，停留时间大于两小时；停留过程中，重复步骤3-步骤5；

此时陀螺仪沿导航系z轴的输出误差为

ϵzCn=ϵx0+δKgxωz---(21)]]>

其中，表示在位置C处陀螺仪沿导航系z轴的输出误差；ε_xs0、δK_gx分别表示纵摇轴陀螺仪的常值漂移和刻度因数误差；

由此得到停留过程中，IMU旋转至位置C处陀螺仪沿oz_n轴输出误差为

其中，下角标C1和C2分别表示在位置C处利用导航计算机中导航解算程序1、导航解算程序2解算的姿态信息；

步骤10：相对于位置C，旋转机构带动惯性组件绕oz_s轴旋转180°，使ox_s轴陀螺仪沿导航系-oz_n方向，设该位置为位置D，停留时间大于两小时；

此时陀螺仪沿导航系z轴的输出误差为

ϵzDn=-ϵx0+δKgxωz---(23)]]>

其中，表示在位置D处陀螺仪沿导航系z轴的输出误差；

停留过程中，重复步骤3-步骤5，得到捷联惯导旋转至位置D处陀螺仪沿oz_n轴输出误差计算方式为

其中，下角标D1和D2分别表示在位置D处利用导航计算机中导航解算程序1、导航解算程序2解算的姿态信息；

步骤11：根据步骤9与步骤10得到的两组陀螺仪沿oz_n轴输出误差和结合（21）和（23）式，得到ox_s陀螺仪的常值漂移和刻度因数误差；

其中，ε_x0表示ox_s轴陀螺常值漂移，δK_gx表示ox_s轴陀螺刻度因数误差；

通过步骤9-步骤11，估算出ox_s轴陀螺仪的常值漂移和刻度因数误差；

步骤12：相对于位置D，旋转机构带动惯性组件绕oz_s轴旋转-90°，使oy_s轴陀螺仪沿导航系oz_n方向，设该位置为位置E，停留时间大于两小时；

IMU置于位置E时，oy_s轴陀螺仪，即横摇轴陀螺仪沿导航系oz_n方向，因此陀螺仪沿oz_n方向的输出误差形式为

ϵzEn=ϵy0+δKgyωz---(26)]]>

其中，表示在位置E处陀螺仪沿导航系z轴的输出误差；ε_y0、δK_gy分别表示横摇轴陀螺仪的常值漂移和刻度因数误差；

停留过程中，重复步骤3-步骤5得到捷联惯导旋转至位置E处陀螺仪沿oz_n轴输出误差；计算方式为

其中，下角标E1和E2分别表示在位置E处利用导航计算机中导航解算程序1、导航解算程序2解算的姿态信息；

（26）、（27）式中可以看出，IMU置于位置E处，利用一组惯性组件测量值、两组导航程序解算值耦合计算得到沿导航系z轴陀螺仪输出误差包含ε_y0和δK_gy项；

步骤13：相对于位置E，旋转机构带动惯性组件绕oz_s轴旋转180°，使oy_s轴陀螺仪沿导航系-oz_n方向，设该位置为位置F，停留时间大于两小时；

IMU置于位置F时，oy_s轴陀螺仪沿导航系-oz_n方向，陀螺仪沿oz_n方向的输出误差为

ϵzFn=-ϵy0+δKgyωz---(28)]]>

其中，表示在位置F处陀螺仪沿导航系z轴的输出误差；

停留过程中，重复步骤3-步骤5，得到捷联惯导旋转至位置F处陀螺仪沿oz_n轴输出误差为

其中，下角标F1和F2分别表示在位置F处利用导航计算机中导航解算程序1、导航解算程序2解算的姿态信息；（26）、（27）式中可以看出，IMU置于位置F处，利用一组惯性组件测量值、两组导航程序解算值耦合计算得到沿导航系z轴陀螺仪输出误差包含-ε_y0和δK_gy项；

步骤14：根据步骤12与步骤13得到的两组陀螺仪沿oz_n轴输出误差和结合（26）式和（28）式得到oy_s陀螺仪的常值漂移和刻度因数误差；

其中，ε_y0表示oy_s轴陀螺常值漂移，δK_gy表示oy_s轴陀螺刻度因数误差；

通过步骤12-步骤14，估算出oy_s轴陀螺仪的常值漂移和刻度因数误差；

通过上述步骤，得到陀螺仪方位轴的常值漂移和刻度因数误差、ox_s轴的常值漂移和刻度因数误差、oy_s轴的常值漂移和刻度因数误差。