机器人技术基础实验及上机.docx

1、机器人技术基础实验及上机机器人技术基础实验及上机指导书机械电子工程实验室2004年8月实验一 齐次变换与HNC-IR机器人运动学建模一、 实验目的1、 认识串并联机器人的典型结构，掌握串、并联机器人的自由度运算方法。2、 熟悉串、并联机器人结构示意图的画法。 3、 理解齐次变换的物理意义，掌握齐次变换矩阵表示刚体位姿的方法，能正确地进行齐次变换矩阵的运算。4、 熟悉D-H表示法，正确确定连杆参数和关节变量，进行运动学建模。二、 实验原理及方法齐次变换和运动学建模是机器人运动学的基础。刚体的位姿通过在刚体上建立坐标系来描述。齐次变换矩阵是一个四行四列的矩阵，它的前三列描述刚体的姿态（方向），第四

2、列描述刚体的位置。齐次变换矩阵的乘表示刚体或坐标系间的复合变换，齐次变换矩阵的逆表示反变换。即：如果坐标系相对的齐次变换矩阵是T，那么T1表示坐标系相对的描述。连杆的功能在于保持其两端的关节轴线具有固定的几何关系，连杆的特征也是由这两条轴线规定的。两轴线的公法线长度就是连杆的长度，两轴线的扭角就是连杆的扭角。两连杆之间的连接关系由两连杆的公法线之间的偏置和夹角描述。基于上述DH法的原理在机器人操作臂的每一连杆（构件）上建立坐标系，确定连杆参数和关节变量，进行运动学建模。三、 实验仪器及材料 HNC-1R教学机器人2并联机器人模型3RPS或6SPS一部四、 实验内容、步骤及数据整理1、 观察并联

3、机器人与HNC-IR机器人的结构，了解其动作原理，并绘制其结构简图。2、 计算自由度3、 对HNC-IR机器人建立连杆坐标系，确定连杆参数和关节变量。相应参数填入HNC-IR连杆参数表。 HNC-1R连杆参数表连杆序号i关节变量1234564、 建立连杆3的齐次变换矩阵23T，求32T，指出23T、32T的物理意义，（要求能正确进行矩阵运算，并能把矩阵运算模型存入软盘，以备后续实验用）。五、 思考题 齐次变换矩阵的物理意义是什么？ 怎样进行机器人操作臂的运动学建模？实验二 HNC-1R机器人运动学正反解一、 实验目的1、掌握机器人运动方程的建立方法2、掌握机器人运动正、反解方法 3、了解运动反

4、解中多解的处理方法4、熟悉D-H表示法，正确确定连杆参数和关节变量，进行运动学建模。二、 实验原理及方法在实验一的基础上，连杆坐标系相对可看作经过了以下四个子变换：绕轴的转动，沿轴的移动，绕轴的转动，沿轴的移动。利用矩阵乘的原理得到坐标系相对的齐次变换矩阵是（即教材上公式3.3），将各个连杆变换（i=1,2,n）相乘得。根据关节变量qi（i=1,2,n）求解的过程是运动学正解，反之已知求解关节变量qi（i=1,2,n）则为运动学反解。反解用反变换法通过分离变量得到只含单变量的方程，从而解出关节变量qi（i=1,2,n）。三、 实验仪器及材料 HNC-1R教学机器人2每组每生电脑一部并配置相应软

5、件四、 实验内容、步骤及数据整理1、结合实验一的内容，建立HNC-1R机器运动学方程2、实现HNC-1R机器人正解算法（借助Matlab，在已知qi（i=1,2,n）的前提下，求出，这里n5）3、实现HNC-1R机器人反解算法（把已求得的作为已知，求得关节变量qi（i=1,2,n），与正解结果互相验证）五、 思考题1运动学反解的多重解如何处理？怎样得出最优解？2运动学反解的数目与机器人的结构本身有无关系？实验三 HNC-1R机器人通信及轨迹规划一、实验目的1 熟悉与机器人通信的三种主要方法2 掌握机器人语言结构与编程特点3 掌握示教再现法4 了解轨迹规划的基本方法 二、实验原理及方法目前与机器

6、人通信的方法主要有三种，即：示教再现，机器人语言和离线编程。示教再现就是根据作业任务的需要，用手或示教盒把机器人的末端执行器移动到所需的位姿上，然后把每一位姿存储起来，编辑并再现示教过的动作，如果示教正确，则机器人可重复再现运行。机器人语言是人机通信问题的通用方式。它是一种专用语言，用符号描述机器人动作。本实验通过实际编程或示教再现，实现2个茶杯盖子的互换，掌握HNC-1R型教学机器人程序的基本结构，学习示教编程获取各点位置姿态的方法，熟悉机器人及其控制系统的基本操作和处理方法并通过机器人的运行体会轨迹规划的实现方法。 三、实验仪器设备HNC-1R型教学机器人一部 四、实验内容及步骤1 观察示

7、教再现过程，理解掌握与机器人通信的方法。2 通过演示程序的运行，掌握程序结构，了解程序编制方法和轨迹规划的实现。3 参考程序 % 01021 ;程序名 N1 speed 500 ；N1是语句标号，speed 是指令，表示速度，500是速度的具体值 N5 open ；手指开 N10 MOVE J19.122，20.470，-60.093，0.364，0.000；J是关节坐标 N20 move J20.358，17.783，-59.482，0.370，0.000 N30 delay 2 ；delay 2表示延时2秒 N40 CLOSE ；手闭合 N50 delay 2 N60 move P401.

