CN112991815B - 一种避障安全距离计算方法及装置 - Google Patents

一种避障安全距离计算方法及装置 Download PDF

Info

Publication number
CN112991815B
CN112991815B CN201911214071.0A CN201911214071A CN112991815B CN 112991815 B CN112991815 B CN 112991815B CN 201911214071 A CN201911214071 A CN 201911214071A CN 112991815 B CN112991815 B CN 112991815B
Authority
CN
China
Prior art keywords
vehicle
unmanned vehicle
target vehicle
vehd
unmanned
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
CN201911214071.0A
Other languages
English (en)
Other versions
CN112991815A (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.)
SAIC Motor Corp Ltd
Original Assignee
SAIC Motor Corp Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by SAIC Motor Corp Ltd filed Critical SAIC Motor Corp Ltd
Priority to CN201911214071.0A priority Critical patent/CN112991815B/zh
Publication of CN112991815A publication Critical patent/CN112991815A/zh
Application granted granted Critical
Publication of CN112991815B publication Critical patent/CN112991815B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/16—Anti-collision systems

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

本发明提供了一种避障安全距离计算方法及装置，该方法包括：在无人驾驶车辆执行主动避障操作的过程中，确定与无人驾驶车辆具有碰撞关系的目标车辆；获取无人驾驶车辆的第一车辆信息和当前时刻下的第一行驶信息、以及目标车辆的第二车辆信息和当前时刻下的第二行驶信息；根据主动避障操作的操作类型、目标车辆所在车道的车道类型、以及目标车辆与无人驾驶车辆的相对位置关系，分析第一车辆信息、第一行驶信息、第二车辆信息和第二行驶信息得到无人驾驶车辆和目标车辆的避障安全距离。本发明通过分析车辆在避障过程中的碰撞关系计算避障安全距离，使得避障安全距离合理，对无人驾驶车辆的避障车辆开发具有理论指导意义和实际工程应用价值。

Description

