基于一体化线性算子和抗饱和技术的航天器跟踪控制方法
文献发布时间：2023-06-19 15:47:50
技术领域
本发明涉及航天器跟踪控制方法。
背景技术
在航天器编队飞行和交会对接等空间近距离任务中，传统的控制技术往往采用姿态和轨道独立控制的思想，这一策略由于忽略了姿态和轨道间的耦合效应，难以满足高精度的控制需求；在考虑模型不确定性时，受制于参数的非线性存在形式，常常先将该不确定性归为系统总干扰的一部分，然后采用神经网络或者观测器等估计结构进行处理，这一策略会大大增加闭环系统的复杂度，而难以应用于实际航天任务；对于输入饱和现象，大多采用规避饱和的策略，这一策略会增加控制器的设计难度和保守性，不利于控制实现和利用执行机构的控制能力。
李群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为本发明流程图，
图2a为角速度跟踪误差对比图，ω
图2b为姿态跟踪误差对比图，θ为追踪航天器姿态误差，θ
图3a为速度跟踪误差对比图，v
图3b为位置跟踪误差对比图，β为追踪航天器位置误差，β
图4a为控制力矩对比图，M为控制力矩，M
图4b为控制力对比图，F为控制力，F
具体实施方式
具体实施方式一：本实施方式基于一体化线性算子和抗饱和技术的航天器跟踪控制方法具体过程为：
步骤1：测量获取目标航天器姿轨状态和追踪航天器姿轨状态，基于目标航天器姿轨状态和追踪航天器姿轨状态确定目标航天器和追踪航天器之间相对位姿构型，基于目标航天器和追踪航天器之间相对位姿构型获得追踪航天器位姿追踪误差；
步骤2：基于目标航天器和追踪航天器之间相对位姿构型，确定追踪航天器本体坐标系下的速度追踪误差；
步骤3：基于S1和S2，定义追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差；
步骤4：引入线性算子，确定惯性参数更新矩阵；
步骤5：根据步骤3的追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差和步骤4的惯性参数更新矩阵，执行转动惯量和质量一体化参数自适应律，获得惯性参数实时估计；
步骤6：基于饱和函数的定义，确定输入偏差，获得抗饱和辅助系统状态向量；
步骤7：基于步骤3、步骤4、步骤5和步骤6，获得控制输入向量，根据控制输入向量执行位姿一体化跟踪控制策略。
具体实施方式二：本实施方式与具体实施方式一不同的是，所述步骤1中测量获取目标航天器姿轨状态和追踪航天器姿轨状态，基于目标航天器姿轨状态和追踪航天器姿轨状态确定目标航天器和追踪航天器之间相对位姿构型，基于目标航天器和追踪航天器之间相对位姿构型获得追踪航天器位姿追踪误差；具体过程为：
测量获取目标航天器姿轨状态
(η)
其中，
其它步骤及参数与具体实施方式一相同。
具体实施方式三：本实施方式与具体实施方式一或二不同的是，所述追踪航天器位置追踪误差的指数坐标向量β表达式为：
β＝S
其中，I
其它步骤及参数与具体实施方式一或二相同。
具体实施方式四：本实施方式与具体实施方式一至三之一不同的是，所述步骤2中基于目标航天器和追踪航天器之间相对位姿构型
基于状态变换矩阵可实现6维矢量的一般性坐标变换，基于坐标变换，追踪航天器在本体坐标系下的速度追踪误差表达式如下：
式中，ξ
其它步骤及参数与具体实施方式一至三之一相同。
具体实施方式五：本实施方式与具体实施方式一至四之一不同的是，所述速度变换映射
其中，(x)
其它步骤及参数与具体实施方式一至四之一相同。
具体实施方式六：本实施方式与具体实施方式一至五之一不同的是，所述步骤3中基于S1和S2，定义追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差；具体过程为：
通过引入常正定对角矩阵将广义速度误差和基于指数坐标的位姿误差转化为一个误差矢量，当该矢量趋近于零时，其中的广义速度误差和位姿误差也将收敛到零。追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差表达式如下：
其中，
其它步骤及参数与具体实施方式一至五之一相同。
具体实施方式七：本实施方式与具体实施方式一至六之一不同的是，所述步骤4中引入线性算子，确定惯性参数更新矩阵；具体过程为：
对于滤波误差动力学中的惯性参数矩阵参与的非线性运算等价转换为线性运算形式。其转换过程如下：
1)对于含有形如
2)将惯性矩阵转换成列向量的形式：
ρ
3)基于该线性算子，相应的惯性参数更新矩阵表示如下，
其中，
所述矩阵
μ
所述运动学矩阵G(η)表达式为：
其中，β
其它步骤及参数与具体实施方式一至六之一相同。
具体实施方式八：本实施方式与具体实施方式一至七之一不同的是，所述步骤5中根据步骤3的追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差和步骤4的惯性参数更新矩阵，执行转动惯量和质量一体化参数自适应律，获得惯性参数实时估计；具体过程为：
其中，
其它步骤及参数与具体实施方式一至七之一相同。
具体实施方式九：本实施方式与具体实施方式一至八之一不同的是，所述步骤6中基于饱和函数的定义，确定输入偏差，获得抗饱和辅助系统状态向量；具体过程为：
输入偏差表达式如下：
利用输入偏差设计抗饱和辅助系统，表示如下，
其中，
其它步骤及参数与具体实施方式一至八之一相同。
具体实施方式十：本实施方式与具体实施方式一至九之一不同的是，所述步骤7中基于步骤3、步骤4、步骤5和步骤6，获得控制输入向量，根据控制输入向量执行位姿一体化跟踪控制策略；具体过程为：
以姿轨一体化控制的方式克服不确定性参数对跟踪性能的负面影响，同时补偿输入受限对系统稳定性的消极作用。控制输入向量
其中，
其它步骤及参数与具体实施方式一至九之一相同。
采用以下实施例验证本发明的有益效果：
实施例一：
步骤1：获取目标航天器姿轨状态和追踪航天器姿轨状态；
对
g为考虑了噪声的目标航天器姿轨状态g
其中，ξ是航天器速度，(ξ)
确定目标航天器和追踪航天器之间相对位姿构型
步骤2：基于目标航天器和追踪航天器之间相对位姿构型，确定追踪航天器本体坐标系下的速度追踪误差；
步骤3：基于S1和S2，定义追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差；
步骤4：引入线性算子，确定惯性参数更新矩阵；
步骤5：根据步骤3的追踪航天器本体坐标下目标航天器和追踪航天器的滤波误差和步骤4的惯性参数更新矩阵，执行转动惯量和质量一体化参数自适应律，获得惯性参数实时估计；
步骤6：基于饱和函数的定义，确定输入偏差，获得抗饱和辅助系统状态向量；
步骤7：基于步骤3、步骤4、步骤5和步骤6，获得控制输入向量
实施例二：
为便于说明本发明的应用效果，下面以一个在轨服务任务为例进行仿真说明。仿真中，假定目标航天器运行在高度为400km，倾角为45°的圆轨道上，目标航天器体坐标轴与其惯性主轴重合，其惯量和质量的矩阵取为:
ξ
位置单位、角速度和平移速度单位分别为km，rad/s，km/s.
对于追踪航天器，其转动惯量为：
质量为m＝105kg，不确定部分为Δm＝0.03m andΔJ＝0.12J。目标服务航天器的初始状态如下得到：其姿态变换矩阵通过按被服务航天器体坐标系的“Z-X-Z”相继旋转π/4得到，服务航天器在被服务航天器体坐标系下[15,-10,-20]
表1控制器参数
惯性参数更新律的初值和其他状态变量的初值皆取0.
从图2a、2b、3a、3b中可以看到，姿态和平移运动都收敛到期望状态，跟踪航天器完成对目标航天器的姿态跟踪。除速度跟踪误差收敛时间大于70s但小于90s的外，几乎所有受控状态的稳定时间都不超过70s。对于稳态行为，160s后的稳态误差分别不超过1.1e-6deg/s，1e-5deg，3e-6m/s，3e-5m。
由图4a、4b可见，力和力矩均由限定值逐渐减小，在该控制作用下跟踪航天器以较快速度和较高精度到达期望的跟踪状态，并继续保持对目标航天器状态的跟踪。实际的航天器执行机构可以提供限定幅值的控制力和控制力矩，表明了本发明所声明的控制方法具有一定的工程应用价值。
本发明还可有其它多种实施例，在不背离本发明精神及其实质的情况下，本领域技术人员当可根据本发明作出各种相应的改变和变形，但这些相应的改变和变形都应属于本发明所附的权利要求的保护范围。