CN112660423A - 一种视频卫星对运动目标的凝视跟踪控制方法及系统 - Google Patents
一种视频卫星对运动目标的凝视跟踪控制方法及系统 Download PDFInfo
- Publication number
- CN112660423A CN112660423A CN202011496677.0A CN202011496677A CN112660423A CN 112660423 A CN112660423 A CN 112660423A CN 202011496677 A CN202011496677 A CN 202011496677A CN 112660423 A CN112660423 A CN 112660423A
- Authority
- CN
- China
- Prior art keywords
- satellite
- attitude
- coordinate system
- video
- earth
- 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 57
- 239000013598 vector Substances 0.000 claims abstract description 75
- 230000001133 acceleration Effects 0.000 claims abstract description 10
- 239000011159 matrix material Substances 0.000 claims description 65
- 230000006870 function Effects 0.000 claims description 15
- 230000009466 transformation Effects 0.000 claims description 11
- 230000007704 transition Effects 0.000 claims description 11
- 238000006243 chemical reaction Methods 0.000 claims description 8
- 238000004590 computer program Methods 0.000 claims description 6
- 238000004458 analytical method Methods 0.000 claims description 5
- 238000009795 derivation Methods 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000009977 dual effect Effects 0.000 claims description 3
- 230000007246 mechanism Effects 0.000 claims description 2
- 125000004432 carbon atom Chemical group C* 0.000 claims 1
- 238000013461 design Methods 0.000 abstract description 5
- 230000004044 response Effects 0.000 abstract description 4
- 230000003068 static effect Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 11
- 238000003384 imaging method Methods 0.000 description 7
- 230000036544 posture Effects 0.000 description 7
- 230000008569 process Effects 0.000 description 7
- 238000004088 simulation Methods 0.000 description 6
- 230000033001 locomotion Effects 0.000 description 5
- 230000003044 adaptive effect Effects 0.000 description 4
- 238000011160 research Methods 0.000 description 4
- 241000287181 Sturnus vulgaris Species 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 238000012795 verification Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000002068 genetic effect Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 150000003839 salts Chemical class 0.000 description 1
Images
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种视频卫星对运动目标的凝视跟踪控制方法及系统,旨在解决视频卫星对一类地面运动的目标进行凝视跟踪控制的问题。首先,基于双矢量方法计算卫星相对于地球惯性坐标系的期望姿态四元素;然后,进一步计算卫星的期望姿态角速度和期望姿态角加速度;接下来建立卫星的姿态运动学和动力学方程;之后基于误差四元数和误差姿态角速度,建立视频卫星对运动目标的凝视姿态跟踪模型;最后设计PD控制器进行卫星的姿态控制。本发明能够在跟踪静止以及低、中、高速运动目标时,均能保证较好的控制收敛性,且响应速度快,鲁棒性好,本发明可为视频卫星对运动目标凝视跟踪姿态控制器的设计提供技术参考和支持。
Description
技术领域
本发明属于视频卫星设计领域,具体涉及一种视频卫星对运动目标的凝视跟踪控制方法及系统。
背景技术
视频卫星是最近几年发展起来的一种新型对地观测卫星,是一种采用视频成像、视频数据实时传输、工作方式为人在回路交互式操作的小卫星,与传统的对地观测卫星相比,其最大的特点是可以对某一目标区域进行“凝视”观测,获取该区域连续的视频信息。目前,已有一定数量的视频卫星在轨运行,其中国外的有:印度尼西亚的LAPAN—TUBSAT卫星、美国的Skysat系列卫星等;国内的有:“天拓二号”卫星、“吉林一号”卫星等。视频卫星对抢险救灾、战场监控、交通监测等发挥着至关重要的作用。所谓视频卫星凝视成像,是指卫星在对地观测过程中,通过姿态控制系统实时调整卫星的姿态,使其光学遥感器始终对准某一目标区域并进行连续拍摄,获取目标区域的视频数据。
近年来,人们对视频卫星的姿态凝视跟踪问题进行了大量研究并且积累了丰富的实践经验。文献“Adaptive attitude tracking control for rigid spacecraft withfinite-time convergence”(作者:Kunfeng Lu,Yuanqing Xia;期刊:Automatica;年份:2013;卷:49;页码3591–3599)根据刚体动力学推导了基于误差四元数和误差角速度的卫星姿态跟踪运动学方程和动力学方程,设计了一种自适应有限时间终端滑模控制方法,很好的满足了卫星姿态控制快速性和高精度两个要求;文献“低轨对地凝视卫星姿态控制”(作者:邬树楠,孙兆伟,叶东;期刊:上海航天;年份:2010;页码:15-19)在低轨卫星对地凝视的姿态控制研究中采用了一种变结构控制律,该控制较传统PD控制响应速度更快,具有较好的鲁棒性,而且能有效增加对地凝视时间;文献“Adaptive Fuzzy Sliding Mode ControlFor Flexible Satellite”(作者:Ping Guan,Xiang-Jie Liu,Ji-Zhen Liu;期刊:Engineering Application of Artificial Intelligence;年份:2005;卷:18;页码:451-459)针对航天器的姿态跟踪控制问题,提出了自适应模糊滑模控制方法,将模糊规则运用到滑模控制中的到达控制部分,使得控制增益得到动态减小,抖振得到有效的减弱;文献“视频小卫星对地凝视高稳定度姿态控制方法研究”(作者:黄富强;单位:国防科学技术大学;类型:硕士学位论文;年份:2016)以视频卫星对多目标凝视成像的任务需求为研究对象,提出了一种基于混合双层编码遗传算法的多指标优化凝视观测任务规划方法,该方法能计算得到对多目标观测时使指标函数达到最优的观测顺序;文献“低轨对地凝视卫星姿态模糊控制器设计”(作者:孙兆伟,梁朝海,邬树楠;期刊:上海航天;年份:2010;卷(期):27(6);页码:1-5)以视频卫星凝视成像精度高、成像时间长为目标,设计了一种滑模控制率,并且采用干扰观测器来抑制滑模控制的固有振颤,设计的控制器能明显改善响应速度,并有效减弱了振颤问题。但是,上述现有技术文献资料都是针对地面固定目标开展的凝视跟踪控制研究,没有考虑地面运动目标的凝视跟踪问题。
发明内容
本发明要解决的技术问题是:提供一种视频卫星对运动目标的凝视跟踪控制方法及系统,旨在解决视频卫星对一类地面运动的目标进行凝视跟踪控制的问题。
为了解决上述技术问题,本发明所采用的技术方案是:
一种视频卫星对运动目标的凝视跟踪控制方法,在运动目标的凝视跟踪控制时,针对预设的视频卫星姿态凝视跟踪模型采用PD控制器进行卫星的姿态控制,所采用PD控制器的函数表达式为:
上式中,T为所述PD控制器输出的控制力矩;系数Kp=e5a·kp,系数Kd=[(1-e-5a)]·kd,其中系数kp、kd是常值正定矩阵,qeυ为姿态误差四元数qe的矢量;we为姿态误差角速度;A(qe)为期望坐标系到卫星本体坐标系的转换矩阵,qe为姿态误差四元数;wt为期望姿态角速度,为期望姿态角速度wt的导数;J为卫星转动惯量,h为执行机构的动量矩;其中:
其中,qe0为姿态误差四元数qe的标量,I表示单位矩阵,I3表示三阶单位矩阵;上标T表示矩阵的转置;(·)×表示斜对称矩阵算子,对任意向量x=[x1 x2 x3]T,有且斜对称矩阵算子为:
可选地,所述预设的视频卫星姿态凝视跟踪模型的函数表达式为:
上式中,J为卫星转动惯量,为姿态误差角速度的导数,we为姿态误差角速度,A(qe)为期望坐标系到卫星本体坐标系的转换矩阵,wt为期望姿态角速度,为期望姿态角速度的导数,qe0为姿态误差四元数qe的标量,qev为姿态误差四元数qe的矢量,(·)×表示斜对称矩阵算子,T为PD控制器输出的控制力矩,Td为干扰力矩。
可选地,所述针对预设的视频卫星姿态凝视跟踪模型采用PD控制器进行卫星的姿态控制之前还包括推导视频卫星姿态凝视跟踪模型的步骤:
S1、基于双矢量方法计算视频卫星相对于地球惯性坐标系的期望姿态四元素;;
S2、计算视频卫星的期望姿态角速度和期望姿态角加速度;
S3、建立视频卫星的姿态跟踪运动学方程和姿态跟踪动力学方程;
S4、基于误差四元数和误差姿态角速度,建立视频卫星对运动目标的凝视姿态跟踪模型。
可选地,步骤S1包括:
S1.1、坐标系定义:地球惯性坐标系Oi-XiYiZi,选用J2000.0坐标系,以地心为坐标系原点,OiZi轴指向J2000.0年平赤道的极点,OiXi轴指向J2000.0平春分点,OiYi轴与OiXi轴和OiZi轴构成右手坐标系;地球固连坐标系为Oe-XeYeZe,以地心为坐标系原点,OeZe指向地球北极,OeXe指向地球赤道面与格林尼治子午线的交点,OeYe在赤道平面内与OeXe轴和OeZe轴构成右手坐标系;卫星本体坐标系为Ob-XbYbZb,以卫星的质心为坐标系原点,三个坐标轴方向分别沿着卫星本体惯量主轴的三个方向;期望坐标系Ot-XtYtZt,以卫星本体坐标系为参考,坐标系原点为卫星质心,并根据目标姿态角确定期望坐标系相对卫星本体坐标系的位置。
S1.2、采用双矢量方法计算视频卫星凝视时的期望姿态:首先计算凝视目标对应的地面点T0(LT0,BT0,HT0)、T1(LT1,BT1,HT1)在地球惯性坐标系的位置矢量RT0(XT0,YT0,ZT0)、RT1(XT1,YT1,ZT1),地面点中的三元素L、B、H分别表示地面点地理经度、地面点地理纬度、地面点高程;位置矢量中的三元素分别表示XYZ轴坐标;
S1.3、计算卫星质心指向地面点T0、T1的矢量分别在地球惯性坐标系和卫星本体坐标系中的分量:
其中,RT0表示地面点T0在地球惯性坐标系的位置矢量,RC表示卫星质心在地球惯性坐标系的位置矢量;
计算卫星质心指向地面点T1的矢量在地球惯性坐标系中分量:
其中,RT1表示地面点T1在地球惯性坐标系的位置矢量,RC表示卫星质心在地球惯性坐标系的位置矢量;
计算卫星质心指向地面点T1的矢量在卫星本体坐标系中分量:
S1.4、由卫星质心指向地面点T0的矢量CT0在地球惯性坐标系中的分量的和在卫星本体坐标系中的分量以及卫星质心指向地面点T1的矢量CT1在地球惯性坐标系中的分量和在卫星本体坐标系中的分量通过非共线双矢量构建期望坐标系,由此得到对地凝视期望姿态下地球惯性坐标系到卫星本体坐标系的转换矩阵:
以CT0和CT1两个非共线矢量构建过渡坐标系O1-X1Y1Z1为:
其中,O1X1,O1Y1,O1Z1分别为过渡坐标系O1-X1Y1Z1的三个轴;
可选地,步骤S2中计算视频卫星的期望姿态角速度和期望姿态角加速度时,采用下式计算视频卫星相对于地球惯性坐标系的期望姿态角速度ωt:
其中,wt为期望姿态角速度,qt为期望姿态四元数,为期望姿态四元数qt的导数,qt0为期望姿态四元数qt的标量;qtυ=[qt1 qt2 qt3]T为期望姿态四元数qt的矢量;上标T表示矩阵的转置,而上标×表示斜对称矩阵算子;I表示单位矩阵;为期望姿态四元数qt的导数,其中期望姿态角加速度的计算函数表达式为:
可选地,步骤S3中建立的视频卫星的姿态跟踪运动学方程的函数表达式为:
其中,qb=[qb0qb1qb2qb3]T=[qb0 qbv]T为地球惯性坐标系到卫星本体坐标系的姿态四元数,即真实姿态四元数,其中,qb0是真实姿态四元数qb的标量,qbv是真实姿态四元数qb的矢量;wb=[wbx wby wbz]T为卫星姿态角速度在卫星本体坐标系中的分量,即真实姿态角速度;I3表示三阶单位矩阵;上标T表示矩阵的转置;(·)×表示斜对称矩阵算子,对任意向量x=[x1 x2 x3]T,有
步骤S3中建立的视频卫星的姿态跟踪动力学方程的函数表达式为:
可选地,所述针对预设的视频卫星姿态凝视跟踪模型采用PD控制器进行卫星的姿态控制之前、推导得出视频卫星姿态凝视跟踪模型之后还包括对PD控制器进行稳定性分析的步骤:
A1、确定李雅普诺夫函数V的函数表达式为:
A2、对李雅普诺夫函数V求导,忽略卫星转动惯量不确定性和外界干扰,得到:
此外,本发明还提供一种视频卫星对运动目标的凝视跟踪控制系统,包括相互连接的微处理器和存储器,所述微处理器被编程或配置以所述视频卫星对运动目标的凝视跟踪控制方法的步骤,或者所述存储器中存储有被编程或配置以所述视频卫星对运动目标的凝视跟踪控制方法的计算机程序。
此外,本发明还提供一种视频卫星,包括卫星本体,所述卫星本体包括相互连接的微处理器和存储器,所述微处理器被编程或配置以执行所述视频卫星对运动目标的凝视跟踪控制方法的步骤,或者所述存储器中存储有被编程或配置以执行所述视频卫星对运动目标的凝视跟踪控制方法的计算机程序。
此外,本发明还提供一种计算机可读存储介质,该计算机可读存储介质中存储有被编程或配置以执行所述视频卫星对运动目标的凝视跟踪控制方法的计算机程序。
与现有技术相比,本发明技术方案具有下述有益效果:
本发明能够在跟踪静止以及低、中、高速运动目标时,均能保证较好的控制收敛性,且响应速度快,鲁棒性好,本发明可为视频卫星对运动目标凝视跟踪姿态控制器的设计提供技术参考和支持。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图示出的结构获得其他的附图。
图1为对地凝视姿态控制示意图。
图2为本发明实施例方法的基本流程图。
图3为本发明实施例中双矢量确定期望姿态原理图。
图4为本发明实施例方法在静止状态下的凝视跟踪控制结果:(a)为姿态误差曲线图;(b)为角速度误差曲线图;(c)为控制力矩曲线图。
图5为本发明实施例方法在低速状态下的凝视跟踪控制结果:(a)为姿态误差曲线图;(b)为角速度误差曲线图;(c)为控制力矩曲线图。
图6为本发明实施例方法在中速状态下的凝视跟踪控制结果:(a)为姿态误差曲线图;(b)为角速度误差曲线图;(c)为控制力矩曲线图。
图7为本发明实施例方法在高速状态下的凝视跟踪控制结果:(a)为姿态误差曲线图;(b)为角速度误差曲线图;(c)为控制力矩曲线图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
为了描述清晰起见,本发明中使用的相关变量符号的含义如下表1所示。
表1各变量或符号的含义
一、本发明的总体思路
视频卫星凝视成像,是指卫星在对地观测过程中,通过姿态控制系统实时调整卫星的姿态,使其光学遥感器始终对准某一目标区域并进行连续拍摄,获取目标区域的视频数据,如图1所示。
本发明为解决视频卫星对一类地面运动的目标进行凝视跟踪控制的问题,提出了一种视频卫星对运动目标的凝视跟踪控制方法,其总体思路如下:
首先,根据姿态运动学中四元数的相关理论知识和轨道运动学相关理论,推导视频卫星对目标点“凝视”时星体相对于地球惯性坐标系的期望姿态四元数,进一步计算得到期望姿态角速度和期望姿态角加速度,以获取它们的变化规律;然后,建立视频卫星姿态跟踪运动学和动力学方程;接下来,基于误差四元数和误差姿态角速度,建立视频卫星对运动目标的凝视姿态跟踪模型;最后,设计一种基于误差四元数和误差角速度反馈的姿态跟踪自适应PD控制器,并用李雅普诺夫稳定性理论证明闭环系统的稳定性。
二、本发明的具体实施步骤流程
基于上述总体思路,本发明所述控制方法的具体实施流程包括如图2所示的5个步骤S1-S5,具体描述如下:
步骤S1,基于双矢量方法计算视频卫星相对于地球惯性坐标系的期望姿态四元素;
首先对相关的坐标系进行定义:
地球惯性坐标系Oi-XiYiZi:选用J2000.0坐标系,它以地心为坐标系原点,OiZi轴指向J2000.0年平赤道的极点,OiXi轴指向J2000.0平春分点,OiYi轴与OiXi轴和OiZi轴构成右手坐标系。
地球固连坐标系Oe-ZeYeZe:它以地心为坐标系原点,OeZe指向地球北极,OeXe指向地球赤道面与格林尼治子午线的交点,OeYe在赤道平面内与OeXe轴和OeZe轴构成右手坐标系。
卫星本体坐标系Ob-XbYbZb:它以卫星的质心为坐标系原点,三个坐标轴方向分别沿着卫星本体惯量主轴的三个方向。
期望坐标系Ot-XtYtZt:它以卫星本体坐标系为参考,坐标系原点为卫星质心,并根据目标姿态角确定期望坐标系相对卫星本体坐标系的位置。
然后采用双矢量方法计算视频凝视时的期望姿态:
双矢量确定期望姿态的原理如图3所示。
首先计算地面点T0(LT0,BT0,HT0)、T1(LT1,BT1,HT1)在地球惯性坐标系的位置矢量RT0(XT0,YT0,ZT0)、RT1(XT1,YT1,ZT1),计算公式为:
其中,L为地面点地理经度,B为地面点地理纬度,H为地面点高程;
而N是法线与椭球面交点的卯酉半径,有:
式中,ee是大地子午圈的偏心率,其表达式为:
其中,ae是地球椭球长半轴,be是地球椭球短半轴。
由卫星质心指向地面点T0的矢量CT0在地球惯性坐标系中的分量的和在卫星本体坐标系中的分量以及卫星质心指向地面点T1的矢量CT1在地球惯性坐标系中的分量和在卫星本体坐标系中的分量通过非共线双矢量构建期望坐标系,由此得到对地凝视期望姿态下地球惯性坐标系到卫星本体坐标系的转换矩阵。
首先以CT0和CT1两个非共线矢量构建过渡坐标系O1-X1Y1Z1:
步骤S2,进一步计算视频卫星的期望姿态角速度和期望姿态角加速度;
步骤S3,建立视频卫星的姿态跟踪运动学和动力学方程;
视频卫星的姿态运动学方程用于描述各运动参数之间的相互关系,如角速度和姿态角导数之间的关系,而卫星的姿态动力学方程用于描述姿态运动(角速度)和作用力矩之间的关系。本发明基于四元数,建立视频卫星的姿态跟踪运动学和动力学方程。
1)姿态跟踪运动学方程
采用地球惯性坐标系到本体坐标系的四元数描述的姿态跟踪运动学方程表示为:
其中,qb=[qb0 qb1 qb2 qb3]T=[qb0 qbv]T为地球惯性坐标系到卫星坐标系的姿态四元数,即真实姿态四元数,其中,qb0是真实姿态四元数qb的标量,qbv是真实姿态四元数qb的矢量;上标“·”表示该变量的导数;wb=[wbx wby wbz]T为卫星姿态角速度在卫星本体坐标系中的分量,简称真实姿态角速度,即为在卫星本体坐标系中表示的卫星本体坐标系相对于地球惯性坐标系的角速度矢量;(·)×表示斜对称矩阵算子。
对任意向量x=[x1 x2 x3]T,有:
姿态运动学方程式(14)也可以表达为
2)姿态跟踪动力学方程
视频卫星采用刚体卫星假设,则卫星的姿态跟踪动力学方程为
式中,J∈R3×3为卫星的惯量矩阵;T∈R3×1控制力矩;Td∈R3×1外部干扰力矩。
步骤S4,基于误差四元数和误差姿态角速度,建立视频卫星对运动目标的凝视姿态跟踪模型;
卫星姿态跟踪即是对期望姿态的跟踪,因此,当视频卫星对地凝视成像时,根据四元数运算法则,定义姿态跟踪误差为
qe=qb·qt (18)
式中,qb为本体姿态四元数,即为地球惯性坐标系到卫星本体坐标系的卫星真实姿态四元数;qt是期望姿态四元数,即为地球惯性坐标系到期望坐标系的姿态四元数;qe为姿态误差四元数,即为期望坐标系到卫星本体坐标系的姿态四元数,它是相对于卫星本体坐标系的期望姿态,可认为是姿态跟踪误差。
由上式(18),可以进一步得到姿态角速度跟踪误差为
we=wb-A(qe)wt (19)
其中,wb为卫星姿态角速度在卫星本体坐标系中的分量,简称真实姿态角速度;wt为卫星姿态角速度在期望坐标系中的分量,简称期望姿态角速度;we为姿态误差角速度,是卫星本体坐标系相对于期望坐标系的误差姿态角速度,可认为是姿态角速度跟踪误差;A(qe)为期望坐标系到卫星本体坐标系的转换矩阵,由姿态误差四元数qe决定,满足
因此,姿态误差运动学方程为
对式(19)两边求导,可得:
上式(22)即为视频卫星对运动目标的凝视姿态跟踪模型。式(22)中,J为卫星的转动惯量矩阵,wb为卫星姿态角速度在本体坐标系中的分量,we为本体坐标系相对于期望坐标系的误差姿态角速度。
步骤S5,设计视频卫星的姿态跟踪自适应PD控制器。
PD控制器因其简单有效,运算资源需求小,实时性好,广泛运用于卫星的姿态控制系统中。根据式(22)表述的视频卫星姿态凝视跟踪模型,本发明设计的PD控制器如下:
该控制器设计的基本思想是初始阶段姿态误差角度较大时,能够实现快速机动至目标姿态附近,当接近目标时,又可以减小,运动速度,从而避免过大的超调,当到达控制目标后,又可以稳定在控制目标周围,且具有一定的鲁棒性。
对控制器进行稳定性分析,取李雅普诺夫函数V为
可以看出V≥0,当且仅当we=0,qeυ=0,qe0=1时等号成立,所以V是正定的。
对V求导数,不考虑卫星转动惯量不确定性和外界的干扰,得到:
三、仿真分析与效果验证
下面通过MATLAB/SIMULINK软件对本发明所提出的控制方法进行了模拟仿真验证。
1)主要仿真参数
卫星轨道要素如下表1所示:
表1卫星轨道要素表
运动目标初始大地坐标:(L=123.458°,B=25.735°,H=0m)
初始真实姿态四元数:qb=[0.9836 0.1742 0.0096 -0.0460]
初始真实姿态角速度:wb=[0.5 -0.5 0.2]T°/s
控制器的参数kp、kd取为:
运动目标速度设定如表2所示:
表2运动目标速度表。
目标姿态 | 速度大小 |
静止状态 | 0m/s |
低速状态 | 100m/s |
中速状态 | 500m/s |
高速状态 | 1000m/s |
2)仿真结果及其分析
目标在不同运动状态下,采用自适应PD控制器得到的跟踪控制仿真结果如图4-图7所示。从上述仿真图中可以得到:
图4中,当目标处于静止状态时,卫星经过12.8s的姿态调整后,能够维持稳定凝视状态,误差欧拉角稳定在0.001°以内,误差角速度稳定在0.001°/s以内,三轴的控制力矩在整个凝视过程中都在执行机构的输出范围内,未达到上限,其中,控制前期滚动轴和偏航轴的控制力矩较大,这是因为滚动轴和偏航轴的初始误差欧拉角和角速度较大,导致控制力矩较大;
图5中,当目标处于低速状态时,卫星经过13.5的姿态调整后,能够维持稳定凝视状态,误差欧拉角稳定在0.005°以内,误差角速度稳定在0.006°/s以内,控制力矩在整个凝视过程中均在执行机构的输出范围内;
图6中,当目标处于中速状态时,卫星经过16.8的姿态调整后,能够维持稳定凝视状态,误差欧拉角稳定在0.03°以内,误差角速度稳定在0.02°/s以内,控制力矩在整个凝视过程中均在执行机构的输出范围内;
图7中,当目标处于高速状态时,卫星经过22.9的姿态调整后,能够维持稳定凝视状态,误差欧拉角稳定在0.05°以内,误差角速度稳定在0.04°/s以内,控制力矩在整个凝视过程中均在执行机构的输出范围内。
综上所述,本发明设计的控制方法,均能保证稳定跟踪不同速度的运动目标,收敛速度较快,收敛曲线平滑,具有较好的鲁棒性,误差欧拉角和误差角速度都能保持在较小范围内,三轴的控制力矩在整个凝视过程中都未达到上限,此外,随着运动目标速度的不断增大,收敛速度变慢,误差欧拉角和误差角速度有所增加。
因此可以得出结论,本发明设计的控制方法简单有效,能够实现视频卫星对不同运动速度的目标凝视跟踪,且均能保证控制收敛性,具有较好的鲁棒性。
以上所述仅为本发明的优选实施例,并非因此限制本发明的专利范围,凡是在本发明的发明构思下,利用本发明说明书及附图内容所作的等效结构变换,或直接/间接运用在其他相关的技术领域均包括在本发明的专利保护范围内。
Claims (10)
1.一种视频卫星对运动目标的凝视跟踪控制方法,在运动目标的凝视跟踪控制时,针对预设的视频卫星姿态凝视跟踪模型采用PD控制器进行卫星的姿态控制,其特征在于,所采用PD控制器的函数表达式为:
上式中,T为所述PD控制器输出的控制力矩;系数系数其中系数kp、kd是常值正定矩阵,qev为姿态误差四元数qe的矢量;we为姿态误差角速度;A(qe)为期望坐标系到卫星本体坐标系的转换矩阵,qe为姿态误差四元数;wt为期望姿态角速度,为期望姿态角速度wt的导数;J为卫星转动惯量,h为执行机构的动量矩;其中:
其中,qe0为姿态误差四元数qe的标量,I表示单位矩阵,I3表示三阶单位矩阵;上标T表示矩阵的转置;(·)×表示斜对称矩阵算子,对任意向量x=[x1 x2 x3]T,有且斜对称矩阵算子为:
3.根据权利要求2所述的视频卫星对运动目标的凝视跟踪控制方法,其特征在于,所述针对预设的视频卫星姿态凝视跟踪模型采用PD控制器进行卫星的姿态控制之前还包括推导视频卫星姿态凝视跟踪模型的步骤:
S1、基于双矢量方法计算视频卫星相对于地球惯性坐标系的期望姿态四元素;;
S2、计算视频卫星的期望姿态角速度和期望姿态角加速度;
S3、建立视频卫星的姿态跟踪运动学方程和姿态跟踪动力学方程;
S4、基于误差四元数和误差姿态角速度,建立视频卫星对运动目标的凝视姿态跟踪模型。
4.根据权利要求3所述的视频卫星对运动目标的凝视跟踪控制方法,其特征在于,步骤S1包括:
S1.1、坐标系定义:地球惯性坐标系Oi-XiYiZi,选用J2000.0坐标系,以地心为坐标系原点,OiZi轴指向J2000.0年平赤道的极点,OiXi轴指向J2000.0平春分点,OiYi轴与OiXi轴和OiZi轴构成右手坐标系;地球固连坐标系为Oe-XeYeZe,以地心为坐标系原点,OeZe指向地球北极,OeXe指向地球赤道面与格林尼治子午线的交点,OeYe在赤道平面内与OeXe轴和OeZe轴构成右手坐标系;卫星本体坐标系为Ob-XbYbZb,以卫星的质心为坐标系原点,三个坐标轴方向分别沿着卫星本体惯量主轴的三个方向;期望坐标系Ot-XtYtZt,以卫星本体坐标系为参考,坐标系原点为卫星质心,并根据目标姿态角确定期望坐标系相对卫星本体坐标系的位置;
S1.2、采用双矢量方法计算视频卫星凝视时的期望姿态:首先计算凝视目标对应的地面点T0(LT0,BT0,HT0)、T1(LT1,BT1,HT1)在地球惯性坐标系的位置矢量RT0(XT0,YT0,ZT0)、RT1(XT1,YT1,ZT1),地面点中的三元素L、B、H分别表示地面点地理经度、地面点地理纬度、地面点高程;位置矢量中的三元素分别表示XYZ轴坐标;
S1.3、计算卫星质心指向地面点T0、T1的矢量分别在地球惯性坐标系和卫星本体坐标系中的分量:
其中,RT0表示卫星质心指向地面点T0在地球惯性坐标系的位置矢量,RC表示卫星质心在地球惯性坐标系的位置矢量;
计算卫星质心指向地面点T1的矢量在地球惯性坐标系中分量:
其中,RT1表示卫星质心指向地面点T1在地球惯性坐标系的位置矢量,RC表示卫星质心在地球惯性坐标系的位置矢量;
计算卫星质心指向地面点T1的矢量在卫星本体坐标系中分量:
S1.4、由卫星质心指向地面点T0的矢量CT0在地球惯性坐标系中的分量的和在卫星本体坐标系中的分量以及卫星质心指向地面点T1的矢量CT1在地球惯性坐标系中的分量和在卫星本体坐标系中的分量通过非共线双矢量构建期望坐标系,由此得到对地凝视期望姿态下地球惯性坐标系到卫星本体坐标系的转换矩阵:
以卫星质心指向地面点T0的矢量CT0和卫星质心指向地面点T1的矢量CT1两个非共线矢量构建过渡坐标系O1-X1Y1Z1为:
其中,O1X1,O1Y1,O1Z1分别为过渡坐标系O1-X1Y1Z1的三个轴;
6.根据权利要求4所述的视频卫星对运动目标的凝视跟踪控制方法,其特征在于,步骤S3中建立的视频卫星的姿态跟踪运动学方程的函数表达式为:
其中,qb=[qb0 qb1 qb2 qb3]T=[qbo qbυ]T为地球惯性坐标系到卫星本体坐标系的姿态四元数,即真实姿态四元数,其中,qb0是真实姿态四元数qb的标量,qbv是真实姿态四元数qb的矢量;wb=[wbx wby wbz]T为卫星姿态角速度在卫星本体坐标系中的分量,即真实姿态角速度;I3表示三阶单位矩阵;上标T表示矩阵的转置;(·)×表示斜对称矩阵算子,对任意向量x=[x1 x2 x3]T,有
步骤S3中建立的视频卫星的姿态跟踪动力学方程的函数表达式为:
7.根据权利要求2所述的视频卫星对运动目标的凝视跟踪控制方法,其特征在于,所述针对预设的视频卫星姿态凝视跟踪模型采用PD控制器进行卫星的姿态控制之前、推导得出视频卫星姿态凝视跟踪模型之后还包括对PD控制器进行稳定性分析的步骤:
A1、确定李雅普诺夫函数V的函数表达式为:
A2、对李雅普诺夫函数V求导,忽略卫星转动惯量不确定性和外界干扰,得到:
8.一种视频卫星对运动目标的凝视跟踪控制系统,包括相互连接的微处理器和存储器,其特征在于,所述微处理器被编程或配置以执行权利要求1~7中任意一项所述视频卫星对运动目标的凝视跟踪控制方法的步骤,或者所述存储器中存储有被编程或配置以执行权利要求1~7中任意一项所述视频卫星对运动目标的凝视跟踪控制方法的计算机程序。
9.一种视频卫星,包括卫星本体,所述卫星本体包括相互连接的微处理器和存储器,其特征在于,所述微处理器被编程或配置以执行权利要求1~7中任意一项所述视频卫星对运动目标的凝视跟踪控制方法的步骤,或者所述存储器中存储有被编程或配置以执行权利要求1~7中任意一项所述视频卫星对运动目标的凝视跟踪控制方法的计算机程序。
10.一种计算机可读存储介质,其特征在于,该计算机可读存储介质中存储有被编程或配置以执行权利要求1~7中任意一项所述视频卫星对运动目标的凝视跟踪控制方法的计算机程序。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011496677.0A CN112660423B (zh) | 2020-12-17 | 2020-12-17 | 一种视频卫星对运动目标的凝视跟踪控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011496677.0A CN112660423B (zh) | 2020-12-17 | 2020-12-17 | 一种视频卫星对运动目标的凝视跟踪控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112660423A true CN112660423A (zh) | 2021-04-16 |
CN112660423B CN112660423B (zh) | 2023-05-09 |
Family
ID=75404856
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011496677.0A Active CN112660423B (zh) | 2020-12-17 | 2020-12-17 | 一种视频卫星对运动目标的凝视跟踪控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112660423B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114877871A (zh) * | 2022-05-06 | 2022-08-09 | 中国人民解放军国防科技大学 | 未标定视频卫星进行深空目标观测的姿态凝视控制方法 |
CN114879709A (zh) * | 2022-05-06 | 2022-08-09 | 浙江大学 | 一种面向运动目标跟踪观测的卫星姿态控制方法及装置 |
CN115649491A (zh) * | 2022-11-11 | 2023-01-31 | 长光卫星技术股份有限公司 | 适用于多源干扰下的低轨光学遥感卫星凝视成像控制方法 |
CN116692028A (zh) * | 2023-05-26 | 2023-09-05 | 中国人民解放军国防科技大学 | 一种小卫星对地快速凝视指向跟踪控制方法及装置 |
CN117422610A (zh) * | 2023-12-19 | 2024-01-19 | 上海卫星互联网研究院有限公司 | 一种三维模型轻量化方法、装置及电子设备 |
CN117719702A (zh) * | 2024-02-07 | 2024-03-19 | 长光卫星技术股份有限公司 | 用于卫星高精度凝视的复合姿态控制方法、设备及介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050133671A1 (en) * | 2003-12-03 | 2005-06-23 | The Boeing Company | Star-tracker-based attitude determination for spinning spacecraft |
CN106054910A (zh) * | 2016-07-07 | 2016-10-26 | 中国人民解放军国防科学技术大学 | 视场方向可调的卫星对地凝视姿态控制方法 |
CN109782810A (zh) * | 2018-12-26 | 2019-05-21 | 中国人民解放军战略支援部队航天工程大学 | 基于图像引导的视频卫星运动目标跟踪成像方法及其装置 |
-
2020
- 2020-12-17 CN CN202011496677.0A patent/CN112660423B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050133671A1 (en) * | 2003-12-03 | 2005-06-23 | The Boeing Company | Star-tracker-based attitude determination for spinning spacecraft |
CN106054910A (zh) * | 2016-07-07 | 2016-10-26 | 中国人民解放军国防科学技术大学 | 视场方向可调的卫星对地凝视姿态控制方法 |
CN109782810A (zh) * | 2018-12-26 | 2019-05-21 | 中国人民解放军战略支援部队航天工程大学 | 基于图像引导的视频卫星运动目标跟踪成像方法及其装置 |
Non-Patent Citations (2)
Title |
---|
张学阳: "视频卫星运动目标智能感知与跟踪控制研究", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》 * |
黄富强: "视频小卫星对地凝视高稳定度姿态控制方法研究", 《中国优秀博硕士学位论文全文数据库(硕士)工程科技Ⅱ辑》 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114877871A (zh) * | 2022-05-06 | 2022-08-09 | 中国人民解放军国防科技大学 | 未标定视频卫星进行深空目标观测的姿态凝视控制方法 |
CN114879709A (zh) * | 2022-05-06 | 2022-08-09 | 浙江大学 | 一种面向运动目标跟踪观测的卫星姿态控制方法及装置 |
CN114877871B (zh) * | 2022-05-06 | 2024-01-09 | 中国人民解放军国防科技大学 | 未标定视频卫星进行深空目标观测的姿态凝视控制方法 |
CN115649491A (zh) * | 2022-11-11 | 2023-01-31 | 长光卫星技术股份有限公司 | 适用于多源干扰下的低轨光学遥感卫星凝视成像控制方法 |
CN115649491B (zh) * | 2022-11-11 | 2024-03-12 | 长光卫星技术股份有限公司 | 适用于多源干扰下的低轨光学遥感卫星凝视成像控制方法 |
CN116692028A (zh) * | 2023-05-26 | 2023-09-05 | 中国人民解放军国防科技大学 | 一种小卫星对地快速凝视指向跟踪控制方法及装置 |
CN116692028B (zh) * | 2023-05-26 | 2023-12-08 | 中国人民解放军国防科技大学 | 一种小卫星对地快速凝视指向跟踪控制方法及装置 |
CN117422610A (zh) * | 2023-12-19 | 2024-01-19 | 上海卫星互联网研究院有限公司 | 一种三维模型轻量化方法、装置及电子设备 |
CN117422610B (zh) * | 2023-12-19 | 2024-03-22 | 上海卫星互联网研究院有限公司 | 一种三维模型轻量化方法、装置及电子设备 |
CN117719702A (zh) * | 2024-02-07 | 2024-03-19 | 长光卫星技术股份有限公司 | 用于卫星高精度凝视的复合姿态控制方法、设备及介质 |
CN117719702B (zh) * | 2024-02-07 | 2024-04-26 | 长光卫星技术股份有限公司 | 用于卫星高精度凝视的复合姿态控制方法、设备及介质 |
Also Published As
Publication number | Publication date |
---|---|
CN112660423B (zh) | 2023-05-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112660423A (zh) | 一种视频卫星对运动目标的凝视跟踪控制方法及系统 | |
CN105116910B (zh) | 一种对地面点凝视成像的卫星姿态控制方法 | |
CN104406598B (zh) | 一种基于虚拟滑模控制的非合作航天器姿态估计方法 | |
Kuantama et al. | Feedback linearization LQR control for quadcopter position tracking | |
CN109343550B (zh) | 一种基于滚动时域估计的航天器角速度的估计方法 | |
CN105629732B (zh) | 一种考虑控制受限的航天器姿态输出反馈跟踪控制方法 | |
Jiao et al. | Analysis and design the controller for quadrotors based on PID control method | |
CN109823572B (zh) | 敏捷卫星姿态往复快速摆动的执行机构配置及控制方法 | |
Jiang et al. | An adaptive backstepping sliding mode method for flight attitude of quadrotor UAVs | |
CN112572835B (zh) | 一种具有姿态切换的卫星在轨角动量管理及控制方法 | |
CN106708078A (zh) | 一种适用于空间机器人执行器故障下的快速姿态稳定方法 | |
CN111506095A (zh) | 一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法 | |
CN115524969A (zh) | 一种提高空间交会对接模型预测控制运算速度的方法 | |
CN115291617A (zh) | 视频小卫星的空间目标防脱靶跟踪控制方法及系统 | |
CN111781833A (zh) | 基于状态依赖分解的航天器在线最优姿态规避控制方法 | |
CN108427429B (zh) | 一种考虑动态指向约束的航天器视轴机动控制方法 | |
CN113815903B (zh) | 一种用于遥感卫星的飞轮过零规避方法 | |
Zhan et al. | Geometric-based prescribed performance control for unmanned aerial manipulator system under model uncertainties and external disturbances | |
Wang et al. | A new spacecraft attitude stabilization mechanism using deep reinforcement learning method | |
CN108227723A (zh) | 一种水下机器人及其稳定性分析及结构优化的应用方法 | |
CN112034869A (zh) | 一种无人机变参神经动力学控制器的设计方法及其应用 | |
CN114415734B (zh) | 基于adp和避障机制的四旋翼无人机编队重构控制系统 | |
Pan et al. | Quadrotor control based on self-tuning LQR | |
Shan et al. | Design and Simulation of Satellite Attitude Control Algorithm Based on PID | |
CN114153222A (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 |