[go: up one dir, main page]

CN111532274A - Intelligent vehicle lane change auxiliary system and method based on multi-sensor data fusion - Google Patents

Intelligent vehicle lane change auxiliary system and method based on multi-sensor data fusion Download PDF

Info

Publication number
CN111532274A
CN111532274A CN202010127272.3A CN202010127272A CN111532274A CN 111532274 A CN111532274 A CN 111532274A CN 202010127272 A CN202010127272 A CN 202010127272A CN 111532274 A CN111532274 A CN 111532274A
Authority
CN
China
Prior art keywords
vehicle
target
lane
data fusion
sensors
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
Application number
CN202010127272.3A
Other languages
Chinese (zh)
Other versions
CN111532274B (en
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.)
Nanjing University of Aeronautics and Astronautics
Original Assignee
Nanjing University of Aeronautics and Astronautics
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 Nanjing University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN202010127272.3A priority Critical patent/CN111532274B/en
Publication of CN111532274A publication Critical patent/CN111532274A/en
Application granted granted Critical
Publication of CN111532274B publication Critical patent/CN111532274B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18163Lane change; Overtaking manoeuvres
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • 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
    • B60W2420/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo, light or radio wave sensitive means, e.g. infrared sensors
    • B60W2420/408Radar; Laser, e.g. lidar

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Traffic Control Systems (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

本发明提出了一种基于多传感器数据融合的智能车辆换道辅助系统及方法,通过安装在汽车四个角的不同频率赫兹数的毫米波雷达传感器进行换道监测,在汽车左前方和左后方分别安装77GHz毫米波雷达传感器,右前方和右后方分别安装24GHz毫米波雷达传感器。汽车前方和后方分别安装的不同频率的毫米波雷达传感器的检测范围会存在一定重合区域和非重合区域。首先对各传感器进行周围车辆目标初选,然后依据卡尔曼滤波原理对周围车辆目标进行有效性检验,最后依据不同频率毫米波雷达传感器的感知范围优势,对重合区域采用D‑S证据理论对其进行决策级信号整合。本发明充分融合各传感器检测优点特性,全面地对汽车周边环境进行检测,及时判断换道是否处于危险状态。

Figure 202010127272

The present invention proposes an intelligent vehicle lane-changing assistance system and method based on multi-sensor data fusion. 77GHz millimeter-wave radar sensors are installed respectively, and 24GHz millimeter-wave radar sensors are installed on the right front and right rear respectively. The detection ranges of millimeter-wave radar sensors with different frequencies installed in the front and rear of the car will have certain overlapping areas and non-overlapping areas. Firstly, the primary selection of surrounding vehicle targets is carried out for each sensor, and then the validity of surrounding vehicle targets is tested according to the principle of Kalman filtering. Finally, according to the advantages of the sensing range of millimeter-wave radar sensors of different frequencies, the D-S evidence theory is used for the overlapping area. Perform decision-level signal integration. The invention fully integrates the detection advantages and characteristics of each sensor, comprehensively detects the surrounding environment of the vehicle, and timely judges whether the lane change is in a dangerous state.

Figure 202010127272

Description

基于多传感器数据融合的智能车辆换道辅助系统及方法Intelligent vehicle lane change assistance system and method based on multi-sensor data fusion

技术领域technical field

本发明属于汽车智能安全驾驶辅助领域,特别是关于一种多传感器数据融合的周边驾驶环境监测的汽车智能换道辅助方法。The invention belongs to the field of automobile intelligent and safe driving assistance, and in particular relates to an automobile intelligent lane-changing assistance method for peripheral driving environment monitoring based on multi-sensor data fusion.

背景技术Background technique

智能车系统是一个集环境感知、规划决策、多等级辅助驾驶等功能于一体的综合系统,是典型的、多学科的、综合性的高科技和高新技术的结合体,其中换道驾驶由于需要快速变更车道而存在较大风险。如果驾驶人员在换道时对于周围车辆的位置以及相对速度预估不足,则极有可能导致驾驶员误判,错误更换车道,进而可能引起不必要的交通事故,造成财产损失或人员伤亡。因此智能驾驶辅助系统(ADAS)应运而生,其能够准确测量汽车两侧后视镜盲区内危险车辆,并且相应地对汽车后方一定距离范围内车辆进行监控。The intelligent vehicle system is a comprehensive system that integrates functions such as environmental perception, planning decision-making, and multi-level assisted driving. It is a typical, multi-disciplinary, and comprehensive combination of high-tech and high-tech. There is a greater risk of rapidly changing lanes. If the driver underestimates the position and relative speed of the surrounding vehicles when changing lanes, it is very likely to cause the driver to misjudge and change lanes incorrectly, which may cause unnecessary traffic accidents, property damage or casualties. Therefore, the intelligent driver assistance system (ADAS) came into being, which can accurately measure the dangerous vehicles in the blind area of the rearview mirror on both sides of the car, and monitor the vehicles within a certain distance behind the car accordingly.

目前,国内外大量研究学者主要对换道过程中自车与后视镜盲区车辆以及一定距离 (60米以内)目标车道后方车辆的相对运动关系进行了充分的换道可行性分析。如丰田、路虎以及宝马车系的盲点监测系统,亦或奥迪车系的自动驾驶系统,其技术已经做得相对成熟可靠。但是以上各系统对于目标车道远距离(60米以上)前方减速慢行的危险车辆以及目标车道远距离(60米以上)后方加速快行的危险车辆基本无任何监测能力。驾驶人员在高速公路如遇到以上两种情况,而驾驶人员本人又毫无准确判断,在此情况下强行超车换道,尤其是双方车辆均处于快速行驶状态时,极易造成严重的交通事故。而且以往的换道辅助系统为保证硬件冗余,常采用双24GHz毫米波雷达作为传感器输入设备,对双同型号雷达进行数据融合,往往同型号雷达测量误差以及测量局限性情况一致,对其进行数据融合往往同样得不到更精确的结果,因此换道辅助系统存在些许弊端。At present, a large number of researchers at home and abroad have mainly conducted a sufficient analysis of the feasibility of lane changing on the relative motion relationship between the ego vehicle and the vehicle in the blind spot of the rearview mirror and the vehicle behind the target lane at a certain distance (within 60 meters) during the lane changing process. For example, the blind spot monitoring system of Toyota, Land Rover and BMW series, or the automatic driving system of Audi series, its technology has been relatively mature and reliable. However, the above systems basically have no monitoring capability for dangerous vehicles slowing down and slowing down in front of the target lane at a long distance (above 60 meters) and dangerous vehicles accelerating fast behind the target lane at a long distance (above 60 meters). If the driver encounters the above two situations on the highway, and the driver himself has no accurate judgment, in this case forcibly overtaking and changing lanes, especially when both vehicles are in a fast driving state, it is very likely to cause serious traffic accidents . In addition, in order to ensure hardware redundancy in the previous lane-changing assistance system, dual 24GHz millimeter-wave radars are often used as sensor input devices to perform data fusion on dual radars of the same type. The measurement errors and measurement limitations of radars of the same type are often consistent. Data fusion often does not get more accurate results, so the lane change assist system has some drawbacks.

发明内容SUMMARY OF THE INVENTION

针对以上提出的现有换道辅助系统的弊端,为克服上述不足,本发明基于汽车前后 77GHz和24GHz毫米波雷达传感器,采用相应的数据处理和数据融合手段,充分发挥不同频率传感器的优势,对目标车道远距离(60米以上)危险车辆进行了监控预警;同时对不同频率雷达之间的监控重合区域进行了决策级的数据融合处理,得到了更为精确的监控预警结果,更加准确全面地提高了换道辅助系统的安全性,更大程度上降低了发生交通事故的可能性。Aiming at the disadvantages of the existing lane-changing assistance system proposed above, in order to overcome the above shortcomings, the present invention is based on the 77GHz and 24GHz millimeter-wave radar sensors at the front and rear of the vehicle, and adopts corresponding data processing and data fusion means to give full play to the advantages of different frequency sensors. The long-distance (more than 60 meters) dangerous vehicles in the target lane are monitored and early warning; at the same time, the decision-level data fusion processing is carried out on the monitoring overlapping areas between different frequency radars, and more accurate monitoring and early warning results are obtained, which is more accurate and comprehensive. The safety of the lane change assist system is improved, and the possibility of traffic accidents is reduced to a greater extent.

为实现上述技术目的,本发明的技术方案是:一种基于智能车辆多传感器的数据融合换道辅助方法,它包括以下步骤:1)改变现有换道辅助系统的传感器以及布局方案,所述智能换道辅助系统包括数据采集单元、信号放大单元、独立数据处理单元、数据融合控制单元和警示预警单元;2)所述数据采集单元同时采集车辆远距离(0-120米)左侧前方和左侧后方目标车道及本车道车辆的行驶数据,以及近距离(60米内)右侧前方和右侧后方车辆行驶数据,并将数据信号放大后通过CAN总线传给独立数据处理单元; 3)所述独立数据处理单元分别对采集到的数据进行预处理,进行目标车辆初选和目标有效性检验,首先大体判断出是否为危险车辆;4)数据融合控制单元接受独立数据处理单元的信号,对监控重合区域进行决策级数据融合处理,非重合区域进行独立判断,生成预警控制指令传给警示预警单元;5)警示预警单元根据接收到的信号进行相应的声光以及转向干预预警。In order to achieve the above-mentioned technical purpose, the technical scheme of the present invention is: a data fusion lane-changing assistance method based on intelligent vehicle multi-sensor, which comprises the following steps: 1) changing the sensors and layout scheme of the existing lane-changing assistance system, the described The intelligent lane-changing auxiliary system includes a data acquisition unit, a signal amplification unit, an independent data processing unit, a data fusion control unit and a warning and early warning unit; 2) The data acquisition unit simultaneously collects the long-distance (0-120 meters) left front and rear of the vehicle. The driving data of the vehicle in the target lane on the left side and the vehicle in this lane, as well as the driving data of the vehicle in the front and rear on the right side (within 60 meters), and the data signal is amplified and transmitted to the independent data processing unit through the CAN bus; 3) All The independent data processing unit respectively preprocesses the collected data, carries out the preliminary selection of the target vehicle and the target validity test, and first generally judges whether it is a dangerous vehicle; 4) The data fusion control unit accepts the signal of the independent data processing unit, and the Monitor the overlapping area for decision-level data fusion processing, and independently judge the non-overlapping area, generate early warning control instructions and transmit them to the warning early warning unit; 5) The warning early warning unit performs corresponding sound and light and steering intervention early warning according to the received signals.

上述数据采集单元所述传感器为两个77GHz的毫米波雷达传感器和两个24GHz毫米波雷达传感器。The sensors in the above data acquisition unit are two 77GHz millimeter wave radar sensors and two 24GHz millimeter wave radar sensors.

上述传感器的安装位置及安装布局为:在汽车左前方和左后方分别安装的是可探测距离远但探测区域较窄的77GHz毫米波雷达传感器,在汽车右前方和右后方分别安装的是可探测距离较近但探测区域较宽的24GHz毫米波雷达传感器。The installation position and installation layout of the above sensors are as follows: the 77GHz millimeter-wave radar sensors with long detection distance and narrow detection area are installed in the left front and left rear of the car, respectively, and the detectable sensors are installed in the right front and right rear of the car respectively. A 24GHz millimeter-wave radar sensor with a short distance and a wide detection area.

上述所述目标车道主要为本车的左边车道,因为国家规定高速路上应为左侧超车,故主要检测左侧车道车辆信息。The target lane mentioned above is mainly the left lane of the vehicle. Because the state stipulates that the highway should be overtaking on the left side, the vehicle information in the left lane is mainly detected.

一种智能车辆多传感器数据融合换道辅助方法,是通过上述系统实现的,具体步骤如下:A lane-changing assistance method for intelligent vehicle multi-sensor data fusion is realized by the above system, and the specific steps are as follows:

S1:通过左前方和左后方77GHz传感器将本车道以及目标车道前后120米范围内环境信息进行采集,通过右前方和右后方24GHz传感器将车辆前后方环境信息进行采集;S1: Collect environmental information within 120 meters before and after the current lane and the target lane through the left front and left rear 77GHz sensors, and collect the front and rear environmental information of the vehicle through the right front and right rear 24GHz sensors;

S2:分别对采集到的汽车前方以及后方四个传感器数据进行独立预处理,实现车辆目标的初选;S2: Independently preprocess the collected data of the four sensors in the front and rear of the car to achieve the primary selection of the vehicle target;

S3:对四个毫米波雷达传感器初选出的车辆目标分别独立进行基于卡尔曼滤波的目标有效性检验;S3: The target validity test based on Kalman filtering is independently performed on the vehicle targets initially selected by the four millimeter-wave radar sensors;

S4:对于汽车前方或后方检测非重合区域进行独立判断,判断出目标车道前方远距离内是否有减速慢行车辆以及后方远距离内是否有加速快行车辆;S4: Independently judge the non-overlapping area in front of or behind the car, and determine whether there is a slow-moving vehicle in the long distance in front of the target lane and whether there is an accelerating fast-moving vehicle in the long distance behind;

S5:采用D-S证据理论分别对汽车前方以及后方两传感器监测重合区域,即产生的经过目标有效性检验的两条独立证据进行数据融合,最大程度上保证检测的可靠性;S5: The D-S evidence theory is used to fuse the data of the two sensors in the front and the rear of the car to monitor the overlapped area, that is, the two independent evidences generated after the target validity test are used to ensure the reliability of the detection to the greatest extent;

S6:将数据融合控制单元处理后的结果输送给警示预警单元;S6: Send the result processed by the data fusion control unit to the warning and early warning unit;

S7:警示预警单元根据判断结果进行声音、闪光以及转向反向干预预警。S7: The warning and early warning unit performs sound, flashing and steering reverse intervention warning according to the judgment result.

上述步骤S1中传感器采集的环境信息包括:每个目标车辆与本车的相对速度vr、相对距离xr以及相对角度

Figure BDA0002394774130000035
等。The environmental information collected by the sensor in the above step S1 includes: the relative speed v r , the relative distance x r and the relative angle between each target vehicle and the vehicle
Figure BDA0002394774130000035
Wait.

上述步骤S2中对传感器数据进行独立预处理主要方法包括滤除空信号目标、滤除静止目标和滤除虚假目标。The main methods of performing independent preprocessing on the sensor data in the above step S2 include filtering out empty signal targets, filtering out stationary targets and filtering out false targets.

上述步骤S3中对目标进行有效性检验主要方法如下:The main methods for validating the target in the above step S3 are as follows:

由于毫米波雷达探测的不确定性,以及检测方法存在误差等原因,应进一步对目标进行有效性检验,在此采用卡尔曼滤波预测方法对车辆目标进行有效性检验。在此使用高阶的三阶卡尔曼滤波方法对周期内有效车辆目标信息进行预测,假设状态

Figure BDA0002394774130000031
其中xn,j,vn,j,
Figure BDA0002394774130000032
分别代表第n个周期内测量到的有效车辆目标的纵向相对距离、相对速度和相对加速度。下一周期的目标车辆状态预测,如下所示:Due to the uncertainty of millimeter-wave radar detection and the existence of errors in the detection method, the validity of the target should be further tested. Here, the Kalman filter prediction method is used to test the validity of the vehicle target. Here, the high-order third-order Kalman filter method is used to predict the effective vehicle target information in the cycle, assuming the state
Figure BDA0002394774130000031
where x n,j ,v n,j ,
Figure BDA0002394774130000032
respectively represent the longitudinal relative distance, relative velocity and relative acceleration of the effective vehicle target measured in the nth cycle. The target vehicle state prediction for the next cycle is as follows:

Figure BDA0002394774130000033
Figure BDA0002394774130000033

上式中,T为毫米波雷达扫描周期,取值为0.04s,x(n+1)|n、、v(n+1)|n

Figure BDA0002394774130000034
分别代表第n+1周期内目标车辆预测值的纵向相对距离、相对速度和相对加速度。对第n+1周期的初选车辆目标信息与上式所得到第n个周期的有效车辆目标信息预测值进行比较验证,比较准则如下:In the above formula, T is the scanning period of the millimeter wave radar, the value is 0.04s, x (n+1)|n , v (n+1)|n
Figure BDA0002394774130000034
respectively represent the longitudinal relative distance, relative speed and relative acceleration of the predicted value of the target vehicle in the n+1th cycle. Compare and verify the primary vehicle target information of the n+1th cycle and the predicted value of the valid vehicle target information of the nth cycle obtained by the above formula. The comparison criteria are as follows:

|xn+1-x(n+1)|n|≤|Δx||x n+1 -x (n+1)|n |≤|Δx|

|vn+1-v(n+1)|n|≤|Δv||v n+1 -v (n+1)|n |≤|Δv|

Figure BDA0002394774130000044
Figure BDA0002394774130000044

上式中,xn+1、vn+1

Figure RE-GDA0002552067860000042
分别代表第n+1个周期内两车的纵向相对距离、相对速度和相对加速度的采集值;Δx、Δv、
Figure RE-GDA0002552067860000043
分别代表比较准则的允许最大误差。在本发明中设定 误差为:In the above formula, x n+1 , v n+1 ,
Figure RE-GDA0002552067860000042
respectively represent the collected values of the longitudinal relative distance, relative velocity and relative acceleration of the two vehicles in the n+1th cycle; Δx, Δv,
Figure RE-GDA0002552067860000043
respectively represent the maximum allowable error of the comparison criterion. In the present invention, the error is set as:

Figure BDA0002394774130000043
Figure BDA0002394774130000043

对于第n+1周期的初选车辆目标,如果符合上式,则认为初选车辆目标与第n周期的有效车辆目标一致,对此进行目标车辆信息更新,即这两个周期的有效车辆目标如果一致为危险车辆的话,则划分为危险车辆,如果一致为非危险车辆的话,则划分为非危险车辆。如不满足上式,则需对进行目标不一致性处理,对于监控重合区域目标,使用 D-S证据理论进行数据融合处理决断是否为危险车辆;对于非重合区域目标,默认假定车辆目标有效,最大限度上保证安全,即如果非重合区域第n个周期和第n+1个周期判断的结果一个是危险车辆,另一个是非危险车辆的话,则认定为危险车辆。For the primary vehicle target of the n+1th cycle, if it conforms to the above formula, it is considered that the primary vehicle target is consistent with the valid vehicle target of the nth cycle, and the target vehicle information is updated for this, that is, the valid vehicle target of these two cycles. If it is a dangerous vehicle, it is classified as a dangerous vehicle, and if it is a non-hazardous vehicle, it is classified as a non-hazardous vehicle. If the above formula is not satisfied, the target inconsistency needs to be dealt with. For the targets in the monitoring overlapping area, the D-S evidence theory is used to perform data fusion processing to determine whether it is a dangerous vehicle; To ensure safety, that is, if one of the judgment results of the nth cycle and the n+1th cycle of the non-coincident area is a dangerous vehicle and the other is a non-dangerous vehicle, it is determined as a dangerous vehicle.

进一步的,步骤S5中的融合过程是采用如下步骤进行的:Further, the fusion process in step S5 is carried out by adopting the following steps:

a、目标合成:把重合区域两个独立不同频率传感器的观测结果合成为一个总的输出结果(ID);D-S证据理论会对来自两个独立传感器的证据源导出基本的概率分配函数,进而D-S证据理论中的Dempster组合规则可以计算这两个证据共同作用产生的反映融合信息的新的基本概率分配函数,根据这一概率分配函数,来合成一个总的输出结果,即是否确定有危险车辆目标;a. Target synthesis: The observation results of two independent different frequency sensors in the overlapping area are synthesized into a total output result (ID); D-S evidence theory will derive a basic probability distribution function for the evidence sources from two independent sensors, and then D-S The Dempster combination rule in evidence theory can calculate a new basic probability distribution function that reflects the fusion information generated by the joint action of the two evidences, and according to this probability distribution function, a total output result is synthesized, that is, whether to determine whether there is a dangerous vehicle target. ;

b、目标推断:本发明根据一定可信度在逻辑上会产生一定置信度的目标车辆报告,来获得传感器的观测结果并进行推断,将传感器观测结果扩展成目标车辆报告;根据D-S 证据理论产生的概率分配函数,会形成一定置信度的目标车辆报告,即是否危险车辆真实存在,进而推断出是否确实是危险车辆;b. Target inference: The present invention will logically generate a target vehicle report with a certain degree of confidence according to a certain degree of reliability, to obtain the observation result of the sensor and make inference, and expand the observation result of the sensor into the target vehicle report; according to the D-S evidence theory to generate The probability distribution function of , will form the target vehicle report with a certain degree of confidence, that is, whether the dangerous vehicle actually exists, and then infer whether it is indeed a dangerous vehicle;

c、目标更新:两种不同频率传感器本身一般都存在随机误差,所以,两个在时间上独立的同频率传感器产生的一组报告比其中任一传感器产生的报告都更可靠。因此,在推理和两个不同频率传感器合成之前,先组合(更新)各自频率传感器的观测数据;即对于第n+1周期的初选车辆目标,如果符合设定误差,则认为初选车辆目标与第n周期的有效车辆目标一致,对此进行目标车辆信息更新。c. Target update: Two different frequency sensors generally have random errors themselves, so a set of reports produced by two time-independent sensors of the same frequency is more reliable than the report produced by either sensor. Therefore, before inference and synthesis of two different frequency sensors, the observation data of the respective frequency sensors are combined (updated); that is, for the primary vehicle target of the n+1th cycle, if the set error is met, the primary vehicle target is considered to be selected. Consistent with the valid vehicle target of the nth cycle, the target vehicle information is updated for this.

作为更进一步的,步骤S7中变换道路时智能提供变道信息是通过相应的声、光或转向干预预警提醒驾驶人员,根据车辆间的相对距离xr和相对速度vr判定车辆是否处于危险状态,如处于安全状态则显示绿色的灯,蜂鸣器不报警;如处于警示状态,则变化为闪烁的黄灯,蜂鸣器两秒响一次;如为危险状态,则转化成红灯状态,蜂鸣器每秒钟响一次;驾驶员如没及时看到或者听到换道辅助的提示信息,进而进行强行变道,则除进行声音或者闪光报警之外,还通过接入转向助力模块的转向接口反馈单元对转向进行相应扭矩干预,及时提醒驾驶人员此时不要做出换道行为。As a further step, the intelligent provision of lane change information when changing roads in step S7 is to remind the driver through corresponding sound, light or steering intervention warning, and determine whether the vehicle is in a dangerous state according to the relative distance x r and relative speed v r between the vehicles , if it is in a safe state, it will display a green light, and the buzzer will not alarm; if it is in a warning state, it will change to a flashing yellow light, and the buzzer will sound once every two seconds; if it is in a dangerous state, it will turn into a red light state, The buzzer sounds once per second; if the driver fails to see or hear the prompt information of lane change assistance in time, and then forcibly changes lanes, in addition to the sound or flashing alarm, it will also be connected to the power steering module. The steering interface feedback unit performs corresponding torque intervention on the steering, timely reminding the driver not to change lanes at this time.

