走迷宫机器人控制系统的设计.doc

走迷宫机器人——控制系统的设计 上海交通大学：钱真彦（F9903406班）苏稚英（F9903501班）摘 要走迷宫机器人主要是基于自动导引小车（AGV——auto-guided vehicle）的原理，实现小车识别路线，判断并自动规避障碍，选择正确的行进路线。导引方式采用与地面颜色有较大差别的导引线，使用反射式光电传感器感知导引线，障碍判断采用机械式传感器。驱动电机采用直流电机，电机控制方式为单向PWM开环控制。控制核心采用51单片机，控制系统与电路用光耦完全隔离以避免干扰。控制上采用分时复用技术，仅用一块单片机就实现了信号采集，路线判断，电机控制。该技术可以应用于无人工厂，仓库，服务机器人等领域。 总体规划对于走迷宫小车控制系统设计主要有三个方面：一、控制电路设计；二、传感器选择以及安放位置设计；三、程序设计。从总的方面来考虑，传感器的使用数量应该尽量少以减少单片机的信号处理量，但是又必须能使小车行驶自如。控制电路要根据选用的电机和传感器来设计，主要考虑稳定性，抗干扰性。 一、 电路设计控制电路主要有电机驱动电路，单片机接口电路，电源电路三个部分。考虑到电机的起动电流和制动时比较大，会造成电源电压不稳定容易对单片机和传感器的工作产生干扰，所以，电机驱动电路和单片机以及传感器电路用光耦隔离。传感器的电源直接使用24V蓄电池，单片机的电源则通过7805将24V电源转换到5V。这里主要对驱动电路进行一下介绍：小车使用24V直流电机， 对于这种小功率直流电机的调速方法一般有两种。（1）线性型使用功率三极管作为功率放大器的输出控制直流电机。线性型驱动的电路结构和原理简单，成本低，加速能力强，但功率损耗大，特别是低速大转距运行时，通过电阻R的电流大，发热厉害，损耗大。（2）脉宽调制另外一种是较常用的脉宽调速（PULSE WIDE MODULATION——PWM），这种调速方式有调速特性优良、调整平滑、调速范围广、过载能力大，能承受频繁的负载冲击，还可以实现频繁的无级快速启动、制动和反转的等优点。因此决定采用PWM方式控制直流电机。PWM调速分为双向式和单向式两种① 双向式图一即为较常用的PWM调速电路，在一个脉冲周期内(T=Ta＋Tb)，T1和T3导通的时间为Ta，T2和T4导通的时间为Tb，这样在Ta这段时间内，电机通过的是正向电流，在Tb这段时间内为反相电流。当Ta=Tb时电机停转，TaTb时电机正转， Ta 图一 ② 单向式单向式的电路更双向式相同。不同的是，在电机正转时，Tb这段时间内不通过反向电流，电机反转时，Ta内不通过正向电流。其调速原理基本与双向式相同。单向式与双向式相比，三极管的开关频率少一半，比较不容易发生上下三极管导通而造成电源短路的情况,故可靠性有所提高，但控制性能比双向式稍差。外特性、低速性能也不如双向式好。 图二 图三如上左图所示为双向式调速方式下速度与占空比关系曲线，右图为单向式调速方式曲线。综合以上两种方式的优缺点，并考虑到走迷宫机器人对调速精度不太高，以及省电，器件损耗等各方面因素，决定采用单向式PWM。考虑到编程时可能会产生使T1、T2、T3、T4都导通的情况，以至电源短路，烧毁器件。为避免出现这种情况，设计了图四所示的电路。此电路只用一个三极管控制电路的通断，用四个继电器控制电流的流向，从而控制电机的转向。这样无论如何，都不会出现因编程原因而造成电源短路的情况。由于采用单片机控制电机，如果单片机的电源采用与电机同一电源，虽然经过稳压、滤波，但是单片机仍然容易受到电机以及继电器的干扰，为了避免干扰，采用光电隔离，单片机和电机采用两套电源。如图二红色方框所示，4N26光耦一般需要2mA以上的驱动电流，由于单片机的输出电流只有几百微安，故需要先接74LS245或者接一个三极管增加驱动能力（74LS245的高电平驱动能力为15mA）。光耦的输出再接给达林顿管，考虑到电机的短路电流有2A，故选用TIP132型号的达林顿管（允许通过的最大瞬时电流为8A）。另外在达林顿管的C极和电源的正极之间接一个耐流为2A的二极管（蓝色方框中），这样在关断电源后，使继电器反相，可以让电机放电，这样小车不至于因为惯性而滑行太远（实验证明，如果不加二极管，同样的初速度，小车要在断电后继续前进20－30cm，如加了二级管则只要继续前进10cm左右）。考虑到走迷宫机器人对电机转速，距离控制的要求不高，为了简化程序和外接电路，所以没有考虑采用闭环PWM控制，用开环PWM控制就可以实现小车的功能。 图四 二、 传感器：1、传感器的选择：小车要实现自动导引功能和避障功能就必须要感知导引线和障碍物，感知导引线相当与给小车一个视觉功能。实现机器人的视觉功能有多种方式，有使用CCD摄像头进行图象采集