CN112519882B - 一种车辆参考轨迹跟踪方法及系统 - Google Patents

一种车辆参考轨迹跟踪方法及系统 Download PDF

Info

Publication number
CN112519882B
CN112519882B CN201910873236.9A CN201910873236A CN112519882B CN 112519882 B CN112519882 B CN 112519882B CN 201910873236 A CN201910873236 A CN 201910873236A CN 112519882 B CN112519882 B CN 112519882B
Authority
CN
China
Prior art keywords
vehicle
steering wheel
wheel angle
yaw rate
calculating
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.)
Active
Application number
CN201910873236.9A
Other languages
English (en)
Other versions
CN112519882A (zh
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.)
Guangzhou Automobile Group Co Ltd
Original Assignee
Guangzhou Automobile Group 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 Guangzhou Automobile Group Co Ltd filed Critical Guangzhou Automobile Group Co Ltd
Priority to CN201910873236.9A priority Critical patent/CN112519882B/zh
Publication of CN112519882A publication Critical patent/CN112519882A/zh
Application granted granted Critical
Publication of CN112519882B publication Critical patent/CN112519882B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D15/00—Steering not otherwise provided for
    • B62D15/02—Steering position indicators ; Steering position determination; Steering aids
    • B62D15/025—Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
    • 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
    • B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D15/00—Steering not otherwise provided for
    • B62D15/02—Steering position indicators ; Steering position determination; Steering aids
    • B62D15/021—Determination of steering angle
    • B62D15/024—Other means for determination of steering angle without directly measuring it, e.g. deriving from wheel speeds on different sides of the car
    • 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
    • B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W2050/0001—Details of the control system
    • B60W2050/0019—Control system elements or transfer functions
    • B60W2050/0028—Mathematical models, e.g. for simulation
    • B60W2050/0031—Mathematical model of the vehicle
    • B60W2050/0034—Multiple-track, 2D vehicle model, e.g. four-wheel model

Abstract

本发明提供一种车辆参考轨迹跟踪方法及系统，其中，车辆参考轨迹跟踪方法包括：实时获取车辆当前车速、车辆横摆角速度、所述参考轨迹的曲率、车辆与所述参考轨迹的相对航向角偏差和相对横向位置偏差、以及车辆运动控制器的期望性能指标；根据所述当前车速、所述车辆横摆角速度、所述曲率、所述相对航向角偏差、所述相对横向位置偏差以及所述期望性能指标计算获得期望横摆角速度；根据所述期望横摆角速度计算获得所述车辆的最终方向盘转角，并控制车辆输出所述最终方向盘转角。本发明根据期望的运动控制器性能指标直接设计控制器，具有控制效果好、调整参数工作量小、可以缩短开发周期等优点。

Description

