对日观测摆扫机动成像的姿态规划与控制的方法及系统技术方案

本发明专利技术提供了一种对日观测摆扫机动成像的姿态规划与控制的方法及系统，包括：通过星敏感器和陀螺的测量信息，计算卫星的对日姿态四元数和对日姿态角速度；根据卫星对日观测的摆扫需求，计算摆扫姿态四元数和摆扫姿态角速度，进而规划姿态机动路径；根据所述姿态机动路径，建立相应的姿态控制律得到控制角动量指令；将所述控制角动量指令分配给飞轮进行姿态控制，进而实现跟踪摆扫姿态机动路径。本发明专利技术通过设计摆扫姿态规划算法，将星体当前对日姿态与摆扫姿态的姿态误差四元数作为姿态控制基准，同时设计PD控制律以实现姿态最短路径机动。实现卫星的连续摆扫机动，达到空间望远镜的全日面观测。的全日面观测。的全日面观测。

【技术实现步骤摘要】
对日观测摆扫机动成像的姿态规划与控制的方法及系统


[0001]本专利技术涉及航天器
，具体地，涉及一种日观测摆扫机动成像的姿态规划与控制的方法及系统。

技术介绍

[0002]某型号对日观测卫星装载有空间光学望远镜，需要对太阳进行全日面观测。由于空间光学望远镜视场角的限制，导致对太阳的覆盖宽度较小。因此，可以利用卫星的姿态控制能力，通过连续的摆扫姿态机动来调整望远镜主轴的对日指向，快速高效的实现光学望远镜对日观测的全覆盖全日面成像。
[0003]专利文献CN104281150A公开了一种姿态机动的轨迹规划方法，该方法的步骤包括：(1)确定特征主轴和欧拉角；(2)对欧拉角进行轨迹规划得到特征主轴方向上的规划角速度函数和规划角度函数；(3)计算姿态机动过程中的规划四元数函数和规划目标角速度函数；(4)输出规划四元数函数和规划目标角速度函数到外部控制系统。但是，该专利文献是一种最短路径的姿态规划方法。
[0004]专利文献CN104848860A公开了一种敏捷卫星成像过程姿态机动规划方法，根据指定的地面成像条带的起始与结束地理位置以及两个端点对应的成像时间,计算每个时间点对应的成像点位置，得到卫星在成像过程中规划的姿态信息。但是，该专利文献是指定地面成像条带的起始与结束地理位置的姿态机动规划方法。
[0005]专利文献CN105444780A公开了星载摆扫式光学相机图像定位验证系统及处理方法，首先根据指定的地面成像条带的起始与结束地理位置以及两个端点对应的成像时间，计算每个时间点对应的成像点位置；然后根据卫星的轨道参数以及对应时刻的成像点位置，计算卫星与成像点在地心赤道惯性坐标系中的相对位置矢量；再根据地心赤道惯性坐标系到卫星轨道坐标系的一系列转换矩阵，计算相对位置矢量在卫星本体坐标系中的分量；随后根据相对位置矢量在卫星轨道坐标系中的分量，计算卫星成像时的滚转角和俯仰角以及滚转角速度和俯仰角速度；最后根据得到的滚转角、滚转角速度、俯仰角和俯仰角速度，轨道参数以及对应的成像点位置计算卫星的偏航角与偏航角速度，得到卫星在成像过程中规划的姿态信息。但是，该专利文献是一种摆扫式光学相机。
[0006]专利文献CN105867395A公开了一种利用滑膜变结构控制的深空探测器约束姿态机动规划方法。利用滑膜变结构控制方法设计满足动力学和运动学约束、控制力矩有界约束的控制率；采用几何规避方法求出可满足禁忌约束的姿态四元数，得到同时满足动力学、运动学约束、控制力矩有界约束和禁忌约束的路径节点和生成节点的控制力矩，生成探测器姿态机动路径和所需要的控制力矩，实现探测器机动到目标姿态。但是，该专利文献用于设计满足动力学和运动学约束、控制力矩有界约束的控制率。
[0007]专利文献CN108508905A公开了一种考虑空间轴进行最短路径姿态机动的方法，包括：进行角速度消旋控制；采集第1拍四元素信息计算当前姿态相对期望姿态的绕空间轴偏转角度和空间轴在坐标系中的方向矢量；判定所采用的机动方式，并计算存储对应的参数
信息；根据时间的变化，计算绕空间轴的瞬时转角；根据瞬时转角及空间轴的方向矢量信息计算获得导引律姿态四元素信息；根据前后采样周期计算获得的四元素信息计算导引律姿态角速度；以及利用轮控PD控制算法计算控制力矩输出。该方法可兼顾大角度姿态机动和小角度姿态机动的情况。但是，该专利文献主要用于解决卫星姿态机动的快速性问题。
[0008]目前，对日观测摆扫机动成像未见研究。因此市场上需要一种日观测卫星摆扫机动成像的姿态规划与控制的方法及系统，解决卫星装载的空间光学望远镜因视场受限而无法对太阳进行全覆盖观测的问题。

