CN105223961B - 一种用于控制力矩陀螺奇异规避的航天器姿态控制方法 - Google Patents
一种用于控制力矩陀螺奇异规避的航天器姿态控制方法 Download PDFInfo
- Publication number
- CN105223961B CN105223961B CN201510666229.3A CN201510666229A CN105223961B CN 105223961 B CN105223961 B CN 105223961B CN 201510666229 A CN201510666229 A CN 201510666229A CN 105223961 B CN105223961 B CN 105223961B
- Authority
- CN
- China
- Prior art keywords
- sgcmg
- spacecraft
- groups
- control
- matrix
- 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
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种用于控制力矩陀螺奇异规避的航天器姿态控制方法,其具体步骤为:第一步,SGCMG群角动量集合的求取;第二步,SGCMG群与航天器整体系统角动量幅值判定;第三步,确定航天器姿控系统最优控制性能指标;第四步,确定SGCMG群与航天器整体系统线性化模型;第五步,确定SGCMG群与航天器所组成整体系统的线性化范围;第六步,确定满足约束条件的线性化范围;第七步,利用非线性预测控制实现航天器姿态控制。本发明完成对航天器姿态的精确控制,达到了降低航天器发射成本、提高航天器在轨运行寿命的目的。
Description
技术领域
本发明涉及一种航天器姿态控制方法,特别是一种用于控制力矩陀螺奇异规避的航天器姿态控制方法。
背景技术
单框架控制力矩陀螺(single gimbal control moment gyro,SGCMG)群作为航天器姿态控制系统的执行机构,具有力矩放大倍数大,物理结构简单,使用寿命长等优点,在航天器姿态控制领域应用广泛。但SGCMG群在应用过程中存在着难以解决的几何奇异问题。目前,国内外通常将航天器姿态控制与SGCMG群的控制分开考虑,其中航天器姿态控制部分仅将航天器角速度及航天器姿态作为系统状态的反馈变量,使得设计的反馈控制器实现了系统状态稳定;SGCMG群作为单一个体通过操纵律进行奇异规避,并响应航天器姿态控制器所需的控制力矩。该控制方式虽然简单,但其规避奇异能力有限,对于采用操纵律无法规避的奇异点,仅能采用喷气执行机构改变系统角动量,从而避免该奇异点对系统稳定性的影响。这不仅增加了航天器发射成本,还大幅度降低了航天器的在轨寿命。
发明内容
本发明的目的在于提供一种用于控制力矩陀螺奇异规避的航天器姿态控制方法,解决以往控制方法中SGCMG群存在的奇异问题。
一种用于控制力矩陀螺奇异规避的航天器姿态控制方法,其具体步骤为:
第一步确定SGCMG群角动量集合
依据SGCMG群的奇异角动量绘制SGCMG群冗余构型奇异动量面。SGCMG群奇异角动量表达式为:
(1)
其中为SGCMG个数,为第个SGCMG的角动量,为SGCMG群奇异方向单位矢量,为第个SGCMG框架轴方向单位矢量。依据所绘制的奇异动量面得到SGCMG群角动量集合包含最大的以原点为球心的球域半径为:
(2)
其中为SGCMG群框架角,表示由坐标原点指向动量包络面的方向矢量。表示SGCMG群动量包络面上的最小角动量,即求取各个方向矢量上的最大角动量,然后在所求得的各个方向上的最大角动量中求得最小值。
第二步判定SGCMG群与航天器组成的整体系统角动量幅值
当SGCMG群与航天器组成的整体系统初始角动量幅值满足时,确定航天器姿控系统最优控制性能指标。
第三步确定航天器姿控系统最优控制性能指标
由传感器实时采集航天器姿态四元数、角速度、SGCMG群框架角及框架角速度作为状态变量,反馈给航天器姿控系统,确定航天器姿控系统初始时刻、控制时域、预测时域及正定矩阵,正定矩阵及正定矩阵,建立SGCMG群与航天器所组成整体系统的最优控制性能指标:
(3)
其中,,输入,为系统平衡点。,,,其中为维单位矩阵,为维单位矩阵,为维单位矩阵。
第四步确定SGCMG群与航天器整体系统线性化模型
SGCMG群与航天器所组成整体系统在平衡点邻域的线性化模型为:
(4)
其中为航天器指令姿态四元数对应的欧拉角,为SGCMG群的框架角平衡点,,为维单位矩阵,为航天器转动惯量,表示三维向量对应的反对称矩阵,为SGCMG角动量,为飞轮角动量幅值,为SGCMG群的安装矩阵,为系统外干扰力矩。
第五步 确定SGCMG群与航天器所组成整体系统的线性化范围
依据SGCMG群与航天器所组成整体系统的线性化模型确定状态反馈控制器,依据最大幅值、控制输入约束确定系统线性化范围。状态变量系数矩阵为,干扰力矩系数矩阵为,控制输入系数矩阵为,依据不等式约束公式(5)~公式(7),得到的下确界及正定矩阵:
(5)
(6)
(7)
其中为个临近系统平衡点的已知状态点,为待求正定矩阵,,为的第行。
(8)
其中为的第行。
第六步 确定满足约束条件的线性化范围
满足系统状态约束及控制输入约束的线性化范围:
(9)
其中,。
,,为的第行第列元素,为系统状态约束最大幅值。
第七步 利用非线性预测控制实现航天器姿态控制
在航天器机动准备阶段,采用序列二次规划离线确定性能指标对应的最优控制输入,并将最优控制输入作为下次序列二次规划实时迭代的初值,采用非线性预测控制进行循环运算,并实时判定系统当前状态变量是否满足,满足时将系统控制器切换为线性控制器,直至系统状态被控制到平衡点。
本发明通过SGCMG群与航天器的整体系统控制,将SGCMG群构型奇异问题转化为带有系统状态约束及输入约束的控制问题,并采用非线性预测控制解决上述控制问题。本发明可保证SGCMG群精确的力矩输出,在航天器存在干扰力矩及模型不确定性的前提下,解决任意数量、任意构型SGCMG群奇异问题,并完成对航天器姿态的精确控制,达到了降低航天器发射成本、提高航天器在轨运行寿命的目的。
具体实施方式
刚体航天器转动惯量,航天器初始四元数,指令四元数,初始角速度,指令角速度,,外部干扰力矩沿最大幅值为。SGCMG群采用金字塔构型,为SGCMG框架安装角,飞轮角动量,初始与终端框架角速度,最大框架角速度,最大框架角加速度。
一种用于控制力矩陀螺奇异规避的航天器姿态控制方法,其具体步骤为:
第一步确定SGCMG群角动量集合
依据SGCMG群的奇异角动量绘制SGCMG群冗余构型奇异动量面。SGCMG群奇异角动量表达式为:
(1)
其中为SGCMG个数,需遍历正负两种情况,,为SGCMG群奇异方向单位矢量,,,,为SGCMG框架轴方向单位矢量。依据所绘制的奇异动量面得到SGCMG群角动量集合包含最大的以原点为球心的球域半径。
第二步判定SGCMG群与航天器组成的整体系统角动量幅值
SGCMG群与航天器组成的整体系统初始角动量幅值满足,确定航天器姿控系统最优控制性能指标。
第三步确定航天器姿控系统最优控制性能指标
由传感器实时采集航天器姿态四元数、角速度、SGCMG群框架角及框架角速度作为状态变量,反馈给航天器姿控系统,确定航天器姿控系统初始时刻、控制时域、预测时域及正定矩阵,正定矩阵及正定矩阵,建立SGCMG群与航天器所组成整体系统的最优控制性能指标:
(3)
其中,,,输入,为系统平衡点。,,,其中为10维单位矩阵,为14维单位矩阵,为4维单位矩阵。
第四步 确定SGCMG群与航天器整体系统线性化模型
SGCMG群与航天器所组成整体系统在平衡点邻域的线性化模型为:
(4)
其中为航天器指令姿态四元数对应的欧拉角,
为SGCMG群的框架角平衡点,,为4维单位矩阵,为航天器转动惯量,表示三维向量对应的反对称矩阵,为SGCMG角动量,为飞轮角动量幅值,为SGCMG群的安装矩阵,为系统外干扰力矩。
第五步 确定SGCMG群与航天器所组成整体系统的线性化范围
依据SGCMG群与航天器所组成整体系统的线性化模型确定状态反馈控制器为:
(5)
估计得出的临近终端平衡点的一组状态变量值与两个点作为椭圆域内的已知点,其中为:
最大幅值,控制输入约束,,依据不等式约束公式,得到的下确界及正定矩阵:
(6)
第六步 确定满足约束条件的线性化范围
满足系统状态约束及控制输入约束的线性化范围:
(7)
其中
第七步 利用非线性预测控制实现航天器姿态控制
在航天器机动准备阶段,采用序列二次规划离线确定性能指标对应的最优控制输入,并将最优控制输入作为下次序列二次规划实时迭代的初值,采用非线性预测控制进行循环运算,系统状态变量在31s时满足,满足时将系统控制器切换为线性控制器,80s后系统状态被控制到平衡点。
Claims (1)
1.一种用于控制力矩陀螺奇异规避的航天器姿态控制方法,其特征在于具体步骤为:
第一步确定SGCMG群角动量集合
依据SGCMG群的奇异角动量绘制SGCMG群冗余构型奇异动量面;SGCMG群奇异角动量表达式为:
(1)
其中为SGCMG个数,为第个SGCMG的角动量,为SGCMG群奇异方向单位矢量,为第个SGCMG框架轴方向单位矢量;依据所绘制的奇异动量面得到SGCMG群角动量集合包含最大的以原点为球心的球域半径为:
(2)
其中为SGCMG群框架角,表示由坐标原点指向动量包络面的方向矢量;表示SGCMG群动量包络面上的最小角动量,即求取各个方向矢量上的最大角动量,然后在所求得的各个方向上的最大角动量中求得最小值;
第二步判定SGCMG群与航天器组成的整体系统角动量幅值
当SGCMG群与航天器组成的整体系统初始角动量幅值满足时,确定航天器姿控系统最优控制性能指标;
第三步确定航天器姿控系统最优控制性能指标
由传感器实时采集航天器姿态四元数、角速度、SGCMG群框架角及框架角速度作为状态变量,反馈给航天器姿控系统,确定航天器姿控系统初始时刻、控制时域、预测时域及正定矩阵,正定矩阵及正定矩阵,建立SGCMG群与航天器所组成整体系统的最优控制性能指标:
(3)
其中,,输入,为系统平衡点;,,,其中为维单位矩阵,为维单位矩阵,为维单位矩阵;
第四步确定SGCMG群与航天器整体系统线性化模型
SGCMG群与航天器所组成整体系统在平衡点邻域的线性化模型为:
(4)
其中为航天器指令姿态四元数对应的欧拉角,为SGCMG群的框架角平衡点,,为维单位矩阵,为航天器转动惯量,表示三维向量对应的反对称矩阵,为SGCMG角动量,为飞轮角动量幅值,为SGCMG群的安装矩阵,为系统外干扰力矩;
第五步 确定SGCMG群与航天器所组成整体系统的线性化范围
依据SGCMG群与航天器所组成整体系统的线性化模型确定状态反馈控制器,依据最大幅值、控制输入约束确定系统线性化范围;状态变量系数矩阵为,干扰力矩系数矩阵为,控制输入系数矩阵为,依据不等式约束公式(5)~公式(7),得到的下确界及正定矩阵:
(5)
(6)
(7)
其中为个临近系统平衡点的已知状态点,为待求正定矩阵,,为的第行;
(8)
其中为的第行;
第六步 确定满足约束条件的线性化范围
满足系统状态约束及控制输入约束的线性化范围:
(9)
其中,;
,,为的第行第列元素,为系统状态约束最大幅值;
第七步 利用非线性预测控制实现航天器姿态控制
在航天器机动准备阶段,采用序列二次规划离线确定性能指标对应的最优控制输入,并将最优控制输入作为下次序列二次规划实时迭代的初值,采用非线性预测控制进行循环运算,并实时判定系统当前状态变量是否满足,满足时将系统控制器切换为线性控制器,直至系统状态被控制到平衡点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510666229.3A CN105223961B (zh) | 2015-10-16 | 2015-10-16 | 一种用于控制力矩陀螺奇异规避的航天器姿态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510666229.3A CN105223961B (zh) | 2015-10-16 | 2015-10-16 | 一种用于控制力矩陀螺奇异规避的航天器姿态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105223961A CN105223961A (zh) | 2016-01-06 |
CN105223961B true CN105223961B (zh) | 2018-04-13 |
Family
ID=54992991
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510666229.3A Active CN105223961B (zh) | 2015-10-16 | 2015-10-16 | 一种用于控制力矩陀螺奇异规避的航天器姿态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105223961B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106125752B (zh) * | 2016-07-27 | 2019-08-30 | 北京机械设备研究所 | 一种应用飞轮群的欠驱动航天器姿态控制方法 |
CN109164817B (zh) * | 2018-07-27 | 2021-09-14 | 西北工业大学 | 一种基于模型预测控制的太阳帆姿态轨道耦合控制方法 |
CN110712768B (zh) * | 2019-10-31 | 2021-03-16 | 上海航天控制技术研究所 | 一种控制力矩陀螺群初始框架位置确定方法 |
CN110990943B (zh) * | 2019-11-13 | 2023-10-20 | 上海航天控制技术研究所 | 一种基于控制力矩陀螺群奇异几何意义的奇异点判定方法 |
CN111169666B (zh) * | 2020-01-19 | 2020-10-23 | 北京空间飞行器总体设计部 | 一种可恢复状态域的受限系统可重构性包络确定方法 |
CN111605735B (zh) * | 2020-04-28 | 2022-03-04 | 北京控制工程研究所 | 一种航天器三超控制可变包络角动量分析方法 |
CN112099519B (zh) * | 2020-09-23 | 2021-09-03 | 北京理工大学 | 航天器控制力矩陀螺的快速奇异躲避规划方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100363851C (zh) * | 2004-11-26 | 2008-01-23 | 清华大学 | 航天器大角度机动控制的单框架力矩陀螺群的最优控制法 |
CN101842755B (zh) * | 2007-08-28 | 2014-12-10 | 萨里大学 | 逆运动学 |
CN100565405C (zh) * | 2008-09-12 | 2009-12-02 | 航天东方红卫星有限公司 | 一种操纵律奇异回避的航天器姿态控制系统 |
CN101694570B (zh) * | 2009-10-19 | 2011-06-15 | 航天东方红卫星有限公司 | 一种控制力矩陀螺群的高精度力矩输出控制方法 |
CN101891018B (zh) * | 2010-07-09 | 2013-04-17 | 中国科学院长春光学精密机械与物理研究所 | 基于力矩输出能力最优的单框架控制力矩陀螺操纵方法 |
CN102566578B (zh) * | 2012-01-12 | 2013-06-19 | 北京航空航天大学 | 基于奇异值分解的单框架控制力矩陀螺群协调控制方法 |
CN102749846B (zh) * | 2012-06-15 | 2014-05-07 | 北京航空航天大学 | 一种两平行构型VSDGCMGs奇异回避操纵律设计方法 |
CN103941741B (zh) * | 2014-04-28 | 2016-06-01 | 北京控制工程研究所 | 基于零运动的控制力矩陀螺框架角速度控制量的确定方法 |
-
2015
- 2015-10-16 CN CN201510666229.3A patent/CN105223961B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105223961A (zh) | 2016-01-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105223961B (zh) | 一种用于控制力矩陀螺奇异规避的航天器姿态控制方法 | |
CN106625671B (zh) | 一种空间机器人抓捕翻滚目标的最优轨迹规划方法 | |
CN107479567B (zh) | 动态特性未知的四旋翼无人机姿态控制器及方法 | |
CN105911866B (zh) | 四旋翼无人飞行器的有限时间全阶滑模控制方法 | |
CN107479370B (zh) | 一种基于非奇异终端滑模的四旋翼无人机有限时间自适应控制方法 | |
CN107479371B (zh) | 一种基于快速非奇异终端滑模的四旋翼无人机有限时间自适应控制方法 | |
CN109426145A (zh) | 关节柔性双臂空间机器人的自适应神经网络滑模控制方法 | |
CN106272380B (zh) | 一种抓捕高速旋转目标后机械臂组合体的姿态稳定方法 | |
CN109283841A (zh) | 关节柔性和臂杆柔性的空间机械臂控制方法 | |
CN110941184A (zh) | 一种电磁轴承柔性转子不同位系统滑模振动主动控制方法 | |
CN111874266A (zh) | 一种刚体航天器的抗退绕滑模姿态机动控制方法及系统 | |
CN107038320A (zh) | 加入挠性和燃料晃动的绳系捕获卫星动力学模型的建立方法 | |
CN109085753A (zh) | 一种基于自适应非线性加权矩阵的磁悬浮控制敏感陀螺群伪逆操纵律 | |
Sun et al. | A design for two-wheeled self-balancing robot based on Kalman filter and LQR | |
CN113219825B (zh) | 一种四足机器人单腿轨迹跟踪控制方法及系统 | |
CN109032156A (zh) | 一种基于状态观测的吊挂载荷四旋翼无人机悬停控制方法 | |
CN110405761A (zh) | 一种机器人关节的仿生粘弹性控制方法 | |
AU2021104734A4 (en) | A Design Method of a Variable-parameter Neural Dynamic Controller for Drones, and Application Thereof | |
CN105619394A (zh) | 一种基于误差四元数反馈的rov姿态控制方法 | |
CN107943062A (zh) | 带外部干扰力矩的挠性卫星姿态滑模控制方法 | |
Rezapour et al. | Path following control of planar snake robots using virtual holonomic constraints | |
CN107608213A (zh) | 一种卫星姿态机动路径规划的参数设计方法 | |
Diao et al. | An output feedback attitude tracking controller design for quadrotor unmanned aerial vehicles using quaternion | |
CN114485672B (zh) | 小天体附着的面状探测器耦合约束轨迹规划方法 | |
CN106379558B (zh) | 一种基于角加速度前馈的滑模变结构复合控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |