当前位置:首页 >> 机械/仪表 >>

六自由度机械手实验报告 (2)


六自由度机械手实验报告

学 专 班 学

院:

机 械 工 程 学



业:机械设计制造及其自动化 级: 号: 机 自 114 11080303 郭

学生姓名:

2014 年 12 月 30 日

六自由度机

械手实验报告
一、机械手介绍
六自由度机器手是由六个关节组成,每个关节上安装一个电动机,通过控制每 个电动机旋转,就可以实现机械手臂的空间运动。 本实验做的六自由度的机械手臂是能实现物品的抓取和移位的机械自动控制 机构。 该六自由度机械手臂的底座能进行大角度转动, 实现机械抓取物体的移位; 关节的俯仰和摆动能实现机械手臂不同位置的抓取物体; 手部关节部分关节的变 换, 手腕的末端安装一机械手, 机械手具有开闭能力, 能实现物体的抓取和放下。 每个关节自由度都是用电动机转动来实现机械手臂的转动、俯仰和摆动等运动。 六自由度机械手臂每个关节处都有一个小型电机控制, 分别能实现个关节的转动、 俯仰等动作。 各个电机用采用 AT89S52 单片机片控制,通过单片机输出程能实现 六个电机按照规定角度运动,从而带动关节的运动。

二、机械手的结构 1、机械部分
本实验中六自由度机械手的机械系统包括机身、臂部、手腕、手部。

图 1 机械手臂的实物图

图 2 机械手臂的结构简图 系统共有 6 个自由度,分别是 a.基座的回转、b.连杆一转动、c.连杆二转动、d.. 手腕转动、e.手腕旋转、f..手部开合。前面三个关节确定手部的空间位置,后面 三个关节确定手部的姿态。

图 3 自由度

2、控制部分
1、人机通信模块 控制系统是机器人的大脑, 它的性能优劣直接影响到机器人的先进程度和功 能强弱。机械人控制涉及自动控制,计算机,传感器、人工智能、电子技术和机 械等多学科的内容, 是一项跨多个学科的综合性技术。本实验机器人控制系统的 硬件由单片机 AT89S52、运动控制模块、驱动模块和通讯模块组成。其单片机 AT89S52 模块如下图 3.1 所示, 该模块由一块 AT89S52 单片机、 串行口通信接口、 转串口下载线连接接头、电源接口、开关、信号输出口 Q 等组成。

图4 单片机 AT89S52模块图 2、舵机驱动模块 该舵机驱动模块采用的是 parallax 公司生产的 16 路舵机控制模块, 其包括 16 路舵机控制线接口、单片机通信接口、舵机驱动电源接口、开关、复位键、控制 芯片等部分组成。具体如图 3.2 所示:

图 5 舵机控制模块 3、工作方式为 (1)在 PC 机上用 keil 软件编号程序,并调试正确输出.hex 文件格式。这就得 到了可供下载到单片机的源程序。 (2) 用转串口下载线将计算机 USB 口与单片机 ISP 下载接口连接,用 progisp 下载软件将编号的.hex 格式文件下载到单片机上(ISP 下载接口如图 3.3) 。

图6 ISP 下载接口

(3)运行程序,单片机产生控制信号,经 P1.2口传输到舵机控制芯片的信号 输入端口, 经 P8X32A-M44对信号的分析, 然后产生6个舵机控制信号, 通过个 YE08 芯片将其电压放大,进入各个舵机控制口,控制各个舵机的动作,从而实现机械 手的动作控制,完成预定的动作。具体控制电路如图3.4所示:

图 7 控制模块的类似原理图

三、运动程序
运动程序如下,要实现不同的运动,修改对应的黑体字参数即可。 #include<BoeBot.h> #include<uart.h> #define uchar unsigned char #define RXD P12 #define TXD P12 #define WRDYN 44 //写延时 #define RDDYN 43 //读延时

//延时程序* void Delay2cp(unsigned char i) { while(--i); } //往串口写一个字节 void WByte(uchar in ) { uchar i=8; TXD=(bit)0; Delay2cp(183); while(i--) { TXD=(bit)(in &0x01); Delay2cp(176); in =in >>1; } //发送校验位(无) TXD=(bit)1; Delay2cp(190); } //从串口读一个字节 uchar RByte(void) { uchar Out =0; uchar i=8; uchar temp=RDDYN; while ( RXD ); Delay2cp(187); Delay2cp(94); while(i--) { Out >>=1; if(RXD) Out |=0x80; Delay2cp(179); } while(--temp) { Delay2cp(1); if(RXD) break;

// 刚好两个指令周期。

// 发送启始位 //发送 8 位数据位

//先传低位

// 发送结束位

//发送 8 位数据位 //此处注意,等过起始位

//先收低位 //(96-26)/2,循环共占用 26 个指令周期 // 在指定的时间内搜寻结束位。

