二维度运动控制系统本科毕业论文.doc

上传人:仙人指路1688 文档编号:4020104 上传时间:2023-04-01 格式:DOC 页数:69 大小:1.29MB
返回 下载 相关 举报
二维度运动控制系统本科毕业论文.doc_第1页
第1页 / 共69页
二维度运动控制系统本科毕业论文.doc_第2页
第2页 / 共69页
二维度运动控制系统本科毕业论文.doc_第3页
第3页 / 共69页
二维度运动控制系统本科毕业论文.doc_第4页
第4页 / 共69页
二维度运动控制系统本科毕业论文.doc_第5页
第5页 / 共69页
点击查看更多>>
资源描述

《二维度运动控制系统本科毕业论文.doc》由会员分享,可在线阅读,更多相关《二维度运动控制系统本科毕业论文.doc(69页珍藏版)》请在三一办公上搜索。

1、*大学本科生毕业论文二维度运动控制系统院 (系):*学院专 业:*学 号:*学 生 姓 名:*指 导 教 师:*年6月 摘 要 工业机器人机械臂的二维度运动经常为运动轴的轴向和径向旋转自由度的结合。为实现在500mm141mm的平面上运动,本设计采用一种基于常见的高速嵌入式单片机AVR单片机作为主系统,应用滚珠丝杠作为直线运动的传动机构,开发设计一套系统来实现工业机器人机械臂的二维度运动。并系统地论述了应用单片机开发步进电动机与直流伺服电机二维运动控制器的方法。 首先,论文介绍了本文的选题背景、主要研究内容和研究意义。 其次,采用模块化的设计思想进行二维度运动控制系统的硬件电路设计。以 ATm

2、ega16为核心,把控制系统分为控制器模块、电机驱动及电机运行、电源模块等,并对各模块进行了详细的介绍和分析。控制模块主要进行各种信息、数据的处理,协调系统中各功能模块完成预定的任务;驱动模块主要负责驱动步进电机和直流伺服电机,实现机械手的动作以及定位;电源模块负责整个二维度运动控制系统的电源供给。设计出电路原理图后根据原理图进行 PCB 的设计。 最后,进行软件程序设计。根据系统的功能要求设计了整个二维度运动控制系统的工作流程并向读者列举了部分程序代码。关键词:ATmega16单片机,步进电机,直流伺服电机,控制系统ABSTRACT The two dimensions movement o

3、f the Industrial robot manipulator is always the combination of the degrees of freedom of the axial of movement axis and the radial rotation. To comply the movement on the 500mm141mm plane, adopting a common high-speed embedded SCMthe AVR SCM as the main system, using the ball screw as the transmiss

4、ion mechanism of the linear movement, this design develops and devises a set of system to achieve the two dimensions movement of the Industrial robot manipulator. It also systematically expounds the method of using the SCM to exploit a two dimensions movement controller based on the stepper motor an

5、d DC servo motor. Firstly, this paper introduces its background, main contents and significance. Secondly, this issue adopts the modular design concept to design the hardware circuit of the two-dimension motion control system. With the ATmega16 as core, this issue divides the control system into the

6、 controller module, the motor driving module, the motor running module, and the power supply module, and it makes detailed description and analysis of every module. The control module mainly deals with every kind of data and information, and coordinates each module of the system to achieve the sched

7、uled tasks. The driving module mainly drive the step motor and the servo motor in order to achieve the location off the robot manipulator. The power supply module supplies power to the whole two-dimension motion control system. In addition this paper also devises the circuit schematic and plans the

8、PCB map according to the circuit schematic. Finally, this paper devises the software programs. Meanwhile it designs the whole workflow of the two-dimension motion control system according to the systems function and enumerates partial code.Key words:ATmega16 SCM, the step motor, the servo motor, the

9、 control system目 录第1章 绪论11.1 课题背景及意义11.2 工业机器人及机械手综述21.3 运动控制系统的现状31.4 本课题的主要研究内容6第2章 系统总体设计72.1 运动控制的基本概念72.2 课题技术指标72.3 系统总体设计72.4 机械设计82.4.1 总体机械结构设计82.4.2 机械手臂的设计92.4.3 理论坐标计算102.4.4 滚珠丝杠的介绍及选型102.5 电机的选型142.5.1 步进电机的选型142.5.2 直流伺服电机的选型162.6 本章小结18第3章 硬件电路设计193.1 微处理器的最小系统电路193.1.1 ATmega16单片机的简

