您当前的位置:五五电子网电子知识电子制作自动控制-单片机智能机器人迷宫车控制系统的制作 正文
智能机器人迷宫车控制系统的制作

智能机器人迷宫车控制系统的制作

点击数:7555 次   录入时间:03-04 11:57:49   整理:http://www.55dianzi.com   自动控制-单片机

    内容摘要:机器人在军事侦察、扫雷排险、防核化污染等危险与恶劣环境中以及工业自动化生产的物料搬运上应用很广,随着任务复杂性的增加,对移动机器人的要求也越来越智能化。然而,功能较完备的路径跟踪控制方法普遍具有计算复杂,不易实现等特点。主要针对移动机器人即智能小车的行走系统进行设计,以MCS-51单片机为控制核心的智能小车利用单光束反射取样红外传感器,探测正前方及左右两侧障碍物,利用控制算法寻找行进路线,在无人控制的情况下自主地走出迷宫。设计采用了轮式移动机构,使机器人能直线行走、左右转弯、主要针对路径跟踪算法优化问题,提出一种有效可行的方法,该法比以往算法更简单易行。

    机器人应当具有几个特征:移动功能,执行功能、感觉和智能。目前全世界各国举办的涉及硬件,软件仿真的机器人大赛不下20余类。各种各样的机器人比赛都有一个共同的宗旨:培养科学创新精神,激发思维的想象力,鼓励理论与实践的结合。不仅如此,现在已经有越来越多的自动控制产品已经介入生产,在农业、工业上都有广泛的应用。新的工作方式将大大的缩短了人工作业的时间,并且减轻了人的体力劳动的支出。走迷宫的微型机器鼠主要是基于自动引导小车(Auto Guided VehICle,AGV)的原理,实现机器鼠识别路线,判断并自动躲避障碍,选择正确的行进路线走出迷宫。在此选择制作一个简易的行进装置,使其能顺利的走避障或是迷宫。为了实现小车识别路线,判断并自动躲避障碍,选择正确的行进路线,障碍判断采用单光束反射取样红外传感器,驱动电机采用直流电机,控制核心采用MCS-51单片机。控制上采用分时复用技术,仅用一块单片机实现了信号采集、线路判断、电机控制等功能。迷宫由16×16个区组成。起点设在拐角处,终点设在中央,占4个区。每个区为180 mm×180 mm大小,间壁高为50 mm,厚度为12 mm,侧面涂白色,底面涂黑色,如图1所示。

    1 迷宫车控制系统的总体设计方案

    迷宫车由墙壁传感器、单片机控制板、动力及转向系组成的,控制框图如图2所示。

33.jpg

    迷宫车采用轮式移动方式。优点是:结构和控制简单而且技术成熟。从选定电动机转速和轮胎直径,可以简单地计算出小车的速度。但是,有关路面的阻力或上坡的驱动转矩等成为重要的因素。考虑这点,在轮胎上使用无线遥控车的塑胶轮胎。如图3所示,前轮1为万向脚轮或球形轮,后轮2和后轮3为独立驱动轮,利用它们的转速差实现转向。这种组合的特点是机枢组合容易,而且当2个驱动轮以相同速度、相反方向转动时车体能绕2个驱动轮连线的中点自转,值得注意的是自转中心与车体中心不一致。

    迷宫车车身材料的选择。迷宫车使用的材料大部分用于结构,一般应采用金属材料。迷宫车承载和运动不应产生严重的变形和断裂,从力学角度讲即具有足够的强度。迷宫车负载小,自重轻,对寿命的要求不高。因此,选用铁皮。

    1.1 迷宫车控制电路的设计

    控制电路主要由电机驱动电路,单片机接口电路,电源电路和传感器电路组成。控制框图如图4所示。

     

