CN107168350B - 一种针对服务航天器定轴转动时的最佳自转角速度的计算方法 - Google Patents
一种针对服务航天器定轴转动时的最佳自转角速度的计算方法 Download PDFInfo
- Publication number
- CN107168350B CN107168350B CN201710375156.1A CN201710375156A CN107168350B CN 107168350 B CN107168350 B CN 107168350B CN 201710375156 A CN201710375156 A CN 201710375156A CN 107168350 B CN107168350 B CN 107168350B
- Authority
- CN
- China
- Prior art keywords
- angular velocity
- target
- frequency
- service spacecraft
- spacecraft
- 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.)
- Expired - Fee Related
Links
- 238000004364 calculation method Methods 0.000 title claims description 6
- 238000000034 method Methods 0.000 claims abstract description 34
- 238000001914 filtration Methods 0.000 claims abstract description 14
- 238000005096 rolling process Methods 0.000 claims abstract description 11
- 230000036544 posture Effects 0.000 claims description 4
- 238000005070 sampling Methods 0.000 claims description 4
- 238000013459 approach Methods 0.000 claims description 2
- 239000011159 matrix material Substances 0.000 claims description 2
- 238000012545 processing Methods 0.000 claims description 2
- 230000001131 transforming effect Effects 0.000 claims description 2
- 230000000007 visual effect Effects 0.000 claims description 2
- 230000002708 enhancing effect Effects 0.000 abstract 1
- 238000003032 molecular docking Methods 0.000 description 6
- 210000001503 joint Anatomy 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 238000009987 spinning 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
-
- 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/64—Systems for coupling or separating cosmonautic vehicles or parts thereof, e.g. docking arrangements
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/14—Fourier, Walsh or analogous domain transformations, e.g. Laplace, Hilbert, Karhunen-Loeve, transforms
- G06F17/141—Discrete Fourier transforms
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Computational Mathematics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Data Mining & Analysis (AREA)
- Remote Sensing (AREA)
- Software Systems (AREA)
- Databases & Information Systems (AREA)
- General Engineering & Computer Science (AREA)
- Algebra (AREA)
- Aviation & Aerospace Engineering (AREA)
- Computing Systems (AREA)
- Discrete Mathematics (AREA)
- Automation & Control Theory (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种针对服务航天器定轴转动时的最佳自转角速度的计算方法,包括以下步骤:首先将测得的目标的姿态四元数进行傅里叶变换,得到目标运动三个特征角频率;然后使用滤波方法使这项角频率的估计值更精确;最后,将影响最大的特征角频率乘以2,即得到服务航天器转动的最佳角速度。依据本发明设计的自转角速度使服务航天器旋转起来,可以有效减小服务航天器和目标之间的相对角速度和相对线速度,从而减轻了机械臂抓捕时的负担,增强了空间在轨服务的安全性。另外,虽然服务航天器是作定轴转动,但本发明设计自转角速度不仅限于定轴转动的目标,对于沿三轴翻滚的目标,同样能有效降低相对角速度。
Description
技术领域:
本发明涉及航天领域的在轨服务技术,具体涉及一种针对服务航天器定轴转动时的最佳自转角速度的计算方法。
背景技术:
目前,空间在轨服务技术正受到国内外研究者们的普遍关注。空间在轨服务的目标包括故障卫星和太空碎片。其目的在于使用服务航天器对目标进行维修,或将目标清除出当前轨道。进行空间在轨服务的先决条件之一是对目标进行对接。由于太空中作用在目标上的外力矩很小,目标初始的角动量很难耗散掉,因此经常处于翻滚状态。对于翻滚目标的对接尤为困难,因为当服务航天器与目标相对速度较大时,很容易造成碰撞使对接机构损坏。对于低速翻滚卫星,可以使用空间机械臂的运动消除相对角速度,但当目标角速度过大时,仅靠机械臂的运动往往无法满足要求。以往有通过使服务航天器本体转动从而降低其与作定轴转动的目标的相对角速度的方法,但是没有研究提出过对于做三轴翻滚运动的目标如何最大程度消除相对速度的方法。
发明内容:
本发明的目的是为了降低服务航天器与任意翻滚目标的相对角速度,提供了一种针对服务航天器定轴转动时的最佳自转角速度的计算方法,用于针对空间抓捕任务中的服务航天器转动时的最佳自传角速度计算。
为达到上述目的,本发明采用如下技术方案来实现:
一种针对服务航天器定轴转动时的最佳自转角速度的计算方法,包括以下步骤:
1)利用视觉观测***或者激光雷达测距***,测量翻滚目标实时的姿态并使用四元数表示方法进行记录,同时记录各姿态对应的时间;
2)在采集N组目标姿态四元数的观测信息后,对姿态四元数的各个分量进行离散傅里叶变换,由于姿态动力学方程的特性,四元数的离散傅里叶变换结果在频域中的图形会出现若干个尖峰,其中N的值需满足fm代表时域中观测值的采样频率,f1为时域中观测数据变换到频域中的图形上的第一个尖峰所对应的频率;
3)以峰值高度最高的三个尖峰所对应的频率作为初始值,通过扩展卡尔曼滤波或其他滤波方法,利用更多的四元数观测数据,使得对这些频率的估计值精确;
4)在对以上频率的估计的相对误差小于5%之后,找到在四元数的频域图形中峰值最高的尖峰所对应的频率,通过此频率直接计算得到服务航天器的最佳自转角速度。
本发明进一步的改进在于,步骤1)中所述的观测***得到的四元数观测值为q(tk),其中tk为第k次观测所对应的时间,观测值包含有误差,且误差被认为是高斯白噪声进行处理。
本发明进一步的改进在于,步骤2)中使用的离散傅里叶变换方法为:
其中,qi(tk)表示q(tk)的第i个分量,zi(n)表示qi(tk)进行离散傅里叶变换后在频域中第n项的值,N是观测值的总数量,j是虚数单位,zi(n)在频域中对应的频率为
其中,fm代表时域中观测值的采样频率,以f(n)为横坐标,zi(n)为纵坐标,即能够绘出qi的离散傅里叶变换在频域中的图形,图形出现若干尖峰,其中使得最高的前三个尖峰所对应的横坐标,即频率,分别记为f1,f2和f3,其中f1所对应的尖峰最高。
本发明进一步的改进在于,步骤3)中采用的滤波方法,在滤波过程中的状态量取为x=[uT,θT]T,其中u=[u1,u2,…,u24]T是一常数向量,θ=[θ1,θ2,θ3]T为特征角频率组成的向量,滤波器运行之前,u的初始值为一零向量,θ的初始值为θ0=2π[f1,f2,f3]T;状态量的误差方差阵的初始值为
其中I24×24和I3×3分别为维度为24×24和维度为3×3的单位矩阵,状态向量的一步预测方程为
xk=xk-1
其中xk和xk-1分别为状态量x在tk时刻和tk-1时刻的估计值,同时由于四元数是可观测的,则基于该状态向量的观测方程为
在滤波过程中,θ1的估计值越来越精确。
本发明进一步的改进在于,步骤4)中最终得到的航天器最佳自转角速度为 2θ1,角速度矢量的方向与目标的角动量方向重合,服务航天器沿目标的角动量方向接近、抓捕目标。
本发明具有如下的有益效果:
本发明依据本发明设计的自转角速度使服务航天器旋转起来,减小服务航天器和目标之间的相对角速度和相对线速度,可以减轻机械臂抓捕时的负担,增强了空间在轨服务的安全性。由于服务航天器作定轴匀速转动,在抓捕过程中不需要消耗额外的力矩对转速进行控制,可以节省服务航天器上的能量消耗。另外,对于最佳转速的计算过程只需要使用现有的服务航天器所具备的敏感器,不需要在服务航天器上增加额外的载荷。
进一步,本发明在最优转速的计算过程中容许有观测误差的存在,更符合实际应用中的情况。
进一步,本发明首先使用傅里叶变换方法确定一个最佳角频率的粗略值,可以为扩展卡尔曼滤波方法的初值,有利于扩展卡尔曼滤波方法的收敛,增强了本发明在实际应用中的稳定性。
进一步,本发明使用扩展卡尔曼滤波器进行最优转速的实时计算,不仅可以消除观测误差的影响,还使得最佳转速的计算精度随着观测量增加越来越精确,因此服务航天器的转速控制不必在计算完成之后再进行,最佳转速可以边控制边计算,直至越来越接近最优。
此外,虽然服务航天器是作定轴转动,但因为本发明精确估计出了翻滚目标旋转时最显著的角频率分量,因此本发明设计自转角速度不仅适用于定轴转动的目标,对于沿三轴翻滚的目标,同样能有效降低相对角速度。
附图说明:
图1:使用旋转的服务航天器与翻滚的目标进行对接的示意图。
图2:翻滚目标的姿态四元数的傅里叶变换结果与角频率的对应关系。
图3:服务航天器静止时(a)以及以最佳转速自转时(b)目标的对接轴端点在服务航天器的本体坐标系中的投影对比。
图4:服务航天器静止时(a)以及以最佳转速自转时(b)目标的对接轴端点相对于服务航天器的运动速度对比。
具体实施方式:
以下结合附图和实施例对本发明作进一步说明。
图1是使用旋转的服务航天器与翻滚的目标进行对接的示意图。如图所示,由于服务航天器作定轴转动,因此其角动量与角速度方向重合,且指向目标的角动量方向。由于目标近似认为不受外力矩影响,因此其角动量守恒,则角动量方向在惯性坐标系中的指向是固定的。同时,由于目标作任意翻滚运动,因此其角速度矢量并不一定与角动量方向重合,并且其在惯性坐标系中的指向一般是随时间变化的。
通过非接触式的测量方法,如双目视觉方法、激光测距雷达方法等,服务航天器可以测得目标的姿态四元数随时间变化的情况。在本示例中,目标的初始状态取为
ω0=[4 5 6]T rad/s
q0=[1 0 0 0]T
其中I为目标的惯量张量在本体主轴坐标系中的表示,ω0为目标的初始角速度在本体主轴坐标系中的表示,q0为目标的本体主轴坐标系相对于惯性坐标系的姿态四元数的初始值。
将观测到的四元数数据进行傅里叶变换,将频域中横坐标对应的频率乘以 2π,即可得到傅里叶变换的结果对应角频率的图像,如图2所示。图中尖峰对应的角频率,即为三个特征角频率。
使用滤波方法进一步求得峰值最高的角频率的精确值,得到θ1=3.6583rad/s。然后得到服务航天器的最佳转速为2θ1=7.3166rad/s。假设目标的对接轴在本体坐标轴的z方向,图3给出了服务航天器静止时(a)以及以最佳转速自转时 (b)目标的对接轴端点在服务航天器的本体坐标系中的投影。可以看出,通过自转,对接轴端点的运动轨迹得到了简化。同时,图4给出了服务航天器静止时(a)以及以最佳转速自转时(b)目标的对接轴端点相对于服务航天器的运动速度。可以看出,通过自转,对接轴端点运动的相对速度也降低了许多。综上所述,服务航天器通过自转可以极大地降低对目标的接轴端点的对接难度,从而提高对接的成功率。
Claims (5)
1.一种针对服务航天器定轴转动时的最佳自转角速度的计算方法,其特征在于,包括以下步骤:
1)利用视觉观测***或者激光雷达测距***,测量翻滚目标实时的姿态并使用四元数表示方法进行记录,同时记录各姿态对应的时间;
2)在采集N组目标姿态四元数的观测信息后,对姿态四元数的各个分量进行离散傅里叶变换,由于姿态动力学方程的特性,四元数的离散傅里叶变换结果在频域中的图形会出现若干个尖峰,其中N的值需满足fm代表时域中观测值的采样频率,f1为时域中观测数据变换到频域中的图形上的第一个尖峰所对应的频率;
3)以峰值高度最高的三个尖峰所对应的频率作为初始值,通过扩展卡尔曼滤波或其他滤波方法,利用更多的四元数观测数据,使得对这些频率的估计值精确;
4)在对以上频率的估计的相对误差小于5%之后,找到在四元数的频域图形中峰值最高的尖峰所对应的频率,通过此频率直接计算得到服务航天器的最佳自转角速度。
2.根据权利要求1所述的一种针对服务航天器定轴转动时的最佳自转角速度的计算方法,其特征在于,步骤1)中所述的观测***得到的四元数观测值为q(tk),其中tk为第k次观测所对应的时间,观测值包含有误差,且误差被认为是高斯白噪声进行处理。
4.根据权利要求3所述的一种针对服务航天器定轴转动时的最佳自转角速度的计算方法,其特征在于,步骤3)中采用的滤波方法,在滤波过程中的状态量取为x=[uT,θT]T,其中u=[u1,u2,…,u24]T是一常数向量,θ=[θ1,θ2,θ3]T为特征角频率组成的向量,滤波器运行之前,u的初始值为一零向量,θ的初始值为θ0=2π[f1,f2,f3]T;状态量的误差方差阵的初始值为
其中I24×24和I3×3分别为维度为24×24和维度为3×3的单位矩阵,状态向量的一步预测方程为
xk=xk-1
其中xk和xk-1分别为状态量x在tk时刻和tk-1时刻的估计值,同时由于四元数是可观测的,则基于该状态向量的观测方程为
在滤波过程中,θ1的估计值越来越精确。
5.根据权利要求4所述的一种针对服务航天器定轴转动时的最佳自转角速度的计算方法,其特征在于,步骤4)中最终得到的航天器最佳自转角速度为2θ1,角速度矢量的方向与目标的角动量方向重合,服务航天器沿目标的角动量方向接近、抓捕目标。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710375156.1A CN107168350B (zh) | 2017-05-24 | 2017-05-24 | 一种针对服务航天器定轴转动时的最佳自转角速度的计算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710375156.1A CN107168350B (zh) | 2017-05-24 | 2017-05-24 | 一种针对服务航天器定轴转动时的最佳自转角速度的计算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107168350A CN107168350A (zh) | 2017-09-15 |
CN107168350B true CN107168350B (zh) | 2020-04-21 |
Family
ID=59821836
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710375156.1A Expired - Fee Related CN107168350B (zh) | 2017-05-24 | 2017-05-24 | 一种针对服务航天器定轴转动时的最佳自转角速度的计算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107168350B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111288888B (zh) * | 2018-12-10 | 2021-08-10 | 中国科学院沈阳自动化研究所 | 面向机械手自动抓捕的大尺寸圆环目标结构光测量方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5569681B2 (ja) * | 2010-04-23 | 2014-08-13 | 国立大学法人 東京大学 | 慣性センサ,磁気センサおよび速度計を用いた移動体の姿勢推定装置および姿勢推定方法 |
US9073648B2 (en) * | 2013-02-15 | 2015-07-07 | The Boeing Company | Star tracker rate estimation with kalman filter enhancement |
CN103218482B (zh) * | 2013-03-29 | 2017-07-07 | 南京航空航天大学 | 一种动力学***中不确定参数的估计方法 |
CN103983278B (zh) * | 2014-05-19 | 2016-07-27 | 中国人民解放军国防科学技术大学 | 一种测量影响卫星姿态确定***精度的方法 |
CN106482896A (zh) * | 2016-09-28 | 2017-03-08 | 西北工业大学 | 一种任意形状翻滚卫星的非接触式惯量系数辨识方法 |
CN106468554B (zh) * | 2016-09-29 | 2018-05-15 | 西北工业大学 | 一种非接触式的翻滚卫星的惯性参数的测算方法 |
-
2017
- 2017-05-24 CN CN201710375156.1A patent/CN107168350B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN107168350A (zh) | 2017-09-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106468554B (zh) | 一种非接触式的翻滚卫星的惯性参数的测算方法 | |
CN107607947B (zh) | 基于卡尔曼滤波的星载雷达成像参数在线估计方法 | |
CN106289641B (zh) | 挠性航天器质心位置和转动惯量参数联合辨识方法 | |
CN111880410B (zh) | 一种针对电机故障的四旋翼无人机容错控制方法 | |
CN105976353A (zh) | 基于模型和点云全局匹配的空间非合作目标位姿估计方法 | |
CN107421541B (zh) | 一种容错非接触式失效卫星的形态参数测算方法 | |
CN110125936A (zh) | 一种空间机器人的柔顺控制方法和地面实验验证*** | |
CN103217544B (zh) | 用星敏感器星点位置变化估算星体角速度的方法及*** | |
CN108680198B (zh) | 一种基于羽流扰动的相对导航目标惯性参数辨识方法 | |
CN109426147B (zh) | 捕获卫星后组合航天器的自适应增益调整控制方法 | |
CN110503713B (zh) | 一种基于轨迹平面法向量和圆心结合的旋转轴估计方法 | |
CN107702709A (zh) | 一种非合作目标运动与惯性参数的时频域混合辨识方法 | |
CN107167145B (zh) | 一种自适应非接触式失效卫星的形态参数测算方法 | |
CN107246883A (zh) | 一种高精度星敏感器安装矩阵在轨实时校准方法 | |
CN109093620B (zh) | 一种双目相机辅助的空间非合作目标动力学参数辨识方法 | |
CN106482896A (zh) | 一种任意形状翻滚卫星的非接触式惯量系数辨识方法 | |
CN114923503B (zh) | 一种基于主元分析的在轨航天器陀螺仪和星敏感器故障诊断方法 | |
CN107168350B (zh) | 一种针对服务航天器定轴转动时的最佳自转角速度的计算方法 | |
CN110567462A (zh) | 一种近似自旋非合作航天器三轴转动惯量比的辨识方法 | |
Liu et al. | Mass and mass center identification of target satellite after rendezvous and docking | |
Biondi et al. | Kinematic registration and shape analysis for locating center of mass in large passive spacecraft | |
Feng et al. | Pose and motion estimation of unknown tumbling spacecraft using stereoscopic vision | |
CN106326576B (zh) | 一种任意基准系下的整星偏置角动量的偏航估计方法 | |
EP2879011A1 (en) | On-board estimation of the nadir attitude of an Earth orbiting spacecraft | |
CN109145387B (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200421 |