六自由度机械手课程设计

1、六自由度机械手设计课程名称：机电系统设计学院：机械学院专业：机械设计制造及其自动化姓名：学号：年级：任课教师：2012年12月20日第一章前言错误！未定义书签。1.1 机器人技术概述错误！未定义书签。1.2 国外机器人技术发展情况错误！未定义书签。1.3 设计任务4.第二章总体设计5.2.1 整体分析5.2.2 各部分分析5.2.2.1 机械部分5.2.2.2 电气部分6.第三章机械结构设计7.3.1 底部设计7.3.2 臂部设计8.3.3 腕部设计8.3.4 手部设计8.第四章电气结构设计9.4.1 计算机与AT89S52通信9.4.2 AT89S52控制舵机1.0第五章程序分析12六自由度

2、机械手设计第一章前言1.1 机器人技术概述机器人技术是现代机电一体化技术的最高成果，涉及诸多学科，是当代科学技术发展最为活跃的领域之一。作为应用最为广泛的机器人技术产物，机械手在工业生产中的应用非常普遍。近年来，由于劳动力成本上升等因素，我国许多企业已经开始将部分生产交给工业机器人处理，特别是在条件较为恶劣的环境，工业机器人发挥了稳定、高效、适应能力强的特点。机器人技术是二十世纪的一项重要明，它的问世和应用在减轻劳动强度，提高生产率，把人从危险、恶劣环境下劳动替换出来等方面显示出极大的优越性；并且在宇宙、海洋开发及军事技术上具有重要的应用价值，对各类相关学科的发展也有很大的促进作用。1.2 国

3、外机器人技术发展情况国外机器人领域发展近几年有如下几个趋势：1 .工业机器人性能不断提高（高速度、高精度、高可靠性、便于操做和维修），而单机价格不断下降。2 .机械结构向模块化、可重构化发展。例如关节模块中的伺服电机、减速机检测系统三位一体化，由关节模块、连杆模块用重组方式构造机器人整机，国外已有模块化装配机器人产品问世。3 .工业机器人控制系统向基于PC机的开放型控制器方向发展，便于标准化、网络化；器件集成度提高，控制柜日渐小巧，且采用模块化结构；大大提高了系统的可靠性、易操作性和可维修性。4 .机器人中的传感器作用日益重要，除采用传统的位置、速度、加速度等传感器外，装配、焊接机器人还应用了

4、视觉、力觉等传感器，而遥控机器人则采用视觉、声觉、力觉、触觉等多传感器的融合技术来进行环境建模及决策控制；多传感器融合配置技术在产品化系统中已有成熟应用。5 .虚拟现实技术在机器人中的作用已从仿真、预演发展到用于过程控制，如使遥控机器人操作者产生置身于远端作业环境中的感觉来操纵机器人。6 .当代遥控机器人系统的发展特点不是追求全自治系统，而是致力于操作者与机器人的人机交互控制，即遥控加局部自主系统构成完整的监控、遥控操作系统，使智能机器人走出实验室进入使用化阶段。1.3设计任务本次课程设计实验对象为深圳德普施公司制造的六自由度机械手，该机械手采用电机驱动实现了伸缩、旋转、夹物等动作，共有六个自

5、由度，我们主要对六自由度机械手的物理结构，关节安排，运动分析，驱动电路及程序控制进行研究。第二章总体设计2.1 整体分析六自由度机械手由舵机、铝合金支架、单片机、控制板等部分组成，六个舵机分别控制六个转动关节，每个关节设计最大转动角度，以此来控制机械臂的运动范围，机械手应有装夹功能，因此设计一个机械式手钳机构；机械手采用AT89S52微控制器控制舵机的工作，具与80C51产品指令和引脚完全兼容。用PC机编写好程序后，烧入控制器中，可以实现机械手的旋转、伸缩、装夹等功能。六自由度机械手实物图如下：手部2.2 各部分分析六自由度机械手分为两个部分：机械部分和电气部分。机械部分主要是机械手的结构，关

6、节安排，材料选择等；而电气部分主要是机械手的控制选择，运动分析，程序指令，电路布置。电气部分控制机械部分实现规定的各项运动。2.2.1 机械部分机械部分由机身、臂部、腕部和手部四个部分组成，共有6个自由度，每个关节都由一个独立的舵机控制，其中J1能够实现机身360的旋转，臂部J2和J3用来控制机械手在空间的位置，腕部的J4、J5用来控制手部的的姿态，而J6则用来控制机械手手部的开合。各个关节中，J1和J5为360。转动关节，其余都为受限关节，只能在一定角度内转动。六自由度机械手的关节布置简图如下，该机械手臂有6个关节，每一个关节的运动控制都是用舵机来实现的，只有一个自由度。2.2.2电气部分六

