CN111674570A - 一种航天器三超控制可变包络操纵律设计方法 - Google Patents

一种航天器三超控制可变包络操纵律设计方法 Download PDF

Info

Publication number
CN111674570A
CN111674570A CN202010351842.7A CN202010351842A CN111674570A CN 111674570 A CN111674570 A CN 111674570A CN 202010351842 A CN202010351842 A CN 202010351842A CN 111674570 A CN111674570 A CN 111674570A
Authority
CN
China
Prior art keywords
control
moment gyro
spacecraft
control moment
law
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202010351842.7A
Other languages
English (en)
Other versions
CN111674570B (zh
Inventor
王有懿
姚宁
袁利
汤亮
关新
宗红
郭子熙
郝仁剑
冯骁
张科备
刘昊
龚立纲
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Control Engineering
Original Assignee
Beijing Institute of Control Engineering
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Control Engineering filed Critical Beijing Institute of Control Engineering
Priority to CN202010351842.7A priority Critical patent/CN111674570B/zh
Publication of CN111674570A publication Critical patent/CN111674570A/zh
Application granted granted Critical
Publication of CN111674570B publication Critical patent/CN111674570B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/244Spacecraft control systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/244Spacecraft control systems
    • B64G1/245Attitude control algorithms for spacecraft attitude control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/28Guiding or controlling apparatus, e.g. for attitude control using inertia or gyro effect
    • B64G1/286Guiding or controlling apparatus, e.g. for attitude control using inertia or gyro effect using control momentum gyroscopes (CMGs)
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00Computer-aided design [CAD]
    • G06F30/20Design optimisation, verification or simulation
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F2119/00Details relating to the type or aim of the analysis or the optimisation
    • G06F2119/14Force analysis or force optimisation, e.g. static or dynamic forces

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Combustion & Propulsion (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Chemical & Material Sciences (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Computer Hardware Design (AREA)
  • Evolutionary Computation (AREA)
  • Geometry (AREA)
  • General Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明一种航天器三超控制可变包络操纵律设计方法,适用于兼具有敏捷机动要求与高精度指向控制需求的航天器姿态控制领域。现有的控制力矩陀螺群安装倾角固定不变,难以充分利用控制力矩陀螺群角动量包络。针对此,设计一种航天器三超控制可变包络操纵律设计方法。在原有控制力矩陀螺群安装构型固定的基础上,引入安装倾角这一控制变量,提升了航天器敏捷机动能力;在原有的低速框架一个自由度避奇异的基础上增加安装倾角,构成两个自由度避奇异,实现低速框架快速脱离奇异。分析结果表明,安装倾角可变时,航天器敏捷机动的最大角速度由2.83(°/s)提升到3.2(°/s),进一步提高航天器敏捷机动性能。

Description

一种航天器三超控制可变包络操纵律设计方法
技术领域
本发明涉及一种航天器三超控制可变包络操纵律设计方法,属于航天器控制领域。
背景技术
近年来,以甚高分辨率对地观测为代表航天任务对航天器快速敏捷机动与机动到位后的高精度的稳态控制提出了需求。这要求执行机构具备大力矩输出能力以及灵活改变角动量包络的能力。现有的控制力矩陀螺在安装构型确定后,其安装倾角固定不变。这不利于执行机构灵活改变整个角动量包络,以满足航天器不同的敏捷机动要求。
现有的控制力矩陀螺固定倾角安装以及其角动量分析方法存在以下不足:
1、难以进一步提高航天器敏捷机动性能
现有的航天器的姿态控制系统中,控制力矩陀螺都采用固定倾角安装。一旦安装倾角固定,整个控制力矩陀螺群的角动量外包络已固定。此时的角动量包络是在综合考虑航天器各个轴敏捷机动要求下的折衷,一定程度下限制了控制力矩陀螺群的角动量外包络。而控制力矩陀螺群的角动量外包络直接决定了航天器敏捷机动的最大角速度。
2、无法满足航天器多种敏捷机动的需求
现有的固定倾角安装的控制力矩陀螺群,其角动量包络更接近于球体,以实现航天器三轴相等的姿态机动能力。但是,在轨航天器的姿态敏捷机动需求多种多样,例如某些工况下,航天器需要提高滚动轴的敏捷机动能力,而对其余两轴的姿态机动能力要求不高。此时固定倾角安装的控制力矩陀螺群难以满足航天器多种敏捷机动的需求。
3、无法实现控制力矩陀螺低速框架的快速避奇异
现有的固定倾角安装的控制力矩陀螺群操纵律设计中,当控制力矩陀螺低速框架接近奇异状态时,仅能通过低速框架一个自由度进行有效避奇异,虽然高速转子也能参与低速框架避奇异,但是其效率比较低,难以实现控制力矩陀螺低速框架的快速避奇异。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提出了一种航天器三超控制可变包络操纵律设计方法,通过分析控制力矩陀螺整个角动量包络与框架角和安装倾角之间的关系,为控制力矩陀螺群的操纵律设计与快速避奇异提供技术支持。
本发明的技术解决方案是:一种航天器三超控制可变包络操纵律设计方法,其特征在于,包括如下步骤:
(1)将N个控制力矩陀螺群(CMGs)呈正N棱锥安装,其安装倾角为β。
(2)建立N个控制力矩陀螺群(CMGs)的合成角动量h的模型;
(3)根据步骤(2)N个控制力矩陀螺群(CMGs)的合成角动量h的模型,建立安装倾角可变的控制力矩陀螺群动力学模型;
(4)根据步骤(3)安装倾角可变的控制力矩陀螺群动力学模型,确定考虑安装倾角、框架转速、转子转速时的控制力矩陀螺群指令操纵律xT
(5)设计框架角与转子转速标称状态的零运动操纵律xN1、设计框架角与转子转速共同避奇异的零运动操纵律xN2、设计框架角与安装倾角共同避奇异的零运动操纵律xN3
(6)将设计框架角与转子转速标称状态的零运动操纵律xN1、设计框架角与转子转速共同避奇异的零运动操纵律xN2、设计框架角与安装倾角共同避奇异的零运动操纵律xN3,结合考虑安装倾角、框架转速、转子转速时的控制力矩陀螺群指令操纵律xT,得到N个控制力矩陀螺群(CMGs)的总的操纵律,以控制航天器的控制力矩陀螺。
优选的,综合控制力矩陀螺布局以及冗余的约束条件,控制力矩陀螺布局的数目N取2、3、4、5或者6。
优选的,安装倾角,是指正N楞锥的每个楞与正N楞锥底面的夹角。
优选的,N个控制力矩陀螺群呈正N楞锥安装在航天器上。
优选的,N大于等于2。
优选的,步骤(2)建立N个控制力矩陀螺群(CMGs)的合成角动量h的模型为:
Figure BDA0002472185750000031
其中,Hi表示第i个控制力矩陀螺角动量在航天器本体系下的三轴投影,cβ=cos(β),sβ=sin(β),cδi=cos(δi),sδi=sin(δi),i=1,2,…,N;δ=[δ1,δ2,…,δN]T为控制力矩陀螺群框架角矢量阵;δi为第i个控制力矩陀螺的框架角;h0为每个控制力矩陀螺的标称角动量;Ω=[Ω1,Ω2,…,ΩN]T为控制力矩陀螺群(CMGs)的转子转速矢量阵;Ωi为第i个控制力矩陀螺转子转速;Isw=[Isw1,Isw2,…,IswN]T为控制力矩陀螺转子惯量矢量阵。Iswi为第i个控制力矩陀螺转子惯量,其中角动量分配阵As
Figure BDA0002472185750000032
优选的,步骤(3)根据步骤(2)N个控制力矩陀螺群(CMGs)的合成角动量h的模型,建立安装倾角可变的控制力矩陀螺群动力学模型为
Figure BDA0002472185750000033
式中,C(δ,Ω)=AtIsw[Ω]d,[Ω]d=diag(Ω)为控制力矩陀螺群的转子转速对角阵,C(δ,Ω)简写为C;D(δ)=AsIsw
Figure BDA0002472185750000041
为控制力矩陀螺群的框架角速度矢量,D(δ)简写为D;
Figure BDA0002472185750000042
为控制力矩陀螺群的转子加速度矢量。矩阵At可表示为
Figure BDA0002472185750000043
控制力矩陀螺群安装倾角的分配阵E(β,δ)可表示为:
Figure BDA0002472185750000044
E(β,δ)简写为E。
优选的,(5)采用高斯函数对框架角力矩分配系数Wg0、转子权重分配系数Wsi、以及低速框架与安装倾角力矩分配系数Wβ进行设计。
优选的,N个控制力矩陀螺群(CMGs)为安装倾角可变的控制力矩陀螺群
优选的,步骤(6)中N个控制力矩陀螺群(CMGs)的总的操纵律x为:x=xT+xN1+xN2+xN3
本发明与现有技术相比的优点在于:
(1)现有的控制力矩陀螺都采用固定倾角安装,整个控制力矩陀螺群的角动量外包络固定。此时的角动量包络是在综合考虑航天器各个轴敏捷机动要求下的折衷,一定程度下限制了航天器敏捷机动的最大角速度,本发明进一步提高航天器敏捷机动性能。
(2)本发明提出的一种航天器三超控制可变包络操纵律设计方法,通过操纵安装倾角、低速框架、高速转子等多变量,实现航天器滚动、俯仰、偏航三轴最大机动角速度由2.56(°/s),2.13(°/s),2.83(°/s)提升到2.75(°/s),2.29(°/s),3.2(°/s),进一步提高航天器敏捷机动性能。
(3)现有的固定倾角安装的控制力矩陀螺群,其角动量包络更接近于球体,以实现航天器三轴相等的姿态机动能力,难以满足航天器多种敏捷机动的需求,本发明能够满足航天器多种敏捷机动的需求。
(4)本发明提出的一种航天器三超控制可变包络操纵律设计方法,能够通过安装倾角控制,动态实时调整控制力矩陀螺群角动量包络,即能够实现由接近于球体的角动量向椭球角动量包络甚至扁球形的角动量包络改变,通过动态实时调节安装构型倾角和低速框架角度,以满足航天器多种敏捷机动的需求。
(5)本发明能够实现2个控制力矩陀螺下航天器三轴敏捷机动能力,现有航天器控制力矩陀螺群一般要求航天器具有4-6个控制力矩陀螺,才能实现航天器具有三轴敏捷机动能力。本发明提出的一种航天器“三超”控制可变包络操纵律设计方法,能够通过调节构型倾角,实现2个控制力矩陀螺下的航天器三轴敏捷机动控制能力。为现有控制力矩陀螺群某个或者某几个控制力矩陀螺故障下,依然实现航天器具备三轴敏捷机动能力提供可靠的技术途径。
(6)本发明实现了控制力矩陀螺低速框架的快速避奇异,现有的固定倾角安装的控制力矩陀螺群操纵律设计中,当控制力矩陀螺低速框架接近奇异状态时,仅能通过低速框架一个自由度进行有效避奇异,本发明提出的一种航天器“三超”控制可变包络操纵律设计方法,将控制力矩陀螺的安装倾角作为一个控制变量进行控制,在原有的低速框架一个自由度避奇异的基础上增加安装倾角,实现两个自由度避奇异,实现低速框架快速脱离奇异。
附图说明
图1为本发明的设计方法流程图;
图2为本发明安装倾角可变三轴机动姿态对比示意图;
图3为本发明倾角可变的三轴机动VSCMGs奇异度对比示意图;
图4为本发明两个CMGs姿态机动示意图;
图5为本发明两个CMGs姿态机动框架角速度示意图。
具体实施方式
下面结合附图和具体实施例对本发明进行详细说明。
本发明方法提出一种航天器三超控制可变包络操纵律设计方法,适用于高分辨率对地观测、天基天文观测等航天器姿态控制领域。三超控制是指使航天器具备“超高精度”、“超高稳定度”、“超敏捷”指向观测目标能力的控制方法。N个控制力矩陀螺组成的控制力矩陀螺群(CMGs)中的每个控制力矩陀螺都是单框架控制力矩陀螺,且每个控制力矩陀螺标称角动量都一样。控制力矩陀螺群中的合成角动量的边界称为角动量包络。通过改变安装倾角β,可实现合成角动量的角动量包络的改变,即称为可变角动量包络。控制力矩陀螺的操纵律是指将指令力矩分配到各个控制力矩陀螺,通过控制力矩陀螺转动输出指令力矩的方法。
本发明提出的一种航天器三超控制可变包络操纵律设计方法,能够通过群改变控制力矩陀螺的安装倾角,框架角等方法,实现控制力矩陀螺群力矩输出能力提升,从而提升航天器的敏捷机动能力,为航天器“三超”控制中的“超敏捷”控制做出贡献。
如图1所示,本发明一种航天器三超控制可变包络操纵律设计方法,优选方案包括如下步骤:
(1)N个控制力矩陀螺群(CMGs)呈正N棱锥安装,其安装倾角为β。(安装倾角,是指N楞锥的每个楞与N楞锥底面的夹角;)(N个控制力矩陀螺群(CMGs)优选为安装倾角可变的控制力矩陀螺群)
(2)建立N个控制力矩陀螺群(CMGs)的合成角动量h的模型优选为:
Figure BDA0002472185750000061
其中,其中,Hi表示第i个控制力矩陀螺角动量在航天器本体系下的三轴投影,cβ=cos(β),sβ=sin(β),cδi=cos(δi),sδi=sin(δi),(i=1,2,…,N)。δ=[δ1,δ2,…,δN]T为控制力矩陀螺群框架角矢量阵。δi为第i个控制力矩陀螺的框架角(所述控制力矩陀螺,优选为单框架控制力矩陀螺)。h0为每个控制力矩陀螺的标称角动量(优选的,N个控制力矩陀螺群中的每个控制力矩陀螺军相同)。Ω=[Ω1,Ω2,…,ΩN]T为控制力矩陀螺群(CMGs)的转子转速矢量阵。Ωi为第i个控制力矩陀螺转子转速。Isw=[Isw1,Isw2,…,IswN]T为控制力矩陀螺转子惯量矢量阵。Iswi为第i个控制力矩陀螺转子惯量。其中角动量分配阵As优选为
Figure BDA0002472185750000071
(3)根据步骤(2)N个控制力矩陀螺群(CMGs)的合成角动量h的模型,建立安装倾角可变的控制力矩陀螺群动力学模型优选为:
Figure BDA0002472185750000072
式中,C(δ,Ω)=AtIsw[Ω]d,[Ω]d=diag(Ω)为控制力矩陀螺群的转子转速对角阵,C(δ,Ω)简写为C;D(δ)=AsIsw
Figure BDA0002472185750000073
为控制力矩陀螺群的框架角速度矢量,D(δ)简写为D;
Figure BDA0002472185750000074
为控制力矩陀螺群的转子加速度矢量。矩阵At可优选表示为
Figure BDA0002472185750000075
控制力矩陀螺群安装倾角的分配阵E(β,δ)可优选表示为:
Figure BDA0002472185750000076
E(β,δ)简写为E;
(4)根据步骤(3)安装倾角可变的控制力矩陀螺群动力学模型,建立考虑安装倾角、框架转速、转子转速时的控制力矩陀螺群指令操纵律xT,具体优选为
Figure BDA0002472185750000081
其中,;Q=[CDE];
Figure BDA0002472185750000082
为航天器姿态控制力矩,即为控制器输出的期望力矩;W=diag(Wg1,…,WgN,Ws1,…,WsN,Wβ)为权重矩阵,用于在安装倾角、框架角、转子转速三者之间分配航天器姿态控制力矩;Wgi=Wg0exp(-εK1)为第i个控制力矩陀螺的框架角力矩权重分配系数,其中Wg0为框架角力矩分配系数,ε为设计参数;Wsi为第i个转子的权重系数。Wβ为安装构型倾角输出力矩权重系数。(优选采用高斯函数对框架角力矩分配系数Wg0、转子权重分配系数Wsi、以及低速框架与安装倾角力矩分配系数Wβ进行设计。)(框架角力矩分配系数Wg0、转子权重分配系数Wsi、以及低速框架与安装倾角力矩分配系数Wβ,共同形成框架角与转子力矩分配系数)
K1优选表示为:
Figure BDA0002472185750000083
式中,T表示转置;ε为设计参数,优选取值范围为ε∈[0.01 0.2];
(5)设计框架角与转子转速标称状态的零运动操纵律xN1、设计框架角与转子转速共同避奇异的零运动操纵律xN2、设计框架角与安装倾角共同避奇异的零运动操纵律xN3
(6)将设计框架角与转子转速标称状态的零运动操纵律xN1、设计框架角与转子转速共同避奇异的零运动操纵律xN2、设计框架角与安装倾角共同避奇异的零运动操纵律xN3结合考虑安装倾角、框架转速、转子转速时的控制力矩陀螺群指令操纵律xT,得到N个控制力矩陀螺群(CMGs)的总的操纵律,以控制航天器的陀螺。
优选的,采用高斯函数对框架角力矩分配系数Wg0、转子权重分配系数Wsi、以及低速框架与安装倾角力矩分配系数Wβ进行设计,具体为
采用高斯函数分配低速框架力矩与高速转子力矩。定义高斯函数为f(x,a,b,c)=a×exp(-(x-b)2/(2c2)),公式中的x等于u,则优选定义Wg0和Wsi这两个力矩分配系数为
Figure BDA0002472185750000091
其中参数Wg00,Wg01,Wsi0,Wsi1,ag0,as0,bg0,bs0,cg0,cs0为设计参数。Wg00取值范围优选为[0.01,0.1],Wg01取值范围优选为[0.005,0.05];Wsi0取值范围优选为[40,100],Wsi1取值范围优选为[40,100],ag0取值范围优选为[0.95,1.05],as0取值范围优选为[0.95,1.05],,bg0取值优选为0,bs0取值优选为0,cg0取值范围优选为(0,2],cs0取值范围优选为(0,2]。
优选的,采用高斯函数对低速框架与安装倾角力矩分配系数的设计,具体为
定义高斯函数为f(x,a,b,c)=a×exp(-(x-b)2/(2c2)),公式中的x等于u。则定义Wg0和Wβ这两个力矩分配系数优选为
Wβ=Wβ0-Wβ1f(x aβ0 bβ0 cβ0)
其中参数Wβ0,Wβ1,aβ0,bβ0,cβ0为设计参数;Wβ0取值范围为[0.001,0.05],Wβ1取值范围为[0.001,0.05];aβ0取值范围为[0.95,1.05];,bβ0取值范围为0;,cβ0取值范围为(0,2];
优选的,设计框架标称位置与转子转速平衡的零运动操纵律xN1、设计基于框架与转子转速共同避奇异的零运动操纵律xN2、设计基于框架与安装构型倾角的零运动操纵律xN3,具体为:
框架标称位置与转子转速平衡的零运动避奇异操纵律xN1优选为
Figure BDA0002472185750000101
其中,kN1为零运动操纵律系数(kN1为零运动操纵律系数,取值范围为[0.1,0.3]),P=I(2*N)-WQT(QWQT)-1为零运动正交投影矩阵。δf为控制力矩陀螺群(CMGs)的期望框架角,Ωf为控制力矩陀螺群(CMGs)的转子期望转速。I(2*N)表示2*N维的单位矩阵;
框架与转子转速共同避奇异的零运动避奇异操纵律xN2优选为
Figure BDA0002472185750000102
式中,kN2为零运动的权重系数;优选设计为
Figure BDA0002472185750000103
Kmin为设定的奇异度最小值,取值范围优选为[0.1,0.3],kN20取值范围优选为[0.1,0.3]。
框架与安装构型倾角的零运动避奇异操纵律xN3,优选为
Figure BDA0002472185750000104
其中,WN为零运动避奇异时安装倾角和框架角的力矩系数分配阵,WN=diag(Wg1,…,WgN,Wβ);QN=[C,E]为零运动避奇异时安装倾角和框架角的力矩分配阵;dN为安装倾角和框架角的零运动矢量。优选表示为:
Figure BDA0002472185750000105
其中,K2为矩阵At的奇异值分解的奇异度量。Kd2为安装倾角零运动系数,取值范围为[0.001,0.05]
通过步骤(6)的控制力矩陀螺操纵律,能够计算出各个控制力矩陀螺的框架角的指令角速度
Figure BDA0002472185750000106
转子指令加速度速
Figure BDA0002472185750000107
安装倾角指令速度
Figure BDA0002472185750000108
由(3)可知,通过上述共同作用,实现航天器指令力矩输出,提升航天器敏捷机动能力。
步骤(6)后优选包括步骤(7)进行操纵律分析验证:
设计步骤(6)中的优选参数,进一步优选为ε=0.1,Wg00=0.1,Wg01=0.05;Wg00=0.1,Wsi0=40;Wsi1=40;ag0=1;as0=1;bg0=0;bs0=0;cg0=1.8;cs0=0.5;Wβ0=0.01,Wβ1=0.02;aβ0=1;,bβ0=0;,cβ0=0.2;kN1=0.2;Kmin=0.3;KN20=0.2;Kd2=0.1;进行航天器操纵设计和验证。并将设计的控制力矩陀螺操纵引入航天器姿态闭环控制系统中,进行姿态控制效果对比。
图2给出了采用本发明设计的可变包络操纵律设计方法进行航天器三轴机动姿态敏捷机动仿真结果。图2中θbxbybz分别表示航天器的滚动角、俯仰角、偏航角。ωbxbybz分别表示航天器的滚动角速度、俯仰角速度、偏航角速度。通过数学仿真,验证了倾角可变的VSCMGs角动量包络与奇异性分析正确性。通过操纵安装倾角、低速框架、高速转子等多变量,实现航天器滚动、俯仰、偏航三轴最大机动角速度由2.56(°/s),2.13(°/s),2.83(°/s)提升到2.75(°/s),2.29(°/s),3.2(°/s),进一步提高航天器敏捷机动性能。图3给出了在航天器三轴姿态敏捷机动过程中倾角可变的控制力矩陀螺群奇异度K1的对比。在三轴机动过程中,控制力矩陀螺群能够保证奇异度K1远离奇异值(大于0).
图4给出了采用两个CMGs时(即N=2)安装倾角可变三轴机动姿态对比。单个控制力矩陀螺角动量为70Nms;航天器三轴惯量设计为[1000,800,800]kgm2.设置三轴机动姿态为[20,-10,20]°,最大角速度为3°/s,角加速为0.5°/s2。通过数学仿真,验证了倾角可变的CMGs可实现三轴机动,可实现航天器绕欧拉轴最大角速度3°/s的敏捷机动,且CMGs框架角速度小于1.5°/s,安装倾角最大角速度小于1.5°/s。采用较少CMGs个数依然能够实现航天器三轴敏捷机动。图4中θbxbybz分别表示航天器的滚动角、俯仰角、偏航角。ωbxbybz分别表示航天器的滚动角速度、俯仰角速度、偏航角速度。图5给出了两个控制力矩陀螺框架角速度,dδ1、dδ2为第一个、第二个控制力矩陀螺的框架角速度。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。

Claims (10)

1.一种航天器三超控制可变包络操纵律设计方法,其特征在于,包括如下步骤:
(1)将N个控制力矩陀螺群(CMGs)呈正N棱锥安装,其安装倾角为β;
(2)建立N个控制力矩陀螺群(CMGs)的合成角动量h的模型;
(3)根据步骤(2)N个控制力矩陀螺群(CMGs)的合成角动量h的模型,建立安装倾角可变的控制力矩陀螺群动力学模型;
(4)根据步骤(3)安装倾角可变的控制力矩陀螺群动力学模型,确定考虑安装倾角、框架转速、转子转速时的控制力矩陀螺群指令操纵律xT
(5)设计框架角与转子转速标称状态的零运动操纵律xN1、设计框架角与转子转速共同避奇异的零运动操纵律xN2、设计框架角与安装倾角共同避奇异的零运动操纵律xN3
(6)将设计框架角与转子转速标称状态的零运动操纵律xN1、设计框架角与转子转速共同避奇异的零运动操纵律xN2、设计框架角与安装倾角共同避奇异的零运动操纵律xN3,结合考虑安装倾角、框架转速、转子转速时的控制力矩陀螺群指令操纵律xT,得到N个控制力矩陀螺群(CMGs)的总的操纵律,以控制航天器的陀螺。
2.根据权利要求1所述的一种航天器三超控制可变包络操纵律设计方法,其特征在于:综合控制力矩陀螺布局以及冗余的约束条件,控制力矩陀螺布局的数目N取2、3、4、5或者6。
3.根据权利要求1所述的一种航天器三超控制可变包络操纵律设计方法,其特征在于:安装倾角β,是指正N楞锥的每个楞与正N楞锥底面的夹角。
4.根据权利要求1所述的一种航天器三超控制可变包络操纵律设计方法,其特征在于:N个控制力矩陀螺群呈正N楞锥安装在航天器上。
5.根据权利要求1所述的一种航天器三超控制可变包络操纵律设计方法,其特征在于:N大于等于2。
6.根据权利要求1所述的一种航天器三超控制可变包络操纵律设计方法,其特征在于:步骤(2)建立N个控制力矩陀螺群(CMGs)的合成角动量h的模型为:
Figure FDA0002472185740000021
其中,Hi表示第i个控制力矩陀螺角动量在航天器本体系下的三轴投影,cβ=cos(β),sβ=sin(β),cδi=cos(δi),sδi=sin(δi),i=1,2,…,N;δ=[δ1,δ2,…,δN]T为控制力矩陀螺群框架角矢量阵;δi为第i个控制力矩陀螺的框架角;h0为每个控制力矩陀螺的标称角动量;Ω=[Ω1,Ω2,…,ΩN]T为控制力矩陀螺群(CMGs)的转子转速矢量阵;Ωi为第i个控制力矩陀螺转子转速;Isw=[Isw1,Isw2,…,IswN]T为控制力矩陀螺转子惯量矢量阵;Iswi为第i个控制力矩陀螺转子惯量,其中角动量分配阵As
Figure FDA0002472185740000022
7.根据权利要求1所述的一种航天器三超控制可变包络操纵律设计方法,其特征在于:步骤(3)根据步骤(2)N个控制力矩陀螺群(CMGs)的合成角动量h的模型,建立安装倾角可变的控制力矩陀螺群动力学模型为
Figure FDA0002472185740000023
式中,C(δ,Ω)=AtIsw[Ω]d,[Ω]d=diag(Ω)为控制力矩陀螺群的转子转速对角阵,C(δ,Ω)简写为C;D(δ)=AsIsw
Figure FDA0002472185740000024
为控制力矩陀螺群的框架角速度矢量,D(δ)简写为D;
Figure FDA0002472185740000031
为控制力矩陀螺群的转子加速度矢量;矩阵At可表示为
Figure FDA0002472185740000032
控制力矩陀螺群安装倾角的分配阵E(β,δ)可表示为:
Figure FDA0002472185740000033
E(β,δ)简写为E。
8.根据权利要求1所述的一种航天器三超控制可变包络操纵律设计方法,其特征在于:(5)采用高斯函数对框架角力矩分配系数Wg0、转子权重分配系数Wsi、以及低速框架与安装倾角力矩分配系数Wβ进行设计。
9.根据权利要求1所述的一种航天器三超控制可变包络操纵律设计方法,其特征在于:N个控制力矩陀螺群(CMGs)为安装倾角可变的控制力矩陀螺群。
10.根据权利要求1所述的一种航天器三超控制可变包络操纵律设计方法,其特征在于:步骤(6)中N个控制力矩陀螺群(CMGs)的总的操纵律x为:
x=xT+xN1+xN2+xN3
CN202010351842.7A 2020-04-28 2020-04-28 一种航天器三超控制可变包络操纵律设计方法 Active CN111674570B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010351842.7A CN111674570B (zh) 2020-04-28 2020-04-28 一种航天器三超控制可变包络操纵律设计方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010351842.7A CN111674570B (zh) 2020-04-28 2020-04-28 一种航天器三超控制可变包络操纵律设计方法

Publications (2)

Publication Number Publication Date
CN111674570A true CN111674570A (zh) 2020-09-18
CN111674570B CN111674570B (zh) 2021-10-01

Family

ID=72452308

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010351842.7A Active CN111674570B (zh) 2020-04-28 2020-04-28 一种航天器三超控制可变包络操纵律设计方法

Country Status (1)

Country Link
CN (1) CN111674570B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113232894A (zh) * 2021-04-30 2021-08-10 北京控制工程研究所 一种多动量轮角动量最大包络计算在轨实现方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101353086A (zh) * 2008-09-12 2009-01-28 航天东方红卫星有限公司 一种操纵律奇异回避的航天器姿态控制系统
CN104238563A (zh) * 2014-09-04 2014-12-24 北京航空航天大学 可变面倾角的控制力矩陀螺群设计方法
US9038958B1 (en) * 2012-05-29 2015-05-26 United States Of America As Represented By The Secretary Of The Navy Method and apparatus for contingency guidance of a CMG-actuated spacecraft
CN110658838A (zh) * 2019-09-19 2020-01-07 北京控制工程研究所 一种敏捷航天器三轴机动角速度实时计算方法及系统

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101353086A (zh) * 2008-09-12 2009-01-28 航天东方红卫星有限公司 一种操纵律奇异回避的航天器姿态控制系统
US9038958B1 (en) * 2012-05-29 2015-05-26 United States Of America As Represented By The Secretary Of The Navy Method and apparatus for contingency guidance of a CMG-actuated spacecraft
CN104238563A (zh) * 2014-09-04 2014-12-24 北京航空航天大学 可变面倾角的控制力矩陀螺群设计方法
CN110658838A (zh) * 2019-09-19 2020-01-07 北京控制工程研究所 一种敏捷航天器三轴机动角速度实时计算方法及系统

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
张志方,董文强等: ""控制力矩陀螺在天宫一号目标飞行器姿态控制上的应用"", 《空间控制技术与应用》 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113232894A (zh) * 2021-04-30 2021-08-10 北京控制工程研究所 一种多动量轮角动量最大包络计算在轨实现方法

Also Published As

Publication number Publication date
CN111674570B (zh) 2021-10-01

Similar Documents

Publication Publication Date Title
CN109871025B (zh) 一种变速控制力矩陀螺操纵律设计方法
Tayebi et al. Attitude stabilization of a four-rotor aerial robot
US7661627B2 (en) Method of controlling the attitude of satellites, particularly agile satellites with a reduced number of gyrodynes
US5799901A (en) Rotor blade swashplate-axis rotation and gyroscopic moments compensator
CN110329550B (zh) 用于敏捷卫星应用的姿态控制
CN111605737B (zh) 一种航天器三超控制多级协同规划与敏捷机动方法
CN109782787B (zh) 一种太阳光压辅助下欠驱动航天器姿态的双模mpc控制方法
CN112394739A (zh) 主动变形四旋翼飞行器自抗扰飞行控制方法
CN112572835A (zh) 一种具有姿态切换的卫星在轨角动量管理及控制方法
CN114879739A (zh) 一种基于零空间的可倾转四旋翼无人机控制分配方法及系统
CN111674570B (zh) 一种航天器三超控制可变包络操纵律设计方法
Jang et al. Design of launch vehicle flight control systems using ascent vehicle stability analysis tool
Lungu et al. Adaptive Neural Network‐Based Satellite Attitude Control by Using the Dynamic Inversion Technique and a VSCMG Pyramidal Cluster
CN114384799A (zh) 一种助推与芯级发动机联合推力矢量控制方法
CN111605735B (zh) 一种航天器三超控制可变包络角动量分析方法
CN117227967B (zh) 用于控制飞行器的方法、装置、介质和飞行器
CN110658838B (zh) 一种敏捷航天器三轴机动角速度实时计算方法及系统
CN107908203A (zh) 一种空间柔性电帆自旋调速控制方法
CN111897219A (zh) 基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法
CN117022679A (zh) 一种卫星的姿态控制方法、装置及卫星
CN108681251B (zh) 六旋翼无人机电机倾角的确定方法
Thieuw et al. Pleiades-HR CMGs-based attitude control system design, development status and performances
Somov et al. Attitude & orbit digital and pulse-width control of large-scale communication spacecraft
CN115202213A (zh) 一种基于自抗扰控制的四旋翼飞行器控制方法
CN111338369B (zh) 一种基于非线性逆补偿的多旋翼飞行控制方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant