CN109911248B - 天基空间运动目标跟踪指向卫星姿态控制方法及*** - Google Patents
天基空间运动目标跟踪指向卫星姿态控制方法及*** Download PDFInfo
- Publication number
- CN109911248B CN109911248B CN201910207318.XA CN201910207318A CN109911248B CN 109911248 B CN109911248 B CN 109911248B CN 201910207318 A CN201910207318 A CN 201910207318A CN 109911248 B CN109911248 B CN 109911248B
- Authority
- CN
- China
- Prior art keywords
- satellite
- space
- attitude
- expected
- coordinate system
- 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
- 238000000034 method Methods 0.000 title claims abstract description 36
- 239000013598 vector Substances 0.000 claims abstract description 52
- 230000033001 locomotion Effects 0.000 claims abstract description 27
- 230000003287 optical effect Effects 0.000 claims description 13
- 230000008569 process Effects 0.000 claims description 13
- 230000001133 acceleration Effects 0.000 claims description 12
- 238000004364 calculation method Methods 0.000 claims description 11
- 239000011159 matrix material Substances 0.000 claims description 6
- 238000004590 computer program Methods 0.000 claims description 4
- 230000006870 function Effects 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 230000008447 perception Effects 0.000 abstract description 3
- 230000006872 improvement Effects 0.000 description 7
- 230000008859 change Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- JJWKPURADFRFRB-UHFFFAOYSA-N carbonyl sulfide Chemical compound O=C=S JJWKPURADFRFRB-UHFFFAOYSA-N 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 230000009191 jumping Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供一种天基空间运动目标跟踪指向卫星姿态控制方法及***,包括以下步骤:S1、获取当前时刻的卫星轨道状态、姿态四元数和角速度和空间运动目标轨道状态;S2、使空间运动目标在卫星相机视场中,获取期望卫星姿态下的姿态四元数与卫星体坐标系三轴的空间单位矢量;S3、获取期望卫星姿态下的卫星体坐标系三轴的空间单位矢量的时间导数;S4、根据期望卫星姿态下的卫星体坐标系三轴的空间单位矢量及单位矢量的时间导数计算期望角速度;S5、根据期望卫星姿态下的期望角速度与姿态四元数计算卫星的控制力矩,并根据控制力矩对卫星进行姿态调控。最大程度保证了相机视场对运动目标的捕获。本发明应用于天基态势感知领域。
Description
技术领域
本发明涉及天基态势感知领域,尤其涉及天基空间运动目标跟踪指向卫星姿态控制方法及***。
背景技术
天基空间运动目标跟踪指向是指,基于空间轨道运行的卫星平台,通过其快速姿态机动,使固连于星体的相机光轴在一段时间内始终指向某空间轨道运动目标,以拍摄照片或视频的方式对空间运动目标进行遥感;空间运动目标可以是任何感兴趣的空间碎片、其他人造卫星或小天体等。天基空间运动目标成像是近年来新兴的一种天基态势感知技术,具有较大的科学、商业和军事应用价值。在对空间运动目标的连续跟踪过程中,星体姿态的控制需要以期望姿态角和期望角速度为参考输入,结合测量得到的实际姿态和实际角速度,产生姿态偏差和角速度偏差信号,最终生成对卫星姿态的控制力矩。
由于突破第一宇宙速度后的在轨运行卫星运动速度很大,且不同卫星的轨道倾角差异很大,导致空间运动目标相对卫星的运动角速度可以达到10°/s的量级,由于无法设计合理的期望跟踪指向姿态,使得空间运动目标较易逸出相机视场。
发明内容
针对现有技术中空间运动目标较易逸出相机视场的问题,本发明的目的是提供一种天基空间运动目标跟踪指向卫星姿态控制方法及***,最大程度保证了相机视场对运动目标的捕获。
为了实现上述发明目的,本发明提供一种天基空间运动目标跟踪指向卫星姿态控制方法,其采用的技术方案是:
一种天基空间运动目标跟踪指向卫星姿态控制方法,包括以下步骤:
S1、获取当前时刻的卫星轨道状态、姿态四元数和角速度和空间运动目标轨道状态;
S2、使空间运动目标在卫星相机视场中,获取期望卫星姿态下的姿态四元数与卫星体坐标系三轴的空间单位矢量,即给出可实现空间运动目标跟踪指向的卫星体坐标系三轴的空间单位矢量的解析表达,卫星体坐标系是相对卫星星体固定不变的坐标系,其具体定义依卫星几何构型和载荷类型而定;
S3、获取期望卫星姿态下的卫星体坐标系三轴的空间单位矢量的时间导数;
S4、根据期望卫星姿态下的卫星体坐标系三轴的空间单位矢量及单位矢量的时间导数计算期望角速度;
S5、根据期望卫星姿态下的期望角速度与姿态四元数计算卫星的控制力矩,并根据控制力矩对卫星进行姿态调控。
作为上述技术方案的进一步改进,步骤S1中,
卫星轨道状态为X=[R,V]T,R为卫星的地心惯性系位置,V为卫星的地心惯性系速度;
角速度为ω=[ωx,ωy,ωz]T,由卫星体坐标系相对地心惯性系定义;
空间运动目标轨道状态为XT=[RT,VT]T,RT为空间运动目标在地心惯性系中的位置,VT为空间运动目标的地心惯性系速度。其中,地心惯性系常用J2000坐标系,定义如下:原点为地球质心,X轴指向2000年1月1日12时(儒略日2451545.0)的平春分点,Z轴指向该日平北极,Y轴在平赤道面内与X轴和Z轴构成的右手坐标系。
作为上述技术方案的进一步改进,步骤S2中期望卫星姿态下的卫星体坐标系三轴的空间单位矢量的获取过程为:
S211、计算当前时刻的空间运动目标相对卫星的位置矢量Rr和速度矢量Vr:
Rr=RT-R
Vr=VT-V
S212、设卫星上相机光轴与卫星体坐标系zb轴重合,zb轴在由Rr和Vr构成的相对运动平面内运动以使得空间运动目标在卫星相机视场中,此时期望姿态对应的卫星体坐标系三轴的空间单位矢量为:
式中,||·||为矢量的模。
作为上述技术方案的进一步改进,步骤S2中期望卫星姿态下的姿态四元数的获取过程包括:
S221、计算从惯性系到卫星体坐标系的转移矩阵MI2B:
S222、由MI2B的元素aij(i,j=1,2,3)计算姿态四元数:
trMI2B=a11+a22+a33
式中,q0为姿态四元数的标部,q=[q1,q2,q3]T为姿态四元数的矢部。
作为上述技术方案的进一步改进,步骤S3具体包括:
S31、计算相机光轴所在体坐标系zb轴的单位矢量的时间导数:
S33、计算相机光轴所在体坐标系的xb轴单位矢量的时间导数:
作为上述技术方案的进一步改进,步骤S32中,
式中,Vp为tp时刻的卫星速度矢量;
作为上述技术方案的进一步改进,步骤S4中,所述期望角速度的获取过程为:
作为上述技术方案的进一步改进,步骤S5中,所述控制力矩获取过程为:
Lc=-KΔq-DΔω
Δω=ω-ω*
K=ksgn(Δq0)I
D=diag(d1,d2,d3)
式中,k,di(i=1,2,3)为正值标量系数,根据具体卫星的转动惯量和执行机构能力进行设置;sgn(*)为符号函数;I为单位矩阵。
本发明提供的对空间运动目标跟踪指向的卫星姿态控制方法,在求解过程中控制人员首先选定空间运动目标,按照上述步骤计算得到期望姿态四元数和期望角速度,将其作为姿态控制器的参考输入,结合当前实际姿态和角速度生成偏差控制信号,即可最终实现对空间运动目标跟踪指向卫星姿态的有效控制。该方法通过合理设计期望的三轴指向,使卫星相机光轴始终处于空间运动目标相对运动平面内,最大程度保证了相机视场对运动目标的捕获;利用矢量解析表达式避免了角度差分运算进而省去角度过零判断,在避免数据跳动的前提下,实现了对卫星姿态的有效控制。
为了实现上述发明目的,本发明还提供一种天基空间运动目标跟踪指向卫星姿态控制***,其采用的技术方案是:
一种天基空间运动目标跟踪指向卫星姿态控制***,包括处理器与存储器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现上述方法的步骤。
本发明的有益技术效果:
本发明通过合理设计卫星期望的三轴指向,使卫星相机光轴始终处于空间目标相对运动平面内,最大程度保证了相机视场对运动目标的捕获;通过矢量微分运算推导出期望四元数和角速度的解析表达式,避免了角度差分运算从而省去了角度过零判断,保证以该方法所得结果作为参考输入时,控制量连续无突变,能生成光滑、连续的空间运动目标跟踪指向的姿态控制量。
附图说明
图1是天基空间运动目标跟踪指向卫星姿态控制方法的流程示意图;
图2是本实施中卫星跟踪指向空间运动目标的空间几何关系示意图;
图3是为理论计算所得卫星期望姿态四元数和角速度随时间变化曲线示意图;
图4为空间运动目标指向偏差的控制效果示意图。
具体实施方式
以下结合具体实例对本发明提供的天基空间运动目标跟踪指向卫星姿态控制方法进行详细说明。如图1所示,其具体步骤如下:
步骤S1:任意选定初始仿真时刻为2019年6月15日0时0分0秒(UTC),卫星轨道状态X=[R,V]T和空间目标轨道状态XT=[RT,VT]T,其空间几何关系如图2所示。同时给定卫星初始时刻的姿态四元数和角速度ω。
RS=[6858.79511,0.00203,0.00942]T(km)
V=[0.00000,6.24669,4.37698]T(km/s)
RT=[6674.11255,1541.85292,-622.64101]T(km)
VT=[1.44099,-3.58977,6.55660]T(km/s)
ω=[0.1,0.1,0.1]T(deg/s)
其中,R为卫星的地心惯性系位置,V为卫星的地心惯性系速度,RT为空间目标在地心惯性系中的位置,VT为空间目标的地心惯性系速度。
步骤S2:计算期望卫星姿态下的姿态四元数与卫星体坐标系三轴的空间单位矢量;
其中,步骤S2中所述的期望姿态下的卫星体坐标系三轴的空间单位矢量的求解包括以下步骤:
步骤S211:计算当前时刻的空间目标相对卫星的位置矢量Rr和速度矢量Vr:
步骤S212:设相机光轴与体坐标系zb轴重合,zb轴在由Rr和Vr构成的相对运动平面内运动,此时期望姿态对应的体坐标系三轴单位矢量发明人设计为:
式中,||·||为矢量的模;
步骤S2中所述的期望姿态四元数的求解包括以下步骤:
步骤S221:计算从惯性系到卫星体坐标系的转移矩阵MI2B:
步骤S222:由MI2B的元素aij(i,j=1,2,3)计算姿态四元数:
式中,q0为四元数的标部,q=[q1,q2,q3]T为四元数的矢部,trMI2B=a11+a22+a33;
步骤S4:求解体轴单位矢量的时间导数,即给出在期望姿态下体轴单位矢量的时间导数的解析表达;
其中,步骤S3中所述体轴单位矢量的时间导数的求解包括以下步骤:
步骤S31:计算相机光轴所在体坐标系zb轴的单位矢量的时间导数:
其中,为卫星的质心运动加速度,为空间目标的质心运动加速度,和可以采用多种方法计算得到,例如可以采用一种较简便又不会产生跳变的计算方法:Vp为tp时刻的卫星速度矢量,为tp时刻的空间目标的速度矢量。由于速度变量不是角度量,不会出现跳变问题,不存在过零判断问题;
步骤S33:计算相机光轴所在体坐标系的xb轴单位矢量的时间导数:
步骤S4:计算卫星的期望角速度,即给出期望姿态下相应角速度的解析表达:
Lc=-KΔq-DΔω (11)
所得结果如图3、图4所示。将所得期望姿态四元数和角速度作为姿态控制器的参考输入,输入控制器中后,即可对卫星姿态进行模拟控制。
本实施例中的卫星对空间运动目标跟踪指向的期望姿态参数随时间变化的曲线如图3所示。由图3可得:本发明提供方法解算得到的期望角速度的Y、Z分量几乎为零,间接显示出相机光轴始终位于相对运动平面内,最大程度保证了相机视场对运动目标的捕获;期望姿态参数解析计算曲线光滑无突变,与姿态运动本质上的物理连续性一致,没有出现通过角度差分计算所得的角速度在角度过零时发生数值突变的问题。由图4可得,指向偏差由最初的110°逐渐收敛到接近0°,充分证明了本发明提供方法的有效性。
以上包含了本发明优选实施例的说明,这是为了详细说明本发明的技术特征,并不是想要将发明内容限制在实施例所描述的具体形式中,依据本发明内容主旨进行的其他修改和变型也受本专利保护。本发明内容的主旨是由权利要求书所界定,而非由实施例的具体描述所界定。
通过对附图,说明书和权利要求书的研究,在实施本发明时本领域技术人员可以理解和实现所公开的实施例的变形。在权利要求书中,术语“包括”不排除其他步骤或元素,而不定冠词“一个”或“一种”不排除多个。在彼此不同的从属权利要求中引用的某些措施的事实不意味着这些措施的组合不能被有利地使用。权利要求书中的任何参考标记不构成对本发明的范围的限制。
Claims (6)
1.天基空间运动目标跟踪指向卫星姿态控制方法,其特征在于,包括以下步骤:
S1、获取当前时刻的卫星轨道状态、姿态四元数和角速度和空间运动目标轨道状态;
S2、使空间运动目标在卫星相机视场中,获取期望卫星姿态下的姿态四元数与卫星体坐标系三轴的空间单位矢量,其中,期望卫星姿态下的卫星体坐标系三轴的空间单位矢量的获取过程为:
S211、计算当前时刻的空间运动目标相对卫星的位置矢量Rr和速度矢量Vr:
Rr=RT-R
Vr=VT-V
S212、设卫星上相机光轴与卫星体坐标系zb轴重合,zb轴在由Rr和Vr构成的相对运动平面内运动以使得空间运动目标在卫星相机视场中,此时期望姿态对应的卫星体坐标系三轴的空间单位矢量为:
式中,||·||为矢量的模;
S3、获取期望卫星姿态下的卫星体坐标系三轴的空间单位矢量的时间导数,具体包括:
S31、计算相机光轴所在体坐标系zb轴的单位矢量的时间导数:
S33、计算相机光轴所在体坐标系的xb轴单位矢量的时间导数:
S4、根据期望卫星姿态下的卫星体坐标系三轴的空间单位矢量及单位矢量的时间导数计算期望角速度,所述期望角速度的计算过程为:
S5、根据期望卫星姿态下的期望角速度与姿态四元数计算卫星的控制力矩,并根据控制力矩对卫星进行姿态调控。
6.天基空间运动目标跟踪指向卫星姿态控制***,包括处理器与存储器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至5中任一项所述方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910207318.XA CN109911248B (zh) | 2019-03-19 | 2019-03-19 | 天基空间运动目标跟踪指向卫星姿态控制方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910207318.XA CN109911248B (zh) | 2019-03-19 | 2019-03-19 | 天基空间运动目标跟踪指向卫星姿态控制方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109911248A CN109911248A (zh) | 2019-06-21 |
CN109911248B true CN109911248B (zh) | 2020-11-27 |
Family
ID=66965628
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910207318.XA Active CN109911248B (zh) | 2019-03-19 | 2019-03-19 | 天基空间运动目标跟踪指向卫星姿态控制方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109911248B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111483615B (zh) * | 2020-04-17 | 2021-06-29 | 中国科学院微小卫星创新研究院 | 一种量子卫星对地面光学站指向姿态实现方法 |
CN111998821B (zh) * | 2020-07-03 | 2023-05-26 | 中国人民解放军32032部队 | 一种在轨维护卫星传感器指向控制角度计算方法 |
CN112061424B (zh) * | 2020-07-16 | 2022-04-12 | 北京控制工程研究所 | 一种基于融合目标姿态的机动过程能源角动态跟踪方法 |
CN112960145B (zh) * | 2021-02-04 | 2022-12-13 | 上海卫星工程研究所 | 一种遥感卫星对地姿态机动扫描的轨迹规划方法及*** |
CN113460336A (zh) * | 2021-08-14 | 2021-10-01 | 苏州吉天星舟空间技术有限公司 | 一种卫星非沿迹曲线成像的姿态轨迹规划方法 |
CN113761664B (zh) * | 2021-09-15 | 2024-01-30 | 长光卫星技术股份有限公司 | 一种遥感卫星成像期间飞轮转速优化方法 |
CN114253136B (zh) * | 2021-12-13 | 2023-05-02 | 哈尔滨工业大学 | 基于离散高阶全驱***的组合卫星模拟器控制方法 |
CN114526742B (zh) * | 2022-01-25 | 2024-05-07 | 上海卫星工程研究所 | 微纳卫星姿态基准的构件化通用构造方法及*** |
CN114935934B (zh) * | 2022-02-24 | 2024-05-07 | 哈尔滨工业大学 | 基于坐标装订的航天器相对运动高精度指向续光控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103838258A (zh) * | 2014-02-26 | 2014-06-04 | 上海微小卫星工程中心 | 一种应用于天基空间目标的自动跟踪方法及*** |
CN104457705A (zh) * | 2014-12-12 | 2015-03-25 | 北京理工大学 | 基于天基自主光学观测的深空目标天体初定轨方法 |
CN104960674A (zh) * | 2015-06-01 | 2015-10-07 | 北京控制工程研究所 | 一种运动目标的指向跟踪控制方法 |
CN105023279A (zh) * | 2015-08-18 | 2015-11-04 | 中国人民解放军国防科学技术大学 | 一种基于运动信息的视频图像空间运动目标检测方法 |
CN106017456A (zh) * | 2016-05-05 | 2016-10-12 | 中国人民解放军国防科学技术大学 | 一种对地面点凝视的卫星期望角速度解析求解方法 |
-
2019
- 2019-03-19 CN CN201910207318.XA patent/CN109911248B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103838258A (zh) * | 2014-02-26 | 2014-06-04 | 上海微小卫星工程中心 | 一种应用于天基空间目标的自动跟踪方法及*** |
CN104457705A (zh) * | 2014-12-12 | 2015-03-25 | 北京理工大学 | 基于天基自主光学观测的深空目标天体初定轨方法 |
CN104960674A (zh) * | 2015-06-01 | 2015-10-07 | 北京控制工程研究所 | 一种运动目标的指向跟踪控制方法 |
CN105023279A (zh) * | 2015-08-18 | 2015-11-04 | 中国人民解放军国防科学技术大学 | 一种基于运动信息的视频图像空间运动目标检测方法 |
CN106017456A (zh) * | 2016-05-05 | 2016-10-12 | 中国人民解放军国防科学技术大学 | 一种对地面点凝视的卫星期望角速度解析求解方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109911248A (zh) | 2019-06-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109911248B (zh) | 天基空间运动目标跟踪指向卫星姿态控制方法及*** | |
Wu et al. | Modeling and sliding mode-based attitude tracking control of a quadrotor UAV with time-varying mass | |
Slavinskis et al. | High spin rate magnetic controller for nanosatellites | |
Crassidis et al. | Minimum model error approach for attitude estimation | |
CN109823571A (zh) | 一种遥感微纳卫星的多阶段姿态控制方法 | |
JP2002510816A (ja) | Cmgアレイ特異点を回避する連続姿勢制御 | |
Jikuya et al. | Attitude maneuver of spacecraft with a variable-speed double-gimbal control moment gyro | |
Sun et al. | Adaptive relative pose control of spacecraft with model couplings and uncertainties | |
Zhang et al. | Precise angles-only navigation for noncooperative proximity operation with application to tethered space robot | |
CN114679541B (zh) | 一种星上运动目标跟踪方法 | |
CN114879709A (zh) | 一种面向运动目标跟踪观测的卫星姿态控制方法及装置 | |
CN110032203B (zh) | 一种集群多星单目标凝视姿态协同控制方法及*** | |
Somov et al. | Dynamics of an autonomous spacecraft control system at initial transition to a tracking mode | |
Shi et al. | Modeling and simulation of space robot visual servoing for autonomous target capturing | |
CN116692028B (zh) | 一种小卫星对地快速凝视指向跟踪控制方法及装置 | |
CN106017456B (zh) | 一种对地面点凝视的卫星期望角速度解析求解方法 | |
Somov et al. | Autonomous attitude and orbit control of a space robot inspecting a geostationary satellite | |
Feng et al. | Relative state and inertia estimation of unknown tumbling spacecraft by stereo vision | |
Bourabah et al. | Inertia tensor estimation of tethered debris through tether tracking | |
Wise | Design, analysis, and testing of a precision guidance, navigation, and control system for a dual-spinning Cubesat | |
CN112498745B (zh) | 一种低轨光学卫星立体成像自主规划方法 | |
CN108983799B (zh) | 一种满足快速绕飞要求的航天器绕飞观测方法 | |
Balkır et al. | External Magnetic Field Contributions to B-Dot Attitude Control of a Nanosatellite | |
Maclean et al. | Computationally light attitude controls for resource limited nano-spacecraft | |
Jin et al. | Ground simulation experiment verification of space robot with ADAMS and Simulink co-simulation |
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 |