10、介193.1.2 基于ATmega16的控制模块203.2 步进电机驱动电路的设计、对比与选择213.2.1 定位精度的理论计算213.2.2 采用以L298N为主芯片的人工设计的步进电机驱动电路223.2.3 采用步进电机驱动器MD540驱动步进电机263.2.4 步进电机驱动模块的选择293.3 直流伺服电机驱动电路的设计、对比与选择293.3.1 基于BTS7960的驱动电路293.3.3 直流伺服电机驱动电路的选择343.4 矩阵键盘的设计343.5 显示模块LCD显示屏1602363.5.1 LCD1602简介363.5.2 LCD1602的硬件电路393.6 PCB的生成393.7

11、本章小结39第4章 软件设计414.1 初始化模块设计424.2 系统整体流程图434.3 电机控制模块444.3.2 步进电机控制454.2.3 直流伺服电机控制464.4 键盘输入模块484.5 LCD显示模块494.6程序编译494.6.1 WinAVR 介绍504.6.2 程序的编译514.7 本章小结51第5章 系统调试525.1 PWM技术简介525.2 系统调试535.3 本章小结54结 论55参考文献57致 谢59附 录11、PCB板12、电路图2第1章 绪论1.1 课题背景及意义机器人是一个集环境感知、动态决策与规划、行为控制与执行等多功能于一体的综合系统,它综合了多学科的发

12、展成果,代表了高技术的发展前沿,对人类生活应用领域的影响越来越大。宋健院士在国际自动控制联合会第 14 届大会报告中指出:“机器人学的进步和应用是 20 世纪自动控制最有说服力的成就,是当代最高意义上的自动化”1。工业机器人是面向工业领域的多关节机械手或多自由度的机器人,是自动执行工作的机器装置,是靠自身动力和控制能力来实现各种功能的一种机器。它可以接受人类指挥,也可以按照预先编排的程序运行,现代的工业机器人还可以根据人工智能技术制定的原则纲领行动2。工业机器人由操作机(机械本体)、控制器、伺服驱动系统和检测传感装置构成,是一种仿人操作、自动控制、可重复编程、能在三维空间完成各种作业的机电一体

13、化自动化生产设备。特别适合于多品种、变批量的柔性生产。它对稳定、提高产品质量,提高生产效率,改善劳动条件和产品的快速更新换代起着十分重要的作用。工业机器人诞生于 20 世纪 60 年代,在 20 世纪 90 年代得到迅速发展,是最先产业化的机器人技术.它是综合了计算机,控制论,机构学,信息和传感技术,人工智能, 仿生学等多学科而形成的高新技术,是当代研究十分活跃,应用日益广泛的领域.它的出现是为了适应制造业规模化生产,解决单调,重复的体力劳动和提高生产质量而代替人工作业.在我国,工业机器人的真正使用到现在已经接近 20 多年了,已经基本实现了试验,引进到自主开发的转变,促进了我国制造业,勘探业

14、等行业的发展.随着我国改革开放的逐渐深入,国内的工业机器人产业将面对越来越大的竞争与冲击, 因此,掌握国内工业机器人市场的实际情况,把握我国工业机器人的相关技术与研究进展,显得十分重要。工业机械手是近代自动控制领域和工业机器人技术中出现的一项新技术,并已成为现代机械制造生产系统中的一个重要组成部分,这种新技术发展很快,逐渐成为一门新兴的学科机械手工程3。机械手涉及到力学、机械学、电器液压技术、自动控制技术、传感器技术和计算机技术等科学领域,是一门跨学科综合技术。同时工业机械手是近几十年发展起来的一种高科技自动生产设备。其特点是可以通过编程来完成各种预期的作业,在构造和性能上兼有人和机器各自的优