7、自由度机械手电气部分由控制器模块，舵机，用行总线，驱动模块和通讯模块组成。首先用keil软件编辑程序，调试正确无误后输出.hex格式文件，再用下载好的progisp下载软件将.hex格式文件烧到控制器上，然后运行程序，控制器产生的控制信号传输到舵机控制芯片，由P8X32A-M44分析信号后，发出6个舵机控制信号，通过YE08芯片将其电压放大，传输进舵机控制口，舵机带动各个关节运动，使机械手按照预定的动作运动。第三章机械结构设计机械结构是六自由度机械手的本体，其设计应该遵循灵活、简洁的原则。三维模型简图如下：3.1 底部设计六自由度机械手底部做成圆盘状，和臂部相连接，对臂部起支撑作用。底部只做旋

8、转运动，结构虽然简单，但是它能带动机械手臂部做360。旋转，并且圆盘机构比较稳定，承载能力较强，适合于360。运转。机身设计的要求：机身要有足够的刚度、强度和稳定性；运动要灵活，用于实现升级运动的导向套长度不宜过短，以避免发生卡死现象；驱动方式要适宜；结7构布置要合理。3.2 臂部设计六自由度机械手臂部由大臂和小臂组成，具备伸缩功能，共有2个自由度，在运动时，直接承受腕部、手部和工件的载荷，但由于本机械载荷较小，在设计时不用过多考虑此因素，但在进行一般机械设计时，臂部载荷能力的计算非常重要。臂部是工业机器人的主要执行部件，除支承作用外，它还负责改变手部的空间位置。臂部设计的基本要求：手臂应具有

9、足够的承载能力和刚度；导向性要好；重量和转动惯量要小；运动要平稳、定位精度要高。3.3 腕部设计工业机器人的腕部是连接手部与臂部的部件，起支承手部的作用。六自由度机械手的腕部按自由度数目分类，为一个二自由度手腕，由一个B关节和一个R关节组成的BR手腕，这也是最为常见的二自由度手腕；按驱动方式分类，为直接驱动手腕，是将驱动元件直接装在手腕上，这样结构十分紧凑。3.4 手部设计手部是机械手用来抓握物品的机构，具有一定的人手功能。在设计手部时，需要充分考虑抓取物品的性质，以此来确定手部结构的样式。一般手部有以下特点：手部与腕部相连处可拆卸；手部是工业机器人的末端操作器；手部的通用性较差；手部是一个独

10、立的部件。工业机器人的手部有机械钳爪式和吸附式之分。本次设计采用齿轮传动的机械钳爪式手部，具结构简单，造价低廉，适用于一般场合下的物品夹紧与放松。第四章电气结构设计电气部分主要由计算机、AT89S52空制器、舵机驱动模块组成。在计算机上编写好程序后输出.hex文件格式源程序，将其通过RS-232串行总线载入AT89S52单片机，打开电源开关后由AT69S52产生六路占空比可调的PW时号,PWM1号输出到舵机，控制舵机按程序规定的步骤运动，从而带动机械手各关节的转动，由此来使机械手完成规定的动作。由于单片机系统是一个数字系统，其控制信号的变化完全依靠硬件计数，所以受外界干扰较小，整个系统工作可靠

11、。RS-232AT89s52六自由度机械手关节4.1 计算机与AT89S52S信计算机与AT89S5之间通过串行总线RS-23怵联系，它是计算机与单片机之间信息传递的枢纽，一切数据的传输必需由它完成。本实验只需将用计算机编好的程序通过RS-232串行总线烧入单片机，然后由单片机控制舵机运行即可。AT89S52JATMEL所生产的一种低功耗、高性能CMOS8微控制器，具有8K在系统可编程Flash存储器，它与80C51产品指令和引脚完全兼容，因此在嵌入式控制应用系统中应用广泛。RS232接口是197/由美国电子工业协会（EIA）联合贝尔系统、调制解调器厂家及计算机终端生产厂家共同制定的用于串行通

