DIY编程器网

标题: 基于9S12DG128的智能车控制系统设计与实现 [打印本页]

作者: admin 时间: 2015-4-27 20:49
标题: 基于9S12DG128的智能车控制系统设计与实现
引言
我国自2006年起举办的全国大学生“飞思卡尔杯”智能汽车竞赛融科学性、趣味性和观赏性为一体，是一项以迅猛发展、前景广阔的汽车电子为背景，涵盖了自动控制、模式识别、传感技术、电子、电气、计算机、机械与汽车等多个专业学科的科技创新比赛。参赛队伍应在车模平台基础上，制作一个能够自主识别路线的智能车，然后在专门设计的赛道上自动识别道路并行驶。本文所述的智能车就是根据比赛规则要求设计并制作而成的，该智能车控制系统采用飞思卡尔半导体公司生产的16位MC9S12DG128单片机作为数字控制器，由安装在车前部的黑白CMOS摄像头负责采集赛道信息，并将采集到的信号经二值化处理后传人单片机，在单片机对信号进行判断处理后，由PWM发生模块发出PWM波对转向舵机进行控制，从而完成智能车的转向。另外，智能车后轮上装有旋转编码器，可用来采集车轮速度的脉冲信号，然后由单片机使用PID控制算法处理后的控制量去改变电机驱动模块的PWM波占空比，从而控制智能车的行驶速度。
1 系统硬件电路组成
设计有效的智能车控制系统必须首先掌握控制对象的特性。根据对智能车特点的分析，可以认为，智能车转向控制系统的传递函数近似为一阶积分加纯滞后，速度控制对象的传递函数则近似为一阶惯性加纯滞后的结论。
转向控制系统主要是要求响应速度快，但对稳态控制精度要求不高。而且控制对象只有积分和滞后环节，没有常见的惯性环节。根据以上特点，本转向控制可采用PD控制器。
对速度进行检测和控制的意义在于尽可能使智能车按照道路条件允许的最高速度行驶。在弯道应将车速限制为不脱轨的最高速度，在直道则应适当进行急加速以缩短单圈运行时间，提高比赛成绩。同时，对速度信号进行积分求和可以得到赛道长度信息，以便为道路识别与记忆模块提供数据。智能车速度控制系统的精度不需要太高，关键是如何快速响应赛道的路况变化。因此，速度采用PID控制，以便针对不同的道路状况可以迅速准确地改变车速，实现稳定过弯。智能车的硬件电路主要由视频处理模块、方向控制模块和车速控制模块组成。各模块与单片机之间的硬件关系如图1所示。

本系统中的视频处理模块由CMOS摄像头、二值化电路和同步分离电路构成；转向控制模块主要由舵机完成。舵机的转动会转化为车模转向拉杆的横向移动，从而带动车模前轮的转动，以控制智能车的行驶方向。舵机的转向控制采用PD控制，单片机可以根据赛道中央黑线的位置向舵机输出相应占空比的PWM信号。
车速控制模块主要由直流电机、驱动电路和旋转编码器构成。该模块可根据CMOS摄像头所检测的路径信息判断智能车当前所处的赛道状况，并根据旋转编码器所检测的实际车速形成对智能车行驶速度的闭环控制，合理地调整数字PID控制算法的Kp，Ki、Kd三个参数，以达到迅速响应车速并消除静态误差之目的。
2 电路设计
2．1 电源模块设计
电源模块要为单片机、传感器、舵机和驱动电机供电。因此需要提供多种电源以满足各个模块的要求。电池在完全充满之后，其空载电压只有8 V左右，而且随着电池的消耗，电压逐渐降低。此外，电机启动及反接制动时的电流很大，也有可能将电池电压拉得更低。为了避免电源电压不稳定，影响摄像头视频处理电路和单片机的正常工作，本设计使用了DC-DC变换芯片MC34063以及低差压稳压器LM2940。MC34063可输出稳定的8V电压给CMOS摄像头，LM2940则可为16位MC9S12DG128单片机、视频放大及二值化电路提供稳定的5 V电源，从而保证了系统在各种情况下的稳定运行。其电源模块电路原理图如图2所示。

2．2 直流电机驱动模块设计
直流电机驱动采用飞思卡尔公司的5 A集成H桥芯片MC33886。MC33886芯片内置有控制逻辑、电荷泵、门驱动电路以及低导通电阻的MOSFET输出电路。适合用来控制感性直流负载(如直流电机)。该芯片可以提供连续的5 A电流，并集成有过流保护、过热保护、欠压保护电路。通过控制MC33886的四根输入线可以方便地实现电机正转、能耗制动及反接制动。图3是经过简化的H桥电路，图中，当S1、S4导通且S2、S3截止时，电流正向流过直流电机，智能车前进；当S2、S3导通且S1、S4截止时，电流反向流过直流电机，利用这个过程可以使车模处于反接制动状态，从而迅速降低车速；当S3、S4导通且S1、S2截止时，没有电源加在直流电机上，直流电机电枢两端相当于短接在一起。由于电机轴在外力作用下旋转时。电机可以产生电能，此时可以把直流电动机看作一个带了很重负载的发电机，此时电机上会产生一个阻碍输出轴运动的力，这个力的大小与负荷的大小成正比，这时电机处于能耗制动状态。

