CN114013429A - 一种一体式自动驾驶车辆控制系统 - Google Patents

一种一体式自动驾驶车辆控制系统 Download PDF

Info

Publication number
CN114013429A
CN114013429A CN202111593965.2A CN202111593965A CN114013429A CN 114013429 A CN114013429 A CN 114013429A CN 202111593965 A CN202111593965 A CN 202111593965A CN 114013429 A CN114013429 A CN 114013429A
Authority
CN
China
Prior art keywords
vehicle
error
module
automatic driving
reference point
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN202111593965.2A
Other languages
English (en)
Inventor
骆嫚
鲁若宇
熊胜健
田小青
张蕾
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Dongfeng Yuexiang Technology Co Ltd
Original Assignee
Dongfeng Yuexiang Technology Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Dongfeng Yuexiang Technology Co Ltd filed Critical Dongfeng Yuexiang Technology Co Ltd
Priority to CN202111593965.2A priority Critical patent/CN114013429A/zh
Publication of CN114013429A publication Critical patent/CN114013429A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/06Automatic manoeuvring for parking
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

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

Description

一种一体式自动驾驶车辆控制系统
技术领域
本发明属于无人驾驶技术领域,特别涉及一种一体式自动驾驶车辆控制系统。
背景技术
自动泊车功能是自动驾驶系统的一个重要组成部分,与自动驾驶的循迹行驶功能类似,自动泊车功能也由泊车规划模块和泊车控制模块组成,其中泊车规划模块提供一条由车辆当前位置到车位停车点的平滑的泊车轨迹线,泊车控制模块负责控制车辆的挡位、方向盘转角、制动/油门踏板开度,使车辆按照规划轨迹线平稳地泊入车位。
自动驾驶车辆的控制方法与车辆的运行场景强相关,自动驾驶车辆循迹行驶时车速较高,任何微小的抖动都会被放大,因此行车的控制方法更注重与控制的稳定性与鲁棒性,不需要过多关注车辆当前位置误差;自动驾驶车辆泊车入库时,车辆动力学模型由前轮转向变为后轮转向,且车速较低,为了保证车辆能够准确地泊入车位,泊车的控制方法更关注车辆当前的位置误差和航向误差。现有技术方案基于上述考虑,往往采用两套或以上控制方法,分别用于车辆行车和泊车的入库、出库控制。
发明内容
本发明涉及一种一体式自动驾驶车辆控制系统,能够同时应用于自动驾驶车辆的循迹行驶和泊车的入库、出库,且在这些工况中都能够保证自动驾驶控制的精度和稳定性。
一种一体式自动驾驶车辆控制系统,包括自动驾驶控制器,所述自动驾驶控制器与车辆EPS电连接,
所述自动驾驶控制器包括参考点选取模块、误差计算模块、误差消除模块、执行模块,所述参考点选取模块用于依据当前的车速和行驶方向在规划参考线上选取一个点作为自动驾驶控制的参考点,所述误差计算模块用于基于参考点选取模块给出的参考点坐标和车辆自身位置坐标计算出自车与参考点间的横向位置误差和航向角误差,所述误差消除模块用于将误差计算模块得出的误差值通过变结构变参数的PID控制方法得到期望的方向盘转角控制量,所述执行模块用于将期望的方向盘转角控制量依据通信协议封装成报文下发给车辆的EPS,由EPS执行该控制量,最终使车辆按照预期轨迹行驶。
作为优选,所述参考点选取模块首先依据当前车速和行驶方向计算出一个平行于车辆行驶方向的预瞄距离,该距离可用下式进行表征:d0为车速为0时的预瞄距离,k为预瞄距离随车速的增益系数,当车速为负,即请求泊车时,预瞄点选取在车辆后方。
Figure BDA0003430189110000021
作为优选,所述自动驾驶控制器还包括PID控制器模块,PID控制器模块具有一套变参数、变结构的PID控制算法。
作为优选,所述参考点选取模块遍历参考轨迹上的所有点,找到参考轨迹上距离预瞄点最近的一个点和该点的下一个点,连接这两个点得到参考航向角,从预瞄点向这两点的连线作垂线,垂足到预瞄点的距离为横向距离误差,若这两点连线平行于车辆航向,则直接输出误差为0。
作为优选,所述误差计算模块将横向距离误差和航向角误差综合计算得到一个误差值,由于航向角的量纲为弧度,位置的量纲为米,因此误差计算模块通过atan函数将位置误差值统一到角度量纲下,计算方法可用下式进行表征:error为综合后的误差,k为位置误差权重,1-k为航向角误差权重。
error=k*atan*errpos+(1-k)errθ
作为优选,所述误差消除模块通过变结构变参数PID控制器对综合误差进行消除,输出一个期望方向盘转角,其中PID控制器的参数及结构由车速与车辆挡位进行确定,确保在低速行车、高速行车、泊车、出库时都有较好的控制效果。
作为优选,所述执行模块接收误差消除模块计算出的期望方向盘转角,并实时按照通讯协议将其封装为报文下发给车辆EPS控制单元,使得车辆的实际方向盘转角与期望一致,则车辆按照预期行驶路径行驶。
与现有技术相比,本发明的有益效果是:
1.本发明用同一种控制架构满足了自动驾驶车辆在不同工况下的需要,且本发明控制架构结构简单,占用极少控制器算力,计算实时性高,控制效果较好,用于泊车时能够准确地泊入预期停车点,用于高速行车时也有较好的鲁棒性,不易因环境扰动使得车辆出现异常的抖动;
2.本发明采用一套变参数、变结构的PID控制器算法,便于测试人员实车调试,大大提高了调试效率,由于采用同一套控制方法,本发明从根本上避免了车辆运行过程中不同控制方法切换时车辆可能产生的抖动。
附图说明
图1为本发明控制模块结构图;
图2为本发明控制流程图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图1、图2所示,一体式自动驾驶车辆控制系统,包括自动驾驶控制器,所述自动驾驶控制器与车辆EPS电连接,
所述自动驾驶控制器具有一存储介质(存储器),存储介质中包括路径规划模块,路径规划模块结合北斗导航模块(模块化电路)和传感器信息,下发的轨迹规划点信息和车辆定位信息、PID控制器模块,PID控制器模块具有一套变参数、变结构的PID控制算法。
此外,所述自动驾驶控制器存储介质中还存储包括参考点选取模块、误差计算模块、误差消除模块、执行模块。
所述参考点选取模块用于依据当前的车速和行驶方向在规划参考线上选取一个点作为自动驾驶控制的参考点。参考点选取模块依据当前车速和行驶方向计算出一个平行于车辆行驶方向的预瞄距离,选出预瞄点,当车速为负,即请求泊车时,预瞄点选取在车辆后方;同时遍历参考轨迹上的所有点,找到参考轨迹上距离预瞄点最近的一个点,作为参考点。再遍历参考轨迹上的所有点,找到参考轨迹上距离预瞄点最近的一个点和该点的下一个点,连接这两个点得到参考航向角,从预瞄点向这两点的连线作垂线,垂足到预瞄点的距离为横向距离误差,若这两点连线平行于车辆航向,则直接输出误差为0。
所述参考点选取模块首先依据当前车速和行驶方向计算出一个平行于车辆行驶方向的预瞄距离,该距离可用下式进行表征:d0为车速为0时的预瞄距离,k为预瞄距离随车速的增益系数,当车速为负,即请求泊车时,预瞄点选取在车辆后方。
Figure BDA0003430189110000051
所述误差计算模块用于基于参考点选取模块给出的参考点坐标和车辆自身位置坐标计算出自车与参考点间的横向位置误差和航向角误差,
所述误差计算模块将横向距离误差和航向角误差综合计算得到一个误差值,由于航向角的量纲为弧度,位置的量纲为米,因此误差计算模块通过atan函数将位置误差值统一到角度量纲下,计算方法可用下式进行表征:error为综合后的误差,k为位置误差权重,1-k为航向角误差权重。
error=k*atan*errpos+(1-k)errθ
所述误差消除模块通过变结构变参数PID控制器对综合误差进行消除,输出一个期望方向盘转角,其中PID控制器的参数及结构由车速与车辆挡位进行确定,确保在低速行车、高速行车、泊车、出库时都有较好的控制效果。
横向控制能够同时应用于自动驾驶车辆的循迹行驶和泊车的入库、出库,且在这些工况中都能够保证自动驾驶控制的精度和稳定性。
所述执行模块接收误差消除模块计算出的期望方向盘转角,将得出的误差值通过变结构变参数的PID控制方法得到期望的方向盘转角控制量。若误差值为0,则直接执行方向盘转角,如误差值不为0,则所述误差消除模块通过变结构变参数PID控制器对综合误差进行消除,输出一个期望方向盘转角;
所述执行模块用于将期望的方向盘转角控制量实时依据通信协议封装成报文下发给车辆的EPS,由EPS执行该控制量,使得车辆的实际方向盘转角与期望一致,最终使车辆按照预期轨迹行驶。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。
上述本发明实施例序号仅仅为了描述,不代表实施例的优劣。
上面结合附图对本发明的实施例进行了描述,但是本发明并不局限于上述的具体实施方式,上述的具体实施方式仅仅是示意性的,而不是限制性的,本领域的普通技术人员在本发明的启示下,在不脱离本发明宗旨和权利要求所保护的范围情况下,还可做出很多形式,这些均属于本发明的保护之内。

