第11卷第6期 智能系统学报 Vol.11 No.6 2016年12月 CAAI Transactions on Intelligent Systems Dec.2016 D0I:10.11992/is.201611022 网络出版地址：http:/www.cnki.net/kcms/detail/23.1538.TP.20170111.1705.022.html 航天器绕飞逼近翻滚目标运动再现的姿轨控制 孙施浩，贾英民 (北京航空航天大学第七研究室，北京100191) 摘要：为了研究地面试验环境下实现航天器捕获失控翻滚目标运动再现的姿轨控制问题，首先，建立了适用于实 验验证的六自由度姿轨联合相似模型，可满足实验场地大小、机构速度和运行时间等约束：其次，基于多项式函数设 计了有限时间收敛且动态性能良好的绕飞逼近参考轨迹，并利用反步法给出了姿轨联合控制律，证明了相似闭环系 统的稳定性。通过仿真算例说明了基于运动再现的姿轨控制方法是有效的。 关键词：运动再现：相似理论：绕飞：翻滚：姿轨控制：航天器 中图分类号：TP18:V416.2文献标志码：A文章编号：1673-4785(2016)06-0818-09 中文引用格式：孙施浩，贾英民.航天器绕飞逼近翻滚目标运动再现的姿轨控制[J].智能系统学报，2016,11(6)：818-826. 英文引用格式：SUN Shihao,JIA Yingmin.Attitude and orbit control of spacecrafts for motion reconstruction of flying around and approaching the tumbling target[J].CAAI Transactions on Intelligent Systems,2016,11(6):818-826. Attitude and orbit control of spacecrafts for motion reconstruction of flying around and approaching the tumbling target SUN Shihao,JIA Yingmin The Seventh Research Division,Beihang University,Beijing 100191,China) Abstract:This paper deals with the attitude and orbit control problem for motion reconstruction of spacecrafts flying around and approaching the tumbling target during ground experiments.Firstly,a 6-DOF similarity model is estab- lished to describe the integrated attitude and orbit motion,which is suitable for the experimental verification with the practical constraints on the space size,running velocity and time involved.Secondly,the polynomial approach is used to design the motion reference trajectory that can ensure finite-time convergence and good dynamic perform- ances,based on which,an integrated attitude and orbit control law is proposed by the back-stepping method and the corresponding closed-loop stability is proved.Finally,a numerical example is included to illustrate the effective- ness of the obtained results. Keywords:motion reconstruction;similarity;flying around;tumbling;attitude and orbit control;spacecrafts 针对空间失控失效航天器进行在轨营救与维修 合控制问题的研究，如Sgal)研究了航天器姿态动 是当前航天领域的一个重要发展方向-】。失控目态对轨道运动的影响，指出建立耦合的动力学模型可 标在空间中处于自由运行的状态，其对接端口随本体 以提高基于视觉的相对位姿控制精度；Liao6研究了 一起在空间中运动，位置时刻都在发生变化，使得传 追踪器本体坐标系下航天器姿轨一体化控制律设计 统的姿态轨道独立控制不能适应快速姿轨机动的要 问题，建立了考虑推进器配置的姿轨动力学模型，并 求3-)。为此，国内外学者开展了大量航天器姿轨联 设计了非线性鲁棒一体化控制律：Shan)设计了一种 自适应同步控制策略，提出了基于交叉耦合概念的六 收稿日期：2016-11-16. 自由度航天器编队飞行控制方法；Zhang!)建立了追 基金项目：国家“973”计划项目(2012CB821200,2012CB821201):国家 自然科学基金项目(61134005,61327807.61520106010). 踪航天器本体坐标系下六自由度模型，采用自适应反 通信作者：孙施浩.E-mail:jxcrssh@126.com. 步法设计了姿轨联合控制器等
第 １１ 卷第 ６ 期 智 能 系 统 学 报 Ｖｏｌ．１１ №．６ ２０１６ 年 １２ 月 ＣＡＡＩ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｉｎｔｅｌｌｉｇｅｎｔ Ｓｙｓｔｅｍｓ Ｄｅｃ． ２０１６ ＤＯＩ：１０．１１９９２ ／ ｔｉｓ．２０１６１１０２２ 网络出版地址：ｈｔｔｐ： ／ ／ ｗｗｗ．ｃｎｋｉ．ｎｅｔ ／ ｋｃｍｓ／ ｄｅｔａｉｌ ／ ２３．１５３８．ＴＰ．２０１７０１１１．１７０５．０２２．ｈｔｍｌ 航天器绕飞逼近翻滚目标运动再现的姿轨控制 孙施浩，贾英民 （北京航空航天大学 第七研究室，北京 １００１９１） 摘 要：为了研究地面试验环境下实现航天器捕获失控翻滚目标运动再现的姿轨控制问题，首先，建立了适用于实 验验证的六自由度姿轨联合相似模型，可满足实验场地大小、机构速度和运行时间等约束；其次，基于多项式函数设 计了有限时间收敛且动态性能良好的绕飞逼近参考轨迹，并利用反步法给出了姿轨联合控制律，证明了相似闭环系 统的稳定性。 通过仿真算例说明了基于运动再现的姿轨控制方法是有效的。 关键词：运动再现；相似理论；绕飞；翻滚；姿轨控制；航天器 中图分类号： ＴＰ１８；Ｖ４１６．２ 文献标志码：Ａ 文章编号：１６７３－４７８５（２０１６）０６－０８１８－０９ 中文引用格式：孙施浩，贾英民． 航天器绕飞逼近翻滚目标运动再现的姿轨控制［Ｊ］． 智能系统学报， ２０１６， １１（６）： ８１８－８２６． 英文引用格式：ＳＵＮ Ｓｈｉｈａｏ，ＪＩＡ Ｙｉｎｇｍｉｎ． Ａｔｔｉｔｕｄｅ ａｎｄ ｏｒｂｉｔ ｃｏｎｔｒｏｌ ｏｆ ｓｐａｃｅｃｒａｆｔｓ ｆｏｒ ｍｏｔｉｏｎ ｒｅｃｏｎｓｔｒｕｃｔｉｏｎ ｏｆ ｆｌｙｉｎｇ ａｒｏｕｎｄ ａｎｄ ａｐｐｒｏａｃｈｉｎｇ ｔｈｅ ｔｕｍｂｌｉｎｇ ｔａｒｇｅｔ［Ｊ］． ＣＡＡＩ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｉｎｔｅｌｌｉｇｅｎｔ Ｓｙｓｔｅｍｓ， ２０１６， １１（６）： ８１８－８２６． Ａｔｔｉｔｕｄｅ ａｎｄ ｏｒｂｉｔ ｃｏｎｔｒｏｌ ｏｆ ｓｐａｃｅｃｒａｆｔｓ ｆｏｒ ｍｏｔｉｏｎ ｒｅｃｏｎｓｔｒｕｃｔｉｏｎ ｏｆ ｆｌｙｉｎｇ ａｒｏｕｎｄ ａｎｄ ａｐｐｒｏａｃｈｉｎｇ ｔｈｅ ｔｕｍｂｌｉｎｇ ｔａｒｇｅｔ ＳＵＮ Ｓｈｉｈａｏ， ＪＩＡ Ｙｉｎｇｍｉｎ （Ｔｈｅ Ｓｅｖｅｎｔｈ Ｒｅｓｅａｒｃｈ Ｄｉｖｉｓｉｏｎ， Ｂｅｉｈａｎｇ Ｕｎｉｖｅｒｓｉｔｙ， Ｂｅｉｊｉｎｇ １００１９１， Ｃｈｉｎａ） Ａｂｓｔｒａｃｔ：Ｔｈｉｓ ｐａｐｅｒ ｄｅａｌｓ ｗｉｔｈ ｔｈｅ ａｔｔｉｔｕｄｅ ａｎｄ ｏｒｂｉｔ ｃｏｎｔｒｏｌ ｐｒｏｂｌｅｍ ｆｏｒ ｍｏｔｉｏｎ ｒｅｃｏｎｓｔｒｕｃｔｉｏｎ ｏｆ ｓｐａｃｅｃｒａｆｔｓ ｆｌｙｉｎｇ ａｒｏｕｎｄ ａｎｄ ａｐｐｒｏａｃｈｉｎｇ ｔｈｅ ｔｕｍｂｌｉｎｇ ｔａｒｇｅｔ ｄｕｒｉｎｇ ｇｒｏｕｎｄ ｅｘｐｅｒｉｍｅｎｔｓ． Ｆｉｒｓｔｌｙ， ａ ６⁃ＤＯＦ ｓｉｍｉｌａｒｉｔｙ ｍｏｄｅｌ ｉｓ ｅｓｔａｂ⁃ ｌｉｓｈｅｄ ｔｏ ｄｅｓｃｒｉｂｅ ｔｈｅ ｉｎｔｅｇｒａｔｅｄ ａｔｔｉｔｕｄｅ ａｎｄ ｏｒｂｉｔ ｍｏｔｉｏｎ， ｗｈｉｃｈ ｉｓ ｓｕｉｔａｂｌｅ ｆｏｒ ｔｈｅ ｅｘｐｅｒｉｍｅｎｔａｌ ｖｅｒｉｆｉｃａｔｉｏｎ ｗｉｔｈ ｔｈｅ ｐｒａｃｔｉｃａｌ ｃｏｎｓｔｒａｉｎｔｓ ｏｎ ｔｈｅ ｓｐａｃｅ ｓｉｚｅ， ｒｕｎｎｉｎｇ ｖｅｌｏｃｉｔｙ ａｎｄ ｔｉｍｅ ｉｎｖｏｌｖｅｄ． Ｓｅｃｏｎｄｌｙ， ｔｈｅ ｐｏｌｙｎｏｍｉａｌ ａｐｐｒｏａｃｈ ｉｓ ｕｓｅｄ ｔｏ ｄｅｓｉｇｎ ｔｈｅ ｍｏｔｉｏｎ ｒｅｆｅｒｅｎｃｅ ｔｒａｊｅｃｔｏｒｙ ｔｈａｔ ｃａｎ ｅｎｓｕｒｅ ｆｉｎｉｔｅ⁃ｔｉｍｅ ｃｏｎｖｅｒｇｅｎｃｅ ａｎｄ ｇｏｏｄ ｄｙｎａｍｉｃ ｐｅｒｆｏｒｍ⁃ ａｎｃｅｓ， ｂａｓｅｄ ｏｎ ｗｈｉｃｈ， ａｎ ｉｎｔｅｇｒａｔｅｄ ａｔｔｉｔｕｄｅ ａｎｄ ｏｒｂｉｔ ｃｏｎｔｒｏｌ ｌａｗ ｉｓ ｐｒｏｐｏｓｅｄ ｂｙ ｔｈｅ ｂａｃｋ⁃ｓｔｅｐｐｉｎｇ ｍｅｔｈｏｄ ａｎｄ ｔｈｅ ｃｏｒｒｅｓｐｏｎｄｉｎｇ ｃｌｏｓｅｄ⁃ｌｏｏｐ ｓｔａｂｉｌｉｔｙ ｉｓ ｐｒｏｖｅｄ． Ｆｉｎａｌｌｙ， ａ ｎｕｍｅｒｉｃａｌ ｅｘａｍｐｌｅ ｉｓ ｉｎｃｌｕｄｅｄ ｔｏ ｉｌｌｕｓｔｒａｔｅ ｔｈｅ ｅｆｆｅｃｔｉｖｅ⁃ ｎｅｓｓ ｏｆ ｔｈｅ ｏｂｔａｉｎｅｄ ｒｅｓｕｌｔｓ． Ｋｅｙｗｏｒｄｓ： ｍｏｔｉｏｎ ｒｅｃｏｎｓｔｒｕｃｔｉｏｎ； ｓｉｍｉｌａｒｉｔｙ； ｆｌｙｉｎｇ ａｒｏｕｎｄ； ｔｕｍｂｌｉｎｇ； ａｔｔｉｔｕｄｅ ａｎｄ ｏｒｂｉｔ ｃｏｎｔｒｏｌ； ｓｐａｃｅｃｒａｆｔｓ 收稿日期：２０１６－１１－１６． 基金项目：国家“ ９７３” 计划项目（ ２０１２ＣＢ８２１２００，２０１２ＣＢ８２１２０１）；国家 自然科学基金项目（６１１３４００５，６１３２７８０７，６１５２０１０６０１０）． 通信作者：孙施浩． Ｅ⁃ｍａｉｌ：ｊｘｃｒｓｓｈ＠ １２６．ｃｏｍ． 针对空间失控失效航天器进行在轨营救与维修 是当前航天领域的一个重要发展方向［１－２］ 。 失控目 标在空间中处于自由运行的状态，其对接端口随本体 一起在空间中运动，位置时刻都在发生变化，使得传 统的姿态轨道独立控制不能适应快速姿轨机动的要 求［３－４］ 。 为此，国内外学者开展了大量航天器姿轨联 合控制问题的研究，如 Ｓｅｇａｌ ［５］ 研究了航天器姿态动 态对轨道运动的影响，指出建立耦合的动力学模型可 以提高基于视觉的相对位姿控制精度；Ｌｉａｏ ［６］研究了 追踪器本体坐标系下航天器姿轨一体化控制律设计 问题，建立了考虑推进器配置的姿轨动力学模型，并 设计了非线性鲁棒一体化控制律；Ｓｈａｎ ［７］设计了一种 自适应同步控制策略，提出了基于交叉耦合概念的六 自由度航天器编队飞行控制方法；Ｚｈａｎｇ ［８］ 建立了追 踪航天器本体坐标系下六自由度模型，采用自适应反 步法设计了姿轨联合控制器等
第6期 孙施浩，等：航天器绕飞逼近翻滚目标运动再现的姿轨控制 ·819. 航天器的控制系统需要具有高可靠性和高精 图1是文献[20]中提出的航天器全方位交会 度，为了降低任务风险，顺利完成航天任务，航天器 地面验证系统，具有9个运动自由度，包含2个三轴 控制技术必须在地面得到充分的实验验证-山。依 转台，以及垂向、周向、径向运动模块。其中，中心固 托数学模型解算与物理反馈结合，驱动模拟器在地 定的三轴转台模拟目标航天器在轨三轴绝对姿态运 面试验环境中再现航天器空间运动控制过程的验证 动，另外六自由度的运动机构模拟服务航天器在轨 仿真方法，是置信水平较高的一种仿真方法，相关的 三轴绝对姿态运动和服务航天器与目标航天器在轨 试验系统有德国宇航局的EPOS交会对接仿真系 三轴相对位置运动。 统[]和中国空间技术研究院的九自由度验证系 统[)等。但是由于实验场地大小、机构速度、运行 时间等方面的约束，文献[5-8]中给出的各类控制 方法无法在地面实验环境中进行验证。 相似理论是解决航天器姿轨系统先进控制方法 与实验验证在场地大小、机构速度、运行时间等方面 图1地面模拟器样机示意图 矛盾的一个有力工具。通过相似三定理]建立仿真 Fig.I Schematic diagram of ground motion simulator 模型系统与航天器姿轨原型系统间的相似性准则，得 在这个九自由度运动模拟器中，径向运动范围为 到不同比例约束下的航天器姿轨相似动力学模型，并 0~10m,垂向运动范围为-2~2m。而对应服务航天 以此设计控制器，可以解决复杂姿轨控制策略地面验 证的问题。国内外学者对此也开展了部分研究工作， 绕飞逼近翻滚目标任务，启动时两航天器相对距离一 如意大利都灵理工大学]为设计开发交会对接的 般需要在100m之外，且速度不易太大，任务时间较 长，因此，地面实验验证中需要应用相似理论方法，对 GNC系统算法，运用尺度缩比方法通过地面气浮试 距离和时间进行缩比处理以满足地面试验需求。 验台仿真了从近程导引到最后对接过程的运动情况： 何兆伟等1]针对水浮仿真系统验证航天器二体运动 2相似动力学模型建立 控制过程提出了相似性分析方法：孙施浩等)基于 针对与椭圆轨道上失控翻滚目标航天器的交会 相似理论、长度量纲分解和绝对运动等效代换方法提 对接任务，在追踪器本体坐标系下建立六自由度姿 出了一种可实现空间合作目标运动再现的相似性试 轨联合模型，并经相似变换得到姿轨联合相似动力 验设计方法。然而针对航天器绕飞逼近翻滚目标运 学模型，以满足同时高精度控制航天器相对位置姿 动再现的姿轨控制问题，应用相似理论设计相应控制 态，实现目标逼近。定义3个坐标系，如图2所示。 器的应用和研究工作至今还未见到。 本文首先介绍适用于绕飞逼近翻滚目标运动再 现的地面仿真验证系统，然后在追踪器本体坐标系 目标航天器 下建立了航天器交会对接相对运动的六自由度姿轨 追踪航天器 联合模型，并应用相似理论将其转换为可适用于实 验验证的缩比相似动力学模型，在此基础上，设计反 步控制器，使其跟踪用多项式函数设计的参考轨迹， 在有限时间内对翻滚目标实现绕飞逼近对接。 1运动再现系统 为了在地面实验室空间内验证航天器姿轨控制 方案、星载计算机性能以及测量敏感器量测可信度 等任务，需要在地面再现航天器在空间中的轨道姿 图2坐标系示意图 态真实运动。采用动力学计算与运动学等效思 Fig.2 Several coordinate frames 想[)]设计的仿真实验，是通过实时计算航天器的姿 赤道惯性坐标系为OXYZ,其中OXY是赤道 轨动力学模型得到航天器空间中的轨道姿态运动， 面，OX从地心指向春分点，OZ垂直于赤道平面指 然后由模拟器运动机构跟踪计算出的轨迹，再现航 向北；追踪器本体坐标系为0xy之。，其中0。是追踪 天器空间的运动。 航天器质心，坐标轴0x。、0y。和02.与航天器惯量
航天器的控制系统需要具有高可靠性和高精 度，为了降低任务风险，顺利完成航天任务，航天器 控制技术必须在地面得到充分的实验验证［９－１１］ 。 依 托数学模型解算与物理反馈结合，驱动模拟器在地 面试验环境中再现航天器空间运动控制过程的验证 仿真方法，是置信水平较高的一种仿真方法，相关的 试验系统有德国宇航局的 ＥＰＯＳ 交会对接仿真系 统［１２］和中国空间技术研究院的九自由度验证系 统［１３］等。 但是由于实验场地大小、机构速度、运行 时间等方面的约束，文献［５－８］中给出的各类控制 方法无法在地面实验环境中进行验证。 相似理论是解决航天器姿轨系统先进控制方法 与实验验证在场地大小、机构速度、运行时间等方面 矛盾的一个有力工具。 通过相似三定理［１４］建立仿真 模型系统与航天器姿轨原型系统间的相似性准则，得 到不同比例约束下的航天器姿轨相似动力学模型，并 以此设计控制器，可以解决复杂姿轨控制策略地面验 证的问题。 国内外学者对此也开展了部分研究工作， 如意大利都灵理工大学［１５］ 为设计开发交会对接的 ＧＮＣ 系统算法，运用尺度缩比方法通过地面气浮试 验台仿真了从近程导引到最后对接过程的运动情况； 何兆伟等［１６］针对水浮仿真系统验证航天器二体运动 控制过程提出了相似性分析方法；孙施浩等［１７］ 基于 相似理论、长度量纲分解和绝对运动等效代换方法提 出了一种可实现空间合作目标运动再现的相似性试 验设计方法。 然而针对航天器绕飞逼近翻滚目标运 动再现的姿轨控制问题，应用相似理论设计相应控制 器的应用和研究工作至今还未见到。 本文首先介绍适用于绕飞逼近翻滚目标运动再 现的地面仿真验证系统，然后在追踪器本体坐标系 下建立了航天器交会对接相对运动的六自由度姿轨 联合模型，并应用相似理论将其转换为可适用于实 验验证的缩比相似动力学模型，在此基础上，设计反 步控制器，使其跟踪用多项式函数设计的参考轨迹， 在有限时间内对翻滚目标实现绕飞逼近对接。 １ 运动再现系统 为了在地面实验室空间内验证航天器姿轨控制 方案、星载计算机性能以及测量敏感器量测可信度 等任务，需要在地面再现航天器在空间中的轨道姿 态真实运动。 采用动力学计算与运动学等效思 想［１８］设计的仿真实验，是通过实时计算航天器的姿 轨动力学模型得到航天器空间中的轨道姿态运动， 然后由模拟器运动机构跟踪计算出的轨迹，再现航 天器空间的运动。 图 １ 是文献［２０］中提出的航天器全方位交会 地面验证系统，具有 ９ 个运动自由度，包含 ２ 个三轴 转台，以及垂向、周向、径向运动模块。 其中，中心固 定的三轴转台模拟目标航天器在轨三轴绝对姿态运 动，另外六自由度的运动机构模拟服务航天器在轨 三轴绝对姿态运动和服务航天器与目标航天器在轨 三轴相对位置运动。 图 １ 地面模拟器样机示意图 Ｆｉｇ．１ Ｓｃｈｅｍａｔｉｃ ｄｉａｇｒａｍ ｏｆ ｇｒｏｕｎｄ ｍｏｔｉｏｎ ｓｉｍｕｌａｔｏｒ 在这个九自由度运动模拟器中，径向运动范围为 ０～１０ ｍ，垂向运动范围为－２ ～ ２ ｍ。 而对应服务航天 绕飞逼近翻滚目标任务，启动时两航天器相对距离一 般需要在 １００ ｍ 之外，且速度不易太大，任务时间较 长，因此，地面实验验证中需要应用相似理论方法，对 距离和时间进行缩比处理以满足地面试验需求。 ２ 相似动力学模型建立 针对与椭圆轨道上失控翻滚目标航天器的交会 对接任务， 在追踪器本体坐标系下建立六自由度姿 轨联合模型，并经相似变换得到姿轨联合相似动力 学模型，以满足同时高精度控制航天器相对位置姿 态，实现目标逼近。 定义 ３ 个坐标系，如图 ２ 所示。 图 ２ 坐标系示意图 Ｆｉｇ．２ Ｓｅｖｅｒａｌ ｃｏｏｒｄｉｎａｔｅ ｆｒａｍｅｓ 赤道惯性坐标系为 ＯＸＹＺ ，其中 ＯＸＹ 是赤道 面， ＯＸ 从地心指向春分点， ＯＺ 垂直于赤道平面指 向北；追踪器本体坐标系为 ｏｃ ｘｃ ｙｃ ｚｃ ，其中 ｏｃ 是追踪 航天器质心，坐标轴 ｏｃ ｘｃ、 ｏｃ ｙｃ 和 ｏｃ ｚｃ 与航天器惯量 第 ６ 期 孙施浩，等：航天器绕飞逼近翻滚目标运动再现的姿轨控制 ·８１９·
·820 智能系统学报 第11卷 主轴重合；目标器平动坐标系0：xy:,0a是目标 态四元数q,、角速度ω，。追踪标器本体坐标系 器质心，0ax、0ya和oaa与坐标系OXYZ各轴平 相对目标器本体坐标系的姿态四元数为q。= 行。（在仿真试验中，地面惯性坐标系与坐标系 9q,。、9。分别为qa的标量和矢量部分。 0xyna相对应。) ()、(),分别表示矢量在追踪器本体和目标器 定义在OXYZ下追踪器的位置矢量re,目标 本体坐标系下的分量列阵。 器的位置矢量，追踪器相对目标器的位置矢量 2.1追踪器本体坐标系下航天器相对姿轨模型[1町 △r;追踪器本体坐标系相对惯性系姿态四元数 航天器相对轨道动力学方程： q。、角速度ω。；目标器本体坐标系相对惯性系姿 d2(△r) M =(f).-MS((w.))S((w.))(△r).-MS((ù.))（△r).- dt 2Ms(m)1-Ma.-3anL(月 (1 r 式中：S(·)表示叉乘矩阵。 航天器相对姿态动力学方程： d(w=(M).-(1)s(a.)L.(w,- (I).dt d(ω)： (s(a)(1).+(1).5(w,))(0).-(1)L.出 式中：L.(qa)=(g6-qq.)1+9.9-2qoS(q.)是日 初始条件：x,(0)=[△r(0)q.(0)], 标航天器本体坐标系到追踪航天器的旋转矩阵。 x2(0)=[d△r(0)/dtω.(0)]'。 航天器相对姿态运动学方程为 其中： (9。=-q(ωu）./2 (3) 「m303x3 q.=(q13+S(q.))(w)./2 M= 033 2.2姿轨联合相似动力学模型 「L3 下文为符号简单，追踪器本体坐标系下的分量 03x3 列阵均省略() 03 2(g.1+5(q.) 1 记x,=[Arq.]'和x2=[d4r/dwa]',则 联立方程(1)、(2)和(3)有姿轨联合方程： 2m.S(w.) 033 C三 dx =x2 03x3 IS(w.)+S(ω)L dt 「F. (4) dx2 F= M =-Cx2 -n +F M. m.5(.)S(.)Ar +m.s(i)r+ -(△r-3 Ar·re r) n d (@, S(.)I.La (@)+ILadi 记入：表示系统变量i的缩比系数，即入：=in九。， x1m(0)=入xx1(0) 给定交会对接再现任务的长度、时间、质量3个基本 x2(0)=入2x2(0) 量纲缩比系数入、入7、入，则根据相似理论的量纲 式中：tm=入r, 分析法，可得姿轨联合相似动力学模型为 3 03x3 {d比m=Ax2m A= 1 =Λ， dt 03×3 2(913+S(gm) (5) 2=-Cx-n+F. M di m,0l0M. 初始条件满足：
主轴重合；目标器平动坐标系 ｏｔｉ ｘｔｉ ｙｔｉ ｚｔｉ ， ｏｔｉ 是目标 器质心， ｏｔｉ ｘｔｉ、 ｏｔｉ ｙｔｉ 和 ｏｔｉ ｚｔｉ 与坐标系 ＯＸＹＺ 各轴平 行。 （在仿真试验中，地面惯性坐标系与坐标系 ｏｔｉ ｘｔｉ ｙｔｉ ｚｔｉ 相对应。） 定义在 ＯＸＹＺ 下追踪器的位置矢量 ｒｃ， 目标 器的位置矢量 ｒｔ， 追踪器相对目标器的位置矢量 Δｒ ；追踪器本体坐标系相对惯性系姿态四元数 ｑｃ、 角速度 ωｃ ；目标器本体坐标系相对惯性系姿 态四元数 ｑｔ、 角速度 ωｔ。 追踪标器本体坐标系 相对目标器本体坐 标 系 的 姿 态 四 元 数 为 ｑｃｔ ＝ ｑ － １ ｔ °ｑｃ， ｑｏ、 ｑｖ 分 别 为 ｑｃｔ 的 标 量 和 矢 量 部 分。 （ ） ｃ、 （ ） ｔ 分别表示矢量在追踪器本体和目标器 本体坐标系下的分量列阵。 ２．１ 追踪器本体坐标系下航天器相对姿轨模型［１９］ 航天器相对轨道动力学方程： Ｍｃ ｄ ２ （Δｒ）ｃ ｄｔ ＝ （ｆ ｃ）ｃ － ＭｃＳ（（ωｃ）ｃ）Ｓ（（ωｃ）ｃ） （Δｒ）ｃ － ＭｃＳ（（ω · ｃ）ｃ） （Δｒ）ｃ － ２ＭｃＳ（（ωｃ）ｃ） ｄ （Δｒ）ｃ ｄｔ － Ｍｃ μ ｒ ３ ｃ （（Δｒ）ｃ － ３ （Δｒ）ｃ·（ｒｃ）ｃ ｒ ２ ｃ （ｒｃ）ｃ） （１） 式中： Ｓ（·） 表示叉乘矩阵。 航天器相对姿态动力学方程： （Ｉｃ）ｃ ｄ （ωｃｔ）ｃ ｄｔ ＝ （Ｍｃ）ｃ － （Ｉｃ）ｃＳ（（ωｃ）ｃ）Ｌｃｔ （ωｔ）ｔ － （Ｓ（（ωｃ）ｃ） （Ｉｃ）ｃ ＋ （Ｉｃ）ｃＳ（（ωｃ）ｃ）） （ωｃｔ）ｃ － （Ｉｃ）ｃＬｃｔ ｄ （ωｔ）ｔ ｄｔ （２） 式中： Ｌｃｔ（ｑｃｔ） ＝ （ｑ ２ ０ － ｑ Ｔ ｖ ｑｖ）Ｉ ＋ ｑｖｑ Ｔ ｖ － ２ｑ０Ｓ（ｑｖ） 是目 标航天器本体坐标系到追踪航天器的旋转矩阵。 航天器相对姿态运动学方程为 ｑ · ｏ ＝ － ｑ Ｔ ｖ （ωｃｔ）ｃ ／ ２ ｑ · ｖ ＝ （ｑｏ Ｉ３ ＋ Ｓ（ｑｖ）） （ωｃｔ）ｃ ／ ２ { （３） ２．２ 姿轨联合相似动力学模型 下文为符号简单，追踪器本体坐标系下的分量 列阵均省略 （）ｃ。 记 ｘ１ ＝ ［Δｒ ｑｖ］ Ｔ 和 ｘ２ ＝ ［ｄΔｒ／ ｄｔ ωｃｔ］ Ｔ ， 则 联立方程（１）、（２）和（３）有姿轨联合方程： ｄｘ１ ｄｔ ＝ Λｘ２ Ｍ ｄｘ２ ｄｔ ＝ － Ｃｘ２ － ｎ ＋ Ｆ ì î í ï ï ï ï （４） 初始条件： ｘ１（０） ＝ ［Δｒ（０） ｑｖ（０）］ Ｔ ， ｘ２（０） ＝ ［ｄΔｒ（０） ／ ｄｔ ωｃｔ（０）］ Ｔ 。 其中： Ｍ ＝ ｍｃ Ｉ３ ０３×３ ０３×３ Ｉｃ é ë ê ê ù û ú ú Λ ＝ Ｉ３ ０３×３ ０３×３ １ ２ （ｑｏ Ｉ３ ＋ Ｓ（ｑｖ）） é ë ê ê êê ù û ú ú úú Ｃ ＝ ２ｍｃＳ（ωｃ） ０３×３ ０３×３ ＩｃＳ（ωｃ） ＋ Ｓ（ωｃ）Ｉｃ é ë ê ê ù û ú ú Ｆ ＝ Ｆｃ Ｍｃ é ë ê ê ù û ú ú ｎ ＝ ｍｃＳ（ωｃ）Ｓ（ωｃ）Δｒ ＋ ｍｃＳ（ω · ｃ）Δｒ ＋ ｍｃμ ｒ ３ ｃ （Δｒ － ３ Δｒ·ｒｃ ｒ ２ ｃ ｒｃ） Ｓ（ωｃ）ＩｃＬｃｔ （ωｔ）ｔ ＋ ＩｃＬｃｔ ｄ （ωｔ）ｔ ｄｔ é ë ê ê ê ê ê ù û ú ú ú ú ú 记 λｉ 表示系统变量 ｉ 的缩比系数，即 λｉ ＝ ｉｍ ／ ｉ ｐ， 给定交会对接再现任务的长度、时间、质量 ３ 个基本 量纲缩比系数 λＬ 、 λＴ、 λ Ｍ， 则根据相似理论的量纲 分析法［１７］ ，可得姿轨联合相似动力学模型为 ｄｘ１ｍ ｄｔ ＝ Λｍ ｘ２ｍ Ｍｍ ｄｘ２ｍ ｄｔｍ ＝ － Ｃｍ ｘ２ｍ － ｎｍ ＋ Ｆｍ ì î í ï ïï ï ï （５） 初始条件满足： ｘ１ｍ（０） ＝ λｘ１ ｘ１（０） ｘ２ｍ（０） ＝ λｘ２ ｘ２（０） 式中： ｔｍ ＝ λＴ ｔ ， Λｍ ＝ Ｉ３ ０３×３ ０３×３ １ ２ （ｑｏｍ Ｉ３ ＋ Ｓ（ｑｖｍ ）） é ë ê ê ê ù û ú ú ú ＝ Λ， Ｍｍ（ｔｍ ） ＝ ｍｃｍ Ｉ３ ０３×３ ０３×３ Ｉｃｍ é ë ê ê ù û ú ú ＝ λ Ｍ Ｉ３ ０３×３ ０３×３ λ Ｍ λ ２ Ｌ Ｉ３ é ë ê ê ù û ú ú Ｍ（ｔ）， ·８２０· 智 能 系 统 学 报 第 １１ 卷
第6期 孙施浩，等：航天器绕飞逼近翻滚目标运动再现的姿轨控制 ·821· 2mnS(wm） 03x3 1「入w入71303x3 Cm(tm）= 1nS(wn）+S(w)1n」L0x C(t), 03x3 入M入入，I3 mn5(u)s(w)4.+mns(0)4.+m-(4r.-3A nnm（tm）= d(ωm): S()1.Lom ()+ILam di 03x3 n(t) 03x3 入yAA7213J 03x3 F(t) 满足：(4rn),(0)=4r(0),( 03×3 AxAiATI] r=)(0)= [入A30x3 d-(0),(4).(T)=0.（ di r)(T)=0. 03x313 0x3入13 式中下标m表示相似动力学模型系统量。 r)(T)=0。 ( dr 3控制器设计 （9m）,(tm）= 首先，针对给定的初始状态和期望完成时间，设 aa aatm+agti+agl+asta,Tom 计一条有限时间收敛且动态性能良好的参考轨迹。 0,tm Tom 然后，将方程(5)转化为误差动态方程，利用反步法 (7) 设计跟踪控制器实现有限时间交会对接。 满足：(qm),(0)=9(0),（9m）（Tm）=0, 3.1参考轨迹设计 假定交会对接初始条件： 9-)(o=g.0l+5g.ow0）· x,(0)=[4r(0)9.(0)] T dq)(T)=0, .d△r 2)(7)= x,(o)=[d (0)w(0)] (gm),(tm)=√1-(qm),(tn)Ⅱ(8) 姿态同步时间为T,对接完成时间为T,。 则根据相似理论，相似过程的初始条件： 4))=d(4) (9) dt △rm(0)=入，△r(0) (wm),(tm）= 9m(0)=q.(0) （-q）(tm） dq)(t.） r"(0)=A(0) (q)()+s((q)())di (10) wm(0)=入7w.(0) 3.2基于反步法的跟踪控制器设计 模拟器完成姿态同步时间T=入，T,对接完成时 定义与参考轨迹的位置、速度误差、姿态和角速 间为Tm=入rT,o 度误差： 针对给定的初始条件和终端收敛条件，利用多 ean=△rm-(△rn）, egm=（9am）-1,qam 项式向量函数设计相对位置（△rm),(tm)、相对速度 山)(1)、相对姿态角(9).)以及相对角 e'irs (dars)() d△rm一（t, (11) 速度（ωm）,（tm)的参考轨迹： (△rm）,(tm)= 式中en=[e,e,]是姿态误差四元数。记： (an+at aratm+art+aistm,Im Tm 0,tn>Tm (6) 容易验证，根据式(6)~(10)所设计的参考轨
Ｃｍ（ｔｍ ） ＝ ２ｍｃｍ Ｓ（ωｃｍ ） ０３×３ ０３×３ Ｉｃｍ Ｓ（ωｃｍ ） ＋ Ｓ（ωｃｍ ）Ｉｃｍ é ë ê ê ù û ú ú ＝ λ Ｍ λ －１ Ｔ Ｉ３ ０３×３ ０３×３ λ Ｍ λ ２ Ｌλ －１ Ｔ Ｉ３ é ë ê ê ù û ú ú Ｃ（ｔ）， ｎｍ（ｔｍ ） ＝ ｍｃｍ Ｓ（ωｃｍ ）Ｓ（ωｃｍ ）Δｒｍ ＋ ｍｃｍ Ｓ（ω · ｃｍ ）Δｒｍ ＋ ｍｃｍ μ ｍ ｒ ３ ｃｍ （Δｒｍ － ３ Δｒｍ·ｒｃｍ ｒ ２ ｃｍ ｒｃｍ ） Ｓ（ωｃｍ ）Ｉｃｍ Ｌｃｔｍ （ωｔｍ ）ｔ ＋ Ｉｃｍ Ｌｃｔｍ ｄ （ωｔｍ ）ｔ ｄｔ é ë ê ê ê ê ê ù û ú ú ú ú ú ＝ λ Ｍ λ －２ Ｔ λＬ Ｉ３ ０３×３ ０３×３ λ Ｍ λ ２ Ｌλ －２ Ｔ Ｉ３ é ë ê ê ù û ú ú ｎ（ｔ） Ｆｍ（ｔｍ ） ＝ ｆｃｍ Ｍｃｍ é ë ê ê ù û ú ú ＝ λＭ λ －２ Ｔ λＬ Ｉ３ ０３×３ ０３×３ λＭ λ ２ Ｌλ －２ Ｔ Ｉ３ é ë ê ê ù û ú ú Ｆ（ｔ） λｘ１ ＝ λＬ Ｉ３ ０３×３ ０３×３ Ｉ３ é ë ê ê ù û ú ú ， λｘ２ ＝ λＬλ －１ Ｔ Ｉ３ ０３×３ ０３×３ λ －１ Ｔ Ｉ３ é ë ê ê ù û ú ú 。 式中下标 ｍ 表示相似动力学模型系统量。 ３ 控制器设计 首先，针对给定的初始状态和期望完成时间，设 计一条有限时间收敛且动态性能良好的参考轨迹。 然后，将方程（５）转化为误差动态方程，利用反步法 设计跟踪控制器实现有限时间交会对接。 ３．１ 参考轨迹设计 假定交会对接初始条件： ｘ１（０） ＝ ［Δｒ（０） ｑｖ（０）］ Ｔ ｘ２（０） ＝ ［ ｄΔｒ ｄｔｍ （０） ωｃｔ（０）］ Ｔ 姿态同步时间为 Ｔｑ ， 对接完成时间为 Ｔｒ。 则根据相似理论，相似过程的初始条件： Δｒｍ（０） ＝ λＬΔｒ（０） ｑｖｍ（０） ＝ ｑｖ（０） ｄΔｒｍ ｄｔｍ （０） ＝ λＬλ －１ Ｔ ｄΔｒ ｄｔｍ （０） ωｃｔｍ（０） ＝ λ －１ Ｔ ωｃｔ（０） 模拟器完成姿态同步时间 Ｔｑｍ ＝ λＴ Ｔｑ ， 对接完成时 间为 Ｔｒｍ ＝ λＴ Ｔｒ。 针对给定的初始条件和终端收敛条件，利用多 项式向量函数设计相对位置 （Δｒｍ ）ｒ（ｔｍ ）、 相对速度 （ ｄΔｒｍ ｄｔｍ ） ｒ （ｔｍ ）、 相对姿态角 （ｑｖｍ ）ｒ（ｔｍ ） 以及相对角 速度 （ωｃｔｍ ）ｒ（ｔｍ ） 的参考轨迹： （Δｒｍ ）ｒ（ｔｍ ） ＝ ａｒ１ ＋ ａｒ２ ｔｍ ＋ ａｒ３ ｔ ２ ｍ ＋ ａｒ４ ｔ ３ ｍ ＋ ａｒ５ ｔ ４ ｍ ， ｔｍ ≤ Ｔｒｍ ０， ｔｍ ＞ Ｔｒｍ { （６） 满 足： （Δｒｍ ）ｒ（０） ＝ Δｒｍ（０） ， （ ｄΔｒｍ ｄｔｍ ） ｒ （０） ＝ ｄΔｒｍ ｄｔｍ （０）， （Δｒｍ ）ｒ（Ｔｒｍ ） ＝ ０， （ ｄΔｒｍ ｄｔｍ ） ｒ （Ｔｒｍ ） ＝ ０， （ ｄ ２Δｒｍ ｄｔ ２ ｍ ） ｒ （Ｔｒｍ ） ＝ ０。 （ｑｖｍ ）ｒ（ｔｍ ） ＝ ａｑ１ ＋ ａｑ２ ｔｍ ＋ ａｑ３ ｔ ２ ｍ ＋ ａｑ４ ｔ ３ ｍ ＋ ａｑ５ ｔ ４ ｍ ， ｔｍ ≤ Ｔｑｍ ０， ｔｍ ＞ Ｔｑｍ { （７） 满 足： （ｑｖｍ ）ｒ（０） ＝ ｑｖｍ（０） ， （ｑｖｍ ）ｒ（Ｔｒｍ ） ＝ ０， （ ｄｑｖｍ ｄｔｍ ） ｒ （０） ＝ １ ２ （ｑｏ（０）Ｉ３ ＋ Ｓ（ｑｖｍ（０）））ωｃｔｍ（０） ， （ ｄｑｖｍ ｄｔｍ ） ｒ （Ｔｑｍ ） ＝ ０， （ ｄ ２ ｑｖｍ ｄｔ ２ ｍ ） ｒ （Ｔｑｍ ） ＝ ０。 （ｑｏｍ ）ｒ（ｔｍ ） ＝ １ － ‖ （ｑｖｍ ）ｒ（ｔｍ ）‖ （８） （ ｄΔｒｍ ｄｔｍ ） ｒ （ｔｍ ） ＝ ｄ （Δｒｍ ）ｒ ｄｔｍ （ｔｍ ） （９） （ωｃｔｍ ）ｒ（ｔｍ ） ＝ ２ （ － ｑ Ｔ ｖｍ ）ｒ（ｔｍ ） （ｑｏ）ｒ（ｔｍ ）Ｉ３ ＋ Ｓ（（ｑｖｍ ）ｒ（ｔｍ ）） é ë ê ê ù û ú ú （ ｄｑｖｍ ｄｔｍ ） ｒ （ｔｍ ） （１０） ３．２ 基于反步法的跟踪控制器设计 定义与参考轨迹的位置、速度误差、姿态和角速 度误差： ｅΔｒｍ ＝ Δｒｍ － （Δｒｍ ）ｒ， ｅｑｃｔｍ ＝ （ｑｃｔｍ ） － １ｒ °ｑｃｔｍ ｅ ｄΔｒｍ ｄｔｍ ＝ ｄΔｒｍ ｄｔｍ － （ ｄΔｒｍ ｄｔｍ ） ｒ ， ｅωｃｔｍ ＝ ωｃｔｍ － （ωｃｔｍ ）ｒ （１１） 式中 ｅｑｃｔｍ ＝ ［ｅｑｏｍ ｅｑｖｍ ］ 是姿态误差四元数。 记： ｅ１ｍ ＝ ｅΔｒｍ ｅｑｖｍ é ë ê êê ù û ú úú ， ｅ２ｍ ＝ ｅ ｄΔｒｍ ｄｔｍ ｅωｃｔｍ é ë ê ê ê ù û ú ú ú 容易验证，根据式（６） ～ （１０） 所设计的参考轨 第 ６ 期 孙施浩，等：航天器绕飞逼近翻滚目标运动再现的姿轨控制 ·８２１·
.822 智能系统学报 第11卷 在{r d)(g)(0m} 能够保证： Fnm=-Ae1m-K2e2m+Cn(&m+(x2m）,）+ d (x2m),da 1)e1m(0)=0,e2m(0)=0; n+M.(+d山 (16) 2)参考轨迹（△山rm),(tn)、(gm),(1m)二次可微： 可保证相似模型(5)的系统状态始终跟踪多项 3)参考轨迹1(4r)()、(q) 式向量函数设计的参考轨迹，即xm(tn)= (x1m）,(tm）、x2n(tm)=(x2m),（tm),对tm≥0。 (wm),}分别在有限时间Tm=入rT,和Tm=入rT, 证明考虑如下Lyapunov函数： 能够收敛到零。 基于此性质，定义系统参考状态： v. (17) drm 对时间1m求导，代入方程(15)可得： (x1m）, dt. dv (wm）, =-eiA KAmeim eine2m- dim 如果设计的控制器能够保证 enCm(&m+(x2m),）+e2n(-Cnm(e2m）- em(tn）=0,e2m(tm）=0,Htn≥0(12) 那么根据误差定义(11)，系统状态一定能够满足： 2受)+）（四 x1m(tn）=(xm）,(tm） 将控制器(16)代入式(18)，并注意到Cm是反 x2m（tm）=(x2n）,(tm）,Htm≥0 对称阵，可得： 由于已经验证参考状态可以在有限时间内收敛 dv 到零，所以系统状态x1m、xm也一定可以在有限时 -=-eimAnKjAmeim -ezK2e2m (19) d 间内收敛到零，由此接下来的工作就是设计合适的 根据参考轨迹的设计要求，可以保证： 控制器保证式(12)成立。 根据上述误差定义以及方程(5)可得误差动态 e1m(0)=0,e2m(0)=0 方程： 也即V(0)=0。 dem-人ne2m 则根据Lyapunov稳定性理论，有： d V(tn)=0,Htm≥0 de2m )M dta 即e1m(tm)=0,e2n(tm）=0,tm≥0。 进一步，根据虚拟控制器设计式(14)可得： -Cnm(e2m+（x2m)r）-nm+Fm-M d(x2m）, &m(tm）=0 em(tn）=0,Htm≥0 (13) 因此，在控制器(16)作用下，相似系统(5)的状 用反步法设计虚拟控制器： 态x1m、x2能够完全跟踪设计的有限时间收敛参考 《m =-K Ameim (14) 轨迹(x1m）,、(x2m）,o 与文献[5-8]相比，本文研究的航天器绕飞逼 定义e2n=e2m-&.,则误差动态方程转化为 近翻滚目标的姿轨联合控制问题，是在追踪航天器 本体系下建立的航天器姿轨耦合的相似动力学模 [de=AK,Ae+Ae dt 型，通过设计相似系数，可与实验系统在场地大小、 机构速度、运行时间等方面的约束相匹配。 de-c.(e)-C.(a.+(x,）- M dt 当基本量刚相似比为1时，控制器(16)即可应 用于航天器交会对接的姿轨联合控制。 d (x)d)+F nn-M.（dn 4数值实验 (15) 4.1仿真条件 定理1考虑误差动态系统(15)，任意给定正 目标航天器参数：轨道参数如表1所示，航天器 定矩阵K1、K2,则设计如下跟踪控制器： 质量m,=8000kg,转动惯量矩阵：
迹 （Δｒｍ ）ｒ，（ ｄΔｒｍ ｄｔｍ ） ｒ { ，（ｑｖｍ ）ｒ，（ωｃｔｍ ）ｒ} 能够保证： １） ｅ１ｍ（０） ＝ ０， ｅ２ｍ（０） ＝ ０； ２）参考轨迹 （Δｒｍ）ｒ（ｔｍ）、 （ｑｖｍ）ｒ（ｔｍ） 二次可微； ３ ） 参 考 轨 迹 ｛ （Δｒｍ ）ｒ， （ ｄΔｒｍ ｄｔｍ ） ｒ ， （ｑｖｍ ）ｒ， （ωｃｔｍ ）ｒ｝ 分别在有限时间 Ｔｑｍ ＝ λＴ Ｔｑ 和 Ｔｒｍ ＝ λＴ Ｔｒ 能够收敛到零。 基于此性质，定义系统参考状态： （ｘ１ｍ ）ｒ ＝ （Δｒｍ ）ｒ （ｑｖｍ ）ｒ é ë ê ê ù û ú ú ， （ｘ２ｍ ）ｒ ＝ （ ｄΔｒｍ ｄｔｍ ） ｒ （ωｃｔｍ ）ｒ é ë ê ê ê ê ù û ú ú ú ú 如果设计的控制器能够保证 ｅ１ｍ（ｔｍ ） ≡ ０，ｅ２ｍ（ｔｍ ） ≡ ０，∀ｔｍ ≥ ０ （１２） 那么根据误差定义（１１），系统状态一定能够满足： ｘ１ｍ（ｔｍ ） ≡ （ｘ１ｍ ）ｒ（ｔｍ ） ｘ２ｍ（ｔｍ ） ≡ （ｘ２ｍ ）ｒ（ｔｍ ），∀ｔｍ ≥ ０ 由于已经验证参考状态可以在有限时间内收敛 到零，所以系统状态 ｘ１ｍ 、 ｘ２ｍ 也一定可以在有限时 间内收敛到零，由此接下来的工作就是设计合适的 控制器保证式（１２）成立。 根据上述误差定义以及方程（５）可得误差动态 方程： ｄｅ１ｍ ｄｔ ＝ Λｍ ｅ２ｍ Ｍｍ ｄｅ２ｍ ｄｔｍ ＝ － Ｃｍ（ｅ２ｍ ＋ （ｘ２ｍ ）ｒ） － ｎｍ ＋ Ｆｍ － Ｍｍ ｄ （ｘ２ｍ ）ｒ ｄｔｍ ì î í ï ï ï ï ï ï ï ï （１３） 用反步法设计虚拟控制器： αｍ ＝ αΔｒｍ αｑｖｍ é ë ê êê ù û ú úú ＝ － Ｋ１Λ Ｔ ｍ ｅ１ｍ （１４） 定义 ｅ ～ ２ｍ ＝ ｅ２ｍ － αｍ ，则误差动态方程转化为 ｄｅ１ｍ ｄｔ ＝ － Λｍ Ｋ１Λ Ｔ ｍ ｅ１ｍ ＋ Λｍ ｅ ～ ２ｍ Ｍｍ ｄｅ ～ ２ｍ ｄｔｍ ＝ － Ｃｍ（ ｅ ～ ２ｍ ） － Ｃｍ（αｍ ＋ （ｘ２ｍ ）ｒ） － ｎｍ － Ｍｍ（ ｄ （ｘ２ｍ ）ｒ ｄｔｍ ＋ ｄαｍ ｄｔｍ ） ＋ Ｆｍ ì î í ï ï ï ïï ï ï ï ï （１５） 定理 １ 考虑误差动态系统（１５），任意给定正 定矩阵 Ｋ１ 、 Ｋ２ ， 则设计如下跟踪控制器： Ｆｍ ＝ － Λ Ｔ ｍ ｅ１ｍ － Ｋ２ ｅ ～ ２ｍ ＋ Ｃｍ（αｍ ＋ （ｘ２ｍ ）ｒ） ＋ ｎｍ ＋ Ｍｍ（ ｄ （ｘ２ｍ ）ｒ ｄｔｍ ＋ ｄαｍ ｄｔｍ ） （１６） 可保证相似模型（５）的系统状态始终跟踪多项 式 向 量 函 数 设 计 的 参 考 轨 迹， 即 ｘ１ｍ（ｔｍ ） ≡ （ｘ１ｍ ）ｒ（ｔｍ ）、 ｘ２ｍ（ｔｍ ） ≡ （ｘ２ｍ ）ｒ（ｔｍ ）， 对 ｔｍ ≥ ０。 证明 考虑如下 Ｌｙａｐｕｎｏｖ 函数： Ｖ ＝ １ ２ ｅ Ｔ １ｍ ｅ１ｍ ＋ １ ２ ｅ ～ Ｔ ２ｍＭｍ ｅ ～ ２ｍ （１７） 对时间 ｔｍ 求导，代入方程（１５）可得： ｄＶ ｄｔｍ ＝ － ｅ Ｔ １ｍΛｍ Ｋ１Λ Ｔ ｍ ｅ１ｍ ＋ ｅ Ｔ １ｍΛｍ ｅ ～ ２ｍ － ｅ ～ Ｔ ２ｍ Ｃｍ（αｍ ＋ （ｘ２ｍ ）ｒ） ＋ ｅ ～ Ｔ ２ｍ（ － Ｃｍ（ ｅ ～ ２ｍ ） － ｎｍ － Ｍｍ（ ｄ （ｘ２ｍ ）ｒ ｄｔｍ ＋ ｄαｍ ｄｔｍ ） ＋ Ｆｍ ） （１８） 将控制器（１６）代入式（１８），并注意到 Ｃｍ 是反 对称阵，可得： ｄＶ ｄｔｍ ＝ － ｅ Ｔ １ｍΛｍ Ｋ１Λ Ｔ ｍ ｅ１ｍ － ｅ ～ Ｔ ２ｍ Ｋ２ ｅ ～ ２ｍ （１９） 根据参考轨迹的设计要求，可以保证： ｅ１ｍ（０） ＝ ０， ｅ ～ ２ｍ（０） ＝ ０ 也即 Ｖ（０） ＝ ０。 则根据 Ｌｙａｐｕｎｏｖ 稳定性理论，有： Ｖ（ｔｍ ） ≡ ０，∀ｔｍ ≥ ０ 即 ｅ１ｍ（ｔｍ ） ≡ ０，ｅ ～ ２ｍ（ｔｍ ） ≡ ０， ∀ｔｍ ≥ ０。 进一步，根据虚拟控制器设计式（１４）可得： α１ｍ（ｔｍ ） ≡ ０ ｅ２ｍ（ｔｍ ） ≡ ０，∀ｔｍ ≥ ０ 因此，在控制器（１６）作用下，相似系统（５）的状 态 ｘ１ｍ 、 ｘ２ｍ 能够完全跟踪设计的有限时间收敛参考 轨迹 （ｘ１ｍ ）ｒ、 （ｘ２ｍ ）ｒ。 与文献［５－８］相比，本文研究的航天器绕飞逼 近翻滚目标的姿轨联合控制问题，是在追踪航天器 本体系下建立的航天器姿轨耦合的相似动力学模 型，通过设计相似系数，可与实验系统在场地大小、 机构速度、运行时间等方面的约束相匹配。 当基本量刚相似比为 １ 时，控制器（１６）即可应 用于航天器交会对接的姿轨联合控制。 ４ 数值实验 ４．１ 仿真条件 目标航天器参数：轨道参数如表 １ 所示，航天器 质量 ｍｔ ＝ ８ ０００ ｋｇ， 转动惯量矩阵： ·８２２· 智 能 系 统 学 报 第 １１ 卷
第6期 孙施浩，等：航天器绕飞逼近翻滚目标运动再现的姿轨控制 ·823· 234941 -1973 2547 仿真输出为航天器空间运动状态的输出，相似 (L),= -1973 748891 1643 (kg·m2) 输出为地面运动再现系统的输出。仿真结果如图4 2547 1643 748052 ~11所示。 初始姿态四元数和姿态角速度分别为 q,(0)=[0.3772-0.43290.66450.4782861T 目标航天器 期望 半物理系统 相似动力学 姿轨联 云 跟踪控制器 相似 w,(0)=[111]'(°)/s 相似动力 合相@ 输出 学仿真 目标航天器无轨道和姿态机动。 动力学 模拟器机构 动力学半物 追踪航天器 理试验时为 表1失控翻滚目标轨道参数 相似动力学 真实运动机构 Table 1 Orbit parameters of uncontrolled tumble target 相对位置测量系统 参数 数值 姿轨联合 控制器 偏心率 0.73 多项式规划的参考轨迹 半长轴/km 24371 仿直 目标航天器动力学 输出 升交点赤经/（°） 98 相似变换 追踪航天器动力学 轨道倾斜角/（°） 0 近地点幅角/（°） 0 图3仿真结构框图 初始真近点角/（°） 10 Fig.3 Block diagram of simulation 追踪航天器参数：轨道倾斜角为(105)°，初始 4.2仿真结果分析 真近点角为(10-1.5×105)°，其他轨道参数均 根据设定的交会对接任务过程、初始条件及相 与目标航天相同。航天器质量m.=6000kg,转动 似比例系数，求得多项式拟合的相似系统姿轨的参 惯量矩阵： 考轨迹如图4、5所示，满足给定时间收敛且动态性 T112362 -1263 1587 能良好。由反步法设计的姿轨联合控制器控制量及 (1).= -1263412553 991 (kg·m2) 跟踪误差如图6、7所示，由于设计的参考轨迹初始 1587 991 365282 值与系统状态初始值相同，且仿真未考虑系统模型 初始姿态四元数和姿态角速度分别为 不确定性及干扰，因此全程控制误差几乎为零，控制 9.(0)=[0001] 量平滑且能量消耗较小。 w.(0)=[000]'(°)/s 2 绕飞逼近任务过程：首先完成姿态同步，并到达 -(X)c 对接口后方2m的位置，其中姿态同步时间为T。= -(Y)c 2000s,到达对接口后方时间T,=10000s,然后保 --(Zc 持当前状态T2=7200s,最终直线逼近完成对接时 间为Ta=2000s。 基本量纲相似比系数： 10 0.5 入，=1/10，入，=1/10，入m=1/1000 10s15 2025*10 在运动再现仿真中，采用的是动力学仿真与运 图4位置参考轨迹 动学等效思想，上述姿态轨道动力学模型仅在计算 Fig.4 Reference trajectory of position 机内进行数值解算，因此涉及的动力学参数，如航天 1.0r 0.8 —(g)0 器的惯量阵1，航天器质量m,均是数值量，与运动 0.6 (g)1 模拟器机构真实惯量和质量无关，质量量纲缩比系 0.4 …(g,2 -(g）3 数入。可任意选取，在这里为了控制量数值显示方 0.2 便取为数值1/1000。 0 -0.2 控制器参数： -0.4 K1=diag(60,60,60),K2=diag(50,50,50) -0.6 -0.8 仿真系统总体结构框图如图3。其中相似变换模块： 0.5 1.0 1.5 25*10 2.0 tis 「入wA2入L3 03x3 7-1 F(t)= F(tn） 图5姿态参考轨迹 03x3 AuxirIs Fig.5 Reference trajectory of attitude
（Ｉｔ）ｔ ＝ ２３４ ９４１ － １ ９７３ ２ ５４７ － １ ９７３ ７４８ ８９１ １ ６４３ ２ ５４７ １ ６４３ ７４８ ０５２ é ë ê ê ê ù û ú ú ú （ｋｇ·ｍ ２ ） 初始姿态四元数和姿态角速度分别为 ｑｔ（０） ＝ [０．３７７ ２ － ０．４３２ ９ ０．６６４ ５ ０．４７８ ２８６] Ｔ ωｔ（０） ＝ [１ １ １] Ｔ （ ° ） ／ ｓ 目标航天器无轨道和姿态机动。 表 １ 失控翻滚目标轨道参数 Ｔａｂｌｅ １ Ｏｒｂｉｔ ｐａｒａｍｅｔｅｒｓ ｏｆ ｕｎｃｏｎｔｒｏｌｌｅｄ ｔｕｍｂｌｅ ｔａｒｇｅｔ 参数 数值 偏心率 ０．７３ 半长轴／ ｋｍ ２４ ３７１ 升交点赤经／ （°） ９８ 轨道倾斜角／ （°） ０ 近地点幅角／ （°） ０ 初始真近点角／ （°） １０ 追踪航天器参数：轨道倾斜角为 （１０ －５ ） ° ， 初始 真近点角为 （１０ － １．５ × １０ －５ ） ° ， 其他轨道参数均 与目标航天相同。 航天器质量 ｍｃ ＝ ６ ０００ ｋｇ， 转动 惯量矩阵： （Ｉｃ）ｃ ＝ １１２ ３６２ － １ ２６３ １ ５８７ － １ ２６３ ４１２ ５５３ ９９１ １ ５８７ ９９１ ３６５ ２８２ é ë ê ê ê ù û ú ú ú （ｋｇ·ｍ ２ ） 初始姿态四元数和姿态角速度分别为 ｑｃ（０） ＝ [０ ０ ０ １] Ｔ ωｃ（０） ＝ [０ ０ ０] Ｔ （ ° ） ／ ｓ 绕飞逼近任务过程：首先完成姿态同步，并到达 对接口后方 ２ ｍ 的位置，其中姿态同步时间为 Ｔｑ ＝ ２ ０００ ｓ， 到达对接口后方时间 Ｔｒ１ ＝ １０ ０００ ｓ， 然后保 持当前状态 Ｔｒ２ ＝ ７ ２００ ｓ ，最终直线逼近完成对接时 间为 Ｔｒ３ ＝ ２ ０００ ｓ 。 基本量纲相似比系数： λＬ ＝ １ ／ １０，λＴ ＝ １ ／ １０，λｍ ＝ １ ／ １ ０００ 在运动再现仿真中，采用的是动力学仿真与运 动学等效思想，上述姿态轨道动力学模型仅在计算 机内进行数值解算，因此涉及的动力学参数，如航天 器的惯量阵 Ｉ， 航天器质量 ｍ， 均是数值量，与运动 模拟器机构真实惯量和质量无关，质量量纲缩比系 数 λ ｍ 可任意选取，在这里为了控制量数值显示方 便取为数值 １ ／ １ ０００。 控制器参数： Ｋ１ ＝ ｄｉａｇ（６０，６０，６０），Ｋ２ ＝ ｄｉａｇ（５０，５０，５０） 仿真系统总体结构框图如图 ３。 其中相似变换模块： Ｆ（ｔ） ＝ λＭ λ －２ Ｔ λＬ Ｉ３ ０３×３ ０３×３ λＭ λ ２ Ｌλ －２ Ｔ Ｉ３ é ë ê ê ù û ú ú －１ Ｆｍ（ｔｍ ） 仿真输出为航天器空间运动状态的输出，相似 输出为地面运动再现系统的输出。 仿真结果如图 ４ ～１１ 所示。 图 ３ 仿真结构框图 Ｆｉｇ．３ Ｂｌｏｃｋ ｄｉａｇｒａｍ ｏｆ ｓｉｍｕｌａｔｉｏｎ ４．２ 仿真结果分析 根据设定的交会对接任务过程、初始条件及相 似比例系数，求得多项式拟合的相似系统姿轨的参 考轨迹如图 ４、５ 所示，满足给定时间收敛且动态性 能良好。 由反步法设计的姿轨联合控制器控制量及 跟踪误差如图 ６、７ 所示，由于设计的参考轨迹初始 值与系统状态初始值相同，且仿真未考虑系统模型 不确定性及干扰，因此全程控制误差几乎为零，控制 量平滑且能量消耗较小。 图 ４ 位置参考轨迹 Ｆｉｇ．４ Ｒｅｆｅｒｅｎｃｅ ｔｒａｊｅｃｔｏｒｙ ｏｆ ｐｏｓｉｔｉｏｎ 图 ５ 姿态参考轨迹 Ｆｉｇ．５ Ｒｅｆｅｒｅｎｃｅ ｔｒａｊｅｃｔｏｒｙ ｏｆ ａｔｔｉｔｕｄｅ 第 ６ 期 孙施浩，等：航天器绕飞逼近翻滚目标运动再现的姿轨控制 ·８２３·
824 智能系统学报 第11卷 0.02 881 004 0.01 0.02 -0.02 -0.04 -0.06 -0.01 -0.08 0.30.20.1 0.2 -0.02 01 Y/m 07 -0.03 09 1.0 s 图91000-2400s坐标系0axyu2m下的运动轨迹 Fig.9 Trajectory in o at time 1000-2400 s 0.0 图10和11为追踪航天器在坐标系0xy之。下 的姿轨运动曲线，对比图4、5，运动距离相差入，= 1/10,运动时间相差入，=1/10，姿态角度数量相同 -0.01 M 入=1，符合预期的相似比结果。 -0.02 --…M 本文主要为了说明姿轨联合控制器设计方法， ---M2 未考虑系统不确定性和干扰。当考虑航天器姿轨动 -0.03 50 100 150 力学和模拟器动力学存在不确定性和干扰时，可以 s 应用鲁棒控制、滑模控制[202)等方法重新设计控制 图6控制器控制力和力矩 器(16)，但是相似性条件和仿真框架、过程均不变。 Fig.6 The force and moment of visual controller 20 5r*10 0 2.0 (X.)c 1.5误差e) -20 (Y)e L.0 误差(ga) 误差(x) -40 (Z )e 0.5 0 误差0y -60 -0.5 误差(g) -80 -1.0误差(g -1.5 -100 -2.0 0 0.5 1.01.5 2.025×10 -2.5 0.5 10152025×10 图10 坐标系0xy。 下的航天器相对轨道运动 Fig.10 Relative orbit trajectory in o.xyz frame 图7跟踪误差曲线 Fig.7 Block diagram of simulation 1.0 —(g)0 0.8 -(9)1 图8、9是在坐标系0xya2:下两航天器的相对轨道 0.6 (9)2 运动轨迹，分别对应0~1000s和1000~2400s。从 0.4 -(93 图中可以看到追踪航天器逼近目标，最终实现对接 0 的过程。由于目标处于翻滚状态，因此接近轨迹不 -0.2 再是沿单一方向的直线逼近。 -0.4 -0.6 -0.8 3 0.5 1.01.52.02.5×10 s 1 泊踪模拟器 图11航天器相对姿态四元数 日标模拟 Fig.11 Relative attitude quaternion 0 5 结束语 5 4-20246810 X/m 本文考虑了地面试验环境中服务航天器与翻滚 图80-1000s坐标系OaxaYa-d下的运动轨迹 目标绕飞逼近运动再现的姿轨联合控制问题，以相 Fig.8 Trajectory in oy at time 0-1000 s 似理论为基础建立了姿轨联合相似动力学模型，给 出姿轨联合控制器的设计方法。通过数值仿真实例
图 ６ 控制器控制力和力矩 Ｆｉｇ．６ Ｔｈｅ ｆｏｒｃｅ ａｎｄ ｍｏｍｅｎｔ ｏｆ ｖｉｓｕａｌ ｃｏｎｔｒｏｌｌｅｒ 图 ７ 跟踪误差曲线 Ｆｉｇ．７ Ｂｌｏｃｋ ｄｉａｇｒａｍ ｏｆ ｓｉｍｕｌａｔｉｏｎ 图 ８、９ 是在坐标系 ｏｔｉ ｘｔｉ ｙｔｉ ｚｔｉ 下两航天器的相对轨道 运动轨迹，分别对应 ０～１ ０００ ｓ 和 １ ０００～２ ４００ ｓ。 从 图中可以看到追踪航天器逼近目标，最终实现对接 的过程。 由于目标处于翻滚状态，因此接近轨迹不 再是沿单一方向的直线逼近。 图 ８ ０～ １ ０００ ｓ 坐标系 ｏｔｉ ｘｔｉ ｙｔｉ ｚｔｉ 下的运动轨迹 Ｆｉｇ．８ Ｔｒａｊｅｃｔｏｒｙ ｉｎ ｏｔｉ ｘｔｉ ｙｔｉ ｚｔｉ ａｔ ｔｉｍｅ ０～ １ ０００ ｓ 图 ９ １ ０００～ ２ ４００ ｓ 坐标系 ｏｔｉ ｘｔｉ ｙｔｉ ｚｔｉ 下的运动轨迹 Ｆｉｇ．９ Ｔｒａｊｅｃｔｏｒｙ ｉｎ ｏｔｉ ｘｔｉ ｙｔｉ ｚｔｉ ａｔ ｔｉｍｅ １ ０００～ ２ ４００ ｓ 图 １０ 和 １１ 为追踪航天器在坐标系 ｏｃ ｘｃ ｙｃ ｚｃ 下 的姿轨运动曲线，对比图 ４、５，运动距离相差 λＬ ＝ １ ／ １０， 运动时间相差 λＴ ＝ １ ／ １０， 姿态角度数量相同 λｑｃ ＝ １， 符合预期的相似比结果。 本文主要为了说明姿轨联合控制器设计方法， 未考虑系统不确定性和干扰。 当考虑航天器姿轨动 力学和模拟器动力学存在不确定性和干扰时，可以 应用鲁棒控制、滑模控制［２０－２１］等方法重新设计控制 器（１６），但是相似性条件和仿真框架、过程均不变。 图 １０ 坐标系 ｏｃ ｘｃ ｙｃ ｚｃ 下的航天器相对轨道运动 Ｆｉｇ．１０ Ｒｅｌａｔｉｖｅ ｏｒｂｉｔ ｔｒａｊｅｃｔｏｒｙ ｉｎ ｏｃ ｘｃ ｙｃ ｚｃ ｆｒａｍｅ 图 １１ 航天器相对姿态四元数 Ｆｉｇ．１１ Ｒｅｌａｔｉｖｅ ａｔｔｉｔｕｄｅ ｑｕａｔｅｒｎｉｏｎ ５ 结束语 本文考虑了地面试验环境中服务航天器与翻滚 目标绕飞逼近运动再现的姿轨联合控制问题，以相 似理论为基础建立了姿轨联合相似动力学模型，给 出姿轨联合控制器的设计方法。 通过数值仿真实例 ·８２４· 智 能 系 统 学 报 第 １１ 卷
第6期 孙施浩，等：航天器绕飞逼近翻滚目标运动再现的姿轨控制 .825. 说明了基于运动再现的姿轨控制方法理论上的有效 matica sinica,2001,27(5):695-699 性。进一步的工作是考虑实际系统中模型不确定性 [10]林来兴.空间交会对接的仿真技术[J].航天控制. 以及干扰存在的情况下，在试验样机上开展验证，以 1990.8(4):66-71 提高本文提出方法的可信度。 LIN Laixing.Simulation technology for rendezvous and doc- king in space[J].Aerospace control,1990,8(4):66- 参考文献： 71. [11]刘良栋.卫星控制系统仿真技术[M].北京：中国宇航 [1]FLORES-ABAD A,MA O,PHAM K.et al.A review of 出版社，2003：15-21. space robotics technologies for on-orbit servicing[J].Pro- LIU Liangdong.Simulation technology for satellite control gress in aerospace sciences,2014,68:1-26. system[M].Beijing:China Astronautic Publishing Press, [2]NOLET S.Development of a guidance,navigation and con- 2003:15-21. trol architecture and validation process enabling autonomous [12]BENNINGHOFF H,REMS F,BOGE T.Development and docking to a tumbling satellite[D].Boston,USA:Massa- chusetts Institute of Technology,2007:34-36. hardware-in-the-loop test of a guidance,navigation and control system for on-orbit servicing J.Acta astronautica, [3]李鹏，岳晓奎，袁建平.基于0D方法的在轨操作相对 姿轨耦合控制[J].中国空间科学技术，2012,32(4)：8 2014,102:67-80. -14 [13]石磊，管乐鑫，王京海，等.交会对接地面验证技术 LI Peng,YUE Xiaokui,YUAN Jianping.Coupled control of [J].中国科学：技术科学，2014,44(1)：27-33. relative position and attitude based on 0-D technique for on- SHI Lei,GUAN Yuexin,WANG Jinghai,et al.Ground orbit operations[].Chinese space science and technology, test technology of rendezvous and docking[J.Scientia sin- 2012,32(4):8-14. ica techologica,2014,44(1):27-33. [4]PAN Haizhou,KAPILA V.Adaptive nonlinear control for [14]KLINE S J.Similitude and approximation theory[M].New spacecraft formation flying with coupled translational and at- York:Springer,1986:76-103. titude dynamics[C]//Proceedings of the 40th IEEE Confer- [15]PERSSON S,BODIN P,GILL E,et al.PRISMA an ence on Decision and Control.Orlando,Florida,USA: autonomous formation flying mission[C]//Proceedings of EEE,2001:2057-2062. the ESA Small Satellite Systems and Services Symposium. [5]SEGAL S,GURFIL P.Effect of kinematic rotation-transla- Sardinia,Italy:ESA,2006:25-29. tion coupling on relative spacecraft translational dynamics [16]何兆伟，师鹏，葛冰，等.航天器地面实验的相似性分 [J].Journal of guidance,control,and dynamics,2009,32 析方法[J].北京航空航天大学学报，2012,38(4)： (3):1045-1050. 502-508. [6]廖飞，季海波，解永春.追踪器本体坐标系下航天器姿 HE Zhaowei,SHI Peng,GE Bing,et al.Similitude inves- 轨一体化控制律设计[J].控制与决策，2015,30(9)： tigation for ground experiment of spacecraft[].Journal of 1679-1684. Beijing university of aeronautics and astronautics,2012, LIAO Fei,JI Haibo,XIE Yongchun.Integrated orbit and 38(4)：502-508. attitude control for spacecraft in body fixed coordinate of [17]孙施浩，赵林，贾英民.空间合作目标运动再现的相似 chaser[J].Control and decision,2015,30(9):1679- 设计方法研究[J].宇航学报，2014,35(7)：802-810. 1684. SUN Shihao,ZHAO Lin,JIA Yingmin.Similitude design [7]SHAN J.Synchronized attitude and translational motion con- method for motion reconstruction of space cooperative vehi- trol for spacecraft formation flying[].Proceedings of the cles[]Journal of astronautics,2014,35(7):802-810. institution of mechanical engineers,part G:journal of aero- [18]XU Wenfu,LIANG Bin,XU Yangsheng,et al.A ground space engineering,2009,223(6):749-768. experiment system of free-floating robot for capturing space [8]ZHANG Feng,DUAN Guangren.Robust adaptive integrated target[J].Journal of intelligent and robotic systems, translation and rotation finite-time control of a rigid space- 2007.48(2):187-208. craft with actuator misalignment and unknown mass property [19]FEHSE W.Automated rendezvous and docking of space- [J].International journal of systems science,2014,45 craft[M].Cambridge:Cambridge University Press,2005: (5):1007-1034. 362-417 [9]李智斌，吴宏鑫，解永春，等.航天器智能控制实验平 [20]SUN Shihao,LI Hao,JIA Yingmin,et al.Development of 台[J].自动化学报，2001,27(5)：695-699. a simulation platform for spacecraft Omni-directional ren- LI Zhibin,WU Hongxin,XIE Yongchun,et al.Experimen- dezvous[C]//Proceedings of 2016 Chinese Intelligent Sys- tal platform for spacecraft intelligent control[J].Acta auto- tems Conference.Xiamen,China,2016:77-88
说明了基于运动再现的姿轨控制方法理论上的有效 性。 进一步的工作是考虑实际系统中模型不确定性 以及干扰存在的情况下，在试验样机上开展验证，以 提高本文提出方法的可信度。 参考文献： ［１］ＦＬＯＲＥＳ⁃ＡＢＡＤ Ａ， ＭＡ Ｏ， ＰＨＡＭ Ｋ， ｅｔ ａｌ． Ａ ｒｅｖｉｅｗ ｏｆ ｓｐａｃｅ ｒｏｂｏｔｉｃｓ ｔｅｃｈｎｏｌｏｇｉｅｓ ｆｏｒ ｏｎ⁃ｏｒｂｉｔ ｓｅｒｖｉｃｉｎｇ ［ Ｊ］． Ｐｒｏ⁃ ｇｒｅｓｓ ｉｎ ａｅｒｏｓｐａｃｅ ｓｃｉｅｎｃｅｓ， ２０１４， ６８： １－２６． ［２］ＮＯＬＥＴ Ｓ． Ｄｅｖｅｌｏｐｍｅｎｔ ｏｆ ａ ｇｕｉｄａｎｃｅ， ｎａｖｉｇａｔｉｏｎ ａｎｄ ｃｏｎ⁃ ｔｒｏｌ ａｒｃｈｉｔｅｃｔｕｒｅ ａｎｄ ｖａｌｉｄａｔｉｏｎ ｐｒｏｃｅｓｓ ｅｎａｂｌｉｎｇ ａｕｔｏｎｏｍｏｕｓ ｄｏｃｋｉｎｇ ｔｏ ａ ｔｕｍｂｌｉｎｇ ｓａｔｅｌｌｉｔｅ［Ｄ］． Ｂｏｓｔｏｎ， ＵＳＡ： Ｍａｓｓａ⁃ ｃｈｕｓｅｔｔｓ Ｉｎｓｔｉｔｕｔｅ ｏｆ Ｔｅｃｈｎｏｌｏｇｙ， ２００７： ３４－３６． ［３］李鹏， 岳晓奎， 袁建平． 基于 θ⁃Ｄ 方法的在轨操作相对 姿轨耦合控制［Ｊ］． 中国空间科学技术， ２０１２， ３２（４）： ８ －１４． ＬＩ Ｐｅｎｇ， ＹＵＥ Ｘｉａｏｋｕｉ， ＹＵＡＮ Ｊｉａｎｐｉｎｇ． Ｃｏｕｐｌｅｄ ｃｏｎｔｒｏｌ ｏｆ ｒｅｌａｔｉｖｅ ｐｏｓｉｔｉｏｎ ａｎｄ ａｔｔｉｔｕｄｅ ｂａｓｅｄ ｏｎ θ⁃Ｄ ｔｅｃｈｎｉｑｕｅ ｆｏｒ ｏｎ⁃ ｏｒｂｉｔ ｏｐｅｒａｔｉｏｎｓ［Ｊ］． Ｃｈｉｎｅｓｅ ｓｐａｃｅ ｓｃｉｅｎｃｅ ａｎｄ ｔｅｃｈｎｏｌｏｇｙ， ２０１２， ３２（４）： ８－１４． ［４］ ＰＡＮ Ｈａｉｚｈｏｕ， ＫＡＰＩＬＡ Ｖ． Ａｄａｐｔｉｖｅ ｎｏｎｌｉｎｅａｒ ｃｏｎｔｒｏｌ ｆｏｒ ｓｐａｃｅｃｒａｆｔ ｆｏｒｍａｔｉｏｎ ｆｌｙｉｎｇ ｗｉｔｈ ｃｏｕｐｌｅｄ ｔｒａｎｓｌａｔｉｏｎａｌ ａｎｄ ａｔ⁃ ｔｉｔｕｄｅ ｄｙｎａｍｉｃｓ［Ｃ］ ／ ／ Ｐｒｏｃｅｅｄｉｎｇｓ ｏｆ ｔｈｅ ４０ｔｈ ＩＥＥＥ Ｃｏｎｆｅｒ⁃ ｅｎｃｅ ｏｎ Ｄｅｃｉｓｉｏｎ ａｎｄ Ｃｏｎｔｒｏｌ． Ｏｒｌａｎｄｏ， Ｆｌｏｒｉｄａ， ＵＳＡ： ＩＥＥＥ， ２００１： ２０５７－２０６２． ［５］ ＳＥＧＡＬ Ｓ， ＧＵＲＦＩＬ Ｐ． Ｅｆｆｅｃｔ ｏｆ ｋｉｎｅｍａｔｉｃ ｒｏｔａｔｉｏｎ⁃ｔｒａｎｓｌａ⁃ ｔｉｏｎ ｃｏｕｐｌｉｎｇ ｏｎ ｒｅｌａｔｉｖｅ ｓｐａｃｅｃｒａｆｔ ｔｒａｎｓｌａｔｉｏｎａｌ ｄｙｎａｍｉｃｓ ［ Ｊ］． Ｊｏｕｒｎａｌ ｏｆ ｇｕｉｄａｎｃｅ， ｃｏｎｔｒｏｌ， ａｎｄ ｄｙｎａｍｉｃｓ， ２００９， ３２ （３）： １０４５－１０５０． ［６］廖飞， 季海波， 解永春． 追踪器本体坐标系下航天器姿 轨一体化控制律设计［ Ｊ］． 控制与决策， ２０１５， ３０（ ９）： １６７９－１６８４． ＬＩＡＯ Ｆｅｉ， ＪＩ Ｈａｉｂｏ， ＸＩＥ Ｙｏｎｇｃｈｕｎ． Ｉｎｔｅｇｒａｔｅｄ ｏｒｂｉｔ ａｎｄ ａｔｔｉｔｕｄｅ ｃｏｎｔｒｏｌ ｆｏｒ ｓｐａｃｅｃｒａｆｔ ｉｎ ｂｏｄｙ ｆｉｘｅｄ ｃｏｏｒｄｉｎａｔｅ ｏｆ ｃｈａｓｅｒ［ Ｊ］． Ｃｏｎｔｒｏｌ ａｎｄ ｄｅｃｉｓｉｏｎ， ２０１５， ３０ （ ９）： １６７９ － １６８４． ［７］ＳＨＡＮ Ｊ． Ｓｙｎｃｈｒｏｎｉｚｅｄ ａｔｔｉｔｕｄｅ ａｎｄ ｔｒａｎｓｌａｔｉｏｎａｌ ｍｏｔｉｏｎ ｃｏｎ⁃ ｔｒｏｌ ｆｏｒ ｓｐａｃｅｃｒａｆｔ ｆｏｒｍａｔｉｏｎ ｆｌｙｉｎｇ ［ Ｊ］． Ｐｒｏｃｅｅｄｉｎｇｓ ｏｆ ｔｈｅ ｉｎｓｔｉｔｕｔｉｏｎ ｏｆ ｍｅｃｈａｎｉｃａｌ ｅｎｇｉｎｅｅｒｓ， ｐａｒｔ Ｇ： ｊｏｕｒｎａｌ ｏｆ ａｅｒｏ⁃ ｓｐａｃｅ ｅｎｇｉｎｅｅｒｉｎｇ， ２００９， ２２３（６）： ７４９－７６８． ［８］ＺＨＡＮＧ Ｆｅｎｇ， ＤＵＡＮ Ｇｕａｎｇｒｅｎ． Ｒｏｂｕｓｔ ａｄａｐｔｉｖｅ ｉｎｔｅｇｒａｔｅｄ ｔｒａｎｓｌａｔｉｏｎ ａｎｄ ｒｏｔａｔｉｏｎ ｆｉｎｉｔｅ⁃ｔｉｍｅ ｃｏｎｔｒｏｌ ｏｆ ａ ｒｉｇｉｄ ｓｐａｃｅ⁃ ｃｒａｆｔ ｗｉｔｈ ａｃｔｕａｔｏｒ ｍｉｓａｌｉｇｎｍｅｎｔ ａｎｄ ｕｎｋｎｏｗｎ ｍａｓｓ ｐｒｏｐｅｒｔｙ ［ Ｊ］． Ｉｎｔｅｒｎａｔｉｏｎａｌ ｊｏｕｒｎａｌ ｏｆ ｓｙｓｔｅｍｓ ｓｃｉｅｎｃｅ， ２０１４， ４５ （５）： １００７－１０３４． ［９］李智斌， 吴宏鑫， 解永春， 等． 航天器智能控制实验平 台［Ｊ］． 自动化学报， ２００１， ２７（５）： ６９５－６９９． ＬＩ Ｚｈｉｂｉｎ， ＷＵ Ｈｏｎｇｘｉｎ， ＸＩＥ Ｙｏｎｇｃｈｕｎ， ｅｔ ａｌ． Ｅｘｐｅｒｉｍｅｎ⁃ ｔａｌ ｐｌａｔｆｏｒｍ ｆｏｒ ｓｐａｃｅｃｒａｆｔ ｉｎｔｅｌｌｉｇｅｎｔ ｃｏｎｔｒｏｌ［ Ｊ］． Ａｃｔａ ａｕｔｏ⁃ ｍａｔｉｃａ ｓｉｎｉｃａ， ２００１， ２７（５）： ６９５－６９９． ［１０］ 林来兴． 空间交会对接的仿真技术［ Ｊ］． 航天控制， １９９０， ８（４）： ６６－７１． ＬＩＮ Ｌａｉｘｉｎｇ． Ｓｉｍｕｌａｔｉｏｎ ｔｅｃｈｎｏｌｏｇｙ ｆｏｒ ｒｅｎｄｅｚｖｏｕｓ ａｎｄ ｄｏｃ⁃ ｋｉｎｇ ｉｎ ｓｐａｃｅ［ Ｊ］． Ａｅｒｏｓｐａｃｅ ｃｏｎｔｒｏｌ， １９９０， ８（ ４）： ６６－ ７１． ［１１］刘良栋． 卫星控制系统仿真技术［Ｍ］． 北京： 中国宇航 出版社， ２００３： １５－２１． ＬＩＵ Ｌｉａｎｇｄｏｎｇ． Ｓｉｍｕｌａｔｉｏｎ ｔｅｃｈｎｏｌｏｇｙ ｆｏｒ ｓａｔｅｌｌｉｔｅ ｃｏｎｔｒｏｌ ｓｙｓｔｅｍ［Ｍ］． Ｂｅｉｊｉｎｇ： Ｃｈｉｎａ Ａｓｔｒｏｎａｕｔｉｃ Ｐｕｂｌｉｓｈｉｎｇ Ｐｒｅｓｓ， ２００３： １５－２１． ［１２］ＢＥＮＮＩＮＧＨＯＦＦ Ｈ， ＲＥＭＳ Ｆ， ＢＯＧＥ Ｔ． Ｄｅｖｅｌｏｐｍｅｎｔ ａｎｄ ｈａｒｄｗａｒｅ⁃ｉｎ⁃ｔｈｅ⁃ｌｏｏｐ ｔｅｓｔ ｏｆ ａ ｇｕｉｄａｎｃｅ， ｎａｖｉｇａｔｉｏｎ ａｎｄ ｃｏｎｔｒｏｌ ｓｙｓｔｅｍ ｆｏｒ ｏｎ⁃ｏｒｂｉｔ ｓｅｒｖｉｃｉｎｇ［Ｊ］． Ａｃｔａ ａｓｔｒｏｎａｕｔｉｃａ， ２０１４， １０２： ６７－８０． ［１３］石磊， 管乐鑫， 王京海， 等． 交会对接地面验证技术 ［Ｊ］． 中国科学： 技术科学， ２０１４， ４４（１）： ２７－３３． ＳＨＩ Ｌｅｉ， ＧＵＡＮ Ｙｕｅｘｉｎ， ＷＡＮＧ Ｊｉｎｇｈａｉ， ｅｔ ａｌ． Ｇｒｏｕｎｄ ｔｅｓｔ ｔｅｃｈｎｏｌｏｇｙ ｏｆ ｒｅｎｄｅｚｖｏｕｓ ａｎｄ ｄｏｃｋｉｎｇ［Ｊ］． Ｓｃｉｅｎｔｉａ ｓｉｎ⁃ ｉｃａ ｔｅｃｈｏｌｏｇｉｃａ， ２０１４， ４４（１）： ２７－３３． ［１４］ＫＬＩＮＥ Ｓ Ｊ． Ｓｉｍｉｌｉｔｕｄｅ ａｎｄ ａｐｐｒｏｘｉｍａｔｉｏｎ ｔｈｅｏｒｙ［Ｍ］． Ｎｅｗ Ｙｏｒｋ： Ｓｐｒｉｎｇｅｒ， １９８６： ７６－１０３． ［１５］ ＰＥＲＳＳＯＮ Ｓ， ＢＯＤＩＮ Ｐ， ＧＩＬＬ Ｅ， ｅｔ ａｌ． ＰＲＩＳＭＡ – ａｎ ａｕｔｏｎｏｍｏｕｓ ｆｏｒｍａｔｉｏｎ ｆｌｙｉｎｇ ｍｉｓｓｉｏｎ ［ Ｃ］ ／ ／ Ｐｒｏｃｅｅｄｉｎｇｓ ｏｆ ｔｈｅ ＥＳＡ Ｓｍａｌｌ Ｓａｔｅｌｌｉｔｅ Ｓｙｓｔｅｍｓ ａｎｄ Ｓｅｒｖｉｃｅｓ Ｓｙｍｐｏｓｉｕｍ． Ｓａｒｄｉｎｉａ， Ｉｔａｌｙ： ＥＳＡ， ２００６： ２５－２９． ［１６］何兆伟， 师鹏， 葛冰， 等． 航天器地面实验的相似性分 析方法［ Ｊ］． 北京航空航天大学学报， ２０１２， ３８ （ ４）： ５０２－５０８． ＨＥ Ｚｈａｏｗｅｉ， ＳＨＩ Ｐｅｎｇ， ＧＥ Ｂｉｎｇ， ｅｔ ａｌ． Ｓｉｍｉｌｉｔｕｄｅ ｉｎｖｅｓ⁃ ｔｉｇａｔｉｏｎ ｆｏｒ ｇｒｏｕｎｄ ｅｘｐｅｒｉｍｅｎｔ ｏｆ ｓｐａｃｅｃｒａｆｔ［ Ｊ］． Ｊｏｕｒｎａｌ ｏｆ Ｂｅｉｊｉｎｇ ｕｎｉｖｅｒｓｉｔｙ ｏｆ ａｅｒｏｎａｕｔｉｃｓ ａｎｄ ａｓｔｒｏｎａｕｔｉｃｓ， ２０１２， ３８（４）： ５０２－５０８． ［１７］孙施浩， 赵林， 贾英民． 空间合作目标运动再现的相似 设计方法研究［Ｊ］． 宇航学报， ２０１４， ３５（７）： ８０２－８１０． ＳＵＮ Ｓｈｉｈａｏ， ＺＨＡＯ Ｌｉｎ， ＪＩＡ Ｙｉｎｇｍｉｎ． Ｓｉｍｉｌｉｔｕｄｅ ｄｅｓｉｇｎ ｍｅｔｈｏｄ ｆｏｒ ｍｏｔｉｏｎ ｒｅｃｏｎｓｔｒｕｃｔｉｏｎ ｏｆ ｓｐａｃｅ ｃｏｏｐｅｒａｔｉｖｅ ｖｅｈｉ⁃ ｃｌｅｓ［Ｊ］． Ｊｏｕｒｎａｌ ｏｆ ａｓｔｒｏｎａｕｔｉｃｓ， ２０１４， ３５（７）： ８０２－８１０． ［１８］ＸＵ Ｗｅｎｆｕ， ＬＩＡＮＧ Ｂｉｎ， ＸＵ Ｙａｎｇｓｈｅｎｇ， ｅｔ ａｌ． Ａ ｇｒｏｕｎｄ ｅｘｐｅｒｉｍｅｎｔ ｓｙｓｔｅｍ ｏｆ ｆｒｅｅ⁃ｆｌｏａｔｉｎｇ ｒｏｂｏｔ ｆｏｒ ｃａｐｔｕｒｉｎｇ ｓｐａｃｅ ｔａｒｇｅｔ ［ Ｊ ］． Ｊｏｕｒｎａｌ ｏｆ ｉｎｔｅｌｌｉｇｅｎｔ ａｎｄ ｒｏｂｏｔｉｃ ｓｙｓｔｅｍｓ， ２００７， ４８（２）： １８７－２０８． ［１９］ ＦＥＨＳＥ Ｗ． Ａｕｔｏｍａｔｅｄ ｒｅｎｄｅｚｖｏｕｓ ａｎｄ ｄｏｃｋｉｎｇ ｏｆ ｓｐａｃｅ⁃ ｃｒａｆｔ［Ｍ］． Ｃａｍｂｒｉｄｇｅ： Ｃａｍｂｒｉｄｇｅ Ｕｎｉｖｅｒｓｉｔｙ Ｐｒｅｓｓ， ２００５： ３６２－４１７． ［２０］ＳＵＮ Ｓｈｉｈａｏ， ＬＩ Ｈａｏ， ＪＩＡ Ｙｉｎｇｍｉｎ， ｅｔ ａｌ． Ｄｅｖｅｌｏｐｍｅｎｔ ｏｆ ａ ｓｉｍｕｌａｔｉｏｎ ｐｌａｔｆｏｒｍ ｆｏｒ ｓｐａｃｅｃｒａｆｔ Ｏｍｎｉ－ｄｉｒｅｃｔｉｏｎａｌ ｒｅｎ⁃ ｄｅｚｖｏｕｓ［Ｃ］ ／ ／ Ｐｒｏｃｅｅｄｉｎｇｓ ｏｆ ２０１６ Ｃｈｉｎｅｓｅ Ｉｎｔｅｌｌｉｇｅｎｔ Ｓｙｓ⁃ ｔｅｍｓ Ｃｏｎｆｅｒｅｎｃｅ． Ｘｉａｍｅｎ， Ｃｈｉｎａ， ２０１６： ７７－８８． 第 ６ 期 孙施浩，等：航天器绕飞逼近翻滚目标运动再现的姿轨控制 ·８２５·
·826 智能系统学报 第11卷 作者简介： 孙施浩，男，1989年生，博士研究 贾英民，男，1958年生，教授，博士 生，主要研究方向为航天器控制、航天 生导师，中国人工智能学会常务理事， 器地面验证实验。 中国人工智能学会智能空天系统专业 委员会主任，主要研究方向为鲁棒与自 适应控制、航空航天控制，发表学术论文 100余篇。 2017第13届中国智能系统会议 The Chinese Intelligent Systems Conference (CISC) 中国智能系统会议是由中国人工智能学会智能空天系统专业委员会发起的系列学术会议，其宗旨是为本领 域的专家学者、研究生以及工程技术人员提供一个学术交流的平台，以推动我国智能系统相关理论、技术与应用 的发展。第13届中国智能系统会议(CISC2017)将于2017年10月14一15日在黑龙江省牡丹江市召开。本次 会议由中国人工智能学会主办，中国人工智能学会智能主天系统专业委员会协办，牡丹江师范学院与北京航空航 天大学承办。会议论文集将由Springer出版社在Lecture Notes in Electrical Engineering系列正式出版，El收录。 热忱欢迎海内外广大同仁踊跃投稿井出席本届会议，交流学术成果。 主办单位：中国人工智能学会 协办单位：中国人工智能学会智能主天系统专业委员会 承办单位：牡丹江师范大学、北京航空航天大学 会议主席：贾英民，北京航空航天大学；杨敬民，牡丹江师范学院 征文范围： S01多智能体系统 S13智能交通与控制 S02网控制 S14预测与学习控制 S03智能机器人 S15信息获取与信息融合 S04复杂系统与群集行为 S16飞行器导航、靠Ⅱ导与控制 S05事件与数据驱动控制 S17混杂与离散事件系统 S06拟人系统与人工生命 S18智能制造与云制造 S07鲁棒与自适应控制 S19高超声速飞行器控制 S08大数据与脑科学 S20电力系统及其自动化 S09过程控制 S21模糊系统与神经网络 S10非线性与变结构控制 S22航天智能发射系统 S11智能传感器与检测技术 S23其他 S12嵌入式系统与无线传感网络 会议网站：http:/sias.buaa.edu.cn/info/1007/1132.htm
作者简介： 孙施浩，男，１９８９ 年生，博士研究 生，主要研究方向为航天器控制、航天 器地面验证实验。 贾英民，男，１９５８ 年生，教授，博士 生导师，中国人工智能学会常务理事， 中国人工智能学会智能空天系统专业 委员会主任，主要研究方向为鲁棒与自 适应控制、航空航天控制，发表学术论文 ２０１７ 第 １３ 届中国智能系统会议 Ｔｈｅ Ｃｈｉｎｅｓｅ Ｉｎｔｅｌｌｉｇｅｎｔ Ｓｙｓｔｅｍｓ Ｃｏｎｆｅｒｅｎｃｅ （ＣＩＳＣ） 中国智能系统会议是由中国人工智能学会智能空天系统专业委员会发起的系列学术会议，其宗旨是为本领 域的专家学者、研究生以及工程技术人员提供一个学术交流的平台，以推动我国智能系统相关理论、技术与应用 的发展。 第 １３ 届中国智能系统会议（ＣＩＳＣ＇ ２０１７） 将于 ２０１７ 年 １０ 月 １４—１５ 日在黑龙江省牡丹江市召开。 本次 会议由中国人工智能学会主办，中国人工智能学会智能主天系统专业委员会协办，牡丹江师范学院与北京航空航 天大学承办。 会议论文集将由 Ｓｐｒｉｎｇｅｒ 出版社在 Ｌｅｃｔｕｒｅ Ｎｏｔｅｓ ｉｎ Ｅｌｅｃｔｒｉｃａｌ Ｅｎｇｉｎｅｅｒｉｎｇ 系列正式出版， ＥＩ 收录。 热忱欢迎海内外广大同仁踊跃投稿井出席本届会议，交流学术成果。 主办单位：中国人工智能学会 协办单位：中国人工智能学会智能主天系统专业委员会 承办单位：牡丹江师范大学、北京航空航天大学 会议主席：贾英民，北京航空航天大学 ；杨敬民，牡丹江师范学院 征文范围： Ｓ０１ 多智能体系统 Ｓ０２ 网络控制 Ｓ０３ 智能机器人 Ｓ０４ 复杂系统与群集行为 Ｓ０５ 事件与数据驱动控制 Ｓ０６ 拟人系统与人工生命 Ｓ０７ 鲁棒与自适应控制 Ｓ０８ 大数据与脑科学 Ｓ０９ 过程控制 Ｓ１０ 非线性与变结构控制 Ｓ１１ 智能传感器与检测技术 Ｓ１２ 嵌入式系统与无线传感网络 Ｓ１３ 智能交通与控制 Ｓ１４ 预测与学习控制 Ｓ１５ 信息获取与信息融合 Ｓ１６ 飞行器导航、靠 ＩＪ 导与控制 Ｓ１７ 混杂与离散事件系统 Ｓ１８ 智能制造与云制造 Ｓ１９ 高超声速飞行器控制 Ｓ２０ 电力系统及其自动化 Ｓ２１ 模糊系统与神经网络 Ｓ２２ 航天智能发射系统 Ｓ２３ 其他 会议网站：ｈｔｔｐ： ／ ／ ｓｉａｓ．ｂｕａａ．ｅｄｕ．ｃｎ ／ ｉｎｆｏ ／ １００７ ／ １１３２．ｈｔｍ ·８２６· 智 能 系 统 学 报 第 １１ 卷 １００ 余篇
