外文翻译--通过优化柔性椭球体对欠驱动冗余度机械臂的自重构中文版-精品

外文翻译--通过优化柔性椭球体对欠驱动冗余度机械臂的自重构中文版-精品 外文翻译--通过优化柔性椭球体对欠驱动冗余度机械臂的自 重构中文版-精品 通过优化柔性椭球体对欠驱动冗余度机械臂的自重构 摘要:根据优化技术，欠驱动冗余度机械臂的多模型特征、柔性操作的测量、自重构的控制已被调查研究。了空间关节的结构变形和欠驱动冗余度机械臂柔性操作之间的关系，处于锁定模式下欠驱动冗余度机械臂的一种新型柔性椭球体操作的测量被提出，能应用于获得自重构控制的最理想结构。因此，基于简谐振动随时间变化非线性控制方法认为能完成其自重构。被动关节三连杆欠驱动机械臂等仿真例子在一些调查方面起重要作用。 关键词: 0 前言 欠驱动机械臂 自重构 优化 非线性控制 欠驱动装置和机械臂能应用于许多领域，例如太空技术、合作机械人、变形装置。在太空领域里，由于没有失去有用功能或了解系统的自重构。当驱动构件出现一些问题时，基于欠驱动技术的误差出现是不可避免的。欠驱动机械臂也能被设计为合作机器人，也就是说COBOT。COBOT 的驱动不是作驱动装置而是提供动力学非函数约束。COBOT 需要操作人员提供外力才能完成准确的应用，例如在生物学上外科手术和半导体制造等等。在机械领域机械变形有多种模态，并能从一种模态向另一种模态转变。引用不同模态之间的改变可能导致连杆数目的变化或机械变形的约束限 制。很显然，欠驱动控制、冗余度驱动和柔性装置是不可避免的。因此，欠驱动系统逐渐的成为研究领域一个具有吸引力的话题。 从力学角度看，研究欠驱动机械臂系统是不可能控制的。被动关节的运动是必须靠与动力装置连接。Jain等明动力装置是欠驱动机械臂的非完整性约束是二阶的。在机械实际上，与非完整性约束广泛被研究比较也有100多年历史，然而，关于这种系统的运动规划和控制技术的研究只是近10的事情，研究多针对轮式移动机器人、跳跃机器人、航空航天机器人等一阶非完整性约束系统。关于欠驱动机械臂的研究观点，Anthoney等研究运动的稳定性，Arai 等提出随时间变化方法完成系统的位置控制。Lee 等为欠驱动机器人提供了多种非线性控制方法。欠驱动研究的这些方法已从本质上揭示了它是非线性的，并且是随时间变化的、抽象的。事实上，Brockett 已证实这并没有消除阻碍和稳定给定结构系统的静电状况反馈。很显然，非线性系统的特征在组合空间多自由度是可以控制的。所以，非线性系统的控制研究受到更多的关注。 欠驱动机构和机械臂是对传统机械设计基本原理相违背的，传动机械设计基本原理认为，原动件的数目要与自由度的数目相等时，机构才具有确定的运动。欠驱动机械臂首先被提出并不是由于它的价值优点，但一些研究表明，欠驱动机构的故意设 1 计也是很有价值的。例如，Rivhter 等获得由柔性欠驱动机械臂多维受力的测量。Nakamura 等设计出了轮式滚动接触的非完整机器人和平面四连杆二驱动机械臂的控制。He 等针对欠驱动冗余度机械臂提出一种自由碰撞运动规划演算法。从以上讨论的结果来看，我们可推断出在研究欠驱 动时，可能遇到一些未被发现的新问题，如所提到的技术和理论的形成。因此，我们改善这装置具有很大的潜能性。 这篇中，我们对欠驱动机械臂的静态特征和自重构控制方法进行探索与研究。 1 柔性椭球体模型 机械硬度是机械臂的一个重要要素，它是用来抵抗受力和阻碍力的能力。对于开式链接机械臂而言，链接部分是非常重要的部分。所以末端位姿的变形将会对连杆带来不良影响。转矩可以近似满足如下方程: Mi?Ki??i i=1，2，…，n (1) 式中 Mi——关节 i 的转矩 ??i——关节 i 的变形量 ki——关节 i 的硬度系数 如果忽略关节 i 的重力和摩擦力不计，假设机械臂末端位姿力矢F?Rm，则转矩方程又可以写成: M?JTF (2) 式中 M?Rn——关节的转矩 J?Rm?n——雅可比矩阵 众所周知，关节有会有变形，机械臂末端位姿有如下关系式: ?x?J?? (3) 式中 ?x——机械臂末端位姿矢量 ??——关节的位姿矢量 将(1)式写成矩阵的形式，结合(2)、(3)式，经简单的计算，?X和F之间的关系如下: ?X?(Jk?1JT)F (4) 式中 如果定义 C?Jk?1JT (6) (6)式是末端位姿的柔性矩阵。然而，在太空工作c?1强度矩阵一致。柔性矩 2 阵C可以用来测量机械臂的静态特征。矩阵C也有雅可比函数功能。因此，它在组合和构造要素较大范围内是可改变的，在稳定条件下机械臂的可变特征能用于完成一些应该的复杂的操作。如装配、抛光、维修等等。由(5)、(6)式可知矩阵C是对称性矩阵。 如果定义 ??det(CCT) (7) 对矩阵C进行微分，方程式(7)我们又可以得到 ????i (8) m 式中?i，i=1,2,3,???，m应用了矩阵C的单一性。因此，CCT是其对称矩阵，有如下关系: i?1 xT(CCT)x?1 (9) 式(9)被描述为椭球体曲线方程，当椭球体的主要曲线与矩阵C的单一值相等时，这椭球体也被认为是一般柔性椭球体GFE。由于直观原因，图一中平面2连杆机械臂的的连杆长Li?1.0m,i?1,2，GFE如图(2)和(3) 所示。 图一 平面2R杆机械臂 图2 平面2R杆全驱动机械臂的GFE模型 3 图3 平面2R杆全驱动机械臂的GFE模型 这些图示表明测量是需要依赖组合和机构要素。然而全驱动机械臂并不能改变其机构要素。因此，由于不同的构件(图2)，而不是结构要素(从图2改变到图3)，GFE模型是可以改变的。当被动关节被引进作为全驱动机械臂时，为了方便使用，假设这些被动关节具有制动装置和位置控制，以便被动关节能在自由模式和锁定模式下进行制动。然而在运动学上，欠驱动机械臂揭示了一些冗余度连杆问题，并没有表明在输入方式下的自运动不如工作状态下的自运动。另一方面，被动关节的制动模式能使欠驱动机械臂具有重构能力,系统具有敏捷性而使其能适合不同的工作。 2. 柔性矩阵 假设在欠驱动冗余度机械臂中s连杆为被动关节 ，被动关节装有制动装置，当被动关节处于自由状态时，其速度运动方程可以写成为: ?x?Ja??a?Jp??p (10) 式中 ?X?Rm——机械臂末端位姿矢量 J??Rm?n——驱动机械臂的雅可比矩阵 ???Rn,??p?R3——分别为驱动和被动机械臂的广义坐标矢量 当机械臂中被动关节处于锁定状态时，系统运动方程可变为 ?x?Ji?q (11) 式中 ?X?Rm——机械臂末端位姿矢量 Ji?Rm?n——锁定状态下被动关节机械臂的雅可比矩阵 ?q?Rn——驱动关节的机械臂广义坐标 很显然，方程(11)和(3)是同一形式，方程(10)和(11)表明欠驱动机械臂在运动学上具有不同的模式。换句话说，在运动学上系统具有多中模式特征。图(4) 4 平面3R连杆机械臂就是很好的例子。机械臂的第二关节是被动关节，其他的都是驱动关节。当被动关节处于自由状态时，??R3被选做为广义坐标变量。如果被动关节处于自锁状态，机械臂的维数将变为2维，这广义坐标变量为q?R2，显然由于q?0，但雅可比矩阵有如下关系: 图4 平面3R杆机械臂 由于欠驱动机械臂存在不同的运动模式，一种可以用来优化和机械臂的机构组合及自重构以使用不同的工作。预测如何完成基于欠驱动下的全驱动机械臂操作是不可避免的问题。不象全驱动冗余度机械臂那样，欠驱动冗余度机械臂并不能改善其操作工作，执行机械臂任务类似于输入空间的体积比工作空间少的缘故。有一条可行的途径就是在不同的时间分解机构的工作。例如，当机械臂工作处于驱动模式下，机构组合能进行机构自重构。然而当机械臂工作在全驱动模式下，其功能之一就是能控制机构的运动。事实上，处于欠驱动工作模式下的机械臂能辩别机构的运动，如位置控制或间断点对应点运动。但是这并不是此论文所讨论的重点。我们应关注的是欠驱动冗余度机械臂的静态特征和机构自重构控制方法。 欠驱动机械臂两中模式的运动方程可以被多种方法描述。但是在复杂的机械装置中多连杆机械臂的机构要素定义还存在一定的困难。为了解决这些问题，我们将进行分析欠驱动冗余度机械臂的两种模式间的关系。 假定一种特殊的机械臂组合机构，假设有n?m，处于装置的两种模式下的末端位姿表达式是一致的，可以表示为 Ji?q?Ja??a?Jp??p (12) (13) (13)式表示微运动发生在关节部分而不是发生在末端位姿处，根据(13)式， 5 假设 Ja??a?Ja??a?0 方程式又可以写成 ??p??J? pJa??a (14) 把(14)代入(12)式中，我们可以得到 Ji?q?(I?JpJ? p)Ja??a (15) (15)式描述欠驱动机械臂两种模式下的不同一机构。因此，两种广义坐标也是相等的。设?q????，又可以得到 Ji?(I?JpJ? p)Ja (16) (16)式表示两种模式下的雅可比矩阵间的关系。此式能预测出全驱动模式的运动。把(16)式代入方程式(5)，可以得到全驱动模式下的欠驱动矩阵方程 ???? C?Jik?1JT i (17) 根据方程(7)，GFE欠驱动机械臂也能定义，方程(17)表示在机械装置改装后的系统静态特征。其一，我们以通过3R杆机械臂模拟(图4)。作为非冗余度机械臂而言，如果我们假定处于工作状态下的一点，它不仅与柔性椭球体模型有关。相反有许多与处于冗余度机械臂工作状态下的这一点相关。假设3R杆平面机械臂三杆长分别为L1?L2?0.5mm和L3?1.0mm，机构的起始角度为?1?60?,?2??60?,?3??30?，GFE其他末端位姿起始位置如图5所示。 显然，根据处于工作状态下的这种状况，可知存在许多这样的关节组合。这些机构都是与GFE相关的。但是一欠驱动冗余度机械臂存在机构自重构的能力。一般而言，我们期望的GFE在不同的基本组合中有类似的运动。换句话说，椭球体模型类似于一个球。如图5所示，在3杆中第一杆运动状态表现最佳。 3 非线性控制 6 我们通过分析系统的动态特性，为了寻求一种能有效地控制欠驱动机械臂运动。欠驱动机械臂动态方程可以写成 Iaa?a?Iap?p?ca?M (18) I?a?Ipp?p?cp?0 (19) 式中为质量惯性矩，为中心吸引力和摩擦转矩矢量。M是驱动关节转矩矢量。Jain??是驱动关节广义坐标矢量。?p是被动关节广义坐标矢量。等证实方程(19)是 二阶非线性约束方程。通过自重构，在工作状态下给定位置，欠驱动机械臂具有改善装置运动的能力。由于系统输入空间维数少于空间关节的维数，被动关节的位置控制只能通过动态藕合来实现。基于Brockett理论，给定机构的系统并不是光滑的，稳定性完全符合静平衡反馈定律。因此，非线性控制的结果表明系统是非线性的、随时间变化的、离散的。非线性控制方法还有一种就是在Ref(17)中所提到的全驱动关节的简谐振动。这种方法的本质就是当驱动关节运动到一个周期时被动关节将偏离平衡位置(图6)。 驱动关节的简谐振动方程有 ?a?Acos?t (20) ?t (21) ???A?sin ?a??A?2cos?t (22) ???????Tap???? 式中 A—简谐振动的振幅 W—简谐振动的角频率 7 如果我们将式中(22)变换一下，代入(19)式得到 ?1T?p??Ippcp?AIap?2 (23) 2? 通常，角频率?是一个较大的数，因此，简谐振动周期T=是一个非常小??1T的数。IPP(23)式有可以写成 ,CP,I?P被作为一个周期的约束， 1?1T?p?Ippcp?AIap?2T2 (24) 2(24)式表示一个周期后有一点发生偏离。显然，构成整体的价值在于简谐振动?????? 的振幅和角频率，者就是简谐振动中的驱动关节能控制被动关节的原 因之一。 4 自重构控制律 自重构需要稳定的控制技术。间谐振动非线性控制方法在第3部分已经简单地介绍了。下面我们将设计一个新的控制方法来执行机构的自重构运动。这种方法将用于优化在工作状态下给定位置时的广义柔性椭球体模型。 假设?d引用于一个期望的组合，此组合源于一些优化方法，?是驱动机械臂的驱动位置角。 设 8 e??d?? (25) 式中 e——关节位置矢量误差 对方程(24)进行微分有: ?ea???da??a??e???? (26) ????p??p??da取滑动模态为 Sa?ea?k1ea (27) ?集中律为 Sa??k2sgnSa()?k3Sa (28) 式中 K1?0,K2?0,K3?0，且sgn()作为符号函数，有如下式子: 如果矢量S?有S??[S?1???S?n]T，可以得到下面式子: (27)式表示驱动关节的运动满足莱布罗定律。假设驱动关节输入与(20)、(21) 2有关，当Kd?0,Kd?4Kp?0时，又可以得到如下关系式 将(26)式中2杆的2倍偏离量代入(30)式，可以得到 设驱动关节输入为 将(32)和(31)式代入(19)式，有如下关系 振动振幅为 虽被动关节并没有达到期望的位置，驱动关节输入控制可用(32)式来描述，另一方面，被动关节处于期望的位置，输入控制方式有以下方程。从(27)式中可知偏离时间为 结合(28)和(35)式，控制律为 显然，这种控制方法是非线性的、随时间变化的、且遵循Brockett理论。有以上关系重新整理振幅，控制律为 当ep=0时满足 9 当ep?0时满足 5 仿真研究 在这部分中，选平面3R杆机械臂作为仿真模型，如图4所示。设第二杆为机械臂的被动关节，其他两杆为驱动关节。如果初始位置为?1?60?,?2??60?,?3??30?，为了改善执行广义的柔性椭球体模型，更好的位置为?1?24.85?,?2??17.89?,?3??81.15?，这在第三部分已给出。我们认为后面一种情况是我们期望的结果。根据第四部分所提供的控制方法，模拟仿真结果如图7所示。 10 图7 3R杆欠驱动机械臂的自重构运动 1.连杆1 2.连杆2 3.连杆3 图7(a)表示随时间变化的关节位置误差;图7(b)表示与时间有 关的关节运动轨道轨迹;图7(c)表示在自重构控制中机械臂机构位置的 改变;图7(d)表示关节速度与位置间关系图。显然，机械臂已满足期望 的机构完成自重构控制。 6 结束语 欠驱动技术是一个非常关键性的问题，它不仅能够产生空间机器人系 统的线性误差，而且能操控合作机器人和机器装置。欠驱动机械臂有实现 机械自重构的能力。新的关仪广义柔性椭球体欠驱动冗余度制动式机械臂 的测量被提出。这测量由于优化系统的稳定性。简谐振动的非线性控制方 法能执行自重构运动。有3连杆欠驱动机械臂的仿真结果证明测量和振幅 的控制是有效的。 References 1 Nakamura Y, Mukerherjee R(Nonholinomic path planning of space robotics via a bi-directional approach(IEEE(Transactions on Robotics and Automation， 11 1991，7(4):500,514 2 Moore C A，Peshkin M A，Colate J E(Design of 3R cobot using continuous variable transmissions(IEEE(1nternationa1 Conference on Robotics and Automation。1999:3249,3254 3 Dai J S(Zhang Q x(Metamorphic mechanisms and their configuration models(Chinese J(of Meehanica1 Engineering，2000，13(3):212,218 4 Arai H(Yanie K(Thchi S(Dynamic contro1 of a manipulator with passive joints in operational space(IEEE(Transactions on Robotics and Automation， 1993， 9(1):85,93 5 Arai H(Tachi S(Position contro1 of a manipulator with passive joints using dynamic coupling(IEEE(Transactions on Robotics and Automation， 1991(7(4):528,534 6 Jain A(Rodriguez G(An analysis of the kinematics and dynamics of under actuated manipulators(IEEE(Transactions on Robotics and Automation， 1993，9(4):411,422 7 Colbaugh R，Barany E(Glass K(Adaptive stabilization of uncertain nonholonomic mechanica1 systems(Robotica，l998，16(2):181,192 8 Robert T M(Joe1 W B(Periodic motions of a hopping robot with vertical and forward motion(1nternationa1 Journa1 of Robotics Research(1993(12(3): 197,218 9 Papadopoulos E(Dubowsky S(On the nature of contro1 of algorithms for free-floating space manipulators(IEEE(Transactions on Robotics and Automation，1991，7(6):75O,758 10 Bloch A M(Wilson C H(Contro1 and stabilization of nonholonomic dynamic systems(IEEE(Transactions on Automatic Control，1992，37(11): 1 746,l757 ll Arai H(Senvi1 L(Time(scaling contro1 of an underactuated manipulaton J( of Robotic Systems，1998，15(9):525,536 12 Lee K(Victoria C C(Contro1 algorithms for stabilizing underactuated robots(J(of Robotic System，1998，15(12):681,697 13 Brocker R W. Asymptotic stability and feedback stabilization(in Deferential Geometric Control Theory(In:Brocker R W Millman R S(Sussman H J(eds(In:Birkgauser,1983:181,208 12 14 Rivhter K Pfeiffer F(A flexible 1ink manipulator as a force measuring and controlling unit(In:Proceedings of the 1991 IEEE International Confer(ence on Robotics and Automation, Sacramento(CaHfomia,1999: 1214,1219 l5 Nakamura Y Chuan W Sordalen O J(Design an d contro1 of the nonholonomic manipulator(IEEE(Transactions on Robotics and Automation，2001(17(1):48,59 16 He G P, Lu Z(Wang F X(Optimal approximation contro1 of underactuated redundant manipulators(In:Proceedings of the 11th World Congress in Mechanism and Machine Science(Apri1 1,4，2004，Tianjin， China 17 He G P, Lu Z, Wang F X(Harmonic function contro1 of planar 3-DOF underactuated manipulators(Chinese Jouma1 of Aeronautics，2004，25(5): 52O,524(In Chinese) 13