技术实现思路

[0009]针对现有技术中的缺陷，本专利技术的目的是提供一种日观测摆扫机动成像的姿态规划与控制的方法及系统。
[0010]根据本专利技术提供的一种对日观测摆扫机动成像的姿态规划与控制的方法，包括：
[0011]步骤S1：通过星敏感器和陀螺的测量信息，计算卫星的对日姿态四元数和对日姿态角速度；
[0012]步骤S2：根据卫星对日观测的摆扫需求，计算摆扫姿态四元数和摆扫姿态角速度，进而规划姿态机动路径；
[0013]步骤S3：根据所述姿态机动路径，建立相应的姿态控制律得到控制角动量指令；
[0014]步骤S4：将所述控制角动量指令分配给飞轮进行姿态控制，进而实现跟踪摆扫姿态机动路径。
[0015]优选地，所述步骤S1包括：
[0016]步骤S1.1：根据星敏感器测得的四元数和星敏感器安装四元数，解算得到惯性坐标系到卫星本体坐标系的姿态四元数q
ib
；
[0017]步骤S1.2：根据陀螺测得的角速度和陀螺安装矩阵，解算得到惯性坐标系到卫星惯性角速度，记为ω
bi
；
[0018]步骤S1.3：计算对日坐标系到本体坐标系的姿态四元数，公式如下：
[0019][0020]式中，q
sunb
表示卫星的对日姿态四元数，q
isun
表示惯性坐标系到对日坐标系的姿态四元数，q
ib
表示惯性坐标系到卫星本体坐标系的姿态四元数；
[0021]步骤S1.4：计算卫星的对日姿态角速度，公式如下：
[0022][0023][0024]式中，ω
bsunx
、ω
bsuny
、和ω
bsunz
分表表示卫星x、y和z轴的对日姿态角速度，ω
bix
、ω
biy
和ω
biz
分别表示卫星x、y和z轴的惯性角速度，A
bsun
表示卫星本体坐标系与对日坐标系
的转换矩阵，q0、q1、q2和q3分别表示卫星姿态四元数，ω
suni
表示对日坐标系惯性角速度。
[0025]优选地，所述步骤S2包括：
[0026]步骤S2.1：计算摆扫过程的加速度，公式如下：
[0027][0028]式中，a
x
表示摆扫过程的加速度，a
js
表示卫星摆扫过程中匀速阶段加速度，ω
ys
表示卫星摆扫过程中匀速阶段角速度，ω
x
表示摆扫过程的角速度；
[0029]步骤S2.2：计算滚动轴摆扫姿态角速度和摆扫姿态角，计算公式如下：
[0030]ω
x,k+1
＝ω
x,k
+a
x
T
[0031]α
x,k+1
＝α
x,k
+ω
ys
T
[0032]式中，ω
x,k+1
和α
x,k+1
分别表示第k+1步摆扫角速度、摆扫姿态角，ω
x,k
和α
x,k
分别表示第k步摆扫角速度、摆扫姿态角，T表示计算周期；
[0033]步骤S2.3：计算摆扫姿态四本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种对日观测摆扫机动成像的姿态规划与控制的方法，其特征在于，包括：步骤S1：通过星敏感器和陀螺的测量信息，计算卫星的对日姿态四元数和对日姿态角速度；步骤S2：根据卫星对日观测的摆扫需求，计算摆扫姿态四元数和摆扫姿态角速度，进而规划姿态机动路径；步骤S3：根据所述姿态机动路径，建立相应的姿态控制律得到控制角动量指令；步骤S4：将所述控制角动量指令分配给飞轮进行姿态控制，进而实现跟踪摆扫姿态机动路径。2.根据权利要求1所述的对日观测摆扫机动成像的姿态规划与控制的方法，其特征在于，所述步骤S1包括：步骤S1.1：根据星敏感器测得的四元数和星敏感器安装四元数，解算得到惯性坐标系到卫星本体坐标系的姿态四元数q
ib
；步骤S1.2：根据陀螺测得的角速度和陀螺安装矩阵，解算得到惯性坐标系到卫星惯性角速度，记为ω
bi
；步骤S1.3：计算对日坐标系到本体坐标系的姿态四元数，公式如下：式中，q
sunb
表示卫星的对日姿态四元数，q
isun
表示惯性坐标系到对日坐标系的姿态四元数，q
ib
表示惯性坐标系到卫星本体坐标系的姿态四元数；步骤S1.4：计算卫星的对日姿态角速度，公式如下：步骤S1.4：计算卫星的对日姿态角速度，公式如下：式中，ω
bsunx
、ω
bsuny
、和ω
bsunz
分别表示卫星x、y和z轴的对日姿态角速度，ω
bix
、ω
biy
和ω
biz
分别表示卫星x、y和z轴的惯性角速度，A
bsun
表示卫星本体坐标系与对日坐标系的转换矩阵，q0、q1、q2和q3分别表示卫星姿态四元数，ω
suni
表示对日坐标系惯性角速度。3.根据权利要求1所述的对日观测摆扫机动成像的姿态规划与控制的方法，其特征在于，所述步骤S2包括：步骤S2.1：计算摆扫过程的加速度，公式如下：式中，a
x
表示摆扫过程的加速度，a
js
表示卫星摆扫过程中匀速阶段加速度，ω
ys
表示卫
星摆扫过程中匀速阶段角速度，ω
x
表示摆扫过程的角速度；步骤S2.2：计算滚动轴摆扫姿态角速度和摆扫姿态角，计算公式如下：ω
x,k+1
＝ω
x,k
+a
x
Tα
x,k+1
＝α
x,k
+ω
ys
T式中，ω
x,k+1
和α
x,k+1
分别表示第k+1步摆扫角速度、摆扫姿态角，ω
x,k
和α
x,k
分别表示第k步摆扫角速度、摆扫姿态角，T表示计算周期；步骤S2.3：计算摆扫姿态四元数和摆扫姿态角速度，计算公式如下：步骤S2.3：计算摆扫姿态四元数和摆扫姿态角速度，计算公式如下：式中，q
baisao
和ω
baisao
分别表示摆扫姿态四元数和摆扫姿态角速度。4.根据权利要求1所述的对日观测摆扫机动成像的姿态规划与控制的方法，其特征在于，所述步骤S3包括：步骤S3.1：计算摆扫时的控制用姿态四元数q
c
，公式如下：式中，q
sunb
表示卫星的对日姿态四元数，q
baisao
摆扫姿态四元数；步骤S3.2：根据对日姿态角速度，计算控制用姿态角速度，公式如下：式中，ω
cx
、ω
cy
和ω
cz
分别表示x、y和z轴控制用姿态角速度，ω
bsunx
、ω
bsuny
、和ω
bsunz
分表表示卫星x、y和z轴的对日姿态角速度，ω
baisao
表示摆扫姿态角速度；步骤S3.3：以卫星姿态角和卫星角速度作为输入，三轴控制指令角动量，建立姿态控制律如下：卫星姿态角卫星角速度为ω
x
,ω
y
,ω
z
其中，θ和ψ分别表示卫星滚动角、俯仰角、偏航角，q0、q1、q2和q3分别表示卫星姿态四
元数，ω
x
,ω
y
,ω
z
分别表示卫星滚动角速度、俯仰角速度、偏航角速度；步骤S3.4：计算得到三轴控制指令角动量，计算公式如下：步骤S3.4：计算得到三轴控制指令角动量，计算公式如下：步骤S3.4：计算得到三轴控制指令角动量，计算公式如下：步骤S3.4：计算得到三轴控制指令角动量，计算公式如下：式中，H
cx
、H
cy
和H
cz
分别表示x、y和z轴的控制指令角动量，K
p1
、K
p2
和K
p3
分别表示控制参数中比例系数，K
d1
、K
d2
和K
d3
分别表示控制参数中阻尼系数，T
magx
、T
magy
和T
magz
分别表示x、y和z轴磁卸载前馈力矩，T
dmx
、T
dmy
和T
dmz
分别表示x、y和z轴摆扫过程中产生的前馈力矩,I表示星体的转动惯量，a
x
表示摆扫加速度。5.根据权利要求1所述的对日观测摆扫机动成像的姿态规划与控制的方法，其特征在于，参与控制的n个飞轮的转速指令如下所示：其中，R
rwi
、R
rwm
表示第i个、第m个飞轮转速指令，D表示卫星的飞轮角动量指令分配矩阵、k
Nms2rpm
表示飞轮角动量转换系数，H
cx
、H
cy
和H...

【专利技术属性】
技术研发人员：程卫强，张恒，张健，聂章海，袁伟，钱方亮，黄庆龙，
申请(专利权)人：上海卫星工程研究所，
类型：发明
国别省市：