在智能车竞赛中,参赛队伍应在车模平台基础上,制作一个能够自主识别路线的智能车,然后在专门设计的赛道上自动识别道路并行驶。本文所设计的智能车,采用16位MC9S12DG128单片机作为数字控制器,由安装在车前部的黑白CMOS摄像头负责采集赛道信息,在单片机对信号进行判断处理后,由PWM发生模块发出PWM波对转向舵机进行控制,从而完成智能车的转向。智能车后轮上装有旋转编码器,可用来采集车轮速度的脉冲信号,然后由单片机使用PID控制算法处理后的控制量去改变电机驱动模块的PWM波占空比,从而控制智能车的行驶速度。
1 系统硬件电路组成
设计有效的智能车控制系统必须首先掌握控制对象的特性。根据对智能车特点的分析,可以认为,智能车转向控制系统的传递函数近似为一阶积分加纯滞后,速度控制对象的传递函数则近似为一阶惯性加纯滞后的结论。
转向控制系统主要是要求响应速度快,但对稳态控制精度要求不高。而且控制对象只有积分和滞后环节,没有常见的惯性环节。根据以上特点,本转向控制可采用PD控制器。
对速度进行检测和控制的意义在于尽可能使智能车按照道路条件允许的最高速度行驶。在弯道应将车速限制为不脱轨的最高速度,在直道则应适当进行急加速以缩短单圈运行时间,提高比赛成绩。智能车的硬件电路主要由视频处理模块、方向控制模块和车速控制模块组成。各模块与单片机之间的硬件关系如图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输出电路。适合用来控制感性直流负载(如直流电机)。通过控制MC33886的四根输入线可以方便地实现电机正转、能耗制动及反接制动。图3是经过简化的H桥电路,图中,当S1、S4导通且S2、S3截止时,电流正向流过直流电机,智能车前进;当S2、S3导通且S1、S4截止时,电流反向流过直流电机,利用这个过程可以使车模处于反接制动状态,从而迅速降低车速;当S3、S4导通且S1、S2截止时,没有电源加在直流电机上,直流电机电枢两端相当于短接在一起。
本方案采用了两片MC33886并联,直流电机驱动模块的电路原理图如图4所示。
2.3 传感器电路设计
本智能车采用CMOS摄像头作为图像传感器,以保证赛道信息采集的准确有效。CMOS摄像头的输出信号是PAL制式的复合全电视信号,每秒输出50帧(分为偶场和奇场)。
2.4 无线数据传输模块设计
该智能车加装了基于射频收发芯片nRF403的无线数据传输模块,并可在此基础上实现MOD-BUS通信协议,这对测试智能车参数及程序调试很有帮助。在运行的过程中,可以将智能车的各项参数实时发送上来,而分析智能车的运行状态可以更有针对性地对控制程序进行改进。
3 软件设计
本智能车控制系统的程序结构如图5所示。这是一个两层的分级控制系统。底层控制包括“转向控制系统”和“车速控制系统”,上层主控程序则可通过改变底层控制系统的设定值、控制参数和约束条件,来对整个控制系统进行调度。设计这种分层结构的控制系统是参照了集散控制系统DCS的结构特点,程序各部分功能明确、结构清晰,便于调试和维护。
本系统软件所实现的功能主要是初始化、数据采集和滤波处理、道路识别、电机控制和舵机控制等。其中初始化主要是设置系统默认参数。其次是数据采集及滤波处理。为了尽量减少引入的纯滞后时间,本文提出了一种独具创新性的视频信号采集方法。即用MC9S12DG128单片机提供的SPI口直接读取经过二值化处理的视频信号。
至于电机控制。本系统是用单片机通过接收旋转编码器来检测智能车后轮转动所产生的脉冲数,然后采用位置式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控制算法来控制舵机的转角,从而实现路径跟踪。
本文介绍了一种智能车控制系统的设计与实现方法。通过大量实验测试证明,该智能车能快速平稳地在制作的赛道上跟踪黑色引导线并行驶,而且寻迹效果良好,控制响应速度快,动态性能良好,稳态误差小,系统的稳定性和抗干扰能力强。