[发明专利]一种基于指令力矩矢量调节的控制力矩陀螺奇异规避方法

权利要求书

1.一种基于指令力矩矢量调节的控制力矩陀螺奇异规避方法，其特征在于包括如下步骤：

(1)采集控制力矩陀螺群框架角向量δ，然后根据控制力矩陀螺运动方程计算框架角运动的雅克比矩阵J；

(2)计算奇异度量值Sv为

Sv＝det(J·J^T)

进而得到指令力矩矢量调节系数υ为

υ=0if Sv>Ds3-ktmpυ·(Sv-Ds3)if Sv≤Ds3]]>

当|υ|>υ_Limt时，υ＝sgn(υ)·υ_Limt，其中，k_tmpυ为调节增益，D_s3为矢量调节阈值，υ_Limt为矢量调节系数限幅值，sgn(υ)为取υ的符号运算；

(3)根据姿态控制器给出的控制力矩指令τ_c得到控制力矩指令调节矢量τ_cAd为

τcAd=1-υυυ1-υ-υυ1·τc]]>

(4)根据奇异度量值Sv确定零运动奇异规避强度系数α_s1、鲁棒奇异规避强度系数α_s2，对于零运动奇异规避强度系数α_s1，

当Sv<D_s1时，零运动奇异规避强度系数

当D_s1≤Sv<D_s2时，零运动奇异规避强度系数

当Sv≥D_s2时，零运动奇异规避强度系数α_s1＝0；

其中，D_s1为鲁棒奇异规避启动阈值，D_s2为零运动奇异规避启动阈值，C₁为零运动奇异规避强度增益系数，α_s10为偏置量；

(5)对于鲁棒奇异规避强度系数α_s2，当Sv<D_s1时，鲁棒奇异规避强度系数αs2=C2·(1Sv+10-6-1Ds1+10-6);]]>

当Sv≥D_s1时，鲁棒奇异规避强度系数α_s2＝0，其中，C₂为鲁棒奇异规避强度增益系数；

(6)根据控制力矩指令调节矢量τ_cAd、奇异规避强度系数α_s1及α_s2得到控制力矩陀螺框架角速度指令向量为δ·d=-1Hcmg0JT(J·JT+αs2I3)-1τcAd+αs1(I3-JT(J·JT+αs2I3)-1J)∂Sv(δ)∂δ.]]>

使用控制力矩陀螺框架角速度指令向量调整控制力矩陀螺群中控制力矩陀螺框架角速度，其中，H_cmg0为控制力矩陀螺角动量，I₃为3阶单位矩阵，为Sv对框架角向量δ的偏导数，-1为矩阵逆运算符号。