15、点,尤其体现在人的智能和适应性。机械手作业的准确性和环境中完成作业的能力,在国民经济领域有着广泛的发展空间。1.2工业机器人及机械手综述 机器人技术是综合了计算机、控制论、机构学、信息和传感技术、人工智能、仿生学等多学科而形成的高新技术,是当代研究十分活跃,应用日益广泛的领域。机器人应用情况,是一个国家工业自动化水平的重要标志。它并不是在简单意义上代替人工劳动,而是综合了人的特长和机器特长的一种拟人的电子机械装置,既有人对环境状态的快速反应和分析判断能力,又有机器可长时间持续工作、精确度高、抗恶劣环境的能力,从某种意义上说它也是机器的进化过程产物,它是工业以及非产业界的重要生产和服务性设备,也

16、是先进制造技术领域不可缺少的自动化设备4。从广义上讲,在现代化的许多工业生产、生活、灾难救援、甚至战争中,工业机器人都有极其重要的价值和极大的应用领域。工业机器人在工业生产中能代替人做某些单调、频繁和重复的长时间作业,或是危险、 恶劣环境下的作业,例如在冲压、压力铸造、热处理、焊接、涂装、塑料制品成形、机械 加工和简单装配等工序上,以及在原子能工业等部门中,完成对人体有害物料的搬运或工艺操作。机械手能模仿人手和臂的某些动作功能,用于按固定程序抓取、搬运物体或操作工具的自动操作装置。它可以代替人的繁重劳动以实现生产自动化和机械化,能在有害环境下操作以保证人的安全,因而广泛应用于机械制造、冶金、电

17、子、轻工和原子能等部门。在工业部门中应用的机械手称为工业机械手。机械手的发展是由于它的积极作用正日益为人们所认识5:其一、它能部分的代替人工操作;其二、它能按照生产工艺的要求,遵循一定的程序、时间和位置来完成工件的传送和装卸;其三、它能操作必要的机具进行焊接和装配,从而大大的改善了工人的劳动条件,显著的提高了劳动生产率,加快实现工业生产机械化和自动化的步伐。因而,受到很多国家的重视,投入大量的人力物力来研究和应用。尤其是在高温、高压、粉尘、噪音以及带有放射性和污染的场合,应用的更为广泛。在我国近几年也有较快的发展,并且取得一定的效果,受到机械工业的。机械手是一种能自动控制并可从新编程以变动的多

18、功能机器,它有多个自由度,可以搬运物体以完成在不同环境中的工作。 机械手的结构形式开始比较简单,专用性较强。 随着工业技术的发展,制成了能够独立的按程序控制实现重复操作,适用范围比较广的“程序控制通用机械手”,简称通用机械手。由于通用机械手能很快的改变工作程序,适应性较强,所以它在不断变换生产品种的中小批量生产中获得广泛的引用6。1.3运动控制系统的现状 当今的技术发展日新月异,高新技术的进步也促进了运动控制系统的发展,总的来说,运动控制系统将进一步向网络化、数字化、智能化方向纵深发展。随着劳动生产率和产品质量的不断提高,工厂生产自动化对运动控制提出了更高的要求,比如更快的响应速度、更高的控制

19、精度、更高的可靠性等。近几年来,运动控制己经逐步形成了一个新的国际研究热点。研究具有开放式结构的高性能运动控制器是当前运动控制领域的一个重要发展方向,越来越得到世界各国学者的广泛关注。 高速、高精度始终是运动控制技术追求的目标。充分利用 DSP 的计算能力,进行复杂的运动规划、高速实时多轴插补、误差补偿和更复杂的运动学、动力学计算,使得运动控制精度更高、速度更快、运动更加平稳;充分利用网络技术、FPGA 技术等,使系统的结构更加合理和开放,通过网络连接方式减少系统的连线,提高系统的实用性和可靠性。运动控制器产品今后的发展基本上沿着上述两个方向走,但是专业化、个性化的运动控制器将是一个新的发展方

20、向。 从 90 年开始,DSP 技术和 FPGA 芯片技术在美国得到高速发展,出现了一批高性能低价格的 DSP,这些 DSP 的重要特性是它们的兼容性好而且浮点运算速度快,使多轴运动控制系统能够浓缩在一块 PC ISA/PCI 控制卡上,而且每个伺服轴的更新速率可以达到 20ms,而 FPGA 芯片技术则使通过软件来更新硬件成为可能,如果将 DSP 和 FPGA 与 PC 相结合,则可充分利用现有的操作环境和资源,进一步降低系统的成本,增加系统的通用性。尽管如此由于近年来高性能的单片机不断推出,再加上用单片机开发产品的技术非常成熟,开发工具丰富且功能强大,开发成本相对低廉,这使传统的以单片机作