本发明由于采用以上双层保障技术方案,具有以下突出优点:1)本发明由于采用24GHz和77GHz频率毫米波雷达传感器组合,成功对目标车道远距离前方减速慢行的车辆以及目标车道远距离后方加速快行的车辆进行了监测。解决了现有换道辅助系统的不足,提高了换道的安全性。2)本发明采用两种不同频率传感器进行采集信息,因此采集到的信息更全面,容错性更强,解决了采用冗余同型号的雷达传感器测量误差以及测量局限性一致的问题。3)采用首先对数据进行独立处理,其次进行决策级数据融合的双层保障方案,分别对监控重合区域和非重合区域进行处理,既保障了数据判断的准确性,又保证了决策的及时性。4)在警示预警模块中引入了转向反馈接口,有效避免了驾驶人员分心忽视声音或者闪光信号的提醒,及时通过方向盘触感反馈给驾驶员。本发明弥补了现有换道辅助系统的不足,提高了智能驾驶辅助系统的安全性。The present invention has the following outstanding advantages due to the adoption of the above double-layer guarantee technical scheme: 1) the present invention adopts a combination of 24GHz and 77GHz frequency millimeter-wave radar sensors, and successfully decelerates and slows down the vehicle at a long distance in the front of the target lane and the rear of the target lane at a long distance. Vehicles that are accelerating fast are monitored. The insufficiency of the existing lane-changing auxiliary system is solved, and the safety of lane-changing is improved. 2) The present invention uses two different frequency sensors to collect information, so the collected information is more comprehensive and more fault-tolerant, and solves the problem of the same measurement error and measurement limitations of redundant radar sensors of the same type. 3) Adopt a two-layer guarantee scheme in which the data is first processed independently, and then the decision-level data fusion is carried out, and the monitoring overlapping areas and non-overlapping areas are processed separately, which not only ensures the accuracy of data judgment, but also ensures the timeliness of decision-making . 4) The steering feedback interface is introduced into the warning and early warning module, which effectively avoids the driver's distraction and ignores the reminder of the sound or flashing signal, and provides feedback to the driver through the steering wheel tactile sensation in time. The invention makes up for the deficiencies of the existing lane-changing assistance system and improves the safety of the intelligent driving assistance system.

附图说明Description of drawings

本发明共有附图5幅:The present invention has 5 accompanying drawings:

图1为汽车上毫米波雷达安装位置及监测区域图;Figure 1 shows the installation location and monitoring area of the millimeter-wave radar on the car;

图2为本发明数据融合换道辅助系统工作流程图;Fig. 2 is the working flow chart of the data fusion lane changing auxiliary system of the present invention;

图3为本发明数据融合换道辅助系统模块示意图;3 is a schematic diagram of a data fusion lane changing auxiliary system module of the present invention;

图4为本发明数据融合换道辅助系统信号放大模块电路图;4 is a circuit diagram of a signal amplification module of the data fusion lane change auxiliary system of the present invention;

图5为本发明数据融合换道辅助系统警示预警模块电路图。FIG. 5 is a circuit diagram of the warning and early warning module of the data fusion lane changing auxiliary system of the present invention.

具体实施方式Detailed ways

下面通过实例,并结合附图,对本发明的技术方案做进一步的具体说明。The technical solutions of the present invention will be further described in detail below through examples and in conjunction with the accompanying drawings.

本发明主要提出了一种基于77GHz和24GHz雷达传感器数据融合的智能车辆换道辅助方法。该方法主要通过在汽车左前方、左后方安装77GHz毫米波雷达传感器以及右前方、右后方安装24GHz毫米波雷达传感器来进行检测。77GHz毫米波雷达传感器有效检测距离长,最高可达120m,但是其检测区域角度较窄,为30度左右;而24GHz毫米波雷达传感器有效检测距离短,仅为60m,但是其检测区域角度较宽,为130度左右。毫米波雷达安装位置及可监测区域如图1所示。不同频率的毫米波雷达传感器的检测范围会存在一定重合区域(图1中黄色重要区域)和非重合区域,首先对各传感器进行周围车辆目标初选,然后依据卡尔曼滤波原理对周围车辆目标进行有效性检验。最后依据不同频率毫米波雷达传感器的感知范围优势,对重合区域采用D-S证据理论进行决策级信号整合。充分融合各传感器检测优点特性,全面地对汽车周边环境进行检测,及时判断换道是否处于危险状态,并通过相应的声、光以及转向干预警示驾驶人员,其信号采集检测处理流程如图2所示。通过此种传感器布置方案可有效监控远距离危险车辆信息 (图1中蓝色线框内区域),并且将不同频率传感器采集的信息进行数据融合,有效避免了同型号冗余传感器之间进行数据融合的弊端。The present invention mainly proposes an intelligent vehicle lane change assistance method based on 77GHz and 24GHz radar sensor data fusion. The method mainly detects by installing 77GHz millimeter-wave radar sensors in the left front and left rear of the car and 24GHz millimeter-wave radar sensors in the right front and right rear. The 77GHz millimeter-wave radar sensor has a long effective detection distance, up to 120m, but its detection area has a narrow angle of about 30 degrees; while the 24GHz millimeter-wave radar sensor has a short effective detection distance of only 60m, but its detection area has a wider angle. , is about 130 degrees. The installation location and monitorable area of the millimeter-wave radar are shown in Figure 1. The detection range of millimeter-wave radar sensors with different frequencies will have certain overlapping areas (the yellow important area in Figure 1) and non-overlapping areas. First, the surrounding vehicle targets are initially selected for each sensor, and then the surrounding vehicle targets are selected according to the principle of Kalman filtering. Validity check. Finally, according to the advantages of the sensing range of millimeter-wave radar sensors of different frequencies, the D-S evidence theory is used for the decision-level signal integration in the overlapping area. Fully integrate the detection advantages and characteristics of each sensor, comprehensively detect the surrounding environment of the car, timely determine whether the lane change is in a dangerous state, and warn the driver through corresponding sound, light and steering intervention. The signal acquisition and detection processing flow is shown in Figure 2. Show. This sensor arrangement scheme can effectively monitor the information of long-distance dangerous vehicles (the area in the blue line frame in Figure 1), and fuse the information collected by sensors of different frequencies, effectively avoiding the need for data exchange between redundant sensors of the same model. Disadvantages of fusion.

一种智能车辆多传感器数据融合换道辅助系统,主要包括以下模块:用于实时采集信息的不同频率毫米波雷达模块、将双通道雷达信号进行放大的放大器模块、对放大后信号进行目标验证以及数据融合处理的雷达信号处理器模块以及警示预警模块。系统模块图如图3所示,不同频率的毫米波雷达模块同时采集车辆远距离(0-120米)左侧前方和左侧后方目标车道及本车道车辆的行驶数据,以及近距离(60米内)右侧前方和右侧后方车辆行驶数据,将数据信号送给双通道放大器模块进行放大;之后数据通过CAN总线传给处理器模块,先后对数据进行目标车辆初选、目标有效性检验以及数据融合;处理器模块生成预警控制指令传给警示预警模块,警示预警模块根据接收到的信号进行相应的声光以及转向干预预警。An intelligent vehicle multi-sensor data fusion lane changing auxiliary system mainly includes the following modules: a different frequency millimeter wave radar module for collecting information in real time, an amplifier module for amplifying a dual-channel radar signal, a target verification for the amplified signal, and Data fusion processing radar signal processor module and warning module. The system module diagram is shown in Figure 3. The millimeter-wave radar modules of different frequencies simultaneously collect the long-distance (0-120 meters) left front and left rear target lanes and the driving data of vehicles in this lane, as well as the short-range (within 60 meters) data. ) The driving data of the right front and right rear vehicles are sent to the dual-channel amplifier module for amplification; then the data is transmitted to the processor module through the CAN bus, and the data is subjected to the preliminary selection of the target vehicle, the target validity test and the data. Fusion; the processor module generates an early warning control command and transmits it to the warning early warning module, and the warning early warning module performs corresponding sound and light and steering intervention early warning according to the received signals.

一种智能车辆多传感器数据融合换道辅助方法,是通过上述系统实现的,具体步骤如下:A lane-changing assistance method for intelligent vehicle multi-sensor data fusion is realized by the above system, and the specific steps are as follows:

S1:在汽车左前方和左后方分别安装可探测距离远但探测区域较窄的77GHz毫米波雷达传感器,在汽车右前方和右后方分别安装可探测距离较近但探测区域较宽的24GHz毫米波雷达传感器;通过左前方和左后方77GHz传感器将本车道以及目标车道前后120 米范围内环境信息进行采集,通过右前方和右后方24GHz传感器将车辆前后方环境信息进行采集,传感器采集的环境信息包括:每个目标车辆与本车的相对速度vr、相对距离xr以及相对角度

Figure BDA0002394774130000071
等;S1: Install a 77GHz millimeter-wave radar sensor with a long detection distance but a narrow detection area in the left front and left rear of the car, respectively, and install a 24GHz millimeter wave with a short detection distance and a wide detection area in the right front and right rear of the car. Radar sensor; the left front and left rear 77GHz sensors collect environmental information within 120 meters before and after the lane and the target lane, and the right front and right rear 24GHz sensors collect environmental information before and after the vehicle. The environmental information collected by the sensors includes : the relative speed v r , the relative distance x r and the relative angle of each target vehicle and the own vehicle
Figure BDA0002394774130000071
Wait;

S2:对采集到的汽车前方以及后方四个传感器数据输入放大器进行放大,放大器原理图如图4所示。两路传感器信号分别为IF LC I和IF LC Q,选择LMP7716MM/NOPB 芯片对信号进行放大,采用3.3V供电电压,配合外围的电容电阻器件,完成对传感器信号的放大。同时两级放大结构拥有着更高的外部增益,拥有更好的信噪比和更高的带宽。S2: Amplify the collected data from the four sensors in the front and rear of the car into the amplifier. The schematic diagram of the amplifier is shown in Figure 4. The two sensor signals are IF LC I and IF LC Q respectively. The LMP7716MM/NOPB chip is selected to amplify the signal, and the 3.3V power supply voltage is used to complete the amplification of the sensor signal with the peripheral capacitance and resistance devices. At the same time, the two-stage amplifier structure has higher external gain, better signal-to-noise ratio and higher bandwidth.

S3:随后分别对数据进行独立预处理,实现车辆目标的初选,具体实施步骤如下:S3: Then independently preprocess the data to achieve the primary selection of vehicle targets. The specific implementation steps are as follows:

a、滤除空信号目标:毫米波雷达由于其本身数据输出为64通道,因此可跟踪64个车辆目标,由于大部分情况下并无探测目标出现,所以一定存在大量检测出的空通道,经雷达信号放大器放大后输出的数据为默认最小值,即相对速度vr=0m/s,相对距离 xr=0m,相对角度

Figure BDA0002394774130000072
因此当某个输出满足以上条件时,即可判定为是空信号,从而滤除空信号;a. Filter out empty signal targets: The millimeter-wave radar can track 64 vehicle targets because its own data output is 64 channels. Since no detection targets appear in most cases, there must be a large number of detected empty channels. The data output by the radar signal amplifier after amplification is the default minimum value, that is, the relative speed v r = 0m/s, the relative distance x r = 0m, the relative angle
Figure BDA0002394774130000072
Therefore, when an output satisfies the above conditions, it can be determined as an empty signal, thereby filtering out the empty signal;

b、滤除静止目标:不同频率毫米波雷达的监控环境中一定会出现例如防护栏、树木或路边行人等接近静止的目标,换道辅助时最主要危险的是动态快速行进目标,因此应将静止目标滤除。而静止目标的相对角度和相对距离同正常动态目标基本无任何区别,但静止目标的绝对速度应该为0m/s。因此设目标与本车之间连线与本车速度方向之间的夹角为α,则静止目标相对于本车的相对速度应接近自车车速,应该满足以下等式:b. Filter out stationary targets: In the monitoring environment of millimeter-wave radars with different frequencies, there must be close-to-stationary targets such as guardrails, trees or roadside pedestrians. Filter out stationary objects. The relative angle and relative distance of the stationary target are basically the same as those of the normal dynamic target, but the absolute speed of the stationary target should be 0m/s. Therefore, set the angle between the connection line between the target and the vehicle and the speed direction of the vehicle as α, then the relative speed of the stationary target relative to the vehicle should be close to the vehicle speed, which should satisfy the following equation:

vr cosα=-vv r cosα=-v

即静止目标相对于本车车速与自车绝对速度相加的绝对值理论上应该等于0,但考虑到路边行人等低速行进物也认为是静止目标进行滤除,同时考虑到测量误差的存在,设置误差最小值为1m/s,满足以下条件的为静止目标,进行滤除:That is, the absolute value of the stationary target relative to the sum of the speed of the vehicle and the absolute speed of the vehicle should theoretically be equal to 0, but considering that low-speed moving objects such as roadside pedestrians are also considered to be stationary targets for filtering, and taking into account the existence of measurement errors , set the minimum error to 1m/s, and the stationary target that meets the following conditions is filtered out:

|vrcosα+v|≤1(m/s)|v r cosα+v|≤1(m/s)

c、滤除虚假目标:c. Filter out false targets:

虚假目标指的是那些并无客观对应的目标或者检测到的目标出现时间极短,并无实际意义,或是由于毫米波雷达偶然受干扰而出现的连贯性差、数据跳跃波动较大的目标,此类为虚假目标。可通过以下不等式予以滤除:False targets refer to those targets that have no objective corresponding or the detected targets appearing for a very short time and have no practical significance, or those targets with poor coherence and large data jumps and fluctuations due to accidental interference of the millimeter-wave radar. This class is a false target. It can be filtered out by the following inequality:

r(n+1)-αr(n)|≥2°r (n+1)-α r (n)|≥2°

|xr(n+1)-xr(n)|≥4m|x r (n+1)-x r (n)|≥4m

|vr(n+1)-vr(n)|≥4m/s|v r (n+1)-v r (n)|≥4m/s

其中,n为毫米波雷达采样点序号(雷达在不同时间点对同一目标的运动状态描述), n=(1,2,3,4,5...);Among them, n is the sequence number of the millimeter wave radar sampling point (the description of the motion state of the same target by the radar at different time points), n=(1,2,3,4,5...);

S4:对四个毫米波雷达传感器初选出的车辆目标分别独立进行基于卡尔曼滤波的目标有效性检验,使用高阶的三阶卡尔曼滤波方法对周期内有效车辆目标信息进行预测,假设状态

Figure BDA0002394774130000087
其中xn,j,vn,j,
Figure BDA0002394774130000081
分别代表第n个周期内测量到的有效车辆目标的纵向相对距离、相对速度和相对加速度。下一周期的目标车辆状态预测,如下所示:S4: Carry out the target validity test based on Kalman filtering independently on the vehicle targets initially selected by the four millimeter-wave radar sensors, and use the high-order third-order Kalman filtering method to predict the effective vehicle target information in the cycle, assuming the state
Figure BDA0002394774130000087
where x n,j ,v n,j ,
Figure BDA0002394774130000081
respectively represent the longitudinal relative distance, relative velocity and relative acceleration of the effective vehicle target measured in the nth cycle. The target vehicle state prediction for the next cycle is as follows:

Figure BDA0002394774130000082
Figure BDA0002394774130000082

上式中,T为毫米波雷达扫描周期,取值为0.04s,x(n+1)|n、、v(n+1)|n

Figure BDA0002394774130000083
分别代表第n+1周期内目标车辆预测值的纵向相对距离、相对速度和相对加速度。对第n+1周期的初选车辆目标信息与上式所得到第n个周期的有效车辆目标信息预测值进行比较验证,比较准则如下:In the above formula, T is the scanning period of the millimeter wave radar, the value is 0.04s, x (n+1)|n , v (n+1)|n
Figure BDA0002394774130000083
respectively represent the longitudinal relative distance, relative speed and relative acceleration of the predicted value of the target vehicle in the n+1th cycle. Compare and verify the primary vehicle target information of the n+1th cycle and the predicted value of the valid vehicle target information of the nth cycle obtained by the above formula. The comparison criteria are as follows:

|xn+1-x(n+1)|n|≤|Δx||x n+1 -x (n+1)|n |≤|Δx|

|vn+1-v(n+1)|n|≤|Δv||v n+1 -v (n+1)|n |≤|Δv|

Figure BDA0002394774130000084
Figure BDA0002394774130000084

上式中,xn+1、vn+1

Figure RE-GDA0002552067860000086
分别代表第n+1个周期内两车的纵向相对距离、相对速度和相对加速度的采集值;Δx、Δv、
Figure RE-GDA0002552067860000087
分别代表比较准则的允许最大误差。在本发明中设定 误差为:In the above formula, x n+1 , v n+1 ,
Figure RE-GDA0002552067860000086
respectively represent the collected values of the longitudinal relative distance, relative velocity and relative acceleration of the two vehicles in the n+1th cycle; Δx, Δv,
Figure RE-GDA0002552067860000087
respectively represent the maximum allowable error of the comparison criterion. In the present invention, the error is set as:

Figure BDA0002394774130000091
Figure BDA0002394774130000091

对于第n+1周期的初选车辆目标,如果符合上式,则认为初选车辆目标与第n周期的有效车辆目标一致,对此进行目标车辆信息更新;如不满足上式,则需对进行目标不一致性处理。对于监控重合区域目标,使用D-S证据理论进行数据融合处理决断,对于非重合区域目标,默认假定车辆目标有效,最大限度上保证安全。For the primary vehicle target of the n+1th cycle, if it conforms to the above formula, it is considered that the primary vehicle target is consistent with the valid vehicle target of the nth cycle, and the target vehicle information is updated; if the above formula is not satisfied, the Perform target inconsistency processing. For the monitoring of overlapping area targets, the D-S evidence theory is used for data fusion processing and decision. For non-overlapping area targets, the vehicle target is assumed to be valid by default to ensure maximum safety.

S5:对于汽车前方或后方检测非重合区域进行独立判断,判断出目标车道前方远距离内是否有减速慢行车辆以及后方远距离内是否有加速快行车辆;独立数据处理单元通过检测雷达传感器数据,判断车辆速度,然后对速度求导,求解加速度,来判定是否有减速或加速车辆;S5: Independently judge the non-overlapping area in front of or behind the car to determine whether there is a slow-moving vehicle in the long distance in front of the target lane and whether there is an accelerating fast-moving vehicle in the long distance behind; the independent data processing unit detects the radar sensor data by , judge the speed of the vehicle, and then derive the speed and solve the acceleration to determine whether there is a deceleration or acceleration of the vehicle;

S6:采用D-S证据理论分别对汽车前方以及后方两传感器监测重合区域,即产生的经过目标有效性检验的两条独立证据进行数据融合,最大程度上保证检测的可靠性;S6: The D-S evidence theory is used to separately monitor the overlapping area of the two sensors in the front and the rear of the car, that is, the two independent evidences generated by the target validity test are data fusion, so as to ensure the reliability of the detection to the greatest extent;

a、目标合成:把重合区域两个独立不同频率传感器的观测结果合成为一个总的输出结果(ID);a. Target synthesis: The observation results of two independent different frequency sensors in the overlapping area are synthesized into a total output result (ID);

b、目标推断:本发明根据一定可信度在逻辑上会产生一定置信度的目标车辆报告,来获得传感器的观测结果并进行推断,将传感器观测结果扩展成目标车辆报告;b. Target inference: the present invention will logically generate a target vehicle report with a certain degree of confidence according to a certain degree of reliability, to obtain the observation result of the sensor and infer, and expand the observation result of the sensor into the target vehicle report;

c、目标更新:两种不同频率传感器本身一般都存在随机误差,所以,在时间上充分独立地来自同一频率传感器的一组连续报告比任何单一报告可靠。因此,在推理和两个不同频率传感器合成之前,先组合(更新)各自频率传感器的观测数据。c. Target update: Two different frequency sensors generally have random errors themselves, so a set of consecutive reports from the same frequency sensor that is sufficiently independent in time is more reliable than any single report. Therefore, the observations of the respective frequency sensors are combined (updated) before inference and synthesis of the two different frequency sensors.

S7:将数据融合控制单元处理后的结果输送给警示预警单元;S7: Send the result processed by the data fusion control unit to the warning and early warning unit;

S8:警示预警单元根据判断结果进行声音、闪光以及转向反向干预预警。警示预警原理图如图5所示,LED_BUSY管脚的显示芯片是否为忙碌(上电期间),LED_DETECT 接口外接两个指示灯,与此同时DETECT_SIGNAL端输出根据危险程度高低判断的不同的蜂鸣器响频频率,DETECT_OUT输出信号与DETECT_SIGNAL类似,根据情况的紧急程度不同输出不同的频率,并且为防止转向接口接地环路或者噪声注入,使用了隔离数字输出,保证输出信号的稳定性。根据相对距离xr和相对速度vr的大小判定是否为危险状态,如处于安全状态则显示绿色的灯,蜂鸣器不报警;如处于警示状态,则变化为闪烁的黄灯,蜂鸣器两秒响一次;如为危险状态,则转化成红灯状态,蜂鸣器每秒钟响一次;驾驶员如没及时看到或者听到换道辅助的提示信息,进而进行强行变道,则除进行声音或者闪光报警之外,还通过接入转向助力模块的转向接口反馈单元通过频率对转向进行相应扭矩干预,及时提醒驾驶人员此时不要做出换道行为。S8: The warning and early warning unit performs sound, flashing and steering reverse intervention warning according to the judgment result. The schematic diagram of warning and warning is shown in Figure 5. The LED_BUSY pin shows whether the chip is busy (during power-on), and the LED_DETECT interface is connected to two external indicators. At the same time, the DETECT_SIGNAL terminal outputs different buzzers according to the level of danger. Response frequency, the DETECT_OUT output signal is similar to DETECT_SIGNAL. Different frequencies are output according to the urgency of the situation. In order to prevent the steering interface ground loop or noise injection, an isolated digital output is used to ensure the stability of the output signal. According to the relative distance x r and relative speed v r to determine whether it is in a dangerous state, if it is in a safe state, it will display a green light, and the buzzer will not alarm; if it is in a warning state, it will change to a flashing yellow light, and the buzzer will It will sound once every two seconds; if it is in a dangerous state, it will turn into a red light state, and the buzzer will sound once every second; In addition to sound or flashing alarms, the steering interface feedback unit connected to the steering assist module also performs corresponding torque interventions on the steering through frequency, timely reminding the driver not to change lanes at this time.

智能车辆多传感器数据融合换道辅助系统是应用在高速公路上防止汽车变道时发生碰撞的智能预警系统,该智能预警系统,可以通过不同频率的毫米波雷达实现对汽车前、后方远、近距离危险车辆的监测,对汽车换道提供准确的变道信息和变道危险提示。换道辅助系统多传感器数据融合就是将两组不同频率雷达传感器所获取的汽车前后方远近距离的环境信息,如远后方目标行驶车辆与本车辆的相对速度,相对距离以及方向角等数据,通过数据采集、数据处理,以及数据融合等方式,对环境中目标车辆信息进行分析判断,从而准确的给出变换道路的危险程度,为驾驶人员作出换道行为提供有效的依据以及及时换道危险提醒。The intelligent vehicle multi-sensor data fusion lane change assist system is an intelligent early warning system applied on the highway to prevent collisions when vehicles change lanes. Monitor the distance to dangerous vehicles, and provide accurate lane-changing information and lane-changing danger prompts for vehicles changing lanes. The multi-sensor data fusion of the lane change assist system is to combine the environmental information of the front and rear of the car obtained by two sets of radar sensors with different frequencies, such as the relative speed, relative distance and direction angle of the target vehicle in the far rear and the vehicle. Data collection, data processing, and data fusion are used to analyze and judge the information of target vehicles in the environment, so as to accurately give the degree of danger of changing roads, provide an effective basis for drivers to make lane-changing behaviors, and timely lane-changing danger reminders .

以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明披露的技术范围内,根据本发明的技术方案机器发明构思加以等同替换或改变,都应涵盖在本发明的保护范围之内。The above is only a preferred embodiment of the present invention, but the protection scope of the present invention is not limited to this. The equivalent replacement or change of the machine inventive concept shall be covered within the protection scope of the present invention.

Claims (9)

1. The utility model provides an intelligent vehicle multisensor data fusion auxiliary system that trades lane which characterized in that includes: the system comprises radars with different frequencies, a signal amplification unit, a data processing unit, a data fusion control unit and a warning and early warning unit, wherein the radars with different frequencies are used for acquiring the front and rear environmental information of the vehicle in real time; the radar signal acquisition areas with different frequencies comprise non-coincident areas and coincident areas.
2. The intelligent vehicle multi-sensor data fusion lane-changing auxiliary system according to claim 1, characterized in that: the radars with different frequencies are a 77GHz millimeter wave radar sensor and a 24GHz millimeter wave radar sensor.
3. The intelligent vehicle multi-sensor data fusion lane-changing auxiliary system according to claim 2, wherein two 77GHz millimeter wave radar sensors are arranged at the left front part and the left rear part of the automobile; the number of the 24GHz millimeter wave radar sensors is two, and the two sensors are arranged at the front right and the rear right of the automobile.
4. The intelligent vehicle multi-sensor data fusion lane change auxiliary method is characterized by comprising the following specific steps:
s1: collecting the environmental information of the front and the back of the lane where the vehicle is located and the target lane by using a 77GHz sensor at the front and the back of the left, and collecting the environmental information of the front and the back of the vehicle by using a 24GHz sensor at the front and the back of the right;
s2: the method comprises the following steps of respectively and independently preprocessing four collected sensor data in front of and behind the automobile to realize the initial selection of a vehicle target;
s3: target validity inspection based on Kalman filtering is independently carried out on vehicle targets preliminarily selected by the four millimeter wave radar sensors;
s4: independently judging the non-coincident region detected in front of or behind the automobile to judge whether a slow-speed vehicle is decelerated in a long distance in front of the target lane and whether an accelerated fast-speed vehicle is accelerated in a long distance behind the target lane;
s5: respectively carrying out data fusion on the superposed areas monitored by the two sensors in front of and behind the automobile, namely two independent evidences which are generated and are subjected to target validity test, by adopting a D-S evidence theory;
s6: transmitting the processed results of the steps S4 and S5 to a warning and early warning unit;
s7: and the warning early warning unit carries out sound, flash and steering reverse intervention early warning according to the judgment result.
5. The intelligent vehicle multi-sensor data fusion lane-changing auxiliary method according to claim 4, wherein the environmental information in the step S1 comprises: relative velocity v of each target vehicle and the host vehiclerRelative distance, relative distancexrAnd relative angle
Figure FDA0002394774120000021
6. The intelligent vehicle multi-sensor data fusion lane-changing auxiliary method according to claim 4, wherein the preprocessing in the step S2 is realized by filtering empty signal targets, filtering static targets and filtering false targets.
7. The intelligent vehicle multi-sensor data fusion lane-changing auxiliary method according to claim 4, wherein the step S3 comprises:
step S3.1: hypothetical states
Figure FDA0002394774120000022
Wherein xn,j,vn,j,
Figure FDA0002394774120000023
Respectively representing the longitudinal relative distance, the relative speed and the relative acceleration of the effective vehicle target measured in the nth period;
step S3.2: the target vehicle state for the next cycle is predicted as follows:
Figure FDA0002394774120000024
in the above formula, T is the scanning period of the millimeter wave radar, x(n+1)|n、、v(n+1)|n
Figure FDA0002394774120000025
Respectively representing the longitudinal relative distance, the relative speed and the relative acceleration of the predicted value of the target vehicle in the (n + 1) th period;
step S3.3: comparing and verifying the initially selected vehicle target information of the (n + 1) th period with the effective vehicle target information predicted value of the nth period obtained by the formula, wherein the comparison criterion is as follows:
|xn+1-x(n+1)|n|≤|Δx|
|vn+1-v(n+1)|n|≤|Δv|
Figure FDA0002394774120000026
in the above formula, xn+1、、vn+1
Figure FDA0002394774120000027
Respectively representing the longitudinal relative distance, the relative speed and the relative acceleration of the two vehicles in the (n + 1) th period; Δ x,. DELTA.v
Figure FDA0002394774120000028
Respectively representing the maximum error allowed for the comparison criterion;
step S3.4: for the primary vehicle target in the n +1 th period, if the formula (2) is satisfied, the primary vehicle target is considered to be consistent with the effective vehicle target in the n th period, target vehicle information is updated on the target vehicle, otherwise, target inconsistency processing is performed, and for the target in the monitored overlapping area, data fusion processing is performed by using a D-S evidence theory to determine whether the target is a dangerous vehicle; for the non-coincident region target, the vehicle target is assumed to be valid by default, and the safety is guaranteed to the maximum extent, namely if the results of the judgment of the nth period and the (n + 1) th period of the non-coincident region are that one is a dangerous vehicle and the other is a non-dangerous vehicle, the non-coincident region is determined to be a dangerous vehicle.
8. The intelligent vehicle multi-sensor data fusion lane-changing auxiliary method according to any one of claims 4-7, wherein the fusion process in step S5 is performed by adopting the following steps:
a. target synthesis: the D-S evidence theory derives basic probability distribution functions for evidence sources from two independent sensors, then a Dempster combination rule in the D-S evidence theory calculates a new basic probability distribution function which reflects fusion information and is generated by the joint action of the two evidences, and a total output result is synthesized according to the probability distribution function, namely whether a dangerous vehicle target is determined or not;
b. target inference: according to a probability distribution function generated by a D-S evidence theory, a target vehicle report with certain confidence coefficient is formed, namely whether a dangerous vehicle really exists or not is judged, and whether the dangerous vehicle really exists or not is judged;
c. target updating: the two different frequency sensors themselves are typically randomly error-prone, so that a set of reports generated by the two time-independent same frequency sensors is more reliable than a report generated by either sensor. Thus, prior to inferencing and synthesis of two different frequency sensors, the observed data of the respective frequency sensors are combined.
9. The intelligent vehicle multi-sensor data fusion lane change assisting method according to claim 4, wherein when the road is changed in the step S7, the intelligently provided lane change information reminds a driver through corresponding sound, light or steering intervention early warning. According to the relative distance x between vehiclesrAnd relative velocity vrJudging whether the vehicle is in a dangerous state, if so, displaying a green lamp, and not giving an alarm by the buzzer; if the alarm is in the warning state, the alarm is changed into a flashing yellow light, and the buzzer rings once every two seconds; if the alarm is in a dangerous state, the alarm is converted into a red light state, and the buzzer rings once per second. If the driver does not see or hear the prompting information of lane change assistance in time, and then the lane change is forcibly carried out, besides sound or flash alarm, corresponding torque intervention is carried out on the steering through a steering interface feedback unit connected into the power steering module, and the driver is timely reminded not to make a lane change behavior at the moment.
CN202010127272.3A 2020-02-28 2020-02-28 Intelligent vehicle lane change assistance system and method based on multi-sensor data fusion Active CN111532274B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010127272.3A CN111532274B (en) 2020-02-28 2020-02-28 Intelligent vehicle lane change assistance system and method based on multi-sensor data fusion

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010127272.3A CN111532274B (en) 2020-02-28 2020-02-28 Intelligent vehicle lane change assistance system and method based on multi-sensor data fusion

Publications (2)

Publication Number Publication Date
CN111532274A true CN111532274A (en) 2020-08-14
CN111532274B CN111532274B (en) 2021-04-27

Family

ID=71969173

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010127272.3A Active CN111532274B (en) 2020-02-28 2020-02-28 Intelligent vehicle lane change assistance system and method based on multi-sensor data fusion

Country Status (1)

Country Link
CN (1) CN111532274B (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112394726A (en) * 2020-10-20 2021-02-23 自然资源部第一海洋研究所 Unmanned ship obstacle fusion detection method based on evidence theory
CN113093191A (en) * 2021-03-31 2021-07-09 武汉大学 Road vehicle detection system based on millimeter wave radar
CN113178081A (en) * 2021-05-17 2021-07-27 中移智行网络科技有限公司 Vehicle immission early warning method and device and electronic equipment
CN113791410A (en) * 2021-08-20 2021-12-14 北京市公安局公安交通管理局 Road environment comprehensive cognition method based on multi-sensor information fusion
CN113895439A (en) * 2021-11-02 2022-01-07 东南大学 A lane-changing decision-making method for autonomous driving based on probabilistic fusion of vehicle-mounted multi-source sensors
CN114655222A (en) * 2022-04-18 2022-06-24 重庆长安汽车股份有限公司 Method and system for displaying target vehicle in real time
CN115407273A (en) * 2022-08-29 2022-11-29 哈尔滨工业大学(威海) Specific security area monitoring reminding alarm device and method

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102303605A (en) * 2011-06-30 2012-01-04 中国汽车技术研究中心 Multi-sensor information fusion-based collision and departure pre-warning device and method
CN202163431U (en) * 2011-06-30 2012-03-14 中国汽车技术研究中心 Collision and traffic lane deviation pre-alarming device based on integrated information of sensors
CN103065501A (en) * 2012-12-14 2013-04-24 清华大学 Automobile lane changing early-warning method and lane changing early-warning system
CN106708040A (en) * 2016-12-09 2017-05-24 重庆长安汽车股份有限公司 Sensor module of automatic driving system, automatic driving system and automatic driving method
CN106740838A (en) * 2016-12-10 2017-05-31 江门市蓬江区弘亿电子科技有限公司 A kind of vehicle risk early warning system
CN206734295U (en) * 2016-12-21 2017-12-12 驭势科技(北京)有限公司 A kind of detection system for being used to detect Vehicle target and its application
CN107512263A (en) * 2017-04-05 2017-12-26 吉利汽车研究院(宁波)有限公司 A kind of lane change blind area danger accessory system
CN108106629A (en) * 2017-12-07 2018-06-01 风度(常州)汽车研发院有限公司 Evade the path guide method to knock into the back, device and Vehicular intelligent driving assistance system

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102303605A (en) * 2011-06-30 2012-01-04 中国汽车技术研究中心 Multi-sensor information fusion-based collision and departure pre-warning device and method
CN202163431U (en) * 2011-06-30 2012-03-14 中国汽车技术研究中心 Collision and traffic lane deviation pre-alarming device based on integrated information of sensors
CN103065501A (en) * 2012-12-14 2013-04-24 清华大学 Automobile lane changing early-warning method and lane changing early-warning system
CN106708040A (en) * 2016-12-09 2017-05-24 重庆长安汽车股份有限公司 Sensor module of automatic driving system, automatic driving system and automatic driving method
CN106740838A (en) * 2016-12-10 2017-05-31 江门市蓬江区弘亿电子科技有限公司 A kind of vehicle risk early warning system
CN206734295U (en) * 2016-12-21 2017-12-12 驭势科技(北京)有限公司 A kind of detection system for being used to detect Vehicle target and its application
CN107512263A (en) * 2017-04-05 2017-12-26 吉利汽车研究院(宁波)有限公司 A kind of lane change blind area danger accessory system
CN108106629A (en) * 2017-12-07 2018-06-01 风度(常州)汽车研发院有限公司 Evade the path guide method to knock into the back, device and Vehicular intelligent driving assistance system

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112394726B (en) * 2020-10-20 2023-08-04 自然资源部第一海洋研究所 Unmanned ship obstacle fusion detection method based on evidence theory
CN112394726A (en) * 2020-10-20 2021-02-23 自然资源部第一海洋研究所 Unmanned ship obstacle fusion detection method based on evidence theory
CN113093191A (en) * 2021-03-31 2021-07-09 武汉大学 Road vehicle detection system based on millimeter wave radar
CN113093191B (en) * 2021-03-31 2022-07-05 武汉大学 A road vehicle detection system based on millimeter wave radar
CN113178081A (en) * 2021-05-17 2021-07-27 中移智行网络科技有限公司 Vehicle immission early warning method and device and electronic equipment
CN113178081B (en) * 2021-05-17 2022-05-03 中移智行网络科技有限公司 A vehicle entry warning method, device and electronic device
CN113791410A (en) * 2021-08-20 2021-12-14 北京市公安局公安交通管理局 Road environment comprehensive cognition method based on multi-sensor information fusion
CN113791410B (en) * 2021-08-20 2023-10-24 北京市公安局公安交通管理局 Road environment comprehensive cognition method based on multi-sensor information fusion
CN113895439A (en) * 2021-11-02 2022-01-07 东南大学 A lane-changing decision-making method for autonomous driving based on probabilistic fusion of vehicle-mounted multi-source sensors
CN113895439B (en) * 2021-11-02 2022-08-12 东南大学 A lane-changing behavior decision-making method for autonomous driving based on probabilistic fusion of vehicle-mounted multi-source sensors
CN114655222A (en) * 2022-04-18 2022-06-24 重庆长安汽车股份有限公司 Method and system for displaying target vehicle in real time
CN115407273A (en) * 2022-08-29 2022-11-29 哈尔滨工业大学(威海) Specific security area monitoring reminding alarm device and method
CN115407273B (en) * 2022-08-29 2024-01-05 哈尔滨工业大学(威海) Monitoring, reminding and alarming device and method for specific security area

Also Published As

Publication number Publication date
CN111532274B (en) 2021-04-27

Similar Documents

Publication Publication Date Title
CN111532274A (en) Intelligent vehicle lane change auxiliary system and method based on multi-sensor data fusion
CN105480229B (en) An intelligent lane change assistance method based on information fusion
CN106428001B (en) A kind of lane change method for early warning and system for vehicle
CN106004659B (en) Vehicle Surrounding Environment Perception System and Control Method
US9378643B2 (en) Driver assistance system and method for operating a driver assistance system
CN112172802B (en) Driving safety assistance system and method capable of improving judgment accuracy and early warning
CN105291978B (en) Vehicle lane change auxiliary warning system and control method thereof
US8718916B2 (en) Object detecting device, and object detecting method
CN102673561B (en) A kind of rear-end collision preventing system and method
CN104290745A (en) Semi-automatic driving system for vehicle and method thereof
CN111252066A (en) Emergency braking control method and device, vehicle and storage medium
CN103448730B (en) A Method for Estimating Key Parameters of Automobile Rear Collision Early Warning on Expressway
CN1321023C (en) Automobile intelligent anticollision system
CN105109484A (en) Target-barrier determining method and device
CN101407193A (en) Anticollision alarming device for vehicle
JPH0858503A (en) Rear side danger alarm device and rear side danger judging method
CN111469835A (en) Vehicle auxiliary driving system and method based on topological map
CN206671554U (en) A kind of anti-car crass based on FUSION WITH MULTISENSOR DETECTION early warning system by all kinds of means
CN106428003B (en) Early warning device and method for lane departure of highway vehicles in bad weather
CN205417368U (en) Highway driving safety precaution device based on ITS
CN205292418U (en) Vehicle lane change assists early warning system
Zhang et al. Research on pedestrian vehicle collision warning based on path prediction
US20230182722A1 (en) Collision avoidance method and apparatus
Zhang et al. Design of arduino-based in-vehicle warning device for inner wheel difference
CN206107236U (en) Early warning device in skew lane of highway vehicle under adverse weather

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