版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
目录第1章绪论 11.1论文研究的背景及意义 11.2自动导引小车的定义及特点 21.3AGV的发展历史 31.4自动导引小车的应用现状 41.5AGV的关键内容及本论文的研究内容 6第2章AGV中机械部分零件的设计 72.1设计任务 72.2总体结构设计 72.3电动机的选择 82.4联轴器设计 102.5蜗杆传动设计 112.6轴的设计 132.7滚动轴承的选择计算 19第3章AGV结构设计以及动力学建模 243.1AGV系统结构设计 243.2AGV小车的动力学建模 25第4章控制系统与行走策略 344.1控制系统 344.2行走策略 454.3传感器采样 464.4控制策略 464.5动作类型 46第5章总结与展望 485.1全文总结 485.2研究展望 49参考文献 50第一章绪论内容提要:本章介绍本论文研究的重要意义,综述自动导引小车的基本概念、组成及其发展简史、应用现状和前景,并分析目前自动导引小车的主要引导方式、关键技术,在此基础提出了本论文的研究内容。1.1论文研究的背景及意义21世纪制造业将进入一个新阶段,敏捷制造将成为企业的主导模式。能否抓住市场机遇开发出新产品将是企业赢得竞争的主要手段。要减小生产成本对生产批量的依赖,就要发展敏捷制造装备。繁重制造装各的可编程、可重组和快速响应能力使得在进行小批量生产时,可实现接近中、大批量生产的效率。由于机器人具有自主规划、可编程、可协调作业和基于传感器控制等特点,它将成为可重组的敏捷制造生产装备及系统的重要组成部分,为传统制造企业向敏捷制造企业跨越发展提供重要的技术支持。自动导向小车((AutomatedGuidedVehicle简称AGV)是移动机器人的一种,是现代制造企业物流系统中的重要设备,主要用来储运各类物料,为系统柔性化、集成化、高效运行提供了重要保证。AGV主要有两类形式,一种是固定路径AGV,它的运行路径是固定的,且有轨道,故导引技术相对简单;另一种是自由路径AGV,由于没有轨道,它为AGV自由运行提供了最大可能,但由于技术限制,AGV沿任意路径自由运行仍是一个有待解决的技术难题。在以往的生产线上,导向式AGV是人们经常采用的方式,有导轨式、磁导引式等方法。这些方法都需要预先规划好AGV的运行路线,而且生产车间的装置不能随意移动。随着生产车间智能化的提高,导向式AGV明显降低了AGV的柔性。因此,非导向式AGV将成为敏捷制造物流系统中的主要选择。在非导向式AGV系统中,AGV的运行路径不需要由附加设备决定,而且当车间的布局变化后,只要及时改变规划系统的软件参数即可满足路径规划要求。资料显示:在产品生产的整个过程中,仅仅有5%的时间是用于加工和制造,剩余的95%都用于储存、装卸、等待加工和输送:在美国,直接劳动成本所占比例不足生产成本的10%,且这一比例还在不断下降,而储存、运输所占的费用却占生产成本的40%.因此,目前世界各工业强国普遍把改造物流结构、降低物流成本作为企业在竞争中取胜的重要措施,为适应现代生产的需要,物流正在向着现代化的方向发展。自动导引小车AGV适应性好、柔性程度高、可靠性好、可实现生产和搬运功能的集成化和自动化,在各国的许多行业都得到广泛的应用。目前,在我国某些汽车、烟草行业,AGV已投入使用,并取得了良好的经济效益。但从使用形式来看,大都采用属于固定路径导向范畴的电磁导引AGV,无固定路径自主导向的AGV由于诸多问题未能完全解决,还没有达到实用。因此进行自山路径导向式AGV的研究,不仅对敏捷物流设备的研制和应用有现实的工程意义,而且对移动机器人路径规划有重要的理论意义。1.2自动导引小车的定义及特点根据美国物流协会定义,AGV是指装备有电磁或光学自动导引装置,能够沿规定的导引路径行驶,具有小车编程与停车选择装置、安全保护以及各种移载功能的运输小车。AGV是以电池为动力、装有非接触导向装置,独立寻址系统的无人驾驶自动运输车。AGVs是自动导引车系统,它由若干辆沿导引路径行驶,独立运行的AGV组成。AGVs在计算机的交通管制下有条不紊地运行,并通过物流系统软件而集成于整个工厂的生产监控与管理系统中。应用AGV具有很多特点:(1)AGV可十分方便地与其它物流系统实现自动连接,如AS/RS(通过出从库台)、各种缓冲站、自动积放链、升降机和机器人等;实现在工作站之间对物料进行跟踪;对输送进行确认;按计划输送物料并有执行检查记录:与生产线和库存管理系统进行在线连接以向工厂管理系统提供实时信息。(2)采用AGV由于人工检取与堆置物料的劳动力减少,操作人员无需为跟踪物料而进行大量的报表土作,因而显著提高劳动生产率。另外,非直接劳动力如物料仓库会计员、发料员以及运货车调度员的工作的减少甚至完全取消又进一步减低了成本。(3)AGV运输物料时,很少有产品或生产设各的损坏,这是因为AGV按固定路径行驶,不易与加工设备和其他障碍物碰撞。(4)绝大多数AGV的使用者均证明,2到3年从经济上均能收回AGV的投资成本。(5)AGV通过安装在地面之下的电缆或其他不构成障碍的地面导引物,其通道必要时可作其他用处。(6)系统具有极高的可靠性。AGVs由若干台小车组成,当一台小车需要维修时,其它小车的生产率不受影响并保持高度的系统可利用性。(7)节约能源与保护环境。AGV的充电和驱动系统耗能少,能量利用率高,噪音极低对制造和仓储环境没有不良影响。1.3自动导引小车的发展简史世界上第一台AGV是由美国Barrett电子公司于20世纪50年代开发成功的,它是一种牵引式小车系统,小车跟随一条钢丝索导引的路径行驶,并具有一个以真空管技术为基础的控制器。到了60年代和70年代初,除Barrett公司以外,Webb和Clark公司在AGV市场中也占有相当的份额。在这个时期,欧洲的AGV技术发展较快,这是由于欧洲公司已经对托盘的尺寸与结构进行了标准化,统一尺寸的托盘搬运促进了AGV的发展。欧洲的主要制造厂家有Schindler-Digitron,Wagner,HJC,ACS,BT,CFC,FATA,Saxby,Denford和Bleehert等。70年代中期,欧洲约装备了520个AGV系统,共有4800台小车,1985年发展到10000台左右,为美、欧、日之首。其应用领域分布为:汽车工业(57峋,柔性制造系统FMS(8)和柔性装配系统FAS(44%),欧洲的AGV技术80年代初通过在美国的欧洲公司以许可证与合资经营的方式转移到美国。芝加哥的分发中心从欧洲引进直接由计算机控制的AGVs,1981年John公司将AGV连接到AS/RS以提供在制造过程中物料自动输送和跟踪.1984年,通用汽车公司成为AGV的最大用户,1986年己达1407台(包括牵引式小车。叉车小车和单元装载小车),1987年又新增加1662台。美国各公司在欧洲技术的基础上将AGV发展到更为先进的水平。他们采用更先进的计算机控制系统(可联网于FMS或CIMS),运输量更人,移载时间更短,具有在线充电功能,以便24小时运行,小车和控制器可靠性更高。此时美国的AGV生产厂商从23家(1983年)骤增至74家(1985年)。日本的第一家AGV工厂于1966年由一家运输设备供应厂与美国的Webb公司合资开设。到1988年,日本AGV制造厂已达20多家,如大福、Fanuc公司、Murata(村田)公司等。到1986年,日本累计安装了2312个AGVs,拥有5032台AGV。我国AGV发展历史较短。北京起重运输机械研究所、中国邮政科学研究规划院、中国科学院沈阳自动化所、人连组合机床研究所、清华大学、国防科技大学和华东工学院都在进行不同类型的AGV的研制并小批量投入生产。1975年北京起重运输机械研究所完成我国第一台电磁导引定点通信的AGV,1989年北京邮政科学研究规划院完成我国第一台双向无信电通信的AGV。该院已能进行AGV的批量生产,己生产的和正在制造的AGV达23台(截止于1996年)。沈阳自动化所在AGV技术方面己取得了多项研究开发成果和专利,解决了AGV车体设计、控制、导航和高度管理等一系列关键技术问题,形成了装配型AGV和搬运型AGV两大系列产品,成为国内唯一能够提供自主品牌AGV产品的单位。其产品性能国内领先,达到国际先进水平,井于19%年度将搬运型AGV系统技术出口韩国三星公司,实现了高技术出口。沈阳自动化所为沈阳金杯汽车厂生产了六台AGV,用于装配线上,可以说是汽车土_业中用得较成功的AGV。以上的AGV均为固定路径导引方式。清华大学独立研制的“自由路径自动导向AGV'属无固定路径导引的类型,在路径跟踪研究方面具有较高的水平。我国越来越多的工厂,科研机构已采用AGV为汽车装配、邮政报刊分拣输送、大型军械仓库、自动化仓储系统服务。如:上海金山化工厂、华宝空调器厂、哈尔滨飞机制造厂、上海新车站邮政枢纽等,所采用的AGV既有国外引进也有国产的。80年代,AGV就已进入我国市场,今后必将得到迅速发展和普及应用。这不仅是现代工业迅速发展的需要,更主要是AGV本身所独具有的优越性所决定的。AGV自动导向车系统,是伴随着柔性装配系统、计算机集成制造系统以及白动化立体仓库产业发展起来的,是物流系统中革命性的换代产品。作为一种高效物流输送设备和工厂自动化的理想手段,随着经济的发展,在我国AGV的应用领域必将越来越大。1.4自动导引小车的应用现状由于AGV具有机能集中、地上系统简单、施工和系统构成容易等优点,因此,广泛地应用在机械加工、汽车制造、港口货运、电子产品装配、造纸、发电厂、电子行业的超净车间等诸多行业。其运行速度可达到百米/分钟,运输能力可以从几千克到儿十吨。AGV是一种非常有前途的物流输送设备,尤其在柔性制造系统(FMS)和柔性装配系统(FAS)中被认为是最有效的物料运输设备。随着电子和控制技术的发展,AGV的技术也在不断进步,正在朝着性能更优越、更廉价、自由度更高、超大型化和微型化方向发展。其应用领域也在不断扩展。这种十儿年前只是用作工厂内的物流输送设各,现在己经不仅仅局限于工厂之内,己成功地应用到办公室、饭店、医院和超级市场等诸多部门,并且取得了很好的效果。AGV的应用领域主要在制造业,在重型机械及部分非制造业中也有应用。AGV在制造业中主要用于物料分发、装配和加工制造二个方面[411。其中装配作业中AGV用量最大,而汽车工业又是AGV的应用大户。美国通用汽车公司90%的AGV用于汽车装配线,西欧各国用于汽车装配的AGV占整个AGV数量的57Yo。物料分发主要是指生产工序间的物料移送和仓库作业中的物料移送。随着电子工业的进一步发展,电子工业中AGV的使用极具市场潜力。其原因在于消费者需求的变化日益加快,生产系统必须适应市场的变化要求,其中FMS(柔性制造系统)即为以灵活的生产方式适应市场变化的制造方式,对于FMS来说,各加工单元之间的中(小)批量元器件的送发效率要求极高,而AGV能提供柔性最好的输送,AGV可以很方便地对AGV的输送工艺路线进行编程,使之按要求的路径和方式到达装配线的指定位置。在净化室中,AGV更可大显身手,它可满足净化耍求极高的操作。在重型机械行业中,AGV主要用来运送模具和原材料(如成卷带钢等)。因而AGV要求承载量人,通常为2.22-4.5t,最大者可达6.3t。配各了功率较大的移藏装置也是这类AGV的特点。在AGV上配备大型机器人用以对大型金属构件进行喷漆(如屹机骨架的喷漆)是AGV在重型行业中的应用之一在非制造业中,AGV的应用越来越普遍。现代化的庆院安装AGV系统,把取样从门诊部自动运送到中央化验室;把药物、医疗用品、食品、衣着用品从中央物料管理中心输送到医院的各个部门。邮政部门也广泛采用AGV,如将邮件进台区的邮件输送到处理区,将处理区的邮件输送到邮件出台区。为了加大运输量,使用了牵引式AGV系统,一次可以牵引多台邮件车。大型的办公大楼也开始安装AGV系统,用以运送邮件、电文和包裹到各个分区部门。宾馆业采用AGV把食品从厨房运送到客房。AGV也可作为机器人的“脚”,使机器人可在更大范围内自动完成作业,如在AGV上配各机器人用于光整水泥地面。在具有核辐射危险的地方,常使用AGV机器人用于核材料的搬运。1.5AGV的关键技术及本论文的研究内容1.5.1自动导引小车的关键技术为使自动导弓}小车成功地完成一项任务,最主要的是如何使小车在复杂的环境中以较小的代价到达目的地。这就涉及到如下几个问题的解决,即:(1)如何从环境中得到自动导引小车周围的障碍物信息及其它相关信息;(2)如何根据内部及外部传感器来回答小车当前处于环境中的什么位置;(3)如何根据小车的当前位置和当前信息确定行动策略;(4)如何产生合适的驱动信号使小车运动在预定的轨迹上。这四个问题的解决对于在实时环境中运动的小乍来说是缺一不可的,与此相对应的技术即为传感器技术、自定位技术、规划决策技术和运动控制技术。1.5.2本论文研究的主要内容:(I)激光导引AGV模型的总体结构设计;(2)激光导引AGV的总体结构分析;1.6本章小结本章介绍了本论文研究的重要意义,综述了自动导引小车的基本概念、组成及其它的发展简史和应用现状和前景,并分析目前自动导引小车的主要引导方式、关键技术,在此基础上提出了本论文的研究内容。激光导引具有精度高、柔性好的特点,本论文研究中用其来实现AGV的引导。第二章AGV中机械部分设计内容提要:本章主要介绍了这次AGV机械部分设计中的一些主要部件的选取。比如说有私服驱动电动机的选取、控制转向的电动机的选取,传动齿轮的选取等。介绍其选取方法只要结构及其主要的参数问题。2.1设计任务 设计一台自动导引小车AGV,可以在水平而上按照预先设定的轨迹行驶。本设计采用AT89C51单片机作为控制系统来控制小车的行驶,从而实现小车的左、右转弯,直走,倒退,停止功能。其设计参数如下:自动导引小车的长度:500mm自动学引小车的宽度:300mm自动导引小车的行驶速度:100mm/s2.2总体结构设计 AGV的机械结构主要由车架,移载装置,驱动部件三大部分组成。其中驱动部件是机械部分的核心部分,它主要完成小车的行走,导向等任务。本设计中的小车使用的是三轮二驱,即后面两个为电机驱动的定向轮,前面为万向轮。移载装置是由几根滚筒组成,将这些滚筒间隔的固定在小车,然后通过一个步进电机带动它们转动,这样就可以将货物自动的卸载。在进行小车的机械设计时需要在小车上面预留一些位置用来放置红外模块,超声波模块,磁检测传感器,主控板和蓄电池等设备。控制结构主要由主控板、超声波避障模块、红外定位模块、磁检测传感器引导模块、步进电机驱动模块、电量检测模块、指示灯模块等部分组成。控制结构的每个模块都和机械部件有紧密的联系,它们必须结合机械部件进行设计和调试。以下简要介绍硬件个模块的功能第三章AGV系统结构设计以及动力学建模型内容提要:设计了一辆前后轮分独立驱动的小车,后轮用步进电机驱动,实现动力源,前轮由私服电机驱动,实现转向。并建立其动力学方程。3.1AGV系统结构设置所设计的AGV小车的模型如图2.1所示。小车采用前后轮独立驱动的模式,后轮由电机带动齿轮传动,给与合适的动力源。前轮有电机带动直推轴焊接横轴来实现转向。四轮结构与三轮结构相比有较大的负载能力和平稳性。蓄电池组2.伺服交流电动机3.激光扫描仪4.车载控制器5.无线通讯装置6.伺服交流电动机7.减速器8.驱动车轮图2.1AGV小车的模型图由于采用了两轮独立驱动差速转动的方式,因此两个驱动车轮的速度的同步性成,成为车辆稳定运行的一个重要指标。鉴于此,齿轮减速结构与车轮通过柔性连轴器来连接。3.2AGV小车的动力学建模自从AGV问世以来,人们在自动导引车的控制过程中一般满足于基于运动学的控制模型,而很少有人进行基于动力学的控制设计等方面的内容。事实表明,根据AGV车体动力学模型,可以得到直接的电机输入与行走、导向车轮转速的非线性的耦合关系,将对指导车体机械结构设计、路径规划以及合理的路径跟踪控制规律设计有重要而且深远的意义。由于AGV在实际问题中有较严格地面要求的环境中运动,车速较低,限定了加速度的问题,而不会发生明显的车体“上跳”运动的现象出现,故可以在二维空间来研究其动力学模型。现以我以后轮为电机带动齿轮来实现动力驱动的方式传达力矩,前轮则为由电机直接带动轴的转动从而达到转动的方式来实现转向的AGV为例建立动力学模型。AGV由车体、蓄电池和充电系统、驱动装置、转向装置、精确停车装置、车上控制器、通信装置、信息采样子系统、超声探障保护子系统、移载装置和车体方位计算子系统等等组成。“智能”较高的AGV都有车上控制器,它类似于机器人控制器,用以对AGV进行监控。控制器计算机通过通信系统从地面站接受指令并报告自己的状态。通常监控器可完成以下监控:手动控制、安全装置启动、蓄电池状态、转向极限、制动器解脱、行走灯光、驱动和转向电机控制和充电接触器等。某些AGV具有编程能力,允许小车离开导引路径,驶向某个示教地点,完成任务后路原道返问到导引路径上来根据上述的介绍,我们可以不难看出同步行进的四轮AGV机械结构分为以下几个部分:车体部分:包括车架、蓄电池、驱动电机、转向电机和齿轮减速机构等,车体受到由后轮传动来的驱动力和前轮的反作用力的作用。驱动后轮:所受的外力可能有两部分组成。一部分是地面的作用力:另一部分是来自车体给于的外力。其中这部分力包括自身的支撑反力和电机产生的等效驱动力矩等。通过齿轮改变转速来调节速率可以得到不用的转速,从而改变AGV的的运动行进方向,已经更好的做到预定的线路跟踪。前轴和连轴:起到支撑作用,同时车轮和竖轴是同轴的,前轮的转动有地面给于的摩擦力也有电机传递的力矩。3.2.1车体运动建模车体受力的示意图见图2.2。图中L、A为驱动左后轮、和驱动右后轮与车体的连接处。图中的R、B为导向左前轮和导向又前轮与车架连接处的垂直点。车体在L、R、A、和B处分别是受到图示沿X、Y方向的阻力和沿Z方向的扭矩。C则为车体的重心,通过C建立起瞬时惯性坐标系O-XYZ,X轴则平行于L=R的连线,Z轴垂直于车体的平面。为车体集合参数,分别表示的是车体质心的X向、Y向的速度和Z向的角速度。在经过了上述的假设的基础之上,我们不难可以得到车体动力学方程如下:(2.1)(2.2)(2.3)上面式子中分别为车体质心的质量和转动惯量。车体的前轮A、B处的运动方程为(2.4)(2.5)(2.6)(2.7)(2.8)(2.9)(2.10)(2.11)车体L和R处运动的方程为:(2.12)(2.13)(2.14)(2.15)(2.16)(2.17)(2.18)(2.19)3.2.2驱动后轮的运动建模左后轮受力图见图2.3所示,图中瞬时惯性坐标系L-与图2.2的方向是一致的,可以认为是由O-XYZ平移到L点从而形成的坐标系,相对应,他们是车体与左轮之间大小相等方向相反的作用力(力矩)和反作用力(力矩)。是驱动电机经过齿轮减速后传递给左轮的驱动力矩,是轴承对左轮的摩擦阻力矩,是滚动阻力矩,是地面对左轮的侧滑动摩擦力,是轴承对左轮的滚动摩擦力,是地面对车轮的扭矩摩擦力矩,是左后轮的转动角速度(为转动轴)。左后轮动力学方程为(2.20)(2.21)(2.22)(2.23)上式中,分别是左后轮的质量‘以及其沿着旋转轴的转动惯量、沿着轴的转动惯量和半径。为其在L-XYZ坐标下的速度,与车体对应点的速度是同一值。是左后轴沿轴的扭转角速度。对于右后轮来说,传动齿轮啮合是在轴中心处,故左右受的力是相同的,因此建立类似的动力学方程为:(2.24)(2.25)(2.26)(2.27)上述各式中,有关物理量的具体意义同对左后轮的说明类似,这里就不做过多说明了。由于AGV速度和加速度均较小的原因,轮子的侧滑阻力很大,假设其中的。这样看来车体将以位于左右轮轴线上的某一点为瞬时速度中心,以角速度w转动,我们根据所了解的知识,我们不难看出一点,通过左右轮转动计算,根据下图2.4所示:即:(2.28)(2.29)将以上的2个式子带入(2.14),(2.18)中可以看到(2.30)(2.3.1)将代入式子(2.12)和式子(2.13)即可得(2.32)(2.33)式子(2.14)和式子(2.15)可改写成(2.34)(2.35)式子(2.4)至式子(2.11)变为(2.36)(2.37)(2.38)(2.39)(2.40)(2.41)(2.42)(2.43)3.2.3车体整体的动力学模型为了能够更好的取得车体整体的动力学模型,根据AGV的实际情况作出如下的简化:(1)左右前轮和轴是一体的,再前行或后退的同时不打滑,只看做是纯滚动,则有:(2)车体设计左右是对称的,则有:(3)左轮的直径及其质量和右轮(4)前轮左右也是一致的和后轮的大小重量以及有些不受力或比较想的部分我们可以忽略不计其的转动惯量,即:在上述简化后的基础上,联立前述车体、左右驱动后轮的动力方程可以得到车体整体的动力学方程。该动力学方程中可以表示为左、右轮所受的动力和左、右轮转动的角速度之间的关系。任何一种导引方法的实现最终都归结为路径跟踪控制的问题上。对于固定路径型的AGV由于具有体现路径的导引媒介物,通过传感器就可直接获得车体对路径的横向偏差和车体方向偏差,以这种偏差作为误差信号通过车体动力学直接对车体进行跟踪控制。但是对于自由路径型AGV,车体对路径之偏差量的获取就要困难得多,以车体方位推算导向的自由路径AGV为例,其方位和对于路径的偏差是通过对车轮转动角度积分计算而获得,其要实现需较大的计算量和通信量。作为一种较好的解决办法是差速驱动的自由路径控制。其路径可简化为一系列直线段和圆弧段的组合。只要保证左右轮的转动角速度满足给定的比例关系(即同步误差为零),AGV就能跟踪这种具有恒定半径(直线和圆弧)的路径。车体动力学方程是实现差速驱动的理论基础之一,结合模糊控制方法,可以实现差速驱动路径跟踪过程。3.3本章小结动力学方程能够帮助AGV的建模、车体结构、刚度设计和路径跟踪控制提供理论依据的基础。本章主要介绍了所设计及其制作的一辆有电机带动齿轮差动驱动后轮,前轮有电机直接控制实现转向的的四轮AGV小车,并建立了所需要的运动学方程。
第4章控制系统与行走策略4.1控制系统4.1.1控制系统总体方案本系统使用AT89C51单片机作为核心的控制运算部分。连接在电机上的数字编码器在电机运转时发出的脉冲信号,经过自行设计和制作的脉冲鉴向电路,可以得到电机的运转方向;来自鉴向电路的正反方向的脉冲信号进入到两块8253计数器进行计数,以获得电机的旋转速度和位移;经过在AT89C51单片机上运行的各种控制程序的适当运算以后,输出的控制量经过两块DAC1208转换器变成模拟量,输出到两块UC3637直流电动机脉宽调制器,通过H桥开关放大器,作为执行机构的速度或者力矩给定,从而控制电机的运转,使整个AGV自动导引小车能够完成所设计的控制任务。整个控制系统的组成框图如下:图4-1控制系统的组成框图1).鉴向伺服电机根据控制要求能够工作在四个不同的象限,作为系统的状态检测部分,必须能够检测电机的转速及分辨电机不同的旋转方向。安装在电机旋转轴上的数字编码器在电机运转时能够产生相位相差90度的两路脉冲信号,电机的旋转方向可以由鉴向电路对此两路脉冲进行鉴向后获得,其原理如图4-2所示。图4-2鉴向原理伺服电机反转时,A相脉冲超前于B相脉冲90度,在cp十端输出反向计数脉冲,当正转时,B相脉冲超前于A相脉冲90度,在cp一端输出正向计数脉冲,见图4-3中的(b)和(c}所示,分辨出的脉冲进入脉冲计数电路进行计数,再由计算机读入进行处理。其电路图见图4-3中的(a)所示。图4-3电机转向分辨电路本次设计使用的数字编码器为500P/R,即电机每旋转一周输出500个脉冲,电机到车轮的减速齿轮的减速比为62:1,因此车轮每前进或者后退一周产生500×62即31000个脉冲,可见分辩率非常高。编码器的脉冲输出为差动形式,鉴向电路接收差动形式的脉冲信号,鉴向后输入到8253计数器。2).计数的扩展为了得到驱动轮运转的速度、位移等,而数字编码器的输出经过鉴向电路提供的是电机的正转和反转脉冲,必须对这些脉冲分别进行计数、运算才能得到所要的速度、位移等状态量。本系统中使用了两块8253计数器,每块芯片具有三个16位计数器。四个独立的计数器即1#、2#、3#和4#分别用于两台电机的正/反转脉冲的计数。8253可编程定时器/计数器可由软件设定定时与计数功能,设定后与CPU并行工作,不占用CPU时间,功能强,使用灵活。它具有3个独立的16位计数器通道,每个计数器都可以按照二进制或二-十进制计数,每个计数器都有6种工作方式,计数频率可高达2MHz,芯片所有的输入输出都与TTL兼容。8253的内部结构框图如图4-4所示;引脚如图4-5所示。图4-48253内部结构框图图4-58253引脚图U6地址为:8000H计数器08001H计数器18002H计数器28003H控制字U7地址为:6000H计数器06001H计数器16002H计数器26003H控制字U6读/写控制逻辑接线:,,;U7读/写控制逻辑接线:,,。U6芯片中计数器0和计数器1用于左轮电机正反转计数,并处于工作方式3。U7芯片中计数器0和计数器1用于右轮电机正反转计数,并处于工作方式3。在中断服务程序中,这四个计数器分别对两台伺服电机的正/反脉冲进行计数,所得到的计数值减掉上一次的计数值,就可以得到在这一时间周期内的各路脉冲数。右轮反转、正转和左论反转、正转的结果分别存于临时变量temp1、temp2、temp3和temp4中,在主程序中通过对它们进行运算就可以得到移动机器人的状态量了。3).中断的扩展AT89C51单片机是使用两个级联的8259A中断控制器来控制中断的。主8259A芯片上的IRQ2扩展成从片上的IRQ8~IRQ15使用。8259A作为一种可编程中断控制器,是一种集成芯片。它用来管理输入到CPU的各种中断申请,主要外围设备,能提供中断向量、屏蔽各种中断输入等功能。每一个8259A芯片都能直接管理8级中断,最多可以用9片8259A芯片级连,由其构成级连机构可以管理64级中断。8259A的外部引脚::数据线,CPU通过数据线向8259A发送各种控制命令和读取各种状态信息。INT:中断请求,和CPU的INTR引脚相连,用来向CPU提出中断请求。:中断响应,接收CPU的中断响应信号。图4-68259A引脚图:读信号,低电平有效,通知8259A将某个寄存器的内容送到数据总线上。:写信号,低电平有效,通知8259A从数据线上接受数据(即命令字)。:片选信号,低电平有效。:端口选择,指出当前哪个端口被访问。:接收设备的中断请求。:级联端,指出具体的从片。在采用主从式级联的多片8259A的系统中,主从片的对应连接在一起。:主从片/缓冲器允许,双功能引脚,双向。它有两个用处:当作为输入时,用来决定本片8259A是主片还是从片。作为输出时,当从8259A往CPU传送数据时,由引出的信号作为总线启动信号,以控制总线缓冲器的接收和发送。本次设计采用两片8259A进行级联:主片的引脚连接从片的中断请求INT,如果某一个引脚下面没有连接从片,则可以直接连接外部中断请求;而主片、从片的中断响应信号和数据信号互相连在一起。主片CAS和从片CAS互相连在一起,当从片数量较多时,可以在主片CAS和从片CAS之间增加驱动器。主片的接高电平。从片的接低电平。在8259A的主从式级联方式中,中断的优先级设置类似于单片机的情况。级联如图4-7所示。图4-78259A的级联4).数模转换器的选择将数字量转换为模拟量的器件称为数/模转换器(digital-analogconverter),简称为DAC。数/模转换器的主要技术指标有分辨率、转换精度、线性误差和建立时间。分辨率指最小输出电压与最大输出电压之比。本次设计采用DAC1208芯片,故其分辨率为。转换精度以最大的静态转换误差的形式给出。DAC1208芯片为12位数/模转换器其最大误差为:,精度为。线性度指DAC的实际转换特性曲线和理想直线之间的最大偏移差。建立时间在数字输入端发生满量程码的变化以后,数/模转换器的模拟输出稳定到最终值±1/2LSB时所需要的时间,当输出的模拟量为电流时,这个时间很短。DAC1208的内部结构及引脚如图4-8和图4-9所示。图4-8DAC1208的内部结构图图4-9DAC1208的引脚图DAC1208内部对输入数据具有两级缓存:8位输入寄存器、4位输入寄存器和12位DAC寄存器,这三个寄存器可以分别选通。DAC1208有三种工作方式:单缓冲方式、双缓冲方式、直通方式。所谓的单缓冲方式就是使DAC1208的两个输入寄存器中有一个处于直通方式,而另一个处于受控的锁存方式。在实际应用中,如果只有一路模拟量输出。所谓双缓冲方式,就是把DAC1208的两个锁存器都接成受控锁存方式。本次设计采用双缓冲方式,目的是为了让两个直流伺服电机能够实现同步。所谓直通方式,输入寄存器和DAC寄存器都接成直通方式,即信号均有效,数据被直接送入数/模转换电路进行数/模转换。图4-10DAC1208双缓冲连接方式U9输入寄存器地址为3FFFHDAC寄存器地址为5FFFHU10输入寄存器地址为1FFFHDAC寄存器地址为5FFFH本次设计采用DAC1208芯片的数/模转换器其连接方式如图4-10所示。为高电平时,选中数据输入到8位输入寄存器;当为低电平时,选中数据输入到4位输入寄存器;片选信号,低电平有效,和输入锁存信号一起决定第一级数据锁存是否有效。第一级允许锁存,高电平有效。写信号1,作为第一级锁存信号,必须和同时有效。写信号2,作为第二级锁存信号,必须和同时有效。控制信号,低电平有效,和一起决定第二级数据锁存是否有效。模拟电流输出端,DAC寄存器全1时最大,全0时为0。模拟电流输出端,和有一个常数差:常数,此常数对应一个固定基准电压的满量程电流。参考电压输入端,可正可负,。5).电机驱动芯片选择电机驱动采用PWM技术来驱动直流伺服电动机。PWM技术为脉宽调制技术其可通过输入直流电压,在其输出可以得到频率固定、脉冲幅度一定、脉冲宽度与输入信号成线性关系的方波脉冲串,利用该方波脉冲串驱动功率放大电路,从而控制伺服电机的转速。采用PWM技术的优点是,PWM具有较高的切换频率,这有助于克服伺服电机的静摩擦力矩,与其线性功率放大器相比,功耗低且效率高,因而在伺服系统中得到了广泛的应运用。为了改善伺服电机的运行特性,必须适当选择PWM的切换频率,其选择可参考以下原则:a)切换频率应能使电机轴产生微振,以克服静摩擦,改善运行特性。即(3-1)其中,为力矩常数,为PWM电源电压,为电感,为电机静摩擦力矩。b)微振的最大角位移应小于设定的位置误差。即(3-3)其中J为转动惯量,为设定的位置误差。c)尽量减少电机产生的高频功耗。即应使得(3-4)其中为电内阻。一般伺服电机的电感很小,如果切换频率不高,导致交流分量很大,很容易损坏功率晶体管。在此采用PWM芯片UC3637和H功率桥放大电路来驱动伺服电机,其UC3637原理如图4-11所示,根据上述原则选择切换频率为30KHz。UC3637的特点:单电源或双电源工作,双路PWM信号输出,驱动电流能力为限流保护欠电压封锁有温度补偿,2.5V阀值的关机控制图4-11UC3637原理框图UC3637的结构与功能:三角波发生器:CP,CN,S1,SR1;PWM比较器:CA,CB;输出控制门:NA,NB;限流电路:CL,SRA,SRB;误差放大器:EA;关机比较器:CS;欠电压封锁电路:UVL。UC3637最具特色的是三角波振荡器,三角波产生电路如图4-12所示。图4-12恒幅三角波产生电路三角波参数的计算取PWM定时电路充电电流为0.5Ma,则有(3-5)(3-6)其中,为PWM频率。由允许电机最大电流决定。(3-7)对于图3-12所示的控制系统,要求:PWM频率限流取计算得(3-8)(3-9)(3-10)(3-11)式中:为三角波峰值的转折(阈值)电压;为电源电压;为定时电阻;为定时电容;为恒流充电电流;为振荡频率。C3637具有一个高速、带宽为kHz、输出低阻抗的误差放大器,既可以作为一般的快速运放,亦可作为反馈补偿运放。4.1.2电源模块小车由电池组提供电压,控制系统所需的5伏稳定电压由电池组经三端集成稳压器稳压后提供.电机所需的电压由电池组直接提供.一个线性三端稳压器扩流电路,此电路是极为常见的一个线性三端稳压器扩流电路。(1)电路工作原理.Io=Ioxx+Ic.Ioxx=IREG–IQ(IQ为7805的静态工作电流,通常为4-8mA)IREG=IR+Ib=IR+Ic/β(β为TIP32C的电流放大倍数)IR=VBE/R1(VBE为TIP32的基极导通电压)所以Ioxx=IREG–IQ=IR+Ib–IQ=VBE/R1+IC/β-IQ由于IQ很小,可略去,则:Ioxx=VBE/R1+IC/β查TIP32C手册,VBE=1.2V,其β可取10Ioxx=1.2/R+Ic/β=1.2/22+Ic/10=0.0545+Ic/10(此处取主贴图中的22OHM)Ic=10*(Ioxx–0.0545)假设Ioxx=100mA,Ic=10*(100-0.0545*1000)=455(mA)则Io=Ioxx+Ic=100+455=555mA.再假设Ioxx=200A,Ic=10*(200–0.0545*1000)=1955mAIo=Ioxx+Ic=200+1955=2155mA由上面的两个举例可见,输出电流大大的提高了.(2)电阻R的大小R的大小对调整通过7805的电流有很大的关系,取不同的值带入上式即可看出.R越大,则输出同样的电流的情况下流过7805的电流要小些,反之亦然.通常这样的电路中,对于扩流三极管TIP32加散热片,而对于7805则无需要,但是R的值不能过大,其条件是:R<VBE/(IREG–IB).4.1.3光电耦合器(TLP521-4)它的额定输入输出都是5伏特,其作用是隔离干扰,消除信号源端的热噪声图4-1光电耦合器(TLP521-4)4.2行走策略(1)直线路径行走策略①小车是否沿着直线路径(白线)行走,由前置传感器探测。正常情况如图4.4a所示。前置传感器(距离为80mm)都在100mm的白线上,则小车沿着直线路径(白线)行走②如果有一个前置传感器探测到不在白线上。如图4.4b所示,如前置左侧传感器探测不到白线,而右侧传感器探测到白线,则认为小车偏左,纠正方法是使小车右侧电机减速,左侧电机加速,使得两个前置传感器回到白线位置。若小车偏右,可采用类似方法处理。③如果两个前置传感器都在白线外,如图4.4c所示,这种情况一般是传感器的出现误判。因为若一个前置传感器偏离白线,②的方法就能把小车纠正过来,根据经验数据,当一个前置传感器偏离白线的角度在以内,都能自动纠正过来。通常小车的两个电机同向转动,由于速度的同步性误差造成小车行走方向有少量偏差,传感器已经会略微偏出白线。如果传感器出现误判,会造成两个前置传感器都在白线外,可由中置传感器检测到白线后,根据时间的长短来判定(与岔路口的情况区分开来),令小车向探测到白线的那一个中置传感器方向转弯,直到两个前置传感器回到白线上,此时,耽误的时间会略长些。(2)遇到弯道时的行走策略先是前置传感器丢失白线,继续前进一段后,此时,小车停止前进向探测到白线的那一个中置传感器方向转弯,随后前置传感器也一定检测到白线,当两个前置传感器同时检测到白线之后,判断方向正确,停止转动,沿此力向继续前进。4.3传感器采样对传感器的采样有两种方法,定时采样和程序扫描采样,本课题采用的是定时采样的方式4.4控制策略小车从起点或终点出发后,每隔50ms读取一次P1口.若前方有障碍物(即P1.4脚或P1.5脚检测到反射信号),则机器人原地待命;若到达终点或起点,则机器人开始装料或卸料工作.否则,机器人进行正常的寻线行驶.图4-134.5动作类型如前所述,针对典型路径,设计出相应的控制动作。所以相应的动作类型如下4.5.1直线路径行走用于主干道上小车长直线路径的快速行走,赢得时间。其结束条件是检测到有弯道。4.5.2特殊路径的行走用于特殊路径的慢速前进,如在小车的行走中,由于导航白线折弯,前置传感器丢失了白线,小车减速行走,当中置传感器检测到白线后,根据时间的长短来判定,令小车向探测到白线的哪一个中置传感器方向转弯,直到两个前置传感器回到白线上,其结束条件是前置传感器检测到白线。其特点是两个前置传感器同时在线外的时候,小车自动旋转寻回直线。4.5.3左转弯用于向左转弯,当小车的行走遇到左边有弯道,需要左转弯时,此时左边中置传感器探测到白线,令小车向左转弯,直到两个前置传感器回到白线上,其结束条件是前置传感器检测到白线。4.5.4右转弯用于向右转弯,当小车的行走遇到右边有弯道,需要右转弯时,此时右边中置传感器探测到白线,令小车向右转弯,直到两个前置传感器回到白线上,其结束条件是前置传感器检测到白线。4.5.5停在整个动作中,直线行走和转弯最为关键。对于不同的行走路径,只需调整相应的动作列表的指针。第5章结论与展望5.1结论本文主要研究了激光导引AGV小车的机械装配,在小车机械设计的基础上可以增加旋转编码器的路径轨迹来运用推算导向法,并将两者相结合用于实现激光导引AGV的自动引导,自制了一辆两后轮独立驱动、差速转向的小车,结合小车的运动控制理论进行了相关的实验,为进一步研究和开发激光导引的AGV小车奠定了坚实的基础。本文的土要研究结论如下:(1)自动导引小车的结构设计。由于设计的小车是前后轮相互独立,后轮驱动,前轮转向。再此基础上,进行稳定的运输。外形结构,采取了钢板与方管的非端面焊接,这样既减轻的车身的重量,还能保证了运载货物的重量。(2)自动引导小车的动力系统结构。小车采用前后轮独立驱动的模式,后轮由电机带动齿轮传动,给与合适的动力源。前轮有电机带动直推轴焊接横轴来实现转向,车辆稳定运行的一个重要指标。动力学方程能够帮助AGV的建模、车体结构、刚度设计和路径跟踪控制提供理论依据的基础。(3)机械部分主要零件的选取。AGV机械部分设计中的一些主要部件的选取。通过计算对伺服驱动电动机的选取、控制转向的电动机的选取,传动齿轮的选取等。选取不同的电机,在确保安全稳定的运行下,还要保证动力最低的浪费。(4)AGV运动控制系统及其实现小车通过两个步进电机实现差速驱动,并由单片机控制8253芯片产生驱动步进电机运行所需的脉冲信号,与单片机的定时器相配合来完成步进电机的升、降速控制。PC机与单片机之间的通信由串口通信来完成,串口通信接口标准RS-232目前己在微机通信接口中广泛采用,它的硬件编程要求比较简单,价格便宜,而且连接方便,对于双向连接只需要3根线。5.2展望在本文研究工作的基础上,作者认为以下几个力面有待进一步的研究:(1)进一步研究檄光导引的理论和实现方法,搭建一个实际的激光扫描仪,并对其数据处理速度、方位计算准确性进行应证。(2)完善基于旋转编码器的路径轨迹推算导向法,结合激光导引方位计算原理用于激光导引AGV的自动导引。(3)研究无线通讯的基本理论,并将其应用于AGV的通信。(4)研究激光导引AGV的路径规划和避障保护控制系统。(5)进一步研究激光导引AGV的运动控制问题,解决AGV实际行走时诸多因素对精度影响的问题。(6)建立实际的激光导引AGV小车,将理论与实践紧密结合。参考文献邱宣怀.机械设计.北京;高等教育出版社,1997(2006重印)罗圣国.龚掕义。机械设计课程设计指导书.高等教育出版社1990.4王德夫.姜勇.李长顺.韩学栓机械设计手册;北京;化学工业出版社;1997年陈顺平,梅德庆,陈子辰.激光导引ACV的自动导引系统设计.工程设计学报,2003,10(5):279-282陈顺平,梅德庆,陈了辰激光导引差速转向AGV的控制系统设计‘机电工程,2003,20(5):87-89T.立贤,汀滨琦.用单片机实现步进电机变速控制的方法.应用科技,2003,30(1):42-42,54李海波,何雪涛步进电机升降速的离散控制.北京化工大学学报,2003,30(1):92-94宋小鹏,盛仲FA.多功能步进电机控制器软件设计.华北工学院学报,2003,24(1):58-61陈细军,谭民.VC编程中的串口通信技术.计算机应用,,2001,21(9):94.95王宏伟.昊建设,基于VC++6.0的串行通信设计与实现.黄石高等专科学校学报,2003,19(2):16-19附录部分:(中英文翻译)RobotRobotisatypeofmechantronicsequipmentwhichsynthesizesthelastresearchachievementofengineandprecisionengine,micro-electronicsandcomputer,automationcontrolanddrive,sensorandmessagedisposeandartificialintelligenceandsoon.Withthedevelopmentofeconomicandthedemandforautomationcontrol,robottechnologyisdevelopedquicklyandalltypesoftherobotsproductsarecomeintobeing.Thepracticalityuseofrobotproductsnotonlysolvestheproblemswhicharedifficulttooperateforhumanbeing,butalsoadvancestheindustrialautomationprogram.Atpresent,theresearchanddevelopmentofrobotinvolvesseveralkindsoftechnologyandtherobotsystemconfigurationissocomplexthatthecostatlargeishighwhichtoacertainextentlimittherobotabroaduse.Todevelopmenteconomicpracticalityandhighreliabilityrobotsystemwillbevaluetorobotsocialapplicationandeconomydevelopment.Withtherapidprogresswiththecontroleconomyandexpandingofthemoderncities,theletofsewageisincreasingquickly:Withthedevelopmentofmoderntechnologyandtheenhancementofconsciousnessaboutenvironmentreserve,moreandmorepeoplerealizedtheimportanceandurgentofsewagedisposal.Activebacteriamethodisaneffectivetechniqueforsewagedisposal,Thelacunarisplasticisaneffectivebasementforactivebacteriaadhesionforsewagedisposal.Theabundancerequirementforlacunarisplasticmakesitisaconsequentfortheplasticproducingwithautomationandhighproductivity.Therefore,itisverynecessarytodesignamanipulatorthatcanautomaticallyfulfilltheplasticholding.Withtheanalysisoftheproblemsinthedesignoftheplasticholdingmanipulatorandsynthesizingtherobotresearchanddevelopmentconditioninrecentyears,aeconomicschemeisconcludedonthebasisoftheanalysisofmechanicalconfiguration,transformsystem,drivedeviceandcontrolsystemandguidedbytheideaofthecharacteristicandcomplexofmechanicalconfiguration,electronic,softwareandhardware.Inthisarticle,themechanicalconfigurationcombinesthecharacterofdirectioncoordinateandthearthrosiscoordinatewhichcanimprovethestabilityandoperationflexibilityofthesystem.Themainfunctionofthetransmissionmechanismistotransmitpowertoimplementdepartmentandcompletethenecessarymovement.Inthistransmissionstructure,thescrewtransmissionmechanismtransmitstherotarymotionintolinearmotion.Wormgearcangivevarytransmissionratio.Bothofthetransmissionmechanismshaveacharacteristicofcompactstructure.Thedesignofdrivesystemoftenislimitedbytheenvironmentconditionandthefactorofcostandtechnicallever.''''Thestepmotorcanreceivedigitalsignaldirectlyandhastheabilitytoresponseouterenvironmentimmediatelyandhasnoaccumulationerror,whichoftenisusedindrivingsystem.Inthisdrivingsystem,open-loopcontrolsystemiscomposedofsteppingmotor,whichcansatisfythedemandnotonlyforcontrolprecisionbutalsoforthetargetofeconomicandpracticality.Onthisbasis,theanalysisofsteppingmotorinpowercalculatingandstyleselectingisalsogiven.Theanalysisofkinematicsanddynamicsforobjectholdingmanipulatorisgivenincompletingthedesignofmechanicalstructureanddrivesystem.Kinematicsanalysisisthebasisofpathprogrammingandtrackcontrol.Thepositiveandreverseanalysisofmanipulatorgivestherelationshipbetweenmanipulatorspaceanddrivespaceinpositionandspeed.Therelationshipbetweenmanipulator’stippositionandarthrosisanglesisconcludedbycoordinatetransformmethod.Thegeometrymethodisusedinsolvinginversekinematicsproblemandtheresultwillprovidetheoryevidenceforcontrolsystem.Thef0unctionofdynamicsistogettherelationshipbetweenthemovementandforceandthetargetistosatisfythedemandofrealtimecontrol.inthischamfer,Newton-Euripidesmethodisusedinanalysisdynamicproblemof七hecleaningrobotandthearthrosisforceandtorquearegivenwhichprovidethefoundationforstepmotorselectingandstructuredynamicoptimalting.Controlsystemisthekeyandcorepartoftheobjectholdingmanipulatorsystemdesignwhichwilldirecteffectthereliabilityandpracticalityoftherobotsysteminthedivisionofconfigurationandcontrolfunctionandalsowilleffectorlimitthedevelopmentcostandcycle.WiththedemandofthePCL-839card,thePCcomputerwhichhasa.tightstructureandiseasytobeextendedisusedastheprincipalcomputercellandtakesthefunctionofsysteminitialization,dataoperationanddispose,stepmotordriveanderrordiagnoseandsoon.Atthesametime,theconfigurationstructurefeatures,taskprinciplesandthepositionfunctionwithhighprecisionofthecontrolcardPCL-839areanalyzed.Hardwareisthematterfoundationofthecontrol.Systemandthesoftwareisthespiritofthecontrolsystem.Thetargetofthesoftwareistocombineallthepartsinoptimizingstyleandtoimprovetheefficiencyandreliabilityofthecontrolsystem.Thesoftwaredesignoftheobjectholdingmanipulatorcontrolsystemisdividedintoseveralblockssuchassysteminitializationblock,dataprocessblockanderrorstationdetectanddisposemodelandsoon.PCL-839cardcansolvethecommunicationbetweenthemaincomputerandthecontrolcellsandtakethemeasureofreducingtheinfluenceoftheoutersignaltothecontrolsystem.Thestartandstopfrequencyofthestepmotorisfarlowerthanthemaximumrunningfrequency.Inordertoimprovetheefficiencyofthestepmotor,theincreaseanddecreaseofthespeedismustconsideredwhenthestepmotorrunninginhighspeedandstartorstopwithgreatacceleration.Theincreaseanddecreaseofthemotor’sspeedcanbecontrolledbythepulsefrequencysenttothestepmotordrivewitharationalmethod.Thiscanbeimplementedeitherbyhardwareorbysoftware.Astepmotorshiftcontrolmethodisproposed,whichissimpletocalculate,easytorealizeandthetheorymeansisstraightforward.Themotor''''saccelerationcanfitthetorque-frequencycurveproperlywiththismethod.Andtheamountofcalculationloadislessthanthelineara
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
评论
0/150
提交评论