《ZigBee压力变送器设计毕业论文.doc》由会员分享,可在线阅读,更多相关《ZigBee压力变送器设计毕业论文.doc(46页珍藏版)》请在三一办公上搜索。
1、长春建筑学院电气信息学院电子信息工程专业本科毕业设计摘 要电子计算机的出现,在科学技术上引起了一场深刻的革命。经过半个世纪的发展,它已广泛应用于工业、农业、国防、能源、商业、金融、交通、文化教育、卫生、军事等各个领域。对国民经济的发展,及信息化的进程起着积的作用。随着工业自动化的高速发展,计算机在对生产过程的控制起着越来越重要的作用,单片机作为微型机的一个分支以其独特的结构和优点,已经在工业生产和科学实验的各个部门得到了迅速的推广和应用。机器人是机构学、运动学、控制理论等学科发展水平的综合体现,是当前国内外研究的热点问题之一。从仿生学的角度,昆虫的生理构造及行为是比较容易模仿的,我们的机器人正
2、是在模仿六足行走的昆虫,该机器人是一个仿生六足行走的机器人,通过对伺服马达的精确控制,模拟六足动物的行走步态,实现行走、急跑、转弯等各种步态行为,并能在各种地面环境下进行步态的智能调整,自适应光滑地面、粗糙地面、沙石地面、湿泥地面等恶劣的路面环境。分析六足爬行机器人步进,参照实体机器人结构尺寸利用 软件Cad设计机器人结构零部件的尺寸,及其整体结构尺寸。本次机器人通过AT89S51、红外发射模块、红外接收模块及相应的辅助电路制实现三角步态行走,实现诸如直线行走、倒退、转弯等基本功能。关键词: 仿生六足爬行机器人;机械结构设计;三角步态;AT89S51单片机;红外遥控 Abstract The
3、emergence of electronic computers in science and technology led to a profound revolution.After half a century of development, it has been widely used in industry, agriculture, national defense, energy, commercial, financial, transportation, culture, education, health, military and other fields.The d
4、evelopment of national economy, and the process of informatization to play the role of a product.With the high-speed development of industrial automation, the computer in the control of the production process is playing a more and more important role, SCM as a branch of a single-chip with its unique
5、 structure and advantages, has been in the industrial production and scientific experiment of each department got a rapid promotion and application. s robot mechanisms, kinematics, control theory and other disciplines integrated embodiment of its level of development, is one of the current research
6、hot topic at home and abroad. From the perspective of bionics, physical structure and behavior of insects is relatively easy to imitate, our animals in imitation of six-legged walking robots, the robot is a bionic six-legged walking robot, based on the accurate control of the servo motor, the simula
7、tion of the six feet animal walking gait, walking, quick run, all sorts of gait behavior, such as turning and under the environment of various ground gait intelligent adjustment, adaptive smooth ground, rough ground, sand ground, such as wet mud ground road environment. Analysis of six foot step, cr
8、awling robot reference entity robot structure size using the software of Cad design the size of the robot structure components, and its overall structure size. The robot by AT89S51, infrared emission module, the infrared receiving module and the corresponding auxiliary circuit system to realize the
9、triangle gait, implement basic functions such as walk straight, backward, turn.Keywords Bionic six foot crawling robot ;The mechanical structure design;Tripod gait AT89S51;Microprocessor Infrared Remote ControlVI目 录摘 要IAbstractII第1章 绪论11.1 前言11.2 我国机器人的发展史21.3 本论文的目的与实际意义2第2章 六足仿生机器人系统设计42.1 机器人系统总体
10、的设计方案42.2 本次设计系统方案论证42.2.1 六足仿生机器人的行走方案论证42.2.2 驱动器模块的方案论证52.2.3 本设计控制器方案论证72.2.4 供电模块的方案论证72.2.5 红外遥控器的论证82.2.6 系统设计的最终方案8第3章 六足仿生机器人步态线性行进的分析与设计93.1 六足仿生机器人的线性行进原理93.2 六足机器人行走时的具体分析103.3 六足机器人的线性步态稳定性分析12第4章 驱动器模块的设计154.1 微型伺服马达(舵机)的内部结构结施154.2 微型伺服马达(舵机)的工作原理154.3 微型伺服马达(舵机)的控制164.4 微型伺服马达(舵机)的运动
11、速度174.5 微型伺服马达(舵机)的注意事项184.6 微型伺服马达(舵机)的电源引线18第5章 机器人控制系统硬件设计205.1 本设计的系统硬件电路设计205.2 51单片机芯片的简介205.2.1 51单片机的最小系统215.2.2 复位电路225.2.3 时钟电路225.3 系统的供电单元介绍235.4 微型伺服马达(舵机)驱动电路介绍245.5 红外遥控电路245.6 LM7805器件介绍25第6章 机器人控制系统软件设计276.1 机器人系统软件流程图如下图图6-1所示:276.2 微型伺服电机(舵机)模块程序设计286.3 红外遥控模块程序设计29结 论31致 谢32参考文献3
12、3附 录34第1章 绪论1.1 前言机器人学是一门综合性的科学。它是机构学、运动学、控制理论等学科发展水平的综合体现,并且,它也是由工程学、神经生理学、生物学、控制论等学科相互渗透结合而成的。机器人研究的意义和应用价值也越来越为人们所认识和重视。自二十世纪六十年代第一代工业机器人通用机器手问世以来,随着测试技术,控制理论的飞速发展,在七十年代发展成为第二代机器人,即由计算机控制的具有多关节,多自由度的机械手或具有简单感觉的机器人。目前,正在向第三代机器人-智能机器人发展。就我国而言,通用机械手的研究和开发已达到一定水平,且已在工业生产中广泛应用。发展和研制具有特殊用途的机器人在我国有较大的现实
13、意义。例如,对于各种不适于人体工作条件下的危险工作,无人参与的采掘与矿井工作,深水作业,在宇宙空间的活动以及诸如此类的各个方面,采用各种机器人已经是非常迫切的任务,为此,研制了六足步行机。它是一种依靠足来移动的“自由型”机器人,在起运载作用时,有比轮式或车无法比拟的优越性。随着车轮转速的提高,它必须依赖平坦的公路行走,这就限制了它的广泛应用。而步行机的足与有足的生物相似,这样它运动的灵活性大,对复杂环境的适应性强,其应用前景广阔。比如用于研究月球及其他星体的太空机器人,由于外星体上可能根本没有路,步行方式具有明显的优点。又如用于检查和抢修核工业,化学工业和冶金工业的高温、强放射性、有毒的反应室
14、,燃烧室的工业机器人,也必须是步行机器人。从这些用途上可以看出,研究步行机对于机器人工业的发展,对人类社会的进步,都有着及其重要的作用和意义。 人工智能是20世纪科学技术所取得的重大成果之一。它的诞生与发展对人类文明产生了巨大的影响和效益。同时也引起了哲学意识与人工智能的理论探讨。其中最具有代表性的就是机器人技术的诞生与发展。大千世界,万事万物都遵循着从无到有的,从低级到高级的发展规律,机器人也不例外。话说早在三千多年前的西周时代,我国就出现了能歌善舞的木偶,称为“倡者”,这可能是世界上最早的“机器人”。然而真正机器人的出现,或者说它的历史并不算长,直到1959年美国英格伯格和德沃尔制造出世界
15、上第一台工业机器人,机器人的历史才真正拉开了帷幕。1.2 我国机器人的发展史 中国机器人的发展状况,古代的中国就可找到机器人的影子,如三国时的木流牛马,周朝的歌舞艺人等。直到20世纪70年代,现代机器人的研究才在中国起步,并于七五期间实施了863计划。 短短的二十年,中国的机器人技术在世界已占有一席之地。在制造业中陆续出现了喷涂,搬运,装配等机器人。但受市场,资金等因素的制约,目前,装机数量仅1200台,与发达国家相比还存在很大差距。今后,走产业化道路是推动中国工业机器人发展的动力。 在特种机器人方面,自第一台水下机器人研制成功后,瑞康一号,探索者一号相续诞生。特别是CR-016000米水下机
16、器人,能在深水中录像,进行海底 地势勘察和水文测量,自动记录各种数据等,曾两次在太平洋圆满完成了各项海底调查任务,为中国进入水下机器人的先进行列立下了功劳。另外,核工业中还研制 成功壁面爬行、遥控检查和排险机器人。 中国机器人技术正朝着微型机器人和智能机器人发展。最近,2毫米微电机制研制成功和第一台导游小姐服务机器人的诞生,有利于推动中国机器人的发展与应用。1.3 本论文的目的与实际意义 查阅国内外的相关文献,收集相关资料,解决以下问题:(1) 仿生六足爬行机器人的腿部结构和整体结构设计。(2) 本次设计的控制系统,设计电路控制系统。(3) 驱动器系统模块,怎样才能让电机可以依据自己的意愿转动
17、,怎样控制电机的速度,这是两个必须要解决的问题。(4) 红外遥控系统模块,我通过查阅、搜集国内外相关的资料和文献,来完成对红外遥控系统的设计。(5) 机器人的步态分析、设计及其实现,我们依据天牛类昆虫的行进原理,可以建立起相应的步行运动模型,可以将昆虫的运动进行简化,这样就能抽象出六足运动的基本原理。 仿生六足爬行机器人是模仿动物的线性运动形式,选用腿式结构就可以完成多种移动功能的一中特种机器人。依据工业机器人的标准定义,我们可以将仿生六足机器人理解成“一种由计算机控制的用足机构推进的地面移动装置”来区别于行走式机械玩具和固定行走模式的机械装置。我们经常将足数多于或等于四的步行机器人称之为多足
18、步行机器人,这类步行机器人可以在不平的路面上进行稳定地行走,它也可以取代轮式车完成在一些复杂环境中的运输作业,这样就造就了多足步行机器人在军事运输及探测、矿山开采、水下建筑、核工业、星球探测、农业及森林采伐、教育、艺术及娱乐等许多领域有着极其广阔的应用前景。自20世纪以来,多足步行机器人技术一直是国内外机器人领域研究的热点之一。为了探索多足步行机器人技术的研究前沿,为我国多足步行机器人工程实用化开发提供关键技术的支持,开展多足步行机器人相关理论和技术的研究具有十分重要的科学意义和应用价值。第2章 六足仿生机器人系统设计2.1 机器人系统总体的设计方案 具体的如下图2-1所示:图2-1 机器人系
19、统总体框图2.2 本次设计系统方案论证2.2.1 六足仿生机器人的行走方案论证 方案一:通过市场调研后发现,我们现在常见的六足机器人它们的行走基本是以每个足上有几个舵机来实现它的多自由度的运动,它们行走稳定,并且也可实现多种方式的行走。但是这种方案花费较大。并且难度较高 方案二:我经过查阅大量的国内外相关资料和文献,我找到了以中每个腿只有一个自由度也能实现前进,后退,转弯运动的方案,它的缺点就是不能适应各种地形,并且行走起来姿态不是很好。 经过反复的研究和结合自身的能力,最终选择了第二天方案在本次的设计中。2.2.2 驱动器模块的方案论证 一、选用步进电机来驱动六足机器人的行进,步进电机也称之
20、为脉冲马达,它实际上是一个电脉冲信号转换成角位移的机电装置。属于机电结构串行式数/模转换器。工作原理是定子按相有节拍的直流励磁,形成电磁铁效应从而可吸附能转动的转子衔铁,并产生转矩去驱动生产机械。 方案一:用两片单片机芯片控制六路方波输出,一个单片机芯片分别控制三路方波输出,即一片单片机芯片控制步行机一条腿的运行。整个步行机得用两个单片机控制系统控制。下图2-2为步行机单腿控制框图。图2-2 步行机单腿控制方框图 这种方案虽然使软件编程大为简化,但是它却远远的加大了硬件电路的复杂程度,因此此种方案不可取。 方案二:用一片单片机芯片控制整个六路方波输出,即用一片单片机芯片控制整个步行机的运行,如
21、下图2-3为整个步行机单片机控制系统.图2-3 步行机单片机控制系统 这种设计方案硬件电路较为简化,它可以较好的发挥单片机的功能,只是这种方案中,软件编程较为复杂,应选用指令功能强的单片机芯片,而这个问题却比较容易解决。 二、选用直流电机来驱动六足机器人的行进,这是最最普通的电机。直流电机最大的问题是无没法精确控制电机转的圈数,也就是位置控制,必须加上一个编码盘,来进行反馈,来获得实际转的圈数。但是直流电机的速度控制相对就比较简单,用一种叫PWM(脉宽调速)的调速方法可以很轻松的调节电机速度。现在也有很多控制芯片带调速功能的。选购时要考虑的参数是电机的输出力矩,电机的功率,电机的最高转速。 三
22、、选用微型伺服马达来驱动六足机器人的行进,微型伺服马达也称之为舵机。微型伺服马达(舵机)的特点就是:微型伺服马达(舵机)扭力较大,控制较为简单,组装比较灵活,而且相对于其它的驱动器也相对经济,但微型伺服马达(舵机)也有它的不足支出:例如微型伺服马达(舵机)是一个较为精细的机械部件,再超出了微型伺服马达(舵机)的承受能力之外的力就会导致微型伺服马达(舵机)损坏,其次微型伺服马达(舵机)里面有藏电子控制电路,所以不正确的电子连接将会会导致微型伺服马达(舵机)的损坏,所以,我们很有必要在使用前了解微型伺服马达(舵机)的工作原理,这样可以避免造成没有必要的损失和损坏。 结合自身所掌握的能力,和对以上三
23、个驱动器的认知程度,最终选择采用微型伺服马达(舵机)为本次设计的驱动器。2.2.3 本设计控制器方案论证 我根据照本次谁题目的要求,因为控制器主要用来控制电机,所以红外遥控器将信号传输给控制器,让控制器可以做出相应处理,并最终实现电机的前进、后退和转向。 方案一:本次设计选用AT89S51单片机芯片来作为系统控制的方案。AT89S51单片机芯片的算术运算功能较强,它的软件编程灵活、并且自由度大,与此同时51单片机芯片功耗低、体积小并且技术较为成熟。 方案二:亦可以选用ARM芯片作为系统的控制器,ARM芯片优点就是它的系统功能很强大,ARM芯片上外设集成度搞密度很高,它提高了稳定性,并且ARM芯
24、片系统的处理速度也很高,它非常适合作为大规模实时系统的控制核心。当然,ARM芯片的难度也较大。 就以上两种方案来说,自己对51单片机较为熟悉,故选取了第一种方案在本次设计中。2.2.4 供电模块的方案论证 本次设计中整个系统需要电源的是,红外接收和发射设备,51单片机芯片,微型伺服马达(舵机)。微型伺服马达(舵机)所需要电压为5V,所以它需要通过LM7805芯片将12V电压转换成5V来进行供电。同时在微型伺服马达(舵机)和直流电机工作时,电路中的电流亦会产生较大的波动。 方案一:选用双电源供电。 我们通过两个相对独立的电源分别对不同的模块去进行供电。这种方案的优点是,可以减少波动,和单片机稳定
25、性比较好,也可以让机器人能够更好的运动起来,这种方案它的唯一的缺点就是会增加重量。 方案二:选用单电源供电。 通过单电源来对整个系统进行全面的供电,这种方案的优点是,领域减轻重量,操作较为简单。但不得不考虑到系统中各个部分它们所需要的电压不一样,则需要通过LM7805来进行转换,但当同时工作时,有可能会产生电流过大,导致烧坏电压转换芯片LM7805,活着烧坏51单片机。与此同时,较大的电流波动也有可能会影响到51单片机的稳定性。 依据上述两个方案各自的优缺点,我最终选择第一种方案的供电方式在本次设计中。2.2.5 红外遥控器的论证 本次设计是需要机器人能够完成前进、后退和转弯运动,机器人的运动
26、形式比较少,因此我们可以选用简单的四个按键的遥控器就能实现。2.2.6 系统设计的最终方案 (1)本次设计中选用AT89S51单片机芯片作为主控制器。 (2)六足仿生机器人行走的腿部选用微型伺服马达(舵机)进行驱动,并且每个足有且仅有一个自由度。 (3)我选择使用较为简单的红外遥控器来控制六足机器人的线性行走。 (4)本次设计中选用双电源来进行供电,5V干电池供微型伺服马达(舵机)使用,并且12V电压经电源转换芯片LM7805转化为5V后给51单片机芯片使用,第3章 六足仿生机器人步态线性行进的分析与设计3.1 六足仿生机器人的线性行进原理 步行机器人是建立在运动摸型、动力模型、控制模型基础上
27、,经过运动学和控制学的分析综合而得出的。 并且,机器人的步态设计是实现步行的关键之一,为达到较为理想的步行, 考虑下列要求: (1)步行平稳、协调, 进退自如, 无左右摇晃及前后冲击; (2)机体和关节间没有较大的冲击, 特别是在摆动腿着地时,与地面接触为软着陆; (3)机体保持与地面平行,且始终以等高运动, 没有明显的上下波动; (4)摆动腿跨步迅速, 腿部运动轨迹圆滑, 关节速度与加速度轨迹无畸点; (5)占空系数的合理取值。 天牛类昆虫一般都不是六足同时直线前进,而是将三对足分成两组,以三角形支架结构交替前行。身体左侧的前、后足及右侧的中足为一组,右侧的前、后足和左侧的中足为另一组,分别
28、组成两个三角形支架。当一组三角形支架中所有的足同时提起时,另一组三角形支架的三只足原地不动,支撑身体并以中足为支点,前后胫节的肌肉收缩,拉动身体向前,后足胫节的肌肉收缩,将虫体往前推,因此身体略作以中足为支点的转动,同时虫体的重心落在另一组“三角形支架” 的三足上,然后再重复前一组的动作,相互轮换周而复始。这种行走方式使昆虫可以随时随地停息下来,因为重心总是落在三角支架之内。这就是典型的三角步态行走法 。运动时六腿呈两组三角形交替支撑迈步前进。其行走轨迹并非是直线,而是呈“之”字形的曲线前进。 在机器人的行走过程中,足的状态有立足(着地),游足(不着地)两种状态。在立足状态中,足着地,这一足就
29、有负载,因此运动速度不能太快;而在游足状态中,该足没有负载,可以快速运动,以便节省运动一步所需的时间。 本次设计中选用了三角步态的运动,三角步态示意如下图3-1所示。其中1,3足联动,4,6足联动,2,5足也是联动。接触地面的腿(如下图图中黑方块所示),这样就形成了稳定的三角形结构。这样的模型通常会保持直立平稳的走姿,就不会出现走路时摔跟头的情况。 六脚三个舵机的控制方式是已知的实现复杂运动的所需最少舵机的实现方式,总共实现前进,后退,前左传,后左传,前右转,后右转六种运动姿态,这也为实现后续控制所要求的复杂运动提供了机械基础。本机械部分采用了前进,后退,左转,右转四种方式。图3-1六足机器人
30、的三角步态行进法由图3-1可以看出,一共用了三个舵机,两个分别在两边,一个在中间,每一边的前腿和后腿是联动的,只有一个自由度,只能做前后移动;中间两条腿是联动的,只能做左右摆动。行走原理是:中间的舵机左右摆动,左中腿和右中腿交替着地,以使两边的腿分时产生推动身体向前的动作,即:左中腿着地时,右前腿和右后腿起作用,当右中腿着地时,左边前后两条腿起作用。中间的舵机在运动相位上始终与两边的腿相差90度;当左右两个舵机同相位时,机器人转弯;当左右两个舵机相位相差180度时,机器人前进或后退。3.2 六足机器人行走时的具体分析 本次设计需要使机器人可以进行前进、后退、左转和右转这四种运动。下面就以其中的
31、前进和左转来进行详细的分析和叙述。 前进:第一步,如下图图3-2所示,5足(立足)支撑并抬高4、6足(游足)使机器人离开地面,与此同时2足(游足)离开地面,1、3足(立足)接触地面并开始向后移动动,然后使机体以5足为中心向右转动一定的角度,同时,4、6足推向前摆动一定的角度,这样就实现了半步,紧接着2足(立足)支撑并且抬高1、3足(游足)使它们离开地面,然后同时5足(游足)也离开地面,4、6足(立足)接触地面并向后移动动,然后使机体以2足为中心向左转动一定角度,同时,3、5腿像前摆动一定角度,从而实现了一步。图3-2 机器人前进步态示意图 左转:第一步,如下图图3-3所示,5足(立足)支撑并同
32、时抬高4、6足(游足)使其离开地面,紧接着2足(游足)离开地面,1、3足(立足)接触地面并且向前移动,然后使机体以5足为中心向左转动一定的角度,同时,4,6足推向前摆动一定的角度,紧接着2足(立足)支撑并且抬高1、3足(游足)使其离开地面,紧接着5足(游足)离开地面,4、6足接触地面并且向后移动,然后让机体以2足为中心向左转动一定的角度,同时,1,3足向后摆动一定的角度,这样就最终实现的机器人的左转,同理可知,当2足(立足)支撑并同时抬高1、3足(游足)使它们离开地面,紧接着5足(游足)也离开地面,4、6足(立足)接触地面并且向前移动,然后使机体以2足为中心向右转动一定的角度,同时,1、3足推
33、向前摆动一定的角度,紧接着5足(立足)支撑并且抬高4、6足(游足)使其离开地面,紧接着2足(游足)离开地面,1、3足接触地面并且向后移动,然后让机体以5足为中心向左转动一定的角度,同时,4、6足向后摆动一定的角度,这样就最终实现的机器人的右转。图3-3 机器人左转步态示意图3.3 六足机器人的线性步态稳定性分析 如下图图3-5所示:点A 、B 、C 分别是六足机器人的左前腿、右中腿、左后腿在地面上的支撑点。三角形ABC 是由三条支撑腿所构成的一组支撑三角形。取机器人本体的重心O 为坐标原点, Y 的正方向为机器人的前进方向, 设支撑点A 、B 、C的水平坐标分别为A(xA , yA)、B(xB
34、 , yB)、C(xC , yC), 各点的z 坐标都相同, 点A、B、C是机器人重心到支撑三角形各边的垂足点, d1 、d2 、d 3 是重心到各边的相应的距离。 直线AB 的方程为: 斜率,则直线OA的斜率。图3-5 三角步态稳定裕量计算题 它的直线方程为:,以上两直线AB和OA的交点A的坐标为: 式中的是线段AB的距离的平方。线段OA长: 同理我们也可以求出和。 则六足机器人以三角步态行走时, 其最小稳定裕量判据则六足机器人以三角步态行走时, 其最小稳定裕量判据为:d=min,。 我们可以假设步态三角形三点的水平面坐标为A (X ,Y),B (X ,Y),C (X ,Y),而机器人本体重
35、心就在坐标原点上。机器人朝前进方向运动一个步长L1后,支撑三角形变为,如下图图3-6所示。然后再向前运动一个步长后,其机器人重心仍落在ABC内,为稳定的步态三角形,否则为不稳定的步态三角形。在三角形步态中,若步态三角形在运动过程中是不变形的,则称此时的位置是协调的。这亦是此结构的优点,它虽然简单,但是稳定性良好。图3-6 六足机器人的坐标分析第4章 驱动器模块的设计4.1 微型伺服马达(舵机)的内部结构结施 一个微型伺服马达内部包括了一个小型直流马达;一组变速齿轮组;一个反馈可调电位器;及一块电子控制板。其中,高速转动的直流马达提供了原始动力,带动变速(减速)齿轮组,使之产生高扭力的输出,齿轮
36、组的变速比愈大,伺服马达的输出扭力也愈大,也就是说越能承受更大的重量,但转动的速度也愈低。它的具体内部结构如下图图4-1所示:图4-1 微型伺服马达的内部结构4.2 微型伺服马达(舵机)的工作原理 一个微型伺服马达是一个典型闭环反馈系统,其原理可由下图图4-2表示:图4-2 微型伺服马达的原理图图4-3 机器人专用伺服马达工作原理 减速齿轮组由马达驱动,其终端(输出端)带动一个线性的比例电位器作位置检测,该电位器把转角坐标转换为一比例电压反馈给控制线路板,控制线路板将其与输入的控制脉冲信号比较,产生纠正脉冲,并驱动马达正向或反向地转动,使齿轮组的输出位置与期望值相符,令纠正脉冲趋于为0,从而达
37、到使伺服马达精确定位的目的。4.3 微型伺服马达(舵机)的控制 标准的微型伺服马达有三条控制线,分别为:电源、地及控制。电源线与地线用于提供内部的直流马达及控制线路所需的能源,电压通常介于4V6V之间,该电源应尽可能与处理系统的电源隔离(因为伺服马达会产生噪音)。甚至小伺服马达在重负载时也会拉低放大器的电压,所以整个系统的电源供应的比例必须合理。 输入一个周期性的正向脉冲信号,这个周期性脉冲信号的高电平时间通常在1ms2ms之间,而低电平时间应在5ms到20ms之间,并不很严格,下表表示出一个典型的20ms周期性脉冲的正脉冲宽度与微型伺服马达的输出臂位置的关系:图4-4 微型伺服马达脉宽与输出
38、臂位置关系4.4 微型伺服马达(舵机)的运动速度 伺服马达的瞬时运动速度是由其内部的直流马达和变速齿轮组的配合决定的,在恒定的电压驱动下,其数值唯一。但其平均运动速度可通过分段停顿的控制方式来改变,例如,我们可把动作幅度为90的转动细分为128个停顿点,通过控制每个停顿点的时间长短来实现090变化的平均速度。对于多数伺服马达来说,速度的单位由“度数/秒”来决定。4.5 微型伺服马达(舵机)的注意事项 (1)普通的模拟微型伺服马达不是一个精确的定位器件,即使是使用同一品牌型号的微型伺服马达产品,他们之间的差别也是非常大的,在同一脉冲驱动时,不同的伺服马达存在10的偏差也是正常的。 (2)由于伺服
39、马达的输出位置角度与控制信号脉冲宽度没有明显统一的标准,而且其行程的总量对于不同的厂家来说也有很大差别,所以控制软件必须具备有依据不同伺服马达进行单独设置的功能。 (3)要特别注意,绝不可加载让伺服马达输出位置超过90的脉冲信号,否则会损坏伺服马达的输出限位机构或齿轮组等机械部件。 (4)保持舵机使用环境的清洁,避免灰尘、腐蚀性气体和潮湿空气的污染。4.6 微型伺服马达(舵机)的电源引线 伺服马达(舵机)的电源引线有三条,如下图图4-5所示:图4-5 微型伺服马达的电源引线 上图中红色的线是控制线,接到控制芯片上。中间的是工作电源线,一般工作电源是5V。 第三条是地线。4.7 舵机的选取 由于
40、机体材料比较轻,整个机器人重量小,我选用的伺服马达型号为FUTABA-S3003。FUTABA-S3003的主要技术参数如下:l 转速:0.23秒60度。l 力矩:3.2kgcm。l 尺寸:40.4mm19.8mm36mm。l 重量:37.2g。l 5V电源供电。 控制周期脉冲宽度为20ms。送出不同的正脉冲宽度就可以得到不同的控制效果。控制正脉冲宽度如下:l 正脉冲宽度为0.3ms时,伺服马达反转。l 正脉冲宽度为2.5ms时,伺服马达正转。l 正脉冲宽度为1.4ms时,伺服马达回到中点。 下图图4-6为FUTABA-S3003舵机的内部电路:图4-6 FUTABA-S3003舵机的内部电路
41、第5章 机器人控制系统硬件设计5.1 本设计的系统硬件电路设计 本次设计的系统是选用51单片机芯片作为控制核心,然后再经过红外遥控器发出的信号去控制每个舵机进行有顺序的左右转动,进而最终达到实现机器人的基本线性运动状态。 系统的控制原理图如图5-1所示:图5-1 系统的控制原理图 有上图我们可以很清楚的知道,本次设计的整个系统是由电机驱动电路、红外遥控电路和供电电路三个电路模块组成。5.2 51单片机芯片的简介 各计算机公司,厂家生产的单片机芯片之中,MCS-51为例是其中的佼佼者,在MCS-51系列之中,有89C51,8051,8751,89C51等十余种芯片/89C51与其它几种比较,只是
42、芯片内部的RAM,ROM有所不同,因此本系统选用价格较低廉的89C51单片机芯片。 AT89S51 为 ATMEL 所生产的可电气烧录清洗的 8051 相容单芯片,其内部程序代码容量为4KB,并且89C51是一个8位单片机芯片,内部有8位CPU,128字节RAM,有二十一个特殊功能寄存器,4个I/O口,32跟I/O线,经外扩展可外部寻址64KB数据存储区和程序存储区。内有振荡器,有二个16位定时/计数器,一个全双I串行口,具有两个优先级五个中断,T0,T1,INT0,IN1,及串行中断,软件指令系统中,有强大的布尔处理功能。 在布尔系统中,主要应用89C51的以下几个部分: P0口:用做系统的
43、数据总线和地址总线的低8位 P1口:为准双向口,每一位分别定义为输入线或输出线 P2口:用做系统地址总线高8位。 P3口:主要采用P3口的第二功能,作为系统的控制总线,另外,还在89C51内部RAM中建立一堆栈区,由于89C51内部128字节RAM中,仅有30H7FH空间是用户可用的I区,因此,堆栈区设置60H(栈指令)。5.2.1 51单片机的最小系统 51单片机最小系统能够运行的必要条件就是:电源电路、晶振电路和复位电路。下图图5-2是51单片机的最小系统原理图:图5-2 单片机最小系统原理图5.2.2 复位电路 AT89S51单片机的第九脚为复位引脚,系统上电后,时钟电路开始工作,只要R
44、ST引脚上出现大于两个机器周期时间的高电平即可引起单片机执行复位操作。有两种方法可以使单片机复位,即在RST引脚上加上大于两个周期的高电平或WDT计数溢出。单片机复位后,PC=0000H,CPU从程序存储器的0000H开始取值执行。单片机外部复位电路有上电自动复位和按键手动复位两种。5.2.3 时钟电路 AT89S51单片机内部有一个高增益反相放大器,引脚XTAL1和XTAL2分别是该放大器的输入端和输出端,如果在引脚XTAL1和XTAL2两端跨接上晶体振荡器(晶振)或陶瓷振荡器就构成了稳定的自激振荡电路,该振荡器电路的输出可直接送入内部时序电路。AT89S51单片机的时钟可由两种方式产生,即
45、内部时钟方式和外部时钟方式。 1、内部时钟方式,内部时钟方式即是由单片机内部的高增益反相放大器和外部跨接的晶振、微调电容构成时钟电路产生时钟的方法,其工作原理如下图图 5-3(a)所示。外接晶振(陶瓷振荡器)时,C1、C2的值通常选择为30pF(40pF)左右;C1、C2对频率有微调作用,晶振或陶瓷谐振器的频率范围可在1.2MHz 12MHz之间选择。为了减小寄生电容,更好地保证振荡器稳定、可靠地工作,振荡器和电容应尽可能安装得与单片机引脚XTALl 和XTAL2靠近。由于内部时钟方式外部电路接线简单,单片机应用系统中大多采用这种方式。内部时钟方式产生的时钟信号的频率就是晶振的固有频率,常用f
46、soc来表示。如选择12MHz 晶振,则 fsoc=12106Hz。图5-3 时钟电路 2、外部时钟方式。外部时钟方式即完全用单片机外部电路产生时钟的方法,外部电路产生的时钟信号被直接接到单片机的XTAL1引,此时XTAL2开路,具体电路如图5-3(b)所示。5.3 系统的供电单元介绍 不同电路模块所需要的工作电压和电流各不相同。AT89S51单片机需要提供5V的工作电压,舵机所需电压为5V,本设计通过12V的稳压电源供电,然后通过三端稳压器LM7805将电压变换为5V电压供给电路系统。电源系统的电路图如下图图5-4所示:图5-4 电源系统电路图5.4 微型伺服马达(舵机)驱动电路介绍 本系统通过5V电池提供给舵机动力实现运动,舵机正负极接电池正负极,三个舵机分别再接P1.