CN113665574B - 智能汽车换道时长预测及拟人化轨迹规划方法 - Google Patents

智能汽车换道时长预测及拟人化轨迹规划方法 Download PDF

Info

Publication number
CN113665574B
CN113665574B CN202111237247.1A CN202111237247A CN113665574B CN 113665574 B CN113665574 B CN 113665574B CN 202111237247 A CN202111237247 A CN 202111237247A CN 113665574 B CN113665574 B CN 113665574B
Authority
CN
China
Prior art keywords
lane change
vehicle
lane
influence
changing
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
CN202111237247.1A
Other languages
English (en)
Other versions
CN113665574A (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.)
Tsinghua University
Original Assignee
Tsinghua University
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 Tsinghua University filed Critical Tsinghua University
Priority to CN202111237247.1A priority Critical patent/CN113665574B/zh
Publication of CN113665574A publication Critical patent/CN113665574A/zh
Application granted granted Critical
Publication of CN113665574B publication Critical patent/CN113665574B/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
    • 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
    • B60W30/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18163Lane change; Overtaking manoeuvres
    • 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/107Longitudinal acceleration
    • 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
    • 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
    • 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/0043Signal treatments, identification of variables or parameters, parameter estimation or state estimation

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Human Computer Interaction (AREA)
  • Traffic Control Systems (AREA)

Abstract

本申请涉及智能汽车应用技术领域,特别涉及一种智能汽车换道时长预测及拟人化轨迹规划方法,包括:从自然驾驶数据中提取优秀驾驶员的换道轨迹,并提取多车影响下的换道时长;获取换道车辆的周车运动信息,将周车影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而获得周车影响下的换道时长预测模型;智能汽车应用换道时长预测模型时,基于预期换道纵向位移、当前纵向速度和换道后目标车道预期车速,结合周车信息,利用预测模型进行换道时长的优选,进而实现拟人化的换道轨迹规划。由此,充分挖掘了自然驾驶数据中优秀驾驶员的操纵规律,为智能汽车科学合理的换道决策提供参考,是智能汽车拟人化决策理念在换道决策中的体现。

Description

智能汽车换道时长预测及拟人化轨迹规划方法
技术领域
本申请涉及智能汽车应用技术领域,特别涉及一种智能汽车换道时长预测及拟人化轨迹规划方法。
背景技术
在人工驾驶和自动驾驶混行的混合交通环境下,自动驾驶汽车的换道行为受到周围交通车的影响,特别是人工驾驶车辆的不确定性影响,使得换道轨迹的纵向运动规律十分复杂。
相关技术中,通常假定换道过程中,智能汽车纵向速度保持不变,在这种理想工况下规划获得的换道轨迹,换道轨迹规划对横向运动规律的考量较多,然而,该方式缺乏对换道过程中车辆纵向运动的分析,未能充分考虑周围车辆对自车换道过程中纵向驾驶行为的影响,使得规划的轨迹的预期性能不一定能够满足预期要求,可能导致频繁的加减速,造成换道舒适性的降低,甚至还存在换道时长不足导致车辆侧向加速度过大,诱发自车的侧滑和侧倾等失稳风险,以及与周围车辆的碰撞风险增加等安全问题,亟待解决。
发明内容
本申请提供一种智能汽车换道时长预测及拟人化轨迹规划方法,以解决相关智能汽车技术中未能充分量化评估周围车辆对自车换道过程中纵向驾驶行为的影响,而导致的换道时长决策合理性不足、可解释性差和可能存在的安全风险的问题,充分挖掘自然驾驶数据中优秀驾驶员的驾驶操纵规律,为智能汽车科学合理的换道决策提供参考,是智能汽车“学习人、模拟人、超越人和服务人”的拟人化决策理念在换道决策中的体现。
本申请第一方面实施例提供一种智能汽车换道时长预测及拟人化轨迹规划方法,包括以下步骤:
从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长;
获取换道车辆的周车运动信息,并根据所述周车运动信息建立多车影响下的车辆换道纵向运动学模型,以及将所述周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数;
在网联多车环境下的智能汽车应用所述换道时长预测模型进行决策的情况下,当下达换道指令时,基于预期换道纵向位移、所述智能汽车的纵向速度和换道后目标车道预期车速,结合所述智能汽车的周车信息,利用所述换道时长预测模型对所述智能汽车的换道时长进行优选,并根据优选获得的所述智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。
在一些示例中,所述从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长,包括:
计算所述优秀驾驶员的换道轨迹的朝向角;
基于所述朝向角从所述自然驾驶数据中确定峰值点,并且由所述峰值点向两边搜索,得到满足预设条件的时间点;
由所述时间点匹配对应的换道轨迹的初始区间;
根据所述初始区间计算所述换道轨迹侧向加速度峰-峰值时间差,并基于所述时间差计算侧向加速度取得最大值和最小值时对应的时间点,得到所述换道轨迹在真实多车影响下的优秀驾驶员换道时长。
在一些示例中,所述获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数,包括:
对所述换道车辆的平均纵向加速度进行加速度修正,得到修正后的平均纵向加速度,将所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射;
根据所述多车影响下的车辆换道纵向运动学模型和所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射,得到所述多车影响下的换道时长预测模型和辨识获得的模型参数。
在一些示例中,所述换道时长预测模型为:
Figure 938260DEST_PATH_IMAGE001
其中,
Figure 136023DEST_PATH_IMAGE002
为自车的换道时长,
Figure 949258DEST_PATH_IMAGE003
为所述自车预期换道纵向位移、
Figure 119339DEST_PATH_IMAGE004
为所述自车平均纵向加速度,
Figure 563090DEST_PATH_IMAGE005
为所述自车换道后在目标车道的预期车速。
在一些示例中,所述预期换道纵向位移是根据纵向位置、纵向速度和纵向加速度状态函数确定的。
本申请第二方面实施例提供一种智能汽车换道时长预测及拟人化轨迹规划装置,包括:
提取模块,用于从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长;
生成模块,用于获取换道车辆的周车运动信息,并根据所述周车运动信息建立多车影响下的车辆换道纵向运动学模型,以及将所述周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数;以及
换道轨迹规划模块,用于在网联多车环境下的所述智能汽车应用所述换道时长预测模型进行决策的情况下,当下达换道指令时,基于预期换道纵向位移、所述智能汽车的纵向速度和换道后目标车道预期车速,结合所述智能汽车的周车信息,利用所述换道时长预测模型对所述智能汽车的换道时长进行优选,并根据优选获得的所述智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。
在一些示例中,所述提取模块,具体用于:
计算所述优秀驾驶员的换道轨迹的朝向角;
基于所述朝向角从所述自然驾驶数据中确定峰值点,并且由所述峰值点向两边搜索,得到满足预设条件的时间点;
由所述时间点匹配对应的换道轨迹的初始区间;
根据所述初始区间计算所述换道轨迹侧向加速度峰-峰值时间差,并基于所述时间差计算侧向加速度取得最大值和最小值时对应的时间点,得到所述换道轨迹在真实多车影响下的优秀驾驶员换道时长。
在一些示例中,所述生成模块,具体用于:
对所述换道车辆的平均纵向加速度进行加速度修正,得到修正后的平均纵向加速度,将所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射;
根据所述多车影响下的车辆换道纵向运动学模型和所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射,得到所述多车影响下的换道时长预测模型和辨识获得的模型参数。
在一些示例中,所述换道时长预测模型为:
Figure 716991DEST_PATH_IMAGE006
其中,
Figure 333917DEST_PATH_IMAGE002
为自车的换道时长,
Figure 155243DEST_PATH_IMAGE003
为所述自车预期换道纵向位移、
Figure 566632DEST_PATH_IMAGE004
为所述自车平均纵向加速度,
Figure 676671DEST_PATH_IMAGE005
为所述自车换道后在目标车道的预期车速。
在一些示例中,所述预期换道纵向位移是根据纵向位置、纵向速度和纵向加速度状态函数确定的。
本申请第三方面实施例提供一种智能汽车换道轨迹决策设备,包括:换道意图识别模块和换道轨迹规划模块,其中,上述第一方面实施例所述的智能汽车换道时长预测及拟人化轨迹规划方法服务于所述换道意图识别模块和换道轨迹规划模块。
本申请第四方面实施例提供一种换道轨迹跟踪模块,其上存储有计算机程序,该程序被处理器执行,以用于实现上述第一方面实施例所述的智能汽车换道时长预测及拟人化轨迹规划方法。
本发明的实施例,可以从大量的驾驶员的自然驾驶数据中提取出优秀驾驶员的换道轨迹,并由优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长,然后,获取换道车辆的周车运动信息,并根据周车运动信息建立多车影响下的车辆换道纵向运动学模型,将周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而能够获得多车影响下的换道时长预测模型,这样,当该换道时长预测模型应用到网联多车环境下的智能汽车之后,该智能汽车便可以根据预期换道纵向位移、智能汽车的纵向速度和换道后目标车道预期车速等,结合智能汽车的周车信息,利用换道时长预测模型对智能汽车的换道时长进行优选,进而,可以根据优选获得的智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。由此,解决了相关智能汽车技术中,未能充分量化评估周围车辆对自车换道过程中纵向驾驶行为的影响,而导致的换道时长决策合理性不足、可解释性差和可能存在的安全风险的问题,本发明的实施例,充分挖掘大量驾驶员的自然驾驶数据中优秀驾驶员的驾驶操纵规律,为智能汽车科学合理的换道决策提供参考,使智能汽车的换道过程更为合理,进而提升智能汽车的安全性和可靠性,是智能汽车“学习人、模拟人、超越人和服务人”的拟人化决策理念在换道决策中的体现。
本申请附加的方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本申请的实践了解到。
附图说明
本申请上述的和/或附加的方面和优点从下面结合附图对实施例的描述中将变得明显和容易理解,其中:
图1为根据本申请实施例提供的一种智能汽车换道时长预测及拟人化轨迹规划方法的流程图;
图2为根据本申请一个实施例的自然驾驶轨迹集HighD中提取的向左的换道轨迹、侧向速度和侧向加速度的变化规律示意图;
图3为根据本申请一个实施例的自然驾驶轨迹集HighD中提取的向右的换道轨迹、侧向速度和侧向加速度的变化规律;
图4为根据本申请一个实施例的周车对自车换道过程中平均等效纵向加速度的非线性映射关系示意图;
图5为根据本申请一个实施例的网联环境下周车运动参数识别说明示例图;
图6为根据本申请一个实施例的实测自然驾驶数据集HighD换道轨迹的纵向驾驶行为统计分析结果的示例图;
图7为根据本申请一个实施例的预测获得的当前车辆的换道时长与换道轨迹对应的换道时长的对比的直方图和散点图的示意图;
图8为根据本申请一个实施例的智能汽车换道时长预测及拟人化轨迹规划方法的流程图;
图9为根据本申请实施例的智能汽车换道时长预测及拟人化轨迹规划装置的方框示意图。
具体实施方式
下面详细描述本申请的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,旨在用于解释本申请,而不能理解为对本申请的限制。
下面参考附图描述本申请实施例的智能汽车换道时长预测及拟人化轨迹规划方法。
在介绍本申请实施例的智能汽车换道时长预测及拟人化轨迹规划方法之前,先简单介绍下相关技术中换道轨迹提取方法。
相关技术中主要有两种方法:(1)采用驾驶模拟器采集换道数据进行分析;(2)直接从自然驾驶数据中提取换道轨迹进行分析。
具体地,驾驶模拟器数据能够直接结合驾驶员问卷调查,并采集同一驾驶员在不同场景下的不同驾驶换道数据,便于进行驾驶员风格的聚类分析,但驾驶模拟器存在样本量有限且与实际驾驶环境存在差异等弊端,因此现有换道研究越来越多的关注于从高精度的自然驾驶轨迹数据中直接提取并挖掘换道行为的规律。
然而,从自然驾驶数据中准确的提取出换道轨迹仍面临较大的挑战,现有自然驾驶数据换道轨迹提取的技术方案通常给定一个阈值,在车辆偏离车道线中心距离大于阈值时认为换道开始,而在车辆偏离目标车道中心线小于阈值时认为换道结束,或者根据侧向速度由零值-峰值-零值的变化过程来提取换道轨迹,以上方法在车辆侧向位移和速度存在波动的情况下,容易造成所提取的换道轨迹不完整或者存在冗余,进而影响下一步的换道时长的建模精度。
正是基于上述问题,本申请提供了一种智能汽车换道时长预测及拟人化轨迹规划方法,在该方法中,可以从大量的驾驶员的自然驾驶数据中提取出优秀驾驶员的换道轨迹,并由优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长,然后,获取换道车辆的周车运动信息,并根据周车运动信息建立多车影响下的车辆换道纵向运动学模型,将周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而能够获得多车影响下的换道时长预测模型,这样,当该换道时长预测模型应用到网联多车环境下的智能汽车之后,该智能汽车便可以根据预期换道纵向位移、智能汽车的纵向速度和换道后目标车道预期车速等,结合智能汽车的周车信息,利用换道时长预测模型对智能汽车的换道时长进行优选,进而,可以根据优选获得的智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。由此,解决了相关智能汽车技术中,未能充分量化评估周围车辆对自车换道过程中纵向驾驶行为的影响,而导致的换道时长决策合理性不足、可解释性差和可能存在的安全风险的问题,本发明的实施例,充分挖掘大量驾驶员的自然驾驶数据中优秀驾驶员的驾驶操纵规律,为智能汽车科学合理的换道决策提供参考,使智能汽车的换道过程更为合理,进而提升智能汽车的安全性和可靠性,是智能汽车“学习人、模拟人、超越人和服务人”的拟人化决策理念在换道决策中的体现。
具体而言,图1为本申请实施例所提供的一种智能汽车换道时长预测及拟人化轨迹规划方法的流程示意图。
如图1所示,该智能汽车换道时长预测及拟人化轨迹规划方法包括以下步骤:
在步骤S101中,从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长。即:从海量的驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,然后,提取出优秀驾驶员的换道轨迹对应的真实多车影响下的优秀驾驶员换道时长。
在具体示例中,从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长,包括:计算所述优秀驾驶员的换道轨迹的朝向角;基于所述朝向角从所述自然驾驶数据中确定峰值点,并且由所述峰值点向两边搜索,得到满足预设条件的时间点;由所述时间点匹配对应的换道轨迹的初始区间;根据所述初始区间计算所述换道轨迹侧向加速度峰-峰值时间差,并基于所述时间差计算侧向加速度取得最大值和最小值时对应的时间点,得到所述换道轨迹在真实多车影响下的优秀驾驶员换道时长。
具体而言,在从海量的驾驶员的自然驾驶数据中提取车辆的换道轨迹时,本申请实施例可以首先计算换道轨迹的朝向角
Figure 362867DEST_PATH_IMAGE007
,峰值点可以为朝向角
Figure 38699DEST_PATH_IMAGE007
大于预设朝向角阈值的点,假设朝向角阈值为2,则自然驾驶数据中朝向角
Figure 620990DEST_PATH_IMAGE008
的点均为峰值点,由峰值点向两边搜索,得到满足预设条件的时间点,其中,预设条件可以为
Figure 218325DEST_PATH_IMAGE009
,从而可以由时间点匹配对应的换道轨迹的初始区间
Figure 911474DEST_PATH_IMAGE010
由此,实现的对车辆的换道轨迹的初步提取,提取出的换道轨迹的初始区间由于车辆的侧向位移和速度波动,可能导致所提取的换道轨迹的初始区间存在冗余时间区间,因此,本申请实施例可以采用侧向加速度峰-峰值进行换道轨迹的精确提取。
进一步地,换道轨迹侧向加速度峰-峰值时间差
Figure 972971DEST_PATH_IMAGE011
的计算公式如式(1)所示:
Figure 726164DEST_PATH_IMAGE012
(1)
其中,
Figure 799075DEST_PATH_IMAGE013
为绝对值计算符号,
Figure 30337DEST_PATH_IMAGE014
为侧向加速度取得最大值时对应的时间点,
Figure 477498DEST_PATH_IMAGE015
为侧向加速度取得最小值时对应的时间点,
Figure 401592DEST_PATH_IMAGE016
为换道轨迹对应的换道时长。
由此可知,换道轨迹对应的换道时长
Figure 504677DEST_PATH_IMAGE016
是两倍的侧向加速度峰-峰值时间差
Figure 336367DEST_PATH_IMAGE011
,故换道时间起点
Figure 841298DEST_PATH_IMAGE017
和换道时间终点
Figure 670714DEST_PATH_IMAGE018
分别如式(2)和式(3)所示:
Figure 526674DEST_PATH_IMAGE019
(2)
Figure 896476DEST_PATH_IMAGE020
(3)
其中,
Figure 521492DEST_PATH_IMAGE021
为取最小值符号,
Figure 521809DEST_PATH_IMAGE022
为取最大值符号。
举例来说,如图2和图3所示,图2中的(a)至(c)分别为自然驾驶轨迹集HighD中提取的向左的换道轨迹、侧向速度和侧向加速度的变化规律;图3中的(a)至(c)分别为自然驾驶轨迹集HighD中提取的向右的换道轨迹、侧向速度和侧向加速度的变化规律。在图2和图3中,换道起点和换道终点即对应于式(2)和式(3)中所提到的
Figure 396224DEST_PATH_IMAGE017
Figure 38558DEST_PATH_IMAGE023
,侧向加速度峰-峰值对应的时间点即为
Figure 721343DEST_PATH_IMAGE024
Figure 423720DEST_PATH_IMAGE025
。由图2和图3可知,该换道轨迹提取方法可以准确而完整的从自然驾驶数据集中提取出换道轨迹,为下一步的换道时长预测建模奠定了可靠的数据基础。
在步骤S102中,获取换道车辆的周车运动信息,并根据所述周车运动信息建立多车影响下的车辆换道纵向运动学模型,以及将所述周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数。在具体应用中,可以采用无人机获得换道车辆周围车辆的运动信息,例如,获取德国自然驾驶数据集HighD中的数据;也可由路侧相机获得换道车辆周围车辆的运动信息,例如,获取美国自然驾驶数据集NGSIM中的数据。
在一个具体示例中,获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数,包括:对所述换道车辆的平均纵向加速度进行加速度修正,得到修正后的平均纵向加速度,将所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射;根据所述多车影响下的车辆换道纵向运动学模型和所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射,得到所述多车影响下的换道时长预测模型和辨识获得的模型参数。
可以理解的是,在理想的驾驶员假设下,驾驶员换道是为了追求更高的行驶速度,因此在不考虑周车影响的换道过程中,驾驶员倾向于保持匀速或加速换道,以快速实现车道的变换和行驶效率的提升,而在复杂行车环境中,驾驶员的换道行为不得不考虑周车的影响,而周车对自车换道纵向驾驶行为的影响,需通过自车驾驶员的应激反应产生。因此,本申请实施例可以将车辆周边的预设范围内的其他车辆的影响等效为对自车平均纵向加速度
Figure 191956DEST_PATH_IMAGE026
的影响,等效系数
Figure 903560DEST_PATH_IMAGE027
(即影响值)与车辆周边的预设范围内的其他车辆状态之间的非线性映射关系,可用式(4)表述:
Figure 503169DEST_PATH_IMAGE028
(4)
其中,式(4)的非线性映射的一种可行方案为式(5)和式(6)的回归模型方案。式(5)和式(6)中,
Figure 845288DEST_PATH_IMAGE029
Figure 897558DEST_PATH_IMAGE030
Figure 412853DEST_PATH_IMAGE031
均为回归系数,可根据实际换道轨迹(即步骤S101中提取到的换道轨迹)进行标定:
Figure 866968DEST_PATH_IMAGE032
(5)
Figure 645568DEST_PATH_IMAGE033
(6)
进一步地,本申请实施例根据周车的影响对自车平均纵向加速度进行加速度修正时,平均纵向加速度
Figure 388396DEST_PATH_IMAGE026
的获取方式可以如图4所示,平均纵向加速度
Figure 910644DEST_PATH_IMAGE026
可以使用如式(7)所示的数学公式进行量化的表达:
Figure 219266DEST_PATH_IMAGE034
(7)
式(7)中,
Figure 965505DEST_PATH_IMAGE035
为与车辆周边的预设范围内的其他车辆运动状态相关的等效系数,
Figure 726788DEST_PATH_IMAGE036
为理想条件下,只考虑换道效率收益的预期纵向加速度,
Figure 787148DEST_PATH_IMAGE036
的定义可以如式(8)所示:
Figure 950276DEST_PATH_IMAGE037
(8)
式(8)中,
Figure 867416DEST_PATH_IMAGE038
为目标车道的预期行驶速度,在理想驾驶员假设前提下,驾驶员换道是为了追求更高的行驶效率,因此,
Figure 115995DEST_PATH_IMAGE039
,车辆在换道过程应快速的实现纵向行驶速度的提升,而换道过程中,驾驶员又不得不考虑与周车的交互,在与周车的交互博弈过程中,采取的最终实际纵向加速度是与周车博弈的结果,周车的影响主要体现在式(7)所示的影响值
Figure 980046DEST_PATH_IMAGE040
中。
由此,即可根据如式(9)所示的车辆换道纵向运动学模型等得到训练好的多车影响下的换道时长预测模型。
Figure 794418DEST_PATH_IMAGE041
(9)
可选地,在一些实施例中,通过求解式(9)所示的一元二次方程,并剔除负数解,即可得到换道时长预测模型为:
Figure 351301DEST_PATH_IMAGE042
其中,
Figure 821597DEST_PATH_IMAGE002
为自车的换道时长,
Figure 20497DEST_PATH_IMAGE043
为所述自车预期换道纵向位移、
Figure 158217DEST_PATH_IMAGE004
为所述自车平均纵向加速度,
Figure 886002DEST_PATH_IMAGE005
为所述自车换道后在目标车道的预期车速。
需要说明的是,式(10)在
Figure 578014DEST_PATH_IMAGE044
的数学极限条件下,可求得不考虑纵向加速度时的换道时长
Figure 846184DEST_PATH_IMAGE002
。显然,在
Figure 838411DEST_PATH_IMAGE044
时,式(10)为
Figure 205939DEST_PATH_IMAGE045
型数学极限问题,利用洛必达法则同时求得分子分母对
Figure 916406DEST_PATH_IMAGE004
的导数,如式(11)所示:
Figure 722688DEST_PATH_IMAGE046
(11)
由式(11)可知,在换道时长
Figure 569421DEST_PATH_IMAGE002
的计算公式(10)中,自车平均纵向加速度
Figure 842270DEST_PATH_IMAGE004
趋向零时的解等于预期换道距离
Figure 774454DEST_PATH_IMAGE043
与换道后目标车道预期车速
Figure 587690DEST_PATH_IMAGE005
的比值,符合匀速运动运动学规律,说明传统的纵向匀速换道时长模型是本申请所提出的换道时长预测模型的特例。
需要说明的是,周车对自车平均纵向加速度的影响的非线性映射模型,不仅可用上述回归建模方法获得,在其他示例中,也可以由其他方式得到,例如:由神经网络模型、支持向量机模型、随机森林模型和深度学习模型等非参数化建模方法获得。
在步骤S103中,在网联多车环境下的智能汽车应用所述换道时长预测模型进行决策的情况下,当下达换道指令时,基于预期换道纵向位移、所述智能汽车的纵向速度和换道后目标车道预期车速,结合所述智能汽车的周车信息,利用所述换道时长预测模型对所述智能汽车的换道时长进行优选,并根据优选获得的所述智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。
也就是说,当通过步骤S101和步骤S102得到换道时长预测模型之后,可以将该换道时长预测模型应用到智能车辆上进行自动且智能的换道控制。
应当理解的是,在网联多车环境下,智能汽车可以通过车载感知***和V2X(Vehicle to X,车对外界的信息交换),其中,X可以为车、路和云,智能汽车才可通过感知***的传感器(如激光雷达、毫米波雷达、相机、GPS和惯导等)和V2X通信设备获取周车运动信息,以便于对周围车辆运动产生的风险进行评估,从而为自车的换道决策提供准确的环境信息。
因此,在智能汽车的换道意图模块和换道决策模块下达换道指令时,基于预期换道纵向位移、自车平均纵向加速度和换道后目标车道预期车速,结合智能汽车感知***和V2X设备获取的周车信息,利用所述换道时长预测模型对所述智能汽车的换道时长进行优选,并根据优选获得的所述智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。
其中,所述预期换道纵向位移是根据纵向位置、纵向速度和纵向加速度状态函数确定的。
具体地,如图5所示,在换道过程中,本申请实施例可以考虑的周围车辆分别是来自当前车道的前后车和目标车道的前后车,图5中,1号车为当前车道前车,2号车为当前车道后车,3号车为目标车道后车,4号车为目标车道前车,
Figure 554509DEST_PATH_IMAGE047
为各车的纵向位置、纵向速度和纵向加速度状态函数。
由此,解决了相关智能汽车技术中,未能充分量化评估周围车辆对自车换道过程中纵向驾驶行为的影响,而导致的换道时长决策合理性不足、可解释性差和可能存在的安全风险的问题,充分挖掘自然驾驶数据中优秀驾驶员的驾驶操纵规律,为智能汽车科学合理的换道决策提供参考,是智能汽车“学习人、模拟人、超越人和服务人”的拟人化决策理念在换道决策中的体现。
为使得本领域技术人员进一步了解本申请实施例的智能汽车换道时长预测及拟人化轨迹规划方法,下面以自然驾驶数据集HighD为例进行详细说明。
具体地,HighD数据集中的换道轨迹共5600多条,从中剔除多次变道的数据,并提取出换道过程中周车符合图5所示的环境的换道轨迹,从中随机选择1000条换道轨迹作为研究对象。
如图6所示,图6(a)至图6(c)分别是这些换道轨迹的纵向位移
Figure 326156DEST_PATH_IMAGE048
、纵向初始速度
Figure 11215DEST_PATH_IMAGE049
和平均等效纵向加速度
Figure 96982DEST_PATH_IMAGE050
的实测结果的统计分布图。由图6可知,纵向位移
Figure 918308DEST_PATH_IMAGE051
服从正态分布,换道过程纵向位移分布在
Figure 64119DEST_PATH_IMAGE052
的区间内。初始纵向速度
Figure 767632DEST_PATH_IMAGE049
呈双峰分布,且集中在
Figure 922670DEST_PATH_IMAGE053
的高速行驶区间内。由自车平均纵向加速度
Figure 332923DEST_PATH_IMAGE050
的分布特性可知,受到周车影响,换道过程可能产生平均加速度为负的场景,而在大部分场景下,驾驶员希望维持平均纵向加速度为零的工况,从而把更多的注意力放在顺利完成换道的横向驾驶行为上。
进一步地,如图7所示,图7(a)和图7(b)分别为根据本申请预测获得的当前车辆的换道时长与初始实测换道轨迹对应的换道时长的对比的直方图和散点图,由统计直方图可知,换道时长服从对数正态分布,采用对数正态分布建立起预测换道时长的概率密度曲线与实测获得的换道时长的统计直方图具有高度的一致性,说明本申请预测得到的当前车辆的换道时长的精确性较高。由换道轨迹对应的换道时长与预测的当前车辆的换道时长的散点图对比可知,预测的换道时长均匀的分散在真实值两侧,说明建模的效果较好。
综上,如图8所示,本申请首先从自然驾驶数据中提取完整的换道轨迹,并计算换道时长;其次是利用网联技术获取自车周围车辆的运动学参数,为周车影响下的量化评估提供数据;最后是换道时长建模,在给定换道纵向距离、纵向速度的前提下,结合周车影响下的纵向加速度,可直接由运动学模型求解出换道时长的预测值(利用换道时长预测模型得到的当前车辆的换道时长)。
根据本申请实施例提出的智能汽车换道时长预测及拟人化轨迹规划方法,可以从大量的驾驶员的自然驾驶数据中提取出优秀驾驶员的换道轨迹,并由优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长,然后,获取换道车辆的周车运动信息,并根据周车运动信息建立多车影响下的车辆换道纵向运动学模型,将周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而能够获得多车影响下的换道时长预测模型,这样,当该换道时长预测模型应用到网联多车环境下的智能汽车之后,该智能汽车便可以根据预期换道纵向位移、智能汽车的纵向速度和换道后目标车道预期车速等,结合智能汽车的周车信息,利用换道时长预测模型对智能汽车的换道时长进行优选,进而,可以根据优选获得的智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。由此,解决了相关智能汽车技术中,未能充分量化评估周围车辆对自车换道过程中纵向驾驶行为的影响,而导致的换道时长决策合理性不足、可解释性差和可能存在的安全风险的问题,本发明的实施例,充分挖掘大量驾驶员的自然驾驶数据中优秀驾驶员的驾驶操纵规律,为智能汽车科学合理的换道决策提供参考,使智能汽车的换道过程更为合理,进而提升智能汽车的安全性和可靠性,是智能汽车“学习人、模拟人、超越人和服务人”的拟人化决策理念在换道决策中的体现。
其次参照附图描述根据本申请实施例提出的智能汽车换道时长预测及拟人化轨迹规划装置。
图9是本申请实施例的智能汽车换道时长预测及拟人化轨迹规划装置的方框示意图。
如图9所示,该智能汽车换道时长预测及拟人化轨迹规划装置10包括:提取模块100、生成模块200和换道轨迹规划模块300。
其中,提取模块100用于从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长;
生成模块200用于获取换道车辆的周车运动信息,并根据所述周车运动信息建立多车影响下的车辆换道纵向运动学模型,以及将所述周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数;以及
换道轨迹规划模块300用于在网联多车环境下的所述智能汽车应用所述换道时长预测模型进行决策的情况下,当下达换道指令时,基于预期换道纵向位移、所述智能汽车的纵向速度和换道后目标车道预期车速,结合所述智能汽车的周车信息,利用所述换道时长预测模型对所述智能汽车的换道时长进行优选,并根据优选获得的所述智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。
可选地,提取模块100具体用于:
计算所述优秀驾驶员的换道轨迹的朝向角;
基于所述朝向角从所述自然驾驶数据中确定峰值点,并且由所述峰值点向两边搜索,得到满足预设条件的时间点;
由所述时间点匹配对应的换道轨迹的初始区间;
根据所述初始区间计算所述换道轨迹侧向加速度峰-峰值时间差,并基于所述时间差计算侧向加速度取得最大值和最小值时对应的时间点,得到所述换道轨迹在真实多车影响下的优秀驾驶员换道时长。
可选地,生成模块200具体用于:
对所述换道车辆的平均纵向加速度进行加速度修正,得到修正后的平均纵向加速度,将所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射;
根据所述多车影响下的车辆换道纵向运动学模型和所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射,得到所述多车影响下的换道时长预测模型和辨识获得的模型参数。
可选地,所述换道时长预测模型为:
Figure 915214DEST_PATH_IMAGE042
其中,
Figure 106024DEST_PATH_IMAGE002
为自车的换道时长,
Figure 799173DEST_PATH_IMAGE003
为所述自车预期换道纵向位移、
Figure 329512DEST_PATH_IMAGE004
为所述自车平均纵向加速度,
Figure 879442DEST_PATH_IMAGE005
为所述自车换道后在目标车道的预期车速。
可选地,所述预期换道纵向位移是根据纵向位置、纵向速度和纵向加速度状态函数确定的。
需要说明的是,前述对智能汽车换道时长预测及拟人化轨迹规划方法实施例的解释说明也适用于该实施例的智能汽车换道时长预测及拟人化轨迹规划装置,此处不再赘述。
根据本申请实施例提出的智能汽车换道时长预测及拟人化轨迹规划装置,可以从大量的驾驶员的自然驾驶数据中提取出优秀驾驶员的换道轨迹,并由优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长,然后,获取换道车辆的周车运动信息,并根据周车运动信息建立多车影响下的车辆换道纵向运动学模型,将周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而能够获得多车影响下的换道时长预测模型,这样,当该换道时长预测模型应用到网联多车环境下的智能汽车之后,该智能汽车便可以根据预期换道纵向位移、智能汽车的纵向速度和换道后目标车道预期车速等,结合智能汽车的周车信息,利用换道时长预测模型对智能汽车的换道时长进行优选,进而,可以根据优选获得的智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。由此,解决了相关智能汽车技术中,未能充分量化评估周围车辆对自车换道过程中纵向驾驶行为的影响,而导致的换道时长决策合理性不足、可解释性差和可能存在的安全风险的问题,本发明的实施例,充分挖掘大量驾驶员的自然驾驶数据中优秀驾驶员的驾驶操纵规律,为智能汽车科学合理的换道决策提供参考,使智能汽车的换道过程更为合理,进而提升智能汽车的安全性和可靠性,是智能汽车“学习人、模拟人、超越人和服务人”的拟人化决策理念在换道决策中的体现。
另外,本申请实施例提供一种智能汽车换道轨迹决策设备,包括:换道意图识别模块和换道轨迹规划模块,其中,如上述任意一个实施例所述的智能汽车换道时长预测及拟人化轨迹规划方法服务于所述换道意图识别模块和换道轨迹规划模块。
此外,本申请第四方面实施例提供一种换道轨迹跟踪模块,其上存储有计算机程序,其特征在于,该程序被处理器执行,以用于实现上述的智能汽车换道时长预测及拟人化轨迹规划方法。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本申请的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不必须针对的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任一个或N个实施例或示例中以合适的方式结合。此外,在不相互矛盾的情况下,本领域的技术人员可以将本说明书中描述的不同实施例或示例以及不同实施例或示例的特征进行结合和组合。
此外,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。在本申请的描述中,“N个”的含义是至少两个,例如两个,三个等,除非另有明确具体的限定。
流程图中或在此以其他方式描述的任何过程或方法描述可以被理解为,表示包括一个或更N个用于实现定制逻辑功能或过程的步骤的可执行指令的代码的模块、片段或部分,并且本申请的优选实施方式的范围包括另外的实现,其中可以不按所示出或讨论的顺序,包括根据所涉及的功能按基本同时的方式或按相反的顺序,来执行功能,这应被本申请的实施例所属技术领域的技术人员所理解。
在流程图中表示或在此以其他方式描述的逻辑和/或步骤,例如,可以被认为是用于实现逻辑功能的可执行指令的定序列表,可以具体实现在任何计算机可读介质中,以供指令执行***、装置或设备(如基于计算机的***、包括处理器的***或其他可以从指令执行***、装置或设备取指令并执行指令的***)使用,或结合这些指令执行***、装置或设备而使用。就本说明书而言,"计算机可读介质"可以是任何可以包含、存储、通信、传播或传输程序以供指令执行***、装置或设备或结合这些指令执行***、装置或设备而使用的装置。计算机可读介质的更具体的示例(非穷尽性列表)包括以下:具有一个或N个布线的电连接部(电子装置),便携式计算机盘盒(磁装置),随机存取存储器(RAM),只读存储器(ROM),可擦除可编辑只读存储器(EPROM或闪速存储器),光纤装置,以及便携式光盘只读存储器(CDROM)。另外,计算机可读介质甚至可以是可在其上打印所述程序的纸或其他合适的介质,因为可以例如通过对纸或其他介质进行光学扫描,接着进行编辑、解译或必要时以其他合适方式进行处理来以电子方式获得所述程序,然后将其存储在计算机存储器中。
应当理解,本申请的各部分可以用硬件、软件、固件或它们的组合来实现。在上述实施方式中,N个步骤或方法可以用存储在存储器中且由合适的指令执行***执行的软件或固件来实现。如,如果用硬件来实现和在另一实施方式中一样,可用本领域公知的下列技术中的任一项或他们的组合来实现:具有用于对数据信号实现逻辑功能的逻辑门电路的离散逻辑电路,具有合适的组合逻辑门电路的专用集成电路,可编程门阵列(PGA),现场可编程门阵列(FPGA)等。
本技术领域的普通技术人员可以理解实现上述实施例方法携带的全部或部分步骤是可以通过程序来指令相关的硬件完成,所述的程序可以存储于一种计算机可读存储介质中,该程序在执行时,包括方法实施例的步骤之一或其组合。
此外,在本申请各个实施例中的各功能单元可以集成在一个处理模块中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个模块中。上述集成的模块既可以采用硬件的形式实现,也可以采用软件功能模块的形式实现。所述集成的模块如果以软件功能模块的形式实现并作为独立的产品销售或使用时,也可以存储在一个计算机可读取存储介质中。
上述提到的存储介质可以是只读存储器,磁盘或光盘等。尽管上面已经示出和描述了本申请的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本申请的限制,本领域的普通技术人员在本申请的范围内可以对上述实施例进行变化、修改、替换和变型。

Claims (9)

1.一种智能汽车换道时长预测及拟人化轨迹规划方法,其特征在于,包括以下步骤:
从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长;
获取换道车辆的周车运动信息,并根据所述周车运动信息建立多车影响下的车辆换道纵向运动学模型,以及将所述周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数,所述换道时长预测模型为:
Figure 822468DEST_PATH_IMAGE001
,其中,
Figure 497163DEST_PATH_IMAGE002
为自车的换道时长,
Figure 20548DEST_PATH_IMAGE003
为所述自车预期换道纵向位移,
Figure 450392DEST_PATH_IMAGE004
为所述自车平均纵向加速度,
Figure 629701DEST_PATH_IMAGE005
为所述自车换道后在目标车道的预期车速;
在网联多车环境下的智能汽车应用所述换道时长预测模型进行决策的情况下,当下达换道指令时,基于预期换道纵向位移、所述智能汽车的纵向速度和换道后目标车道预期车速,结合所述智能汽车的周车信息,利用所述换道时长预测模型对所述智能汽车的换道时长进行优选,并根据优选获得的所述智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。
2.根据权利要求1所述的方法,其特征在于,所述从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长,包括:
计算所述优秀驾驶员的换道轨迹的朝向角;
基于所述朝向角从所述自然驾驶数据中确定峰值点,并且由所述峰值点向两边搜索,得到满足预设条件的时间点;
由所述时间点匹配对应的换道轨迹的初始区间;
根据所述初始区间计算所述换道轨迹侧向加速度峰-峰值时间差,并基于所述时间差计算侧向加速度取得最大值和最小值时对应的时间点,得到所述换道轨迹在真实多车影响下的优秀驾驶员换道时长。
3.根据权利要求1所述的方法,其特征在于,所述获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数,包括:
对所述换道车辆的平均纵向加速度进行加速度修正,得到修正后的平均纵向加速度,将所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射;
根据所述多车影响下的车辆换道纵向运动学模型和所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射,得到所述多车影响下的换道时长预测模型和辨识获得的模型参数。
4.根据权利要求1所述的方法,其特征在于,其中,所述预期换道纵向位移是根据纵向位置、纵向速度和纵向加速度状态函数确定的。
5.一种智能汽车换道时长预测及拟人化轨迹规划装置,其特征在于,包括:
提取模块,用于从若干驾驶员的自然驾驶数据中提取优秀驾驶员的换道轨迹,并由所述优秀驾驶员的换道轨迹提取真实多车影响下的优秀驾驶员换道时长;
生成模块,用于获取换道车辆的周车运动信息,并根据所述周车运动信息建立多车影响下的车辆换道纵向运动学模型,以及将所述周车的影响表征为周车运动学参数对换道车辆的平均纵向加速度的非线性映射,进而获得训练好的多车影响下的换道时长预测模型和辨识获得的模型参数,所述换道时长预测模型为:
Figure 904824DEST_PATH_IMAGE001
,其中,
Figure 984513DEST_PATH_IMAGE002
为自车的换道时长,
Figure 319680DEST_PATH_IMAGE003
为所述自车预期换道纵向位移,
Figure 48601DEST_PATH_IMAGE004
为所述自车平均纵向加速度,
Figure 65099DEST_PATH_IMAGE005
为所述自车换道后在目标车道的预期车速;以及
换道轨迹规划模块,用于在网联多车环境下的所述智能汽车应用所述换道时长预测模型进行决策的情况下,当下达换道指令时,基于预期换道纵向位移、所述智能汽车的纵向速度和换道后目标车道预期车速,结合所述智能汽车的周车信息,利用所述换道时长预测模型对所述智能汽车的换道时长进行优选,并根据优选获得的所述智能汽车的换道时长进行拟人化的轨迹规划,以实现所述智能汽车换道意图的准确实施。
6.根据权利要求5所述的装置,其特征在于,所述提取模块,具体用于:
计算所述优秀驾驶员的换道轨迹的朝向角;
基于所述朝向角从所述自然驾驶数据中确定峰值点,并且由所述峰值点向两边搜索,得到满足预设条件的时间点;
由所述时间点匹配对应的换道轨迹的初始区间;
根据所述初始区间计算所述换道轨迹侧向加速度峰-峰值时间差,并基于所述时间差计算侧向加速度取得最大值和最小值时对应的时间点,得到所述换道轨迹在真实多车影响下的优秀驾驶员换道时长。
7.根据权利要求5所述的装置,其特征在于,所述生成模块,具体用于:
对所述换道车辆的平均纵向加速度进行加速度修正,得到修正后的平均纵向加速度,将所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射;
根据所述多车影响下的车辆换道纵向运动学模型和所述周车的影响表征为周车运动学参数对换道车辆的所述平均纵向加速度的非线性映射,得到所述多车影响下的换道时长预测模型和辨识获得的模型参数。
8.一种智能汽车换道轨迹决策设备,其特征在于,包括:换道意图识别模块和换道轨迹规划模块,其中,如权利要求1-4任一项所述的智能汽车换道时长预测及拟人化轨迹规划方法服务于所述换道意图识别模块和换道轨迹规划模块。
9.一种换道轨迹跟踪模块,其上存储有计算机程序,其特征在于,该程序被处理器执行,以用于实现如权利要求1-4任一项所述的智能汽车换道时长预测及拟人化轨迹规划方法。
CN202111237247.1A 2021-10-22 2021-10-22 智能汽车换道时长预测及拟人化轨迹规划方法 Active CN113665574B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111237247.1A CN113665574B (zh) 2021-10-22 2021-10-22 智能汽车换道时长预测及拟人化轨迹规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111237247.1A CN113665574B (zh) 2021-10-22 2021-10-22 智能汽车换道时长预测及拟人化轨迹规划方法

Publications (2)

Publication Number Publication Date
CN113665574A CN113665574A (zh) 2021-11-19
CN113665574B true CN113665574B (zh) 2022-01-11

Family

ID=78550986

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111237247.1A Active CN113665574B (zh) 2021-10-22 2021-10-22 智能汽车换道时长预测及拟人化轨迹规划方法

Country Status (1)

Country Link
CN (1) CN113665574B (zh)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114169371B (zh) * 2021-12-09 2024-05-14 合肥工业大学智能制造技术研究院 车辆换道工况下考虑风险势场分布的驾驶风格分类方法
CN114056332B (zh) * 2022-01-14 2022-04-12 清华大学 基于认知风险平衡的智能汽车跟车决策和控制方法
CN114633750A (zh) * 2022-03-29 2022-06-17 山东交通学院 一种基于无监督技术的换道过程提取及换道特性分析方法
CN114475608B (zh) * 2022-04-13 2022-07-12 清华大学 自动驾驶车辆的拟人化换道方法、装置、车辆及存储介质
CN114475607B (zh) * 2022-04-13 2022-07-12 清华大学 自动驾驶车辆的拟人化换道方法、装置、车辆及存储介质
CN115050183B (zh) * 2022-06-09 2023-07-25 上海人工智能创新中心 一种生成模拟交通流的方法
CN115830886B (zh) * 2023-02-09 2023-05-12 西南交通大学 智能网联车辆协同换道时序计算方法、装置、设备及介质

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103754221B (zh) * 2014-01-24 2017-05-24 清华大学 一种车辆自适应巡航控制***
JP6986239B2 (ja) * 2016-08-25 2021-12-22 スズキ株式会社 車両の走行制御装置
JP2018030479A (ja) * 2016-08-25 2018-03-01 スズキ株式会社 車両の走行制御装置
CN109739218A (zh) * 2018-12-24 2019-05-10 江苏大学 一种基于gru网络的仿优秀驾驶员换道模型建立方法
CN110576864A (zh) * 2019-08-15 2019-12-17 中国第一汽车股份有限公司 驾驶模式的控制方法、装置、车辆及存储介质
CN110936958B (zh) * 2019-11-26 2021-01-19 交通运输部公路科学研究所 自动驾驶换道轨迹优化方法及其***
CN111009153B (zh) * 2019-12-04 2021-10-15 珠海深圳清华大学研究院创新中心 一种轨迹预测模型的训练方法、装置和设备
CN111260956B (zh) * 2020-01-15 2021-03-16 清华大学 一种基于模型预测控制的车辆自动换道规划与控制方法
CN112053589B (zh) * 2020-08-18 2022-05-24 北京航空航天大学 一种目标车辆换道行为自适应识别模型构建方法

Also Published As

Publication number Publication date
CN113665574A (zh) 2021-11-19

Similar Documents

Publication Publication Date Title
CN113665574B (zh) 智能汽车换道时长预测及拟人化轨迹规划方法
CN106428009B (zh) 车辆轨迹确定的***和方法
CN109213134B (zh) 生成自动驾驶策略的方法和装置
CN110562258B (zh) 一种车辆自动换道决策的方法、车载设备和存储介质
US9053433B2 (en) Assisting vehicle guidance over terrain
US20130052614A1 (en) Driver Performance Metric
CN104875740B (zh) 用于管理跟随空间的方法、主车辆以及跟随空间管理单元
Dong et al. Smooth behavioral estimation for ramp merging control in autonomous driving
US20210397198A1 (en) Enhanced vehicle operation
EP2405383A1 (en) Assisting with guiding a vehicle over terrain
CN113942526A (zh) 一种基于可接受风险的自动驾驶超车轨迹规划方法
US20210276546A1 (en) Vehicle detection and response
CN115923833A (zh) 车辆的拟人化决策控制方法、装置、车辆及存储介质
CN114730494A (zh) 用于对交通场景的空间的覆盖进行估计的方法
Wheeler et al. A probabilistic framework for microscopic traffic propagation
JP2020075561A (ja) 走行範囲取得システム、車両制御システムおよび走行範囲取得プログラム
CN116448134B (zh) 基于风险场与不确定分析的车辆路径规划方法及装置
Akca et al. eTS fuzzy driver model for simultaneous longitudinal and lateral vehicle control
CN116262507A (zh) 人类数据驱动的可解释人工智能***和方法
Salzmann et al. Online Path Generation from Sensor Data for Highly Automated Driving Functions
Mechernene et al. Lane change decision algorithm based on risk prediction and fuzzy logic method
Pavelko et al. Modification and Experimental Validation of a Logistic Regression Vehicle-Pedestrian Model
US20240043022A1 (en) Method, system, and computer program product for objective assessment of the performance of an adas/ads system
US20230195977A1 (en) Method and system for classifying scenarios of a virtual test, and training method
EP4338052A1 (en) Tools for testing autonomous vehicle planners

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