CN112896555A - 一种姿态控制飞轮转速自平衡控制方法 - Google Patents

Abstract

本发明的一个实施例公开了一种姿态控制飞轮转速自平衡控制方法，所述方法包括：S101：根据飞轮构型中飞轮控制系统的安装矩阵进行奇异值分解计算；S102：根据所述奇异值中零奇异值对应的奇异向量组成奇异矩阵；S103：根据飞轮转速偏差和所述奇异矩阵在卫星的飞轮转速自平衡算法模块实时计算得到各飞轮的飞轮转速平衡控制力矩；S104：根据卫星姿态控制系统计算的三轴控制力矩在卫星的飞轮力矩分配模块经力矩分配得到各飞轮的第一控制力矩；S105：将所述第一控制力矩与所述飞轮转速平衡控制力矩叠加得到各飞轮的第二控制力矩；S106：将所述各飞轮的第二控制力矩输出给各飞轮。

Description

一种姿态控制飞轮转速自平衡控制方法

技术领域

本发明涉及卫星姿态控制技术领域，具体涉及一种姿态控制飞轮转速自平衡控制方法。

背景技术

卫星姿态控制的主要设备包括姿态控制推力器、力矩陀螺以及飞轮等，姿态控制推力器和力矩陀螺适用于大型具有快速机动需求的卫星，飞轮作为一种小型姿态控制部件，具有角动量小、输出力矩小的特点，适用于小型卫星的姿态控制，能够实现小型卫星的高精度姿态控制，近年来已成为以互联网卫星为代表的小型卫星的一种首选姿态控制部件。

使用飞轮进行卫星姿态控制是基于角动量守恒原理，通过卫星和飞轮间的角动量交换实现卫星的姿态机动，或者通过飞轮吸收卫星所受的空间环境力矩实现卫星的姿态保持。使用飞轮进行姿态控制时在控制指令的作用下飞轮转速会发生波动，当飞轮转速过零时，以飞轮轴系摩擦力矩为主的飞轮干扰力矩会发生突变，此干扰力矩作用于卫星会造成卫星姿态的抖动。

发明内容

本发明的目的在于提供一种姿态控制飞轮转速自平衡控制方法，解决姿态控制过程中飞轮转速过零可能会造成卫星姿态抖动的问题。

为达到上述目的，本发明采用下述技术方案：

本发明提供一种姿态控制飞轮转速自平衡控制方法，应用于四斜装构型的飞轮控制系统，所述方法包括：

S101：根据飞轮构型中飞轮控制系统的安装矩阵进行奇异值分解计算；

S102：根据所述奇异值中零奇异值对应的奇异向量组成奇异矩阵；

S103：根据飞轮转速偏差和所述奇异矩阵在卫星的飞轮转速自平衡算法模块实时计算得到各飞轮的飞轮转速平衡控制力矩；

S104：根据卫星姿态控制系统计算的三轴控制力矩在卫星的飞轮力矩分配模块经力矩分配得到各飞轮的第一控制力矩；

S105：将所述第一控制力矩与所述飞轮转速平衡控制力矩叠加得到各飞轮的第二控制力矩；

S106：将所述各飞轮的第二控制力矩输出给各飞轮。

在一个具体实施例中，所述步骤S101的计算方法包括：

飞轮构型中飞轮控制系统的安装矩阵B的表达式为：

对所述安装矩阵B进行奇异值分解计算得：

其中，

四斜装构型的飞轮控制系统四个飞轮绕卫星本体的Y轴安装，第一和第三飞轮的角动量轴线位于卫星本体坐标系的XOY平面内，第一和第三飞轮的角动量轴线与Y轴的夹角为θ；第二和第四飞轮的角动量轴线位于卫星本体坐标系的YOZ平面内，第二和第四飞轮的角动量轴线与Y轴的夹角为α；

m和n为安装矩阵维数，m＝3，n＝4；

