五自由度机器人结构设计【5自由度】

喜欢这套资料就充值下载吧。资源目录里展示的都可在线预览哦。下载后都有，请放心下载，文件全都包含在内，图纸为CAD格式可编辑，有疑问咨询QQ:414951605 或 1304139763p 2005年3月14日 星期一 为顺利完成毕业设计，对社设计的题目的状况有了个大概的了解，我所设计的题目是：五自由度教学演示机器人结构设计“首先应设计一个机器人结构部分，其可以实现5个自由度的运动，同时实现这些运动达到教学演示的目的。 今天我参阅了相关的资料，对机器人的结构组成有了个大概的了解，在次做简单的概述，通俗点讲所谓的机器人就是为了满足人类的需要，用一种机械装置，按照人的意愿，实现一些运动代替人的劳动，类似人的手，当然我们着眼与机能方面，没有限定在要与人的手相同。 机器人作为一个系统，其组成有机械手，末端执行器，驱动器、传感器、 处理器及相关软件组成。，通过参阅这些资料，对机器人历史发展过程目前的状况有了外大致的了解，对自己的设计有个很好的基础。 2005年3月15日 星期二 作为机器人的饿重要组成部分，机械手的作用可以说是十分重要的，今天通过参阅资料，了解了机械手的发展，它的作用日益被人民所认识 其一：它能部分代替人的操作其二：它能按照生产工艺的要求，遵循一定的程序和时间位置来完成工件的传送和装卸，从而大大的改善了劳动条件。显著提高劳动生产率，加快实现工业机械化和自动化。 通过对机械手的执行机构的概括了解对设计过程中各个组成部分的布置及驱动件的布置有很大的益处，也为实习过程中有效快速学习总结提高了基础。 2005年3月16日 星期三 在对机械手执行机构进行驱动时，常见的驱动方式有液压、气动、电动其中液压驱动方式具有输出力矩大运动平稳，且速度较快易控制，定位精度高等一系列的优点，但对油液的过滤和密封要求过高，而气动驱动方式多用于具备压缩空气源的工厂，于液压驱动相比，气动的优点有1、压缩空气黏度小，容易达到高速 2、利于工厂中集中供气站，不必添家动力设备 3、气动元件工作压力低，故制造要求低。 结合自己所设计的题目，两种驱动方式都不太适合，不适合教学演示的环境，待下次比较电动方式后在做选择 2005年3月17 星期四 上次对液压驱动、气动做了比较，今天参阅相关的资料，对电动做个概述和比较 电气驱动是目前驱动应用最多的方式，其动力源简单，无需配套使用，维修方便，便于计算机连接 电驱动主要有两种电机，步进电机伺服电机，步进电机易实现开环控制，但稳定性差，且启动频率高时会产生丢步，多应用于精度不高的场合 伺服电机是一种转子的运动受输入信号控制，做快速反映控制电机分为直流和交流。 2005年3月18日 星期五 今天实习对直流伺服电机和交流伺服做了比较，总结如下： 1、 优点（直流） 1） 相同座机时效率高 2） 机械特性好 3） 在直流系统中使用方便 4） 系统稳定性技术比较简单 2、 缺点 1） 接触式直流电机的换向是对无线电的干扰 2） 有放大器漂移现象 3） 在交流系统中使用不方便 4） 电机的寿命受电刷的限制 对两种电机进行了比较，对在设计过程中的电机选择有很大的帮助。 2005年3月21日 星期一 比较上次直流伺服和交流伺服电机，结合本次设计内容，综合考虑选用步进电机驱动。今天通过去工厂，电机生产的中了解到步进电机又称脉冲电动机，是脉冲电信号转换成角位移的转化元件，没输入一个脉冲电信号，步进电机就转动一个角度，它的角位移量与脉冲数成正比，速度与频率成正比，在负载能力下，这些关系不因电源电压环境的改变和变化，可以通过改变脉冲频率来调速，反转正转等，鉴于这些特点，步进电动机在即人控制系统中应用广泛。结合自己的题目，想想自己的各个自由度的运动采用步进电机驱动，（试想）。 2005年3月22日 星期二 今天在工厂里通过师傅门的介绍，得知步进电机应用十分的广泛，对步进电机的原理有了个很好的了解， 从原理可以知道，为使步进电机连续旋转，必须有一个切换电路，按照不同的要求来控制绕组的输入，也就是步进电机驱动器，它由逻辑序列发生器及规律驱动电路组成，即输入脉冲通过环行分配器，在通过方大电路来驱动步进电机的运动。 2005.3.23 星期三 在设计思考中，为使各执行部件运动，如使臂伸缩旋转等基本操作时，传动部分必不可少，今天参照各种资料对传动方式进行了使用。 机器人手部夹持器的重复定位精度是机器人设计中一个十分重要的指标。它的实现依靠两方面因素：一是传动链精度，二是伺服精度而对传动系统而言，传动链越短，运动的驱动越直接，则精度越高。但目前工业机器人都不是直接驱动的，必须有中间环节，工业机器人主要应用减速方法，是齿轮传动，螺轮蜗杆传动。以及丝杆螺母和滚珠丝杆减速等。 齿轮传动和螺轮蜗杆传动减速有它的优越性，且价格低廉，齿合间隙也可以调到很小，可以满足重复定位的要求。 滚珠丝杠具有减速比大，效率高等优点，适用于把圆周运动转换为直线运动，且不需要自锁时没，尤其适用于机器人大小臂的传动。 另外，还应考虑大小臂，重心位置变化后的平衡计算问题，用相应方法解决。 2005.2.24 星期四 实习期间，根据王老师的设计三点要求，结构简单，自由度应具有代表性。易于教学演示，思考采用。常用臂部回转，臂部伸缩，腕部升降，腕部回转，手爪回转五个自由度方向运动。 2005.2.25 星期五 结合上次的机构布局图，对各部件的运动形式和传动方式作出进一步说明。 臂部回转采用蜗轮蜗杆传动。主要因为其所带动的部件多，惯量大，所以转数不 能带高，选用VT筒减速机构，综合考虑其能实现较大的传动比，体积小，便于安装 臂部伸缩采用丝杠螺母传动机构产生直线运动。 腕部升降部分采用丝杠螺母传动机构，用步进电机驱动，同时为减小腕及手部机构的重量所产生的倾覆力矩的作用。 腕部回转，因为要求重量轻，结构紧凑，可以采用电机直接驱动。 2005.3.28 星期一 结合资料今天我交接了工业机器人计算机控制一般分为两级控制，即主——从控制方式。 第一级，主控制计算机主要完成协调，管理，显示，轨迹规划，坐标变换，插补，编程控制再现其任务。 第二级，计算机接收第一级传来的位置指令，完成机器人各自由度运动控制。 从控机主要有两种形式，一种是CPU分时控制，由一个CPU按时间顺序分别控制机器人各自由度运动，另一种是CPU并行控制形式。 2005.3.29 星期二 集合自己题目参阅书本机器人演示系统是为教学服务的，应能开设尽可能多的演示实验还允许学习者以某种方式，输入机器人的运动位置，控制机器人完成设想的动作，因此决定采用微软伺服的点位控制方式，使学生对机器人控制有一个较全面的认识。 而在控制策略上，采用开环控制和闭环控制相结合的方式，这样做能满足实验对系统的要求。 2005.3.30 星期三 在设计过程中，考虑的因素很多，其中经济性十分重要，为降低成本，在控制策略上本实验不必作太多的要求，因此电机选取和驱动电路的设计力求经济简单。 控制核心用单片机控制并努力使多的软件功能代替硬件功能，基于同样的因素，步进电机驱动器采用简单实用的单电压串电阻驱动。 2005.3.31 星期四 在机器人中，传感器应用广泛，而用于内部反馈控制，也用于感知与外部环境的相互作用。 在机器人中，当连杆个关节运动时，传感器例如电位器，编码器，旋转变压器等将信号传给控制器，由其[判断各关节位置。 在特殊情况下，传感器还会具备人类所不具备的功能如放射性探测传感器。 本设计中用到位置传感器，判断运动位置以便于单片控制。 2005.4.1 星期五 通过这次实习，我觉得自己受益非浅，为毕业设计打下了基础，在实习的同时考虑到整个设计应该考虑的问题，整体方案的确定，驱动类型的选择，以至传动部分各部分方式，如蜗轮蜗杆传动，齿轮传动等，对整个设计的完成打下了基础，也是设计完成的保障。 我会在原有的基础上，继续努力，高质量，按进度完成设计内容，在此感谢王老师在此期间的指导。 机械设计制造及其自动化学院 毕业设计开题报告 年 级： 机械01-6班 题 目： 五自由度教学演示机器人结构设计 指导教师： 王宏 学生姓名： 黄亚东 学 号： 27 号 2005年 04月 18日 设计题目 五自由度教学演示机器人结构设计 选题的目的和意义 随着机器人技术的不断发展，工业机器人的应用领域正在不段的扩大，对教育培训部门提出了新的要求，大多数机器人专家都反复的强调制定培训规划以为新的工作岗位准备合格的劳动力，谈到培训就面临一个协调问题，工业和教育团体应减少培训与需要之间的协调失误，在学校学生应了解市场情况，在教师的协助下调整自己的课程，使所学的知识和技能在毕业时能满足社会的需要，提高毕业生的专业技能和更好的学习专业知识，提高教学水平，培养学生的科研能力，为此选定五自由度的机器人机构设计并设计一套以实验教学为目的的机器人演示系统。 大量的采用机器人用减少失业，只是对教育和培训提出了新的要求，在机器人的研究、制造和应用上有七种职业，即研究与开发、设计、制造应用、市场服务、维修 与教育，现在国外机器人制造厂家不仅开设机器人入门课程，也向学校提供资助，为学校提供有效的机器人教学系统，某些机器人制造商与院校建立密切的协调关系，我所设计的题目对教育有很大的意义，可以使学习者对机器人的全貌有个直观的认识，进一步对机器人系统极其适用的环境进行学习，使学习者熟悉机器人自动化生产及控制过程，从而提高专业设计水平及生产实践能力。 选题背景 研究目标、内容和关键问题、采取的研究方案，及本项目的创新之处和可行性分析： 研究目标：设计出一个具有5个自由度运动的机器人结构，并设计出实验用来说明机器人 分类、结构组成极其控制原理，实现教学目的。 研究内容：设计一种机器人结构，使其能完成5个自由度的运动，并采用单片机对运动进行控制以及设计出几个实验来说明演示系统的组成和结构特点和功能。基本内容有系统分析阶段和技术设计阶段以及用于教学的演示实验部分。如机器人的动作精度以及对个方面的温度环境条件的适应性，机器人坐标形式的选择，驱动系统的类型，控制系统的原理图，各部件的具体结构，机器人总装图的设计。 关键问题： 1、各自由度的方向的实现 2、各部件结构具体结构的设计和计算。 3、驱动系统的类型 4、各部位运动系统的控制系统的设计 5、用于教学演示系统的设计及方案的确定 研究方案：为完成设计目的，选用臂部回转、伸缩、腕部回转、升降、及手爪的回转5个自由度方向运动为主要思路，其中驱动均采用电机直接驱动，传动部分臂部回转采用采用蜗轮蜗杆传动、臂部伸缩采用丝杠传动，腕部回转采用电机直接驱动，升降采用丝杠传动，采用单片机逐次对不同电机进行控制实现教学演示的目的。 创新点：结构具有线条便于理解，使初学者较快掌握其要领，理解其工作原理，各驱动部分采用电机驱动，适用于机器人教学。 可执行性：由于驱动部分采用电机来源广，硬件部分采用单片机，选择性较高，用于教学演示很方便可取。 设计任务书 为顺利完成设计我决定从以下方面进展： 第一部分：绪论 1、 国内外机器人发展的状况。 2、 机器人对教育、培训的要求及本课题的提出 3、 工业机器人的价值 第二部分：总体方案的确定 1、 工业机器人总体设计方案选择的一般原则 2、 本结构总体方案的确定。 第三部分：各自由度方向运动部位的具体结构设计和计算 1、 臂部和机身的设计计算 2、 腕部结构设计和计算 3、 手爪的结构设计 第四部分：教学机器人演示系统的控制系统设计 第五部分：教学机器人演示系统演示实验的设计 第六部分：结论 第七部分：参考文献 进度安排 周 完成内容 1 查阅资料 2 毕业实习 3 完成开题报告 4 典型自由度选择及运动特点 各自由度运动结构设计计算 5 6 选择各部件的具体结构，进行机器人总装图的设计 7 绘制机器人零件图，确定及坐标尺寸 8 确定驱动类型 9 拟订控制系统原理图 10 教学机器人演示实验的设计 11 撰写论文准备答辩 12 13 14 15 16 17 18 文献综述 柳洪义 机器人技术基础 冶金工业出版社 2002年 方键军 智能机器人 化学各种业出版社 2003年 何广平 关节型机器人 化学各种业出版社 2003年 吴振彪 工业机器人 华中科技大学出版社 1996年 孟繁华 机器人技术基础 哈工大出版社1988年 导师 评语 导师签字： 年 月 日 毕业设计(或论文)说明书 页 摘要 随着机器人技术的飞速发展，工业机器人的应用领域正在不断的扩大，对教育培训部门提出了新的要求，为提高机器人教学的水平，我们研制了一套以实验教学为目的的机器人演示系统。 本文阐述了机器人的发展历程，国内外的应用现状，及其巨大的优越性，提出具体的机器人设计要求，进行了本演示系统的总体方案设计和各自由度具体结构设计、计算；对演示系统的控制部分的研制，其中包括：进电机开环控制；光电码盘为反馈元件的，以PWM型功放电路为驱动器的直流电机闭环控制；以89C51单片机为核心，实现演示系统的键盘管理和LCD显示，并以单CPU分时控制形式，实现机器人运动的点位控制方式。 最后设计制定出利用本演示系统所开设的几个实验的指导书。 关键字：教学机器人、结构设计、闭环控制、演示实验 Abstract With the development of robot technology, the continual expansion of application of industrial robots presents newrequire-ments before education and training agencies.We have developed a robot demonstration system for experiments in training to improve the teaching effect of “Robot Teaching”. Firstly, this paper discusses the development course ,the study both in demestic and in external, the significant advantages of robot and then gives the supporting source of the study and the technical requirements, Secoundly,this paper discusses the overall design and calculation on each degree of freedom ，and about the study on the control part of the Training Robot system,which includes the open-loop control of the stepping motor ,the digital closed-loop control of the DC motor with an optical-electrical encoder as feedback cell and the PWM power amplifier as driver .The keyboard management and the LCD display is based on a 89C51 singal plate computer .It is achieved in point to point control by a singal CPU with share time. At the end, it presents guidances to some experiments on the demonstration system. Keywords: Training Robot、Structure Design、Closed-Loop Control 、Demonstrating Experiment.  目　　录 摘要 1 Abstract 2 第1章 绪论 1 1.1 机器人概述 1 1.1.1 机器人的诞生与发展 1 1.1.2 国内发展状况 2 1.1.3 国外机器人发展趋势 3 1.2 机器人产业对教育、培训的要求及本课题的提出 3 第2章 总体设计方案 5 2.1 总体设计的思路 5 2.2 总体方案的确定 5 2.2.1 坐标形式的选择 6 2.2.2 驱动系统的类型选择 6 2.2.3 各部位传动机构的确定 6 2.2.4 外形尺寸和运动范围的确定 7 2.2.5 控制系统的确定 7 第3章 结构设计及计算 9 3.1 手部夹持器的结构设计 9 3.1.1 概述 9 3.1.2 手部的结构和手指形状的确定 9 3.1.3 手部驱动力的计算和电机的选择 10 3.2 腕部结构设计 13 3.2.1 概述 13 3.2.2 腕部结构设计 14 3.3 臂部及机身（底座）的设计计算 18 3.3.1 概述 18 3.3.2 结构设计计算 19 第4章 控制系统设计 25 4.1 控制系统方案的确定 25 4.1.1 控制方案的确定 25 4.1.2 驱动方式的确定 25 4.1.3 控制系统类型的确定 25 4.1.4 步进电机控制方式的确定 26 4.1.5 直流电机控制方式的确定 26 4.1.6 键盘及显示方式的确定 26 4.2 演示系统的组成 26 4.3 驱动电路的研制 29 4.3.1 恒流源型步进电机驱动电路的研制 29 4.3.2 双极型PWM直流力矩电机的驱动电路的研制 31 4.3.3 光电码盘的选择和辩向电路的研制， 33 4.3.4 直流电机的闭环控制系统的研制。 36 4.3.5 以单片机为核心的机器人控制系统的研制 36 第5章 技术经济分析 46 第6章 教学机器人演示系统演示实验的设计 47 6.1 实验一 教学机器人演示系统的组成及结构 47 6.2 实验二：教学机器人控制系统的演示实验 48 结论 50 专题部分:——旋转电机的分类及其总结 51 致谢 61 参考文献 62 附录1 63 附录2 70 附录3 75 IV 毕业设计(或论文)说明书 共77页 第1章 绪论 1.1 机器人概述 1.1.1 机器人的诞生和发展 　　1920年克作家卡雷尔.卡佩克发表了科幻剧本《罗萨姆的万能机器人》。剧情是这样的 ：罗萨姆公司把机器人作为人类生产的工业产品推向市场，让它去充当劳动力，以呆板的方 式从事繁重的劳动。后来，罗萨姆公司使机器人具有了感情，在工厂和家务劳动中，机器人成了必不可少的成员 。该剧预告了机器人的发展对人类社会的影响。在剧本中，卡佩克把捷克语“Robota”(农奴) 写成了“Robot”（机器人）。这也是人类社会首次使用“机器人”这一概念。 自动化技术的发展，特别是计算机的诞生，推动了现代机器人的发展 50年代是机器人的萌芽期，其概念是“一个空间机构组成的机械臂，一个可重复编程 动作的机器”。1954年美国戴沃尔发表了“通用重复型机器人”的专利论文，首次提出“ 工业机器人”的概念；1958年美国联合控制公司研制出第一台数控工业机器人原型；1959年 美国UNIMATION公司推出第一台工业机器人。 60年代随着传感技术和工业自动化的发展，工业机器人进入成长期，机器人开始向实用化发 展，并被用于焊接和喷涂作业中。 70年代随着计算机和人工智能的发展，机器人进入实用化时代。日本虽起步较晚，但结合国 情，面向中小企业，采取了一系列鼓励使用机器人的措施，其机器人拥有量很快超过了美国 ，一举成为“机器人王国”。 80年代，机器人发展成为具有各种移动机构、通过传感器控制的机器。工业机器人进入普及 时代，开始在汽车、电子等行业得到大量使用，推动了机器人产业的发展。 为满足人们个性化的要求，工业机器人的生产趋于小批量、多品种。 90年代初期，工业机器人的生产与需求进入了高潮期：1990年世界上新装备机器人81 000台，1991年新装备76 000台。1991年底世界上已有53万台工业机器人工作在各 条战线上。 随后由于受到日本等国经济危机的影响，机器人产业也一度跌入低谷。近两年随着世界经济 的复苏，机器人产业又出现了一片生机。90年代还出现了具有感知、决策、动作能力的智能机器人，产生了智能机器或机器人化机 器。随着信息技术的发展，机器人的概念和应用领域也在不断扩大。 2000年出现了仿人机器人及其他仿生机器人，机器人的运动能力和智能水平进一步的提高，并以智能体的形式出现，应用领域进一步的扩大。 1.1.2 国内发展状况 我国的工业机器人从80年代“七五”科技攻关开始起步，在国家的支持下，通过“七五”、“八五”科技攻关，目前已基本掌握了机器人操作机的设计制造技术、控制系统硬件和软件设计技术、运动学和轨迹规划技术，生产了部分机器人关键元器件，开发出喷漆、弧焊、点焊、装配、搬运等机器人；其中有130多台套喷漆机器人在二十余家企业的近30条自动喷漆生产线（站）上获得规模应用，弧焊机器人已应用在汽车制造厂的焊装线上。但总的来看，我国的工业机器人技术及其工程应用的水平和国外比还有一定的距离，如：可靠性低于国外产品；机器人应用工程起步较晚，应用领域窄，生产线系统技术与国外比有差距；在应用规模上，我国已安装的国产工业机器人约200台，约占全球已安装台数的万分之四。以上原因主要是没有形成机器人产业，当前我国的机器人生产都是应用户的要求，“一客户，一次重新设计”，品种规格多、批量小、零部件通用化程度低、供货周期长、成本也不低，而且质量、可靠性不稳定。因此迫切需要解决产业化前期的关键技术，对产品进行全面规划，搞好系列化、通用化、模化设计，积极推进产业化进程。 我国的智能机器人和特种机器人在“863”计划的支持下，也取得了不少成果。其中最为突出的是水下机器人，6000米水下无缆机器人的成果居世界领先水平，还开发出直接遥控机器人、双臂协调控制机器人、爬壁机器人、管道机器人等机种；在机器人视觉、力觉、触觉、声觉等基础技术的开发应用上开展了不少工作，有了一定的发展基础。但是在多传感器信息融合控制技术、遥控加局部自主系统遥控机器人、智能装配机器人、机器人化机械等的开发应用方面则刚刚起步，与国外先进水平差距较大，需要在原有成绩的基础上，有重点地系统攻关，才能形成系统配套可供实用的技术和产品。 1.1.3 国外机器人发展趋势 国外机器人领域发展近几年有如下几个趋势： 1．工业机器人性能不断提高（高速度、高精度、高可靠性、便于操作和维修），而单机价格不断下降，平均单机价格从91年的10．3万美元降至97年的6．5万美元。 　2．机械结构向模块化、可重构化发展。例如关节模块中的伺服电机、减速机、检测系统三位一体化；由关节模块、连杆模块用重组方式构造机器人整机；国外已有模块化装配机器人产品问市。 3．工业机器人控制系统向基于PC机的开放型控制器方向发展，便于标准化、网络化；器件集成度提高，控制柜日见小巧，且采用模块化结构；大大提高了系统的可靠性、易操作性和可维修性。 4．机器人中的传感器作用日益重要，除采用传统的位置、速度、加速度等传感器外，装配、焊接机器人还应用了视觉、力觉等传感器，而遥控机器人则采用视觉、声觉、力觉、触觉等多传感器的融合技术来进行环境建模及决策控制；多传感器融合配置技术在产品化系统中已有成熟应用。 　5．虚拟现实技术在机器人中的作用已从仿真、预演发展到用于过程控制，如使遥控机器人操作者产生置身于远端作业环境中的感觉来操纵机器人。 6．当代遥控机器人系统的发展特点不是追求全自治系统，而是致力于操作者与机器人的人机交互控制，即遥控加局部自主系统构成完整的监控遥控操作系统，使智能机器人走出实验室进入实用化阶段。美国发射到火星上的“索杰纳”机器人就是这种系统成功应用的最著名实例。 　7．机器人化机械开始兴起。从94年美国开发出“虚拟轴机床”以来，这种新型装置已成为国际研究的热点之一，纷纷探索开拓其实际应用的领域。 1.2 机器人产业对教育、培训的要求及本课题的提出 采用机器人会给我们带来很大的方便，机器人和其他自动化装置最主要的区别在于机器人的功能和任务很容易修改或改变，仅需要改变软件就可以了，同时机器人比一般自动化装备更复杂，需要更多的软件和硬件知识，故一旦大量采用机器人就需要专门的培训使用机器人的具有较高水平和技术人员，这无疑对教育和培训提出新的要求，大多数机器人专家都反复的强调需要制定培训计划以为新的工作岗位准备合格的劳动力。 谈到培训，还有个协调的问题，工业和教育团体应减少培训与需求的协调失误，在校学生也应了解市场情况，在教师的协助下开设和调整自己的课程，使所学的专业和技能在毕业的时候满足社会的需求。 对机器人，人们的头一个问题就是：机器人是否会造成失业？应该说大量采用机器人会使一部分人丧失工作，然而这一新的产业所创造的新的就业机会比其消灭的职业更多，新的职业需要新的技能，就再需要教育和培训，再次证明，机器人对社会的冲击就是再培训的课题。 大量采用机器人不回带来失业，在机器人的研究、制造和应用上有七种职业，即研究、开发、设计、制造、应用、市场、服务、维修和教育，而潜在的部门是机器人制造部门，教育机构和机器人相关部门。现在国外机器人制造厂家不仅自己开设机器人课程也向学校提供资助 ，为学校提供机器人教学系统，据资料显示，美国有很多大学开设了机器人课程。 早我国，许多大学也开设了机器人方面的课程（如上海交大，华中科技大学等），也有很多研究开发机器人的研究机构，但资金问题是困饶机器人发展的障碍，在教学中也面临相同的问题。但教学课程上，只是纸上谈兵，没有一点直观的印象，关键是设备问题，研制一个价格低廉、性能优越、结构简单、能给学生以深刻印象的实验用的教学演示系统，在这前提和背景下，提出本课题，它能达到以下目标： 1. 成本低，必要时可以降低精度要求，因为是实验演示装置。 2. 机械结构简单，便于学生掌握机器人结构上的特点。 3. 整体尺寸不宜过大，以摆放实验台为准。 4. 与结构相匹配，为降低成本，采用开环、闭环控制相结合 5. 各部分结构最好方便拆卸，以便维修保养。 第2章 总体设计方案 在确定机器人总体设计方案前，必须对机器人设计基本步骤及其基本原则，使设计的方案更合理 2.1 总体设计的思路 设计机器人大体上可分为两个阶段： 一、系统分析阶段 1、根据系统的目标，明确所采用机器人的目的和任务。 2、分析机器人所在系统的工作环境。 3、根据机器人的工作要求，确定机器人的基本功能和方案。如机器人的自由度、信息的存储量、计算机功能、动作精度的要求、所能抓取的重量、容许的运动范围、以及对温度、震动等环境的适应性。 二、技术设计阶段 1、根据系统的要求的自由度和允许的空间空做范围，选择机器人的坐标形式 2、拟订机器人的运动路线和空间作业图。 3、确定驱动系统的类型。 4、拟订控制系统的控制原理图。 5、选择个部件的具体集体够，进行机器人总装图的设计。 6、绘制机器人的零件图，并确定尺寸。 下面结合本演示系统的基本要求和设计的基本原则确定本系统的方案。 2.2 总体方案的确定 提到总体方案的确定，让我们重复下本课题的要求： 1、它是一个教学用的演示系统。 2、我们希望它不太大，可以安置在实验台沙锅内给学生讲解，即小型化、轻型化。 3、经费有限，要求成本低。 4、在满足前几点的要求下，尽可能的要造型美观。 2.2.1 坐标形式的选择 有要求可知这是一个演示的系统，即机器人的几个基本的动作的演示，了解机器人的基本结构、控制方式等，加深对工业机器人及其适用的工作环境的了解，综合考虑选用 圆柱型坐标，此坐标的运动特点是各动作直观性强，占用空间小，相对工作范围大，也常用，而关节型、极坐标型机器人的运动直观性差，而直角坐标型占地面积大、工作范围小，灵活性差。 2.2.2 驱动系统的类型选择 因为现有的实验设备中电机控制的优点，基本设想采用电机驱动，使用步进电机和伺服电机驱动。 整体结构布局的确定 在确定整体结构时，考虑到课题的基本要求，觉得采用模块式结构，各部位自成体系，组装方便，根据思想有图的个构想，臂部回转电机1通过减速机构驱动2回转，从 而带动手臂回转，又臂部电机带动丝杠驱动4缩运动，5 固定载上实现腕部的升降，7为控制腕不粉回转的位置传感器，8实现手爪的旋转，如图所示： 综合考虑此设计，可以认为该结构具有线条简洁明快，能使初学者较快的得其要领，理解工作原理，很适合于机器人教学的需要。 2.2.3 各部位传动机构的确定 我们从底座开始，分别的一一 考虑。 首先是臂部的回转，因为臂部的回转带动的部件多、惯性大，所以转速不能太高，考虑到用步进电机，要用减速机构，如选用齿轮传动，体积较大，不适合教学的要求，综合考虑采用蜗轮蜗杆传动比较合理，首先能实现较大的传动比；其次体积小，便于安装，其也有传动效率底的缺点，工作过程中有相当一部分的能量要转化成热，在工业生产中要装有散热的装置，由于本系统是为教学演示的，不需要长时间的工作，所以温升不大，不必安装散热装置。 臂部伸缩采用步进电机驱动丝杠螺母传动机构产生直线运动，由螺母带动臂部和腕部机构伸缩是，采用普通丝杠传动（主要考虑到价格） 腕部升降也采用丝杠传动，用步进电机驱动。 腕部回转要求重量轻、机构紧凑，故采用直流电机直接驱动，但要求转速低，故采用长时间工作在堵转状态下的直流力矩伺服电机，位置检测采用光电码盘。手部回转也采用同样的电机驱动，其中各个部分实现连接简单，方便拆卸。 2.2.4 外形尺寸和运动范围的确定 考虑到本系统的小型化的要求，可将外形尺寸及各部分的运动范围确定如下： 1、 外形尺寸：600×600×700范围内 2、 臂部回转：0～360° 3、 臂部伸缩：80mm 4、 腕部升降：70 mm 5、 腕部回转：0～180° 6、 手爪回转：90° 7、 手指开合：±5～10° 8、 抓重 0.5 Kg 运动速度、控制精度的确定 因为本系统是教学演示用的，为节约资金，对速度和精度要求较低。 2.2.5 控制系统的确定 本系统采用89C51单片机控制，臂部伸缩、回转、腕部升降、手爪开合采用步进电机开环控制；腕部回转和手爪回转采用直流电机闭环控制，其中步进电机采用单电压恒流源驱动，，由单片机直接发出控制脉冲信号。腕部的闭环控制采用直流力矩电机加装光电码盘实现，显示部分采用LCD液晶显示模块。 第3章 结构设计及计算 本章将详细设计机器人系统的具体零部件，完成装配图和全部零部件图的设计工作，也将完成一些标准器件（如电机）的选型工作。我们将按结构分块，分步进行设计，阅读本章是请参考总装图及零部件。3.1 手部夹持器的结构设计 3.1 手部夹持器的结构设计 3.1.1 概述 机器人的手部是最重要的部件。从其功能和形态上看，分为工业机器人的手部和类人机器人的手部。目前前者应用较多，也较成熟，后者正在发展中。 工业机器人的手部夹持器（亦称抓取机构）是用来握持工作或工具的部件，由于被握持工件的形状，尺寸，重量，材料及表面状态的不同，其手部结构也是多种多样的，大部分的手部结构都是根据特定的工件要求而专门设计的，按起我持原理的不同，常用的手部夹持器分为如下两类： 1.夹持式，包括内撑式和外夹式，常用的还有勾托式和弹簧式等。 2.吸附式，包括气吸式和磁吸式等 3.1.2 手部的结构和手指形状的确定 在本系统中，抓重为5N,手指开合5.10。我们决定选择滑槽杠杆支点回转手部。这种结构可通过各杆之间的角度或杆长，该变握力的大小及指间的开闭角。其优点是结构简单，动作灵活，夹持范围大，这种手部的结构比较简单，工作原理清晰易懂，也是机器人较常用的结构，这些都合乎教学演示的要求，缺点是工件直径误差会引起夹持后工件的中心发生移动。指端采用V块型式，也是机器人手指形状中较常用的形式，争取到手部能从腕部方便地装拆，以提高通用性。 下图是本系统的手部结构示意图，具体结构和零部件尺寸见图纸 图 31手部结构简图 3.1.3 手部驱动力的计算和电机的选择 我们先做手指工作时的简图，然后做力的分析 1.1.3.1握力计算 由初始设计可知，G=5N 则 N=×G ——方位系数，他与手指和工件的形状，以及手指夹持攻击的方位有关。此处，按手指是水平放置，夹持垂直的工件，V型指端夹圆形棒料的情况考虑。 取===2.764 其中 θ —— 型手指半角 ，由结构设计可知 tgθ=2.75故θ=70° f—为其与工件的摩擦系数，取0.17 所以 N =K3×G=2.764×5=13.82(N) 图 32滑槽杠杆式手部受力分析 1.1.3.2 上图是滑槽杠杆式手部结构及受力分析间图。丝杆通过销轴的向上的拉力（驱动力）是P，作用与手指上的力，其方向垂直于滑槽的中心线OO1和 OO2 。滑槽对销轴的反作用力为P1和 P2。且其延长线交 A 、B 点，由于∠OB和 ∠OA为直角，故 ∠AOC =∠BOC = α。根据轴销的力平衡条件得： P1=P2； P=2×P1×cosα 由手指的力矩平衡条件得： h=N×b 因为 = P1 ，h= 所以， P= 2b cosα×N× 式中， a ——手指的回转支点到对称中心距离 α——工件被夹持时，手指的滑槽方向与两回转支点线间的夹角，结构设计时取 a =25 mm ，b =35mm α= arctg17/25 = 34.22° 所以，销轴或螺母所受力（驱动力的反作用力） P = 2b cosα×N× =26.461（N） 考虑工件在加工过程中产生的惯性力、震动及传力机构效率的影响，其实际的驱动力为： Ps ≥ P× 其中： K1——安全系数，一般取1.2——1.6， K2——工作情况系数，且K2=1+a/g A:机构的加速度。 η ——机械效率 Ps≥ P×==42.2(N) 1.1.3.3扭距计算 我们先来计算一下螺旋升角。校核一下此丝杆，螺母机构是否满足自锁条件。 根据结构尺寸，丝杆的公称直径d=12mm 螺距 t=2mm 螺纹头数 n=1 所以，丝杆中径d2=d-0.5t=11mm 螺纹升角 λ= arctg=arctg=3.31° 螺纹的当量摩擦角 ρv= arctg = rctg=5.91° 其中：f,是摩擦副间的摩擦系数取0.1 是螺纹牙形半角取15° λ<ρv 所以，此丝杆螺母机构可安全自锁 下面来计算驱动力距 Tq=T1+T2+T3 其中T1—螺旋副摩擦力矩 T1=F×(d2/2)×tg(λ+ρv) (Nm) F – 螺旋副轴向载荷 ,N D2—螺旋副中径 ， M ρv ——当量摩擦角 λ——螺旋升角 T2(T3)是端面摩擦力矩，此处不计 故 Tq=T1= F×(d2/2)×tg(λ+ρv) =42.2×(11/2) ×tg(3.31°+5.91°) =0.04N 1.1.3.4电机的选择 至此，根据上述计算，我们得出了丝杆上应具有的扭 距， 据此，根据步进电机产品样本手册，选用45BF003型电机可以满足要求. 3.2 腕部结构设计 3.2.1 概述 腕部是臂部和手部的连接部件，其作用是在臂部运动的基础上，进一步改变或调整手部在空间上的位置和方向，从而增强手部的灵活性，扩大手部的工作范围。腕部应具有独立的自由度，为使手臂能出于空间的任意方向，腕部应具有回转，上下俯仰和左右摆动三个自由度，多数 情况下，工业机器人和机械手的腕部应具有一个或两个自由度，即回转或回转上下俯仰（左右摆动） 3.2.2 腕部结构设计 本系统的腕部结构向其他机器人一样，也是整个结构中最复杂的一部分，将臂部的升降改在腕部实现，是为了整体结构小型化，同时增加腕部的灵活性。具体结构参照总装图. 一、腕部设计计算 1、腕部转动时所需的驱动力矩 手腕的回转、上下和左右摆动，均是回转运动。驱动手腕回转时的驱动力矩必须克服手腕启动所产生的惯性力矩，手腕的转动轴与支撑处的摩擦力距，动件与缸壁、端盖等处的摩擦阻力距，以及由于转动件的重心与转动轴线不重合时所产生的偏重力距。 而对于本系统来说，参与手腕转动的零部件很多，如果每一件都去校核的话，即太烦琐，也没有必要。所以我们将整个回转部件分为4个部分。 1）转轴，包括与之相连的螺母、垫母、轴承内圈等。 2）手部电机，包括电机罩等。 3）手部换向变速箱，可将它视为65*65*70mm的一个重0.4mm的长方体。 4）手指工件，可将它看成是一个70*60*50的长方体，重0.8公斤，重心位置距回转轴线为65毫米，由此，手腕回转驱动力矩 Mq=Mg+Mm+Mf 其中：Mg ——惯性力矩。 Mp ——参与转动的零部件的重量对转轴产生的偏重力矩。 Mm ——手腕的转动轴与支撑处的摩擦力矩。 Mf ——手腕密封装置处的摩擦阻力矩。 下面我们分别计算上述四个力矩。 （1）手腕启动时产生的惯性力矩， Mg 设 手腕转动的角速度 　ω= π/6/s 启动过程时间为 △t =0.4s 则 J1=1/2×M1R2 电机罩及电机可看作一个半径是50mm，重0.45公斤的圆柱体。 则 J2=1/2×M1R2=1/2×0.45×(0..5/2)2 变速箱的转动惯量 J3=1/2M3(a2+b2) =1/2×0.4×(0..652+0..652) =1.69×10kgcm2 手部机构的转动惯量 J4= 1/2M4(a2+b2 )+M4e2 =1/2×0.8×(0.072+0.0.62)+0.8×0.0652 =6.78×10kgcm2 由此可知， Mg=(J1+J2+J3+J4) ×ω/ △t =(0.0000098+0.00014+0.00169+0.00678) ×π/6/0.4 =0.0113(NM) （2） 摩擦力距， Mm 先估算两轴承部位所受的压力。 图 33 则根据力的平衡， 所以，N=20.4N 再考虑其他因素影响，附加一定系数， 可令，N1=N2=35（N） 又由轴承部位尺寸， D1= 0.02m D2=0.015m 所以，Mm=f/2×(ND1+N2D2) =(0.012/2) ×35×(0.02+0.015)=0.00735(NM) （3）偏重力矩，Mp 根据结构设计知，其余部分重心在回转轴线上，因此不产生偏重力矩，只有手爪部分产生偏重力矩， 所以，Mp=G4×e=0.8×9.8×0.065=0.50(Nm) (4)密封处的摩擦阻力距 本系统是电机驱动，对密封没有严格要求，这部分阻力距可以咯去不计。 综上所述，考虑一定的安全系数。有 Mq=1.1×(Mg+Mm+Mp) =1.1×(0.0113+0.0074+0.50)=0.570(Nm) 据此数据，可选用60LY003型直流力矩电机。 二、腕部升降的设计计算 首先，校核螺旋副的自锁性。根据结构设计，公称尺寸d=18mm, 梯形螺纹牙型角 α =30° ,螺距t=4mm, 中径d2=d-0.5t=18-0.5×4=16mm 螺旋副为钢——青铜，取摩擦系数f=0.14 所以，当量摩擦角 ρv= arctg = arctg =8.2° 摩擦角λ= arctg = arctg =4.55° λ〈ρv ，满足自锁条件。 下面来计算腕部升降所需的驱动力 图 34腕部结构受力分析 上图给出了整个腕部的受力情况。随着腕部的移动,由腕部结构的重量Gw，手指和工件的重量Gs将在A 、B两点形成压力 N1、 N2，从而形成摩擦力F1和 F2,而电机提供的力矩应能克服 F1 F2腕部所有结构的重量Gqw 。 由力矩平衡得： N1×30=Gw×44+Gs×(65+44) 估算 Gw=24.5N Gs=7.84N Gqw=35N 所以,N1=N2===64.4(N) F1=F2=N1×f=64.4×0.11=7.08(N) 所以加在螺母上的全部轴向力 P=Gqw+2F1=35+2*7.08=49.168(N) 考虑启动时的惯性力、震动和机构效率的影响，其实际的驱动力 PSJ≥P× 其中 K1——安全系数，取 K1=1.2 V～ 1.6 K2 ——工作情况系数，取K2=1+a/g a: 机构的加速度 η——机械效率 取η=0.85 所以驱动力矩为Tq= PSJ×(d/2)tg(λ+ρv)/1000 =75.97×8×tg(8.247+4.55)/1000 =0.138（Nm） 根据这一数据，查阅资料，选用55BF003型步进电机可满足要求。 3.3 臂部及机身（底座）的设计计算 3.3.1 概述 机身表示直接连接支承，传动手臂和行走机构的部件，一般情况下实现臂部的升降，回转或俯仰等运动的驱动装置或传动部件都安装在机身上。臂都的运动越多，机身的结构和受力情况越复杂。机身既可以是固定式，也可以是行走式的，即在它的下部装有能行走的机构，可沿地面过架空轨道运动。 手臂部件（简称臂部和手臂）是机器人的组要执行部件，它的作用是支承腕部（关节）和手部（包括工件和工具），并带动它们在空间运动，臂部还安装一些传动驱动机构，从臂部的受力情况来看，它在工作中直接承受腕，手和工件的静动载荷，自身运动 又较多，所以受力情况复杂。 我们采用机座式机身,臂部安装在机座立柱的顶端,在臂部只实现伸缩运动,而臂部的回转由机座上安装的电机驱动减速机构进一步驱动立柱带动臂部回转,由于臂部质量大,而且手及腕部君安在臂部,驱动臂部回转的功率较大,,这样的配置可以使结构大的部分装在机座内,可以避免头重脚清的影响,同时应尽量的是臂部的结构重心靠近立柱,臂部和立柱连接是快速可换的,以实现总体设计的思想—条块清晰、结构简单. 臂部的主体结构设计成板状连接的,这样可以减轻臂部的质量,可以提高刚度,加工时方便实现,驱动方式采用步进电机驱动丝杠、螺母机构,为降低成本,没有采用滚珠丝杠,只采用滑动丝杠. 臂部回转的速度和加速度都不应过大,所以减速环节就要有较大的传动比,这里采用蜗轮、蜗杆一级减速,没有采用多级齿轮减速(其一级减速齿轮太大),其基本参数如下: 传动比:i=62 中心距;a=40mm 蜗杆头数 Z2=1,蜗轮齿数Z2=Iz1=62 齿形角α=20° 模数m=1 蜗轮变位系数 X2=0 蜗杆轴向齿距Px=πm 蜗杆分度圆直径 d1=mz1/tanγ=18(标准值) 蜗杆齿顶圆直径da1=d1+2ha1=d1+2ha*=18+2×1=20 蜗杆齿根圆直径df1=d1-2hf1=d1-2m(ha*+c*)=18-2×1.2=15.6 蜗杆齿顶高: ha1=ha*m=1 ha*=1 顶隙c=c* ×m=0.2 c*=0.2 蜗杆齿根高: hf1=(ha*+ c*)m=(d1-df)=1.2 蜗杆齿高: h1=ha1+hf1=(da1-df1)= (20-15.6)=2.2 蜗杆齿宽: b1=50 查表得 蜗轮分度圆直径:d2=m Z2=2a1-d1-2 X2m=80-18=62 蜗轮齿顶圆直径:da2=d2+2ha2=62+2=64 蜗轮齿根圆直径: df2=d2-2hf2=62-2.4=59.6 蜗轮齿顶高:ha2=(da2-d2)/2=m(ha*+ X2)=1 蜗轮齿根高: hf2=(d2-df2)=1(1+0.2)=1.2 蜗轮齿高:h2=ha2+hf2=1.2+1=2.2 蜗轮齿宽:b2=15 查表 3.3.2 结构设计计算 1、手臂做伸缩运动时的所需要的驱动力 P驱=P惯+P摩+P密 在此估算所有参与臂部伸缩运动零件的总质量为=20Kg (1) P惯 手臂在运动过程中的惯性力 因演示系统对速度没有严格的要求,故可设正常运动速度 V=0.005m/s,设0.1秒加速到正常运动速度则启动加速度a=0.05(m/s2 ) 所以 P惯=×a=20×0.05=1(N) (2) P摩 —摩擦阻力矩 P摩 =2f×g=2×0.12×20×9.8=47.02(N) (3) P密 —本系统对密封并无严格要求,故忽略不计 所以 P驱=P惯+P摩+P密 =1+47.02=48.02 在根据结构设计,知螺旋副公称值为T26×4 即中径 d=26mm 螺距 t=4mm 牙形角 α=30° 所以 中径d2=d-0.5t=26-0.5×4=24mm ，螺纹头数 n=1 所以，当量摩擦角 ρv= arctg = arctg =7.04° 摩擦角λ= arctg = arctg =3.04° 由此可知摩擦力和惯性立力共同产生的转矩为 T1= (P惯+P摩) d2/2 ×tg(λ+ρv)/1000 =(1+47) ×12×tg10.12°/1000 =0.122(Nm) 现在考虑丝杠及其附带零件所产生的惯性矩 现在考虑丝杠及其附带零件可以看作是半径24mm质量1.5千克的光轴,起转动惯量 JS丝 = m丝×R2 =0.5×1.5×0.0122 =1.08×10-3 Kgcm3 丝杠角速度ω===25π( rad/s) 启动时间为0.1秒则丝杠产生的驱动力矩 T2=J丝 ×ω/△t=1.08×10-4 ×25×3.14/0.1=0.085(Nm) 所以电机驱动最小力矩为T驱=T1+T2=0.122+0.085=0.207( Nm) 根据实际需要和整体布局,要选大点的电机使臂部平衡,综合选择90BF003型步进电机. 2、臂部回转运动的计算 臂部回转运动的驱动力矩应根据启动时产生的惯性力矩与回转不见支撑处的摩擦力矩计算,且启动过程中不是等加速运动,故最小驱动力比理论大些所以 .M驱=1.3(M惯 +M摩 )/η 其中, η为蜗轮,蜗杆传动效率 取0.85 M惯 启动时的惯性力矩 M摩 摩擦力矩 J 臂部零部件对其回转轴线的转动惯量 ω 回转部件的角速度 取ω=π/6(弧度/s) △t 启动过程时间 取0.5秒 (1)计算惯性力矩M惯 各部件的重量和距回转轴线的距离见下图 图 35 臂部机构力矩分析 各部件对回转轴的转动惯量为: J1=J c1+M1ρ12=0.5×1×(0.072+0.062)+1×0.242=0.064Kgm2 J2=J c2+M2ρ22=0.5×4×(0.072+0.12)+4×0.182=0.01545Kgm2 J3=J c3+M3ρ32=0.5×3×(0.072+0.132)+3×0.122=0.0759Kgm2 J4=J c4+M4ρ42=2+L2)+M4ρ42=2+0.222)+10×0.222 =0.061+0.484=0.545 Kgm2 J5=J c5+M5ρ52=2+L2)+M5ρ52=2+0.12)+2×0.252 =0.0057+0.125=0.1307 Kgm2 J5=M5ρ52=×1.5×0.0252=0.00047 Kgm2 所以惯性力矩M惯=×(ω/△t)=(J1+J2+J3+J4+J5+J6)×(π/6/0.5) =(0.064+0.115+0.076+0.545+0.130+0.0005)×(3.14/6/0.5) =0.9405+1.047=1.016(Nm) (2)计算摩擦力矩 M摩 图 36摩擦力矩的计算 如上图所示可先求出臂部结构的重心位置,在求各部分轴承的支反力,由图可以知 L= = 以O2为支点求支反力N1 N1===42(N) 可知N2=N1=42NN,而轴承所受正压力约为200N 所以摩擦力矩M摩=(N1 D1+N2D2)= (42×0.04+42×0.03)=0.02 Nm 所以驱动力矩M惯===1.58Nm 据此,我们选用步进电机为90BF003型 第4章 控制系统设计 教学机器人控制方案的确定，主要以教学为目的，以控制简单，成本底为原则，根据机器人的机械结构制定适当的控制方案。 4.1 控制系统方案的确定 4.1.1 控制方案的确定 机器人控制方式的很多，就位置控制而言，有点位控制，连续轨迹控制。本机器人演示系统是为 服务的，机器人主要用于完成工件的搬运、装配等教学演示任务，对手爪的运动轨迹没有严格的要求，因此采用点位控制方式。 控制电路简单，易于实现造价底，符合本系统节省费用的原则。 4.1.2 驱动方式的确定 机器人驱动方式主要有液压、气动和电动三种，前两种所需辅助器件多，不易实现。而电机便于控制，能实现较复杂的运动，很适合在程序控制下做驱动部件，所以选择电机驱动方式。为满足教学实验，我们选用步进电机和直流电机两种步进电机在臂部旋转、臂部伸缩、腕部 升降、手爪开合 ，而腕部旋转采用直流电机，利用光电码盘做反馈元件，实现闭环控制、手部回转采用直流电机。 4.1.3 控制系统类型的确定 机器人演示系统是为学生开设实验的，应能开设尽可能多的演示实验，还容许学生以某中方式，输入机械手的位置，控制机器人完成设想的动作，因此在控制策略上，采用计算机编程控制。我们采用单片机分时控制方式，用一个单片机控制机器人的个自由度的运动，虽然控制精度要求不高，运动速度较慢，但可以实现机器人基本运动的要求，能满足为学生开设实验的要求。 4.1.4 步进电机控制方式的确定 在控制精度要求较高的情况下，步进电机也可采用闭环控制，但由于步进电机有步距，难以实现精确的闭环控制。而步进电机在控制精度不太高的情况下，完全可以采用开环控制，本系统电机控制的速度、位置等要求精度不高，为降低成本，采用开环控制方式。 4.1.5 直流电机控制方式的确定 直流电机的控制方式很多如：数字控制、，软件控制等，前者硬件结构复杂、成本高，后者硬件结构简单，成本低，控制灵活，改变软件程序，就可以使电机实现多种运动，所以我们采用软件伺服方式。增量式光电编码盘，可以实现直接输出数字脉冲信号，在软件伺服系统中，适合做反馈元件。本系统采用增量式光电码盘做直流电机的反馈元件。 4.1.6 键盘及显示方式的确定 为完成教学演示实验，使学生能够输入机器人的运动位置参数，控制机器人实现期望的功能，能显示机器人的运动及位置状态，所以控制系统需要键盘和显示器，为降低成本和设计简单，采用普通按键做键盘，采用LCD作为显示器。 4.2 演示系统的组成 本系统主要由机器人本体部分、控制、驱动部分、实验台组成。如图： 图 41机器人控制框图 其中各部分驱动电机的性能参数 1、臂部旋转：机械传动机构为蜗轮蜗杆，传动比为1：62，选用电机90BF003性能参数 （1） 相数：3 （2） 分配方式3向6拍步距角1。5度 （3） 相电流：5安 （4） 电压：60V （5） 最大静转距：15Kg.cm 2、臂部伸缩:: 其结构采用丝杠（T26×4）螺母结构，选用电机75BFOO3其性能参数 （1）相数：3 （2）分配方式3向6拍 （3）步距角1。5度 （4）相电流：4安 （5）电压：30V （6）最大静转距：10Kg.cm 3、腕部升降：其传动副采用丝杠螺母传动（T18*4）电机选用55BF003参数 （1）相数：3 （2）分配方式3向6拍 （3）步距角1。5度 （4）相电流：3安 （5）电压：27V （6）最大静转距：7Kg.cm 4、腕部旋转此部分需电机长工作在堵转状态，选用直流力矩电机60LY003参数 （1）连续堵转电压：：30V （2）连续堵转电流1。5安 （3）连续堵转转距：2kg.cm （4）峰值电压：45V （5）峰值堵转电流1.5安 （6）空载转速：1200/min 5 、部回转同上 6、手爪：传动机构采用丝杠螺母结构，选用电机45BF003性能参数 （1）相数：3 （2）分配方式3向6拍 （3）步距角1。5度 （4）相电流2。5安 （5）电压：27V （6）最大静转距2Kg.cm 4.3 驱动电路的研制 4.3.1 恒流源型步进电机驱动电路的研制 4.3.1.1驱动电路的选择 步进电机驱动电路，有的结构简单但性能较差，如基本型，有的性能好，但结构复杂、造价高，且难以调试，如晶闸管型、斩波型等。教学机器人控制精度要求不高，工作频率在几百赫兹左右，工作电流在1-5A，不联系工作。为简化电路，降低成本，我们选定单电压、恒流源功放电路，用晶体管及相关电路构成的恒流源代替基本型中的Rc，组成恒流源型步进电机驱动电路。这种电路不太复杂，安装、调试简单，改变电阻Re，增减串联二极管个数，可以很方便的改变工作电流，以适用不同步进电机。这种电路的缺点是高频特性差，但工作要求不高，所以可以使用。 恒流源型功率放大电路原理图 图 42恒流源型功率放大电路原理图 4.3.1.2：电路元件和参数的确定 与续流二极管串联的电阻RD的对电流的波形的下降沿影响很大，小则电机绕组的电流泄放时间长，电流波形下降沿边差，增大RD能改善下降沿，但开关管承受的反电压回增大，容易将开关管击穿，因此RD也不应过大，一般取50～100，我们取51，功率10W，泄放二极管为IN5404，前置放大管采用BU408，耐反电压PCEO＞400V，最大电流TCM =5A，耗散功率PCM=60W，相配电阻Re1为300，R2为10。 开关管采用BU508，耗散功率，PCM=125W，最大电流TCM =8A，恒流源管采用BU326，耗散功率，PCM=60W，最大电流TCM =8A，恒流源三极管集电极电阻100。 恒流源上的限流电阻计算为： R=U/I 其中 N 恒流源上二极管个数 I 设计的工作电流 0.7为二极管压降 这里用的二极管为IN4007，根据电机所需的工作电流，可适当选取二极管个数N及限流电阻Re. 本电路选取 N=3，Re=0.4～1，这样单向电压可达3.5A， 4.3.1.3步进电机开环控制的研制 机器人三个自由度及手爪开合驱动采用了步进电机开环控制，其核心采用8051单片机，步进电机驱动所需的环形脉冲直接由8051输出口输出，省掉环形分配器，控制框图如下 图 43步进电机开环控制框图 4.3.2 双极型PWM直流力矩电机的驱动电路的研制 双极型PWM功放电路如下图 N1，P1为达林顿管，N1为NPN型TIP31C，最大电流3A，最大耗散功率为40W，耐反电压100V，，P1与N1管参数相同，但为PNP型TIP32B， 图 44双极型PWM功率放大器原理图 D1，D2为泄放二极管，用以保护N1，P1不被击穿。光电偶合管为TLP521，将数字电路与模拟电路隔开，7401为二输入与非门，正逻辑；7414为六反向器，正逻辑。下面介绍工作原理： 光电偶合管前部分的数字电路逻辑功能为=，， 真值表如图： 表格 1直流电机控制信号逻辑电路真值表 当输入信号A，B为0，1时，=1，=0，此时路光偶导通R3电阻有电流通过，a 点电位升高，达林顿管N1饱和导通，P1截止，+45V电压几乎全加在直流电机上，使直流电机正转。 当输入信号A，B为1，0时，=0，=1，此时路光偶导通R4电阻有电流通过，达林顿管P1饱和导通，N1截止，-45V电压几乎全加在直流电机上，使直流电机反转。 当输入信号A，B为00或11时，=1，=1，即高电平，此时两路全截止，两达林顿管基极军无电流通过而截止，此时电机绕组无电流通过，即停止。 当输入信号为相位相反的脉冲信号时，达林顿管N1，P1交替导通，截止，调整脉冲频率可使直流电机处于所定状态，改变输入脉冲的占空比，可改变电机运行方向和速度。 4.3.3 光电码盘的选择和辩向电路的研制， 1.3.3.1：光电码盘的选择 教学机器人演示系统中，对位置精度要求不高，直流电机反馈选用从长春光学仪器厂生产的分辨率2000的光电码盘器作为位置反馈元件，其输出为TTL电平，5V方波脉冲信号，所需电源电压+5V输出波形为： 1.3.3.2辨向电路的研制 光电码盘直接安装在直流电机的主轴上，在直流电机转动的过程中，即有正转也有反转，这样光电码盘输出的脉冲信号即有正转的也有反转的 。为了准确的检测电机的转动角度，必须辨别光电码盘的转动方向。这种辨别码盘转动方向的电路称为辨向电路，原理如图： 图表 1辨向电路原理图 从码盘输出的两路信号Ue,Uf在相位上互差90度。设正向运动时Uf超前于Ue90度，则此时Ue的上升沿A对应于Uf的高电平，反向移动时Ue超前于Uf90度，这时Ue的上升沿B对应着Uf的低电平。据此可以判别码盘的转动的方向。 我们采用一片单稳态触法器74LS221和一片与非门74LS00来够成辨向电路如下图： 图 45辨向电路原理图 单稳态触法器74LS221只有一个稳定状态。当没有外加信号时，输出Q为低电平；在出发脉冲的作用下，输出Q为高电平，并停留一段时间自动返回低电平。此处“停留”时间在数十毫秒到数十秒范围内变化。它由外加电阻Rext和外加电容Cext决定，可以大致按以下公式计算： Tw=Rext*Cext*Ln2 其中 ： 电容C单位为法拉 Tw单位为秒 将第一路方波信号同时送入74LS221的上升沿触发端A和下降沿触发端B可以得到两路窄脉冲（其中脉冲宽度由外接电阻，电容调节）e上 ，e下，将e上、e下分别与第二路方波信号Uf进行与非运算，输出分别送入两个计数器，进行计数，这样当码盘正向运动时，计数器1有脉冲，而计数器2没有脉冲输入；当反向运动时，计数器1无脉冲输入而计数器2有脉冲输入，由此达到辨向的目的。 4.3.4 直流电机的闭环控制系统的研制。 前面介绍了直流电机的驱动电路和辨向电路，这里加上控制核心单片机，就形成了直流电机的闭环控制系统。 在本系统中，直流电机用在机器人的腕部回转和手爪回转上。考虑到结构特点，减少手部、