用于目标姿态跟踪的刚性航天器的控制方法技术

用于目标姿态跟踪的刚性航天器的控制方法，属于航天器高精度高稳定性的姿态跟踪控制技术领域。它解决了姿态跟踪航天器在外太空中低轨道运行时，现有控制方法中不能消除滑模变结构的固有振颤的问题。本发明专利技术包括以下步骤：一、建立刚性航天器的动力学与运动学模型；二、设定刚性航天器的姿态跟踪误差和期望姿态参数，将姿态跟踪误差和期望姿态参数和动力学与运动学模型结合建立用于姿态跟踪的数学模型；三、采用滑模变结构控制器的控制算法调整二中建立的用于姿态跟踪的数学模型的控制律，同时结合干扰观测器的观测结果对所述控制律进行修正；四、用三中获得的修正后的控制律控制刚性航天器实现姿态跟踪。本发明专利技术适用于外太空运行的目标的姿态跟踪。

【技术实现步骤摘要】

本专利技术涉及一种，属于航天器高精度与高稳定性的姿态跟踪控制

技术介绍
姿态跟踪技术在航天器编队飞行、对地监测与成像等许多领域具有重要的应用价值。实现航天器姿态跟踪的控制方法是其中的核心技术，国内外已经有许多的研究与应用。例如传统的PID控制，模糊控制以及自适应控制等，但这些方法均有一定的局限性。外太空航天器运行的中低轨道，存在相对较大的环境力矩，这些环境力矩会严重影响航天器的姿态运动。因此，外太空中低轨道运行的航天器的姿态跟踪的控制方法应重点考虑其鲁棒性、快速性以及保证航天器平台的稳定性。滑模变结构控制由于具有响应快速、对参数和扰动不灵敏、控制精度高以及无需在线辨识等优点，被广泛应用在刚性航天器的姿态跟踪控制的研究上。但是，滑模变结构控制本质上的不连续开关特性会引起系统振颤。振颤不仅影响航天器平台的稳定以及跟踪控制的精确性，还会增加能量消耗，损耗控制器件。目前具有代表性的抑制滑模变结构固有振颤的方法有边界层方法、智能控制与滑模变结构控制相结合以及高阶滑模方法。但这些方法都不适用于外太空中低轨道存在较大力矩干扰情况下，用于姿态跟踪的刚性航天器所采用的滑模变结构的控制方法上。
技术实现思路
本专利技术的目的是为了解决姿态跟踪航天器在外太空中低轨道运行时，现有控制方法中不能消除滑模变结构的固有振颤的问题，提供了一种。 本专利技术基于滑模变结构控制器和干扰观测器来实现，它包括以下步骤 步骤一 建立刚性航天器的动力学与运动学模型； 步骤二 设定刚性航天器的姿态跟踪误差和与所述姿态跟踪误差相对应的期望姿态参数，再将姿态跟踪误差和期望姿态参数与步骤一中建立的动力学与运动学模型相结合建立刚性航天器用于姿态跟踪的数学模型； 步骤三采用滑模变结构控制器的控制算法调整步骤二中建立的用于姿态跟踪的数学模型的控制律，同时结合干扰观测器的观测结果对所述控制律进行修正； 步骤四用步骤三中获得的修正后的控制律控制刚性航天器实现姿态跟踪。 本专利技术的优点是 本专利技术针对外太空中低轨道运行的用于姿态跟踪的刚性航天器的控制方法，提出了一种以滑模变结构控制为主，结合干扰观测器的方法来进行姿态跟踪的控制方法，在保证了滑模变结构控制本身的快速性以及对外界干扰的鲁棒性的同时，通过干扰观测器的融合来抑制外太空中低轨道的力矩干扰，解决了滑模变结构控制系统本身的固有振颤问题，同时保证了刚性航天器平台的稳定性，使姿态跟踪的控制精度提高。附图说明 图l是本专利技术方法的流程图；图2是本专利技术的控制原理图；图3是采用本专利技术的控制方法对刚性航天器进行控制的姿态跟踪过程中姿态跟踪误差^的标量部分qTO的仿真曲线图；图4是采用本专利技术的控制方法对刚性航天器进行控制的姿态跟踪过程中姿态跟踪误差qe的矢量部分qre。的仿真曲线图，qe由&、 q2、 q3组成；图5是采用本专利技术的控制方法对刚性航天器进行控制的姿态跟踪过程中姿态跟踪误差"e的仿真曲线，"x、 "y、"，表示"e的三个分量；图6是本专利技术控制方法中修正后的控制律u的曲线图，图中曲线Ul、 u2、 u3表示所述修正后的控制律u的三个分量，从该曲线可以获知，所述修正后的控制率u抑制了滑模变结构控制器的固有振颤；图7是滑模变结构控制器获得的控制律u的曲线图，图中曲线Ul、u2、u3表示所述控制律u的三个分量，从该曲线可以获知，所述控制率u中带有滑模变结构控制器的固有振颤。具体实施例方式具体实施方式一 下面结合图l和图2说明本实施方式，本实施方式基于滑模变结构控制器1和干扰观测器2来实现，它包括以下步骤 步骤一 建立刚性航天器的动力学与运动学模型； 步骤二 设定刚性航天器的姿态跟踪误差和与所述姿态跟踪误差相对应的期望姿态参数，再将姿态跟踪误差和期望姿态参数与步骤一中建立的动力学与运动学模型相结合建立刚性航天器用于姿态跟踪的数学模型； 步骤三采用滑模变结构控制器1的控制算法调整步骤二中建立的用于姿态跟踪的数学模型的控制律，同时结合干扰观测器2的观测结果对所述控制律进行修正； 步骤四用步骤三中获得的修正后的控制律控制刚性航天器实现姿态跟踪。 具体实施方式二 本实施方式是对实施方式一中步骤一的进一步说明所述步骤一中的刚性航天器的动力学模型为 J^+6;x(7w」+ w = J， 刚性航天器的动力学模型为 《二丄C2(ft))'《，2 式中J为航天器的转动惯量矩阵，"为航天器在体坐标系下相对惯性坐标系的角速度矢量，U为控制律，d表示外部的干扰力矩；q为刚性航天器姿态四元数，且满足约束3Z《,2 =1， Q (")为含有角速度分量的输入矩阵。,.=0 具体实施方式三本实施方式是对实施方式一中步骤二的进一步说明所述步骤二中姿态跟踪误差设定为&和"^期望姿态参数设定为qd和"d，定义四元数乘法，则姿态跟踪误差与期望姿态参数之间建立公式为 & =《/1 《， "e = "-AX "rt， 式中②表示四元数乘法，A表示航天器轨道坐标系到体坐标系的转换矩阵，将所述姿态跟踪误差与期望姿态参数之间建立的公式和动力学与运动学模型相结合，建立用于姿态跟踪的数学模型为 & =*Q(We)'ge' 式中"eX为coe的叉乘矩阵。具体实施方式四下面结合图3_图7说明本实施方式，本实施方式是对实施方式一中步骤三的进一步说明所述步骤三中采用滑模变结构控制器1的控制算法调整步骤二中建立的用于姿态跟踪的数学模型的控制律的方法为 首先定义切换函数s :s = "e+kqvec = "-A "d+kqvec， qre。为^的矢量部分，k为正定对角阵，将步骤二中用于姿态跟踪的数学模型的控制律调整为 式中u^为等效控制，并满足;二 0 ;^为开关控制，对外部扰动和参数变化具有鲁棒性，G取为正定对角阵，sgn为符号函数； 所述步骤三中结合干扰观测器2的观测结果对所述控制律进行修正的过程为 干扰观测器2采用的控制算法为_0o一八1 —「 「+w +a 一 aIM—-/r2 式中，具有如下形式的函数(J)代表①的估计值，q和「2为增益矩阵，控制输入M =尸1 (W + ,增益矩阵M = -J—卞，f = J—M， I为单位矩阵； 采用干扰观测器2对外部的干扰力矩d的观测结果^ 二 J .》对所述滑模变结构控制器1的控制律进行修正，修正后滑模变结构控制器1的控制律调整为A〃二w,+w +丄 其中^ 二一一 +J.^)XJ(6;e + j.^)+J(C0^.a - j.^) ， P为增益矩阵，此时对目标的姿态跟踪实现。 通过调整控制律u使姿态跟踪误差^和"e收敛于0时，表明刚性航天器对被跟6踪目标的姿态跟踪成功。 如图3、图4和图5所示，分别为姿态跟踪过程中姿态跟踪误差^的标量部分qTO 与矢量部分L。和"e的仿真曲线图，可以看出从仿真的初始时刻开始，经过大约70s时， 和"e均收敛于O，验证了本专利技术控制方法的有效性；对比图6和图7可以看出，通过结 合干扰观测器2对外部干扰的观测并对滑模变结构控制器1的控制律进行修正，有效的抑 制了滑模变结构控制器1的固有振颤，提高了控制系统的性能。 可见本专利技术方法控制的刚性航天器适合于在外太空的中低轨道运行并对目标进 行跟踪，具有响应速度快，对外界环境力矩干扰不敏感以及保持航天器本文档来自技高网...

【技术保护点】
一种用于目标姿态跟踪的刚性航天器的控制方法，它基于滑模变结构控制器（１）和干扰观测器（２）来实现，其特征在于：它包括以下步骤：步骤一：建立刚性航天器的动力学与运动学模型；步骤二：设定刚性航天器的姿态跟踪误差和与所述姿态跟踪误差相对应的期望姿态参数，再将姿态跟踪误差和期望姿态参数与步骤一中建立的动力学与运动学模型相结合建立刚性航天器用于姿态跟踪的数学模型；步骤三：采用滑模变结构控制器（１）的控制算法调整步骤二中建立的用于姿态跟踪的数学模型的控制律，同时结合干扰观测器（２）的观测结果对所述控制律进行修正；步骤四：用步骤三中获得的修正后的控制律控制刚性航天器实现姿态跟踪。

【技术特征摘要】

【专利技术属性】
技术研发人员：孙兆伟，邬树楠，苗赢，吴限德，陈长春，
申请(专利权)人：哈尔滨工业大学，
类型：发明
国别省市：93[中国|哈尔滨]