21、为基础的运动控制系统仍然具有很强的生命力7。 这里向读者简介两款现代工业生产、紧急救援工作中,代替人类进行繁重或危险生产活动的机器人。2008年底,安川公司推出世界第一台7轴弧焊专用机器人 MOTOMAN-VA1400。VA1400 在传统工业机器人第一俯仰臂上增加了1个回转关节,具有冗余的自由度,使机器人本体的机动性和可达性提升到了前所未有的高度。其主要技术参数为, 最大动作范围: S关节(旋转)170; L关节(下手臂) 148、-70; U关节(上臂) 150、-175; R关节(手腕旋转) 150; B关节(手腕) 180、-45; T关节(手腕回转)200; 最大动作速度: S关节2

22、20/s; L关节200/s; U关节220/s; R关节410/s; B关节410/s; T关节610/s。图1.1 MOTOMAN-VA1400 美国 iRobot公司研制了 PackBot 系列反狙击机器人。 图1.2 PackBot 反狙击机器人Packbot 反狙击机器人是根据部分反恐专家提议, 在美国军方授意下, 由 iROBOT 公司为驻伊美军量身打造的。从外形来看, 该机器人体形小巧, 长 0.87 米, 宽 0.51米, 高 0.18 米, 重仅 18 千克, 在行军中士兵可以把它轻松地背在背上。美国军方已准备将其纳入美军新型单兵标准装备“ 模块化轻型携行装备(MOLLE)”

23、 中。1.4本课题的主要研究内容 论文主要对二维度运动控制系统进行设计,主要研究内容为: (1)根据控制要求选择合适的电机,了解其运动特性; (2)通过数据手册深入学习电机驱动方式和控制方式,并为为电机设计、选用合适的驱动器; (3)选择主控模块,进行运动控制系统的硬件电路设计; (4)实现一个两轴机械臂运动控制。 本文各章节安排如下: 第 1 章“绪论”,概述了课题研究背景及意义,阐明了运动控制系统的现状,并介绍了论文的主要内容。 第 2 章“系统整体设计”,本章先简介运动控制系统,然后重点介绍二维度运动控制系统机械部分的设计与选型,电机的选型及其负载的计算、匹配等。 第 3 章“硬件电路设

24、计”,本章给出以AVR单片机为核心的控制系统硬件电路,主要介绍二维度运动控制系统控制电路的设计,并详细介绍各个电路模块,如键盘模块,显示模块等。重点介绍了步进电机、直流伺服电机驱动的电路设计与各驱动电路的对比和选择,为达到目标控制精度打下基础,并给出系统电路图和PCB图。 第 4 章“软件设计”,在硬件的基础上,主要介绍二维度运动控制系统软件设计的总体思路与软件实现的流程图。 第 5 章“系统调试”,介绍了PWM的原理和系统调试相关问题,并给出了本课题的研究总结,指出有待改进之处,并提出后续工作的研究展望。 第2章 系统总体设计2.1 运动控制的基本概念 “运动控制”是近十年来国际上流行的一种

25、新的技术,通常是指在复杂的条件下,将预定的控制方案、规划指令转变成期望的机械运动7。按照国际运动控制工程师协会的定义:“运动控制是指应用一个可控制的力的作用实现机电系统有效运动的技术,这个机电系统可以是以电气、液压、气动或其他形式驱动的。”2.2课题技术指标 本二维度运动控制系统主要技术指标: 1、X向定位精度:0.1mm;2、Y向定位精度:0.2mm(即转角定位精度约0.1);3、X向运动范围:500mm;4、Y向运动范围:141mm(即转角转动范围为45)。2.3系统总体设计本课题所设计的二维度运动控制系统主要包括主控制模块、键盘输入模块、显示模块、步进电机控制模块、直流伺服电机控制模块和