8、263, 152.891，-73.804，0.370，20.858；P是直角坐标 N70 move P429.40l，1.461，-73.804，0.370，0.195 N80 move J0.195，0.463，-39.412，0.370，0.000 N90 delay 2 N100 Open N110 delay 1 N120 move P472.060，1.607，-142.620，0.370，0.195 N130 move J-25.032，23559，-71811，0370，0000 N140 move J-25.032，21472，-71586，0370，0000 N150 del

9、ay 2 N160 Close N170 delay 1 N180 move P349635，-163.275，-17483，0370,-25032 N190 move P361284，135560，-17483，0370，20567 N200 move J21405，20554，-62049，0370，0。000 N210 move J21905，19692，-60967，0370，0.000 N220 delay 2 N230 open N240 deIay l N250 move P400529，154591，-94324，0.370，31105 N260 move P428488，26

10、831，-94324，0370，3583 N270 move J-0.132，2713，-41279，0370，0.000 N280 move J2.932，0946，-42279，0370，0000 N300 Close N310 delay l N320 move P450224，-1037，-17505，0370，0132 N330 move J-24844，24101，-716530370，0000 N340 move J-24844，22275，-71653, 0370，0000 N350 delay 2 N360 open N370 delay l N380 move P36036

11、9，-151811，-34136，0370，-22844 N390 move P188702，342497，-34136，0370, 61147N400 end 4运行操作 (1)在示教编程界面下，保存上述程序； (2)在自动运行方式下，选择上述程序： (3)按下示教操作盒上的“循环启动”按钮；(4)运行程序直到完毕。五 思考题1 与机器人通信的三种主要方法是什么？什么是示教再现法，体会如何对机器人示教？2 机器人语言的基本结构是怎样的？体会用机器人语言如何与机器人通信？MATLAB上机指导MATLAB是一种编程语言，它的科学计算功能强大。在国外，尤其是美国，早在八十年代末期，各著名大学已开设

12、MATLAB课程。MATLAB是学生在实验环境中必须掌握的技术工具。一上机要求1能够熟练进行数值和符号矩阵的加、减、乘、逆运算2 能够熟练求解矩阵方程3 熟悉MATLAB编程和运算环境4 熟悉MATLAB标准函数的应用二MATLAB入门知识1 上机过程点击桌面上的Matlab图标(进入command窗口)点击File点New点击M-file（进入编程窗口，在此窗口下进行编程）编程完毕，点击File点击save或save as保存程序（程序名应以字母开头，且不能是Matlab的保留字，程序的扩展名必须是.m），保存程序后点击Debug点击Run,运行程序。2程序运行结果程序运行结果在Comman

13、d窗口中(在任务栏中点击)。3 矩阵输入举例t1=1 2 ; 3 4表示矩阵t1是22的，第一行元素是1和2，第二行元素是3和4。矩阵t1的第i行第j列的元素表示为t1（i,j），如：t1（2,1）=34矩阵运算指令举例41 矩阵乘法t1*t2表示矩阵t1与矩阵t2相乘42矩阵的逆inv(t1)表示求矩阵t1的逆矩阵5赋值语句a= inv(t1)表示把矩阵t1的逆矩阵用a表示。6方程及方程组的解法61 方程的解法要解方程f(x)=0在程序中写成f1=f(x)x=solve(f1,x)要解方程f1（x）=0，需按下列指令处理：y=f1(x)x=solve(y,x)62 方程组的解法若要求解方程组

14、在程序中写成:x，y,z=solve(f1,f2,f3,x,y,z)此时在command窗口中可得变量x、y、z的具体数值或表达式。7角度的输入需要注意角度的输入，系统中默认的是弧度。Matlab中用pi表示8数值运算若进行数值运算，可直接给变量赋值，进行运算，这与其它高级语言类似。9符号运算若进行的不是数值运算，而是符号运算，则需要在程序开始的第一行进行符号说明，即说明变量是符号变量。例：a和b是符号变量，则说明如下：syms a bc=a+b则在command 窗口中可见c的内容就是a+b。10.如果数据表达式复杂，可用simplify(f1)语句对f1整理简化。11. 如果数据太长，可用

15、vpa(q2)看数据q2。12可变精度的运算，可以设置任意多的有效计算位数进行计算（Vpa,digits）如：digits（16） x，ysolve（f1,f2.x,y）三 上机作业：1 编程计算矩阵T1与T2的乘积,其中 2解矩阵方程,求得变量和（提示利用对应元素相等，列方程,程序语句如下：f1=t1(1,1)-t2(1,1) f2=t1(2,1)-t2(2,1)x,y,=solve(f1,f2,x,y)要求：实验前认真阅读实验报告及教材上相关内容，实验过程中认真建模、编程，记录实验数据，细心观察实验现象。实验后认真整理实验报告，并按指定时间把实验报告（内容：实验目的、实验原理及方法、实验仪器设备、实验内容及步骤、实验思考）交于实验室。