工业机器人实验报告.doc

本科生实验报告实验课程 机器人技术基础 学院名称 核技术与自动化工程学院 专业名称 机械工程及自动化 学生姓名 学生学号 指导教师 实验地点 JB201 实验成绩 二 15 年 5 月 二 15 年 5 月填写说明1、 适用于本科生所有的实验报告（印制实验报告册除外）；2、 专业填写为专业全称，有专业方向的用小括号标明；3、 格式要求： 用A4纸双面打印（封面双面打印）或在A4大小纸上用蓝黑色水笔书写。 打印排版：正文用宋体小四号，1.5倍行距，页边距采取默认形式（上下2.54cm，左右2.54cm，页眉1.5cm，页脚1.75cm）。字符间距为默认值（缩放100%，间距：标准）；页码用小五号字底端居中。 具体要求：题目（二号黑体居中）；摘要（“摘要”二字用小二号黑体居中，隔行书写摘要的文字部分，小4号宋体）；关键词（隔行顶格书写“关键词”三字，提炼3-5个关键词，用分号隔开，小4号黑体)； 正文部分采用三级标题；第1章 (小二号黑体居中，段前0.5行)1.1 小三号黑体（段前、段后0.5行）1.1.1小四号黑体（段前、段后0.5行）参考文献（黑体小二号居中，段前0.5行），参考文献用五号宋体，参照参考文献著录规则（GB/T 77142005）。目录第一章实验一41.1实验目的41.2实验步骤：41.3实验数据41.4实验截图41.5实验心得5第二章实验二52.1实验目的52.2实验步骤52.3实验数据52.4理论计算62.4.1直接求导法62.4.2计算过程72.5实验总结和结论8第三章实验三83.1实验目的83.2实验步骤：83.3实验数据93.4理论计算93.5实验结论9第四章实验四104.1实验目的104.2实验步骤104.3实验截图104.4实验结论12参考文献121.工业机器人12摘要 理解和掌握6自由度机械手位资变换矩阵、雅可比矩阵的计算方法以及机械手手腕运动方式和机械手网络控制的基本程序结构和方法，利用matlab矩阵计算方法对所学机械手的各种数据进行实际验证。关键词：斯坦福机械手；雅可比矩阵.第一章 实验一1.1实验目的了解斯坦福机械手的PRO/E模型在装配运动空间的具体关节各变量值的设定。1.2实验步骤：（1）在PRO/E装配环境中设定机械手各关节变量值，要求：第一个关节转动角度为学号后三位，如2班30号的同学，对应角度为230，第二到第六个关节的变量值在装配空间进行适当的随机确定。（2）记录下步骤（1）中各个关节变量值，并利用PRO/E的拍摄快照功能，记录所确定的位置。1.3实验数据theta1=210；theta2=-30；d3=0；theta4=120；theta5=30；theta6=60；1.4实验截图1.5实验心得 关节变量值确定时主要确定其旋转或移动时的中心轴即可。第二章 实验二2.1实验目的理解和掌握6自由度机械手雅可比矩阵的计算方法，通过斯坦福机械手的PRO/E模型在装配运动空间的具体关节速度值，利用matlab矩阵计算方法对所学机械手速度分析进行实际验证。2.2实验步骤（1）在PRO/E装配环境中设定机械手各关节变量值，要求：第一个关节转动角度为210，第二到第六个关节的变量值在装配空间进行适当的随机确定。（2）记录下步骤（1）中各个关节变量值，并利用PRO/E的拍摄快照功能，记录所确定的位置。（3）在PRO/E装配环境中设定各个关节的速度值，角速度单位取弧度/秒，移动关节速度取mm/秒，要求第1、2、4、5、6共五个关节的角速度取值为210（奇数关节角速度取正、偶数关节角速度取负），第3个关节是移动关节，移动速度值取为210。（4）在PRO/E运动仿真环境中测量连杆6的坐标原点的速度并记录。（5）在实验1的基础上找到T0矩阵，并利用直接求导确定雅可比矩阵的上三行（速度项）和下三行（角速度项）。（6）利用速度矢量的方法计算雅可比矩阵的前三行（速度项）（7）在matlab 中利用所求矩阵计算连杆6的坐标原点的速度并记录。（8）比较步骤（7）和步骤（4）的结果，并进行说明。2.3实验数据各关节变量值：theta1=210；theta2=-30；d3=0；theta4=120；theta5=30；theta6=60；测得的角度和距离：d2=21mm，theta1=150；theta2=-60；d3=69mm；theta4=30；theta5=30；theta6=-120；连杆6坐标原点的速度：Vx=166.777mm/s，Vy=-180.583mm/s，Vz=232.4138mm/s2.4理论计算2.4.1直接求导法 机械手雅克比矩阵即是反应坐标系6坐标原点的平移速度变换矩阵和坐标系6坐标原点的转动角速度变换矩阵。 机械手末端连杆的运动速度可以完全由各个关节的速度来确定，与关节变量有偏导关系。 第一行就是（平移变换矩阵），第二行就是（旋转变换矩阵）。雅克比矩阵的变换都是针对坐标系6坐标原点的变换，所以雅克比矩阵的X方向的变换就是位姿矩阵第一行第四列的（即为原点的X方向的变换）对每个关节变量求偏导就是X方向平移速度雅克比矩阵；同理，雅克比矩阵y方向的变换就是位姿矩阵第二行第四列（即为原点的y方向的变换）对每个关节变量求偏导就是y方向平移速度雅克比矩阵；同理，雅克比矩阵z方向的变换就是位姿矩阵第三行第四列（即为原点的z方向的变换）对每个关节变量求偏导就是y方向平移速度雅克比矩阵；从而得出平移雅克比矩阵。 是雅克比矩阵的旋转速度部分，就是坐标系6的坐标原点绕的角速度矢量的矢量和，即就是各个关节Z轴相对于基座坐标系的单位向量组成的一个矩阵，从而得出了旋转雅克比矩阵矢量积法由速度合成定理可知：，其中是在对应的连杆i坐标系中的牵连速度。所以对于转动关节有：，其中就是的Z轴变换（即为第三列），为到坐标系i的坐标原点的连线矢量在基座标系0中的表示。所以可以求得雅克比矩阵。2.4.2计算过程function Re=result(d2,d3,theta1,theta2,theta3,theta4,theta5,theta6,v1,v2,v3,v4,v5,v6) syms d2 d3 theta1 theta2 theta3 theta4 theta5 theta6 v1 v2 v3 v4 v5 v6; theta1 =210*pi/180;theta2 = -60*pi/180;theta3 = 0;theta4 =30*pi/180;theta5 =30*pi/180;theta6 = -120*pi/180;d2 = 21;d3 =69;v1=210*pi/180;v2=-210*pi/180;v3=210; v4=-210*pi/180;v5=210*pi/180;v6=-210*pi/180; J=-cos(theta1)*d2-sin(theta1)*sin(theta2)*d3 cos(theta1)*cos(theta2)*d3 cos(theta1)*sin(theta2) 0 0 0;-sin(theta1)*d2+cos(theta1)*sin(theta2)*d3 sin(theta1)*cos(theta2)*d3 sin(theta1)*sin(theta2) 0 0 0;0 -sin(theta2)*d3 cos(theta2) 0 0 0;0 -sin(theta1) 0 -cos(theta1)*cos(theta2)*sin(theta4)-sin(theta1)*cos(theta4) -cos(theta1)*cos(theta2)*sin(theta4)-sin(theta1)*cos(theta4) cos(theta1)*cos(theta2)*cos(theta4)*sin(theta5)-sin(theta1)*sin(theta4)*sin(theta5)+cos(theta1)*sin(theta2)*cos(theta5);0 cos(theta1) 0 -sin(theta1)*cos(theta2)*sin(theta4)+cos(theta1)*cos(theta4) -sin(theta1)*cos(theta2)*sin(theta4)+cos(theta1)*cos(theta4) sin(theta1)*cos(theta2)*cos(theta4)*sin(theta5)+cos(theta1)*sin(theta4)*sin(theta5)+sin(theta1)*sin(theta2)*cos(theta5);1 0 0 sin(theta2)*sin(theta4) sin(theta2)*sin(theta4) -sin(theta2)*cos(theta4)*sin(theta5)+cos(theta5)*cos(theta2); v=v1;v2;v3;v4;v5;v6; Re=J*v; ans = 166.7594 -180.5765 232.4446 -5.7835 4.3369 0.78562.5实验总结和结论通过对机械手各参数的控制以及雅克比矩阵的辅助计算，可以很好的控制需要输出的速度和运动。第三章 实验三3.1实验目的理解和掌握机械手手腕的腕摆、手转、臂转三种运动，通过所建立的PRO/E模型在装配运动空间对三种运动的运动干涉进行分析，利用机械原理相关知识，通过理论计算运动仿真消除诱导运动。3.2实验步骤：（1）在PRO/E装配环境中固定机械手的支座、T轴（行星架）S轴、设置机械手B轴的角速度值WB，要求：WB为学号后三位，如2班30号的同学，对应角度为230度/秒，进行运动仿真，并测量此时腕摆角速度Wwb和手转角速度Wsz，并进行记录。（2）为了消除手转诱导运动，计算此时S轴转动所需角速度，并进行运动仿真验证（若计算正确仿真测量的手转角速度Wsz应该=0）。（3）在PRO/E装配环境中固定机械手的支座、B轴和S轴、设置机械手T轴的角速度值WT，要求：WT为学号后三位，如2班30号的同学，对应角度为230度/秒，进行运动仿真，并测量此时腕摆角速度Wwb和手转角速度Wsz，并进行记录。（4）为了消除手转腕摆诱导运动，计算此时S轴和B转动所需角速度，并进行运动仿真验证（若计算正确仿真测量的Wsz和Wwb均应该=0）。（5）参考教师提供的屏幕录像文件，进行理论分析。3.3实验数据（1）测得Wwb=Wsz=210/s（2）计算得Ws=-210/s，经运动仿真验证Wsz=0（3）设置WT=210/s，测得Wwb=-840/s，Wsz=-1575/s（4）计算得WB=840/s，WS=945/s，经运动仿真验证Wsz=0，Wwb=03.4理论计算设置WB=210/s，计算此时腕摆角速度Wwb和手转角速度Wsz，为了消除手转诱导运动，计算此时S轴转动所需角速度。已知WB=210/s，则易得支架角度为210/s，即Wwb=210/s，而S轴固定，支架与手部齿数比为1:1，所以有Wsz=Wwb= 210/s，为了消除手转诱导运动，只需使得WS=-Wsz=-210/s，则在行星架上观察时Wsz=0。设置WT=210/s，计算此时腕摆角速度Wwb和手转角速度Wsz，为了消除手转腕摆诱导运动，计算此时S轴和B轴转动所需角速度。已知WT=210/s，即行星架角速度为210/s，WB=WS=0，即齿轮固定，齿轮传动比为1:4，齿轮传动比1:3.5，相对于行星架有W3=WT*4=840，W4=WT*3.5=735，腕摆也是相对于行星架，Wwb=-WB=-840，手转则是相对于腕摆，有Wsz=-（W4- Wwb）=-1575为了消除腕摆诱导运动，使WB=-Wwb=840，而要消除手转则要使WS=-W4-WT=-945.3.5实验结论机械手的三种运动方式都可以通过改变对S、T、B轴输入速度的大小来改变。第四章 实验四4.1实验目的理解和掌握机械手网络控制的基本程序结构和方法，利用TCP/UDP网络调试工具和相关程序联合调试实现6自由度机械手关节数据的网络传输，模拟网络机械手的现场工作。4.2实验步骤（1）打开visual studio 2010，选择“文件-打开项目/解决方案”，打开robot.sln（或者robot.csproj）文件。（2）仔细阅读代码，理解程序各个部分的功能（包括网络连接、数据接收、程序界面等）。（3）运行TCP&UDP通讯调试助手，建立TCP的服务端。（4）运行robot.exe ，输入TCP&UDP通讯调试助手的IP地址，点击“连接”，观察TCP&UDP通讯调试助手界面变化。（5）打开“数据格式.txt”，文档中：GW01表示关节1位置，GS03表示关节3速度，GL01表示关节1的力矩，GJ05表示关节5的加速度，以此类推。（6）将“数据格式.txt”文档中的GW01GW06以及GS01GS06修改为本人实验1、2中斯坦福机械手的关节位置值和速度值，并将其拷贝到“TC