CN114671050B - 基于一体化线性算子和抗饱和技术的航天器跟踪控制方法 - Google Patents
基于一体化线性算子和抗饱和技术的航天器跟踪控制方法 Download PDFInfo
- Publication number
- CN114671050B CN114671050B CN202210324784.8A CN202210324784A CN114671050B CN 114671050 B CN114671050 B CN 114671050B CN 202210324784 A CN202210324784 A CN 202210324784A CN 114671050 B CN114671050 B CN 114671050B
- Authority
- CN
- China
- Prior art keywords
- spacecraft
- tracking
- matrix
- vector
- target
- 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 46
- 238000005516 engineering process Methods 0.000 title claims abstract description 11
- 239000011159 matrix material Substances 0.000 claims abstract description 93
- 239000013598 vector Substances 0.000 claims abstract description 83
- 230000008569 process Effects 0.000 claims abstract description 21
- 238000001914 filtration Methods 0.000 claims abstract description 18
- 238000011217 control strategy Methods 0.000 claims abstract description 7
- 230000014509 gene expression Effects 0.000 claims description 14
- 230000008859 change Effects 0.000 claims description 8
- 239000000126 substance Substances 0.000 claims description 8
- 230000009466 transformation Effects 0.000 claims description 8
- 238000013519 translation Methods 0.000 claims description 6
- 238000013461 design Methods 0.000 claims description 4
- 230000005484 gravity Effects 0.000 claims description 2
- 238000013507 mapping Methods 0.000 claims description 2
- 238000003491 array Methods 0.000 claims 1
- 230000007246 mechanism Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 230000010354 integration Effects 0.000 description 3
- 230000036544 posture Effects 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 230000003044 adaptive effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000009795 derivation Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000002411 adverse Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000001808 coupling effect Effects 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000003032 molecular docking Methods 0.000 description 1
- 238000011426 transformation method Methods 0.000 description 1
- 230000000007 visual effect Effects 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/242—Orbits and trajectories
-
- 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/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
- B64G1/245—Attitude control algorithms for spacecraft attitude control
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
基于一体化线性算子和抗饱和技术的航天器跟踪控制方法,本发明涉及航天器跟踪控制方法。本发明的目的是为了解决近距空间任务中,航天器在受制于惯性参数不确定性和输入饱和等不利工况的条件,导致航天器姿态轨道跟踪机动控制性能低的问题。过程为:测量获取目标和追踪航天器姿轨状态,确定目标和追踪航天器之间相对位姿构型,获得追踪航天器位姿追踪误差;确定追踪航天器本体坐标系下的速度追踪误差;定义追踪航天器本体坐标下目标和追踪航天器的滤波误差;引入线性算子,确定惯性参数更新矩阵;获得惯性参数实时估计;获得抗饱和辅助系统状态向量;获得控制输入向量执行位姿一体化跟踪控制策略。本发明用于航天器跟踪控制领域。
Description
技术领域
本发明涉及航天器跟踪控制方法。
背景技术
在航天器编队飞行和交会对接等空间近距离任务中,传统的控制技术往往采用姿态和轨道独立控制的思想,这一策略由于忽略了姿态和轨道间的耦合效应,难以满足高精度的控制需求;在考虑模型不确定性时,受制于参数的非线性存在形式,常常先将该不确定性归为系统总干扰的一部分,然后采用神经网络或者观测器等估计结构进行处理,这一策略会大大增加闭环系统的复杂度,而难以应用于实际航天任务;对于输入饱和现象,大多采用规避饱和的策略,这一策略会增加控制器的设计难度和保守性,不利于控制实现和利用执行机构的控制能力。
李群SE(3)是三维欧几里得空间中刚体的位置和姿态的集合,可以以独特的非奇异方式一体化描述航天器的姿态运动和位置运动。SE(3)上的指数坐标同样可描述航天器的运动状态,其优势在于可针对不同工况,结合优良的控制方法进行控制器的设计。该变换方法不显式依赖航天器姿态参数和速度参数,使得控制目标更加直观,推导过程更为简化,控制器形式更简洁。
自适应方法同样能够处理模型中的未知参数,特别在处理线性形式的不确定性时,其较其它的估计结构更具有效性和简洁性,因而在引入线性算子将未知的惯性参数从非线性运算中分离开来后,采用自适应策略更新不确定性参数的估计值并反馈到控制器中,会显著提高控制器的性能。
抗饱和策略允许输入饱和现象发生,但在控制器中增加抗饱和辅助系统补偿饱和偏差对系统稳定性带来的影响。该方法由于允许执行机构满载运行,因此可以充分执行机构的控制能力,显著减低控制设计的保守性。
基于上述分析,有必要设计一种基于自适应方法和抗饱和策略的位姿一体化跟踪控制算法,解决航天器姿态轨道跟踪机动控制问题。
发明内容
本发明的目的是为了解决近距空间任务中,航天器在受制于惯性参数不确定性和输入饱和等不利工况的条件,导致航天器姿态轨道跟踪机动控制性能低的问题,而提出基于一体化线性算子和抗饱和技术的航天器跟踪控制方法。
基于一体化线性算子和抗饱和技术的航天器跟踪控制方法具体过程为:
步骤1:测量获取目标航天器姿轨状态和追踪航天器姿轨状态,基于目标航天器姿轨状态和追踪航天器姿轨状态确定目标航天器和追踪航天器之间相对位姿构型,基于目标航天器和追踪航天器之间相对位姿构型获得追踪航天器位姿追踪误差;
步骤2:基于目标航天器和追踪航天器之间相对位姿构型,确定追踪航天器本体坐标系下的速度追踪误差;
步骤3:基于S1和S2,定义追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差;
步骤4:引入线性算子,确定惯性参数更新矩阵;
步骤5:根据步骤3的追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差和步骤4的惯性参数更新矩阵,获得惯性参数实时估计;
步骤6:基于饱和函数的定义,确定输入偏差,获得抗饱和辅助系统状态向量;
步骤7:基于步骤3、步骤4、步骤5和步骤6,获得控制输入向量,根据控制输入向量执行位姿一体化跟踪控制策略。
本发明的有益效果为:
本发明针对空间近距任务中航天器姿态和位置跟踪机动控制问题,提出一种基于自适应方法和抗饱和策略的位姿一体化跟踪控制算法,该方法能够在存在惯性参数不确定性和输入饱和的情况下,保证受控航天器系统稳定,同时实现姿态和位置快速高精度跟踪目标位姿轨迹。
本发明显著提高轨迹跟踪精度,即位姿误差和速度误差的控制准确度,即可实现稳态误差分别不超过1.1e-6deg/s,1e-5deg,3e-6m/s,3e-5m;消除输入饱和对受控系统的不利影响,实现李雅普诺夫稳定性意义下的实际渐进稳定的控制效果。
附图说明
图1为本发明流程图,为饱和控制输入,为空间干扰向量,g为追踪航天器位姿的空间构型,ω为追踪航天器角速度,v为追踪航天器速度,gd为目标航天器位姿的空间构型,ωd为目标航天器角速度,vd为目标航天器速度,h为位姿构型误差,ve为平移速度,η为位姿追踪误差的指数坐标,ξe为追踪航天器在体坐标系下的速度追踪误差,为输入偏差,为控制输入向量,为追踪航天器惯性参数估计向量,为抗饱和辅助系统状态向量;
图2a为角速度跟踪误差对比图,ωe为追踪航天器角速度误差,ωex为角速度误差x轴分量,ωey为角速度误差y轴分量,ωez为角速度误差z轴分量;
图2b为姿态跟踪误差对比图,θ为追踪航天器姿态误差,θx为姿态误差x轴分量,θy为姿态误差y轴分量,θz为姿态误差z轴分量;
图3a为速度跟踪误差对比图,ve为追踪航天器速度误差,vex为速度误差x轴分量,vey为速度误差y轴分量,vez为速度误差z轴分量;
图3b为位置跟踪误差对比图,β为追踪航天器位置误差,βx为位置误差x轴分量,βy为位置误差y轴分量,βz为位置误差z轴分量;
图4a为控制力矩对比图,M为控制力矩,Mx为控制力矩x轴分量,My为控制力矩y轴分量,Mz为控制力矩z轴分量;
图4b为控制力对比图,F为控制力,Fx为控制力x轴分量,Fy为控制力y轴分量,Fz为控制力z轴分量。
具体实施方式
具体实施方式一:本实施方式基于一体化线性算子和抗饱和技术的航天器跟踪控制方法具体过程为:
步骤1:测量获取目标航天器姿轨状态和追踪航天器姿轨状态,基于目标航天器姿轨状态和追踪航天器姿轨状态确定目标航天器和追踪航天器之间相对位姿构型,基于目标航天器和追踪航天器之间相对位姿构型获得追踪航天器位姿追踪误差;
步骤2:基于目标航天器和追踪航天器之间相对位姿构型,确定追踪航天器本体坐标系下的速度追踪误差;
步骤3:基于S1和S2,定义追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差;
步骤4:引入线性算子,确定惯性参数更新矩阵;
步骤5:根据步骤3的追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差和步骤4的惯性参数更新矩阵,执行转动惯量和质量一体化参数自适应律,获得惯性参数实时估计;
步骤6:基于饱和函数的定义,确定输入偏差,获得抗饱和辅助系统状态向量;
步骤7:基于步骤3、步骤4、步骤5和步骤6,获得控制输入向量,根据控制输入向量执行位姿一体化跟踪控制策略。
具体实施方式二:本实施方式与具体实施方式一不同的是,所述步骤1中测量获取目标航天器姿轨状态和追踪航天器姿轨状态,基于目标航天器姿轨状态和追踪航天器姿轨状态确定目标航天器和追踪航天器之间相对位姿构型,基于目标航天器和追踪航天器之间相对位姿构型获得追踪航天器位姿追踪误差;具体过程为:
(η)∨=logSE(3)h=logSE(3)((gd)-1g)
其中,R∈SO(3)为追踪航天器的体坐标系到地心惯性坐标系的旋转矩阵,为从地心惯性坐标系原点到追踪航天器质心位置的向量,Rd∈SO(3)为目标航天器的体坐标系到地心惯性坐标系的旋转矩阵,为从地心惯性坐标系原点到目标航天器质心位置的向量;SE(3)是一般变换群,SO(3)是特殊正交群,是三维实空间;Q为误差姿态矩阵,x为误差位置;(η)∨是追踪航天器位姿追踪误差的指数坐标的李代数,η是追踪航天器位姿追踪误差的指数坐标,是追踪航天器姿态追踪误差(主旋转矢量)的指数坐标向量,是追踪航天器位置追踪误差的指数坐标向量,θ×是追踪航天器姿态追踪误差(主旋转矢量)的指数坐标向量的反对称矩阵,是6维实空间,01×3是三维零向量。
其它步骤及参数与具体实施方式一相同。
具体实施方式三:本实施方式与具体实施方式一或二不同的是,所述追踪航天器位置追踪误差的指数坐标向量β表达式为:
β=S-1(θ)x
其中,I3是3维单位矩阵,S(θ)为中间矩阵。
其它步骤及参数与具体实施方式一或二相同。
基于状态变换矩阵可实现6维矢量的一般性坐标变换,基于坐标变换,追踪航天器在本体坐标系下的速度追踪误差表达式如下:
其它步骤及参数与具体实施方式一至三之一相同。
其中,(x)×是误差位置的反对称矩阵,03×3是元素为0的3维方阵。
其它步骤及参数与具体实施方式一至四之一相同。
具体实施方式六:本实施方式与具体实施方式一至五之一不同的是,所述步骤3中基于S1和S2,定义追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差;具体过程为:
通过引入常正定对角矩阵将广义速度误差和基于指数坐标的位姿误差转化为一个误差矢量,当该矢量趋近于零时,其中的广义速度误差和位姿误差也将收敛到零。追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差表达式如下:
其它步骤及参数与具体实施方式一至五之一相同。
具体实施方式七:本实施方式与具体实施方式一至六之一不同的是,所述步骤4中引入线性算子,确定惯性参数更新矩阵;具体过程为:
对于滤波误差动力学中的惯性参数矩阵参与的非线性运算等价转换为线性运算形式。其转换过程如下:
2)将惯性矩阵转换成列向量的形式:
ρL=[J11 J22 J33 J23 J13 J12 m]T
3)基于该线性算子,相应的惯性参数更新矩阵表示如下,
其中,是航天器惯性参数矩阵,J是转动惯量矩阵,m是航天器质量,I3是3维单位矩阵,J11、J12、J13、J21、J22、J23、J31、J32、J33是J中元素,03×3是元素为0的3维方阵,为任意六维列向量,是a的线性算子,a1为a中1维分量,a2为a中2维分量,a3为a中3维分量,a4为a中4维分量,a5为a中5维分量,a6为a中6维分量,ρL是惯性参数的列向量形式,T是转置,是惯性参数更新矩阵,adξ是速度伴随矩阵, 是追踪航天器的平移速度,(ν)×是追踪航天器的平移速度的反对称矩阵,是追踪航天器的角速度,(Ω)×是追踪航天器的角速度的反对称矩阵,是追踪航天器速度的共轭伴随矩阵,T为转置,ξd是目标航天器的广义速度矢量,是期望的广义速度矢量的变化率,是ξ的线性算子,是线性算子,G(η)是运动学矩阵,是矩阵,是的线性算子,为矩阵,bb是追踪航天器体系下的位置矢量,为从地心惯性坐标系原点到追踪航天器质心位置的向量;
μe=3.986×1014m3/s2是地球引力常数,Re=6378.14km为地球半径,R(R∈SO(3))为从追踪航天器的体坐标系到地心惯性坐标系的旋转矩阵,bz是位置向量的z轴分量,D=diag([1,1,3])为自定义矩阵,(bb)×是追踪航天器体系下的位置矢量的反对称矩阵;
所述运动学矩阵G(η)表达式为:
其中,β×是追踪航天器位置追踪误差的指数坐标向量的反对称矩阵;A(θ)、T(θ,β)为中间矩阵。
其它步骤及参数与具体实施方式一至六之一相同。
具体实施方式八:本实施方式与具体实施方式一至七之一不同的是,所述步骤5中根据步骤3的追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差和步骤4的惯性参数更新矩阵,执行转动惯量和质量一体化参数自适应律,获得惯性参数实时估计;具体过程为:
其它步骤及参数与具体实施方式一至七之一相同。
具体实施方式九:本实施方式与具体实施方式一至八之一不同的是,所述步骤6中基于饱和函数的定义,确定输入偏差,获得抗饱和辅助系统状态向量;具体过程为:
输入偏差表达式如下:
利用输入偏差设计抗饱和辅助系统,表示如下,
其它步骤及参数与具体实施方式一至八之一相同。
具体实施方式十:本实施方式与具体实施方式一至九之一不同的是,所述步骤7中基于步骤3、步骤4、步骤5和步骤6,获得控制输入向量,根据控制输入向量执行位姿一体化跟踪控制策略;具体过程为:
其它步骤及参数与具体实施方式一至九之一相同。
采用以下实施例验证本发明的有益效果:
实施例一:
步骤1:获取目标航天器姿轨状态和追踪航天器姿轨状态;
g为考虑了噪声的目标航天器姿轨状态gd或追踪航天器姿轨状态gf;
其中,ξ是航天器速度,(ξ)∨是航天器速度的李代数, 是航天器的平移速度,是航天器的角速度,(Ω)×是航天器的角速度的反对称矩阵,01×3是三维零向量,是航天器位姿变化率,是航天器惯性参数矩阵,J是转动惯量矩阵,03×3是元素为0的3维方阵,m是航天器质量,I3是3维单位矩阵,J11、J12、J13、J21、J22、J23、J31、J32、J33是J中元素,是航天器速度变化率,是航天器速度的共轭伴随矩阵,(ν)×是航天器的平移速度的反对称矩阵,T为转置,是空间干扰向量,是控制输入向量,是输入偏差;
步骤2:基于目标航天器和追踪航天器之间相对位姿构型,确定追踪航天器本体坐标系下的速度追踪误差;
步骤3:基于S1和S2,定义追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差;
步骤4:引入线性算子,确定惯性参数更新矩阵;
步骤5:根据步骤3的追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差和步骤4的惯性参数更新矩阵,执行转动惯量和质量一体化参数自适应律,获得惯性参数实时估计;
步骤6:基于饱和函数的定义,确定输入偏差,获得抗饱和辅助系统状态向量;
实施例二:
为便于说明本发明的应用效果,下面以一个在轨服务任务为例进行仿真说明。仿真中,假定目标航天器运行在高度为400km,倾角为45°的圆轨道上,目标航天器体坐标轴与其惯性主轴重合,其惯量和质量的矩阵取为:惯量单位为kg·m2,质量单位为kg,目标航天器初始位姿构型和在其本体下的速度为:
ξd=[0,0,0.0011,0,7.6126,0]T,
位置单位、角速度和平移速度单位分别为km,rad/s,km/s.
对于追踪航天器,其转动惯量为:
质量为m=105kg,不确定部分为Δm=0.03m andΔJ=0.12J。目标服务航天器的初始状态如下得到:其姿态变换矩阵通过按被服务航天器体坐标系的“Z-X-Z”相继旋转π/4得到,服务航天器在被服务航天器体坐标系下[15,-10,-20]Tm处,其角速度和平移速度在其体固连坐标系下为[0.000009,0.000598,0.000931]rad/s和[3.44151,5.69884,-3.69202]km/s。控制目标为将服务航天器从初始位置机动到目的地,并对被服务航天器进行维护。目的地在被服务航天器下方5米处,方向为被服务航天器体固连坐标系x轴的负方向。服务航天器的姿态预期与被服务航天器在目的地的态度一致。仿真中,控制力限制在[-5,5]N,控制力矩限制在[-0.5,0.5]N.m。控制参数列于表1。
表1控制器参数
惯性参数更新律的初值和其他状态变量的初值皆取0.
从图2a、2b、3a、3b中可以看到,姿态和平移运动都收敛到期望状态,跟踪航天器完成对目标航天器的姿态跟踪。除速度跟踪误差收敛时间大于70s但小于90s的外,几乎所有受控状态的稳定时间都不超过70s。对于稳态行为,160s后的稳态误差分别不超过1.1e-6deg/s,1e-5deg,3e-6m/s,3e-5m。
由图4a、4b可见,力和力矩均由限定值逐渐减小,在该控制作用下跟踪航天器以较快速度和较高精度到达期望的跟踪状态,并继续保持对目标航天器状态的跟踪。实际的航天器执行机构可以提供限定幅值的控制力和控制力矩,表明了本发明所声明的控制方法具有一定的工程应用价值。
本发明还可有其它多种实施例,在不背离本发明精神及其实质的情况下,本领域技术人员当可根据本发明作出各种相应的改变和变形,但这些相应的改变和变形都应属于本发明所附的权利要求的保护范围。
Claims (4)
1.基于一体化线性算子和抗饱和技术的航天器跟踪控制方法,其特征在于:所述方法具体过程为:
步骤1:测量获取目标航天器姿轨状态和追踪航天器姿轨状态,基于目标航天器姿轨状态和追踪航天器姿轨状态确定目标航天器和追踪航天器之间相对位姿构型,基于目标航天器和追踪航天器之间相对位姿构型获得追踪航天器位姿追踪误差;
步骤2:基于目标航天器和追踪航天器之间相对位姿构型,确定追踪航天器本体坐标系下的速度追踪误差;
步骤3:基于步骤1和步骤2,定义追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差;
步骤4:引入线性算子,确定惯性参数更新矩阵;
步骤5:根据步骤3的追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差和步骤4的惯性参数更新矩阵,获得惯性参数实时估计;
步骤6:基于饱和函数的定义,确定输入偏差,获得抗饱和辅助系统状态向量;
步骤7:基于步骤3、步骤4、步骤5和步骤6,获得控制输入向量,根据控制输入向量执行位姿一体化跟踪控制策略;
所述步骤1中测量获取目标航天器姿轨状态和追踪航天器姿轨状态,基于目标航天器姿轨状态和追踪航天器姿轨状态确定目标航天器和追踪航天器之间相对位姿构型,基于目标航天器和追踪航天器之间相对位姿构型获得追踪航天器位姿追踪误差;具体过程为:
(η)∨=logSE(3)h=logSE(3)((gd)-1g)
其中,R为追踪航天器的体坐标系到地心惯性坐标系的旋转矩阵,为从地心惯性坐标系原点到追踪航天器质心位置的向量,Rd为目标航天器的体坐标系到地心惯性坐标系的旋转矩阵,为从地心惯性坐标系原点到目标航天器质心位置的向量;是三维实空间;Q为误差姿态矩阵,x为误差位置;(η)∨是追踪航天器位姿追踪误差的指数坐标的李代数,η是追踪航天器位姿追踪误差的指数坐标,是追踪航天器姿态追踪误差的指数坐标向量,是追踪航天器位置追踪误差的指数坐标向量,θ×是追踪航天器姿态追踪误差的指数坐标向量的反对称矩阵,是6维实空间,01×3是三维零向量;
所述追踪航天器位置追踪误差的指数坐标向量β表达式为:
β=S-1(θ)x
其中,I3是3维单位矩阵,S(θ)为中间矩阵;
所述步骤2中基于目标航天器和追踪航天器之间相对位姿构型,确定追踪航天器本体坐标系下的速度追踪误差;具体过程为:
追踪航天器在本体坐标系下的速度追踪误差表达式如下:
其中,(x)×是误差位置的反对称矩阵,03×3是元素为0的3维方阵;
所述步骤3中基于S1和S2,定义追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差;具体过程为:
追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差表达式如下:
所述步骤4中引入线性算子,确定惯性参数更新矩阵;具体过程为:
2)将惯性矩阵转换成列向量的形式:
ρL=[J11 J22 J33 J23 J13 J12 m]T
3)基于该线性算子,相应的惯性参数更新矩阵表示如下,
其中,是航天器惯性参数矩阵,J是转动惯量矩阵,m是航天器质量,I3是3维单位矩阵,J11、J12、J13、J21、J22、J23、J31、J32、J33是J中元素,03×3是元素为0的3维方阵,为任意六维列向量,是a的线性算子,a1为a中1维分量,a2为a中2维分量,a3为a中3维分量,a4为a中4维分量,a5为a中5维分量,a6为a中6维分量,ρL是惯性参数的列向量形式,T是转置,是惯性参数更新矩阵,adξ是速度伴随矩阵,是追踪航天器的平移速度,(ν)×是追踪航天器的平移速度的反对称矩阵,是追踪航天器的角速度,(Ω)×是追踪航天器的角速度的反对称矩阵,是追踪航天器速度的共轭伴随矩阵,T为转置,ξd是目标航天器的广义速度矢量,是期望的广义速度矢量的变化率,是ξ的线性算子,是线性算子,G(η)是运动学矩阵,是矩阵,是的线性算子,为矩阵,bb是追踪航天器体系下的位置矢量,为从地心惯性坐标系原点到追踪航天器质心位置的向量;
μe=3.986×1014m3/s2是地球引力常数,Re=6378.14km为地球半径,R为追踪航天器的体坐标系到地心惯性坐标系的旋转矩阵,bz是位置向量的z轴分量,D=diag([1,1,3])为矩阵,(bb)×是追踪航天器体系下的位置矢量的反对称矩阵;
所述运动学矩阵G(η)表达式为:
其中,β×是追踪航天器位置追踪误差的指数坐标向量的反对称矩阵;A(θ)、T(θ,β)为中间矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210324784.8A CN114671050B (zh) | 2022-03-30 | 2022-03-30 | 基于一体化线性算子和抗饱和技术的航天器跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210324784.8A CN114671050B (zh) | 2022-03-30 | 2022-03-30 | 基于一体化线性算子和抗饱和技术的航天器跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114671050A CN114671050A (zh) | 2022-06-28 |
CN114671050B true CN114671050B (zh) | 2023-01-24 |
Family
ID=82075950
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210324784.8A Active CN114671050B (zh) | 2022-03-30 | 2022-03-30 | 基于一体化线性算子和抗饱和技术的航天器跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114671050B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115202215B (zh) * | 2022-09-13 | 2022-12-20 | 哈尔滨工业大学 | Se(3)上鲁棒自适应姿轨跟踪控制的方法、装置及介质 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5400033A (en) * | 1994-02-07 | 1995-03-21 | Rockwell International Corporation | Tracking system for tracking targets with a spacecraft |
US6691033B1 (en) * | 2000-07-26 | 2004-02-10 | Hughes Electronics Corporation | System and method for calibrating inter-star-tracker misalignments in a stellar inertial attitude determination system |
CN101708780A (zh) * | 2009-11-26 | 2010-05-19 | 哈尔滨工业大学 | 用于目标姿态跟踪的刚性航天器的控制方法 |
CN106814746A (zh) * | 2017-03-24 | 2017-06-09 | 哈尔滨工业大学 | 一种航天器姿轨一体化反步跟踪控制方法 |
CN107422741A (zh) * | 2017-04-28 | 2017-12-01 | 西北工业大学 | 基于学习的保预设性能集群飞行分布式姿态追踪控制方法 |
CN108710303A (zh) * | 2018-07-25 | 2018-10-26 | 西北工业大学 | 含有多源扰动及执行器饱和的航天器相对姿态控制方法 |
CN111605737A (zh) * | 2020-05-11 | 2020-09-01 | 北京控制工程研究所 | 一种航天器三超控制多级协同规划与敏捷机动方法 |
CN113619814A (zh) * | 2021-06-29 | 2021-11-09 | 北京控制工程研究所 | 一种交会对接最后逼近段相对姿轨耦合控制方法 |
CN113885547A (zh) * | 2021-10-20 | 2022-01-04 | 河北工业大学 | 一种刚体航天器预定时间容错姿态控制策略 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108375904B (zh) * | 2018-02-28 | 2020-04-21 | 北京航空航天大学 | 一种非合作目标航天器交会对接最终段饱和控制方法 |
-
2022
- 2022-03-30 CN CN202210324784.8A patent/CN114671050B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5400033A (en) * | 1994-02-07 | 1995-03-21 | Rockwell International Corporation | Tracking system for tracking targets with a spacecraft |
US6691033B1 (en) * | 2000-07-26 | 2004-02-10 | Hughes Electronics Corporation | System and method for calibrating inter-star-tracker misalignments in a stellar inertial attitude determination system |
CN101708780A (zh) * | 2009-11-26 | 2010-05-19 | 哈尔滨工业大学 | 用于目标姿态跟踪的刚性航天器的控制方法 |
CN106814746A (zh) * | 2017-03-24 | 2017-06-09 | 哈尔滨工业大学 | 一种航天器姿轨一体化反步跟踪控制方法 |
CN107422741A (zh) * | 2017-04-28 | 2017-12-01 | 西北工业大学 | 基于学习的保预设性能集群飞行分布式姿态追踪控制方法 |
CN108710303A (zh) * | 2018-07-25 | 2018-10-26 | 西北工业大学 | 含有多源扰动及执行器饱和的航天器相对姿态控制方法 |
CN111605737A (zh) * | 2020-05-11 | 2020-09-01 | 北京控制工程研究所 | 一种航天器三超控制多级协同规划与敏捷机动方法 |
CN113619814A (zh) * | 2021-06-29 | 2021-11-09 | 北京控制工程研究所 | 一种交会对接最后逼近段相对姿轨耦合控制方法 |
CN113885547A (zh) * | 2021-10-20 | 2022-01-04 | 河北工业大学 | 一种刚体航天器预定时间容错姿态控制策略 |
Non-Patent Citations (2)
Title |
---|
基于SE(3)的航天器姿轨一体化建模与控制;段玉瑞;《第二十届中国系统仿真技术及其应用学术年会》;20190820;正文第2.3节 * |
航天器姿轨一体化建模与控制方法研究;张剑桥;《中国博士学位论文全文数据库-工程科技II辑》;20210115(第1期);正文第3-4章 * |
Also Published As
Publication number | Publication date |
---|---|
CN114671050A (zh) | 2022-06-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Patre et al. | Disturbance estimator based non-singular fast fuzzy terminal sliding mode control of an autonomous underwater vehicle | |
CN107065565B (zh) | 一种用于集群航天器电磁拖拽的自抗扰控制方法 | |
CN113110495B (zh) | 一种考虑外部干扰下移动机器人的编队控制方法 | |
CN108646556B (zh) | 输入饱和航天器无退绕姿态跟踪控制方法 | |
CN111506095B (zh) | 一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法 | |
CN108375904B (zh) | 一种非合作目标航天器交会对接最终段饱和控制方法 | |
CN111624878B (zh) | 自主式水面机器人轨迹跟踪的积分滑模获取方法及系统 | |
Dinh et al. | Adaptive tracking control of a quadrotor unmanned vehicle | |
Zhang et al. | Attitude decoupling control of semifloating space robots using time-delay estimation and supertwisting control | |
CN114671050B (zh) | 基于一体化线性算子和抗饱和技术的航天器跟踪控制方法 | |
CN108427281B (zh) | 一种航天器六自由度固定时间交会对接控制方法 | |
CN105912007A (zh) | 空间机械臂抗干扰姿态稳定的微分几何非线性控制方法 | |
CN112148025A (zh) | 一种基于积分补偿强化学习的无人飞行器稳定控制算法 | |
Sun et al. | Saturated adaptive relative motion coordination of docking ports in space close-range rendezvous | |
Wang et al. | Configuration error function design and application to fixed-time geometric terminal sliding-mode control on SE (3) | |
Huang et al. | Distributed flocking control of quad-rotor UAVs with obstacle avoidance under the parallel-triggered scheme | |
CN110377044B (zh) | 一种无人直升机的有限时间高度和姿态跟踪控制方法 | |
CN113220007B (zh) | 执行机构故障的挠性航天器有限时间姿态协同控制方法 | |
CN112990549B (zh) | 一种空间非合作目标抵近绕飞观测轨迹优化方法 | |
Enjiao et al. | Finite-time control of formation system for multiple flight vehicles subject to actuator saturation | |
CN113156820B (zh) | 基于二阶锥优化的多约束下航天器姿态机动路径规划方法 | |
CN113741493A (zh) | 一种航天器安全接近控制方法 | |
Bai et al. | A fuzzy adaptive drogue control method in autonomous aerial refueling | |
He et al. | Unknown Dynamics Estimator-based Control for a 3-DOF Model Helicopter System | |
CN113703451B (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 |