空间站宏微机械臂动力学建模与零反作用控制_尹旺.pdf

第 卷第期 年月航天器工程 空间站宏微机械臂动力学建模与零反作用控制尹旺王翔王为刘冬雨（北京空间飞行器总体设计部，北京 ）摘要为满足空间站宏微机械臂级联在一起运动的任务需求，文章提出一种简化的动力学建模方法。首先利用雅克比矩阵将柔性关节宏机械臂等效为柔性基座，根据柔性基座、刚性微机械臂以及两者之间的耦合作用推导出柔性基座机械臂动力学模型。基于机械臂系统的动力学冗余特性，采用零反作用运动控制法使柔性基座与微机械臂之间运动解耦。文中数学模型的仿真结果与商业软件一致，表明了柔性基座机械臂模型的正确性。另外，将零反作用轨迹跟踪控制法成功应用于该模型，使得微机械臂末端在跟踪期望轨迹的同时完全不会激起基座的弹性变形。关键词宏微机械臂；柔性基座；零反作用；振动抑制中图分类号：文献标志码：（，）：，：；收稿日期：；修回日期：作者简介：尹旺，男，博士研究生，研究方向为空间机械臂轨迹规划和动力学控制。：。空间站舱外机械臂系统一般由大型柔性机械臂和固连在其末端的刚性灵活机械臂组成。如国际空间站上的加拿大臂和专用灵巧手、日本实验舱的遥控机械臂系统（）和中国空间站上的核心舱机械臂和实验舱小臂。宏机械臂用于实现大范围转移运动，微机械臂用于实现精细化操作。采用行星齿轮减速器的宏机械臂会表现出大挠度的特点，如果不采取措施，微机械臂运动时会在惯性力的作用下激起宏机械臂末端的大幅度振动，从而影响微机械臂末端的精度和效率。另外，为提高机械臂的灵活性和可操作性，微机械臂通常具有一定的冗余自由度，因此此类宏微机械臂最主要的特点是支撑结构的柔性和自由度的冗余性。抑制柔性基座机械臂弹性振动的方法主要有被动控制方法和主动控制方法。被动控制方法是通过选用各种耗能材料及对机械结构进行优化设计，从而达到降低柔性结构弹性变形、控制结构振动的目的。主动控制方法是通过外部能量的输入以获得期望的阻尼、刚度特性，从而抑制柔性结构的动态响应。主动控制主要有前馈控制（输入整形、轨迹规划）和反馈控制两种典型方法，前者应用时只需要建立系统的动力学模型而不用测量基座振动量的传感器设备，在工程中的应用时简单可靠，但是前馈控制的调节时间长、鲁棒性较差，当系统模型存在误差时不再适用。反馈控制是根据系统振动状态的反馈信息来产生作动力力矩，从而实现柔性机械臂的轨迹跟踪和振动控制。诸多学者利用冗余机械臂的自运动能力进行了抑振研究。文献 基于拉格朗日乘子法和最小二乘推导得到冗余机械臂的反作用最优控制，并从理论上证明了两种控制方法的一致性，试验证实所提方法能减微机械臂运动产生的反作用力矩。文献 等人指出由于系统中柔性坐标远多于机械臂的冗余度，基于上述方法求得的只是最小二乘意义上的反作用最优解，故提出一种新的算法，该算法利用机械臂冗余特性可消除在模态空间的低阶模态力，因而具有更好的抑振效果。同时，国内的文献 也对自运动优化选择的复模态法进行了研究。文献 将反作用零空间的思想应用到柔性基座机械臂中，并提出一种综合控制律，该控制律充分利用逆动力学模型，能同时满足柔性基座的振动抑制、反作用激振最小以及末端轨迹跟踪等任务。文献 将 小精细臂（）系统的前三个关节视为柔性关节，后九个关节视为微机械臂，并将文献提出的综合控制算法成功应用到该系统，仿真结果证实了这种综合控制算法对于真实的宏微机械臂系统是有效的。文献 等并没有将柔性宏机械臂等效为柔性基座，为了获取更多的冗余自由度，将宏机械臂的部分关节与微机械臂关节同时控制，这在实际应用时难度较大。为了满足空间站宏微机械臂分时独立控制的任务需求，本文首先将宏机械臂等效为柔性基座，并对微机械臂进行了零反作用运动控制，使得微机械臂在完成任务的同时不对基座产生任何扰动。柔性基座机械臂系统建模 问题描述空间站建造完成进入运营阶段后，空间机械臂主要用于舱外载荷照料、在轨可更换单元替换以及航天员转移等，微机械臂末端是相对于空间站运动的，因此在运动学关系上空间机械臂相当于地面机械臂。另外，空间站自身质量远大于机械臂系统，机械臂运动对站的姿态影响很小，因此本文将宏机械臂基座坐标系视为惯性参考系，宏臂和微臂末端的固连坐标系分别为，两者的运动都是相对于而言的，如图所示。图空间站宏微机械臂示意图 地面实验表明，由碳纤维增强基复合材料制作而成的臂杆刚度远大于关节刚度，宏机械臂的柔性主要来源于柔性关节，因而本文不考虑宏机械臂臂杆柔性的影响。柔性基座机械臂运动方程柔性关节宏机械臂的动力学模型为（）（，?）（）（）（）式中：为宏机械臂的关节角度向量；为电机经减速比后输出的角度向量；（）为宏机械臂在关节空间的惯性矩阵；（，?）为宏机械臂的离心力和哥氏力矢量；为关节刚度矩阵；为电机转子减速后的等效转动惯量；和分别为施加在宏机械臂关节处的外力矩和驱动力矩。文献 中和 中分别给出了宏机械臂末端的惯量特性和等效刚度矩阵为（）（）（）航天器工程 卷（）（）（）式中：为宏机械臂末端在固定基下的雅克比矩阵。由此可见，宏机械臂末端的惯量特性和刚度矩阵随其构型的变化而变化，当宏机械臂处于某一固定构型时，（）和（）可近似为常值矩阵。此时柔性宏机械臂等效为六自由度柔性基座与空间站相连，根据拉格朗日方程可求得柔性基座的受迫振动方程为（）（）式中：为柔性基座的位姿矢量；（）为柔性基座受到的广义外力。刚性微机械臂的动力学方程为（）（，?）（）式中：为微臂的惯性矩阵；为微臂的哥氏力和离心力；为微臂的驱动力矩。式（）和式（）分别给出了刚性微机械臂与柔性基座的动力学模型，两个子系统有着各自的动力学特性，当结合在一起后会相互影响。由于两者之间存在动力学耦合作用，因此柔性基座机械臂系统不是柔性基座和刚性机械臂之间的简单结合，而是通过耦合项将两者耦合在一起的。根据拉格朗日方程和牛顿欧拉法推导得出柔性基座机械臂的动力学方程为?（）（）式中，和?为基座和微机械臂臂的之间的惯性耦合矩阵，和为非线性耦合力。零反作用运动控制当微机械臂自由度大于柔性基座的自由度时，微机械臂具有反作用零空间，即微机械臂在运动过程中各连杆产生的反作用力相互抵消，从而不对柔性基座产生任何扰动，从而实现微机械臂与基座之间的运动解耦。微机械臂的零反作用运动控制可基于关节加速度的控制律实现。（?）（）式中：为主动阻尼系数；（）表示惯性耦合矩阵的零空间；为任意矢量。当微机械臂按该控制律运动时，不会对基座产生反作用，同时系统中引入了主动阻尼控制。另外，利用动力学冗余项 还能在反作用空间实现对微机械臂末端的轨迹跟踪控制。（）?（）式中：和分别为微机械臂和柔性基座的雅克比矩阵；是期望的跟踪路径；（）为路径的跟踪误差；和为合适的增益矩阵。式（）代入式（）即可得到基于加速度的零反作用轨迹跟踪控制律。该控制律应用的前提是微机械臂自由度大于柔性基座自由度，另外惯性耦合矩阵应该行满秩，否则会发生动力学奇异。仿真分析 等效模型验证由图知，宏机械臂具有个自由度，等效为柔性基座后具有个自由度（个平动，个转动），为表明等效前后动力学特性不变，首先分析两者的固有频率。宏机械臂肘部关节（关节）连接的两臂杆跨度最大，因而对宏机械臂末端的动力学特性最大，其他连杆跨度较小，影响较小。为分析宏机械臂肘关节对柔性 系 统 各 阶 固 有 频 率 的 影 响，设 宏 臂 构 型 为，其 中在 之间变化。计算结果如图所示，红色虚线代表柔性宏机械臂固有频率，蓝色实线为柔性基座固有频率。第期尹旺 等：空间站宏微机械臂动力学建模与零反作用控制图柔性基座各阶固有频率 自由度的柔性宏机械臂等效为自由度的柔性基座，会丢失阶固有频率。由图（）知当肘关节小于 时，柔性基座和柔性宏机械臂的第阶固有频率对应相同，相当于丢失了第阶频率；当肘关节大于 时，柔性基座的第阶固有频率与宏机械臂的第阶相同，相当于丢失了第阶频率。由于柔性宏机械臂的、阶固有频率相差很小且远大于基频，因此，宏机械臂等效为柔性基座后丢失的阶固有频率对动力学特性的影响很小。由图（）和（）可知，等效柔性基座模型与机械臂、阶频率相差稍大，原因在于当肘部关节位于 和 附近时，宏机械臂雅克比矩阵的最小奇异值较小，即宏机械臂接近奇异构型，此时进行动力学等效时会造成一定误差。但出现误差的频率都在 以上，而基频在 以下，因此该误差对整体的动力学特性影响也可接受。从图（）发现柔性宏机械臂的基频随着肘关节角的变化而变化，当肘关节角度为 时基频最高，当肘关节角度为 时基频最低，表明宏机械臂折叠程度越高，基频越高，等效成的柔性基座稳定性越好；伸展程度越高，基频越低，柔性基座稳定性越差。为验证所建立模型的正确性，采用 商业软件进行仿真对比。宏机械臂初始时刻处于静止状态，关节锁定时角度为，假设 宏 机 械 臂 柔 性 关 节 刚 度 为 （），提取的固有频率和基于模型的计算结果如表所示。刚性微机械臂进行空间点到点的运动，初始时刻关节角度为，终止时刻构型为，仿真时长为 ，采样周期为 ，各关节角位移采用五次多项式的轨迹，起止时刻的关节角速度、角加速度均为零，如图所示。对于柔性基座而言，激励载荷即为微机械臂各关节的角位移，如图所示，柔性基座的振动响应如图所示。将式（）中柔性宏机械臂的惯性矩阵和刚度矩阵代入频率行列式 ，计算得到柔性宏机械臂的各阶固有频率，同理将式（）中的和代入频率行列式?中即可得到柔性基座的各阶固有频率?。表中数据表明，基于 提取的各阶频率与基于模型的计算结果一致，表明本文中所建立动力学模型的正确性。航天器工程 卷表柔性宏机械臂及柔性基座各阶固有频率 阶数 柔性宏机械臂 柔性基座 图柔性宏刚性微机械臂仿真模型 图微机械臂关节角位移 从仿真曲线可以看出柔性基座振动位移曲线完全吻合，分析结果说明了本文给出的柔性基座机械臂动力学建模的正确性和合理性。给出的动力学方程可作为空间站宏微机械臂级联控制的基础模型。第期尹旺 等：空间站宏微机械臂动力学建模与零反作用控制图柔性基座振动位移 零反作用运动控制假设宏机械臂处于完全伸展构型，即，此时宏机械臂为奇异构型，考虑到各关节的弹性变形沿轴线方向，则宏机械臂末端具有个柔性自由度，即宏臂末端只能在沿着轴、绕着轴和绕轴的方向发生弹性位移。微机械臂具有自由度，此时柔性基座机械臂的反作用零空间是维的，不考虑姿态的变化，基于式（）和式（）所示的控制律，微机械臂末端可跟踪三维空间内任意轨迹而不引起基座的振动。假设微机械臂初始构型为，末端沿着直线从（，）运动到（，），该坐标是末端固连系相对于惯性系的描述，过程中微机械臂对柔性基座的反作用及弹性位移如图所示。航天器工程 卷图柔性基座振动位移及其反作用 由图知，对机械臂采用零反作用的轨迹跟踪控制时，基座在个柔性自由度方向所受的反作用力力矩均为零，因此微机械臂能在完全不激起基座扰动的前提下完成轨迹跟踪任务，图给出了微机械臂在不同视角下的运动轨迹。图基于零反作用的末端轨迹跟踪控制 结束语本文将柔性关节宏机械臂等效为柔性基座，经数值仿真证实两者动力学特性的一致性。基于该简化模型能方便地得到柔性宏机械臂在各种构型下的固有频率，宏机械臂伸展程度越高，固有频率越低，反之。将零反作用轨迹跟踪法成功应用于真实结构的柔性基座机械臂的运动控制中，使得微机械臂在不引起基座扰动的前提下完成轨迹跟踪任务，为我国空间宏微机械臂在轨级联操作提供了借鉴意义。本文中的仿真是以大臂位于奇异构型为例进行的零反作用控制，因为奇异构型下的大臂柔性自由度减少，柔性基座机械臂的反作用零空间维度相应增大，因而小臂在完全不引起基座扰动的前提下能完成更高维度的轨迹跟踪任务。对于大臂其它非奇异的构型，可采用模态截断技术略去柔性基座的高频响应，利用文中方法可完全消除小臂在运动过程中激起的低频振动，从而实现基座的抑振控制，提高组合臂末第期尹旺 等：空间站宏微机械臂动力学建模与零反作用控制端操作稳定性。参考文献（），（）：，：，：，（）：尹旺，王翔空间宏微机械臂振动抑制最优轨迹规划航天器工程，（）：，（）：，：，：，：，（）：吴立成，陆震，于守谦，等一种柔性冗余度机器人振动抑制的复 模 态 法 中 国 机 械 工 程，（）：，（）：（），（）：，：，：，：，：陈启军，王月娟，陈辉堂宏微机器人末端惯量特性的数学分析同济大学学报，（）：，（）：（）赵庆刚面向空间站小臂地面试验的柔性基座分析及实验研究哈尔滨：哈尔滨工业大学，：，（）（编辑：张小琳）航天器工程 卷