机器人大赛参赛计划书导购机器人计划书.doc

1中国科技大学第十三届ROBOGAME机器人大赛参赛计划书队伍名称A杖地卜师所在院系工院九系参赛内容机器人导购负责人姓名何启明负责人电话队员信息职务姓名学号手机学校邮箱队长何启明PB11009MAILUSTCEDUCN队员曹龙轩PB11009MAILUSTCEDUCN队员卢强PB11009LUQIANGMAILUSTCEDUCN队员成亚能PB11009MAILUSTCEDUCN队员杨金钊PB11009MAILUSTCEDUCN2指导老师承诺书组委会承诺我们组委会保证及时解决各参赛队就比赛相关问题提出的疑问，为各参赛队的制作计划等保密，公正处理机器人比赛相关事务，选拔优秀成员担任比赛裁判，保证裁判的公正。组委会负责人（签字）2013年5月22日参赛者承诺我们队承诺对本人填写的各项内容保证是本队的原创，没有抄袭他人。我们保证以本承诺为有约束力的协议，遵守中国科学技术大学第十三届ROBOGAME组委会的有关规定，认真进行机器人的设计制作等工作，就比赛相关问题3积极与组委会交流，服从组委会的活动安排与最终裁判。对于由本队引发的一切不良后果由本队承担相应责任。参赛队员（签字）何启明曹龙轩卢强杨金钊成亚能2013年5月22日序战队简介队伍取名渊源地卜师生活在黑森林中，最初被赫尔马尼的异族所崇拜的神MEEPO，是个淘气的小土灵。身体偏小的土精一点也不弱小，造世主给予了他们过人的智慧。它的强大在于它“分则能成”的强力大招，出A杖后五只精灵一起进攻更是强大到不可思议，我们战队的五个人就代表了这五精灵。4战队宣言五只精灵团结一致，同进同退，我们相信在队长的带领下我们一定能发挥出“分则能成”的强大力量，秒杀一切，马到成功战队分工何启明程序设计及调试曹龙轩程序设计及调试卢强机械设计，加工及调试杨金钊程序设计，加工及调试成亚能电路设计及调试一机械部分1机器人总装配图主视图67俯视图8侧视图2机器人各零部件介绍21三角钢我们机器人的构架由三角刚来搭建，三角钢较易购买，易打孔与其他构件连接，而且性能稳定。三角钢922底框底座俯视图底座主视图10上面是底座的俯视图和主视图，是50CM乘50CM的方形结构，由三角钢搭成。23轮子底座框架前面和后面的正中间有两个从动轮（万向轮），20MM的宽度，类似超市里的手推车的前轮，起到支撑和导向的作用。前后万向轮1112左右两侧是两个主动轮，用俩控制行走和转向，每个轮子分别用一个电机控制。左右主动轮转向轮和电机和底边三角钢1324机器人直线行走及转向问题当左右轮子转速相等时，机器人走直线。在机器人转弯的问题上，我们采用原地转的方式，即机器人向左转时，左侧轮子反转，右侧轮子正转，同理，机器人右转时左轮正传右轮反转。用原地转能很好地控制机器人的位置，不至于在转弯过程中机器人因发生位移而使后面的运动跑偏。底部是一块铁板，铺在方形框架上，用来放电机等其他东西。14底板从底边框架的立起四个三角钢的竖直杆，用来支撑其他结构。在杆的中部和顶部会搭建两个平板，中部的平板用来放置传送带的电机和篮子，顶部的电机用来丝杠电脑及其它的一些东西。25底座加杆底座加杆后视图15支撑平板用的是与竖直丝杠焊接的三角铁。26三角铁及固定三角铁16三角铁固定于三角钢上27电机下面介绍一下电机和传送带分类装置。电机简介17电机固定板18我们的机器人总共需要五个电机，左右两个轮子各一个，传送带两侧各一个，还有一个用来收放绳子。28分类装置介绍我们用传送带的传送来完成分类任务。传送带左侧和右侧各焊接一个矩形铁框，框下吊着一个布袋子，布袋用来缓冲压力，以免物品落下后摔碎。传送带电机的正传和反转由程序控制，电机带动传送带向左或向右转动，从而使放到传送带上的物品掉到左侧（生活类）或右侧（食品类）的篮子里，达到分类的目的。本来我们打算只用一个电动机，另一个带轮用从动轮，但考虑到一个电机可能动力不足，最后决定两侧带轮均由电机控制。传送带装配图19下面详细介绍一下传送带这一部分用到的各个部件传送带履带20传送带带轮传送带履带和带轮21传送带固定1传送带固定2传送带装配图及固定22左右分类框及固定板29提篮装置下面介绍机器人完成导购任务后，最后一步走向收银台将货物打包并提到收银台上的过程。23由于我们的传送带分类装置已经直接把两类物品分别放到两个购物袋里面，所以机器人下面只需将购物袋从篮子里面提出即圆满完成了任务。我们设计用一个丝杠来完成提袋的任务。购物袋放在篮子里，两个袋口用一根线穿起来（不系，与左右两侧连接的两根线最后均通过一根总线与丝杠连接。丝杠上面还有一节杆，杆端有一个定滑轮，总线通过定滑轮连接到下面的一个电机，通过电机的转动来控制总线的收放，从而来完成购物袋提起和放下的任务。丝杠水平放置,可以前后运动。机器人到达收银台后，在完成提起购物袋的过程中，丝杠往前伸，同时，控制拉绳子的电机开始转动，使绳子开始收缩。这两个部分的综合作用，能使购物袋同时提到收银台的上方，最后电机反转，绳子伸长，购物袋放到桌面上，即圆满完成任务下面具体介绍一下提篮的装置291提篮工具总图24292丝杠和电机293混合步进电机86BYGHS25该电机放在丝杠的一端，电机转动来控制丝杠的前伸和后缩，从而来完成提袋和放袋的过程。294定滑轮我们需要两个这样的定滑轮，一个固定在丝杠的前端，另一个固定在框架的上平的下方。滑轮固定126滑轮固定2这个滑轮固定装置相当于一个轴承，把滑轮固定在滑轮固定1当中。295拉绳电机下面讲一下转动电机部分。拉绳转轴27上面是拉绳转轴，中间有一个洞，绳子从洞中穿过。该转轴与电机相连，电机固定在中间的平板上。电机转动时带动拉绳转轴旋转，从而达到收缩绳子的目的。拉绳电机及固定在机器人完成任务的过程中，需要电脑随时控制，电脑放在框架中部的平板上。296电脑283重要步骤介绍以上，我把机器人地卜师每个机械部分及其工作原理都做了详细介绍，下面具体介绍一下机器人执行任务两个重要步骤的动作。31重要步骤一物品分类在分类过程中，人取物品后放在传送带上，机器人的程序控制传送带电机旋转，物品即落入左边或右边的框中，完成分类任务。机器人在进行物品分类2932重要步骤二提袋过程在完成所有的导购任务后，机器人走到收银台前面，机器人转向，正面面对收银台。然后开始完成提袋任务。30购物袋很难用SOLIDWORKS画图画出来，就简单地用一个立方体代替。在该过程中，固定在框架中部控制拉绳的电机开始转动，绳子收缩，两个购物袋同时从左右两侧的框中被提到半空中。机器人在提袋3133重要步骤三放袋过程最后，控制丝杠的电机转动，丝杠前伸，同时控制拉绳的电机反转，使绳子略微放长。两个购物袋被放到收银台的上空。然后，控制拉升的电机继续反转，绳子伸长，购物袋被到收银台上，本次比赛任务圆满完成二程序部分程序的目的是让机器人自主完成导购过程与跟随过程，以及最后的分类与装袋过程，现分不同的阶段逐一讨论321导购阶段导购阶段要求机器人自主寻找已经设定好的商品位置，主动前往并且绕过路上的障碍（可能是绕过障碍，或者直接换路行走）。分析可知，该阶段的重点是机器人自动生成最优路径，并且在最优路径检测到障碍物之后，重新生成最优路径，并沿着新生成的路径行走。考虑到现行流行RPG游戏人物定位方法可以应用到路径自动生成中，我们预在游戏人物定位算法的基础上编辑机器人自定位算法。游戏中人物当前位置被记录，如果鼠标指向已经储存在电脑中的地图某处，计算机就会自动生成最优路径并且命令人物沿着生成路径行走。如果人物行走过程中遇到移动型障碍（我们称之为卡位）一直挡在路径前方，电脑就会随时更新生成最优路径，绕开障碍达到目的地。在最优路径设计过程中，依靠先验地图（可行路线与不可达位置）和后验勘测（发现障碍并生成新路径）的算法可以应用在机器人实践中。这种算法被专业人士称为A星算法。A星算法简介首先将地图分为不同的节点，储存节点与相邻节点的关系，将地图中不可达的地方设置为死节点。其次，从起始点开始检索相邻活节点，并计算相邻节点的G值与F值。33如上图所示，G值可以看做从绿色节点到周围节点的距离，H值是可以看做相邻节点到目的地红色节点的距离。在计算G值时，正向相邻记作10，斜向相邻记作14（1414倍），之所以不用小数是考虑到计算机执行效率。而计算H值时采用简单的曼哈顿算法（移动像过街道一样只有横向与纵向位移），每经过一个格子加十，死节点也需计算进入。这样在上图的节点中生成了FGH值（左上角F，左下角G，右下角H），选取F值最小的节点，重复检索该节点的相邻节点（父节点不予考虑以免重复检索）。这样重复下去就可以生成一条相对较短的路径34如上图所示就是A星算法生成最短路径的过程。A星算法避免了深度优先和广度优先算法的遍历，也避免了狄杰斯特拉算法的繁琐，用较简单的方法找到了类优路径。下面给出A星算法的伪代码实现HEAPADDFIRSTNODE/将开始节点加入堆,同时也是加入OPENLISTDOFLEASTHEAPPOP/从OPENLIST取FCOST最小的元素CURRENTFLEAST/取出的元素作为当前节点FLEASTFLAG1/1ONCLOSE0NOTONOPENNORONCLOSEFORINTICURRENTX1ICURRENTX1I/考察当前节点的所有相邻节点FORINTJCURRENTY1JCURRENTY1JIFMAPIJUNWALKABLE|ONCLOSENODEI,J/相邻节点可通并且没有考察过IFONOPENNODEI,J/相邻节点不在OPENLIST中HEAPADDNODEI,J/加入OPENLISTNODEI,JPARENTCURRENT/设置相邻节点的父节点为当前节点NODEI,JCALCULATEF,G,H/重新计算FCOST,GCOST,HCOSTIFNODEI,JDEST/如果加入的节点是目标点则找到路径PATHFIND35ELSETEMPGCOSTPARENTGCOSTADDCOST/相邻节点已经在OPENLIST中NODEI,JHCOST10ABSIPARENTXABSJPARENTYNODEI,JFCOSTNODEI,JGCOSTNODEI,JHCOSTIFTEMPGCOSTNODEI,JGCOSTNODEI,JPARENTCURRENTNODEI,JRECACULATEF,G,H/重新计算FCOST,GCOST,HCOSTWHILEHPISEMPTY/如果堆空则没有找到路径IFPATHFINDOUTPATH/输出路径ELSECOUT“PATHNOTFIND“ENDLA星算法应用在本次机器人制作需要以下几个工作11、地图的划分A星算法需要知道地图的分布，因此合理将场地划分是执行程序的第一步。考虑到现实情形，机器人有碰撞体积，并不能将场上所有的空地设置为活节点，可以设置机器人型心为质点，考虑该型心所能到达的地方，如果机器人型心超出此范围，则其边界有可能碰到货架或者场地边界，地图的分块是建立在此范围之内，下图显示了计算过机器人大小的型心运动区域分布图，其中阴影部分就是机器人的型心可以到达的区域。36之后在这个区域上划分小块，考虑到机器人绕障碍的精度要求，我们将可行区域划分为200X200MM的小区域，以区域中心作为节点所在位置，如下图所示，所画区域恰好分成诸多小块12、节点的储存为了避免不稳定性，我们设定机器人只能沿节点横向或纵向移动（G值不能为14），将每个节点与其邻居节点用结构体储存，结构体应该包括节点编号，节点死活，节点邻居指针，节点中心坐标等元素。3713节点的定标我们拟采用加速度计与陀螺仪判定机器人当前位移与身姿（详见电路部分）加速度的积分是速度，速度的积分是位移，只需知道水平面上的加速度，通过计算机的积分运算可以得到位移数据，只要知道机器人的具体坐标值，就可以判定机器人现在位置属于哪个具体的节点。这对于绕障碍以及出现故障重新开始时重新定标起到帮助作用。14、相邻节点间的移动控制转向的节点结构体具体包含的几个变量如下TYPEDEFSTRUCTFLOATX/该方块的X坐标FLOATY/该方块的Y坐标FLOATG/该方块的G值FLOATH/该方块的H值RECTR/该方块的右邻方块（RIGHT）RECTL/该方块的左邻方块（LEFT）RECTT/该方块的上邻方块（TOP）RECTD/该方块的下邻方块（DOWN）INTISLIVE/该方块的死活状态INTN/该方块的编号RECT38为了使机器人能够判断怎样走到相邻的方块（如应该先旋转多少角度后再移动），则机器人必须先知道自己现在的朝向（朝向可以通过之前走过的路径判断，如果出现故障，可以采用电子罗盘辅助寻找朝向，具体见电路部分）为此，我们将四个方向标记为不同的值以资区分，各个方向对应的值如下图设机器人当前朝向方向的值为DIRECT，则机器人要走到R方块（右邻方块），则需要顺时针旋转的角度为ANGLEDIRECT41（90）360；下面为各个值对应的顺时针旋转角度若DIRECT1,则ANGLE0903600；若DIRECT2,则ANGLE19036090；若DIRECT3,则ANGLE290360180；若DIRECT4,则ANGLE19036090；同理可以得到要走到T方块需要顺时针旋转的角度ANGLE（DIRECT419090）360同理可以得到要走到L方块需要顺时针旋转的角度39ANGLE（DIRECT4190180360同理可以得到要走到D方块需要顺时针旋转的角度ANGLEDIRECT419090360当角度转完后，再前行200MM即可到达下一节点这样就可以从一个节点移动到它任意邻居节点。15、卡位节点的删除如果机器人在行进过程中偶遇障碍物，需要将障碍物所在处的节点删除并重新生成最优路径（绕障碍或者换路）。首先发现障碍并且确定障碍位置和障碍所在节点（发现障碍的算法见程序部分的识别板块），之后并不能简单删除该节点，如果只删除单一节点有时并不能生成符合实际的最优路径。如图，假设机器人处于蓝色方块的位置检测到障碍物的存在，如果仅删除一个节点，其余节点仍然可以行走，则机器人可能走到如图所示位置，会碰到障碍40因此为了保证行走的可行性与避障不碰障碍的要求，我们采用以下方法首先检测到障碍中心所在节点，其次删除其所有相邻节点，删除相邻节点时检测相邻节点的相邻节点（邻居的邻居），如果邻居邻居节点中心到障碍中心的横坐标（或纵坐标）之差的绝对值小于400MM，就将该节点删除，否则不删除。改进以后的删除方式见下图这样机器人若想到对面去只有一条路可以选择就是绕道（我们设定机器人转向只能原地旋转再前行）。经多次测试，这种方法可以保证准确删除障碍节点，并完成绕路算法。如果路被堵死的情况41机器人前行检测到障碍并删除节点机器人重新生成最优路径并转向。3商品的定位商品的位置可以对应到相应最近的节点上，由于我们分块的时候已经照顾到商品的位置，故只需将机器人目的地设置在商品旁边的位置，这样也方便机器人接近货架200MM以内42如图绿色框图所在节点就是商品所在的节点，可以将商品编号与节点进行一一映射，从而让机器人方便的找到目的地。综上，我们可以对基于A星算法的导购过程进行一个概述1、开始时机器人受到指令，了解商品节点位置2、机器人生成最优路径并按照路径行走3、机器人发现障碍，将障碍位置节点删除，重新生成最优路径，再次遇到障碍之后重复删除步骤和最优路径生成步骤4、机器人到达商品位置，移动到与商品间距不超过200MM处，重复2过程寻找下一物品5、报价，导购阶段结束432、跟随部分跟随部分不再需要机器人自己寻找最优路径，而是只要跟着人走就可以了，因此也就不再需要使用划分的方块，考虑到前后的一致性，机器人按照如下图的路径行走比较合适（与导购阶段的路径相比只是将方块去掉了）跟随阶段有几个主要的问题需要解决21识别人和障碍。识别需要摄像头。但由于导购阶段人跟随在机器人后方，因此机器人只需要通过超声波传感器测出与人之间的距离，就可以通过调整自己的速度来达到距离上的要求，这样来看机器人后方并没有安装摄像头的44必要。而跟随阶段机器人需要跟随着人行走，并且还有可能遇到障碍，因此机器人前方一定至少有一个摄像头，以识别人和障碍。22测量与人之间的距离以及与障碍之间的距离。机器人通过超声波传感器测量与人之间的距离。但是由于超声波传感器基本上只能测量与它正对的物体的距离，而机器人需要测量的人的位置不是固定的，因此在机器人上安装多个超声波传感器是必要的；由于测量与障碍之间的距离是非常重要的（这涉及到导购阶段的挖掉死方块），为了保证尽可能准确地测出机器人与障碍之间的距离，我们通过双目识别来测量，这需要机器人前方有两个摄像头。这些装置我们认为按下图（俯视图）放置比较合适。其中前方的两个摄像头的高度在500MM障碍的高度以下，通过双目识别技术，这两个摄像头可以比较有效精准地识别圆柱体障碍物到机器人的距离。由于人的中心位置不好测定，因此我们不打算也用双目识别来测量机器人与人之间的距离，而是通过超声波传感器直接测量。由于测量人的上半身的距离比较容易，因此前后的超声波传感器都放置在机器人的顶部，这样可以达到人的腰部的高度；由于安装在机器人前面（后面）的超声波传感器之间的距45离为200MM，超声波传感器与机器人边缘的距离为150MM，而人的腰部宽度一般大于200MM，因此可以保证在跟随过程中只要人大致在机器人前方时，就能保证至少有一个超声波传感器是正对着前方的人的，如下图所示在导购和跟随过程中，只要人的中心位置在上图所示两条绿色虚线范围之内，机器人就能比较准确地测定与人之间的距离。由于超声波传感器有一定的发射角（约15），因此图中所示范围与实际相比还要略小一些。跟随阶段的大致流程图如下跟随阶段开始机器人跟随人走，并保持与人之间的距离为400500MM人转弯时机器人记下最后一次测出的人的位置，并在最接近此位置的路径上转弯机器人识别出人到达货架旁停下，机器人到达商品旁边停下等待人取放商品人取下商品交与机器人并通过机器人获取价格人向下一个商品的位置出发人取完商品后向收银台出发机器人跟随人到达收银台区，并停在指定的位置跟随阶段结束46分类装袋与报价过程由于已知商品分为食品类与生活类两种，机器人需要准确区分两种商品，并自主将其分类在不同的位置。我们的机械结构设计留出了这种装置。简单而言，通过已经储存在电脑中的商品位置来判断商品种类，通过带轮正反转来将放置在平台的商品转送到不同的袋子中。导购阶段商品的位置是提前输入给电脑，而跟随阶段的商品由摄像机识别条形码，由电脑将条形码信息与商品信息对应并顺利完成计算与报价、分类等过程。下简单介绍条形码的实现。在跟随过程中，商品的识别我们决定采用条形码识别的方案，现今的商品上都贴有条形码标识，很容易通过商品上的条形码来判别商品的各项信息（类别，价格等）。条形码BARCODE是将宽度不等的多个黑条和空白，按照一定的编码规则排列，用以表达一组信息的图形标识符。常见的条形码是由反射率相差很大的黑条（简称条）和白条（简称空）排成的平行线图案。条形码的扫描需要扫描器，扫描器利用自身光源照射条形码，再利用光电转换器接受反射的光线，将反射光线的明暗转换成数字信号。不论是采取何种规则印制的条形码，都由静区、起始字符、数据字符与终止字符组成。有些条码在数据字符与终止字符之间还有校验字符。关于识别的部分，我们可以采用摄像头的拍照传输给计算机，然后通过特定的识别软件将分析得出的结果传给单片机，从而达到机器人识别商品的目的。相对于手动输入，条形码识别主要有以下几点好处1输入速度快与键盘输入相比，条形码输入的速度是键盘输入的5倍，并且能实现“即时数据输入”。472可靠性高键盘输入数据出错率为三百分之一，利用光学字符识别技术出错率为万分之一，而采用条形码技术误码率低于百万分之一。机器人需要实现的另一项任务是计算总价并报价，我们计划用扩音器让机器人发声，机器人将每件已购产品储存并计算出总价值并通过电脑传输指令播放音频，通过扩音器发出声音。该过程用简图表示如下3基于双目视觉的障碍识别系统由之前的循迹算法可知，定位绕路等算法的核心在于如何准确识别障碍物所在的节点，我们考虑使用计算机视觉中的双目视觉来实现对障碍物的识别。双目立体视觉，即由不同位置的两台或者一台摄像机CCD经过移动或旋转拍摄同一幅场景，通过计算空间点在两幅图像中的视差，获得该点的三维坐标值。当一个摄像机拍摄图像时，由于图像中的像素点坐标相对于真实的世界坐标并不是唯一的，这就造成深度信息的丢失。然而用两个摄像机同时拍摄图像时，可以获取同一场景的两幅不同的图像，通过三角测量原理计算图像像素间的位置偏差，复原三维世界坐标中的深度信息。融合两只眼睛获得的图像并观察它们之间的差别，使我们可以获得明显的深度感，建立特征间的对应关系，将同一空间物理点在不同图像中的映像点对应起来，这个差别，我们称作视差DISPARITY图像，如图。获取商品（导购阶段直接了解商品信息）条形码识别商品（导购阶段记录所选商品）语音播报当前商品名称，现有商品总价，并由机械系统进行分类48以下对双目视觉原理进行简单阐述立体视觉系统由左右两部摄像机组成。如图所示，图中分别以下标L和R标注左、右摄像机的相应参数。世界空间中一点AX，Y，Z在左右摄像机的成像面CL和CR上的像点分别为ALUL，VL和ARUR，VR。这两个像点是世界空间中同一个对象点A的像，称为“共轭点”。知道了这两个共轭像点，分别作它们与各自相机的光心OL和OR的连线，即投影线ALOL和AROR，它们的交点即为世界空间中的对象点AX，Y，Z。这就是立体视觉的基本原理。49在平行光轴的立体视觉系统中，左右两台摄像机的焦距及其它内部参数均相等，光轴与摄像机的成像平面垂直，两台摄像机的X轴重合，Y轴相互平行，因此将左摄像机沿着其X轴方向平移一段距离B（称为基线BASELINE）后与右摄像机重合。由空间点A及左右两摄像机的光心OL、OR确定的极平面（EPIPOLARPLANE）分别与左右成像平面CL、CR的交线PL、PR为共轭极线对，它们分别与各自成像平面的坐标轴UL、UR平行且共线。在这种理想的结构形式中，左右摄像机配置的几何关系最为简单，极线已具有很好的性质，为寻找对象点A在左右成像平面上的投影点AL和AR之间的匹配关系提供了非常便利的条件。将上述原理应用于计算机识别还需要进行特征点匹配，特征点匹配分为稀疏点匹配和密集点匹配，由于本次任务对识别对象形状要求并不高红色圆柱体，并且只需要定出圆柱体型心所在的坐标值，故只需采用基于窗口的稀疏点匹配。下面将结合圆柱实物简单介绍特征匹配的方法并定出型心。50实验所用的圆柱对上述识别图像进行轮廓提取由于图形轮廓具有很好的连续性，在一些弱角点的地方无法提取到角点却可以提取到轮阔点。提取到特征点以后，以左摄像机的图像为参考对象，对右图进行匹配，用极点坐标法中的向量夹角匹配的方法计算两图同一行特征点的COS值，将取值最大且大于09的特征点作为对应匹配点，两个点X坐标差值为视差值，视差越大则三维点离摄像机距离越近，反之越远。51MINMAXIN125DDIP上式中的最大视差，最小视差，则视差图中的灰AXMIND度值就可以帮助计算出视点离摄像头的距离。PI在获取多个视点之后，就是圆柱型心的判定。上面通过灰度值算出了圆柱边缘到摄像机的距离，为了简化起见，我们现将机器人视为质点，计算出圆柱的位置，如下图设测出的机器人到圆柱边缘的距离为D1，圆柱半径为R（已知量），设圆心到摄像机的距离为X，则由勾股定理容易得到X2D12R2,又因为H为已知量，则圆心到摄像机的水平距离SX2H2D12H2R205，摄像机的位置是已知的，则圆柱圆心的坐标也就很容易得到，为（X摄S,Y摄H）。52三电路部分1电路总体框图2电源电路鉴于这次的机械部分较为复杂，简化后可以将电源分为三部分。其一，是为传感器，单片机这类低功耗器件提供电力的电源；其二，是为机器人下部的移摄像头计算机传（加速度传感器）感（超声波传感器）器（电子罗盘）外围电路单片机机械臂系统传送带系统移动系统功能实现53动部分以及机械臂牵引绳子的部分提供电力的电源；其三，是在机器人上部平台处提供机械臂丝杠部分以及传送带部分电力的电源。这三处电源我们决定采用一个三端子稳压器变压来给低功耗器件提供电力，其余电机的可以使用两个电池分别在机器人的上，下方供电。正电压输出的78系列的三端稳压集成电路输出的电压范围是5V24V，可以在选购时挑选出符合需求的规格下图为TO200封装的78系列恒压电路芯片从左至右三个针脚依次对应INPUT，COMMON以及OUTPUT下图为下位7805（输出电压为5V）原理图543控制电路由于传感器的数目和种类较多，运算较为复杂，所以我们决定采用计算机与单片机联合控制的方法。计算机方面，我们将把诸多传感器（超声波，加速度等）所得到的信息传递给计算机，由计算机程序得出最优算法，并传递给单片机。具体的算法实现过程见程序部分。单片机方面，根据往年的经验及性价比，可以采用基于增强的AVRRISC结构的ATMEGA16单片机。下图为ATMEGA16单片机的引脚图55相对于其他的单片机，ATMEGA16具有高性能，低功耗的特点。它具有先进的RISC结构，以及非易失的程序和数据存储器。它的内核具有丰富的指令集以及32个通用工作寄存器，工作于16MHZ时，性能高达16MPS，大大提高了代码效率。同时它具有32个可编程的I/O口，完全可以满足本次机器人的设计需求。564移动系统由于机器人的行进过程较为复杂，转向和定位需要精确，所以应当采用直流伺服电机，并相应的要求电机的功率放大器具有良好的电压调节特性。现在最常用的功率放大器为桥式PWM功放电路，及H型功放电路。下图为双极性桥式PWM晶体管放大器的结构图由左图可以看出，H型结构的晶体管按Q1、Q4，Q2、Q3配对工作。Q1、Q4导通则Q2、Q3截止，反之Q2、Q3导通则Q1、Q4截止。实际工作时，要靠在晶体管上施加不同的占空比的脉冲信号来控制电机的正反转。显然两路不能同时导通，故若Q1、Q4的导通时间比Q2、Q3长，则电机正传，反之则电机反转，导通时间相等则电机停止不动，从而实现对电机的控制。而市场上最常见的基于H型功放电路的驱动芯片就是L298N驱动芯片了。L298N内含两个H桥的高电压大电流双桥式驱动器，可以驱动46V、2A以下的电机。下图为采用15脚MULTIWATT封装的L298N的管脚示意图57其中，2、3脚，13、14脚可分别输出控制两个直流电机，5、7脚，10、12脚可由单片机向驱动芯片输入控制信号，从而对两个电机进行控制。下图为其使能、输入引脚、输出引脚的逻辑关系。5机械臂部分由于丝杆部分需要完成推进的任务，需要很高的精度，并且不需要很高的速度，所以采用混合式步进电机来作为丝杆滑台移动的动力。步进电机驱动的速度和位移大小，可由电气控制系统发出的脉冲数加以控制。由于步进电机的位移量与脉冲数严格成正比，故步进电机驱动可以达到较高的重复定位精度。由于步进电机的步距或转速不受电压波动和负载变化的影响，不受环境（温度、压力等）的限制，仅与脉冲频率同步，能按控制脉冲的要求立58即启动、停止、翻转或改变转速，它每一转都有固定的步数，在不丢步的情况下运行时，步距误差不会长期积累，所以十分适合完成写字这种精度较高的工作。下图为混合式步进电动机剖面图在考虑承重的条件下，我们选用57BYGH56型电机，它可以提供一个较为合适的移动速度。下图为57BYGH56型电机及其参数机身长56MM重量07KG转动惯量300GCM2静扭矩126KGCM相电流28A步距脚18。596传感器电路61超声波传感器机器人在行进过程中需要识别障碍物以及人的位置与自身的距离，所以需要超声波传感器来测距。下图为超声波传感器实物图超声波感应器的原理比较简单，向传感器输入至少10US的高电平信号，模块会自动发送8个40KHZ的方波，自动检测是否有信号返回，若有信号返回，通过I/O输出一高电信号，高电平信号持续时间及时超60声波从发射到返回的时间，这样就可以得出测试