26、机械执行模块。整体系统的功能为:操作者使用键盘向系统输入符合输入规则的机械臂运动坐标,按下开始工作键后,系统开始工作,直流伺服电机带动丝杠转动,使机械臂先沿丝杠轴向运动到X向目标位置,然后步进电机带动机械臂转动到转角目标位置,此时机械臂的臂尖在Y向运动到相应的距离,至此,一次运动结束。若在运动过程中需要停止本次运动,则按下系统复位按钮。主控制模块是以ATmega16单片机为主的最小系统,其分别控制显示模块输出显示运动坐标,READY、ERROR信号,步进电机和直流伺服电机转动。其对应的系统整体框图如下: 图2.1 系统框图2.4机械设计2.4.1 总体机械结构设计整个二维度运动控制系统采用常见

27、的高速嵌入式单片机 AVR 系列单片机作为主系统,应用滚珠丝杠作为直线传动机构。该运动系统的结构示意图如下图所示: 图2.2 总体机械结构示意图如图所示,丝杠将直流伺服电动机的转动转化为机械臂在丝杠上的平动,从而使得直流伺服电机驱动整个机械臂在丝杠上做轴向的运动。2.4.2 机械手臂的设计 对于机械手臂,臂长200mm,由于手臂重量不是很大,负载重量几乎可以忽略不计,所以设计的机械臂并前端负载质量按0.1kg。因此,机械臂如下作设计:(1)由于所需电机提供的力矩很小,故小型步进电机设计在机械臂的关节处,带动机械臂进行转角运动,运动范围在045;(2)不设置配重。示意图如下: 图2.3 系统机械

28、臂左视图2.4.3 理论坐标计算设定前臂长度200mm,由于角在045度之间变化,故Y向范围为0141mm;轴向运动范围就是机械臂在丝杠上的运动范围,即0500mm。请见下图图示: 图2.4 理论坐标计算图若外部输入设备输入轴向坐标a、转角,表示机械臂在丝杠上(这里表示为X轴)应横向运动至距离起点O处a个单位的位置;机械臂前臂应转动的角度为,则机械臂在Y向的位置为距离起点O处个单位的位置,即机械臂臂尖的坐标为(a,)。2.4.4 滚珠丝杠的介绍及选型1、滚珠丝杠的原理 整个二维度运动控制系统应用滚珠丝杠作为直线传动机构。如图 2.4 所示,滚珠丝杠一般是由丝杠 1、螺母 2、滚珠 3 及滚珠循

29、环返回装置 4 等四个部分的组成。 图 2.5 滚珠丝杠副结构示意图 滚珠丝杠副的工作原理如下:当螺母 2(或丝杠 1)转动时,在丝杠与螺母间布置的滚珠 3 依次沿螺纹滚道滚动,同时滚珠 3 促使丝杠 1(或螺母 2)做直线运动。为了防止滚珠沿螺纹滚道滚出,在螺母上设有滚珠循环返回装置(反向器)4,构成一个滚珠循环通道。借助于这个返回装置,可以使滚珠沿滚道面运动后,经通道自动地返回到其工作的入口处,从而使滚珠能在螺纹滚道上继续不断地参与工作9。2、滚珠丝杠的特点 (1)传动效率高 对于滑动丝杠在定期润滑的条件下,丝杠与螺母间的滑动摩擦系数在0.060.15 之间,摩擦阻力大,传动效率低。而滚珠

30、丝杠副的摩擦系数经实验测得,一般为 0.00250.0035。显然,其传动摩擦阻力大大减小,传动效率得到很大提高。这样,滚珠丝杠副相对于滑动丝杠副来说,就能以较小的动力推动较大的载荷,而功率消耗只有滑动丝杠副的 1/41/2,不仅能大大减轻操纵者的劳动强度,而且对机械小型化、启动后的颤动和滞后时间的减少,以及节省能源等方面,都具有重要意义。 (2)同步性能好 由于滚珠丝杠副的滚动摩擦特性,摩擦阻力几乎与运动速度无关,静摩擦力矩极小,启动摩擦力矩与运动摩擦力矩接近相等,因此,运转启动时无颤动,低速下运转无爬行。这不但缩短了启动的时间,消除了滑动丝杠副中存在的滑移现象,而且大大提高了传动的灵敏度和

