CN114879709A - 一种面向运动目标跟踪观测的卫星姿态控制方法及装置 - Google Patents

一种面向运动目标跟踪观测的卫星姿态控制方法及装置 Download PDF

Info

Publication number
CN114879709A
CN114879709A CN202210499967.3A CN202210499967A CN114879709A CN 114879709 A CN114879709 A CN 114879709A CN 202210499967 A CN202210499967 A CN 202210499967A CN 114879709 A CN114879709 A CN 114879709A
Authority
CN
China
Prior art keywords
satellite
attitude
tracking
representing
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.)
Pending
Application number
CN202210499967.3A
Other languages
English (en)
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.)
Zhejiang University ZJU
Original Assignee
Zhejiang University ZJU
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 Zhejiang University ZJU filed Critical Zhejiang University ZJU
Priority to CN202210499967.3A priority Critical patent/CN114879709A/zh
Publication of CN114879709A publication Critical patent/CN114879709A/zh
Pending legal-status Critical Current

Links

Images

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

Landscapes

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

Abstract

本发明公开一种面向运动目标跟踪观测的卫星姿态控制方法,包括:步骤1、构建卫星姿态动力学模型;步骤2、基于跟踪目标在星载相机观测图像上的位置,计算卫星的跟踪姿态约束矩阵;步骤3、基于卫星的跟踪姿态约束矩阵和能量约束函数,构建导航函数;步骤4、基于卫星姿态动力学模型与导航函数,构建用于自适应反步控制器;步骤5、将运动目标信息发送至卫星系统中,当星载相机观测到运动目标时,将配合所述自适应反步控制器对卫星姿态的进行调节,完成运动目标的跟踪拍摄。本发明还公开了一种基于卫星姿态控制方法的装置。本发明提供的方法将导航函数引入自适应反步控制器,对控制力矩和角速度进行约束,实现了对卫星跟踪姿态的稳定控制。

Description

