METHOD AND APPARATUS FOR DETERMINING THE INCLINATION OF A MOVING VEHICLE WITH RESPECT TO THE ROAD AND FOR PERFORMING DYNAMIC HEADLIGHT LEVELING

• US 20160001695A1
• Filed: 06/29/2015
• Published: 01/07/2016
• Est. Priority Date: 07/03/2014
• Status: Abandoned Application

• Current Assignee: Memsic Incorporated (MZ Investment Holdings Ltd.)
• Original Assignee: Memsic Incorporated (MZ Investment Holdings Ltd.)
• Inventors: Fennelly, James
• Application Number:
  US14/753,182
• Publication Number:
  US 20160001695A1
• Time in Patent Office: Days
• US Class Current: 1/1
• CPC Class Codes: B60Q 1/0023 the element being a sensor, e.g. distance sensor, camera
• CPC Class Codes: B60Q 1/115 by electric means details of the electric drive components, e.g. motors, shafts, ball joints B60Q1/076
• CPC Class Codes: B60Q 2300/132 Pitch
• CPC Class Codes: B60W 40/11 Pitch movement
• CPC Class Codes: G01C 9/08 Means for compensating acceleration forces due to movement of instrument

Abstract

A method and system for determining the inclination of the suspended portion of a moving vehicle with respect to the road from a 2 axis or 3 axis accelerometer, inclinometer, or the like, for use in controlling a system or device that is dependent upon inclination. The method and system provide for the determination of the angle of inclination of the portion of the vehicle which is suspended with respect to the portion of the vehicle which is not suspended. The angle of inclination is derived from the dependence of acceleration along the axis normal to the vehicle (z axis) due to longitudinal (x axis) and/or latitudinal (y axis) accelerations of the vehicle.

Claims

1. A method for controlling an electromechanical system based on the inclination of a suspended portion of a vehicle with respect to a road comprising:

obtaining first and second signals representative of z axis and x axis acceleration, respectively, from at least one sensor coupled to the suspended portion of the vehicle;

filtering the first and second signals to attenuate high frequency components of acceleration to produce filtered first and second signals;

calculating a slope corresponding to a least squares best fit linear regression using the filtered first and second signals;

generating an indication of inclination of the suspended portion of the vehicle (0) by calculating the arctangent of the slope determined in the calculating step;

generating at least one control signal based upon the indication of inclination of the suspended portion of the vehicle; and

providing the at least one control signal to the electromechanical system.

2. The method of claim 1 wherein the electromechanical system is a headlight leveling system and the at least one control signal is operative to provide control of the inclination of the headlights of the vehicle with respect to the road.

3. The method of claim 1 wherein:

obtaining the first and second signals includes obtaining, at a predetermined sampling frequency, a predetermined number of first and second data samples corresponding to z axis and x axis acceleration, respectively, from at least one sensor coupled to the suspended portion of the vehicle;

filtering the first and second signals includes the step of filtering the z axis and x axis data samples to attenuate high frequency components of acceleration to produce filtered z axis and x axis data samples and storing the filtered z axis and x axis data samples in a memory; and

calculating the slope corresponding to the least squares best fit linear regression using the filtered first and second signals includes calculating a slope corresponding to a least squares best fit linear regression using the filtered z axis and x axis data samples.

4. The method of claim 3 wherein the electromechanical system is a headlight leveling system and the at least one control signal is operative to provide control of the inclination of the headlights of the vehicle with respect to the road.

5. The method of claim 3 further comprising checking the filtered data samples to verify that a range of x axis acceleration values exceeds a predetermined limit so as to ensure that the z axis acceleration can be accurately established.

6. The method of claim 5 wherein the predetermined limit is 0.05 g.

7. The method of claim 3 wherein the step of filtering comprises the step of performing low pass digital filtering on the stored data samples z axis and x axis data samples to attenuate high frequency road noise.

8. The method of claim 3 wherein the step of filtering comprises the step of performing band pass digital filtering on the stored z axis and x axis data samples to attenuate high frequency road noise and very low frequencies associated with slowly changing road inclinations.

9. The method of claim 1 further including calculating θ

_v on a rolling basis in response to obtaining each additional pair of z axis and x axis acceleration values.

10. The method of claim 1 wherein the at least one sensor includes at least one accelerometer.

11. The method of claim 10 further including at least one additional sensor selected from the group of a gyro, a wheel speed sensor and a gps position sensor, the method including verifying the data used in the determination of the inclination of the suspended portion of the vehicle from data produced by the at least one additional sensor.

12. Apparatus for controlling an electromechanical system based on the inclination of a suspended portion of a vehicle with respect to a road comprising:

a processor;

at least one memory in communication with the processor, the at least one memory containing a computer program stored therein, the processor operative upon execution of the computer program to;

obtain at a predetermined sampling frequency a predetermined number of first and second data samples corresponding to z axis and x axis acceleration respectively from at least one sensor coupled to the suspended portion of the vehicle;

filter the z axis and x axis data samples to attenuate high frequency components of acceleration to produce filtered z axis and x axis data samples;

store the filtered z axis and x axis data samples in the at least one memory;

calculate a slope corresponding to a least squares best fit linear regression using the filtered z axis and x axis data samples;

generate an indication of inclination of the suspended portion of the vehicle (θ

_v) by calculating the arctangent of the slope determined in the calculating step;

generate at least one control signal based upon the indication of inclination of the suspended portion of the vehicle; and

provide the at least one control signal to the electromechanical system.

13. The apparatus of claim 12 wherein the electromechanical system is a headlight leveling system and the at least one control signal is operative to provide control of the inclination of the headlights of the vehicle with respect to the road.

14. The apparatus of claim 12 wherein the at least one sensor includes at least one accelerometer.

15. The apparatus of claim 12 wherein the processor to is operative to perform low pass filtering of the filtered z axis and x axis acceleration values to attenuate high frequency road noise.

16. The apparatus of claim 12 wherein the processor is operative to perform band pass filtering of the filtered z axis and x axis acceleration values to attenuate high frequency road noise and very low frequencies associated with slowly changing road inclinations.

17. The apparatus of claim 12 further wherein the processor is further operative to verify that a range of x axis acceleration values exceeds a predetermined limit so as to ensure that the z axis acceleration can be accurately established.

18. The apparatus of claim 12 wherein the predetermined limit is 0.05 g.