31、准确度,具有持续平稳运行的特点。 (3)传动的可逆性 滚珠丝杠副不仅正传动效率(简称正效率)高,而且逆传动效率(简称逆效率)也几乎同样高达 95%。它既可把回转运动变成直线运动(简称正运动),又可以把直线运动变成回转运动(简称逆运动)。因此,与滑动丝杠副相比,突出的不同点是传动具有可逆性。 滚珠丝杠副的逆效率高,一方面固然带来了逆传动的好处,但另一方面却不如滑动丝杠副那样具有自锁能力。在某些机构中,特别是垂直升降机构中使用滚珠丝杠副时,必须设置防逆转装置10。 (4)传动精度高 滚珠丝杠副的传动精度主要是指其进给精度和轴向定位精度。经过淬硬和精磨螺纹滚道后的滚珠丝杠副,本身就具有较高的进给精度

32、。高精度的滚珠螺旋副导程累积误差可达5m/300mm 以上。当采用预紧螺母进行预紧时,可完全消除滚珠丝杠副的轴向间隙。如果预紧力适当(即为最佳预紧力时),在不增加驱动力矩和基本不降低传动效率的前提下,可提高传动系统的刚度和定位精度;在带有反馈系统的滚珠丝杠副中,通过机电补偿伺服系统,能获得较高的重复定位精度。由于滚珠丝杠副的摩擦小,工作时本身几乎没有温度变化,因此不但进给速度稳定,而且尺寸也非常稳定,这就是滚珠丝杠副具有很高定位精度和重复定位精度的重要原因11。3、滚珠丝杠的选型 步进电机是安装在机械臂上的,型号为42BYG012 步进电机的质量约为0.24kg,而机械臂的质量为0.1kg,加

33、之其他一些质量较轻的机械零件,如螺丝等,丝杠上的负载质量范围为0.34kg0.4kg(不包括驱动器)。 在丝杠的选择上,本设计选择台湾HIWIN(上银)公司生产的滚珠丝杠。HIWIN 滚珠丝杠在使用上具有很多的有点,举凡高效率、可逆性、零背隙、高刚性,导程精度高及其它多项优点,与传统艾克姆螺杆(ACME)相比较,如下图所示,滚珠丝杠在螺杆与螺帽间,加入钢珠。将传统螺杆的滑动摩擦传动以钢珠滚动运动取代,以大大降低摩擦损耗。有助于维持高效率和高精度。 图2.6 滚珠螺杆与传统艾克姆螺杆比较下面介绍下HIWIN滚珠丝杠的几个主要特性和优点。 (1)高效率及可逆性 由于滚珠螺杆的螺杆轴及螺冒均是点接触

34、之滚动运动,所以其效率可高达90%以上。 (2)零背隙及高刚性 (3)高导程精度 (4)静音 (5)短交期 滚珠丝杠型号的确定: 由于上述一些滚珠丝杠特点的介绍和台湾HIWIN公司可定制特定规格的滚珠丝杠的优点,故本设计滚珠丝杠选用上银公司的型号为1R12-5B2-PSDWE1-500-650-0.027-H,所表示的滚珠丝杠的技术指标为:牙长:500mm,总长:650mm,任意300mm内的导程误差:0.027mm,导程:5mm,牙口数:单牙口,公称外径:12mm,旋转方向:右旋,珠卷数:B2,预压型式:压缩型,螺帽外型:方型,螺帽型式:双螺帽,循环种类:回流管低于螺帽外径,选用配备:自润式

35、,中空件。2.5 电机的选型 本设计中电机的选型包括步进电机的选型和直流伺服电机的选型。2.5.1 步进电机的选型1、扭矩匹配 由前面所述系统机械臂左视图,机械臂质量为m=0.1kg,长度L=200mm,转角范围在045之间,取g=10N/kg,可计算得所需步进电机提供的最大扭矩为;这个转矩T也是负载折算到步进电机轴上的等效转矩12。步进电机的最大静转矩需要满足的条件为:在这里取分母为0.5,则=0.142在这里对于步进电机的脉冲频率要求的比较宽松,故可以主要匹配负载的转动扭矩。同时,由于步进电机是安装在机械臂的关节处,因此该电机的外形和重量都不应过大,以外形小、质量小为首选,因此本设计选用外