矩阵U_m*m为左奇异向量阵，所述左奇异向量阵的第i列向量称为安装矩阵B的关于奇异值σ_i的左奇异向量；

矩阵V_n*n为右奇异向量阵，所述右奇异向量阵的第i列向量称为安装矩阵B的关于奇异值σ_i的右奇异向量；上角标T为转置矩阵符号；

矩阵S_m*n为对角阵，对角线上的元素σ_i为安装矩阵B的奇异值，非对角线上的元素全为0；即安装矩阵B有三个非零奇异值，第四个奇异值为0，即第四个奇异值为零奇异值；

其中，i取1到n。

在一个具体实施例中，所述步骤S102包括：

根据线性方程组特性得到：

即得到：

记向量x＝[x₁ x₂ … x_n]，则得到第一矩阵：

由所述第一矩阵可知，矩阵V_i*V_i ^T满足通过奇异矩阵得到的各飞轮的飞轮转速平衡控制力矩映射到卫星本体坐标系的三个正交轴上的分量均为零，因此得到奇异矩阵为：

其中，所述安装矩阵B的第四个奇异值σ₄对应的奇异向量为V₄，所述安装矩阵B的第i个奇异值σ_i对应的奇异向量为V_i。

在一个具体实施例中，所述步骤S103的计算方法包括：

飞轮转速偏差向量dh为：

则根据飞轮转速偏差和所述奇异矩阵实时计算得到的各飞轮的飞轮转速平衡控制力矩为：

其中，四斜装构型的飞轮控制系统中第一到第四飞轮的目标偏置转速分别为h1₀、h2₀、h3₀和h4₀；第一到第四飞轮的实时转速为h1_t、h2_t、h3_t、和h4_t；

dh₁、dh₂、dh₃和dh₄为第一到第四飞轮的飞轮转速偏差向量；

T_b1、T_b2、T_b3和T_b4为第一到第四飞轮的飞轮转速平衡控制力矩；

k为增益系数且k为实数。

在一个具体实施例中，所述步骤S104的力矩分配公式为：

其中，

T_cx、T_cy和T_cz为卫星姿态控制系统计算的三轴控制力矩；

T_c1、T_c2、T_c3和T_c4为经力矩分配得到的第一到第四飞轮的第一控制力矩。

在一个具体实施例中，所述步骤S105的叠加方法为：

其中，T₁、T₂、T₃和T₄分别为第一到第四飞轮的第二控制力矩。

本发明的有益效果如下：

通过本发明提供的一种姿态控制飞轮转速自平衡控制方法，可有效减少卫星在轨期间飞轮转速过零事件的发生，从而降低飞轮转速过零对卫星姿态的扰动，解决了姿态控制过程中飞轮转速过零可能会造成卫星姿态抖动的问题。同时，本发明所提供的方法适用于所有四斜装飞轮构型，不增加硬件成本，能够在不影响卫星姿态控制的前提下对飞轮转速进行自平衡调节。

附图说明

为了更清楚地说明本申请具体实施方式或现有的技术方案，下面将对具体实施方式或现有的技术描述中所需要使用的附图作简单地介绍，显而易见的，下面描述中的附图是本申请的一种实施方式，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。

图1示出根据本发明一个实施例的一种姿态控制飞轮转速自平衡控制方法流程图。

图2示出根据本发明一个实施例的一种飞轮控制系统安装构型示意图。

图3示出根据本发明一个实施例的一种姿态控制飞轮转速自平衡控制方法原理框图。

图4示出根据本发明一个实施例的未进行飞轮转速自平衡控制的飞轮转速仿真结果示意图。

图5示出根据本发明一个实施例的未进行飞轮转速自平衡控制的星体姿态仿真结果示意图。

图6示出根据本发明一个实施例的采用本发明所提供的一种姿态控制飞轮转速自平衡控制方法进行飞轮转速自平衡控制的飞轮转速仿真结果示意图。

