CN114475663A - 一种自动驾驶横向控制的处理方法 - Google Patents

一种自动驾驶横向控制的处理方法 Download PDF

Info

Publication number
CN114475663A
CN114475663A CN202210227539.5A CN202210227539A CN114475663A CN 114475663 A CN114475663 A CN 114475663A CN 202210227539 A CN202210227539 A CN 202210227539A CN 114475663 A CN114475663 A CN 114475663A
Authority
CN
China
Prior art keywords
road curvature
steering wheel
motion model
objective function
point data
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
Application number
CN202210227539.5A
Other languages
English (en)
Other versions
CN114475663B (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.)
Beijing Qingzhou Zhihang Intelligent Technology Co ltd
Original Assignee
Beijing Qingzhou Zhihang Intelligent 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 Beijing Qingzhou Zhihang Intelligent Technology Co ltd filed Critical Beijing Qingzhou Zhihang Intelligent Technology Co ltd
Priority to CN202210227539.5A priority Critical patent/CN114475663B/zh
Publication of CN114475663A publication Critical patent/CN114475663A/zh
Application granted granted Critical
Publication of CN114475663B publication Critical patent/CN114475663B/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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • 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, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/02Control of vehicle driving stability
    • 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
    • B60W50/00Details 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
    • B60W50/0098Details of control systems ensuring comfort, safety or stability not otherwise provided for
    • 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
    • B60W50/00Details 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/0001Details of the control system
    • B60W2050/0019Control system elements or transfer functions
    • B60W2050/0028Mathematical models, e.g. for simulation
    • B60W2050/0031Mathematical model of the vehicle

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明实施例涉及一种自动驾驶横向控制的处理方法,所述方法包括:对自行车运动模型进行改造,向其中加入道路曲率的时间导数从而得到新的第一运动模型;并基于第一运动模型创建第一目标函数;获取实时纵向车速记为第一车速v;并获取上游轨迹规划模块对未来n个位置点进行轨迹规划输出的第一轨迹点集合;基于第一运动模型和第一目标函数,根据第一车速v和第一轨迹点集合,对未来n个位置点的位置点数据进行预测生成第一位置点集合;根据第一位置点集合的第一位置点数据
Figure DDA0003536582900000011
的第一道路曲率ki=1,进行方向盘转角预测生成对应的第一方向盘转角;根据第一方向盘转角对自车的横向运动进行控制。通过本发明可提高车辆行驶稳定性。

Description

一种自动驾驶横向控制的处理方法
技术领域
本发明涉及数据处理技术领域,特别涉及一种自动驾驶横向控制的处理方法。
背景技术
车辆自动驾驶系统的轨迹规划模块用于对车辆从起始位置到结束位置进行理想化的轨迹规划,并将规划轨迹传输到运动控制模块起到指导作用;运动控制模块若直接基于规划轨迹进行运动控制(纵向控制或横向控制)是很容易出现控制偏差的,所以运动控制模块还会参考规划轨迹对运动位置进行二次预测。常规情况下运动控制模块在进行二次预测时会基于自行车运动模型,以与前轮转向角δ有关的道路曲率k为控制量对各个位置点进行预测。在实际应用中我们发现,这种处理方式下道路曲率k会是一连串不同的预测数据,这会导致在直行状态下车辆方向盘也会左右来回转动,这无疑会降低车辆的行驶稳定性。
发明内容
本发明的目的,就是针对现有技术的缺陷,提供一种自动驾驶横向控制的处理方法、电子设备及计算机可读存储介质,通过向其中加入道路曲率k的时间导数ψ来改造自行车运动模型,基于改造后的运动模型进行二次预测时以道路曲率时间导数ψ作为控制量,这样就可以在相邻位置点的道路曲率k间由时间导数ψ建立前后关联关系。如此一来,在直行状态下通过使得相邻位置点间的时间导数ψ为0就能保持前后点的道路曲率k不发生变化,从而就能解决传统运动模型导致的直行道路上方向盘左右来回转动的问题,提高了车辆的行驶稳定性。
为实现上述目的,本发明实施例第一方面提供了一种自动驾驶横向控制的处理方法,所述方法包括:
对自行车运动模型进行改造,向其中加入道路曲率的时间导数从而得到新的第一运动模型;并基于所述第一运动模型,创建对应的目标函数记为第一目标函数;
获取上游感知模块输出的实时纵向车速记为第一车速v;并获取上游轨迹规划模块对未来n个位置点进行轨迹规划输出的第一轨迹点集合,n>1;所述第一轨迹点集合包括n个第一轨迹点数据
Figure BDA0003536582880000021
基于所述第一运动模型和对应的所述第一目标函数,根据所述第一车速v和所述第一轨迹点集合,对未来n个位置点的位置点数据进行预测生成对应的第一位置点集合;所述第一位置点集合包括n个第一位置点数据
Figure BDA0003536582880000022
1<i≤n;
根据所述第一位置点集合的第一位置点数据
Figure BDA0003536582880000023
的第一道路曲率ki=1,进行方向盘转角预测生成对应的第一方向盘转角;
根据所述第一方向盘转角对自车的横向运动进行控制。
优选的,所述自行车运动模型为:
Figure BDA0003536582880000024
所述第一运动模型为:
Figure BDA0003536582880000025
其中,x为横向坐标、y为纵向坐标、θ为航向角、k为道路曲率、ψ为道路曲率k的时间导数、dk为相邻两个位置点的道路曲率差值、dt为相邻两个位置点的行驶时间差值;
所述第一目标函数为:
Figure BDA0003536582880000031
其中,每组(xi、yi、θi、ki、ψi-1)与所述第一位置点数据
Figure BDA0003536582880000032
对应,每组
Figure BDA0003536582880000033
与所述第一轨迹点数据
Figure BDA0003536582880000034
对应;所述第一位置点数据
Figure BDA0003536582880000035
包括第一横向坐标xi、第一纵向坐标yi、第一航向角θi和第一道路曲率ki;所述第一轨迹点数据
Figure BDA0003536582880000036
包括第一规划横向坐标
Figure BDA0003536582880000037
第一规划纵向坐标
Figure BDA0003536582880000038
第一规划航向角
Figure BDA0003536582880000039
和第一规划道路曲率
Figure BDA00035365828800000310
wx、wy、wθ、wk、wψ分别为对应的权重参数。
优选的,所述基于所述第一运动模型和对应的所述第一目标函数,根据所述第一车速v和所述第一轨迹点集合,对未来n个位置点的位置点数据进行预测生成对应的第一位置点集合,具体包括:
由所述第一运动模型,可得第一公式组:
Figure BDA00035365828800000311
并将所述第一公式组代入所述第一目标函数,得到转换后第二目标函数为:
Figure BDA00035365828800000312
将所述第一车速v,以及从所述第一轨迹点集合中提取出的第1-n个位置点的所述第一规划横向坐标
Figure BDA00035365828800000313
所述第一规划纵向坐标
Figure BDA00035365828800000314
所述第一规划航向角
Figure BDA00035365828800000315
和所述第一规划道路曲率
Figure BDA00035365828800000316
代入所述第二目标函数并对其进行二次规划求解得到一个由{ψ01…ψn-1}构成的道路曲率时间导数序列记为第一数据序列;
从所述第一数据序列中提取道路曲率时间导数ψ0,根据ki=1=k00*dt生成未来第1个位置点的第一道路曲率ki=1,并基于所述第一公式组根据所述第一道路曲率ki=1计算生成未来第1个位置点的第一横向坐标xi=1、第一纵向坐标yi=1和第一航向角θi=1,并由所述第一横向坐标xi=1、所述第一纵向坐标yi=1、所述第一航向角θi=1和所述第一道路曲率ki=1组成未来第1个位置点的第一位置点数据
Figure BDA0003536582880000041
以此类推,最终得到未来n个位置点的所述第一位置点数据
Figure BDA0003536582880000042
Figure BDA0003536582880000043
构成所述第一位置点集合;其中,k0为当前时刻位置点的道路曲率。
优选的,所述根据所述第一位置点集合的第一位置点数据
Figure BDA0003536582880000044
的第一道路曲率ki=1,进行方向盘转角预测生成对应的第一方向盘转角,具体包括:
提取所述第一位置点集合的所述第一位置点数据
Figure BDA0003536582880000045
的第一道路曲率ki=1,作为第一曲率k’;
根据所述第一曲率k’计算第一前轮转角δ=actan(k’*L),L为自车车辆轴距;
根据所述第一前轮转角δ计算第一方向盘转角=δ*A,A为方向盘与前轮转角的转向比。
优选的,所述根据所述第一方向盘转角对自车的横向运动进行控制,具体包括:
根据所述第一方向盘转角生成当前时刻的第一方向盘控制指令;并基于所述第一方向盘控制指令控制车辆方向盘从而对车辆横向运动进行控制。
本发明实施例第二方面提供了一种电子设备,包括:存储器、处理器和收发器;
所述处理器用于与所述存储器耦合,读取并执行所述存储器中的指令,以实现上述第一方面所述的方法步骤;
所述收发器与所述处理器耦合,由所述处理器控制所述收发器进行消息收发。
本发明实施例第三方面提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机指令,当所述计算机指令被计算机执行时,使得所述计算机执行上述第一方面所述的方法的指令。
本发明实施例提供了一种自动驾驶横向控制的处理方法、电子设备及计算机可读存储介质,通过向其中加入道路曲率k的时间导数ψ来改造自行车运动模型,基于改造后的运动模型进行二次预测时以道路曲率时间导数ψ作为控制量,这样就可以在相邻位置点的道路曲率k间由时间导数ψ建立前后关联关系。如此一来,在直行状态下通过使得相邻位置点间的时间导数ψ为0就能保持前后点的道路曲率k不发生变化,从而解决了传统运动模型导致的直行道路上方向盘左右来回转动的问题,提高了车辆的行驶稳定性。
附图说明
图1为本发明实施例一提供的一种自动驾驶横向控制的处理方法示意图;
图2为本发明实施例二提供的一种电子设备的结构示意图。
具体实施方式
为了使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明作进一步地详细描述,显然,所描述的实施例仅仅是本发明一部份实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
车辆的运动控制模块会在每个当前时刻基于本发明实施例一提供的一种自动驾驶横向控制的处理方法,以轨迹规划模块输出的未来n个位置点的规划轨迹也就是轨迹点集合为参考进行二次规划,输出未来n个位置点的优化轨迹也就是位置点集合,并从得到的位置点集合中提取出第1个位置点的道路曲率参数对当前时刻的方向盘进行控制从而达到对车辆进行横向控制的目的;如图1为本发明实施例一提供的一种自动驾驶横向控制的处理方法示意图所示,本方法主要包括如下步骤:
步骤1,对自行车运动模型进行改造,向其中加入道路曲率的时间导数从而得到新的第一运动模型;并基于第一运动模型,创建对应的目标函数记为第一目标函数;
其中,公知的自行车运动模型为:
Figure BDA0003536582880000061
x为横向坐标、y为纵向坐标、θ为航向角、k为道路曲率;
向自行车运动模型加入道路曲率得到的第一运动模型为:
Figure BDA0003536582880000062
ψ为道路曲率k的时间导数,dk为相邻两个位置点的道路曲率差值,dt为相邻两个位置点的行驶时间差值;
第一目标函数为:
Figure BDA0003536582880000063
每组(xi、yi、θi、ki、ψi-1)对应运动控制模块输出的位置点集合的一个位置点的预测数据也即是下文中的第一位置点数据
Figure BDA0003536582880000064
每组
Figure BDA0003536582880000065
Figure BDA0003536582880000066
对应轨迹规划模块输出的轨迹点集合的一个位置点的轨迹规划数据也即是下文中的第一轨迹点数据
Figure BDA0003536582880000067
wx、wy、wθ、wk、wψ分别为对应x、y、θ、k、ψ分量的权重参数也称为惩罚权重参数。
这里,本发明实施例通过加入道路曲率k的时间导数ψ来改造自行车运动模型得到第一运动模型,使得第一运动模型可以道路曲率时间导数ψ为控制量,这样就可以由时间导数ψ在相邻位置点的道路曲率k间建立前后关联关系;如此一来,在车辆直行状态下设置相邻位置点间的时间导数ψ为0,就能保持前后点的道路曲率k不发生变化,从而就能解决传统运动模型导致的直行道路上方向盘左右来回转动的问题。
本发明实施例要求运动控制模块的二次规划输出也就是位置点集合应与轨迹规划模块输出的轨迹点集合的逼近度最大,要求预测出的前后位置点的道路曲率k变化平滑没有畸变也就是要求前后位置点道路曲率的时间导数为最小;那么,基于最小二乘法原则,以及上述第一运动模型的5个分量(x、y、θ、k、ψ)就可构建出运动控制模块进行预测时使用的最小二乘法目标函数:
Figure BDA0003536582880000071
在上述最小二乘法目标函数中,以ψi-1替换
Figure BDA0003536582880000072
就可得到第一目标函数:
Figure BDA0003536582880000073
步骤2,获取上游感知模块输出的实时纵向车速记为第一车速v;并获取上游轨迹规划模块对未来n个位置点进行轨迹规划输出的第一轨迹点集合,n>1;
其中,第一轨迹点集合包括n个第一轨迹点数据
Figure BDA0003536582880000074
1<i≤n;第一轨迹点数据
Figure BDA0003536582880000075
包括第一规划横向坐标
Figure BDA0003536582880000076
第一规划纵向坐标
Figure BDA0003536582880000077
第一规划航向角
Figure BDA0003536582880000078
和第一规划道路曲率
Figure BDA0003536582880000079
这里,第一车速v可由上游感知模块获得,也可从车辆的其他速度传感器获得;第一轨迹点集合的第一轨迹点数据
Figure BDA00035365828800000710
即是轨迹规划模块输出的未来n个位置点的规划轨迹;第一规划横向坐标
Figure BDA00035365828800000711
即是轨迹规划模块输出的未来第i个位置点的横向规划坐标,第一规划纵向坐标
Figure BDA00035365828800000712
即是未来第i个位置点的纵向规划坐标,第一规划航向角
Figure BDA00035365828800000713
即是未来第i个位置点的规划航向角,第一规划道路曲率
Figure BDA00035365828800000714
即是未来第i个位置点的规划道路曲率。
步骤3,基于第一运动模型和对应的第一目标函数,根据第一车速v和第一轨迹点集合,对未来n个位置点的位置点数据进行预测生成对应的第一位置点集合;
其中,第一位置点集合包括n个第一位置点数据
Figure BDA0003536582880000081
第一位置点数据
Figure BDA0003536582880000082
包括第一横向坐标xi、第一纵向坐标yi、第一航向角θi和第一道路曲率ki
具体包括:步骤31,由第一运动模型,可得第一公式组:并将第一公式组代入第一目标函数,得到转换后第二目标函数;
其中,第一公式组为:
Figure BDA0003536582880000083
第二目标函数为:
Figure BDA0003536582880000084
这里,第一公式组实际是由前文提及的第一运动模型推导得到的:将第一运动模型的x=v*cosθ、y=v*sinθ和θ=v*k,带入脚标i得到第一公式组的xi=v*cosθi、yi=v*sinθi和θi=v*ki
将第一运动模型的ψ=dkdt带入脚标可改写为ψi-1*dt=(ki-ki-1),从而得到第一公式组的ki=ki-1i-1*dt;
在得到第一公式组之后,将第一目标函数中的
Figure BDA0003536582880000085
基于第一公式组中的对应关系,全部转为以ki-1、ψi-1为特征量的表达式就可得到第二目标函数;
步骤32,将第一车速v,以及从第一轨迹点集合中提取出的第1-n个位置点的第一规划横向坐标
Figure BDA0003536582880000086
第一规划纵向坐标
Figure BDA0003536582880000087
第一规划航向角
Figure BDA0003536582880000088
和第一规划道路曲率
Figure BDA0003536582880000091
代入第二目标函数并对其进行二次规划求解得到一个由{ψ01…ψn-1}构成的道路曲率时间导数序列记为第一数据序列;
这里,第一车速v、第一规划横向坐标
Figure BDA0003536582880000092
第一规划纵向坐标
Figure BDA0003536582880000093
第一规划航向角
Figure BDA0003536582880000094
和第一规划道路曲率
Figure BDA0003536582880000095
为已知量;
又k1=k00*dt、k2=k11*dt=k0+(ψ01)*dt,以此类推,
ki-1=k0+(ψ01+…+ψi-2)*dt,k0为当前时刻位置点的道路曲率也可视为一个已知量,dt在本发明实施例中也是一个已知量;
将ki-1=k0+(ψ01+…+ψi-2)*dt代入第二目标函数之后,第二目标函数就变成了一个以{ψ01…ψn-1}数据序列为控制量的目标函数;
此时,按函数最小值对这个目标函数进行二次规划求解的结果就是得到使这个目标函数达到最小值的道路曲率时间导数序列{ψ01…ψn-1}也就是第一数据序列;在进行具体求解时可使用多种二次规划求解器进行求解,诸如自行实现的求解器计算接口、又或者是第三方提供的求解器计算软件或接口;
步骤33,从第一数据序列中提取道路曲率时间导数ψ0,根据ki=1=k00生成未来第1个位置点的第一道路曲率ki=1,并基于第一公式组根据第一道路曲率ki=1计算生成未来第1个位置点的第一横向坐标xi=1、第一纵向坐标yi=1和第一航向角θi=1,并由第一横向坐标xi=1、第一纵向坐标yi=1、第一航向角θi=1和第一道路曲率ki=1组成未来第1个位置点的第一位置点数据
Figure BDA0003536582880000096
以此类推,最终得到未来n个位置点的第一位置点数据
Figure BDA0003536582880000097
构成第一位置点集合。
这里,通过步骤32得到第一数据序列{ψ01…ψn-1}之后,就可根据ψ0基于第一公式组的ki=1=ki-1=0i-1=0*dt得到第1个位置点的第一道路曲率ki=1,继而根据ki=1基于第一公式组的θi=1=v*ki=1得到第1个位置点的第一航向角θi=1,继而根据θi=1基于第一公式组的xi=1=v*cosθi=1、yi=1=v*sinθi=1得到第1个位置点的第一横向坐标xi=1和第一纵向坐标yi=1;以此类推,最终就能得到第1-n个位置点的所有第一位置点数据
Figure BDA0003536582880000098
的数据,再将所有第一位置点数据
Figure BDA0003536582880000099
按脚标i从小到大的顺序排列即可得到第一位置点集合。
步骤4,根据第一位置点集合的第一位置点数据
Figure BDA0003536582880000101
的第一道路曲率ki=1,进行方向盘转角预测生成对应的第一方向盘转角;
具体包括:步骤41,提取第一位置点集合的第一位置点数据
Figure BDA0003536582880000102
的第一道路曲率ki=1,作为第一曲率k’;
这里,第一位置点集合是运动控制模块在当前时刻预测出的未来n个位置点的轨迹信息,每个第一位置点数据
Figure BDA0003536582880000103
对应一个位置点;那么,对于当前时刻而言其下一时刻期望到达的轨迹点实际就应是第一位置点集合中的第1个位置点,也就是说,在当前时刻的横向控制需要以第一位置点集合中第一位置点数据
Figure BDA0003536582880000104
的第一道路曲率ki=1也就是第一曲率k’作为参考;
步骤42,根据第一曲率k’计算第一前轮转角δ=actan(k’*L),L为自车车辆轴距;
这里,由公知的自行车运动模型理论可知,车辆前轮转角δ与车辆道路曲率k和自车车辆轴距L之间的对应关系为tan(δ)=k*L;那么,在得到第一曲率k’后就可根据上述对应关系推导出对应的第一前轮转角δ;
步骤43,根据第一前轮转角δ计算第一方向盘转角=δ*A,A为方向盘与前轮转角的转向比。
这里,已知车辆方向盘转角/前轮转角δ的比值为一个常量也就是方向盘与前轮转角的转向比A;那么,在得到第一前轮转角δ之后就可以进一步算出对应的第一方向盘转角。
步骤5,根据第一方向盘转角对自车的横向运动进行控制;
具体包括:根据第一方向盘转角生成当前时刻的第一方向盘控制指令;并基于第一方向盘控制指令控制车辆方向盘从而对车辆横向运动进行控制。
图2为本发明实施例二提供的一种电子设备的结构示意图。该电子设备可以为前述的终端设备或者服务器,也可以为与前述终端设备或者服务器连接的实现本发明实施例方法的终端设备或服务器。如图2所示,该电子设备可以包括:处理器301(例如CPU)、存储器302、收发器303;收发器303耦合至处理器301,处理器301控制收发器303的收发动作。存储器302中可以存储各种指令,以用于完成各种处理功能以及实现前述方法实施例描述的处理步骤。优选的,本发明实施例涉及的电子设备还包括:电源304、系统总线305以及通信端口306。系统总线305用于实现元件之间的通信连接。上述通信端口306用于电子设备与其他外设之间进行连接通信。
在图2中提到的系统总线305可以是外设部件互连标准(Peripheral ComponentInterconnect,PCI)总线或扩展工业标准结构(Extended Industry StandardArchitecture,EISA)总线等。该系统总线可以分为地址总线、数据总线、控制总线等。为便于表示,图中仅用一条粗线表示,但并不表示仅有一根总线或一种类型的总线。通信接口用于实现数据库访问装置与其他设备(例如客户端、读写库和只读库)之间的通信。存储器可能包含随机存取存储器(Random Access Memory,RAM),也可能还包括非易失性存储器(Non-Volatile Memory),例如至少一个磁盘存储器。
上述的处理器可以是通用处理器,包括中央处理器(Central Processing Unit,CPU)、网络处理器(Network Processor,NP)、图形处理器(Graphics Processing Unit,GPU)等;还可以是数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现场可编程门阵列(FieldProgrammable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。
需要说明的是,本发明实施例还提供一种计算机可读存储介质,该计算机可读存储介质中存储有指令,当其在计算机上运行时,使得计算机执行上述实施例中提供的方法和处理过程。
本发明实施例还提供一种运行指令的芯片,该芯片用于执行前述方法实施例描述的处理步骤。
本发明实施例提供了一种自动驾驶横向控制的处理方法、电子设备及计算机可读存储介质,通过向其中加入道路曲率k的时间导数ψ来改造自行车运动模型,基于改造后的运动模型进行二次预测时以道路曲率时间导数ψ作为控制量,这样就可以在相邻位置点的道路曲率k间由时间导数ψ建立前后关联关系。如此一来,在直行状态下通过使得相邻位置点间的时间导数ψ为0就能保持前后点的道路曲率k不发生变化,从而解决了传统运动模型导致的直行道路上方向盘左右来回转动的问题,提高了车辆的行驶稳定性。
专业人员应该还可以进一步意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、计算机软件或者二者的结合来实现,为了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本发明的范围。
结合本文中所公开的实施例描述的方法或算法的步骤可以用硬件、处理器执行的软件模块,或者二者的结合来实施。软件模块可以置于随机存储器(RAM)、内存、只读存储器(ROM)、电可编程ROM、电可擦除可编程ROM、寄存器、硬盘、可移动磁盘、CD-ROM、或技术领域内所公知的任意其它形式的存储介质中。
以上所述的具体实施方式,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施方式而已,并不用于限定本发明的保护范围,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

Claims (7)

1.一种自动驾驶横向控制的处理方法,其特征在于,所述方法包括:
对自行车运动模型进行改造,向其中加入道路曲率的时间导数从而得到新的第一运动模型;并基于所述第一运动模型,创建对应的目标函数记为第一目标函数;
获取上游感知模块输出的实时纵向车速记为第一车速v;并获取上游轨迹规划模块对未来n个位置点进行轨迹规划输出的第一轨迹点集合,n>1;所述第一轨迹点集合包括n个第一轨迹点数据
Figure FDA0003536582870000011
基于所述第一运动模型和对应的所述第一目标函数,根据所述第一车速v和所述第一轨迹点集合,对未来n个位置点的位置点数据进行预测生成对应的第一位置点集合;所述第一位置点集合包括n个第一位置点数据
Figure FDA0003536582870000012
Figure FDA0003536582870000013
根据所述第一位置点集合的第一位置点数据
Figure FDA0003536582870000014
的第一道路曲率ki=1,进行方向盘转角预测生成对应的第一方向盘转角;
根据所述第一方向盘转角对自车的横向运动进行控制。
2.根据权利要求1所述的自动驾驶横向控制的处理方法,其特征在于,
所述自行车运动模型为:
Figure FDA0003536582870000015
所述第一运动模型为:
Figure FDA0003536582870000016
其中,x为横向坐标、y为纵向坐标、θ为航向角、k为道路曲率、ψ为道路曲率k的时间导数、dk为相邻两个位置点的道路曲率差值、dt为相邻两个位置点的行驶时间差值;
所述第一目标函数为:
Figure FDA0003536582870000021
其中,每组(xi、yi、θi、ki、ψi-1)与所述第一位置点数据
Figure FDA0003536582870000022
对应,每组
Figure FDA0003536582870000023
与所述第一轨迹点数据
Figure FDA0003536582870000024
对应;所述第一位置点数据
Figure FDA0003536582870000025
包括第一横向坐标xi、第一纵向坐标yi、第一航向角θi和第一道路曲率ki;所述第一轨迹点数据
Figure FDA0003536582870000026
包括第一规划横向坐标
Figure FDA0003536582870000027
第一规划纵向坐标
Figure FDA0003536582870000028
第一规划航向角
Figure FDA0003536582870000029
和第一规划道路曲率
Figure FDA00035365828700000210
wx、wy、wθ、wk、wψ分别为对应的权重参数。
3.根据权利要求2所述的自动驾驶横向控制的处理方法,其特征在于,所述基于所述第一运动模型和对应的所述第一目标函数,根据所述第一车速v和所述第一轨迹点集合,对未来n个位置点的位置点数据进行预测生成对应的第一位置点集合,具体包括:
由所述第一运动模型,可得第一公式组:
Figure FDA00035365828700000211
并将所述第一公式组代入所述第一目标函数,得到转换后第二目标函数为:
Figure FDA00035365828700000212
将所述第一车速v,以及从所述第一轨迹点集合中提取出的第1-n个位置点的所述第一规划横向坐标
Figure FDA00035365828700000213
所述第一规划纵向坐标
Figure FDA00035365828700000214
所述第一规划航向角
Figure FDA00035365828700000215
和所述第一规划道路曲率
Figure FDA00035365828700000216
代入所述第二目标函数并对其进行二次规划求解得到一个由{ψ01…ψn-1}构成的道路曲率时间导数序列记为第一数据序列;
从所述第一数据序列中提取道路曲率时间导数ψ0,根据ki=1=k00*dt生成未来第1个位置点的第一道路曲率ki=1,并基于所述第一公式组根据所述第一道路曲率ki=1计算生成未来第1个位置点的第一横向坐标xi=1、第一纵向坐标yi=1和第一航向角θi=1,并由所述第一横向坐标xi=1、所述第一纵向坐标yi=1、所述第一航向角θi=1和所述第一道路曲率ki=1组成未来第1个位置点的第一位置点数据
Figure FDA0003536582870000031
以此类推,最终得到未来n个位置点的所述第一位置点数据
Figure FDA0003536582870000032
Figure FDA0003536582870000033
构成所述第一位置点集合;其中,k0为当前时刻位置点的道路曲率。
4.根据权利要求1所述的自动驾驶横向控制的处理方法,其特征在于,所述根据所述第一位置点集合的第一位置点数据
Figure FDA0003536582870000034
的第一道路曲率ki=1,进行方向盘转角预测生成对应的第一方向盘转角,具体包括:
提取所述第一位置点集合的所述第一位置点数据
Figure FDA0003536582870000035
的第一道路曲率ki=1,作为第一曲率k’;
根据所述第一曲率k’计算第一前轮转角δ=actan(k’*L),L为自车车辆轴距;
根据所述第一前轮转角δ计算第一方向盘转角=δ*A,A为方向盘与前轮转角的转向比。
5.根据权利要求1所述的自动驾驶横向控制的处理方法,其特征在于,所述根据所述第一方向盘转角对自车的横向运动进行控制,具体包括:
根据所述第一方向盘转角生成当前时刻的第一方向盘控制指令;并基于所述第一方向盘控制指令控制车辆方向盘从而对车辆横向运动进行控制。
6.一种电子设备,其特征在于,包括:存储器、处理器和收发器;
所述处理器用于与所述存储器耦合,读取并执行所述存储器中的指令,以实现权利要求1-5任一项所述的方法步骤;
所述收发器与所述处理器耦合,由所述处理器控制所述收发器进行消息收发。
7.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机指令,当所述计算机指令被计算机执行时,使得所述计算机执行权利要求1-5任一项所述的方法的指令。
CN202210227539.5A 2022-03-08 2022-03-08 一种自动驾驶横向控制的处理方法 Active CN114475663B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210227539.5A CN114475663B (zh) 2022-03-08 2022-03-08 一种自动驾驶横向控制的处理方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210227539.5A CN114475663B (zh) 2022-03-08 2022-03-08 一种自动驾驶横向控制的处理方法

Publications (2)

Publication Number Publication Date
CN114475663A true CN114475663A (zh) 2022-05-13
CN114475663B CN114475663B (zh) 2024-04-09

Family

ID=81486054

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210227539.5A Active CN114475663B (zh) 2022-03-08 2022-03-08 一种自动驾驶横向控制的处理方法

Country Status (1)

Country Link
CN (1) CN114475663B (zh)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107618503A (zh) * 2017-08-29 2018-01-23 广州小鹏汽车科技有限公司 一种自动泊车控制方法及系统
JP2019059441A (ja) * 2017-09-28 2019-04-18 トヨタ自動車株式会社 車両運転支援装置
CN110597245A (zh) * 2019-08-12 2019-12-20 北京交通大学 基于二次型规划和神经网络的自动驾驶换道轨迹规划方法
US20200156631A1 (en) * 2018-11-15 2020-05-21 Automotive Research & Testing Center Method for planning a trajectory for a self-driving vehicle
CN111775949A (zh) * 2020-07-09 2020-10-16 中国人民解放军国防科技大学 一种人机共驾控制系统的个性化驾驶员转向行为辅助方法
CN112020686A (zh) * 2019-03-28 2020-12-01 百度时代网络技术(北京)有限公司 用于自动驾驶的基于qp样条路径和螺旋路径的参考线平滑方法
WO2021175313A1 (zh) * 2020-03-05 2021-09-10 中国第一汽车股份有限公司 自动驾驶控制方法、装置、车辆及存储介质
CN113581213A (zh) * 2021-08-31 2021-11-02 北京轻舟智航科技有限公司 一种预测车辆运动轨迹的处理方法
CN113771829A (zh) * 2020-12-15 2021-12-10 北京京东乾石科技有限公司 用于自动驾驶车辆的控制方法和装置

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107618503A (zh) * 2017-08-29 2018-01-23 广州小鹏汽车科技有限公司 一种自动泊车控制方法及系统
JP2019059441A (ja) * 2017-09-28 2019-04-18 トヨタ自動車株式会社 車両運転支援装置
US20200156631A1 (en) * 2018-11-15 2020-05-21 Automotive Research & Testing Center Method for planning a trajectory for a self-driving vehicle
CN112020686A (zh) * 2019-03-28 2020-12-01 百度时代网络技术(北京)有限公司 用于自动驾驶的基于qp样条路径和螺旋路径的参考线平滑方法
CN110597245A (zh) * 2019-08-12 2019-12-20 北京交通大学 基于二次型规划和神经网络的自动驾驶换道轨迹规划方法
WO2021175313A1 (zh) * 2020-03-05 2021-09-10 中国第一汽车股份有限公司 自动驾驶控制方法、装置、车辆及存储介质
CN111775949A (zh) * 2020-07-09 2020-10-16 中国人民解放军国防科技大学 一种人机共驾控制系统的个性化驾驶员转向行为辅助方法
CN113771829A (zh) * 2020-12-15 2021-12-10 北京京东乾石科技有限公司 用于自动驾驶车辆的控制方法和装置
CN113581213A (zh) * 2021-08-31 2021-11-02 北京轻舟智航科技有限公司 一种预测车辆运动轨迹的处理方法

Also Published As

Publication number Publication date
CN114475663B (zh) 2024-04-09

Similar Documents

Publication Publication Date Title
KR102292277B1 (ko) 자율 주행 차량에서 3d cnn 네트워크를 사용하여 솔루션을 추론하는 lidar 위치 추정
KR102350181B1 (ko) 자율 주행 차량에서 rnn 및 lstm을 사용하여 시간적 평활화를 수행하는 lidar 위치 추정
KR102335389B1 (ko) 자율 주행 차량의 lidar 위치 추정을 위한 심층 학습 기반 특징 추출
JP2020001678A (ja) 重み付け幾何学的コストを有する区分的螺旋曲線を使用した基準線平滑化方法
WO2023103692A1 (zh) 自动驾驶的决策规划方法、电子设备及计算机存储介质
CN114676939B (zh) 一种多车型参数自适应的参考线平滑方法和系统
CN115309170B (zh) 一种考虑舒适性约束的轨迹规划方法、装置和系统
CN108994838A (zh) 机器人位置与规划路径的关系计算方法及系统
CN111731326A (zh) 避障策略确定方法、装置及存储介质
CN113581213A (zh) 一种预测车辆运动轨迹的处理方法
CN111126598A (zh) 自动泊车方法、装置、计算机设备和存储介质
CN115112141A (zh) 一种车辆路径规划方法、系统、电子设备及存储介质
CN114475663A (zh) 一种自动驾驶横向控制的处理方法
Dai et al. Safety analysis of integrated adaptive cruise and lane keeping control using multi-modal port-Hamiltonian systems
CN115626158B (zh) 车辆转向防剐蹭方法及相关装置
CN115435795B (zh) 一种基于环视图像和语义地图的车辆定位方法
CN114966736A (zh) 一种基于点云数据进行目标速度预测的处理方法
CN115817457A (zh) 反向斜列车位的自动泊车路径规划方法及装置
CN115112114B (zh) 一种修正自车周围车辆朝向角的处理方法和装置
CN112764421B (zh) 无人深潜器自主导航轨迹预测积分控制方法及装置
CN117687042B (zh) 一种多雷达数据融合方法、系统和设备
Yu et al. DGPR‐MPC: Learning‐based model predictive controller for autonomous vehicle path following
CN113935638A (zh) 一种基于平面拓扑分析的轨迹决策评估方法
CN116185030A (zh) 车辆的控制方法、装置、车辆及存储介质
CN116860618A (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