控制框图

     

    (1)红外线光感电路传感器通过发光二极管发出红外线,若有障碍物在前方,红外线会被反射回来,被感光三极管接收,单片机程序对信号进行比较处理,按设定的动作要求向后轮的两个电机发出控制命令,控制小车行进。

    (2)电机驱动电路采用89S51单片机,通过L293D芯片来控制两个驱动电机动作。89S51根据红外传感器对外界进行探测后反馈回来的信号,依据迷宫车探路算法,判定迷宫车行进方向,分别向左右两个驱动电机发出控制指令,该信号经L293D芯片驱动后,直接控制相应电机动作,使迷宫车按既定动作进行前进、后退、转向。

    1.2 迷宫车控制程序设计

    控制算法:

    迷宫车一般有四种控制算法:

    (1)靠左算法

    ①默认靠左走法。即一直沿着左墙壁走,左边有墙时一直沿着左边墙壁前进,当左边没有墙时左转,然后继续靠左边墙壁运行。该算法使用于最简单的迷宫走法。如图5所示,其中虚线表示小车前进的路线。

     

最简单的迷宫走法

     

    ②算法流程图如图6所示。

66.jpg

    ③靠左算法的弊端。按照该算法,小车在走第二遍迷宫的时候,可以一次性的走出迷宫,但是这条道路不一定是最短的道路;如果迷宫本身存在“孤岛”,那么小车很有可能走不出迷宫。如图7所示。图7中两个圆点分别表示入口和出口,小车从入口进入迷宫,靠左前进则会导致小车一直按照虚线所描绘出的路线一直在迷宫里循环,终走不出迷宫。

     

走不出迷宫

     

    (2)靠前算法

    ①靠前算法即一直沿着前方道路前行(前方没有任何障碍时一直前进),当前边没有墙时判断左边,左边没墙左转,左边有墙则判断右边。然后重复该循环。该算法使用于最简单的迷宫走法。

    ②算法流程图如图8所示。

     

算法流程图

     

    ③程序思路:前边没墙靠前走,前面有墙判断左边,左边没墙靠左转,左边前边都有墙再判断右边,右边没有墙靠右转,三面都墙直接后退转180°,继续靠前走。0表示有墙,1表示没墙,p3.0表示左传感器;p3.1表示前传感器;p3.2表示右传感器。



www.55dianzi.com

    转角控制思路:计算轮子的转速,测出小车转90°时每个轮子所行的路程,用路程来除速度,求出一个时间作为小车转弯时的延迟时间,再通过调试进一步精确转角。

    (3)洪水算法

    洪水算法即使用256 B额外内存,会大幅提高性能。该算法比一般迷宫算法的有效率高20~50倍。同时可以在内存中建立一个区域,与实际中的迷宫格数一一对应。在实际使用时算法并不太复杂。该额外内存区域称为“浪头”,它将体现在内存区域的实际状况中如图9所示。当迷宫被淹没的时候,一个波浪的前头从目标格向外扩展。在内存区域中这种单元格是惟一需要处理的,当浪头到达开始的单元格子,机器人已经被淹没。通常来说,开始的单元格可以是任何一个格子。但是为了方便起见,把开始点设在迷宫的第一个单元格,终点任意。反过来也可以把出口放在第一个单元格,把开始点设在中间或希望的位置。一旦到达了起点即搜索完成,最短的路径可以使机器老鼠移动到周围的格子中数值比较小的那个格子去,依次类推机器老鼠就能走到终点。

     

内存区域的实际状况

     

    洪水算法的优缺点:

    ①按照该算法小车在第一次走迷宫的时候,必须把迷宫中所有的道路都走一遍。但是该算法可以让小车走任何迷宫,即使迷宫本身有“孤岛”小车一样可以顺利的走出迷宫。

    ②当小车再走第二遍迷宫的时候小车可以1次性走正确的路线走出迷宫,并且该路线一定为最短的路线。

    (4)铺路算法

    在内存中建立一个区域与实际中的迷宫格数一一对应,并将所有走过的路进行记忆,如果发现前方是死胡同或走过的路就转回前一个岔道口;在行走过程中遇岔道口默认靠左。因为有了记忆功能,就可以走第二遍。

    铺路算法的优缺点:

    ①运用该算法可以走复杂的迷宫,不存在走不出来的问题。

    ②运用该算法在小车第二次走迷宫的时候可以一次性的走出迷宫,但是不能保此条道路走的是最短的线路。

[1] [2]  下一页


本文关键字:控制系统  制作  智能机器人  自动控制-单片机电子制作 - 自动控制-单片机