36、形较小、质量较轻的BYG系列混合式步进电机,其型号为42BYG012,相数为两相,额定电压12V,静态电流0.52A,步距角1.8,保持转矩0.172,空载启动频率600。由此可看出该电机的转矩满足设计要求。2、累计误差 累计误差的计算涉及到为步进电机安装减速器的减速比13,由于步进电机有两种驱动方式,一种驱动方式是人工设计驱动电路,需配备减速器;另一种驱动方式是用成品步进电机驱动器,利用其对步距角的细分,完成相应精度要求,在此不作详细讨论,在步进电机驱动设计部分会有细致讨论与对比选择。3、控制频率 所选步进电机的控制频率,将在后面的步进电机驱动设计部分讨论,这里不做赘述。4、外形与质量42B

37、YG012步进电机的外形尺寸为:总长50mm、外径42mm、轴径4.7mm,质量为0.24kg。由于步进电机是安装在机械臂上,必须要求其质量和外形尽量小,此电机相比于同等类型的其他型号的电机,质量小,外形小。满足本设计中选用小型步进电机的要求。5、启动矩频特性步进电机带载很小,换算至其轴上的惯量对其启动影响不大,因此电机轴上的惯量基本满足启动矩频特性的要求。因此,选择型号为42GYB012的步进电机满足系统设计的需求。2.5.2 直流伺服电机的选型 在选型中,为首先满足系统设计指标要求,对电机的选择着重考虑扭矩和转速的因素;其次,是考虑电机外形大小是否与本设计相配合、轴与滚珠丝杠的直径是否相合

38、以利于连接与带动负载14。对直流伺服电机的一些额定值(包括额定功率、额定电压、额定电流等)则不做深入考虑。1、 扭矩匹配在本设计中,直流伺服电机带动的机械臂在丝杠上做直线运动,对速度要求不高,故采用匀速运动即可。对于扭矩的计算采用如下公式:式中,:驱动扭矩;:轴向负载(,:丝杠的轴向切削力,:导向件的综合摩擦系数,:移动物体重量(工作台+工件)kg,g:9.8 );:丝杠导程mm;:进给丝杠的正效率。机械臂质量为0.1kg,步进电机质量为0.24kg,驱动器质量在0.40.6kg之间,为便于计算,不妨取。丝杠的轴向切削力,综合摩擦系数,得;由 且按经验,取 得 即所需的直流伺服电机所能提供的扭

39、矩最小为0.332。因此,根据系统需要的扭矩,本设计选取德国Fanlhaber2342L012编码器空心杯减速电机2342L012-12V120转,其主要技术参数如下: 堵转转矩:();连续扭矩:;工作电压:;空载转速:;减速后速:;直径:;出轴直径:;电机长度:;出轴长度:;总共长度:;输出功率:;空载电流:;堵转电流:;减速箱型号:日本定制(全金属精密行星减速箱);减速比:66:1;编码器:光电式;输出路数:AB双路输出;每圈脉冲:。由此,电机的能提供的最大转矩满足系统设计的要求。同时需要注意的是,该电机若采用PWM方式驱动,可接收的PWM频率范围是080KHz。2、外形与轴的匹配由前面陈

40、述的滚珠丝杠与该直流伺服电机的外形、质量,轴长度、直径,满足设计要求与指标。直流伺服电机的轴与滚珠丝杠的轴采用销连接即可满足系统对连接刚度的要求。3、丝杠进给速度计算滚珠丝杠的导程是,设定电机匀速转速为,则机械臂在滚珠丝杠上的运动速度约为,从起始点运动至丝杠终点的时间约为100s,在合理范围内。因此,选择型号为德国Fanlhaber2342L012编码器空心杯减速电机2342L012-12V120转,满足系统设计指标需求。2.6 本章小结本节主要介绍了一些运动控制的基本概念,课题技术指标,阐述了系统的总体设计。同时设计了机械臂、介绍了滚珠丝杠的工作原理和特点,并根据系统的性能要求和指标选用了台

