机器人逆运动学实验(共8页).docx

《机器人逆运动学实验(共8页).docx》由会员分享，可在线阅读，更多相关《机器人逆运动学实验(共8页).docx（8页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、精选优质文档-倾情为你奉上实验（3）机器人逆运动学实验一、实验目的：1） 基于robotics机器人库构建机器人；2） 对构建的机器人进行逆运动学分析；3） 了解和熟悉机器人逆运动学的作用。二、机器人连杆关系图：图1 机器人连杆关系图连杆变换矩阵：参数含义：三、基本函数介绍（1）2连杆机器人实例图 2连杆机器人坐标系1）建立机器人DH参数表2）根据D-H参数创建机器人连杆对象3）根据连杆对象，建立机器人4） 观测建立机器人的情况正运动学函数：1）正运动学函数的使用T=two_link.fkine(pi/4 pi/4)T = 0.0000 -1.0000 0 0.7071 1.0000 0.00

2、00 0 1.7071 0 0 1.0000 0 0 0 0 1.00002）观测计算结果的情况，三维显示two_link.plot(pi/4 pi/4)3）逆运动学函数q=two_link.ikine(T,0 0,1 1 0 0 0 0)q = 0.7854 0.7854ikine函数的参数说明：Q = R.ikine(T, Q0, M, OPTIONS)Q0为求解的初始值；M为自由度数，也就是有运动关节，对应有关节的为1。（2）对于六自由度机器人求解的逆解，以puma560为例。1）函数ikine6s使用方法Q = R.ikine6s(T, CONFIG)其中T为机器人位姿矩阵。CONFI

3、G为臂型 l arm to the left (default) r arm to the right u elbow up (default) d elbow down n wrist not flipped (default) f wrist flipped (rotated by 180 deg)2）puma560实例 mdl_puma560 qnqn =0 0.7854 3.1416 0 0.7854 0 T = p560.fkine(qn)T =-0.0000 0.0000 1.0000 0.5963-0.0000 1.0000 -0.0000 -0.1501-1.0000 -0.0

4、000 -0.0000 -0.01440 0 0 1.0000 qi = p560.ikine6s(T)qi = 2.6486 -3.9270 0.0940 2.5326 0.9743 0.3734 qi = p560.ikine6s(T,ru)qi = -0.0000 0.7854 3.1416 0.0000 0.7854 -0.0000p560.plot(qi)六、实验内容（1）用机器人库建立下图的机器人，并且求解和显示下面几种情况讨论平面3自由度机器人的姿态逆运动学解。并用机器人库求解给定 的前提下，求解平面机器人的关节角度。1） 复习机器人逆解的代数求解方法，见P83-86页，尝试用m

5、atlab编写平面3R求解过程。2）当，条件下的3R机器人的关节角度。（2）根据机器人库提供过得puma5606自由度工业机器人模型，进行一下逆运动分析：Puma-560机器人1） T=p560.fkine(q),其中q=0 0.7854 3.1416 0 0.7854 0时，调用逆解函数，求出该情况下所有的解。并且用机器人plot函数画出计算前后的机器人图形，对比观测结果，分析情况。2） T=p560.fkine(q)，q = 0 pi/4 pi 0.1 0 0.2时，调用逆解函数，求出该情况下所有的解。并且用机器人plot函数画出计算前后的机器人图形，对比观测结果，分析情况。专心-专注-专业