一种基于反作用轮摩擦特性的抗干扰姿态控制方法
一种基于反作用轮摩擦特性的抗干扰姿态控制方法
【技术领域】
[0001] 本发明涉及一种基于反作用轮摩擦特性的抗干扰姿态控制方法，特别是针对包含 反作用轮摩擦、环境力矩等多源干扰下的航天器抗干扰姿态控制方法，该方法可用于航空 航天领域高精度观测卫星，太空望远镜等航天器的高精度姿态控制。
【背景技术】
[0002] 航天器姿态控制系统的可靠性和长期工作稳定性一直是航天器研制中的关键课 题。反作用轮是航天器姿态控制系统中最重要的惯性执行部件之一，近几年发射的长寿命、 高精度、多功能三轴稳定卫星，几乎毫不例外地利用反作用轮作为主要执行部件。在航天器 姿控系统中，反作用轮按照姿控系统指令，提供合适的控制力矩，校正航天器的姿态偏差， 完成某种预定的姿态调整。反作用轮作为航天器三轴稳定控制系统主要的执行部件，其性 能对姿态控制系统具有决定性的影响，提高反作用轮控制系统的性能对卫星姿态控制系统 具有重要意义。反作用轮系统内部存在的多种干扰和噪声，如摩擦力矩干扰和速率测量噪 声等，会使反作用轮执行指令产生误差，给航天器姿态控制系统带来干扰。此外航天器在轨 飞行过程中，除了受到反作用轮带来的摩擦力矩干扰等，还将受到各种外部太空环境干扰 力矩的作用，如气动力矩、太阳辐射光压、重力梯度力矩、空间碎片撞击力矩以及磁力矩等。 对于航天器系统而言，来自上述外部环境干扰以及反作用轮的干扰，都将严重影响到姿态 控制系统的精度和稳定度，在航天器设计的过程中，必须考虑上述干扰的影响。
[0003] 航天器姿态控制器目前设计过程一般都是基于模型进行设计，准确的模型参数能 够提高航天器的姿态控制精度，以往的研宄过程中姿态控制系统的设计与执行机构的特性 联系并不紧密，忽略了执行机构动态特性，此外对于航天器所遭受的太空环境干扰，也忽略 部分干扰特性，不够精细，使得航天器动力学模型在精确性上有所欠缺，导致所设计的控 制方法不够精确，影响航天器系统的姿态精度和稳定度，在面向实际工程对象时，会存在问 题。
【发明内容】
[0004] 本发明的技术解决问题是：针对使用反作用轮的航天器系统，克服现有技术的不 足，并充分利用反作用轮的动态特性，建立包含反作用轮摩擦特性的抗干扰姿态控制方法， 并同时针对航天系统存在的外部环境干扰力矩以及反作用摩擦等多源干扰，提供一种基于 反作用动态特性的抗干扰姿态控制方法，解决多源干扰下航天器的姿态控制问题，提高航 天器姿态系统的控制精度和稳定度。
[0005] 本发明的技术解决方案为：一种基于反作用轮摩擦特性的抗干扰姿态控制方法， 其特征在于包括以下步骤：针对反作用轮摩擦以及姿控精度较低的问题，首先构建含有反 作用轮摩擦特性的航天器耦合动力学方程，其次针对由于反作用轮带来的摩擦干扰设计摩 擦干扰估计器，对反作用轮摩擦进行实时估计；再次，针对航天器系统中存在的环境干扰力 矩以及摩擦干扰估计误差，设计标称控制器进行抑制；最后通过联合标称控制器与摩擦干 扰估计器，设计复合分层抗干扰控制器，完成多源干扰影响下的航天器抗干扰姿态控制；
[0006] 第一步：构建含有反作用轮摩擦特性的航天器耦合动力学模型
[0007] 当航天器本体坐标系和轨道坐标系之间的欧拉角很小时，姿态运动学可以小角 度线性化，得到如下的姿态动力学模型：
[0009] 其中，Ii，I2，I3分别为航天器的三轴转动惯量；巾⑴，0⑴，步⑴分别为三轴 姿态角，知)滅0,#(0分别为三轴姿态角速度，知),知)#(0分别为三轴姿态角加速度； ?L，J2,1分别为三轴上安装的反作用轮的转动惯量；分别表示航天器三轴 上的反作用轮中电机的转动角加速度，Tdl(t)，Td2(t)，Td3(t)分别为航天器三轴受到的环境 干扰；n为航天器轨道角速度；
[0010] 用于航天器姿态控制的反作用轮系统一般是由微型直流无刷电机、反作用轮本 体、以及控制器线路构成，是一个相对独立的机电执行部件，反作用轮的转动方程为：
[0012] 其中，Ji为反作用轮的转动惯量，Di(t)为反作用轮中电机的转动角速度，4(0 为反作用轮中电机的转动角加速度，kTi为反作用轮中电机的电流力矩系数，ii(t)为反作 用轮中电机的电流，kTi*ii(t)为反作用轮的驱动力矩，Mfi(t)为反作用轮摩擦力矩；对于反 作用轮使用的无刷直流电机，电流力矩系数kTi在数值上与反作用轮中的反电动势系数相 等，kEi为反作用轮使用电机的反电动势系数，Ei⑴为加在反作用轮两端的控制电压，氏为 反作用轮使用电机的电阻值，Q为反作用轮使用电机的电感，在正常使用过程中，%⑴在 数值上大小接近〇,在实际处理过程中，这一项可以忽略，因此反作用轮转动方程进一步可 以描述为；
[0014] 对于分装在航天器三轴上的反作用轮，航天器的控制力矩指令可以表示为：
[0016] 其中，kT1，kT2，kT3为安装在航天器三轴上的反作用轮中电机的电流力矩系数，ijt),i2(t),i3(t)为安装在航天器三轴上的反作用轮中电机的电流，Mfl(t)，Mf2(t)，Mf3(t) 为安装在航天器三轴上的反作用轮的摩擦力矩；进一步，三轴上安装的反作用轮中所用电 机的电流方程为：
[0018] 其中^^心馬为安装在航天器三轴上的反作用轮电机电阻^"七^&⑴^八^为 安装在航天器三轴上的三个反作用轮的控制电压；kE1，kE2,kE3是安装在航天器三轴上的三 个反作用轮中电机的反电动势系数；
[0019] 进一步，建立包含反作用轮摩擦特性的航天器姿态系统动力学模型为：
[0021] 将式E4写成矩阵形式如下：
[0023]其中，状态p(t)=[伞（t)，0 (t)，边（t)]T，Td(t) = 天器三轴受到的环境干扰力矩，E(t) = [Eiah&ahEjtUT为安装在航天器三轴上的三 个反作用轮的控制电压，D(t) = [Mt)，D2(t)，D3(t)]T为安装在航天器三轴上的反作 用轮中电机的角速度，Mf(t) = [1^(0，{2(0，{3(0^为安装在航天器三轴上的反作用轮 的摩擦力矩干扰；式中P=diagUi, 12,I3}，Bm=I，Bw=I，
， Q=diag{4n2 (I2-I3)，3n2 ，n2 (H)}，
，
[0024] 进一步可以将包含反作用轮摩擦特性的航天器姿态系统动力学模型写成状态空 间表达式形式如下：
[0026]其中，x(t)、E(t)分别为系统的状态变量和控制输入，E(t)=唞(〇，&(〇33(〇] T,
，其中ep (t) =p(t) _pd (t)，pd (t)为航天器系统 的期望姿态信息，P(t)为航天器系统当前最新的姿态信息，ep(t)为航天器当前姿态与期望 姿态的偏差，A为系统阵，B。为控制输入矩阵，Bi为摩擦力矩干扰输入矩阵，B2为环境干扰 力矩的输入矩阵，其对应的表达式如下：
[0028]其中，KT=diag{kT1，kT2,kT3}，J=diagUpJ2,J3}，KE=diag{kE1，kE2,kE3}，R= diagtRi,R2,R3}；
[0029] 第二步：设计摩擦干扰估计器
[0030] 对于上述反作用轮摩擦干扰，设计摩擦干扰估计器，对摩擦干扰的估计表征为：
[0032] 其中，N为摩擦干扰估计器增益，6,(7)为反作用轮摩擦干扰的估计值，r(t)为摩 擦干扰估计器中的辅助变量；
[0033] 第三步：设计标称控制器
[0034] 在通过摩擦干扰估计器完成对反作用轮摩擦进行估计后，对于航天器系统中还存 在的环境干扰力矩以及摩擦干扰估计误差干扰，进一步设计具有干扰抑制能力的标称控制 器，其对应控制律为：
[0036] 其中，EK(t)为当前时刻标称控制器的控制量，K为标称控制器的控制增益；
[0037] 第四步：设计航天器复合分层抗干扰姿态控制器
[0038] 在分别完成反作用轮摩擦观测器与标称控制器基础上，进行复合，得到多源干扰 下航天器复合分层抗干扰姿态控制器，其对应的控制律为：
[0040] 其中，EK(t)为复合分层抗干扰姿态控制器的输出，用于控制安装在航天器三轴上 的反作用轮完成姿态控制；
[0041] 本发明与现有技术相比的优点在于：本发明在航天器动力学建模过程中，加入了 执行机构反作用轮的动态特性，相对于目前存在的姿态控制方法，充分利用已有的信息，更 贴合工程实际，能更好的解决工程中出现的问题；此外，针对航天器系统还存在的外部环境 干扰力矩，通过引入摩擦干扰估计器与标称控制器构成复合控制器，对摩擦干扰的估计和 补偿与对航天器系统受到的外部环境干扰的抑制相结合，能够有效的提高航天器的姿态控 制精度和稳定度。
【附图说明】
[0042]图1为本发明一种基于反作用轮动态特性的抗干扰姿态控制方法的设计流程图。
【具体实施方式】
[0043]如图1所示，本发明具体实现步骤如下（卫星作为一种典型的航天器，本实施例中 以一类微纳卫星为例来说明方法的具体实现）：
[0044] 1、构建含有反作用轮摩擦特性的卫星耦合动力学模型
[0045] 当卫星本体坐标系和轨道坐标系之间的欧拉角很小时，姿态运动学可以小角度 线性化，得到如下的姿态动力学模型：
[0047]其中，Ii，I2, 13分别为本实施例中微纳卫星的三轴转动惯量，其对应数值为 11= 5. 5,I2= 6. 2,I3= 2. 2 ;Mt)，0⑴，Mt)分别为三轴姿态角，分别为 三轴姿态角速度，
分别为三轴姿态角加速度；^2，1分别为三轴上安装 的反作用轮的转动惯量，在此实施例中，采用同一类型反作用轮，其转动惯量对应数值 为1= 0.00273,J2= 0.00273,J3= 0.00273 ;
分别表示卫星三轴上 的反作用轮的转速，Tdl(t)，Td2(t)，Td3(t)分别为航天器三轴受到的环境干扰力矩，其对 应数值为Tdl= 2.4X10 -4(3cosl0t+l)，Td2= 2.4X10 -4(3cosl0t++1.6sinl0t)，Td3 = 2. 3X10_4(3sinl0t+l)，n为航天器轨道角速度，此实施例中n= 0?OOllrad/s;
[0048] 用于卫星姿态控制的反作用轮系统一般是由微型直流无刷电机、反作用轮本体、 以及控制器线路构成，是一个相对独立的机电执行部件，反作用轮的转动方程为：
[0050]其中，Ji为反作用轮的转动惯量，DJt)为反作用轮中电机的转动角速度，&⑴为 反作用轮中电机的转动角加速度，kTi为反作用轮中电机的电流力矩系数，ii⑴为反作用轮 中电机的电流，kTi*ii(t)为反作用轮的驱动力矩，Mfi(t)为反作用轮摩擦力矩；对于反作用 轮使用的无刷直流电机，电流力矩系数kTi在数值上与反作用轮中的反电动势系数相等，kEi 为反作用轮使用电机的反电动势系数，Ei(t)为加在反作用轮两端的控制电压，氏为反作用 轮使用电机的电阻值，Q为反作用轮使用电机的电感，在此实施例中，三轴安装的反作用轮 均为同一类型电机驱动， 反作用轮的转动惯量数值大小为〇. 00273,对应的反电动势系数均 为0. 02,电流力矩系数均为0. 02,电机中电阻值均为1Q，电感大小均为0. 0002H，在正常使 用过程中，& */,(/)在数值上大小接近0,在实际处理过程中，这一项可以忽略，因此反作用 轮转动方程进一步可以描述为；
[0052] 对于分装在卫星三轴上的反作用轮，卫星的控制力矩指令可以表示为：
[0054]其中，kT1，kT2，kT3为安装在卫星三轴上的反作用轮中电机的电流力矩系数，其 数值大小均为0.02,ijthijthidt)为安装在卫星三轴上的反作用轮中电机的电流， Mfl(t)，Mf2(t)，Mf3(t)为安装在卫星三轴上的反作用轮的摩擦力矩；进一步，三轴上安装的 反作用轮中所用电机的电流方程为：
[0056]其中，《，馬为安装在卫星三轴上的反作用轮电机电阻，其数值大小均为1，Ei(t)，E2 (t)，E3 (t)为安装在卫星三轴上的三个反作用轮的控制电压；kE1，kE2,kE3是安装在 卫星三轴上的三个反作用轮中电机的反电动势系数，其数值大小均为0. 02 ;
[0057] 进一步，建立包含反作用轮摩擦特性的卫星姿态系统动力学模型为：
[0059]将式E4写成矩阵形式如下：
[0061]其中，状态p(t)=[伞（t)，0 (t)，边（t)]T，Td(t)=[Tdl(t)，Td2(t)，Td3(t)]TSl星三轴受到的环境干扰力矩，E(t) = [Eiah&ahEjt)]1为安装在卫星三轴上的三个反 作用轮的控制电压，由控制器解算所得，D(t) = [Djt)，D2(t)，D3(t)]T为安装在卫星 三轴上的反作用轮中电机的角速度，Mf(t) = [Mfl，Mf2，Mf3]T为安装在卫星三轴上的反作用 轮的摩擦力矩干扰；式中？ = (^区{11，12，13}，8111=1，8 1?=1，.，
Q=diag{4n2 (I2-I3)，3n2C^-13)，n2 (H)}，
[0062] 进一步可以将包含反作用轮摩擦特性的卫星姿态系统动力学模型写成状态空间 表达式形式如下：
[0064]其中，x(t)、E(t)分别为系统的状态变量和控制输入，E(t)=[EiahEjthEia)] T
，其中ep(t) =p(t)_pd(t)，pd(t)为航天器系统 的期望姿态信息，P(t)为航天器系统当前最新的姿态信息，ep(t)为航天器当前姿态与期望 姿态的偏差；A为系统阵，为控制输入矩阵，为摩擦力矩干扰输入矩阵，B2为环境干扰 力矩的输入矩阵，其对应的表达式如下：
[0066]其中，KT=diag{kT1，kT2,kT3}，J=diaglJi，J2,J3}，KE=diag{kel，ke2,ke3}，R= diagtRi,R2,R3}；
[0067]2、设计摩擦干扰估计器
[0068] 对于上述反作用轮摩擦干扰，设计摩擦干扰估计器，对摩擦干扰的估计表征为：
[0070] 其中，N为摩擦干扰估计器的增益，在此实施例中，以卫星俯仰轴姿态控制为例，N 的取值大小为[0 0.0008 0 0. 1367]，⑴为反作用轮摩擦干扰的估计值，r(t)为摩擦干 扰估计器中的辅助变量；
[0071] 3、设计标称控制器
[0072] 在通过摩擦干扰估计器完成对反作用轮摩擦进行估计后，对于卫星系统中还存在 的环境干扰力矩以及摩擦干扰估计误差干扰，进一步设计具有干扰抑制能力的标称控制 器，在此实施例中，选用的标称控制律为ro控制律，其具体表现形式为：
[0074] 其中，EK(t)为当前时刻ro控制器的控制量，K为ro控制器的控制增益，以卫星 俯仰轴姿态控制为例，ro控制器的控制增益为K= [0. 2160 2. 3540 -0. 0438 -0. 2467]，KP 为PD控制器比例增益，KP取值为[0. 2160 -0. 0438]，KD为PD控制器微分增益，KD取值为 [2. 3540 -0. 2467]；
[0075] 4、设计卫星复合分层抗干扰姿态控制器
[0076] 在分别完成反作用轮摩擦观测器与标称控制器基础上，对两种控制器进行复合， 得到多源干扰下卫星复合分层抗干扰姿态控制器，其对应的控制律为：
[0078] 其中，EK(t)为复合分层抗干扰姿态控制器的输出，用于控制安装在微纳卫星三轴 上的反作用轮完成姿态控制。
[0079] 本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
【主权项】
1. 一种基于反作用轮摩擦特性的抗干扰姿态控制方法，其特征在于，包括以下步骤： 针对反作用轮摩擦以及姿控精度较低的问题，首先，构建含有反作用轮摩擦特性的航天器 耦合动力学模型，其次，针对由于反作用轮带来的摩擦干扰设计摩擦干扰估计器，对反作用 轮摩擦进行实时估计；再次，针对航天器系统中存在的摩擦干扰估计误差及环境干扰力矩， 设计标称控制器进行抑制；最后，通过联合标称控制器与摩擦干扰估计器，设计复合分层抗 干扰控制器，完成多源干扰影响下的航天器抗干扰姿态控制； 第一步：构建含有反作用轮摩擦特性的航天器耦合动力学模型 当航天器本体坐标系和轨道坐标系之间的欧拉角很小时，姿态运动学可以小角度线 性化，得到如下的姿态动力学模型：其中，I1,12,13分别为航天器的三轴转动惯量；φ (t)，Θ (t)，Φ⑴分别为三轴姿 态角，火分别为三轴姿态角速度，?),與〇,列〇分别为三轴姿态角加速度； J1, J2, J3分别为三轴上安装的反作用轮的转动惯⑴，0;⑴分别表示航天器三轴 上的反作用轮中电机的转动角加速度，Tdl (t)，Td2 (t)，Td3 (t)分别为航天器三轴受到的环境 干扰力矩；η为航天器轨道角速度； 用于航天器姿态控制的反作用轮系统一般是由微型直流无刷电机、反作用轮本体、以 及控制器线路构成，是一个相对独立的机电执行部件，反作用轮的转动方程为：其中，Ji为反作用轮的转动惯量，Ω Jt)为反作用轮中电机的转动角速度，A⑴为反 作用轮中电机的转动角加速度，kTi为反作用轮中电机的电流力矩系数，ijt)为反作用轮 中电机的电流，kTi*ii(t)为反作用轮的驱动力矩，Mfi(t)为反作用轮摩擦力矩；对于反作用 轮使用的无刷直流电机，电流力矩系数kTi在数值上与反作用轮中的反电动势系数相等，kEi为反作用轮使用电机的反电动势系数，Ei (t)为加在反作用轮两端的控制电压，氏为反作用 轮使用电机的电阻值，Li为反作用轮使用电机的电感，在正常使用过程中，L,. *((〇在数值上 大小接近〇,在实际处理过程中，这一项可以忽略，因此反作用轮转动方程进一步可以描述 为；对于分装在航天器三轴上的反作用轮，航天器的控制力矩指令可以表示为：其中，kT1，kT2，kT3为安装在航天器三轴上的反作用轮中电机的电流力矩系数， ijt), i2(t), i3(t)为安装在航天器三轴上的反作用轮中电机的电流，Mfl(t)，Mf2(t)，M f3(t) 为安装在航天器三轴上的反作用轮的摩擦力矩；进一步，三轴上安装的反作用轮中所用电 机的电流方程为：其中，R1, R2, R3为安装在航天器三轴上的反作用轮电机电阻，E i (t)，E2 (t)，E3 (t)为安装 在航天器三轴上的三个反作用轮的控制电压；kE1，kE2, kE3是安装在航天器三轴上的三个反 作用轮中电机的反电动势系数； 进一步，建立包含反作用轮摩擦特性的航天器姿态系统动力学模型为：将式Σ4写成矩阵形式如下： p-f)(i) + Cp(i) + QP(t) = β,:Ε(?) + BiP-(I) + BmMf (I) + BhTi1(J) 其中，状态 P (t) = [ Φ (t)，Θ (t)，Φ (t) ]T，Td (t) = [Tdl (t)，Td2 (t)，Td3 (t) ]τ为航天 器三轴受到的环境的干扰力矩，E(t) = 为安装在航天器三轴上的三 个反作用轮的控制电压，Ωα) = [Q1U), Ω2α)，Ω3α)]τ为安装在航天器三轴上的反作 用轮中电机的角速度，Mf(t) = [1^(〇，1^2(〇，1^(〇]1为安装在航天器三轴上的反作用轮 的摩擦力矩干扰；式中 P = CliagU1, I2, I3}，Bm= I, B w= I，进一步可以将包含反作用轮摩擦特性的航天器姿态系统动力学模型写成状态空间表 达式形式如下： 女(?)= Ax(J) + βηΕ(?) + BfM 十 β，Τ(?(?) 其中，x(t)、E(t)分别为系统的状态变量和控制输入，E(t) =,其中ep(t) = p(t)-pd(t)，pd(t)为航天器系统的 期望姿态信息，P(t)为航天器系统当前最新的姿态信息，ep(t)为航天器当前姿态与期望姿 态的偏差，A为系统阵，Btl为控制输入矩阵，B1为摩擦力矩干扰输入矩阵，B2为环境干扰力 矩的输入矩阵，其对应的表达式如下：其中，Kt= diag{k T1，kT2, kT3}，J = diaglj" J2, J3}，Ke= diag{k E1，kE2, kE3}，R = diagtRi, R2, R3I ； 第二步：设计摩擦干扰估计器 对于上述反作用轮摩擦干扰，设计摩擦干扰估计器，对摩擦干扰的估计表征为：其中，N为摩擦干扰估计器增益，&,(0为反作用轮摩擦干扰的估计值，r(t)为摩擦干 扰估计器中的辅助变量； 第三步：设计标称控制器 通过摩擦干扰估计器完成对反作用轮摩擦进行估计后，对于航天器系统中还存在的环 境干扰力矩以及摩擦干扰估计误差，进一步设计具有干扰抑制能力的标称控制器，其对应 控制律为：其中，Ek(t)为当前时刻标称控制器的控制量，K为标称控制器的控制增益； 第四步：设计航天器复合分层抗干扰姿态控制器 在分别完成反作用轮摩擦观测器与标称控制器基础上，进行复合，得到多源干扰下航 天器复合分层抗干扰姿态控制器，其对应的控制律为：其中，E(t)为复合分层抗干扰姿态控制器的输出，用于控制安装在航天器三轴上的反 作用轮完成姿态控制。
【专利摘要】一种基于反作用轮摩擦特性的抗干扰姿态控制方法，针对反作用轮过零摩擦以及姿控精度较低的问题，首先构建含有反作用轮摩擦特性的航天器耦合动力学方程，其次针对由于反作用轮带来的摩擦干扰设计摩擦干扰估计器，对反作用轮摩擦进行实时估计；再次，针对航天器系统中的摩擦干扰估计误差及环境干扰，设计标称控制器进行抑制；最后通过联合标称控制器与摩擦干扰估计器，设计复合分层抗干扰控制器，完成多源干扰影响下的航天器抗干扰姿态控制；本方法在传统的航天器动力学方程中加入执行机构动力学，能够更好的分析由于执行机构特性带来的控制精度下降问题，可用于航空航天领域高精度对地观测卫星，太空望远镜等航天器的高精度姿态控制。
【IPC分类】G05D1/08
【公开号】CN104898686
【申请号】CN201510294341
【发明人】郭雷, 张培喜, 乔建忠, 李文硕, 王春
【申请人】北京航空航天大学
【公开日】2015年9月9日
【申请日】2015年6月2日
【技术领域】
[0001] 本发明涉及一种基于反作用轮摩擦特性的抗干扰姿态控制方法，特别是针对包含 反作用轮摩擦、环境力矩等多源干扰下的航天器抗干扰姿态控制方法，该方法可用于航空 航天领域高精度观测卫星，太空望远镜等航天器的高精度姿态控制。
【背景技术】
[0002] 航天器姿态控制系统的可靠性和长期工作稳定性一直是航天器研制中的关键课 题。反作用轮是航天器姿态控制系统中最重要的惯性执行部件之一，近几年发射的长寿命、 高精度、多功能三轴稳定卫星，几乎毫不例外地利用反作用轮作为主要执行部件。在航天器 姿控系统中，反作用轮按照姿控系统指令，提供合适的控制力矩，校正航天器的姿态偏差， 完成某种预定的姿态调整。反作用轮作为航天器三轴稳定控制系统主要的执行部件，其性 能对姿态控制系统具有决定性的影响，提高反作用轮控制系统的性能对卫星姿态控制系统 具有重要意义。反作用轮系统内部存在的多种干扰和噪声，如摩擦力矩干扰和速率测量噪 声等，会使反作用轮执行指令产生误差，给航天器姿态控制系统带来干扰。此外航天器在轨 飞行过程中，除了受到反作用轮带来的摩擦力矩干扰等，还将受到各种外部太空环境干扰 力矩的作用，如气动力矩、太阳辐射光压、重力梯度力矩、空间碎片撞击力矩以及磁力矩等。 对于航天器系统而言，来自上述外部环境干扰以及反作用轮的干扰，都将严重影响到姿态 控制系统的精度和稳定度，在航天器设计的过程中，必须考虑上述干扰的影响。
[0003] 航天器姿态控制器目前设计过程一般都是基于模型进行设计，准确的模型参数能 够提高航天器的姿态控制精度，以往的研宄过程中姿态控制系统的设计与执行机构的特性 联系并不紧密，忽略了执行机构动态特性，此外对于航天器所遭受的太空环境干扰，也忽略 部分干扰特性，不够精细，使得航天器动力学模型在精确性上有所欠缺，导致所设计的控 制方法不够精确，影响航天器系统的姿态精度和稳定度，在面向实际工程对象时，会存在问 题。
【发明内容】
[0004] 本发明的技术解决问题是：针对使用反作用轮的航天器系统，克服现有技术的不 足，并充分利用反作用轮的动态特性，建立包含反作用轮摩擦特性的抗干扰姿态控制方法， 并同时针对航天系统存在的外部环境干扰力矩以及反作用摩擦等多源干扰，提供一种基于 反作用动态特性的抗干扰姿态控制方法，解决多源干扰下航天器的姿态控制问题，提高航 天器姿态系统的控制精度和稳定度。
[0005] 本发明的技术解决方案为：一种基于反作用轮摩擦特性的抗干扰姿态控制方法， 其特征在于包括以下步骤：针对反作用轮摩擦以及姿控精度较低的问题，首先构建含有反 作用轮摩擦特性的航天器耦合动力学方程，其次针对由于反作用轮带来的摩擦干扰设计摩 擦干扰估计器，对反作用轮摩擦进行实时估计；再次，针对航天器系统中存在的环境干扰力 矩以及摩擦干扰估计误差，设计标称控制器进行抑制；最后通过联合标称控制器与摩擦干 扰估计器，设计复合分层抗干扰控制器，完成多源干扰影响下的航天器抗干扰姿态控制；
[0006] 第一步：构建含有反作用轮摩擦特性的航天器耦合动力学模型
[0007] 当航天器本体坐标系和轨道坐标系之间的欧拉角很小时，姿态运动学可以小角 度线性化，得到如下的姿态动力学模型：
[0009] 其中，Ii，I2，I3分别为航天器的三轴转动惯量；巾⑴，0⑴，步⑴分别为三轴 姿态角，知)滅0,#(0分别为三轴姿态角速度，知),知)#(0分别为三轴姿态角加速度； ?L，J2,1分别为三轴上安装的反作用轮的转动惯量；分别表示航天器三轴 上的反作用轮中电机的转动角加速度，Tdl(t)，Td2(t)，Td3(t)分别为航天器三轴受到的环境 干扰；n为航天器轨道角速度；
[0010] 用于航天器姿态控制的反作用轮系统一般是由微型直流无刷电机、反作用轮本 体、以及控制器线路构成，是一个相对独立的机电执行部件，反作用轮的转动方程为：
[0012] 其中，Ji为反作用轮的转动惯量，Di(t)为反作用轮中电机的转动角速度，4(0 为反作用轮中电机的转动角加速度，kTi为反作用轮中电机的电流力矩系数，ii(t)为反作 用轮中电机的电流，kTi*ii(t)为反作用轮的驱动力矩，Mfi(t)为反作用轮摩擦力矩；对于反 作用轮使用的无刷直流电机，电流力矩系数kTi在数值上与反作用轮中的反电动势系数相 等，kEi为反作用轮使用电机的反电动势系数，Ei⑴为加在反作用轮两端的控制电压，氏为 反作用轮使用电机的电阻值，Q为反作用轮使用电机的电感，在正常使用过程中，%⑴在 数值上大小接近〇,在实际处理过程中，这一项可以忽略，因此反作用轮转动方程进一步可 以描述为；
[0014] 对于分装在航天器三轴上的反作用轮，航天器的控制力矩指令可以表示为：
[0016] 其中，kT1，kT2，kT3为安装在航天器三轴上的反作用轮中电机的电流力矩系数，ijt),i2(t),i3(t)为安装在航天器三轴上的反作用轮中电机的电流，Mfl(t)，Mf2(t)，Mf3(t) 为安装在航天器三轴上的反作用轮的摩擦力矩；进一步，三轴上安装的反作用轮中所用电 机的电流方程为：
[0018] 其中^^心馬为安装在航天器三轴上的反作用轮电机电阻^"七^&⑴^八^为 安装在航天器三轴上的三个反作用轮的控制电压；kE1，kE2,kE3是安装在航天器三轴上的三 个反作用轮中电机的反电动势系数；
[0019] 进一步，建立包含反作用轮摩擦特性的航天器姿态系统动力学模型为：
[0021] 将式E4写成矩阵形式如下：
[0023]其中，状态p(t)=[伞（t)，0 (t)，边（t)]T，Td(t) = 天器三轴受到的环境干扰力矩，E(t) = [Eiah&ahEjtUT为安装在航天器三轴上的三 个反作用轮的控制电压，D(t) = [Mt)，D2(t)，D3(t)]T为安装在航天器三轴上的反作 用轮中电机的角速度，Mf(t) = [1^(0，{2(0，{3(0^为安装在航天器三轴上的反作用轮 的摩擦力矩干扰；式中P=diagUi, 12,I3}，Bm=I，Bw=I，
， Q=diag{4n2 (I2-I3)，3n2 ，n2 (H)}，
，
[0024] 进一步可以将包含反作用轮摩擦特性的航天器姿态系统动力学模型写成状态空 间表达式形式如下：
[0026]其中，x(t)、E(t)分别为系统的状态变量和控制输入，E(t)=唞(〇，&(〇33(〇] T,
，其中ep (t) =p(t) _pd (t)，pd (t)为航天器系统 的期望姿态信息，P(t)为航天器系统当前最新的姿态信息，ep(t)为航天器当前姿态与期望 姿态的偏差，A为系统阵，B。为控制输入矩阵，Bi为摩擦力矩干扰输入矩阵，B2为环境干扰 力矩的输入矩阵，其对应的表达式如下：
[0028]其中，KT=diag{kT1，kT2,kT3}，J=diagUpJ2,J3}，KE=diag{kE1，kE2,kE3}，R= diagtRi,R2,R3}；
[0029] 第二步：设计摩擦干扰估计器
[0030] 对于上述反作用轮摩擦干扰，设计摩擦干扰估计器，对摩擦干扰的估计表征为：
[0032] 其中，N为摩擦干扰估计器增益，6,(7)为反作用轮摩擦干扰的估计值，r(t)为摩 擦干扰估计器中的辅助变量；
[0033] 第三步：设计标称控制器
[0034] 在通过摩擦干扰估计器完成对反作用轮摩擦进行估计后，对于航天器系统中还存 在的环境干扰力矩以及摩擦干扰估计误差干扰，进一步设计具有干扰抑制能力的标称控制 器，其对应控制律为：
[0036] 其中，EK(t)为当前时刻标称控制器的控制量，K为标称控制器的控制增益；
[0037] 第四步：设计航天器复合分层抗干扰姿态控制器
[0038] 在分别完成反作用轮摩擦观测器与标称控制器基础上，进行复合，得到多源干扰 下航天器复合分层抗干扰姿态控制器，其对应的控制律为：
[0040] 其中，EK(t)为复合分层抗干扰姿态控制器的输出，用于控制安装在航天器三轴上 的反作用轮完成姿态控制；
[0041] 本发明与现有技术相比的优点在于：本发明在航天器动力学建模过程中，加入了 执行机构反作用轮的动态特性，相对于目前存在的姿态控制方法，充分利用已有的信息，更 贴合工程实际，能更好的解决工程中出现的问题；此外，针对航天器系统还存在的外部环境 干扰力矩，通过引入摩擦干扰估计器与标称控制器构成复合控制器，对摩擦干扰的估计和 补偿与对航天器系统受到的外部环境干扰的抑制相结合，能够有效的提高航天器的姿态控 制精度和稳定度。
【附图说明】
[0042]图1为本发明一种基于反作用轮动态特性的抗干扰姿态控制方法的设计流程图。
【具体实施方式】
[0043]如图1所示，本发明具体实现步骤如下（卫星作为一种典型的航天器，本实施例中 以一类微纳卫星为例来说明方法的具体实现）：
[0044] 1、构建含有反作用轮摩擦特性的卫星耦合动力学模型
[0045] 当卫星本体坐标系和轨道坐标系之间的欧拉角很小时，姿态运动学可以小角度 线性化，得到如下的姿态动力学模型：
[0047]其中，Ii，I2, 13分别为本实施例中微纳卫星的三轴转动惯量，其对应数值为 11= 5. 5,I2= 6. 2,I3= 2. 2 ;Mt)，0⑴，Mt)分别为三轴姿态角，分别为 三轴姿态角速度，
分别为三轴姿态角加速度；^2，1分别为三轴上安装 的反作用轮的转动惯量，在此实施例中，采用同一类型反作用轮，其转动惯量对应数值 为1= 0.00273,J2= 0.00273,J3= 0.00273 ;
分别表示卫星三轴上 的反作用轮的转速，Tdl(t)，Td2(t)，Td3(t)分别为航天器三轴受到的环境干扰力矩，其对 应数值为Tdl= 2.4X10 -4(3cosl0t+l)，Td2= 2.4X10 -4(3cosl0t++1.6sinl0t)，Td3 = 2. 3X10_4(3sinl0t+l)，n为航天器轨道角速度，此实施例中n= 0?OOllrad/s;
[0048] 用于卫星姿态控制的反作用轮系统一般是由微型直流无刷电机、反作用轮本体、 以及控制器线路构成，是一个相对独立的机电执行部件，反作用轮的转动方程为：
[0050]其中，Ji为反作用轮的转动惯量，DJt)为反作用轮中电机的转动角速度，&⑴为 反作用轮中电机的转动角加速度，kTi为反作用轮中电机的电流力矩系数，ii⑴为反作用轮 中电机的电流，kTi*ii(t)为反作用轮的驱动力矩，Mfi(t)为反作用轮摩擦力矩；对于反作用 轮使用的无刷直流电机，电流力矩系数kTi在数值上与反作用轮中的反电动势系数相等，kEi 为反作用轮使用电机的反电动势系数，Ei(t)为加在反作用轮两端的控制电压，氏为反作用 轮使用电机的电阻值，Q为反作用轮使用电机的电感，在此实施例中，三轴安装的反作用轮 均为同一类型电机驱动， 反作用轮的转动惯量数值大小为〇. 00273,对应的反电动势系数均 为0. 02,电流力矩系数均为0. 02,电机中电阻值均为1Q，电感大小均为0. 0002H，在正常使 用过程中，& */,(/)在数值上大小接近0,在实际处理过程中，这一项可以忽略，因此反作用 轮转动方程进一步可以描述为；
[0052] 对于分装在卫星三轴上的反作用轮，卫星的控制力矩指令可以表示为：
[0054]其中，kT1，kT2，kT3为安装在卫星三轴上的反作用轮中电机的电流力矩系数，其 数值大小均为0.02,ijthijthidt)为安装在卫星三轴上的反作用轮中电机的电流， Mfl(t)，Mf2(t)，Mf3(t)为安装在卫星三轴上的反作用轮的摩擦力矩；进一步，三轴上安装的 反作用轮中所用电机的电流方程为：
[0056]其中，《，馬为安装在卫星三轴上的反作用轮电机电阻，其数值大小均为1，Ei(t)，E2 (t)，E3 (t)为安装在卫星三轴上的三个反作用轮的控制电压；kE1，kE2,kE3是安装在 卫星三轴上的三个反作用轮中电机的反电动势系数，其数值大小均为0. 02 ;
[0057] 进一步，建立包含反作用轮摩擦特性的卫星姿态系统动力学模型为：
[0059]将式E4写成矩阵形式如下：
[0061]其中，状态p(t)=[伞（t)，0 (t)，边（t)]T，Td(t)=[Tdl(t)，Td2(t)，Td3(t)]TSl星三轴受到的环境干扰力矩，E(t) = [Eiah&ahEjt)]1为安装在卫星三轴上的三个反 作用轮的控制电压，由控制器解算所得，D(t) = [Djt)，D2(t)，D3(t)]T为安装在卫星 三轴上的反作用轮中电机的角速度，Mf(t) = [Mfl，Mf2，Mf3]T为安装在卫星三轴上的反作用 轮的摩擦力矩干扰；式中？ = (^区{11，12，13}，8111=1，8 1?=1，.，
Q=diag{4n2 (I2-I3)，3n2C^-13)，n2 (H)}，
[0062] 进一步可以将包含反作用轮摩擦特性的卫星姿态系统动力学模型写成状态空间 表达式形式如下：
[0064]其中，x(t)、E(t)分别为系统的状态变量和控制输入，E(t)=[EiahEjthEia)] T
，其中ep(t) =p(t)_pd(t)，pd(t)为航天器系统 的期望姿态信息，P(t)为航天器系统当前最新的姿态信息，ep(t)为航天器当前姿态与期望 姿态的偏差；A为系统阵，为控制输入矩阵，为摩擦力矩干扰输入矩阵，B2为环境干扰 力矩的输入矩阵，其对应的表达式如下：
[0066]其中，KT=diag{kT1，kT2,kT3}，J=diaglJi，J2,J3}，KE=diag{kel，ke2,ke3}，R= diagtRi,R2,R3}；
[0067]2、设计摩擦干扰估计器
[0068] 对于上述反作用轮摩擦干扰，设计摩擦干扰估计器，对摩擦干扰的估计表征为：
[0070] 其中，N为摩擦干扰估计器的增益，在此实施例中，以卫星俯仰轴姿态控制为例，N 的取值大小为[0 0.0008 0 0. 1367]，⑴为反作用轮摩擦干扰的估计值，r(t)为摩擦干 扰估计器中的辅助变量；
[0071] 3、设计标称控制器
[0072] 在通过摩擦干扰估计器完成对反作用轮摩擦进行估计后，对于卫星系统中还存在 的环境干扰力矩以及摩擦干扰估计误差干扰，进一步设计具有干扰抑制能力的标称控制 器，在此实施例中，选用的标称控制律为ro控制律，其具体表现形式为：
[0074] 其中，EK(t)为当前时刻ro控制器的控制量，K为ro控制器的控制增益，以卫星 俯仰轴姿态控制为例，ro控制器的控制增益为K= [0. 2160 2. 3540 -0. 0438 -0. 2467]，KP 为PD控制器比例增益，KP取值为[0. 2160 -0. 0438]，KD为PD控制器微分增益，KD取值为 [2. 3540 -0. 2467]；
[0075] 4、设计卫星复合分层抗干扰姿态控制器
[0076] 在分别完成反作用轮摩擦观测器与标称控制器基础上，对两种控制器进行复合， 得到多源干扰下卫星复合分层抗干扰姿态控制器，其对应的控制律为：
[0078] 其中，EK(t)为复合分层抗干扰姿态控制器的输出，用于控制安装在微纳卫星三轴 上的反作用轮完成姿态控制。
[0079] 本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
【主权项】
1. 一种基于反作用轮摩擦特性的抗干扰姿态控制方法，其特征在于，包括以下步骤： 针对反作用轮摩擦以及姿控精度较低的问题，首先，构建含有反作用轮摩擦特性的航天器 耦合动力学模型，其次，针对由于反作用轮带来的摩擦干扰设计摩擦干扰估计器，对反作用 轮摩擦进行实时估计；再次，针对航天器系统中存在的摩擦干扰估计误差及环境干扰力矩， 设计标称控制器进行抑制；最后，通过联合标称控制器与摩擦干扰估计器，设计复合分层抗 干扰控制器，完成多源干扰影响下的航天器抗干扰姿态控制； 第一步：构建含有反作用轮摩擦特性的航天器耦合动力学模型 当航天器本体坐标系和轨道坐标系之间的欧拉角很小时，姿态运动学可以小角度线 性化，得到如下的姿态动力学模型：其中，I1,12,13分别为航天器的三轴转动惯量；φ (t)，Θ (t)，Φ⑴分别为三轴姿 态角，火分别为三轴姿态角速度，?),與〇,列〇分别为三轴姿态角加速度； J1, J2, J3分别为三轴上安装的反作用轮的转动惯⑴，0;⑴分别表示航天器三轴 上的反作用轮中电机的转动角加速度，Tdl (t)，Td2 (t)，Td3 (t)分别为航天器三轴受到的环境 干扰力矩；η为航天器轨道角速度； 用于航天器姿态控制的反作用轮系统一般是由微型直流无刷电机、反作用轮本体、以 及控制器线路构成，是一个相对独立的机电执行部件，反作用轮的转动方程为：其中，Ji为反作用轮的转动惯量，Ω Jt)为反作用轮中电机的转动角速度，A⑴为反 作用轮中电机的转动角加速度，kTi为反作用轮中电机的电流力矩系数，ijt)为反作用轮 中电机的电流，kTi*ii(t)为反作用轮的驱动力矩，Mfi(t)为反作用轮摩擦力矩；对于反作用 轮使用的无刷直流电机，电流力矩系数kTi在数值上与反作用轮中的反电动势系数相等，kEi为反作用轮使用电机的反电动势系数，Ei (t)为加在反作用轮两端的控制电压，氏为反作用 轮使用电机的电阻值，Li为反作用轮使用电机的电感，在正常使用过程中，L,. *((〇在数值上 大小接近〇,在实际处理过程中，这一项可以忽略，因此反作用轮转动方程进一步可以描述 为；对于分装在航天器三轴上的反作用轮，航天器的控制力矩指令可以表示为：其中，kT1，kT2，kT3为安装在航天器三轴上的反作用轮中电机的电流力矩系数， ijt), i2(t), i3(t)为安装在航天器三轴上的反作用轮中电机的电流，Mfl(t)，Mf2(t)，M f3(t) 为安装在航天器三轴上的反作用轮的摩擦力矩；进一步，三轴上安装的反作用轮中所用电 机的电流方程为：其中，R1, R2, R3为安装在航天器三轴上的反作用轮电机电阻，E i (t)，E2 (t)，E3 (t)为安装 在航天器三轴上的三个反作用轮的控制电压；kE1，kE2, kE3是安装在航天器三轴上的三个反 作用轮中电机的反电动势系数； 进一步，建立包含反作用轮摩擦特性的航天器姿态系统动力学模型为：将式Σ4写成矩阵形式如下： p-f)(i) + Cp(i) + QP(t) = β,:Ε(?) + BiP-(I) + BmMf (I) + BhTi1(J) 其中，状态 P (t) = [ Φ (t)，Θ (t)，Φ (t) ]T，Td (t) = [Tdl (t)，Td2 (t)，Td3 (t) ]τ为航天 器三轴受到的环境的干扰力矩，E(t) = 为安装在航天器三轴上的三 个反作用轮的控制电压，Ωα) = [Q1U), Ω2α)，Ω3α)]τ为安装在航天器三轴上的反作 用轮中电机的角速度，Mf(t) = [1^(〇，1^2(〇，1^(〇]1为安装在航天器三轴上的反作用轮 的摩擦力矩干扰；式中 P = CliagU1, I2, I3}，Bm= I, B w= I，进一步可以将包含反作用轮摩擦特性的航天器姿态系统动力学模型写成状态空间表 达式形式如下： 女(?)= Ax(J) + βηΕ(?) + BfM 十 β，Τ(?(?) 其中，x(t)、E(t)分别为系统的状态变量和控制输入，E(t) =,其中ep(t) = p(t)-pd(t)，pd(t)为航天器系统的 期望姿态信息，P(t)为航天器系统当前最新的姿态信息，ep(t)为航天器当前姿态与期望姿 态的偏差，A为系统阵，Btl为控制输入矩阵，B1为摩擦力矩干扰输入矩阵，B2为环境干扰力 矩的输入矩阵，其对应的表达式如下：其中，Kt= diag{k T1，kT2, kT3}，J = diaglj" J2, J3}，Ke= diag{k E1，kE2, kE3}，R = diagtRi, R2, R3I ； 第二步：设计摩擦干扰估计器 对于上述反作用轮摩擦干扰，设计摩擦干扰估计器，对摩擦干扰的估计表征为：其中，N为摩擦干扰估计器增益，&,(0为反作用轮摩擦干扰的估计值，r(t)为摩擦干 扰估计器中的辅助变量； 第三步：设计标称控制器 通过摩擦干扰估计器完成对反作用轮摩擦进行估计后，对于航天器系统中还存在的环 境干扰力矩以及摩擦干扰估计误差，进一步设计具有干扰抑制能力的标称控制器，其对应 控制律为：其中，Ek(t)为当前时刻标称控制器的控制量，K为标称控制器的控制增益； 第四步：设计航天器复合分层抗干扰姿态控制器 在分别完成反作用轮摩擦观测器与标称控制器基础上，进行复合，得到多源干扰下航 天器复合分层抗干扰姿态控制器，其对应的控制律为：其中，E(t)为复合分层抗干扰姿态控制器的输出，用于控制安装在航天器三轴上的反 作用轮完成姿态控制。
【专利摘要】一种基于反作用轮摩擦特性的抗干扰姿态控制方法，针对反作用轮过零摩擦以及姿控精度较低的问题，首先构建含有反作用轮摩擦特性的航天器耦合动力学方程，其次针对由于反作用轮带来的摩擦干扰设计摩擦干扰估计器，对反作用轮摩擦进行实时估计；再次，针对航天器系统中的摩擦干扰估计误差及环境干扰，设计标称控制器进行抑制；最后通过联合标称控制器与摩擦干扰估计器，设计复合分层抗干扰控制器，完成多源干扰影响下的航天器抗干扰姿态控制；本方法在传统的航天器动力学方程中加入执行机构动力学，能够更好的分析由于执行机构特性带来的控制精度下降问题，可用于航空航天领域高精度对地观测卫星，太空望远镜等航天器的高精度姿态控制。
【IPC分类】G05D1/08
【公开号】CN104898686
【申请号】CN201510294341
【发明人】郭雷, 张培喜, 乔建忠, 李文硕, 王春
【申请人】北京航空航天大学
【公开日】2015年9月9日
【申请日】2015年6月2日
最新回复(0)