图7示出根据本发明一个实施例的采用本发明所提供的一种姿态控制飞轮转速自平衡控制方法进行飞轮转速自平衡控制的星体姿态仿真结果示意图。

具体实施方式

为了使本发明的技术方案更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。以下通过具体实施例对本发明进行了详细的说明，但这些并非构成对本发明的限制。在不脱离本发明原理的情况下，本领域的技术人员可以做出变形与改进，也应视为本发明的保护范围。

本实施例提供一种姿态控制飞轮转速自平衡控制方法，所述方法应用于所有四斜装构型的飞轮控制系统。所述方法的流程图如图1所示，所述方法包括：

S101：根据飞轮构型中飞轮控制系统的安装矩阵进行奇异值分解计算；

其中，

飞轮构型中飞轮控制系统的安装矩阵B的表达式为：

对所述安装矩阵B进行奇异值分解计算得：

其中，

本实施例的一种飞轮控制系统安装构型如图2所示，该飞轮控制系统采用四斜装构型，四个飞轮绕卫星本体的Y轴安装，其中第一和第三飞轮#1和#3的角动量轴线(又称转子旋转轴)位于卫星本体坐标系的XOY平面内，且以近卫星本体坐标系的Y轴为正向(即图中箭头所指的方向为正向)，第一和第三飞轮的角动量轴线与Y轴夹角为θ；第二和第四飞轮#2和#4的角动量轴线(又称转子旋转轴)位于卫星本体坐标系的YOZ平面内，且以近卫星本体坐标系的Y轴为正向，第二和第四飞轮的角动量轴线与Y轴夹角为α。

m和n为安装矩阵维数，m＝3，n＝4；

矩阵U_m*m为左奇异向量阵，所述左奇异向量阵的第i列向量称为安装矩阵B的关于奇异值σ_i的左奇异向量；

矩阵V_n*n为右奇异向量阵，所述右奇异向量阵的第i列向量称为安装矩阵B的关于奇异值σ_i的右奇异向量；上角标T为转置矩阵符号；

矩阵S_m*n为对角阵，对角线上的元素σ_i为安装矩阵B的奇异值，非对角线上的元素全为0；

即安装矩阵B有三个非零奇异值，第四个奇异值为0，即第四个奇异值为零奇异值；

i取1到n。

以某互联网卫星为例，当带入，α＝28°、θ＝30°时步骤S101得到：

S102：根据所述奇异值中零奇异值对应的奇异向量组成奇异矩阵；

记所述安装矩阵B的第四个奇异值σ₄＝0对应的奇异向量为V₄，同理所述安装矩阵B的第i个奇异值σ_i对应的奇异向量为V_i，根据线性方程组特性得到：

即得到：

记向量x＝[x₁ x₂ … x_n]，则得到第一矩阵：

其中，向量x_n中的n与上述n相同，取4。

本实施例中构建奇异矩阵的原则是通过奇异矩阵得到的各飞轮的飞轮转速平衡控制力矩映射到卫星本体坐标系的三个正交轴上的分量均为零，即不对卫星姿态控制产生影响，由所述第一矩阵可知，矩阵V_i*V_i ^T满足此条件，故得到奇异矩阵为：

以某互联网卫星为例，当带入，α＝28°、θ＝30°时步骤S102得到：

V₄＝[0.5048141 -0.4951391 0.5048141 0.4951391]^T

S103：根据飞轮转速偏差和所述奇异矩阵在卫星的飞轮转速自平衡算法模块实时计算得到各飞轮的飞轮转速平衡控制力矩；

飞轮转速偏差向量dh为：

则根据飞轮转速偏差和所述奇异矩阵实时计算得到的各飞轮的飞轮转速平衡控制力矩为：

其中，四斜装构型的飞轮控制系统中第一到第四飞轮的目标偏置转速分别为h1₀、h2₀、h3₀和h4₀；第一到第四飞轮的实时转速为h1_t、h2_t、h3_t和h4_t；

