CN104537888A - Automobile collision alarming method based on mobile phone - Google Patents

Abstract

The invention relates to the field of automobiles, in particular to a mobile phone-based automobile collision alarm method. The camera of the mobile phone captures the image of obstacles in front/rear of the vehicle; calculates the actual distance d _c between the obstacle and the vehicle according to the position of the obstacle captured by the mobile phone in the image; according to the actual distance d _c between the obstacle and the vehicle Calculate the time t from the collision with the speed v of the collision; compare the time t with the alarm threshold time T, and when t reaches the threshold time T, an alarm will be issued. Mobile phones are widely used in daily life, which makes the present invention low in cost and high in popularity.

Description

A method of car collision alarm based on mobile phone

technical field

The invention relates to the field of automobiles, in particular to a mobile phone-based automobile collision alarm method.

Background technique

The car collision warning system is to install a vehicle recognition sensor on the front or rear of the car. By testing the distance between the front and rear cars, the relative speed of the car and the car in front or behind, the collision time is calculated, and at different time points (such as 2.7 seconds, 0.9 seconds) to send out alarms of different urgency through sound and images of different colors, so as to remind the driver.

Traditional vehicle recognition sensors use high-end equipment such as medium and long-distance radars and on-board proprietary cameras. Due to the high price, it is mostly equipped in luxury cars and high-end cars at present, which affects the popularization.

Contents of the invention

The purpose of the present invention is to provide a mobile phone-based automobile collision warning method, which can utilize the popular mobile phone camera to realize the purpose of active safety warning.

The technical scheme of the present invention is, comprises the following steps:

Step 1: The mobile phone camera captures images of obstacles in front of/rear of the vehicle;

Step 2: Calculate the actual distance d _c between the obstacle and the vehicle according to the position of the obstacle captured by the mobile phone in the image;

Step 4: According to the actual distance dc between the obstacle and the own vehicle and the speed v of the own vehicle, calculate the time _t from the collision;

Step 5: compare the time t with the alarm threshold time T, and when t reaches the threshold time T, an alarm is issued.

Further, the actual distance between the obstacle and the own vehicle is _dc =d1+d2, d1 is the distance from the shortest field of view of the mobile phone camera to the front end/tail of the vehicle, and d2 is the distance between the shortest field of view and the obstacle obtained on the image, d2 is obtained through the following steps:

Step 1: Select the rectangular frame formed by the obstacle captured by the camera in the image, and calculate the image plane coordinates xl, yl of the midpoint of the bottom edge of the rectangular frame;

Step 2: Obtain the image plane coordinates x2, y2 of the midpoint of the bottom edge of the mobile phone screen;

Step 3: the image plane coordinates x1, yl and x2, y2 are calculated according to the mapping relationship between the image plane coordinates and the road surface coordinates to remove the road surface coordinates X1, Y1 and X2, Y2;

Step 4: Distance d2=((Yl-Y2) ² +(Xl-X2) ² ) ^0.5 .

Further, the mapping relationship between the image plane coordinates and the road surface coordinates is as follows:

$\left\{\begin{array}{c}{\mathrm{<span\; class="notranslate">\; Y</span>}}_{\mathrm{<span\; class="notranslate">\; P</span>}}<span\; class="notranslate">\; =</span>\mathrm{<span\; class="notranslate">\; h</span>}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 1</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; the\; y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; *</span>\frac{\mathrm{<span\; class="notranslate">\; 1</span>}<span\; class="notranslate">\; +</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 2</span>}}^{\mathrm{<span\; class="notranslate">\; 2</span>}}}{\mathrm{<span\; class="notranslate">\; 1</span>}<span\; class="notranslate">\; -</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 2</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 1</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; the\; y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}}\\ {\mathrm{<span\; class="notranslate">\; x</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; =</span>\frac{\mathrm{<span\; class="notranslate">\; UG</span>}<span\; class="notranslate">\; +</span>{\mathrm{<span\; class="notranslate">\; Y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}}{\mathrm{<span\; class="notranslate">\; UG</span>}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 3</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; x</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 4</span>}}}\\ {\mathrm{<span\; class="notranslate">\; the\; y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; =</span>\frac{{\mathrm{<span\; class="notranslate">\; Y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; /</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 1</span>}}}{\mathrm{<span\; class="notranslate">\; h</span>}<span\; class="notranslate">\; +</span>\mathrm{<span\; class="notranslate">\; h</span>}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 2</span>}}^{\mathrm{<span\; class="notranslate">\; 2</span>}}<span\; class="notranslate">\; +</span>{\mathrm{<span\; class="notranslate">\; Y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 2</span>}}}\\ {\mathrm{<span\; class="notranslate">\; x</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; =</span>\frac{\mathrm{<span\; class="notranslate">\; UG</span>}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; x</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}}{{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 3</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 4</span>}}<span\; class="notranslate">\; (</span>\mathrm{<span\; class="notranslate">\; UG</span>}<span\; class="notranslate">\; +</span>{\mathrm{<span\; class="notranslate">\; Y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; )</span>}\end{array}\right.$

in:

$\left\{\begin{array}{c}{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 1</span>}}<span\; class="notranslate">\; =</span>\mathrm{<span\; class="notranslate">\; 2</span>}\mathrm{<span\; class="notranslate">\; tg</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&alpha;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span><span\; class="notranslate">\; /</span>\mathrm{<span\; class="notranslate">\; h</span>}\\ {\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 2</span>}}<span\; class="notranslate">\; =</span>\mathrm{<span\; class="notranslate">\; tg</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span>\\ \mathrm{<span\; class="notranslate">\; k</span>}\mathrm{<span\; class="notranslate">\; 3</span>}<span\; class="notranslate">\; =</span>\mathrm{<span\; class="notranslate">\; h</span>}<span\; class="notranslate">\; /</span>\mathrm{<span\; class="notranslate">\; cos</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span>\\ {\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 4</span>}}<span\; class="notranslate">\; =</span>\mathrm{<span\; class="notranslate">\; 2</span>}\mathrm{<span\; class="notranslate">\; tg</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&beta;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span><span\; class="notranslate">\; /</span>\mathrm{<span\; class="notranslate">\; W</span>}\\ \mathrm{<span\; class="notranslate">\; UG</span>}<span\; class="notranslate">\; =</span>\frac{\mathrm{<span\; class="notranslate">\; h</span>}<span\; class="notranslate">\; (</span>\mathrm{<span\; class="notranslate">\; tg</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span><span\; class="notranslate">\; -</span>\mathrm{<span\; class="notranslate">\; tg</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; -</span>{\mathrm{<span\; class="notranslate">\; \&alpha;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span><span\; class="notranslate">\; )</span>\mathrm{<span\; class="notranslate">\; cos</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; -</span>{\mathrm{<span\; class="notranslate">\; \&alpha;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span>}{\mathrm{<span\; class="notranslate">\; cos</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; -</span>{\mathrm{<span\; class="notranslate">\; \&alpha;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span><span\; class="notranslate">\; -</span>\mathrm{<span\; class="notranslate">\; cos</span>}{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}}\end{array}\right.$

(X _p , Y _P ) are the coordinates of the road surface, (x _p , y _p ) are the coordinates of the image plane, H is the height of the image, w is the width of the image, h is the distance between the optical axis of the camera and the ground, and 2β ₀ is the camera The horizontal view angle of the lens, 2α ₀ is the vertical view angle of the camera lens, and γ ₀ is the pitch angle of the camera.

Further, the time from collision t=d _c /v.

Further, there is at least one alarm threshold time, and when the collision time reaches different alarm threshold times, alarm tones of different frequencies are output.

The beneficial effects of the present invention are: obtain the road obstacle image through the camera of the mobile phone, and then obtain the relationship between the road surface coordinate system and the image coordinate system through geometric derivation according to the camera projection model, so as to obtain the time to travel to the obstacle , that is, the collision time. The collision time is compared with the alarm threshold time, and the collision alarm is performed when the alarm threshold time is reached, so as to achieve the purpose of using the mobile phone camera to realize active safety warning. Mobile phones are widely used in daily life, which makes the present invention low in cost and high in popularity.

Description of drawings

Figure 1 is a monocular vision geometric projection model a;

Figure 2 is a monocular vision geometric projection model b;

detailed description

In order to make the object, technical solution and advantages of the present invention clearer, the present invention will be described in further 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.

The mobile phone in the present invention is firmly fixed on the front or rear windshield of the car through precise calculation and calibrated angle, so that the camera of the mobile phone is aimed at the objects in the front or rear path of the vehicle and acquires image information.

After the mobile phone captures obstacles (that is, objects in the path in front of or behind the vehicle), the image display output.

As shown in Figure 1, the plane ABU represents the road plane, ABCD is the trapezoidal area on the road plane captured by the camera, point O is the center point of the camera lens, OG is the optical axis of the camera, and point G is the intersection point between the optical axis of the camera and the road plane (It is also the diagonal intersection point of the trapezoid of the field of view at the same time), and point I is the vertical projection of point O on the road plane. In the road surface coordinate system, point G is defined as the origin of the coordinate system, and the forward direction of the vehicle is defined as the direction of the Y axis.

The corresponding points of G, A, B, C, and D in the image plane are shown in Figure 2, a, b, c, and d are the four endpoints of the image plane rectangle, H and W are the height and height of the image plane, respectively. Width. Define the midpoint g of the image rectangle as the coordinate origin of the image plane coordinate system, and the y-axis represents the forward direction of the vehicle. Take a point P on the road plane, its coordinates in the road plane coordinate system are (X _p , Y _p ), the corresponding point of point P in the image plane is P1, and its coordinates in the image plane coordinate system are (x _p , y _p ). Using the geometric relationship, the following correspondence between road surface coordinates and image coordinates can be deduced:

$\left\{\begin{array}{c}{\mathrm{<span\; class="notranslate">\; Y</span>}}_{\mathrm{<span\; class="notranslate">\; P</span>}}<span\; class="notranslate">\; =</span>\mathrm{<span\; class="notranslate">\; h</span>}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 1</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; the\; y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; *</span>\frac{\mathrm{<span\; class="notranslate">\; 1</span>}<span\; class="notranslate">\; +</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 2</span>}}^{\mathrm{<span\; class="notranslate">\; 2</span>}}}{\mathrm{<span\; class="notranslate">\; 1</span>}<span\; class="notranslate">\; -</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 2</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 1</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; the\; y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}}\\ {\mathrm{<span\; class="notranslate">\; x</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; =</span>\frac{\mathrm{<span\; class="notranslate">\; UG</span>}<span\; class="notranslate">\; +</span>{\mathrm{<span\; class="notranslate">\; Y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}}{\mathrm{<span\; class="notranslate">\; UG</span>}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 3</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; x</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 4</span>}}}\\ {\mathrm{<span\; class="notranslate">\; the\; y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; =</span>\frac{{\mathrm{<span\; class="notranslate">\; Y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; /</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 1</span>}}}{\mathrm{<span\; class="notranslate">\; h</span>}<span\; class="notranslate">\; +</span>\mathrm{<span\; class="notranslate">\; h</span>}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 2</span>}}^{\mathrm{<span\; class="notranslate">\; 2</span>}}<span\; class="notranslate">\; +</span>{\mathrm{<span\; class="notranslate">\; Y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 2</span>}}}\\ {\mathrm{<span\; class="notranslate">\; x</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; =</span>\frac{\mathrm{<span\; class="notranslate">\; UG</span>}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; x</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}}{{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 3</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 4</span>}}<span\; class="notranslate">\; (</span>\mathrm{<span\; class="notranslate">\; UG</span>}<span\; class="notranslate">\; +</span>{\mathrm{<span\; class="notranslate">\; Y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; )</span>}\end{array}\right.<span\; class="notranslate">\; -</span><span\; class="notranslate">\; -</span><span\; class="notranslate">\; -</span><span\; class="notranslate">\; (</span>\mathrm{<span\; class="notranslate">\; 1</span>}<span\; class="notranslate">\; )</span>$

in:

$\left\{\begin{array}{c}{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 1</span>}}<span\; class="notranslate">\; =</span>\mathrm{<span\; class="notranslate">\; 2</span>}\mathrm{<span\; class="notranslate">\; tg</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&alpha;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span><span\; class="notranslate">\; /</span>\mathrm{<span\; class="notranslate">\; h</span>}\\ {\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 2</span>}}<span\; class="notranslate">\; =</span>\mathrm{<span\; class="notranslate">\; tg</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span>\\ \mathrm{<span\; class="notranslate">\; k</span>}\mathrm{<span\; class="notranslate">\; 3</span>}<span\; class="notranslate">\; =</span>\mathrm{<span\; class="notranslate">\; h</span>}<span\; class="notranslate">\; /</span>\mathrm{<span\; class="notranslate">\; cos</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span>\\ {\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 4</span>}}<span\; class="notranslate">\; =</span>\mathrm{<span\; class="notranslate">\; 2</span>}\mathrm{<span\; class="notranslate">\; tg</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&beta;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span><span\; class="notranslate">\; /</span>\mathrm{<span\; class="notranslate">\; W</span>}\\ \mathrm{<span\; class="notranslate">\; UG</span>}<span\; class="notranslate">\; =</span>\frac{\mathrm{<span\; class="notranslate">\; h</span>}<span\; class="notranslate">\; (</span>\mathrm{<span\; class="notranslate">\; tg</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span><span\; class="notranslate">\; -</span>\mathrm{<span\; class="notranslate">\; tg</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; -</span>{\mathrm{<span\; class="notranslate">\; \&alpha;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span><span\; class="notranslate">\; )</span>\mathrm{<span\; class="notranslate">\; cos</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; -</span>{\mathrm{<span\; class="notranslate">\; \&alpha;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span>}{\mathrm{<span\; class="notranslate">\; cos</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; -</span>{\mathrm{<span\; class="notranslate">\; \&alpha;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span><span\; class="notranslate">\; -</span>\mathrm{<span\; class="notranslate">\; cos</span>}{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}}\end{array}\right.$

w is the width of the image, h is the distance between the optical axis of the camera and the ground, 2β ₀ is the horizontal view angle of the camera lens, 2α ₀ is the vertical view angle of the camera lens, and γ ₀ is the pitch angle of the camera.

After obtaining the mapping relationship between the image plane coordinates and the road plane coordinates, the distance between the obstacle and the vehicle can be calculated. The actual distance between the obstacle and the own vehicle is d _c =d1+d2, d1 is the distance from the nearest field of view of the mobile phone camera to the front/rear of the vehicle (that is, the distance from the front end of the mobile phone camera to the front/rear of the vehicle), and d2 is the distance on the image The obtained distance between the nearest field of view and the obstacle, d2 can be obtained through the following steps:

Step 1: Select the rectangular frame formed by the obstacle captured by the camera in the image, and calculate the image plane coordinates xl, yl of the midpoint of the bottom edge of the rectangular frame;

Step 2: Obtain the image plane coordinates x2, y2 of the midpoint of the bottom edge of the mobile phone screen;

Step 3: the image plane coordinates x1, yl and x2, y2 are calculated according to the mapping relationship between the image plane coordinates and the road surface coordinates to remove the road surface coordinates X1, Y1 and X2, Y2;

Step 4: Distance d2=((Yl-Y2) ² +(Xl-X2) ² ) ^0.5 .

According to the GPS signal of the mobile phone, the running speed V of the vehicle can be calculated, so that the time t=d _c /v from the collision can be calculated. The alarm threshold times T ₁ , T ₂ etc. are stored in the control unit to represent the urgency of the vehicle approaching the object. When t decreases from greater than or equal to T ₁ (such as 2.7 seconds), the control unit outputs an early warning signal indicating a certain degree of urgency; when t decreases from T ₁ to equal to T ₂ (T ₂ > T ₁ , such as 0.9 seconds), The control unit outputs a warning signal with a high degree of urgency. After the alarm system receives these early warning signals, it converts the early warning signals into sound signals or graphic flashing signals with different frequencies. The higher the degree _of urgency, the higher the frequency, that is, the warning sound or graphic flashing frequency corresponding to T2 should be higher _than the warning sound or graphic flashing frequency corresponding to T1.

The above is only a specific embodiment of the present invention. It should be pointed out that any changes or substitutions that can be easily conceived by those skilled in the art within the technical scope disclosed in the present invention shall be covered by the protection scope of the present invention. within.

Claims (5)

1. A mobile phone-based automobile collision warning method, is characterized in that, comprises the following steps: Step 1: The mobile phone camera captures images of obstacles in front of/rear of the vehicle; Step 2: Calculate the actual distance d _c between the obstacle and the vehicle according to the position of the obstacle captured by the mobile phone in the image; Step 4: Calculate the time t from the collision according to the actual distance d _c of the obstacle from the own vehicle and the speed v of the own vehicle; Step 5: compare the time t with the alarm threshold time T, and when t reaches the threshold time T, an alarm is issued. 2. a kind of mobile phone-based automobile collision warning method as claimed in claim 1, is characterized in that: the actual distance of described obstacle apart from own car is _dc =d1+d2, and d1 is the shortest visual field of mobile phone camera to this car The distance between the front end/tail, d2 is the distance between the nearest field of view and the obstacle obtained on the image, and d2 is obtained by the following steps: Step 1: Select the rectangular frame formed by the obstacle captured by the camera in the image, and calculate the image plane coordinates xl, yl of the midpoint of the bottom edge of the rectangular frame; Step 2: Obtain the image plane coordinates x2, y2 of the midpoint of the bottom edge of the mobile phone screen; Step 3: the image plane coordinates x1, yl and x2, y2 are calculated according to the mapping relationship between the image plane coordinates and the road surface coordinates to remove the road surface coordinates X1, Y1 and X2, Y2; Step 4: Distance d2=((Yl-Y2) ² +(Xl-X2) ² ) ^0.5 . 3. a kind of mobile phone-based automobile collision warning method as claimed in claim 2, is characterized in that: the mapping relation of described image plane coordinates and road surface coordinates is as follows: $\left\{\begin{array}{c}{\mathrm{<span\; class="notranslate">\; Y</span>}}_{\mathrm{<span\; class="notranslate">\; P</span>}}<span\; class="notranslate">\; =</span>\mathrm{<span\; class="notranslate">\; h</span>}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 1</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; the\; y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; *</span>\frac{\mathrm{<span\; class="notranslate">\; 1</span>}<span\; class="notranslate">\; +</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 2</span>}}^{\mathrm{<span\; class="notranslate">\; 2</span>}}}{\mathrm{<span\; class="notranslate">\; 1</span>}<span\; class="notranslate">\; -</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 2</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 1</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; the\; y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}}\\ {\mathrm{<span\; class="notranslate">\; x</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; =</span>\frac{\mathrm{<span\; class="notranslate">\; UG</span>}<span\; class="notranslate">\; +</span>{\mathrm{<span\; class="notranslate">\; Y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}}{\mathrm{<span\; class="notranslate">\; UG</span>}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 3</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; x</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 4</span>}}}\\ {\mathrm{<span\; class="notranslate">\; the\; y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; =</span>\frac{{\mathrm{<span\; class="notranslate">\; Y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; /</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 1</span>}}}{\mathrm{<span\; class="notranslate">\; h</span>}<span\; class="notranslate">\; +</span>\mathrm{<span\; class="notranslate">\; h</span>}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 2</span>}}^{\mathrm{<span\; class="notranslate">\; 2</span>}}<span\; class="notranslate">\; +</span>{\mathrm{<span\; class="notranslate">\; Y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 2</span>}}}\\ {\mathrm{<span\; class="notranslate">\; x</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; =</span>\frac{\mathrm{<span\; class="notranslate">\; UG</span>}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; x</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}}{{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 3</span>}}<span\; class="notranslate">\; *</span>{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 4</span>}}<span\; class="notranslate">\; (</span>\mathrm{<span\; class="notranslate">\; UG</span>}<span\; class="notranslate">\; +</span>{\mathrm{<span\; class="notranslate">\; Y</span>}}_{\mathrm{<span\; class="notranslate">\; p</span>}}<span\; class="notranslate">\; )</span>}\end{array}\right.$ in: $\left\{\begin{array}{c}{\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 1</span>}}<span\; class="notranslate">\; =</span>\mathrm{<span\; class="notranslate">\; 2</span>}\mathrm{<span\; class="notranslate">\; tg</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&alpha;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span><span\; class="notranslate">\; /</span>\mathrm{<span\; class="notranslate">\; h</span>}\\ {\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 2</span>}}<span\; class="notranslate">\; =</span>\mathrm{<span\; class="notranslate">\; tg</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span>\\ \mathrm{<span\; class="notranslate">\; k</span>}\mathrm{<span\; class="notranslate">\; 3</span>}<span\; class="notranslate">\; =</span>\mathrm{<span\; class="notranslate">\; h</span>}<span\; class="notranslate">\; /</span>\mathrm{<span\; class="notranslate">\; cos</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span>\\ {\mathrm{<span\; class="notranslate">\; k</span>}}_{\mathrm{<span\; class="notranslate">\; 4</span>}}<span\; class="notranslate">\; =</span>\mathrm{<span\; class="notranslate">\; 2</span>}\mathrm{<span\; class="notranslate">\; tg</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&beta;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span><span\; class="notranslate">\; /</span>\mathrm{<span\; class="notranslate">\; W</span>}\\ \mathrm{<span\; class="notranslate">\; UG</span>}<span\; class="notranslate">\; =</span>\frac{\mathrm{<span\; class="notranslate">\; h</span>}<span\; class="notranslate">\; (</span>\mathrm{<span\; class="notranslate">\; tg</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span><span\; class="notranslate">\; -</span>\mathrm{<span\; class="notranslate">\; tg</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; -</span>{\mathrm{<span\; class="notranslate">\; \&alpha;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span><span\; class="notranslate">\; )</span>\mathrm{<span\; class="notranslate">\; cos</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; -</span>{\mathrm{<span\; class="notranslate">\; \&alpha;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span>}{\mathrm{<span\; class="notranslate">\; cos</span>}<span\; class="notranslate">\; (</span>{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; -</span>{\mathrm{<span\; class="notranslate">\; \&alpha;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}<span\; class="notranslate">\; )</span><span\; class="notranslate">\; -</span>\mathrm{<span\; class="notranslate">\; cos</span>}{\mathrm{<span\; class="notranslate">\; \&gamma;</span>}}_{\mathrm{<span\; class="notranslate">\; 0</span>}}}\end{array}\right.$ (X _p , Y _P ) are the coordinates of the road surface, (x _p , y _p ) are the coordinates of the image plane, H is the height of the image, w is the width of the image, h is the distance between the optical axis of the camera and the ground, and 2β ₀ is the camera The horizontal view angle of the lens, 2α ₀ is the vertical view angle of the camera lens, and γ ₀ is the pitch angle of the camera. 4. A mobile phone-based car collision warning method according to claim 1, characterized in that: the time from collision _t =dc/v. 5. A kind of automobile collision alarm method based on mobile phone as claimed in claim 1, is characterized in that: described alarm threshold time is at least one, and when described collision time reaches different alarm threshold times, output alarm sounds of different frequencies .