利用角速率估计信息的单套陀螺故障诊断方法技术

利用角速率估计信息的单套陀螺故障诊断方法，包括以下步骤：S1、设定卫星的姿态动力学模型、卫星的运动学模型和卫星的状态变量；S2、根据卫星的姿态动力学模型、卫星的运动学模型和卫星的状态变量建立状态方程和测量方程；S3、将所述状态方程和测量方程离散化；S4、根据离散化的状态方程和测量方程对测量的卫星的姿态角进行滤波，获得当前拍的姿态角和角速度的估计值；S5、测量卫星的惯性角速度，根据当前拍的角速度的估计值和预定阈值，来判断陀螺是否故障。

A single set of gyroscope fault diagnosis method using angular rate estimation information

A single set of gyro fault diagnosis method using angular rate estimation information, which comprises the following steps: S1, set the satellite attitude dynamics model and the kinematics model of satellite and satellite state variables; the establishment of the state equation and measurement equation of S2, according to the state variables and the kinematics model of satellite satellite, the satellite attitude dynamics model; S3 the discrete state equation and measurement equation; filtering S4, satellite according to the state equation and measurement equation discretization on the measurement of the attitude angle estimation to obtain the current shot attitude angle and angular velocity value; S5 satellite measurement, inertial angular velocity, angular velocity according to the estimated current value and shoot a predetermined threshold to determine whether the gyro fault.