一种面向运动目标跟踪观测的卫星姿态控制方法及装置
技术领域
本发明涉及航天器控制技术领域,尤其涉及一种面向运动目标跟踪观测的卫星姿态控制方法及装置。
背景技术
成像卫星具有全天时和全天域等感知特性,广泛应用于国土普查、军事侦察、抗震救灾和城市规划等领域。随着卫星技术的不断发展和卫星数量的不断增加,利用卫星对运动目标进行跟踪观测逐渐成为航天领域的研究重点。利用卫星对运动目标跟踪观测,不受国界和地域限制,可以实现长时间大范围的连续观测,有利于对运动目标的状态监测和特性识别分析,比如对空间碎片进行跟踪监测或对地面运动目标的长时间观测识别。
由于目标运动的不确定性和多变性,如何实时调整卫星姿态以使星载相机保持指向运动目标是亟需解决的难题。现有的方法主要有路径规划法和势函数法两类:
路径规划法是根据目标的图像位置利用卫星和目标之间的空间几何关系规划姿态机动路径,将规划得到的期望姿态路径输入姿态控制系统进行跟踪姿态控制,然而,这类方法将规划与控制解耦,姿态路径规划时未考虑控制系统是否易于实现。
势函数法通过构建人工势函数约束卫星的机动姿态,确保星载相机指向运动目标,并将势函数与控制系统结合,确保姿态控制系统的可实现,然而,对于运动目标的跟踪观测,如何设计合理的势函数是亟需解决的难题。
专利文献CN109911248A公开了一种天基空间运动目标跟踪指向卫星姿态控制方法及系统,包括S1、获取当前时刻的卫星轨道状态、姿态四元数和角速度和空间运动目标轨道状态;S2、使空间运动目标在卫星相机视场中,获取期望卫星姿态下的姿态四元数与卫星体坐标系三轴的空间单位矢量;S3、获取期望卫星姿态下的卫星体坐标系三轴的空间单位矢量的时间导数;S4、根据期望卫星姿态下的卫星体坐标系三轴的空间单位矢量及单位矢量的时间导数计算期望角速度;S5、根据期望卫星姿态下的期望角速度与姿态四元数计算卫星的控制力矩,并根据控制力矩对卫星进行姿态调控。由于运动目标的跟踪需要时时改变卫星位姿,因此该方法并没有考虑卫星改变位姿时需要消耗储能大小,导致该技术方案只适用于理论计算。
专利文献CN112660423A公开了一种视频卫星对运动目标的凝视跟踪控制方法及系统,所述控制方法包括:基于双矢量方法计算卫星相对于地球惯性坐标系的期望姿态四元素;然后,进一步计算卫星的期望姿态角速度和期望姿态角加速度;接下来建立卫星的姿态运动学和动力学方程;之后基于误差四元数和误差姿态角速度,建立视频卫星对运动目标的凝视姿态跟踪模型;最后设计PD控制器进行卫星的姿态控制。该技术方案对于运动目标的捕捉是基于地球经纬度,但是运动目标的经纬度是动态变化,使得每次的位姿变化都需要重新计算运动目标的经纬度坐标,且只适用于对地面的运动目标,如果是外太空的目标则无法提供参考坐标。
发明内容
为了解决上述问题,本发明提供了一种面向运动目标跟踪观测的卫星姿态控制方法,该方法通过结合卫星的跟踪姿态约束矩阵和能量约束函数构建出用于提供卫星位姿参考值的导航函数,并将导航函数引入自适应反步控制器中,从而实现对卫星跟踪姿态的稳定控制。
一种面向运动目标跟踪观测的卫星姿态控制方法,包括:
步骤1、构建用于描述卫星姿态的卫星姿态动力学模型;
步骤2、基于跟踪目标在星载相机观测图像上的位置,计算卫星的跟踪姿态约束矩阵;
步骤3、基于卫星的跟踪姿态约束矩阵和能量约束函数,构建用于提供卫星位姿参考值的导航函数;
步骤4、基于步骤1的卫星姿态动力学模型与步骤3的导航函数,构建用于输出卫星姿态控制力矩的自适应反步控制器;
步骤5、将运动目标信息发送至卫星系统中,当星载相机观测到运动目标时,将配合所述自适应反步控制器对卫星姿态的进行调节,完成运动目标的跟踪拍摄。
具体的,所述步骤1中的卫星姿态动力学模型,基于卫星姿态角速度进行构建:
Figure BDA0003628928530000041
其中,
Figure BDA0003628928530000042
表示卫星惯量矩阵的标称值,
Figure BDA0003628928530000043
表示控制力矩,ω×表示姿态角速度的反对称矩阵,ω表示姿态角速度,
Figure BDA0003628928530000044
表示包含惯量不确定性和外部干扰的集中扰动;
sat(u)=[sat(u1),sat(u21),sat(u3)]T
Figure BDA0003628928530000045
其中,umax表示姿态角速度的上界;
|ω|≤ωmax
其中,ωmax表示姿态角速度的上界。
具体的,所述步骤1的具体步骤如下:
步骤1.1、构建卫星姿态运动学模型:
Figure BDA0003628928530000046
其中,
Figure BDA0003628928530000047
表示姿态四元数,q0表示姿态四元数的标量,qv表示姿态四元数的矢量,ω=[ω1,ω2,ω3]T表示姿态角速度,
Figure BDA0003628928530000048
表示3x3单位矩阵,
Figure BDA0003628928530000049
表示姿态四元数矢量的反对称矩阵;
步骤1.2、构建原始卫星姿态动力学模型:
Figure BDA0003628928530000051
其中,
Figure BDA0003628928530000052
表示卫星惯量矩阵,
Figure BDA0003628928530000053
表示控制力矩,
Figure BDA0003628928530000054
表示外部干扰,
Figure BDA0003628928530000055
表示姿态角速度的反对称矩阵;
步骤1.3、基于卫星惯量矩阵的不确定性,对原始卫星姿态动力学模型进行改进:
Figure BDA0003628928530000056
Figure BDA0003628928530000057
其中,ΔJ表示卫星惯量矩阵的不确定部分,
Figure BDA0003628928530000058
表示惯量不确定性和外部干扰的集中干扰。
优选的,所述步骤2中的计算卫星的跟踪姿态约束矩阵,具体表达式为:
Figure BDA0003628928530000059
其中,ρTI表示目标视线轴向量,h表示星载相机的光轴向量,
Figure BDA00036289285300000510
表示3x3单位矩阵;
即卫星姿态约束的表达式为:
qTAq≥cosθC
其中,q表示卫星的姿态四元数,θC表示星载相机的视场角。
具体的,所述步骤2的具体步骤如下:
步骤2.1、根据目标在观测图像上的位置[xTI,yTI]T,计算目标视线周向量:
Figure BDA0003628928530000061
Figure BDA0003628928530000062
其中,
Figure BDA0003628928530000063
表示星载相机的安装矩阵,f表示相机焦距,RBI表示观测时刻的卫星姿态的旋转矩阵,
Figure BDA0003628928530000064
表示观测时的卫星姿态四元数;
步骤2.2、根据星载相机安装距离,计算光轴向量:
Figure BDA0003628928530000065
步骤2.3、基于步骤2.1与2.2获得的数据,计算获得卫星的跟踪姿态约束矩阵。
具体的,所述步骤3的构建用于提供卫星位姿参考值的导航函数,具体过程如下:
步骤3.1、根据卫星姿态约束矩阵,建立用于约束参考姿态四元数的姿态约束项:
Figure BDA0003628928530000066
其中,r表示参考姿态四元数;
步骤3.2、基于减少姿态控制量,建立用于约束参考姿态四元数的能量约束项:
Figure BDA0003628928530000071
Figure BDA0003628928530000072
其中,
Figure BDA0003628928530000073
表示4x4单位矩阵,β为条件系数:
步骤3.3、将步骤3.1的姿态约束项与步骤3.2的能量约束项,结合获得导航函数。
优选的,所述步骤4中的自适应反步控制器,引入卫星动力学模型与角速度势函数对输出的卫星姿态控制力矩进行约束,从而使得输出的控制力矩能符合实际控制需求。
具体的,所述自适应反步控制器的控制表达式如下:
Figure BDA0003628928530000074
其中,u表示控制力矩,z1表示一阶反步状态向量,z2表示二阶反步状态向量,
Figure BDA0003628928530000075
表示估计的集中扰动最大值,Φ表示角速度势函数矩阵,χ表示卫星动力学模型的辅助变量,
Figure BDA0003628928530000076
表示预设的正定矩阵,σ=-k1tanh(Qz1)表示二阶反步状态向量的参数,
Figure BDA0003628928530000077
表示卫星姿态四元数矢量矩阵,qe0表示卫星姿态误差四元数的标量部分,
Figure BDA0003628928530000078
表示卫星误差姿态四元数矢量部分的斜对称矩阵,k1与k2表示大于零的常数。
具体的,所述步骤4的具体步骤如下:
步骤4.1、计算卫星姿态四元数与参考姿态之间的误差四元数:
Figure BDA0003628928530000081
其中,
Figure BDA0003628928530000082
表示参考姿态四元数的矢量部分rv=[r1,r2,r3]T的斜对称矩阵;
步骤4.2、根据卫星位姿的动力学方程,计算用于约束输出控制力矩的辅助变量:
χ=[χ1,χ2,χ3]
Figure BDA0003628928530000083
其中,
Figure BDA0003628928530000084
为预设的正定矩阵;
步骤4.3计算一阶反步状态向量:
Figure BDA0003628928530000085
计算二阶反步状态向量:
z2=[z21,z22,z23]T=ω-σ
其中,σ=-k1tanh(Qz1),k1表示大于0的常数,
Figure BDA0003628928530000086
步骤4.4、计算用于约束角速度的势函数矩阵:
Figure BDA0003628928530000087
其中,
Figure BDA0003628928530000091
步骤4.5、构建用于削弱卫星惯量矩阵不确定和外部干扰对姿态控制稳定性影响的干扰器,其表达式如下:
Figure BDA0003628928530000092
其中,ρ表示大于零的常数;
步骤4.6、基于步骤4.1-4.5设计的约束函数,构建用于输出卫星姿态控制力矩的自适应反步控制器。
优选的,所述步骤4中的自适应反步控制器还设有干扰估计器,所述干扰估计器用于削弱卫星惯量矩阵不确定和外部干扰对卫星姿态控制卫星的影响。
本发明还提供了一种卫星姿态控制装置,包括计算机存储器、计算机处理器以及存储在所述计算机存储器中并可在所述计算机处理器上执行的计算机程序,所述计算机存储器中采用上述的面向运动目标跟踪观测的卫星姿态控制方法;所述计算机处理器执行所述计算机程序时实现以下步骤:将运动目标信息发送至卫星系统中,当星载相机观测到运动目标时,将配合所述自适应反步控制器对卫星姿态的进行调节,完成运动目标的跟踪拍摄。
与现有技术相比,本发明的有益效果:
(1)基于传统势函数的位姿调整方法上,提出了以位姿约束与能量约束函数基础的导航函数,通过约束运动目标跟踪过程中的卫星姿态,从而保证卫星跟踪过程的位姿准确率,同时降低了卫星调整位姿的能耗。
(2)在构建自适应反步控制器时,增设了干扰估计器,从而卫星惯量不确定性和外部干扰对姿态控制稳定性的不利影响,提升了本发明的姿态控制方法的鲁棒性。
(3)将导航函数与自适应反步控制器相结合,既实现了对运动目标的姿态跟踪,又确保了姿态控制过程中满足控制力矩和姿态角速度约束,同时保证了系统在存在外部干扰和惯量不确定性情况下的强鲁棒性。
附图说明
图1为本发明提供的一种面向运动目标跟踪观测的卫星姿态控制方法的流程示意图;
图2为本实施例中传统路径规划法的跟踪角速度与时间变化图;
图3为本实施例中本发明提供的方法的跟踪角速度与时间变化图;
图4为本实施例中传统路径规划法的跟踪控制力矩与时间变化图;
图5为本实施例中本发明提供的方法的跟踪控制力矩与时间变化图。
具体实施方式
现阶段由于星载能源有限,使得星载相机的调整频率不能过于频繁;同时由于星载陀螺仪的饱和限制,卫星的姿态控制力矩和姿态角速度存在边界,此外卫星的外部干扰,星载燃料消耗变化以及星上柔性组件的所构成的不确定性干扰也会影响卫星位姿控制的稳定性。
本实施例提供了一种面向运动目标跟踪观测的卫星姿态控制方法,如图1所示,包括:
步骤1、构建用于描述卫星姿态的卫星姿态动力学模型:
步骤1.1、构建卫星姿态运动学模型:
Figure BDA0003628928530000111
其中,
Figure BDA0003628928530000112
表示姿态四元数,q0表示姿态四元数的标量,qv表示姿态四元数的矢量,ω=[ω1,ω2,ω3]T表示姿态角速度,
Figure BDA0003628928530000113
表示3x3单位矩阵,
Figure BDA0003628928530000114
表示姿态四元数矢量的反对称矩阵;
步骤1.2、构建原始卫星姿态动力学模型:
Figure BDA0003628928530000115
其中,
Figure BDA0003628928530000116
表示卫星惯量矩阵,
Figure BDA0003628928530000117
表示控制力矩,
Figure BDA0003628928530000118
表示外部干扰,
Figure BDA0003628928530000119
表示姿态角速度的反对称矩阵;
步骤1.3、基于卫星惯量矩阵的不确定性,对原始卫星姿态动力学模型进行改进:
Figure BDA00036289285300001110
Figure BDA00036289285300001111
其中,
Figure BDA0003628928530000121
表示卫星惯量矩阵的标称值,ΔJ表示卫星惯量矩阵的不确定部分,
Figure BDA0003628928530000122
表示控制力矩,ω×表示姿态角速度的反对称矩阵,ω表示姿态角速度,
Figure BDA0003628928530000123
表示包含惯量不确定性和外部干扰的集中扰动;
sat(u)=[sat(u1),sat(u21),sat(u3)]T
Figure BDA0003628928530000124
其中,umax表示姿态角速度的上界;
|ω|≤ωmax
其中,ωmax表示姿态角速度的上界。
步骤2、基于跟踪目标在星载相机观测图像上的位置,计算卫星的跟踪姿态约束矩阵:
步骤2.1、根据目标在观测图像上的位置[xTI,yTI]T,计算目标视线周向量:
Figure BDA0003628928530000125
Figure BDA0003628928530000126
其中,
Figure BDA0003628928530000127
表示星载相机的安装矩阵,f表示相机焦距,RBI表示观测时刻的卫星姿态的旋转矩阵,
Figure BDA0003628928530000128
表示观测时的卫星姿态四元数;
步骤2.2、根据星载相机安装距离,计算光轴向量:
Figure BDA0003628928530000129
步骤2.3、基于步骤2.1与2.2获得的数据,计算获得卫星的跟踪姿态约束矩阵:
Figure BDA0003628928530000131
其中,ρTI表示目标视线轴向量,h表示星载相机的光轴向量,
Figure BDA0003628928530000132
表示3x3单位矩阵;
即卫星姿态约束的表达式为:
qTAq≥cosθC
其中,q表示卫星的姿态四元数,θC表示星载相机的视场角。
步骤3、基于卫星的跟踪姿态约束矩阵和能量约束函数,构建用于提供卫星位姿参考值的导航函数:
步骤3.1、根据卫星姿态约束矩阵,建立用于约束参考姿态四元数的姿态约束项:
Figure BDA0003628928530000133
其中,r表示参考姿态四元数;
步骤3.2、基于减少姿态控制量,建立用于约束参考姿态四元数的能量约束项:
Figure BDA0003628928530000134
Figure BDA0003628928530000135
其中,
Figure BDA0003628928530000136
表示4x4单位矩阵,β为条件系数:
步骤3.3、将步骤3.1的姿态约束项与步骤3.2的能量约束项,结合获得导航函数:
Figure BDA0003628928530000141
其中,r表示卫星的参考姿态。
步骤4、基于步骤1的卫星姿态动力学模型与步骤3的导航函数,构建用于输出卫星姿态控制力矩的自适应反步控制器:
步骤4.1、计算卫星姿态四元数与参考姿态之间的误差四元数:
Figure BDA0003628928530000142
其中,
Figure BDA0003628928530000143
表示参考姿态四元数的矢量部分rv=[r1,r2,r3]T的斜对称矩阵;
步骤4.2、根据卫星位姿的动力学方程,计算用于约束输出控制力矩的辅助变量:
χ=[χ1,χ2,χ3]
Figure BDA0003628928530000144
其中,
Figure BDA0003628928530000145
为预设的正定矩阵;
步骤4.3计算一阶反步状态向量:
Figure BDA0003628928530000146
计算二阶反步状态向量:
z2=[z21,z22,z23]T=ω-σ
其中,σ=-k1tanh(Qz1),k1表示大于0的常数,
Figure BDA0003628928530000151
步骤4.4、计算用于约束角速度的势函数矩阵:
Figure BDA0003628928530000152
其中,
Figure BDA0003628928530000153
步骤4.5、构建用于削弱卫星惯量矩阵不确定和外部干扰对姿态控制稳定性影响的干扰器,其表达式如下:
Figure BDA0003628928530000154
其中,ρ表示大于零的常数;
步骤4.6、基于步骤4.1-4.5设计的约束函数,构建用于输出卫星姿态控制力矩的自适应反步控制器:
Figure BDA0003628928530000155
其中,u表示控制力矩,z1表示一阶反步状态向量,z2表示二阶反步状态向量,
Figure BDA0003628928530000156
表示估计的集中扰动最大值,Φ表示角速度势函数矩阵,χ表示卫星动力学模型的辅助变量,
Figure BDA0003628928530000157
表示预设的正定矩阵,σ=-k1tanh(Qz1)表示二阶反步状态向量的参数,
Figure BDA0003628928530000158
表示卫星姿态四元数矢量矩阵,qe0表示卫星姿态误差四元数的标量部分,
Figure BDA0003628928530000159
表示卫星误差姿态四元数矢量部分的斜对称矩阵,k1与k2表示大于零的常数。
步骤5、将运动目标信息发送至卫星系统中,当星载相机观测到运动目标时,将配合所述自适应反步控制器对卫星姿态的进行调节,完成运动目标的跟踪拍摄。
本实例还提供了一种卫星姿态控制装置,包括计算机存储器、计算机处理器以及存储在该计算机存储器中并可在该计算机处理器上执行的计算机程序,该计算机存储器中采用上述的面向运动目标跟踪观测的卫星姿态控制方法;
计算机处理器执行所述计算机程序时实现以下步骤:将运动目标信息发送至卫星系统中,当星载相机观测到运动目标时,将配合所述自适应反步控制器对卫星姿态的进行调节,完成运动目标的跟踪拍摄。
考虑不确定性因素,设定卫星惯量矩阵:
Figure BDA0003628928530000161
其标称值为J0=diag{[22,23,24]}kg·m2,控制力矩上限设定为umax=1N·m,姿态加速度上界设定为ωmax=2deg·s-1,外部干扰设定为d=2×10-3[sin(0.1t),cos(0.2t),sin(0.2t)]TN·m。
卫星轨道半轴设定为7200km,偏性率设定为10-5,倾角设定为98.6deg,升交点赤经设定为180deg,近地点幅角设定为0deg,真近点设定为-10deg;
同时设定星载相机安装矩阵为
Figure BDA0003628928530000162
焦距f设定为1m,视场角度设定为30°;
运动目标选取为空间碎片,其轨道半轴设定为7600km,偏心率设定为10-5,倾角设定为0deg,升交点赤经设定为0deg,近地点幅角设为0deg,真近角设为160deg;
自适应反步控制器的参数设定为k1=0.04,k2=10,ρ=0.1,Γ=diag{[10,10,10]}。
基于上述预设的参数,如图2与图3所示,分别为传统路径规划方法与本实施例提供的方法所产生的卫星姿态角速度-时间变化图,在0~50s的时间段中,传统方法所产生的卫星姿态角速度的变化量非常大(-10~5deg),相较于本实施例提供的方法所产生的卫星叫姿态角速度,本方法在0~50s时间段中的变化量较小(-2~2deg);
如图4与图5所示,分别为传统路径规划方法与本实施例提供的方法所产生的控制力矩-时间变化图,同样在0~50s的时间段中,传统方法产生的控制力矩的变化量为-3.2~2.2deg,而本实施例提供的方法所产生的控制力矩的变化量为-1~1deg;
由图可知,本发明提供的控制方法所需要的能耗要远远小于传统方法,更加符合星载卫星载能量不多的实际情况,同时所需的控制力矩更小并且控制力矩和姿态角速度满足约束要求,说明本发明效果较好。