dh₁、dh₂、dh₃和dh₄为第一到第四飞轮的飞轮转速偏差向量；

T_b1、T_b2、T_b3和T_b4为第一到第四飞轮的飞轮转速平衡控制力矩；

k为增益系数，依据具体控制对象进行调节，k为实数。

S104：根据卫星姿态控制系统计算的三轴控制力矩在卫星的飞轮力矩分配模块经力矩分配得到各飞轮的第一控制力矩；

记T_cx、T_cy和T_cz为卫星姿态控制系统计算的三轴控制力矩(T_cx对应X轴控制力矩，T_cy对应Y轴控制力矩，T_cz对应Z轴控制力矩)；T_c1、T_c2、T_c3和T_c4为经力矩分配得到的第一到第四飞轮的第一控制力矩；力矩分配公式为：

S105：将所述第一控制力矩与所述飞轮转速平衡控制力矩叠加得到各飞轮的第二控制力矩；叠加方法为：

其中，T₁、T₂、T₃和T₄分别为第一到第四飞轮的第二控制力矩。

S106：将所述各飞轮的第二控制力矩输出给各飞轮。即可实现飞轮转速自平衡下的卫星姿态控制。

上述所有公式中的“*”号表示数学运算中的乘。

上述方法的原理框图如图3所示。

本实施例所提供的方法通过对飞轮安装矩阵的奇异值分解，求取奇异矩阵，根据奇异矩阵解算各飞轮的飞轮转速平衡控制力矩，该飞轮转速平衡控制力矩与卫星姿态控制系统计算的三轴控制力矩经力矩分配得到的各飞轮的第一控制力矩叠加作为飞轮的第二控制力矩，输出给各飞轮，在不影响卫星姿态控制的前提下实现了各飞轮转速的自动调节，使各飞轮转速约束在了目标偏置转速附近，实现飞轮转速的自动平衡，减小与目标偏置转速的偏差，从而减少飞轮转速过零次数，降低飞轮转速过零对卫星姿态的扰动。

