CN113655469A - 基于智能驾驶的预测感知盲区中存在物体的方法及系统 - Google Patents
基于智能驾驶的预测感知盲区中存在物体的方法及系统 Download PDFInfo
- Publication number
- CN113655469A CN113655469A CN202110783880.4A CN202110783880A CN113655469A CN 113655469 A CN113655469 A CN 113655469A CN 202110783880 A CN202110783880 A CN 202110783880A CN 113655469 A CN113655469 A CN 113655469A
- Authority
- CN
- China
- Prior art keywords
- action
- time
- env
- vehicle
- shielding
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 25
- 230000008447 perception Effects 0.000 claims abstract description 37
- 238000004364 calculation method Methods 0.000 claims abstract description 26
- 230000009471 action Effects 0.000 claims description 81
- 238000012545 processing Methods 0.000 claims description 10
- 238000006243 chemical reaction Methods 0.000 claims description 7
- 230000008859 change Effects 0.000 claims description 4
- 238000011156 evaluation Methods 0.000 claims description 4
- 230000008569 process Effects 0.000 abstract description 2
- 230000000007 visual effect Effects 0.000 abstract 2
- 230000006399 behavior Effects 0.000 description 20
- 238000004891 communication Methods 0.000 description 6
- 230000001133 acceleration Effects 0.000 description 4
- 238000013136 deep learning model Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 101001093748 Homo sapiens Phosphatidylinositol N-acetylglucosaminyltransferase subunit P Proteins 0.000 description 1
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
- G01S13/04—Systems determining presence of a target
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
- G01S15/04—Systems determining presence of a target
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/88—Sonar systems specially adapted for specific applications
- G01S15/93—Sonar systems specially adapted for specific applications for anti-collision purposes
- G01S15/931—Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/04—Systems determining the presence of a target
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
- G01V8/00—Prospecting or detecting by optical means
- G01V8/10—Detecting, e.g. by using light barriers
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Acoustics & Sound (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geophysics (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开基于智能驾驶的预测感知盲区中存在物体的方法及系统,在智能驾驶过程中,通过充分考虑附近物体的预测行为与实际行为的差异,来判定智能驾驶中预测感知盲区中是否存在物体;首先,根据自车的感知信息对目标车辆的行为进行预测;然后,根据目标车辆的预测行为与实际行为的差异程度来判断目标车辆前方存在物体的概率;最后,将物体添加到自车的感知结果中;此外,为了降低计算成本,将检测周围车辆对自动驾驶汽车感知造成的影响,当影响较大时才启动预测算法;在智能驾驶场景中由于其它交通参与者的遮挡形成感知视野盲区时,对视野盲区内存在物体的概率进行估计,让智能驾驶汽车预见可能出现的行人或障碍物,从而提高驾驶的安全性。
Description
技术领域
本发明涉及智能驾驶行业的环境感知领域,尤其是涉及基于智能驾驶的预测感知盲区中存在物体的方法及系统。
背景技术
随着智能驾驶行业的飞速发展,以及社会对驾驶智能化需求的增长,智能驾驶应用的环境也变得越来越复杂。汽车行驶中,传感器受地形、建筑物、交通设施以及树木等的影响使感知范围受到限制,形成感知盲区。感知盲区是引发交通事故的重要原因,给驾驶员、乘客和行为的人身安全造成极大威胁。
公开号为CN103514758A的中国发明专利申请《一种基于车车通信的高效道路交通防碰撞预警方法》公开了一种通过专用短程通信技术(DSRC)获取附近盲区中车辆的运动状态信息,提高十字路口车辆通行安全性。该专利的实施的前提是道路中所有车辆均安装无线通信设备,在此种设备普及率不高情况下,即如果盲区中的车辆、行人、故障物体以及交通设施未安装此种设备,则无法使用该方法。
公开号为CN104376735B的中国发明专利申请《一种盲区路口车辆行驶安全预警系统及其预警方法》公开了一种在路侧立柱的横杆上安装相机、计算与处理模块和无线通信模块,对盲区路口车辆进行检测,并将盲区路口车辆的位置、航向角、速度以及加速度等信息广播出去。该专利的实施的前提是车辆安装车载单元,路边安装路侧单元,增加了智能驾驶的成本。并且,该专利只针对路口盲区,无法覆盖整个路段。相比路口通行,车辆在路段行驶时速度较快,此时由于其它车辆、路障的遮挡造成的盲区的危害性更大。
发明内容
为解决现有技术的不足,本发明在智能驾驶过程中对比周围感知范围内的物体的预测行为与实际行为之间的差异,通过自身车载传感器主动实时获取感知盲区中的信息,推断盲区中是否存在物体,无需额外增加车-车、车-路通信单元,实现提高智能驾驶的安全性的目的,本发明采用如下的技术方案:
基于智能驾驶的预测感知盲区中存在物体的方法,包括如下步骤:
S1,汽车V上的感知系统,在tk时刻,感知到汽车V坐标系XOY下,一组被感知物体的状态集合{s(oi,tk) | i=1,2,3,...,N},生成感知结果Env(V,tk),s(oi,tk)表示第i个被感知物体oi的状态,包括被感知物体oi的位置(xi,yi)、航向角φ、速度以及加速度等信息,k为自然数,N为被感知到的物体数量;所述感知系统包括激光雷达、超声波雷达、超声波雷达以及相机;
S2,选择出n个被感知物体v1,v2,...,vn,其中任意一个被感知物体vi作为一个遮挡子,其满足以下要求:
(a)vi为具有主动运动能力的物体;
(b)vi位于汽车V即将要行驶的线路附近;
(c)vi遮挡了汽车V的感知系统对周围环境发出的电磁波信号,和/或遮挡了汽车V的感知系统从周围环境接收电磁波信号;
S3,对每个vi进行处理,设vi的前进方向上,存在未被汽车V感知到的物体oi’,汽车V根据感知结果是否包括oi’,规划出两条等时长T的轨迹,不考虑oi’的轨迹与考虑oi’的轨迹,轨迹由等时长间隔dt的轨迹点序列组成,标记为{pt=(xt,yt),t=0,dt,2dt,...,T},两条轨迹在时间点t的差异et,通过计算不考虑oi’的轨迹上第t个时间点的位置p不考虑,t,与考虑oi’的轨迹上第t个时间点的位置p考虑,t的欧式距离et=((x不考虑,t-x考虑,t)2+(y不考虑,t-y考虑,t)2)(1/2),得到两条轨迹所有对应时间点的欧氏距离并求和E=e0+edt+e2dt+...+eT,利用E评估物体oi’对汽车V的行驶造成的影响度;所述等时长T为2秒,等时长间隔dt为0.1秒;
S4,选出遮挡子的影响度大于影响阈值的一组遮挡子vv,并对每个所述遮挡子vv进行如下处理:
S41,选取与遮挡子vv类型相匹配的感知计算模型;
所述感知计算模型,是二维坐标系转换,将汽车V坐标系XOY下的感知结果Env(V,tk)和汽车V当前状态,转换到遮挡子vv坐标系X’O’Y’下,转换后的Env_tfm(vv,tk),表示遮挡子vv在tk时刻的推算感知结果,当k<0时,定义Env_tfm(vv,tk)为空集;
S42,选取与遮挡子vv类型相匹配的行为预测计算模型,所述行为预测计算模型,是考虑遮挡子vv类型的历史轨迹、动运学约束、动力学约束、道路地图、交通规则以及道路中其它交通参与者的深度学习模型,利用行为预测计算模型,根据Env_tfm(vv,tk1),Env_tfm(vv,tk1-1),...,Env_tfm(vv,tk1-h1),预测出遮挡子vv从tk1时刻到tk时刻间会做出的预测行动action_p,其中k1=k - δ,δ为预设正整数,h1为预设阈值,h1>=1;
S43,根据汽车V对遮挡子vv在tk,tk-1,tk-2,...,tk1时刻的感知结果s(vv,tk), s(vv,tk-1),s(vv,tk-2),...,s(vv,tk1),计算遮挡子vv从tk1时刻到tk时刻间的实际行动action_a,其中当j<0时,定义s(vv,tj)为空集;
S44,度量action_p和action_a的差异,当其大于等于差异阈值时,根据遮挡子vv的类型,设定遮挡子vv在时间tk时刻的速度为vtk,设定遮挡子vv前进方向距离为mvtk上,存在物体ov,m为距离系数,物体ov加上Env_tfm(vv,tk)后,利用遮挡子vv对应的行为预测计算模型,预测出vv从tk1时刻到tk时刻间会做出的行动action_c;度量action_p和action_c的差异,并与度量action_p和action_a的差异计算存在物体ov的概率,若存在物体概率大于存在阈值,则将存在物体的状态转换为由汽车V的感知结果,并添加入Env(V, tk)中;
S5,输出添加后的感知结果Env(V, tk),其为汽车V在tk时刻,对遮挡进行补偿后感知结果。
进一步地,所述S44中,存在物体ov的概率为min(dist(action_p, action_a)/dist(action_p, action_c), 1.0)。
进一步地,所述S4中,预测行动action_p为遮挡子vv从tk1时刻到tk时刻预测的位置姿态变化(xp, yp, θ p);实际行动action_a为遮挡子vv从tk1时刻到tk时刻的实际位置姿态变化(xa, ya, θ a);度量action_p和action_a的差异:dist(action_p, action_a)=w1|xa-xp|+w2|ya-yp|+w3|θ a-θ p|;行动action_c=(xc, yc, θ c),度量action_p和action_c的差异:dist(action_p, action_c)=w1|xc-xp|+w2|yc-yp|+w3|θ c-θ p|。
进一步地,所述S2的(a)中,通过记录vi的历史速度,确定vi为具有主动运动能力的物体。
进一步地,所述S2的(b)中,通过计算vi的位置(xi,yi),与汽车V即将行驶的线路的车道中心线R,最短距离d(vi,R)小于第一距离阈值,确定vi位于汽车V即将要行驶的线路附近。
进一步地,所述第一距离阈值,是3倍的当前所在车道的车道宽度。
进一步地,所述vi相对于汽车V的距离小于第二距离阈值,确定vi位于汽车V即将要行驶的线路附近。
进一步地,所述第二距离阈值,为2倍的汽车V的速度值。
进一步地,所述S2的(c)中,通过计算vi占据汽车V的感知水平视场角度θ小于角度阈值,判断vi遮挡了汽车V的感知系统对周围环境发出的电磁波信号,和/或遮挡了汽车V的感知系统从周围环境接收电磁波信号。
基于智能驾驶的预测感知盲区中存在物体的系统,包括汽车本体V、感知系统、处理单元,所述处理单元分别与感知计算模型和行为预测计算模型连接;
所述感知系统,在tk时刻,感知到汽车V坐标系XOY下,一组被感知物体的状态集合{s(oi,tk) | i=1,2,3,...,N},生成感知结果Env(V,tk),s(oi,tk)表示第i个被感知物体oi的状态,包括被感知物体oi的位置(xi,yi)、航向角φ、速度以及加速度等信息,k为自然数,N为被感知到的物体数量;所述感知系统包括激光雷达、超声波雷达、超声波雷达以及相机;
所述处理单元,选择出n个被感知物体v1,v2,...,vn,其中任意一个被感知物体vi作为一个遮挡子,其满足以下要求:
(a)vi为具有主动运动能力的物体;
(b)vi位于汽车V即将要行驶的线路附近;
(c)vi遮挡了汽车V的感知系统对周围环境发出的电磁波信号,和/或遮挡了汽车V的感知系统从周围环境接收电磁波信号;
对每个vi进行处理,设vi的前进方向上,存在未被汽车V感知到的物体oi’,汽车V根据感知结果是否包括oi’,规划出两条等时长T的轨迹,不考虑oi’的轨迹与考虑oi’的轨迹,轨迹由等时长间隔dt的轨迹点序列组成,标记为{pt=(xt,yt),t=0,dt,2dt,...,T},两条轨迹在时间点t的差异et,通过计算不考虑oi’的轨迹上第t个时间点的位置p不考虑,t,与考虑oi’的轨迹上第t个时间点的位置p考虑,t的欧式距离et=((x不考虑,t-x考虑,t)2+(y不考虑,t-y考虑,t)2)(1/2),得到两条轨迹所有对应时间点的欧氏距离并求和E=e0+edt+e2dt+...+eT,利用E评估物体oi’对汽车V的行驶造成的影响度;所述等时长T为2秒,等时长间隔dt为0.1秒;
根据汽车V对遮挡子vv在tk,tk-1,tk-2,...,tk1时刻的感知结果s(vv,tk), s(vv,tk-1),s(vv,tk-2),...,s(vv,tk1),计算遮挡子vv从tk1时刻到tk时刻间的实际行动action_a,其中当j<0时,定义s(vv,tj)为空集;
度量action_p和action_a的差异,当其大于等于差异阈值时,根据遮挡子vv的类型,设定遮挡子vv在时间tk时刻的速度为vtk,设定遮挡子vv前进方向距离为mvtk上,存在物体ov,m为距离系数,物体ov加上Env_tfm(vv,tk)后,利用遮挡子vv对应的行为预测计算模型,预测出vv从tk1时刻到tk时刻间会做出的行动action_c;度量action_p和action_c的差异,并与度量action_p和action_a的差异计算存在物体ov的概率,若存在物体概率大于存在阈值,则将存在物体的状态转换为由汽车V的感知结果,并添加入Env(V, tk)中,输出添加后的感知结果Env(V, tk),其为汽车V在tk时刻,对遮挡进行补偿后感知结果;
所述感知计算模型,对选取的遮挡子的影响度大于影响阈值的一组遮挡子vv,进行二维坐标系转换,将汽车V坐标系XOY下的感知结果Env(V, tk)和汽车V当前状态,转换到遮挡子vv坐标系X’O’Y’下,转换后的Env_tfm(vv,tk),表示遮挡子vv在tk时刻的推算感知结果,当k<0时,定义Env_tfm(vv,tk)为空集;
所述行为预测计算模型,是考虑遮挡子vv类型的历史轨迹、动运学约束、动力学约束、道路地图、交通规则以及道路中其它交通参与者的深度学习模型,利用行为预测计算模型,对选取与遮挡子vv类型相匹配的行为预测,根据Env_tfm(vv,tk1),Env_tfm(vv,tk1-1),...,Env_tfm(vv,tk1-h1),预测出遮挡子vv从tk1时刻到tk时刻间会做出的预测行动action_p,其中k1=k - δ,δ为预设正整数,h1为预设阈值,h1>=1。
本发明的优势和有益效果在于:
本发明无需增加额外车-车、车-路通信单元,仅通过自身车载传感器对附近的物体进行感知,进而预测物体的行为,最终通过对比物体的预测行为与真实行为间的差异来推断盲区中是否存在物体,利用推断结果对自身的感知结果进行补偿,使智能驾驶决策规划模块能够预先考虑感知盲区的存在的物体,产生安全的驾驶行为。
附图说明
图1为由于物体遮挡造成汽车V感知盲区的示意图。
图2为本发明中计算遮挡子对汽车V的行驶造成影响的程度的示意图。
图3为本发明中二维坐标系转换公式的示意图。
具体实施方式
以下结合附图对本发明的具体实施方式进行详细说明。应当理解的是,此处所描述的具体实施方式仅用于说明和解释本发明,并不用于限制本发明。
一种在智能驾驶中预测感知盲区中存在物体的方法,包括以下步骤:
(1)在汽车V上安装由激光雷达、超声波雷达、超声波雷达以及相机等组成的感知系统,设在tk时刻,k为自然数下标,该感知系统对当前周围环境进行感知,输出被感知到的若干物体在tk时刻的状态,记在tk时刻第i个被感知到的物体oi的状态为s(oi,tk),s(oi,tk)由物体在汽车V本体坐标系下的位置、航向角、速度以及加速度等信息组成。如图1所示,假设在汽车V附近有物体o1与o2。其中,物体o1被汽车V感知到;物体o2由于被物体o1遮挡未被汽车V感知到。汽车V本体坐标系为XOY,物体o1被在XOY上的坐标点为(x,y),航向角为phi。集合{s(oi,tk) | i=1,...,N, N为被感知到的物体数量}为感知系统对周围环境的感知结果,该感知结果由Env(V, tk)标识。
(2)从被感知物体o1,o2,...,oN中选择出n个被感知物体v1,v2,...,vn,其中任意一个被选择的被感知物体vi称为一个遮挡子,其满足以下要求:(a)vi为具有主动运动能力的物体;该条可通过记录vi的历史速度来确定,一个优选的判定方法为: vi过去10秒内存在速度不为零,则 vi为具有主动运动能力的物体。(b)vi位于汽车V即将要行驶的线路附近,可以通过计算vi的位置(x,y)与汽车V即将行驶的线路的车道中心线R的最短距离d(vi,R)来确定vi位于汽车V即将要行驶的线路附近,一个优选的判定条件为:当d(vi,R)小于3倍的当前所在车道的车道宽度,则vi位于汽车V即将要行驶的线路附近;且相对于汽车V的距离小于预设阈值,一个优选的阈值可设定为2倍的汽车V的速度值。(c)vi严重遮挡了汽车V的感知系统对周围环境发出的电磁波信号,或者严重遮挡了汽车V的感知系统从周围环境接收电磁波信号;一个优选的判定方法如图2所示,通过计算物体 vi占据汽车V感知水平视场角度theta小于某设定阈值来判断vi严重遮挡了汽车V的感知系统对周围环境发出的电磁波信号,或者严重遮挡了汽车V的感知系统从周围环境接收电磁波信号。
(3)每个遮挡子vi进行处理,其中i=1,..., n。如图2所示,o1被判定为遮挡子v1,假设v1的前进方向上存在着一个未被汽车V感知到的物体o2。汽车V根据感知结果是否包括o2规划出两条等时长T(一个优选的时长为2秒)的轨迹,图2中不考虑o2的轨迹(由带箭头实线表示)与考虑o2的轨迹(由带箭头虚线表示)。轨迹由等时长间隔dt(一个优选的时长间隔为0.1秒)的轨迹点序列组成,标记为{pt=(xt,yt),t=0,dt,2dt,...,T}。两条轨迹在时间点t的差异e可以通过计算不考虑o2的轨迹上第t个点p不考虑,t与考虑o2的轨迹上第t个点p考虑,t的欧式距离et=((x不考虑,t-x考虑,t)2+(y不考虑,t-y考虑,t)2)(1/2)。求出两条轨迹所有对应点的欧氏距离并求和E=e0+edt+e2dt+...+eT。利用E评估该物体对汽车V的行驶造成影响的程度。
(4)选择出遮挡子的影响度大于预定阈值的若干遮挡子,再对每个这样选出的遮挡子vv进行如下处理:
(4.1)根据vv的类型,选择与vv类型相匹配的感知计算模型,一个优选的感知计算模型是如图3所示的二维坐标系转换公式。二维坐标系转换公式将汽车V坐标系XOY下的感知结果Env(V, tk)和汽车V的当前状态转换到vv坐标系X’O’Y’下,转换后的数据集记为Env_tfm(vv,tk),称为vv在tk时刻的推算感知结果,当k<0时,定义Env_tfm(vv,tk)为空集;具体地,根据汽车V位姿构建坐标系XOY,遮挡子vv在坐标系XOY下的位姿为(xvv, yvv, θ vv),基于vv的位姿,构建坐标系X’O’Y’,在坐标系XOY下的位姿点(x, y, θ),可以利用如下二维坐标系转换公式得到该位姿点再坐标系X’O’Y’的坐标与方向角(x’, y’, θ’):
x’=(x-xvv)cosθ vv +(y-yvv) sinθ vv
y’=(y-yvv)cosθ vv -(x-xvv) sinθ vv
θ’=θ-θ vv 。
(4.2)根据vv的类型,选择与vv类型相匹配的行为预测计算模型,一个优选的行为预测计算模型是考虑vv类型的历史轨迹、动运学约束、动力学约束、道路地图、交通规则以及道路中其它交通参与者的深度学习模型。利用该行为预测计算模型,根据Env_tfm(vv,tk1),Env_tfm(vv,tk1-1),...,Env_tfm(vv,tk1-h1),预测出vv从tk1时刻到tk时刻间会做出的行动action_p。一个优选的预测行动action_p表示为vv从tk1时刻到tk时刻的预测位置姿态变化,记为(xp, yp, thetap),其中k1=k - delta,delta为预设正整数,h1为预设阈值,h1>=1。
(4.3)根据由汽车V对vv在tk,tk-1,tk-2,...,tk1时刻的感知结果s(vv,tk), s(vv,tk-1),s(vv,tk-2),...,s(vv,tk1),计算vv从tk1时刻到tk时刻间实际做出的行动action_a,其中当j<0时,定义s(vv,tj)为空集;一个优选的实际行动表示为vv从tk1时刻到tk时刻的实际位置姿态变化,记为(xa, ya, thetaa)。
(4.4)度量action_p和action_a的差异,一个优选的度量公式为dist(action_p,action_a)=w1|xa-xp|+w2|ya-yp|+w3|thetaa-thetap|, 当差异大于等于预定阈值时,则进行如下处理:根据vv的类型,使用Env_tfm(vv,tk)和action_a,估计tk时刻在vi的前进方向上除了Env_tfm(vv,tk)中记录的物体还存在其他物体的概率以及该可能存在物体的可能位置,一个优选的方案是,vv在时间tk时刻的速度为vtk,假定vv正前方距离为2vtk的存在物体ov, 并加Env_tfm(vv,tk),利用vv对应的行为预测计算模型,预测出vv从tk1时刻到tk时刻间会做出的行动action_c=(xc, yc, thetac),度量action_p和action_c的差异dist(action_p, action_c)=w1|xc-xp|+w2|yc-yp|+w3|thetac-thetap|,利用dist(action_p, action_c)与dist(action_p, action_a)计算存在物体ov的概率为min(dist(action_p, action_a)/dist(action_p, action_c), 1.0)。若存在物体概率大于预定阈值,则将该物体的状态转换为由汽车V的感知结果,并添加入Env(V, tk)中。
(5)输出Env(V, tk),其为汽车V在t时刻对遮挡进行补偿后感知结果。
以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明实施例技术方案的范围。
Claims (10)
1.基于智能驾驶的预测感知盲区中存在物体的方法,其特征在于包括如下步骤:
S1,汽车V上的感知系统,在tk时刻,感知到汽车V坐标系XOY下,一组被感知物体的状态集合{s(oi,tk) | i=1,2,3,...,N},生成感知结果Env(V,tk),s(oi,tk)表示第i个被感知物体oi的状态,包括被感知物体oi的位置(xi,yi),k为自然数,N为被感知到的物体数量;
S2,选择出n个被感知物体v1,v2,...,vn,被感知物体vi作为遮挡子,其满足以下要求:
(a)vi为具有主动运动能力的物体;
(b)vi位于汽车V即将要行驶的线路附近;
(c)vi遮挡了汽车V的感知系统对周围环境发出的电磁波信号,和/或遮挡了汽车V的感知系统从周围环境接收电磁波信号;
S3,对vi进行处理,设vi的前进方向上,存在未被汽车V感知到的物体oi’,汽车V根据感知结果是否包括oi’,规划出两条等时长T的轨迹,不考虑oi’的轨迹与考虑oi’的轨迹,轨迹由等时长间隔dt的轨迹点序列组成,标记为{pt=(xt,yt),t=0,dt,2dt,...,T},两条轨迹在时间点t的差异et,通过计算不考虑oi’的轨迹上第t个时间点的位置p不考虑,t,与考虑oi’的轨迹上第t个时间点的位置p考虑,t的欧式距离et=((x不考虑,t-x考虑,t)2+(y不考虑,t-y考虑,t)2)(1/2),得到两条轨迹对应时间点的欧氏距离并求和E=e0+edt+e2dt+...+eT,利用E评估物体oi’对汽车V的行驶造成的影响度;
S4,选出遮挡子的影响度大于影响阈值的一组遮挡子vv,并对所述遮挡子vv进行如下处理:
S41,二维坐标系转换,将汽车V坐标系XOY下的感知结果Env(V, tk)和汽车V当前状态,转换到遮挡子vv坐标系X’O’Y’下,转换后的Env_tfm(vv,tk),表示遮挡子vv在tk时刻的推算感知结果,当k<0时,定义Env_tfm(vv,tk)为空集;
S42,选取与遮挡子vv类型相匹配的行为预测计算模型,根据Env_tfm(vv,tk1),Env_tfm(vv,tk1-1),...,Env_tfm(vv,tk1-h1),预测出遮挡子vv从tk1时刻到tk时刻间会做出的预测行动action_p,其中k1=k - δ,δ为预设正整数,h1为预设阈值,h1>=1;
S43,根据汽车V对遮挡子vv在tk,tk-1,tk-2,...,tk1时刻的感知结果s(vv,tk), s(vv,tk-1),s(vv,tk-2),...,s(vv,tk1),计算遮挡子vv从tk1时刻到tk时刻间的实际行动action_a,其中当j<0时,定义s(vv,tj)为空集;
S44,度量action_p和action_a的差异,当其大于等于差异阈值时,根据遮挡子vv的类型,设定遮挡子vv在时间tk时刻的速度为vtk,设定遮挡子vv前进方向距离为mvtk上,存在物体ov,m为距离系数,物体ov加上Env_tfm(vv,tk)后,利用遮挡子vv对应的行为预测计算模型,预测出vv从tk1时刻到tk时刻间会做出的行动action_c;度量action_p和action_c的差异,并与度量action_p和action_a的差异计算存在物体ov的概率,若存在物体概率大于存在阈值,则将存在物体的状态转换为由汽车V的感知结果,并添加入Env(V, tk)中;
S5,输出添加后的感知结果Env(V, tk)。
2.根据权利要求1所述的基于智能驾驶的预测感知盲区中存在物体的方法,其特征在于所述S44中,存在物体ov的概率为min(dist(action_p, action_a)/dist(action_p,action_c), 1.0)。
3.根据权利要求1所述的基于智能驾驶的预测感知盲区中存在物体的方法,其特征在于所述S4中,预测行动action_p为遮挡子vv从tk1时刻到tk时刻预测的位置姿态变化(xp,yp, θ p);实际行动action_a为遮挡子vv从tk1时刻到tk时刻的实际位置姿态变化(xa, ya,θ a);度量action_p和action_a的差异:dist(action_p, action_a)=w1|xa-xp|+w2|ya-yp|+w3|θ a-θ p|;行动action_c=(xc, yc, θ c),度量action_p和action_c的差异:dist(action_p,action_c)=w1|xc-xp|+w2|yc-yp|+w3|θ c-θ p|。
4.根据权利要求1所述的基于智能驾驶的预测感知盲区中存在物体的方法,其特征在于所述S2的(a)中,通过记录vi的历史速度,确定vi为具有主动运动能力的物体。
5.根据权利要求1所述的基于智能驾驶的预测感知盲区中存在物体的方法,其特征在于所述S2的(b)中,通过计算vi的位置(xi,yi),与汽车V即将行驶的线路的车道中心线R,最短距离d(vi,R)小于第一距离阈值,确定vi位于汽车V即将要行驶的线路附近。
6.根据权利要求5所述的基于智能驾驶的预测感知盲区中存在物体的方法,其特征在于所述第一距离阈值,是3倍的当前所在车道的车道宽度。
7.根据权利要求5所述的基于智能驾驶的预测感知盲区中存在物体的方法,其特征在于vi相对于汽车V的距离小于第二距离阈值,确定vi位于汽车V即将要行驶的线路附近。
8.根据权利要求7所述的基于智能驾驶的预测感知盲区中存在物体的方法,其特征在于所述第二距离阈值,为2倍的汽车V的速度值。
9.根据权利要求1所述的基于智能驾驶的预测感知盲区中存在物体的方法,其特征在于所述S2的(c)中,通过计算vi占据汽车V的感知水平视场角度θ小于角度阈值,判断vi遮挡了汽车V的感知系统对周围环境发出的电磁波信号,和/或遮挡了汽车V的感知系统从周围环境接收电磁波信号。
10.基于智能驾驶的预测感知盲区中存在物体的系统,包括汽车本体V、感知系统、处理单元,其特征在于所述处理单元分别与感知计算模型和行为预测计算模型连接;
所述感知系统,在tk时刻,感知到汽车V坐标系XOY下,一组被感知物体的状态集合{s(oi,tk) | i=1,2,3,...,N},生成感知结果Env(V,tk),s(oi,tk)表示第i个被感知物体oi的状态,包括被感知物体oi的位置(xi,yi),k为自然数,N为被感知到的物体数量;
所述处理单元,选择出n个被感知物体v1,v2,...,vn,被感知物体vi作为遮挡子,其满足以下要求:
(a)vi为具有主动运动能力的物体;
(b)vi位于汽车V即将要行驶的线路附近;
(c)vi遮挡了汽车V的感知系统对周围环境发出的电磁波信号,和/或遮挡了汽车V的感知系统从周围环境接收电磁波信号;
对vi进行处理,设vi的前进方向上,存在未被汽车V感知到的物体oi’,汽车V根据感知结果是否包括oi’,规划出两条等时长T的轨迹,不考虑oi’的轨迹与考虑oi’的轨迹,轨迹由等时长间隔dt的轨迹点序列组成,标记为{pt=(xt,yt),t=0,dt,2dt,...,T},两条轨迹在时间点t的差异et,通过计算不考虑oi’的轨迹上第t个时间点的位置p不考虑,t,与考虑oi’的轨迹上第t个时间点的位置p考虑,t的欧式距离et=((x不考虑,t-x考虑,t)2+(y不考虑,t-y考虑,t)2)(1/2),得到两条轨迹对应时间点的欧氏距离并求和E=e0+edt+e2dt+...+eT,利用E评估物体oi’对汽车V的行驶造成的影响度;
根据汽车V对遮挡子vv在tk,tk-1,tk-2,...,tk1时刻的感知结果s(vv,tk), s(vv,tk-1),s(vv,tk-2),...,s(vv,tk1),计算遮挡子vv从tk1时刻到tk时刻间的实际行动action_a,其中当j<0时,定义s(vv,tj)为空集;
度量action_p和action_a的差异,当其大于等于差异阈值时,根据遮挡子vv的类型,设定遮挡子vv在时间tk时刻的速度为vtk,设定遮挡子vv前进方向距离为mvtk上,存在物体ov,m为距离系数,物体ov加上Env_tfm(vv,tk)后,利用遮挡子vv对应的行为预测计算模型,预测出vv从tk1时刻到tk时刻间会做出的行动action_c;度量action_p和action_c的差异,并与度量action_p和action_a的差异计算存在物体ov的概率,若存在物体概率大于存在阈值,则将存在物体的状态转换为由汽车V的感知结果,并添加入Env(V, tk)中,输出添加后的感知结果Env(V, tk);
所述感知计算模型,对选取的遮挡子的影响度大于影响阈值的一组遮挡子vv,进行二维坐标系转换,将汽车V坐标系XOY下的感知结果Env(V, tk)和汽车V当前状态,转换到遮挡子vv坐标系X’O’Y’下,转换后的Env_tfm(vv,tk),表示遮挡子vv在tk时刻的推算感知结果,当k<0时,定义Env_tfm(vv,tk)为空集;
所述行为预测计算模型,对选取与遮挡子vv类型相匹配的行为预测,根据Env_tfm(vv,tk1),Env_tfm(vv,tk1-1),...,Env_tfm(vv,tk1-h1),预测出遮挡子vv从tk1时刻到tk时刻间会做出的预测行动action_p,其中k1=k - δ,δ为预设正整数,h1为预设阈值,h1>=1。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110783880.4A CN113655469B (zh) | 2021-07-12 | 2021-07-12 | 基于智能驾驶的预测感知盲区中存在物体的方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110783880.4A CN113655469B (zh) | 2021-07-12 | 2021-07-12 | 基于智能驾驶的预测感知盲区中存在物体的方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113655469A true CN113655469A (zh) | 2021-11-16 |
CN113655469B CN113655469B (zh) | 2023-12-12 |
Family
ID=78477247
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110783880.4A Active CN113655469B (zh) | 2021-07-12 | 2021-07-12 | 基于智能驾驶的预测感知盲区中存在物体的方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113655469B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114274979A (zh) * | 2022-01-07 | 2022-04-05 | 中国第一汽车股份有限公司 | 自动驾驶的目标关注度等级判别方法、装置及存储介质 |
CN116321072A (zh) * | 2023-03-13 | 2023-06-23 | 阿里云计算有限公司 | 基于感知失效的数据补偿方法以及装置 |
CN117593904A (zh) * | 2023-11-06 | 2024-02-23 | 广东省电信规划设计院有限公司 | 基于云原生的辅助驾驶控制方法及装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20190086549A1 (en) * | 2017-09-15 | 2019-03-21 | Toyota Research Institute, Inc. | System and method for object detection using a probabilistic observation model |
WO2019172104A1 (ja) * | 2018-03-09 | 2019-09-12 | 日立オートモティブシステムズ株式会社 | 移動体挙動予測装置 |
WO2019213981A1 (zh) * | 2018-05-08 | 2019-11-14 | 清华大学 | 基于等效力的行车风险实时评估方法及其装置 |
CN110481526A (zh) * | 2019-07-22 | 2019-11-22 | 江苏大学 | 一种智能汽车传感器盲区行人检测及主动避撞方法 |
CN111554088A (zh) * | 2020-04-13 | 2020-08-18 | 重庆邮电大学 | 一种多功能v2x智能路侧基站系统 |
-
2021
- 2021-07-12 CN CN202110783880.4A patent/CN113655469B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20190086549A1 (en) * | 2017-09-15 | 2019-03-21 | Toyota Research Institute, Inc. | System and method for object detection using a probabilistic observation model |
WO2019172104A1 (ja) * | 2018-03-09 | 2019-09-12 | 日立オートモティブシステムズ株式会社 | 移動体挙動予測装置 |
WO2019213981A1 (zh) * | 2018-05-08 | 2019-11-14 | 清华大学 | 基于等效力的行车风险实时评估方法及其装置 |
CN110481526A (zh) * | 2019-07-22 | 2019-11-22 | 江苏大学 | 一种智能汽车传感器盲区行人检测及主动避撞方法 |
CN111554088A (zh) * | 2020-04-13 | 2020-08-18 | 重庆邮电大学 | 一种多功能v2x智能路侧基站系统 |
Non-Patent Citations (2)
Title |
---|
王昊;刘雍翡;: "基于双目视觉计算的车辆跟驰状态实时感知系统", 中国公路学报, no. 12 * |
谢辉;高斌;熊硕;王悦;: "结构化道路中动态车辆的轨迹预测", 汽车安全与节能学报, no. 04 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114274979A (zh) * | 2022-01-07 | 2022-04-05 | 中国第一汽车股份有限公司 | 自动驾驶的目标关注度等级判别方法、装置及存储介质 |
CN116321072A (zh) * | 2023-03-13 | 2023-06-23 | 阿里云计算有限公司 | 基于感知失效的数据补偿方法以及装置 |
CN116321072B (zh) * | 2023-03-13 | 2024-01-23 | 阿里云计算有限公司 | 基于感知失效的数据补偿方法以及装置 |
CN117593904A (zh) * | 2023-11-06 | 2024-02-23 | 广东省电信规划设计院有限公司 | 基于云原生的辅助驾驶控制方法及装置 |
CN117593904B (zh) * | 2023-11-06 | 2024-08-02 | 广东省电信规划设计院有限公司 | 基于云原生的辅助驾驶控制方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN113655469B (zh) | 2023-12-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20210370921A1 (en) | Vehicle collision avoidance based on perturbed object trajectories | |
CN107918758B (zh) | 能够进行环境情景分析的车辆 | |
JP2021527591A (ja) | オクルージョン認識プランニング | |
US20180239361A1 (en) | Autonomous Driving At Intersections Based On Perception Data | |
CN113655469A (zh) | 基于智能驾驶的预测感知盲区中存在物体的方法及系统 | |
JP2021531208A (ja) | 車両のための衝突予測及び回避 | |
US11648939B2 (en) | Collision monitoring using system data | |
JP7205154B2 (ja) | 表示装置 | |
US11697412B2 (en) | Collision monitoring using statistic models | |
KR102588008B1 (ko) | 진입하거나 진출하는 차량을 검출하기 위한 방법 및 제어 유닛 | |
CN105774806A (zh) | 车辆行驶控制装置 | |
CN106114217A (zh) | 行驶控制装置 | |
KR20180092101A (ko) | Ecu, 상기 ecu를 포함하는 무인 자율 주행 차량, 및 이의 주행 차로 판단 방법 | |
US11390288B2 (en) | Other-vehicle action prediction method and other-vehicle action prediction device | |
CN105702088A (zh) | 警报装置 | |
US11042160B2 (en) | Autonomous driving trajectory determination device | |
US11493919B2 (en) | Vehicle including information presentation apparatus for presenting information to driver | |
US20230242149A1 (en) | Radar object classification based on radar cross-section data | |
CN113844445A (zh) | 基于预测参考线坐标系的车辆自动紧急制动系统与方法 | |
CN107200016A (zh) | 道路自适应预测方法及采用该方法的车辆系统 | |
CN118235180A (zh) | 预测可行驶车道的方法和装置 | |
US20230419830A1 (en) | Determining right of way | |
CN115140096A (zh) | 一种基于样条曲线与多项式曲线的自动驾驶轨迹规划方法 | |
CN116674593A (zh) | 用于自主车辆的具有异常检测的安全增强规划系统 | |
CN116736855A (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 |