CN104269070B - Active vehicle safety pre-warning method and safety pre-warning system with same applied - Google Patents
Active vehicle safety pre-warning method and safety pre-warning system with same applied Download PDFInfo
- Publication number
- CN104269070B CN104269070B CN201410411664.7A CN201410411664A CN104269070B CN 104269070 B CN104269070 B CN 104269070B CN 201410411664 A CN201410411664 A CN 201410411664A CN 104269070 B CN104269070 B CN 104269070B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- speed
- sigma
- target
- self
- 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
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000007781 pre-processing Methods 0.000 claims abstract description 22
- 238000004891 communication Methods 0.000 claims abstract description 7
- 238000004364 calculation method Methods 0.000 claims description 23
- 230000033001 locomotion Effects 0.000 claims description 15
- 238000001914 filtration Methods 0.000 claims description 8
- 238000012545 processing Methods 0.000 claims description 7
- 230000008569 process Effects 0.000 claims description 4
- 230000014509 gene expression Effects 0.000 claims description 3
- 230000005540 biological transmission Effects 0.000 claims description 2
- 238000005516 engineering process Methods 0.000 abstract description 10
- 238000010586 diagram Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 230000003044 adaptive effect Effects 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000000969 carrier Substances 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 231100001261 hazardous Toxicity 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/09—Arrangements for giving variable traffic instructions
- G08G1/0962—Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/123—Traffic control systems for road vehicles indicating the position of vehicles, e.g. scheduled vehicles; Managing passenger vehicles circulating according to a fixed timetable, e.g. buses, trains, trams
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/166—Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明涉及车辆主动安全控制和移动互联技术领域,尤其涉及一种车辆主动安全预警方法和运用该方法的安全预警系统。安全预警系统包括移动智能终端、无线通信网络和卫星定位系统,而主动安全预警方法则是在移动智能终端上安装数据预处理模块、轨迹追踪和预估模块、危险预警模块这三个软件,使自车能够根据目标范围内的行人及他车信息作出是否有碰撞危险的判断,并在必要情况下发出安全警报。通过对普遍普及的智能手机的巧妙地利用,使低成本车辆和行人能够享受到主动安全技术的保护,又不泄漏个人隐私,普及度高,成本低,易被大众接受。
The invention relates to the technical field of vehicle active safety control and mobile interconnection, in particular to a vehicle active safety early warning method and a safety early warning system using the method. The safety early warning system includes mobile smart terminals, wireless communication networks and satellite positioning systems, and the active safety early warning method is to install three software modules: data preprocessing module, trajectory tracking and estimation module, and danger warning module on the mobile smart terminal. The self-vehicle can judge whether there is a risk of collision based on the information of pedestrians and other vehicles within the target range, and issue a safety alarm if necessary. Through the ingenious use of popular smart phones, low-cost vehicles and pedestrians can enjoy the protection of active safety technology without leaking personal privacy, high popularity, low cost, and easy to be accepted by the public.
Description
技术领域technical field
本发明涉及车辆主动安全控制和移动互联技术领域,尤其涉及一种车辆主动安全预警方法和运用该方法的安全预警系统。The invention relates to the technical field of vehicle active safety control and mobile interconnection, in particular to a vehicle active safety early warning method and a safety early warning system using the method.
背景技术Background technique
车辆主动安全控制系统可以实现车辆碰撞预警和对驾驶操作的干预,使驾驶变得更加安全和轻松。近年来,该技术领域的研究热度不断升温,基于雷达、摄像头等环境探测传感器的主动安全控制系统如ACC(自适应巡航)、EBA(紧急制动辅助)、LKA(车道保持辅助)等已经成熟,并且还在不断被优化。如韩国专利KR2007023392A(ADAPTIVE CRUISE CONTROLSYSTEM AND METHOD CONSIDERING DRIVING ENVIRONMENT,CAPABLE OF AUTOMATICALLYCONTROLLING AN INTER-CAR DISTANCE ESPECIALLY WHEN IT IS RAINY OR DARK)介绍了利用雨量传感器、夜间驾驶传感器优化现有ACC系统,使车辆具有更好的环境感知功能,从而更加准确地实现主动安全控制。The vehicle active safety control system can realize vehicle collision warning and intervention in driving operation, making driving safer and easier. In recent years, the research enthusiasm in this technical field has continued to heat up. Active safety control systems such as ACC (Adaptive Cruise Control), EBA (Emergency Brake Assist), and LKA (Lane Keeping Assist) based on radar, camera and other environmental detection sensors have matured. , and is still being optimized. For example, Korean patent KR2007023392A (ADAPTIVE CRUISE CONTROL SYSTEM AND METHOD CONSIDERING DRIVING ENVIRONMENT, CAPABLE OF AUTOMATICALLY CONTROLLING AN INTER-CAR DISTANCE ESPECIALLY WHEN IT IS RAINY OR DARK) introduces the use of rain sensors to optimize the vehicle’s existing ACC system, and the night driving sensor to optimize the vehicle’s existing ACC system. The environment perception function of the vehicle can realize active safety control more accurately.
然而,现阶段还远不能实现完全意义上的道路主动安全。首先,车载雷达和摄像头主要用于探测前后方向的车辆,对于左右方向较远,或者驾驶员视觉的死角范围内的障碍物,或有障碍物遮挡的高速小型机动车辆,无法预先提出警报。其次,主动安全控制系统价格昂贵,目前只应用在高级别车型上,对于道路车辆占比最大的普通家用轿车来说,还无法实现该功能。第三,微车、摩托车和路上的行人更是无法享受主动安全技术带来的安全和舒适。However, at this stage, it is still far from realizing the full sense of road active safety. First of all, on-board radars and cameras are mainly used to detect vehicles in the front and rear directions. For obstacles that are far away in the left and right directions, or within the blind spot of the driver's vision, or high-speed small motor vehicles that are blocked by obstacles, it is impossible to raise an alarm in advance. Secondly, the active safety control system is expensive, and it is currently only used in high-end models. For ordinary family cars, which account for the largest proportion of road vehicles, this function cannot be realized. Third, mini-cars, motorcycles and pedestrians on the road cannot enjoy the safety and comfort brought by active safety technology.
随着车联网概念的兴起,基于互联的新技术——V2V,即Vehicle-to-Vehicle(也称作Car-to-Car)也被提出。所谓V2V,即是通过车载传感器等设备实现车辆之间的信息交换技术,在可能发生碰撞时,及时提醒驾驶员,避免交通事故的发生。汽车业界对于V2V技术的主要焦点放在了车载组件上。然而,虽然这些相关的车载组件在技术上已经取得了很大的进步,但是除了V2V技术本身之外,技术的普及程度也是十分重要的因素,如果不能普及,则根本不能发挥预期作用。With the rise of the concept of the Internet of Vehicles, a new technology based on the Internet - V2V, that is, Vehicle-to-Vehicle (also known as Car-to-Car) has also been proposed. The so-called V2V is to realize the information exchange technology between vehicles through on-board sensors and other equipment. When a collision may occur, the driver will be reminded in time to avoid traffic accidents. The main focus of the automotive industry for V2V technology is on the vehicle components. However, although these related vehicle components have made great technological progress, in addition to the V2V technology itself, the popularity of the technology is also a very important factor. If it cannot be popularized, it will not be able to play the expected role at all.
随着移动互联技术的快速发展,如今人们的生活正在发生着深刻的变化。现在,几乎每个人都会随身携带一部智能手机,安装了各种各样的应用软件,人们可以随时知道自己的地理位置,可以利用导航技术顺利到达目的地,而智能手机通过卫星定位系统可以对外发出所在地理位置信息而不泄漏隐私(如不发出手机号等个人信息)。With the rapid development of mobile Internet technology, people's lives are undergoing profound changes. Now, almost everyone carries a smart phone with various application software. People can know their geographical location at any time, and can use navigation technology to reach their destination smoothly. Send location information without leaking privacy (such as not sending personal information such as mobile phone number).
发明内容Contents of the invention
本发明的目的在于提供一种车辆主动安全预警方法和运用该方法的安全预警系统。它利用广泛普及的智能手机对外发送卫星定位系统定位的智能手机持有者所在位置信息,并通过安装在智能手机等移动智能终端上的软件对自己和他人的位置信息进行速度位置的计算预测,并在有碰撞危险时报警,具有主动安全预警的功能,并可以广泛普及。The object of the present invention is to provide a vehicle active safety early warning method and a safety early warning system using the method. It uses the widely popular smart phone to send out the location information of the smart phone holder positioned by the satellite positioning system, and calculates and predicts the speed and position of the location information of itself and others through the software installed on the smart phone and other mobile smart terminals. And when there is a risk of collision, the alarm has the function of active safety warning, and can be widely popularized.
对于本发明的主动安全预警方法来说,上述技术问题是这样解决的:For the active safety early warning method of the present invention, above-mentioned technical problem is solved like this:
一种基于移动智能终端位置信息的车辆主动安全预警方法,包括如下步骤:A vehicle active safety early warning method based on location information of a mobile intelligent terminal, comprising the following steps:
(1)自车目标范围内移动目标的移动智能终端通过无线通信网络将卫星定位系统定位的他们的位置数据传送至自车移动智能终端的数据预处理模块上;(1) The mobile intelligent terminal of the mobile target within the target range of the vehicle transmits their position data positioned by the satellite positioning system to the data preprocessing module of the mobile intelligent terminal of the vehicle through the wireless communication network;
(2)自车移动智能终端上的数据预处理模块根据自车的位置适时计算自车每一时刻的行驶距离和行驶速度,根据目标范围内移动目标的位置适时计算移动目标每一时刻的行驶距离和行驶速度,并将得出的自车和目标范围内移动目标的数据传输给自车移动智能终端上的轨迹追踪和预估模块;(2) The data preprocessing module on the mobile intelligent terminal of the own vehicle calculates the driving distance and driving speed of the own vehicle at each moment according to the position of the own vehicle, and calculates the driving of the moving target at each moment according to the position of the moving target within the target range. The distance and driving speed, and the obtained data of the moving target within the range of the vehicle and the target are transmitted to the trajectory tracking and estimation module on the mobile smart terminal of the vehicle;
(3)自车移动智能终端上的轨迹追踪和预估模块根据前几个时刻自车的位置、速度信息,预估自车下一时刻的位置、速度和运动方向,根据前几个时刻目标范围内移动目标的位置、速度信息预估下一时刻目标范围内移动目标的位置、速度和运动方向,并将得出的自车和目标范围内移动目标的数据信息传输给自车移动智能终端上的危险预警模块;(3) The trajectory tracking and estimation module on the mobile intelligent terminal of the self-vehicle predicts the position, speed and direction of movement of the self-vehicle at the next moment based on the position and speed information of the self-vehicle at the previous few moments. The position and speed information of the moving target within the range predicts the position, speed and direction of movement of the moving target within the target range at the next moment, and transmits the obtained data information of the own vehicle and the moving target within the target range to the mobile intelligent terminal of the own vehicle The hazard warning module on the
(4)自车移动智能终端上的危险预警模块根据自车的位置、速度和运动方向以及目标范围内移动目标的位置、速度和运动方向判断是否有碰撞危险,并在判断为有碰撞危险时发出危险警报。(4) The danger warning module on the mobile intelligent terminal of the self-vehicle judges whether there is a collision risk according to the position, speed and direction of movement of the self-vehicle and the position, speed and direction of movement of the moving target within the target range, and when it is judged that there is a risk of collision Hazard alert.
进一步的,所述步骤(1)中目标范围为以自车为中心半径为250米的圆形区域。Further, the target range in the step (1) is a circular area with the ego vehicle as the center and a radius of 250 meters.
所述步骤(2)中自车移动智能终端上的数据预处理模块在检测到小范围内有密集多机以相同速度、相同方向运行时,则将该目标判断为密集多机成组。When the data preprocessing module on the self-vehicle mobile intelligent terminal in the step (2) detects that there are dense multi-machines running at the same speed and in the same direction in a small area, the target is judged as a group of dense multi-machines.
所述自车移动智能终端上的数据预处理模块在进行密集多机成组判断时,将目标范围内移动目标上一时刻和当前时刻位置的连线方向作为速度方向。The data preprocessing module on the mobile intelligent terminal of the ego vehicle takes the direction of the line connecting the position of the moving target at the previous moment and the current moment within the target range as the speed direction when making intensive multi-machine group judgment.
判断为密集多机成组时以相同速度、相同方向运行的他机分布范围不大于半径为6m2的圆形区域。It is judged that the distribution range of other aircraft running at the same speed and in the same direction when it is judged as a dense multi-machine group is not larger than a circular area with a radius of 6m2.
所述步骤(2)中当数据预处理模块判断他机为密集多机成组时,以自车局部坐标系为标准,将离自车最远的他机为边界框画出矩形框线,并以矩形框线离自车最近的角作为危险目标点。In the step (2), when the data preprocessing module judges that the other machine is a dense multi-machine group, the local coordinate system of the self-vehicle is used as a standard, and the farthest other machine from the self-vehicle is used as a bounding box to draw a rectangular frame line, And take the corner closest to the ego vehicle as the dangerous target point.
所述步骤(2)中自车或目标范围内移动目标的速度计算方法为:首先从移动智能终端的存储芯片上调用当前时刻t和前一时刻t-1的位置信息,再根据这两个时刻的大地坐标(xt,yt)、(xt-1,yt-1)通过两点距离公式计算出两点距离D(t),再根据速度计算公式V(t)=D(t)/Δt计算出当前时刻速度大小V(t),其中Δt为系统计算周期。The speed calculation method of the moving target in the self-vehicle or the target range in the step (2) is: first call the position information of the current moment t and the previous moment t-1 from the memory chip of the mobile intelligent terminal, and then according to these two The geodetic coordinates (x t , y t ) and (x t-1 , y t-1 ) at the time are calculated by the distance formula between two points Calculate the distance D(t) between two points, and then calculate the current speed V(t) according to the speed calculation formula V(t)=D(t)/Δt, where Δt is the system calculation period.
所述步骤(2)中自车或目标范围内移动目标根据速度计算公式计算出的当前时刻速度V(t)需通过低通滤波进行滤波处理,然后再将经过低通滤波处理后的速度V'(t)作为当前时刻的速度大小,并输入到自车移动智能终端上的轨迹追踪和预估模块中去,所述的低通滤波算法公式为:V'(t)=a0V(t)+a1V(t-1)+a2V(t-2)+b1V'(t-1)+b2V'(t-2),其中:a0、a1、a2、b1、b2为CFC滤波常数。In the step (2), the current moment velocity V(t) calculated by the vehicle or the moving target within the target range according to the velocity calculation formula needs to be filtered by low-pass filtering, and then the velocity V after low-pass filtering is processed '(t) is used as the speed at the current moment, and is input to the trajectory tracking and estimation module on the mobile intelligent terminal of the vehicle. The formula of the low-pass filter algorithm is: V'(t)=a 0 V( t)+a 1 V(t-1)+a 2 V(t-2)+b 1 V'(t-1)+b 2 V'(t-2), where: a 0 , a 1 , a 2 , b 1 and b 2 are CFC filter constants.
所述步骤(3)中自车或目标范围内移动目标下一时刻的位置是通过最小二乘轨迹预测算法进行预估的。In the step (3), the position of the ego vehicle or the moving target within the range of the target at the next moment is estimated by the least squares trajectory prediction algorithm.
所述最小二乘轨迹预测算法的运算过程为:调用自当前时刻往前k个时刻被测物的位置数据,并将这k个点的轨迹假设成直线,得出下一时刻被测物的x坐标和y坐标的表达式分别为:x=a'+b't,y=a″+b″t,通过最小二乘轨迹预测算法计算出使k个时刻轨迹点预估误差最小的a',b',a″,b″的值,从而得出下一时刻的预估位置,其中a',b',a″,b″通过最小二乘轨迹预测算法的计算公式分别为:The operation process of the least squares trajectory prediction algorithm is: call the position data of the measured object at k moments before the current moment, and assume that the trajectory of these k points is a straight line, and obtain the position data of the measured object at the next moment The expressions of x-coordinate and y-coordinate are: x=a'+b't, y=a″+b″t, and the a that makes the trajectory point estimation error minimum at k time points is calculated by the least squares trajectory prediction algorithm ', b', a ", b ", so as to obtain the estimated position at the next moment, wherein a', b', a ", b " are respectively calculated by the least squares trajectory prediction algorithm as follows:
其中,ti为往前第i个时刻距初始计算时刻的时间间隔,t+1为下一时刻距初始计算点的时间间隔,xi,yi为往前第i个时刻被测物的实际坐标。Among them, t i is the time interval from the i-th time to the initial calculation time, t+1 is the time interval from the next time to the initial calculation point, x i and y i are the time interval of the measured object at the i-th time before actual coordinates.
所述步骤(3)中自车或目标范围内移动目标下一时刻的速度大小为经过低通滤波处理后的当前时刻速度大小V'(t)。In the step (3), the velocity of the ego vehicle or the moving target within the target range at the next moment is the velocity V'(t) at the current moment after the low-pass filtering process.
所述步骤(3)中自车或目标范围内移动目标下一时刻的速度方向为运用最小二乘法预测的直线方向。In the step (3), the speed direction of the ego vehicle or the moving target within the target range at the next moment is the linear direction predicted by the least square method.
所述步骤(4)中碰撞危险的判断方式为:根据下一时刻自车的速度信息和位置以及目标范围内移动目标的速度信息和位置计算出碰撞点,若离碰撞点的行驶时间小于危险警报时间,则将危险工况置标志位1,危险预警模块短时间之内进行多次危险工况判断,若危险工况标志位连续5次置1,则发出危险警报。The judgment method of the collision risk in the step (4) is: calculate the collision point according to the speed information and position of the vehicle at the next moment and the speed information and the position of the moving target within the target range, if the travel time from the collision point is less than the danger When the alarm time is set, the dangerous working condition flag is set to 1, and the danger warning module makes multiple judgments on dangerous working conditions in a short period of time. If the dangerous working condition flag is set to 1 for 5 consecutive times, a dangerous alarm is issued.
对于本发明的安全预警系统来说,上述技术问题是这样解决的:For the safety early warning system of the present invention, above-mentioned technical problem is solved like this:
包括移动智能终端,用于对外发送自车位置信息,接收目标范围内移动目标位置信息并对目标范围内移动目标位置进行速度运算、轨迹预估和危险报警;Including the mobile intelligent terminal, which is used to send the position information of the vehicle to the outside, receive the position information of the moving target within the target range, and perform speed calculation, trajectory estimation and danger alarm on the moving target position within the target range;
无线通信网络,用于自车和目标范围内移动目标位置的相互传送;The wireless communication network is used for the mutual transmission of the position of the mobile target within the range of the vehicle and the target;
卫星定位系统,用于确定移动智能终端所在位置。The satellite positioning system is used to determine the location of the mobile intelligent terminal.
进一步的,所述的移动智能终端为智能手机、车载信息采集装置T-Box、平板电脑、笔记本电脑中的一种或多种。Further, the mobile intelligent terminal is one or more of a smart phone, a vehicle-mounted information collection device T-Box, a tablet computer, and a notebook computer.
本发明的有益效果是:本发明基于广泛普及的能对外发送地理位置信息的智能手机,并通过在智能手机等移动智能终端上安装数据预处理模块、轨迹追踪和预估模块、危险预警模块这三个软件,使自车能够根据目标范围内的行人及他车信息作出是否有碰撞危险的判断,并在必要情况下发出安全警报。通过对普遍普及的智能手机的巧妙地利用,使低成本车辆和行人能够享受到主动安全技术的保护,又不泄漏个人隐私,普及度高,成本低,易被大众接受。The beneficial effect of the present invention is that: the present invention is based on the widely popularized smart phone capable of sending geographical location information to the outside, and by installing a data preprocessing module, a trajectory tracking and estimation module, and a danger warning module on mobile smart terminals such as smart phones. Three pieces of software enable the vehicle to judge whether there is a risk of collision based on the information of pedestrians and other vehicles within the target range, and issue a safety alarm if necessary. Through the ingenious use of popular smart phones, low-cost vehicles and pedestrians can enjoy the protection of active safety technology without leaking personal privacy, high popularity, low cost, and easy to be accepted by the public.
附图说明Description of drawings
图1为本发明控制主流程图;Fig. 1 is the control main flowchart of the present invention;
图2为数据预处理模块处理流程图;Fig. 2 is the processing flowchart of data preprocessing module;
图3为轨迹追踪和预估模块处理流程图;Fig. 3 is a flow chart of trajectory tracking and estimation module processing;
图4为危险预警模块处理流程图;Fig. 4 is the processing flowchart of danger early warning module;
图5为密集多机成组示意图;Figure 5 is a schematic diagram of dense multi-machine grouping;
图6为轨迹追踪与预测的自车位置信息示意图;Fig. 6 is a schematic diagram of the position information of the vehicle tracked and predicted;
图7为碰撞危险点预测示意图;Fig. 7 is a schematic diagram of collision danger point prediction;
图中:1—数据预处理模块,2—轨迹追踪和预估模块,3—危险预警模块。In the figure: 1—data preprocessing module, 2—trajectory tracking and estimation module, 3—danger warning module.
具体实施方式detailed description
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。In order to make the object, technical solution and advantages of the present invention clearer, the present invention will be further described in detail below in conjunction with the accompanying drawings and embodiments. The specific embodiments described here are only used to explain the present invention, not to limit the present invention. In addition, the technical features involved in the various embodiments of the present invention described below can be combined with each other as long as they do not constitute a conflict with each other.
本发明的主动安全预警系统包括移动智能终端、无线通信网络和卫星定位系统。移动智能终端为智能手机、平板电脑、车载信息采集装置(T-Box)、笔记本电脑等具有用户友好操作界面,且能够安装本发明所需软件的智能载体。自车和他车或他人的移动智能终端均可通过卫星定位系统进行位置定位,并通过无线通信网络对外发送自己的地理位置信息,同时不泄露自己的手机号等个人隐私,即行人车辆的移动智能终端之间可以同时对外发送自己的位置信息和接受他人的地理位置信息。在这些移动智能终端上还匹配安装了数据预处理模块1、轨迹追踪和预估模块2和危险预警模块3这几个主动安全预警软件。自车的移动智能终端在接收到他人的地理位置信息后,通过安装在其上的数据预处理模块1、轨迹追踪和预估模块2和危险预警模块3的处理,并通过相匹配的地图信息,在自车移动智能终端的显示屏上实时显示自机和他机的位置及运动轨迹。The active safety early warning system of the present invention includes a mobile intelligent terminal, a wireless communication network and a satellite positioning system. The mobile smart terminal is a smart phone, a tablet computer, a vehicle-mounted information collection device (T-Box), a notebook computer, etc., which have a user-friendly operation interface and are intelligent carriers capable of installing the software required by the present invention. The self-car and other cars or mobile smart terminals of other people can be positioned through the satellite positioning system, and send their own geographical location information to the outside world through the wireless communication network, and at the same time do not disclose their personal privacy such as their mobile phone numbers, that is, the movement of pedestrians and vehicles. Smart terminals can simultaneously send their own location information and receive other people's location information. These active safety early warning software, data preprocessing module 1, trajectory tracking and estimation module 2 and danger warning module 3, are also installed on these mobile smart terminals. After the mobile intelligent terminal of the ego vehicle receives the geographic location information of others, it processes the data preprocessing module 1, track tracking and estimation module 2 and danger warning module 3 installed on it, and passes the matching map information , on the display screen of the mobile intelligent terminal of the vehicle to display the position and trajectory of the vehicle and other vehicles in real time.
假设某车辆在道路上行驶,驾驶员A运行了智能手机中本发明的软件,主动安全预警进入启动状态。如图1和2所示,驾驶员智能手机中的数据预处理模块1开始接收方圆250m范围内他机的位置信息,并对进入监控范围内的每一个他机分配唯一的临时ID号,他机产生的位置信息存入智能手机存储芯片对应ID的数据位中。当他机移出监控范围,对应的ID号及存储的位置信息自动清除。数据预处理模块1首先调用智能手机储芯片中每一个ID对象在当前时刻和前一时刻(t-1,t)的位置,分别计算出自机和目标范围内移动目标即所有他机的速度大小,由于自己和他机在几个模块中的速度、位置等信息的处理和计算方式是一样的,为了描述方便在后面全部以自机为例进行说明。Assuming that a certain vehicle is running on the road, driver A runs the software of the present invention in the smart phone, and the active safety warning enters the starting state. As shown in Figures 1 and 2, the data preprocessing module 1 in the driver's smart phone starts to receive the location information of other aircraft within a radius of 250m, and assigns a unique temporary ID number to each other aircraft entering the monitoring range. The location information generated by the mobile phone is stored in the data bit corresponding to the ID of the smart phone memory chip. When other machines move out of the monitoring range, the corresponding ID number and stored location information will be cleared automatically. Data preprocessing module 1 first calls the position of each ID object in the smart phone storage chip at the current moment and the previous moment (t-1, t), and calculates the speed of the own machine and the moving target within the target range, that is, all other machines , since the processing and calculation methods of the speed, position and other information of the self and other machines in several modules are the same, for the convenience of description, the self-machine is used as an example for illustration.
自机在t-1和t两个时刻的大地坐标分别为(xt,yt)和(xt-1,yt-1),则通过两点距离公式可以计算出从t-1时刻到当前t时刻自车行驶的距离D(t),再根据速度计算公式V(t)=D(t)/Δt计算出当前时刻速度大小V(t),其中Δt为系统计算周期。车速数据为避免较大的波动,可以应用低通滤波算法消除曲线峰谷,使车速曲线更加平滑,低通滤波算法公式为:The geodetic coordinates of the self-machine at two moments t-1 and t are (x t , y t ) and (x t-1 , y t-1 ) respectively, then the two-point distance formula The distance D(t) traveled by the self-vehicle from time t-1 to the current time t can be calculated, and then the speed V(t) at the current moment can be calculated according to the speed calculation formula V(t)=D(t)/Δt, where Δt is the calculation cycle of the system. In order to avoid large fluctuations in the vehicle speed data, a low-pass filter algorithm can be used to eliminate the peaks and valleys of the curve and make the vehicle speed curve smoother. The formula of the low-pass filter algorithm is:
V'(t)=a0V(t)+a1V(t-1)+a2V(t-2)+b1V'(t-1)+b2V'(t-2),V'(t)=a 0 V(t)+a 1 V(t-1)+a 2 V(t-2)+b 1 V'(t-1)+b 2 V'(t-2) ,
其中:a0、a1、a2、b1、b2为CFC滤波常数,而这一系列滤波常数的计算公式如下:Among them: a 0 , a 1 , a 2 , b 1 , b 2 are CFC filter constants, and the calculation formula of this series of filter constants is as follows:
ωd=2π·1.25·CutOff_Frqω d =2π·1.25·CutOff_Frq
a1=2a0 a 1 =2a 0
a2=a0 a 2 =a 0
其中CutOff_Frq为滤波的截止频率,默认取值为5,具体取值可根据车速曲线的具体波动进行调整。Among them, CutOff_Frq is the cutoff frequency of the filter, the default value is 5, and the specific value can be adjusted according to the specific fluctuation of the vehicle speed curve.
V(t)为未经过低通滤波处理的速度,而数据预处理模块1将经过低通滤波处理后的速度V'(t)作为当前时刻的速度大小,并输入到自车移动智能终端上的轨迹追踪和预估模块2中去。在数据预处理模块1对自车和目标范围内移动目标的行驶距离和行驶速度是根据系统计算周期时刻进行适时计算的。而在进行这一系列计算时还会进行他机密集多机成组的判断。V(t) is the speed without low-pass filtering processing, and the data preprocessing module 1 takes the speed V'(t) after low-pass filtering processing as the speed at the current moment, and inputs it to the mobile intelligent terminal of the vehicle Go in module 2 of trajectory tracking and estimation. In the data preprocessing module 1, the traveling distance and traveling speed of the own vehicle and the moving target within the target range are calculated in a timely manner according to the calculation period of the system. And when performing this series of calculations, other confidential and intensive multi-machine group judgments will also be carried out.
如图5所示,在数据预处理模块1内运动方向判定为当前时刻与前一时刻的位置连线方向(这里的速度方向判断只是在密集多机成组判断中运用,在轨迹追踪和预估模块中还会进行重新判断)。若同一时刻,计算ID编号为5、6、7、8的四个他机在不大于6m2的范围内以相同速度、相同方向运行。此时,本系统判断ID编号为5、6、7、8的四个他机为一个grouping,即为密集多机成组,并给予此grouping ID编号5*6*7*8=1680,同时删除ID编号为6、7、8的三个他机数据。同时,以自车局部坐标系为标准,将离自机最远的他机为边界框画出矩形线框,并以矩形线框离自机最近的角作为危险目标点,grouping的运动速度和运动方向与ID编号为5的他机一致。As shown in Figure 5, the direction of motion in the data preprocessing module 1 is determined as the direction of the line connecting the position between the current moment and the previous moment (the judgment of speed and direction here is only used in the judgment of dense multi-machine groups, and it is used in trajectory tracking and forecasting). will be re-judged in the evaluation module). If at the same moment, four other machines whose calculated ID numbers are 5, 6, 7, and 8 are running at the same speed and in the same direction within a range not greater than 6m 2 . At this time, the system judges that the four other machines whose ID numbers are 5, 6, 7, and 8 are a grouping, which is a dense multi-machine group, and gives the grouping ID number 5*6*7*8=1680, and at the same time Delete the data of three other machines whose ID numbers are 6, 7, and 8. At the same time, with the local coordinate system of the own vehicle as the standard, draw a rectangular wire frame with the other machine farthest from the own machine as the bounding box, and use the corner of the rectangular wire frame closest to the own machine as the dangerous target point, the movement speed of grouping and The direction of movement is the same as that of the other machine with ID number 5.
如图3所示,轨迹追踪和预估模块2将数据预处理模块1输入的经过低通滤波处理过的当前时刻速度V'(t)作为自车的预测的下一时刻速度信息,而对于下一时刻自车的位置估计则通过最小二乘轨迹预测算法进行预测。如图6所示,轨迹追踪和预估模块2调用智能手机存储芯片中自车前k(k<=10)个时刻的位置信息,由于本系统的计算频率为10Hz以上,所以前k个时刻的运动轨迹可以当成一条直线,对于下一时刻位置的x(t+1)和y(t+1)坐标则可以根据公式x(t+1)=a'+b'(t+1),y(t+1)=a″+b″(t+1)得出。由于实际上运动轨迹不可能是直线,因此会存在误差,而x坐标和y坐标的误差公式分别为:εi'=xi-a'-b'ti,εi″=yi-a″-b″ti,k个点的位置在x和y坐标上的方差分别为:为使误差最小,需要对a'、b'、a″、b″进行偏微分,最后得出在误差最小时的a'、b'、a″、b″的表达式分别为:As shown in Figure 3, the trajectory tracking and estimation module 2 uses the low-pass filtered current velocity V'(t) input by the data preprocessing module 1 as the predicted next moment velocity information of the own vehicle, and for The position estimation of the ego vehicle at the next moment is predicted by the least squares trajectory prediction algorithm. As shown in Figure 6, the trajectory tracking and estimation module 2 calls the position information of the car at the previous k (k<=10) moments in the storage chip of the smart phone. Since the calculation frequency of this system is above 10Hz, the first k moments The trajectory of the movement can be regarded as a straight line, and the x(t+1) and y(t+1) coordinates of the position at the next moment can be based on the formula x (t+1) = a'+b'(t+1), y (t+1) = a″+b″(t+1) to obtain. Since the motion trajectory cannot be a straight line in fact, there will be errors, and the error formulas of x coordinates and y coordinates are: ε i '=x i -a'-b't i , ε i ″=y i -a ″-b″t i , the variances of the positions of k points on the x and y coordinates are: In order to minimize the error, it is necessary to perform partial differentiation on a', b', a", and b". Finally, the expressions of a', b', a", and b" when the error is minimized are:
式中,ti为往前第i个时刻距初始计算时刻的时间间隔,t+1为下一时刻距初始计算点的时间间隔,xi,yi为往前第i个时刻被测物的实际坐标。In the formula, t i is the time interval from the i-th time to the initial calculation time, t+1 is the time interval from the next time to the initial calculation point, x i and y i are the time interval of the measured object at the i-th time before actual coordinates.
将a'、b'、a″、b″分别代入公式x(t+1)=a'+b'(t+1),y(t+1)=a″+b″(t+1)中,从而得自车出下一时刻的位置。而下一时刻自车的运动方向则为最小二乘轨迹预测算法预估的直线方向。在轨迹追踪和预估模块2中目标范围内移动目标的下一时刻速度、方向和位置也通过相同的方式进行计算处理。轨迹追踪和预估模块2将得出的自车和目标范围内的移动目标的下一时刻速度,方向和位置输入到危险预警模块3中。Substitute a', b', a", and b" into the formula x (t+1) = a'+b'(t+1), y (t+1) = a"+b"(t+1) , so as to obtain the position at the next moment when the car exits. The direction of motion of the ego vehicle at the next moment is the linear direction estimated by the least squares trajectory prediction algorithm. The speed, direction and position of the moving target at the next moment within the target range in the trajectory tracking and estimation module 2 are also calculated and processed in the same manner. The trajectory tracking and estimation module 2 inputs the obtained next moment speed, direction and position of the ego vehicle and the moving target within the target range into the danger warning module 3 .
如图4所示,危险预警模块3根据自车和他车的运行轨迹和运行速度,预测出发生碰撞的位置点,当自车离碰撞点的行驶距离小于危险警报时间3s时,则将危险工况标志位置为1。例如,危险预警模块3根据下一时刻自机及编号为3的他机位置信息和速度信息,计算出在大地坐标系点P(x0,y0)的位置上将发生碰撞(如图7所示),而自机离点P的运行时间Δt'为2.8s,此时,危险预警模块4将危险工况标志位置为1并存入存储芯片中,并同时调用存储芯片中前四个时刻的危险工况标志位。若发现前四个时刻危险工况标志位均为1,此时危险预警模块4发出危险警报命令,控制系统发出危险警报。As shown in Figure 4, the danger warning module 3 predicts the location of the collision according to the running track and running speed of the self-vehicle and other vehicles. The position of the working condition flag is 1. For example, the danger warning module 3 calculates that a collision will occur at the position of the earth coordinate system point P (x0, y0) according to the location information and speed information of the own machine and the other machine numbered 3 at the next moment (as shown in Figure 7 ), and the running time Δt' of the self-machine departure point P is 2.8s. At this time, the danger warning module 4 stores the position of the dangerous working condition flag as 1 and stores it in the memory chip, and calls the previous four moments in the memory chip at the same time. Hazardous working condition sign. If it is found that the dangerous working condition flags are all 1 at the first four moments, then the dangerous warning module 4 sends a dangerous warning command, and the control system sends a dangerous warning.
当车辆停止时,自机计算位车辆速度信号为0,判断车辆已停止,系统自动退出运行。When the vehicle stops, the computer calculates that the vehicle speed signal is 0, judging that the vehicle has stopped, and the system automatically exits the operation.
应当理解的是,对本领域普通技术人员来说,可以根据上述说明加以改进或变换,而所有这些改进和变换都应属于本发明所附权利要求的保护范围。It should be understood that those skilled in the art can make improvements or changes based on the above description, and all these improvements and changes should belong to the protection scope of the appended claims of the present invention.
Claims (14)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410411664.7A CN104269070B (en) | 2014-08-20 | 2014-08-20 | Active vehicle safety pre-warning method and safety pre-warning system with same applied |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410411664.7A CN104269070B (en) | 2014-08-20 | 2014-08-20 | Active vehicle safety pre-warning method and safety pre-warning system with same applied |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104269070A CN104269070A (en) | 2015-01-07 |
CN104269070B true CN104269070B (en) | 2017-05-17 |
Family
ID=52160587
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410411664.7A Active CN104269070B (en) | 2014-08-20 | 2014-08-20 | Active vehicle safety pre-warning method and safety pre-warning system with same applied |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104269070B (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11458966B2 (en) * | 2017-10-26 | 2022-10-04 | Continental Autonomous Mobility US, LLC | Method and device of determining kinematics of a target |
Families Citing this family (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104501820B (en) * | 2014-11-24 | 2018-12-21 | 朱今兰 | A kind of intelligent city's Position Fixing Navigation System |
CN104680841B (en) * | 2015-03-12 | 2017-01-11 | 厦门奥声科技有限公司 | Driving early warning method |
CN104882025B (en) * | 2015-05-13 | 2017-02-22 | 东华大学 | Crashing detecting and warning method based on vehicle network technology |
CN105303890A (en) * | 2015-10-27 | 2016-02-03 | 重庆智韬信息技术中心 | Intelligent early warning method for surrounding vehicle with abnormal driving state |
CN105390025A (en) * | 2015-11-16 | 2016-03-09 | 浙江交通职业技术学院 | Intelligent traffic safety management system based on location information |
CN105469599B (en) * | 2015-12-01 | 2017-12-15 | 上海交通大学 | Vehicle tracing and vehicle behavior prediction method |
CN105679091B (en) * | 2016-01-21 | 2018-04-20 | 东华大学 | A kind of Clash-Visualization method for early warning based on car networking |
MX381551B (en) * | 2016-01-22 | 2025-03-12 | Nissan Motor | DRIVING ASSISTANCE METHOD AND DEVICE. |
CN105774650B (en) * | 2016-03-03 | 2018-08-07 | 胡良 | A kind of anticollision of motor vehicles method for early warning and system based on satellite navigation |
CN106251668B (en) * | 2016-08-18 | 2019-02-26 | 深圳市永兴元科技股份有限公司 | Vehicle drive reminding method and device |
CN106251671A (en) * | 2016-08-19 | 2016-12-21 | 深圳市元征科技股份有限公司 | A kind of vehicle early warning method and device |
CN106357753B (en) * | 2016-08-31 | 2019-05-07 | 重庆长安汽车股份有限公司 | A method of reducing vehicle active safety false triggering rate |
CN106408978B (en) * | 2016-10-28 | 2020-04-14 | 北京航空航天大学 | A V2V-based method for calculating headway and headway distance on a curve |
DE102016224516A1 (en) * | 2016-12-08 | 2018-06-14 | Robert Bosch Gmbh | Method and device for recognizing at least one pedestrian by a vehicle |
CN106652560B (en) * | 2016-12-12 | 2019-05-14 | 珠海格力电器股份有限公司 | Road safety method and device |
CN107010086B (en) * | 2017-03-29 | 2018-07-10 | 宁夏凯速德科技有限公司 | High ferro line security control method and system |
CN109087485B (en) * | 2018-08-30 | 2021-06-08 | Oppo广东移动通信有限公司 | Driving reminding method and device, intelligent glasses and storage medium |
CN110428663B (en) * | 2019-08-30 | 2021-04-20 | 合肥鑫晟光电科技有限公司 | Vehicle collision early warning method, vehicle-mounted terminal and server |
CN111932942A (en) * | 2020-08-28 | 2020-11-13 | 英华达(南京)科技有限公司 | Vehicle collision early warning method and device, terminal device and computer readable storage medium |
CN112109707B (en) * | 2020-09-07 | 2022-01-07 | 东风汽车集团有限公司 | An emergency lane keeping assist method for VRU |
CN113733930B (en) * | 2021-08-20 | 2023-09-29 | 合众新能源汽车股份有限公司 | An automatic control method and device for parking gear locking when a pure electric vehicle is powered off |
CN117456714A (en) * | 2022-07-19 | 2024-01-26 | 广州六环信息科技有限公司 | Vehicle safety early warning method, system, equipment and storage medium |
CN115892824A (en) * | 2022-12-08 | 2023-04-04 | 杭州高达软件系统股份有限公司 | An early warning method and system based on forklift carrying trend correction behavior analysis and system |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102649430A (en) * | 2011-02-28 | 2012-08-29 | 通用汽车环球科技运作有限责任公司 | Redundant lane sensing systems for fault-tolerant vehicular lateral controller |
CN102696060A (en) * | 2009-12-08 | 2012-09-26 | 丰田自动车株式会社 | Object detection apparatus and object detection method |
CN102783144A (en) * | 2010-03-01 | 2012-11-14 | 本田技研工业株式会社 | Vehicle perimeter monitoring device |
CN102959600A (en) * | 2010-06-29 | 2013-03-06 | 本田技研工业株式会社 | Device for estimating vehicle travel path |
CN103718225A (en) * | 2011-08-02 | 2014-04-09 | 日产自动车株式会社 | Driving assistance apparatus and driving assistance method |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102007015032A1 (en) * | 2007-03-29 | 2008-01-10 | Daimlerchrysler Ag | Method for evaluating how critical driving situation is comprises calculating possible accelerations and decelerations for vehicle and object whose paths are set to cross and deducing time periods in which their paths would overlap |
US8179239B2 (en) * | 2009-02-19 | 2012-05-15 | Automotive Research & Testing Center | Driving safety auxiliary network administration system and method thereof |
JP5428036B2 (en) * | 2009-08-31 | 2014-02-26 | 株式会社国際電気通信基礎技術研究所 | Support device, program for causing computer to execute safe driving support therein, and computer-readable recording medium recording the program |
DE102011111899A1 (en) * | 2011-08-30 | 2013-02-28 | Gm Global Technology Operations, Llc | Detection device and method for detecting a carrier of a transceiver, motor vehicle |
JP5668862B2 (en) * | 2011-09-14 | 2015-02-12 | トヨタ自動車株式会社 | Driving support device and driving support method |
CN102750837A (en) * | 2012-06-26 | 2012-10-24 | 北京航空航天大学 | No-signal intersection vehicle and vehicle cooperative collision prevention system |
CN103514758A (en) * | 2013-09-18 | 2014-01-15 | 中国科学技术大学苏州研究院 | Efficient road traffic anti-collision warning method based on vehicle-to-vehicle communication |
-
2014
- 2014-08-20 CN CN201410411664.7A patent/CN104269070B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102696060A (en) * | 2009-12-08 | 2012-09-26 | 丰田自动车株式会社 | Object detection apparatus and object detection method |
CN102783144A (en) * | 2010-03-01 | 2012-11-14 | 本田技研工业株式会社 | Vehicle perimeter monitoring device |
CN102959600A (en) * | 2010-06-29 | 2013-03-06 | 本田技研工业株式会社 | Device for estimating vehicle travel path |
CN102649430A (en) * | 2011-02-28 | 2012-08-29 | 通用汽车环球科技运作有限责任公司 | Redundant lane sensing systems for fault-tolerant vehicular lateral controller |
CN103718225A (en) * | 2011-08-02 | 2014-04-09 | 日产自动车株式会社 | Driving assistance apparatus and driving assistance method |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11458966B2 (en) * | 2017-10-26 | 2022-10-04 | Continental Autonomous Mobility US, LLC | Method and device of determining kinematics of a target |
Also Published As
Publication number | Publication date |
---|---|
CN104269070A (en) | 2015-01-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104269070B (en) | Active vehicle safety pre-warning method and safety pre-warning system with same applied | |
CN111240328B (en) | Vehicle driving safety monitoring method and device and unmanned vehicle | |
Hu et al. | A review of research on traffic conflicts based on intelligent vehicles | |
US11945460B1 (en) | Systems and methods for interfacing with an occupant | |
CN106969779B (en) | Intelligent vehicle map fusion system and method based on DSRC | |
WO2021135371A1 (en) | Automatic driving method, related device and computer-readable storage medium | |
JP6714513B2 (en) | An in-vehicle device that informs the navigation module of the vehicle of the presence of an object | |
CN112512887B (en) | Driving decision selection method and device | |
JP2021111329A (en) | Map production system | |
EP3794571A2 (en) | System and method for using v2x and sensor data | |
KR20210038852A (en) | Method, apparatus, electronic device, computer readable storage medium and computer program for early-warning | |
JPWO2018096644A1 (en) | VEHICLE DISPLAY CONTROL DEVICE, VEHICLE DISPLAY CONTROL METHOD, AND VEHICLE DISPLAY CONTROL PROGRAM | |
CN111145589A (en) | Vehicle omnidirectional anti-collision warning system based on vector algorithm | |
CN113085852A (en) | Behavior early warning method and device for automatic driving vehicle and cloud equipment | |
CN106251666A (en) | Under the foggy environment of intelligent network connection automobile, expressway safety speed guides system and method | |
JP2017102556A (en) | Information processing device, information processing method, vehicle control device, and vehicle control method | |
CN112829762A (en) | A method for generating vehicle speed and related equipment | |
EP3855123B1 (en) | Map generation system | |
JP7212708B2 (en) | Traffic signal control method and device | |
CN114782921A (en) | Pedestrian and vehicle collision early warning system and method in internet connection environment based on pedestrian intention identification | |
JP7579332B2 (en) | Method, device and system for transmitting waypoint information for autonomous vehicle platoons | |
US11794737B2 (en) | Vehicle operation | |
CN116009533A (en) | Unmanned vehicle path switching method, device, system and medium | |
CN115649155A (en) | Obstacle avoidance method based on intelligent driving, electronic device, storage medium and vehicle | |
CN115115707B (en) | Vehicle falling water detection method, vehicle, computer readable storage medium and chip |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CP01 | Change in the name or title of a patent holder |
Address after: 430056 No. 1 Dongfeng Avenue, Wuhan economic and Technological Development Zone, Hubei, Wuhan Patentee after: dFac Address before: 430056 No. 1 Dongfeng Avenue, Wuhan economic and Technological Development Zone, Hubei, Wuhan Patentee before: Dongfeng Car Co. |
|
CP01 | Change in the name or title of a patent holder |