【技术实现步骤摘要】
利用角速率估计信息的单套陀螺故障诊断方法
本专利技术涉及一种卫星姿态控制单套速率陀螺的故障诊断方法。
技术介绍
当卫星只有一套速率陀螺开机运行时，仅能测得一组卫星的三轴角速率，设为ωm＝[ωmx(k)ωmy(k)ωmz(k)]T。由于没有冗余的角速率测量信息，很难对陀螺的故障进行有效诊断。然而，卫星一般配有多种角度测量敏感器，如星敏感器、太阳敏感器、地平仪等，通过多种角度敏感器的信息融合，可以较为可靠的获得卫星在参考坐标系的角度信息，设为θm、ψm。利用角度信息对卫星角速率进行较为准确的估计，得到卫星在参考坐标系的角速率，设为因此需要将单套陀螺测得的角速率信号和利用角度敏感器求得的角速率估计值进行比较，当诊断出陀螺故障后，可进行控制模式切换(如无陀螺信息的控制模式)，以免卫星姿态失稳。
技术实现思路
本专利技术的技术解决问题是：解决现有技术的缺陷，提出一种利用角速率估计信息的单套陀螺故障诊断方法，可将单套陀螺测得的角速率信号和利用角度敏感器求得的角速率估计值进行比较，以实现速率陀螺的故障诊断。本专利技术的技术解决方案是：利用角速率估计信息的单套陀螺故障诊断方法，包括以下步骤：S1、设定卫星的姿态动力学模型、卫星的运动学模型和卫星的状态变量；S2、根据卫星的姿态动力学模型、卫星的运动学模型和卫星的状态变量建立状态方程和测量方程；S3、将所述状态方程和测量方程离散化；S4、根据离散化的状态方程和测量方程对测量的卫星的姿态角进行滤波，获得当前拍的姿态角和角速度的估计值；S5、测量卫星的惯性角速度，根据当前拍的角速度的估计值和预定阈值，来判断陀螺是否故障。根据本专利技术的一个实施例，在步骤S1中，卫星的姿态动力学模型为：卫星的运动学模型为：卫星的状态变量为：其中，I为卫星的惯量矩阵，为卫星的角速度，为卫星的角速度的一阶导数，ωbix为卫星的滚动角速度，ωbiy为卫星的俯仰角速度，ωbiz为卫星的偏航角速度，h为卫星的角动量，为卫星的角动量的一阶导数，ω0为卫星轨道角速度，为卫星的滚动角，θ为卫星的俯仰角，ψ为卫星的偏航角，为卫星的滚动角的一阶导数，为卫星的俯仰角的一阶导数，为卫星的偏航角的一阶导数，Td为卫星的干扰力矩。根据本专利技术的一个实施例，在步骤S2中，状态方程为：测量方程为Z＝HX+DV，其中，为卫星的滚动角速度的一阶导数，为卫星的俯仰角速度的一阶导数，为卫星的偏航角速度的一阶导数，U为控制量输入，E为单位矩阵，W是输入噪声，H＝D＝[03×3E3×3]，V为量测噪声，根据本专利技术的一个实施例，在步骤S3中，离散化的状态方程为：X(k)＝Φk,k-1X(k-1)+Gk,k-1u(k-1)+Γk,k-1Wk-1，离散化的测量方程为：Z(k)＝H(k)X(k)+D(k)V(k)，其中，X(k)为当前拍的状态变量，X(k-1)为上一拍的状态变量，Z(k)为当前拍的卫星的姿态角，Wk-1为上一拍的输入噪声，ΔT为采样周期，Ux为滚动轴控制量输入，Uy为俯仰轴控制量输入，Uz为偏航轴控制量输入，为上一拍滚动角速度估计值，为上一拍俯仰角速度估计值，为上一拍偏航角速度估计值，为上一拍偏航角估计值，为上一拍滚动角估计值，为上一拍偏航角估计值，H(k)＝D(k)＝[03×3I3×3]，V(k)为当前拍的量测噪声。根据本专利技术的一个实施例，计算Ux、Uy和Uz包括以下步骤：(1)根据等式计算当前拍的卫星的角动量的一阶导数其中，h(k)为当前拍的卫星的角动量，hx(k)为当前拍滚动轴的角动量，hx(k-1)为上一拍拍滚动轴的角动量，hy(k)为当前拍俯仰轴的角动量，hy(k-1)为上一拍拍俯仰轴的角动量，hz(k)为当前拍偏航轴的角动量，hz(k-1)为上一拍偏航轴的角动量；(2)根据等式计算当前拍卫星星体总角动量Htotal(k)，其中，ω(k-1)为上一拍的卫星角速度，Ixx为滚动轴的惯量，Ixy为滚动轴和俯仰轴的惯量积，Ixz为滚动轴和偏航轴的惯量积，Iyy为俯仰轴的惯量，Iyz为俯仰轴和偏航轴的惯量积，Izz为偏航轴的惯量，Hx_total(k)为当前拍滚动轴总角动量，Hy_total(k)为当前拍俯仰轴总角动量，Hz_total(k)为当前拍偏航轴总角动量；(3)根据等式计算总力矩M_total，其中，Td(k)为当前拍的卫星的干扰力矩，M根据等式获得；(4)根据等式获得Ux、Uy和Uz。根据本专利技术的一个实施例，在步骤S4中，当前拍的滚动角测量值为当前拍的俯仰角测量值为θm，当前拍的偏航角测量值为ψm，根据滤波方程获得当前拍的滚动角速度估计值当前拍的俯仰角速度估计值和当前拍的偏航角速度估计值K1、K2和K3为滤波增益。根据本专利技术的一个实施例，在步骤S4中，当前拍的滚动角估计值当前拍的俯仰角估计值当前拍的偏航角估计值根据等式获得。根据本专利技术的一个实施例，在步骤S5中，滚动角速度测量值为ωmx(k)，俯仰角速度测量值为ωmy(k)，偏航角速度测量值为ωmz(k)，当时，陀螺有故障，否则，陀螺无故障，其中，δ为预定误差阈值。根据本专利技术的一个实施例，预定误差阈值δ为陀螺三轴噪声与对应三轴角速度估计误差的平方和的1.5倍。一种存储了指令的计算机可读存储介质，当所述指令被至少一个计算机执行时，使得所述计算机执行以下步骤：S1、设定卫星的姿态动力学模型、卫星的运动学模型和卫星的状态变量；S2、根据卫星的姿态动力学模型、卫星的运动学模型和卫星的状态变量建立状态方程和测量方程；S3、将所述状态方程和测量方程离散化；S4、根据离散化的状态方程和测量方程对测量的卫星的姿态角进行滤波，获得当前拍的姿态角和角速度的估计值；S5、测量卫星的惯性角速度，根据当前拍的角速度的估计值和预定阈值，来判断陀螺是否故障。本专利技术与现有技术相比的优点在于：(1)提供了冗余的角速率测量信息，对陀螺的故障进行有效诊断(2)利用卫星上现有的多种角度测量敏感器，如星敏感器、太阳敏感器、地平仪，通过多种角度敏感器可以较为可靠的获得卫星在参考坐标系的角度信息，从而提高测量精度。(3)利用角度信息对卫星角速率进行较为准确的估计，可提供对陀螺进行故障诊断的参考信号，以实现速率陀螺的故障诊断。附图说明图1是根据本专利技术的实施例的利用角速率估计信息的单套陀螺故障诊断方法流程图。具体实施方式下面根据附图详细描述本专利技术的实施例。如图1所示，利用角速率估计信息的单套陀螺故障诊断方法包括以下步骤：S1、设定卫星的姿态动力学模型、卫星的运动学模型和卫星的状态变量。在步骤S1中，卫星的姿态动力学模型为如以下等式(1)所示：卫星的运动学模型为如以下等式(2)所示：卫星的状态变量为：其中，I为卫星的惯量矩阵，为卫星的角速度，为卫星的角速度的一阶导数，ωbix为卫星的滚动角速度，ωbiy为卫星的俯仰角速度，ωbiz为卫星的偏航角速度，h为卫星的角动量，为卫星的角动量的一阶导数，ω0为卫星轨道角速度，为卫星的滚动角，θ为卫星的俯仰角，ψ为卫星的偏航角，为卫星的滚动角的一阶导数，为卫星的俯仰角的一阶导数，为卫星的偏航角的一阶导数，Td为卫星的干扰力矩。S2、根据卫星的姿态动力学模型、卫星的运动学模型和卫星的状态变量建立状态方程和测量方程。在步骤S2中，状态方程为如以下等式(3)所示：测量方程如以下等式(4)所示本文档来自技高网...

