CN112319852A - 一种带有前馈补偿的新型cmg操纵律设计方法 - Google Patents

Abstract

一种带有前馈补偿的新型CMG操纵律设计方法，属于航天器控制领域。航天器GNC模块在每个控制周期内不仅计算各个CMG的框架角速度指令，而且计算由于星体角速度影响而施加在各个CMG框架轴的陀螺力矩，将这两部分同时提供给CMG单机，用于确定控制律。与现有技术相比，本发明给出的方法利用陀螺力矩的信息，对CMG单机进行前馈补偿，从而放宽对星体角速度的约束，解决星体角速度较大时出现的CMG失速问题。

Description

一种带有前馈补偿的新型CMG操纵律设计方法

技术领域

本发明涉及一种带有前馈补偿的新型CMG操纵律设计方法，属于航天器控制领域。

背景技术

由于CMG的输出力矩较大，大型组合体航天器如空间站通常将CMG作为长期运行的执行部件。现有的CMG操纵律设计方法是：根据CMG群期望的三轴输出力矩，反解出各个CMG的框架角速度指令，然后各个CMG去跟踪各自的框架角速度指令。

发明内容

本发明要解决的技术问题是：当CMG跟踪其框架角速度指令时，如果星体的角速度较大，导致星体角速度在CMG框架轴上产生的陀螺力矩大于施加在CMG上的驱动力矩且反向时，无法实现跟踪，即发现了CMG失速现象。CMG失速现象的存在，使得CMG单机需要对星体的角速度施加苛刻的约束，这在很大程度上削弱了平台的功能。本发明在发现CMG失速现象的基础上，克服现有技术的不足，提供了一种带有前馈补偿的新型CMG操纵律设计方法。航天器GNC模块不仅计算各个CMG的框架角速度指令，而且计算由于星体角速度影响而施加在各个CMG框架轴的陀螺力矩，将这两部分同时提供给CMG单机，用于确定控制律。与现有技术相比，本发明给出的方法利用陀螺力矩的信息，对CMG单机进行前馈补偿，从而放宽对星体角速度的约束，解决星体角速度较大时出现的CMG失速问题。

本发明目的通过以下技术方案予以实现：

一种带有前馈补偿的新型CMG操纵律设计方法，包括如下步骤：

S1、在每个GNC控制周期内，基于GNC计算的姿态控制力矩T_cmgc，确定CMG群的框架角速度指令；

S2、在每个GNC控制周期内，计算星体角速度在每个CMG单机的框架轴上的陀螺力矩；

S3、CMG单机根据S2中所述的陀螺力矩确定控制律，用于跟踪S1中所述的框架角速度指令。

上述带有前馈补偿的新型CMG操纵律设计方法，优选的，所述确定CMG群的框架角速度指令的方法为：

式中，

其中，h₀为CMG的标称角动量大小，δ＝(δ₁,δ₂,…,δ_n)^T为CMG群的框架角，T_cmgc为姿态控制力矩，A和B均为3×n矩阵，其中A矩阵的第i列为第i个CMG框架角为90度时CMG角动量在航天器本体系的方位，B矩阵的第i列为第i个CMG框架角为0度时CMG角动量在航天器本体系的方位。

上述带有前馈补偿的新型CMG操纵律设计方法，优选的，计算星体角速度在第i个CMG单机的框架轴上的陀螺力矩

的方法为：

其中，ω为星体角速度，h_i为第i个CMG当前时刻的角动量，g_i为第i个CMG的框架轴方向。

一种带有前馈补偿的新型CMG操纵律确定装置，包括框架角速度指令确定模块、陀螺力矩确定模块、控制律确定模块；

所述框架角速度指令确定模块用于在每个GNC控制周期内，基于GNC计算的姿态控制力矩T_cmgc，确定CMG群的框架角速度指令；

所述陀螺力矩确定模块用于在每个GNC控制周期内，计算星体角速度在每个CMG单机的框架轴上的陀螺力矩；

所述控制律确定模块根据所述陀螺力矩确定控制律，用于跟踪所述框架角速度指令。

上述带有前馈补偿的新型CMG操纵律确定装置，优选的，所述确定CMG群的框架角速度指令的方法为：

式中，

其中，h₀为CMG的标称角动量大小，δ＝(δ₁,δ₂,…,δ_n)^T为CMG群的框架角，T_cmgc为姿态控制力矩，A和B均为3×n矩阵，其中A矩阵的第i列为第i个CMG框架角为90度时CMG角动量在航天器本体系的方位，B矩阵的第i列为第i个CMG框架角为0度时CMG角动量在航天器本体系的方位。

