CN113485396A - 一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法 - Google Patents

一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法 Download PDF

Info

Publication number
CN113485396A
CN113485396A CN202110748227.4A CN202110748227A CN113485396A CN 113485396 A CN113485396 A CN 113485396A CN 202110748227 A CN202110748227 A CN 202110748227A CN 113485396 A CN113485396 A CN 113485396A
Authority
CN
China
Prior art keywords
relative orbit
attitude
spacecraft
tracking
relative
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
Application number
CN202110748227.4A
Other languages
English (en)
Other versions
CN113485396B (zh
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.)
Beijing Institute of Control Engineering
Original Assignee
Beijing Institute of Control Engineering
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 Beijing Institute of Control Engineering filed Critical Beijing Institute of Control Engineering
Priority to CN202110748227.4A priority Critical patent/CN113485396B/zh
Publication of CN113485396A publication Critical patent/CN113485396A/zh
Application granted granted Critical
Publication of CN113485396B publication Critical patent/CN113485396B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • G05D1/0816Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
    • G05D1/0825Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models

Landscapes

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

Abstract

一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法,为了解决现有预设性能控制方案中控制器设计对系统跟踪误差初值有依赖性,而且现有的方法在考虑相对轨道与姿态跟踪误差预设性能约束的情况下,不能保证满足实际交会对接任务中推力器、控制力矩陀螺、动量轮等执行机构的物理结构限制的问题,通过建立跟踪航天器与目标航天器之间相对轨道与姿态跟踪动力学模型,构造一种新的性能函数,放宽了对初始跟踪误差已知的限制,利用预设性能的设计思想来实现兼顾相对轨道与姿态跟踪误差的精细稳态与暂态控制,并通过设计一个辅助饱和补偿系统来补偿执行机构的饱和非线性。

Description

