[go: up one dir, main page]

CN115257803B - 一种适用于高速自动驾驶功能场景提取方法 - Google Patents

一种适用于高速自动驾驶功能场景提取方法

Info

Publication number
CN115257803B
CN115257803B CN202210765745.1A CN202210765745A CN115257803B CN 115257803 B CN115257803 B CN 115257803B CN 202210765745 A CN202210765745 A CN 202210765745A CN 115257803 B CN115257803 B CN 115257803B
Authority
CN
China
Prior art keywords
vehicle
data
speed
scene
target
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
CN202210765745.1A
Other languages
English (en)
Other versions
CN115257803A (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.)
FAW Group Corp
Original Assignee
FAW Group Corp
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 FAW Group Corp filed Critical FAW Group Corp
Priority to CN202210765745.1A priority Critical patent/CN115257803B/zh
Publication of CN115257803A publication Critical patent/CN115257803A/zh
Application granted granted Critical
Publication of CN115257803B publication Critical patent/CN115257803B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • 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
    • 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/06Direction of travel
    • 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • B60W2520/105Longitudinal 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/12Lateral speed
    • B60W2520/125Lateral 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/18Steering angle

Landscapes

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

Abstract

一种适用于高速自动驾驶功能场景提取方法,所述方法包括:将数据采集设备固定在本车上,实时采集本车和目标车相关数据;以本车车速、周围目标车个数创建数据分区序号列,使采集的数据按照本车车速、周围目标车个数的数据分区序号列进行分区;对获得的每个分区执行数据清洗;依据清洗后的数据,将本车的行驶参数进行处理后获得本车预测行驶区域,进入本车预测行驶区域的目标物标记为前方目标物;对高速自动驾驶功能场景进行分类,将高速自动驾驶功能场景的跟车场景、切入场景和切出场景进行数据提取;对提取场景数据进行整合后,在1到N之间分别随机选取不重复的n1和n2个整数,对应的数值就是检验的编号,按照编号对提取的数据进行检验。

Description

