《工业机器人运动学3逆运动学课件》由会员分享,可在线阅读,更多相关《工业机器人运动学3逆运动学课件(27页珍藏版)》请在金锄头文库上搜索。
1、 三章 工业机器人的运动学- 三、逆运动学方程 Inyverse Kinematic Equations ) 珊国|即基ER让于3 斯坦福机械手的道运动学解se关交纸汪:本站部下ER/话洒;人二 语册肥刻EU于汪下和二到这全3.1 引言 (mntroduction) 局 证区大罗入隐忆区 贱必本二全加 二六【也国信2天花eltOBGOHE和 让k乞下由一相邻两连杆的距离; 局本局汪过本证忆三本二让2) 根据任务确定机械手的位姿Te2多 芝久二症E :|外后本人天7的甘生sn才网二全:证太c和2所插0 有 Oo。 anehutewlcom让(届放 册(3) 由Ti和ACT 2,.,6) 和式 4
2、.1) 求出相应的关节变量6人3.2 逆运动学方程的解 (Solving inverse kinematic equations) Te=AlAAsAiAsA6三1,2,5) 的逆左乘式 (3.1) 有ArIT5=1T5 人ArLATIT6=2T6 全) (3.3)AFLA放T5=开 人 届 G.4)ITAL ASIADLATLT5=5T5 人 (5市交汪惠光大2太太求出关节变量,或 d。玉生着耻有大友 医芭2(JInverse solution of Stanford manipulator )太太 攻区下公营式 (3.2) 一 3.6) 进行求解: 三全权到克有 EX站ME /人cs 0
3、of oo pp 十广3 22)有touTCRTLCORETJi2(2) Jiz(o) Ji2(a) Jiz(P)JisCD) Jas(o) Jis(a) Jis(D) 0 1Ci人这里 人 L)万=一 (3.1D)站 (3.12)全汪二是到于二疝风生生证下刘本罗加和co CiGuce- .89) 这wwSwwSS 由 WE0 1比较式3.9)和式3. 13 和拢阵中的第三行第四列元素相等得到Ji (P) =由-Sip十ClPy=风所忆=7s11由 TU六 生多下是)人0 (KK 中一9元)0 大局这里土号表示机械手是右肩结构十还是左肩结构一) 。L鸡)改天遇)L尖)(3.17)二)L光人【瑟0二7由式 (3.21) 、 (3.22) 和 3.18) 可得到第一个关节变量9;的值二| 4是 昌| 的有司 和 加 国辐 要玖 人及 贡 六 沁和7下用达各关节变量如下:Cips+SiP,忆轩半十光三全性 加二 全于 汪屋况司芝及茹况全区|人全国定允屋六汪汪月本允汪区光| 六商人生网区史居|本人天束7有区可本7 申=tan3 7【Le 27b) |和