一种车辆参考轨迹跟踪方法及系统
技术领域
本发明涉及智能驾驶技术领域，具体涉及一种车辆参考轨迹跟踪方法及系统。
背景技术
车辆运动控制是自动驾驶汽车的关键技术之一，是以环境感知、决策规划的车辆轨迹为基础，通过控制油门、制动和转向等执行机构准确跟随规划出的目标轨迹，同时使汽车在行驶过程中能够实现车速调节、车距保持、换道、超车等基本操作，以期保证汽车的安全性、操纵性和稳定性。
如何控制车辆更好地跟随目标轨迹是运动控制要解决的核心问题。针对该问题，现阶段技术人员大都从控制算法层面去提高轨迹跟踪精度，如采用PID控制、最优控制、模型预测控制等。但无论采用上述何种算法，在算法设计之初是没有将控制器性能指标(如超调量、调整时间等)纳入控制器设计范围，只是在算法实施之后，通过效果评估不断调整参数直至满足系统性能指标，这一方面需要丰富的参数整定经验，也延长了开发周期。
此外，现有的关于轨迹跟踪的算法，很大一部分都是在大地坐标系和车辆坐标系之间进行坐标转化，相比于Frenet坐标系，存在公式多，计算量大的问题。
发明内容
本发明所要解决的技术问题在于，提供一种车辆参考轨迹跟踪方法及系统，以降低参数整定工作量，缩短开发周期，以及简化控制器设计，提高控制效果。
为了解决上述技术问题，本发明提供一种车辆参考轨迹跟踪方法，包括如下步骤：
步骤S1，实时获取车辆当前车速、车辆横摆角速度、所述参考轨迹的曲率、车辆与所述参考轨迹的相对航向角偏差和相对横向位置偏差、以及车辆运动控制器的期望性能指标；
步骤S2，根据所述当前车速、所述车辆横摆角速度、所述曲率、所述相对航向角偏差、所述相对横向位置偏差以及所述期望性能指标计算获得期望横摆角速度；
步骤S3，根据所述期望横摆角速度计算获得所述车辆的最终方向盘转角，并控制车辆输出所述最终方向盘转角。
其中，所述步骤S2具体包括：
根据车辆在Frenet坐标系下的运动学模型建立的所述运动控制器的二阶系统方程、所述车辆运动控制器的期望性能指标和所述期望横摆角速度的表达式计算获得所述期望横摆角速度；
其中，所述车辆在Frenet坐标系下的运动学模型基于所述当前车速、所述车辆横摆角速度、所述曲率、所述相对航向角偏差、所述相对横向位置偏差建立，所述期望横摆角速度的表达式基于所述运动学模型获得。
其中，所述运动学模型为：
Figure BDA0002203498450000021
Figure BDA0002203498450000022
Figure BDA0002203498450000023
其中，v为车辆当前车速，w为车辆当前横摆角速度，θ为车辆与所述参考轨迹的相对航向角偏差，r为车辆与所述参考轨迹的相对横向位置偏差，k为所述参考轨迹的曲率，
Figure BDA0002203498450000024
为车辆参考点在Frenet坐标系的切向速度，
Figure BDA0002203498450000025
为所述车辆在Frenet坐标系下的侧向速度，
Figure BDA0002203498450000026
为在Frenet坐标系下的车辆与参考轨迹的相对角速度。
其中，所述计算获得所述期望横摆角速度的步骤具体包括：
根据调整时间与二阶系统的自然频率和阻尼比的对应关系、所述超调量与所述阻尼比的对应关系以及所述运动控制器的期望的调整时间和期望的超调量计算获得所述自然频率和阻尼比，其中，所述二阶系统基于所述车辆与参考轨迹的相对横向位置偏差为变量建立，所述二阶系统方程中的各比例系数与二阶系统的自然频率和阻尼比的关系表达式根据二阶系统特征方程分别获得；
根据计算获得的自然频率、阻尼比以及二阶系统方程中的各比例系数与二阶系统的自然频率和阻尼比的关系表达式计算获得所述二阶系统方程中的各比例系数的值；
根据所述各比例系数的值和所述期望横摆角速度的表达式计算获得所述期望横摆角速度。
其中，所述步骤S3具体包括：
步骤S31，根据当前车速获得车辆的当前运行模式，计算所述当前运行模式下的方向盘转角前馈控制量；
步骤S32，根据所述期望横摆角速度计算所述方向盘转角反馈控制量；
步骤S33，根据所述方向盘转角前馈控制量和所述方向盘转角反馈控制量计算获得所述车辆的最终方向盘转角，并控制输出所述最终方向盘转角。
其中，所述步骤S31具体包括：
判断当前车速是否大于一预设车速，若大于，则判断车辆运行在中高速模式下，进一步根据车辆动力学模型计算所述中高速模式下的方向盘转角前馈控制量；若小于，则判断车辆运行在低速模式下，进一步根据车辆运动学模型计算所述低速模式下的方向盘转角前馈控制量。
其中，所述中高速模式下的方向盘转角前馈控制量为：
Figure BDA0002203498450000031
其中，δw,ff1为中高速模式下的方向盘转角前馈控制量，δf为前轮转角，i为车轮至转向盘的角传动比；
其中，所述低速模式下的方向盘转角前馈控制量为：
Figure BDA0002203498450000032
其中，δw,ff2为低速模式下的方向盘转角前馈控制量，ωd为所述期望的横摆角速度，lf为车辆质心到前轴的距离，lr为车辆质心到后轴的距离，β为质心侧偏角，v为车辆当前车速。
其中，所述方向盘转角的反馈控制量为：
δw,fb＝kw(ωd-ω)
其中，δw,fb为车辆方向盘转角的反馈量，kw为反馈控制增益，ω为实际的车辆横摆角速度，wd为期望横摆角速度。
其中，所述步骤S33具体包括：
当车辆运行在中高速模式下时，计算所述中高速模式下的方向盘转角的前馈控制量和所述方向盘转角的反馈控制量的和获得所述中高速模式下的最终方向盘转角，并控制输出所述中高速模式下的最终方向盘转角；
当车辆运行在低速模式下时，计算所述低速模式下的方向盘转角的前馈控制量和所述方向盘转角的反馈控制量的和获得所述低速模式下的最终方向盘转角，并控制输出所述低速模式下的最终方向盘转角。
本发明还提供一种车辆参考轨迹跟踪系统，包括：
获取单元，用于实时获取车辆当前车速、车辆横摆角速度、所述参考轨迹的曲率、车辆与所述参考轨迹的相对航向角偏差和相对横向位置偏差、以及车辆运动控制器的期望性能指标；
期望横摆角速度计算单元，用于根据所述当前车速、所述车辆横摆角速度、所述曲率、所述相对航向角偏差、所述相对横向位置偏差以及所述期望性能指标计算获得期望横摆角速度；
最终方向盘转角计算单元，用于根据所述期望横摆角速度计算获得所述车辆的最终方向盘转角，并控制车辆输出所述最终方向盘转角。
其中，所述期望横摆角速度计算单元具体包括：
第一计算模块，用于根据车辆在Frenet坐标系下的运动学模型建立的所述车辆运动控制器的二阶系统方程、所述车辆运动控制器的期望性能指标和所述期望横摆角速度的表达式计算获得所述期望横摆角速度；
存储模块，用于存储基于所述当前车速、所述车辆横摆角速度、所述曲率、所述相对航向角偏差、所述相对横向位置偏差建立的所述车辆在Frenet坐标系下的运动学模型，以及基于所述运动学模型获得的所述期望横摆角速度的表达式。
其中，所述运动学模型为：
Figure BDA0002203498450000041
Figure BDA0002203498450000051
Figure BDA0002203498450000052
其中，v为车辆当前车速，w为车辆当前横摆角速度，θ为车辆与所述参考轨迹的相对航向角偏差，r为车辆与所述参考轨迹的相对横向位置偏差，k为所述参考轨迹的曲率，
Figure BDA0002203498450000053
为车辆参考点在Frenet坐标系的切向速度，
Figure BDA0002203498450000054
为所述车辆在Frenet坐标系下的侧向速度，
Figure BDA0002203498450000055
为在Frenet坐标系下的车辆与参考轨迹的相对角速度。
其中，所述第一计算模块具体用于：
根据调整时间与二阶系统的自然频率和阻尼比的对应关系、所述超调量与所述阻尼比的对应关系以及所述运动控制器的期望的调整时间和期望的超调量计算获得所述自然频率和阻尼比，其中，所述二阶系统基于所述车辆与参考轨迹的相对横向位置偏差为变量建立，所述二阶系统方程中的各比例系数与二阶系统的自然频率和阻尼比的关系表达式根据二阶系统特征方程分别获得；
根据计算获得的自然频率、阻尼比以及二阶系统方程中的各比例系数与二阶系统的自然频率和阻尼比的关系表达式计算获得所述二阶系统方程中的各比例系数的值。
其中，所述最终方向盘转角计算单元进一步包括：
第二计算模块，用于根据当前车速获得车辆的当前运行模式，计算所述当前运行模式下的方向盘转角前馈控制量；
第三计算模块，用于根据所述期望横摆角速度计算所述方向盘转角反馈控制量；
第四计算模块，用于根据所述方向盘转角前馈控制量和所述方向盘转角反馈控制量计算获得所述车辆的最终方向盘转角，并控制输出所述最终方向盘转角。
其中，第二计算模块具体用于判断当前车速是否大于一预设车速，若大于，则判断车辆运行在中高速模式下，进一步根据车辆动力学模型计算所述中高速模式下的方向盘转角前馈控制量；若小于，则判断车辆运行在低速模式下，进一步根据车辆运动学模型计算所述低速模式下的方向盘转角前馈控制量。
实施本发明实施例具有以下有益效果：
根据期望的运动控制器性能指标直接设计控制器，具有控制效果好、调整参数工作量小、可以缩短开发周期等优点；
将满足性能指标的期望横摆角速度作为虚拟控制可实现车辆相对于轨迹的横向位置误差的渐进稳定；
为保证车辆航向角的稳定，结合车辆运动学和动力学模型的特点及适用范围，根据不同的车速，设计中高速和低速控制器，可以很好的兼顾模型复杂度和精度的需求，从而降低整个控制算法的实施难度以及对搭载平台计算能力的需求。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1是本发明实施例一一种车辆参考轨迹跟踪方法的流程示意图。
图2是本发明实施例一中笛卡尔坐标系示意图。
图3是本发明实施例一中Frenet坐标系流程示意图。
图4是本发明实施例一中步骤S3的流程示意图。
图5是本发明实施例一中车辆运动学模型示意图。
具体实施方式
以下各实施例的说明是参考附图，用以示例本发明可以用以实施的特定实施例。
本发明采用控制器逆向设计的思路，通过设定的系统性能指标直接进行控制器设计，相比于正向设计思路开发的控制器，具有效果好、调参工作量小、节约开发时间的特点。
请参照图1所示，本发明实施例一提供一种车辆参考轨迹跟踪方法，该方法包括如下步骤：
步骤S1，实时获取车辆当前车速、车辆横摆角速度、所述参考轨迹的曲率、车辆与所述参考轨迹的相对航向角偏差和相对横向位置偏差、以及车辆运动控制器的期望性能指标；
步骤S2，根据所述当前车速、所述车辆横摆角速度、所述曲率、所述相对航向角偏差、所述相对横向位置偏差以及所述期望性能指标计算获得期望横摆角速度；
步骤S3，根据所述期望横摆角速度计算获得所述车辆的最终方向盘转角，并控制车辆输出所述最终方向盘转角。
具体地，步骤S1中，车辆视觉系统采集车辆坐标系下的车辆横摆角ψ、车辆质心侧偏角β、车辆当前车速v，车辆横摆角速度ω，车辆视觉系统将车辆坐标系下的相关参量经过坐标转换，转换到笛卡尔坐标系下，如图2所示，为笛卡尔坐标系，根据车辆运动学模型，获得笛卡尔坐标系下的运动学方程为：
Figure BDA0002203498450000071
Figure BDA0002203498450000072
Figure BDA0002203498450000073
其中，x0、y0、ψ0分别表示初始时刻车辆质心处的横向位置和纵向位置及横摆角，
Figure BDA0002203498450000074
为笛卡尔坐标系下车辆质心纵向车速；
Figure BDA0002203498450000075
为笛卡尔坐标系下车辆质心侧向车速；
Figure BDA0002203498450000076
为车辆横摆角微分。
由于正交投影不随车辆旋转而变化，只要车速为正，投影点沿路径单调运动，因而采用正交投影的方式将参考点投影到参考轨迹上，从而获得参考轨迹的曲率k、车辆与参考轨迹的相对航向角偏差θ和相对横向位置偏差r。
具体地，车辆运动控制器的期望性能指标包括调整时间ts和超调量yp。
在一具体实施方式中，步骤S2具体包括：
根据车辆在Frenet坐标系下的运动学模型建立的所述车辆运动控制器的二阶系统方程、所述车辆运动控制器的期望性能指标和所述期望横摆角速度的表达式计算获得所述期望横摆角速度；
其中，所述车辆在Frenet坐标系下的运动学模型基于所述当前车速、所述车辆横摆角速度、所述曲率、所述相对航向角偏差、所述相对横向位置偏差建立；所述期望横摆角速度的表达式基于所述运动学模型获得。
如图3所示，所述车辆在Frenet坐标系下的运动学模型为：
Figure BDA0002203498450000081
Figure BDA0002203498450000082
Figure BDA0002203498450000083
其中，s为所述参考轨迹的长度，
Figure BDA00022034984500000810
为车辆参考点在Frenet坐标系的切向速度，
Figure BDA0002203498450000084
为所述车辆在Frenet坐标系下的侧向速度，
Figure BDA0002203498450000085
为在Frenet坐标系下的车辆与参考轨迹的相对角速度，s0为所述参考轨迹的初始值，r0为所述车辆与所述参考轨迹的相对横向位置偏差的初始值，θ0为所述车辆与参考轨迹的相对航向角偏差θ的初始值。
具体地，基于所述车辆在Frenet坐标下的运动学模型，同时考虑质心侧偏角通常很小，可视为0，做如下定义：
z＝r
Figure BDA0002203498450000086
Figure BDA0002203498450000087
基于上述第一等式，可以推导出期望的横摆角速度：
Figure BDA0002203498450000088
其中，
Figure BDA0002203498450000089
k0和k1分别为二阶系统的比例系数。
计算获得期望横摆角速度的步骤具体如下：
根据调整时间与二阶系统的自然频率和阻尼比的对应关系、所述超调量与所述阻尼比的对应关系以及所述运动控制器的期望的调整时间和期望的超调量计算获得所述自然频率和阻尼比，其中，所述二阶系统基于所述车辆与参考轨迹的相对横向位置偏差为变量建立，所述二阶系统方程中的各比例系数与二阶系统的自然频率和阻尼比的关系表达式根据二阶系统特征方程分别获得；
根据计算获得的自然频率、阻尼比以及二阶系统方程中的各比例系数与二阶系统的自然频率和阻尼比的关系表达式计算获得所述二阶系统方程中的各比例系数的值；
根据所述各比例系数的值和所述期望横摆角速度的表达式计算获得所述期望横摆角速度。
具体地，本实施例做如下定义并设计二阶系统：
Figure BDA0002203498450000091
则建立的二阶系统的方程为：
Figure BDA0002203498450000092
由于二阶系统的特征方程为：
Figure BDA0002203498450000093
将建立的二阶系统方程与二阶系统的特征方程进行对比可知：
Figure BDA0002203498450000094
k1＝2ζω0
其中，ω0为二阶系统自然频率，ζ为阻尼比。由于二阶控制系统的性能(调整时间ts和超调量yp等)主要由自然频率和阻尼比决定。调整时间和超调量与自然频率和阻尼比的对应关系如下：
Figure BDA0002203498450000095
Figure BDA0002203498450000096
其中，∈为实际响应和稳态输出之间的误差。
在实际的应用过程中，如果要求二阶系统达到期望的性能指标，即已知调整时间ts和超调量yp，则可以获得相应的自然频率ω0和阻尼比ζ。考虑到在实际控制过程中，通常都希望控制系统具有适度的阻尼、较快的响应速度以及较短的超调时间，也就是欠阻尼系统。在主要考虑欠阻尼(0<ζ<1)以及临界阻尼(ζ＝1)的情况下：
当0<ζ<1：
Figure BDA0002203498450000097
Figure BDA0002203498450000098
当ζ＝1：
Figure BDA0002203498450000099
基于上式，在已知调整时间ts和超调整量yp的情况下，可以计算获得二阶系统的自然频率ω0和阻尼比ζ，进一步地，可计算获得二阶系统的比例系数k0和k1，最终求解获得期望的横摆角速度ωd。
在一具体实施方式中，如图4所示，步骤S3具体包括：
步骤S31，根据车辆当前车速获得车辆的当前运行模式，计算所述当前运行模式下的方向盘转角前馈控制量。
具体地，判断当前车速是否大于一预设车速，若大于，则判断车辆运行在中高速模式下，进一步根据车辆动力学模型计算所述中高速模式下的方向盘转角前馈控制量，若小于，则判断车辆运行在低速模式下，进一步根据车辆运动学模式计算所述低速模式下的方向盘转角前馈控制量。其中，所述预设车速为36千米每小时。
当车辆运行在中高速模式下时，搭建的车辆动力学模型为：
Figure BDA0002203498450000101
其中，m为整车质量，lf为质心到前轴的距离，Iz为转动惯量，lr为质心到后轴距离，Cf为前轮侧偏刚度，Cr为后轮侧偏刚度，β为质心侧偏角，δf为前轮转角，
Figure BDA0002203498450000102
为质心侧偏角的变化率，
Figure BDA0002203498450000103
为车辆当前横摆角速度的变化率。
当车辆处于稳态时，则
Figure BDA0002203498450000104
x＝-A-1Bδf，进一步求得状态量在稳态下的数值解：
Figure BDA0002203498450000105
其中，βss和ωss分别表示中高速模式下的稳定状态下的质心侧偏角和稳态横摆角速度。
因而，方向盘转角的前馈控制量为：
Figure BDA0002203498450000106
其中，δw,ff1为方向盘转角前馈控制量，i为车轮至转向盘的角传动比。
当车辆运行于低速模式下时，车辆运动学模型如图5所示，根据车辆运动学模型可得：
Figure BDA0002203498450000111
Figure BDA0002203498450000112
其中，βcc和ωcc分别表示低速运行模式下的稳定状态下的质心侧偏角和稳态横摆角速度。
基于上式，可以得出低速模式下方向盘转角的前馈控制量δw,ff2为：
Figure BDA0002203498450000113
步骤S32，根据所述期望横摆角速度计算所述方向盘转角反馈控制量。
具体地，考虑到外界干扰以及模型的不确定性，引入反馈控制，其中，方向盘转角反馈控制量为：
δw,fb＝kw(ωd-ω)
其中，δw,fb为方向盘转角反馈控制量，ω为车辆横摆角速度，kw为反馈控制增益。
步骤S33，根据所述方向盘转角前馈控制量和所述方向盘转角反馈控制量计算获得所述车辆的最终方向盘转角，并控制输出所述最终方向盘转角。
具体地，当车辆运行在中高速模式下时，最终方向盘转角δw为中高速模式下的方向盘转角前馈控制量加上方向盘转角反馈控制量，即：
Figure BDA0002203498450000114
当车辆运行在低速模式下时，最终方向盘转角δw为低速模式下的方向盘转角前馈控制量加上方向盘转角反馈控制量，即：
Figure BDA0002203498450000121
在获得了最终方向盘转角后，控制车辆输出最终方向盘转角以跟踪所述参考轨迹。
本发明实施例的参考轨迹跟踪方法，根据车辆在Frenet坐标系下的运动学模型建立的车辆运动控制器的二阶系统方程、所述车辆运动控制器的期望性能指标和期望横摆角速度的表达式计算获得所述期望横摆角速度，基于横摆角速度采用前馈控制和反馈控制计算最终的方向盘转角，以跟踪所述参考轨迹。
本实施例的方法根据期望的运动控制器性能指标直接设计控制器，具有控制效果好、调整参数工作量小、可以缩短开发周期等优点；其次将满足性能指标的期望横摆角速度作为虚拟控制可实现车辆相对于轨迹的横向位置误差的渐进稳定；最后为保证车辆航向角的稳定，结合车辆运动学和动力学模型的特点及适用范围，根据不同的车速，设计中高速模式方向盘前馈控制量和低速模式方向盘前馈控制量，可以很好的兼顾模型复杂度和精度的需求，从而降低整个控制算法的实施难度以及对呆在平台计算能力的需求。
基于本发明实施例一，本发明实施例二提供一种车辆参考轨迹跟踪系统，包括：
获取单元，用于实时获取车辆当前车速、车辆横摆角速度、所述参考轨迹的曲率、车辆与所述参考轨迹的相对航向角偏差和相对横向位置偏差、以及车辆运动控制器的期望性能指标；
期望横摆角速度计算单元，用于根据所述当前车速、所述车辆横摆角速度、所述曲率、所述相对航向角偏差、所述相对横向位置偏差以及所述期望性能指标计算获得期望横摆角速度；
最终方向盘转角计算单元，用于根据所述期望横摆角速度计算获得所述车辆的最终方向盘转角，并控制车辆输出所述最终方向盘转角。
其中，期望横摆角速度计算单元具体包括：
第一计算模块，用于根据车辆在Frenet坐标系下的运动学模型建立的所述运动控制器的二阶系统方程、所述运动控制器的期望性能指标和所述期望横摆角速度的表达式计算获得所述期望横摆角速度；
存储模块，用于存储基于所述当前车速、所述车辆横摆角速度、所述曲率、所述相对航向角偏差、所述相对横向位置偏差建立的所述车辆在Frenet坐标系下的运动学模型，以及基于所述运动学模型获得的所述期望横摆角速度的表达式。
其中，所述运动学模型为：
Figure BDA0002203498450000131
Figure BDA0002203498450000132
Figure BDA0002203498450000133
其中，v为车辆当前车速，w为车辆当前横摆角速度，θ为车辆与所述参考轨迹的相对航向角偏差，r为车辆与所述参考轨迹的相对横向位置偏差，k为所述参考轨迹的曲率，
Figure BDA0002203498450000134
为车辆参考点在Frenet坐标系的切向速度，
Figure BDA0002203498450000135
为所述车辆在Frenet坐标系下的侧向速度，
Figure BDA0002203498450000136
为在Frenet坐标系下的车辆与参考轨迹的相对角速度。
其中，所述第一计算模块具体用于：
以所述车辆与参考轨迹的相对横向位置偏差为变量建立所述二阶系统方程；
根据二阶系统特征方程分别获得所述二阶系统方程中的各比例系数与二阶系统的自然频率和阻尼比的关系表达式；
根据调整时间与所述二阶系统的自然频率和阻尼比的对应关系、所述超调量与所述阻尼比的对应关系以及所述运动控制器的期望的调整时间和期望的超调量计算获得所述自然频率和阻尼比；
根据计算获得的自然频率、阻尼比以及二阶系统方程中的各比例系数与二阶系统的自然频率和阻尼比的关系表达式计算获得所述二阶系统方程中的各比例系数的值；
根据所述各比例系数的值和所述期望横摆角速度的表达式计算获得所述期望横摆角速度。
其中，所述最终方向盘转角计算单元进一步包括：
第二计算模块，用于根据当前车速获得车辆的当前运行模式，计算所述当前运行模式下的方向盘转角前馈控制量；
第三计算模块，用于根据所述期望横摆角速度计算所述方向盘转角反馈控制量；
第四计算模块，用于根据所述方向盘转角前馈控制量和所述方向盘转角反馈控制量计算获得所述车辆的最终方向盘转角，并控制输出所述最终方向盘转角。
其中，第二计算模块具体用于判断当前车速是否大于一预设车速，若大于，则判断车辆运行在中高速模式下，进一步根据车辆动力学模型计算所述中高速模式下的方向盘转角前馈控制量；若小于，则判断车辆运行在低速模式下，进一步根据车辆运动学模型计算所述低速模式下的方向盘转角前馈控制量。
有关本实施例的工作原理以及所带来的有益效果请参照本发明实施例一的说明，此处不再赘述。
以上所揭露的仅为本发明较佳实施例而已，当然不能以此来限定本发明之权利范围，因此依本发明权利要求所作的等同变化，仍属本发明所涵盖的范围。

