CN103425133A - 基于符号修正的空间飞行器姿态偏差参数的姿态控制方法 - Google Patents
基于符号修正的空间飞行器姿态偏差参数的姿态控制方法 Download PDFInfo
- Publication number
- CN103425133A CN103425133A CN2012101601497A CN201210160149A CN103425133A CN 103425133 A CN103425133 A CN 103425133A CN 2012101601497 A CN2012101601497 A CN 2012101601497A CN 201210160149 A CN201210160149 A CN 201210160149A CN 103425133 A CN103425133 A CN 103425133A
- Authority
- CN
- China
- Prior art keywords
- attitude
- spacecraft
- quaternion
- aircraft
- deviation
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 38
- 239000011159 matrix material Substances 0.000 claims description 16
- 230000036544 posture Effects 0.000 abstract 12
- 230000014509 gene expression Effects 0.000 description 4
- 238000013459 approach Methods 0.000 description 3
- 239000013598 vector Substances 0.000 description 3
- 238000010276 construction Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 241000764238 Isis Species 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明的基于符号修正的空间飞行器姿态偏差参数的姿态控制方法包括以下步骤:步骤1,构建经过符号修正的姿态偏差描述参数;步骤2,根据经过符号修正的姿态偏差描述参数确定姿态控制律;步骤3,将步骤2确定的姿态控制律代入空间飞行器姿态动力学方程,并结合飞行器姿态运动学方程对空间飞行器的姿态进行控制;步骤4,判断当前空间飞行器姿态是否满足姿态控制要求,如果为是,结束姿态控制过程,如果为否,返回步骤1。本发明的基于符号修正的空间飞行器姿态偏差参数的姿态控制方法可规避姿态四元数的符号二义性,防止发生unwinding现象。
Description
技术领域
本发明涉及空间飞行器姿态描述及姿态控制技术领域,尤其涉及一种基于符号修正的空间飞行器姿态偏差描述参数的姿态控制方法。
背景技术
空间飞行器在轨运行期间,任务的切换要求飞行器进行大角度的姿态机动,欧拉角在描述空间姿态时具有多值性,即使将欧拉角取值限定在(-π,π]内,也仍有两组欧拉角对应于飞行器的空间姿态,这在姿态控制过程中容易引起unwinding现象;另外,基于欧拉角描述的姿态运动模型还在飞行器进行大角度姿态机动过程中存在奇异性。
四元数姿态描述虽不会给姿态运动模型引入奇异现象,但姿态四元数不具有明确的物理意义,难以直观地反映飞行器姿态变化的情况;另外,姿态四元数还存在符号二义性(±q两个姿态四元数描述同一空间姿态),这在反馈控制中也将会引起unwinding现象。
基于偏差四元数的拟欧拉角概念的提出,给四元数的某些项赋予了明晰的物理意义,基于拟欧拉角的姿态运动模型继承了四元数姿态运动模型无奇异的特点,但拟欧拉角并未能回避姿态四元数的符号二义性,即不能防止unwinding现象的发生。
发明内容
本发明的目的在于提供一种基于符号修正的空间飞行器姿态偏差参数的姿态控制方法,可规避姿态四元数的符号二义性,防止发生unwinding现象。
为了达到上述的目的,本发明提供一种基于符号修正的空间飞行器姿态偏差参数的姿态控制方法,包括以下步骤:步骤1,构建经过符号修正的姿态偏差描述参数;步骤2,根据经过符号修正的姿态偏差描述参数确定姿态控制律;步骤3,将步骤2确定的姿态控制律代入空间飞行器姿态动力学方程,并结合飞行器姿态运动学方程对空间飞行器的姿态进行控制;步骤4,判断当前空间飞行器姿态是否满足姿态控制要求,如果为是,结束姿态控制过程,如果为否,返回步骤1。
上述基于符号修正的空间飞行器姿态偏差参数的姿态控制方法,其中,所述步骤1包括以下步骤:步骤1.1,根据飞行器当前姿态四元数及期望姿态四元数确定描述飞行器姿态偏差的拟欧拉角参数;基于姿态四元数描述的空间飞行器姿态运动学方程为:
其中,为飞行器姿态四元数,ω=[ω x , ω y , ω z ] T 为飞行器相对于惯性空间的转动角速度,D(q)是姿态四元数p的左乘矩阵;根据飞行器当前姿态四元数q和期望姿态四元数q f ,引入飞行器姿态运动学方程,定义拟欧拉角和拟欧拉角速度如下:
步骤1.6,构建经过符号修正的姿态偏差描述参数;经过符号修正的姿态偏差描述参数定义如下:
上述基于符号修正的空间飞行器姿态偏差参数的姿态控制方法,其中,所述姿态控制律给定如下:
其中,M C 为控制力矩,K和D均为正的标量系数。
上述基于符号修正的空间飞行器姿态偏差参数的姿态控制方法,其中,所述空间飞行器姿态动力学方程为:
上述基于符号修正的空间飞行器姿态偏差参数的姿态控制方法,其中,所述姿态控制要求为姿控时间或姿态精度。
本发明基于符号修正的空间飞行器姿态偏差参数的姿态控制方法利用经过符号修正的姿态偏差描述参数设计PD姿态控制器,对空间飞行器姿态进行控制,由于经过符号修正的姿态偏差描述参数不受期望姿态四元数取+q f 或-q f 的影响,因此,本发明基于符号修正的空间飞行器姿态偏差参数的姿态控制方法成功规避了期望姿态四元数双值性所引起的unwinding现象。
附图说明
本发明的基于符号修正的空间飞行器姿态偏差参数的姿态控制方法由以下的实施例及附图给出。
图1是本发明基于符号修正的空间飞行器姿态偏差参数的姿态控制方法的流程图。
图2是本发明中构建经过符号修正的姿态偏差描述参数的流程图。
图3是本发明中空间飞行器姿态四元数的变化曲线图。
图4是本发明中空间飞行器姿态欧拉角的变化曲线图。
图5是本发明中空间飞行器姿态角速度的变化曲线图。
图6是本发明中空间飞行器拟欧拉角参数的变化曲线图。
图7是本发明中经过符号修正的姿态偏差描述参数的变化曲线图。
具体实施方式
以下将结合图1~图7对本发明的基于符号修正的空间飞行器姿态偏差参数的姿态控制方法作进一步的详细描述。
参见图1和图2,本实施例的基于符号修正的空间飞行器姿态偏差参数的姿态控制方法包括以下步骤:
步骤1,构建经过符号修正的姿态偏差描述参数;
步骤1.1,根据飞行器当前姿态四元数及期望姿态四元数确定描述飞行器姿态偏差的拟欧拉角参数;
基于姿态四元数描述的空间飞行器姿态运动学方程为:
DT(q)D(q)=I4×4(I4×4为4×4单位矩阵),GT(q)G(q)=I3×3(I3×3为3×3单位矩阵),D(q)是姿态四元数p的左乘矩阵;
设Δγ,Δψ和Δθ为飞行器对应于姿态偏差四元数的偏差欧拉角,当飞行器姿态趋于期望姿态时,拟欧拉角近似为[Δγ Δψ Δθ]T,并趋于[0 0 0]T,具有类似于欧拉角的性质,此时由于q→q f ,有υ=G T (q f )G(q)ω→ω,在飞行器姿态控制作用下,υ还将同ω一道向零趋近,显然,在由和υ构建的相平面上,飞行器当前姿态与其期望姿态所对应的相点即为坐标原点;
当期望姿态四元数分别取+q f 及-q f 时,相应的拟欧拉角参数是反号的,可见,步骤1定义的拟欧拉角参数没有规避姿态四元数所固有的符号二义性;
步骤1.2,构建扩展的拟欧拉角;
其中,I4×4表示4×4单位矩阵,I4×1=[1 0 0 0]T;
步骤1.4,令;
考虑四元数p与旋转之间的关系:
其中,E为惯性空间中旋转轴对应的单位列矢量,α为对应的旋转角,σ 0=0表示α=±π,即q f 与q分别所对应的空间矢量关于旋转轴对称,可见,此时姿态偏差所对应的角程与飞行器期望姿态四元数q f 的符号无关,无需关注期望姿态四元数q f 的符号,此时可采用如下方式处理σ 0,即:
步骤1.5,构建改进的拟欧拉角参数;
定义变量矩阵Δ为:
扩展的拟欧拉角的变化率可确定为:
(11)
由Δ与Δ变化率的表达式可得:
下面定义不受期望姿态四元数取+q f 或-q f 影响的控制变量,即:
根据姿态四元数的左乘矩阵的相关运算法则,并结合Δ及Δ变化率的表达式,经过推导和化简,可得下式:
步骤1.6,构建经过符号修正的姿态偏差描述参数;
按下式构建经过符号修正的姿态偏差描述参数:
经过符号修正的姿态偏差描述参数与拟欧拉角参数之间的关系为:
其中,sgn(·)为符号函数;
根据步骤1.1中拟欧拉角及步骤1.2中扩展拟欧拉角的构建过程,由上式可以得到经过符号修正的空间飞行器期望姿态四元数的描述形式,设当前指定的期望姿态四元数为q f ,经过符号修正的期望姿态四元数为q F ,有:
显然,+q f 与-q f 对应于同一个q F ;
步骤2,根据经过符号修正的姿态偏差描述参数确定姿态控制律;
空间飞行器姿态动力学方程可写为:
其中, II 为飞行器转动惯量,M C 为控制力矩,控制力矩M C 由控制律结合飞行器的相关运动参数确定;
对经过符号修正的姿态偏差描述参数求导,代入姿态动力学方程并整理,则有:
随着姿态控制进程的推进,飞行器的姿态四元数q将向期望姿态四元数q F 趋近,矩阵G T (q F )G(q)将趋于单位阵,矩阵G T (q F )G(q)II -1的对角项也为正值,设计PD姿态控制器,相应的姿态控制律给定如下:
其中,K和D均为正的标量系数,易证,所设计的PD控制器渐近稳定;
步骤3,将步骤2确定的姿态控制律代入空间飞行器姿态动力学方程,并结合飞行器姿态运动学方程对空间飞行器的姿态进行控制;
将公式(21)代入公式(19),并结合公式(1),即可实现对飞行器姿态的控制;
步骤4,判断当前空间飞行器姿态是否满足姿态控制要求,如果为是,结束姿态控制过程,如果为否,返回步骤1;
所述姿态控制要求为姿控时间或姿态精度。
以下通过数值仿真对本实施例的基于符号修正的空间飞行器姿态偏差参数的姿态控制方法进行验证:
设空间飞行器姿控相关参数表述如下:
(1)空间飞行器初始姿态:
偏航角: 15°
俯仰角: -60°
滚转角: 50°
(2)空间飞行器初始姿态对应的姿态四元数:
q=[0.75059 0.42202 -0.10705 -0.49705]
(3)空间飞行器期望姿态:
偏航角: -60°
俯仰角: 110°
滚转角: -120°
(4)空间飞行器期望姿态对应的姿态四元数:
q f =[0.60307 -0.22539 -0.75776 0.10634]
或
q f =-[0.60307 -0.22539 -0.75776 0.10634]
(5)空间飞行器转动惯量: II=[2298 -88.4 -158.3;-88.4 2754 74.5;-158.3 74.5 2452.7]
(6)所设计PD控制律的系数K和D:K=100,D=1200
同时,空间飞行器姿态控制机构可以执行任意大小的控制力矩。
图3~图7为相应的仿真结果,其中,图3与图4所示为在步骤2所确定的姿态控制律的控制作用下,空间飞行器的姿态四元数及姿态欧拉角的变化曲线;图5所示为空间飞行器姿态角速度变化曲线;图6所示为q f 取为-[0.60307 -0.22539 -0.75776 0.10634]时,空间飞行器拟欧拉角及拟欧拉角速度的变化曲线,图7则为经过符号修正的姿态偏差描述参数的变化曲线。观察易见,图6与图7中变化曲线所对应参数的取值互为相反数,这正是符号修正功能的体现。若空间飞行器的期望姿态四元数q f 取为[0.60307 -0.22539 -0.75776 0.10634]时,则在步骤2对应的姿态控制律的控制作用下,除拟欧拉角参数与图6中所示符号相反之外,其余参数的变化曲线图均与图3~图5及图7完全一致。
可见,本发明的基于符号修正的空间飞行器姿态偏差参数的姿态控制方法成功规避了期望姿态四元数双值性所引起的unwinding现象。
Claims (5)
1.一种基于符号修正的空间飞行器姿态偏差参数的姿态控制方法,其特征在于,包括以下步骤:
步骤1,构建经过符号修正的姿态偏差描述参数;
步骤2,根据经过符号修正的姿态偏差描述参数确定姿态控制律;
步骤3,将步骤2确定的姿态控制律代入空间飞行器姿态动力学方程,并结合飞行器姿态运动学方程对空间飞行器的姿态进行控制;
步骤4,判断当前空间飞行器姿态是否满足姿态控制要求,如果为是,结束姿态控制过程,如果为否,返回步骤1。
2.如权利要求1所述的基于符号修正的空间飞行器姿态偏差参数的姿态控制方法,其特征在于,所述步骤1包括以下步骤:
步骤1.1,根据飞行器当前姿态四元数及期望姿态四元数确定描述飞行器姿态偏差的拟欧拉角参数;
基于姿态四元数描述的空间飞行器姿态运动学方程为:
;
步骤1.2,构建扩展的拟欧拉角;
步骤1.3,判断初始时刻是否为0,如果是,先执行步骤1.4,再执行步骤1.5,如果否,直接执行步骤1.5;
步骤1.5,构建改进的拟欧拉角参数;
步骤1.6,构建经过符号修正的姿态偏差描述参数;
经过符号修正的姿态偏差描述参数定义如下:
5.如权利要求1所述的基于符号修正的空间飞行器姿态偏差参数的姿态控制方法,其特征在于,所述姿态控制要求为姿控时间或姿态精度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210160149.7A CN103425133B (zh) | 2012-05-23 | 2012-05-23 | 基于符号修正的空间飞行器姿态偏差参数的姿态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210160149.7A CN103425133B (zh) | 2012-05-23 | 2012-05-23 | 基于符号修正的空间飞行器姿态偏差参数的姿态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103425133A true CN103425133A (zh) | 2013-12-04 |
CN103425133B CN103425133B (zh) | 2015-11-18 |
Family
ID=49650033
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210160149.7A Active CN103425133B (zh) | 2012-05-23 | 2012-05-23 | 基于符号修正的空间飞行器姿态偏差参数的姿态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103425133B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107894778A (zh) * | 2017-11-14 | 2018-04-10 | 北京临近空间飞行器系统工程研究所 | 一种基于相平面分析的飞行器大幅调姿控制方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080147254A1 (en) * | 2004-06-02 | 2008-06-19 | David William Vos | Systems and Methods for Controlling Dynamic Systems |
CN101462598A (zh) * | 2009-01-12 | 2009-06-24 | 徐国栋 | 一种卫星姿态定向系统及方法 |
-
2012
- 2012-05-23 CN CN201210160149.7A patent/CN103425133B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080147254A1 (en) * | 2004-06-02 | 2008-06-19 | David William Vos | Systems and Methods for Controlling Dynamic Systems |
CN101462598A (zh) * | 2009-01-12 | 2009-06-24 | 徐国栋 | 一种卫星姿态定向系统及方法 |
Non-Patent Citations (2)
Title |
---|
XIWANG XIA,ETC: "Time-shared scheme design for attitude control system during space separation", 《AEROSPACE SCIENCE AND TECHNOLOGY》 * |
荆武兴等: "基于拟欧拉角信号的连续力矩姿态机动控制", 《宇航学报》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107894778A (zh) * | 2017-11-14 | 2018-04-10 | 北京临近空间飞行器系统工程研究所 | 一种基于相平面分析的飞行器大幅调姿控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103425133B (zh) | 2015-11-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Park et al. | Odar: Aerial manipulation platform enabling omnidirectional wrench generation | |
Lu et al. | Uncertainty and disturbance estimator-based global trajectory tracking control for a quadrotor | |
CN107688295B (zh) | 一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法 | |
Kang et al. | Pseudospectral optimal control theory makes debut flight, saves NASA $1 M in under three hours | |
US20180164835A1 (en) | Systems and methods for dynamics, modeling, simulation and control of mid-flight coupling of quadrotors | |
US20120253514A1 (en) | Reinforcement learning apparatus, control apparatus, and reinforcement learning method | |
CN102189550A (zh) | 具有学习控制功能的机器人 | |
Bonna et al. | Trajectory tracking control of a quadrotor using feedback linearization | |
CN110888324B (zh) | 针对无人机舵机故障的姿态鲁棒自适应容错控制方法 | |
Alaimo et al. | Comparison between Euler and quaternion parametrization in UAV dynamics | |
CN106200665A (zh) | 携带不确定负载的四轴飞行器的建模与自适应控制方法 | |
CN107444675B (zh) | 一种航天器速率阻尼控制方法 | |
CN109164819B (zh) | 刚体航天器的反步自适应滑模大角度姿态机动控制方法 | |
Hehn et al. | An iterative learning scheme for high performance, periodic quadrocopter trajectories | |
Lee et al. | Backstepping control on se (3) of a micro quadrotor for stable trajectory tracking | |
CN109709970A (zh) | 一种水下机器人六自由度推力分配优化方法 | |
CN106855690B (zh) | 空间绳系机器人近距离抓捕后回收目标的自适应控制方法 | |
Samadikhoshkho et al. | Vision-based reduced-order adaptive control of aerial continuum manipulation systems | |
Cheng et al. | Fractional order sliding mode control for attitude and altitude stabilization of a quadrotor UAV | |
Yun et al. | Fixed-time terminal sliding mode trajectory tracking control of quadrotor helicopter | |
Hassani et al. | Robust Finite‐Time Tracking Control Based on Disturbance Observer for an Uncertain Quadrotor under External Disturbances | |
CN103425133B (zh) | 基于符号修正的空间飞行器姿态偏差参数的姿态控制方法 | |
Kim et al. | Globally defined dynamic modelling and geometric tracking controller design for aerial manipulator | |
Di et al. | Low-level control with actuator dynamics for multirotor UAVs | |
Shi et al. | Hybrid control of space robot in on-orbit screw-driving operation |
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 |