上述带有前馈补偿的新型CMG操纵律确定装置，优选的，计算星体角速度在第i个CMG单机的框架轴上的陀螺力矩

的方法为：

其中，ω为星体角速度，h_i为第i个CMG当前时刻的角动量，g_i为第i个CMG的框架轴方向。

本发明相比于现有技术具有如下有益效果：

(1)本发明发现了当星体的角速度较大时，会出现无法跟踪GNC给出的框架角速度指令的情况，也即发现了CMG失速问题；

(2)本发明方法不仅解算出各个CMG的框架角速度指令，同时计算出由于星体角速度影响而施加在各个CMG框架轴的陀螺力矩，并将陀螺力矩作为前馈补偿量，解决了CMG失速问题；

(3)本发明方法突破了CMG单机对星体的角速度施加苛刻的约束条件，大幅提升了平台的能力；

(4)相比现有技术方案中仅提供框架角速度指令，本发明方法提出需要将各CMG框架轴受到的陀螺力矩也提供给CMG单机，是现有技术方案的一大改良，该方法普遍适用于采用CMG控制的各类卫星。

附图说明

图1为本发明实施例1方法的流程框图。

具体实施方式

为使本发明的目的、技术方案和优点更加清楚，下面将结合附图对本发明的实施方式作进一步详细描述。

一种带有前馈补偿的新型CMG操纵律设计方法，包括如下步骤：

S1、在每个GNC控制周期内，基于GNC计算的姿态控制力矩T_cmgc，确定CMG群的框架角速度指令；

S2、在每个GNC控制周期内，计算星体角速度在每个CMG单机的框架轴上的陀螺力矩；

S3、CMG单机根据S2中所述的陀螺力矩确定控制律，用于跟踪S1中所述的框架角速度指令。

一种带有前馈补偿的新型CMG操纵律确定装置，包括框架角速度指令确定模块、陀螺力矩确定模块、控制律确定模块；

所述框架角速度指令确定模块用于在每个GNC控制周期内，基于GNC计算的姿态控制力矩T_cmgc，确定CMG群的框架角速度指令；

所述陀螺力矩确定模块用于在每个GNC控制周期内，计算星体角速度在每个CMG单机的框架轴上的陀螺力矩；

所述控制律确定模块根据所述陀螺力矩确定控制律，用于跟踪所述框架角速度指令。

作为本发明的一种优选方案，所述确定CMG群的框架角速度指令的方法为：

式中，

其中，h₀为CMG的标称角动量大小，δ＝(δ₁,δ₂,…,δ_n)^T为CMG群的框架角，T_cmgc为姿态控制力矩，A和B均为3×n矩阵，其中A矩阵的第i列为第i个CMG框架角为90度时CMG角动量在航天器本体系的方位，B矩阵的第i列为第i个CMG框架角为0度时CMG角动量在航天器本体系的方位。

作为本发明的一种优选方案，计算星体角速度在第i个CMG单机的框架轴上的陀螺力矩

的方法为：

其中，ω为星体角速度，h_i为第i个CMG当前时刻的角动量，g_i为第i个CMG的框架轴方向。

实施例：

一种带有前馈补偿的新型CMG操纵律设计方法，包括步骤如下：

S1、在每个控制周期内，GNC按下式解算出CMG群的框架角速度指令

式中，T_cmgc为计算的姿态控制力矩，h₀为CMG的标称角动量大小，δ＝(δ₁,δ₂,…,δ_n)^T为CMG群的框架角，C(δ)为3×n矩阵，是框架角的三角函数，表达式如下：

式中，A和B均为3×n矩阵，第i列分别对应第i个CMG框架角为90度和0度时其角动量在航天器本体系的方位。

S2、在每个控制周期内，GNC按下式计算星体角速度在每个CMG的框架轴上产生的陀螺力矩

式中g_i为第i个CMG的框架轴方向，ω为星体角速度，h_i为第i个CMG当前时刻的角动量，计算公式如下

h_i＝A(:,i)sinδ_i+B(:,i)cosδ_i

S3、在每个控制周期内，GNC将S1中的框架角速度指令

和S2中沿框架轴的陀螺力矩

输出给CMG单机，CMG单机确定控制律，实现对S1中的框架角速度指令的跟踪控制，该控制律包含了对S2中沿框架轴的陀螺力矩的前馈补偿。

即，在每个GNC控制周期内，除了S1计算CMG群的框架角速度指令，S2中同时计算星体角速度在各个CMG的框架轴上产生的陀螺力矩。S3中需要将S1中得到的各个CMG的框架角速度指令和S2中得到的星体角速度沿各CMG框架轴产生的陀螺力矩同时提供给CMG单机。

具体的：

