CN108333944B - 基于框架角自适应调整的cmg操纵方法及系统 - Google Patents
基于框架角自适应调整的cmg操纵方法及系统 Download PDFInfo
- Publication number
- CN108333944B CN108333944B CN201810164240.3A CN201810164240A CN108333944B CN 108333944 B CN108333944 B CN 108333944B CN 201810164240 A CN201810164240 A CN 201810164240A CN 108333944 B CN108333944 B CN 108333944B
- Authority
- CN
- China
- Prior art keywords
- cmg
- frame
- adjustment
- angle
- adaptive
- 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
- 238000000034 method Methods 0.000 title claims abstract description 29
- 238000011967 cystometrography Methods 0.000 claims abstract description 99
- 239000013598 vector Substances 0.000 claims abstract description 49
- 230000002194 synthesizing effect Effects 0.000 claims abstract description 8
- 230000003044 adaptive effect Effects 0.000 claims description 29
- 239000004576 sand Substances 0.000 claims description 3
- 230000006978 adaptation Effects 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 230000003321 amplification Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000001186 cumulative effect Effects 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000004146 energy storage Methods 0.000 description 1
- 238000003199 nucleic acid amplification method Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Traffic Control Systems (AREA)
- Mobile Radio Communication Systems (AREA)
Abstract
本发明公开了一种基于框架角自适应调整的CMG操纵方法及系统。其中,该方法包括如下步骤:(1)依次计算各CMG角动量方向单位矢量和飞行器期望控制力矩方向单位矢量的夹角,得到包含所有夹角的夹角向量Φ,若夹角向量Φ中的最小夹角小于阈值ε,则需要进行自适应调整并计算调整方向;(2)在自适应调整时间内,计算步骤(1)中最小夹角所对应的CMG框架的正弦运动转速及相应的力矩,再计算其他CMG的随动补偿转速;(3)将步骤(2)中的最小夹角所对应的CMG框架的正弦运动转速、其他CMG的随动补偿转速与CMG的其他操纵律合成,作为CMG控制指令输入。本发明解决了因CMG奇异问题导致卫星不能输出期望控制力矩、甚至影响飞行器性能指标实现的问题。
Description
技术领域
本发明属于飞行器自动控制技术领域,尤其涉及一种基于框架角自适应调整的CMG操纵方法及系统。
背景技术
随着飞行器任务变得越来越复杂,控制力矩陀螺(CMG)的应用也越来越广泛。CMG具有优异的力矩放大能力及能量存储能力,为了很好的使用CMG,需要保证其在运行的过程中稳定、可靠,而设计有效的操纵律至关重要。CMG的主要问题是奇异问题,由于奇异性的存在,不能保证其精确输出期望控制力矩,不能随动跟踪规划姿态轨迹,甚至影响飞行器快速机动、快速稳定等性能指标的实现,而奇异性的解决主要依靠操纵律的设计。
以往关于CMG奇异问题的主要解决方法为:对CMG群力矩矩阵的伪逆下功夫以寻求准确、可解的输出力矩,如添加零运动、添加物理约束、鲁棒伪逆、奇异值分解、混合操纵律等方法,但其中涉及的伪逆解往往难以平衡准确性与可解性,从而影响飞行器性能指标的实现。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提供一种基于框架角自适应调整的CMG操纵方法及系统,解决了因CMG奇异问题导致卫星不能输出期望控制力矩、甚至影响飞行器性能指标实现的问题。
本发明目的通过以下技术方案予以实现:根据本发明的一个方面,提供了一种基于框架角自适应调整的CMG操纵方法,所述方法包括如下步骤:(1)依次计算各CMG角动量方向单位矢量和飞行器期望控制力矩方向单位矢量的夹角,得到包含所有夹角的夹角向量Φ,若夹角向量Φ中的最小夹角小于阈值ε,则需要进行自适应调整并计算调整方向;(2)在自适应调整时间内,计算步骤(1)中最小夹角所对应的CMG框架的正弦运动转速及相应的力矩,再计算其他CMG的随动补偿转速;(3)将步骤(2)中的最小夹角所对应的CMG框架的正弦运动转速、其他CMG的随动补偿转速与CMG的其他操纵律合成,作为CMG控制指令输入。
上述基于框架角自适应调整的CMG操纵方法中,在步骤(1)中,若夹角向量Φ中的最小夹角对应第n个CMG框架,则调整方向为其中,为第n个CMG框架的角动量方向单位矢量,为第n个CMG框架的框架转轴单位矢量,sgn(·)为取1或-1两态的符号函数,dot(·)为点乘函数。
上述基于框架角自适应调整的CMG操纵方法中,在步骤(1)中,阈值ε为大于30°。
上述基于框架角自适应调整的CMG操纵方法中,在步骤(2)中,最小夹角所对应的CMG框架的正弦运动转速即第n个CMG框架的正弦运动转速为其中,dt为自适应调整时间,为正弦转速幅值,ts为正弦运动轨迹的半个周期时间。
上述基于框架角自适应调整的CMG操纵方法中,在步骤(2)中,若自适应调整时间dt大于正弦运动轨迹的半个周期时间ts,自适应调整结束。
根据本发明的另一方面,还提供了一种基于框架角自适应调整的CMG操纵系统,包括:第一模块,用于依次计算各CMG角动量方向单位矢量和飞行器期望控制力矩方向单位矢量的夹角,得到包含所有夹角的夹角向量Φ,若夹角向量Φ中的最小夹角小于阈值ε,则需要进行自适应调整并计算调整方向;第二模块,用于在自适应调整时间内,计算第一模块中最小夹角所对应的CMG框架的正弦运动转速及相应的力矩,再计算其他CMG的随动补偿转速;第三模块,用于将第二模块中的最小夹角所对应的CMG框架的正弦运动转速、其他CMG的随动补偿转速与CMG的其他操纵律合成,作为CMG控制指令输入。
上述基于框架角自适应调整的CMG操纵系统中,若夹角向量Φ中的最小夹角对应第n个CMG框架,则调整方向为其中,为第n个CMG框架的角动量方向单位矢量,为第n个CMG框架的框架转轴单位矢量,sgn(·)为取1或-1两态的符号函数,dot(·)为点乘函数。
上述基于框架角自适应调整的CMG操纵系统中,阈值ε为大于30°。
上述基于框架角自适应调整的CMG操纵系统中,若自适应调整时间dt大于正弦运动轨迹的半个周期时间ts,自适应调整结束。
本发明与现有技术相比具有如下有益效果:
(1)本发明通过阈值ε的设计值和操作方法主动提高CMG系统奇异度,远离奇异区域,而不需要进行奇异规避;
(2)本发明调整过程自适应,框架角自适应调整采用正弦运动规律并且由其他CMG随动补偿,不产生额外力矩,一方面减小对CMG框架运动的启、停性能需求,另一方面有利于飞行器稳定。
附图说明
通过阅读下文优选实施方式的详细描述,各种其他的优点和益处对于本领域普通技术人员将变得清楚明了。附图仅用于示出优选实施方式的目的,而并不认为是对本发明的限制。而且在整个附图中,用相同的参考符号表示相同的部件。在附图中:
图1是本发明实施例提供的基于框架角自适应调整的CMG操纵方法的流程图;
图2是本发明实施例提供的CMG正弦运动轨迹的转速和转角示意图。
具体实施方式
下面将参照附图更详细地描述本公开的示例性实施例。虽然附图中显示了本公开的示例性实施例,然而应当理解,可以以各种形式实现本公开而不应被这里阐述的实施例所限制。相反,提供这些实施例是为了能够更透彻地理解本公开,并且能够将本公开的范围完整的传达给本领域的技术人员。需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本发明。
方法实施例
图1是本发明实施例提供的基于框架角自适应调整的CMG操纵方法的流程图。如图1所示,该方法包括如下步骤:
(2)在自适应调整时间内,计算步骤(1)中最小夹角所对应的CMG框架的正弦运动转速及相应的力矩,再计算其他CMG的随动补偿转速;
(3)将步骤(2)中的最小夹角所对应的CMG框架的正弦运动转速、其他CMG的随动补偿转速与CMG的其他操纵律合成,作为CMG控制指令输入。
具体的,(1)如果未进行自适应调整,判断是否需要自适应调整
如果所有夹角Φ中第n个夹角最小且小于阈值εm(如30度),则计算调整方向并进入步骤(2)。其中分别为第n个CMG的角动量方向单位矢量、框架转轴单位矢量,sgn(·)为取1或-1两态的符号函数,dot(·)为点乘函数。
阈值ε的设计值使得CMG系统远离奇异区域,一般大于30度。
(2)进行自适应调整
若自适应调整时间dt大于正弦运动轨迹的半个周期时间ts(dt>ts),则自适应调整结束,否则(即在自适应调整时间ts内):计算步骤(1)得出的第n个CMG框架的正弦运动转速以及第n个CMG框架以转速运动产生的力矩Ttn,再计算其他CMG的随动补偿转速其中dt为进入步骤(2)的累计时间,为设计的正弦转速幅值,ts为设计的正弦运动轨迹的半个周期时间,为其他CMG构成的力矩矩阵。假设ts=3.0秒、kn=1的CMG正弦运动转速轨迹示意图见图2,可见大概3秒内CMG框架转动49度。
(3)计算CMG控制指令
装置实施例
本实施例还提供了一种基于框架角自适应调整的CMG操纵系统,该系统包括第一模块、第二模块和第三模块。其中,
第二模块,用于在自适应调整时间内,计算第一模块中最小夹角所对应的CMG框架的正弦运动转速及相应的力矩,再计算其他CMG的随动补偿转速;
第三模块,用于将第二模块中的最小夹角所对应的CMG框架的正弦运动转速、其他CMG的随动补偿转速与CMG的其他操纵律合成,作为CMG控制指令输入。
上述实施例中,若夹角向量Φ中的最小夹角对应第n个CMG框架,则调整方向为其中,为第n个CMG框架的角动量方向单位矢量,为第n个CMG框架的框架转轴单位矢量,sgn(·)为取1或-1两态的符号函数,dot(·)为点乘函数。
上述实施例中,阈值ε为大于30°。
本实施例通过阈值ε的设计值和操作方法主动提高CMG系统奇异度,远离奇异区域,而不需要进行奇异规避;本实施例调整过程自适应,框架角自适应调整采用正弦运动规律并且由其他CMG随动补偿,不产生额外力矩,一方面减小对CMG框架运动的启、停性能需求,另一方面有利于飞行器稳定。
以上所述的实施例只是本发明较优选的具体实施方式,本领域的技术人员在本发明技术方案范围内进行的通常变化和替换都应包含在本发明的保护范围内。
Claims (10)
3.根据权利要求1所述的基于框架角自适应调整的CMG操纵方法,其特征在于:在步骤(1)中,阈值ε为大于30°。
6.根据权利要求4所述的基于框架角自适应调整的CMG操纵方法,其特征在于:在步骤(2)中,若自适应调整时间dt大于正弦运动轨迹的半个周期时间ts,自适应调整结束。
9.根据权利要求7所述的基于框架角自适应调整的CMG操纵系统,其特征在于:阈值ε为大于30°。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810164240.3A CN108333944B (zh) | 2018-02-27 | 2018-02-27 | 基于框架角自适应调整的cmg操纵方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810164240.3A CN108333944B (zh) | 2018-02-27 | 2018-02-27 | 基于框架角自适应调整的cmg操纵方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108333944A CN108333944A (zh) | 2018-07-27 |
CN108333944B true CN108333944B (zh) | 2020-05-15 |
Family
ID=62929927
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810164240.3A Active CN108333944B (zh) | 2018-02-27 | 2018-02-27 | 基于框架角自适应调整的cmg操纵方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108333944B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110109357B (zh) * | 2019-05-15 | 2022-02-18 | 曲阜师范大学 | 针对非标准型非线性航空器的半全局自适应控制方法 |
CN110723316B (zh) * | 2019-09-16 | 2020-09-18 | 北京控制工程研究所 | 一种sgcmg的框架角速度确定方法 |
CN110597274B (zh) * | 2019-09-16 | 2020-11-10 | 北京控制工程研究所 | 一种适应姿态重定向的sgcmg动态框架角速度确定方法 |
CN110658837B (zh) * | 2019-09-19 | 2020-10-23 | 北京控制工程研究所 | 一种控制力矩陀螺故障情况下的平稳重构方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103592848A (zh) * | 2013-11-06 | 2014-02-19 | 北京控制工程研究所 | 一种变速控制力矩陀螺群的精准敏捷操纵方法 |
CN107707172A (zh) * | 2017-09-14 | 2018-02-16 | 北京控制工程研究所 | 一种cmg低速框架快速宽转矩范围、高精度驱动控制系统 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2766745B2 (ja) * | 1991-08-29 | 1998-06-18 | 三菱重工業株式会社 | コントロールモーメントジャイロ |
CN100565405C (zh) * | 2008-09-12 | 2009-12-02 | 航天东方红卫星有限公司 | 一种操纵律奇异回避的航天器姿态控制系统 |
US8352101B2 (en) * | 2009-12-22 | 2013-01-08 | The Boeing Company | Algorithm for simultaneous attitude maneuver and momentum dumping |
CN101763038B (zh) * | 2009-12-22 | 2012-06-06 | 北京航空航天大学 | 一种双框架磁悬浮控制力矩陀螺结构模态振动控制方法 |
CN101891018B (zh) * | 2010-07-09 | 2013-04-17 | 中国科学院长春光学精密机械与物理研究所 | 基于力矩输出能力最优的单框架控制力矩陀螺操纵方法 |
CN102880183B (zh) * | 2012-10-15 | 2015-04-22 | 北京控制工程研究所 | 一种用于偏航机动的控制力矩陀螺角动量管理方法 |
CN104090489B (zh) * | 2014-07-02 | 2016-12-07 | 中国科学院长春光学精密机械与物理研究所 | 一种挠性敏捷卫星姿态机动滚动优化控制方法 |
CN104777842B (zh) * | 2015-01-06 | 2020-04-10 | 中国人民解放军装备学院 | 一种基于磁悬浮控制敏感陀螺的卫星单轴测控一体化方法 |
CN105388902B (zh) * | 2015-11-30 | 2018-04-27 | 北京控制工程研究所 | 一种基于指令力矩矢量调节的控制力矩陀螺奇异规避方法 |
CN106933241B (zh) * | 2017-03-30 | 2019-11-29 | 北京航空航天大学 | 基于故障解耦的单框架控制力矩陀螺航天器容错控制方法 |
-
2018
- 2018-02-27 CN CN201810164240.3A patent/CN108333944B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103592848A (zh) * | 2013-11-06 | 2014-02-19 | 北京控制工程研究所 | 一种变速控制力矩陀螺群的精准敏捷操纵方法 |
CN107707172A (zh) * | 2017-09-14 | 2018-02-16 | 北京控制工程研究所 | 一种cmg低速框架快速宽转矩范围、高精度驱动控制系统 |
Non-Patent Citations (4)
Title |
---|
Adaptive neural network-based satellite attitude control in the presence of CMG uncertainty;W.MacKunis;《Aerospace Science and Technology》;20160426;第218-228页 * |
Fault detection and isolation for a small CMG-based satellite: A fuzzy Q-learning approach;Young-CheolChoi;《Aerospace Science and Technology》;20151016;第340-355页 * |
单框架控制力矩陀螺群的奇异几何分析;汤亮 等;《CHINESE JOURNAL OF AERONAUTICS》;20051130;第295-303页 * |
基于角动量管理的空间站惯量矩阵设计;马艳红 等;《载人航天》;20111125;第40-45页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108333944A (zh) | 2018-07-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108333944B (zh) | 基于框架角自适应调整的cmg操纵方法及系统 | |
CN106292287B (zh) | 一种基于自适应滑模控制的uuv路径跟踪方法 | |
Shao et al. | Robust dynamic surface trajectory tracking control for a quadrotor UAV via extended state observer | |
Chen et al. | Fuzzy adaptive nonsingular fixed-time attitude tracking control of quadrotor UAVs | |
CN106275508B (zh) | 一种卫星绕空间轴的最短路径姿态机动控制方法 | |
CN108181807B (zh) | 一种卫星初态阶段自适应容错姿态控制方法 | |
Sun et al. | Neural network-based sliding mode control for atmospheric-actuated spacecraft formation using switching strategy | |
CN104960674B (zh) | 一种运动目标的指向跟踪控制方法 | |
CN100363851C (zh) | 航天器大角度机动控制的单框架力矩陀螺群的最优控制法 | |
CN108594837A (zh) | 基于pd-smc和rise的无模型四旋翼无人机轨迹跟踪控制器及方法 | |
Kumar et al. | A novel single thruster control strategy for spacecraft attitude stabilization | |
CN108132601A (zh) | 一种利用机械臂抑制航天器基座姿态干扰的方法 | |
Li et al. | Extended state observer based output control for spacecraft rendezvous and docking with actuator saturation | |
CN111624878B (zh) | 自主式水面机器人轨迹跟踪的积分滑模获取方法及系统 | |
CN108227728A (zh) | 一种考虑混合执行机构切换的航天器姿态动态控制分配方法 | |
Shahna et al. | An anti-unwinding finite time fault tolerant sliding mode control of a satellite based on accurate estimation of inertia moments | |
Chen et al. | Two-stage exogenous Kalman filter for time-varying fault estimation of satellite attitude control system | |
Wang et al. | Robust trajectory tracking and control allocation of X-rudder AUV with actuator uncertainty | |
CN106406337B (zh) | 一种优化航天器姿态控制系统鲁棒性的方法及系统 | |
CN103941741A (zh) | 基于零运动的控制力矩陀螺框架角速度控制量的确定方法 | |
Yin et al. | Extended state observer-based attitude fault-tolerant control of rigid spacecraft | |
Yao et al. | Model predictive and adaptive neural sliding mode control for three-dimensional path following of autonomous underwater vehicle with input saturation | |
CN109445448B (zh) | 一种轮控小卫星自适应积分滑模姿态控制器 | |
Wu et al. | Multi-objective output-feedback control for microsatellite attitude control: An LMI approach | |
Zhou et al. | Energy-based trajectory tracking control of under-actuated unmanned surface vessels |
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 |