Claims (8)

1.一种面向运动目标跟踪观测的卫星姿态控制方法,其特征在在于,包括:
步骤1、构建用于描述卫星姿态的卫星姿态动力学模型;
步骤2、基于跟踪目标在星载相机观测图像上的位置,计算卫星的跟踪姿态约束矩阵;
步骤3、基于卫星的跟踪姿态约束矩阵和能量约束函数,构建用于提供卫星位姿参考值的导航函数;
步骤4、基于步骤1的卫星姿态动力学模型与步骤3的导航函数,构建用于输出卫星姿态控制力矩的自适应反步控制器;
步骤5、将运动目标信息发送至卫星系统中,当星载相机观测到运动目标时,将配合所述自适应反步控制器对卫星姿态的进行调节,完成运动目标的跟踪拍摄。
2.根据权利要求1所述的面向运动目标跟踪观测的卫星姿态控制方法,其特征在于,所述步骤1中的卫星姿态动力学模型,基于卫星姿态角速度进行构建:
Figure FDA0003628928520000011
其中,
Figure FDA0003628928520000012
表示卫星惯量矩阵的标称值,
Figure FDA0003628928520000013
表示控制力矩,ω×表示姿态角速度的反对称矩阵,ω表示姿态角速度,
Figure FDA0003628928520000014
表示包含惯量不确定性和外部干扰的集中扰动;
sat(u)=[sat(u1),sat(u21),sat(u3)]T
Figure FDA0003628928520000021
其中,umax表示姿态角速度的上界;
|ω|≤ωmax
其中,ωmax表示姿态角速度的上界。
3.根据权利要求1所述的面向运动目标跟踪观测的卫星姿态控制方法,其特征在于,所述步骤2中的计算卫星的跟踪姿态约束矩阵,具体表达式为:
Figure FDA0003628928520000022
其中,ρTI表示目标视线轴向量,h表示星载相机的光轴向量,
Figure FDA0003628928520000023
表示3x3单位矩阵;
即卫星姿态约束的表达式为:
qTAq≥cosθC
其中,q表示卫星的姿态四元数,θC表示星载相机的视场角。
4.根据权利要求1所述的面向运动目标跟踪观测的卫星姿态控制方法,其特征在于,所述步骤3的构建用于提供卫星位姿参考值的导航函数,具体过程如下:
步骤3.1、根据卫星姿态约束矩阵,建立用于约束参考姿态四元数的姿态约束项:
Figure FDA0003628928520000031
其中,r表示参考姿态四元数;
步骤3.2、基于减少姿态控制量,建立用于约束参考姿态四元数的能量约束项:
Figure FDA0003628928520000032
Figure FDA0003628928520000033
其中,
Figure FDA0003628928520000034
表示4x4单位矩阵,β为条件系数:
步骤3.3、将步骤3.1的姿态约束项与步骤3.2的能量约束项,结合获得导航函数。
5.根据权利要求1所述的面向运动目标跟踪观测的卫星姿态控制方法,其特征在于,所述步骤4中的自适应反步控制器,引入卫星动力学模型与角速度势函数对输出的卫星姿态控制力矩进行约束。
6.根据权利要求5所述的面向运动目标跟踪观测的卫星姿态控制方法,其特征在于,所述自适应反步控制器的控制表达式如下:
Figure FDA0003628928520000035
其中,u表示控制力矩,z1表示一阶反步状态向量,z2表示二阶反步状态向量,
Figure FDA0003628928520000041
表示估计的集中扰动最大值,Φ表示角速度势函数矩阵,χ表示卫星动力学模型的辅助变量,
Figure FDA0003628928520000042
表示预设的正定矩阵,σ=-k1tanh(Qz1)表示二阶反步状态向量的参数,
Figure FDA0003628928520000043
表示卫星姿态四元数矢量矩阵,qe0表示卫星姿态误差四元数的标量部分,
Figure FDA0003628928520000044
表示卫星姿态误差四元数矢量部分的斜对称矩阵,k1与k2表示大于零的常数。
7.根据权利要求1所述的面向运动目标跟踪观测的卫星姿态控制方法,其特征在于,所述步骤4中的自适应反步控制器还设有干扰估计器,所述干扰估计器用于削弱卫星惯量矩阵不确定和外部干扰对卫星姿态控制卫星的影响。
8.一种卫星姿态控制装置,包括计算机存储器、计算机处理器以及存储在所述计算机存储器中并可在所述计算机处理器上执行的计算机程序,其特征在于,所述计算机存储器中采用权利要求1-7任一所述的面向运动目标跟踪观测的卫星姿态控制方法;所述计算机处理器执行所述计算机程序时实现以下步骤:将运动目标信息发送至卫星系统中,当星载相机观测到运动目标时,将配合所述自适应反步控制器对卫星姿态的进行调节,完成运动目标的跟踪拍摄。
CN202210499967.3A 2022-05-06 2022-05-06 一种面向运动目标跟踪观测的卫星姿态控制方法及装置 Pending CN114879709A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210499967.3A CN114879709A (zh) 2022-05-06 2022-05-06 一种面向运动目标跟踪观测的卫星姿态控制方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210499967.3A CN114879709A (zh) 2022-05-06 2022-05-06 一种面向运动目标跟踪观测的卫星姿态控制方法及装置