12、讯的标准。单片机和RS23和电平标准是不一样的，单片机与电脑串口通信应该遵循下面的连接方式：在单片机与上位机给出的RS232q之间通过电平转换电路实现TTL电平与RS23或平之间的转换。(T2)P1.0L140VCC(T2EX)P1JE230FC.0(ADO)PU2E3犯1PC.1(ADHjP1.3C437PC2(AD2.P14E5前TlPC3(AD3iiW5l.P1,5E635PC4i：AD4i(MSO)PIjOC734JPC5iAD5i(SCK)P17C833PCeiAECirstEe32FC7(AD7i但孙国0匚1031EAlWPTXDjP3J匚1130al&PHQQ12201P5EN(

13、TNm户*3匚132SP27(A15(TD)PM匚1427P2C(A14)(1却P3,5匚1523JP：5iA13；(WR)P3,flL25P24A12)丽jP3r7匚1724Z|P23iA1rKTAL2匚IB23P2.2(A1D)XTAL1匚id22TlP2.1(A3iGhnr2D21nF2.D|A3)AT89S5叩脚图4.2 AT89S52控制舵机单片机控制舵机具有简单、精度高、成本低、体积小的特点，并可根据不同的舵机数量加以灵活应用。本次实验中AT89S5/生的占空比可调的PW时号经由驱动模块的接收通道进入信号解调电路进行解调，获得一个直流偏置电压。该直流偏置电压与电位器的电压比较，获得

14、电压差送入电机驱动集成电路，以驱动电机正反转。直到电压差为0,电机停止转动。舵机主要由外壳、减速齿轮组、电机、电位器、控制电路组成。减速齿轮组由马达驱动，其终端、输出端带动一个线性的比例电位器作位置检测该电位器把转角坐标转换为一比例电压反馈给控制线路板，控制线路板将其与输入的控制脉冲信号比较。产生纠正脉冲并驱动马达正向或反向地转动，使齿轮组的输出位置与期望值相符，令纠正脉冲趋于为0,从而达到舵机精确定位的目的。本次实验舵机驱动模块采用的是parallax公司生产的16路舵机控制模块，具包括16路舵机控制线接口、单片机通信接口、舵机驱动电源接口、开关、复位键、控制芯片等部分组成。10AT89S5

15、2空制模块与舵机驱动模块11第五章程序分析六自由度机械手控制程序如下，改变codearmdata数组中的数据即可调整各转动副的转动角度。程序主函数只有最后很小的一部分，主程序通过调用各个子函数完成程序的运行。这样做可有效的较少主程序的大小，提高程序的运行速度。首先运行子函数uart_Init(),它主要负责单片机用口中断驱动程序、发送和接收中断信号、初始化用行口和UART波特率函数。下一个子程序robotmove()主要用于舵机的转角控制。数组armdata中的数据为占空比数，子程序robotmove()通过读取其中的数据改变脉冲宽度而控制舵机。子程序delay_nms()为各个舵机动作延迟时

16、间控制。#include#include#defineucharunsignedchar#defineRXDP12#defineTXDP12#defineWRDYN44/写延时#defineRDDYN43/读延时/延时程序*voidDelay2cp(unsignedchari)while(-i);/往用口写一个字节voidWByte(ucharin)uchari=8;TXD=(bit)0;/Delay2cp(183);while(i-)TXD=(bit)(in&0x01);/Delay2cp(176);in=in1;刚好两个指令周期发送启始位/发送8位数据位先传低位12/发送校验位(无)TXD

17、=(bit)1;/Delay2cp(190);)/从串口读一个字节ucharRByte(void)(ucharOut=0;uchari=8;发送结束位/发送8位数据位uchartemp=RDDYN;while(RXD);Delay2cp(187);Delay2cp(94);while(i-)(Out=1;if(RXD)Out|=0x80;Delay2cp(179);)while(-temp)(Delay2cp(1);if(RXD)break;/此处注意，等过起始位先收低位/(96-26)/2/,循环共占用26个指令周期在指定的时间内搜寻结束位。收到结束位便退出)returnOut;)intmo

18、tormove(charchannel,charramp,intposition)(unsignedchari;ucharcmd8=!SC;cmd3=channel;cmd4=ramp;cmd5=position;cmd6=position8;cmd7=0x0D;for(i=0;i8;i+)(WByte(cmdi);)13/BseBcptelbwwrstwrstRgrpprintcodearmdata=750,800,800,540,750,650,550,800,800,540,750,650,550,800,700,540,750,550,550,800,700,540,750,550,9

19、00,800,700,540,750,550,900,800,600,540,750,1200,900,800,600,540,750,1200,900,800,600,:540,750,1200,750,800,900,540,750,1200,750,8010,9010,540,750,1200,750,800,900,540,750,550,450,800,900,540,750,550,450,800,900,540,750,650,450,800,900,540,750,650,750,800,800,540,750,650,0xffintcodedelay=20,20,15,20,

20、30,10,10,10,30,20,10,30,10,10,10;introbotmove(inti,int*movedata)ucharj;while(*movedata!=0xff)for(j=0;ji;j+=6)motormove(0x00,15,*movedata+);delay_nms(delayj/6);motormove(0x01,15,*movedata+);delay_nms(delayj/6);motormove(0x02,15,*movedata+);delay_nms(delayj/6);motormove(0x03,12,*movedata+);delay_nms(dela