如图4和图5所示，图4和图5分别给出了未进行飞轮转速自平衡控制的飞轮转速仿真结果示意图和星体姿态仿真结果示意图；由图可知在未采用本发明中的飞轮转速自平衡控制方法时，飞轮转速波动较为剧烈且会发生飞轮转速过零的情况，在飞轮转速过零时，星体姿态产生了抖动；如图6和图7所示，图6和图7分别给出了采用本发明所提供的一种姿态控制飞轮转速自平衡控制方法进行飞轮转速自平衡控制的飞轮转速仿真结果示意图和星体姿态仿真结果示意图；由图可知在采用了本发明所提供的一种姿态控制飞轮转速自平衡控制方法后飞轮转速在目标偏置转速附近波动且飞轮转速波动较为平缓，避免了飞轮转速过零对星体姿态控制的扰动，解决了姿态控制过程中飞轮转速过零可能会造成卫星姿态抖动的问题。其中，图4和图6中的1、2、3和4代表第一到第4飞轮，竖轴飞轮转速单位为rpm((Revolutions Per minute，转/分钟)。

显然，本发明的上述实施例仅仅是为清楚地说明本发明所作的举例，而并非是对本发明的实施方式的限定，对于所属领域的普通技术人员来说，在上述说明的基础上还可以做出其它不同形式的变化或变动，这里无法对所有的实施方式予以穷举，凡是属于本发明的技术方案所引伸出的显而易见的变化或变动仍处于本发明的保护范围之列。

Claims (6)

1.一种姿态控制飞轮转速自平衡控制方法，应用于四斜装构型的飞轮控制系统，其特征在于，所述方法包括：

S101：根据飞轮构型中飞轮控制系统的安装矩阵进行奇异值分解计算；

S102：根据所述奇异值中零奇异值对应的奇异向量组成奇异矩阵；

S103：根据飞轮转速偏差和所述奇异矩阵在卫星的飞轮转速自平衡算法模块实时计算得到各飞轮的飞轮转速平衡控制力矩；

S104：根据卫星姿态控制系统计算的三轴控制力矩在卫星的飞轮力矩分配模块经力矩分配得到各飞轮的第一控制力矩；

S105：将所述第一控制力矩与所述飞轮转速平衡控制力矩叠加得到各飞轮的第二控制力矩；

S106：将所述各飞轮的第二控制力矩输出给各飞轮。

2.根据权利要求1所述的方法，其特征在于，所述步骤S101的计算方法包括：

飞轮构型中飞轮控制系统的安装矩阵B的表达式为：

对所述安装矩阵B进行奇异值分解计算得：

其中，

四斜装构型的飞轮控制系统四个飞轮绕卫星本体的Y轴安装，第一和第三飞轮的角动量轴线位于卫星本体坐标系的XOY平面内，第一和第三飞轮的角动量轴线与Y轴的夹角为θ；第二和第四飞轮的角动量轴线位于卫星本体坐标系的YOZ平面内，第二和第四飞轮的角动量轴线与Y轴的夹角为α；

m和n为安装矩阵维数，m＝3，n＝4；

矩阵U_m*m为左奇异向量阵，所述左奇异向量阵的第i列向量称为安装矩阵B的关于奇异值σ_i的左奇异向量；

矩阵V_n*n为右奇异向量阵，所述右奇异向量阵的第i列向量称为安装矩阵B的关于奇异值σ_i的右奇异向量；上角标T为转置矩阵符号；

矩阵S_m*n为对角阵，对角线上的元素σ_i为安装矩阵B的奇异值，非对角线上的元素全为0；即安装矩阵B有三个非零奇异值，第四个奇异值为0，即第四个奇异值为零奇异值；

其中，i取1到n。

3.根据权利要求2所述的方法，其特征在于，所述步骤S102包括：

根据线性方程组特性得到：

即得到：

记向量x＝[x₁ x₂ … x_n]，则得到第一矩阵：

由所述第一矩阵可知，矩阵V_i*V_i ^T满足通过奇异矩阵得到的各飞轮的飞轮转速平衡控制力矩映射到卫星本体坐标系的三个正交轴上的分量均为零，因此得到奇异矩阵为：

其中，所述安装矩阵B的第四个奇异值σ₄对应的奇异向量为V₄，所述安装矩阵B的第i个奇异值σ_i对应的奇异向量为V_i。

4.根据权利要求3所述的方法，其特征在于，所述步骤S103的计算方法包括：

飞轮转速偏差向量dh为：

则根据飞轮转速偏差和所述奇异矩阵实时计算得到的各飞轮的飞轮转速平衡控制力矩为：

其中，四斜装构型的飞轮控制系统中第一到第四飞轮的目标偏置转速分别为h1₀、h2₀、h3₀和h4₀；第一到第四飞轮的实时转速为h1_t、h2_t、h3_t和h4_t；

dh₁、dh₂、dh₃和dh₄为第一到第四飞轮的飞轮转速偏差向量；

T_b1、T_b2、T_b3和T_b4为第一到第四飞轮的飞轮转速平衡控制力矩；

k为增益系数且k为实数。

5.根据权利要求4所述的方法，其特征在于，所述步骤S104的力矩分配公式为：

其中，

T_cx、T_cy和T_cz为卫星姿态控制系统计算的三轴控制力矩；

T_c1、T_c2、T_c3和T_c4为经力矩分配得到的第一到第四飞轮的第一控制力矩。

6.根据权利要求5所述的方法，其特征在于，所述步骤S105的叠加方法为：

其中，T₁、T₂、T₃和T₄分别为第一到第四飞轮的第二控制力矩。

Images