本方案采用了两片MC33886并联，一方面减小导通电阻对直流电机特性的影响，另一方面，可以减小MC33886内部过流保护电路对电机启动及制动的影响。直流电机驱动模块的电路原理图如图4所示。

2．3 传感器电路设计
本智能车采用CMOS摄像头作为图像传感器，以保证赛道信息采集的准确有效。CMOS摄像头的输出信号是PAL制式的复合全电视信号，每秒输出50帧(分为偶场和奇场)。由于CMOS摄像头采集图像时，偶场和奇场不是同时采集的。因此，可以在每场信号都对路径进行识别。
2．4 无线数据传输模块设计
该智能车加装了基于射频收发芯片nRF403的无线数据传输模块，并可在此基础上实现MOD－BUS通信协议，这对测试智能车参数及程序调试很有帮助。在运行的过程中，可以将智能车的各项参数实时发送上来，而分析智能车的运行状态可以更有针对性地对控制程序进行改进。事实上，在调试运动参数的过程中，可以通过上位机软件改变Kp、Ki、Kd等参数，而不用重新烧写程序，因而十分迅速而方便。
3 软件设计
本智能车控制系统的程序结构如图5所示。这是一个两层的分级控制系统。底层控制包括“转向控制系统”和“车速控制系统”，上层主控程序则可通过改变底层控制系统的设定值、控制参数和约束条件，来对整个控制系统进行调度。设计这种分层结构的控制系统是参照了集散控制系统DCS的结构特点，程序各部分功能明确、结构清晰，便于调试和维护。为了调试方便，同时在主控程序中添加了基于无线信道的MODBUS通讯协议，因而对智能车行驶参数的监视和调整提供了很大的便利。

本系统软件所实现的功能主要是初始化、数据采集和滤波处理、道路识别、电机控制和舵机控制等。其中初始化主要是设置系统默认参数。其次是数据采集及滤波处理。为了尽量减少引入的纯滞后时间，本文提出了一种独具创新性的视频信号采集方法。即用MC9S12DG128单片机提供的SPI口直接读取经过二值化处理的视频信号。由于大赛规则中指定了赛道上黑色引导线的宽度为2．5厘米，故摄像头中采集到的引导线宽度在正常情况下也应当落在一定范围内。设计时可以用实验的方法测得引导线对应的像素宽度，然后在滤波程序中对采集到的引导线线宽进行控制，如果超出正常范围即认为是无效数据。
实验证明，这种方法可以有效地滤除干扰。智能车分层控制系统的核心是赛道的识别。实际测试发现，由于CMOS摄像头的可视范围比较小而且视野范围呈梯形，且在快速运动中经常发生赛道部分可能全部脱离视野范围的情况，给赛道识别带来很大的困难，因此，完整赛道识别模式几乎是不可能的。为了简化问题，本方案只识别赛道中的直线段，并根据直线段的数量和长度将赛道分割成不同的区域，然后在一个区域中对控制参数进行优化。
至于电机控制。本系统是用单片机通过接收旋转编码器来检测智能车后轮转动所产生的脉冲数，然后采用位置式PID控制算法的递推形式对直流电机的转速进行快速准确地控制。位置式PID控制算法的递推形式如下：
△u(k)=Kp[e(k)－e(k－1)]+Kixe(k)+Kd[e(k)－2e(k-1)+e(k-2)]，u(k)=u(k-1)+△u(k)
式中：u(k)为k时刻控制器的输出；e(k)为k时刻的偏差；Kp、Ki、Kd分别为位置式PID控制算法的比例系数、积分常数和微分常数。舵机控制也是用单片机通过CMOS摄像头来检测路径信息，然后采用不完全微分PD控制算法来控制舵机的转角，从而实现路径跟踪。
4 结束语
本文介绍了一种智能车控制系统的设计与实现方法。通过大量实验测试证明，该智能车能快速平稳地在制作的赛道上跟踪黑色引导线并行驶，而且寻迹效果良好，控制响应速度快，动态性能良好，稳态误差小，系统的稳定性和抗干扰能力强。用本设计制作的智能车在2008年举办的全国大学生“飞思卡尔杯”智能汽车竞赛中取得了华北赛区二等奖，充分证明了该设计方案的有效性和稳定性。

欢迎光临 DIY编程器网 (http://diybcq.com/)