CN108427429B - 一种考虑动态指向约束的航天器视轴机动控制方法 - Google Patents
一种考虑动态指向约束的航天器视轴机动控制方法 Download PDFInfo
- Publication number
- CN108427429B CN108427429B CN201810269782.7A CN201810269782A CN108427429B CN 108427429 B CN108427429 B CN 108427429B CN 201810269782 A CN201810269782 A CN 201810269782A CN 108427429 B CN108427429 B CN 108427429B
- Authority
- CN
- China
- Prior art keywords
- vector
- spacecraft
- coordinate system
- constraint
- control
- 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
- 230000000007 visual effect Effects 0.000 title claims abstract description 44
- 238000000034 method Methods 0.000 title claims abstract description 39
- 238000013178 mathematical model Methods 0.000 claims abstract description 3
- 239000013598 vector Substances 0.000 claims description 103
- 239000011159 matrix material Substances 0.000 claims description 18
- 238000005381 potential energy Methods 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 125000004432 carbon atom Chemical group C* 0.000 claims description 3
- 150000001875 compounds Chemical class 0.000 claims description 2
- 230000009466 transformation Effects 0.000 claims description 2
- 238000004891 communication Methods 0.000 abstract description 4
- 238000004422 calculation algorithm Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 238000007792 addition Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 230000009467 reduction Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000005358 geomagnetic field Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000006467 substitution reaction 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
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种考虑动态指向约束的航天器视轴机动控制方法,包括建立航天器视轴控制系统模型,提出动态约束的数学模型并建立势函数以及设计系统的控制律的步骤,针对航天器视轴机动控制问题,考虑航天器旋转空间中存在动态指向约束的实际问题,提出了一种与势函数方法结合的航天器控制律,使航天器能够完成控制任务并自主实现对于动态约束的满足,该方法保证空间存在动态指向约束时航天器姿态控制系统的稳定性,并且能够自主规避约束,减少了航天器对于地面通讯的需求,提高了航天器的自主控制能力。
Description
技术领域
本发明涉及航天器控制技术领域,具体涉及一种考虑动态指向约束的航天器视轴机动控制方法,主要应用于航天器在空间中进行视轴机动任务且空间中存在视轴的动态指向性约束的情形,提出了一种控制方法使得航天器在进行视轴机动控制时能够自主对动态约束进行规避。
背景技术
航天器的姿态控制问题是航天器控制不可分割的一部分,有很重要的工程应用意义。一般的姿态控制问题中设计者使用航天器的全部姿态信息,但是,在一些控制任务中,并不需要航天器的所有的姿态信息。例如,在控制航天器星载照相机、太阳电池阵列或者天线等仪器的指向任务中,只需要考虑该仪器视轴的指向,而不需要考虑绕这个视轴的旋转姿态。此外,由于传感器故障等一些因素,在一些情况下航天器的全部姿态信息也不能完全得到。因此,基于这些应用,视轴控制方法被提出。视轴控制方法是利用航天器的视轴信息进行机动控制的,这种控制只包含视轴位置信息而不包含关于视轴旋转的信息,与全姿态信息具有三个自由度相比,视轴控制方法只有两个自由度。
由于部分星载敏感仪器如CCD相机、红外照相机等镜头对光线比较敏感,不能直接对准强光物体,如太阳等,因此这些仪器的视轴在空间中存在一定的指向约束,并且这些约束在惯性坐标系下在一些情况下是时变的,即动态指向约束。对于姿态约束问题,主要自主处理方法分为势函数法与路径规划方法,其中,势函数法是通过设计势函数使得障碍区的势能处于高势,目标位置处于低势,设计控制律使得系统朝着势函数降低的方向运行,这样就能使得系统避免障碍区并最终到达目标位置。路径规划法是在系统运行之前将整个运行的路径做出详细的规划,然后是系统按照规划好的路径运行,但是这种方法随着障碍区的增多计算量也会随着增加。实时控制算法增加了航天器对地面通讯的依赖性,在通讯受限时有很大的约束性。中国专利CN201610323291.7基于几何分析提出另外空间飞行器的单轴指向纯磁控算法,通过磁力矩器输出的磁力矩与地磁场相互作用来实现单轴控制,但是该方法仅考虑了磁控算法,并没有考虑单轴的指向约束。中国专利CN201710521561.X中考虑了姿态约束与处理抗退绕的航天器姿态机动控制问题,将姿态约束与抗退绕问题结合起来,提出了新的势函数,但是该方法中使用了姿态四元素来表示航天器的姿态,即需要航天器姿态的全部信息,并且该发明仅考虑了静态约束而没有考虑动态约束。
发明内容
本发明的目的在于克服现有技术的不足,提供一种考虑动态指向约束的航天器视轴机动控制方法,利用视轴控制的方法来处理动态指向性约束问题,针对航天器姿态控制中,只要求航天器某一视轴的指向目标位置,对航天器关于该视轴的旋转没有控制要求,并且该视轴在空间中存在动态指向约束的问题,提出了一种与势函数结合的视轴控制方法,使得航天器能够完成机动任务并且在机动过程中能够自主地满足动态指向约束,避免仪器的损坏。
本发明提供一种考虑动态指向约束的航天器视轴机动控制方法,包括以下步骤:
(1)基于航天器姿态动力学和运动学模型建立航天器视轴控制系统模型;
(2)基于步骤(1)建立的航天器视轴控制系统模型,根据要求的动态指向约束,提出约束的数学模型并建立势函数;
(3)在步骤(2)建立的势函数的基础上,对于步骤(1)建立的航天器视轴控制系统模型,设计系统的控制律,实现航天器对于视轴的机动控制并满足动态指向约束。
其中,所述步骤(1)具体为:
设本体坐标系下单位向量a=[a1,a2,a3]T固连于航天器视轴上,a1,a2,a3分别为向量a在本体坐标系下的各坐标轴上的分量;
惯性坐标系下单位向量bI=[bI1,bI2,bI3]T指向固定的目标位置,bI1,bI2,bI3分别为在惯性坐标系各坐标轴上的分量,单位向量fI(t)=[fI1(t),fI2(t),fI3(t)]T指向障碍物,fI1(t),fI2(t),fI3(t)分别为惯性坐标系各轴上的坐标分量;惯性坐标系下,向量bI为常向量,向量fI(t)为时变向量;
设3×3的正交矩阵R为本体坐标系相对于惯性坐标系的旋转矩阵,令向量b=[b1,b2,b3]T表示向量bI在本体坐标系下的向量表示,b1,b2,b3分别为向量b在本体坐标系各坐标轴上的向量分量,向量f=[f1,f2,f3]T表示向量fI在本体坐标系下的向量表示,f1,f2,f3为向量f在本体坐标系各轴上的分量,则有
b=RTbI
f=RTfI
向量a,b和f在本体坐标系下的运动学方程为
其中,向量与分别表示向量a,b与f在本体坐标系下关于时间的导数,ω=[ω1,ω2,ω3]Trad/s为航天器本体坐标系相对于惯性坐标系的角速度,其中,ω1,ω2,ω3分别为关于本体系中的横滚轴、偏航轴和俯仰轴上的角速度分量,向量表示向量fI在惯性坐标系下关于时间的导数,角标×表示将3×1的向量转换为3×3的斜对阵矩阵,其形式为
航天器的动力学方程为
其中,所述步骤(2)具体为:
设指向约束允许的向量a与f之间的最小夹角为固定角度θm,则该约束的数学表达式为
fTa=cosθ<cosθm;
上式中,θ∈[0,π]为向量a与f之间的夹角;
向量a与向量b之间的误差函数定义为
根据动态约束的条件,以及结合误差函数,势函数为:
其中,所述步骤(3)中设计的系统控制律如下:
τ=-k1x-k2ω;
其中,k1与k2为正常数,为开发人员或者用户自己设计的控制器参数,ω为角速度向量,3×1 的实数向量x为设计的与势函数结合的控制向量,其定义为
本发明的考虑动态指向约束的航天器视轴机动控制方法,可以实现:
1)本发明与传统的航天器姿态控制方法相比,使用视轴机动控制的方法,与全姿态控制方法相比减少了需要的信息量,能够适用于航天器姿态信息有限的情形;
2)本发明中考虑了动态的视轴指向约束,与传统的实时控制算法相比,这种利用势函数法的方法能够使航天器自主避开约束区,减少航天器对于地面通讯的依赖,提高航天器在轨自主运行能力。
附图说明
图1为一种考虑动态指向约束的航天器视轴机动控制方法的设计流程图;
图2为一种考虑动态指向约束的航天器视轴机动控制方法原理框图。
具体实施方式
下面详细说明本发明的具体实施,有必要在此指出的是,以下实施只是用于本发明的进一步说明,不能理解为对本发明保护范围的限制,该领域技术熟练人员根据上述本发明内容对本发明做出的一些非本质的改进和调整,仍然属于本发明的保护范围。
本发明提供了一种考虑动态指向约束的航天器视轴机动控制方法,如附图1所示,其具体步骤为:首先建立航天器视轴机动控制的动力学与运动学模型;然后根据基于动态的指向约束和机动目标建立误差函数与势函数;接着,设计控制器使得系统朝着势能减小的方向运行,整个系统的原理框图如图2所示;具体实施步骤如下:
第一步,建立航天器视轴机动控制的运动学模型:假设在本体坐标系下单位向量a=[a1,a2,a3]T为固连于航天器视轴,a1,a2,a3分别为向量a本体坐标系各轴向上的分量,这里取 a=[1,0,0]T。惯性坐标系下,单位向量bI=[bI1,bI2,bI3]T指向固定目标,bI1,bI2,bI3分别为向量bI在惯性坐标系各轴上的分量,这里取bI=[-0.8924,0.2391,0.3827]T。单位向量fI(t)=[fI1(t),fI2(t),fI3(t)]T在惯性坐标系下指向障碍物,为时变向量,fI1(t),fI2(t),fI3(t) 分别为向量fI(t)在惯性坐标系各轴向上的分量,这里取设正交矩阵表示本体坐标系相对于惯性坐标系的旋转矩阵,用单位四元素表示初始条件为Q=[q1,q2,q3,q0]T=[1,0,0,0]T。令 b=[b1,b2,b3]T表示向量bI在本体坐标系下表示,b1,b2,b3分别为向量b在本体坐标系各轴向上的分量,f=[f1,f2,f3]T为向量fI在本体坐标下的向量表示,f1,f2,f3分别为向量f在本体坐标系各轴向上的分量,则有
b=RTbI
f=RTfI
旋转矩阵R的运动学方程为
式中,ω=[ω1,ω2,ω3]T表示航天器本体坐标系相对于惯性坐标系的姿态角速度向量,ω1,ω2,ω3分别为关于本体系中的横滚轴、偏航轴和俯仰轴上的角速度分量,这里取角速度初值为ω(0)=[0,0,0]Trad/s。其中,ω×表示一类关于向量ω的斜对称矩阵,其形式如下:
向量a,b,f在本体坐标系下的运动学方程分别为
上式中,为向量fI在惯性坐标系下关于时间的导数,ω=[ω1,ω2,ω3]Trad/s表示航天器在本体坐标系下相对于惯性坐标系的角速度,ω1,ω2,ω3分别为卫星的横滚角速度、偏航角速度以及俯仰角速度;
航天器的动力学方程为
其中,J表示航天器的转动惯量矩阵,为3×3的对称正定矩阵,这里取 J=diag([300,200,190])kg·m2;表示航天器的角加速度向量;τ=[τ1,τ2,τ3]T表示系统的控制力矩,τ1,τ2,τ3分别为航天器本体各轴向上执行机构提供的实际控制力矩。
第二步,建立姿态约束的模型:
假设向量a与向量f之间的夹角为θ∈[0,π],则有
fTa=cosθ
设允许的θ的最小值为θm,则该约束的数学表达式为
cosθ<cosθm
定义误差函数为
根据该势函数设计控制律为
τ=-k1x-k2ω
其中,k1和k2为用户自己设计的控制器参数,这里取k1=50,k2=5,ω为角速度向量,向量x为设计的与势函数结合的向量,定义为
其中,向量a,b,f为上述内容中定义的向量,分别为向量a与b,a与f之间的夹角,θm为允许的向量a与f之间的最小夹角,向量为向量fI在惯性坐标系下关于时间的导数,根据上面fI的取值,这里有ε是为了防止奇异加入的正极小量,这里取ε=0.01。
通过以上系统联合仿真,可以得到存在动态指向约束的航天器视轴控制输出,该方法能够解决动态指向约束问题,使得航天器的角速度在有限时间内收敛,并且视轴最后指向目标位置,并且在机动过程中能够自主避开约束区,完成控制任务,提高航天器自主控制能力。
尽管为了说明的目的,已描述了本发明的示例性实施方式,但是本领域的技术人员将理解,不脱离所附权利要求中公开的发明的范围和精神的情况下,可以在形式和细节上进行各种修改、添加和替换等的改变,而所有这些改变都应属于本发明所附权利要求的保护范围,并且本发明要求保护的产品各个部门和方法中的各个步骤,可以以任意组合的形式组合在一起。因此,对本发明中所公开的实施方式的描述并非为了限制本发明的范围,而是用于描述本发明。相应地,本发明的范围不受以上实施方式的限制,而是由权利要求或其等同物进行限定。
Claims (3)
1.一种考虑动态指向约束的航天器视轴机动控制方法,其特征在于,包括以下步骤:
(1)基于航天器姿态动力学和运动学模型建立航天器视轴控制系统模型;
(2)基于步骤(1)建立的航天器视轴控制系统模型,根据要求的动态指向约束,提出约束的数学模型并建立势函数;
(3)在步骤(2)建立的势函数的基础上,对于步骤(1)建立的航天器视轴控制系统模型,设计系统的控制律,实现航天器对于视轴的机动控制并满足动态指向约束;
所述步骤(1)具体为:
设本体坐标系下单位向量a=[a1,a2,a3]T固连于航天器视轴上,a1,a2,a3分别为向量a在本体坐标系下的各坐标轴上的分量;
惯性坐标系下单位向量bI=[bI1,bI2,bI3]T指向固定的目标位置,bI1,bI2,bI3分别为在惯性坐标系各坐标轴上的分量,单位向量fI(t)=[fI1(t),fI2(t),fI3(t)]T指向障碍物,fI1(t),fI2(t),fI3(t)分别为惯性坐标系各坐标轴上的分量;惯性坐标系下,向量bI为常向量,向量fI(t)为时变向量;
设3×3的正交矩阵R为本体坐标系相对于惯性坐标系的旋转矩阵,令向量b=[b1,b2,b3]T表示向量bI在本体坐标系下的向量表示,b1,b2,b3分别为向量b在本体坐标系各坐标轴上的向量分量,向量f=[f1,f2,f3]T表示向量fI在本体坐标系下的向量表示,f1,f2,f3为向量f在本体坐标系各轴上的分量,则有
b=RTbI
f=RTfI
向量a,b和f在本体坐标系下的运动学方程为
其中,向量与分别表示向量a,b与f在本体坐标系下关于时间的导数,ω=[ω1,ω2,ω3]Trad/s为航天器本体坐标系相对于惯性坐标系的角速度,其中,ω1,ω2,ω3分别为关于本体系中的横滚轴、偏航轴和俯仰轴上的角速度分量,向量表示向量fI在惯性坐标系下关于时间的导数,角标×表示将3×1的向量转换为3×3的斜对阵矩阵,其形式为
航天器的动力学方程为
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810269782.7A CN108427429B (zh) | 2018-03-29 | 2018-03-29 | 一种考虑动态指向约束的航天器视轴机动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810269782.7A CN108427429B (zh) | 2018-03-29 | 2018-03-29 | 一种考虑动态指向约束的航天器视轴机动控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108427429A CN108427429A (zh) | 2018-08-21 |
CN108427429B true CN108427429B (zh) | 2020-07-03 |
Family
ID=63159985
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810269782.7A Active CN108427429B (zh) | 2018-03-29 | 2018-03-29 | 一种考虑动态指向约束的航天器视轴机动控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108427429B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111240297A (zh) * | 2018-11-28 | 2020-06-05 | 中国科学院沈阳自动化研究所 | 基于Kalman滤波器的航天器姿控系统故障诊断方法 |
CN110262537B (zh) * | 2019-06-28 | 2020-07-07 | 北京理工大学 | 多约束下航天器快速姿态机动参数化确定性规划方法 |
CN114879708B (zh) * | 2022-04-19 | 2023-03-14 | 四川大学 | 一种固定时间收敛的航天器姿态跟踪抗退绕控制方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5092543A (en) * | 1989-09-27 | 1992-03-03 | General Electric Company | Spacecraft attitude control with avoidance constraint |
CN102331785B (zh) * | 2011-07-16 | 2014-04-16 | 北京理工大学 | 一种航天器指向约束姿态机动控制方法 |
CN103019091B (zh) * | 2012-12-20 | 2015-04-22 | 北京航空航天大学 | 一种基于线性扩张状态观测器的柔性航天器容错姿态控制方法 |
CN104635740B (zh) * | 2014-12-23 | 2017-03-01 | 北京理工大学 | 一种深空探测器自主姿态机动控制方法 |
CN105468007B (zh) * | 2015-12-02 | 2018-07-06 | 哈尔滨工业大学 | 一种基于干扰观测器的挠性卫星轨迹线性化姿态控制方法 |
CN105867406B (zh) * | 2016-05-30 | 2017-08-08 | 北京航空航天大学 | 一种组合体航天器闭环反馈最优控制分配方法 |
CN107168357B (zh) * | 2017-06-30 | 2018-08-07 | 北京航空航天大学 | 一种考虑姿态约束与抗退绕的航天器姿态机动控制方法 |
-
2018
- 2018-03-29 CN CN201810269782.7A patent/CN108427429B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN108427429A (zh) | 2018-08-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Lee et al. | Adaptive image-based visual servoing for an underactuated quadrotor system | |
CN105786024B (zh) | 一种基于模型误差补偿的机载光电平台高精度跟踪控制器及其跟踪控制方法 | |
Rysdyk | UAV path following for constant line-of-sight | |
CN108381553B (zh) | 一种用于空间非合作目标捕获的相对导航近距离跟踪方法及系统 | |
CN104527994B (zh) | 异面交叉快变轨道固定时间稳定姿态指向跟踪控制方法 | |
CN108845588B (zh) | 一种基于非线性制导的四旋翼飞行器轨迹跟踪控制方法 | |
CN106985139A (zh) | 基于扩展状态观测与补偿的空间机器人自抗扰协调控制方法 | |
CN106970530B (zh) | 空间非合作目标自主视线交会的无模型预设性能控制方法 | |
CN108427429B (zh) | 一种考虑动态指向约束的航天器视轴机动控制方法 | |
Meng et al. | Vibration suppression control of free-floating space robots with flexible appendages for autonomous target capturing | |
Zhao et al. | Adaptive saturated control for spacecraft rendezvous and docking under motion constraints | |
Li et al. | Extended state observer based output control for spacecraft rendezvous and docking with actuator saturation | |
CN113371231B (zh) | 一种带约束的航天器姿态控制方法 | |
CN112572835B (zh) | 一种具有姿态切换的卫星在轨角动量管理及控制方法 | |
CN109677637A (zh) | 基于光学测角相机的空间非合作目标跟踪指向方法 | |
Chen et al. | Autonomous flight control for multi-rotor UAVs flying at low altitude | |
Zhang et al. | Output-feedback super-twisting control for line-of-sight angles tracking of non-cooperative target spacecraft | |
Mills et al. | Vision based control for fixed wing UAVs inspecting locally linear infrastructure using skid-to-turn maneuvers | |
CN105382843A (zh) | 一种抓捕末阶段机械臂与操作平台协调控制方法 | |
Sun et al. | Adaptive relative pose control of spacecraft with model couplings and uncertainties | |
CN108663052A (zh) | 一种星上自主空间非合作目标相对导航相机指向控制方法 | |
Chen et al. | Image-based visual servoing of unmanned aerial manipulators for tracking and grasping a moving target | |
CN116142490A (zh) | 复杂约束下基于势函数的航天器姿态重定向控制方法 | |
Xie et al. | Adaptive visual servoing of UAVs using a virtual camera | |
CN115480583A (zh) | 飞行作业机器人的视觉伺服跟踪与阻抗控制方法 |
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 |