一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制 方法
技术领域
本发明涉及一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法,属于航天器控制技术领域。
背景技术
随着空间技术的快速发展,如何实现跟踪航天和目标航天器的交会对接,是完成在轨清理、维修及空间加注等任务的重要保障。此外,在实际空间交会对接操作中,往往要求跟踪航天器与目标航天器相对轨道与姿态控制误差具有指定的暂态和稳态性能,因此,如何实现考虑执行机构饱和约束的相对轨道与姿态预设性能控制,是交会对接任务的一项关键技术。
传统的交会对接控制方法大多将重点放在控制系统的稳态性能的研究上,即保证跟踪航天器与目标航天器之间的相对轨道和相对姿态跟踪误差收敛到一个有界的区域或渐进收敛至平衡点,而对跟踪误差收敛过程的暂态性能(包括超调量和收敛速度)的研究则相对较少。鉴于此,有学者提出了一种预设性能控制的概念,预设性能设计方法要求跟踪误差必须收敛到预先定义的任意小的残差内,同时,收敛速度、超调量必须保证满足之前设置的条件。其中,预设性能指标通过性能函数来描述,通过引入误差转换,将系统满足预设性能的问题转化为新的误差的有界性问题。该技术在航天领域也受到了广泛的关注。然而,上述技术仍然存在技术缺陷,即传统的预设性能设计方法对系统跟踪误差初值有依赖性,使得预设性能的应用受到一定的限制。此外,在实际交会对接任务中由于推力器、控制力矩陀螺、动量轮等执行机构的物理结构限制,使得相对轨道与姿态控制系统存在控制控制饱和非线性,控制系统处于饱和状态下会导致闭环系统控制性能降低,甚至破坏系统的稳定性,因此针对交会对接任务有必要提出一种考虑执行机构饱和约束同时具有预设性能的相对轨道与姿态耦合控制方法。
发明内容
本发明解决的技术问题是:针对目前现有技术中存在的不足,提出了一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法,既兼顾了相对轨道与姿态跟踪系统的暂态性能和稳态性能,同时考虑了执行机构的饱和约束,保证交会对接任务的顺利实现。
本发明解决上述技术问题是通过如下技术方案予以实现的:
一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法,步骤如下:
(1)考虑执行机构饱和约束的情况,建立跟踪航天器与目标航天器间六自由度交会对接模型;
跟踪航天器与目标航天器间六自由度交会对接模型包括两个航天器间相对轨道与相对姿态跟踪控制运动学模型、动力学模型;
(2)根据交会对接任务中相对轨道与姿态跟踪控制误差的暂态和稳态性能指标要求,设计相对轨道与姿态跟踪误差性能函数;
(3)根据步骤(2)所得误差性能函数构造转换误差变量,并利用转换误差变量构造相对轨道与姿态跟踪控制器的中间误差变量;
(4)根据步骤(1)所得相对姿态跟踪控制运动学模型及动力学模型与步骤(3)所得中间误差变量设计相对轨道与姿态虚拟控制量,利用所得相对轨道与姿态虚拟控制量计算相对轨道与姿态虚拟控制量的导数;
(5)利用步骤(1)所得相对姿态跟踪控制运动学模型及动力学模型、步骤(3)所得中间误差变量、步骤(4)所得相对轨道与姿态虚拟控制量的导数,构建抗饱和预设性能交会对接控制器,通过构建自适应律对跟踪航天器质量、转动惯量矩阵分量与控制器设计所需的辅助变量进行估计。
步骤(1)中,跟踪航天器与目标航天器间六自由度交会对接模型的建模过程具体为:
(1-1)分别建立跟踪航天器和目标航天器的相关坐标系,
Figure BDA0003139353770000021
为惯性坐标系,
Figure BDA0003139353770000022
为跟踪航天器的本体坐标系,
Figure BDA0003139353770000023
为目标航天器的本体坐标系;
(1-2)建立两个航天器间相对轨道与相对姿态跟踪控制运动学模型、动力学模型,具体为:
Figure BDA0003139353770000031
Figure BDA0003139353770000032
式中,
Figure BDA0003139353770000033
为用修正罗德里格斯参数描述的姿态跟踪误差,
Figure BDA0003139353770000034
为姿态跟踪误差,
Figure BDA0003139353770000035
为轨道器转动惯量矩阵,
Figure BDA0003139353770000036
Figure BDA0003139353770000037
分别表示干扰力矩与控制力矩;
相对姿态动力学模型中矩阵G(σe)、Ca和非线性向量ha具体为:
Figure BDA0003139353770000038
Ca=S(J(ωe+R(σet))-S(R(σet)J-JS(R(σet)
Figure BDA0003139353770000039
跟踪航天器与目标航天器相对轨道跟踪运动学与动力学模型分别为:
Figure BDA00031393537700000310
Figure BDA00031393537700000311
式中,
Figure BDA00031393537700000312
Figure BDA00031393537700000313
分别表示相对轨道与速度跟踪误差,m为轨道器质量,
Figure BDA00031393537700000314
Figure BDA00031393537700000315
分别表示轨道器与上升器的角速度,满足ωe=ωs-R(σet
Figure BDA00031393537700000316
Figure BDA00031393537700000317
分别表示干扰力与控制力。S(·)为叉乘算子,hp为相对轨道动力学模型中非线性向量。
对于任意三维向量γ=[γ1 γ2 γ3]T,S(γ)具体为:
Figure BDA00031393537700000321
相对轨道动力学模型中非线性向量hp具体为:
Figure BDA00031393537700000318
控制力矩
Figure BDA00031393537700000319
与控制力
Figure BDA00031393537700000320
分别存在幅值上限τmax与fmax,此时τi与fi(i=1,2,3)分别满足:
Figure BDA0003139353770000046
Figure BDA0003139353770000045
步骤(2)中,相对轨道与姿态跟踪误差性能函数具体为:
Figure BDA0003139353770000041
Figure BDA0003139353770000042
式中,ρpi∞与ρσi∞分别为相对轨道跟踪误差与姿态跟踪误差稳态精度指标,lpi和lσi分别约束相对轨道与姿态跟踪误差的收敛速度,κσ与κp均为正常数。
步骤(3)中,转换误差变量具体为:
Figure BDA0003139353770000043
Figure BDA0003139353770000044
式中,δui与δli分别为性能边界约束系数;
利用转换误差变量构造相对轨道与姿态跟踪控制器的中间误差变量具体为:
Figure BDA0003139353770000047
Figure BDA0003139353770000048
式中,ασ和αp均为待设计的虚拟控制量,ξσ1σ2和ξp1p2均为待设计的辅助补偿信号,其中:
Figure BDA0003139353770000051
Figure BDA0003139353770000052
式中,Kσ1,Kσ21,Kσ2和Kp1,Kp21,Kp2均为正定矩阵,Δτ=τ-τc,Δf=f-fc
步骤(4)中,相对轨道与姿态虚拟控制量具体为:
Figure BDA0003139353770000053
Figure BDA0003139353770000054
式中,K1,Kσ1,Kσ21与K3,Kp1,Kp21均为对称正定矩阵。
Figure BDA0003139353770000055
Figure BDA0003139353770000056
分别为:
Figure BDA0003139353770000057
Figure BDA0003139353770000058
相对轨道与姿态虚拟控制量的导数估计值
Figure BDA0003139353770000059
Figure BDA00031393537700000510
分别为:
Figure BDA00031393537700000511
Figure BDA00031393537700000512
式中,ζ12与ωn1n2分别为命令滤波器增益与阻尼比。
步骤(5)中,抗饱和预设性能交会对接控制器具体为:
Figure BDA00031393537700000513
式中,K2,Kσ2,Kσ21和K4,K4,Kp21均为对称正定矩阵;
辅助变量kσ与kp的自适应律分别为:
Figure BDA0003139353770000061
Figure BDA0003139353770000062
式中,bσ,bσ1,bσ2和bp,bp1,bp2均为正常数,
Figure BDA0003139353770000063
Figure BDA0003139353770000064
的自适应律分别为:
Figure BDA0003139353770000065
式中,Γ1和Γ2均为正定矩阵,Proj(·)为投影算子,kσ为正常数,
Figure BDA0003139353770000066
具体为:
Figure BDA0003139353770000067
Figure BDA0003139353770000068
Figure BDA0003139353770000069
所述
Figure BDA00031393537700000610
为线性算子,对于任意向量α=[a1 a2 a3]T
Figure BDA00031393537700000611
其中,
Figure BDA00031393537700000612
Figure BDA00031393537700000613
的自适应律分别为:
Figure BDA0003139353770000071
式中,γ3与kp均为正常数,Γ4均为正定矩阵。
本发明与现有技术相比的优点在于:
本发明提供的一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法,通过构造相对轨道与姿态跟踪误差性能函数,放宽了对初始跟踪误差已知的限制,利用预设性能的设计思想来实现兼顾精细稳态与暂态控制,同时在考虑预设稳态和暂态性能的同时兼顾了执行机构的饱和约束,克服了传统预设性能控制方法依赖跟踪误差初值的缺点,为了解决现有预设性能控制方案中控制器设计对系统跟踪误差初值有依赖性、不能保证满足实际交会对接任务中推力器、控制力矩陀螺、动量轮等执行机构的物理结构限制,工程实现性强。
附图说明
图1为发明提供的坐标系建立示意图;
图2为发明提供的考虑执行机构饱和约束的抗饱和预设性能相对轨道与姿态跟踪控制方法流程框图;
图3为发明提供的相对轨道跟踪误差x轴分量曲线;
图4为发明提供的相对轨道跟踪误差y轴分量曲线;
图5为发明提供的相对轨道跟踪误差z轴分量曲线;
图6为发明提供的相对姿态跟踪误差x轴分量曲线;
图7为发明提供的相对姿态跟踪误差y轴分量曲线;
图8为发明提供的相对姿态跟踪误差z轴分量曲线;
具体实施方式
一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法,通过构造一种新的性能函数,放宽了对初始跟踪误差已知的限制,利用预设性能的设计思想来实现兼顾精细稳态与暂态控制,在考虑预设稳态和暂态性能的同时兼顾了执行机构的饱和约束。
首先建立了交会对接任务中最后逼近段追踪航天器与目标航天器间的相对轨道与姿态跟踪动力学与运动学模型,考虑了模型不确定性、外界环境干扰、执行机构饱和约束。然后,分别设计不依赖初值的性能边界来约束相对轨道跟踪误差与相对姿态跟踪误差。同时,设计辅助补偿信号来解决执行机构的控制约束难题,最后设计自适应更新律来估计模型不确定性,并由此得到最终的追踪航天器与目标航天器间的相对轨道与姿态跟踪控制律,具体步骤如下:
(1)考虑执行机构饱和约束的情况,建立跟踪航天器与目标航天器间六自由度交会对接模型;
跟踪航天器与目标航天器间六自由度交会对接模型包括两个航天器间相对轨道与相对姿态跟踪控制运动学模型、动力学模型;
其中,跟踪航天器与目标航天器间六自由度交会对接模型的建模过程具体为:
(1-1)分别建立跟踪航天器和目标航天器的相关坐标系,
Figure BDA0003139353770000081
为惯性坐标系,
Figure BDA0003139353770000082
为跟踪航天器的本体坐标系,
Figure BDA0003139353770000083
为目标航天器的本体坐标系;
(1-2)建立两个航天器间相对轨道与相对姿态跟踪控制运动学模型、动力学模型,具体为:
Figure BDA0003139353770000084
Figure BDA0003139353770000085
式中,
Figure BDA0003139353770000086
为用修正罗德里格斯参数描述的姿态跟踪误差,
Figure BDA0003139353770000087
为姿态跟踪误差,
Figure BDA0003139353770000088
为轨道器转动惯量矩阵,
Figure BDA0003139353770000089
Figure BDA00031393537700000810
分别表示干扰力矩与控制力矩;
相对姿态动力学模型中矩阵G(σe)、Ca和非线性向量ha具体为:
Figure BDA00031393537700000811
Ca=S(J(ωe+R(σet))-S(R(σet)J-JS(R(σet)
Figure BDA00031393537700000812
跟踪航天器与目标航天器相对轨道跟踪运动学与动力学模型分别为:
Figure BDA0003139353770000091
Figure BDA0003139353770000092
式中,
Figure BDA0003139353770000093
Figure BDA0003139353770000094
分别表示相对轨道与速度跟踪误差,m为轨道器质量,
Figure BDA0003139353770000095
Figure BDA0003139353770000096
分别表示轨道器与上升器的角速度,满足ωe=ωs-R(σet
Figure BDA0003139353770000097
Figure BDA0003139353770000098
分别表示干扰力与控制力。S(·)为叉乘算子,hp为相对轨道动力学模型中非线性向量;
进一步的,对于任意三维向量γ=[γ1 γ2 γ3]T,S(γ)具体为:
Figure BDA00031393537700000914
相对轨道动力学模型中非线性向量hp具体为:
Figure BDA0003139353770000099
控制力矩
Figure BDA00031393537700000910
与控制力
Figure BDA00031393537700000911
分别存在幅值上限τmax与fmax,此时τi与fi(i=1,2,3)分别满足:
Figure BDA00031393537700000915
Figure BDA00031393537700000916
(2)根据交会对接任务中相对轨道与姿态跟踪控制误差的暂态和稳态性能指标要求,设计相对轨道与姿态跟踪误差性能函数;
其中,相对轨道与姿态跟踪误差性能函数具体为:
Figure BDA00031393537700000912
Figure BDA00031393537700000913
式中,ρpi∞与ρσi∞分别为相对轨道跟踪误差与姿态跟踪误差稳态精度指标,lpi和lσi分别约束相对轨道与姿态跟踪误差的收敛速度,κσ与κp均为正常数;
(3)根据步骤(2)所得误差性能函数构造转换误差变量,并利用转换误差变量构造相对轨道与姿态跟踪控制器的中间误差变量;
其中,转换误差变量具体为:
Figure BDA0003139353770000101
Figure BDA0003139353770000102
式中,δui与δli分别为性能边界约束系数;
利用转换误差变量构造相对轨道与姿态跟踪控制器的中间误差变量具体为:
Figure BDA0003139353770000105
Figure BDA0003139353770000106
式中,ασ和αp均为待设计的虚拟控制量,ξσ1σ2和ξp1p2均为待设计的辅助补偿信号,其中:
Figure BDA0003139353770000103
Figure BDA0003139353770000104
式中,Kσ1,Kσ21,Kσ2和Kp1,Kp21,Kp2均为正定矩阵,Δτ=τ-τc,Δf=f-fc
(4)根据步骤(1)所得相对姿态跟踪控制运动学模型及动力学模型与步骤(3)所得中间误差变量设计相对轨道与姿态虚拟控制量,利用所得相对轨道与姿态虚拟控制量计算相对轨道与姿态虚拟控制量的导数;
其中,相对轨道与姿态虚拟控制量具体为:
Figure BDA0003139353770000111
Figure BDA0003139353770000112
式中,K1,Kσ1,Kσ21与K3,Kp1,Kp21均为对称正定矩阵。
Figure BDA0003139353770000113
Figure BDA0003139353770000114
分别为:
Figure BDA0003139353770000115
Figure BDA0003139353770000116
相对轨道与姿态虚拟控制量的导数估计值
Figure BDA0003139353770000117
Figure BDA0003139353770000118
分别为:
Figure BDA0003139353770000119
Figure BDA00031393537700001110
式中,ζ12与ωn1n2分别为命令滤波器增益与阻尼比;
(5)利用步骤(1)所得相对姿态跟踪控制运动学模型及动力学模型、步骤(3)所得中间误差变量、步骤(4)所得相对轨道与姿态虚拟控制量的导数,构建抗饱和预设性能交会对接控制器,通过构建自适应律对跟踪航天器质量、转动惯量矩阵分量与控制器设计所需的辅助变量进行估计。
其中,抗饱和预设性能交会对接控制器具体为:
Figure BDA00031393537700001111
式中,K2,Kσ2,Kσ21和K4,K4,Kp21均为对称正定矩阵;
辅助变量kσ与kp的自适应律分别为:
Figure BDA0003139353770000121
Figure BDA0003139353770000122
式中,bσ,bσ1,bσ2和bp,bp1,bp2均为正常数,
Figure BDA0003139353770000123
Figure BDA0003139353770000124
的自适应律分别为:
Figure BDA0003139353770000125
式中,Γ1和Γ2均为正定矩阵,Proj(·)为投影算子,kσ为正常数,
Figure BDA0003139353770000126
具体为:
Figure BDA0003139353770000127
Figure BDA0003139353770000128
Figure BDA0003139353770000129
Figure BDA00031393537700001210
为线性算子,对于任意向量α=[a1 a2 a3]T
Figure BDA00031393537700001211
其中,
Figure BDA00031393537700001212
Figure BDA00031393537700001213
的自适应律分别为:
Figure BDA0003139353770000131
式中,γ3与kp均为正常数,Γ4均为正定矩阵。
下面结合具体实施例进行进一步说明:
在本实施例中,如图1、图2所示,针对交会对接任务中跟踪航天器与目标航天器间的相对轨道与姿态跟踪控制问题提出了一种抗饱和预设性能控制方法,具体步骤为:
(1)在考虑执行机构饱和约束的情况下,建立跟踪航天器与目标航天器间六自由度交会对接模型,该模型包含两个航天器之间的相对轨道和相对姿态跟踪控制运动学与动力学。
Figure BDA0003139353770000132
Figure BDA0003139353770000133
式中,
Figure BDA0003139353770000134
为用修正罗德里格斯参数描述的姿态跟踪误差,
Figure BDA0003139353770000135
为姿态跟踪误差,
Figure BDA0003139353770000136
为轨道器转动惯量矩阵,
Figure BDA0003139353770000137
Figure BDA0003139353770000138
分别表示干扰力矩与控制力矩,由于实际执行机构物理结构的限制,导致控制力矩
Figure BDA0003139353770000139
存在幅值上限τmax,即
Figure BDA00031393537700001313
相对姿态动力学模型中矩阵G(σe)、Ca和非线性向量ha分别表示为
Figure BDA00031393537700001310
Ca=S(J(ωe+R(σet))-S(R(σet)J-JS(R(σet)
Figure BDA00031393537700001311
相对轨道跟踪控制系统的运动学与动力学模型分别为:
Figure BDA00031393537700001312
Figure BDA0003139353770000141
式中,
Figure BDA0003139353770000142
Figure BDA0003139353770000143
分别表示相对轨道与速度跟踪误差,m为轨道器质量,
Figure BDA0003139353770000144
Figure BDA0003139353770000145
分别表示轨道器与上升器的角速度,满足ωe=ωs-R(σet
Figure BDA0003139353770000146
Figure BDA0003139353770000147
分别表示干扰力与控制力,由于实际执行机构物理结构的限制,导致控制力
Figure BDA0003139353770000148
存在幅值上限fmax,即
Figure BDA00031393537700001413
相对轨道动力学模型中非线性向量hp
Figure BDA0003139353770000149
S(·)为叉乘算子,定义:对于任意三维向量γ=[γ1 γ2 γ3]T,S(γ)为
Figure BDA00031393537700001414
(2)根据交会对接任务中相对轨道与姿态跟踪控制误差的暂态和稳态性能指标要求,设计相对轨道与姿态跟踪误差性能函数。
Figure BDA00031393537700001410
Figure BDA00031393537700001411
式中,ρpi∞与ρσi∞分别表示相对轨道跟踪误差与姿态跟踪误差稳态精度指标,lpi和lσi分别约束相对轨道与姿态跟踪误差的收敛速度,κσ与κp均为正常数。
(3)基于步骤(2)的相对轨道与姿态跟踪误差性能函数构造转换误差变量;
Figure BDA00031393537700001412
Figure BDA0003139353770000151
式中,δui与δli分别为性能边界约束系数,一般取1。
(4)基于步骤(3)的相对轨道与姿态转换误差变量构造用于后续相对轨道与姿态跟踪控制器设计的中间误差变量;
Figure BDA0003139353770000159
Figure BDA00031393537700001510
式中,ασ和αp均为待设计的虚拟控制量,ξσ1σ2和ξp1p2均为待设计的辅助补偿信号,分别满足
Figure BDA0003139353770000152
Figure BDA0003139353770000153
式中,Kσ1,Kσ21,Kσ2和Kp1,Kp21,Kp2均为正定矩阵,Δτ=τ-τc,Δf=f-fc
(5)基于步骤(1)的相对轨道与姿态运动学和步骤(4)中相对轨道与姿态中间误差变量设计相对轨道与姿态虚拟控制量;
Figure BDA0003139353770000154
Figure BDA0003139353770000155
式中,K1,Kσ1,Kσ21与K3,Kp1,Kp21均为对称正定矩阵。
Figure BDA0003139353770000156
Figure BDA0003139353770000157
分别为
Figure BDA0003139353770000158
Figure BDA0003139353770000161
(6)基于步骤(5)的相对轨道与姿态虚拟控制量,求解相对轨道与姿态虚拟控制量的导数估计值
Figure BDA0003139353770000162
Figure BDA0003139353770000163
Figure BDA0003139353770000164
Figure BDA0003139353770000165
式中,ζ12与ωn1n2分别为命令滤波器增益与阻尼比。
(7)基于步骤(1)的相对轨道与姿态动力学、步骤(4)中相对轨道与姿态中间误差变量、步骤(6)的相对轨道与姿态虚拟控制量的导数设计抗饱和预设性能交会对接控制器,并构建自适应律估计跟踪航天器质量、转动惯量矩阵分量与控制器设计所需的辅助变量。
Figure BDA0003139353770000166
式中,K2,Kσ2,Kσ21和K4,K4,Kp21均为对称正定矩阵,辅助变量kσ与kp的自适应律分别为
Figure BDA0003139353770000167
Figure BDA0003139353770000168
式中,bσ,bσ1,bσ2和bp,bp1,bp2均为正常数,
Figure BDA0003139353770000169
Figure BDA00031393537700001610
的自适应律分别为
Figure BDA0003139353770000171
式中,Γ1和Γ2均为正定矩阵,Proj(·)为投影算子,kσ为正常数,
Figure BDA0003139353770000172
表示为
Figure BDA0003139353770000173
Figure BDA0003139353770000174
可表示为
Figure BDA0003139353770000175
Figure BDA0003139353770000176
式中,
Figure BDA0003139353770000177
为线性算子,对于任意向量α=[a1 a2 a3]T,有
Figure BDA0003139353770000178
Figure BDA0003139353770000179
Figure BDA00031393537700001710
的自适应律分别为
Figure BDA00031393537700001711
式中,γ3与kp均为正常数,Γ4均为正定矩阵。
给出本发明仿真实例,如图3至图5所示,给出了跟踪航天器与目标航天器间相对轨道跟踪误差随时间变化曲线,如图6至图8所示,给出了跟踪航天器与目标航天器间相对姿态跟踪误差随时间变化曲线。根据图3∽5和图6∽8可以看出,相对轨道与姿态跟踪误差均能在较短的时间内收敛到平衡点附近,而且整个暂态过程中,相对轨道与姿态跟踪误差均位于由相对轨道与姿态跟踪性能指标要求所确定的性能边界约束范围内。
综上,本发明设计的交会对接最后逼近段相对轨道与姿态跟踪控制方法,通过设计一种新的预设性能函数,克服了传统预设性能控制方法依赖跟踪误差初值的缺点。在考虑了执行机构饱和约束的情况下,既保证了控制系统稳定的同时,又兼顾了相对轨道与姿态跟踪误差的暂态性能和稳态性能。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。

Claims (8)

1.一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法,其特征在于步骤如下:
(1)考虑执行机构饱和约束的情况,建立跟踪航天器与目标航天器间六自由度交会对接模型;
跟踪航天器与目标航天器间六自由度交会对接模型包括两个航天器间相对轨道与相对姿态跟踪控制运动学模型、动力学模型;
(2)根据交会对接任务中相对轨道与姿态跟踪控制误差的暂态和稳态性能指标要求,设计相对轨道与姿态跟踪误差性能函数;
(3)根据步骤(2)所得误差性能函数构造转换误差变量,并利用转换误差变量构造相对轨道与姿态跟踪控制器的中间误差变量;
(4)根据步骤(1)所得相对姿态跟踪控制运动学模型及动力学模型与步骤(3)所得中间误差变量设计相对轨道与姿态虚拟控制量,利用所得相对轨道与姿态虚拟控制量计算相对轨道与姿态虚拟控制量的导数;
(5)利用步骤(1)所得相对姿态跟踪控制运动学模型及动力学模型、步骤(3)所得中间误差变量、步骤(4)所得相对轨道与姿态虚拟控制量的导数,构建抗饱和预设性能交会对接控制器,通过构建自适应律对跟踪航天器质量、转动惯量矩阵分量与控制器设计所需的辅助变量进行估计。
2.根据权利要求1所述的一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法,其特征在于:
所述步骤(1)中,跟踪航天器与目标航天器间六自由度交会对接模型的建模过程具体为:
(1-1)分别建立跟踪航天器和目标航天器的相关坐标系,
Figure FDA0003139353760000011
为惯性坐标系,
Figure FDA0003139353760000012
为跟踪航天器的本体坐标系,
Figure FDA0003139353760000013
为目标航天器的本体坐标系;
(1-2)建立两个航天器间相对轨道与相对姿态跟踪控制运动学模型、动力学模型,具体为:
Figure FDA0003139353760000021
Figure FDA0003139353760000022
式中,
Figure FDA0003139353760000023
为用修正罗德里格斯参数描述的姿态跟踪误差,
Figure FDA0003139353760000024
为姿态跟踪误差,
Figure FDA0003139353760000025
为轨道器转动惯量矩阵,
Figure FDA0003139353760000026
Figure FDA0003139353760000027
分别表示干扰力矩与控制力矩;
相对姿态动力学模型中矩阵G(σe)、Ca和非线性向量ha具体为:
Figure FDA0003139353760000028
Ca=S(J(ωe+R(σet))-S(R(σet)J-JS(R(σet)
Figure FDA0003139353760000029
跟踪航天器与目标航天器相对轨道跟踪运动学与动力学模型分别为:
Figure FDA00031393537600000210
Figure FDA00031393537600000211
式中,
Figure FDA00031393537600000212
Figure FDA00031393537600000213
分别表示相对轨道与速度跟踪误差,m为轨道器质量,
Figure FDA00031393537600000214
Figure FDA00031393537600000215
分别表示轨道器与上升器的角速度,满足ωe=ωs-R(σet
Figure FDA00031393537600000216
Figure FDA00031393537600000217
分别表示干扰力与控制力。S(·)为叉乘算子,hp为相对轨道动力学模型中非线性向量。
3.根据权利要求2所述的一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法,其特征在于:
对于任意三维向量γ=[γ1 γ2 γ3]T,S(γ)具体为:
Figure FDA00031393537600000218
相对轨道动力学模型中非线性向量hp具体为:
Figure FDA00031393537600000219
控制力矩
Figure FDA00031393537600000220
与控制力
Figure FDA00031393537600000221
分别存在幅值上限τmax与fmax,此时τi与fi(i=1,2,3)分别满足:
Figure FDA0003139353760000031
Figure FDA0003139353760000032
4.根据权利要求1所述的一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法,其特征在于:
所述步骤(2)中,相对轨道与姿态跟踪误差性能函数具体为:
Figure FDA0003139353760000033
Figure FDA0003139353760000034
式中,ρpi∞与ρσi∞分别为相对轨道跟踪误差与姿态跟踪误差稳态精度指标,lpi和lσi分别约束相对轨道与姿态跟踪误差的收敛速度,κσ与κp均为正常数。
5.根据权利要求1所述的一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法,其特征在于:
所述步骤(3)中,转换误差变量具体为:
Figure FDA0003139353760000035
Figure FDA0003139353760000036
式中,δui与δli分别为性能边界约束系数;
利用转换误差变量构造相对轨道与姿态跟踪控制器的中间误差变量具体为:
Figure FDA0003139353760000041
Figure FDA0003139353760000042
式中,ασ和αp均为待设计的虚拟控制量,ξσ1σ2和ξp1p2均为待设计的辅助补偿信号,其中:
Figure FDA0003139353760000043
Figure FDA0003139353760000044
式中,Kσ1,Kσ21,Kσ2和Kp1,Kp21,Kp2均为正定矩阵,Δτ=τ-τc,Δf=f-fc
6.根据权利要求1所述的一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法,其特征在于:
所述步骤(4)中,相对轨道与姿态虚拟控制量具体为:
Figure FDA0003139353760000045
Figure FDA0003139353760000046
式中,K1,Kσ1,Kσ21与K3,Kp1,Kp21均为对称正定矩阵。
Figure FDA0003139353760000047
Figure FDA0003139353760000048
分别为:
Figure FDA0003139353760000049
Figure FDA00031393537600000410
相对轨道与姿态虚拟控制量的导数估计值
Figure FDA00031393537600000411
Figure FDA00031393537600000412
分别为:
Figure FDA0003139353760000051
Figure FDA0003139353760000052
式中,ζ12与ωn1n2分别为命令滤波器增益与阻尼比。
7.根据权利要求1所述的一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法,其特征在于:
所述步骤(5)中,抗饱和预设性能交会对接控制器具体为:
Figure FDA0003139353760000053
式中,K2,Kσ2,Kσ21和K4,K4,Kp21均为对称正定矩阵;
辅助变量kσ与kp的自适应律分别为:
Figure FDA0003139353760000054
Figure FDA0003139353760000055
式中,bσ,bσ1,bσ2和bp,bp1,bp2均为正常数,
Figure FDA0003139353760000056
Figure FDA0003139353760000057
的自适应律分别为:
Figure FDA0003139353760000058
式中,Γ1和Γ2均为正定矩阵,Proj(·)为投影算子,kσ为正常数,
Figure FDA0003139353760000059
具体为:
Figure FDA00031393537600000510
Figure FDA0003139353760000061
Figure FDA0003139353760000062
8.根据权利要求7所述的一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法,其特征在于:
所述
Figure FDA0003139353760000063
为线性算子,对于任意向量α=[a1 a2 a3]T
Figure FDA0003139353760000064
其中,
Figure FDA0003139353760000065
Figure FDA0003139353760000066
的自适应律分别为:
Figure FDA0003139353760000067
式中,γ3与kp均为正常数,Γ4均为正定矩阵。
CN202110748227.4A 2021-06-29 2021-06-29 一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法 Active CN113485396B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110748227.4A CN113485396B (zh) 2021-06-29 2021-06-29 一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110748227.4A CN113485396B (zh) 2021-06-29 2021-06-29 一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法

Publications (2)

Publication Number Publication Date
CN113485396A true CN113485396A (zh) 2021-10-08
CN113485396B CN113485396B (zh) 2023-11-10

Family

ID=77939503

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110748227.4A Active CN113485396B (zh) 2021-06-29 2021-06-29 一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法

Country Status (1)

Country Link
CN (1) CN113485396B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114153222A (zh) * 2022-02-10 2022-03-08 伸瑞科技(北京)有限公司 多约束条件下的姿轨一体跟踪控制方法、装置

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2017005052A1 (zh) * 2015-07-09 2017-01-12 北京航空航天大学 航天器脉冲交会轨迹的梯度分割区间优化设计方法
CN108375904A (zh) * 2018-02-28 2018-08-07 北京航空航天大学 一种非合作目标航天器交会对接最终段饱和控制方法
CN108646556A (zh) * 2018-05-08 2018-10-12 中国人民解放军战略支援部队航天工程大学 输入饱和航天器无退绕姿态跟踪控制方法
CN108762284A (zh) * 2018-05-17 2018-11-06 北京航空航天大学 一种基于lpv技术的航天器姿态跟踪控制方法与装置
CN110347173A (zh) * 2019-08-21 2019-10-18 哈尔滨工业大学 一种基于非连续自适应控制的航天器姿态跟踪控制方法
US10882644B1 (en) * 2017-07-31 2021-01-05 Space Systems/Loral, Llc Spacecraft rendezvous and docking techniques
CN112394645A (zh) * 2021-01-20 2021-02-23 中国人民解放军国防科技大学 一种航天器姿态跟踪的神经网络反步滑模控制方法和系统
CN113619814A (zh) * 2021-06-29 2021-11-09 北京控制工程研究所 一种交会对接最后逼近段相对姿轨耦合控制方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2017005052A1 (zh) * 2015-07-09 2017-01-12 北京航空航天大学 航天器脉冲交会轨迹的梯度分割区间优化设计方法
US10882644B1 (en) * 2017-07-31 2021-01-05 Space Systems/Loral, Llc Spacecraft rendezvous and docking techniques
CN108375904A (zh) * 2018-02-28 2018-08-07 北京航空航天大学 一种非合作目标航天器交会对接最终段饱和控制方法
CN108646556A (zh) * 2018-05-08 2018-10-12 中国人民解放军战略支援部队航天工程大学 输入饱和航天器无退绕姿态跟踪控制方法
CN108762284A (zh) * 2018-05-17 2018-11-06 北京航空航天大学 一种基于lpv技术的航天器姿态跟踪控制方法与装置
CN110347173A (zh) * 2019-08-21 2019-10-18 哈尔滨工业大学 一种基于非连续自适应控制的航天器姿态跟踪控制方法
CN112394645A (zh) * 2021-01-20 2021-02-23 中国人民解放军国防科技大学 一种航天器姿态跟踪的神经网络反步滑模控制方法和系统
CN113619814A (zh) * 2021-06-29 2021-11-09 北京控制工程研究所 一种交会对接最后逼近段相对姿轨耦合控制方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
刘鲁华;汤国建;余梦伦: "采用终端滑模控制实现交会对接逼近段姿态跟踪", 国防科技大学学报, no. 002, pages 16 - 21 *
陶佳伟;张涛;: "考虑控制受限的近距离星间相对姿轨耦合控制", 清华大学学报(自然科学版), no. 03, pages 89 - 94 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114153222A (zh) * 2022-02-10 2022-03-08 伸瑞科技(北京)有限公司 多约束条件下的姿轨一体跟踪控制方法、装置

Also Published As

Publication number Publication date
CN113485396B (zh) 2023-11-10

Similar Documents

Publication Publication Date Title
CN108803649B (zh) 一种垂直起降重复使用运载器自抗扰滑模控制方法
Sun et al. Fixed-time sliding mode disturbance observer-based nonsmooth backstepping control for hypersonic vehicles
CN110308735B (zh) 一种针对输入时滞的欠驱动uuv轨迹跟踪滑模控制方法
Sun et al. Adaptive backstepping control of spacecraft rendezvous and proximity operations with input saturation and full-state constraint
An et al. Barrier Lyapunov function-based adaptive control for hypersonic flight vehicles
Hu et al. Disturbance observer based finite-time attitude control for rigid spacecraft under input saturation
Ming et al. A novel non-singular terminal sliding mode control-based integrated missile guidance and control with impact angle constraint
CN107807657B (zh) 一种基于路径规划的挠性航天器姿态自适应控制方法
CN108563131B (zh) 一种卫星姿态控制系统执行器失控故障的自适应补偿方法
CN113619814B (zh) 一种交会对接最后逼近段相对姿轨耦合控制方法
CN113859589B (zh) 一种基于模型预测控制与滑模控制的航天器姿态控制方法
Chen et al. Nonlinear fault-tolerant control for hypersonic flight vehicle with multi-sensor faults
Wang et al. Configuration error function design and application to fixed-time geometric terminal sliding-mode control on SE (3)
CN110333656B (zh) 一种基于互联系统方法的挠性航天器容错控制方法
CN113485396B (zh) 一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法
CN113110527B (zh) 一种自主水下航行器有限时间路径跟踪的级联控制方法
Cao et al. Robust flight control design using sensor-based backstepping control for unmanned aerial vehicles
CN110647161A (zh) 基于状态预测补偿的欠驱动uuv水平面轨迹跟踪控制方法
CN113485394B (zh) 一种高精度固定时间收敛的相对姿态容错跟踪控制方法
CN116360258A (zh) 基于固定时间收敛的高超声速变形飞行器抗干扰控制方法
CN113220003B (zh) 一种非合作柔性组合体航天器姿态稳定混合非脆弱控制方法
Gregory Dynamic inversion to control large flexible transport aircraft
Wu et al. Finite-time reentry attitude control using time-varying sliding mode and disturbance observer
CN113485395A (zh) 一种误差约束下固定时间相对姿轨跟踪控制方法
Lorenz Open-loop reference system for nonlinear control applied to unmanned helicopters

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