一种适用于高速自动驾驶功能场景提取方法
技术领域
本发明涉及高速自动驾驶功能场景技术领域,具体涉及一种适用于高速自动驾驶功能场景提取方法。
背景技术
随着国内智能汽车逐步达到L3/L4级,主要涉及拥堵跟车、高速代驾和代客泊车等ADAS功能;其中,最常用的即为高速自动驾驶功能,可实现根据前车的速度与车道线自动调整跟车速度,并辅助驾驶员使车辆保持在自身车道内。
提取高速自动驾驶功能相关的具有代表性的场景,进行数据切片与提取,对数据片段进行分析,为高速自动驾驶功能决策模型研发及试验验证提供对应的场景数据支持。
但超高的数采频率以及超长的数据采集里程使车辆数据呈指数级爆炸式增长,包含场景达到数百万个,如何能从中提取高速自动驾驶功能具备代表性的有效场景,进行数据提取,成为一大难点。
现有技术中,专利文献CN114064656A公开了“一种基于路端感知系统的自动驾驶场景识别与转化方法”,可以将路端感知系统采集到大量驾驶数据进行识别、转化,输出带有功能标记的切片数据,为自动驾驶训练的大体量数据库的建设提供数据源,而本发明靠主车的传感器,且仅有一台主车的情况下,进行场景的准确快速切分。专利文献CN114067243A公开了“一种自动驾驶场景识别方法、系统、设备及介质”,能够准确区分当前环境特征和差异性,实现环境的深度聚类,辅助自动驾驶决策算法迁移,而并非本发明的场景切分方法。
因此,现有的技术手段无法从高速自动驾驶功能的大量数据中提取出具备代表性的有效场景数据。
发明内容
本发明解决了现有的技术手段无法从高速自动驾驶功能的大量数据中提取出具备代表性的有效场景数据的问题。
本发明所述的一种适用于高速自动驾驶功能场景提取方法,包括以下步骤:
步骤S1,将数据采集设备固定在本车上,采集本车和目标车相关数据;
步骤S2,以本车车速、周围目标车个数创建数据分区序号列,使采集的数据按照本车车速、周围目标车个数的数据分区序号列进行分区;
步骤S3,对步骤S2获得的每个分区执行数据清洗;
步骤S4,依据步骤S3清洗后的数据,将本车的行驶参数进行处理后获得本车预测行驶区域,进入本车预测行驶区域的目标物标记为前方目标物;
步骤S5,对高速自动驾驶功能场景进行分类,将高速自动驾驶功能场景的跟车场景、切入场景和切出场景进行数据提取;
步骤S6,对提取场景数据进行整合后,在1到N之间分别随机选取不重复的n1和n2个整数,对应的数值就是检验的编号,按照编号对提取的数据进行检验。
进一步地,在本发明的一个实施例中,所述的步骤S1中,所述的数据采集设备包括毫米波雷达、智能摄像头和激光雷达。
进一步地,在本发明的一个实施例中,所述的步骤S1中,所述的本车相关数据包括本车车速、本车横向加速度、本车纵向加速度、本车方向盘转角、本车航向角、本车经度和本车纬度;
所述的目标车相关数据包括目标车与本车相对纵向距离、目标车与本车相对横向距离、目标车与本车相对速度、目标车与本车绝对速度、目标车绝对横向加速度和目标车绝对纵向加速度。
进一步地,在本发明的一个实施例中,所述的步骤S3中,所述的每个分区执行数据清洗,包括以下步骤:
步骤S301,对本车车速、目标车与本车相对速度和目标车与本车绝对速度数据进行二阶样条曲线插值升采样;
步骤S302,构造高斯核函数的标准差,确定均值后,开始执行卷积运算;
步骤S303,将本车车速、目标车与本车相对速度和目标车与本车绝对速度数据等间隔降采样至其数据原采样频率。
进一步地,在本发明的一个实施例中,所述的步骤S303中,所述的卷积运算公式为:
式中,y(n)为滤波后的更新值,G(i)为高斯核函数模板,h(n-i)为本车车速、目标车与本车相对速度和目标车与本车绝对速度的原始数据。
进一步地,在本发明的一个实施例中,所述的步骤S4中,所述的将本车的行驶参数进行处理后获得本车预测行驶区域,包括以下步骤:
步骤S401,获取已采集的本车行驶曲率和本车方向盘转角数据;
步骤S402,求本车行驶曲率和本车方向盘转角数据的加权平均值,以本车行驶轨迹为原点,本车前进方向延长为本车预测路径;
步骤S403,将本车预测路径分别向两侧沿径向方向平移1/2车道宽度,得到本车预测行驶区域。
进一步地,在本发明的一个实施例中,所述的步骤S5中,所述的跟车场景包括跟车起步、匀速跟车、跟车加速、跟车减速、跟车刹停、本车道超越和弯道行驶。
进一步地,在本发明的一个实施例中,所述的步骤S5中,所述的高速自动驾驶功能场景的跟车场景、切入场景和切出场景进行数据提取的原则为:
以目标车与本车相对速度为提取条件,当相对速度介于不同区间时,则目标车与本车处于不同的交互状态;
对目标车与本车处于不同的交互状态创建标识列,当相对速度>0时,该列标识列为0,否则为1;
对目标车与本车处于不同的交互状态标识列进行求导,得到其标识列的导数列,并将末尾值置1;
对目标车与本车处于不同的交互状态标识列进行反向求导,得到其标识列的反导数列,并将首位值置1;
筛选导数列与反导数列中非0的值对应的时间点,则反导数列非0的点与导数列为0的点对应的时间轴组成每个相对速度区间的起终点时刻;
组成单数顺位的相对速度区间则为第一个区间对应的本车状态,偶数顺位的则相反。
当两段连续的相同状态间隔小于1s时,则进行合并;
目标车与本车初始动作均为循线。
进一步地,在本发明的一个实施例中,所述的步骤S6中,所述的对提取场景数据进行整合,包括以下步骤:
步骤S601,选取150~180个提取的场景数据;
步骤S602,将所要检验的场景数据从1开始依次递增进行编号;
步骤S603,根据选取的场景数据量和预期准确率,设定对应检验轮次的场景数据数量、接收限和拒绝限。
进一步地,在本发明的一个实施例中,所述的步骤S6中,所述的按照编号对提取的数据进行检验,具体为:
若在第一次检验场景数据中发现的不合格数量d1小于或等于Ac1,认为检验结果是接收;
若在第一次检验场景数据中发现的不合格数量d1大于或等于Re1,认为检验结果是拒绝;
若第一次检验场景数据中发现的不合格数量d1介于Ac1与Re1之间,按照方案进行第二次检验,并累计两次检验的不合格数量,即d1+d2;
若d1与d2的和小于或等于接收限Ac2,认为检验结果是接收;
若d1与d2的和大于或等于拒绝限Re2,认为检验结果是拒绝。
本发明解决了现有的技术手段无法从高速自动驾驶功能的大量数据中提取出具备代表性的有效场景数据的问题。具体有益效果包括:
1、本发明所述的一种适用于高速自动驾驶功能场景提取方法,对自然驾驶场景数据中本车车速、目标车辆速度、目标车辆距本车的横纵向距离等客观数据,通过创新使用分区算法、清洗算法、基于相对速度的场景识别算法、场景提取算法,实现大数据高效自动化高速自动驾驶功能场景数据提取。
2、本发明所述的一种适用于高速自动驾驶功能场景提取方法,通过基于高斯核函数的数据清洗算法,能够更准确的修正干扰功能场景数据。
3、本发明所述的一种适用于高速自动驾驶功能场景提取方法,使用基于目标车相对速度的场景识别算法,减少算法参数。
4、本发明所述的一种适用于高速自动驾驶功能场景提取方法,以车辆速度、周围目标物个数创建数据分区序号列,使得采集数据按照该列进行分区,采用分区算法进行并行计算,大大缩短计算时间。
附图说明
本发明上述的和/或附加的方面和优点从下面结合附图对实施例的描述中将变得明显和容易理解,其中:
图1是具体实施方式所述的功能场景提取方法总体流程图。
图2是具体实施方式所述的分区流程图。
图3是具体实施方式所述的二次样条求解图。
图4是具体实施方式所述的预测行驶区域示意图。
图5是具体实施方式所述的跟车关键场景图。
图6是具体实施方式所述的本车状态提取方法图。
图7是具体实施方式所述的切入关键场景图。
图8是具体实施方式所述的切出关键场景图。
图9是具体实施方式所述的二次抽样检验流程图。
具体实施方式
下面结合附图将对本发明的多种实施方式进行清楚、完整地描述。通过参考附图描述的实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。
本实施方式所述的一种适用于高速自动驾驶功能场景提取方法,包括以下步骤:
步骤S1,将数据采集设备固定在本车上,采集本车和目标车相关数据;
步骤S2,以本车车速、周围目标车个数创建数据分区序号列,使采集的数据按照本车车速、周围目标车个数的数据分区序号列进行分区;
步骤S3,对步骤S2获得的每个分区执行数据清洗;
步骤S4,依据步骤S3清洗后的数据,将本车的行驶参数进行处理后获得本车预测行驶区域,进入本车预测行驶区域的目标物标记为前方目标物;
步骤S5,对高速自动驾驶功能场景进行分类,将高速自动驾驶功能场景的跟车场景、切入场景和切出场景进行数据提取;
步骤S6,对提取场景数据进行整合后,在1到N之间分别随机选取不重复的n1和n2个整数,对应的数值就是检验的编号,按照编号对提取的数据进行检验。
本实施方式中,所述的步骤S1中,所述的数据采集设备包括毫米波雷达、智能摄像头和激光雷达。
本实施方式中,所述的步骤S1中,所述的本车相关数据包括本车车速、本车横向加速度、本车纵向加速度、本车方向盘转角、本车航向角、本车经度和本车纬度;
所述的目标车相关数据包括目标车与本车相对纵向距离、目标车与本车相对横向距离、目标车与本车相对速度、目标车与本车绝对速度、目标车绝对横向加速度和目标车绝对纵向加速度。
本实施方式中,所述的步骤S3中,所述的每个分区执行数据清洗,包括以下步骤:
步骤S301,对本车车速、目标车与本车相对速度和目标车与本车绝对速度数据进行二阶样条曲线插值升采样;
步骤S302,构造高斯核函数的标准差,确定均值后,开始执行卷积运算;
步骤S303,将本车车速、目标车与本车相对速度和目标车与本车绝对速度数据等间隔降采样至其数据原采样频率。
本实施方式中,所述的步骤S303中,所述的卷积运算公式为:
式中,y(n)为滤波后的更新值,G(i)为高斯核函数模板,h(n-i)为本车车速、目标车与本车相对速度和目标车与本车绝对速度的原始数据。
本实施方式中,所述的步骤S4中,所述的将本车的行驶参数进行处理后获得本车预测行驶区域,包括以下步骤:
步骤S401,获取已采集的本车行驶曲率和本车方向盘转角数据;
步骤S402,求本车行驶曲率和本车方向盘转角数据的加权平均值,以本车行驶轨迹为原点,本车前进方向延长为本车预测路径;
步骤S403,将本车预测路径分别向两侧沿径向方向平移1/2车道宽度,得到本车预测行驶区域。
本实施方式中,所述的步骤S5中,所述的跟车场景包括跟车起步、匀速跟车、跟车加速、跟车减速、跟车刹停、本车道超越和弯道行驶。
本实施方式中,所述的步骤S5中,所述的高速自动驾驶功能场景的跟车场景、切入场景和切出场景进行数据提取的原则为:
以目标车与本车相对速度为提取条件,当相对速度介于不同区间时,则目标车与本车处于不同的交互状态;
对目标车与本车处于不同的交互状态创建标识列,当相对速度>0时,该列标识列为0,否则为1;
对目标车与本车处于不同的交互状态标识列进行求导,得到其标识列的导数列,并将末尾值置1;
对目标车与本车处于不同的交互状态标识列进行反向求导,得到其标识列的反导数列,并将首位值置1;
筛选导数列与反导数列中非0的值对应的时间点,则反导数列非0的点与导数列为0的点对应的时间轴组成每个相对速度区间的起终点时刻;
组成单数顺位的相对速度区间则为第一个区间对应的本车状态,偶数顺位的则相反。
当两段连续的相同状态间隔小于1s时,则进行合并;
目标车与本车初始动作均为循线。
本实施方式中,所述的步骤S6中,所述的对提取场景数据进行整合,包括以下步骤:
步骤S601,选取150~180个提取的场景数据;
步骤S602,将所要检验的场景数据从1开始依次递增进行编号;
步骤S603,根据选取的场景数据量和预期准确率,设定对应检验轮次的场景数据数量、接收限和拒绝限。
本实施方式中,所述的步骤S6中,所述的按照编号对提取的数据进行检验,具体为:
若在第一次检验场景数据中发现的不合格数量d1小于或等于Ac1,认为检验结果是接收;
若在第一次检验场景数据中发现的不合格数量d1大于或等于Re1,认为检验结果是拒绝;
若第一次检验场景数据中发现的不合格数量d1介于Ac1与Re1之间,按照方案进行第二次检验,并累计两次检验的不合格数量,即d1+d2;
若d1与d2的和小于或等于接收限Ac2,认为检验结果是接收;
若d1与d2的和大于或等于拒绝限Re2,认为检验结果是拒绝。
本实施方式基于本发明所述的一种适用于高速自动驾驶功能场景提取方法,结合图1可以更好地理解本实施方式,并结合具体对象提供一种实际的实施方式:
S1数据采集:
S101:数据采集包括毫米波雷达、智能摄像头、激光雷达固定于场景采集车辆周围,实时采集周围交通参与者客观数据。采集的客观数据可满足场景提取数据要求,包含内容如下:
本车:本车速度、本车横向加速度、本车纵向加速度、本车方向盘转角、本车航向角、本车经度、本车纬度。
目标车:与本车相对纵向距离、与本车相对横向距离、与本车相对速度、与本车绝对速度、目标车绝对横向加速度和目标车绝对纵向加速度。
S2以车辆速度、周围目标物个数创建数据分区序号列,使得采集数据按照该列进行分区,保证每个分区内,数据行数大致相同,分区规则如下,流程见图2:
S201首先,选取所有数据中本车车速不为0的数据,将连续的时间点内的数据作为一个分区;
S202将a中每一段分区的终止时间与下一段分区的起始时间之差小于1s的分区进行合并;
S203设定分区结束阈值i为10;
S204计算每个分区的行数与最大分区行数之差,如果大于i%,则按照每个分区中周围目标物数据量小于1为条件,进行再次切割,即在每个车速不为0的区间内,再进行切分;
S205再次判断每个分区的行数与最大分区行数之差,如果仍然大于i%,则按照周围车辆数大于1且相对距离、相对速度2s内稳定不变的条件进行再次分区;
S206再次判断每个分区的行数与最大分区行数之差,如果仍然大于i%,则更新i值为10*循环次数;
S207重复S204~S206步骤,直至条件满足;
若最终i值超过30,则需对数据进行清洗,滤除,再次进行分区,以保证每个分区的数据行数与最大分区行数之差小于30%。
S3数据清洗:
S301针对每个分区,执行数据清洗步骤;
S302对本车速度、目标车绝对速度、相对速度数据进行二阶样条曲线插值升采样,将数据采样率提升至至少100Hz,插值方法如下:
假设4个点,x0,x1,x2,x3,有3个区间,需要3个二次样条,每个二次样条为ax^2+bx+c,故总计9个未知数,如图3所示。
图中x0与x3两个端点都有一个二次函数经过,可确定2个方程。
X1和x2两个中间点都有两个二次函数经过,可确定4个方程。
中间点处必须连接,需要保证左右二次函数一阶导相等,即:
2a1x1+b1=2a2x2+b2
2a2x2+b2=2a3x3+b3
可确定2个方程,此时有了8个方程。
采用自由边界进行约束,则2a0x0+b0=0。
共计9个未知数,联立9个方程求解,完成升采样。
S303构造高斯核函数的标准差为σ,均值为μ=15,以均值以外μ±nσ=4标准差的长度进行截断的高斯模板,如下;
S304执行卷积运算;
式中。y(n)为滤波后的更新值,G(i)为高斯核函数模板,h(n-i)为原始数据。
S305执行降采样,将数据等间隔降采样至原采样频率。
S4前方目标车辆识别:
S401获取传感器采集的本车行驶曲率,获取本车方向盘转角;
S402依据方向盘转角与本车行驶曲率加权平均,将本车当前行驶轨迹以前保中心为原点,车辆前进方向延长,作为预测路径;
S403将预测路径分别向两侧沿径向方向平移1/2车道宽度,得到预测行驶区域,如图4所示。
S404当探测的目标物侵入本车预测行驶区域时,则该目标物则标记为前方目标物。
S5功能场景识别:
S501对高速自动驾驶功能场景进行分类如何分类,将本车前方有目标车的情况,定义为跟车场景,对跟车场景中的关键场景进行提取,关键场景如图5所示。
场景提取方法原则如下:
以本车与前方目标车相对速度为主要提取条件,当相对速度介于不同区间时,定义本车与前车处于不同的交互状态,如:当相对速度小于0km/h时,为本车追击前车状态,当相对速度大于0km/h时,为本车接近前车状态,不同状态提取方法如下,如图6所示;
创建标识列名为,当相对速度>0时,该列为0,否则为1;
对标识列进行求导,得到标识列的导数列,并将末尾值置1;
对标识列进行反向求导,得到标识列的反导数列,并将首位值置1;
筛选导数列与反导数列中非0的值对应的时间点,则反导数列非0的点与导数列为0的点对应的时间轴组成每个相对速度区间的起终点时刻;
组成单数顺位的相对速度区间则为第一个区间对应的本车状态,偶数顺位的则相反;
当两段连续的相同状态间隔小于1s时,则进行合并;
本车与目标车初始动作均为循线。
跟车起步提取方法:
筛选相对速度大于0km/h区间,且持续时间大于1s,本车速度在该区间下最小值小于1km/h,本车速度最大值大于5km/h,本车纵向加速度平均值大于0m/s2,目标车绝对速度最大值小于160km/h,目标车绝对速度最小值小于2km/h,目标车纵向绝对加速度平均值大于0m/s2,相对距离最小值小于10m。
匀速跟车提取方法:
提取相对速度介于-5~5km/h区间,且合并后持续时间大于5s,本车速度最小值大于5km/h,本车速度最大值与最小值的差小于5km/h,本车方向盘转角绝对值的最大值小于30°,目标车绝对速度小于160km/h。
跟车加速提取方法:
提取相对速度大于0km/h,且合并后持续时间大于1s;本车速度最小值大于5km/h;本车转向盘转角绝对值小于30°;本车纵向加速度平均值大于0m/s2;目标车纵向绝对加速度平均值大于0m/s2;目标车绝对速度最大值小于160km/h;目标车绝对速度最小值大于0km/h。
跟车减速提取方法:
提取相对速度小于0km/h,且合并后持续时间大于1s;本车速度最小值大于5km/h;本车转向盘转角绝对值的最大值小于30°;本车纵向加速度平均值小于0m/s 2;相对速度小于-5km/h;相对速度平均值大于-60km/h;目标车绝对速度最大值小于160km/h;目标车绝对速度最小值大于0km/h。
跟车刹停提取方法:
提取相对速度小于0km/h,且合并后持续时间大于1s;本车速度最小值小于1km/h;本车速度最大值大于5km/h;本车转向盘转角绝对值的最大值小于30°;本车纵向加速度平均值小于0m/s2;目标车绝对速度最大值小于160km/h;相对距离最小值小于15m;目标车纵向绝对加速度平均值小于0m/s2
本车道超越提取规则:
本车与正右或正左侧车辆相对速度大于0km/h;本车转向盘转角绝对值的最大值小于30°;目标车绝对速度最大值小于160km/h。
弯道行驶提取规则:
提取本车行驶轨迹半径小于1km的区间;当两段连续的区间间隔小于1s时,则进行合并。
S502数据提取方法,将切入关键场景定义如下:
定义:连续的时间段内,目标车与本车的重叠率大于30%,并且目标车横向速度大于设定的阈值,且目标车辆初始在右前侧或右侧,最终重叠率大于90%的过程。
开始时间:目标物与本车重叠率刚开始大于30%(可调)。
结束时间:目标物与本车重叠率达到90%以上或者目标车中心与本车行驶中心的距离小于0.5m(可调)且横向速度低于0.3m/s(可调)。
初始时刻:开始时间后推至目标物出现时刻或目标物接近本车速度小于0.3m/s时刻或开始时间最小值。
本车开始刹车:在切入过程中本车刹车踏板第一次踩下时刻。
本车结束刹车:在切入过程中本车刹车踏板最后一次松开时刻。
如图7所示,本车本车道行驶:目标车辆开始时间在右前侧或右侧。
本车本车道行驶:目标车辆开始时间在左前侧或左侧。
S503数据提取方法,将切出关键场景定义如下:
定义:连续的时间段内,目标车与本车的重叠率大于90%,并且目标车横向速度大于设定值。且最终重叠率小于0%的过程。
开始时间:目标车在本车行驶车道行驶时,横向速度开始增大且最终重叠率小于0%的过程中,横向速度大于0.3m/s(可调)时刻。
结束时间:目标车与本车的重叠率刚开始小于0时刻。
如图8所示,本车本车道行驶:结束时间目标车位于本车右前或者右侧。
本车本车道行驶:结束时间目标车位于本车左前或者左侧。
S6数据提取结果
S601数据提取的每一个场景拥有唯一标识符,标识符存在于提取数据的每一行中;
S602提取的数据包含所有原始数据信息并统一时间轴。
S7数据提取结果检查
S701对提取样本进行整合。
1、选取150~180个提取的场景数据;
2、将需要检验的场景片段,从1开始依次递增作为编号;
3、根据样本量和预期准确率,设定对应检验轮次的样本数量、接收限和拒绝限,其表达式如下:
(n1,n2|Ac1,Re1;Ac2,Re2),式中:n1为第一次检验样本数量;n2为第二次检验样本数量;Ac1为第一次检验的接收限;Re1为第一次检验的拒绝限;Ac2为二次检验的累计接收限;Re2为二次检验的累计拒绝限。
S702在1到N之间分别随机选取不重复的n1和n2个整数,其数值就是需要检验的片段编号;
S703按照编号对提取的数据片段进行检验,检验流程如图9所示;
S705如果在第一次检验样本中发现的不合格数量d1大于或等于Re1,应认为检验结果是拒绝;
S706如果第一次检验样本中发现的不合格数量d1介于Ac1与Re1之间,应按照方案进行第二次检验,并累计两次检验的不合格数量,即d1+d2;
S707如果d1与d2的和小于或等于接收限Ac2,应认为检验结果是接收;如果d1与d2的和大于或等于拒绝限Re2,应认为检验结果是拒绝。
以上对本发明所提出的一种适用于高速自动驾驶功能场景提取方法进行了详细介绍,本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处,综上所述,本说明书内容不应理解为对本发明的限制。

Claims (10)

1.一种适用于高速自动驾驶功能场景提取方法,其特征在于,包括以下步骤:
步骤S1,将数据采集设备固定在本车上,采集本车和目标车相关数据;
步骤S2,以本车车速、周围目标车个数创建数据分区序号列,使采集的数据按照本车车速、周围目标车个数的数据分区序号列进行分区;
步骤S3,对步骤S2获得的每个分区执行数据清洗;
步骤S4,依据步骤S3清洗后的数据,将本车的行驶参数进行处理后获得本车预测行驶区域,进入本车预测行驶区域的目标物标记为前方目标物;
步骤S5,对高速自动驾驶功能场景进行分类,将高速自动驾驶功能场景的跟车场景、切入场景和切出场景进行数据提取;
步骤S6,对提取场景数据进行整合后,在1到N之间分别随机选取不重复的n1和n2个整数,对应的数值就是检验的编号,按照编号对提取的数据进行检验。
2.根据权利要求1所述的一种适用于高速自动驾驶功能场景提取方法,其特征在于,所述的步骤S1中,所述的数据采集设备包括毫米波雷达、智能摄像头和激光雷达。
3.根据权利要求1所述的一种适用于高速自动驾驶功能场景提取方法,其特征在于,所述的步骤S1中,所述的本车相关数据包括本车车速、本车横向加速度、本车纵向加速度、本车方向盘转角、本车航向角、本车经度和本车纬度;
所述的目标车相关数据包括目标车与本车相对纵向距离、目标车与本车相对横向距离、目标车与本车相对速度、目标车绝对速度、目标车绝对横向加速度和目标车绝对纵向加速度。
4.根据权利要求1所述的一种适用于高速自动驾驶功能场景提取方法,其特征在于,所述的步骤S3中,所述的每个分区执行数据清洗,包括以下步骤:
步骤S301,对本车车速、目标车与本车相对速度和目标车绝对速度数据进行二阶样条曲线插值升采样;
步骤S302,构造高斯核函数的标准差,确定均值后,开始执行卷积运算;
步骤S303,将本车车速、目标车与本车相对速度和目标车绝对速度数据等间隔降采样至其数据原采样频率。
5.根据权利要求4所述的一种适用于高速自动驾驶功能场景提取方法,其特征在于,所述的步骤S303中,所述的卷积运算公式为:
式中,y(n)为滤波后的更新值,G(i)为高斯核函数模板,h(n-i)为本车车速、目标车与本车相对速度和目标车绝对速度的原始数据。
6.根据权利要求1所述的一种适用于高速自动驾驶功能场景提取方法,其特征在于,所述的步骤S4中,所述的将本车的行驶参数进行处理后获得本车预测行驶区域,包括以下步骤:
步骤S401,获取已采集的本车行驶曲率和本车方向盘转角数据;
步骤S402,求本车行驶曲率和本车方向盘转角数据的加权平均值,以本车行驶轨迹为原点,本车前进方向延长为本车预测路径;
步骤S403,将本车预测路径分别向两侧沿径向方向平移1/2车道宽度,得到本车预测行驶区域。
7.根据权利要求1所述的一种适用于高速自动驾驶功能场景提取方法,其特征在于,所述的步骤S5中,所述的跟车场景包括跟车起步、匀速跟车、跟车加速、跟车减速、跟车刹停、本车道超越和弯道行驶。
8.根据权利要求1所述的一种适用于高速自动驾驶功能场景提取方法,其特征在于,所述的步骤S5中,所述的高速自动驾驶功能场景的跟车场景、切入场景和切出场景进行数据提取的原则为:
以目标车与本车相对速度为提取条件,当相对速度介于不同区间时,则目标车与本车处于不同的交互状态;
对目标车与本车处于不同的交互状态创建标识列,当相对速度>0时,该列标识列为0,否则为1;
对目标车与本车处于不同的交互状态标识列进行求导,得到其标识列的导数列,并将末尾值置1;
对目标车与本车处于不同的交互状态标识列进行反向求导,得到其标识列的反导数列,并将首位值置1;
筛选导数列与反导数列中非0的值对应的时间点,则反导数列非0的点与导数列为0的点对应的时间轴组成每个相对速度区间的起终点时刻;
组成单数顺位的相对速度区间则为第一个区间对应的本车状态,偶数顺位的则相反;
当两段连续的相同状态间隔小于1s时,则进行合并;
目标车与本车初始动作均为循线。
9.根据权利要求1所述的一种适用于高速自动驾驶功能场景提取方法,其特征在于,所述的步骤S6中,所述的对提取场景数据进行整合,包括以下步骤:
步骤S601,选取150~180个提取的场景数据;
步骤S602,将所要检验的场景数据从1开始依次递增进行编号;
步骤S603,根据选取的场景数据量和预期准确率,设定对应检验轮次的场景数据数量、接收限和拒绝限。
10.根据权利要求1所述的一种适用于高速自动驾驶功能场景提取方法,其特征在于,所述的步骤S6中,所述的按照编号对提取的数据进行检验,具体为:
若在第一次检验场景数据中发现的不合格数量d1小于或等于Ac1,认为检验结果是接收;
若在第一次检验场景数据中发现的不合格数量d1大于或等于Re1,认为检验结果是拒绝;
若第一次检验场景数据中发现的不合格数量d1介于Ac1与Re1之间,按照方案进行第二次检验,并累计两次检验的不合格数量,即d1+d2;
若d1与d2的和小于或等于接收限Ac2,认为检验结果是接收;
若d1与d2的和大于或等于拒绝限Re2,认为检验结果是拒绝。
CN202210765745.1A 2022-07-01 2022-07-01 一种适用于高速自动驾驶功能场景提取方法 Active CN115257803B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210765745.1A CN115257803B (zh) 2022-07-01 2022-07-01 一种适用于高速自动驾驶功能场景提取方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210765745.1A CN115257803B (zh) 2022-07-01 2022-07-01 一种适用于高速自动驾驶功能场景提取方法

Publications (2)

Publication Number Publication Date
CN115257803A CN115257803A (zh) 2022-11-01
CN115257803B true CN115257803B (zh) 2025-08-01

Family

ID=83763099

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210765745.1A Active CN115257803B (zh) 2022-07-01 2022-07-01 一种适用于高速自动驾驶功能场景提取方法

Country Status (1)

Country Link
CN (1) CN115257803B (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116958938A (zh) * 2023-07-28 2023-10-27 安徽江淮汽车集团股份有限公司 一种基于驾驶数据逻辑代码的危险场景提取方法
CN117272690B (zh) * 2023-11-21 2024-02-23 中汽智联技术有限公司 自动驾驶车辆危险切入场景提取方法、设备及介质
CN119884983B (zh) * 2025-03-25 2025-06-03 南昌智能新能源汽车研究院 一种制动意图识别方法、系统、设备及介质

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109910872A (zh) * 2019-03-18 2019-06-21 中国汽车工程研究院股份有限公司 一种基于自然驾驶数据的泊车场景提取系统和方法
CN111324120A (zh) * 2020-02-26 2020-06-23 中汽研汽车检验中心(天津)有限公司 一种自动驾驶前车切入切出场景提取方法

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4289421B2 (ja) * 2007-05-14 2009-07-01 株式会社デンソー 車両制御装置
US11798297B2 (en) * 2017-03-21 2023-10-24 Toyota Motor Europe Nv/Sa Control device, system and method for determining the perceptual load of a visual and dynamic driving scene
JP6779590B2 (ja) * 2017-10-10 2020-11-04 日産自動車株式会社 運転制御方法及び運転制御装置
US11392131B2 (en) * 2018-02-27 2022-07-19 Nauto, Inc. Method for determining driving policy
JP7291015B2 (ja) * 2019-07-03 2023-06-14 日産自動車株式会社 周囲物体認識方法及び周囲物体認識装置
CN111144015A (zh) * 2019-12-30 2020-05-12 吉林大学 一种自动驾驶汽车虚拟场景库构建方法
CN111599181B (zh) * 2020-07-22 2020-10-27 中汽院汽车技术有限公司 用于智能驾驶系统测试的典型自然驾驶场景识别提取方法
CN111599182B (zh) * 2020-07-22 2020-10-20 中汽院汽车技术有限公司 一种基于自然驾驶数据的换道行为自动提取方法
CN114637667A (zh) * 2022-02-24 2022-06-17 中国第一汽车股份有限公司 自然驾驶场景数据特征点选取的场地测试用例提取方法与系统

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109910872A (zh) * 2019-03-18 2019-06-21 中国汽车工程研究院股份有限公司 一种基于自然驾驶数据的泊车场景提取系统和方法
CN111324120A (zh) * 2020-02-26 2020-06-23 中汽研汽车检验中心(天津)有限公司 一种自动驾驶前车切入切出场景提取方法

Also Published As

Publication number Publication date
CN115257803A (zh) 2022-11-01

Similar Documents

Publication Publication Date Title
CN115257803B (zh) 一种适用于高速自动驾驶功能场景提取方法
CN111599181B (zh) 用于智能驾驶系统测试的典型自然驾驶场景识别提取方法
US9727820B2 (en) Vehicle behavior prediction device and vehicle behavior prediction method, and driving assistance device
EP2710572B1 (en) Vehicle data analysis method and vehicle data analysis system
DE102013214328B4 (de) Fahrzeugverhaltensvorhersagevorrichtung und Fahrzeugsverhaltensvorhersageverfahren
CN111579251A (zh) 车辆测试场景的确定方法、装置、设备及存储介质
CN109117869B (zh) 用户画像方法、介质及系统
Seraj et al. A smartphone based method to enhance road pavement anomaly detection by analyzing the driver behavior
CN111351499B (zh) 路径识别方法、装置、计算机设备和计算机可读存储介质
CN104640756A (zh) 车辆驾驶行为预测装置
CN114912689B (zh) 基于地图网格索引和xgboost的超限车辆目的地预测方法及系统
CN113868875A (zh) 测试场景自动生成方法、装置、设备和存储介质
Tian et al. A vehicle re-identification algorithm based on multi-sensor correlation
EP3770879B1 (de) Verfahren, vorrichtung und computerprogramm zum aufbereiten von daten über eine ampelanlage
CN116753938A (zh) 车辆测试场景生成方法、装置、存储介质及设备
CN116383678A (zh) 一种营运客车异常变速行为常发性路段识别方法
CN118244257B (zh) 基于毫米波雷达的车辆自身状态的评估方法及系统
CN118628319B (zh) 一种基于大数据的城市道路规划设计系统
Puthan et al. Characterizing future crashes on Indian roads using counterfactual simulations of pre-crash vehicle safety technologies
Van Hinsbergh et al. Vehicle point of interest detection using in-car data
CN117272690A (zh) 自动驾驶车辆危险切入场景提取方法、设备及介质
CN114999150A (zh) 路段拥堵判别方法、装置、车辆及存储介质
CN115249351A (zh) 一种道路结构识别方法、装置、设备及可读存储介质
CN116912800B (zh) 场景分类方法、场景分类装置以及计算机可读介质
CN118762521B (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