【技术保护点】
利用角速率估计信息的单套陀螺故障诊断方法，其特征在于，包括以下步骤：S1、设定卫星的姿态动力学模型、卫星的运动学模型和卫星的状态变量；S2、根据卫星的姿态动力学模型、卫星的运动学模型和卫星的状态变量建立状态方程和测量方程；S3、将所述状态方程和测量方程离散化；S4、根据离散化的状态方程和测量方程对测量的卫星的姿态角进行滤波，获得当前拍的姿态角和角速度的估计值；S5、测量卫星的惯性角速度，根据当前拍的角速度的估计值和预定阈值，来判断陀螺是否故障。

【技术特征摘要】
1.利用角速率估计信息的单套陀螺故障诊断方法，其特征在于，包括以下步骤：S1、设定卫星的姿态动力学模型、卫星的运动学模型和卫星的状态变量；S2、根据卫星的姿态动力学模型、卫星的运动学模型和卫星的状态变量建立状态方程和测量方程；S3、将所述状态方程和测量方程离散化；S4、根据离散化的状态方程和测量方程对测量的卫星的姿态角进行滤波，获得当前拍的姿态角和角速度的估计值；S5、测量卫星的惯性角速度，根据当前拍的角速度的估计值和预定阈值，来判断陀螺是否故障。2.根据权利要求1所述的利用角速率估计信息的单套陀螺故障诊断方法，其特征在于，在步骤S1中，卫星的姿态动力学模型为：卫星的运动学模型为：卫星的状态变量为：其中，I为卫星的惯量矩阵，为卫星的角速度，为卫星的角速度的一阶导数，ωbix为卫星的滚动角速度，ωbiy为卫星的俯仰角速度，ωbiz为卫星的偏航角速度，h为卫星的角动量，为卫星的角动量的一阶导数，ω0为卫星轨道角速度，为卫星的滚动角，θ为卫星的俯仰角，ψ为卫星的偏航角，为卫星的滚动角的一阶导数，为卫星的俯仰角的一阶导数，为卫星的偏航角的一阶导数，Td为卫星的干扰力矩。3.根据权利要求1所述的利用角速率估计信息的单套陀螺故障诊断方法，其特征在于，在步骤S2中，状态方程为：测量方程为Z＝HX+DV，其中，为卫星的滚动角速度的一阶导数，为卫星的俯仰角速度的一阶导数，为卫星的偏航角速度的一阶导数，U为控制量输入，E为单位矩阵，W是输入噪声，H＝D＝[03×3E3×3]，V为量测噪声，4.根据权利要求2所述的利用角速率估计信息的单套陀螺故障诊断方法，其特征在于，在步骤S3中，离散化的状态方程为：X(k)＝Φk,k-1X(k-1)+Gk,k-1u(k-1)+Γk,k-1Wk-1，离散化的测量方程为：Z(k)＝H(k)X(k)+D(k)V(k)，其中，X(k)为当前拍的状态变量，X(k-1)为上一拍的状态变量，Z(k)为当前拍的卫星的姿态角，Wk-1为上一拍的输入噪声，ΔT为采样周期，Ux为滚动轴控制量输入，Uy为俯仰轴控制量输入，Uz为偏航轴控制量输入，为上一拍滚动角速度估计值，为上一拍俯仰角速度估计值，为上一拍偏航角速度估计值，为上一拍偏...

【专利技术属性】
技术研发人员：李英波，刘斌，程卫强，程静，刘晓娜，张子龙，聂章海，陆丹萍，吴伟清，
申请(专利权)人：上海航天控制技术研究所，
类型：发明
国别省市：上海,31