Claims (13)

1.一种车辆参考轨迹跟踪方法，其特征在于，包括如下步骤：
步骤S1，实时获取车辆当前车速、车辆横摆角速度、所述参考轨迹的曲率、车辆与所述参考轨迹的相对航向角偏差和相对横向位置偏差、以及车辆运动控制器的期望性能指标；
步骤S2，根据车辆在Frenet坐标系下的运动学模型建立的所述车辆运动控制器的二阶系统方程、所述车辆运动控制器的期望性能指标和期望横摆角速度的表达式计算获得所述期望横摆角速度；其中，所述车辆在Frenet坐标系下的运动学模型基于所述当前车速、所述车辆横摆角速度、所述曲率、所述相对航向角偏差、所述相对横向位置偏差建立；所述期望横摆角速度的表达式基于所述运动学模型获得；
步骤S3，根据所述期望横摆角速度计算获得所述车辆的最终方向盘转角，并控制车辆输出所述最终方向盘转角。
2.根据权利要求1所述的方法，其特征在于，所述运动学模型为：
Figure FDA0003373398800000011
Figure FDA0003373398800000012
Figure FDA0003373398800000013
其中，v为车辆当前车速，w为车辆当前横摆角速度，θ为车辆与所述参考轨迹的相对航向角偏差，r为车辆与所述参考轨迹的相对横向位置偏差，k为所述参考轨迹的曲率，
Figure FDA0003373398800000014
为车辆参考点在Frenet坐标系的切向速度，
Figure FDA0003373398800000015
为所述车辆在Frenet坐标系下的侧向速度，
Figure FDA0003373398800000016
为在Frenet坐标系下的车辆与参考轨迹的相对角速度，
Figure FDA0003373398800000017
为质心侧偏角的变化率。
3.根据权利要求2所述的方法，其特征在于，所述计算获得所述期望横摆角速度的步骤具体包括：
根据调整时间与二阶系统的自然频率和阻尼比的对应关系、超调量与所述阻尼比的对应关系以及所述运动控制器的期望的调整时间和期望的超调量计算获得所述自然频率和阻尼比，其中，所述二阶系统基于所述车辆与参考轨迹的相对横向位置偏差为变量建立，所述二阶系统方程中的各比例系数与二阶系统的自然频率和阻尼比的关系表达式根据二阶系统特征方程分别获得；
根据计算获得的自然频率、阻尼比以及二阶系统方程中的各比例系数与二阶系统的自然频率和阻尼比的关系表达式计算获得所述二阶系统方程中的各比例系数的值；
根据所述各比例系数的值和所述期望横摆角速度的表达式计算获得所述期望横摆角速度。
4.根据权利要求1所述的方法，其特征在于，所述步骤S3具体包括：
步骤S31，根据当前车速获得车辆的当前运行模式，计算所述当前运行模式下的方向盘转角前馈控制量；
步骤S32，根据所述期望横摆角速度计算所述方向盘转角反馈控制量；
步骤S33，根据所述方向盘转角前馈控制量和所述方向盘转角反馈控制量计算获得所述车辆的最终方向盘转角，并控制输出所述最终方向盘转角。
5.根据权利要求4所述的方法，其特征在于，所述步骤S31具体包括：
判断当前车速是否大于一预设车速，若大于，则判断车辆运行在中高速模式下，进一步根据车辆动力学模型计算所述中高速模式下的方向盘转角前馈控制量；若小于，则判断车辆运行在低速模式下，进一步根据车辆运动学模型计算所述低速模式下的方向盘转角前馈控制量。
6.根据权利要求5所述的方法，其特征在于，所述中高速模式下的方向盘转角前馈控制量为：
Figure FDA0003373398800000021
其中，δw,ff1为中高速模式下的方向盘转角前馈控制量，δf为前轮转角，i为车轮至转向盘的角传动比；
其中，所述低速模式下的方向盘转角前馈控制量为：
Figure FDA0003373398800000022
其中，δw,ff2为低速模式下的方向盘转角前馈控制量，ωd为所述期望横摆角速度，lf为车辆质心到前轴的距离，lr为车辆质心到后轴的距离，β为质心侧偏角，v为车辆当前车速。
7.根据权利要求6所述的方法，其特征在于，所述方向盘转角的反馈控制量为：
δw,fb＝kw(ωd-ω)
其中，δw,fb为车辆方向盘转角的反馈量，kw为反馈控制增益，ω为实际的车辆横摆角速度，ωd为期望横摆角速度。
8.根据权利要求5所述的方法，其特征在于，所述步骤S33具体包括：
当车辆运行在中高速模式下时，计算所述中高速模式下的方向盘转角的前馈控制量和所述方向盘转角的反馈控制量的和获得所述中高速模式下的最终方向盘转角，并控制输出所述中高速模式下的最终方向盘转角；
当车辆运行在低速模式下时，计算所述低速模式下的方向盘转角的前馈控制量和所述方向盘转角的反馈控制量的和获得所述低速模式下的最终方向盘转角，并控制输出所述低速模式下的最终方向盘转角。
9.一种车辆参考轨迹跟踪系统，其特征在于，包括：
获取单元，用于实时获取车辆当前车速、车辆横摆角速度、所述参考轨迹的曲率、车辆与所述参考轨迹的相对航向角偏差和相对横向位置偏差、以及车辆运动控制器的期望性能指标；
期望横摆角速度计算单元，用于根据所述当前车速、所述车辆横摆角速度、所述曲率、所述相对航向角偏差、所述相对横向位置偏差以及所述期望性能指标计算获得期望横摆角速度；
最终方向盘转角计算单元，用于根据所述期望横摆角速度计算获得所述车辆的最终方向盘转角，并控制车辆输出所述最终方向盘转角；
所述期望横摆角速度计算单元具体包括：
第一计算模块，用于根据车辆在Frenet坐标系下的运动学模型建立的所述运动控制器的二阶系统方程、所述运动控制器的期望性能指标和所述期望横摆角速度的表达式计算获得所述期望横摆角速度；
存储模块，用于存储基于所述当前车速、所述车辆横摆角速度、所述曲率、所述相对航向角偏差、所述相对横向位置偏差建立的所述车辆在Frenet坐标系下的运动学模型，以及基于所述运动学模型获得的所述期望横摆角速度的表达式。
10.根据权利要求9所述的系统，其特征在于，所述运动学模型为：
Figure FDA0003373398800000041
Figure FDA0003373398800000042
Figure FDA0003373398800000043
其中，v为车辆当前车速，w为车辆当前横摆角速度，θ为车辆与所述参考轨迹的相对航向角偏差，r为车辆与所述参考轨迹的相对横向位置偏差，k为所述参考轨迹的曲率，
Figure FDA0003373398800000044
为车辆参考点在Frenet坐标系的切向速度，
Figure FDA0003373398800000045
为所述车辆在Frenet坐标系下的侧向速度，
Figure FDA0003373398800000046
为在Frenet坐标系下的车辆与参考轨迹的相对角速度，
Figure FDA0003373398800000047
为质心侧偏角的变化率。
11.根据权利要求10所述的系统，其特征在于，所述第一计算模块具体用于：
根据调整时间与二阶系统的自然频率和阻尼比的对应关系、超调量与所述阻尼比的对应关系以及所述运动控制器的期望的调整时间和期望的超调量计算获得所述自然频率和阻尼比，其中，所述二阶系统基于所述车辆与参考轨迹的相对横向位置偏差为变量建立，所述二阶系统方程中的各比例系数与二阶系统的自然频率和阻尼比的关系表达式根据二阶系统特征方程分别获得；
根据计算获得的自然频率、阻尼比以及二阶系统方程中的各比例系数与二阶系统的自然频率和阻尼比的关系表达式计算获得所述二阶系统方程中的各比例系数的值。
12.根据权利要求9所述的系统，其特征在于，所述最终方向盘转角计算单元进一步包括：
第二计算模块，用于根据当前车速获得车辆的当前运行模式，计算所述当前运行模式下的方向盘转角前馈控制量；
第三计算模块，用于根据所述期望横摆角速度计算所述方向盘转角反馈控制量；
第四计算模块，用于根据所述方向盘转角前馈控制量和所述方向盘转角反馈控制量计算获得所述车辆的最终方向盘转角，并控制输出所述最终方向盘转角。
13.根据权利要求12所述的系统，其特征在于，所述第二计算模块具体用于判断当前车速是否大于一预设车速，若大于，则判断车辆运行在中高速模式下，进一步根据车辆动力学模型计算所述中高速模式下的方向盘转角前馈控制量；若小于，则判断车辆运行在低速模式下，进一步根据车辆运动学模型计算所述低速模式下的方向盘转角前馈控制量。
CN201910873236.9A 2019-09-17 2019-09-17 一种车辆参考轨迹跟踪方法及系统 Active CN112519882B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910873236.9A CN112519882B (zh) 2019-09-17 2019-09-17 一种车辆参考轨迹跟踪方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910873236.9A CN112519882B (zh) 2019-09-17 2019-09-17 一种车辆参考轨迹跟踪方法及系统

