发明内容
本发明所要解决的技术问题是需要提供一种能够对没有自动驾驶功能,但具备转向、制动、加速及变速器的内燃引擎驱动汽车或由电池驱动的汽车进行加装,进而实现自动驾驶的自动驾驶改装方法;在此基础上,还进一步提供用于实现该适用于非自动驾驶车辆的自动驾驶改装方法的自动驾驶改装装置。
对此,本发明提供一种适用于非自动驾驶车辆的自动驾驶改装方法,通过适用于非自动驾驶车辆的自动驾驶改装装置与被改装汽车相连接,所述被改装汽车(简称汽车或车辆)为非自动驾驶车辆,所述自动驾驶改装装置分别与行车环境感知单元和自动驾驶决策单元相连,所述自动驾驶决策单元根据所述行车环境感知单元所获得的行车环境感知数据进行控制指令和车辆的运动控制传递函数的输出;所述自动驾驶决策单元包括路线规划子单元、路径规划子单元、行为选择子单元、运动规划子单元和车路协同子单元,所述路线规划子单元用于负责计算出穿过路网的路线,让汽车能从起始位置自动驾驶到达终点位置;所述路径规划子单元根据汽车状态和环境数据以及交通规则计算一组路径;所述行为选取子单元用于负责选择当前的驾驶行为,所述驾驶行为包括车道保持、交叉路口处理以及交通灯处理;所述运动规划子单元用于负责计算从汽车的当前状态到当前目标的轨迹,该轨迹遵循所述行为选取子单元所定义的路径,并满足汽车的运动学和动力学约束条件;所述车路协同子单元用于负责实现与路网以及临近车辆的驾驶协同。
本例所述适用于非自动驾驶车辆的自动驾驶改装装置通过CAN总线与自动驾驶***(可以是业内现行的也可以是自主研发的)的行车环境感知单元和自动驾驶决策单元相连,所述自动驾驶决策单元先根据所述行车环境感知单元获得行车环境感知数据进行自动驾驶决策,然后结合所述自动驾驶改装装置内的运动控制传递函数及线控制调节器,线控化非自动驾驶车辆的控制信号,所述控制信号包括但不限于转向、油门、刹车及制动控制信号,最后向汽车的ECU电子控制执行单元输出非自动驾驶车辆的自动驾驶控制信号。
本例所述与非自动驾驶车辆相连的自动驾驶改装装置与车路协同的DSRC OBU车载单元(即V2X OBU,车路协同简称V2X,DSRC是Dedicated Short Range Communication的缩写,OBU是on board unit的缩写)连接,以实现路侧云端控制下的自动驾驶模式;所述的非自动驾驶车辆的自动驾驶改装装置内含有自动驾驶模式逻辑选择开关,可使被改装车辆灵活的在基于云端路侧决策的自动驾驶或基于本地环境信息决策的自动驾驶两种驾驶模式间切换。所述自动驾驶改装装置也采集被改装车辆的人工驾驶信息。当人工驾驶信号被检测到、自动驾驶改装装置输出人工驾驶信息,即切换为人工驾驶模式。
本发明的进一步改进在于,所述行车环境感知单元包括汽车定位子单元、静态障碍物地图测绘子单元、移动目标检测与跟踪子单元、道路地图测绘子单元以及交通信号检测与识别子单元,所述汽车定位子单元用于负责估计在静态地图相关的汽车状态;所述静态障碍物地图测绘子单元用于负责计算汽车所在环境中的障碍物地图,以便汽车有能力安全地驶过公共道路而不与障碍物发生碰撞,障碍物地图包含汽车可以驶过或不能驶过的位置信息,并区分可通行与已占用区域;所述移动目标检测与跟踪子单元用于负责检测和跟踪汽车所处环境中的移动障碍物的姿态数据;所述道路测绘子单元用于负责收集汽车周围的道路和车道信息,并使用几何和拓扑属性将它们表示在地图中,包括互连的区域和受限区域;所述交通信号检测与识别子单元用于负责检测和识别交通规则定义的信号。
本发明的进一步改进在于,所述自动驾驶改装装置包括第一CAN总线、第二CAN总线、第三CAN总线和第四CAN总线,所述自动驾驶改装装置通过第一CAN总线与DSRC OBU车载单元相连;所述自动驾驶改装装置通过第二CAN总线与所述自动驾驶决策单元相连;所述自动驾驶改装装置通过第三CAN总线与汽车自身的里方向盘、刹车以及油门的操作控制信号相连;所述自动驾驶改装装置通过第四CAN总线与汽车当前的自动驾驶控制总线以及ECU电子控制执行单元相连接。
本发明的进一步改进在于,所述第一CAN总线用于负责云端路网驾驶决策与导航信息之间的传输;所述第二CAN总线用于负责基于车身环境传感器的决策与导航信息之间的传输;所述第三CAN总线用于负责在紧急情况下输出人工驾驶信息至所述自动驾驶决策单元;所述第四CAN总线用于将自动驾驶的决策指令下发至汽车中包括启停、油门、刹车以及转向的ECU电子控制执行单元。
本发明的进一步改进在于,所述自动驾驶改装装置包括用于车路协同的DSRC OBU车载单元,该DSRC OBU车载单元与路测装置进行实时通讯,安装在汽车的前挡风玻璃内侧、中间上方区域以及汽车外部车顶部中的任意一处,用于车辆定位及向周边传送自身信息,便于车辆接收道路、周边车辆及环境信息。
本发明的进一步改进在于,所述自动驾驶改装装置包括用于启动线控校正算法的线控调节开关启动按钮,所述线控校正算法包括PID控制算法,用于将原车的控制信号进行线控化,并封装成汽车的自动驾驶控制指令发送至所述第四CAN总线,原车的控制信号包括转向、刹车、油门以及制动的运动控制传递函数(也称控制模型二阶传递函数)信号。
本发明的进一步改进在于,运动控制传递函数的参数包括比例系数、积分系数以及微分系数,其参数值通过对汽车的加速、减速、制动以及转向的动态试验测试得到,或通过深度学习算法对驾驶过程中驾驶员包括转向、刹车、油门以及制动的原车操作控制参数进行分析和学习得到。
本发明的进一步改进在于,所述自动驾驶改装装置还包括自动驾驶模式逻辑选择开关,用于选择环境感知决策自动驾驶模式和路网协同云端决策自动驾驶模式;人工驾驶优先级最高,在转动方向盘或踩下刹车与油门则进入紧急人工辅助驾驶状态,直到再次按下自动驾驶模式逻辑选择开关,则进入被选择的自动驾驶模式。
本发明的进一步改进在于,通过原车命令解析模块实现原车控制信号和逻辑的解析,在路网协同云端决策自动驾驶模式下,通过原车命令解析模块定时向所述自动驾驶改装装置发送某个车辆预期下一定时时刻t0的速度v、加速度a与位置信息z,在转动方向盘或踩下刹车与油门则进入紧急人工辅助驾驶状态;直到再次选择则恢复选择的驾驶模式状态。
本发明还提供一种适用于非自动驾驶车辆的自动驾驶改装装置,用于实现如上所述的适用于非自动驾驶车辆的自动驾驶改装方法,并包括外挂和内置在非自动驾驶车辆的部分或全部组件。
与现有技术相比,本发明的有益效果在于:所述自动驾驶决策单元根据所述行车环境感知单元所获得的行车环境感知数据进行控制指令和车辆的运动控制传递函数的输出,使得操作信号通过传感和变换得到电控信号,进而使得非自动驾驶车辆具备自动驾驶能力,实现非自动驾驶向自动驾驶的快速过渡和转换,为非自动驾驶车辆实现自动驾驶找到一个通用的方法,快速且高效地实现非自动驾驶车辆的线控化。
具体实施方式
下面结合附图,对本发明的较优的实施例作进一步的详细说明。
目前相当多汽车还是不能将驾驶员的操作信号通过传感器变换成电控制信号的非线控车辆,这些汽车需要一种方法对其进行线控化,需要符合非自动驾驶车辆改装自动驾驶的技术安全升级,具体包括:1、非线控汽车的线控化;2、加入目前市面已有的车身传感器,如视频和雷达等环境数据传感器参与驾驶决策;3、通过路网管理与服务机构得到驾驶与导航决策信息(如加减速和转向等),或相反,当前车辆的位置坐标、速度和加速度信息也可发送给路网管理与服务机构,即由车路协同子单元OBU负责在车辆与路网间收发自动驾驶导航的决策信息;4、紧急情况下的自动驾驶人工干预。通过实验和理论分析证明:在相对封闭道路环境,包括停车场以及多车辆自动驾驶的决策由路网通过云计算集中决策效率远大于各车辆单独决策的效率,并且能耗最低。
因此,如图1所示,本例提供一种适用于非自动驾驶车辆的自动驾驶改装方法,通过适用于非自动驾驶车辆的自动驾驶改装装置与汽车相连接,所述汽车为线控或者非线控、电池或者内燃引擎驱动的非自动驾驶车辆。所述自动驾驶改装装置分别与自动驾驶***(可以是业内现行的也可以是自主研发的)的行车环境感知单元和自动驾驶决策单元连接。所述自动驾驶决策单元先根据所述行车环境感知单元获得行车环境感知数据,进行控制指令和车辆的运动控制传递函数的输出;然后所述自动驾驶决策单元结合所述自动驾驶改装装置内的运动控制传递函数及线控制调节器,线控化非自动驾驶车辆的转向、油门、刹车以及制动控制信号;最后向汽车的ECU电子控制执行单元输出自动驾驶的控制信号;所述自动驾驶决策单元包括路线规划子单元、路径规划子单元、行为选择子单元、运动规划子单元和车路协同子单元,所述路线规划子单元用于负责计算出穿过路网的路线,让汽车能从起始位置自动驾驶到达终点位置;所述路径规划子单元根据汽车状态和环境数据以及交通规则计算一组路径;所述行为选取子单元用于负责选择当前的驾驶行为,所述驾驶行为包括车道保持、交叉路口处理以及交通灯处理;所述运动规划子单元用于负责计算从汽车的当前状态到当前目标(到达终点位置路径上对应的目标位置)的轨迹,该轨迹遵循所述行为选取子单元所定义的路径,并满足汽车的运动学和动力学约束条件,能够保证乘客的舒适度;所述车路协同子单元(V2X的DSRC OBU)用于负责实现与路网以及临近车辆的驾驶协同,保证道路及车辆的行车安全,其规范包括但不限于C-V2X等。
本例所述的非自动驾驶车辆指的是没有自动驾驶功能,但具备转向、制动、加速及变速器(包括线控或者非线控)的内燃引擎驱动的车辆或由电池驱动的汽车,通过对这类汽车加装本例所述适用于非自动驾驶车辆的自动驾驶改装装置,加上业内通行或自主研发的自动驾驶***(套件),所述自动驾驶改装装置结合线控校正算法与训练数据集(主要是控制指令和汽车的控制模型二阶传递函数)的不同、可使满足上述条件的传统的非自动驾驶车具备L4或L5级的自动驾驶能力。
本例所述行车环境感知单元具有GPS和北斗定位接收机,还具有激光、毫米波、超声雷达以及CMOS等车身传感器,可以用于对行车环境进行检测和感知;具体包括汽车定位子单元、静态障碍物地图测绘子单元、移动目标检测与跟踪子单元、道路地图测绘子单元以及交通信号检测与识别子单元,所述汽车定位子单元用于负责估计在静态地图相关的汽车状态;所述静态障碍物地图测绘子单元用于负责计算汽车所在环境中的障碍物地图,以便汽车有能力安全地驶过公共道路而不与障碍物(如标牌或路沿等)发生碰撞,障碍物地图包含汽车可以驶过或不能驶过的位置信息,并区分可通行与已占用区域;所述移动目标检测与跟踪子单元用于负责检测和跟踪汽车所处环境中的移动障碍物的姿态数据;所述道路测绘子单元用于负责收集汽车周围的道路和车道信息,并使用几何和拓扑属性将它们表示在地图中,包括互连的区域和受限区域;所述交通信号检测与识别子单元用于负责检测和识别交通规则定义的信号,使汽车可以在遵守交通法规的基础上做出正确的决策。
本例所述自动驾驶改装装置包括用于车路协同的DSRC OBU车载单元,该DSRC OBU车载单元与路测装置进行实时或延时通讯,安装在汽车的前挡风玻璃内侧、中间上方区域以及汽车外部车顶部中的任意一处,用于解决车辆定位及向周边传送自身信息以及车辆接收道路、周边车辆及环境信息等问题,当然,也可以安装在其他合理的地方,加装简单有效。
如图1所示,本例所述自动驾驶改装装置优选包括第一CAN总线、第二CAN总线、第三CAN总线和第四CAN总线,所述自动驾驶改装装置通过第一CAN总线与DSRC OBU车载单元相连,所述第一CAN总线用于负责云端路网驾驶决策与导航信息之间的传输;所述自动驾驶改装装置通过第二CAN总线与所述自动驾驶决策单元相连,所述第二CAN总线用于负责基于车身环境传感器的决策与导航信息之间的传输;所述自动驾驶改装装置通过第三CAN总线与汽车自身的里方向盘(转向)、刹车(减速)以及油门(加速)的操作控制信号相连,所述第三CAN总线用于负责在紧急情况下输出人工驾驶信息至所述自动驾驶决策单元;所述自动驾驶改装装置通过第四CAN总线与汽车当前的自动驾驶控制总线以及ECU电子控制执行单元相连接,所述ECU电子控制执行单元为ECU,所述第四CAN总线用于将自动驾驶的决策指令下发至汽车中包括启停、油门、刹车以及转向的ECU电子控制执行单元,用于实现汽车启停、加速、减速以及转向的电子控制。
如图2所示,本例所述自动驾驶改装装置包括用于启动线控校正算法的线控调节开关启动按钮,该优选为硬件按钮,按下后默认线控校正算法的启动,所述自动驾驶改装装置的内部具有CAN总线原车命令解析模块及车辆的线控校正算法,原车命令解析模块及车辆的线控校正算法优选通过DSP、MCU或FPGA实现,DSP含有FLASHROM存放上述算法与程序,并由RTC、UART和CAN等硬件资源支持上述的程序的实现。所述原车命令解析模块用于负责解析来自第三CAN总线的原车控制,如转向、刹车、油门和制动的控制信号和逻辑,不同的车辆可能控制命令与时序不一样,需要测试或通过车厂的授权来获得;所述线控校正算法包括PID控制算法,用于将原车的控制信号进行线控化,并封装成汽车的自动驾驶控制指令发送至所述第四CAN总线,原车的控制信号包括转向、刹车、油门以及制动的控制模型二阶传递函数信号。
本例所述线控校正算法是对原车控制参数如:转向、刹车、油门和制动的控制模型的二阶传递函数外加PID调节器算法进行线控调节。如图3所示,在实际应用中,也可以通过其它有利于线控上述控制参数的线性化的高阶算法,方便自动驾驶***决策各个子单元的加装与工作,方便提升汽车的舒适驾驶程度。
本例的运动控制传递函数(也称控制模型二阶传递函数)的参数包括转向、刹车、油门、制动的各二阶传递函数模型的比例系数、积分系数以及微分系数等参数,其参数值通过对汽车的加速、减速、制动以及转向的动态试验测试得到,如图3所示,图3中,Kd表示微分因子,Ki表示积分因子,Kp表示比例因子,S表示算子,通过自动驾驶决策单元给出自动驾驶改装装置内的转向、加速、制动线控校正模块的输入给定,进而实现转向、加速、制动线控输出控制;上述各因子可通过深度学习算法对驾驶过程中驾驶员包括转向、刹车、油门以及制动的原车操作控制参数进行分析和学习得到。
其中,深度学习算法对原车操作控制参数进行分析和学习的过程如下:初始化参数,对计数器进行赋1操作,输入第一组样本,计算各层的输出,通过公式
计算误差E,其中,P为计数器参数,初始值为1;t为时间参数,代表当前时刻,当样本没计算完之后,计数器逐步加1,并通过上述公式计算各层的误差值,通过误差值调整各层的权值,直到当前误差小于预先设定的最小误差值,则结束;否则对误差值设置为0,对计数器参数进行初始化操作,返回第一组样本进行计算。当然,这只是优选的其中一种深度学习算法,在实际应用中也可以通过其它的线性化的高阶算法或深度学习算法对原车操作控制参数进行分析和学习。
本例所述自动驾驶改装装置还优选包括自动驾驶模式逻辑选择开关,属于硬件输入开关,用于选择环境感知自动驾驶模式或路网协同云端决策自动驾驶模式,环境感知自动驾驶模式属于一种依靠车辆自身环境感知传感器+高精度地图+本地决策算法进行自动驾驶的工作模式;人工驾驶优先级最高,在转动方向盘或踩下刹车与油门则进入紧急人工辅助驾驶状态,直到再次按下自动驾驶模式逻辑选择开关,则进入被选择的自动驾驶模式。
本例通过原车命令解析模块实现原车控制信号和逻辑的解析,路网协同云端决策自动驾驶模式属于一种依靠路网信息采集+云端驾驶决策+高精度地图进行自动驾驶的工作模式,在路网协同云端决策自动驾驶模式下,通过路网定时向所述自动驾驶改装装置发送该车辆下一时刻t0的速度v、加速度a与位置信息z,该信号在改装装置内部转换为控制车辆驾驶的转向角度、油门大小、刹车力度大小及制动与否的信号,送给汽车的电控单元。依据汽车在转动方向盘或踩下刹车与油门则进入紧急人工辅助驾驶状态;直到再次选择则恢复选择的驾驶模式状态。定时发送的周期依据路网的限速、交通流量的控制要求而定、如果是120公里的高速公路,限速是33.3M米每秒,200M的车距、则发送周期设置3秒;当然,这些数值的限定和设置可以根据实际情况进行修改和自定义设置。
具体的,如图2所示,本例所述适用于非自动驾驶车辆的自动驾驶改装方法的工作过程如下:首先判断线控调节开关启动按钮是否按下,若是,则读入原车辆方向盘、刹车、油门以及制动的控制模型二阶传递函数,或通过深度学习算法对驾驶过程中驾驶员包括转向、刹车、油门以及制动的原车操作控制参数进行分析和学习得到汽车线控调节器的比例、积分和微分系数;若否,则跳转至自动驾驶模式逻辑选择;此时,如果选择了路网协同云端决策自动驾驶模式,则进入路网协同云端决策自动驾驶模式并接收下一时刻的速度、加速度以及转向角度等信息,如果没有进入路网协同云端决策自动驾驶模式则默认进入环境感知自动驾驶模式,或接收紧急人工辅助驾驶状态信息,以便非自动驾驶车辆快速且高效地实现自动驾驶的过渡和转换。
如图1所示,本例还提供一种适用于非自动驾驶车辆的自动驾驶改装装置,用于实现如上所述的适用于非自动驾驶车辆的自动驾驶改装方法,并包括外挂和内置在非自动驾驶车辆的部分或全部组件。通过该自动驾驶改装装置与传统的非自动驾驶车辆相连,然后根据线控校正算法与深度学习算法的训练数据集,主要包括控制指令和车辆的运动控制传递函数,可使传统的所述非自动驾驶车辆具备L4或L5级的自动驾驶能力。
综上所述,本例所述自动驾驶决策单元根据所述行车环境感知单元所获得的行车环境感知数据进行控制指令和车辆的运动控制传递函数的输出,使得操作信号通过传感和变换得到电控信号,进而使得非自动驾驶车辆具备自动驾驶能力,实现非自动驾驶向自动驾驶的快速过渡和转换,为非自动驾驶车辆实现自动驾驶找到一个通用的方法,快速且高效地实现非自动驾驶车辆的线控化。
以上内容是结合具体的优选实施方式对本发明所作的进一步详细说明,不能认定本发明的具体实施只局限于这些说明。对于本发明所属技术领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干简单推演或替换,都应当视为属于本发明的保护范围。