考虑5个CMG组成的5棱锥构型，每个CMG标称角动量大小均为h₀＝200Nms，而且各CMG已经稳定在标准角动量附近。控制周期为0.2秒。一种带有前馈补偿的新型CMG操纵律设计方法，如图1所示，包括步骤如下：

S1、在每个控制周期内，GNC根据计算得到的姿态控制力矩T_cmgc，按下式解算出CMG群的框架角速度指令

式中，δ＝(δ₁,δ₂,…,δ₅)^T为CMG群的框架角，C(δ)为3×5矩阵，是框架角的三角函数，表达式如下

式中，A和B均为3×5矩阵，第i列分别对应第i个CMG框架角为90度和0度时其角动量在航天器本体系的方位。

S2、在每个控制周期内，GNC按下式计算星体角速度在第i个CMG的框架轴上产生的陀螺力矩

式中g_i为第i个CMG的框架轴方向，ω为星体角速度，h_i为第i个CMG当前时刻的角动量，计算公式如下

h_i＝A(:,i)sinδ_i+B(:,i)cosδ_i

S3、在每个控制周期内，GNC将S1中的框架角速度指令

和S2中的沿框架轴的陀螺力矩

提供给CMG单机。根据S2中的沿框架轴的陀螺力矩

CMG单机确定跟踪控制律，实现对S1中的框架角速度指令的跟踪控制。其中，该控制律中包含了对S2中的沿框架轴的陀螺力矩的前馈补偿。

本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。

本发明虽然已以较佳实施例公开如上，但其并不是用来限定本发明，任何本领域技术人员在不脱离本发明的精神和范围内，都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改，因此，凡是未脱离本发明技术方案的内容，依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰，均属于本发明技术方案的保护范围。

Claims (6)

1.一种带有前馈补偿的新型CMG操纵律设计方法，其特征在于，包括如下步骤：

S1、在每个GNC控制周期内，基于GNC计算的姿态控制力矩T_cmgc，确定CMG群的框架角速度指令；

S2、在每个GNC控制周期内，计算星体角速度在每个CMG单机的框架轴上的陀螺力矩；

S3、CMG单机根据S2中所述的陀螺力矩确定控制律，用于跟踪S1中所述的框架角速度指令。

2.根据权利要求1所述的一种带有前馈补偿的新型CMG操纵律设计方法，其特征在于，所述确定CMG群的框架角速度指令的方法为：

式中，

其中，h₀为CMG的标称角动量大小，δ＝(δ₁,δ₂,…,δ_n)^T为CMG群的框架角，T_cmgc为姿态控制力矩，A和B均为3×n矩阵，其中A矩阵的第i列为第i个CMG框架角为90度时CMG角动量在航天器本体系的方位，B矩阵的第i列为第i个CMG框架角为0度时CMG角动量在航天器本体系的方位。

3.根据权利要求1所述的一种带有前馈补偿的新型CMG操纵律设计方法，其特征在于，计算星体角速度在第i个CMG单机的框架轴上的陀螺力矩

的方法为：

其中，ω为星体角速度，h_i为第i个CMG当前时刻的角动量，g_i为第i个CMG的框架轴方向。

4.一种带有前馈补偿的新型CMG操纵律确定装置，其特征在于，包括框架角速度指令确定模块、陀螺力矩确定模块、控制律确定模块；

所述框架角速度指令确定模块用于在每个GNC控制周期内，基于GNC计算的姿态控制力矩T_cmgc，确定CMG群的框架角速度指令；

所述陀螺力矩确定模块用于在每个GNC控制周期内，计算星体角速度在每个CMG单机的框架轴上的陀螺力矩；

所述控制律确定模块根据所述陀螺力矩确定控制律，用于跟踪所述框架角速度指令。

5.根据权利要求4所述的一种带有前馈补偿的新型CMG操纵律确定装置，其特征在于，所述确定CMG群的框架角速度指令的方法为：

式中，

其中，h₀为CMG的标称角动量大小，δ＝(δ₁,δ₂,…,δ_n)^T为CMG群的框架角，T_cmgc为姿态控制力矩，A和B均为3×n矩阵，其中A矩阵的第i列为第i个CMG框架角为90度时CMG角动量在航天器本体系的方位，B矩阵的第i列为第i个CMG框架角为0度时CMG角动量在航天器本体系的方位。

6.根据权利要求4所述的一种带有前馈补偿的新型CMG操纵律确定装置，其特征在于，计算星体角速度在第i个CMG单机的框架轴上的陀螺力矩

的方法为：

其中，ω为星体角速度，h_i为第i个CMG当前时刻的角动量，g_i为第i个CMG的框架轴方向。

Images