CN113759903A - 无人驾驶车辆及其转向控制方法、电子设备及存储介质 - Google Patents
无人驾驶车辆及其转向控制方法、电子设备及存储介质 Download PDFInfo
- Publication number
- CN113759903A CN113759903A CN202110967071.9A CN202110967071A CN113759903A CN 113759903 A CN113759903 A CN 113759903A CN 202110967071 A CN202110967071 A CN 202110967071A CN 113759903 A CN113759903 A CN 113759903A
- Authority
- CN
- China
- Prior art keywords
- unmanned vehicle
- vehicle
- steering angle
- real
- curve
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 49
- 230000015654 memory Effects 0.000 claims description 18
- 238000004364 calculation method Methods 0.000 claims description 14
- 238000013459 approach Methods 0.000 claims description 3
- 238000013135 deep learning Methods 0.000 abstract description 5
- 230000006870 function Effects 0.000 description 9
- 238000012545 processing Methods 0.000 description 8
- 238000012937 correction Methods 0.000 description 7
- 238000004891 communication Methods 0.000 description 5
- 238000005070 sampling Methods 0.000 description 5
- 238000009434 installation Methods 0.000 description 4
- 230000003137 locomotive effect Effects 0.000 description 4
- 238000013178 mathematical model Methods 0.000 description 4
- 101150061388 LON1 gene Proteins 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000010191 image analysis Methods 0.000 description 2
- 101150004293 lon2 gene Proteins 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 101100182247 Caenorhabditis elegans lat-1 gene Proteins 0.000 description 1
- 101100182248 Caenorhabditis elegans lat-2 gene Proteins 0.000 description 1
- 241000084490 Esenbeckia delta Species 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000004888 barrier function Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000010295 mobile communication Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000011897 real-time detection Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000007723 transport mechanism 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
-
- 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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
-
- 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/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Traffic Control Systems (AREA)
Abstract
本申请公开了一种无人驾驶车辆及其转向控制方法、电子设备及存储介质,涉及无人驾驶技术领域,其中,本申请中的无人驾驶车辆的转向控制方法包括:获取高精地图;根据高精地图计算出弯道区域及弯道半径;获取无人驾驶车辆的实时位置和实时速度;若实时位置位于弯道区域中,则根据弯道半径、实时车速、雷达测距以及车辆与道路上相邻护栏之间的GPS位置信息计算车辆预设转向角度和修正转向角度并获得最终的车辆实际转向角度达到沿护栏贴行的目标。随后通过深度学习算法在相似行驶路径情况下寻找最优转向控制参数。本申请的无人驾驶车辆转向控制方法算法简练、运行效率高,可大幅提高车辆在高速行驶时的转向操控稳定性和安全性。
Description
技术领域
本申请涉及无人驾驶技术领域,特别涉及一种无人驾驶车辆及其转向控制方法、电子设备及存储介质。
背景技术
无人驾驶汽车是智能汽车的一种,也称为轮式移动机器人,主要依靠车内的以计算机系统为主的智能驾驶仪来实现无人驾驶的目的。目前,在普通道路上无人驾驶汽车的控制已经较为成熟,但是在高速公路上应用得还不多,主要因为高速公路汽车行驶速度较快,控制响应要求高,特别在需要转向时,低速算法的无人驾驶汽车需要大量的SLAM点云分析处理,运行繁琐且效率低下,转向策略和计算实时性无法满足高速行驶的要求。
发明内容
本申请旨在至少解决现有技术中存在的技术问题之一。为此,本申请提出一种无人驾驶车辆及其转向控制方法、电子设备及存储介质,通过数学模型计算出车辆的初始转向角度,通过传感器实时检测数据对转向角度做闭环修正,运用深度学习算法不断迭代优化转向角参赛,从而提高了无人驾驶车辆在高速行驶时的转向操控稳定性和安全性,同时还进一步提升了车辆线控转向的运算效率。
第一方面,本申请提供了一种无人驾驶车辆的转向控制方法,包括:
获取高精地图;
根据所述高精地图计算出弯道区域及弯道半径;
获取无人驾驶车辆的实时位置和实时速度;
若所述实时位置位于所述弯道区域中,则根据所述弯道半径和所述实时速度得到预设转向角度;
获取所述无人驾驶车辆与道路上相邻护栏之间的护栏距离信息;
根据所述护栏距离信息得到修正转向角度;
根据所述预设转向角度和所述修正转向角度计算得到实际转向角度;其中,所述预设转向角度、所述修正转向角度和所述实际转向角度皆为方向盘的转动角度。
根据本申请第一方面实施例的无人驾驶车辆的转向控制方法,至少具有如下有益效果:获取关于汽车规划行驶道路的高精地图,通过高精地图的图像分析处理,计算出规划行驶道路中所有的弯道,并计算出各弯道的半径,对半径超过阈值的弯道依次做编号,获得第x个弯道的弯道半径Rx以及该弯道的区域GPS位置[latx1,lonx1],[latx2,lonx2]。实时获取无人驾驶车辆的实时位置和实时速度,当无人驾驶车辆的实时位置落在弯道GPS位置区域内,即无人驾驶车辆位于弯道区域,根据该弯道区域的弯道半径与无人驾驶车辆的实时速度,计算出无人驾驶车辆的预设转向角度,并且获取无人驾驶车辆与道路上相邻护栏的护栏距离信息,并且根据护栏距离信息得到修正转向角度,根据预设转向角度和修正转向角度得到实际转向角度。在本发明的方案中,通过数学模型计算出预设转向角度,通过单点激光雷达检测出车辆与护栏的距离信息,在预设转向角度的基础上对转向的角度进行修正,提升了转向角度的计算效率,保证了系统控制的实时性,提高了无人驾驶车辆转向的安全性,以使得无人驾驶车辆在高速道路上转向操控更加稳定。
根据本申请第一方面的一些实施例,若所述实时位置位于所述弯道区域中,则根据所述弯道半径和所述实时速度得到预设转向角度,包括:若所述实时位置位于所述弯道区域中且所述弯道半径小于或等于第一半径阈值,则根据所述弯道半径和所述实时速度得到预设转向角度;若所述实时位置位于所述弯道区域中且所述弯道半径大于第一半径阈值,则所述预设转向角度设为0°。
根据本申请第一方面的一些实施例,所述第一半径阈值为1500米。
根据本申请第一方面的一些实施例,所述无人驾驶车辆包括第一单点激光雷达和第二单点激光雷达,所述第一单点激光雷达设置于所述无人驾驶车辆的车头侧旁处,所述第二单点激光雷达设置于所述无人驾驶车辆的车尾侧旁处,所述获取所述无人驾驶车辆与道路上相邻护栏之间的护栏距离信息,包括:根据所述高精地图和所述实时位置获取车身距离信息;若所述车身距离信息小于第一距离阈值,则启动所述第一单点激光雷达和所述第二单点激光雷达进行测距;获取来自所述第一单点激光雷达测量的车头距离信息;其中,所述车头距离信息为所述无人驾驶车辆车头侧旁与道路上相邻护栏的距离;获取来自所述第二单点激光雷达测量的车尾距离信息;其中,所述车尾距离信息为所述无人驾驶车辆车尾侧旁与道路上相邻护栏的距离。
根据本申请第一方面的一些实施例,所述根据所述护栏距离信息得到修正转向角度,包括:根据所述车头距离信息和所述车尾距离信息得到修正转向角度。
根据本申请第一方面的一些实施例,所述修正转向角度的计算频率大于20Hz。
根据本申请第一方面的一些实施例,若所述实时速度在第一时间内持续超过第一速度阈值,则控制所述无人驾驶车辆向左偏移贴近道路左侧护栏。
第二方面,本申请还提供了一种电子设备,包括:至少一个存储器;至少一个处理器;至少一个程序;所述程序被存储在所述存储器中,所述处理器执行至少一个所述程序以实现如第一方面任一项实施例所述的无人驾驶车辆的转向控制方法。
第三方面,本申请还提供了一种无人驾驶车辆,包括如第二方面实施例所述的电子设备。
第四方面,本申请还提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机可执行信号,所述计算机可执行信号用于执行如第一方面任一项实施例所述的无人驾驶车辆的转向控制方法。
本申请的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本申请的实践了解到。
附图说明
本申请的附加方面和优点结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1为本申请一个实施例提供的无人驾驶车辆的转向控制方法的流程图;
图2为本申请另一实施例提供的无人驾驶车辆的转向控制方法的流程图;
图3为本申请一个实施例提供的无人驾驶车辆的转向控制方法的流程图;
图4为本申请一个实施例提供的电子设备的示意图;
图5为本申请一个实施例提供的第一单点激光雷达和第二单点激光雷达的示意图。
具体实施方式
下面详细描述本申请的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,仅用于解释本申请,而不能理解为对本申请的限制。
在本申请的描述中,需要理解的是,涉及到方位描述,例如上、下、前、后、左、右等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本申请和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本申请的限制。
在本申请的描述中,如果有描述到第一、第二只是用于区分技术特征为目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量或者隐含指明所指示的技术特征的先后关系。
本申请的描述中,除非另有明确的限定,设置、安装、连接等词语应做广义理解,所属技术领域技术人员可以结合技术方案的具体内容合理确定上述词语在本申请中的具体含义。
参照图1,图1为本申请一个实施例提供的无人驾驶车辆的转向控制方法的流程图。本申请实施例提供了一种无人驾驶车辆的转向控制方法,该无人驾驶车辆的转向控制方法包括但不限于有步骤S110、步骤S120、步骤S130、步骤S140、步骤S150、步骤S160和步骤S170:
步骤S110:获取高精地图。
可以理解的是,无人驾驶车辆上设有互联网通信模块,可以通过互联网通信模块下载高精地图,具体地,使用5G通信模块进行获取高精地图,通过5G网络提高地图获取的速度;或高精地图可以设置在独立的电子控制单元(Electronic Control Unit,ECU)内,也可以设置在车辆的ECU内,在本申请对此不作限定,高精地图应至少包括无人驾驶车辆预设的路径道路信息,其中路径道路信息包括但不限于道路上各处的经纬度信息。
步骤S120:根据高精地图计算出弯道区域及弯道半径。
可以理解的是,通过对获取的高精地图进行图像分析处理,计算出高精地图上弯道区域和每个弯道区域对应的弯道半径,除此之外,为了减少对无人驾驶处理系统的负担,可以提前计算好无人驾驶车辆预设的路径的弯道区域和对应的弯道半径,还可以直接获取提前生成的对各条道路标注有弯道区域和弯道半径的高精地图,在每次驾驶前对高精地图进行更新以获得最新的道路弯道区域和弯道半径的信息,并对每个超过阈值的弯道进行编号标注,待无人驾驶车辆到达某个弯道区域时,自动识别该弯道的编号,以可以直接获取弯道半径。具体地,其弯道区域使用经度和纬度的方式标记的坐标集合,在本申请对此不作限定。
步骤S130:获取无人驾驶车辆的实时位置和实时速度;
可以理解的是,无人驾驶车辆上设有GPS差分定位模块和速度检测模块,通过GPS差分定位模块检测无人驾驶车辆的实时位置,具体地,实时位置包括车辆的实时经度信息和实时纬度信息,通过无人驾驶车辆内的速度检测模块获取无人驾驶车辆的实时速度。
步骤S140:若实时位置位于弯道区域中,则根据弯道半径和实时速度计算得到预设转向角度。
可以理解的是,通过无人驾驶车辆的GPS差分定位模块检测到无人驾驶车辆的实时位置,该实时位置包括实时经度信息和实时纬度信息,当实时经度信息和实时纬度信息的值位于弯道区域的经纬度坐标集合中,则表明无人驾驶车辆位于道路的弯道处。
可以理解的是,若无人驾驶车辆的经纬度位于弯道区域的经纬度集合中,则通过弯道半径和无人驾驶车辆的实时速度计算得到预设转向角度,具体预设转向角度通过数学模型获得的计算方法为:
其中,α(t)表示实时预设转向角度,i为转向器传动比,即方向盘转动的角度与车轮转动的角度的比值,设定为12,v(t)为无人驾驶车辆的实时速度,Rx为第x个弯道区域的半径(车辆直行前进方向需顺时针打方向为正、逆时针打方向为负),t为行驶时间,需要说明的是,在本实施例中,无人驾驶车辆对弯道半径的更新频率为3Hz,即t=0.333s,在本申请不作限定,所属技术领域的技术人员根据实际应用的GPS数据更新时间进行设定。
具体地,例如,当无人驾驶车辆位于弯道半径Rx为700m的弯道区域内,检测到无人驾驶车辆的行驶速度为100km/h,根据计算预设转向角为9.093°。
步骤S150:获取无人驾驶车辆与道路上相邻护栏之间的护栏距离信息。
可以理解的是,可以通过GPS差分定位模块或测距传感器等获取无人驾驶车辆与道路相邻护栏之间的护栏距离信息,以保证车辆驾驶的安全,以免撞到道路的护栏上。
步骤S160:根据护栏距离信息得到修正转向角度。
可以理解的是,通过步骤S150获取到护栏距离信息,并且根据护栏距离信息计算出无人驾驶车辆的修正转向角度或判断是否需要进行角度修正,以提高无人驾驶车辆转向的准确性。
步骤S170:根据预设转向角度和修正转向角度得到实际转向角度;其中,预设转向角度、修正转向角度和实际转向角度皆为方向盘的转动角度。
可以理解的是,实际转向角度为预设转向角度加上修正转向角度,即实际转向角度为:
γ(t)=α(t)+β(t)
其中,上述的α(t)为预设转向角度,β(t)为修正转向角度,γ(t)为实际转向角度,通过弯道半径与无人驾驶车辆的实时速度得到的预设转向角度,为了使得无人驾驶车辆更好地在弯道上贴边行驶,通过护栏距离信息计算出无人驾驶车辆需要调整的修正转向角度,以使无人驾驶车辆在转向中更加安全,提高了用户体验。
参照图2,图2为本申请另一实施例提供的无人驾驶车辆的转向控制方法的流程图,其中,步骤S140包括但不限于步骤S210和步骤S220:
步骤S210:若实时位置与弯道区域重合且弯道半径小于或等于第一半径阈值,则根据弯道半径和实时速度得到预设转向角度。
步骤S220:若实时位置与弯道区域重合且弯道半径大于第一半径阈值(若实时位置不在已规划行驶道路中编了号的弯道区域),则预设转向角度设为0°。
可以理解的是,当无人驾驶车辆的实时位置的对应经纬度坐标值位于弯道区域的经纬度坐标集合中,判断弯道半径与第一半径阈值的大小关系。当弯道半径大于第一半径阈值时,表示该弯道转角程度较小,即可以粗略认为该弯道为一条直线道路,其预设转向角度较小可忽略不计,即当弯道半径大于第一半径阈值时,预设转向角度设为0°,其实际转向角度只需要根据护栏距离信息得到的修正转向角度进行控制转向;当弯道半径小于第一半径阈值时,根据弯道半径和无人驾驶车辆的实时速度得到预设转向角度,并根据修正转向角度得到实际转向角度。
可以理解的是,第一半径阈值为1500米,即当弯道半径大于1500米时,表示该弯道转角程度较小,计算出的预设转向角度也相对较小,此情况可以通过不用补偿预设转向角度,直接计算修正角度来实现转向闭环反馈控制。即当弯道半径大于1500米时,预设转向角度不做计算,设为固定值0°,实际转向角度只需要根据护栏距离信息得到的修正转向角度进行控制即可,如此既能简化运算,又可提高算法效率。当弯道半径小于1500米时,根据弯道半径和无人驾驶车辆的实时速度的算法获得预设转向角度,根据护栏距离信息的算法获得修正转向角度,之后进一步计算而获得实际转向角度。
可以理解的是,无人驾驶车辆包括GPS差分定位模块、第一单点激光雷达和第二单点激光雷达,第一单点激光雷达设置于无人驾驶车辆的车头侧旁处,第二单点激光雷达设置于无人驾驶车辆的车尾侧旁处,具体地,第一单点激光雷达设置于无人驾驶车辆左侧靠近车头的位置处,第二单点激光雷达设置于无人驾驶车辆左侧靠近车尾的位置处。
参照图3,图3为本申请一个实施例提供的无人驾驶车辆的转向控制方法的流程图,其中,步骤S150包括但不限于步骤S310至步骤S340:
步骤S310:根据高精地图和实时位置获取车身距离信息。
可以理解的是,高精地图上还包括道路上护栏的具体位置,通过GPS差分定位模块能够精准地检测无人驾驶车辆的实时位置,根据道路上护栏的具体位置与无人驾驶车辆的实时位置使用下述算法获得汽车侧面到护栏的距离信息。
需要说明的是,差分GPS定位模块获取无人驾驶车辆的经度信息和纬度信息,通过与高精度地图中的护栏经纬度数据用Haversine公式计算得到第一距离信息值d0(如图5所示)。假设汽车的GPS位置(lat1,lon1),护栏的GPS位置(lat2,lon2),它们之间的距离函数为:
其中,
其中,R0地球半径,可取平均值6371km;d0为车身距离信息(汽车侧面到护栏的距离信息,用差分GPS定位模块的位置和车宽信息计算可得);φ1=lon1,φ2=lon2表示汽车和护栏两点的纬度;Δλ=|lat2-lat1|表示汽车和护栏两点经度差值的绝对值。
步骤S320:若车身距离信息小于第一距离阈值,则启动第一单点激光雷达和第二单点激光雷达进行测距。
可以理解的是,当车身距离信息小于第一距离阈值时,第一距离阈值表示无人驾驶车辆与相邻护栏的最小安全距离值,当无人驾驶车辆的车身距离信息小于第一距离阈值时,无人驾驶车辆可能存在与相邻护栏相撞的风险,则启动在近距离测距更为精确的第一单点激光雷达和第二单点激光雷达进行测距,以保证无人驾驶车辆的安全行使。具体地,第一距离阈值为2米,即当无人驾驶车辆的车身距离信息小于2米时,则启动在近距离测距更为精确的第一单点激光雷达和第二单点激光雷达进行测距,在本申请对此不作限定。
步骤S330:获取来自第一单点激光雷达测量的车头距离信息;其中,车头距离信息为无人驾驶车辆车头侧旁与道路上相邻护栏的距离。
步骤S340:获取来自第二单点激光雷达测量的车尾距离信息;其中,车尾距离信息为无人驾驶车辆车尾侧旁与道路上相邻护栏的距离。
可以理解的是,通过第一单点激光雷达和第二单点激光雷达分别对无人驾驶车辆的车头和车尾侧旁与道路相邻护栏之间的车头距离信息和车尾距离信息进行距离测量,除了更加全面把控好无人驾驶车辆与相邻护栏之间距离,提高无人驾驶车辆行驶的安全性,更重要的是判断车辆行驶延伸线与道路护栏延伸线的夹角从而使用转向控制算法实时修正反馈调整转向角参数。
可以理解的是,在本申请一实施例中,步骤S160包括但不限于以下步骤:
根据车头距离信息和车尾距离信息得到修正转向角度。
可以理解的是,通过第一单点激光雷达和第二单点激光雷达分别对无人驾驶车辆的车头和车尾侧旁与道路相邻护栏之间的车头距离信息和车尾距离信息,并根据车头距离信息和车尾距离信息计算出修正角转向角度,修正转向角度的计算方法为:
其中,β(t)为修正转向角度,i为转向器传动比,即方向盘转动的角度与车轮转动的角度的比值,设定为12;t为行驶时间,即单点激光雷达采样时间,此处单点激光雷达采样频率为100Hz,即t=0.01s;v(t)为无人驾驶车辆的实时速度,d2(t)为无人驾驶车辆的车头实时距离信息,d1(t)为无人驾驶车辆的车尾实时距离信息,其中,d1和d2参照图5所示。其中η=d[d2(t)-d1(t)]dt为横向偏移率,例如η=d[d2(t)-d1(t)]dt=0.25m/s,无人驾驶车辆的实时速度为100km/h,由上述修正转向角度的计算方法可得修正转向角度β为6.19°。
可以理解的是,修正转向角度的计算频率要求大于20Hz(即选取单点激光雷达采样频率>20Hz),以保证无人驾驶车辆能够及时调整修正转向角度,使得无人驾驶车辆能够安全平稳地行驶,对于修正转向角度的计算频率和精度在本申请对此不作限定。
可以理解的是,当无人驾驶车辆位于第x个弯道上,弯道半径Rx为700m的弯道区域内,检测到无人驾驶车辆的行驶速度为100km/h,横向偏移率η=d[d2(t)-d1(t)]dt=0.25m/s,则通过上述预设转向角度的计算方法可得出预设转向角度αx(t)为9.093°,通过上述修正转向角度的计算方法可得出修正转向角度βx(t)为6.19°,从而可得出实际转向角度γx(t)为15.28°,此处的横向偏移率η的大小将做为计算修正转向角度的限值,如果η≥0.5m/s,车辆会出现明显的道路跑偏,此情况下不计算修正角βx(t),同时将启用其他传感器进行新的转向策略计算,在本申请对此不作阐述和限定。
参照图5,可以理解的是,第一单点激光雷达和第二激光单点安装定位角ρ设定为可调,弯道的转弯半径越小,ρ越调整的小,接近0°,此时限制车辆加速,预警系统启动,同时启用多个传感器融合式的行驶方案。如果弯道的转弯半径越大,超过1500m,ρ的调整角度越大,最大接近45°,其预见性增强,设定的ρ角为3°≤ρ≤45°,对此在本申请不作限定。
具体地,根据弯道半径设定的激光雷达的安装定位角ρx角计算方法为,
其中,Rx为道路第X个弯道的半径,b为左前和左后激光雷达的安装距离,ρ为激光雷达的安装定位角,m为实验参数,m取值1.1。
可以理解的是,在本申请一实施例中,本申请提供的无人驾驶车辆的转向控制方法还包括但不限于以下步骤:
若实时速度在第一时间内持续超过第一速度阈值,则控制无人驾驶车辆向左偏移贴近道路左侧护栏。
可以理解的是,本申请提供的无人驾驶车辆的转向控制方法适用于在高速公路上行驶,当无人驾驶车辆在第一时间内持续超过第一速度阈值,则代表无人驾驶车辆已经在高速公路上行驶,为了更好控制无人驾驶车辆在弯道处的转向,无人驾驶车辆在系统的控制下向左偏移至贴近道路左侧护栏行驶,并根据车头距离信息和车尾距离信息保持无人驾驶车辆与左侧护栏不发生碰撞,即无人驾驶车辆自动驾驶到道路最左侧的车道上行驶,以便无人驾驶车辆能够沿边行驶,提高自动转向的准确性。
可以理解的是,在本申请提供的无人驾驶车辆的转向控制方法还能够通过以下深度学习算法在行驶路径中迭代寻优,在遇到相似的情况下能够优化转向参数并做出快速操控反应。
具体地深度学习算法1,对于无人驾驶汽车行驶同一条路径,该路径上具有x个超过阈值的弯道,通过计算无人驾驶车辆在这条路径上连续n个(3≤n≤10)实际转向角度函数γx(t)的积分总和最小进行迭代,获得该路径较优的转向方案,以便下次直接应用该转向方案,减少转向角度计算的时间,提高了转向效率。例如,通过对比第一次行驶该路径与第二次行驶该路径连续10个弯道的实际转向角度函数积分总和,若第一次的实际转向角度函数积分总和小于第二次的实际转向角度函数积分总和,则下一次行驶该路径时,采用第一次的转向方案。具体地,转向稳定系数的计算方法为:
其中,δ为转向稳定系数,γx(t)为上述无人驾驶车辆实际转向角计算函数,t为行驶时间,即单点激光雷达的采样时间,例如单点激光雷达的采样频率为100Hz,则t=0.01s。计算连续n个弯道上实际转向角度积分之和的小者为优,转向操控平顺,即作为下一次同样参数时的实际转向角的修正值。即δ<δt-1,γx(t)t+1=γx(t)。
具体地,深度学习算法2,统计γx(t)在相邻两段弯道件转向正负符合的变化的次数(即统计方向盘经过0°的次数),少为优,说明转向越稳定,不会来回不停的打转向,计算的具体程序代码如下:
#include<iostream>
using namespace std;
int main()
{
int i=0,n=0,count=0;
cout<<"输入数组γx(t)"<<endl;//获取实际转向角γx(t),零不属于正数也不属于负数
cin>>n;//n=10,统计连续10个弯道上的转向角正负变化次数
int*Array=new int[n];
for(i=0;i<n;i++)
{
cin>>Array[i];
}
for(i=0;i<n-1;i++)
{
if(Array[i]*Array[i+1]<0)
{
count++;
}
}
cout<<count<<endl;
return 0;
}
第二方面,参照图4,本申请的还提供了一种电子设备,包括至少一个存储器;至少一个处理器;至少一个程序;所述程序被存储在所述存储器中,所述处理器执行至少一个所述程序以实现如第一方面任一项实施例的无人驾驶车辆的转向控制方法。该电子设备通过简练的方式计算出预设转向角度,并且检测出车辆与护栏的具体在预设转向角度的基础上对转向的角度进行修正,提高了无人驾驶车辆转向的安全性,以使得无人驾驶车辆在道路上行驶更加安全。图4以一个存储器和一个处理器为例。
存储器作为一种非暂态计算机可读存储介质,可用于存储非暂态软件程序、非暂态性计算机可执行程序以及信号,如本申请实施例中的处理模块对应的程序指令/信号。处理器通过运行存储在存储器中的非暂态软件程序、指令以及信号,从而执行各种功能应用以及数据处理,即实现上述方法实施例的无人驾驶车辆的转向控制方法。
存储器可以包括存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需要的应用程序;存储数据区可存储上述无人驾驶车辆的转向控制方法的相关数据等。此外,存储器可以包括高速随机存取存储器,还可以包括非暂态存储器,例如至少一个磁盘存储器件、闪存器件、或其他非暂态固态存储器件。在一些实施例中,存储器可选包括相对于处理器远程设置的存储器,这些远程存储器可以通过网络连接至该处理模块。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
一个或者多个信号存储在存储器中,当被一个或者多个处理器执行时,执行上述任意方法实施例中的无人驾驶车辆的转向控制方法。例如,执行以上描述的图1中的方法步骤S110至S170、图2中的方法步骤S210至S220和图3中的方法步骤S310至S340。
第三方面,本申请还提供了一种无人驾驶车辆,包括如第二方面的电子设备,能够通过数学模型计算出车辆的转向角度,并对转向角度进行适当的修正,提升了运算效率,提高了无人驾驶转向的安全性。
第四方面,本申请实施例提供了一种计算机可读存储介质,计算机可读存储介质存储有计算机可执行指令,该计算机可执行指令被一个或多个处理器执行,可使得上述一个或多个处理器执行上述方法实施例中的无人驾驶车辆的转向控制方法。例如,执行以上描述的图1中的方法步骤S110至S170、图2中的方法步骤S210至S220和图3中的方法步骤S310至S340。
以上所描述的装置实施例仅仅是示意性的,其中作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
通过以上的实施方式的描述,本领域普通技术人员可以理解,上文中所公开方法中的全部或某些步骤、系统可以被实施为软件、固件、硬件及其适当的组合。某些物理组件或所有物理组件可以被实施为由处理器,如中央处理器、数字信号处理器或微处理器执行的软件,或者被实施为硬件,或者被实施为集成电路,如专用集成电路。这样的软件可以分布在计算机可读介质上,计算机可读介质可以包括计算机存储介质(或非暂时性介质)和通信介质(或暂时性介质)。如本领域普通技术人员公知的,术语计算机存储介质包括在用于存储信息(诸如计算机可读信号、数据结构、程序模块或其他数据)的任何方法或技术中实施的易失性和非易失性、可移除和不可移除介质。计算机存储介质包括但不限于RAM、ROM、EEPROM、闪存或其他存储器技术、CD-ROM、数字多功能盘(DVD)或其他光盘存储、磁盒、磁带、磁盘存储或其他磁存储装置、或者可以用于存储期望的信息并且可以被计算机访问的任何其他的介质。此外,本领域普通技术人员公知的是,通信介质通常包含计算机可读信号、数据结构、程序模块或者诸如载波或其他传输机制之类的调制数据信号中的其他数据,并且可包括任何信息递送介质。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示意性实施例”、“示例”、“具体地”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本申请的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
上面结合附图对本申请实施例作了详细说明,但是本申请不限于上述实施例,在所属技术领域普通技术人员所具备的知识范围内,还可以在不脱离本申请宗旨的前提下,作出各种变化。
Claims (10)
1.一种无人驾驶车辆的转向控制方法,其特征在于,包括:
获取高精地图;
根据所述高精地图计算出弯道区域及弯道半径;
获取无人驾驶车辆的实时位置和实时速度;
若所述实时位置位于所述弯道区域中,则根据所述弯道半径和所述实时速度得到预设转向角度;
获取所述无人驾驶车辆与道路上相邻护栏之间的护栏距离信息;
根据所述护栏距离信息得到修正转向角度;
根据所述预设转向角度和所述修正转向角度得到实际转向角度;其中,所述预设转向角度、所述修正转向角度和所述实际转向角度皆为方向盘的转动角度。
2.根据权利要求1所述的无人驾驶车辆的转向控制方法,其特征在于,所述若所述实时位置位于所述弯道区域中,则根据所述弯道半径和所述实时速度得到预设转向角度,包括:
若所述实时位置位于所述弯道区域中且所述弯道半径小于或等于第一半径阈值,则根据所述弯道半径和所述实时速度得到预设转向角度;
若所述实时位置位于所述弯道区域中且所述弯道半径大于第一半径阈值,则所述预设转向角度设为0°。
3.根据权利要求2所述的无人驾驶车辆的转向控制方法,其特征在于,所述第一半径阈值为1500米。
4.根据权利要求1所述的无人驾驶车辆的转向控制方法,其特征在于,所述无人驾驶车辆包括第一单点激光雷达和第二单点激光雷达,所述第一单点激光雷达设置于所述无人驾驶车辆的车头侧旁处,所述第二单点激光雷达设置于所述无人驾驶车辆的车尾侧旁处,所述获取所述无人驾驶车辆与道路上相邻护栏之间的护栏距离信息,包括:
根据所述高精地图和所述实时位置获取车身距离信息;
若所述车身距离信息小于第一距离阈值,则启动所述第一单点激光雷达和所述第二单点激光雷达进行测距;
获取来自所述第一单点激光雷达测量的车头距离信息;其中,所述车头距离信息为所述无人驾驶车辆车头侧旁与道路上相邻护栏的距离;
获取来自所述第二单点激光雷达测量的车尾距离信息;其中,所述车尾距离信息为所述无人驾驶车辆车尾侧旁与道路上相邻护栏的距离。
5.根据权利要求4所述的无人驾驶车辆的转向控制方法,其特征在于,所述根据所述护栏距离信息得到修正转向角度,包括:
根据所述车头距离信息和所述车尾距离信息得到修正转向角度。
6.根据权利要求5所述的无人驾驶车辆的转向控制方法,其特征在于,所述修正转向角度的计算频率大于20Hz。
7.根据权利要求1所述的无人驾驶车辆的转向控制方法,其特征在于,还包括:
若所述实时速度在第一时间内持续超过第一速度阈值,则控制所述无人驾驶车辆向左偏移贴近道路左侧护栏。
8.一种电子设备,其特征在于,包括:
至少一个存储器;
至少一个处理器;
至少一个程序;
所述程序被存储在所述存储器中,所述处理器执行至少一个所述程序以实现如权利要求1至7任一项所述的无人驾驶车辆的转向控制方法。
9.一种无人驾驶车辆,其特征在于,包括如权利要求8所述的电子设备。
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机可执行信号,所述计算机可执行信号用于执行如权利要求1至7中任一项所述的无人驾驶车辆的转向控制方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110967071.9A CN113759903A (zh) | 2021-08-23 | 2021-08-23 | 无人驾驶车辆及其转向控制方法、电子设备及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110967071.9A CN113759903A (zh) | 2021-08-23 | 2021-08-23 | 无人驾驶车辆及其转向控制方法、电子设备及存储介质 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113759903A true CN113759903A (zh) | 2021-12-07 |
Family
ID=78790777
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110967071.9A Pending CN113759903A (zh) | 2021-08-23 | 2021-08-23 | 无人驾驶车辆及其转向控制方法、电子设备及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113759903A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115891977A (zh) * | 2023-02-22 | 2023-04-04 | 北京易控智驾科技有限公司 | 无人驾驶矿用车辆转向不足的控制方法、装置、电子设备及存储介质 |
CN116380107A (zh) * | 2023-05-29 | 2023-07-04 | 速度科技股份有限公司 | 一种基于高精地图对车辆进行定位的系统 |
CN116412814A (zh) * | 2023-06-12 | 2023-07-11 | 旷智中科(北京)技术有限公司 | 一种基于激光雷达的图像构建导航辅助系统 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5913376A (en) * | 1995-10-31 | 1999-06-22 | Honda Giken Kogyo Kabushiki Kaisha | Automatic steering control apparatus |
JP2000020896A (ja) * | 1998-06-29 | 2000-01-21 | Mitsubishi Motors Corp | 車両走行制御装置 |
DE102006042966A1 (de) * | 2006-09-13 | 2008-03-27 | Bayerische Motoren Werke Ag | Fahrtrichtungsanzeigesystem für ein Kraftfahrzeug |
DE102012009568B3 (de) * | 2012-05-10 | 2013-05-16 | Audi Ag | Verfahren zum Betreiben einer Überlagerungslenkung und Kraftwagen mit einer Überlagerungslenkung |
CN105882515A (zh) * | 2015-11-11 | 2016-08-24 | 乐卡汽车智能科技(北京)有限公司 | 应用于行车记录仪的信息处理方法、装置及行车记录仪 |
CN106314419A (zh) * | 2015-07-01 | 2017-01-11 | 丰田自动车株式会社 | 自动驾驶控制装置 |
CN106774313A (zh) * | 2016-12-06 | 2017-05-31 | 广州大学 | 一种基于多传感器的室外自动避障agv导航方法 |
CN108820039A (zh) * | 2018-05-11 | 2018-11-16 | 江苏大学 | 一种无人驾驶车辆弯道横向控制系统及方法 |
WO2020009162A1 (ja) * | 2018-07-03 | 2020-01-09 | 株式会社ブリヂストン | 走行車両の自動テスト走行システム |
CN110803161A (zh) * | 2018-08-02 | 2020-02-18 | 上海汽车集团股份有限公司 | 车道保持方法及车道保持辅助系统 |
CN111361638A (zh) * | 2019-10-12 | 2020-07-03 | 北汽福田汽车股份有限公司 | 车辆感知装置的控制方法、装置、可读存储介质及车辆 |
-
2021
- 2021-08-23 CN CN202110967071.9A patent/CN113759903A/zh active Pending
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5913376A (en) * | 1995-10-31 | 1999-06-22 | Honda Giken Kogyo Kabushiki Kaisha | Automatic steering control apparatus |
JP2000020896A (ja) * | 1998-06-29 | 2000-01-21 | Mitsubishi Motors Corp | 車両走行制御装置 |
DE102006042966A1 (de) * | 2006-09-13 | 2008-03-27 | Bayerische Motoren Werke Ag | Fahrtrichtungsanzeigesystem für ein Kraftfahrzeug |
DE102012009568B3 (de) * | 2012-05-10 | 2013-05-16 | Audi Ag | Verfahren zum Betreiben einer Überlagerungslenkung und Kraftwagen mit einer Überlagerungslenkung |
CN106314419A (zh) * | 2015-07-01 | 2017-01-11 | 丰田自动车株式会社 | 自动驾驶控制装置 |
CN105882515A (zh) * | 2015-11-11 | 2016-08-24 | 乐卡汽车智能科技(北京)有限公司 | 应用于行车记录仪的信息处理方法、装置及行车记录仪 |
CN106774313A (zh) * | 2016-12-06 | 2017-05-31 | 广州大学 | 一种基于多传感器的室外自动避障agv导航方法 |
CN108820039A (zh) * | 2018-05-11 | 2018-11-16 | 江苏大学 | 一种无人驾驶车辆弯道横向控制系统及方法 |
WO2020009162A1 (ja) * | 2018-07-03 | 2020-01-09 | 株式会社ブリヂストン | 走行車両の自動テスト走行システム |
CN110803161A (zh) * | 2018-08-02 | 2020-02-18 | 上海汽车集团股份有限公司 | 车道保持方法及车道保持辅助系统 |
CN111361638A (zh) * | 2019-10-12 | 2020-07-03 | 北汽福田汽车股份有限公司 | 车辆感知装置的控制方法、装置、可读存储介质及车辆 |
Non-Patent Citations (1)
Title |
---|
谭炳新: "现代城市交通规划设计全书", vol. 1, 海潮出版社, pages: 1402 - 1403 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115891977A (zh) * | 2023-02-22 | 2023-04-04 | 北京易控智驾科技有限公司 | 无人驾驶矿用车辆转向不足的控制方法、装置、电子设备及存储介质 |
CN116380107A (zh) * | 2023-05-29 | 2023-07-04 | 速度科技股份有限公司 | 一种基于高精地图对车辆进行定位的系统 |
CN116380107B (zh) * | 2023-05-29 | 2023-08-22 | 速度科技股份有限公司 | 一种基于高精地图对车辆进行定位的系统 |
CN116412814A (zh) * | 2023-06-12 | 2023-07-11 | 旷智中科(北京)技术有限公司 | 一种基于激光雷达的图像构建导航辅助系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107128314B (zh) | 用于牵引车辆的增强的车辆横向控制 | |
US9849878B2 (en) | System and method for providing a corrected lane following path through a curve for trailering vehicles | |
JP6055525B1 (ja) | 車両の走行制御装置 | |
US9457807B2 (en) | Unified motion planning algorithm for autonomous driving vehicle in obstacle avoidance maneuver | |
US9227632B1 (en) | Method of path planning for evasive steering maneuver | |
US9229453B1 (en) | Unified motion planner for autonomous driving vehicle in avoiding the moving obstacle | |
CN105292116B (zh) | 自动驾驶车辆的车道变换路径规划算法 | |
CN113759903A (zh) | 无人驾驶车辆及其转向控制方法、电子设备及存储介质 | |
US8094001B2 (en) | Vehicle lane departure warning system and method | |
JP5953426B2 (ja) | 作業用車両の自動操舵システム | |
US11526173B2 (en) | Traveling trajectory correction method, traveling control method, and traveling trajectory correction device | |
CN105270410A (zh) | 用于自主驾驶车辆的路径规划的精确曲率估计算法 | |
CN107764265B (zh) | 用于车辆定位反馈的方法 | |
US10466064B2 (en) | Odometry method for determining a position of a motor vehicle, control device and motor vehicle | |
US9841765B2 (en) | Curb detection for vehicle parking | |
US20140236412A1 (en) | Apparatus and method for automatically parking vehicle | |
JP7037317B2 (ja) | 自車位置検出装置 | |
US20170240171A1 (en) | Method for modifying steering of an automated vehicle for improved passenger comfort | |
CN116080754B (zh) | 一种车辆自主驾驶横向控制方法 | |
TW201420399A (zh) | 利用車身訊號偵測車道曲率之方法及其系統 | |
JP4576914B2 (ja) | 車両のレーン走行支援装置 | |
TWI633030B (zh) | Vehicle automatic lane following control system and method | |
WO2024088506A1 (en) | Slope estimation using ground radar | |
CN116118770A (zh) | 面向稳健自动驾驶控制的车辆感知系统的自适应合理化器 | |
CN113928307A (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20211207 |
|
RJ01 | Rejection of invention patent application after publication |