CN110789526A - 一种克服无人驾驶汽车横向控制大纯滞后的方法 - Google Patents
一种克服无人驾驶汽车横向控制大纯滞后的方法 Download PDFInfo
- Publication number
- CN110789526A CN110789526A CN201910991620.9A CN201910991620A CN110789526A CN 110789526 A CN110789526 A CN 110789526A CN 201910991620 A CN201910991620 A CN 201910991620A CN 110789526 A CN110789526 A CN 110789526A
- Authority
- CN
- China
- Prior art keywords
- control
- transverse
- transverse control
- unmanned
- unmanned automobile
- 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 title claims abstract description 23
- 238000012937 correction Methods 0.000 claims abstract description 12
- 238000005259 measurement Methods 0.000 claims abstract description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000001105 regulatory effect Effects 0.000 claims description 2
- 230000007547 defect Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Purposes 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/18—Propelling the vehicle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种克服无人驾驶汽车横向控制大纯滞后的方法,其包括步骤:获取实际测量域控制器发出横向控制指令至无人驾驶汽车响应横向控制指令的滞后时间ΔT;获取无人驾驶汽车的参考行驶轨迹;计算修正量R(t);根据滞后时间ΔT,采用预测模型获取无人驾驶汽车t+ΔT时刻的预测位置;根据预测位置和修正量R(t)获取横向控制计算参考点Pc;采用PID控制或预瞄控制方法在横向控制计算参考点Pc处计算无人驾驶汽车横向控制的控制量;将横向控制量作为控制指令值发送给底层执行器。本发明能有效克服大纯滞后的影响,克服轨迹跟踪精度较差。
Description
技术领域
本发明涉及一种无人驾驶控制技术领域,特别是关于一种克服无人驾驶汽车横向控制大纯滞后的方法。
背景技术
目前,无人驾驶汽车控制可分为横向控制和纵向控制两类,其中横向控制为方向盘转角控制,纵向控制为车速控制。无人驾驶汽车按照设定的全局轨迹以及动态变化的局部轨迹行驶,横向控制决定轨迹跟踪的精度,进而决定无人驾驶汽车的行车安全。
由于操作系统、数据传输等环节不同因素影响,无人驾驶汽车从发送横向控制指令至车辆响应横向控制指令出现大纯滞后时,横向控制的控制难度增大且控制精度降低。此时使用常规的横向控制方法如PID控制、预瞄控制等无法克服大纯滞后的影响,导致轨迹跟踪精度较差,无法满足无人驾驶汽车的控制要求。
发明内容
针对大纯滞后条件下常规横向控制问题,本发明的目的是提供一种克服无人驾驶汽车横向控制大纯滞后的方法,其能有效克服大纯滞后的影响,克服轨迹跟踪精度较差。
为实现上述目的,本发明采取以下技术方案:一种克服无人驾驶汽车横向控制大纯滞后的方法,其包括以下步骤:1)获取实际测量域控制器发出横向控制指令至无人驾驶汽车响应横向控制指令的滞后时间ΔT;2)获取无人驾驶汽车的参考行驶轨迹;3)计算修正量R(t);4)根据滞后时间ΔT,采用预测模型获取无人驾驶汽车t+ΔT时刻的预测位置Pp(t+ΔT);5)根据预测位置Pp(t+ΔT)和修正量R(t)获取横向控制计算参考点Pc;6)在横向控制计算参考点Pc处计算无人驾驶汽车横向控制的控制量;7)将横向控制量作为控制指令值发送给底层执行器。
进一步,所述步骤1)中,在时刻T1给定期望的横向控制指令,测量横向控制指令响应过程的初始时刻T2,得到所述滞后时间ΔT:
ΔT=T2-T1。
进一步,所述步骤3)中,所述修正量R(t)为:
R(t)=P(t)-Pr(t),
其中,P(t)是无人驾驶汽车当前时刻位置,Pr(t)是参考行驶轨迹上与P(t)距离最近的位置。
进一步,所述步骤4)中,依据当前无人驾驶汽车位置,由预测模型预测ΔT时刻之后无人驾驶汽车所处的位置Pp(t+ΔT)。
进一步,所述预测模型采用匀速模型或匀加速模型。
进一步,所述步骤5)中,横向控制计算参考点Pc为:
Pc=Pp(t+ΔT)+αR(t),
其中,α是调节因子。
进一步,所述步骤6)中,采用PID控制或预瞄控制方法计算无人驾驶汽车横向控制的控制量。
本发明由于采取以上技术方案,其具有以下优点:本发明能够以较小的域控制器计算资源,克服横向控制指令大纯滞后所导致的轨迹跟踪响应延迟、超调量较大、跟踪精度较差等问题,确保无人驾驶汽车的行车安全。
附图说明
图1是本发明的滞后时间示意图;
图2是本发明的方案框架示意图;
图3是本发明的关键变量示意图。
具体实施方式
下面结合附图和实施例对本发明进行详细的描述。
本发明提供一种克服无人驾驶汽车横向控制大纯滞后的方法,其包括以下步骤:
1)获取大纯滞后时间ΔT:实际测量域控制器发出横向控制指令至无人驾驶汽车响应横向控制指令的滞后时间ΔT;
如图1所示,在时刻T1给定期望的横向控制指令,测量横向控制指令响应过程的初始时刻T2,ΔT=T2-T1。
2)获取无人驾驶汽车的参考行驶轨迹;
3)计算修正量R(t):如图2~3所示,修正量R(t)是无人驾驶汽车当前时刻位置P(t)与参考行驶轨迹最近点Pr(t)坐标的差值,即:
R(t)=P(t)-Pr(t),
其中,P(t)是无人驾驶汽车当前时刻t的位置,Pr(t)是参考行驶轨迹上与P(t)距离最近的位置;
4)根据滞后时间ΔT,采用预测模型获取无人驾驶汽车t+ΔT时刻的预测位置Pp(t+ΔT);
如图2~图3所示,依据当前无人驾驶汽车位置,由预测模型预测ΔT时刻之后无人驾驶汽车所处的位置Pp(t+ΔT)。在本实施例中,不限定预测模型的类型及输入参数,可以优选匀速模型或匀加速模型。
5)根据预测位置Pp(t+ΔT)和修正量R(t)获取横向控制计算参考点Pc,Pc=Pp(t+ΔT)+αR(t);
其中,横向控制计算参考点Pc由t+ΔT时刻的预测位置Pp(t+ΔT)和修正量R(t)共同决定;α是调节因子,调节因子α可以由实车测试的效果最终决定。
6)采用PID控制或预瞄控制等方法在横向控制计算参考点Pc处计算无人驾驶汽车横向控制的控制量;
7)将横向控制量作为控制指令值发送给底层执行器。
上述步骤2)中,参考行驶轨迹由全局轨迹和局部轨迹组合而成。其中,全局轨迹可以事先采集或从高精度地图获取,局部轨迹由无人驾驶规划策略获取。
上述各实施例仅用于说明本发明,各个步骤都是可以有所变化的,在本发明技术方案的基础上,凡根据本发明原理对个别步骤进行的改进和等同变换,均不应排除在本发明的保护范围之外。
Claims (7)
1.一种克服无人驾驶汽车横向控制大纯滞后的方法,其特征在于包括以下步骤:
1)获取实际测量域控制器发出横向控制指令至无人驾驶汽车响应横向控制指令的滞后时间ΔT;
2)获取无人驾驶汽车的参考行驶轨迹;
3)计算修正量R(t);
4)根据滞后时间ΔT,采用预测模型获取无人驾驶汽车t+ΔT时刻的预测位置Pp(t+ΔT);
5)根据预测位置Pp(t+ΔT)和修正量R(t)获取横向控制计算参考点Pc;
6)在横向控制计算参考点Pc处计算无人驾驶汽车横向控制的控制量;
7)将横向控制量作为控制指令值发送给底层执行器。
2.如权利要求1所述方法,其特征在于,所述步骤1)中,在时刻T1给定期望的横向控制指令,测量横向控制指令响应过程的初始时刻T2,得到所述滞后时间ΔT:
ΔT=T2-T1。
3.如权利要求1所述方法,其特征在于,所述步骤3)中,所述修正量R(t)为:
R(t)=P(t)-Pr(t),
其中,P(t)是无人驾驶汽车当前时刻位置,Pr(t)是参考行驶轨迹上与P(t)距离最近的位置。
4.如权利要求1所述方法,其特征在于,所述步骤4)中,依据当前无人驾驶汽车位置,由预测模型预测ΔT时刻之后无人驾驶汽车所处的位置Pp(t+ΔT)。
5.如权利要求4所述方法,其特征在于,所述预测模型采用匀速模型或匀加速模型。
6.如权利要求1所述方法,其特征在于,所述步骤5)中,横向控制计算参考点Pc为:
Pc=Pp(t+ΔT)+αR(t),
其中,α是调节因子。
7.如权利要求1所述方法,其特征在于,所述步骤6)中,采用PID控制或预瞄控制方法计算无人驾驶汽车横向控制的控制量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910991620.9A CN110789526B (zh) | 2019-10-18 | 2019-10-18 | 一种克服无人驾驶汽车横向控制大纯滞后的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910991620.9A CN110789526B (zh) | 2019-10-18 | 2019-10-18 | 一种克服无人驾驶汽车横向控制大纯滞后的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110789526A true CN110789526A (zh) | 2020-02-14 |
CN110789526B CN110789526B (zh) | 2021-05-18 |
Family
ID=69440449
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910991620.9A Active CN110789526B (zh) | 2019-10-18 | 2019-10-18 | 一种克服无人驾驶汽车横向控制大纯滞后的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110789526B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111284478A (zh) * | 2020-03-13 | 2020-06-16 | 联创汽车电子有限公司 | 预瞄路径跟踪计算方法及跟踪计算模块 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106681327A (zh) * | 2017-01-11 | 2017-05-17 | 中南大学 | 一种大惯性电动客车的智能驾驶横纵向解耦控制方法及系统 |
US20180043934A1 (en) * | 2016-08-09 | 2018-02-15 | Denso Corporation | Driver assistance system |
CN108137006A (zh) * | 2016-09-28 | 2018-06-08 | 百度(美国)有限责任公司 | 用于自动驾驶车辆的系统延迟校正控制方法 |
CN108646748A (zh) * | 2018-06-05 | 2018-10-12 | 北京联合大学 | 一种场地无人车轨迹跟踪方法及系统 |
US20190276016A1 (en) * | 2016-10-31 | 2019-09-12 | MAGNETI MARELLI S.p.A. | Adaptive control method and system in a terrestrial vehicle for tracking a route, particularly in an autonomous driving scenario |
-
2019
- 2019-10-18 CN CN201910991620.9A patent/CN110789526B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20180043934A1 (en) * | 2016-08-09 | 2018-02-15 | Denso Corporation | Driver assistance system |
CN108137006A (zh) * | 2016-09-28 | 2018-06-08 | 百度(美国)有限责任公司 | 用于自动驾驶车辆的系统延迟校正控制方法 |
US20190276016A1 (en) * | 2016-10-31 | 2019-09-12 | MAGNETI MARELLI S.p.A. | Adaptive control method and system in a terrestrial vehicle for tracking a route, particularly in an autonomous driving scenario |
CN106681327A (zh) * | 2017-01-11 | 2017-05-17 | 中南大学 | 一种大惯性电动客车的智能驾驶横纵向解耦控制方法及系统 |
CN108646748A (zh) * | 2018-06-05 | 2018-10-12 | 北京联合大学 | 一种场地无人车轨迹跟踪方法及系统 |
Non-Patent Citations (1)
Title |
---|
刘晓峰等: "一种克服大纯滞后的预测控制方法", 《河南科技大学学报:自然科学版》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111284478A (zh) * | 2020-03-13 | 2020-06-16 | 联创汽车电子有限公司 | 预瞄路径跟踪计算方法及跟踪计算模块 |
Also Published As
Publication number | Publication date |
---|---|
CN110789526B (zh) | 2021-05-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112733270B (zh) | 车辆行驶轨迹预测和轨迹偏离危险度评估的系统与方法 | |
CN109131325B (zh) | 智能驾驶汽车的三维可拓预瞄切换的车道保持控制方法 | |
CN101837781B (zh) | 用于自动车道对正或换道的控制系统的基于模型的预测控制 | |
CN110568758B (zh) | 一种自动驾驶汽车的参数自适应横向运动lqr控制方法 | |
US10099691B2 (en) | Apparatus and program for assisting drive of vehicle | |
US10860035B2 (en) | Travel history storage method, method for producing travel path model, method for estimating local position, and travel history storage device | |
CN108058706B (zh) | 一种车道保持系统及方法 | |
US8078373B2 (en) | Vehicle dynamics prediction with lane/path information using a preview-correction-prediction approach | |
JP2008143269A (ja) | 車両用制御装置 | |
CN111731307B (zh) | 一种车辆转弯控制方法、装置、车辆及存储介质 | |
RU2018102681A (ru) | Способ управления скоростью для транспортного средства и соответствующее транспортное средство | |
CN104864867B (zh) | 适用gnss的车辆在vsyr盲区定位误差修正方法 | |
Solyom et al. | Performance limitations in vehicle platoon control | |
CN111696339A (zh) | 一种自动驾驶车队的跟车控制方法、系统及车辆 | |
US20210139007A1 (en) | Enhanced vehicle operation | |
CN108693862A (zh) | 自动操舵控制装置 | |
WO2011086698A1 (ja) | 車両制御装置 | |
CN110789526B (zh) | 一种克服无人驾驶汽车横向控制大纯滞后的方法 | |
CN108919798B (zh) | 一种基于混合函数域的网联智能车辆编队行驶控制方法 | |
KR101930163B1 (ko) | 차로 유지 제어 장치 및 방법 | |
CN116691668A (zh) | 一种大型智能车辆的横向控制方法 | |
CN113325849A (zh) | 一种针对高地隙植保机的运动控制方法 | |
Shufeng et al. | Lane level turning trajectory tracking of intelligent vehicle based on drivers' manipulate habits | |
TWI602725B (zh) | 具路徑誤差修正的車輛軌跡追蹤裝置及方法 | |
JP6409711B2 (ja) | 走行環境認識装置 |
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 |