[发明专利]一种二维导引姿态控制方法

权利要求书

1.一种二维导引姿态控制方法，其特征在于，包括以下过程：

在卫星运行的偏航方向引入偏航导引角和偏航导引角速度，计算得到修正后的偏航角速度；

在卫星运行的滚动方向进行与偏航方向的解耦控制，用于消除偏航方向导引后对滚动方向的耦合影响，得到修正后的滚动角速度；

在卫星运行的俯仰方向引入俯仰导引角和俯仰导引角速度，计算得到修正后的俯仰角速度；

将修正后的偏航角速度、修正后的俯仰角速度、修正后的滚动角速度分别对应与光纤陀螺组合输出角速度相加得到角速度指令；

将所述角速度指令代入控制算法得到卫星飞轮的控制力矩。

2.如权利要求1所述的一种二维导引姿态控制方法，其特征在于：所述修正后的偏航角速度ω_kx和修正后的滚动角速度ω_kz为：

式中，参数K、K_int为增益系数，ψ分别为滚动和偏航姿态角，ω₀为轨道角速度，ψ_c、分别为偏航导引角和偏航导引角速度。

3.如权利要求2所述的一种二维导引姿态控制方法，其特征在于：所述修正后的俯仰角速度ω_ky为：

式中，参数K_Icy、K_cy为增益系数，θ为俯仰姿态角，θ_c、分别为俯仰导引角和俯仰导引角速度。

4.如权利要求3所述的一种二维导引姿态控制方法，其特征在于，所述控制卫星飞轮的控制力矩的角速度指令信号ω_cx、ω_cy、ω_cz计算如下：

ω_cx＝ω_kx+ω_gx

ω_cy＝ω_ky+ω_gy

ω_cz＝ω_kz+ω_gz

式中，ω_gx、ω_gy、ω_gz为陀螺组合输出角速度信号。