CN101694570B - 一种控制力矩陀螺群的高精度力矩输出控制方法 - Google Patents
一种控制力矩陀螺群的高精度力矩输出控制方法 Download PDFInfo
- Publication number
- CN101694570B CN101694570B CN2009100937916A CN200910093791A CN101694570B CN 101694570 B CN101694570 B CN 101694570B CN 2009100937916 A CN2009100937916 A CN 2009100937916A CN 200910093791 A CN200910093791 A CN 200910093791A CN 101694570 B CN101694570 B CN 101694570B
- Authority
- CN
- China
- Prior art keywords
- delta
- control
- moment gyro
- sin
- cos
- 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.)
- Active
Links
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种控制力矩陀螺群的高精度力矩输出控制方法,步骤:(1)首先建立控制力矩陀螺群的动力学模型;(2)构造奇异回避操纵律算法和确定控制力矩陀螺群接近奇异区域的距离阈值d 1和阈值d 2;(3)对控制力矩陀螺群的动力学模型进行奇异性判断,计算控制力矩陀螺群奇异度量值D,如果D>d 1则控制力矩陀螺群的操纵律直接用伪逆操纵律算法,如果d 2<D<d 1,则减小参数λ的调节幅度,如果0<D<d 2,则增大参数λ的调节幅度;(4)计算控制力矩陀螺群各个控制力矩陀螺的框架角速率值;(5)将所述的框架角速率积分计算得到框架角位置输入给步骤(1)进行循环计算,并根据框架角速率值驱动控制力矩陀螺群输出力矩给卫星。
Description
技术领域
本发明涉及一种敏捷卫星姿态控制执行机构控制力矩陀螺群的高精度力矩输出控制方法,通过该方法的设计弥补单框架控制力矩陀螺的奇异性缺陷,提高控制力矩陀螺群的力矩输出精度。
背景技术
敏捷卫星借助姿态的敏捷机动具有大幅宽和高分辨率成像的双重能力,已成为小卫星重要的发展方向之一。目前,卫星姿态控制系统的执行机构主要包括三大类:(1)推力器;(2)飞轮执行机构:包括反作用轮、(偏置)动量轮、框架动量轮和控制力矩陀螺;(3)环境力矩执行机构。控制力矩陀螺因其能够输出大力矩的优点成为空间站等大型卫星进行姿态控制的最佳选择。单框架控制力矩陀螺又因其力矩放大和动态性能良好的特点成为高敏捷小卫星姿态执行机构的最佳选择。
单框架控制力矩陀螺输出力矩的原理是通过以一定的角速度改变高速转子的角动量方向,从而达到力矩输出的目的。而单个的控制力矩陀螺只具有一个自由度的力矩输出能力,因此要进行卫星姿态的三轴稳定控制,需要至少三个以上的控制力矩陀螺。由多个控制力矩陀螺组成的控制力矩陀螺群具有两个问题:(1)控制力矩陀螺群的构型,不同的构型具有不同的力矩输出能力;(2)控制力矩陀螺群的奇异性问题,当操纵这群控制力矩陀螺输出力矩时,控制力矩陀螺群的力矩方程矩阵中的列矢量会出现相互平行的情况,这种状态会导致控制力矩陀螺群不能在与各列矢量的正交方向输出力矩,或者当力矩方程矩阵中的列矢量位于同一个平面内时,控制力矩陀螺群也不能在垂直于此平面的方向上输出力矩,以上情况下控制力矩陀螺群失去三维控制能力,陷入奇异状态。所以操纵律设计所面临的最主要的基本问题是解决控制力矩陀螺群的奇异问题。
控制力矩陀螺群操纵律奇异回避性能的设计决定着卫星姿态执行机构的力矩输出精度,直接影响卫星的姿态稳定精度。因此,控制力矩陀螺群操纵律的奇异性是影响控制力矩陀螺应用必须突破的关键技术。现有的控制力矩陀螺操纵律设计有三类方法:伪逆操纵律、零运动操纵律、鲁棒操纵律设计。伪逆操纵律是直接对控制力矩陀螺群的构型矩阵求逆,当矩阵的维数小于3时,矩阵的逆不存在,因此,该操纵律算法不能够回避控制力矩陀螺群的奇异性问题;零运动操纵律能够回避控制力矩陀螺群的部分奇点,不能够回避全部奇异区域;鲁棒操纵律设计其实是伪逆操纵律的变形,唯一不同的是在此算法中,加入了可变的参数矩阵项,用这种操纵律计算得到的框架角速率命令来操纵控制力矩陀螺群,最终产生的输出力矩相对期望力矩就会有一定的偏差。也就是说,这种算法是牺牲控制力矩陀螺群力矩的输出精度来换取奇异的回避。因此,目前这三类控制力矩陀螺的操纵律设计方法均不能够满足对高敏捷卫星姿态控制的高精度要求。
中国专利:200810222230.7,名称“一种操纵律奇异回避的航天器姿态控制系统”中涉及控制力矩陀螺群的力矩输出控制方面的内容,主要是采用零运动算法、查表法和操纵律伪逆算法的切换解决航天器姿态控制系统中控制力矩陀螺群的奇异问题,该设计方法虽然在一定程度上避免了控制力矩陀螺群的奇异问题,但是零运动算法仅仅能够回避部分奇异点,另外零运动算法不能够回避的奇异区域需要经过计算用查表的方法解决,这种设计方法导致操纵律算法频繁切换,计算出的框架角速度跳跃性大,给力矩的高精度输出引入了误差,并且计算量大。
发明内容
本发明的技术解决问题是:针对控制力矩陀螺群的奇异性问题,提供了一种控制力矩陀螺群的高精度力矩输出控制方法。
本发明的技术解决方案是:一种控制力矩陀螺群的高精度力矩输出控制方法,包括下列步骤:
(1)首先根据控制力矩陀螺群的构型、框架角位置建立控制力矩陀螺群的动力学模型,所述的动力学模型采用整个控制力矩陀螺群的角动量表示;
(2)根据控制力矩陀螺群的动力学模型、卫星姿态机动的角速度、卫星控制系统所需的力矩输出构造奇异回避操纵律算法和确定控制力矩陀螺群接近奇异区域的距离阈值d1和阈值d2,其中,阈值d1>阈值d2;所述的奇异回避操纵律算法为:
为控制力矩陀螺群角动量的导数;
λ为奇异回避算法调节参数;
(3)对控制力矩陀螺群的动力学模型进行奇异性判断,计算控制力矩陀螺群奇异度量值D,如果D>d1则控制力矩陀螺群的操纵律直接用伪逆操纵律算法,如果d2<D<d1,则减小奇异回避操纵律算法中的参数λ的调节幅度,如果0<D<d2,则增大奇异回避操纵律算法中的参数λ的调节幅度;
(4)根据步骤(3)中确定的操纵律,计算控制力矩陀螺群各个控制力矩陀螺的框架角速率值;
(5)将所述的框架角速率积分计算得到框架角位置输入给步骤(1)进行循环计算,并根据框架角速率值驱动控制力矩陀螺群输出力矩给卫星。
所述的控制力矩陀螺群动力学模型的建立由控制力矩陀螺群的构型和框架角位置确定,首先由控制力矩陀螺群的构型确定每个控制力矩陀螺的安装位置和安装角度,计算出控制力矩陀螺群的角动量矩阵:
然后,由控制力矩陀螺群的角动量矩阵计算出整个控制力矩陀螺群的角动量: 其中,h0为每个控制力矩陀螺的标称角动量值,参数β值为控制力矩陀螺框架轴与卫星本体系Z轴的夹角;δi为控制力矩陀螺的框架角位置,n控制力矩陀螺群中控制力矩陀螺的个数。
所述步骤(2)中的阈值d1和阈值d2满足:
0<d2<d1<1,d1/d2范围[1.5-3.5],具体根据控制力矩陀螺群的期望力矩的幅值和频率确定,选取d1取值范围[0.3-0.8]。
本发明的原理是:一种控制力矩陀螺群的高精度力矩输出控制方法,其特征在于:根据控制力矩陀螺群构型计算出控制力矩陀螺群的动力学模型,通过控制力矩陀螺群的动力学特性设计控制力矩陀螺群的操纵律,确定奇异回避操纵律算法的矩阵构型和操纵律算法参数的阈值。然后判定控制力矩陀螺群的奇异性,如果远离奇异区域,选择伪逆操纵律算法;如果接近奇异区域,选择奇异回避操纵律算法,根据接近奇异区域距离的远近,调节奇异回避操纵律算法的参数值。该操纵律算法是将最优理论引入鲁棒操纵律算法中,增加一个非线性的调节矩阵避免伪逆运算无法求解的问题,这个非线性的调节矩阵由一正交阵和指数函数的标量相乘组成,通过调节指数函数的初始值和中心值来调节奇异回避操纵律的性能,正交阵中对角线上的元素用常值1,其他元素设计成正弦函数,通过调节正弦函数的幅值、频率和相位达到精细调节操纵律性能的问题。频率的相位参数的调节根据控制力矩陀螺群的角动量包络实时优化设计,以提高控制力矩陀螺群力矩的输出精度。
本发明与现有技术相比的优点在于:
(1)本发明将非线性的微小调节量λE引入到奇异回避操纵律算法,非线性的调节参数改进了原线性给定参数在调节时的大幅度跳跃问题,对每个控制力矩陀螺期望角速度值的调节是慢时变的,调节更加精细,能够更加有效的达到回避奇异的目的;
(2)本发明所述的奇异回避操纵律算法是将最优理论引入鲁棒操纵律算法中,避免仅根据期望控制力矩和当前框架角状态来计算框架转动角速率指令,而没有考虑当前决策对未来框架角状态的影响问题,同时也避免了全局操纵律直接寻优法在考虑系统长期行为状态下计算量很大,在星上很难实现的问题;
(3)本发明距离阈值d1和阈值d2的确定,对操纵律算法的参数实行分段调节,且该调节速度与卫星姿态机动角速度值相关联,当卫星姿态控制系统需要高频率变化的大力矩输出,并且控制力矩陀螺群距离奇异区域较近时,则采用小于阈值d2的快速操纵律奇异回避算法,这种情况下控制力矩陀螺群能够快速越过奇异区域,反之,当要求小幅值慢时变的力矩输出,且控制力矩陀螺群距离奇异区域较远时,则采用大于阈值d2的慢变操纵律奇异回避算法。本发明所述的采用阈值d1和阈值d2分段的调节方法,可以大大提高控制力矩陀螺群的力矩输出精度,尤其是在控制力矩陀螺群即将进入奇异区域的时段内,大大降低了由于奇异回避算法的引入给力矩输出精度带来的损失。
总之,本发明的控制力矩陀螺群的高精度力矩输出控制方法,对奇异回避操纵律算法的参数进行了精细优化,对控制力矩陀螺群的奇异区域进行了有效的回避,大大提高了控制力矩陀螺群的力矩输出精度。
附图说明
图1为本发明控制力矩陀螺群操纵律流程图;
图2为本发明控制力矩陀螺群奇异回避操纵律算法流程图。
具体实施方式
如图1和图2所示,一种控制力矩陀螺群的高精度力矩输出控制方法,步骤如下:
(1)首先针对控制力矩陀螺群的构型建立控制力矩陀螺群的动力学模型,框架角位置计算出整个控制力矩陀螺群的角动量;
控制力矩陀螺群的角动量: 其中, 为控制力矩陀螺群角动量矩阵,h0为每个控制力矩陀螺的标称角动量值,参数β值为控制力矩陀螺框架轴与卫星本体系Z轴的夹角,参数β值根据卫星姿控所需的三轴力矩输出要求所确定,例如,金字塔构型的四个控制力矩陀螺组成的控制力矩陀螺群,卫星俯仰轴和滚动轴需要大角度姿态机动,要求大力矩输出,因此设定β值在30°左右,其它的构型可以依据需求进行β值的选取设计。
(2)首先利用控制力矩陀螺群的动力学模型确定奇异回避操纵律算法的矩阵结构,矩阵为正交阵,对角线上的元素用常值1,其他元素设计成正弦函数,矩阵结构为E矩阵的结构形式: 根据控制力矩陀螺群的动力学模型、卫星姿态机动的角速度ω、卫星控制系统所需的力矩输出u,构造奇异回避操纵律算法的矩阵结构和确定控制力矩陀螺群接近奇异区域的距离阈值d1和阈值d2(其中,阈值d1>阈值d2);
距离阈值d1和阈值d2的确定方法为:1)首先,阈值d1和阈值d2满足:0<d2<d1<1,d1/d2≈3,具体根据控制力矩陀螺群的期望力矩的幅值和频率确定,一般选取d1≈0.5。
(3)将卫星姿态机动的角速度ω和姿态控制器力矩控制信号u作为输入,计算陀螺群角动量的导数
(4)对控制力矩陀螺群的动力学模型进行奇异性判断,计算控制力矩陀螺群奇异性的度量值D=det(CCT),其中
上述cβ=cosβ sβ=sinβ,C为控制力矩陀螺群角动量矩阵M的雅克比矩阵。
(5)如果D>d1则操纵律算法直接用伪逆操纵律算法: 如果d2<D<d1,则操纵律算法减小奇异回避操纵律算法中的参数调节幅度,采用式 计算,其中 如果0<D<d2,则操纵律算法增大奇异回避操纵律算法中的参数调节幅度,采用式 计算,其中 μ为奇异操纵律算法的非线性调节参数,式 和式 中的 其中为所对应的控制力矩陀螺的相位角偏差,ωc为控制力矩陀螺群操纵律奇异回避算法的调节频率;由上述阈值判断和计算得到控制力矩陀螺群各个控制力矩陀螺的框架角速率值
(6)将所述的框架角速率积分计算得到框架角位置输入给步骤(1)进行循环计算,并根据框架角速率值驱动控制力矩陀螺群输出力矩给卫星。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。
Claims (2)
1.一种控制力矩陀螺群的高精度力矩输出控制方法,其特征在于包括下列步骤:
(1)首先根据控制力矩陀螺群的构型、框架角位置建立控制力矩陀螺群的动力学模型,所述的动力学模型采用整个控制力矩陀螺群的角动量表示;
(2)根据控制力矩陀螺群的动力学模型、卫星姿态机动的角速度、卫星控制系统所需的力矩输出构造奇异回避操纵律算法和确定控制力矩陀螺群接近奇异区域的距离阈值d1和阈值d2,其中,阈值d1>阈值d2,所述的阈值d1和阈值d2满足:
0<d2<d1<1,d1/d2范围[1.5-3.5],具体根据控制力矩陀螺群的期望力矩的幅值和频率确定,选取d1取值范围[0.3-0.8];
所述的奇异回避操纵律算法为:
λ为奇异回避算法调节参数;
(3)对控制力矩陀螺群的动力学模型进行奇异性判断,计算控制力矩陀螺群奇异度量值D,如果D>d1则控制力矩陀螺群的操纵律直接用伪逆操纵律算法,如果d2<D<d1,则减小奇异回避操纵律算法中的参数λ的调节幅度,如果0<D<d2,则增大奇异回避操纵律算法中的参数λ的调节幅度;
(4)根据步骤(3)中确定的操纵律,计算控制力矩陀螺群各个控制力矩陀螺的框架角速率值;
(5)将所述的框架角速率积分计算得到框架角位置输入给步骤(1)进行循环计算,并根据框架角速率值驱动控制力矩陀螺群输出力矩给卫星。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2009100937916A CN101694570B (zh) | 2009-10-19 | 2009-10-19 | 一种控制力矩陀螺群的高精度力矩输出控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2009100937916A CN101694570B (zh) | 2009-10-19 | 2009-10-19 | 一种控制力矩陀螺群的高精度力矩输出控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101694570A CN101694570A (zh) | 2010-04-14 |
CN101694570B true CN101694570B (zh) | 2011-06-15 |
Family
ID=42093544
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2009100937916A Active CN101694570B (zh) | 2009-10-19 | 2009-10-19 | 一种控制力矩陀螺群的高精度力矩输出控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101694570B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101891018B (zh) * | 2010-07-09 | 2013-04-17 | 中国科学院长春光学精密机械与物理研究所 | 基于力矩输出能力最优的单框架控制力矩陀螺操纵方法 |
CN102566578B (zh) * | 2012-01-12 | 2013-06-19 | 北京航空航天大学 | 基于奇异值分解的单框架控制力矩陀螺群协调控制方法 |
CN103592848B (zh) * | 2013-11-06 | 2017-01-11 | 北京控制工程研究所 | 一种变速控制力矩陀螺群的精准敏捷操纵方法 |
CN103869704B (zh) * | 2014-04-08 | 2016-05-25 | 哈尔滨工业大学 | 基于扩展雅克比矩阵的空间机器人星臂协调控制方法 |
CN105223961B (zh) * | 2015-10-16 | 2018-04-13 | 北京机械设备研究所 | 一种用于控制力矩陀螺奇异规避的航天器姿态控制方法 |
CN105388902B (zh) * | 2015-11-30 | 2018-04-27 | 北京控制工程研究所 | 一种基于指令力矩矢量调节的控制力矩陀螺奇异规避方法 |
CN106896821B (zh) * | 2017-03-10 | 2019-10-11 | 北京航空航天大学 | 一种变速控制力矩陀螺的角动量管理方法 |
CN110466806B (zh) * | 2019-07-24 | 2020-09-18 | 北京控制工程研究所 | 一种使用cmg控制卫星姿态的方法 |
CN110597062B (zh) * | 2019-09-19 | 2020-11-10 | 北京控制工程研究所 | 一种控制力矩陀螺时延特性建模与补偿控制方法 |
CN110990943B (zh) * | 2019-11-13 | 2023-10-20 | 上海航天控制技术研究所 | 一种基于控制力矩陀螺群奇异几何意义的奇异点判定方法 |
CN111605735B (zh) * | 2020-04-28 | 2022-03-04 | 北京控制工程研究所 | 一种航天器三超控制可变包络角动量分析方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1605962A (zh) * | 2004-11-26 | 2005-04-13 | 清华大学 | 航天器大角度机动控制的单框架力矩陀螺群的最优控制法 |
CN101353086A (zh) * | 2008-09-12 | 2009-01-28 | 航天东方红卫星有限公司 | 一种操纵律奇异回避的航天器姿态控制系统 |
-
2009
- 2009-10-19 CN CN2009100937916A patent/CN101694570B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1605962A (zh) * | 2004-11-26 | 2005-04-13 | 清华大学 | 航天器大角度机动控制的单框架力矩陀螺群的最优控制法 |
CN101353086A (zh) * | 2008-09-12 | 2009-01-28 | 航天东方红卫星有限公司 | 一种操纵律奇异回避的航天器姿态控制系统 |
Non-Patent Citations (2)
Title |
---|
于灵慧,房建成.控制力矩陀螺高速转子稳定性控制仿真研究.《系统仿真学报》.2007,第19卷(第9期),2045-2048. * |
汤亮,陈义庆.单框架控制力矩陀螺奇异问题研究.《航空学报》.2007,第28卷(第5期),1182-1189. * |
Also Published As
Publication number | Publication date |
---|---|
CN101694570A (zh) | 2010-04-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101694570B (zh) | 一种控制力矩陀螺群的高精度力矩输出控制方法 | |
CN100565405C (zh) | 一种操纵律奇异回避的航天器姿态控制系统 | |
CN103592848B (zh) | 一种变速控制力矩陀螺群的精准敏捷操纵方法 | |
CN101891018B (zh) | 基于力矩输出能力最优的单框架控制力矩陀螺操纵方法 | |
CN102627151B (zh) | 一种基于混合执行机构的快速机动卫星的力矩分配方法 | |
CN103092208B (zh) | 基于sgcmg和rw的航天器高精度快速姿态机动方法 | |
CN102343985B (zh) | 带反作用飞轮的卫星时间最优姿态机动方法 | |
CN102566578B (zh) | 基于奇异值分解的单框架控制力矩陀螺群协调控制方法 | |
Jia et al. | Robust trajectory tracking control of a dual-arm space robot actuated by control moment gyroscopes | |
CN103869704B (zh) | 基于扩展雅克比矩阵的空间机器人星臂协调控制方法 | |
CN104527994A (zh) | 异面交叉快变轨道固定时间稳定姿态指向跟踪控制方法 | |
CN106896821A (zh) | 一种变速控制力矩陀螺的角动量管理方法 | |
CN102736631B (zh) | 一种基于角加速度传感器的多操纵面无人机闭环控制分配方法 | |
CN104090489A (zh) | 一种挠性敏捷卫星姿态机动滚动优化控制方法 | |
CN101794154A (zh) | 一种编队卫星相对轨道与姿态解耦控制方法 | |
Cao et al. | Time efficient spacecraft maneuver using constrained torque distribution | |
CN104881035A (zh) | 飞行器操纵耦合补偿方法、姿态运动控制方法及系统 | |
CN104504294A (zh) | 飞行仿真初始状态混合遗传配平方法 | |
CN104062976A (zh) | 一种基于角加速度导数为正弦曲线的飞行器姿态快速机动方法 | |
CN102749846B (zh) | 一种两平行构型VSDGCMGs奇异回避操纵律设计方法 | |
CN109782787A (zh) | 一种太阳光压辅助下欠驱动航天器姿态的双模mpc控制方法 | |
CN103235515B (zh) | 一种利用零运动避免单框架控制力矩陀螺群框架轴转速死区的方法 | |
CN103034237A (zh) | 使用两个单框架控制力矩陀螺的航天器姿态机动控制方法 | |
Wu et al. | Hybrid actuator optimal angular momentum management with analytical solution for spacecraft attitude agile maneuvering mission | |
EP4032816A1 (en) | Manipulation method suitable for non-redundant sgcmg group |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |