CN112590802B - 车辆驾驶控制方法、装置、车辆以及计算机可读存储介质 - Google Patents

车辆驾驶控制方法、装置、车辆以及计算机可读存储介质 Download PDF

Info

Publication number
CN112590802B
CN112590802B CN202011409839.2A CN202011409839A CN112590802B CN 112590802 B CN112590802 B CN 112590802B CN 202011409839 A CN202011409839 A CN 202011409839A CN 112590802 B CN112590802 B CN 112590802B
Authority
CN
China
Prior art keywords
lane
vehicle
distance
calculating
lqr
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
CN202011409839.2A
Other languages
English (en)
Other versions
CN112590802A (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.)
Inbo Supercomputing Nanjing Technology Co Ltd
Original Assignee
Inbo Supercomputing Nanjing 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 Inbo Supercomputing Nanjing Technology Co Ltd filed Critical Inbo Supercomputing Nanjing Technology Co Ltd
Priority to CN202011409839.2A priority Critical patent/CN112590802B/zh
Publication of CN112590802A publication Critical patent/CN112590802A/zh
Application granted granted Critical
Publication of CN112590802B publication Critical patent/CN112590802B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • B60W40/00Estimation 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/10Estimation 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
    • B60W40/114Yaw movement
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/50Context or environment of the image
    • G06V20/56Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/588Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Multimedia (AREA)
  • Theoretical Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Mathematical Physics (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

本发明提供一种基于LQR的车道居中驾驶控制方法,所述方法包括:根据车道线计算车道中心线以使车辆大致位于车道中心线上;根据车辆坐标系沿车头航向角方向预瞄一段距离X0计算横向偏移量D0、预瞄一段距离X1计算横向偏移量D1、预瞄一段距离X2计算横向偏移量D2,根据X1、X2、D1、D2计算相对航向角ε,通过LQR横向控制算法计算方向转角以对车辆进行横向控制。本发明能够提高车辆自动驾驶的稳定性。

Description

车辆驾驶控制方法、装置、车辆以及计算机可读存储介质
技术领域
本发明涉及自动驾驶技术领域,尤其涉及一种车辆驾驶控制方法、装置、车辆以及计算机可读存储介质。
背景技术
自动驾驶车辆行驶在车载摄像头可识别车道线的结构化道路上,当驾驶员激活车道居中系统时,汽车的摄像头传感器会跟踪车道标记,并通过使用汽车的主动转向系统来保持航向,帮助司机保持前方的稳定路径,使车辆控制在车道中心行驶,在车速过快或者曲率变化率过大的情况下运动学模型的方法无法满足车辆的稳定性控制要求。
发明内容
鉴于此,为了在一定程度上解决相关技术中的技术问题之一,有必要提供一种车辆驾驶控制方法、装置、车辆以及计算机可读存储介质,提高车辆自动驾驶的稳定性。
本发明第一方面提供一种基于LQR的车道居中驾驶控制方法,所述方法包括:
根据车道线计算车道中心线以使车辆大致位于车道中心线上;
根据车辆坐标系沿车头航向角方向预瞄一段距离X0计算横向偏移量D0、预瞄一段距离X1计算横向偏移量D1、预瞄一段距离X2计算横向偏移量D2,其中:X1≠X2
根据X1、X2、D1、D2计算相对航向角ε,ε的计算公式为:
Figure BDA0002818264990000011
其中,D0为横向误差,D0_last为上一帧的横向误差,D0-D0_last为横向误差率,ε为航向误差,εlast为上一帧的航向误差,ε-εlast为航向误差率;
通过LQR横向控制算法计算方向转角以对车辆进行横向控制。
进一步的,所述根据车道线计算车道中心线,包括:
根据摄像头输入的车道线信息,计算车辆与左边车道线的距离以及车辆与右边车道线的距离;
车辆与左边车道线的距离以及车辆与右边车道线的距离之和为车道宽度值。
进一步的,当道路只有一边车道线时,计算车辆与该车道线的距离;
若该距离在不合理范围内,则将该距离数据剔除并使用上一帧距离值计算车道中心线。
进一步的,在行驶过程中,存储左右车道线距离值的多帧数据以计算车道宽度;
根据车道宽度和视觉识别到的车道线坐标平移获得车道中心点;
对离散的车道中心点进行三次样条拟合;
对拟合的在车辆坐标系下的车道中心线计算横向误差、横向误差率、航向误差、航向误差率。
本发明第二方面提供一种基于LQR的车道居中驾驶控制装置,所述装置包括:
第一计算模块,用于根据车道线计算车道中心线以使车辆大致位于车道中心线上;
预瞄模块,用于根据车辆坐标系沿车头航向角方向预瞄一段距离X0计算横向偏移量D0、预瞄一段距离X1计算横向偏移量D1、预瞄一段距离X2计算横向偏移量D2,其中:X1≠X2
第二计算模块,用于根据X1、X2、D1、D2计算相对航向角ε,ε的计算公式为:
Figure BDA0002818264990000031
其中,D0为横向误差,D0_last为上一帧的横向误差,D0-D0_last为横向误差率,ε为航向误差,εlast为上一帧的航向误差,ε-εlast为航向误差率;
第三计算模块,用于通过LQR横向控制算法计算方向转角以对车辆进行横向控制。
进一步的,所述第一计算模块具体用于:
根据摄像头输入的车道线信息,计算车辆与左边车道线的距离以及车辆与右边车道线的距离;
车辆与左边车道线的距离以及车辆与右边车道线的距离之和为车道宽度值。
进一步的,当道路只有一边车道线时,计算车辆与该车道线的距离;
若该距离在不合理范围内,则将该距离数据剔除并使用上一帧距离值计算车道中心线。
进一步的,在行驶过程中,存储左右车道线距离值的多帧数据以计算车道宽度;
根据车道宽度和视觉识别到的车道线坐标平移获得车道中心点;
对离散的车道中心点进行三次样条拟合;
对拟合的在车辆坐标系下的车道中心线计算横向误差、横向误差率、航向误差、航向误差率。
本发明第三方面提供一种车辆,所述车辆包括:
处理器;以及
存储装置,该存储装置存储有计算机程序,所述计算机程序在由处理器执行时用于执行所述的基于LQR的车道居中驾驶控制方法的步骤。
本发明第四方面提供一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现所述的基于LQR的车道居中驾驶控制方法的步骤。
通过以上方案可知,本发明根据车道线计算车道中心线以使车辆大致位于车道中心线上,根据车辆坐标系沿车头航向角方向预瞄一段距离X0计算横向偏移量D0、预瞄一段距离X1计算横向偏移量D1、预瞄一段距离X2计算横向偏移量D2,根据X1、X2、D1、D2计算相对航向角ε,通过LQR横向控制算法计算方向转角以对车辆进行横向控制,因此,本发明基于视觉方法得到LQR计算所需的状态偏差,从而得到期望方向盘转角,在不同速度的情况下以及在弯道场景下横向偏离距离小,车道居中驾驶稳定性高。
附图说明
图1为车辆上的作用力示意图。
图2为单车模型示意图。
图3为车辆轮胎受到的横向压力示意图。
图4为本发明的具体实施方式的方法流程图。
图5为车辆居中驾驶示意图。
图6为本发明的车辆原理图。
图7为本发明的一实施方式的基于LQR的车道居中驾驶控制装置的结构示意图。
如下具体实施方式将结合上述附图进一步说明本发明。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所获得所有其他实施例,都属于本发明的保护范围。可以理解的是,附图仅仅提供参考与说明用,并非用来对本发明加以限制。
在本发明中,车辆线性二自由度动力学模型如下:
正常情况下,如图1所示,车辆上的作用力沿着三个不同的轴分布:
(1)纵轴上的力包括驱动力和制动力,以及滚动阻力和拖拽阻力作滚摆运动;
(2)横轴上的力包括转向力、离心力和侧风力,汽车绕横轴作俯仰运动;
(3)立轴上的力包括车辆上下振荡施加的力,汽车绕立轴作偏摆或转向运动。
在单车模型假设的前提下,仅考虑纯侧偏轮胎特性,忽略轮胎力的纵横向耦合关系,用单车模型来描述车辆的运动,不考虑载荷的左右转移,忽略横纵向空气动力学,即可构建车辆的动力学模型。
如图2所示,oxyz为固定于车身的车辆坐标系,OXY为固定于地面的惯性坐标系。单车模型的车辆具有2个自由度:绕z轴的横摆运动,和沿x轴的纵向运动。纵向指沿物体前进方向,横向(或侧向)指垂直纵向方向。
横向运动:出自横向的风力,以及曲线行驶时的离心力等。
纵向运动:受总驱动阻力、加速、减速等的影响。总驱动阻力由滚动阻力、拖拽阻力和坡度阻力等构成。
滑移角(slip-angle):轮胎方向和轮胎速度方向的夹角。滑移角的产生主要是由于车轮所受合力方向并非朝向车轮行进方向,但车轮的偏移角通常较小。
根据牛顿第二定律,分别沿x轴、y轴和z轴作受力分析:
在x轴方向上:
max=Fxf+Fxr (1)
在y轴方向上:
may=Fyf+Fyr (2)
在z轴方向上:
Figure BDA0002818264990000061
其中,m为整车质量,Iz为车辆绕z轴转动的转动惯量。x轴方向的运动(绕纵轴的滚动运动)可暂不用考虑。
y轴方向加速度ay由两部分构成:y轴方向的位移相关的加速度和向心加速度:
Figure BDA0002818264990000062
公式2可变为:
Figure BDA0002818264990000063
如图3所示,由于轮胎受到的横向压力,轮胎会有一个很小的滑移角,前轮滑移角为:
αf=δ-θVf (5)
其中,θVf为前轮速度方向,δ为前轮转角。
后轮滑移角,因为为前驱,后轮转角为零αr=-θVr(6),其中,θVr为后轮速度方向。
则前轮所受的横向力为Fyf=2Cαf(δ-θVf)(7),后轮所受的横向力为Fyr=2Cαr(-θVr)(8),其中,Cαf,Cαr分别为前后轮的侧偏刚度(cornering stiffness),由于车辆前后各两个轮,所以受力要乘以2。
结合图2,θVf和θVr可用下式计算
Figure BDA0002818264990000064
Figure BDA0002818264990000065
其中,lf为前悬长度,lr为后悬长度。
又因为
Figure BDA0002818264990000066
则公式9、公式10可近似转换为:
Figure BDA0002818264990000071
Figure BDA0002818264990000072
将公式5、公式6、公式11、公式12代入公式2、公式3中可得动力学模型:
Figure BDA0002818264990000073
横向控制主要通过控制轮胎转角实现,而对于驾驶员来说,可直接操控的是方向盘角度,因此在搭建车辆动力学模型时,可以以相对于道路的方向和距离误差为状态变量的动力学模型,亦即车辆路径跟踪偏差状态方程。
假设,e1为横向误差,车辆质心距车道中心线的距离,e2为航向误差,车辆纵向速度为Vx,车辆转弯半径为R,结合图1和图2,则:
车身转过期望角度所需转角速度:
Figure BDA0002818264990000074
所需横向加速度:
Figure BDA0002818264990000075
则横向加速度误差:
Figure BDA0002818264990000076
横行速度误差为:
Figure BDA0002818264990000077
航向误差:
Figure BDA0002818264990000078
将公式17、公式18带入公式3、公式4可得:
Figure BDA0002818264990000081
Figure BDA0002818264990000082
横向控制中,系统的状态变量有四个:横向误差e1、横向误差率
Figure BDA0002818264990000083
航向误差e2、航向误差率
Figure BDA0002818264990000084
综上,可得方向盘控制的动力学模型:
Figure BDA0002818264990000085
假设车辆系统的状态空间方程为:
Figure BDA0002818264990000086
由于
Figure BDA0002818264990000087
只对横摆角角度偏差变化率的导数产生影响,在横向控制中主要是控制横向偏差、横向偏差变化率、横摆角角度偏差、横摆角角度偏差变化率,因而忽略公式中(22)的
Figure BDA0002818264990000088
车辆系统的状态空间方程表示为:
Figure BDA0002818264990000089
上述连续的状态空间方程用于计算机控制需要对连续的状态空间方程进行离散化,其中At采用双线性变换得到:
Figure BDA0002818264990000091
同理则有:
Figure BDA0002818264990000092
其中T为控制周期。
通过上述介绍我们得到了车辆离散状态空间方程(21)中的At,Bt,B1t,则系统的最优前轮转角为多元线性表达式:
Figure BDA0002818264990000093
LQR算法的核心就是定义和求解如下目标函数:
Figure BDA0002818264990000094
其中Q为状态权重系数,R为控制量权重系数。
当上述目标函数(27)最小时就得到最优的状态反馈矩阵K:
Figure BDA0002818264990000095
同时矩阵P满足黎卡提方程:
Figure BDA0002818264990000096
将公式(26)的控制量带入公式(23)得到系统状态反馈后的状态空间方程如下:
Figure BDA0002818264990000097
车辆沿固定曲率的轨迹运行时
Figure BDA0002818264990000098
不为零,因此通过LQR调节(A-BK)的特征值使系统趋于稳定,但是系统的稳态偏差并不为0。
为此在原有最优控制量的基础上增加一个前馈环节,使系统趋于稳定的同时系统的横向稳态偏差为0。
u(t)=δ=-Kx(t)+δff (31)
公式中为前馈环节提供的前轮转角。将公式(31)带入公式(23)得到:
Figure BDA0002818264990000099
在此设初始条件为0,对公式(29)进行拉普拉斯变换得到:
Figure BDA0002818264990000101
假设汽车以固定纵向速度Vx沿某一固定曲率的弯道行驶,则通过纵向车速Vx和道路的半径R可以计算出期望汽车横摆角速度:
Figure BDA0002818264990000102
公式(34)可知横摆角速度的拉普拉斯变换结果为:
Figure BDA0002818264990000103
假设δff为固定值,则其拉普拉斯变换结果为
Figure BDA0002818264990000104
根据终值定理,系统的稳态误差为:
Figure BDA0002818264990000105
将A,B,B1,K带入公式(33)得到:
Figure BDA0002818264990000106
观察公式(38)中的第一项和第三项。可知道对横摆角角度偏差无影响,选择合适的可将横向偏差稳态值趋向于0。
Figure BDA0002818264990000107
要想横向偏差的稳态值趋于零,则:
Figure BDA0002818264990000108
因此由(38)可知:
Figure BDA0002818264990000111
Figure BDA0002818264990000112
不足转向梯度系数
Figure BDA0002818264990000113
前馈控制前轮转角公式(34)可以简化为:
Figure BDA0002818264990000114
最终的前轮转角的控制量为前馈控制前轮转角与最优状态反馈控制量之和,由公式(24)和(35)可知:δdes=δff+u(t)(45)。
本发明主要提供一种基于LQR的车道居中驾驶控制方法,如图4所示,所述方法包括以下步骤:
S110:根据车道线计算车道中心线以使车辆大致位于车道中心线上。
具体的,如图5所示,车道中心线位于左右车道的中间处,在本实施方式中,可以根据摄像头输入的车道线信息,计算车辆与左边车道线的距离以及车辆与右边车道线的距离,车辆与左边车道线的距离以及车辆与右边车道线的距离之和为车道宽度值。
需要说明的是,当道路只有一边车道线时,计算车辆与该车道线的距离;若该距离在不合理范围内,则将该距离数据剔除并使用上一帧距离值计算车道中心线。
S120:根据车辆坐标系沿车头航向角方向预瞄一段距离X0计算横向偏移量D0、预瞄一段距离X1计算横向偏移量D1、预瞄一段距离X2计算横向偏移量D2
D0为横向误差,D0_last为上一帧的横向误差,D0-D0_last为横向误差率。
S130:根据X1、X2、D1、D2计算相对航向角ε。
ε为航向误差,εlast为上一帧的航向误差,ε-εlast为航向误差率。ε的计算公式为:
Figure BDA0002818264990000121
S140:通过LQR横向控制算法计算方向转角以对车辆进行横向控制。
结合计算公式23-45。选择参数矩阵Q、R,求解黎卡提方程得到矩阵P,并可以得到最优的状态反馈矩阵K。根据车辆相关参数求解车辆动力学的A和B矩阵,再由A和B矩阵以及状态偏差(横向误差、横向误差率、航向误差以及航向误差率)通过LQR求解最优状态反馈方程。
在行驶过程中,存储左右车道线距离值的多帧数据以计算车道宽度,根据车道宽度和视觉识别到的车道线坐标平移获得车道中心点,对离散的车道中心点进行三次样条拟合,对拟合的在车辆坐标系下的车道中心线计算横向误差、横向误差率、航向误差、航向误差率。
在离散的车道中心点进行三次样条拟合得到车道中心线后,可以得到车道中心线的曲率,可以一并结合LQR求解得到的方向转角,综合得到期望方向盘转角值。
根据本发明提供的实施方式,在直车道上居中自动驾驶进行测试,测试如下:
Figure BDA0002818264990000122
Figure BDA0002818264990000131
在弯道车道上居中自动驾驶进行测试,测试如下:
Figure BDA0002818264990000132
本发明基于视觉方法得到LQR计算所需的状态偏差,从而得到期望方向盘转角,在不同速度的情况下以及在弯道场景下横向偏离距离小,车道居中驾驶稳定性高。
图6为本发明提供的车辆100的一种实施例的结构图,所述车辆100可包括处理器10、存储装置20,还包括存储在所述存储装置20中并可向所述处理器10上运行的计算机程序,例如控制程序等等。
所述处理器10可以是中央处理单元(CPU),还可以是其他通用处理器、数字信号处理器(DSP)、专用集成电路(ASIC)、现场可编程门阵列(FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等,所述处理器是所述车辆100的控制中心,利用各种接口和线路连接整个车辆100的各个部分。
所述存储装置20可用于存储所述计算机程序和/或模块,所述处理器10通过运行或执行存储在所述存储装置20内的计算机程序和/或模块,以及调用存储在存储装置20内的数据,实现所述车辆的各种功能。所述存储装置20可主要包括存储程序区和存储数据区,其中,存储程序区可存储操作车辆、至少一个功能所需的程序等;存储数据区可存储根据手机的使用所创建的数据等。此外,存储装置20可以包括高速随机存取存储装置,还可以包括非易失性存储装置,例如硬盘、内存、插接式硬盘,智能存储卡,安全数字卡,闪存卡、至少一个磁盘存储装置件、闪存器件、或其他非易失性固态存储装置件。
图7为发明提供的基于LQR的车道居中驾驶控制装置200的结构示意图,所述基于LQR的车道居中驾驶控制装置200可以包括第一计算模块21、预瞄模块22、第二计算模块23、第三计算模块24。
第一计算模块21,用于根据车道线计算车道中心线以使车辆大致位于车道中心线上;
预瞄模块22,用于根据车辆坐标系沿车头航向角方向预瞄一段距离X0计算横向偏移量D0、预瞄一段距离X1计算横向偏移量D1、预瞄一段距离X2计算横向偏移量D2,其中:X1≠X2
第二计算模块23,用于根据X1、X2、D1、D2计算相对航向角ε,ε的计算公式为:
Figure BDA0002818264990000141
其中,D0为横向误差,D0_last为上一帧的横向误差,D0-D0_last为横向误差率,ε为航向误差,εlast为上一帧的航向误差,ε-εlast为航向误差率;
第三计算模块24,用于通过LQR横向控制算法计算方向转角以对车辆进行横向控制。
进一步的,所述第一计算模块21具体用于:
根据摄像头输入的车道线信息,计算车辆与左边车道线的距离以及车辆与右边车道线的距离;
车辆与左边车道线的距离以及车辆与右边车道线的距离之和为车道宽度值。
进一步的,当道路只有一边车道线时,计算车辆与该车道线的距离;
若该距离在不合理范围内,则将该距离数据剔除并使用上一帧距离值计算车道中心线。
进一步的,在行驶过程中,存储左右车道线距离值的多帧数据以计算车道宽度;
根据车道宽度和视觉识别到的车道线坐标平移获得车道中心点;
对离散的车道中心点进行三次样条拟合;
对拟合的在车辆坐标系下的车道中心线计算横向误差、横向误差率、航向误差、航向误差率。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包括在本发明的保护范围之内。

Claims (10)

1.一种基于LQR的车道居中驾驶控制方法,其特征在于,所述方法包括:
根据车道线计算车道中心线以使车辆大致位于车道中心线上;
根据车辆坐标系沿车头航向角方向预瞄一段距离X0计算横向偏移量D0、预瞄一段距离X1计算横向偏移量D1、预瞄一段距离X2计算横向偏移量D2,其中:X1≠X2
根据X1、X2、D1、D2计算相对航向角ε,ε的计算公式为:
Figure FDA0002818264980000011
其中,D0为横向误差,D0_last为上一帧的横向误差,D0-D0_last为横向误差率,ε为航向误差,εlast为上一帧的航向误差,ε-εlast为航向误差率;
通过LQR横向控制算法计算方向转角以对车辆进行横向控制。
2.根据权利要求1所述的基于LQR的车道居中驾驶控制方法,其特征在于,所述根据车道线计算车道中心线,包括:
根据摄像头输入的车道线信息,计算车辆与左边车道线的距离以及车辆与右边车道线的距离;
车辆与左边车道线的距离以及车辆与右边车道线的距离之和为车道宽度值。
3.根据权利要求2所述的基于LQR的车道居中驾驶控制方法,其特征在于:
当道路只有一边车道线时,计算车辆与该车道线的距离;
若该距离在不合理范围内,则将该距离数据剔除并使用上一帧距离值计算车道中心线。
4.根据权利要求2所述的基于LQR的车道居中驾驶控制方法,其特征在于:
在行驶过程中,存储左右车道线距离值的多帧数据以计算车道宽度;
根据车道宽度和视觉识别到的车道线坐标平移获得车道中心点;
对离散的车道中心点进行三次样条拟合;
对拟合的在车辆坐标系下的车道中心线计算横向误差、横向误差率、航向误差、航向误差率。
5.一种基于LQR的车道居中驾驶控制装置,其特征在于,所述装置包括:
第一计算模块,用于根据车道线计算车道中心线以使车辆大致位于车道中心线上;
预瞄模块,用于根据车辆坐标系沿车头航向角方向预瞄一段距离X0计算横向偏移量D0、预瞄一段距离X1计算横向偏移量D1、预瞄一段距离X2计算横向偏移量D2,其中:X1≠X2
第二计算模块,用于根据X1、X2、D1、D2计算相对航向角ε,ε的计算公式为:
Figure FDA0002818264980000021
其中,D0为横向误差,D0_last为上一帧的横向误差,D0-D0_last为横向误差率,ε为航向误差,εlast为上一帧的航向误差,ε-εlast为航向误差率;
第三计算模块,用于通过LQR横向控制算法计算方向转角以对车辆进行横向控制。
6.根据权利要求5所述的基于LQR的车道居中驾驶控制装置,其特征在于,所述第一计算模块具体用于:
根据摄像头输入的车道线信息,计算车辆与左边车道线的距离以及车辆与右边车道线的距离;
车辆与左边车道线的距离以及车辆与右边车道线的距离之和为车道宽度值。
7.根据权利要求6所述的基于LQR的车道居中驾驶控制装置,其特征在于:
当道路只有一边车道线时,计算车辆与该车道线的距离;
若该距离在不合理范围内,则将该距离数据剔除并使用上一帧距离值计算车道中心线。
8.根据权利要求6所述的基于LQR的车道居中驾驶控制装置,其特征在于:
在行驶过程中,存储左右车道线距离值的多帧数据以计算车道宽度;
根据车道宽度和视觉识别到的车道线坐标平移获得车道中心点;
对离散的车道中心点进行三次样条拟合;
对拟合的在车辆坐标系下的车道中心线计算横向误差、横向误差率、航向误差、航向误差率。
9.一种车辆,其特征在于,所述车辆包括:
处理器;以及
存储装置,该存储装置存储有计算机程序,所述计算机程序在由处理器执行时用于执行如权利要求1-4任一项所述的基于LQR的车道居中驾驶控制方法的步骤。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1-4任一项所述的基于LQR的车道居中驾驶控制方法的步骤。
CN202011409839.2A 2020-12-04 2020-12-04 车辆驾驶控制方法、装置、车辆以及计算机可读存储介质 Active CN112590802B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011409839.2A CN112590802B (zh) 2020-12-04 2020-12-04 车辆驾驶控制方法、装置、车辆以及计算机可读存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011409839.2A CN112590802B (zh) 2020-12-04 2020-12-04 车辆驾驶控制方法、装置、车辆以及计算机可读存储介质

Publications (2)

Publication Number Publication Date
CN112590802A CN112590802A (zh) 2021-04-02
CN112590802B true CN112590802B (zh) 2022-12-20

Family

ID=75188369

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011409839.2A Active CN112590802B (zh) 2020-12-04 2020-12-04 车辆驾驶控制方法、装置、车辆以及计算机可读存储介质

Country Status (1)

Country Link
CN (1) CN112590802B (zh)

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113276833B (zh) * 2021-05-11 2022-07-29 上汽通用五菱汽车股份有限公司 车辆的横向运动控制方法、控制终端及存储介质
CN113183957A (zh) * 2021-05-24 2021-07-30 前海七剑科技(深圳)有限公司 车辆控制方法、装置、设备及自动驾驶车辆
CN113608530B (zh) * 2021-07-22 2023-04-25 武汉理工大学 一种带有pid转角补偿的参数自整定lqr路径跟踪方法
CN113525384B (zh) * 2021-09-13 2022-04-19 国汽智控(北京)科技有限公司 车辆的横向控制方法和控制器
CN113715816B (zh) * 2021-09-30 2023-06-30 岚图汽车科技有限公司 车道居中功能控制方法、装置、设备及可读存储介质
CN114347994B (zh) * 2022-03-17 2022-07-15 北京宏景智驾科技有限公司 车道线位置估计方法和装置、电子设备和存储介质
CN114940163B (zh) * 2022-04-25 2023-03-24 北京宾理信息科技有限公司 一种后轮转向车辆的横向运动控制方法、后轮转向车辆及电子系统
CN115230696B (zh) * 2022-07-01 2024-06-04 一汽解放汽车有限公司 车辆单车道行驶的居中控制方法
CN115366877B (zh) * 2022-09-26 2024-09-24 重庆长安汽车股份有限公司 车辆回正时间确定方法、控制方法、系统、设备及介质
CN118651220A (zh) * 2024-08-20 2024-09-17 深圳安智杰科技有限公司 一种车道居中行驶轨迹决策方法、设备及存储介质

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109421702A (zh) * 2017-08-25 2019-03-05 上海汽车集团股份有限公司 一种汽车控制方法及装置

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101409747B1 (ko) * 2012-12-28 2014-07-02 현대모비스 주식회사 횡방향 제어 장치 및 그 제어 방법
CN109383500B (zh) * 2017-08-14 2020-09-01 郑州宇通客车股份有限公司 基于预瞄点的车道保持方法及其辅助系统
CN108732921B (zh) * 2018-04-28 2021-05-25 江苏大学 一种自动驾驶汽车横向可拓预瞄切换控制方法
CN108622104A (zh) * 2018-05-07 2018-10-09 湖北汽车工业学院 一种用于无人驾驶车辆的轨迹跟踪控制方法
CN109214127B (zh) * 2018-10-24 2022-09-27 合肥工业大学智能制造技术研究院 一种多点预瞄方法及其多点预瞄装置与目标路径跟踪方法
CN109606363B (zh) * 2018-11-19 2020-11-20 江苏大学 一种多状态反馈的智能汽车可拓车道保持控制方法
US20200278686A1 (en) * 2019-02-28 2020-09-03 University Of South Carolina Iterative Feedback Motion Planning
CN111674404A (zh) * 2020-05-12 2020-09-18 坤泰车辆系统(常州)有限公司 自动驾驶系统车道居中辅助功能使用b样条曲线进行路径预测的方法

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109421702A (zh) * 2017-08-25 2019-03-05 上海汽车集团股份有限公司 一种汽车控制方法及装置

Also Published As

Publication number Publication date
CN112590802A (zh) 2021-04-02

Similar Documents

Publication Publication Date Title
CN112590802B (zh) 车辆驾驶控制方法、装置、车辆以及计算机可读存储介质
JP4568302B2 (ja) 加加速度情報を用いた車両の前後加速度制御装置
Rajamani et al. Lateral vehicle dynamics
CN104925054B (zh) 一种基于微分平坦的车辆稳定转向集成控制方法
CN108839652B (zh) 一种车辆失稳可控域的自动驾驶紧急避让系统
WO2022266824A1 (zh) 一种转向控制方法及装置
CN111923908A (zh) 一种融合稳定性的智能汽车路径跟踪控制方法
CN108749919B (zh) 一种线控四轮独立转向系统容错控制系统及其控制方法
CN104477237A (zh) 一种四轮独立转向电动车转向控制方法及系统
JP5919889B2 (ja) 車両姿勢制御装置
US20230131835A1 (en) Apparatus for controlling autonomous driving of independent driving electric vehicle and method thereof
Chen et al. Path tracking control of four-wheel independent steering electric vehicles based on optimal control
Yu et al. Simultaneous estimation of vehicle’s center of gravity and inertial parameters based on Ackermann’s steering geometry
JP2003231429A (ja) 車両の中心対称面の両側での荷重移動を考慮した横方向力の測定値による車両の軌道へのアクション
JP2010260544A (ja) 加加速度情報を用いた車両の運動制御方法
CN114044003B (zh) 前后双轴转向车辆的循迹控制方法
CN115480570A (zh) 农机车辆自动导航控制方法和装置、农机车辆
Wachter Lateral path tracking in limit handling condition using SDRE control
Lin et al. High speed optimal yaw stability of tractor-semitrailers with active trailer steering
Guo et al. Modular scheme for vehicle tire forces and velocities estimation based on sliding mode observer
Ozatay et al. Enhancement of vehicle handling using four wheel steering control strategy
Tamaddoni et al. Optimal vehicle stability controller based on Nash strategy for differential LQ games
JP5918303B2 (ja) 加加速度情報を用いて運動制御される車両
CN114312847B (zh) 一种自动驾驶车辆的横向控制方法及装置
CN113954876B (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