CN113759903A - 无人驾驶车辆及其转向控制方法、电子设备及存储介质 - Google Patents

无人驾驶车辆及其转向控制方法、电子设备及存储介质 Download PDF

Info

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
Application number
CN202110967071.9A
Other languages
English (en)
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.)
Dongguan Polytechnic
Original Assignee
Dongguan Polytechnic
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 Dongguan Polytechnic filed Critical Dongguan Polytechnic
Priority to CN202110967071.9A priority Critical patent/CN113759903A/zh
Publication of CN113759903A publication Critical patent/CN113759903A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0257Control of position or course in two dimensions specially adapted to land vehicles using a radar
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278Control 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差分定位模块检测到无人驾驶车辆的实时位置,该实时位置包括实时经度信息和实时纬度信息,当实时经度信息和实时纬度信息的值位于弯道区域的经纬度坐标集合中,则表明无人驾驶车辆位于道路的弯道处。
可以理解的是,若无人驾驶车辆的经纬度位于弯道区域的经纬度集合中,则通过弯道半径和无人驾驶车辆的实时速度计算得到预设转向角度,具体预设转向角度通过数学模型获得的计算方法为:
Figure BDA0003224330790000051
其中,α(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),它们之间的距离函数为:
Figure BDA0003224330790000071
其中,
Figure BDA0003224330790000072
其中,R0地球半径,可取平均值6371km;d0为车身距离信息(汽车侧面到护栏的距离信息,用差分GPS定位模块的位置和车宽信息计算可得);φ1=lon1,φ2=lon2表示汽车和护栏两点的纬度;Δλ=|lat2-lat1|表示汽车和护栏两点经度差值的绝对值。
步骤S320:若车身距离信息小于第一距离阈值,则启动第一单点激光雷达和第二单点激光雷达进行测距。
可以理解的是,当车身距离信息小于第一距离阈值时,第一距离阈值表示无人驾驶车辆与相邻护栏的最小安全距离值,当无人驾驶车辆的车身距离信息小于第一距离阈值时,无人驾驶车辆可能存在与相邻护栏相撞的风险,则启动在近距离测距更为精确的第一单点激光雷达和第二单点激光雷达进行测距,以保证无人驾驶车辆的安全行使。具体地,第一距离阈值为2米,即当无人驾驶车辆的车身距离信息小于2米时,则启动在近距离测距更为精确的第一单点激光雷达和第二单点激光雷达进行测距,在本申请对此不作限定。
步骤S330:获取来自第一单点激光雷达测量的车头距离信息;其中,车头距离信息为无人驾驶车辆车头侧旁与道路上相邻护栏的距离。
步骤S340:获取来自第二单点激光雷达测量的车尾距离信息;其中,车尾距离信息为无人驾驶车辆车尾侧旁与道路上相邻护栏的距离。
可以理解的是,通过第一单点激光雷达和第二单点激光雷达分别对无人驾驶车辆的车头和车尾侧旁与道路相邻护栏之间的车头距离信息和车尾距离信息进行距离测量,除了更加全面把控好无人驾驶车辆与相邻护栏之间距离,提高无人驾驶车辆行驶的安全性,更重要的是判断车辆行驶延伸线与道路护栏延伸线的夹角从而使用转向控制算法实时修正反馈调整转向角参数。
可以理解的是,在本申请一实施例中,步骤S160包括但不限于以下步骤:
根据车头距离信息和车尾距离信息得到修正转向角度。
可以理解的是,通过第一单点激光雷达和第二单点激光雷达分别对无人驾驶车辆的车头和车尾侧旁与道路相邻护栏之间的车头距离信息和车尾距离信息,并根据车头距离信息和车尾距离信息计算出修正角转向角度,修正转向角度的计算方法为:
Figure BDA0003224330790000081
其中,β(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角计算方法为,
Figure BDA0003224330790000091
其中,Rx为道路第X个弯道的半径,b为左前和左后激光雷达的安装距离,ρ为激光雷达的安装定位角,m为实验参数,m取值1.1。
具体地,车辆横向偏离距离算术平均值
Figure BDA0003224330790000092
其中,d1(t)为左后单点激光雷达测出车辆左侧距护栏的实际距离、d2(t)为左前单点激光雷达测出车辆左侧距护栏的实际距离,通过用ε和0.5d0的误差大小修正ρ值。
可以理解的是,在本申请一实施例中,本申请提供的无人驾驶车辆的转向控制方法还包括但不限于以下步骤:
若实时速度在第一时间内持续超过第一速度阈值,则控制无人驾驶车辆向左偏移贴近道路左侧护栏。
可以理解的是,本申请提供的无人驾驶车辆的转向控制方法适用于在高速公路上行驶,当无人驾驶车辆在第一时间内持续超过第一速度阈值,则代表无人驾驶车辆已经在高速公路上行驶,为了更好控制无人驾驶车辆在弯道处的转向,无人驾驶车辆在***的控制下向左偏移至贴近道路左侧护栏行驶,并根据车头距离信息和车尾距离信息保持无人驾驶车辆与左侧护栏不发生碰撞,即无人驾驶车辆自动驾驶到道路最左侧的车道上行驶,以便无人驾驶车辆能够沿边行驶,提高自动转向的准确性。
可以理解的是,在本申请提供的无人驾驶车辆的转向控制方法还能够通过以下深度学习算法在行驶路径中迭代寻优,在遇到相似的情况下能够优化转向参数并做出快速操控反应。
具体地深度学习算法1,对于无人驾驶汽车行驶同一条路径,该路径上具有x个超过阈值的弯道,通过计算无人驾驶车辆在这条路径上连续n个(3≤n≤10)实际转向角度函数γx(t)的积分总和最小进行迭代,获得该路径较优的转向方案,以便下次直接应用该转向方案,减少转向角度计算的时间,提高了转向效率。例如,通过对比第一次行驶该路径与第二次行驶该路径连续10个弯道的实际转向角度函数积分总和,若第一次的实际转向角度函数积分总和小于第二次的实际转向角度函数积分总和,则下一次行驶该路径时,采用第一次的转向方案。具体地,转向稳定系数的计算方法为:
Figure BDA0003224330790000101
其中,δ为转向稳定系数,γ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中任一项所述的无人驾驶车辆的转向控制方法。
CN202110967071.9A 2021-08-23 2021-08-23 无人驾驶车辆及其转向控制方法、电子设备及存储介质 Pending CN113759903A (zh)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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 北汽福田汽车股份有限公司 车辆感知装置的控制方法、装置、可读存储介质及车辆

Patent Citations (11)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
Title
谭炳新: "现代城市交通规划设计全书", vol. 1, 海潮出版社, pages: 1402 - 1403 *

Cited By (4)

* Cited by examiner, † Cited by third party
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) 車両の走行制御装置
US9227632B1 (en) Method of path planning for evasive steering maneuver
US9457807B2 (en) Unified motion planning algorithm for autonomous driving vehicle in obstacle avoidance maneuver
CN113759903A (zh) 无人驾驶车辆及其转向控制方法、电子设备及存储介质
US9428187B2 (en) Lane change path planning algorithm for autonomous driving vehicle
US9229453B1 (en) Unified motion planner for autonomous driving vehicle in avoiding the moving obstacle
US8094001B2 (en) Vehicle lane departure warning system and method
JP5953426B2 (ja) 作業用車両の自動操舵システム
KR20060049706A (ko) 차량의 레인주행지원장치
US9841765B2 (en) Curb detection for vehicle parking
CN107764265B (zh) 用于车辆定位反馈的方法
JP7037317B2 (ja) 自車位置検出装置
US20140236412A1 (en) Apparatus and method for automatically parking vehicle
US20170240171A1 (en) Method for modifying steering of an automated vehicle for improved passenger comfort
US10466064B2 (en) Odometry method for determining a position of a motor vehicle, control device and motor vehicle
JP6579699B2 (ja) 車両の走行制御装置
US20220212678A1 (en) Systems and methods for vehicle control using terrain-based localization
TW201420399A (zh) 利用車身訊號偵測車道曲率之方法及其系統
US20230041499A1 (en) Method for determining the current angle of lateral inclination of a roadway
CN116080754B (zh) 一种车辆自主驾驶横向控制方法
JP2018167735A (ja) 車両の操舵支援装置
JP4576914B2 (ja) 車両のレーン走行支援装置
TWI633030B (zh) Vehicle automatic lane following control system and method

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