CN104748974A - Vehicle collision detection method based on non-horizontal installation of MEMS (Micro Electro Mechanical Systems) sensor - Google Patents

Vehicle collision detection method based on non-horizontal installation of MEMS (Micro Electro Mechanical Systems) sensor Download PDF

Info

Publication number
CN104748974A
CN104748974A CN201510110156.XA CN201510110156A CN104748974A CN 104748974 A CN104748974 A CN 104748974A CN 201510110156 A CN201510110156 A CN 201510110156A CN 104748974 A CN104748974 A CN 104748974A
Authority
CN
China
Prior art keywords
vehicle
level
collision detection
installation
mems sensor
Prior art date
Application number
CN201510110156.XA
Other languages
Chinese (zh)
Other versions
CN104748974B (en
Inventor
田雨农
张晓伟
苍柏
李刚
Original Assignee
大连楼兰科技股份有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 大连楼兰科技股份有限公司 filed Critical 大连楼兰科技股份有限公司
Priority to CN201510110156.XA priority Critical patent/CN104748974B/en
Publication of CN104748974A publication Critical patent/CN104748974A/en
Application granted granted Critical
Publication of CN104748974B publication Critical patent/CN104748974B/en

Links

Abstract

The invention discloses a vehicle collision detection method based on the non-horizontal installation of an MEMS (Micro Electro Mechanical Systems) sensor. The method comprises the following steps: S1, installing an MEMS sensor on a vehicle, and calculating an installation attitude angle; S2, decomposing the output of an accelerator of the MEMS into the velocity increment of a vehicle forward direction, a vehicle transverse direction and a vehicle upward direction according to the installation attitude angle; S3, converting the decomposed velocity increment into an acceleration; S4, carrying out collision detection to the vehicle forward direction and/or the transverse direction. According to the detection method provided by the invention, the effective detection on the vehicle collision can be realized.

Description

Based on the vehicle collision detection method of the out-of-level installation of MEMS sensor

Technical field

The present invention relates to a kind of collision checking method, particularly relate to a kind of vehicle collision detection method based on the out-of-level installation of MEMS sensor.

Background technology

Increasing along with vehicle, traffic hazard also more and more takes place frequently, so detect the collision of vehicle timely and effectively, effectively can reduce the injures and deaths of traffic hazard.In order to realize the detection to vehicle collision, general employing OBD mobile unit, this equipment comprises mems accelerometer and gyroscope, but due to the restriction by aspects such as installation site sizes, the installation of this equipment has larger randomness, can not ensure that complete level is installed.

Summary of the invention

In order to solve the problems of the technologies described above, the invention provides a kind of vehicle collision detection method based on the out-of-level installation of MEMS sensor, the effective detection to vehicle collision can be realized.Technical scheme of the present invention is: a kind of vehicle collision detection method based on the out-of-level installation of MEMS sensor, comprises the steps:

S1., MEMS sensor is installed on vehicle, and calculates Installation posture angle;

S2. according to Installation posture angle, the output of the accelerometer of MEMS sensor is decomposed into vehicle forward direction, lateral direction of car and vehicle sky speed increment upwards;

S3. the speed increment after decomposition is converted to acceleration;

S4. collision detection is carried out to vehicle forward direction and/or transverse direction.

Supplementing further as technical scheme, Installation posture angle calculation procedure is as follows:

(1) error of calculation compensates

Make N a=(N ax, N ay, N az) t, then

Wherein Na is the raw velocity increment signal amount output of three axles of accelerometer, N ax, N ay, N azcar working direction, transverse direction and sky speed increment upwards respectively, it is the nominal amount of accelerometer;

(2) the specific force increment δ w after error of calculation compensation b:

δw b = Ea ( δw 1 b - k 0 δT )

δ T is the systematic sampling time interval, k 0be zero of each axle of accelerometer partially, Ea is the alignment error matrix of accelerometer;

(3) specific force incremental integration is calculated

Δw b Σδw b

(4) normalization

Δw = Δ w x b 2 + Δ w y b 2 + Δ w z b 2

g α b = Δ w α b Δw

Wherein, g α(α=x, y, z) is car working direction, transverse direction and sky upwards normalized result, and Δ w is that intermediate variable exports;

(5) Installation posture angle is calculated

Order: roll angle then in Installation posture angle and the angle of pitch are calculated as follows: θ=arcsinT 32; wherein: θ is roll angle, γ is the angle of pitch.

Supplementing further as technical scheme, the output quantity decomposition method of degree of will speed up meter is vehicle forward direction, the method for lateral direction of car and vehicle sky speed increment is upwards: use the output quantity of following formula to accelerometer to decompose, obtain the speed increment in three directions;

g _ level _ x g _ level _ y g _ level _ z T = wb _ x wb _ y wb _ z T * 1 0 0 0 cos γ sin γ 0 - sin γ cos γ * cos θ 0 - sin θ 0 1 0 sin θ 0 cos θ

Wherein, g_level_x, g_level_y, g_level_z is at vehicle forward direction, lateral direction of car and vehicle sky speed increment upwards after decomposing, wb_x, wb_y, wb_z compensate specific force increment in vehicle forward direction, lateral direction of car and the decomposition upwards of vehicle sky.

Supplementing further as technical scheme, by the method that the speed increment after decomposition is converted to acceleration is: use following formula that speed increment is converted to acceleration;

g_x=g_level_x/δT/g 0

g_y=g_level_y/δT/g 0

Wherein, g 0be local gravitational acceleration, g_x and g_y represents the acceleration of vehicle forward direction and lateral direction of car respectively, and unit is: g.

Supplementing further as technical scheme, the method of vehicle forward direction collision detection is: often get ten groups of accekerations and calculate a variance, and add round-robin queue, until last group of the variance ratio finding that there is one group of accekeration and latter one group when being all greater than a certain multiple, be judged to there occurs collision in vehicle forward direction.

Supplementing further as technical scheme, the method of lateral direction of car collision detection is: often get ten groups of accekerations and calculate a variance, and add round-robin queue, until last group of the variance ratio finding that there is one group of accekeration and latter one group when being all greater than a certain multiple, be judged to there occurs collision in the lateral direction of the vehicle.

The invention still further relates to a kind of collision detecting apparatus for vehicle based on the out-of-level installation of MEMS sensor, comprising:

Sensor is installed and Installation posture angle calculation element, for installing MEMS sensor in vehicle, and calculates Installation posture angle;

The output decomposer of accelerometer, for being decomposed into vehicle forward direction, lateral direction of car and vehicle sky speed increment upwards according to Installation posture angle by the output of the accelerometer of MEMS sensor;

Acceleration conversion equipment, for being converted to acceleration by the speed increment after decomposition;

Collision detecting device, for carrying out collision detection to vehicle forward direction and/or transverse direction.

Beneficial effect: invent herein under the prerequisite of the out-of-level installation of MEMS, by calculating out-of-level degree (Installation posture angle) and carrying out the method for coordinate conversion, become vehicle forward direction, transverse direction, sky to three-dimensional system of coordinate MEMS ordinate transform, by detecting vehicle forward direction in real time, transverse acceleration changes the detection realized vehicle collision.The present invention can identify car two collision fast and effectively, and according to the adjustment for the variance difference multiple compared, present invention achieves the vehicle collision identifying different sensitivity.

Accompanying drawing explanation

Fig. 1 is schematic flow sheet of the present invention.

Embodiment

Embodiment:

Based on a vehicle collision detection method for the out-of-level installation of MEMS sensor, comprise the steps:

S1., MEMS sensor is installed on vehicle, and calculates Installation posture angle;

Installation posture angle calculation procedure is as follows:

(1) error of calculation compensates

Make N a=(N ax, N ay, N az) t, then

Wherein Na is the raw velocity increment signal amount output of three axles of accelerometer, N ax, N ay, N azcar working direction, transverse direction and sky speed increment upwards respectively, it is the nominal amount of accelerometer;

(2) the specific force increment δ w after error of calculation compensation b:

δw b = Ea ( δw 1 b - k 0 δT )

δ T is the systematic sampling time interval, k 0be zero of each axle of accelerometer partially, Ea is the alignment error matrix of accelerometer;

(3) specific force incremental integration is calculated

Δw b=Σδw b

(4) normalization

Δw = Δ w x b 2 + Δ w y b 2 + Δ w z b 2

g α b = Δ w α b Δw

Wherein, g α(α=x, y, z) is car working direction, transverse direction and sky upwards normalized result, and Δ w is that intermediate variable exports;

(5) Installation posture angle is calculated

Order: roll angle then in Installation posture angle and the angle of pitch are calculated as follows: θ=arcsinT 32; wherein: θ is roll angle, γ is the angle of pitch.

S2. according to Installation posture angle, the output of the accelerometer of MEMS sensor is decomposed into vehicle forward direction, lateral direction of car and vehicle sky speed increment upwards;

The output quantity decomposition method of degree of will speed up meter is vehicle forward direction, the method for lateral direction of car and vehicle sky speed increment is upwards: use the output quantity of following formula to accelerometer to decompose, obtain the speed increment in three directions;

g _ level _ x g _ level _ y g _ level _ z T = wb _ x wb _ y wb _ z T * 1 0 0 0 cos γ sin γ 0 - sin γ cos γ * cos θ 0 - sin θ 0 1 0 sin θ 0 cos θ

Wherein, g_level_x, g_level_y, g_level_z is at vehicle forward direction, lateral direction of car and vehicle sky speed increment upwards after decomposing, wb_x, wb_y, wb_z compensate specific force increment in vehicle forward direction, lateral direction of car and the decomposition upwards of vehicle sky.

S3. the speed increment after decomposition is converted to acceleration;

By the method that the speed increment after decomposition is converted to acceleration be: use following formula that speed increment is converted to acceleration;

g_x=g_level_x/δT/g 0

g_y=g_level_y/δT/g 0

Wherein, g 0be local gravitational acceleration, g_x and g_y represents the acceleration of vehicle forward direction and lateral direction of car respectively, and unit is: g.

S4. collision detection is carried out to vehicle forward direction and/or transverse direction;

The method of vehicle forward direction collision detection is: often get ten groups of accekerations and calculate a variance, and add round-robin queue, until last group of the variance ratio finding that there is one group of accekeration and latter one group when being all greater than a certain multiple, be judged to there occurs collision in vehicle forward direction, as follows:

varx1>factor*varx2;

varx1>factor*varx0;

The method of lateral direction of car collision detection is: often get ten groups of accekerations and calculate a variance, and add round-robin queue, until last group of the variance ratio finding that there is one group of accekeration and latter one group when being all greater than a certain multiple, be judged to there occurs collision in the lateral direction of the vehicle, as follows:

vary1>factor*vary2;

vary1>factor*vary0;

Wherein, vary0, vary1, vary2 represent the variance yields of three groups of adjacent acceleration, and factor is adjustable coefficient, and the less collision recognition of coefficient is sensitiveer, can regulate the size of this coefficient according to actual conditions.

The invention still further relates to a kind of collision detecting apparatus for vehicle based on the out-of-level installation of MEMS sensor, comprising:

Sensor is installed and Installation posture angle calculation element, for installing MEMS sensor in vehicle, and calculates Installation posture angle;

The output decomposer of accelerometer, for being decomposed into vehicle forward direction, lateral direction of car and vehicle sky speed increment upwards according to Installation posture angle by the output of the accelerometer of MEMS sensor;

Acceleration conversion equipment, for being converted to acceleration by the speed increment after decomposition;

Collision detecting device, for carrying out collision detection to vehicle forward direction and/or transverse direction.

Claims (11)

1., based on a vehicle collision detection method for the out-of-level installation of MEMS sensor, it is characterized in that: comprise the steps:
S1., MEMS sensor is installed on vehicle, and calculates Installation posture angle;
S2. according to Installation posture angle, the output of the accelerometer of MEMS sensor is decomposed into vehicle forward direction, lateral direction of car and vehicle sky speed increment upwards;
S3. the speed increment after decomposition is converted to acceleration;
S4. collision detection is carried out to vehicle forward direction and/or transverse direction.
2., as claimed in claim 1 based on the vehicle collision detection method of the out-of-level installation of MEMS sensor, it is characterized in that: Installation posture angle calculation procedure is as follows:
(1) error of calculation compensates
Make N a=(N ax, N ay, N az) t, then
Wherein Na is the raw velocity increment signal amount output of three axles of accelerometer, N ax, N ay, N azcar working direction, transverse direction and sky speed increment upwards respectively, it is the nominal amount of accelerometer;
(2) the specific force increment δ w after error of calculation compensation b:
δ T is the systematic sampling time interval, k 0be zero of each axle of accelerometer partially, Ea is the alignment error matrix of accelerometer;
(3) specific force incremental integration is calculated
Δw b=Σδw b
(4) normalization
Wherein, g α(α=x, y, z) is car working direction, transverse direction and sky upwards normalized result, and Δ w is that intermediate variable exports;
(5) Installation posture angle is calculated
Order: roll angle then in Installation posture angle and the angle of pitch are calculated as follows: θ=arcsin T 32; wherein: θ is roll angle, γ is the angle of pitch.
3. as claimed in claim 2 based on the vehicle collision detection method of the out-of-level installation of MEMS sensor, it is characterized in that, the output quantity decomposition method of degree of will speed up meter is vehicle forward direction, the method for lateral direction of car and vehicle sky speed increment is upwards: use the output quantity of following formula to accelerometer to decompose, obtain the speed increment in three directions;
Wherein, g_level_x, g_level_y, g_level_z is at vehicle forward direction, lateral direction of car and vehicle sky speed increment upwards after decomposing, wb_x, wb_y, wb_z are that compensation specific force increment in claim 2 is in vehicle forward direction, lateral direction of car and the decomposition upwards of vehicle sky.
4. as claimed in claim 3 based on the vehicle collision detection method of the out-of-level installation of MEMS sensor, it is characterized in that, by the method that the speed increment after decomposition is converted to acceleration be: use following formula that speed increment is converted to acceleration;
g_x=g_level_x/δT/g 0
g_y=g_level_y/δT/g 0
Wherein, g 0be local gravitational acceleration, g_x and g_y represents the acceleration of vehicle forward direction and lateral direction of car respectively, and unit is: g.
5. as claimed in claim 4 based on the vehicle collision detection method of the out-of-level installation of MEMS sensor, it is characterized in that, the method of vehicle forward direction collision detection is: often get ten groups of accekerations and calculate a variance, and add round-robin queue, until last group of the variance ratio finding that there is one group of accekeration and latter one group when being all greater than a certain multiple, be judged to there occurs collision in vehicle forward direction.
6. as claimed in claim 5 based on the vehicle collision detection method of the out-of-level installation of MEMS sensor, it is characterized in that, the method of lateral direction of car collision detection is: often get ten groups of accekerations and calculate a variance, and add round-robin queue, until last group of the variance ratio finding that there is one group of accekeration and latter one group when being all greater than a certain multiple, be judged to there occurs collision in the lateral direction of the vehicle.
7. based on a collision detecting apparatus for vehicle for the out-of-level installation of MEMS sensor, it is characterized in that: comprising:
Sensor is installed and Installation posture angle calculation element, for installing MEMS sensor in vehicle, and calculates Installation posture angle;
The output decomposer of accelerometer, for being decomposed into vehicle forward direction, lateral direction of car and vehicle sky speed increment upwards according to Installation posture angle by the output of the accelerometer of MEMS sensor;
Acceleration conversion equipment, for being converted to acceleration by the speed increment after decomposition;
Collision detecting device, for carrying out collision detection to vehicle forward direction and/or transverse direction.
CN201510110156.XA 2015-03-13 2015-03-13 Based on the vehicle collision detection method that MEMS sensor is not horizontally mounted CN104748974B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510110156.XA CN104748974B (en) 2015-03-13 2015-03-13 Based on the vehicle collision detection method that MEMS sensor is not horizontally mounted

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510110156.XA CN104748974B (en) 2015-03-13 2015-03-13 Based on the vehicle collision detection method that MEMS sensor is not horizontally mounted

Publications (2)

Publication Number Publication Date
CN104748974A true CN104748974A (en) 2015-07-01
CN104748974B CN104748974B (en) 2017-06-13

Family

ID=53588989

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510110156.XA CN104748974B (en) 2015-03-13 2015-03-13 Based on the vehicle collision detection method that MEMS sensor is not horizontally mounted

Country Status (1)

Country Link
CN (1) CN104748974B (en)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0245802A (en) * 1988-08-08 1990-02-15 Nissan Motor Co Ltd Estimating device for vehicle state quantity
CN1687709A (en) * 2005-05-12 2005-10-26 吉林大学 System for measuring motion state of automobile
CN104021601A (en) * 2014-05-30 2014-09-03 爱培科科技开发(深圳)有限公司 Car collision detection method and device based on three-shaft acceleration sensor
CN104198765A (en) * 2014-09-15 2014-12-10 大连楼兰科技股份有限公司 Coordinate system transformation method for detection of vehicle motion acceleration

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0245802A (en) * 1988-08-08 1990-02-15 Nissan Motor Co Ltd Estimating device for vehicle state quantity
CN1687709A (en) * 2005-05-12 2005-10-26 吉林大学 System for measuring motion state of automobile
CN104021601A (en) * 2014-05-30 2014-09-03 爱培科科技开发(深圳)有限公司 Car collision detection method and device based on three-shaft acceleration sensor
CN104198765A (en) * 2014-09-15 2014-12-10 大连楼兰科技股份有限公司 Coordinate system transformation method for detection of vehicle motion acceleration

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
吴黎明等: "基于ANN和单个三轴加速度传感器的汽车运动姿态测量", 《传感器技术学报》 *
赵翔等: "基于MEMS加速度计和陀螺仪的姿态检测系统", 《铁路计算机应用》 *

Also Published As

Publication number Publication date
CN104748974B (en) 2017-06-13

Similar Documents

Publication Publication Date Title
US9020680B2 (en) Travel direction determination method and system
CN102749851B (en) Fine anti-interference tracking controller of flexible hypersonic vehicle
Ni et al. Dynamics control of autonomous vehicle at driving limits and experiment on an autonomous formula racing car
Gustafsson Automotive safety systems
US8200452B2 (en) Attitude-angle detecting apparatus and attitude-angle detecting method
CN103247199B (en) Precise measuring method for moving position and moving gesture of motor vehicle
DE102012201811A1 (en) METHOD AND SYSTEM FOR CONTROLLING THE RELATIVE POSITION BETWEEN VEHICLES USING A MOBILE BASE STATION
Rhudy et al. UAV attitude, heading, and wind estimation using GPS/INS and an air data system
CN103365296B (en) A kind of four rotor unmanned aircraft nonlinear object feedback flight control methods
CN103164962B (en) Mountain road sharp turn section real-time vehicle speed early warning method
CN102754139B (en) Vehicle orientation angle calculating device, and lane deviation warning system using same
Katriniok et al. Optimal vehicle dynamics control for combined longitudinal and lateral autonomous vehicle guidance
US20140081542A1 (en) System and method for preventing vehicle from rolling over in curved lane
CN103640622B (en) A kind of automobile steering intelligent control method based on pilot model and control system
US8620610B2 (en) Crane jib attitude and heading reference system and method
CN105151047B (en) A kind of automobile side slip angle measurement method
ES2393202T3 (en) A device for the production of electrical energy and a process for the automatic control of said device
US20100019963A1 (en) Vehicular navigation and positioning system
Oh et al. Vehicle velocity observer design using 6-d imu and multiple-observer approach
Yoon et al. Robust vehicle sideslip angle estimation through a disturbance rejection filter that integrates a magnetometer with GPS
CN105005313B (en) A kind of martian atmosphere approach section Predictor-corrector guidance method planned based on path point
CN105842684B (en) Enhancing is estimated using the vehicle movement of radar data
EP2419795B1 (en) Method for determining local accelerations, dynamic load distributions and aerodynamic data in an aircraft
US20070236367A1 (en) Airspeed / wind speed measurement device for aircraft, and display device for same
US10024955B2 (en) System and method for determining of and compensating for misalignment of a sensor

Legal Events

Date Code Title Description
PB01 Publication
C06 Publication
SE01 Entry into force of request for substantive examination
C10 Entry into substantive examination
GR01 Patent grant
GR01 Patent grant