一种一体式自动驾驶车辆控制系统技术方案

一种一体式自动驾驶车辆控制系统，包括：参考点选取模块、误差计算模块、误差消除模块、执行模块，分别与自动驾驶控制器电连接，所述执行模块还与车辆EPS电连接，其中，所述参考点选取模块用于依据当前的车速和行驶方向在规划参考线上选取一个点作为自动驾驶控制的参考点。本发明专利技术用同一种控制方法满足了自动驾驶车辆在不同工况下的需要，且本发明专利技术结构简单，占用极少控制器算力，计算实时性高，控制效果较好，用于泊车时能够准确地泊入预期停车点，用于高速行车时也有较好的鲁棒性，不易因环境扰动使得车辆出现异常的抖动。扰动使得车辆出现异常的抖动。

【技术实现步骤摘要】
一种一体式自动驾驶车辆控制系统


[0001]本专利技术属于无人驾驶
，特别涉及一种一体式自动驾驶车辆控制系统。

技术介绍

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

技术实现思路

[0004]本专利技术涉及一种一体式自动驾驶车辆控制系统，能够同时应用于自动驾驶车辆的循迹行驶和泊车的入库、出库，且在这些工况中都能够保证自动驾驶控制的精度和稳定性。
[0005]一种一体式自动驾驶车辆控制系统，包括自动驾驶控制器，所述自动驾驶控制器与车辆EPS电连接，
[0006]所述自动驾驶控制器包括参考点选取模块、误差计算模块、误差消除模块、执行模块，所述参考点选取模块用于依据当前的车速和行驶方向在规划参考线上选取一个点作为自动驾驶控制的参考点，所述误差计算模块用于基于参考点选取模块给出的参考点坐标和车辆自身位置坐标计算出自车与参考点间的横向位置误差和航向角误差，所述误差消除模块用于将误差计算模块得出的误差值通过变结构变参数的PID控制方法得到期望的方向盘转角控制量，所述执行模块用于将期望的方向盘转角控制量依据通信协议封装成报文下发给车辆的EPS，由EPS执行该控制量，最终使车辆按照预期轨迹行驶。
[0007]作为优选，所述参考点选取模块首先依据当前车速和行驶方向计算出一个平行于车辆行驶方向的预瞄距离，该距离可用下式进行表征：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.一种一体式自动驾驶车辆控制系统，包括自动驾驶控制器，所述自动驾驶控制器与车辆EPS电连接，其特征是所述自动驾驶控制器包括参考点选取模块、误差计算模块、误差消除模块、执行模块，所述参考点选取模块用于依据当前的车速和行驶方向在规划参考线上选取一个点作为自动驾驶控制的参考点，所述误差计算模块用于基于参考点选取模块给出的参考点坐标和车辆自身位置坐标计算出自车与参考点间的横向位置误差和航向角误差，所述误差消除模块用于将误差计算模块得出的误差值通过变结构变参数的PID控制方法得到期望的方向盘转角控制量，所述执行模块用于将期望的方向盘转角控制量依据通信协议封装成报文下发给车辆的EPS，由EPS执行该控制量，最终使车辆按照预期轨迹行驶。2.如权利要求1所述的一种一体式自动驾驶车辆控制系统，其特征在于，所述自动驾驶控制器还包括PID控制器模块，PID控制器模块具有一套变参数、变结构的PID控制算法。3.如权利要求1或2所述的一种一体式自动驾驶车辆控制系统，其特征在于，所述参考点选取模块首先依据当前车速和行驶方向计算出一个平行于车辆行驶方向的预瞄距离，该距离可用下式进行表征：d0为车速为0时的预瞄距离，k为预瞄距离随车速的增益系数，当车速为负，即请求泊车时，预瞄点选取在车辆后方。。4.如权利要求1或2所述的一种一体式自动驾驶车辆控制系统，其特征在于，所述参考点选取模块遍历参考轨迹上的所有点，找到参考轨迹...

【专利技术属性】
技术研发人员：骆嫚，鲁若宇，熊胜健，田小青，张蕾，
申请(专利权)人：东风悦享科技有限公司，
类型：发明
国别省市：