Claims (7)

1.一种一体式自动驾驶车辆控制系统,包括自动驾驶控制器,所述自动驾驶控制器与车辆EPS电连接,其特征是所述自动驾驶控制器包括参考点选取模块、误差计算模块、误差消除模块、执行模块,所述参考点选取模块用于依据当前的车速和行驶方向在规划参考线上选取一个点作为自动驾驶控制的参考点,所述误差计算模块用于基于参考点选取模块给出的参考点坐标和车辆自身位置坐标计算出自车与参考点间的横向位置误差和航向角误差,所述误差消除模块用于将误差计算模块得出的误差值通过变结构变参数的PID控制方法得到期望的方向盘转角控制量,所述执行模块用于将期望的方向盘转角控制量依据通信协议封装成报文下发给车辆的EPS,由EPS执行该控制量,最终使车辆按照预期轨迹行驶。
2.如权利要求1所述的一种一体式自动驾驶车辆控制系统,其特征在于,所述自动驾驶控制器还包括PID控制器模块,PID控制器模块具有一套变参数、变结构的PID控制算法。
3.如权利要求1或2所述的一种一体式自动驾驶车辆控制系统,其特征在于,所述参考点选取模块首先依据当前车速和行驶方向计算出一个平行于车辆行驶方向的预瞄距离,该距离可用下式进行表征:d0为车速为0时的预瞄距离,k为预瞄距离随车速的增益系数,当车速为负,即请求泊车时,预瞄点选取在车辆后方。
Figure FDA0003430189100000011
4.如权利要求1或2所述的一种一体式自动驾驶车辆控制系统,其特征在于,所述参考点选取模块遍历参考轨迹上的所有点,找到参考轨迹上距离预瞄点最近的一个点和该点的下一个点,连接这两个点得到参考航向角,从预瞄点向这两点的连线作垂线,垂足到预瞄点的距离为横向距离误差,若这两点连线平行于车辆航向,则直接输出误差为0。
5.如权利要求1或2所述的一种一体式自动驾驶车辆控制系统,其特征在于,所述误差计算模块将横向距离误差和航向角误差综合计算得到一个误差值,由于航向角的量纲为弧度,位置的量纲为米,因此误差计算模块通过atan函数将位置误差值统一到角度量纲下,计算方法可用下式进行表征:error为综合后的误差,k为位置误差权重,1-k为航向角误差权重。
error=k*atan*errpos+(1-k)errθ
6.如权利要求1或2所述的一种一体式自动驾驶车辆控制系统,其特征在于,所述误差消除模块通过变结构变参数PID控制器对综合误差进行消除,输出一个期望方向盘转角,其中PID控制器的参数及结构由车速与车辆挡位进行确定,确保在低速行车、高速行车、泊车、出库时都有较好的控制效果。
7.如权利要求1所述的一种一体式自动驾驶车辆控制系统,其特征在于,所述执行模块接收误差消除模块计算出的期望方向盘转角,并实时按照通讯协议将其封装为报文下发给车辆EPS控制单元,使得车辆的实际方向盘转角与期望一致,则车辆按照预期行驶路径行驶。
CN202111593965.2A 2021-12-23 2021-12-23 一种一体式自动驾驶车辆控制系统 Pending CN114013429A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111593965.2A CN114013429A (zh) 2021-12-23 2021-12-23 一种一体式自动驾驶车辆控制系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111593965.2A CN114013429A (zh) 2021-12-23 2021-12-23 一种一体式自动驾驶车辆控制系统

