专利名称：一种自动驾驶车辆的油门智能控制系统的制作方法
技术领域：
本实用新型涉及是一种自动驾驶车辆的油门智能控制系统，属于汽车领域。
二、背景技术自动驾驶和辅助驾驶系统在智能交通领域占有重要的地位，是智能车辆速度控制的一个重要的组成部分，其性能的好坏直接影响到了智能车辆的速度控制性能和精度。智能车辆的应用对车辆的自动和半自动驾驶，速度巡航自动泊车辅助驾驶技术有重要的实际意义。其电子油门的控制系统将计算机、单片机、机械、电气、控制技术的结合；同时也是辅助驾驶和主动安全技术的重要组成部分，随着人们对交通和车辆的安全意识的提高，其越来越受到人们的重视。有时由于驾驶员的经验不够丰富，对油门踏板和制动踏板的使用次数比较多，油门的一些损耗和开度变化很大，造成大量费油的情况。同时驾驶员长时间保持一个姿势控制油门踏板，驾驶的舒适性毫无保障，并容易产生疲劳，不利于安全行驶。自动和辅助驾驶的油门控制技术，是由车速传感器(光电编码盘)，直流有刷电机，CAN总线网络、控制和采集单元的MCU，控制上位机单元组成。但是一般的控制系统只有单独的油门位置反馈，测速精度不够，一个大的系统闭环没有实现，对油门开度的计算也不够准确，这样不能保证油门和速度的平稳性和实时性，对车辆速度控制精度也无法保证，无法满足乘客的舒适性。
三
实用新型内容本实用新型旨在提供一种对自动驾驶和辅助驾驶有效稳定的油门智能控制控制方法，为了能让车辆油门速度控制有足够精度同时保障乘客的舒适性，能让车辆在自动巡航和自动泊车关键技术中发挥其安全方便的优势。为了达到上述目的，本实用新型是这样实现的一种自动驾驶车辆的油门智能控制系统，是基于智能电动车平台BJUT号，采用三个MCU搭建的CAN网络传输控制信息，各个MCU功能分别为微控制器一 HUB微处理器构建CAN网络并通过串口和上位机电脑通信、微控制器二采集并处理车速信息、微控制器三控制直流有刷电机进行电子油门的行程控制；上位机电脑通过各个单片机发送回来的信息和时间戳进行增量处理，把油门开度的模糊PID输出量发送给控制油门的MCU，来实现整体的车速控制。包括三个微处理器MCU、直流有刷电机、电机驱动电路、光电编码器、油门行程传感器、串口、制动踏板传感器。系统具有三个MCU，一个是负责采集的速度反馈信号，一个是控制油门电机的MCU，一个是搭建CAN网络的HUB微控制器，一个光电编码盘速度计，一个油门行程传感器，油门控制MCU应用的其CAN模块收到其控制油门开度的数据，然后通过脉冲宽度调制PWM模块和电机驱动模块H桥电路连接直流有刷电机。速度采集MCU通过增强型定时器ETC来进行定时中断来采集光电编码盘的脉冲个数并计算速度值，并把速度值通过HUB微控制器发送给上位机电脑，上位机电脑通过计算模糊增量PID计算出期望油门开度，并串口和HUB微控制器进行连接发送到底层CAN网络里面。其上述系统中微控制器为MC9S12DG128B单片机，其应用的油门电机为Maxon直流有刷电机。四、有益效果由于采用了有效的模糊增量PID和时间戳算法，本实用新型具有以下的特点，控制精度高，并且可以在计算中考虑弥补延迟时间多少来改变控制策略，同时计算效率和稳定性高，不会出现致命错误。软硬件分离、功能模块化程度高。其中加入和对速度检测的MCU和CAN总线HUB微控制器能很好的结合上位机和下位机的数据，底层CAN总线网络抗干扰能力强可以增加多个节点，让车辆控制更加灵活。同时在上位机形成速度控制闭环系统， 上位机电脑速度快运算效率高，可以在很短的时间中进行复杂的算法。基于以上几点，本系统可以很好的提高自动驾驶和辅助驾驶的油门控制精度和能力。是车辆行驶平稳安全。
五、
附图I是本实用新型自动驾驶车辆的油门智能控制的算法流程图附图2是本实用新型自动驾驶和辅助驾驶控制系统的方框图附图3是本实用新型自动驾驶车辆的油门控制MCU的原理图附图4是本实用新型自动驾驶车辆的油门控制中电机驱动模块的电气原理图附图5是本实用新型自动驾驶车辆的油门控制中电源模块原理图附图6是本实用新型自动驾驶车辆的油门控制中速度采集模块电气原理图图中具体编号I.为 MCU 控制器 MC9S12DG128B2.为最小系统的复位电路3.滤波电路4.时钟电路5.直流电机6.驱动 MOS 管7.保护二极管8.电源稳压模块9.光电码盘内部原理10.整形电路
六、具体的实施方式图I所示是算法的流程图中，从开始从光电编码盘MCU中ECT模块定时捕获得脉冲值，增加时间戳并计算速度值发送给上位机，通过模糊增量PID计算当前控制量，检测计算当前控制量是否已经超过了最大控制量的极限，检测当前控制量是否小于最小控制量的限制，如果计算出来的控制量在其范围内，输出控制量作用于油门电机控制其到达指定位置。在MCU采集光电编码盘的脉冲的时候采用定时50ms采集计算一次速度值，同时应用车轮半径信息算出所行驶的里程。通过串口发送到上位机软件中，其中波特率为19200，校验位位NONE，数据位8，停止位为I。通过多线程编程处理串口接收和要发送的数据。通过模糊增量PID算出其给电机输出的增量值后，发送给电机控制MCU，通过MCU中的PWM模块配置一个2kHZ的控制量。应用ECT模块每50ms定时发送一次电机控制信号。如图2所示油门智能控制系统由四部分组成，包括三个MCU和一个上位机构成。由车速传感器(光电编码盘)，直流有刷电机，CAN总线网络、控制和采集单元的MCU，控制上位机、油门踏板行程传感器构成，通过三个MCU输入三个传感器信号，可以分别向单片机提供速度信息，油门踏板行程，电机的位置信息。电机控制MCU通过上位机发送的信号对控制微控制器的PWM模块发送脉宽调制信号，来控制油门电机拉动油门工作。通过CAN网络来进行各个车辆实时的信息传输，并对车辆信息进行编码和解码。本实用新型实施应用MCU为MC9S12DG128B单片机控制油门电机如图3所示为其
最小系统电气原理图。应用PP4 PP5来组成双通道的PWM波的输出，首先进行PWM模块的初始化，使能PWM模块，设置PWM的周期和占空比参数进行，通过MCU中的ECT模块进行定时50ms来进行·电机的控制。输出控制电机的模拟信号，PB 口接出工作指示灯，通过设置不同工作状态对应的灯的状态来监测MCU的工作状态。PTl为MCU的采集光电编码盘脉冲的输入端口，通过ECT模块定时发送已经读取并计算出来的速度值。如图4所示为电机驱动H桥模块。如图5所示电源稳压电路，图6所示为速度采集电路本实用新型的关键是通过整个系统的采集信息和时间戳，和模糊增量PID算法可以有很高的精度来控制油门，整个3个MCU工作是否协调一致，CAN总线的通讯是否畅通都是整个系统运行的关键，下面结合实例对各个模块的通讯和流程进行进一步的说明I.初始化3个MCU模块，设置MCU的总线频率，初始化时钟模块，设置锁相环PLL参数，采集MCU的PTO设置为输入捕捉方式，PTl设置定时中断，设置PB各个端口位输出I/O模式允许中断。2.设置定时50ms进行一次中断将输入捕捉采集的信息转换成速度信息和里程信息通过串口发送给上位机。PB接口 LED灯的状态是从向右依次闪烁。3.上位机通过SerialPort的类应用VC6. O环境编写上位机串口接收软件，通过多线程的分别处理收发串口得到的信息。首先计算其偏差量，确定其时间戳，然后通过模糊增量PID来计算其控制量，判断其计算出得控制量是否大于上界和计算出来的控制量是否小于下界。最后确定要输出的控制量，通过串口下发到Hub的MCU中。4. HubMCU经过解码和换算处理，通过CAN总线网络分别对整个控制网络中的不同ID的MCU进行发送相关信息。5.当控制电机MCU其CAN中的ID值为0x100接收到控制电机的参数的时候，其解码成对应的PWM占空比通过电机驱动模块来控制电机拉动油门行程。来实时控制智能车辆的速度。6.不断采集速度信息，在控制周期范围内来下发命令来控制油门电机和车速。
权利要求1. 一种自动驾驶车辆的油门智能控制系统，是基于智能电动车平台BJUT号，其特征在于采用三个MCU搭建的CAN网络传输控制信息，各个MCU功能分别为微控制器一 HUB微处理器构建CAN网络并通过串口和上位机电脑通信、微控制器二采集并处理车速信息、微控制器三控制直流有刷电机进行电子油门的行程控制；上位机电脑通过各个单片机发送回来的信息和时间戳进行增量处理，把油门开度的模糊PID输出量发送给控制油门的MCU，来实现整体的车速控制。·
专利摘要本实用新型涉及一种自动驾驶车辆的油门智能控制系统，是基于智能交通的自动驾驶和辅助驾驶技术的实际应用，通过光电编码盘测速器来实时采集车速信息并进行里程记录传输给上位机电脑，上位机电脑经过计算形成对速度控制的闭环，通过模糊增量PID方法控制电子油门开度，发送给油门MCU微控制器并使其PWM波模块控制直流有刷电机来控制油门行程从而控制车速，并搭建车辆底层CAN总线网络传输车辆状态信息。有效的提高自动驾驶车辆的油门的控制精度。
文档编号F02D11/10GK202789143SQ201220078348
公开日2013年3月13日 申请日期2012年3月5日 优先权日2012年3月5日
发明者于宏啸, 段建民, 李玮, 胡建锋 申请人:北京工业大学