CN105867395B - 一种基于滑模控制的深空探测器约束姿态机动规划方法 - Google Patents

一种基于滑模控制的深空探测器约束姿态机动规划方法 Download PDF

Info

Publication number
CN105867395B
CN105867395B CN201610187160.0A CN201610187160A CN105867395B CN 105867395 B CN105867395 B CN 105867395B CN 201610187160 A CN201610187160 A CN 201610187160A CN 105867395 B CN105867395 B CN 105867395B
Authority
CN
China
Prior art keywords
attitude
detector
control
formula
constraint
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
Application number
CN201610187160.0A
Other languages
English (en)
Other versions
CN105867395A (zh
Inventor
徐瑞
武长青
崔平远
朱圣英
高艾
尚海滨
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Technology BIT
Original Assignee
Beijing Institute of Technology BIT
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Technology BIT filed Critical Beijing Institute of Technology BIT
Publication of CN105867395A publication Critical patent/CN105867395A/zh
Application granted granted Critical
Publication of CN105867395B publication Critical patent/CN105867395B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0816Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
    • G05D1/0825Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Pure & Applied Mathematics (AREA)
  • Mathematical Optimization (AREA)
  • Mathematical Physics (AREA)
  • Mathematical Analysis (AREA)
  • Algebra (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开的一种基于滑模控制的深空探测器约束姿态机动规划方法,涉及一种用于深空探测器约束姿态机动规划方法,属于探测器姿态控制技术领域。本发明利用滑膜变结构控制方法设计满足动力学和运动学约束、控制力矩有界约束的控制率;采用几何规避方法求出可满足禁忌约束的姿态四元数,得到同时满足动力学、运动学约束、控制力矩有界约束和禁忌约束的路径节点和生成节点的控制力矩,生成探测器姿态机动路径和所需要的控制力矩,实现探测器机动到目标姿态。本发明不仅考虑动力学和运动学约束、控制力矩有界约束,而且充分满足探测器面临的禁忌约束,能够减小规划路径的曲率,提高探测器从起始姿态机动到目标姿态的效率。

Description

一种基于滑模控制的深空探测器约束姿态机动规划方法
技术领域
本发明涉及一种约束姿态机动规划方法,尤其涉及一种深空探测器约束姿态机动规划方法,属于探测器姿态控制技术领域。
背景技术
深空探测器在轨运行时,为了完成它所承担的科学任务,必须具有一定的姿态。完成这些姿态的切换需要通过姿态机动来进行实现。但是在姿态机动过程中,探测器必需满足一系列的禁忌约束,比如,某些光学敏感器(如:红外敏感元件或弱光敏感元件等)不能指向强光天体;对目标进行观测时,照相机或者其他遥感器要指向观测目标;穿越行星环或小行星带时,未经加固的表面不能指向容易受到撞击的方向等。这些约束极大地限制了探测器在姿态机动过程中的可行区域。在探测器姿态机动过程中,如何来规避这些禁忌约束是不得不考虑的一个主要问题。禁忌约束可以看作是来自探测器外部环境的约束,然而也需要考虑到探测器自身的动力学约束。一方面,探测器需要满足基本的姿态动力学和运动学约束,这种约束是姿态机动的前提。另一方面,探测器的控制力矩不是无限大的,执行机构的输出力矩是有界的,这对控制器的设计提出了更高的要求。面对以上诸多约束,姿控技术必须要得到相应的改进才能满足航天任务的发展需求。
针对这一问题,McInnes C R在“Large angle slew maneuvers with autonomoussun vector avoidance”一文中利用势能函数法求解该问题,这种方法计算简单,对探测器上资源要求较少,但是该方法很难处理控制力矩有界的问题。
Cheng X,Cui H,Yu M在“Spacecraft Attitude Maneuver Planning Based onRapidly Exploring Random Tree and Sliding Mode Control”一文中利用快速搜索随机树作为全局规划器,并将局部扩展算法采用滑模 控制,在满足禁忌约束和动力学约束的情况下,规划路径从初始节点安全到达目标节点。但是得到的机动路径曲率较大,不利于探测器实际跟踪。
发明内容
本发明公开的一种基于滑模 控制的深空探测器约束姿态机动规划方法,要解决的技术问题是在满足探测器面临的各种复杂约束条件下,减小规划路径的曲率,提高探测器从起始姿态机动到目标姿态的效率。本发明公开的一种基于滑模 控制的深空探测器约束姿态机动规划方法,在满足探测器面临的各种复杂约束条件下,能够快速地使探测器从起始姿态机动到目标姿态。所述的各种复杂约束包括动力学和运动学约束、控制力矩有界约束、禁忌约束。
本发明是通过下述技术方案实现的:
本发明公开的一种基于滑模 控制的深空探测器约束姿态机动规划方法,利用滑模 变结构控制方法设计满足动力学和运动学约束、控制力矩有界约束的控制率。然后采用几何规避方法求出可满足禁忌约束的姿态四元数,得到同时满足动力学、运动学约束、控制力矩有界约束和禁忌约束的路径节点和生成节点的控制力矩,进而生成探测器姿态机动路径和所需要的控制力矩,按照生成探测器姿态机动路径和所需要的控制力矩,可减小规划路径的曲率,实现探测器机动到目标姿态。本发明不仅考虑动力学和运动学约束、控制力矩有界约束,而且充分满足探测器面临的禁忌约束,能够减小规划路径的曲率,提高探测器从起始姿态机动到目标姿态的效率。
本发明公开的一种基于滑模 控制的深空探测器约束姿态机动规划方法,包括如下步骤:
步骤一:建立姿态机动参考模型。
定义本体坐标系相对于惯性坐标系的误差四元数qe为,
式中:qR为目标四元数,q为当前四元数。为qR的共轭四元数;表示四元数相乘;qev=[qe1 qe2 qe3]T。则误差旋转矩阵为,
定义本体坐标系相对于惯性坐标系的误差角速度ωe为,
ωe=ω-R(qeR (3)
式中,ω=[ω123]T是当前探测器在本体系下的角速度,ωR表示目标角速度。
误差四元数qe和误差角速度ωe构成姿态机动参考模型。
步骤二:采用滑模 控制方法设计控制率,产生控制力矩对姿态进行机动。
滑模 面s选取为,
s=ωe+kqev=J-1he+kqev (4)
式中:he=Jωe,k为正常数。
选取Lyapunov函数为,
V(s)关于时间的导数为,
所设计控制率的输出力矩u必须使得(当qe≠0且ωe≠0时),才能使整个控制系统稳定。
综合考虑误差四元数qe、误差角速度ωe的模型,选取飞轮的控制力矩u为,
式中:K1∈R3×3为正定的对角阵;λ=diag(λi)(i=1,2,3)为用来限制飞轮产生干扰力矩d 的增益矩阵;符号函数sgn(s)=[sgn(s1) sgn(s2) sgn(s3)]T,sgn(s)的每个元素定义为,
根据选取飞轮的控制力矩u,Lyapunov函数的导数为,
由此可得当t→∞时,s(t)→0。也即意味着ωe→0且qev→0。所以式(7)为本步骤设计的控制率。
式(7)的控制率是基于滑模 控制方法设计的,可以满足动力学和运动学以及控制力矩有界约束的。
步骤三:根据姿态动力学和运动学模型更新角速度ω和四元数q。
姿态动力学方程为公式(10),
J=diag(J1,J2,J3)表示探测器相对本体系的惯性矩阵,u=[u1,u2,u3]T为控制力矩在本体系下的分量,d=[dx dy dz]T为干扰力矩,ω=[ω123]T是当前探测器相对惯性系的角速度在本体系下的表示。
由式(10)可知,根据控制力矩u和当前角速度ω,能够积分递推出下一步长的角速度ω(k+1)。
姿态运动学方程为公式(11),
其中,q0为四元数的标量部分,qv=[q1 q2 q3]T为四元数的矢量部分。q0和qv需要满足归一化约束 表示qv的反对称矩阵,
由式(12)可以得到下一步长的四元数q(k+1)。
步骤四:采用几何规避方法对产生的姿态四元数进行规划,使得姿态四元数满足禁忌约束。
禁忌约束可以表示成如公式(13)所示的几何关系,
其中,rB表示敏感元件在本体系下的方向矢量,vB为强光天体在本体坐标下的方向矢量为了避免探测器在机动过程中,强光天体光线进入到光学敏感元件的视场内,必须要保证此类敏感器件的视线方向矢量与强光天体方向矢量之间的夹角不能低于阈值θ。
将式(13)转换成四元数表示形式为,
vB=CBIrI=rI-2qv TqvrI+2qvqv TrI+2q0([rI×]qv) (14)
其中,rI表示探测器到强光天体的方向矢量在惯性系下的分量,CBI表示探测器的姿态余弦矩阵。[rI×]为叉乘矩阵,具体形式为,
将(13)表示成更加紧凑的形式,得到(16)式中的二次约束形式,
qTKq≤0 (16)
其中,q=[q0 q1 q2 q3]T
步骤三得到的姿态四元数可以利用式(16)进行判断,假如满足,那么输出该四元数q(k+1)和角速度ω(k+1)到步骤一所述的参考模型进行循环,假如不满足,令,
式中,p=[cos(π/4) sin(π/4) 0 0]T
步骤五:在给出探测器的起始姿态和目标姿态条件下,通过实现上述步骤一、二、三、四闭环规划系统循环,规划出满足约束的路径节点和生成节点的控制力矩,可以生成探测器姿态机动路径和所需要的控制力矩,按照生成探测器姿态机动路径和所需要的控制力矩实现探测器机动到目标姿态。
有益效果:
1、本发明公开的一种基于滑模 控制的深空探测器约束姿态机动规划方法,采用滑模 变结构控制方法设计可以满足动力学和运动学以及控制力矩有界约束的控制率,然后针对禁忌约束采用几何规避方法求出可满足的姿态,可减小规划路径曲率,提高探测器从起始姿态机动到目标姿态的效率。
2、本发明公开的一种基于滑模 控制的深空探测器约束姿态机动规划方法,规划出的姿态机动路径不仅考虑了输入控制力矩有界约束,而且充分满足了探测器面临的禁忌约束,可避免探测器在姿态机动过程中敏感元件被强光天体损害,保证执行机构不超出它所承受的最大执行力矩,提高探测器姿态机动中的稳定性。
附图说明
图1探测器姿态机动所受禁忌约束示意图;
图2是本发明一种深空探测器约束姿态机动路径规划流程图;
图3是本发明一种深空探测器约束姿态机动路径规划数据流程图;
图4天球坐标系下探测器姿态机动路径实例图;
图5规划生成的控制力矩实例图。
具体实施方式
为了更好的说明本发明的目的和优点,下面结合附图和实例对发明内容做进一步说明。
实施例1:
本实例公开的一种基于滑模 控制的深空探测器约束姿态机动规划方法,具体实现步骤如下:
步骤一:建立姿态机动参考模型。利用当前状态和目标状态,求出误差四元数qe和误差角速度ωe
给出探测器的起始姿态q(0)=[0.2616 0.9374 -0.4234 0.2417]T和目标姿态 qR=[-0.6418 0.2262 0.0145 -0.5226]T,可以计算出当前误差四元数qe和误差角速度ωe。每一次循环当前状态包括姿态四元数q(k)和角速度ω(k),所述的两个状态每次都会更新。
步骤二:采用滑模 控制方法设计控制率,产生控制力矩对姿态进行机动。
利用qe和ωe,求出机动到下一路径节点所需的控制力矩u(k+1),代入到动力学和运动学方程求出下一路径节点的状态q(k+1)和ω(k+1)。
将qe和ωe代入公式,
求出机动到下一路径节点所需的控制力矩u(k+1)。
步骤三:根据姿态动力学和运动学模型更新角速度ω和四元数q。
由动力学和运动学方程,
代入步骤二得到的控制力矩u(k+1)可以求得下一路径节点的状态q(k+1)和ω(k+1)。
步骤四:利用几何规避法规划出符合约束的q(k+1)。
根据当时姿态机动时刻星历时刻,确定出太阳在惯性系下的矢量为 rI=[1 0 0]T,然后确定惯性系到探测器本体坐标系下的姿态转换矩阵为CBI,因此可以表示出太阳在探测器本体系下的位置矢量vB=CBIr,探测器姿态机动所受禁忌约束如图1所示;
根据探测器自身安装特性,确定出敏感器在探测器本体系下的位置矢量。为了验证算法有效性,设值有4个敏感器,参数如下表,
由式(16)中的约束形式,可以得到K1,K2,K3,K4四个禁忌约束。
判断是否满足qTKq≤0,若满足保存q(k+1)和u(k+1)。若不满足利用式(16):
求出修正后的四元数返回到步骤一,进行循环求解。
步骤五:通过实现上述步骤一、二、三、四闭环规划系统循环,实现从起始姿态机动到目标姿态的路径规划,并且生成控制力矩u。在天球坐标系下表示得到探测器姿态机动路径如图4,所需要的控制力矩如图5。
采以下公式计算能量消耗值P,
式中,u(i)为每一控制步长上的输入力矩,kmax为总的控制步数。
在同样仿真条件下,文献《Spacecraft Attitude Maneuver Planning Based onRapidly Exploring Random Tree and Sliding Mode Control》能量消耗P为55.6889,本发明的能量消耗P为38.5906,降低了30.70%。
本发明保护范围不仅局限于实施例,实施例用于解释本发明,凡与本发明在相同原理和构思条件下的变更或修改均在本发明公开的保护范围之内。

Claims (1)

1.一种基于滑模控制的深空探测器约束姿态机动规划方法,其特征在于:包括如下步骤,
步骤一:建立姿态机动参考模型;
定义本体坐标系相对于惯性坐标系的误差四元数qe为,
式中:qR为目标四元数,q为当前四元数;为qR的共轭四元数;表示四元数相乘;qev=[qe1 qe2 qe3]T;则误差旋转矩阵为,
定义本体坐标系相对于惯性坐标系的误差角速度ωe为,
ωe=ω-R(qeR (3)
式中,ω=[ω123]T是当前探测器在本体系下的角速度,ωR表示目标角速度;
误差四元数qe和误差角速度ωe构成姿态机动参考模型;
步骤二:采用滑模控制方法设计控制率,产生控制力矩对姿态进行机动;
滑模面s选取为,
s=ωe+kqev=J-1he+kqev (4)
式中:he=Jωe,k为正常数;
选取Lyapunov函数为,
V(s)关于时间的导数为,
所设计控制率的控制力矩u必须使得当qe≠0且ωe≠0时,才能使整个控制系统稳定;
综合考虑误差四元数qe、误差角速度ωe的模型,选取飞轮的控制力矩u为,
式中:K1∈R3×3为正定的对角阵;λ=diag(λi),i=1,2,3为用来限制飞轮产生干扰力矩d的增益矩阵;ωb是控制系统中参考系统的本体角速度;符号函数sgn(s)=[sgn(s1) sgn(s2) sgn(s3)]T,sgn(s)的每个元素定义为,
si是滑模面s的三个分量;根据选取飞轮的控制力矩u,Lyapunov函数的导数为,
由此得当t→∞时,s(t)→0;也即意味着ωe→0且qev→0;所以式(7)为本步骤设计的控制率;
步骤三:根据姿态动力学和运动学模型更新角速度ω和四元数q;
姿态动力学方程为公式(10),
J=diag(J1,J2,J3)表示探测器相对本体系的惯性矩阵,u=[u1,u2,u3]T为控制力矩在本体系下的分量,为干扰力矩,ω=[ω123]T是当前探测器相对惯性系的角速度在本体系下的表示;
由式(10)得知,根据控制力矩u和当前角速度ω,能够积分递推出下一步长的角速度ω(k+1);
姿态运动学方程为公式(11),
其中,q0为四元数的标量部分,qv=[q1 q2 q3]T为四元数的矢量部分;q0和qv需要满足归一化约束 表示qv的反对称矩阵,
由式(12)能够得到下一步长的四元数q(k+1);
步骤四:采用几何规避方法对产生的姿态四元数进行规划,使得姿态四元数满足禁忌约束;
禁忌约束表示成如公式(13)所示的几何关系,
其中,rB表示敏感元件在本体系下的方向矢量,vB为强光天体在本体坐标下的方向矢量;为了避免探测器在机动过程中,强光天体光线进入到光学敏感元件的视场内,必须要保证此类敏感器件的视线方向矢量与强光天体方向矢量之间的夹角不能低于阈值θ;
将式(13)转换成四元数表示形式为,
vB=CBIrI=rI-2qv TqvrI+2qvqv TrI+2q0([rI×]qv) (14)
其中,rI表示探测器到强光天体的方向矢量在惯性系下的分量,CBI表示探测器的姿态余弦矩阵;[rI×]为叉乘矩阵,具体形式为,
将(13)表示成更加紧凑的形式,得到(16)式中的二次约束形式,
qTKq≤0 (16)
其中,q=[q0 q1 q2 q3]T
步骤三得到的姿态四元数能够利用式(16)进行判断,假如满足,那么输出该四元数q(k+1)和角速度ω(k+1)到步骤一所述的参考模型进行循环,假如不满足,令,
式中,p=[cos(π/4) sin(π/4) 0 0]T
步骤五:在给出探测器的起始姿态和目标姿态条件下,通过实现上述步骤一、二、三、四闭环规划系统循环,规划出满足约束的路径节点和生成节点的控制力矩,能够生成探测器姿态机动路径和所需要的控制力矩,按照生成探测器姿态机动路径和所需要的控制力矩实现探测器机动到目标姿态。
CN201610187160.0A 2015-12-28 2016-03-29 一种基于滑模控制的深空探测器约束姿态机动规划方法 Active CN105867395B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN2015110011562 2015-12-28
CN201511001156 2015-12-28

Publications (2)

Publication Number Publication Date
CN105867395A CN105867395A (zh) 2016-08-17
CN105867395B true CN105867395B (zh) 2018-08-28

Family

ID=56625100

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610187160.0A Active CN105867395B (zh) 2015-12-28 2016-03-29 一种基于滑模控制的深空探测器约束姿态机动规划方法

Country Status (1)

Country Link
CN (1) CN105867395B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107329485B (zh) * 2017-07-12 2020-02-14 北京理工大学 一种快速的多约束航天器姿态路径递归规划方法
CN108536014B (zh) * 2018-04-04 2020-02-21 北京航空航天大学 一种考虑飞轮动态特性的航天器姿态规避的模型预测控制方法
CN109283934B (zh) * 2018-11-06 2020-08-21 北京理工大学 基于旋转路径质量的航天器多约束姿态机动优化方法
CN109254589B (zh) * 2018-11-23 2020-05-29 北京理工大学 带可动相机探测器的姿态机动规划方法
CN112269390B (zh) * 2020-10-15 2021-09-21 北京理工大学 考虑弹跳的小天体表面定点附着轨迹规划方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1851598A (zh) * 2006-06-02 2006-10-25 哈尔滨工业大学 深空探测器大角度机动路径自主生成方法
CN103853157A (zh) * 2014-03-19 2014-06-11 湖北蔚蓝国际航空学校有限公司 一种基于自适应滑模的飞行器姿态控制方法
CN104635740A (zh) * 2014-12-23 2015-05-20 北京理工大学 一种深空探测器自主姿态机动控制方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1851598A (zh) * 2006-06-02 2006-10-25 哈尔滨工业大学 深空探测器大角度机动路径自主生成方法
CN103853157A (zh) * 2014-03-19 2014-06-11 湖北蔚蓝国际航空学校有限公司 一种基于自适应滑模的飞行器姿态控制方法
CN104635740A (zh) * 2014-12-23 2015-05-20 北京理工大学 一种深空探测器自主姿态机动控制方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
深空探测器复杂约束姿态机动规划;程小军等;《中国宇航学会深空探测技术专业委员会第五届学术年会论文集》;20081231;第175-179页 *
深空探测器自主技术发展现状与趋势;崔平远等;《航空学报》;20140125;第35卷(第1期);第13-28页 *

Also Published As

Publication number Publication date
CN105867395A (zh) 2016-08-17

Similar Documents

Publication Publication Date Title
CN105867395B (zh) 一种基于滑模控制的深空探测器约束姿态机动规划方法
Lee et al. Feedback control for spacecraft reorientation under attitude constraints via convex potentials
Mahony et al. Dynamic image-based visual servo control using centroid and optic flow features
Zhou et al. Robust prescribed performance tracking control for free-floating space manipulators with kinematic and dynamic uncertainty
Pérez-Alcocer et al. A robust approach for trajectory tracking control of a quadrotor with experimental validation
Dai et al. Path planning of spatial rigid motion with constrained attitude
CN104635740A (zh) 一种深空探测器自主姿态机动控制方法
Zhang et al. Adaptive control on SE (3) for spacecraft pose tracking with harmonic disturbance and input saturation
Islam et al. Adaptive sliding mode control of unmanned four rotor flying vehicle
Qin et al. Fuzzy adaptive robust control for space robot considering the effect of the gravity
Hu et al. Recursive decentralized control for robotic manipulators
Maclean et al. Planning natural repointing manoeuvres for nano-spacecraft
Muralidharan Orbit maintenance strategies for sun-earth/moon libration point missions: Parameter selection for target point and cauchy-green tensor approaches
Wong et al. Adaptive learning control for spacecraft formation flying
Guo et al. Nonlinear vision-based observer for visual servo control of an aerial robot in global positioning system denied environments
Han et al. Trajectory tracking control for underactuated autonomous vehicles via adaptive dynamic programming
Calderón et al. qLPV predictive control-A benchmark study on state space vs input-output approach
Chen et al. Robust control of quadrotor MAV using self‐organizing interval type‐II fuzzy neural networks (SOIT‐IIFNNs) controller
CN108427429A (zh) 一种考虑动态指向约束的航天器视轴机动控制方法
Chávez-Moreno et al. Contracting angular velocity observer for small satellites
Zamani et al. Continuous-time nonlinear robust MPC for offset-free tracking of piece-wise constant setpoints with unknown disturbance
Huang et al. Nonlinear Robust $ H_ {\infty} $ Control for Spacecraft Body-Fixed Hovering Around Noncooperative Target Via Modified $\theta-D $ Method
Tang et al. Estimation of imu orientation using nesterov’s accelerated gradient improved by fuzzy control rule
Zheng et al. A coordinated trajectory tracking method with active utilization of drag for underwater vehicle manipulator systems
AlShabi et al. Modeling and implementing the behavior of RR robot using FPGA

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