一种避障安全距离计算方法及装置
技术领域
本发明涉及无人驾驶技术领域，更具体地说，涉及一种避障安全距离计算方法及装置。
背景技术
随着无人驾驶技术的不断发展，各大公司不断完善不同场景下的自动驾驶功能，其中主动避障功能是无人驾驶车辆的关键基础，良好的避障能力决定了车辆的整体性能。
现有技术中，通过研究车辆的超车过程标定了部分超车距离参数，但由于未详细分析车辆的碰撞关系，设计的安全距离参数较为保守。
发明内容
有鉴于此，为解决上述问题，本发明提供一种避障安全距离计算方法及装置。技术方案如下：
一种避障安全距离计算方法，所述方法包括：
在无人驾驶车辆执行主动避障操作的过程中，确定与所述无人驾驶车辆具有碰撞关系的目标车辆；
获取所述无人驾驶车辆的第一车辆信息和当前时刻下的第一行驶信息、以及所述目标车辆的第二车辆信息和当前时刻下的第二行驶信息；
根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离。
优选的，所述主动避障操作的操作类型为左侧避障、所述目标车辆所在车道的车道类型为主车道、所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的前方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)+0.5lvehd*sin(θ(t))-0.5wvehd*cos(θ(t))＝0.5wL0
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为所述无人驾驶车辆的车身长度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、wvehd为所述无人驾驶车辆的车身宽度、wL0为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SL0(tstart)min＝xL0(tstart)-xvehd(tstart)-0.5lL0-0.5lvehd-0.5wvehd
其中，tstart为所述当前时刻、SL0(tstart)min为所述第一最小相对位移、xL0(tstart)为所述当前时刻下所述目标车辆在行驶方向上的位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、lL0为所述目标车辆的车身长度、wvehd为所述无人驾驶车辆的车身宽度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000021
其中，SL0(tstart～tadj)min为第二最小相对位移、VL0为所述目标车辆的速度、Vvehd为所述无人驾驶车辆的速度、aL0为所述目标车辆的加速度、avehd为所述无人驾驶车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SL0(tadj)min＝SL0(tstart)min+SL0(tstart～tadj)min
其中，SL0(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
优选的，所述主动避障操作的操作类型为左侧避障、所述目标车辆所在车道的车道类型为主车道、所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的后方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)-0.5wvehd*cos(θ(t))-0.5lvehd*sin(θ(t))＝0.5wF0
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、wvehd为所述无人驾驶车辆的车身宽度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、lvehd为所述无人驾驶车辆的车身长度、wF0为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SF0(tstart)min＝xvehd(tstart)-xF0(tstart)-0.5lvehd-0.5lF0
其中，tstart为所述当前时刻、SF0(tstart)min为所述第一最小相对位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、
Figure BDA0002298984430000032
为所述当前时刻下所述目标车辆在行驶方向上的位移、lF0为所述目标车辆的车身长度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000031
其中，SF0(tstart～tadj)min为第二最小相对位移、Vvehd为所述无人驾驶车辆的速度、VF0为所述目标车辆的速度、avehd为所述无人驾驶车辆的加速度、aF0为所述目标车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SF0(tadj)min＝SF0(tstart)min+SF0(tstart～tadj)min
其中，SF0(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
优选的，所述主动避障操作的操作类型为右侧回归、所述目标车辆所在车道的车道类型为主车道、所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的后方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)+0.5lvehd*sin(θ(t))-0.5wvehd*cos(θ(t))＝0.5wFd
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为所述无人驾驶车辆的车身长度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、wvehd为所述无人驾驶车辆的车身宽度、wFd为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SFd(tstart)min＝xvehd(tstart)-xFd(tstart)-0.5wvehd-0.5lvehd-0.5lFd
其中，tstart为所述当前时刻、SFd(tstart)min为所述第一最小相对位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、xFd(tstart)为所述当前时刻下所述目标车辆在行驶方向上的位移、wvehd为所述无人驾驶车辆的车身宽度、lFd为所述目标车辆的车身长度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000041
其中，SFd(tstart～tadj)min为第二最小相对位移、Vvehd为所述无人驾驶车辆的速度、VFd为所述目标车辆的速度、avehd为所述无人驾驶车辆的加速度、aFd为所述目标车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SFd(tadj)min＝SFd(tstart)min+SFd(tstart～tadj)min
其中，SFd(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
优选的，所述主动避障操作的操作类型为右侧回归、所述目标车辆所在车道的车道类型为主车道、所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的前方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)-0.5lvehd*sin(θ(t))-0.5wvehd*cos(θ(t))＝0.5wLd
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为所述无人驾驶车辆的车身长度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、wvehd为所述无人驾驶车辆的车身宽度、wLd为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SLd(tstart)min＝xLd(tstart)-xvehd(tstart)-0.5lLd-0.5lvehd
其中，tstart为所述当前时刻、SLd(tstart)min为所述第一最小相对位移、xLd(tstart)为所述当前时刻下所述目标车辆在行驶方向上的位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、lLd为所述目标车辆的车身长度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000051
其中，SLd(tstart～tadj)min为第二最小相对位移、VLd为所述目标车辆的速度、Vvehd为所述无人驾驶车辆的速度、aLd为所述目标车辆的加速度、avehd为所述无人驾驶车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SLd(tadj)min＝SLd(tstart)min+SLd(tstart～tadj)min
其中，SLd(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
优选的，所述主动避障操作的操作类型为左侧避障、所述目标车辆所在车道的车道类型为相邻车道，所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的前方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)+0.5lvehd*sin(θ(t))+0.5wvehd*cos(θ(t))＝H-0.5wL1
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为所述无人驾驶车辆的车身长度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、wvehd为所述无人驾驶车辆的车身宽度、H为预设的车道宽度、wL1为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SL1(tstart)min＝xL1(tstart)-xvehd(tstart)-0.5lL1-0.5lvehd
其中，tstart为所述当前时刻、SL1(tstart)min为所述第一最小相对位移、xL1(tstart)为所述当前时刻下所述目标车辆在行驶方向上的位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、lL1为所述目标车辆的车身长度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000061
其中，SL1(tstart～tadj)min为第二最小相对位移、VL1为所述目标车辆的速度、Vvehd为所述无人驾驶车辆的速度、aL1为所述目标车辆的加速度、avehd为所述无人驾驶车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SL1(tadj)min＝SL1(tstart)min+SL1(tstart～tadj)min
其中，SL1(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
优选的，所述主动避障操作的操作类型为左侧避障、所述目标车辆所在车道的车道类型为相邻车道，所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的后方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)+0.5wvehd*cos(θ(t))-0.5lvehd*sin(θ(t))＝H-0.5wFI
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、wvehd为所述无人驾驶车辆的车身宽度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、lvehd为所述无人驾驶车辆的车身长度、wFI为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SFI(tstart)min＝xvehd(tstart)-xFI(tstart)-0.5lvehd-0.5wvehd-0.5lFI
其中，tstart为所述当前时刻、SFI(tstart)min为所述第一最小相对位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、xFI(tstart)为所述当前时刻下所述目标车辆在行驶方向上的位移、wvehd为所述无人驾驶车辆的车身宽度、lFI为所述目标车辆的车身长度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000071
其中，SFI(tstart～tadj)min为第二最小相对位移、Vvehd为所述无人驾驶车辆的速度、VFI为所述目标车辆的速度、avehd为所述无人驾驶车辆的加速度、aFI为所述目标车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SFI(tadj)min＝SFI(tstart)min+SFI(tstart～tadj)min
其中，SFI(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
优选的，所述主动避障操作的操作类型为右侧回归、所述目标车辆所在车道的车道类型为相邻车道、所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的后方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)+0.5lvehd*sin(θ(t))+0.5wvehd*cos(θ(t))＝H-0.5wFId
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为所述无人驾驶车辆的车身长度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、wvehd为所述无人驾驶车辆的车身宽度、H为预设的车道宽度、wFId为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SFId(tstart)min＝xvehd(tstart)-xFId(tstart)-0.5lvehd-0.5lFId
其中，tstart为所述当前时刻、SFId(tstart)min为所述第一最小相对位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、xFId(tstart)为所述当前时刻下所述目标车辆在行驶方向上的位移、lFId为所述目标车辆的车身长度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000081
其中，SFId(tstart～tadj)min为第二最小相对位移、Vvehd为所述无人驾驶车辆的速度、VFId为所述目标车辆的速度、avehd为所述无人驾驶车辆的加速度、aFId为所述目标车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SFId(tadj)min＝SFId(tstart)min+SFId(tstart～tadj)min
其中，SFId(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
优选的，所述主动避障操作的操作类型为右侧回归、所述目标车辆所在车道的车道类型为相邻车道、所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的前方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)-0.5lvehd*sin(θ(t))+0.5wvehd*cos(θ(t))＝H-0.5wLId
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为所述无人驾驶车辆的车身长度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、wvehd为所述无人驾驶车辆的车身宽度、H为预设的车道宽度、wLId为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SLId(tstart)min＝xLId(tstart)-xvehd(tstart)-0.5lLId-0.5lvehd-0.5wvehd
其中，tstart为所述当前时刻、SLId(tstart)min为所述第一最小相对位移、xLId(tstart)为所述当前时刻下所述目标驾驶车辆在行驶方向上的位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、lLId为所述目标车辆的车身长度、wvehd为所述无人驾驶车辆的车身宽度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000091
其中，SLId(tstart～tadj)min为第二最小相对位移、VLId为所述目标车辆的速度、Vvehd为所述无人驾驶车辆的速度、aLId为所述目标车辆的加速度、avehd为所述无人驾驶车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SLId(tadj)min＝SLId(tstart)min+SLId(tstart～tadj)min
其中，SLId(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
一种避障安全距离计算装置，所述装置包括：
确定模块，用于在无人驾驶车辆执行主动避障操作的过程中，确定与所述无人驾驶车辆具有碰撞关系的目标车辆；
获取模块，用于获取所述无人驾驶车辆的第一车辆信息和当前时刻下的第一行驶信息、以及所述目标车辆的第二车辆信息和当前时刻下的第二行驶信息；
分析模块，用于根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离。
以上本发明提供的避障安全距离计算方法及装置，可以在无人驾驶车辆执行主动避障操作的过程中，根据主动避障操作的操作类型、与无人驾驶车辆具有碰撞关系的目标车辆的车道类型、目标车辆与无人驾驶车辆的相对位置关系，分析无人驾驶车辆的第一车辆信息和当前时刻下的第一行驶信息、以及目标车辆的第二车辆信息和当前时刻下的第二行驶信息来获得无人驾驶车辆与目标车辆的避障安全距离。本发明通过分析车辆在避障过程中的碰撞关系计算避障安全距离，使得避障安全距离合理，对无人驾驶车辆的避障车辆开发具有理论指导意义和实际工程应用价值。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据提供的附图获得其他的附图。
图1为本发明实施例提供的无人驾驶车辆与周围车辆在主车道上的碰撞关系示意图；
图2为本发明实施例提供的无人驾驶车辆与周围车辆在相邻车道上的碰撞关系示意图；
图3为本发明实施例提供的避障安全距离计算方法的方法流程图；
图4为本发明实施例提供的避障安全距离计算装置的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
为方便理解本申请，以下首先分析无人驾驶车辆的碰撞关系：
无人驾驶车辆在避障期间与周围车辆的碰撞关系主要有两种碰撞形式：一种是无人驾驶车辆在主车道内完成避障动作，无人驾驶车辆与主车道前方、后方车辆的碰撞关系，参见图1所示的碰撞关系示意图；另一种是无人驾驶车辆借助与主车道相邻的相邻车道完成避障动作，无人驾驶车辆与车道的前方、后方车辆的碰撞关系，参见图2所示的避障关系示意图。
基于上述场景，假设无人驾驶车辆和周围车辆均行驶在车道中心线上，以无人驾驶车辆初始避障时刻所在位置为坐标原点，建立某点大地坐标系xoy，无人车辆行驶方向为x正向，向左侧车道行驶方向为y正向，车辆航向角θ定义为车速与x向的夹角，逆时针为正。
以无人驾驶车辆与周围车辆在主车道上的碰撞关系为例，假设两车某时刻在碰撞点发生碰撞，根据此时两车的横向位移关系，计算无人驾驶车辆从避障动作开始至发生碰撞所需时间，根据碰撞时间、车速、车辆位置、车身长度、车身宽度等条件设计最小纵向距离，即无人驾驶车辆在避障动作期间，为了使无人驾驶车辆不与主车道周围车辆发生碰撞，应保持的最小安全距离。同理，计算无人驾驶车辆与周围车辆在临车道上的碰撞关系，当无人驾驶车辆与周围车辆的距离均满足安全距离关系时，开启避障动作。
基于此，本发明实施例提供一种避障安全距离计算方法，该方法的方法流程图如图3所示，包括如下步骤：
S10，在无人驾驶车辆执行主动避障操作的过程中，确定与无人驾驶车辆具有碰撞关系的目标车辆。
参见图1和图2所示的避障关系示意图，在无人驾驶车辆主动避障期间，与无人驾驶车辆具有碰撞关系的目标车辆为无人驾驶车辆所在主车道的前车和后车、以及无人驾驶车辆在相邻车道上的前车和后车。
S20，获取无人驾驶车辆的第一车辆信息和当前时刻下的第一行驶信息、以及目标车辆的第二车辆信息和当前时刻下的第二行驶信息。
本发明实施例中，第一车辆信息包括但不局限于无人驾驶车辆的车身长度、车身宽度、位置点、在位置点时的车辆航向角、以及在行驶方向上的位移；第一行驶信息包括但不局限于无人驾驶车辆预先规划的主动避障路径、速度、以及加速度；第二车辆信息包括但不局限于目标车辆的车身宽度、以及车身长度；第二行驶信息包括但不局限于目标车辆的速度、加速度、在行驶方向上的位移。
S30，根据主动避障操作的操作类型、目标车辆所在车道的车道类型、以及目标车辆与无人驾驶车辆的相对位置关系，分析第一车辆信息、第一行驶信息第二车辆信息和第二行驶信息得到无人驾驶车辆和目标车辆的避障安全距离。
本发明实施例中，主动避障操作的操作类型包括左侧避障和右侧回归，目标车辆所在车道的车道类型包括主车道和相邻车道，目标车辆与无人驾驶车的相对位置关系包括目标车辆位于无人驾驶车辆的前方、目标车辆位于无人驾驶车辆的后方。
此外，本发明实施例中基于极端碰撞假设以及避障过程中的碰撞工况来计算无人驾驶车辆避障的最小纵向安全距离，即避障安全距离。
具体实现过程中，主动避障操作的操作类型为左侧避障、目标车辆所在车道的车道类型为主车道、目标车辆与无人驾驶车辆的相对位置关系为目标车辆位于无人驾驶车辆的前方；
步骤S30“根据主动避障操作的操作类型、目标车辆所在车道的车道类型、以及目标车辆与无人驾驶车辆的相对位置关系，分析第一车辆信息、第一行驶信息第二车辆信息和第二行驶信息得到无人驾驶车辆和目标车辆的避障安全距离”可以采用如下步骤：
计算无人驾驶车辆和目标车辆的碰撞时刻，公式如下：
y(t)+0.5lvehd*sin(θ(t))-0.5wvehd*cos(θ(t))＝0.5wL0
其中，y(t)为无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为无人驾驶车辆的车身长度、θ(t)为无人驾驶车辆在该位置点时的车辆航向角、wvehd为无人驾驶车辆的车身宽度、wL0为目标车辆的车身宽度，无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为无人驾驶车辆和目标车辆的碰撞时刻tadj；
计算当前时刻下无人驾驶车辆和目标车辆的第一最小相对位移，公式如下：
SL0(tstart)min＝xL0(tstart)-xvehd(tstart)-0.5lL0-0.5lvehd-0.5wvehd
其中，tstart为当前时刻、SL0(tstart)min为第一最小相对位移、xL0(tstart)为当前时刻下目标车辆在行驶方向上的位移、xvehd(tstart)为当前时刻下无人驾驶车辆在行驶方向上的位移、lL0为目标车辆的车身长度、wvehd为无人驾驶车辆的车身宽度；
计算在当前时刻到碰撞时刻的时段内无人驾驶车辆和目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000121
其中，SL0(tstart～tadj)min为第二最小相对位移、VL0为目标车辆的速度、Vvehd为无人驾驶车辆的速度、aL0为目标车辆的加速度、avehd为无人驾驶车辆的加速度；
计算无人驾驶车辆和目标车辆的避障安全距离，公式如下：
SL0(tadj)min＝SL0(tstart)min+SL0(tstart～tadj)min
其中，SL0(tadj)min为无人驾驶车辆和目标车辆的避障安全距离。
具体实现过程中，主动避障操作的操作类型为左侧避障、目标车辆所在车道的车道类型为主车道、目标车辆与无人驾驶车辆的相对位置关系为目标车辆位于无人驾驶车辆的后方；
步骤S30“根据主动避障操作的操作类型、目标车辆所在车道的车道类型、以及目标车辆与无人驾驶车辆的相对位置关系，分析第一车辆信息、第一行驶信息第二车辆信息和第二行驶信息得到无人驾驶车辆和目标车辆的避障安全距离”可以采用如下步骤：
计算无人驾驶车辆和目标车辆的碰撞时刻，公式如下：
y(t)-0.5wvehd*cos(θ(t))-0.5lvehd*sin(θ(t))＝0.5wF0
其中，y(t)为无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、wvehd为无人驾驶车辆的车身宽度、θ(t)为无人驾驶车辆在该位置点时的车辆航向角、lvehd为无人驾驶车辆的车身长度、wF0为目标车辆的车身宽度，无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为无人驾驶车辆和目标车辆的碰撞时刻tadj；
计算当前时刻下无人驾驶车辆和目标车辆的第一最小相对位移，公式如下：
SF0(tstart)min＝xvehd(tstart)-xF0(tstart)-0.5lvehd-0.5lF0
其中，tstart为当前时刻、SF0(tstart)min为第一最小相对位移、xvehd(tstart)为当前时刻下无人驾驶车辆在行驶方向上的位移、
Figure BDA0002298984430000132
为当前时刻下目标车辆在行驶方向上的位移、lF0为目标车辆的车身长度；
计算在当前时刻到碰撞时刻的时段内无人驾驶车辆和目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000131
其中，SF0(tstart～tadj)min为第二最小相对位移、Vvehd为无人驾驶车辆的速度、VF0为目标车辆的速度、avehd为无人驾驶车辆的加速度、aF0为目标车辆的加速度；
计算无人驾驶车辆和目标车辆的避障安全距离，公式如下：
SF0(tadj)min＝SF0(tstart)min+SF0(tstart～tadj)min
其中，SF0(tadj)min为无人驾驶车辆和目标车辆的避障安全距离。
具体实现过程中，主动避障操作的操作类型为右侧回归、目标车辆所在车道的车道类型为主车道、目标车辆与无人驾驶车辆的相对位置关系为目标车辆位于无人驾驶车辆的后方；
步骤S30“根据主动避障操作的操作类型、目标车辆所在车道的车道类型、以及目标车辆与无人驾驶车辆的相对位置关系，分析第一车辆信息、第一行驶信息第二车辆信息和第二行驶信息得到无人驾驶车辆和目标车辆的避障安全距离”可以采用如下步骤：
计算无人驾驶车辆和目标车辆的碰撞时刻，公式如下：
y(t)+0.5lvehd*sin(θ(t))-0.5wvehd*cos(θ(t))＝0.5wFd
其中，y(t)为无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为无人驾驶车辆的车身长度、θ(t)为无人驾驶车辆在该位置点时的车辆航向角、wvehd为无人驾驶车辆的车身宽度、wFd为目标车辆的车身宽度，无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为无人驾驶车辆和目标车辆的碰撞时刻tadj；
计算当前时刻下无人驾驶车辆和目标车辆的第一最小相对位移，公式如下：
SFd(tstart)min＝xvehd(tstart)-xFd(tstart)-0.5wvehd-0.5lvehd-0.5lFd
其中，tstart为当前时刻、SFd(tstart)min为第一最小相对位移、xvehd(tstart)为当前时刻下无人驾驶车辆在行驶方向上的位移、xFd(tstart)为当前时刻下目标车辆在行驶方向上的位移、wvehd为无人驾驶车辆的车身宽度、lFd为目标车辆的车身长度；
计算在当前时刻到碰撞时刻的时段内无人驾驶车辆和目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000141
其中，SFd(tstart～tadj)min为第二最小相对位移、Vvehd为无人驾驶车辆的速度、VFd为目标车辆的速度、avehd为无人驾驶车辆的加速度、aFd为目标车辆的加速度；
计算无人驾驶车辆和目标车辆的避障安全距离，公式如下：
SFd(tadj)min＝SFd(tstart)min+SFd(tstart～tadj)min
其中，SFd(tadj)min为无人驾驶车辆和目标车辆的避障安全距离。
具体实现过程中，主动避障操作的操作类型为右侧回归、目标车辆所在车道的车道类型为主车道、目标车辆与无人驾驶车辆的相对位置关系为目标车辆位于无人驾驶车辆的前方；
步骤S30“根据主动避障操作的操作类型、目标车辆所在车道的车道类型、以及目标车辆与无人驾驶车辆的相对位置关系，分析第一车辆信息、第一行驶信息第二车辆信息和第二行驶信息得到无人驾驶车辆和目标车辆的避障安全距离”可以采用如下步骤：
计算无人驾驶车辆和目标车辆的碰撞时刻，公式如下：
y(t)-0.5lvehd*sin(θ(t))-0.5wvehd*cos(θ(t))＝0.5wLd
其中，y(t)为无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为无人驾驶车辆的车身长度、θ(t)为无人驾驶车辆在该位置点时的车辆航向角、wvehd为无人驾驶车辆的车身宽度、wLd为目标车辆的车身宽度，无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为无人驾驶车辆和目标车辆的碰撞时刻tadj；
计算当前时刻下无人驾驶车辆和目标车辆的第一最小相对位移，公式如下：
SLd(tstart)min＝xLd(tstart)-xvehd(tstart)-0.5lLd-0.5lvehd
其中，tstart为当前时刻、SLd(tstart)min为第一最小相对位移、xLd(tstart)为当前时刻下目标车辆在行驶方向上的位移、xvehd(tstart)为当前时刻下无人驾驶车辆在行驶方向上的位移、lLd为目标车辆的车身长度；
计算在当前时刻到碰撞时刻的时段内无人驾驶车辆和目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000151
其中，SLd(tstart～tadj)min为第二最小相对位移、VLd为目标车辆的速度、Vvehd为无人驾驶车辆的速度、aLd为目标车辆的加速度、avehd为无人驾驶车辆的加速度；
计算无人驾驶车辆和目标车辆的避障安全距离，公式如下：
SLd(tadj)min＝SLd(tstart)min+SLd(tstart～tadj)min
其中，SLd(tadj)min为无人驾驶车辆和目标车辆的避障安全距离。
具体实现过程中，主动避障操作的操作类型为左侧避障、目标车辆所在车道的车道类型为相邻车道，目标车辆与无人驾驶车辆的相对位置关系为目标车辆位于无人驾驶车辆的前方；
步骤S30“根据主动避障操作的操作类型、目标车辆所在车道的车道类型、以及目标车辆与无人驾驶车辆的相对位置关系，分析第一车辆信息、第一行驶信息第二车辆信息和第二行驶信息得到无人驾驶车辆和目标车辆的避障安全距离”可以采用如下步骤：
计算无人驾驶车辆和目标车辆的碰撞时刻，公式如下：
y(t)+0.5lvehd*sin(θ(t))+0.5wvehd*cos(θ(t))＝H-0.5wL1
其中，y(t)为无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为无人驾驶车辆的车身长度、θ(t)为无人驾驶车辆在该位置点时的车辆航向角、wvehd为无人驾驶车辆的车身宽度、H为预设的车道宽度、wL1为目标车辆的车身宽度，无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为无人驾驶车辆和目标车辆的碰撞时刻tadj；
计算当前时刻下无人驾驶车辆和目标车辆的第一最小相对位移，公式如下：
SL1(tstart)min＝xL1(tstart)-xvehd(tstart)-0.5lL1-0.5lvehd
其中，tstart为当前时刻、SL1(tstart)min为第一最小相对位移、xL1(tstart)为当前时刻下目标车辆在行驶方向上的位移、xvehd(tstart)为当前时刻下无人驾驶车辆在行驶方向上的位移、lL1为目标车辆的车身长度；
计算在当前时刻到碰撞时刻的时段内无人驾驶车辆和目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000161
其中，SL1(tstart～tadj)min为第二最小相对位移、VL1为目标车辆的速度、Vvehd为无人驾驶车辆的速度、aL1为目标车辆的加速度、avehd为无人驾驶车辆的加速度；
计算无人驾驶车辆和目标车辆的避障安全距离，公式如下：
SL1(tadj)min＝SL1(tstart)min+SL1(tstart～tadj)min
其中，SL1(tadj)min为无人驾驶车辆和目标车辆的避障安全距离。
具体实现过程中，主动避障操作的操作类型为左侧避障、目标车辆所在车道的车道类型为相邻车道，目标车辆与无人驾驶车辆的相对位置关系为目标车辆位于无人驾驶车辆的后方；
步骤S30“根据主动避障操作的操作类型、目标车辆所在车道的车道类型、以及目标车辆与无人驾驶车辆的相对位置关系，分析第一车辆信息、第一行驶信息第二车辆信息和第二行驶信息得到无人驾驶车辆和目标车辆的避障安全距离”可以采用如下步骤：
计算无人驾驶车辆和目标车辆的碰撞时刻，公式如下：
y(t)+0.5wvehd*cos(θ(t))-0.5lvehd*sin(θ(t))＝H-0.5wFI
其中，y(t)为无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、wvehd为无人驾驶车辆的车身宽度、θ(t)为无人驾驶车辆在该位置点时的车辆航向角、lvehd为无人驾驶车辆的车身长度、wFI为目标车辆的车身宽度，无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为无人驾驶车辆和目标车辆的碰撞时刻tadj；
计算当前时刻下无人驾驶车辆和目标车辆的第一最小相对位移，公式如下：
SFI(tstart)min＝xvehd(tstart)-xFI(tstart)-0.5lvehd-0.5wvehd-0.5lFI
其中，tstart为当前时刻、SFI(tstart)min为第一最小相对位移、xvehd(tstart)为当前时刻下无人驾驶车辆在行驶方向上的位移、xFI(tstart)为当前时刻下目标车辆在行驶方向上的位移、wvehd为无人驾驶车辆的车身宽度、lFI为目标车辆的车身长度；
计算在当前时刻到碰撞时刻的时段内无人驾驶车辆和目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000171
其中，SFI(tstart～tadj)min为第二最小相对位移、Vvehd为无人驾驶车辆的速度、VFI为目标车辆的速度、avehd为无人驾驶车辆的加速度、aFI为目标车辆的加速度；
计算无人驾驶车辆和目标车辆的避障安全距离，公式如下：
SFI(tadj)min＝SFI(tstart)min+SFI(tstart～tadj)min
其中，SFI(tadj)min为无人驾驶车辆和目标车辆的避障安全距离。
具体实现过程中，动避障操作的操作类型为右侧回归、目标车辆所在车道的车道类型为相邻车道、目标车辆与无人驾驶车辆的相对位置关系为目标车辆位于无人驾驶车辆的后方；
步骤S30“根据主动避障操作的操作类型、目标车辆所在车道的车道类型、以及目标车辆与无人驾驶车辆的相对位置关系，分析第一车辆信息、第一行驶信息第二车辆信息和第二行驶信息得到无人驾驶车辆和目标车辆的避障安全距离”可以采用如下步骤：
计算无人驾驶车辆和目标车辆的碰撞时刻，公式如下：
y(t)+0.5lvehd*sin(θ(t))+0.5wvehd*cos(θ(t))＝H-0.5wFId
其中，y(t)为无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为无人驾驶车辆的车身长度、θ(t)为无人驾驶车辆在该位置点时的车辆航向角、wvehd为无人驾驶车辆的车身宽度、H为预设的车道宽度、wFId为目标车辆的车身宽度，无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为无人驾驶车辆和目标车辆的碰撞时刻tadj；
计算当前时刻下无人驾驶车辆和目标车辆的第一最小相对位移，公式如下：
SFId(tstart)min＝xvehd(tstart)-xFId(tstart)-0.5lvehd-0.5lFId
其中，tstart为当前时刻、SFId(tstart)min为第一最小相对位移、xvehd(tstart)为当前时刻下无人驾驶车辆在行驶方向上的位移、xFId(tstart)为当前时刻下目标车辆在行驶方向上的位移、lFId为目标车辆的车身长度；
计算在当前时刻到碰撞时刻的时段内无人驾驶车辆和目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000181
其中，SFId(tstart～tadj)min为第二最小相对位移、Vvehd为无人驾驶车辆的速度、VFId为目标车辆的速度、avehd为无人驾驶车辆的加速度、aFId为目标车辆的加速度；
计算无人驾驶车辆和目标车辆的避障安全距离，公式如下：
SFId(tadj)min＝SFId(tstart)min+SFId(tstart～tadj)min
其中，SFId(tadj)min为无人驾驶车辆和目标车辆的避障安全距离。
具体实现过程中，主动避障操作的操作类型为右侧回归、目标车辆所在车道的车道类型为相邻车道、目标车辆与无人驾驶车辆的相对位置关系为目标车辆位于无人驾驶车辆的前方；
步骤S30“根据主动避障操作的操作类型、目标车辆所在车道的车道类型、以及目标车辆与无人驾驶车辆的相对位置关系，分析第一车辆信息、第一行驶信息第二车辆信息和第二行驶信息得到无人驾驶车辆和目标车辆的避障安全距离”可以采用如下步骤：
计算无人驾驶车辆和目标车辆的碰撞时刻，公式如下：
y(t)-0.5lvehd*sin(θ(t))+0.5wvehd*cos(θ(t))＝H-0.5wLId
其中，y(t)为无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为无人驾驶车辆的车身长度、θ(t)为无人驾驶车辆在该位置点时的车辆航向角、wvehd为无人驾驶车辆的车身宽度、H为预设的车道宽度、wLId为目标车辆的车身宽度，无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为无人驾驶车辆和目标车辆的碰撞时刻tadj；
计算当前时刻下无人驾驶车辆和目标车辆的第一最小相对位移，公式如下：
SLId(tstart)min＝xLId(tstart)-xvehd(tstart)-0.5lLId-0.5lvehd-0.5wvehd
其中，tstart为当前时刻、SLId(tstart)min为第一最小相对位移、xLId(tstart)为当前时刻下目标驾驶车辆在行驶方向上的位移、xvehd(tstart)为当前时刻下无人驾驶车辆在行驶方向上的位移、lLId为目标车辆的车身长度、wvehd为无人驾驶车辆的车身宽度；
计算在当前时刻到碰撞时刻的时段内无人驾驶车辆和目标车辆的第二最小相对位移，公式如下：
Figure BDA0002298984430000191
其中，SLId(tstart～tadj)min为第二最小相对位移、VLId为目标车辆的速度、Vvehd为无人驾驶车辆的速度、aLId为目标车辆的加速度、avehd为无人驾驶车辆的加速度；
计算无人驾驶车辆和目标车辆的避障安全距离，公式如下：
SLId(tadj)min＝SLId(tstart)min+SLId(tstart～tadj)min
其中，SLId(tadj)min为无人驾驶车辆和目标车辆的避障安全距离。
本发明实施例提供的避障安全距离计算方法，通过分析车辆在避障过程中的碰撞关系计算避障安全距离，使得避障安全距离合理，对无人驾驶车辆的避障车辆开发具有理论指导意义和实际工程应用价值。
基于上述实施例提供的避障安全距离计算方法，本发明实施例则提供一种避障安全距离计算装置，该装置的结构示意图如图4所示，包括：
确定模块10，用于在无人驾驶车辆执行主动避障操作的过程中，确定与无人驾驶车辆具有碰撞关系的目标车辆；
获取模块20，用于获取无人驾驶车辆的第一车辆信息和当前时刻下的第一行驶信息、以及目标车辆的第二车辆信息和当前时刻下的第二行驶信息；
分析模块30，用于根据主动避障操作的操作类型、目标车辆所在车道的车道类型、以及目标车辆与无人驾驶车辆的相对位置关系，分析第一车辆信息、第一行驶信息、第二车辆信息和第二行驶信息得到无人驾驶车辆和目标车辆的避障安全距离。
本发明实施例提供的避障安全距离计算装置，通过分析车辆在避障过程中的碰撞关系计算避障安全距离，使得避障安全距离合理，对无人驾驶车辆的避障车辆开发具有理论指导意义和实际工程应用价值。
以上对本发明所提供的一种避障安全距离计算方法及装置进行了详细介绍，本文中应用了具体个例对本发明的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本发明的方法及其核心思想；同时，对于本领域的一般技术人员，依据本发明的思想，在具体实施方式及应用范围上均会有改变之处，综上所述，本说明书内容不应理解为对本发明的限制。
需要说明的是，本说明书中的各个实施例均采用递进的方式描述，每个实施例重点说明的都是与其他实施例的不同之处，各个实施例之间相同相似的部分互相参见即可。对于实施例公开的装置而言，由于其与实施例公开的方法相对应，所以描述的比较简单，相关之处参见方法部分说明即可。
还需要说明的是，在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者设备所固有的要素，或者是还包括为这些过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
对所公开的实施例的上述说明，使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的，本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下，在其它实施例中实现。因此，本发明将不会被限制于本文所示的这些实施例，而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。

Claims (9)

1.一种避障安全距离计算方法，其特征在于，所述方法包括：
在无人驾驶车辆执行主动避障操作的过程中，确定与所述无人驾驶车辆具有碰撞关系的目标车辆；
获取所述无人驾驶车辆的第一车辆信息和当前时刻下的第一行驶信息、以及所述目标车辆的第二车辆信息和当前时刻下的第二行驶信息，其中，所述第一车辆信息至少包括：无人驾驶车辆的车身长度、车身宽度、位置点、在位置点时的车辆航向角、和在行驶方向上的位移；
根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离；
所述主动避障操作的操作类型为左侧避障、所述目标车辆所在车道的车道类型为主车道、所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的前方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)+0.5lvehd*sin(θ(t))-0.5wvehd*cos(θ(t))＝0.5wL0
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为所述无人驾驶车辆的车身长度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、wvehd为所述无人驾驶车辆的车身宽度、wL0为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SL0(tstart)min＝xL0(tstart)-xvehd(tstart)-0.5lL0-0.5lvehd-0.5wvehd
其中，tstart为所述当前时刻、SL0(tstart)min为所述第一最小相对位移、xL0(tstart)为所述当前时刻下所述目标车辆在行驶方向上的位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、lL0为所述目标车辆的车身长度、wvehd为所述无人驾驶车辆的车身宽度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure FDA0003401434790000021
其中，SL0(tstart～tadj)min为第二最小相对位移、VL0为所述目标车辆的速度、Vvehd为所述无人驾驶车辆的速度、aL0为所述目标车辆的加速度、avehd为所述无人驾驶车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SL0(tadj)min＝SL0(tstart)min+SL0(tstart～tadj)min
其中，SL0(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
2.根据权利要求1所述的方法，其特征在于，所述主动避障操作的操作类型为左侧避障、所述目标车辆所在车道的车道类型为主车道、所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的后方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)-0.5wvehd*cos(θ(t))-0.5lvehd*sin(θ(t))＝0.5wF0
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、wvehd为所述无人驾驶车辆的车身宽度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、lvehd为所述无人驾驶车辆的车身长度、wF0为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SF0(tstart)min＝xvehd(tstart)-xF0(tstart)-0.5lvehd-0.5lF0
其中，tstart为所述当前时刻、SF0(tstart)min为所述第一最小相对位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、
Figure FDA0003401434790000022
为所述当前时刻下所述目标车辆在行驶方向上的位移、lF0为所述目标车辆的车身长度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure FDA0003401434790000031
其中，SF0(tstart～tadj)min为第二最小相对位移、Vvehd为所述无人驾驶车辆的速度、VF0为所述目标车辆的速度、avehd为所述无人驾驶车辆的加速度、aF0为所述目标车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SF0(tadj)min＝SF0(tstart)min+SF0(tstart～tadj)min
其中，SF0(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
3.根据权利要求1所述的方法，其特征在于，所述主动避障操作的操作类型为右侧回归、所述目标车辆所在车道的车道类型为主车道、所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的后方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)+0.5lvehd*sin(θ(t))-0.5wvehd*cos(θ(t))＝0.5wFd
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为所述无人驾驶车辆的车身长度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、wvehd为所述无人驾驶车辆的车身宽度、wFd为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SFd(tstart)min＝xvehd(tstart)-xFd(tstart)-0.5wvehd-0.5lvehd-0.5lFd
其中，tstart为所述当前时刻、SFd(tstart)min为所述第一最小相对位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、xFd(tstart)为所述当前时刻下所述目标车辆在行驶方向上的位移、wvehd为所述无人驾驶车辆的车身宽度、lFd为所述目标车辆的车身长度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure FDA0003401434790000041
其中，SFd(tstart～tadj)min为第二最小相对位移、Vvehd为所述无人驾驶车辆的速度、VFd为所述目标车辆的速度、avehd为所述无人驾驶车辆的加速度、aFd为所述目标车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SFd(tadj)min＝SFd(tstart)min+SFd(tstart～tadj)min
其中，SFd(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
4.根据权利要求1所述的方法，其特征在于，所述主动避障操作的操作类型为右侧回归、所述目标车辆所在车道的车道类型为主车道、所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的前方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)-0.5lvehd*sin(θ(t))-0.5wvehd*cos(θ(t))＝0.5wLd
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为所述无人驾驶车辆的车身长度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、wvehd为所述无人驾驶车辆的车身宽度、wLd为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SLd(tstart)min＝xLd(tstart)-xvehd(tstart)-0.5lLd-0.5lvehd
其中，tstart为所述当前时刻、SLd(tstart)min为所述第一最小相对位移、xLd(tstart)为所述当前时刻下所述目标车辆在行驶方向上的位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、lLd为所述目标车辆的车身长度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure FDA0003401434790000051
其中，SLd(tstart～tadj)min为第二最小相对位移、VLd为所述目标车辆的速度、Vvehd为所述无人驾驶车辆的速度、aLd为所述目标车辆的加速度、avehd为所述无人驾驶车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SLd(tadj)min＝SLd(tstart)min+SLd(tstart～tadj)min
其中，SLd(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
5.根据权利要求1所述的方法，其特征在于，所述主动避障操作的操作类型为左侧避障、所述目标车辆所在车道的车道类型为相邻车道，所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的前方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)+0.5lvehd*sin(θ(t))+0.5wvehd*cos(θ(t))＝H-0.5wL1
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为所述无人驾驶车辆的车身长度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、wvehd为所述无人驾驶车辆的车身宽度、H为预设的车道宽度、wL1为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SL1(tstart)min＝xL1(tstart)-xvehd(tstart)-0.5lL1-0.5lvehd
其中，tstart为所述当前时刻、SL1(tstart)min为所述第一最小相对位移、xL1(tstart)为所述当前时刻下所述目标车辆在行驶方向上的位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、lL1为所述目标车辆的车身长度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure FDA0003401434790000061
其中，SL1(tstart～tadj)min为第二最小相对位移、VL1为所述目标车辆的速度、Vvehd为所述无人驾驶车辆的速度、aL1为所述目标车辆的加速度、avehd为所述无人驾驶车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SL1(tadj)min＝SL1(tstart)min+SL1(tstart～tadj)min
其中，SL1(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
6.根据权利要求1所述的方法，其特征在于，所述主动避障操作的操作类型为左侧避障、所述目标车辆所在车道的车道类型为相邻车道，所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的后方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)+0.5wvehd*cos(θ(t))-0.5lvehd*sin(θ(t))＝H-0.5wFI
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、wvehd为所述无人驾驶车辆的车身宽度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、lvehd为所述无人驾驶车辆的车身长度、wFI为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SFI(tstart)min＝xvehd(tstart)-xFI(tstart)-0.5lvehd-0.5wvehd-0.5lFI
其中，tstart为所述当前时刻、SFI(tstart)min为所述第一最小相对位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、xFI(tstart)为所述当前时刻下所述目标车辆在行驶方向上的位移、wvehd为所述无人驾驶车辆的车身宽度、lFI为所述目标车辆的车身长度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure FDA0003401434790000071
其中，SFI(tstart～tadj)min为第二最小相对位移、Vvehd为所述无人驾驶车辆的速度、VFI为所述目标车辆的速度、avehd为所述无人驾驶车辆的加速度、aFI为所述目标车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SFI(tadj)min＝SFI(tstart)min+SFI(tstart～tadj)min
其中，SFI(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
7.根据权利要求1所述的方法，其特征在于，所述主动避障操作的操作类型为右侧回归、所述目标车辆所在车道的车道类型为相邻车道、所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的后方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)+0.5lvehd*sin(θ(t))+0.5wvehd*cos(θ(t))＝H-0.5wFId
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为所述无人驾驶车辆的车身长度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、wvehd为所述无人驾驶车辆的车身宽度、H为预设的车道宽度、wFId为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SFId(tstart)min＝xvehd(tstart)-xFId(tstart)-0.5lvehd-0.5lFId
其中，tstart为所述当前时刻、SFId(tstart)min为所述第一最小相对位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、xFId(tstart)为所述当前时刻下所述目标车辆在行驶方向上的位移、lFId为所述目标车辆的车身长度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure FDA0003401434790000081
其中，SFId(tstart～tadj)min为第二最小相对位移、Vvehd为所述无人驾驶车辆的速度、VFId为所述目标车辆的速度、avehd为所述无人驾驶车辆的加速度、aFId为所述目标车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SFId(tadj)min＝SFId(tstart)min+SFId(tstart～tadj)min
其中，SFId(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
8.根据权利要求1所述的方法，其特征在于，所述主动避障操作的操作类型为右侧回归、所述目标车辆所在车道的车道类型为相邻车道、所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的前方；
所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：
计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：
y(t)-0.5lvehd*sin(θ(t))+0.5wvehd*cos(θ(t))＝H-0.5wLId
其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为所述无人驾驶车辆的车身长度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、wvehd为所述无人驾驶车辆的车身宽度、H为预设的车道宽度、wLId为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；
计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：
SLId(tstart)min＝xLId(tstart)-xvehd(tstart)-0.5lLId-0.5lvehd-0.5wvehd
其中，tstart为所述当前时刻、SLId(tstart)min为所述第一最小相对位移、xLId(tstart)为所述当前时刻下所述目标车辆在行驶方向上的位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、lLId为所述目标车辆的车身长度、wvehd为所述无人驾驶车辆的车身宽度；
计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure FDA0003401434790000091
其中，SLId(tstart～tadj)min为第二最小相对位移、VLId为所述目标车辆的速度、Vvehd为所述无人驾驶车辆的速度、aLId为所述目标车辆的加速度、avehd为所述无人驾驶车辆的加速度；
计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：
SLId(tadj)min＝SLId(tstart)min+SLId(tstart～tadj)min
其中，SLId(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
9.一种避障安全距离计算装置，其特征在于，所述装置包括：
确定模块，用于在无人驾驶车辆执行主动避障操作的过程中，确定与所述无人驾驶车辆具有碰撞关系的目标车辆；
获取模块，用于获取所述无人驾驶车辆的第一车辆信息和当前时刻下的第一行驶信息、以及所述目标车辆的第二车辆信息和当前时刻下的第二行驶信息，其中，所述第一车辆信息至少包括：无人驾驶车辆的车身长度、车身宽度、位置点、在位置点时的车辆航向角、和在行驶方向上的位移；
分析模块，用于根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，其中，所述主动避障操作的操作类型为左侧避障、所述目标车辆所在车道的车道类型为主车道、所述目标车辆与所述无人驾驶车辆的相对位置关系为所述目标车辆位于所述无人驾驶车辆的前方，所述根据所述主动避障操作的操作类型、所述目标车辆所在车道的车道类型、以及所述目标车辆与所述无人驾驶车辆的相对位置关系，分析所述第一车辆信息、所述第一行驶信息、所述第二车辆信息和所述第二行驶信息得到所述无人驾驶车辆和所述目标车辆的避障安全距离，包括：计算所述无人驾驶车辆和所述目标车辆的碰撞时刻，公式如下：y(t)+0.5lvehd*sin(θ(t))-0.5wvehd*cos(θ(t))＝0.5wL0，其中，y(t)为所述无人驾驶车辆在预先规划的主动避障路径上一个位置点时在行驶方向上的位移、lvehd为所述无人驾驶车辆的车身长度、θ(t)为所述无人驾驶车辆在该位置点时的车辆航向角、wvehd为所述无人驾驶车辆的车身宽度、wL0为所述目标车辆的车身宽度，所述无人驾驶车辆在该位置点时的时刻t满足上述公式时，该时刻t作为所述无人驾驶车辆和所述目标车辆的碰撞时刻tadj；计算所述当前时刻下所述无人驾驶车辆和所述目标车辆的第一最小相对位移，公式如下：SL0(tstart)min＝xL0(tstart)-xvehd(tstart)-0.5lL0-0.5lvehd-0.5wvehd，其中，tstart为所述当前时刻、SL0(tstart)min为所述第一最小相对位移、xL0(tstart)为所述当前时刻下所述目标车辆在行驶方向上的位移、xvehd(tstart)为所述当前时刻下所述无人驾驶车辆在行驶方向上的位移、lL0为所述目标车辆的车身长度、wvehd为所述无人驾驶车辆的车身宽度；计算在所述当前时刻到所述碰撞时刻的时段内所述无人驾驶车辆和所述目标车辆的第二最小相对位移，公式如下：
Figure FDA0003401434790000101
其中，SL0(tstart～tadj)min为第二最小相对位移、VL0为所述目标车辆的速度、Vvehd为所述无人驾驶车辆的速度、aL0为所述目标车辆的加速度、avehd为所述无人驾驶车辆的加速度；计算所述无人驾驶车辆和所述目标车辆的避障安全距离，公式如下：SL0(tadj)min＝SL0(tstart)min+SL0(tstart～tadj)min，其中，SL0(tadj)min为所述无人驾驶车辆和所述目标车辆的避障安全距离。
CN201911214071.0A 2019-12-02 2019-12-02 一种避障安全距离计算方法及装置 Active CN112991815B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911214071.0A CN112991815B (zh) 2019-12-02 2019-12-02 一种避障安全距离计算方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911214071.0A CN112991815B (zh) 2019-12-02 2019-12-02 一种避障安全距离计算方法及装置

Publications (2)

Publication Number Publication Date
CN112991815A CN112991815A (zh) 2021-06-18
CN112991815B true CN112991815B (zh) 2022-02-25

Family

ID=76331084

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911214071.0A Active CN112991815B (zh) 2019-12-02 2019-12-02 一种避障安全距离计算方法及装置

Country Status (1)

Country Link
CN (1) CN112991815B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117148848B (zh) * 2023-10-27 2024-01-26 上海伯镭智能科技有限公司 一种无人驾驶车辆智能避障方法及系统

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008065481A (ja) * 2006-09-05 2008-03-21 Mazda Motor Corp 車両用運転支援システム
CN107315411A (zh) * 2017-07-04 2017-11-03 合肥工业大学 一种基于车车协同下无人驾驶车辆的换道轨迹规划方法
WO2018023385A1 (zh) * 2016-08-02 2018-02-08 张阳 一种汽车变道时报警的方法以及报警系统
CN109360445A (zh) * 2018-07-09 2019-02-19 重庆大学 一种基于横向与纵向运动学特征分布的高速换道风险检测方法
CN110356394A (zh) * 2019-07-31 2019-10-22 重庆长安汽车股份有限公司 一种车辆主动避让障碍物的方法、装置及汽车

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9341485B1 (en) * 2003-06-19 2016-05-17 Here Global B.V. Method and apparatus for representing road intersections
JP5070151B2 (ja) * 2008-07-18 2012-11-07 本田技研工業株式会社 車両の走行安全装置
KR102663017B1 (ko) * 2016-11-24 2024-05-07 현대자동차주식회사 차량 및 그 제어방법
CN108257417A (zh) * 2016-12-28 2018-07-06 上海汽车集团股份有限公司 用于路侧单元的车辆碰撞预警方法及装置
CN110379203B (zh) * 2019-06-21 2021-08-03 江苏大学 一种行车转向碰撞预警方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008065481A (ja) * 2006-09-05 2008-03-21 Mazda Motor Corp 車両用運転支援システム
WO2018023385A1 (zh) * 2016-08-02 2018-02-08 张阳 一种汽车变道时报警的方法以及报警系统
CN107315411A (zh) * 2017-07-04 2017-11-03 合肥工业大学 一种基于车车协同下无人驾驶车辆的换道轨迹规划方法
CN109360445A (zh) * 2018-07-09 2019-02-19 重庆大学 一种基于横向与纵向运动学特征分布的高速换道风险检测方法
CN110356394A (zh) * 2019-07-31 2019-10-22 重庆长安汽车股份有限公司 一种车辆主动避让障碍物的方法、装置及汽车

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
罗强.面向高速公路行车安全预警的车道偏离及换道模型研究.《中国优秀博硕士学位论文全文数据库(博士)工程科技Ⅱ辑》.2014,(第12期),参见正文第66-85页，图4.1-4.11. *
面向高速公路行车安全预警的车道偏离及换道模型研究;罗强;《中国优秀博硕士学位论文全文数据库(博士)工程科技Ⅱ辑》;20141215(第12期);参见正文第66-85页，图4.1-4.11 *

Also Published As

Publication number Publication date
CN112991815A (zh) 2021-06-18

Similar Documents

Publication Publication Date Title
DE102016206318B4 (de) Fahrtsteuervorrichtung
CN110546461B (zh) 驾驶控制方法以及驾驶控制装置
CN107848533B (zh) 车辆控制装置、车辆控制方法及存储车辆控制程序的介质
JP7180426B2 (ja) 車両制御システム
CN108974010B (zh) 处理装置、车辆、处理方法以及存储介质
RU2735720C1 (ru) Способ оценки транспортного средства, способ корректировки маршрута движения, устройство оценки транспортного средства и устройство корректировки маршрута движения
EP3451311A1 (en) Method and device for parking assistance
US20210053560A1 (en) System and method for detecting a risk of collision between a motor vehicle and a secondary object located in the traffic lanes adjacent to said vehicle when changing lanes
US11169526B2 (en) Vehicle control device
EP3549837A1 (en) Vehicle control apparatus
CN110949387A (zh) 车辆控制装置
JP2018112989A (ja) 運転補助装置及び運転補助方法
EP3626570B1 (en) Driving assistance method and driving assistance apparatus
JP2020083106A (ja) 車両制御装置、車両制御方法、およびプログラム
JP7234967B2 (ja) 衝突回避支援装置
CN112991815B (zh) 一种避障安全距离计算方法及装置
JP6143184B2 (ja) 走行可否判定装置
JP4661602B2 (ja) 後方車両解析装置及び衝突予測装置
JP6648384B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP6583697B2 (ja) 周辺監視装置、制御装置、周辺監視方法、およびプログラム
CN113479204B (zh) 车辆控制装置、车辆控制方法及存储介质
JP2019202663A (ja) 走路設定装置
CN112896152B (zh) 一种无人驾驶车辆的避障方法及装置
JP2020042340A (ja) 移動体検知システム
WO2023047148A1 (ja) 走行支援方法及び 走行支援装置

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