Publications (1)

Publication Number Publication Date
CN114879709A true CN114879709A (zh) 2022-08-09

Family

ID=82673109

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210499967.3A Pending CN114879709A (zh) 2022-05-06 2022-05-06 一种面向运动目标跟踪观测的卫星姿态控制方法及装置

Country Status (1)

Country Link
CN (1) CN114879709A (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116692028A (zh) * 2023-05-26 2023-09-05 中国人民解放军国防科技大学 一种小卫星对地快速凝视指向跟踪控制方法及装置
CN117647243B (zh) * 2024-01-30 2024-04-16 山东星辰卫星技术有限公司 一种基于6u立方星的凝视监测方法及系统

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116692028A (zh) * 2023-05-26 2023-09-05 中国人民解放军国防科技大学 一种小卫星对地快速凝视指向跟踪控制方法及装置
CN116692028B (zh) * 2023-05-26 2023-12-08 中国人民解放军国防科技大学 一种小卫星对地快速凝视指向跟踪控制方法及装置
CN117647243B (zh) * 2024-01-30 2024-04-16 山东星辰卫星技术有限公司 一种基于6u立方星的凝视监测方法及系统

Similar Documents

Publication Publication Date Title
US9073648B2 (en) Star tracker rate estimation with kalman filter enhancement
Woffinden et al. Relative angles-only navigation and pose estimation for autonomous orbital rendezvous
CN114879709A (zh) 一种面向运动目标跟踪观测的卫星姿态控制方法及装置
US20050060092A1 (en) Laser range finder closed-loop pointing technology of relative navigation, attitude determination, pointing and tracking for spacecraft rendezvous
CN108663052B (zh) 一种星上自主空间非合作目标相对导航相机指向控制方法
CN111102981B (zh) 一种基于ukf的高精度卫星相对导航方法
US20220097872A1 (en) Attitude control system and method
CN108733066B (zh) 一种基于吊舱姿态反馈的目标跟踪控制方法
CN110632935B (zh) 一种编队卫星绕飞自主控制方法
CN110032203B (zh) 一种集群多星单目标凝视姿态协同控制方法及系统
CN116692028B (zh) 一种小卫星对地快速凝视指向跟踪控制方法及装置
JP2021011257A (ja) 結合された天文座標系の非線形モデル予測制御
Abdollahzadeh et al. Automatic orbital docking with tumbling target using sliding mode control
Khoder et al. A quaternion scaled unscented kalman estimator for inertial navigation states determination using ins/gps/magnetometer fusion
CN110608724B (zh) 一种卫星机动成像过程中无偏流姿态的直接求解方法
Lee et al. Integrated system for autonomous proximity operations and docking
CN114802818A (zh) 晨昏轨道卫星及其对日姿态计算方法、导引方法
Xie et al. Autonomous guidance, navigation, and control of spacecraft
Ali et al. In-flight Correction of the Satellite Orientation Parameter during Target Mode.
CN113968362B (zh) 一种卫星在轨自主三轴快速机动控制方法
EP1134640A2 (en) Attitude control system for a spacecraft
Çifdalöz Line-of-sight rate construction for a roll-pitch gimbal via a virtualpitch-yaw gimbal
Fan et al. Small video satellites visual tracking control for arbitrary maneuvering targets
Somov et al. Land-survey satellite guidance and attitude control during a scanning stereoscopic imagery.
Liu et al. A Framework of High-precision State Estimation for Approaching, Orbiting, and Touching an Asteroid

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