



版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
1、.基于笛卡尔空间变量反馈的关节轨迹规划和仿真徐建明,陆群(浙江工业大学信息工程学院 ,浙江杭州 )摘要:对于冗余操作臂逆运动学问题,建立欧拉迭代公式,将关节空间轨迹规划问题,化为求解关节角速度和关节角加速度的问题。对于奇异位形问题和避障问题,沿用过去经典的方法,并对这些方法加以论证。 最终给出了基于笛卡尔空间变量反馈的关节轨迹规划流程图,并对平面 4R 操作臂进行了MATLAB 仿真。关键词 :冗余操作臂 ;奇异位形和碰撞;仿真中图分类号 :Joint Trajectory Planning and SimulationBased on the Feedback of Cartesian Sp
2、aceVariableXu Jian-ming,Lu Qun(College of Information Engineering,Zhejiang University of Technology .Hangzhou Zhejiang )Abstract:For the problem of redundant manipulator inverse kinematic, we convert the joint space programming proplem into solving the problem of joint velocity and joint acceleratio
3、n using Euler Iterative Method. For the problem of singularity gesture and collision avoidance, we follow the classical methods, and acquire the demonstration of these methods. Finally we proposed the joint trajectoryplanning flow diagram based on the feedback of Cartesian space variable. As an illu
4、stration, we simulate the plane 4R manipulator using MATLAB and get desired result.Key words:redundant manipulators;singularity and collision;simulation0 引言从 1959 年第一代工业机器人在美国诞生起,机器人行业发展迅速 。 机器人的研究对象.下载可编辑 .也先后经历了具有确定性的机器人到具有不确定性的机器人、单个机器人到多个机器人、非冗余机器人到冗余机器人的发展阶段。添加冗余自由度的机械臂能够在有障碍物的机动工作空间中具有更好的灵活性,同
5、时可以方便、有效地避开其奇异位形。考虑到冗余机器人具有灵活性好和多任务等特点,自 20 世纪 80 年代以后 ,研究冗余机器人的人数不断增加,研究不仅限于传统运动学层次,而且也包括传感器和信息处理,从而实现智能机器人的分级控制系统8 。逆运动学求解问题是机器人学中重要的环节,由于其解情况的复杂性,逆运动学问题相对于正运动学要复杂得多。 Whitney(1969,1972)13,14 和 Albala(1979) 等分别提出了解决逆运动学问题的两种方法: ResolvedMotionMethod和 InverseKinematicMethod,Resolved Motion Method可以看成
6、是Inverse Kinematic Method没有内建收敛标准的一次迭代的形式。 PyungH.Chang ( 1987 )在他的博士论文8 中对这两种方法在冗余机器人和非冗余机器人中的应用进行了比较。鉴于冗余机器人的雅可比矩阵为非方阵,Whitney(1972) 通过提出了雅可比矩阵的Moore-Penrose 伪逆矩阵 , J.Baillieul(1985)1 则给出了逆运动学解的一般形,但其中的一些参数的求解方法并未给出。 Hanafusa(1981) 等提出了基于优先级分解总任务为子任务的概念, Tsuneo Yoshikawa(1984,1987) 4 等将奇异位形或障碍物避开等
7、任务归为低优先级的子任务,引出了低优先级子任务的性能指标,从而给出了逆运动学解的具体形式。 Joel W.Burdick ( 1989 ) 11 以2R 和 3R 操作臂为例,分析了它们的自运动流形( Self-MotionManifolds), 给出了冗余操作臂的零空间的几何解释。 D.K.Chol 等 12 ( 1992 )结合自运动流形的定义,提出了给定任务最优解的充分条件,并给出了SFS( Singularity-FreeSpace )的概念和定义。 Jin-LiangChen ( 2002 ) 10 等结合了梯度投影方法,给出了一种新的目标方程来避免障碍物和关节角的限制。 Guoxi
8、angPing ( 2009 ) 9 基于人工安全区域,给出了操作臂与安全区的距离的度量,从而达到实时.下载可编辑 .避障 。论文首先对操作臂逆运动学问题加以描述,然后针对欧拉迭代的方法,将冗余操作臂的奇异位形和避障问题都归结于求解关节速度和关节角速度的问题。对于经典的避免奇异位形和避障的方法加以阐述和证明。最后,根据笛卡尔空间变量反馈,给出了关节轨迹规划的流程图 ,并对 4R 操作臂进行了MATLAB 仿真 。1 逆运动学问题考虑一个 n 自由度的操作臂 ,定义各关节变量定义为t in 。操作臂ii ( ),1,2,3,.,任务空间笛卡尔变量: x jx j (t ),1,2,3,., m
9、。 根据运动学方程可建立两者的关系,x(t ) f ( ) 。驱动器函数是要最终给出的,它不易用笛卡尔变量表示,而关节变量能起到桥梁的作用 。 通常运动学方程是非线性的,无法求出的解析解 。 根据 ResolvedMotion Method,可构造雅可比矩阵 :J() J(t )f ( (t)Rm n ,且 x x(t)dx(t) ,(t)d (t) ,则有(t )dtdtx(t )J (t)(t)( 1 )据( 1)式,如果 mn ,则 J (t)不是方阵 ,对于特定的 x(t) ,与之对应的(t ) 有无穷多个 ,这一方面说明了该操作臂是冗余的,证实了冗余机器人能够避免奇异位形和障碍的可能
10、性 ,另一方面也提出了如何寻找最合适的关节轨迹的问题。解决轨迹规划的一种思路是采用欧拉迭代,即分步控制方法,即(2)式(tt )(t) (t) t1(t) t 2(2)2t 是个常量 ,则关键是对(t),(t ) 的求解 。2 关节角速率的求解2.1 关节角速率的求解可用 Moore-Penrose伪逆阵来解决雅可比矩阵为非方阵的问题, J () 的伪逆阵定.下载可编辑 .义为 J ( (t )J(t)T ( J ( (t ) J ( (t)T ) 1 , 可得(t )J( (t)x(t ) 。 为了避免机械臂的奇异位形和障碍物,J.Baillieul1 给出了 ( 1)解的一般形式 :(t)
11、J ( (t)x(t )(IJ ( (t) J ( (t ) k(t)(3 )其中 k(t ) 是先验的 ,是随时间变化的向量,且维数与(t ) 相同 。TsuneoYoshikawa ( 1975 )将避开操作臂奇异位形作为第二优先级的子任务,提出了标量性能指标 ,从而解决了 ( 3)中 k 。 定义性能指标函数为:pq( )( 4)并且 p 越大 ,表示性能越好 。记 1 , n T , lq ,(l 1,2, ,n) , 对 于( 4 ) 两 侧 对时 间 求导 得 ,lTp( 5 )pTT Jr( IJ J )kT JrT (IJ J )k( 6 )若令 kk1(其中 k1 为常数 )
12、, 则有J r (I J J ) k1( 7 )pT J rT (I J J ) k1( 8)为了便于讨论 k 的形式 ,可假设某时刻 r0 ,则( 7)、( 8)两式变为 ( 9)、( 10),1(IJ J ) k1( 9 )pT ( IJ J ) k1( 10 ).下载可编辑 .J JJ JJT(JJT) 1JJT(JJT) 1JT (JJT) 1J J(IJJ)(IJJ)I2JJJJJJIJJ( 11 )由( 11)易见 IJ J是幂等的。记 AT (IJ J),B (I J J)根据 IJJ 的幂等性 ,可得 ABT(I J J)据矩阵范数的相容性有:|AB| |A|B |(12 )而
13、|A|B | | ,| AB |pk1k1据( 12)有 k1 p | |2(13 )推得:|2k1 pmaxk12T ( IJJ) (14 )假设 | |k2 H , 其中H 为关节速率的阈值, k2 为一个常数 ( 0 k21 ),可推得 |k1 pmaxk1T (IJJ) 1/2k2H(15 )因此k1k2 H T (IJ J) 1/2(16 )对于 ( 4), Tsuneo Yoshikawa ( 1985 )2 引入了可操作性的概念,其表达式为 :wdet(JJ T )(17 ).下载可编辑 .对于 J进行SVD 分解,即 JUV ,其中 U ,V 为酉矩阵 , 为由奇异值构成的矩阵
14、,奇异值为i, i1,2, m。 可推得 :wdet(UVV TTUT)det(UTUT)det(U ) det(T ) det(U T )12m若 J 为方阵时 , w| det(J ) | ;若机械臂处于奇异位形时,至少有m 0 ,则 w0。 w越大 ,表明机械臂的位形越好。假设各连杆的长度和为一定值,则可以利用使得w 最大 ,而设计各连杆的长度大小。对于(5)中的,其推导过程如下 :记 GJJ T gij , i , j 1,2,.,m ,则 wdet(G) w( 1,2 ,.,n ) ,对 w 求导 ,lwdet(G)1det(G) /l ,l1,2,.,nll2det(G)(18 )
15、g11( 1 ,2 ,.,n )g1m (1 ,2 ,.,n )det(G )gm1( 1 ,2 ,.,n )gmm (1 ,2 ,.,n )(19 )det(G)mgi1gi 2gimmmgij(Gi 1Gi 2Gim )Gijli 1llli 1j 1l( 20 )其中 , Gij 为代数余子式 。Rn n 为可逆矩阵 ,则 A*A11An1若 AA 1,其中 A* 为伴随矩阵 , A*| A |A1nAnn则有 Gijdet(G)G 1 jidet(G) G 1 ji( 21 )且 gijJi J j T ,其中 Ji , J j 分别为 J 的第 i, j 行向量 。.下载可编辑 .g
16、ijJiTJ jTJ jJilll( 22 )将( 22)-(24)带入(21),1mmJiTJ jT1det(G)(Ji) G jil2J ji 1j 1ll( 23 )除此之外 ,还有其它不同的性能指标,它们与可操作性是等价的,如:条件数 ,运动学作用指标KCI,它们的定义分别为:( J )l, KCI1 ,其中 l , s , m 分别是最大奇异值 ,最小奇异值及最小条件数 。sm2.2 空间解释YoshihikoNakamura ( 1987 ) 4 等对 ( 3)作了空间解释,为了导出结论,先引出四个引理 :设 A , B 为 mn , mn 且 rank (A)rank ( B)m
17、A, B 的零空间分别记为: SRANull ( A) x : Ax0, xRn ;A 的值域分别记为: R( A) v : vAx, xR n , R(B)v : vBx, xR nA 的伪逆记为 : AAT (AAT ) 1引理1设AAT ( AAT ) 1,Rn 1,Rm 1 , 则构成的空间为A 零空间的补空间 ,即S( Null ( A)(SRA )。此引理只需对原式两侧同时乘以A 方可证明。引 理2设(IA A),Rn 1 ,Rm 1 , 则所 构 成 的 空 间 为null ( A)SRA 。同样的 ,对于原式两侧同时左乘A.下载可编辑 .AA(IA A)(AAA A)(AAAT
18、(AAT) 1A)(AA)0 , 易见结论。引理 3设C B(IA A),(I CC),则所构成的空间为 : SRSR。AB根据引理2,可得所构成的空间为 :Null (C )Null ( B( IA A):B(I A A)0:BAA 0SRASRB引理4设C,Rn 1,R m 1,则( Null ( A)Null ( B)SRASRB。由引理 1、 3 可得引理4。为了表述方便将( 1)、( 5)式记为 :r iJ i,i1,2( 24 )重复利用 ( 3)对(1)的求解方法 ,可得 :J1 r 1( IJ1 J1) kJ1 r 1(IJ1 J1 ) J 2 ( r 2J2 J1 r1 )(
19、 IJ1 J1)( IJ 2 J 2 )z( 25 )其中, J2(I J1 J1) J2。设 , r 1, r 2 分别为 Rn , Rm1 , Rm2 空 间, SR1 , SR2 分别是 J1 , J2 的零空间 , SM1 , SM 2 分别是 J1,J2在 下的值域 。如图 1 所示 ,根据引理1,式( 25)右侧的第一项将r 1 映射到子空间A 中 。 右侧第二项的 r 2 J2 J1r 1 ,它是不影响第一子空间变量的第二子空间变量,它最终映射到子空间B 中。据引理3,右侧的第三项将第三操作变量映射到剩余的子空间C 中 。 也就是在处理奇异位形时 ,不会影响笛卡尔空间的要求 。.
20、下载可编辑 .子空间 A : Rn子空间 B r1 : Rm1子空间CSR1SM1R( J1)SR2SM2R(J 2)r 2 : Rm 2图 1 空间解释示意图3 关节角加速度的求解3.1 避免障碍物Uicker ( 1965 )和 Kahn (1969 ) 5 提出了刚体机械系统基于Euler-Lagrange方程的方法,它们用这种方法来模拟多刚体系统的动力学特性。欧拉 - 拉格朗日方程为:dTTdt( 26 )其中 T 为标量函数 ,它表示系统的动能,为 n 维广义力矢量。其中可分为两部分,即:pn ;pV ,为 V 产生的系统的保守力;n 为非保守力 。若令LTV,则有dLLndt( 2
21、7 )Khatib 和 Le Maitre ( 1978 ) 4 根据欧拉 - 拉格朗日方程 ,提出了用Artificalpotential和耗散函数来确定关节广义力来避免障碍物的方法。关节广义力表达式为:T(dP / ddD / d)T( 28 ).下载可编辑 .n其 中 P 为 人 工 势 能 ( Artificalpotential ) , D 为 耗 散 函 数2D kDii 1(29 )所需的广义力 ,一部分用来避开障碍物,另一部分用来提供各关节转动的能量。Khatib 和 Le Maitre( 1978 ) 15定义了障碍物表面的逼近方程:平行六面体 : ( xx0 )8( yy0
22、 )8( zcz0 )81ab圆锥 : ( xx0 )2( yay0 )2( zz0 )81ac圆柱体 : ( xax0 )8( yy0 )8( zz0 )81bc其中 , x0 , y0 , z0 分别是各障碍物的几何中心。设 pi为操作臂中某些点的坐标设为( xi, yi , zi) ,且有 N 个点 。 以平行六面体为例,定义下列函数 :CO ( pi ) ( xix0 )8( yiy0 )8( ziz0 )8abc(30 )NPOkO1/ CO ( pi ) 1i1(31 )n22PJkJ1/(i maxi )i1(32 )nPVi 1Vi(33 )PO 限制了障碍物与操作臂的相对位置
23、, PJ 防止各关节超过最大关节角, PV 为势能项 。则PPOPJPV.下载可编辑 .( 34 ) 3.2 关节角加速度的求解机械臂的动力学方程为 :TM()V(,)G()( 35 )M ( ) 为操作臂的质量矩阵, V (,) 为离心力和哥氏力, G () 为重力矢量 。由( 28)和(35)可得M 1 ( )( dP / ddD / d)TV ( ,)G( )( 36 )4 反馈控制由于操作臂的建模误差及部分参数的不准确性的存在以及扰动输入与计算的精度的影响,操作臂实际输出的关节角与期望的关节角是存在偏差的,同样 ,操作臂末端执行器运动轨迹也存在轮廓误差。反馈控制可以较好的解决该问题,使
24、其精度提高 。 通常对于操作臂有两种反馈方式 :基于关节变量的反馈以及基于笛卡尔变量的反馈。对于前者反馈的方式所需的传感器比较简单,后者所需的传感器要求比较高,但控制精度会更高 ,应为其输出反馈的是最终要求的。对于前者的控制反馈示意图如图2所示:Xr ef , X r e f, X r e fr e f, r e f, r e fT, ,X, X,X功率逆运动学操作臂正运动学放大器图 2基于关节变量的反馈控制基于后者的反馈控制,可以采用Yoshihiko Nakamura4 ( 1987 )的形式 ,该方法与传统的反馈控制方法不同,是将反馈后形成的差量,作为的一个输入 ,具体过程为 :对( 1
25、)两侧同时对时间求导得,.下载可编辑 .rJ()J()( 37 )利用反馈 ,r orG1 (r or )G2 (ror )0( 38 )其中 , ro , r o , r o 为理想轨迹 ,速度及加速度 。综合 ( 37)、( 38 )可得:J ( )J ( )r oG1( r or 1 )G2 (ror1)h1 ( , , t )( 39 )记J2M 1 ( )( d P/ ddD / d )TV ( , ) h2 ( , , t ), J 2 I Rn n( 40 )仿照 ( 3)的形式 ,则由 ( 39)、( 40 )可得J h1 ( IJ J )h2(41 )据此 ,( 2 )的问题
26、得到了解决。 这里有一点 ,当初始关节角满足 w( )0 时,要给 添加一个增量,通常可取0.2, ,0.2T ,由于可操作性函数的作用,操作臂其它时刻点不会出现奇异位形 。 操作臂关节轨迹规划流程图 ,如图 3 所示:.下载可编辑 .M (i )Prir i(34)G ( i)JJ T(JJT) 1iJ( i )(1)w(18)iDh2 ( , ,t )T(17)(7)(29)(40)(41)(35)寄存器 1(2)初值为 0r i寄存器2V(, )寄存器3ro寄存器4r or o机械臂图 3 冗余操作臂轨迹规划流程图4 仿真实例假设一个平面4R机器人,它各连杆的长为L11.0m, L21.
27、0m, L3 0.2m, L40.2m ,其初始角度为:1,2, 3, 4T 30 ,70 ,30 ,40 T,规划该机器人的各关节轨迹,末端执行器的笛卡尔运动速度要求为:X x, y, zT 0.2, 0.2,0.2T (m / s, rad / s) 。4L3L432L2L11图 4 平面 4R机器人.下载可编辑 .由图 4 末端执行器坐标 ( x, y) 的表达式为 :x L1c 1L2 c( 12 ) L3 c( 123 ) L4c( 1234 )y L1s 1L2 s( 12 ) L3 s( 13 ) L4 s( 1(42)2234 )对于 ( 42)两侧同时求导,可得xL1 s1L
28、2s12L3 s123L4 s1234L2 s12L3s123L4 s1234L3 s123L4 s1234L4 s1234yL1c1L2 c12L3c123L4c1234L2 c12L3c123L4 c1234L3c123L4c1234L4 c1234z1111( 43)其中 , ssin, ccos,且 s1234sin( 1234 ) , c1234cos( 1234 ) ,z 表示末端执行器绕 z 轴旋转的角速度。末端执行器只用实现三个动作:两平移 、一旋转 ,而操作臂有四个关节,易判断该4R 操作臂是冗余的。由于本实例比较特殊,对于的求解 ,只需JX 即可 ,又由于不具有具体的操作臂
29、对象,无法建立动力学方程,这里只考虑到分步速度控制层面。表 1为该操作臂的DH 参数表 。 利用 MATLAB&RoboticsToolBox 进行仿真 ,其结果如图5 所示。1234表 1机械臂 DH 参数表ii 1ai 1dii1000120L10230L20340L304.下载可编辑 .5 结语针对操作臂奇异位形和任务空间避障问题,结合基于笛卡尔空间变量反馈的方法,将所求问题转化为求解关节速率及关节加速度的方法。该方法 ,流程清楚 ,具有确定性和可行性 。 且编程简单 ,无条件判断语句,执行速度快 。120120100100808060604040202000-20-20-40-40-6
30、0-60-80123-8012300图 5 操作臂关节及关节速率轨迹曲线参考文献1J.Baillieul,Kinematic programming alternatives for redundant manipulators,Proceedings.1985 IEEE Int.Conference on Robotics and Automation,March. 1985.pp.722-728.2T.Yoshikawa,Manipulability and redundancy control of robotic mechanisms,Proceedings.1985 IEEE Int
31、.Conf. On Robotics and Automation,March.1985.pp.1004-1009.3T.Yoshikawa,Analysis and control of robot manipulators with redundancy,Robotic Research:The FirstInt.Symposium ,Brady,M.and Paul,R.(eds).MITPress 1984.pp.735-747.4Nakamura,Y.,Hanafusa,H.andYoshikawa,.TTask prioritybasedredundancycontrolof ro
32、botmanipulators,International Journal of Robotics Research,1987.6(2).pp.3-15.5Jorge Angeles,Fundamentals of Robotic Mechanical Systems, Spriger-Verlag New Yourk,Inc.2003.6R.V.Mayorga-A.K.C.Wong,ASingularitiesavoidancemethodforthe trajectoryplanning ofredundant and nonredundant robot manipulators,Pro
33、ceedings.1987 IEEE International Conference onRobotics and Automation. Mar 1987.pp.1707-17127Tsuneo Yoshikawa,a steering law for three double-gimbal control moment gryo systems, NASASTI/Recon Technical Report N,.Aug.1975.8Pyung H.Chang,Analysis and Control of Robot Manipulators wit
34、h Kinematic Redundancy,TechanicalReport 1022,MIT 1987.9Guoxiang Ping,Bing Wei,Xianglong Li,Xiang Luo,Realtime obstacleavoidanceforredundantrobot,IEEE International Conference on Mechatronics and Automation,Aug.2009.pp.223-228.下载可编辑 .10Jinliang Chen,Jingsin Liu,Avoidance of obstacles and joint limit for end-effector trackin
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 广东科贸职业学院《学校课外音乐活动组织》2023-2024学年第一学期期末试卷
- 广东交通职业技术学院《建设项目环境影响评价》2023-2024学年第一学期期末试卷
- 广东技术师范大学《水文预报实验》2023-2024学年第一学期期末试卷
- 广东潮州卫生健康职业学院《界面设计导论》2023-2024学年第一学期期末试卷
- 女员工培训课件
- 广安职业技术学院《运筹学》2023-2024学年第一学期期末试卷
- 《岩石的破坏判据》课件
- 赣南师范大学《Moecuar》2023-2024学年第一学期期末试卷
- nfabe培训课件教学课件
- 甘孜职业学院《二外(法语-德语-俄语-阿拉伯语)》2023-2024学年第一学期期末试卷
- 投标人资格审查表(范本)
- eva乳液工艺流程
- 体育行业新媒体营销策划方案之在社交平台上推广体育赛事和运动品牌
- 建筑工程幕墙工程作业活动风险分级管控清单
- 期末复习计划:部编版六年级上册道德与法治教案
- 《大学生礼仪规范》课件
- 销售心态的转变与创新思路
- 教师个人三进两联一交友计划
- (完整版)四年级上册数学竖式计算题100题直接打印版
- 10kV线路施工安全及技术交底
- 北京的春节说课 公开课教学设计
评论
0/150
提交评论