CN113997862B - 一种基于冗余传感器的工程车盲区监测预警系统及方法 - Google Patents
一种基于冗余传感器的工程车盲区监测预警系统及方法 Download PDFInfo
- Publication number
- CN113997862B CN113997862B CN202111398179.7A CN202111398179A CN113997862B CN 113997862 B CN113997862 B CN 113997862B CN 202111398179 A CN202111398179 A CN 202111398179A CN 113997862 B CN113997862 B CN 113997862B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- target object
- alarm
- information
- blind area
- 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
Links
- 238000012544 monitoring process Methods 0.000 title claims abstract description 33
- 238000000034 method Methods 0.000 title claims abstract description 30
- 230000004927 fusion Effects 0.000 claims abstract description 33
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 17
- 238000005259 measurement Methods 0.000 claims description 35
- 239000011159 matrix material Substances 0.000 claims description 25
- 238000001914 filtration Methods 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 claims description 4
- 238000001514 detection method Methods 0.000 claims description 4
- 238000004088 simulation Methods 0.000 claims description 4
- 230000003068 static effect Effects 0.000 claims description 4
- 230000007704 transition Effects 0.000 claims description 4
- 230000003137 locomotive effect Effects 0.000 claims description 3
- 238000013461 design Methods 0.000 abstract description 3
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical compound [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 description 6
- 206010039203 Road traffic accident Diseases 0.000 description 5
- 239000004566 building material Substances 0.000 description 5
- 238000010276 construction Methods 0.000 description 3
- 238000007499 fusion processing Methods 0.000 description 3
- 229910052742 iron Inorganic materials 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 239000000428 dust Substances 0.000 description 2
- 239000002689 soil Substances 0.000 description 2
- 230000009897 systematic effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- CLOMYZFHNHFSIQ-UHFFFAOYSA-N clonixin Chemical compound CC1=C(Cl)C=CC=C1NC1=NC=CC=C1C(O)=O CLOMYZFHNHFSIQ-UHFFFAOYSA-N 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000035772 mutation Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Q—ARRANGEMENT OF SIGNALLING OR LIGHTING DEVICES, THE MOUNTING OR SUPPORTING THEREOF OR CIRCUITS THEREFOR, FOR VEHICLES IN GENERAL
- B60Q9/00—Arrangement or adaptation of signal devices not provided for in one of main groups B60Q1/00 - B60Q7/00, e.g. haptic signalling
- B60Q9/008—Arrangement or adaptation of signal devices not provided for in one of main groups B60Q1/00 - B60Q7/00, e.g. haptic signalling for anti-collision purposes
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Mechanical Engineering (AREA)
- Traffic Control Systems (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明提出的一种基于冗余传感器的工程车盲区监测预警系统及方法，涉及智能驾驶技术领域。所述方法包括：控制器接收车载传感器发送的本车行驶信息；根据本车行驶信息，判断车辆行驶状态，并根据车辆行驶状态计算盲区范围；控制器接收毫米波传感器和摄像头发送的目标物信息；根据目标物信息判定目标物是否为有效目标；若目标物为有效目标，采用预设算法对目标物信息进行融合，生成目标物信息融合结果；判断目标物是否在盲区范围内，并根据预设报警条件启动报警装置进行分级预警。本发明通过使用多传感器融合的方式对工程车盲区进行监测，并进行相应算法的冗余性设计，有效的提高盲区监测的准确性和可靠性。
Description
技术领域
本发明涉及智能驾驶技术领域，更具体的说是涉及一种基于冗余传感器的工程车盲区监测预警系统及方法。
背景技术
工程车具有车身“高、长、大”的特点，驾驶员驾驶过程中存在无法观测到的视觉盲区，从而发生骑车人或行人被卷入车底而造成伤亡的交通事故。特别地，车辆在转弯时存在内轮差和视野盲区，特别容易造成交通事故。资料显示，全球每年有50万例交通事故是盲区引起的，其中由于后视镜盲区造成的交通事故占30％。鉴于后视镜盲区交通事故的严重性和现有后视镜显示范围有限性，我们应从智能化入手对其综合性能对后视镜盲区问题进行优化提升。因此，需要一种盲区监测预警系统，对驾驶员进行驾驶辅助。研究表明，盲区监测预警系统可以有效提高车辆行车安全性。
当前，现有的商用车盲区监测方案，普遍使用了毫米波雷达方案。工程车多在工地作业，存在较多尘土、建筑物料、工人等。针对工程车作业环境的复杂性，单传感器无法实现功能的准确性。视觉类摄像机受尘土影响严重，雷达无法准确分辨目标物类别，容易将建筑物料识别为道路使用者产生误报。
发明内容
针对现有技术中存在的问题，本发明的目的在于提供一种基于冗余传感器的工程车盲区监测预警系统及方法，通过使用多传感器融合的方式对工程车盲区进行监测，并进行相应算法的冗余性设计，有效的提高盲区监测的准确性和可靠性。
本发明为实现上述目的，通过以下技术方案实现：
一种基于冗余传感器的工程车盲区监测预警系统，包括：车载传感器、控制器、报警装置、摄像头和毫米波传感器；控制器分别与车载传感器、报警装置、摄像头和毫米波传感器连接；
车载传感器设置在工程车驾驶室内，用于采集本车行驶信息，并发送至控制器；摄像头和毫米波传感器设置在工程车的车头两侧，用于实时监测工程车周边的目标物信息；
控制器设置内工程车驾驶室内，用于根据本车行驶信息判断车辆行驶状态，根据车辆行驶状态计算盲区范围；通过预设算法对目标物信息进行融合，判断目标物是否在盲区范围内，并根据判断结果结合预设报警条件向报警装置发出报警指令；
报警装置设置在工程车驾驶室内，用于根据报警指令发出相应的报警信号。
进一步，本车行驶信息包括车速信号、方向盘转角信号、挡位信号和转向灯信号，所述目标物信息包括目标物的位置信号、速度信号和类型信号。
相应的，本发明还公开了一种基于冗余传感器的工程车盲区监测预警方法，包括：
控制器接收车载传感器发送的本车行驶信息，包括车速信号、方向盘转角信号、挡位信号、转向灯信号；
根据本车行驶信息，判断车辆行驶状态，并根据车辆行驶状态计算盲区范围；控制器接收毫米波传感器和摄像头发送的目标物信息，包括位置信号、速度信号、类型信号；
根据目标物信息判定目标物是否为有效目标；
若目标物为有效目标，采用预设算法对目标物信息进行融合，生成目标物信息融合结果；
判断目标物是否在盲区范围内，并根据预设报警条件启动报警装置进行分级预警。
进一步，所述根据本车行驶信息，判断车辆行驶状态，并根据车辆行驶状态计算盲区范围，包括：
根据方向盘转角信号，判断车辆行驶状态；
若车辆左转，将报警区域设为车身左侧的盲区范围，计算内轮差，以内轮差下弧线为分割线，将盲区范围分为前后两部分；
若车辆直行，将报警区域设为车身左右两侧的盲区范围；
若车辆右转，将报警区域设为车身右侧的盲区范围，计算内轮差，以内轮差下弧线为分割线，将盲区范围分为前后两部分。
进一步，所述内轮差下弧线通过以下过程生成：
通过以下公式计算得出内轮差ΔR：
其中，r1为左前轮的转弯半径，l为车身长度，d为车身宽度；
根据以下公式得出左前轮的转弯角度θ：
假设当前车辆匀速行驶，根据内轮差ΔR和左前轮的转弯角度θ，拟合出内轮差下弧线。
进一步，所述根据目标物信息判定目标物是否为有效目标，包括：
如果当前摄像头工作正常，根据摄像头获取的目标物信息确定目标物；若目标物为行人、车辆或驾驶车辆的人，则目标物为有效目标；
如果当前摄像头工作异常，根据毫米波传感器获取的目标物信息确定目标物；若目标物为动态物或由静变动的目标物，则目标物为有效目标。
进一步，所述采用预设算法对目标物信息进行融合，生成目标物信息融合结果，具体为：
采用基于联邦式卡尔曼滤波算法对目标物速度信息和位置信息进行融合，包括：
通过以下公式组建离散化系统误差模型：
其中，为第i个传感器在k时刻的系统状态向量，Zk (i)为第i个传感器在k时刻的量测向量，i＝1表示摄像头的量测，i＝2表示毫米波传感器的量测，/>表示第i个传感器在k-1时刻至k时刻的状态转移矩阵，/>表示第i个传感器在k-1时刻的系统状态向量，/>为第i个传感器在k-1时刻的系统噪声向量，/>为第i个传感器在k时刻的量测矩阵，/>为第i个传感器在k时刻的量测噪声向量；
将两个传感器并联运行，进行时间更新和量测更新，得到误差写仿真Pk (i)和状态估计值
通过以下公式进行滤波器时间更新：
其中，为第i个传感器在时刻k-1到时刻k的预测均方差，/>表示第i传感器在时刻k-1到时刻k的预测状态估计，/>表示第i传感器在时刻k-1到时刻k的误差协方差阵，/>为/>的协方差；
通过以下公式进行传感器的量测更新：
其中，为全局状态估计，/>为/>的协方差，/>为卡尔曼增益，/>为第i个传感器在k时刻的量测向量；
通过以下公式进行故障检测：
其中，εk为测量值残差，Zk为第i个传感器在k时刻的量测向量，H为量测矩阵，为时刻k-1到时刻k的预测状态估计；
通过以下公式进行信息融合：
其中，为主滤波器中协方差矩阵，/>为融合后的状态估计，/>为传感器融合后的协方差矩阵；
通过以下公式进行信息分配：
其中，γi为信息分配系数；
其中，γn＝1，γi＝1/N。
进一步，所述判断目标物是否在盲区范围内，并根据预设报警条件启动报警装置进行分级预警，包括：
若车辆直行且根据目标物信息融合结果确定目标物进入左右两侧盲区范围内，控制器向报警装置发出报警指令，通过报警装置对目标物所在的一侧发出一级报警信号；
若车辆处于左转或右转状态，根据目标物信息融合结果确定目标物进入内轮差下弧线前部分的盲区范围内，控制器向报警装置发出报警指令，通过报警装置对目标物所在的一侧发出一级报警信号；
若车辆处于左转或右转状态，根据目标物信息融合结果确定目标物进入内轮差下弧线后部分的盲区范围内，当判定有碰撞风险时，控制器向报警装置发出报警指令，通过报警装置对目标物所在的一侧发出一级报警信号；
在满足上述发出一级报警信号条件下，若驾驶员打转向灯，控制器向报警装置发出报警指令，通过报警装置发出二级报警信号。
进一步，所述碰撞风险根据碰撞时间TTC判定，计算方法如下：
其中，d目标物距离内轮差下弧线的距离，v为目标物行驶速度。
对比现有技术，本发明有益效果在于：本发明提供了一种基于冗余传感器的工程车盲区监测预警系统及方法，首先，根据本车车身信息和运动信息，计算盲区范围；然后，通过控制器接收多传感器发送的目标物位置信息与速度信息，并进行融合处理；最后，判断目标物是否在盲区范围内，根据报警条件进行分级预警。本发明使用多传感器融合的方式进行工程车盲区的监测，当多传感器提供不同的目标物位置信息和速度信息时，采用滤波技术有效融合多种信源，并对各传感器数据并联处理，独立维护车辆的信息观测，实现算法的冗余性设计，并提高其容错性和定位精度。
本发明针对工程车工作环境复杂，工地中建筑物料、铁皮等目标物会增加其误警现象，过于颠簸路况会增加对传感器的伤害的工况特点，采用摄像头和雷达的方案，增加盲区监测预警系统的准确性和可靠性。本发明能够在提高工程车盲区行车安全的基础上，能够提高其预警的准确度，兼顾驾驶员的体验感。
由此可见，本发明与现有技术相比，具有突出的实质性特点和显著的进步，其实施的有益效果也是显而易见的。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据提供的附图获得其他的附图。
附图1是本发明实施例一的系统结构图。
附图2是本发明实施例一的电气框图。
附图3是本发明实施例二的方法流程图。
附图4是本发明实施例三的方法流程图。
图中，1为车载传感器；2为控制器；3为报警装置；4为摄像头；5为毫米波传感器。
具体实施方式
下面结合附图对本发明的具体实施方式做出说明。
实施例一
如图1-2所示，本实施例公开了一种的基于冗余传感器的工程车盲区监测预警系统，包括：车载传感器1、控制器2、报警装置3、摄像头4和毫米波传感器5；控制器2分别与车载传感器1、报警装置3、摄像头4和毫米波传感器5连接.
车载传感器设置1在工程车驾驶室内，用于采集本车行驶信息，并发送至控制器2。其中，本车行驶信息包括车速信号、方向盘转角信号、挡位信号和转向灯信号。
摄像头4和毫米波传感器5设置在工程车的车头两侧，用于实时监测工程车周边的目标物信息。其中，目标物信息包括目标物的位置信号、速度信号和类型信号。
控制器2设置内工程车驾驶室内，用于根据本车行驶信息判断车辆行驶状态，根据车辆行驶状态计算盲区范围；通过预设算法对目标物信息进行融合，判断目标物是否在盲区范围内，并根据判断结果结合预设报警条件向报警装置3发出报警指令。报警装置3设置在工程车驾驶室内，用于根据报警指令发出相应的报警信号。
实施例二：
基于实施例一，如图3所示，本实施例公开了一种基于冗余传感器的工程车盲区监测预警方法，包括如下步骤：
S1：控制器接收车载传感器发送的本车行驶信息，包括车速信号、方向盘转角信号、挡位信号、转向灯信号。
S2：根据本车行驶信息，判断车辆行驶状态，并根据车辆行驶状态计算盲区范围。
首先，根据方向盘转角信号，判断车辆行驶状态。若车辆左转，将报警区域设为车身左侧的盲区范围，计算内轮差，以内轮差下弧线为分割线，将盲区范围分为前后两部分；若车辆直行，将报警区域设为车身左右两侧的盲区范围；若车辆右转，将报警区域设为车身右侧的盲区范围，计算内轮差，以内轮差下弧线为分割线，将盲区范围分为前后两部分。
在本步骤中，通过以下公式计算得出内轮差ΔR：
其中，r1为左前轮的转弯半径，l为车身长度，d为车身宽度；
根据以下公式得出左前轮的转弯角度θ：
假设当前车辆匀速行驶，根据内轮差ΔR和左前轮的转弯角度θ，拟合出内轮差下弧线。
S3：控制器接收毫米波传感器和摄像头发送的目标物信息，包括位置信号、速度信号、类型信号。
S4：根据目标物信息判定目标物是否为有效目标。
如果当前摄像头工作正常，根据摄像头获取的目标物信息确定目标物；若目标物为行人、车辆或驾驶车辆的人，则目标物为有效目标。如果当前摄像头工作异常，根据毫米波传感器获取的目标物信息确定目标物；若目标物为动态物或由静变动的目标物，则目标物为有效目标。
S5：若目标物为有效目标，采用预设算法对目标物信息进行融合，生成目标物信息融合结果。
具体来说，若目标物为有效目标，采用基于联邦式卡尔曼滤波算法对目标物速度信息和位置信息进行融合，包括：
通过以下公式组建离散化系统误差模型：
其中，为第i个传感器在k时刻的系统状态向量，Zk (i)为第i个传感器在k时刻的量测向量，i＝1表示摄像头的量测，i＝2表示毫米波传感器的量测，/>表示第i个传感器在k-1时刻至k时刻的状态转移矩阵，/>表示第i个传感器在k-1时刻的系统状态向量，/>为第i个传感器在k-1时刻的系统噪声向量，/>为第i个传感器在k时刻的量测矩阵，/>为第i个传感器在k时刻的量测噪声向量；
将两个传感器并联运行，进行时间更新和量测更新，得到误差写仿真Pk (i)和状态估计值
通过以下公式进行滤波器时间更新：
其中，为第i个传感器在时刻k-1到时刻k的预测均方差，/>表示第i传感器在时刻k-1到时刻k的预测状态估计，/>表示第i传感器在时刻k-1到时刻k的误差协方差阵，/>为/>的协方差；
通过以下公式进行传感器的量测更新：
其中，为全局状态估计，/>为/>的协方差，/>为卡尔曼增益，/>为第i个传感器在k时刻的量测向量；
通过以下公式进行故障检测：
其中，εk为测量值残差，Zk为第i个传感器在k时刻的量测向量，H为量测矩阵，为时刻k-1到时刻k的预测状态估计；
通过以下公式进行信息融合：
其中，为主滤波器中协方差矩阵，/>为融合后的状态估计，/>为传感器融合后的协方差矩阵；
通过以下公式进行信息分配：
其中，γi为信息分配系数；
其中，γn＝1，γi＝1/N。
S6：判断目标物是否在盲区范围内，并根据预设报警条件启动报警装置进行分级预警。
若车辆直行且根据目标物信息融合结果确定目标物进入左右两侧盲区范围内，控制器向报警装置发出报警指令，通过报警装置对目标物所在的一侧发出一级报警信号。
若车辆处于左转或右转状态，根据目标物信息融合结果确定目标物进入内轮差下弧线前部分的盲区范围内，控制器向报警装置发出报警指令，通过报警装置对目标物所在的一侧发出一级报警信号。
若车辆处于左转或右转状态，根据目标物信息融合结果确定目标物进入内轮差下弧线后部分的盲区范围内，当判定有碰撞风险时，控制器向报警装置发出报警指令，通过报警装置对目标物所在的一侧发出一级报警信号。
在满足上述发出一级报警信号条件下，若驾驶员打转向灯，控制器向报警装置发出报警指令，通过报警装置发出二级报警信号。
其中，碰撞风险根据碰撞时间TTC判定，计算方法如下：
其中，d目标物距离内轮差下弧线的距离，v为目标物行驶速度。
本实施例提供了一种基于冗余传感器的工程车盲区监测预警方法，首先，根据本车车身信息和运动信息，计算盲区范围；然后，通过控制器接收多传感器发送的目标物位置信息与速度信息，并进行融合处理；最后，判断目标物是否在盲区范围内，根据报警条件进行分级预警。本方法有效克服了工程车工作环境中，建筑物料、土堆、铁皮墙等造成的误警现象，以及工程车恶劣地工作环境对传感器影响较大的问题，增强了监测的冗余性，提高了容错性和定位精度。
实施例三：
基于上述实施例，如图4所示，本实施例还公开了一种基于冗余传感器的工程车盲区监测预警方法，包括以下步骤：
第一步：根据本车车身信息和运动信息，计算盲区范围；
第二步：控制器接收多传感器发送的目标物位置信息与速度信息，并进行融合处理；
第三步：判断目标物是否在盲区范围内，根据报警条件进行分级预警。
在第一步中，控制器可接收汽车总线发送的方向盘转角信号，结合控制器中开始写入的车身参数，计算盲区范围包括以下步骤：
根据方向盘转角信号，判断车辆行驶状态。
若车辆左转，车身右侧无碰撞风险，关闭车身右侧报警区域。报警范围为车身左侧范围，以内轮差下弧线为分割线，将报警区域分为前后两部分。
若车辆直行，报警区域为车身左右两侧范围。
若车辆右转，车身左侧无碰撞风险，关闭车身左侧报警区域。报警范围为车身右侧，以内轮差下弧线为分割线，将报警区域分为前后两部分。
内轮差ΔR的计算方法如下：
其中，r1为左前轮的转弯半径，l为车身长度，d为车身宽度。
根据方向盘转角，可得左前轮的转弯角度θ。
假设车辆匀速行驶，根据以上信息，拟合出内轮差下弧线。
在第二步中，控制器接收多传感器发送的目标物位置信息与速度信息，并进行冗余处理包括以下步骤：
本发明采用摄像头与毫米波雷达的方案，实时监测车辆左右两侧后视镜盲区目标信息，各传感器数据并联处理。通过故障诊断与系统重构决定各传感器是否参与融合。
首先，需要过滤无效目标，以摄像头识别到的目标物为主，将行人、车辆、骑电动车的人、骑摩托车的人作为有效目标。若摄像头故障，则将毫米波雷达识别到的动态物和由动变静的目标物识别为有效目标。
然后，基于联邦式卡尔曼滤波算法对目标物速度信息和位置信息进行融合。
对应的离散化系统误差模型如下：
其中，为第i个传感器的系统状态向量，Zk (i)为第i个传感器的量测向量，i＝1表示摄像头的量测，i＝2表示毫米波雷达的量测，/>表示k-1时刻至k时刻的状态转移矩阵，Wk-1为系统噪声向量，/>为量测矩阵，/>为量测噪声向量。
的协方差为R(i)，/>的协方差为/>
两个传感器器并联运行，进行时间更新和量测更新，得到误差写仿真Pk (i)和状态估计值
滤波器时间更新。
其中，为第i个传感器在时刻k-1到时刻k的预测均方差，/>表示第i传感器在时刻k-1到时刻k的预测状态估计，/>表示第i传感器在时刻k-1到时刻k的误差协方差阵
传感器的量测更新：
其中，为全局状态估计。
故障检测：
其中，εk为测量值残差。
当发生故障时，εk会发生突变。
信息融合：
其中，为主滤波器中协方差矩阵，/>为融合后的状态估计，/>为传感器融合后的协方差矩阵。
信息分配：
其中，γi为信息分配系数。
其中，γn＝1，γi＝1/N。
在第三步中，判断目标物是否在盲区范围内，根据报警条件进行分级预警，包括以下步骤：
根据第一种车辆运动状态的判断结果。
若车辆直行有目标物进入左右两侧盲区范围内，相应一侧发出一级报警。
若车辆转弯时，目标物进入内轮差下弧线前部分范围内，系统相应一侧报警器发出一级报警。目标物进入内轮差下弧线后部分，且有碰撞风险时，系统相应一侧报警器发出一级报警。
当满足一级报警条件下，若驾驶员打转向灯，系统发出二级报警。
其中，碰撞风险可根据碰撞时间TTC判定，计算方法如下：
其中，d目标物距离内轮差下弧线的距离，v为目标物行驶速度。
本实施例提供了一种基于冗余传感器的工程车盲区监测预警方法，能够有效提高盲区监测预警系统在工程车上的可靠性。由于工程车工作环境复杂，工地中建筑物料、铁皮墙和土堆会增加其误警现象，过于颠簸路况会增加对传感器的损坏性。因此，本方法从这一角度出发，采用摄像头和雷达的方案，增加盲区监测预警系统的准确性和可靠性。使得本发明在提高工程车盲区行车安全的基础上，能够提高其预警的准确度，兼顾驾驶员的体验感。
结合附图和具体实施例，对本发明作进一步说明。应理解，这些实施例仅用于说明本发明而不用于限制本发明的范围。此外应理解，在阅读了本发明讲授的内容之后，本领域技术人员可以对本发明作各种改动或修改，这些等价形式同样落于本申请所限定的范围。
Claims (8)
1.一种基于冗余传感器的工程车盲区监测预警系统，其特征在于，包括：车载传感器、控制器、报警装置、摄像头和毫米波传感器；控制器分别与车载传感器、报警装置、摄像头和毫米波传感器连接；
车载传感器设置在工程车驾驶室内，用于采集本车行驶信息，并发送至控制器；摄像头和毫米波传感器设置在工程车的车头两侧，用于实时监测工程车周边的目标物信息；
控制器设置在工程车驾驶室内，用于根据本车行驶信息判断车辆行驶状态，根据车辆行驶状态计算盲区范围；通过预设算法对目标物信息进行融合，判断目标物是否在盲区范围内，并根据判断结果结合预设报警条件向报警装置发出报警指令；
报警装置设置在工程车驾驶室内，用于根据报警指令发出相应的报警信号；
所述本车行驶信息包括车速信号、方向盘转角信号、挡位信号和转向灯信号，所述目标物信息包括目标物的位置信号、速度信号和类型信号；
所述根据本车行驶信息判断车辆行驶状态，根据车辆行驶状态计算盲区范围，包括：
根据方向盘转角信号，判断车辆行驶状态；
若车辆左转，将报警区域设为车身左侧的盲区范围，计算内轮差，以内轮差下弧线为分割线，将盲区范围分为前后两部分；
若车辆直行，将报警区域设为车身左右两侧的盲区范围；
若车辆右转，将报警区域设为车身右侧的盲区范围，计算内轮差，以内轮差下弧线为分割线，将盲区范围分为前后两部分；
所述判断目标物是否在盲区范围内，并根据判断结果结合预设报警条件向报警装置发出报警指令，包括：
若车辆直行且根据目标物信息融合结果确定目标物进入左右两侧盲区范围内，控制器向报警装置发出报警指令，通过报警装置对目标物所在的一侧发出一级报警信号；
若车辆处于左转或右转状态，根据目标物信息融合结果确定目标物进入内轮差下弧线前部分的盲区范围内，控制器向报警装置发出报警指令，通过报警装置对目标物所在的一侧发出一级报警信号；
若车辆处于左转或右转状态，根据目标物信息融合结果确定目标物进入内轮差下弧线后部分的盲区范围内，当判定有碰撞风险时，控制器向报警装置发出报警指令，通过报警装置对目标物所在的一侧发出一级报警信号；
在满足上述发出一级报警信号条件下，若驾驶员打转向灯，控制器向报警装置发出报警指令，通过报警装置发出二级报警信号。
2.一种应用于权利要求1所述的基于冗余传感器的工程车盲区监测预警系统的方法，其特征在于，包括：
控制器接收车载传感器发送的本车行驶信息，包括车速信号、方向盘转角信号、挡位信号、转向灯信号；
根据本车行驶信息，判断车辆行驶状态，并根据车辆行驶状态计算盲区范围；控制器接收毫米波传感器和摄像头发送的目标物信息，包括位置信号、速度信号、类型信号；
根据目标物信息判定目标物是否为有效目标；
若目标物为有效目标，采用预设算法对目标物信息进行融合，生成目标物信息融合结果；
判断目标物是否在盲区范围内，并根据预设报警条件启动报警装置进行分级预警。
3.根据权利要求2所述的基于冗余传感器的工程车盲区监测预警方法，其特征在于，所述根据本车行驶信息，判断车辆行驶状态，并根据车辆行驶状态计算盲区范围，包括：
根据方向盘转角信号，判断车辆行驶状态；
若车辆左转，将报警区域设为车身左侧的盲区范围，计算内轮差，以内轮差下弧线为分割线，将盲区范围分为前后两部分；
若车辆直行，将报警区域设为车身左右两侧的盲区范围；
若车辆右转，将报警区域设为车身右侧的盲区范围，计算内轮差，以内轮差下弧线为分割线，将盲区范围分为前后两部分。
4.根据权利要求3所述的基于冗余传感器的工程车盲区监测预警方法，其特征在于，所述内轮差下弧线通过以下过程生成：
通过以下公式计算得出内轮差ΔR：
其中，r1为左前轮的转弯半径，l为车身长度，d为车身宽度；
根据以下公式得出左前轮的转弯角度θ：
假设当前车辆匀速行驶，根据内轮差ΔR和左前轮的转弯角度θ，拟合出内轮差下弧线。
5.根据权利要求2所述的基于冗余传感器的工程车盲区监测预警方法，其特征在于，所述根据目标物信息判定目标物是否为有效目标，包括：
如果当前摄像头工作正常，根据摄像头获取的目标物信息确定目标物；若目标物为行人、车辆或驾驶车辆的人，则目标物为有效目标；
如果当前摄像头工作异常，根据毫米波传感器获取的目标物信息确定目标物；若目标物为动态物或由静变动的目标物，则目标物为有效目标。
6.根据权利要求2所述的基于冗余传感器的工程车盲区监测预警方法，其特征在于，所述采用预设算法对目标物信息进行融合，生成目标物信息融合结果，具体为：
采用基于联邦式卡尔曼滤波算法对目标物速度信息和位置信息进行融合，包括：
通过以下公式组建离散化系统误差模型：
其中，为第i个传感器在k时刻的系统状态向量，Zk (i)为第i个传感器在k时刻的量测向量，i＝1表示摄像头的量测，i＝2表示毫米波传感器的量测，/>表示第i个传感器在k-1时刻至k时刻的状态转移矩阵，/>表示第i个传感器在k-1时刻的系统状态向量，为第i个传感器在k-1时刻的系统噪声向量，/>为第i个传感器在k时刻的量测矩阵，为第i个传感器在k时刻的量测噪声向量；
将两个传感器并联运行，进行时间更新和量测更新，得到误差写仿真Pk (i)和状态估计值
通过以下公式进行滤波器时间更新：
其中，为第i个传感器在时刻k-1到时刻k的预测均方差，/>表示第i传感器在时刻k-1到时刻k的预测状态估计，/>表示第i传感器在时刻k-1到时刻k的误差协方差阵，/>为/>的协方差；
通过以下公式进行传感器的量测更新：
其中，为全局状态估计，/>为/>的协方差，/>为卡尔曼增益，/>为第i个传感器在k时刻的量测向量；
通过以下公式进行故障检测：
其中，εk为测量值残差，Zk为第i个传感器在k时刻的量测向量，H为量测矩阵，为时刻k-1到时刻k的预测状态估计；
通过以下公式进行信息融合：
其中，为主滤波器中协方差矩阵，/>为融合后的状态估计，/>为传感器融合后的协方差矩阵；
通过以下公式进行信息分配：
其中，γi为信息分配系数；
其中，γn＝1，γi＝1/N。
7.根据权利要求2所述的基于冗余传感器的工程车盲区监测预警方法，其特征在于，所述判断目标物是否在盲区范围内，并根据预设报警条件启动报警装置进行分级预警，包括：
若车辆直行且根据目标物信息融合结果确定目标物进入左右两侧盲区范围内，控制器向报警装置发出报警指令，通过报警装置对目标物所在的一侧发出一级报警信号；
若车辆处于左转或右转状态，根据目标物信息融合结果确定目标物进入内轮差下弧线前部分的盲区范围内，控制器向报警装置发出报警指令，通过报警装置对目标物所在的一侧发出一级报警信号；
若车辆处于左转或右转状态，根据目标物信息融合结果确定目标物进入内轮差下弧线后部分的盲区范围内，当判定有碰撞风险时，控制器向报警装置发出报警指令，通过报警装置对目标物所在的一侧发出一级报警信号；
在满足上述发出一级报警信号条件下，若驾驶员打转向灯，控制器向报警装置发出报警指令，通过报警装置发出二级报警信号。
8.根据权利要求7所述的基于冗余传感器的工程车盲区监测预警方法，其特征在于，所述碰撞风险根据碰撞时间TTC判定，计算方法如下：
其中，d目标物距离内轮差下弧线的距离，v为目标物行驶速度。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111398179.7A CN113997862B (zh) | 2021-11-19 | 2021-11-19 | 一种基于冗余传感器的工程车盲区监测预警系统及方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111398179.7A CN113997862B (zh) | 2021-11-19 | 2021-11-19 | 一种基于冗余传感器的工程车盲区监测预警系统及方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN113997862A CN113997862A (zh) | 2022-02-01 |
| CN113997862B true CN113997862B (zh) | 2024-04-16 |
Family
ID=79929995
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202111398179.7A Active CN113997862B (zh) | 2021-11-19 | 2021-11-19 | 一种基于冗余传感器的工程车盲区监测预警系统及方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN113997862B (zh) |
Families Citing this family (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114427979B (zh) * | 2022-02-08 | 2024-06-21 | 中国重汽集团济南动力有限公司 | 一种汽车驾驶员前下视野盲区边界指示装置及其使用方法 |
| CN115503731B (zh) * | 2022-11-02 | 2024-07-12 | 中国重汽集团济南动力有限公司 | 一种重型汽车驾驶辅助系统的驾驶员脱手检测系统及方法 |
| CN115828071B (zh) * | 2023-02-16 | 2023-05-23 | 深圳市瑞芬科技有限公司 | 一种高抗振动特性的倾斜角度融合分析系统 |
| CN116039503A (zh) * | 2023-03-30 | 2023-05-02 | 江铃汽车股份有限公司 | 商用车视野盲区监测提醒方法、移动终端及存储介质 |
| CN117002379B (zh) * | 2023-09-21 | 2024-02-13 | 名商科技有限公司 | 一种货车行驶盲区判断处理方法及控制装置 |
| CN117310713B (zh) * | 2023-11-29 | 2024-03-15 | 广州优创电子有限公司 | 一种基于单传感器的盲区监测装置及监测方法 |
Citations (19)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20030031931A (ko) * | 2003-02-05 | 2003-04-23 | 최준익 | 방향 지시등 전원을 이용하는 자동차 사각지대 물체감지장치 및 방법 |
| CN104104915A (zh) * | 2014-07-21 | 2014-10-15 | 四川沛阳科技有限公司 | 基于移动终端的多功能行车监控预警系统 |
| CN106840242A (zh) * | 2017-01-23 | 2017-06-13 | 驭势科技（北京）有限公司 | 一种智能驾驶汽车的传感器自检系统及多传感融合系统 |
| CN106981220A (zh) * | 2017-04-24 | 2017-07-25 | 河海大学 | 大型车右转弯安全预警系统 |
| CN108137054A (zh) * | 2015-10-20 | 2018-06-08 | 罗伯特·博世有限公司 | 传感器测量数据的替换 |
| CN110065450A (zh) * | 2019-04-18 | 2019-07-30 | 深圳技术大学 | 内轮差盲区探测系统及其货车盲区监测方法 |
| CN110356325A (zh) * | 2019-09-04 | 2019-10-22 | 魔视智能科技(上海)有限公司 | 一种城市交通客运车辆盲区预警系统 |
| CN111267734A (zh) * | 2020-04-01 | 2020-06-12 | 上海神添实业有限公司 | 大型运输车辆安全防护系统及其预警方法 |
| CN111497832A (zh) * | 2020-04-28 | 2020-08-07 | 深圳市国脉畅行科技股份有限公司 | 车辆内轮差风险监测方法、装置、计算机设备及存储介质 |
| CN111554124A (zh) * | 2020-04-16 | 2020-08-18 | 天津职业技术师范大学(中国职业培训指导教师进修中心) | 交叉路口大货车右转弯防撞预警系统及预警方法 |
| CN111928846A (zh) * | 2020-07-31 | 2020-11-13 | 南京理工大学 | 一种基于联邦滤波的多源融合即插即用组合导航方法 |
| CN112069559A (zh) * | 2020-07-08 | 2020-12-11 | 南京工业大学 | 大型车辆交叉口右转弯内轮差区域范围确定方法及其应用 |
| CN112485784A (zh) * | 2020-11-03 | 2021-03-12 | 浙江吉利控股集团有限公司 | 内轮差区域内目标的危险系数确定方法、装置、电子设备及存储介质 |
| CN112793509A (zh) * | 2021-04-14 | 2021-05-14 | 天津所托瑞安汽车科技有限公司 | 一种盲区监测方法及装置、设备、介质 |
| CN112793507A (zh) * | 2020-11-16 | 2021-05-14 | 理工雷科智途(北京)科技有限公司 | 基于惯性器件感知车辆右转运动特性的盲区预警制动系统 |
| CN112859080A (zh) * | 2021-01-12 | 2021-05-28 | 一汽解放汽车有限公司 | 一种盲区预警方法、装置、城市用专用车及存储介质 |
| CN113276769A (zh) * | 2021-04-29 | 2021-08-20 | 深圳技术大学 | 车辆盲区防撞预警系统及方法 |
| CN113276770A (zh) * | 2021-04-30 | 2021-08-20 | 中汽研（天津）汽车工程研究院有限公司 | 基于安全和低成本需求的商用车全盲区监测系统和方法 |
| CN113362607A (zh) * | 2021-08-10 | 2021-09-07 | 天津所托瑞安汽车科技有限公司 | 基于转向状态的盲区预警方法、装置、设备和介质 |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20180105107A1 (en) * | 2016-10-19 | 2018-04-19 | Novateur Research Solutions LLC | Pedestrian collision warning system for vehicles |
| US11203287B2 (en) * | 2018-06-28 | 2021-12-21 | Paccar Inc | Camera-based automatic turn signal deactivation |
-
2021
- 2021-11-19 CN CN202111398179.7A patent/CN113997862B/zh active Active
Patent Citations (19)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20030031931A (ko) * | 2003-02-05 | 2003-04-23 | 최준익 | 방향 지시등 전원을 이용하는 자동차 사각지대 물체감지장치 및 방법 |
| CN104104915A (zh) * | 2014-07-21 | 2014-10-15 | 四川沛阳科技有限公司 | 基于移动终端的多功能行车监控预警系统 |
| CN108137054A (zh) * | 2015-10-20 | 2018-06-08 | 罗伯特·博世有限公司 | 传感器测量数据的替换 |
| CN106840242A (zh) * | 2017-01-23 | 2017-06-13 | 驭势科技（北京）有限公司 | 一种智能驾驶汽车的传感器自检系统及多传感融合系统 |
| CN106981220A (zh) * | 2017-04-24 | 2017-07-25 | 河海大学 | 大型车右转弯安全预警系统 |
| CN110065450A (zh) * | 2019-04-18 | 2019-07-30 | 深圳技术大学 | 内轮差盲区探测系统及其货车盲区监测方法 |
| CN110356325A (zh) * | 2019-09-04 | 2019-10-22 | 魔视智能科技(上海)有限公司 | 一种城市交通客运车辆盲区预警系统 |
| CN111267734A (zh) * | 2020-04-01 | 2020-06-12 | 上海神添实业有限公司 | 大型运输车辆安全防护系统及其预警方法 |
| CN111554124A (zh) * | 2020-04-16 | 2020-08-18 | 天津职业技术师范大学(中国职业培训指导教师进修中心) | 交叉路口大货车右转弯防撞预警系统及预警方法 |
| CN111497832A (zh) * | 2020-04-28 | 2020-08-07 | 深圳市国脉畅行科技股份有限公司 | 车辆内轮差风险监测方法、装置、计算机设备及存储介质 |
| CN112069559A (zh) * | 2020-07-08 | 2020-12-11 | 南京工业大学 | 大型车辆交叉口右转弯内轮差区域范围确定方法及其应用 |
| CN111928846A (zh) * | 2020-07-31 | 2020-11-13 | 南京理工大学 | 一种基于联邦滤波的多源融合即插即用组合导航方法 |
| CN112485784A (zh) * | 2020-11-03 | 2021-03-12 | 浙江吉利控股集团有限公司 | 内轮差区域内目标的危险系数确定方法、装置、电子设备及存储介质 |
| CN112793507A (zh) * | 2020-11-16 | 2021-05-14 | 理工雷科智途(北京)科技有限公司 | 基于惯性器件感知车辆右转运动特性的盲区预警制动系统 |
| CN112859080A (zh) * | 2021-01-12 | 2021-05-28 | 一汽解放汽车有限公司 | 一种盲区预警方法、装置、城市用专用车及存储介质 |
| CN112793509A (zh) * | 2021-04-14 | 2021-05-14 | 天津所托瑞安汽车科技有限公司 | 一种盲区监测方法及装置、设备、介质 |
| CN113276769A (zh) * | 2021-04-29 | 2021-08-20 | 深圳技术大学 | 车辆盲区防撞预警系统及方法 |
| CN113276770A (zh) * | 2021-04-30 | 2021-08-20 | 中汽研（天津）汽车工程研究院有限公司 | 基于安全和低成本需求的商用车全盲区监测系统和方法 |
| CN113362607A (zh) * | 2021-08-10 | 2021-09-07 | 天津所托瑞安汽车科技有限公司 | 基于转向状态的盲区预警方法、装置、设备和介质 |
Non-Patent Citations (4)
| Title |
|---|
| SINS/CNS/SAR组合导航系统中的信息融合算法研究;胡秀华;赵岩;;测控技术(第08期);全文 * |
| 一种基于联邦卡尔曼滤波器的多源信息融合定位算法;张靖等;导弹与航天运载技术(第2期);第91-97页 * |
| 多传感器信息融合的列车定位方法研究;阎树田;曹长虹;;机械与电子(第04期);第19-22页 * |
| 林洋.实用汽车事故鉴定学.人民交通出版社,2001,第118-119页. * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN113997862A (zh) | 2022-02-01 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN113997862B (zh) | 一种基于冗余传感器的工程车盲区监测预警系统及方法 | |
| KR101320223B1 (ko) | 자동차를 주차하거나 운전할 때 운전자를 돕기 위한 방법및 시스템 | |
| EP2473388B1 (en) | Vehicle or traffic control method and system | |
| CN110775028B (zh) | 一种汽车挡风玻璃遮挡物检测及辅助驾驶系统和方法 | |
| CN110073429B (zh) | 用于监控车辆组合的车辆周围环境的方法以及监控系统 | |
| CN111976598A (zh) | 车辆盲区监测方法及系统 | |
| CN111708016B (zh) | 一种毫米波雷达与激光雷达融合的车辆前碰撞预警方法 | |
| US20080136612A1 (en) | Obstacle Detection Apparatus | |
| CN105711588A (zh) | 一种车道保持辅助系统和车道保持辅助方法 | |
| CN106875746B (zh) | 一种汽车安全驾驶预警系统与方法 | |
| SE1150118A1 (sv) | Längdskattning av fordon | |
| CN102066185A (zh) | 用于协助变换车道的车辆驾驶辅助系统 | |
| KR101102818B1 (ko) | 상대속도를 고려한 실시간 안전거리 및 정지거리 바 산출 알고리즘을 이용한 적정차량간격 정보제공시스템 | |
| KR102697012B1 (ko) | 자동차 및 그 제어 방법 | |
| CN111469835A (zh) | 基于拓扑地图的车辆辅助驾驶系统和方法 | |
| CN113470433A (zh) | 基于v2i的车辆内轮差区域危险预警方法、系统、车辆及路侧设备 | |
| CN111497871A (zh) | 一种汽车行驶跑偏告警方法、电子设备及系统 | |
| JP2004302622A (ja) | 車両用制動制御装置 | |
| CN109835262A (zh) | 车辆预警的系统 | |
| CN113470432A (zh) | 基于v2v的车辆内轮差区域危险预警方法、系统及车辆 | |
| CN108238102A (zh) | 一种车载超声波传感器系统 | |
| CN113920734B (zh) | 一种基于logistics模型的变道预警方法 | |
| CN115892012A (zh) | 基于信息融合的换道辅助处理方法、设备及存储介质 | |
| CN115862383A (zh) | 一种基于不确定性的车辆盲区潜在风险量化方法 | |
| JPH08110224A (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 |