Summary of the invention
The technical problem to be solved in the present invention is to provide a kind of vehicle collision avoidance safety alarm method and device, can judge whether two cars can cross with the account form of vector quantization, is conducive to send in advance early warning to avoid collision.
For solving the problems of the technologies described above, the invention provides a kind of vehicle collision avoidance safety alarm method, comprising:
Obtain velocity and the position of its car, and confirm velocity and the position of this car;
Obtain the position vector of its car according to the position calculation of its car, and obtain the position vector of this car according to the position calculation of this car, the position vector of its car is pointed to the position of its car by initial point, and the position vector of this car is pointed to the position of this car by this initial point;
If (PB-PA) × VA, (PB-PA) × VB and VA × VB three homopolarity, judge that this car and its car will cross forwardly, the position vector that wherein PA is this car, the velocity that VA is this car, PB is the position vector of its car, and VB is the velocity of its car.
According to one embodiment of present invention, the method also comprises:
If judge that this car and its car will cross forwardly, calculate and estimate collision time, this expectation collision time equals the poor business with the poor projection in the poor direction of this position vector of velocity of position vector, and wherein to discuss poor be PB-PA in this position, and this velocity is poor is VB-VA;
If described expectation collision time is less than default threshold value, send collision warning.
According to one embodiment of present invention, the method also comprises: in the time judging the crossing forwardly of this car and its car, if receive the emergency brake situation that its car sends, send emergency brake alarm.
According to one embodiment of present invention, the method also comprises: if any both different poles in (PB-PA) × VA, (PB-PA) × VB and VA × VB judge that this car and its car will not cross forwardly.
According to one embodiment of present invention, obtain velocity and the position of its car by Dedicated Short Range Communications.
The present invention also provides a kind of vehicle collision avoidance safety alarm device, comprising:
Acquisition of information module, for obtaining velocity and the position of its car, and confirms velocity and the position of this car;
Vector computing module, for obtain the position vector of its car according to the position calculation of its car, and obtain the position vector of this car according to the position calculation of this car, and the position vector of its car is pointed to the position of its car by initial point, and the position vector of this car is pointed to the position of this car by this initial point;
Judge module, if (PB-PA) × VA, (PB-PA) × VB and VA × VB three homopolarity, judge that this car and its car will cross forwardly, the position vector that wherein PA is this car, VA is the velocity of this car, PB is the position vector of its car, and VB is the velocity of its car.
According to one embodiment of present invention, this device also comprises:
Time Calculation module, for calculating and estimate collision time in the time judging the crossing forwardly of this car and its car, this expectation collision time equals the poor business with the poor projection in the poor direction of this position vector of velocity of position vector, wherein the poor PB-PA of being is discussed in this position, and this velocity is poor is VB-VA;
Collision warning module, if described expectation collision time is less than default threshold value, sends collision warning.
According to one embodiment of present invention, this device also comprises: emergency brake alarm modules, in the time judging the crossing forwardly of this car and its car, if receive the emergency brake situation that its car sends, send emergency brake alarm.
According to one embodiment of present invention, if any both different poles in (PB-PA) × VA, (PB-PA) × VB and VA × VB, described judge module judges that this car and its car will not cross forwardly.
According to one embodiment of present invention, described acquisition of information module is obtained its car by Dedicated Short Range Communications, velocity and position.
Compared with prior art, the present invention has the following advantages:
The vehicle collision avoidance safety alarm method of the embodiment of the present invention and device are according to position vector and the velocity of Ben Che and its car, adopt the computing method of vector quantization to judge whether two cars can cross, in the situation that judgement will cross, can send prompting to driver in advance, to avoid collision.
Furthermore, the vehicle collision avoidance safety alarm method of the embodiment of the present invention and device also adopt the computing method of vector quantization to calculate expectation collision time, if this expectation collision time is less than default threshold value, send collision warning, make driver can make in time evasive action, reduce accident rate.
In addition, the embodiment of the present invention, in the situation that two cars will cross, can also directly be sent emergency brake alarm according to the emergency brake situation of its car, so that driver can take workaround as early as possible.
Embodiment
Below in conjunction with specific embodiments and the drawings, the invention will be further described, but should not limit the scope of the invention with this.
With reference to figure 1, the vehicle collision avoidance safety alarm method of the present embodiment comprises the steps:
Step S11, obtains velocity and the position of its car, and confirms velocity and the position of this car;
Step S12, obtains the position vector of its car according to the position calculation of its car, and obtains the position vector of this car according to the position calculation of this car, and the position vector of its car is pointed to the position of its car by initial point, and the position vector of this car is pointed to the position of this car by this initial point;
Step S13, if (PB-PA) × VA, (PB-PA) × VB and VA × VB three homopolarity, judge that this car and its car will cross forwardly, the position vector that wherein PA is this car, VA is the velocity of this car, PB is the position vector of its car, and VB is the velocity of its car.
In step S11, can obtain by Dedicated Short Range Communications, (DSRC) information such as velocity and position of its car of periphery.The position of its car and the position of Ben Che for example can adopt the mode of longitude, latitude to represent, but are not limited to this.The velocity of its car and Ben Che comprises velocity amplitude and velocity reversal.
Adopt DSRC can in less time delay (being generally Millisecond), obtain the information of nearby vehicle.While adopting DSRC, vehicle can adopt the information of the continuous peripherad vehicle broadcast of the frequency of 10Hz oneself, and such as position, velocity etc., also can receive the information that surrounding vehicles sends over.Certainly, Dedicated Short Range Communications, is only a kind of preferred mode, and the mode of obtaining the information of its car is not limited to this, also can adopt with other appropriate means.
Initial point in step S12 can be the initial point of the lat/longitude of GPS, or can be also the initial point of Chinese terrestrial coordinate, or can be also other suitable origin positions.
In step S13, it is equidirectional that (PB-PA) × VA, (PB-PA) × VB and VA × VB three homopolarity refer to three, and namely the direction of three vector products is identical.If three's homopolarity, so just can judge that two cars will cross forwardly, now can send prompting to driver, remind auditor to note enhancing your vigilance, can certainly not send prompting; If three's any two different poles wherein, so just can judge that this car and its car will can not cross forwardly.
In the time judging that two cars will cross forwardly, can continue to do and collide more accurately anticipation, specific as follows: first to calculate and estimate collision time, this expectation collision time=position vector is poor/the poor projection in the poor direction of this position vector of velocity, wherein, position vector is poor=position vector of the position vector-Ben Che of its car, and the velocity of the velocity-Ben Che of velocity=its car; For example, if the expectation collision time calculating is less than default threshold value (5s, 10s, 20s, but be not limited to this), send collision warning.
This collision warning can adopt the mode of voice, signal lamp to offer user, if remaining unchanged, the current state of alerting driver will cause collision, that is to say under the position and velocity conditions of current two cars, cause the most at last collision accident, remind driver to take in advance workaround, for example, brake or suitably turn to etc.
In addition, in the time judging that this car and its car will cross forwardly, this car can also receive the emergency brake situation that its car sends by modes such as DSRC.If received emergency brake situation, show that its car taked brake hard, so directly send emergency brake alarm, point out the driver of this car to take to evade action.It is real-time that the sending of emergency brake alarm is preferably, and just sends emergency brake alarm once namely receive the emergency brake situation of its car, makes this car driver the very first time to take workaround as far as possible.
Example below in conjunction with a crossing is elaborated to this vehicle collision avoidance safety alarm method.
With reference to figure 2, in intersection, this car A travels eastwards in west, and its car B travels from south orientation north, and two cars all will, through intersection, likely bump in intersection.
Correlation parameter mark is as follows:
The position vector of this car is designated as: PA;
The position vector of its car is designated as: PB;
The velocity of this car is designated as: VA;
The velocity of its car is designated as: VB.
If (PB-PA) × VA, (PB-PA) × VB and VA × VB three homopolarity, judge that this car A and its car B will cross forwardly; If any both different poles in (PB-PA) × VA, (PB-PA) × VB and VA × VB, judge that two cars do not cross forwardly.
Below calculating and deterministic process are elaborated.
The position of this car A can represent with longitude and latitude, and its longitude is designated as LLong, and its latitude is designated as LLat; The position of its car B also can represent with longitude and latitude, and its longitude is designated as RLong, and its latitude is designated as RLat.The velocity amplitude of this car A is designated as LSpeed, and the velocity reversal of this car A is designated as Lheading; The velocity amplitude of its car B is designated as RSpeed, and the velocity reversal of its car B is designated as Rheading.In addition, earth radius is designated as R.
According to above mark, corresponding computation process is as follows:
The position vector of this car A: PA=(LLong, LLat);
The position vector of its car B: PB=(RLong, RLat);
The position vector of its car B and this car A is poor: DP=PB-PA=(DPx, DPy);
Wherein, DPx=Cos (LLat) × Sin (RLong – LLong) × R, DPx is again two car East and West direction distances;
DPy=Sin (RLat – LLat) × R, Dpy is again two car north-south distances;
The velocity of its car B: VB=(VBx, VBy);
Wherein, VBx=Sin (Rheading) × RSpeed;
VBy=Cos(Rheading)×RSpeed;
The velocity of this car A: VA=(VAx, VAy);
Wherein, VAx=Sin (Lheading) × LSpeed;
VAy=Cos(Lheading)×LSpeed;
The velocity of its car B and this car A is poor: DV=VB-VA=(DVx, DVy);
Wherein, DVx=VBx-VAx;
DVy=VBy-VAy;
For judging whether two cars are calculated as follows the variable crossing forwardly:
The vector product (or being called multiplication cross) of the velocity of the velocity of this car A and its car B:
VA×VB=(VAx,VAy)×(VBx,VBy)=(VAx×VBy)–(VAy×VBx);
The vector product of the poor velocity with this car A of the position vector of two cars:
DP×VA=(DPx,DPy)×(VAx,VAy)=(DPx×VAy)-(DPy×VAx);
The vector product of the poor velocity with its car B of the position vector of two cars:
DP×VB=(DPx,DPy)×(VBx,VBy)=(DPx×VBy)-(DPy×VBx);
According to above calculating, corresponding deterministic process is as follows:
If VA × VB<0 and DP × VA<0 and DP × VB<0, or VA × VB>0 and DP × VA>0 and DP × VB>0, two cars will cross forwardly so; Otherwise two cars will can not cross forwardly, and two cars do not exist the possibility bumping.
If judge that two cars will cross forwardly, can continue so to calculate and estimate collision time, detailed process is as follows:
The vector length of two truck position phasor differences: DPValu=|DP|=Sqrt (DPx × DPx+DPy × DPy);
The vector length of two vehicle speed phasor differences: DVValu=|DV|=Sqrt (DVx × DVx+DVy × DVy);
The included angle cosine value of two truck position phasor differences and two vehicle speed phasor differences:
cosDAngle=(DPx×DVx+DPy×DVy)/(DPValu×DVValu);
Estimate collision time: tImpact=DPValu/ (cosDAngle × DVValu);
Wherein, (cosDAngle × DVValu) is the vector length of the projection of velocity on the direction vector of position.
If this expectation collision time tImpact is less than default threshold value, send collision warning to this car driver, remind driver to carry out in advance evasive action.
It should be noted that, although the example scenario of Fig. 2 is crossing of right-angled intersection, the method for the present embodiment can also be applicable to other scenes, and for example T-shaped road junction crosses, Y shape crossing crosses etc.But, the method for the present embodiment is in the time being applied to the anti-collision warning of right-angled intersection, and effect is better.
With reference to figure 3, the vehicle collision avoidance safety alarm device of the present embodiment comprises: acquisition of information module 31, vector computing module 32, judge module 33, Time Calculation module 34, collision warning module 35 and emergency brake alarm modules 36.
Wherein, acquisition of information module 31 is for obtaining velocity and the position of its car, and confirms velocity and the position of this car; Vector computing module 32 is for obtaining the position vector of its car according to the position calculation of its car, and obtain the position vector of this car according to the position calculation of this car, the position vector of its car is pointed to the position of its car by initial point, the position vector of this car is pointed to the position of this car by this initial point; Judge module 33 is for judging whether two cars will cross forwardly, if (PB-PA) × VA, (PB-PA) × VB and VA × VB three homopolarity, judge that this car and its car will cross forwardly, the position vector that wherein PA is this car, VA is the velocity of this car, PB is the position vector of its car, and VB is the velocity of its car; Time Calculation module 34 is estimated collision time for calculating in the time judging that this car and its car will cross forwardly, this expectation collision time equals the poor business with the poor projection in the poor direction of this position vector of velocity of position vector, wherein the poor PB-PA of being is discussed in this position, and this velocity is poor is VB-VA; If described expectation collision time is less than default threshold value, collision warning module 35 is sent collision warning; In the time that judge module 33 judges that this car and its car will cross forwardly, if acquisition of information module 31 receives the emergency brake situation that its car sends, emergency brake alarm modules 36 is sent emergency brake alarm.
About more details of this vehicle collision avoidance safety alarm device, refer to the associated description of previous embodiment for vehicle collision avoidance safety alarm method, repeat no more here.
This vehicle collision avoidance safety alarm device can adopt the mode of software, hardware or software and hardware combining to realize.For example, this vehicle collision avoidance safety alarm device can be integrated in vehicle-mounted terminal equipment, as one of them hardware module or software module,
By upper, the vehicle collision avoidance safety alarm method of the embodiment of the present invention and device judge according to the dependent vector computing of the position vector of vehicle, velocity whether two cars will cross and whether can bump, can improve the accuracy of anti-collision warning, make driver can obtain more rapidly reliable alarm signal before accident occurs, and reserve the more time and allow driver take necessary workaround, thereby reduce traffic hazard ratio.The technical scheme that adopts the present embodiment, can very well realize the vehicle collision prewarning of intersection, and the conventional art means such as radar, video cannot complete this point.
Although the present invention with preferred embodiment openly as above; but it is not for limiting the present invention; any those skilled in the art without departing from the spirit and scope of the present invention; can make possible variation and amendment, therefore protection scope of the present invention should be as the criterion with the scope that the claims in the present invention were defined.