1.本发明属于无人驾驶技术领域，特别涉及一种一体式自动驾驶车辆控制系统。


背景技术：

2.自动泊车功能是自动驾驶系统的一个重要组成部分，与自动驾驶的循迹行驶功能类似，自动泊车功能也由泊车规划模块和泊车控制模块组成，其中泊车规划模块提供一条由车辆当前位置到车位停车点的平滑的泊车轨迹线，泊车控制模块负责控制车辆的挡位、方向盘转角、制动/油门踏板开度，使车辆按照规划轨迹线平稳地泊入车位。
3.自动驾驶车辆的控制方法与车辆的运行场景强相关，自动驾驶车辆循迹行驶时车速较高，任何微小的抖动都会被放大，因此行车的控制方法更注重与控制的稳定性与鲁棒性，不需要过多关注车辆当前位置误差；自动驾驶车辆泊车入库时，车辆动力学模型由前轮转向变为后轮转向，且车速较低，为了保证车辆能够准确地泊入车位，泊车的控制方法更关注车辆当前的位置误差和航向误差。现有技术方案基于上述考虑，往往采用两套或以上控制方法，分别用于车辆行车和泊车的入库、出库控制。


技术实现要素：

4.本发明涉及一种一体式自动驾驶车辆控制系统，能够同时应用于自动驾驶车辆的循迹行驶和泊车的入库、出库，且在这些工况中都能够保证自动驾驶控制的精度和稳定性。
5.一种一体式自动驾驶车辆控制系统，包括自动驾驶控制器，所述自动驾驶控制器与车辆eps电连接，
6.所述自动驾驶控制器包括参考点选取模块、误差计算模块、误差消除模块、执行模块，所述参考点选取模块用于依据当前的车速和行驶方向在规划参考线上选取一个点作为自动驾驶控制的参考点，所述误差计算模块用于基于参考点选取模块给出的参考点坐标和车辆自身位置坐标计算出自车与参考点间的横向位置误差和航向角误差，所述误差消除模块用于将误差计算模块得出的误差值通过变结构变参数的pid控制方法得到期望的方向盘转角控制量，所述执行模块用于将期望的方向盘转角控制量依据通信协议封装成报文下发给车辆的eps，由eps执行该控制量，最终使车辆按照预期轨迹行驶。
7.作为优选，所述参考点选取模块首先依据当前车速和行驶方向计算出一个平行于车辆行驶方向的预瞄距离，该距离可用下式进行表征：d0为车速为0时的预瞄距离，k为预瞄距离随车速的增益系数，当车速为负，即请求泊车时，预瞄点选取在车辆后方。
[0008][0009]
作为优选，所述自动驾驶控制器还包括pid控制器模块，pid控制器模块具有一套变参数、变结构的pid控制算法。
[0010]
作为优选，所述参考点选取模块遍历参考轨迹上的所有点，找到参考轨迹上距离预瞄点最近的一个点和该点的下一个点，连接这两个点得到参考航向角，从预瞄点向这两
点的连线作垂线，垂足到预瞄点的距离为横向距离误差，若这两点连线平行于车辆航向，则直接输出误差为0。
[0011]
作为优选，所述误差计算模块将横向距离误差和航向角误差综合计算得到一个误差值，由于航向角的量纲为弧度，位置的量纲为米，因此误差计算模块通过atan函数将位置误差值统一到角度量纲下，计算方法可用下式进行表征：error为综合后的误差，k为位置误差权重，1-k为航向角误差权重。
[0012]
error＝k*atan*err
pos
+(1-k)err
θ
[0013]
作为优选，所述误差消除模块通过变结构变参数pid控制器对综合误差进行消除，输出一个期望方向盘转角，其中pid控制器的参数及结构由车速与车辆挡位进行确定，确保在低速行车、高速行车、泊车、出库时都有较好的控制效果。
[0014]
作为优选，所述执行模块接收误差消除模块计算出的期望方向盘转角，并实时按照通讯协议将其封装为报文下发给车辆eps控制单元，使得车辆的实际方向盘转角与期望一致，则车辆按照预期行驶路径行驶。
[0015]
与现有技术相比，本发明的有益效果是：
[0016]
1.本发明用同一种控制架构满足了自动驾驶车辆在不同工况下的需要，且本发明控制架构结构简单，占用极少控制器算力，计算实时性高，控制效果较好，用于泊车时能够准确地泊入预期停车点，用于高速行车时也有较好的鲁棒性，不易因环境扰动使得车辆出现异常的抖动；
[0017]
2.本发明采用一套变参数、变结构的pid控制器算法，便于测试人员实车调试，大大提高了调试效率，由于采用同一套控制方法，本发明从根本上避免了车辆运行过程中不同控制方法切换时车辆可能产生的抖动。
附图说明
[0018]
图1为本发明控制模块结构图；
[0019]
图2为本发明控制流程图。
具体实施方式
[0020]
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
[0021]
如图1、图2所示，一体式自动驾驶车辆控制系统，包括自动驾驶控制器，所述自动驾驶控制器与车辆eps电连接，
[0022]
所述自动驾驶控制器具有一存储介质(存储器)，存储介质中包括路径规划模块，路径规划模块结合北斗导航模块(模块化电路)和传感器信息，下发的轨迹规划点信息和车辆定位信息、pid控制器模块，pid控制器模块具有一套变参数、变结构的pid控制算法。
[0023]
此外，所述自动驾驶控制器存储介质中还存储包括参考点选取模块、误差计算模块、误差消除模块、执行模块。
[0024]
所述参考点选取模块用于依据当前的车速和行驶方向在规划参考线上选取一个
点作为自动驾驶控制的参考点。参考点选取模块依据当前车速和行驶方向计算出一个平行于车辆行驶方向的预瞄距离，选出预瞄点，当车速为负，即请求泊车时，预瞄点选取在车辆后方；同时遍历参考轨迹上的所有点，找到参考轨迹上距离预瞄点最近的一个点，作为参考点。再遍历参考轨迹上的所有点，找到参考轨迹上距离预瞄点最近的一个点和该点的下一个点，连接这两个点得到参考航向角，从预瞄点向这两点的连线作垂线，垂足到预瞄点的距离为横向距离误差，若这两点连线平行于车辆航向，则直接输出误差为0。
[0025]
所述参考点选取模块首先依据当前车速和行驶方向计算出一个平行于车辆行驶方向的预瞄距离，该距离可用下式进行表征：d0为车速为0时的预瞄距离，k为预瞄距离随车速的增益系数，当车速为负，即请求泊车时，预瞄点选取在车辆后方。
[0026][0027]
所述误差计算模块用于基于参考点选取模块给出的参考点坐标和车辆自身位置坐标计算出自车与参考点间的横向位置误差和航向角误差，
[0028]
所述误差计算模块将横向距离误差和航向角误差综合计算得到一个误差值，由于航向角的量纲为弧度，位置的量纲为米，因此误差计算模块通过atan函数将位置误差值统一到角度量纲下，计算方法可用下式进行表征：error为综合后的误差，k为位置误差权重，1-k为航向角误差权重。
[0029]
error＝k*atan*err
pos
+(1-k)err
θ
[0030]
所述误差消除模块通过变结构变参数pid控制器对综合误差进行消除，输出一个期望方向盘转角，其中pid控制器的参数及结构由车速与车辆挡位进行确定，确保在低速行车、高速行车、泊车、出库时都有较好的控制效果。
[0031]
横向控制能够同时应用于自动驾驶车辆的循迹行驶和泊车的入库、出库，且在这些工况中都能够保证自动驾驶控制的精度和稳定性。
[0032]
所述执行模块接收误差消除模块计算出的期望方向盘转角，将得出的误差值通过变结构变参数的pid控制方法得到期望的方向盘转角控制量。若误差值为0，则直接执行方向盘转角，如误差值不为0，则所述误差消除模块通过变结构变参数pid控制器对综合误差进行消除，输出一个期望方向盘转角；
[0033]
所述执行模块用于将期望的方向盘转角控制量实时依据通信协议封装成报文下发给车辆的eps，由eps执行该控制量，使得车辆的实际方向盘转角与期望一致，最终使车辆按照预期轨迹行驶。
[0034]
尽管已经示出和描述了本发明的实施例，对于本领域的普通技术人员而言，可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型，本发明的范围由所附权利要求及其等同物限定。
[0035]
上述本发明实施例序号仅仅为了描述，不代表实施例的优劣。
[0036]
上面结合附图对本发明的实施例进行了描述，但是本发明并不局限于上述的具体实施方式，上述的具体实施方式仅仅是示意性的，而不是限制性的，本领域的普通技术人员在本发明的启示下，在不脱离本发明宗旨和权利要求所保护的范围情况下，还可做出很多形式，这些均属于本发明的保护之内。