资源描述：
《基于动力学约束的机械臂最优关节轨迹规划_王兴贵 1993.pdf》由会员上传分享，免费在线阅读，更多相关内容在应用文档-天天文库。
1、o.,.ROBOTVl15No5捻霜擎糟机器人SePt.,1993t基于动力学约束的机械臂最优关节轨迹规划王兴贵尹朝万’马兴瑞邹振祝邵成勋.(哈尔滨工业大学航夭工程与力学系15。。。6)(中国科学院沈阳自动化研究所110015)(中国,沈11。。1科学院机器人学开放研究实验室阳5)摘要本文提出了基于机械臂关节驱动力矩约束方程规划其关节最优运动轨迹的一种有效方法.该方法运用矩阵范数理论简化机械臂的动力学约束方程;在机械臂的关节空间内采用归一化的无因次量运用非线性规划法.,优化其运动轨迹将所规划的无因次量轨迹方程作为机械臂产生实际运动轨迹的发生器通过给定机械臂各运动段的起始和终,,止关节坐
2、标由系统的动力学约束方程计算出整个运动段所允许的最短运行时间即生成所期望的运动..,,文中通过算例证实了该方法的实用性轨迹本文的轨迹规划方法计算效率高可用于在线轨迹规划:关键词轨迹规划机械胃动力学非线性规划1前言要使机械臂具有高的工作效率,必须对其工作轨迹进行最优规划,实现工作时间最短.对,.于:工业机器人工作轨迹规划的方法研究人们已经作了许多探索约束条件大体可分为两类.’〕I主要是基于机械臂关节的最大速度和加速度是定常的约束[1.由于关节的最大速度和加速、,因此,度是与机械臂的运动位置负载等有直接关系这些约束均在极端情况导出的所以它不.,且不能保证对所有的工况都能实现能保证所规划的轨
3、迹为最优另外对于极端情况的约束·条件确定也常常是困难和繁琐的,因为对于一个确定的机械臂通常要通过实验才能获得.1,主要是将关节驱动力矩作为约束条件在轨迹规划过程中将机械臂的动力学方程考虑进.,,‘〕去[a,此类方法从理论上易实现也具有一定的科学性但由于机械臂动力学方程是时变的强,,非线性方程计算量非常大在目前的机器人或机械臂处理系统还无法将其作为约束方程进行实时在线轨迹规划的运算.因此如何提高其计算效率就成为研究的关键.本文针对上述第五类的约束问题提出一种有效的最优轨迹规划方法.该方法旨在提高系.,统的轨迹规划效率便于实现机械臂实时在线轨迹规划首先运用范数理论对机械臂的动力学;约束方程
4、进行简化处理其次在机械臂的关节空间内采用归一化的无因次量运用非线性规划.;法优化其运动轨迹再将所规划的无因次轨迹方程作为机械臂产生实际运动轨迹的发生器然,,后利用所规划的无因次轨迹方程的特性仅通过运动段的四个特殊点的轨迹函数值即可由系统的动力学约束方程计算出整个运动所允许的最短运行时间.最后通过输入各关节的初始和.终止坐标便可得机械臂的期望运动轨迹,该轨迹规划方法具有一定的通用性和可移植性计算量小、规划效率高,便于实现在线轨迹规划.文中通过示例验证了所提出方法的可行性与有效性.2机械臂动力学约束方程的简化处理,Lagran:设机械臂具有几个关节由ge方法推得其动力学方程具有如下形式卞国
5、家自然科学基金资助.收稿时间:1992一12一20:15卷5期王兴贵等基于动力学约束的机械臂最优关节轨迹规划。。。u,一,。、,,*,,,,,n习D()奋+艺艺ci&(。)奋奋+G(、)(j一z2)(1)吞二11=!,;。、。;u,;*式中q任尸机械臂广义关节坐标奋奋关节k的速度和加速度关节j的驱动力矩几(妇k;。,关节j和的藕合惯性项系数q(砂由于关节k和l的速度产生的哥氏力作用项系数(l二泛。,k);G,(妇关节j的重力作用项时是关节的速度产生的离心力作用项系数.,处理相当繁琐,,目前的机器人或机由于式(l)是时变强藕合的非线性方程计算量非常大械臂处理系统还无法将其作为约束方程直接
6、联机进行实时在线轨迹规划的运算。为解决这一,,对式·:难题我们运用矩阵范数理论对式(1)进行简化处理(1)两边取范数}}}{o得u,j;·a*x*,lI成(!刀(、)!)m不}奋{+m,(}Cj(。)1)习叉·,·ax,(,,(,,,(ml奋l)习I奋I)+IG。)l(j二l2⋯)(2)、;‘,q,q式(2)中的系数Di,(q)几(q)和G(妇是关节坐标的时变函数且都是的正弦(或余.,··二:弦)函数再进一步简化对它们均取函数的范数{}}!或}}I即相应运动段的最大值或.,:算术平均使其变成常系数最后动力学约束方程进一步简化成如下形式,*)·*。·luI镇(习及m鲜}奋.+m鲜(习乙)
7、·,,,,n(max}峥*})(}奋l)+己(j一12)(3)兄一式中“~”表示对该元素取函数的范数】},】!.,。、‘,,由于机械臂在工作过程中其起始和终止关节坐标qq是已知的因此若系统的运动路,u,只是关节运动速度奋和加速度奋的函数,。径也已知则约束方程(3)中的关节驱动力矩即.~f(奋,)奋3机械臂关节轨迹的无因次归一化,由于机器人多数是采用关节伺服控制在笛卡尔空间所规划的轨迹难保证各关节的平稳,,,运动在关节空间内规划轨迹可以获得良好的