//收到结束位便退出

} return Out ; } int motormove(char channel, char ramp, int position) { unsigned char i; uchar cmd[8] ="!SC"; cmd[3] = channel; cmd[4] = ramp; cmd[5] = position; cmd[6] = position>>8; cmd[7] = 0x0D; for(i=0; i<8; i++) { WByte(cmd[i]); } } // int code armdata[] = { Bse Bcpt elbw wrst wrstR grppr 750, 800, 800, 540, 750, 1250, 750, 800, 800, 540, 750, 1250, 930, 800, 800, 540, 750, 550, 930, 800, 800, 540, 750, 550, 930, 800, 800, 540, 750, 550, 940, 800, 800, 540, 750, 550, 940, 800, 800, 540, 750, 550, 940, 800, 800, 540, 750, 550, 940, 800, 800, 540, 750, 550, 750, 800, 800, 540, 750, 1250, 750, 800, 800, 540, 750, 1250, 750, 800, 800, 540, 750, 1250, 800, 800, 800, 540, 750, 1250, 750, 800, 800, 540, 750, 1250, 750, 800, 800, 540, 750, 1250,0xff};

int code delay[] = { 20,20,15,20,30,10,10,10,30,20,10,30,10,10,10};

int robotmove(int i, int* movedata) { uchar j; while(*movedata!=0xff) {

for(j=0; j<i; j+=6) { motormove(0x00,15,*movedata++); delay_nms(delay[j/6]); motormove(0x01,15,*movedata++); delay_nms(delay[j/6]); motormove(0x02,15,*movedata++); delay_nms(delay[j/6]); motormove(0x03,12,*movedata++); delay_nms(delay[j/6]); motormove(0x04,15,*movedata++); delay_nms(delay[j/6]); motormove(0x05,15,*movedata++); delay_nms(delay[j/6]); delay_nms(2000); //让所有动作执行完 } } }

int main(void) { uart_Init(); robotmove(90,armdata); delay_nms(100);

四.总结
今年我们开了《工业机器人》这门课,所以这个实验也就加深了我们对工业机器 人的了解和控制。无论是在关节布置上,还是在手部设计上,应该说对机械手臂 有了一个比较具体的认识。 这次设计性实验同时也涉及单片机的运用和控制,主 要涉及到的是编程, 需要我们对编程语言的了解和认识,还有对单片机的通信有 一点的了解,这里面还涉及到了舵机控制,对舵机控制性能的了解,以及各个关 节间的相互协调动作, 所以这个设计实验对我们来说是一个比较综合的实验,同 时锻炼了我们很多知识。


相关文章:
六自由度焊接机器人
** *** No.* 20** DOI:10.3901/JME.20**.**.*** 六自由度焊接机械手实验报告孔潜 1,2 (1.山东建筑大学机械 103 班 山东济南历城区 250101; 2. ...
六自由度机械手
3 第章 总体介绍 机械手由 6 个伺服电机组成,实现机械手六自由度运动。...5 第三章 机械结构及设计 本次设计主要用于实验平台,对载荷没太大要求,符合...
六自由度机械手运动分析
六自由度机械手运动分析_机械/仪表_工程科技_专业资料...32 附录二 毕业设计任务书与开题报告???46 -5- ...的监控遥控操作系 统,使智能机器人走出实验室进入...
毕业论文-六自由度机械手实验教学平台的硬件设计
2 六自由度机械手实验教学平台的总体方案 2.1 机械手平台设计方案 实验教学平台机械手由 6 个伺服电机组成,实现机械手六自由度运动。该平 台以 AT89S52 ...
六自由度机械手动力学仿真
2 ADAMS 运动仿真机械手在运动过程中要尽量平滑、平稳,否则会产生机械部件的磨损...实验验证了所设计的六自由度机械手在运动过程中平滑、平稳,没有 振动和冲击现象...
六自由度机械手设计
六自由度机械手 液压泵俯仰机构零件设计及强度校核 液压泵俯仰机构零件设计及强度校核 设计及计算说明 1.采用普通螺柱连接,布局如图 2.确定螺柱组连接所受的工作...
六自由度机械手设计说明书
机电系统课程设计说明书 六自由度机械手 学班 院:农业工程与食品科学学院 级:...21 1.机械手指部基座与回转体的螺栓连接 ... 21 2.机械手指部设计及夹紧力...
工业机器人
总评成绩: 《机器人应用技术》实验报告 专业: 班级: 学号: 姓名: 机电一体化...六自由度机械手基本构成控制柜与机械本体 2、学习六自由度机械手本体各关节的...
六自由度机械手设计
六自由度机械手设计_机械/仪表_工程科技_专业资料。六自由度机械手设计参数六自由度机械手 2.1.机械手的设计参数 该机械臂用于物流生产线上物品的抓取和移位。 ...
六自由度机械手
六自由度机械手运动控制”等对 6 自由度机械手臂的运 动设计主要进行了 1、位姿与指尖的空间位置之间的关系的研究,2、目标位姿的预测分析,3、受限目 标到达...
更多相关标签:
三自由度机械手 | 六自由度机械手 | 四自由度机械手 | 五自由度机械手 | 机械手自由度 | 二自由度机械手 | 多自由度机械手 | 6自由度机械手 |