41、湾HIWIN公司的一款滚珠丝杠。在最后,按系统的设计指标和要求选取了合适的步进电机和直流伺服电机。第3章 硬件电路设计3.1 微处理器的最小系统电路 控制系统的主芯片采用ATMEL公司的ATmega16芯片,该芯片是AVR系列的一款中档功能的芯片。性价比很高。3.1.1 ATmega16单片机的简介1、ATmega16单片机的产品特性 (1)高性能、低功耗的 8 位 AVR 微处理器15 (2)RISC 精简指令集 131 条指令 大多数指令执行时间为单个时钟周期 32 个8 位通用工作寄存器 全静态工作 工作于16 MHz 时性能高达16 MIPS 只需两个时钟周期的硬件乘法器 (3)哈佛结

42、构,具备 1MIPS / MHz 的高速运行处理能力 (4)非易失性程序和数据存储器 (5)JTAG 接口( 与IEEE 1149.1标准兼容 )2、ATmega16单片机外设特点 (1)两个具有独立预分频器和比较器功能的8 位定时器/ 计数器16 (2)一个具有预分频器、比较功能和捕捉功能的16 位定时器 /计数器 (3)具有独立振荡器的实时计数器RTC (4)四通道PWM (5)8路 10 位ADC 上电复位以及可编程的掉电检测;片内经过标定的RC 振荡器;片内/片外中断源;6种睡眠模式(空闲模式、ADC噪声抑制模式、省电模式、掉电模式、Standby 模、式以及扩展的Standby 模式

43、)3、ATmega16单片机的主要技术参数 (1)工作电压 ATmega16L:2.7 - 5.5V ATmega16:4.5 - 5.5V (2)速度等级 0 - 8 MHz ATmega16L 0 - 16 MHz ATmega16 (3)I/O和封装 32 个可编程的I/O口 40 引脚PDIP封装 , 44 引脚 TQFP 封装,与 44 引脚MLF封装。3.1.2 基于ATmega16的控制模块 下面,是本设计的控制电路部分基于ATmega16的控制模块。单片机的控制模块电路由单片机ATmega16与时钟电路、复位电路等组成。电路如下图所示: 图3.1 单片机的控制模块电路 在此控制

44、系统中PB0PB7与显示模块相连,负责将从输入模块输入的信号显示和单片机发出的提示指令显示出来;IN1、IN2与直流伺服电机的驱动模块相连,负责控制直流伺服电机的转动;PLU-、DIR-、EN-与步进电机驱动模块相连,负责控制步进电机的转动;K1K8与键盘矩阵相连,接收输入信号。3.2 步进电机驱动电路的设计、对比与选择3.2.1 定位精度的理论计算 由于步进电机控制机械臂转动,使得臂尖在平面上Y轴方向完成平动,又由于在系统设计指标中,Y轴方向的定位精度为0.2mm,理论上计算臂尖在Y轴方向上平动0.2mm时,机械臂所转动的角度,由角即可确定步进电机转动的精度,即解决上述提及的累积误差方面的问

45、题。 图3.2 所需最小转角计算注意:图中边b=c=200mm,这里为了使读者看清楚,才将角放大。由余弦定理知,可得,。步进电机工作在两相单二拍,每从控制器输出一个控制脉冲16,步进电机带动机械臂转动的角度为。如果采用人工设计的驱动电路,需要为步进电机增加一个减速器,并且减速器的减速比约为30:1,采用小型的行星减速箱即可;如果采用成品步进电机驱动模块 M D540为步进电机驱动,则需要该模块细分数为30左右。下面就两种不同的驱动方式作出详细对比与芯片性能分析。3.2.2 采用以L298N为主芯片的人工设计的步进电机驱动电路1、L298N的基本工作原理与特点 L298是ST公司的产品,内部包含4通道逻辑驱动电路。是一种二相和四相电机的专用驱动器,即内含二个H桥的高电压大电流双全桥式驱动器,接收标准TTL逻辑电平信号,可驱动46V、2A以下的电机。比较常见的是15脚Multiw

展开阅读全文
相关资源
猜你喜欢
相关搜索
资源标签

当前位置:首页 > 办公文档 > 其他范文


备案号:宁ICP备20000045号-2

经营许可证:宁B2-20210002

宁公网安备 64010402000987号