CN110851916A - 适用于任意曲率道路的车辆运动学人-车-路闭环系统 - Google Patents
适用于任意曲率道路的车辆运动学人-车-路闭环系统 Download PDFInfo
- Publication number
- CN110851916A CN110851916A CN201911042535.4A CN201911042535A CN110851916A CN 110851916 A CN110851916 A CN 110851916A CN 201911042535 A CN201911042535 A CN 201911042535A CN 110851916 A CN110851916 A CN 110851916A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- road
- driver
- model
- roads
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 claims description 5
- 230000006399 behavior Effects 0.000 abstract description 7
- 230000033001 locomotion Effects 0.000 abstract description 7
- 238000004364 calculation method Methods 0.000 abstract description 6
- 238000013461 design Methods 0.000 abstract description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000004044 response Effects 0.000 description 4
- 230000002232 neuromuscular Effects 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 230000008520 organization Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明公开了一种适用于任意曲率道路,基于车辆‑道路运动学模型建立的人‑车‑路闭环系统。该模型忽略轮胎的非线性特性,进一步地降低了控制器设计的计算复杂度,使得车辆运动控制具有更好的实时性。同时,在车辆‑道路模型的基础上耦合了驾驶员模型,考虑了人类驾驶员在自动/半自动车辆行驶中的作用,利用反应延迟时间、预瞄时间以及转向比例增益这三种驾驶员转向特性参数来表征不同驾驶员的驾驶行为。采用曲线坐标来获得车辆与道路之间的位置关系,通过双点预瞄驾驶员模型来获得弯曲道路近点和远点的道路信息,所建系统不仅能够适用于直道或小曲率道路,也适用于S弯等大曲率道路,能够做到直道与弯道之间的完美切换,更加具有普适性。
Description
技术领域
本发明涉及路径规划与路径跟踪,属于智能交通技术领域,具体涉及一种适用于任意曲率道路的车辆运动学人-车-路闭环系统。
背景技术
根据世界卫生组织的《道路安全报告》,道路交通死亡是世界上最主要的死亡原因之一。自动驾驶车辆可以提升安全性和道路利用率,是针对上述问题的一个很好的解决方案。因此,自动驾驶车辆成为了一个新兴的研究热点。目前对自动驾驶车辆的研究多集中在一般行驶工况,即低速、直道或者小曲率道路行驶,而在复杂工况下,如:高速行驶或者大曲率路径,常常被忽略。与直道相比,弯曲道路更为复杂多变,是交通事故的易发路段。这是自动驾驶车辆控制设计中的一个基本却至关重要的问题,需要进一步研究。本专利提出的驾驶员-车辆-道路闭环系统可以适用于任意曲率的道路,可以做到直道与大曲率弯道之间的完美衔接。
自动驾驶车辆横向运动控制器的设计一般采用车辆动力学或运动学模型,近几十年来,车辆运动学模型由于不需要大量的车辆非线性参数,如侧滑角、转弯刚度、轮胎参数等,被广泛应用于降低车辆运动控制的计算复杂度和实时性。同时,驾驶员与车辆模型在闭环系统中的结合已成为一个新兴的研究热点。利用驾驶员转向特性的延迟时间、预瞄时间和转向增益等参数表示不同驾驶行为的驾驶员,在控制器设计中考虑驾驶员的这些特性,使得控制器的行为更接近于真实的人类驾驶员的行为,这可以使人类驾驶员及乘客感到更加舒适。另一方面,考虑到车辆动力学模型的计算复杂度,本专利采用的运动学车辆模型更适合于构建用于路径规划的驾驶员-车辆-道路闭环系统。
发明内容
为解决上述问题,本发明公开了适用于任意曲率道路的车辆运动学人-车-路闭环系统,通过基于车辆运动学的建模方法来降低控制器的计算负担。利用双点预瞄驾驶员模型获得目标路径远点和近点处的道路信息,结合曲线坐标,能够让自主车辆在任意曲率道路上完成路径规划和跟踪。同时利用驾驶员转向特性中的延迟时间、预瞄时间和转向增益等参数来表征不同驾驶员的驾驶特性,使得车辆控制器能够做到类人驾驶,提高驾驶员和乘客的乘坐舒适性。
为达到上述目的,本发明的技术方案如下:
适用于任意曲率道路的车辆运动学人-车-路闭环系统,采用建立的车辆运动学模型来代替目前更为常用的车辆动力学模型,使用曲线坐标系代替传统的XY直线坐标系描述车辆与道路的位置关系,采用双点预瞄驾驶员模型,通过道路近点和远点处的信息,来描述目标道路的结构。车辆在大曲率道路上行驶时,虽然车辆的航向角为大角度,但是车辆前轮转角δf,与目标路径的航向偏差eψ以及近点处的航向偏差ψL都为小角度,可以对这三个角度的三角函数值进行近似处理,即cosx=1,sinx=x,tanx=x,车辆-道路运动学模型可以表示为
其中,lf和lr分别为车辆前轴和后轴到车辆质心的距离,Vx和Vy分别表示车辆的纵向速度和横向速度,y是车辆质心当前的横向位置,ydes表示车辆质心在参考轨迹上对应点的横向位置,ey=y-ydes表示车辆质心当前位置与参考轨迹之间的横向偏差。ψ表示车辆当前位置的航向角,ψdes是车辆质心在参考路径上对应位置的切线与X轴形成的切角,eψ=ψ-ψdes表示车辆与参考路径上对应位置的航向偏差。车辆的侧偏运动和纵向速度可以表示为:
在弯道行驶时,为了方便确定自车的位置,还需要引入曲线坐标。在二维笛卡尔直线坐标系中,将参考路径视为与x轴对应的σ轴,将自车与参考曲线之间的偏移量视为与y轴对应的ey轴,可以用车辆从出发点到当前位置行驶的曲线距离,以及与目标路径的横向偏移来代表代表车的位置,即(σ,ey)。曲线位置σ在车辆运动学模型中可以表示为:
本发明主要考虑大曲率路径等弯曲道路,使得自动驾驶车辆针对适应任意曲率的道路都能有很好的响应。因此,系统中还包含能够响应不同驾驶员特征的适用于大曲率路径的双点预瞄驾驶员模型。假设驾驶员仅通过视觉方法确定道路信息,车辆质心位置与参考路径相关,驾驶员可以使用一个近点和一个远点来描述一条弯曲道路信息来进行驾驶。近点在目标路径上,用来确定车辆的横向位置,远点假设为驾驶员视线与道路边界的切点,用来获得前方的道路曲率。在两点视觉驾驶员模型中,它们分别表示为与车辆行驶方向之间的夹角θnear,θfar。这两个角度是驾驶员模型的输入,描述了驾驶员前馈和反馈转向控制的运动。
车辆航向与近点处与目标路径的横向偏差eL以及航向偏差ψL可以表示为:
驾驶员双点预瞄模型可以表示为:
其中,κctrl是规划道路的曲率,Td,Tp分别表示驾驶员的延迟时间和预瞄时间,为常数,其中τd1为驾驶员意识到需要转向到去执行转向动作存在的一个反应延时,同时,在驾驶员执行转向动作时,手臂上还会存在一个神经肌肉延时τd2,Td=τd1+τd2。Rg是转向系统的传动比,即方向盘转角与汽车前轮转角的比值。Kp为驾驶员的转向比例增益,Kc为控制器的转向比例增益。Tp表示驾驶员的预瞄时间,驾驶员前视距离为L=Tp*Vx,近点处的距离为ClfnTp*Vx。进一步地,为了方便在Matlab/Simulink中建模,根据以上建立的所述驾驶员-车辆-道路模型,将离散时间状态变量定义为x(k)=[x1(k),x2(k),x3(k),x4(k),x5(k),x6(k),x7(k),x8(k)]T,其中x1(k)=ey(k),x2(k)=eψ(k),x3(k)=Vx(k),x4(k)=ψL(k),x5(k)=eL(k),x6(k)=δf(k),x7(k)=xdp(k),x8(k)=σ(k),驾驶员-车辆-道路系统的输入为u(k)=[ax(k),κctrl(k)]T,外部道路信号输入为w(k)=ρroad(k),为当前道路的曲率,可由摄像头等传感器获得。驾驶员-车辆-道路系统的状态方程可由一个近似地方法表示为:
x(k+1)=Ax(k)+Buu(k)+Bww(k)
u(k)=u(k-1)+Δu(k)
进一步地,提出的基于运动学车辆模型的人-车-路闭环系统路径规划的示意图所示。本发明提出的驾驶员-车辆-道路闭环系统,采用曲线坐标来代替XY直线坐标系,可以适用于任意曲率道路。同时,本发明的驾驶员模型考虑到了驾驶员在弯道行驶时的转向特性,将该系统用于路径规划和路径跟踪时,便于实现考虑不同驾驶员操纵行为和偏好的仿真试验。同时,由于采用了基于运动学的车辆-道路模型,所提出的驾驶员-车辆-道路闭环系统本质上是线性的,在复杂的路径规划或者路径跟踪中使用该模型可以有效降低计算成本,提高计算的实时性,利于工程实践。
本发明的有益效果是:
本发明在所提出的人车路闭环系统中采用运动学车辆模型,不需要考虑复杂的非线性特性,使得控制器的计算负担较低,极大的提高了车辆运动控制的实时性,利于工程实践的应用;采用双点预瞄驾驶员模型和曲线坐标,能够让车辆适用于任意曲率的道路,能够在直道和大曲率弯道直接完美衔接;考虑了驾驶员的预瞄作用、反应延迟时间(驾驶员反应延时和神经肌肉延时)、转向比例增益等特性,使得所设计的车辆控制器更加拟人化,将驾驶员的驾驶行为考虑到控制回路设计中,使得所设计的控制器同时考虑驾驶员的驾驶行为,从而使得控制器能够提高驾驶员的乘坐舒适性。
附图说明
图1为本发明适用于任意曲率弯道的驾驶员-车辆-道路双点预瞄模型示意图;
图2为本发明采用的曲线坐标示意图;
图3为本发明基于运动学车辆模型的驾驶员-车辆-道路模型示意框图。
具体实施方式
下面结合附图和具体实施方式,进一步阐明本发明,应理解下述具体实施方式仅用于说明本发明而不用于限制本发明的范围。
如图1-3所示,本发明是建立一种以运动学车辆模型为基础的适用于任意曲率道路的驾驶员-车辆-道路闭环系统,采用车辆-道路运动学模型来代替目前更为常用的车辆动力学模型,采用双点预瞄驾驶员模型,通过道路近点和远点处的信息,来描述目标道路的结构。车辆-道路运动学模型可以表示为:
其中,lf和lr分别为车辆前轴和后轴到车辆质心的距离,Vx和Vy分别表示车辆的纵向速度和横向速度,y是车辆质心当前的横向位置,ydes表示车辆质心在参考轨迹上对应点的横向位置,ey=y-ydes表示车辆质心当前位置与参考轨迹之间的横向偏差。ψ表示车辆当前位置的航向角,ψdes是车辆质心在参考路径上对应位置的切线与X轴形成的切角,eψ=ψ-ψdes表示车辆与参考路径上对应位置的航向偏差。车辆的侧偏运动和纵向速度可以表示为:
在弯道行驶时,为了方便确定自车的位置,还需要引入曲线坐标。在二维笛卡尔坐标系中,将参考路径视为与x轴对应的σ轴,将自车与参考曲线之间的偏移量视为与y轴对应的ey轴,如图3所示,可以用车辆从出发点到当前位置行驶的曲线距离,以及与目标路径的横向偏移来代表代表车的位置,即(σ,ey)。曲线位置σ在车辆运动学模型中可以表示为:
本发明主要考虑大曲率路径等弯曲道路,让自动驾驶车辆针对适应任意曲率的道路都能有很好的响应。因此,系统中还包含能够响应不同驾驶员特征的适用于大曲率路径的双点预瞄驾驶员模型。车辆航向与近点处目标路径的横向偏差eL以及航向偏差ψL可以表示为:
驾驶员双点预瞄模型可以表示为:
其中,κctrl是规划道路的曲率,Td,Tp分别表示驾驶员的延迟时间和预瞄时间,为常数,其中τd1为驾驶员意识到需要转向到去执行转向动作存在的一个反应延时,同时,在驾驶员执行转向动作时,手臂上还会存在一个神经肌肉延时τd2,Td=τd1+τd2。Rg是转向系统的传动比,即方向盘转角与汽车前轮转角的比值。Kp为驾驶员的转向比例增益,Kc为控制器的转向比例增益。Tp表示驾驶员的预瞄时间,驾驶员前视距离为L=Tp*Vx,近点处的距离为ClfnTp*Vx。
进一步地,为了方便在Matlab/Simulink中建模,根据以上建立的所述驾驶员-车辆-道路模型,将离散时间状态变量定义为x(k)=[x1(k),x2(k),x3(k),x4(k),x5(k),x6(k),x7(k),x8(k)]T,其中x1(k)=ey(k),x2(k)=eψ(k),x3(k)=Vx(k),x4(k)=ψL(k),x5(k)=eL(k),x6(k)=δf(k),x7(k)=xdp(k),x8(k)=σ(k),驾驶员-车辆-道路系统的输入为u(k)=[ax(k),κctrl(k)]T,外部道路信号输入为w(k)=ρroad(k),为当前道路的曲率,可由摄像头等传感器获得。驾驶员-车辆-道路系统的状态方程可由一个近似地方法表示为:
x(k+1)=Ax(k)+Buu(k)+Bww(k)
u(k)=u(k-1)+Δu(k)。
Claims (1)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911042535.4A CN110851916B (zh) | 2019-10-30 | 2019-10-30 | 适用于任意曲率道路的车辆运动学人-车-路闭环系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911042535.4A CN110851916B (zh) | 2019-10-30 | 2019-10-30 | 适用于任意曲率道路的车辆运动学人-车-路闭环系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110851916A true CN110851916A (zh) | 2020-02-28 |
CN110851916B CN110851916B (zh) | 2023-03-21 |
Family
ID=69598251
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911042535.4A Active CN110851916B (zh) | 2019-10-30 | 2019-10-30 | 适用于任意曲率道路的车辆运动学人-车-路闭环系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110851916B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112096852A (zh) * | 2020-09-27 | 2020-12-18 | 吉林大学 | 一种超多挡位自动变速器换挡规律设计方法 |
CN112109725A (zh) * | 2020-08-07 | 2020-12-22 | 吉林大学 | 考虑疲劳特性的驾驶员转向控制模型的建模系统及方法 |
CN113297685A (zh) * | 2021-07-27 | 2021-08-24 | 中汽研(天津)汽车工程研究院有限公司 | 一种车辆运行工况模式识别方法 |
CN113934200A (zh) * | 2020-06-28 | 2022-01-14 | 上海汽车集团股份有限公司 | 一种无人驾驶车辆的路径跟踪控制方法及装置 |
CN114030474A (zh) * | 2021-08-19 | 2022-02-11 | 东南大学 | 基于驾驶员主观风险感受的行车安全场构建方法 |
CN113548038B (zh) * | 2020-04-22 | 2024-03-01 | 广州汽车集团股份有限公司 | 一种泊车曲率控制方法及系统、控制设备、存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9731755B1 (en) * | 2016-02-16 | 2017-08-15 | GM Global Technology Operations LLC | Preview lateral control for automated driving |
CN108791301A (zh) * | 2018-05-31 | 2018-11-13 | 重庆大学 | 基于驾驶员特性的智能汽车驾驶过程横向动态控制方法 |
CN110077418A (zh) * | 2019-04-08 | 2019-08-02 | 东南大学 | 考虑驾驶员特性的差动辅助转向与共享控制系统建模方法 |
CN110096748A (zh) * | 2019-04-01 | 2019-08-06 | 东南大学 | 一种基于车辆运动学模型的人-车-路模型建模方法 |
CN110147041A (zh) * | 2019-05-20 | 2019-08-20 | 重庆大学 | 一种基于梯度校正估计预瞄时间的车辆横向控制方法 |
-
2019
- 2019-10-30 CN CN201911042535.4A patent/CN110851916B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9731755B1 (en) * | 2016-02-16 | 2017-08-15 | GM Global Technology Operations LLC | Preview lateral control for automated driving |
CN108791301A (zh) * | 2018-05-31 | 2018-11-13 | 重庆大学 | 基于驾驶员特性的智能汽车驾驶过程横向动态控制方法 |
CN110096748A (zh) * | 2019-04-01 | 2019-08-06 | 东南大学 | 一种基于车辆运动学模型的人-车-路模型建模方法 |
CN110077418A (zh) * | 2019-04-08 | 2019-08-02 | 东南大学 | 考虑驾驶员特性的差动辅助转向与共享控制系统建模方法 |
CN110147041A (zh) * | 2019-05-20 | 2019-08-20 | 重庆大学 | 一种基于梯度校正估计预瞄时间的车辆横向控制方法 |
Non-Patent Citations (3)
Title |
---|
YONGJUN YAN等: "Path Planning using a Kinematic Driver-Vehicle-Road Model with Consideration of Driver’s Characteristics", 《2019 IEEE INTELLIGENT VEHICLES SYMPOSIUM (IV)》 * |
杨浩等: "基于曲率与车速的两点智能控制驾驶员模型", 《汽车技术》 * |
牛晶: "基于单点预瞄最优曲率的4WDEV人-车-路闭环仿真研究", 《机械研究与应用》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113548038B (zh) * | 2020-04-22 | 2024-03-01 | 广州汽车集团股份有限公司 | 一种泊车曲率控制方法及系统、控制设备、存储介质 |
CN113934200A (zh) * | 2020-06-28 | 2022-01-14 | 上海汽车集团股份有限公司 | 一种无人驾驶车辆的路径跟踪控制方法及装置 |
CN112109725A (zh) * | 2020-08-07 | 2020-12-22 | 吉林大学 | 考虑疲劳特性的驾驶员转向控制模型的建模系统及方法 |
CN112096852A (zh) * | 2020-09-27 | 2020-12-18 | 吉林大学 | 一种超多挡位自动变速器换挡规律设计方法 |
CN112096852B (zh) * | 2020-09-27 | 2021-05-25 | 吉林大学 | 一种超多挡位自动变速器换挡规律设计方法 |
CN113297685A (zh) * | 2021-07-27 | 2021-08-24 | 中汽研(天津)汽车工程研究院有限公司 | 一种车辆运行工况模式识别方法 |
CN114030474A (zh) * | 2021-08-19 | 2022-02-11 | 东南大学 | 基于驾驶员主观风险感受的行车安全场构建方法 |
CN114030474B (zh) * | 2021-08-19 | 2022-08-12 | 东南大学 | 基于驾驶员主观风险感受的行车安全场构建方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110851916B (zh) | 2023-03-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110851916B (zh) | 适用于任意曲率道路的车辆运动学人-车-路闭环系统 | |
CN105329238B (zh) | 一种基于单目视觉的自动驾驶汽车换道控制方法 | |
CN111610780B (zh) | 一种自动驾驶车路径跟踪控制方法及其装置 | |
CN106681327B (zh) | 一种大惯性电动客车的智能驾驶横纵向解耦控制方法及系统 | |
EP1862374B1 (en) | Steering control device for vehicles | |
JP3286334B2 (ja) | 移動体の制御装置 | |
CN103121451B (zh) | 一种弯路换道轨迹的跟踪控制方法 | |
CN109733395B (zh) | 一种基于可拓优度评价的自动驾驶汽车横向协调控制方法 | |
CN108732921B (zh) | 一种自动驾驶汽车横向可拓预瞄切换控制方法 | |
CN111897344B (zh) | 一种兼顾稳定性的自动驾驶汽车路径跟踪控制方法 | |
CN110096748B (zh) | 一种基于车辆运动学模型的人-车-路模型建模方法 | |
CN111806467A (zh) | 一种基于车辆行驶规律的变速动态换道轨迹规划方法 | |
CN110920616A (zh) | 一种智能车换道轨迹及换道轨迹跟随控制方法 | |
CN106915349B (zh) | 一种车辆侧向控制的方法及装置 | |
JP6773215B2 (ja) | 車両制御方法及び車両制御装置 | |
CN110641465A (zh) | 一种基于车速的车道保持系统和方法 | |
CN113553726B (zh) | 一种冰雪环境下的主从博弈型人机协同转向控制方法 | |
CN109292018A (zh) | 基于同轴式轮腿结构的四轮转向轨迹跟踪控制方法 | |
CN113619574A (zh) | 一种车辆避让方法、装置、计算机设备和存储介质 | |
WO2022270322A1 (ja) | 連結車両の後退制御装置、連結車両の後退制御プログラムを記憶したコンピュータ可読媒体、および連結車両の後退制御方法 | |
CN113050651A (zh) | 智能车自主行驶路径跟踪的时滞控制方法及系统 | |
CN115489594A (zh) | 一种纯跟踪智能车路径跟随控制方法 | |
CN114179818A (zh) | 基于自适应预瞄时间和滑模控制的智能汽车横向控制方法 | |
CN111703417B (zh) | 一种高低速统一预瞄滑膜驾驶控制方法及控制系统 | |
CN110654386B (zh) | 弯道下多智能电动汽车协作式巡航纵横向综合控制方法 |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |