舵机控制型机器人设计要点.pdf
课程设计项目说明书 舵机控制型机器人设计 学院机械工程学院 专业班级2013 级机械创新班 姓名吴泽群王志波谢嘉恒袁土良 指导教师王苗苗 提交日期 2016年 4 月 1 日 华 南 理 工 大 学 广 州 学 院 任 务 书 兹发给2013 级机械创新班学生吴泽群王志波谢嘉恒袁土良 产品设计项目课程任务书，内容如下： 1. 题目：舵机控制型机器人设计 2.应完成的项目：1.设计舵机机器人并实现运动 2.撰写机器人说明书 3.参考资料以及说明： 1 孙桓. 机械原理 M. 北京. 第六版 ; 高等教育出版社， 2001 2 张铁，李琳，李杞仪 . 创新思维与设计 M. 国防工业出版社， 2005 3 周蔼如 . 林伟健 .C+程序设计基础 M. 电子工业出版社 . 北京.2012.7 4 唐增宏 . 常建娥 . 机械设计课程设计 M. 华中科技大学出版社 . 武汉.2006.4 5 李琳. 李杞仪 . 机械原理 M. 中国轻工业出版社 . 北京.2009.8 6 何庭蕙 . 黄小清 . 陆丽芳 . 工程力学 M. 华南理工大学 . 广州.2007.1 4.本任务书于2016 年 2 月27 日发出，应于2016 年4 月 2 日前完 成，然后提交给指导教师进行评定。 指导教师（导师组）签发 2016年月日 评语： 总评成绩： 指导教师签字： 年月日 目录 摘要 1 第一章绪论 2 1.1机器人的定义及应用范围 2 1.2舵机对机器人的驱动控制 2 第二章 舵机模块 3 2.1舵机 3 2.2舵机组成 3 2.3舵机工作原理 4 第三章 总体方案设计与分析 6 3.1 机器人达到的目标动作 . 6 3.2 设计原则 . 6 3.3 智能机器人的体系结构 . 6 3.4 控制系统硬件设计 . 6 3.4.1 中央控制模块 . 7 3.4.2 舵机驱动模块 . 7 3.5机器人腿部整体结构 8 第四章 程序设计 9 4.1 程序流程图 . 9 4.2 主要中断程序 . 9 4.3 主程序 . 11 参考文献 13 附录 14 一程序 14 二硬件图 17 1 摘要 机器人是上个世纪中叶迅速发展起来的高新技术密集的机电一体化产品，在发达国家， 工业机器人已经得到广泛的应用。随着科学技术的发展，机器人的应用范围也日益扩大， 遍及工业、国防、宇宙空间、海洋开发、医疗康复等领域。进入21世纪，人们已经越来越 亲身地感受到机器人的深入生产，深入生活，深入社会的坚实步伐。 机器人技术在不断发展提高， 机器人系统中的驱动装置也在不断更新，用以满足更高 的控制要求。舵机就是在机器人驱动装置发展中诞生的新型驱动装置。 本次课程设计应用MG995 舵机与 C51单片机来对二足机器人完成一系列制定的动作， 用单片机实现了对舵机的控制，概述了程序控制思路。基于舵机实现对二足机器人关节控 制信号产生，关节摆动速度和角度还有同步运动的控制，使其能完成如向前行走、向后行 走、蹲下、起立、检测障碍等一系列动作。次设计可用于学校机器人教学，还可以用于机 器人玩具产品开发等领域。 关键词 ：二足机器人； MG995 舵机控制；动作设计； C51单片机 2 第一章绪论 1.1 机器人的定义及应用范围 机器人是能自动执行工作的机器装置。既可以接受人类指挥，又可以运行预先编排的 程序，也可以根据人工智能技术制定的原则行动。它的任务是协助或取代人类的一些工作， 例如生产业、建筑业，或是危险的工作。 国际上对机器人的概念已经逐渐趋近一致。一般说来，人们都可以接受这种说法，即 机器人是靠自身动力和控制能力来实现各种功能的一种机器，是一种可编程和多功能的， 用来搬运材料、零件、工具的操作机；或是为了执行不同的任务而具有可改变和可编程动 作的专门系统。” 机器人的产生是一个科学技术发展的综合结果，也是生产力发展的必然结果，人们总 是期待有种机器能够代替我们去从事复杂和繁重的体力劳动，社会的发展总是需要进行大 批量的生产制造，需要不断的提高生产效率，可以说机器人是为了满足我们的发展需要而 创造出来的。而后发展的各种各样的机器人也是由于人类的需要所设计的，随着人们需求 角度的增加，各种各样的机器人还会在今后问世。 我国的机器人专家从应用环境出发，将机器人分为两大类，即工业机器人和特种机器 人。工业机器人是面向工业领域的多关节机械手或多自由度机器人。而特种机器人则是除 工业机器人之外的、用于非制造业并服务于人类的各种先进机器人，包括：服务机器人、 水下机器人、娱乐机器人、军用机器人、农业机器人等。 1.2 舵机对机器人的驱动控制 机器人上身的手臂结构是由多舵机组成的。舵机是一种位置伺服的驱动器，适用于需 要角度不断变化并可以保持的控制系统。 在机器人机电控制系统中，舵机控制效果是性能的重要影响因素。舵机可以在微机电 系统和航模中作为基本的输出执行机构，其简单的控制和输出使得单片机系统非常容易与 之接口。 舵机与外界的连接端口只有三端，其中与单片机的接口只有一端，称之为控制线，另 外两端分别接电源与电源地，为电源线与地线。舵机的控制信号是PWM 信号，利用占空比 的变化改变舵机的位置。 本设计的二足机器人的6 个运动关节都是用舵机实现，设计机器人的动作其实就是对 结构机器人关节舵机的一个控制过程。 3 第二章舵机模块 2.1 舵机 舵机是一个闭环控制系统。 其输入信号为周期为20Ms ， 脉宽变化范围为 0.5Ms 到 2.5Ms 的 PWM 波。PWM 信号经过解调后得到一个直流偏置电压，舵机中的直流电机与一个电位器 相连，直流电机的转动带动电位器转动，电位器又可以输出一个电压（这是反馈信号）， 直流偏置电压与这个电位器得到的电压经过电压比较器后得到的电压差输入控制芯片中， 来完成对对舵机的控制。所以对舵机的控制，即对PWM 波形的控制。 以上说的是位置伺服舵机的原理，其实速度伺服舵机的原理是大同小异的，只不过随 直流电机转动的电位器变成了事先固定好的电位器或电阻，输出一个固定的电压，这个电 压对应的就是使舵机停转的PWM 信号得到的直流偏置电压值，所以也可以通过调整这个电 压的值，来调整舵机停转的PWM 脉宽。 当 PWM 的脉宽为 0.5Ms 或 2.5Ms时， 舵机正转或反转的速度最快， 当脉宽越接近 1.5Ms 时转速越慢，当脉宽为1.5Ms时舵机停转 2.2 舵机组成 图 2-1 舵机内部结构 4 舵机的输入线共有三条，如图2-1 所示，红色中间，是电源线，一边黑色的是地线， 这辆根线给舵机提供最基本的能源保证，主要是电机的转动消耗。电源有两种规格，一是 4.8V，一是 6.0V，分别对应不同的转矩标准，即输出力矩不同，6.0V 对应的要大一些，具 体看应用条件； 另外一根线是控制信号线， Futaba 的一般为白色， JR的一般为桔黄色。 另 外要注意一点， SANWA 的某些型号的舵机引线电源线在边上而不是中间，需要辨认。但记 住红色为电源，黑色为地线，一般不会搞错。本次用的舵机型号为MG995 ，接地线为褐色， 控制线为橙色。 2.3 舵机工作原理 控制电路板接受来自信号线的控制信号，控制电机转动，电机带动一系列齿轮组，减 速后传动至输出舵盘。舵机的输出轴和位置反馈电位计是相连的，舵盘转动的同时，带动 位置反馈电位计，电位计将输出一个电压信号到控制电路板，进行反馈，然后控制电路板 根据所在位置决定电机转动的方向和速度，从而达到目标停止。其工作流程为：控制信号 控制电路板电机转动齿轮组减速舵盘转动位置反馈电位计控制电路板反馈。 流，才可发挥舵机应有的性能。 舵机的控制信号周期为20MS的脉宽调制（PWM）信号，其中脉冲宽度从0.5-2.5MS,相 对应的舵盘位置为0180度，呈线性变化。也就是说，给他提供一定的脉宽，它的输出轴 就会保持一定对应角度上，无论外界转矩怎么改变，直到给它提供一个另外宽度的脉冲信 号，它才会改变输出角度到新的对应位置上如图7所求。舵机内部有一个基准电路，产生 周期为20MS，宽度1.5MS的基准信号，有一个比出较器，将外加信号与基准信号相比较， 判断出方向和大小，从而生产电机的转动信号。由此可见，舵机是一种位置伺服驱动器， 转动范围不能超过180度，适用于那些需要不断变化并可以保持的驱动器中，比如说机器 人的关节、飞机的舵面等。 5 图 2-2 舵机输出转角与输出脉冲的关系 6 第三章总体方案设计与分析 3.1 机器人达到的目标动作 1）外形与人手相似，包括肩、上臂、下臂、手腕及手等几部分； 2）双手可以做出各种简单的动作并实现自主行走的功能； 3.2 设计原则 本项目中的机器人， 它不但具有人类的外形特征， 手臂能实现各种不同的动作， 要 求成本低廉，功能相对来说也比较单一，因此在保证性能的情况下，我们尽量不要采用高 档的材料和元器件。基于以上的考虑，我们有下面几条设计原则： 1)经济性：在满足功能的前提下尽可能采用简单的方案，使用常见的、供应丰富的材 料和元器件，以降低生产成本： 2)可靠性：机器人的使用环境比较恶劣，有电机启制动火花对无线通讯及控制系统 的干扰，有可能遇到的碰撞以及关节被卡住造成电机堵转等各种情况，对机器人控制系统 提出了一定的要求。 3)易维护性：包括机械维护和控制系统软硬件维护。机械上尽可能采用模块化设计方 法，减少零部件种类，提高通用性，便于安装拆卸，同时也可以提高可靠性和经济性。控 制系统软硬件设计同样采用模块化设计，便于检测调试。 4)强壮性：机器人的手臂都是由各个关节链接起来的，对刚性的要求比较高。在机械 设计上，机器人应具有较好的刚性和较小的传动间隙，不至于发生严重的机械变形，各种 接插件不能松动、脱落。 3.3 智能机器人的体系结构 机器人的体系结构是定义一个智能机器人系统各部分之间相互关系和功能分配,确定 一个智能机器人或多个智能机器人的信息流通关系和逻辑上的结构。本设计的控制系统是 以微处理器为基础 ,采用二级结构 ,即协调级和执行级。协调级实现和外界环境的信息交换功 能,包括人 2 机信息交换、外界环境信息的获取和处理、生成控制指令等功能;执行级实现 对各个关节进行伺服控制,将接受的控制指令 ,分解成各关节的坐标 ,并对执行器进行伺服控制。 3.4 控制系统硬件设计 按照机器人控制系统结构, 设计控制系统硬件结构由中央控制模块、舵机驱动模块组 7 成。 3.4.1 中央控制模块 该模块是整个控制系统的核心, 采用微处理器AT89S52为核心构成 , 负责输入数据处 理、舵机协调动作处理和显示数据处理等功能。 机器人控制系统是一种典型的多轴实时运动控制系统。传统的机器人控制系统基 本上是设计者基于自己的独立结构和生产目的而开发，它采用了专用计算机、专用机器人 语言、专用微处理器的封闭式体系结构。这种结构的控制器存在制造和使用成本高，开发 周期长，升级换代困难， 无法添加系统的新功能等一系列缺点。该系统基于 TRIO运动控制 卡的开放式结构机器人控制系统，采用IPC+DSP 的结构来实现机器人的控制。这种机器人 控制系统采用开放式硬件、软件结构，可以根据需要方便地扩展功能，具有良好的开放性 和扩展性，能适应于不同类型机器人或机器人自动生产线。通过运动控制卡在工业机器人 控制系统中的应用，根据运动控制的相关理论和直流伺服电机的具有不易受干扰、易于用 微机实现数字控制、无积累误差等特性以及其动作迅速、反映快、维护简单、可实现过载 自动保护等特点作为相关背景的基础之上提出了基于TRIO 运动控制卡的自动化程度和定 位精度均较高的工业机器人控制系统。这种机器人控制系统的重要特点在于它采用通用个 人计算机加 DSP 多控制回路的开放式体系结构以及它的网络控制特性。 图 3-1 51单片机最小系统 3.4.2 舵机驱动模块 舵机是一种位置伺服的驱动器。 控制电路板接受来自信号线的控制信号,控制电机转动 机带动一系列齿轮组 ,减速后传动至输出舵盘。 舵机的输出轴和位置反馈电位计是相连的舵 8 盘转动的同时 ,带动位置反馈电位计 ,电位计将输出一个电压信号到控制电路板,进行反馈。 然后控制电路板根据所在位置决定电机转动的方向和速度，从而达到目标停止。其工作流 程为控制信号控制电路板电机转动齿轮组减速舵盘转动位置反馈电位计控制 电路板反馈。 才可发挥舵机应有的性能。控制信号由接收机的通道进入信号调制芯片,获得 直流偏置电压。它内部有一个基准电路,产生周期为 20ms,宽度为 1.5ms的基准信号 ,将获得 的直流偏置电压与电位器的电压比较获得电压差输出。最后电压差的正负输出到电机 驱动芯片决定电机的正反转。 当电机转速一定时 ,通过级联减速齿轮带动电位器旋转,使得电 压差为 0，电机停止转动。当然我们可以不用去了解它的具体工作原理,知道它的控制原理 就够了。 就象我们使用晶体管一样 ,知道可以拿它来做开关管或放大管就行了,至于管内的电 子具体怎么流动是可以完全不用去考虑的。 （1）电机参数：空心杯电机；金属齿轮结构；双滚珠轴承；连接线长度 30 厘米； （2） 技术参数 : 尺寸：40mmX20mmX36.5mm 重量：62g 技术参数：无负载速度 0.17 秒/60 度(4.8V) 0.13 秒/60 度(6.0V) 扭矩： 13KG 使用温度 :-30+60 摄氏度 死区设定 :4 微秒 工作电压 :3.0V-7.2V； 3.5 机器人腿部整体结构 图 3-2 机器人下半部分共有4 个舵机，其中脚部两个，主要实现抬腿功能；腿部两个，主要 实现向前前进功能。 9 第四章程序设计 4.1 程序流程图 图 4-1 4.2 主要中断程序 void tt1() interrupt 1 /右脚迈出 if (k # define uint unsigned int # define uchar unsigned char uint c=0; uchar x1=22,k=0,x3=8,x4=13,x5=22; sbit a1=P11;/右腿 sbit a2=P12;/左腿 sbit a3=P13;/左脚 sbit a4=P14;/右脚 sbit a5=P15;/左手 sbit a6=P16;/右手 void main() / 主函数 TMOD=0x02; TH0=156; TL0=156;/定时 0.1 毫秒 EA=1; ET0=1; TR0=1; while(1); void tt1() interrupt 1 /中断函数 /右脚迈出 if (kx1) a1=1; a2=1; 15 else a1=0; a2=0; /左脚抬起 if(kx3) a3=1; else a3=0; /右脚抬起 if (kx4) a4=1; else a4=0; /手部动作 if(kx5) a5=1; a6=1; else a5=0; a6=0; if (c=10000) k=0; x4=16; if(c=15000) k=0; x3=10; x5=13; 16 /2秒后左脚迈出 if (c=20000) k=0; x1=12; if(c=25000) x3=8; /3秒循环一次 if(c=30000) k=0; c=0; x1=22; x4=13; x5=22; k+; c+; 17 二硬件图 图 1 电路板 18 三整体图
