CN113371231B - 一种带约束的航天器姿态控制方法 - Google Patents
一种带约束的航天器姿态控制方法 Download PDFInfo
- Publication number
- CN113371231B CN113371231B CN202110710309.XA CN202110710309A CN113371231B CN 113371231 B CN113371231 B CN 113371231B CN 202110710309 A CN202110710309 A CN 202110710309A CN 113371231 B CN113371231 B CN 113371231B
- Authority
- CN
- China
- Prior art keywords
- control
- spacecraft
- attitude
- constraint
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 51
- 238000013178 mathematical model Methods 0.000 claims abstract description 8
- 239000011159 matrix material Substances 0.000 claims description 24
- 238000004891 communication Methods 0.000 claims description 13
- 238000005457 optimization Methods 0.000 claims description 11
- 238000001228 spectrum Methods 0.000 claims description 4
- 238000005286 illumination Methods 0.000 claims description 3
- 150000001875 compounds Chemical class 0.000 claims description 2
- 230000006870 function Effects 0.000 abstract description 38
- 238000002360 preparation method Methods 0.000 abstract 1
- 238000004422 calculation algorithm Methods 0.000 description 4
- 238000013459 approach Methods 0.000 description 3
- 238000013461 design Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 238000012800 visualization Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 230000037361 pathway Effects 0.000 description 1
- 230000005855 radiation Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
- B64G1/245—Attitude control algorithms for spacecraft attitude control
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/10—Geometric CAD
- G06F30/15—Vehicle, aircraft or watercraft design
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Geometry (AREA)
- Remote Sensing (AREA)
- Theoretical Computer Science (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- General Engineering & Computer Science (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Analysis (AREA)
- Computational Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
技术领域
本发明涉及航空航天技术领域,具体涉及的是一种带约束的航天器姿态控制方法。
背景技术
航天器姿态控制算法在航空领域占据着重要地位。大角度姿态机动任务是空间技术中最具挑战性的任务之一,其目标是在满足各种约束条件的情况下,将航天器的姿态驱动到一个期望的值。
在一些特殊的场合,需要避免航天器相关的设备长时间暴露在特定波长的射线中或者保证航天器的通信设备在一定范围内。满足这样的姿态约束的控制方法称为带姿态约束的航天器姿态控制方法。近年来,用于实现航天器姿态控制的方法已被开发和研究,例如路径规划、最优控制、势函数方法等。
路径规划的方法,是机动前寻找一条可行的路径,例如文献1:《DiscretizedQuaternion Constrained Attitude Pathfinding》提出了一种离散球面路径的方法,使用路径规划的方法解决航天器姿态控制问题;文献2:《Fast Three-Axis ConstrainedAttitude Pathfinding and Visualization Using Minimum DistortionParameterizations》通过垂直障碍区域施加反方向转矩的方法实现姿态控制;文献3:《Attitude Commands Avoiding Bright Objects and Maintaining Communication withGround Station》将三轴姿态表示投影到三维工件,投影表示为三维笛卡尔坐标上的点,使用图搜索的方法寻找最小代价路径。
最优控制的方法也是解决问题的一种有效手段,例如文献4:《Hybrid Methodsfor Determining Time-Optimal Constrained Spacecraft Reorientation Maneuvers》采用了混合优化的方法寻找约束问题的初始解;文献5:《On the ConvexParameterization of Constrained SpacecraftReorientation》将该问题作为一个凸的最优控制问题来解决,提出了基于凸优化的航天器控制算法;文献6:《ConstrainedSpacecraft Reorientation Using Mixed Integer Convex Programming》提出了一种新的姿态运动规划算法,采用混合整数凸规划的方法来解决航天器姿态约束问题。
势函数的方法,这是进一步使用的综合相应的姿态控制律来避免不想要的天体,同时达到想要的姿态。因为这种方法的解是可析解的,不需要改变任何整体结构的姿态控制软件以及硬件方面,它适合于板载计算,并且提供了灵活性自主操作。利用势函数来描述动态环境,并进行控制力矩的选取使得航天器的姿态收敛到在不违反用户定义列表指向约束的情况下所期望的最终方向,也减少昂贵的计算负荷。
势函数法的思想是构建一个非负的能量函数,在期望的位置有一个唯一的全局最小值,在禁区有很大的函数值。因此,在无需进行轨迹规划的情况下,可以满足姿态指向约束。
采用势函数法解决问题的例子如文献7:《Single-Axis Pointing ofUnderactuated Spacecraft in the Presence of Path Constraints》使用了势函数方法解决航天器姿态控制问题中的单轴指向问题,并且解决了其中的转矩饱和问题;文献8:《Large Angle Slew Maneuvers with Autonomous Sun Vector Avoidance》使用了人工势函数的方法解决航天器姿态控制问题;文献9:《Feedback Control for SpacecraftReorientation under Attitude Constraints Via Convex Potentials》采用了两种控制算法解决了姿态约束下的航天器控制问题,并且对其中的约束问题进行了凸参数化;文献10:《Velocity-Free Attitude Reorientation of a Flexible Spacecraft withAttitude Constraints》考虑一类无角速度反馈的情况,构建了势函数控制器;文献11:《Spacecraft Reorientation Control in Presence of Attitude ConstraintConsidering Input Saturation and Stochastic Disturbance》考虑了势函数控制中可能出现的随机扰动,并且给出了一类适用的满足转矩饱和的控制器;文献12:《SafeGuidance for Autonomous Rendezvous and Docking with a Non-Cooperative Target》提出了一种新的制导控制方法—势函数制导与模糊逻辑相结合,该方法满足追击器与非合作目标之间的安全逼近约束条件,用李雅普诺夫理论保证了系统的稳定性。
发明内容
本发明的目的在于提供一种带约束的航天器姿态控制方法,从势函数角度给出了一类带可设计参数和控制律的控制方法,并给出了控制器参数的优化方法,不仅解决了航天器姿态控制中的约束指向控制问题,而且能减小排斥势力的影响,保证了姿态控制的稳定性。
为实现上述目的,本发明采用的技术方案如下:
一种带约束的航天器姿态控制方法,包括以下步骤:
(1)建立包含航天器姿态动力学、运动学和指向约束的数学模型;
(2)建立如下带有可设计参数的势函数,其表达式为:
式中,Q为四元数,表示当前航天器姿态;Qd为四元数,表示目标姿态;表示第j个约束区域的权重系数;δ为可设计参数,用于在姿态控制过程中调节轨迹和边界的距离,其数值根据实际需要设定;表示姿态系数矩阵,其中,表示第j个约束的参数矩阵;
(3)根据势函数和李雅普诺夫理论构建李雅普诺夫函数,其表达式为:
式中,ω表示角速度;I表示航天器中的转动惯量矩阵;T表示矩阵的转置;kq为控制器参数;
(4)设计以下控制律:
(5)利用以下方法优化kq、kω:
a、建立最优控制问题:
J为目标函数;ω为角速度的扩充向量,且ω=[ω,0]T;k表示控制器参数,为优化问题的决策变量,且k=[kq,kw]T;tf为终端时间;Qe=Q-Qd表示当前四元数与目标四元数的误差;RQ,Rω,Ru均为优化问题的权值矩阵,为对角阵;表示第i个光约束区域的参数矩阵;为第j个光约束区域的参数矩阵的等价表达形式;k2表示通信区域的权重系数;M2为通信区域的参数矩阵;φ2为通信约束区域的等价表达形式;α、β均为大于0的常量;
b、利用伪谱法求解最优控制问题,确定kq、kω;
(6)在步骤(1)建立的数学模型基础上,根据控制律和李雅普诺夫函数实现航天器姿态控制并满足约束指向控制。
具体地,所述姿态系数矩阵其中,A=xyT+yxT-(xTy+cosθ)I3,b=x×y,d=xTy-cosθ,y表示安装在航天器上的敏感元件设备的指向,x为要满足避开光照强度过高的区域指向,最低安全角度为θ;I3表示三维单位矩阵。
进一步地,利用伪谱法求解最优控制问题,具体是指通过Lagrange插值多项式近似最优控制问题中的状态变量和控制变量,将连续最优控制问题转化为离散的非线性规划问题,然后进行求解。
再进一步地,约束区域和通信区域的权重系数的取值范围均为[0,1]。
与现有技术相比,本发明具有以下有益效果:
(1)本发明以航天器姿态动力学、运动学和指向约束为基础建立数学模型,并设计了带有可设计参数δ的人工势函数而后,在此基础上构建李雅普诺夫函数然后设计控制律:并对其中的kq、kω进行优化,最后根据控制律和李雅普诺夫函数实现对航天器姿态控制并满足约束指向控制。本发明相比现有文献的方法来说,基于势函数中引入的可设计参数,结合李雅普诺夫函数的构建以及控制律的设计,能够改善航天器机动状态,减小排斥势力的影响,同时,通过建立最优控制问题并利用伪普法求解,确保了控制器参数的最优性选择,如此一来,可以很好地保证姿态控制的稳定性。并且,本发明所设计的控制方法,不仅能够应用于大型卫星上,还能应用于计算能力有限的小型卫星上,并满足指向约束控制要求,适用范围广。
附图说明
图1为本发明-实施例中航天器四元数状态轨迹图。
图2为本发明-实施例中角速度以及控制输入图。
图3为本发明-实施例中指向约束三维展开图。
具体实施方式
下面结合附图说明和实施例对本发明作进一步说明,本发明的实施包含但不限于以下实施例。
实施例
本实施例提供了一种带约束的航天器姿态控制方法,其控制流程如下:
首先,建立包含航天器姿态动力学、运动学和指向约束的数学模型,具体为:
1、考虑三轴自由轮航天器方程式:
可以获得:
q=q″0q′+q′0q″+q′×q″
q0=q′0q″0-(q′)Tq″
u=(u1,u2,u3)
2、假设航天器从当前观测天体y2转向到下次观测天体y1,要求通信传感器归一化方向矢量y1与航天器和地面基站直接连线x2之间的夹角θ1应当保持在能保证通信的最大夹角θmax以内。因此,将向量进行单位化,并整理后,可以得到如下数学表达式:
x2·y′1>cosθmax
本实施例中,考虑三轴自由轮航天器在多个指向约束下的机动:
初始四元数为:[0.6469,0.0347,0.7224,0.2417];
终止四元数为:[0.7303,0.3651,-0.5477,0.1826];
表1航天器指向约束模型相关参数
航天器四元数状态轨迹、角速度以及控制输入、指向约束分别如图1~3所示。
接着,建立以下带有可设计参数构建的人工势函数:
δ为可设计参数,用于在姿态控制过程中调节轨迹和边界的距离,其数值根据实际需要人为设定。
对于姿态系数矩阵来说:
A=xyT+yxT-(xTy+cosθ)I3,b=x×y,d=xTy-cosθ,
其中,y表示安装在航天器上的敏感元件设备的指向,x为要满足避开光照强度过高的区域指向,最低安全角度为θ。
然后在势函数基础上构建下面的李雅普诺夫函数:
而后,设计以下控制律:
对其中的kq、kω的优化:
1、建立最优控制问题:
由于需要考虑重定向任务的目标和能量成本,因此,本实施例选择以下二次性能指标作为成本函数:
然后,将最优参数优化问题表述如下:
2、利用伪谱法求解最优控制问题,确定kq、kω。
根据上述最优参数优化问题的表述,可以看出,这个问题实际上是一个受状态约束的最优参数选择问题,通过伪谱法可以解决这一状态首先的最优参数选择问题。具体为:通过Lagrange插值多项式近似最优控制问题中的状态变量和控制变量,将连续最优控制问题转化为离散的非线性规划问题,后者更容易求解。
最后,根据控制律和李雅普诺夫函数实现航天器姿态控制并满足约束指向控制。
经系统联合仿真,本发明所设计的控制方法,能够解决航天器姿态控制中的约束指向控制问题,并减小了排斥势力的影响,并在结合控制器参数的最优性选择后,保证了姿态控制的稳定性。
上述实施例仅为本发明的优选实施方式之一,不应当用于限制本发明的保护范围,凡在本发明的主体设计思想和精神上作出的毫无实质意义的改动或润色,其所解决的技术问题仍然与本发明一致的,均应当包含在本发明的保护范围之内。
Claims (4)
1.一种带约束的航天器姿态控制方法,其特征在于,包括以下步骤:
(1)建立包含航天器姿态动力学、运动学和指向约束的数学模型;
(2)建立如下带有可设计参数的势函数,其表达式为:
式中,Q为四元数,表示当前航天器姿态;Qd为四元数,表示目标姿态;表示第j个约束区域的权重系数;δ为可设计参数,用于在姿态控制过程中调节轨迹和边界的距离,其数值根据实际需要设定;表示姿态系数矩阵,其中,表示第j个约束的参数矩阵;
(3)根据势函数和李雅普诺夫理论构建李雅普诺夫函数,其表达式为:
式中,ω表示角速度;I表示航天器中的转动惯量矩阵;T表示矩阵的转置;kq为控制器参数;
(4)设计以下控制律:
(5)利用以下方法优化kq、kω:
a、建立最优控制问题:
式中, J为目标函数;ω为角速度的扩充向量,且ω=[ω,0]T;k表示控制器参数,为优化问题的决策变量,且k=[kq,kw]T;tf为终端时间;Qe=Q-Qd表示当前四元数与目标四元数的误差;RQ,Rω,Ru均为优化问题的权值矩阵,为对角阵;表示第i个光约束区域的参数矩阵;为第j个光约束区域的参数矩阵的等价表达形式;k2表示通信区域的权重系数;M2为通信区域的参数矩阵;φ2为通信约束区域的等价表达形式;α、β均为大于0的常量;
b、利用伪谱法求解最优控制问题,确定kq、kω;
(6)在步骤(1)建立的数学模型基础上,根据控制律和李雅普诺夫函数实现航天器姿态控制并满足约束指向控制。
3.根据权利要求1或2所述的一种带约束的航天器姿态控制方法,其特征在于,利用伪谱法求解最优控制问题,具体是指通过Lagrange插值多项式近似最优控制问题中的状态变量和控制变量,将连续最优控制问题转化为离散的非线性规划问题,然后进行求解。
4.根据权利要求1所述的一种带约束的航天器姿态控制方法,其特征在于,约束区域和通信区域的权重系数的取值范围均为[0,1]。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110710309.XA CN113371231B (zh) | 2021-06-25 | 2021-06-25 | 一种带约束的航天器姿态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110710309.XA CN113371231B (zh) | 2021-06-25 | 2021-06-25 | 一种带约束的航天器姿态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113371231A CN113371231A (zh) | 2021-09-10 |
CN113371231B true CN113371231B (zh) | 2022-03-08 |
Family
ID=77579178
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110710309.XA Expired - Fee Related CN113371231B (zh) | 2021-06-25 | 2021-06-25 | 一种带约束的航天器姿态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113371231B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114740733B (zh) * | 2022-04-24 | 2022-11-22 | 四川大学 | 一种航天器姿态重定向的最优固定时间滑模控制方法 |
CN115092420B (zh) * | 2022-06-06 | 2023-02-17 | 哈尔滨工业大学(深圳) | 一种基于方向余弦矩阵的复杂约束下航天器姿态机动规划方法、设备和介质 |
CN115158705B (zh) * | 2022-07-11 | 2024-06-21 | 北京理工大学 | 分段多项式航天器姿态机动轨迹规划方法 |
CN116955893B (zh) * | 2023-08-25 | 2024-09-13 | 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院) | 一种基于旋转矩阵的航天器姿态受限下的协同势函数族设计方法 |
CN117348390B (zh) * | 2023-09-22 | 2024-07-23 | 四川大学 | 一种全状态约束事件触发航天器姿态重定向控制方法 |
CN118062260B (zh) * | 2023-12-05 | 2024-08-27 | 四川大学 | 一种指向约束下的时间最优航天器姿态控制方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5134274A (en) * | 1991-03-18 | 1992-07-28 | Hughes Aircraft Company | Two-sided solid-state imaging device |
JPH08299469A (ja) * | 1995-05-09 | 1996-11-19 | Meidensha Corp | 心臓の正常・異常識別装置 |
CN102890506B (zh) * | 2011-07-19 | 2015-04-15 | 北京理工大学 | 一种基于约束规划的小天体接近段制导控制方法 |
FR2991081A1 (fr) * | 2012-05-25 | 2013-11-29 | Inst Nat Rech Inf Automat | Procede de simulation d'un ensemble d'elements, programme d'ordinateur associe |
CN103512673B (zh) * | 2012-06-28 | 2016-01-20 | 中国科学院国家天文台 | 一种微波探测仪观测月球亮温度数据处理方法 |
CN105955028B (zh) * | 2016-06-02 | 2018-09-07 | 西北工业大学 | 一种航天器在轨规避制导控制一体化算法 |
CN109613827B (zh) * | 2018-12-29 | 2021-04-02 | 西北工业大学 | 一种相对速度未知的平动点轨道交会控制方法 |
-
2021
- 2021-06-25 CN CN202110710309.XA patent/CN113371231B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN113371231A (zh) | 2021-09-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113371231B (zh) | 一种带约束的航天器姿态控制方法 | |
Ollero et al. | Past, present, and future of aerial robotic manipulators | |
Wang et al. | Coordinated trajectory planning of dual-arm space robot using constrained particle swarm optimization | |
Lunni et al. | Nonlinear model predictive control for aerial manipulation | |
Kim et al. | Vision-guided aerial manipulation using a multirotor with a robotic arm | |
Muthusamy et al. | Real-time adaptive intelligent control system for quadcopter unmanned aerial vehicles with payload uncertainties | |
Kapnopoulos et al. | A cooperative particle swarm optimization approach for tuning an MPC-based quadrotor trajectory tracking scheme | |
Liang et al. | Adaptive prescribed performance control of unmanned aerial manipulator with disturbances | |
Imanberdiyev et al. | A fast learning control strategy for unmanned aerial manipulators | |
Santos et al. | Fast real-time control allocation applied to over-actuated quadrotor tilt-rotor | |
Nava et al. | Position and attitude control of an underactuated flying humanoid robot | |
Panyakeow et al. | Deconfliction algorithms for a pair of constant speed unmanned aerial vehicles | |
Pérez-Alcocer et al. | A novel Lyapunov-based trajectory tracking controller for a quadrotor: Experimental analysis by using two motion tasks | |
Luna et al. | Gain-scheduling and pid control for an autonomous aerial vehicle with a robotic arm | |
Ansari et al. | Quadrotor motion control using adaptive generalized dynamic inversion | |
Golbol et al. | Rg-trees: Trajectory-free feedback motion planning using sparse random reference governor trees | |
Basri et al. | Nonlinear control of an autonomous quadrotor unmanned aerial vehicle using backstepping controller optimized by particle swarm optimization | |
Ugurlu et al. | Reinforcement learning versus conventional control for controlling a planar bi-rotor platform with tail appendage | |
CN108427429B (zh) | 一种考虑动态指向约束的航天器视轴机动控制方法 | |
Danko et al. | Evaluation of visual servoing control of aerial manipulators using test gantry emulation | |
Sugihara et al. | Design, Control, and Motion Strategy of TRADY: Tilted‐Rotor‐Equipped Aerial Robot With Autonomous In‐Flight Assembly and Disassembly Ability | |
Ding et al. | Optimal Joint Space Control of a Cable-Driven Aerial Manipulator. | |
Mutawe et al. | Robust Path Following Controllers for Quadrotor and Ground Robot | |
Wang et al. | Modeling and Control of a Novel Over-actuated Tri-rotor UAV | |
Hosseini Sani et al. | Online sliding mode-based integrated guidance and control system for a quadcopter uav in the presence of unknown obstacles |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20220308 |