智能巡线小车的多模式速度控制系统.docVIP

摘要：介绍了基于Freescale?HCS12系列单片机的智能巡线小车多模式速度控制系统的设计方案。该速度控制系统主要由直流电机驱动电路、速度检测模块和无线通信模块构成，包含四种速度模式。介绍了速度控制系统的总体结构，并分析了其主要模块的工作原理。介绍了软件思想和程序设计流程图。实验结果表明，该多模式速度控制系统保证了智能巡线小车具有较好的稳定性和快速跟随性。 关键词：单片机；多模式；制动；稳定性；快速跟随性 引言 目前，设计出具有智能化的产品已经成为商家开发产品的目标之一，也是学生课外科技活动的热点之一；其中，专门针对具有自主巡线功能的智能小车的设计更是数不胜数，但大多数智能巡线小车只是完成了“智能化”所要求的各部分的功能，在小车速度的稳定性和快速性上考虑的相对比较少。本文主要针对具有自主巡线功能的智能小车，设计出了一种多模式速度控制系统，可以使智能小车具有较好的稳定性和快速跟随性。同时，该速度控制系统的多模式设计思想也可以用在以其它系列单片机为控制核心的智能模型车上。 1 控制系统原理 多模式速度控制系统的速度模式有4种：1、开环加速模式2、反接制动模式3、能耗制动模式4、速度闭环运行模式。系统模式通过速度测量值与给定值的偏差范围进行选择，速度给定值由前方传感器检测到的路径形状进行设定，而偏差范围与模式选择的关系根据电机自身的特性曲线和智能小车实际运行情况进行设定。 多模式速度控制系统由HCS12单片机、直流电机驱动电路、直流电机、速度检测模块和无线通信模块组成。单片机产生的PWM波通过由H桥组成的驱动电路来控制直流电机的输入电压大小，速度检测模块通过旋转编码器把电机的转速转换为单位时间内的脉冲个数，无线通信模块实现对速度控制系统相关参数的实时监测与调整，主要用于系统的调试和开发。整个速度控制系统的电源均由一节7.2V镍镉电池提供，控制系统原理图如图1所示。系统中使用低差压稳压器LM2940将7.2V电源变为5V稳压电源输出，可为单片机、速度检测模块和无线通信模块等提供相应的电源，也可减少电池电压不稳定给控制系统各个部分带来的不良影响，保证了控制系统的稳定运行 \o 【1】。 图1? 控制系统原理图 2 控制系统硬件设计 2.1 直流电机驱动电路 系统中采用的直流电机型号为RS—380H。直流电机驱动采用飞思卡尔公司的5A 集成H 桥芯片MC33886。MC33886芯片内置了控制逻辑、电荷泵、门驱动电路以及低导通电阻的MOSFET 输出电路，适合用来控制感性直流负载，可以提供连续的5A 电流，并且集成了过流保护、过热保护、欠压保护。直流电机驱动电路如图2所示。 ??????????????????????? ?图2? 直流电机驱动电路 通过控制MC33886 的四根输入线可以方便地实现电机正转、反转、能耗制动及反接制动。图3为经过简化的H 桥电路，当S1、S4 导通且S2、S3 截止时，电流正向流过电机，电机正转；S2、S3 导通S1、S4 截止时，电流反向流过电机，适当利用这个过程可以使电机处于反接制动状态，迅速降低电机速度；当S3、S4导通且S1、S2 截止时，没有电源加在电机上，可认为电机一端直接与另一端连接在一起，此时电机处于能耗制动状态。 本设计中使用两片MC33886 并联，一方面进一步减小导通电阻对电机特性的影响，另一方面减小过流保护电路对电机启动及制动时的影响 \o 【2】。 ??? ? ????????????????????? ?????图3? 简化的H桥电路 ??? 2.2 速度检测模块 通过在电机驱动轴的齿轮上加装小型旋转编码器,使旋转编码器齿轮与电机驱动轴的齿轮进行啮合。这样，就可通过实验测定每个脉冲对应的智能小车运行的距离；同时，可设定一个合适的定时中断作为脉冲采样周期，根据每个采样周期内旋转编码器的输出脉冲个数就可计算出智能小车的实际速度，这样就使脉冲个数和智能小车实际速度具有了明确的对应关系，实际操作、测量非常方便。在本设计中，选用了OMRON E6A2-CS3E旋转编码器，该编码器采用5v 供电，单相输出，每圈输出60个脉冲，用在本系统中比较合适 \o 【3】。在采样周期的选取中，考虑到脉冲计数器所能允许的最大值及脉冲计数值要参与实际的运算，为了避免数据溢出，采样周期不能选取过大。 2.3 无线通信模块 本系统中的无线通信模块是基于nRF403的无线数据传输模块，并在此基础上实现了MODBUS 通信协议。该模块在智能小车参数测试及程序调试的过程中起到了很大的作用。在智能小车运行的过程中，可以通过下位机将与小车运行状态有关的各项参数发送到上位机，并可通过简单的VB程序在上位机上显示出相应的状态曲线，从而达到对智能小车的运行状态进行实时监测的目的。在PID参数整定过程中，根