Method for correction of dynamic output signals of inertial sensors having mounting offsets

• US 8,639,415 B2
• Filed: 08/24/2009
• Issued: 01/28/2014
• Est. Priority Date: 08/25/2008
• Status: Active Grant

• Current Assignee: TRW Automotive USLLC (Zeppelin - Stiftung der Stadt Friedrichshafen)
• Original Assignee: TRW Automotive USLLC (Zeppelin - Stiftung der Stadt Friedrichshafen)
• Inventors: Haller, Mark, Hartman, Patrick, Kempen, Gary M.
• Primary Examiner(s): Tarcza, Thomas
• Assistant Examiner(s): Dunn, Alex C
• Application Number:
  US13/060,489
• Publication Number:
  US 20110153156A1
• Time in Patent Office: 1,618 Days
• Field of Search: 701/36, 701/45, 701/82, 701/90, 701/91
• US Class Current: 701/36
• CPC Class Codes: B60T 2250/06 Sensor zero-point adjustment; Offset compensation
• CPC Class Codes: B60T 8/171 Detecting parameters used in the regulation; Measuring values used in the regulation
• CPC Class Codes: G01C 21/183 Compensation of inertial measurements, e.g. for temperature effects
• CPC Class Codes: G01P 21/00 Testing or calibrating of apparatus or devices covered by the preceding groups

Abstract

A method for compensating inertial sensor measurement outputs for mounting locations that are not coincident, nor orthogonal, with the vehicle center of gravity. The method further utilizes vehicle angular rate measurements, data, or estimates to determine the discrete acceleration components of the composite inertial sensor measurement output.

Claims

1. A method for compensating an axial accelerometer output for use in a vehicle control system, comprising the steps of:

(a) providing an axial accelerometer at a first location that is different from a vehicular center of gravity location, the first location defining a moment arm from an axis of a vehicle center of gravity coordinate system to the axial accelerometer, the moment arm being defined from the first location and is perpendicular to a plane that includes one of the x, y, and z axes of the vehicle center of gravity coordinate system that corresponds to the axis of rotational movement as measured by the angular rate sensor, also providing at least one angular rate sensor, and further providing a control module that is in communication with the axial accelerometer and the angular rate sensor, the control module further being operative to compensate an output signal generated by the axial accelerometer, the control module including an algorithm, the algorithm having an operation to compute the rate of change of the angular rate sensor output signal in step (d) as dω

/dt where ω

is an angular velocity of at least one of the yaw, roll, and pitch rotational movement, the algorithm further having an operation to compensate the axial accelerometer output by a term of (ω

² R) and ((dω

/dt)R) where R is the inertial sensor moment arm defined from the first location that is perpendicular to a plane that includes one of the x, y, and z axis of the vehicle center of gravity coordinate system that corresponds to the axis of rotational movement as measured by the angular rate sensor, the operation to compensate the axial accelerometer output is in the form of an equation;

a_corrected=a_measured−

ω

²R−

(dω

/dt)R;

(b) sensing an acceleration at the first location with the axial accelerometer and generating an output signal that is proportional to the acceleration;

(c) sensing a rate of change of a rotational movement about at least one axis of the vehicular center of gravity coordinate system with the angular rate sensor, the angular rate sensor generating an angular rate sensor output signal that is proportional to the rate of change of the rotational movement; and

(d) the control module receiving the axial accelerometer output signal and the angular rate sensor output signal, the control module being responsive to the angular rate sensor output signal to calculate an angular acceleration, such that the control module determines a correction factor that is proportional to the moment arm and the angular acceleration and modifies the axial accelerometer output signal in response to the correction factor.

2. The method of claim 1 wherein the control module generates a control module output that is responsive to the modified axial accelerometer output signal.

3. The method of claim 1 wherein the rotational movement of step (c) is one of a roll, yaw, and pitch rotational movement about a respective x, y, and z axis of the vehicular center of gravity coordinate system, and the angular rate sensor of step (c) senses the rate of change of one of the yaw, roll, and pitch rotational movement.

4. The method of claim 3 wherein the control module includes an algorithm, the algorithm having an operation to compute the angular acceleration in step (d), the algorithm further having an operation to compensate the axial accelerometer output that is a function of the product of one of the angular rate or the angular acceleration and the moment arm.

5. The method of claim 4 wherein the output compensation function includes a function of the product of the angular rate and the moment arm and the angular acceleration and the moment arm.

6. The method of claim 1 wherein step (a) includes providing a plurality of angular rate sensors measuring the rate of change of at least two of the yaw, roll, and pitch rotational movements, and further wherein step (c) includes sensing a plurality of rotational movements about at least two corresponding x, y, and z axes of the vehicular center of gravity coordinate system.

7. The method of claim 6 wherein the control module includes an algorithm, the algorithm having an operation to compute the rate of change of a plurality of angular rate sensor output signals in step (d) as dω

_a/dt and dω

_b/dt where ω

_a and ω

_b are angular velocities of two of the yaw, roll, and pitch rotational movements, the algorithm further having an operation to compensate the axial accelerometer output by terms of (ω

_a² R_a) and ((dω

_a/dt)R_a) and (ω

_b² R_b) and ((dω

_b/dt)R_b) where R_a and R_b are the moment arms defined from the first location to a pair of orthogonal planes wherein each plane includes one of the x, y, and z axes of the vehicle center of gravity coordinate system that corresponds to the respective axis of rotational movement as measured by the plurality of angular rate sensors.

8. The method of claim 1 wherein step (a) includes providing a plurality of angular rate sensors measuring the rate of change of the yaw, roll, and pitch rotational movements, and further wherein step (c) includes sensing a plurality of rotational movements of each of the roll, yaw, and pitch rotational movements about the respective x, y, and z axes of the vehicular center of gravity coordinate system.

9. The method of claim 8 wherein the control module includes an algorithm, the algorithm having an operation to compute the rate of change of a plurality of angular rate sensor output signals in step (d) as dω

_a/dt, dω

_b/dt, and dω

_c/dt where ω

_a, ω

_b, and ω

_c are angular velocities of the yaw, roll, and pitch rotational movements, the algorithm further having an operation to compensate the axial accelerometer output by terms of (ω

_a² R_a) and ((dω

_a/dt)R_a), and (ω

_b² R_b) and ((dω

_b/dt)R_b), and (ω

_c² R_c) and ((dω

_c/dt)R_c) where R_a, R_b, and R_c are the moment arms defined from the first location to each of a plurality of orthogonal planes, each plane including one of the x, y, and z axes of the vehicle center of gravity coordinate system that correspond to the respective axis of rotational movement as measured by the plurality of angular rate sensors.

10. A method for compensating an axial accelerometer output for use in a vehicle control system, comprising the steps of:

(a) providing an axial accelerometer at a first location that is different from a vehicular center of gravity location, the first location defining an moment arm from an axis of a vehicle center of gravity coordinate system to the axial accelerometer, also providing a plurality of sensors mounted at a plurality of locations, and further providing a control module that is in communication with the axial accelerometer and the plurality of sensors, the control module further being operative to compensate an output signal generated by the inertial sensor;

(b) sensing an acceleration at the first location with the accelerometer, the accelerometer generating an output signal that is proportional to the acceleration;

(c) sensing a plurality of vehicle characteristics with the plurality of sensors and generating a plurality of sensor output signals that are each proportional to the respective sensed vehicle characteristic;

(d) the control module receiving the accelerometer output signal and the plurality of sensor output signals, the control module being operative to derive an at least one angular acceleration from the plurality of sensor output signals,

characterized in that the control module determines a correction factor that is proportional to the product of the accelerometer moment arm and the at least one angular acceleration;

(e) modifying the accelerometer output signal in response to the correction factor which includes an equation in the form of;

a_corrected=a_measured−

ω

²R−

(dω

/dt)R; and

(f) generating a control module output that is responsive to the modified accelerometer output signal.

11. The method of claim 10 wherein the plurality of sensors is at least one of a wheel speed sensor and a throttle position sensor, and at least one of a steering angle sensor and a steering rate sensor.

12. The method of claim 11 wherein the control module includes an algorithm programmed to derive an angular velocity rate of change from the plurality of sensor output signals.

13. The method of claim 12 wherein the plurality of sensors includes at least three of a wheel speed sensor, a steering angle sensor, a steering rate sensor, an air bag deployment sensor, a suspension height sensor, and a throttle position sensor.

14. An inertial motion sensing system for generating a compensated accelerometer output, the system comprising:

at least one axial accelerometer mounted at a first location that is different from a vehicular center of gravity location, the first location further defining a moment arm from an axis of a vehicle center of gravity coordinate system to the accelerometer, the accelerometer being operative to sense an acceleration at the first location and to generate an output signal that is proportional to the acceleration;

at least one of a plurality of sensors mounted at an at least one of a plurality of locations, the at least one of a plurality of sensors being operative to sense an at least one of a plurality of vehicle characteristics about the axis of the vehicular center of gravity coordinate system, the at least one of a plurality of sensors being further operative to generate an at least one of a plurality of sensor output signals; and

a control module in communication with the at least one accelerometer and the at least one of a plurality of sensors,

characterized in that the control module is operative to derive an at least one angular acceleration from the plurality of sensor output signals, the control module being also operative to calculate a correction factor, the control module being further operative to modify the accelerometer output signal in response to the correction factor which includes an equation in the form of

a_corrected=a_measured−

ω

²R−

(dω

/dt)R;

the control module further generating a control module output that is responsive to the modified output signal.

15. The inertial motion sensing system of claim 14 wherein the at least one of a plurality of sensors is at least one angular rate sensor, the at least one of a plurality of locations is a second location, and the at least one vehicle characteristic is a rate of change of a rotational movement.

16. The inertial motion sensing system of claim 15 wherein the at least one angular rate sensor is a plurality of angular rate sensors and the control module includes an algorithm, the algorithm having an operation to compute the rate of change of at least one angular rate sensor output signal as at least one of dω

_a/dt, dω

_b/dt, and dω

_c/dt where ω

_a, ω

_b, and ω

_c are angular velocities of the yaw, roll, and pitch rotational movements, the algorithm further having an operation to compensate the accelerometer output by terms of at least one of (ω

_a² R_a) and ((dω

_a/dt)R_a), and (ω

_b² R_b) and ((dω

_b/dt)R_b), and (ω

_c² R_c) and ((dω

_c/dt)R_c) where R_a, R_b, and R_c are the moment arms defined from the first location to each of a plurality of orthogonal planes, each plane including one of the x, y, and z axes of the vehicle center of gravity coordinate system that correspond to the respective axis of rotational movement as measured by the plurality of angular rate sensors.

17. The method of claim 14 wherein the at least one of a plurality of sensors is a plurality of sensors that includes at least three of a wheel speed sensor, a steering angle sensor, a steering rate sensor, an air bag deployment sensor, a suspension height sensor, and a throttle position sensor, and the control module includes an algorithm programmed to derive an angular velocity rate of change from the output signals of the three selected sensors.

18. A vehicle control system for modifying a dynamic characteristic of a vehicle, comprising:

an accelerometer mounted at a first location that is different from a vehicular center of gravity location, the first location further defining a moment arm from an axis of a vehicle center of gravity coordinate system to the accelerometer, the accelerometer being operative to measure an acceleration at the first location and to generate an output signal that is proportional to the acceleration;

at least one angular rate sensor mounted at a second location, the at least one angular rate sensor being operative to measure a rate of change of a rotational movement about the axis of the vehicular center of gravity coordinate system, the angular rate sensor being further operative to generate an angular rate sensor output signal;

a vehicle dynamic subsystem including a subsystem controller in communication with a subsystem actuator, the subsystem actuator being responsive to the subsystem controller to alter a movement of the vehicle center of gravity location; and

a control module being in communication with the accelerometer, the angular rate sensor, and the subsystem controller,

characterized in that the control module includes an algorithm, the algorithm being operative to calculate a rate of change of the angular rate sensor output signal and to calculate a correction factor, the algorithm being further operative to modify the accelerometer output signal in response to the correction factor which includes the equation;

a_corrected=[(a_measured)²−

(ω

²R)²]^1/2−

(dω

/dt)R,

the control module being further operative to generate a control module output that is communicated to the subsystem controller in order to operatively actuate the subsystem actuator.

19. The vehicle control system of claim 18 wherein the vehicle dynamic subsystem is at least one of an antilock braking system, a traction control system, a throttle control system, and a suspension control system, the vehicle dynamic subsystem including a subsystem controller mounted on at least a portion of the vehicle dynamic subsystem.

20. The vehicle control system of claim 19 wherein the subsystem controller is part of the control module.