Publications (2)

Publication Number Publication Date
CN112519882A CN112519882A (zh) 2021-03-19
CN112519882B true CN112519882B (zh) 2022-02-22

Family

ID=74974329

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910873236.9A Active CN112519882B (zh) 2019-09-17 2019-09-17 一种车辆参考轨迹跟踪方法及系统

Country Status (1)

Country Link
CN (1) CN112519882B (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113156934B (zh) * 2019-12-31 2022-02-25 上海司南卫星导航技术股份有限公司 一种车辆的自动驾驶系统及其方法、非临时性计算机可读存储介质
CN113183957A (zh) * 2021-05-24 2021-07-30 前海七剑科技(深圳)有限公司 车辆控制方法、装置、设备及自动驾驶车辆
CN113050660B (zh) * 2021-06-01 2021-08-20 新石器慧通（北京）科技有限公司 误差补偿方法、装置、计算机设备及存储介质
CN113335278B (zh) * 2021-07-20 2023-08-11 常州机电职业技术学院 一种网联式智能车队自适应巡航控制方法及系统
CN113415276B (zh) * 2021-07-30 2022-10-14 东风商用车有限公司 一种智能驾驶预瞄控制方法、装置和存储介质
CN113561969B (zh) * 2021-08-31 2023-07-28 岚图汽车科技有限公司 一种倒车辅助方法及装置
CN114253241B (zh) * 2021-12-21 2023-12-22 昆山星际舟智能科技有限公司 用于工业智能小车的路径跟踪方法
CN114802442B (zh) * 2022-05-06 2023-09-05 小米汽车科技有限公司 车辆横向控制方法、装置、存储介质及车辆
CN114895677B (zh) * 2022-05-17 2023-06-16 华南理工大学 一种车辆轨迹跟踪方法、系统、装置及存储介质

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103121451A (zh) * 2013-03-19 2013-05-29 大连理工大学 一种弯路换道轨迹的跟踪控制方法
CN104477237A (zh) * 2014-11-11 2015-04-01 深圳职业技术学院 一种四轮独立转向电动车转向控制方法及系统
CN107521496A (zh) * 2017-09-08 2017-12-29 吉林大学 一种无人车辆的横纵向协调控制轨迹跟随控制方法
CN108622104A (zh) * 2018-05-07 2018-10-09 湖北汽车工业学院 一种用于无人驾驶车辆的轨迹跟踪控制方法
CN109017778A (zh) * 2018-07-31 2018-12-18 大连民族大学 四轮独立驱动车辆的期望路径主动转向控制方法
CN109292018A (zh) * 2018-09-13 2019-02-01 吉林大学 基于同轴式轮腿结构的四轮转向轨迹跟踪控制方法
CN109606352A (zh) * 2018-11-22 2019-04-12 江苏大学 一种车辆路径跟踪与稳定性协调控制方法
CN110155031A (zh) * 2018-02-14 2019-08-23 通用汽车环球科技运作有限责任公司 使用神经网络的用于车辆横向控制的轨迹跟踪

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE10018558A1 (de) * 2000-04-14 2001-10-18 Bosch Gmbh Robert Verfahren zur Regelung der Geschwindigkeit eines Fahrzeugs
US9037348B2 (en) * 2012-01-02 2015-05-19 Ford Global Technologies, Llc Lane-keeping assistance method for a motor vehicle

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103121451A (zh) * 2013-03-19 2013-05-29 大连理工大学 一种弯路换道轨迹的跟踪控制方法
CN104477237A (zh) * 2014-11-11 2015-04-01 深圳职业技术学院 一种四轮独立转向电动车转向控制方法及系统
CN107521496A (zh) * 2017-09-08 2017-12-29 吉林大学 一种无人车辆的横纵向协调控制轨迹跟随控制方法
CN110155031A (zh) * 2018-02-14 2019-08-23 通用汽车环球科技运作有限责任公司 使用神经网络的用于车辆横向控制的轨迹跟踪
CN108622104A (zh) * 2018-05-07 2018-10-09 湖北汽车工业学院 一种用于无人驾驶车辆的轨迹跟踪控制方法
CN109017778A (zh) * 2018-07-31 2018-12-18 大连民族大学 四轮独立驱动车辆的期望路径主动转向控制方法
CN109292018A (zh) * 2018-09-13 2019-02-01 吉林大学 基于同轴式轮腿结构的四轮转向轨迹跟踪控制方法
CN109606352A (zh) * 2018-11-22 2019-04-12 江苏大学 一种车辆路径跟踪与稳定性协调控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
智能汽车的轨迹跟随控制研究;明廷友;《中国优秀硕士学位论文全文数据库 (工程科技Ⅱ辑)》;20160915(第09期);C035-104 *

Also Published As

Publication number Publication date
CN112519882A (zh) 2021-03-19

Similar Documents

Publication Publication Date Title
CN112519882B (zh) 一种车辆参考轨迹跟踪方法及系统
CN110588633B (zh) 一种智能汽车极限工况下路径跟踪与稳定控制方法
CN108001447A (zh) 一种智能车辆路径跟踪前轮转角补偿控制方法
CN111409641A (zh) 一种基于纵横向协调的轨迹跟踪控制方法及系统
CN112462760B (zh) 一种双舵轮agv路径跟踪方法
CN113325691B (zh) 一种无人车双闭环纵向控制方法、系统及设备
CN112622895B (zh) 一种应用于自动驾驶的轨迹控制的预估控制方法
CN113183957A (zh) 车辆控制方法、装置、设备及自动驾驶车辆
CN113126623B (zh) 一种考虑输入饱和的自适应动态滑模自动驾驶车辆路径跟踪控制方法
CN112109732A (zh) 一种智能驾驶自适应曲线预瞄方法
CN114625002B (zh) 一种基于模型预测控制的车辆横纵向集成控制方法
WO2023241050A1 (zh) 车辆横向控制方法、系统及车辆
CN116834754A (zh) 一种自动驾驶车辆自适应调速的横纵协同控制方法
CN115447615A (zh) 基于车辆运动学模型预测控制的轨迹优化方法
CN113311698B (zh) 车道保持控制方法、控制装置和车辆
CN110989346B (zh) 一种集成驾驶员决策行为的智能操纵方法
CN114802200A (zh) 一种智能汽车极限工况下轨迹跟踪和稳定性控制方法
Xiao et al. Smooth trajectory tracking using longitudinal distance constraint for a 4WS4WD unmanned ground vehicle
CN117657201A (zh) 一种车辆横向控制方法、系统及汽车
CN116520857B (zh) 一种车辆轨迹跟踪方法
CN117092909A (zh) 一种车辆稳定性控制仿真方法和系统
CN114326728A (zh) 高安全裕度的单agv智能车库路径跟踪控制系统及方法
CN116520700A (zh) 一种欠驱动自动驾驶车辆的路径跟踪控制方法
CN114896694A (zh) 一种基于两点预瞄的路径跟踪控制方法
CN117698725A (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