Publications (1)

Publication Number Publication Date
CN114013429A true CN114013429A (zh) 2022-02-08

Family

ID=80069008

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111593965.2A Pending CN114013429A (zh) 2021-12-23 2021-12-23 一种一体式自动驾驶车辆控制系统

Country Status (1)

Country Link
CN (1) CN114013429A (zh)

Citations (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN201681294U (zh) * 2010-04-03 2010-12-22 天正集团有限公司 基于can总线的隧道灯光控制系统
CN102358287A (zh) * 2011-09-05 2012-02-22 北京航空航天大学 一种用于车辆自动驾驶机器人的轨迹跟踪控制方法
CN104260722A (zh) * 2014-09-23 2015-01-07 北京理工大学 一种自动泊车系统
CN106020191A (zh) * 2016-05-26 2016-10-12 百度在线网络技术(北京)有限公司 无人车的控制方法、装置及系统
CN109017766A (zh) * 2018-08-03 2018-12-18 湖北汽车工业学院 一种用于自动驾驶车辆的平行车位全自动泊车控制系统
CN109760672A (zh) * 2018-12-29 2019-05-17 北京智行者科技有限公司 自动驾驶充电车精准泊车的横向控制方法
CN110979305A (zh) * 2019-03-18 2020-04-10 长城汽车股份有限公司 车辆异常换道控制方法、装置及系统
CN111196271A (zh) * 2020-01-21 2020-05-26 北京百度网讯科技有限公司 自动泊车方法、装置、设备及存储介质
CN111610780A (zh) * 2019-02-25 2020-09-01 广州汽车集团股份有限公司 一种自动驾驶车路径跟踪控制方法及其装置
CN111800375A (zh) * 2015-01-26 2020-10-20 卢森堡商创研腾智权信托有限公司 借由云端安全动态传输包括数据资料封包的方法
CN112124295A (zh) * 2020-09-29 2020-12-25 北京易控智驾科技有限公司 无人驾驶车辆及其终点横向稳态控制方法、电子设备
CN112356827A (zh) * 2020-10-30 2021-02-12 的卢技术有限公司 自动泊车控制方法、装置、计算机设备和存储介质
CN112572397A (zh) * 2019-09-30 2021-03-30 长城汽车股份有限公司 自动泊车控制方法、装置及控制器
CN112793585A (zh) * 2021-02-07 2021-05-14 厦门金龙联合汽车工业有限公司 一种自动驾驶的轨迹跟踪控制方法
CN112896147A (zh) * 2019-12-04 2021-06-04 青岛慧拓智能机器有限公司 用于矿用车辆的双向定位泊车控制方法及装置
CN113415276A (zh) * 2021-07-30 2021-09-21 东风商用车有限公司 一种智能驾驶预瞄控制方法、装置和存储介质
CN113419420A (zh) * 2021-06-30 2021-09-21 东风悦享科技有限公司 一种车辆线性二自由度动力学模型循迹控制方法及系统
CN113608530A (zh) * 2021-07-22 2021-11-05 武汉理工大学 一种带有pid转角补偿的参数自整定lqr路径跟踪方法

Patent Citations (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN201681294U (zh) * 2010-04-03 2010-12-22 天正集团有限公司 基于can总线的隧道灯光控制系统
CN102358287A (zh) * 2011-09-05 2012-02-22 北京航空航天大学 一种用于车辆自动驾驶机器人的轨迹跟踪控制方法
CN104260722A (zh) * 2014-09-23 2015-01-07 北京理工大学 一种自动泊车系统
CN111800375A (zh) * 2015-01-26 2020-10-20 卢森堡商创研腾智权信托有限公司 借由云端安全动态传输包括数据资料封包的方法
CN106020191A (zh) * 2016-05-26 2016-10-12 百度在线网络技术(北京)有限公司 无人车的控制方法、装置及系统
CN109017766A (zh) * 2018-08-03 2018-12-18 湖北汽车工业学院 一种用于自动驾驶车辆的平行车位全自动泊车控制系统
CN109760672A (zh) * 2018-12-29 2019-05-17 北京智行者科技有限公司 自动驾驶充电车精准泊车的横向控制方法
CN111610780A (zh) * 2019-02-25 2020-09-01 广州汽车集团股份有限公司 一种自动驾驶车路径跟踪控制方法及其装置
CN110979305A (zh) * 2019-03-18 2020-04-10 长城汽车股份有限公司 车辆异常换道控制方法、装置及系统
CN112572397A (zh) * 2019-09-30 2021-03-30 长城汽车股份有限公司 自动泊车控制方法、装置及控制器
CN112896147A (zh) * 2019-12-04 2021-06-04 青岛慧拓智能机器有限公司 用于矿用车辆的双向定位泊车控制方法及装置
CN111196271A (zh) * 2020-01-21 2020-05-26 北京百度网讯科技有限公司 自动泊车方法、装置、设备及存储介质
CN112124295A (zh) * 2020-09-29 2020-12-25 北京易控智驾科技有限公司 无人驾驶车辆及其终点横向稳态控制方法、电子设备
CN112356827A (zh) * 2020-10-30 2021-02-12 的卢技术有限公司 自动泊车控制方法、装置、计算机设备和存储介质
CN112793585A (zh) * 2021-02-07 2021-05-14 厦门金龙联合汽车工业有限公司 一种自动驾驶的轨迹跟踪控制方法
CN113419420A (zh) * 2021-06-30 2021-09-21 东风悦享科技有限公司 一种车辆线性二自由度动力学模型循迹控制方法及系统
CN113608530A (zh) * 2021-07-22 2021-11-05 武汉理工大学 一种带有pid转角补偿的参数自整定lqr路径跟踪方法
CN113415276A (zh) * 2021-07-30 2021-09-21 东风商用车有限公司 一种智能驾驶预瞄控制方法、装置和存储介质

Similar Documents

Publication Publication Date Title
CN108609014B (zh) 智能车辆的横向控制方法及装置
CN102393744B (zh) 一种无人驾驶汽车的导航方法
CN107618503B (zh) 一种自动泊车控制方法及系统
CN114013430B (zh) 一种行车和泊车统一的自动驾驶车辆控制方法
Wang et al. The improved pure pursuit algorithm for autonomous driving advanced system
CN111578957B (zh) 基于三维点云地图定位的智能车纯追踪循迹方法
CN109799828B (zh) 自动驾驶车辆横纵向协调控制方法
US11334083B2 (en) Route tracking method for mobile vehicle
EP4030403A1 (en) Method and device for predicting exit for vehicle
CN112519882B (zh) 一种车辆参考轨迹跟踪方法及系统
CN102981173A (zh) 一种里程计算的自适应修正方法
WO2023241343A1 (zh) 车辆控制方法、车辆、存储介质及电子装置
CN113602350A (zh) 车辆前轮偏差角动态标定方法、装置、设备及存储介质
CN112859860A (zh) 一种机器人系统及其路径规划方法
CN113625702B (zh) 基于二次规划的无人车同时路径跟踪与避障方法
CN110928290A (zh) 五次曲线路径规划方法及车道中心线维护方法
CN115042816A (zh) 路径跟踪方法、装置、设备、介质及程序
CN111596666A (zh) 一种基于agv运动预测的障碍物碰撞威胁的检测方法
CN114013429A (zh) 一种一体式自动驾驶车辆控制系统
CN111169470B (zh) 一种自动泊车方法、装置及电子设备
CN111674406A (zh) 自动驾驶系统车辆横向控制的方法
Yang et al. ESO-based lateral control for electrical vehicles with unmodeled tire dynamics on uneven road
CN113325849A (zh) 一种针对高地隙植保机的运动控制方法
CN113778045A (zh) 对自动驾驶车辆控制器进行评价的方法和装置
Xiao et al. Smooth trajectory tracking using longitudinal distance constraint for a 4WS4WD unmanned ground vehicle

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination