USPatentGranted
B2

Method for determining and correcting incorrect orientations and offsets of the sensors of an inertial measurement unit in a land vehicle

Granted 22 Nov 2011 · 10 office actions

Life of the patent

18 dated events
⤢ drag to zoom20062008201020122014201620182020202220242026ProsecutionOwnershipTerm & fees
ProsecutionOwnershipTerm & feeshover for detail · click to open

Abstract

An inertial measurement unit (IMU) contains three linear acceleration sensors and three rotational speed sensors. For the sensors there are desired installation directions parallel to the co-ordinate axes of a Cartesian co-ordinate system which is fixed to the vehicle. The actual installation directions of the sensors may differ from the desired installation directions owing to incorrect orientations. By comparing accelerations which are measured by the linear acceleration sensors for different attitudes of the vehicle with acceleration values which are known for these different attitudes in the Cartesian co-ordinate system which is fixed to the vehicle, the actual installation directions of the linear acceleration sensors are determined. By using a co-ordinate transformation it is then possible to convert the measured accelerations into the actual accelerations.

Description

9 parts
›CROSS-REFERENCE TO RELATED APPLICATIONS

This application is a U.S. national stage application of International Application No. PCT/EP2006/062248 filed May 11, 2006, which designates the United States of America, and claims priority to German application number 10 2005 033 237.4 filed Jul. 15, 2005, the contents of which are hereby incorporated by reference in their entirety.

›TECHNICAL FIELD

The present application concerns a method for determining and correcting incorrect orientations and offsets of the sensors of an inertial measurement unit in a land vehicle.

›BACKGROUND

Sensor clusters, consisting of acceleration sensors and rotational speed sensors, have been used in automotive engineering for some time for applications, for example in electronic stability programs (ESP), in flashover recognition and prevention and for navigation. These sensor clusters generally contain one to two rotational speed sensors for determining the yaw rate (angular velocity about an axis vertical to the standing surface of the vehicle) or the roll rate (angular velocity about the longitudinal axis of the vehicle) and one to two acceleration sensors for determining the transverse or longitudinal acceleration of the vehicle.

In the meantime it has proven possible to produce rotational speed sensors at low cost with characteristics that are adequate for the automotive field based on MEMS technology (MEMS=Micro Electro Mechanical Systems), so that sensor clusters with at least three rotational speed sensors and at least three acceleration sensors are also feasible for mid-range automobiles without high additional costs. Sensor clusters of this type are also referred to as IMUs (Inertial Measurement Units). An IMU contains three rotational speed sensors and three acceleration sensors. The acceleration sensors are disposed in such a manner that they measure the components of the acceleration vector of a fixed point in the vehicle in the longitudinal direction and transverse direction of the vehicle and vertical to the standing surface of the vehicle. These directions are generally orthogonal to each other in pairs. The rotational speed sensors are disposed in such a manner that they measure the components of the vector of the current angular velocity of the vehicle in respect of the same three directions.

With regard to the central monitoring of the different electronic systems in the vehicle and possibilities for using fewer sensors, such sensor clusters, which make their data available to different systems in the vehicle, are of particular interest.

If all or some of the corresponding sensors in such a sensor cluster are not oriented in the desired directions (e.g. due to errors in the manufacturing process), these incorrect orientations can generally not be located without taking measurements within the cluster housing.

›SUMMARY

According to an embodiment, incorrect orientations can be determined without major outlay and can be corrected by a method for determining incorrect orientations of sensors of a sensor cluster in a vehicle, wherein the sensor cluster has either three linear acceleration sensors and/or three rotational speed sensors, comprising the steps of: predetermining desired installation directions of the sensors in relation to coordinate axes of a fixed vehicle Cartesian coordinate system; and determining actual installation directions of the sensors, which can deviate from the desired installation directions due to incorrect orientations, by comparing values measured by the sensors in different conditions with values known for these different conditions in the fixed vehicle Cartesian coordinate system.

According to further embodiment, any offset can be determined during measurements by the sensors by means of a suitable plurality of measurements by the sensors in different conditions, which result in known values in the fixed vehicle Cartesian coordinate system. According to further embodiment, mean values during a vehicle trip can be selected as known values in the fixed vehicle Cartesian coordinate system. According to further embodiment, values determined by other sensors can be selected as known values in the fixed vehicle Cartesian coordinate system.

According to another embodiment, a method for correcting measurement values of sensors of a sensor cluster in a vehicle, comprises the steps of: determining incorrect orientations of the sensors by predetermining desired installation directions of the sensors in relation to coordinate axes of a fixed vehicle Cartesian coordinate system and determining actual installation directions of the sensors by comparing values measured by the sensors in different conditions with values known for these different conditions in the fixed vehicle Cartesian coordinate system; and wherein with the aid of incorrect orientations determined from values measured by the sensors actual values of the vehicle in relation to a fixed vehicle Cartesian coordinate system are predicted.

According to yet another embodiment, a method for determining the position of an inertial sensor cluster in a vehicle, comprises the steps of: determining the position in the longitudinal direction of the vehicle, wherein the distance between the inertial sensor cluster and the rear axle of the vehicle is determined by averaging the longitudinal acceleration of the vehicle, which is not measured on the rear axle.

According to yet another embodiment, a computer readable medium storing a computer program, which when executed on a computation unit, a microcontroller, DSP, FPGA or computer or on a plurality of these in a network, performs the steps of: predetermining desired installation directions of the sensors in relation to coordinate axes of a fixed vehicle Cartesian coordinate system; determining actual installation directions of the sensors by comparing values measured by the sensors in different conditions with values known for these different conditions in the fixed vehicle Cartesian coordinate system.

›BRIEF DESCRIPTION OF THE DRAWINGS

The exemplary embodiments are shown schematically in the figures. The same reference characters in the individual figures refer to elements which are the same or have identical functions or correspond to each other in respect of their functions. In the figures, more specifically:

FIG. 1 shows a schematic diagram of the fixed vehicle coordinate system, the installation directions of the sensors and the movements of the vehicle in the six degrees of freedom;

FIG. 2 shows a schematic diagram of the position changes of a vehicle;

FIG. 2A shows a schematic diagram of the position of a vehicle on a horizontal surface;

FIG. 2B shows a schematic diagram of the position change of a vehicle when rotated about the y-axis or about the pitch angle θ; and

FIG. 2C shows a schematic diagram of the position change of a vehicle when rotated about the x-axis or about the roll angle φ.

›DETAILED DESCRIPTION · 1 of 4

A method is indicated for the quantitative determination of incorrect orientations of sensors in particular within the IMU or incorrect orientations of the IMU as a whole. A method for determining the position of the IMU within the vehicle is similarly indicated. Incorrect orientations of IMU sensors and incorrect positioning of the IMU are corrected in a computation unit, which prepares and processes the IMU sensor signals.

If at least three acceleration sensors are disposed in three linearly independent directions and at least three acceleration sensors are disposed in three linearly independent directions in an IMU, it becomes possible to identify, quantitatively define and correct incorrect orientations with the aid of simple manipulations.

Individual method steps are described in more detail below. The steps do not necessarily have to be implemented in the order indicated and the method to be described can also have further unspecified steps.

A method is proposed for determining incorrect orientations of sensors of a sensor cluster in a vehicle. A vehicle can be any type of vehicle, for example an aircraft or ship, but is preferably a land vehicle, such as a motorbike, railed vehicle, bus, truck or automobile.

The sensor cluster has at least three linear acceleration sensors and/or three rotational speed sensors. These sensors have desired installation directions in relation to coordinate axes of a fixed vehicle Cartesian coordinate system. The desired installation directions are generally parallel to these coordinate axes. The actual installation directions of the sensors can however deviate from the desired installation directions due to incorrect orientations.

By comparing values measured by the sensors in different conditions with values in the fixed vehicle Cartesian coordinate system that are known for these different conditions, it is possible to determine the actual installation directions of the linear acceleration sensors. As well as the values themselves, the results of processing said values, e.g. mathematically modified, perhaps integrated values, can be compared with each other in this process.

Known values can result for example from defined tilt directions of the vehicle or by forming a mean value over a longer period, e.g. a trip. Or they are determined by other sensors, for example from wheel speeds and the steering angle.

It is also possible to determine any offset in measurements by the sensors using a suitable plurality of measurements by the sensors in different conditions, which result in known values in the fixed vehicle Cartesian coordinate system.

The suitable plurality of measurements by the sensors in different conditions must be large enough to be able to determine the number of unknowns, which occur with an additional offset correction. For example measurements can be taken at more than one angle per tilt direction, generally one angle and an angle offset by 180° thereto.

Sensor clusters in the form of IMUs also typically have rotational speed sensors, which likewise have desired installation directions and actual installation directions that occasionally deviate therefrom. For such IMUs the incorrect orientations of the actual installation directions of the rotational speed sensors are determined.

If mean values during a vehicle trip are selected as known values in the fixed vehicle Cartesian coordinate system, incorrect orientations and offsets can also be determined during operation of the vehicle with the aid of self-learning algorithms. Typically accelerations average out to zero during a trip, which starts and ends with a stationary state, when the acceleration is measured on the unsteered rear axle. There is then no need for special calibrations or measurement cycles, which would have to be incorporated into the production process.

Known values in the fixed vehicle Cartesian coordinate system can also be obtained by means of values of this acceleration determined by other sensors, for example by means of long-term means values for the difference between values measured by the longitudinal and transverse acceleration sensors and the actual accelerations determined from the wheel speeds and steering angle.

The values obtained relating to the incorrect orientations can then be used to correct measurement values from sensors of a sensor cluster in a vehicle, since the determined incorrect orientations can be used to conclude actual acceleration values of the vehicle, in relation to a fixed vehicle Cartesian coordinate system, from values measured by the sensors. This correction is typically corrected in a computation unit, which prepares and processes the sensor signals. In mathematical terms this is a coordinate transformation.

A method is also proposed for determining the position of an inertial sensor cluster in a vehicle, wherein the position in the longitudinal direction of the vehicle is determined, wherein the distance between the inertial sensor cluster and the rear axle of the vehicle is determined by averaging the longitudinal acceleration of the vehicle, which is not measured in the rear axle.

In particular a method is proposed for determining the position of an inertial sensor cluster in a vehicle in the longitudinal direction of the vehicle, wherein the following equation is used to determine the distance l R between the inertial sensor cluster and the rear axle of the vehicle:

∫ 0 T ⁢ a x ⁡ ( t ) ⁢ ⅆ t = v x ⁡ ( T ) - v x ⁡ ( 0 ) + l R ⁢ ∫ 0 T ⁢ ω z 2 ⁡ ( t ) ⁢ ⅆ t ,

where T is the observation period, a x (t) the acceleration of the vehicle in the longitudinal direction, measured in a fixed vehicle Cartesian coordinate system, ν x the longitudinal velocity of the vehicle, and ω z the yaw rate of the vehicle.

In general the methods shown make it possible, by simple manipulations at the vehicle (inclinations) and drive maneuvers, to determine all the information about incorrect orientations of sensors of an IMU and then to correct the incorrect orientations. To correct incorrect sensor orientations it is therefore no longer necessary to open the sensor cluster and intervene therein or even to replace the cluster.

›DETAILED DESCRIPTION · 2 of 4

A subsequent determination of the position of an IMU sensor cluster in the vehicle is difficult, if the installation site is difficult to access. The described method for indirect position location makes direct access to the installation site unnecessary.

According to another embodiment, a computer program, executes the method according to various embodiments when run on a computation unit, a microcontroller, DSP, FPGA or computer or on a plurality of these in a network. A typical computation unit is an on-board computer in a vehicle or part of the vehicle electronic system, for example a microcontroller in an ECU (Electronic Control Unit).

According to yet another embodiment a computer program comprises program code means, to implement the method according to various embodiments, when the program is executed on a computation unit, a microcontroller, DSP, FPGA or computer or on a plurality of these in a network. In particular the program code means can be instructions stored on a machine-readable data medium.

According to yet another embodiment, a data medium, on which a data structure is stored, which, after being loaded into a random access memory and/or main memory of a computation unit, a microcontroller, DSP, FPGA or computer or a plurality of these in a network, can execute the method according to various embodiments.

According to yet another embodiment, a computer program product comprises program code means stored on a machine-readable medium, to implement the method according to various embodiments, wherein the program is executed on a computation unit, a microcontroller, DSP, FPGA or computer or on a plurality of these in a network.

A computer program product here refers to the program as a commercial product. It can essentially be in any form, for example on paper or a machine-readable data medium, and can in particular be distributed by way of a data transmission network.

According to yet another embodiment, a modulated data signal contains instructions for executing the method according to various embodiments, wherein the instructions can be executed by a computation unit, a microcontroller, DSP, FPGA or computer or by a plurality of these in a network.

Further details and features will emerge from the description which follows of preferred exemplary embodiments in conjunction with the subclaims. The respective features can be realized alone per se or in combinations of more than one here. The possible ways in which the various objects of the present invention can be achieved are not restricted to the exemplary embodiments.

For clarity FIG. 1 shows a typical diagram of the fixed vehicle coordinate system and the movements in the six degrees of freedom. It is a three-dimensional coordinate system with an x-axis 100 , a y-axis 102 and a z-axis 104 . We will take as our basis a fixed vehicle coordinate system, more specifically a coordinate system, which is connected permanently to the vehicle structure or the (presumably rigid) body 106 and whose x-axis 100 points in the forward direction of the vehicle and whose z-axis 104 points upward at right angles to the drive path. The direction of the y-axis 102 is determined in that the coordinate system is intended to be a right-handed system. The point of origin of the coordinate system is generally disposed in the center of gravity G of the vehicle body 106 .

If the vehicle response about the center of gravity G is assumed to be the movement of a rigid body in three-dimensional space, the vehicle response can be defined as a movement with six degrees of freedom. The individual degrees of freedom are hereby defined as follows:

linear movement along the x-axis 100 —longitudinal movement; linear movement along the y-axis 102 —transverse movement; linear movement along the z-axis 104 —vertical movement; rotational movement about the x-axis 100 —rolling movement 108 with the roll angle φ; rotational movement about the y-axis 102 —pitch movement 110 with the pitch angle θ; and rotational movement about the z-axis 104 —yaw movement 112 with the yaw angle ψ.

The desired installation directions of the sensors (acceleration sensors and rotational speed sensors) run parallel to the coordinate axes and are designated in the fixed vehicle coordinate system by the unit vectors ê(j),j=x,y,z. The actual installation directions, which can differ from the desired installation directions due to incorrect orientations, are designated in the fixed vehicle coordinate system with the unit vectors û(j),j=x,y,z. They are not necessarily orthogonal in pairs.

The vector of effective acceleration {right arrow over (a)} (e) is defined as

{right arrow over (a)} (e) ={right arrow over (a)}−g{circumflex over (n)},

where {right arrow over (a)} is the vector of actual acceleration in the fixed vehicle coordinate system and {circumflex over (n)} is the unit vector in the direction of gravity, which points “downward”. In this process

{circumflex over (n)}= (sin θ,−sin φ cos θ,−cos φ cos θ) T ,

measured in the coordinate system of the vehicle, with the roll angle φ and the pitch angle θ.

The actual acceleration {right arrow over (a)} reflects the movement of the vehicle. The acceleration measured by an acceleration sensor is referred to as the effective acceleration {right arrow over (a)} (e) . When the vehicle is stationary, the actual acceleration {right arrow over (a)} disappears and the effective acceleration {right arrow over (a)} (e) points in the direction counter to gravity.

A standard acceleration sensor is made for example from a mass, which is suspended in a sprung manner. If such an acceleration sensor is used for example to determine the acceleration in the z-direction and the vehicle is stationary, the mass is deflected downward by gravity and the sensor measures a corresponding effective acceleration.

The variables measured by the three acceleration sensors are the projection of the effective acceleration onto the respective sensor axis:

b (e) ( j )= û ( j )•{right arrow over (a)} (e) =û ( j )•{right arrow over (a)}− gû ( j )• {circumflex over (n)},

›DETAILED DESCRIPTION · 3 of 4

where • indicates the scalar product. In other words:

{right arrow over (b)} (e) = ·{right arrow over (a)} (e) ,  (1)

where the rows of the 3×3 matrix are the components of the unit vectors û(j),j=x,y,z in relation to the fixed vehicle Cartesian coordinate system. is a coordinate transformation matrix.

What is required are the three Cartesian components a j (e) , j=x,y,z of the vector of effective acceleration {right arrow over (a)} (e) , which would be measured by the acceleration sensors, if they were oriented along the axes of the fixed vehicle coordinate system.

If the three unit vectors û(j),j=x,y,z are not all in one plane, which is almost always the case, the required variables a j (e) ,j=x,y,z can be calculated from b (e) (j), j=x,y,z by inverting the 3×3 matrix :

{right arrow over (a)} (e) = −1 ·{right arrow over (b)} (e) .  (2)

Methods for determining the matrix are indicated below.

To this end three static situations are first considered:

1 St Position

The first position is shown in FIG. 2A . The vehicle stands on a horizontal surface. The vector of effective acceleration {right arrow over (a)} (e,1) is then {right arrow over (a)} (e,1) =(0,0,g) T , from which according to equation (1)

b (e,1) ( j )= û z ( j ) g,j=x,y,z,

and

û z ( j )= b (e,1) ( j )/ g,j=x,y,z   (3)

result. Here b (e,1) (j),j=x,y,z are the values supplied by the three acceleration sensors in this first position of the vehicle. û z (j) is the z-component of the unit vector û(j),j=x,y,z of the actual installation directions in the fixed vehicle coordinate system determined therewith.

2 nd Position

In the second position, as shown in FIG. 2B , the vehicle is inclined about the pitch angle θ forward or backward. If the sensor cluster is incorporated in the vehicle structure, as is generally the case, the inclination of the structure must be determined. If the vehicle is on a ramp or inclined plane, which is inclined through an angle θ 0 , the angle difference, Δθ=θ−θ 0 between the inclination of the vehicle structure θ and the inclination of the inclined plane θ 0 must be determined, so that θ=θ 0 +Δθ can be worked out.

If level sensors are incorporated in the vehicle, to indicate the spring paths of wheel suspension systems or axles, these can be used to determine the angle difference Δθ. Alternatively the angle difference Δθ can be calculated with the aid of a vehicle model, which describes the elasticities of the vehicle, in particular the elastic coupling of chassis and vehicle structure in sufficient detail (e.g. in the context of a five-mass model). Non-linearities of the corresponding springs should also be taken into account here. The inclination of the vehicle structure can also be determined by means of additional inclination sensors.

The vector of effective acceleration {right arrow over (a)} (e,2+) in this second position is then

{right arrow over (a)} (e,2+) =g (−sin θ,0, cos θ) T

and equation (1) gives:

{right arrow over (b)} (e,2+) = ·g (−sin θ,0, cos θ) T

and

b (e,2+) ( j )=− û x ( j )· g sin θ+ û z ( j )· g cos θ, j=x,y,z.

Here b (e,2+) (j),j=x,y,z are the values supplied by the three acceleration sensors in this second position of the vehicle. Inserting equation (3) for û z (j) gives

b (e,2+) ( j )=− û x ( j )· g sin θ+ b (e,1) ( j )/ g·g cos θ, j=x,y,z.

After resolution according to û x (j)

u ^ x ⁡ ( j ) = [ b ( e , 1 ) ⁡ ( j ) ⁢ cos ⁢ ⁢ ϑ - b ( e , 2 + ) ⁡ ( j ) ] ⁢ 1 g ⁢ ⁢ sin ⁢ ⁢ ϑ , j = x , y , z . ( 4 )

û x (j) is the z-component of the unit vector û(j),j=x,y,z of the actual installation directions of the sensors in the fixed vehicle coordinate system determined therewith.

3 rd Position

The y-components of the unit vectors û(j),j=x,y,z still have to be determined. To this end the vehicle is inclined laterally through the roll angle φ in a third position. This position is shown in FIG. 2C .

If the sensor cluster is incorporated in the vehicle structure, the angle of inclination of the structure must again be determined, as it does not correspond to the vehicle path/ramp. The angle difference can be determined with the aid of level sensors on the wheel suspension systems and/or a vehicle model.

The vector of effective acceleration {right arrow over (a)} (e,3+) for this third position is then

{right arrow over (a)} (e,3+) =g (0, sin φ, cos φ) T

giving, as in the second position,

Here b (e,3+) (j),j=x, y, z are the values supplied by the three acceleration sensors in this third position of the vehicle.

The matrix is thus fully defined and the required components of the vector of effective acceleration in respect of the fixed vehicle Cartesian coordinate system can be determined at any time from the measurement values of the possibly incorrectly oriented acceleration sensors according to

⁢ a j ( e ) = ∑ j ′ = x , y , z ⁢ ⁢ M jj , b ( e ) ⁡ ( j ) , j = x , y , z ⁢

⁢ and ⁢ a → ( e ) = M · b → ( e ) ,

where the matrix is the inverse of the matrix :

= −1 ,

thus according to equation (2).

Offset Correction:

If there is a non-negligible and quantitatively unknown offset present at the acceleration sensors, in other words they indicate accelerations for instance when none are present, an additive error is present and the vehicle is rotated through 180° on the ramp inclined through the angle −θ 0 or −φ 0 . This corresponds to an inclination about the angle −θ 0 or −φ 0 . The outputs of the acceleration sensors obtained in this position of the vehicle are designated as b (e,2−) (j),j=x, y, z and b (e,3−) (j),j=x, y, z.

The corresponding angles of inclination of the structure should be determined here, these generally not being exactly equal to −θ 0 or −φ 0 . This can be done again with the aid of level sensors for instance or with the aid of a vehicle model or by means of further inclination sensors.

The components of the direction unit vectors û(j),j-=x,y,z are then

u ^ x ⁡ ( j ) = [ b ( e , 2 - ) ⁡ ( j ) - b ( e , 2 + ) ⁡ ( j ) ] ⁢ 1 g ⁢ ⁢ sin ⁢ ⁢ ϑ , j = x , y , z ,

⁢ u ^ y ⁡ ( j ) = [ b ( e , 3 - ) ⁡ ( j ) - b ( e , 3 + ) ⁡ ( j ) ] ⁢ 1 g ⁢ ⁢ sin ⁢ ⁢ ϑ , j = x , y , z ,

›DETAILED DESCRIPTION · 4 of 4

⁢ u ^ z ⁡ ( j ) = { b ( e , 1 ) ⁡ ( j ) - 1 2 ⁡ [ b ( e , 2 + ) ⁡ ( j ) + b ( e , 2 - ) ⁡ ( j ) ] } ⁢ 1 g ⁡ ( 1 - cos ⁢ ⁢ ϑ ) , j = x , y , z ,

where for derivation purposes, differences between sensor values of the same sensor are always used, with which additive errors emerge. This allows the additive offset to be eliminated from the measured accelerations.

Use can also be made of the fact that the direction vectors û(j),j=x,y,z are unit vectors and that therefore

û x 2 ( j )+ û y 2 ( j ) +û z 2 ( j )=1 ,j=x,y,z.

This causes the equation system to be over-defined and certain errors can be minimized by means of a compensation calculation. In these derivations it was assumed that the offset of the acceleration sensors is independent of their orientation in space. The compensation calculation can be effected using a Kalman filter.

To identify an offset of the acceleration sensors, use can be made of the fact that when the vehicle is stationary the following must apply

a x (e)2 +a y (e)2 +a z (e)2 =g 2 .

If not, at least one of the sensors must have an offset.

Rotational Speed Sensors

The procedure is similar for the rotational speed sensors. The outputs of the three rotational speed sensors, {tilde over (ω)} j ,j=x, y, z are linked to the rotation vector {right arrow over (ω)} via

ti {tilde over (ω)} j =û ( j )•{right arrow over (ω)}.

The offsets of the rotational speed sensors can be identified and corrected when the vehicle is stationary, since when the vehicle is stationary all the rotational speeds should disappear.

To determine incorrect orientations of the rotational speed sensors, the same maneuver is used as for the acceleration sensors, in other words the three different positions, with the corresponding rotational movements now having to be monitored over time. In the first position a rotational movement must also be executed about the z-axis.

For the calculation of û(j),j=x,y,z from the signals {tilde over (ω)} j ,j=x,y,z of the three rotational speed sensors in the individual positions, the above formulae (2), (3), (4) and (5) are used with the following identifiers or replacements:

{right arrow over (a)} (e) corresponds to the vector from the three angles φ, θ and ψ.

The angles roll angle φ, pitch angle θ and yaw angle ψ set in the individual positions are related to the rotational speeds by way of integral relationships relating to the corresponding rotational speeds:

rotation of the vehicle about the normal axis or z-axis on a horizontal plane:

∫ 0 T ⁢ ω ~ j ( 1 ) ⁡ ( t ) ⁢ ⅆ t = ψ ⁢ u ^ z ⁡ ( j ) ,

where T is the measuring time and {tilde over (ω)} j (1) (t) is the signal of the jth rotational speed sensor measured during rotation in the first position about the z-axis of the vehicle.

rotation of the vehicle about the transverse axis:

The integrals

∫ 0 T ⁢ ω ~ j ⁡ ( t ) ⁢ ⅆ t

correspond to the acceleration values b (e) (j),j=x,y,z.

The unit direction vectors û(j),j=x,y,z of the rotational direction sensors are thus determined. It is thus possible from the measured rotational speeds {tilde over (ω)} j ,j=x,y,z to calculate the actual rotational speeds {right arrow over (ω)} in relation to the Cartesian axes according to:

{right arrow over (ω)}= −1 ·{tilde over ({right arrow over (ω)}.

Self-Learning Algorithms

In practice in some circumstances it is only possible for there to be incorrect orientations of one of the three acceleration sensors and one of the three rotational speed sensors. Two of the three sensors respectively are normally housed on a board. Two sensors can even be embodied as a dual axis sensor. The third of the three sensors respectively may be incorporated on a second printed circuit board, which is turned through an angle of 90°+ε in relation to the first.

Incorrect orientations and offsets can be determined during operation of the vehicle with the aid of self-learning algorithms. This is to be illustrated for the specific instance mentioned above of two boards not exactly at right angles to each other.

If the entire sensor cluster is tilted about the longitudinal or transverse axis of the vehicle, long-term mean values of the difference between values measured by the longitudinal and transverse acceleration sensors and the actual accelerations determined from the wheel speeds and steering angle are used first to determine the tilt angles φ and θ of the entire cluster and to correct the value of the vertical acceleration sensor by this overall incorrect orientation. Then while the vehicle is stationary the measured values of the effective longitudinal and transverse acceleration sensors can be used to determine the vehicle inclination and to determine the angle ε by means of a comparison with the output of the vertical acceleration sensor. The signal of the vertical acceleration sensor and the signals of all three rotational speed sensors are then corrected by the incorrect orientation angles φ, θ and ε.

Determination of the Position of the Sensor Cluster

To determine the position of the sensor cluster in the longitudinal direction, the following equation can be used:

Here ν x is the longitudinal velocity of the vehicle and l R is the distance between the sensor cluster and the rear axle. The following kinematic relationship is used here:

a x ={dot over (ν)} x +ν y ω z

Here ν y is the transverse velocity of the vehicle. If the rear axle rolls, then

ν y =l R ω z .

Insertion and integration give the said equation.

Use is made here of the fact that the longitudinal acceleration does not average out to zero, if it is not measured on the unsteered rear axle.

The temporal mean values occurring in this equation may only be executed over those time intervals, in which oblique running angles of the rear wheels are negligible. The sensor value for the longitudinal acceleration must be corrected by the relevant pitch angle. Corrections can be incorporated into the above equation, which take into account the final oblique running angles of the rear wheels and therefore extend the range of validity of this equation to higher velocities. The corrections consist of ν y being specified by means of a side slip angle determination beyond the term l R ω z . The side slip angle β is arctan(ν y /ν x ).

Claims

15 · 5 independent · depth 2
123456789101112131415
15 granted claims

Classifications

4 codes
IPC · International Patent Classification
Section G — Physics
  • G01C17/38
  • G01P21/00
USPC · US Patent Classification
702/9573/1.38

Claim changes

Soon
Coming soonHow the claims changed between publication and grant

See which claims were amended, added or cancelled during examination, with every added and removed word marked.

AmendedAddedCancelledUnchanged

The published claims of this patent are not paired with the granted ones in what we hold.

File wrapper

⤢ drag to zoom200720082009201020112012USPTOApplicantNon-final rejectionResponse after non-finalResponse after non-finalResponse after non-finalResponse after non-final
USPTOApplicanthover for detail · click to open
Pendency
5.5 y
2,021 days filing → grant
Office actions
5
non-final + final
Responses
6
no RCE
Examiner
Mohamed Charioui
art unit 2857 · TC 2800
Citations: 28 back · 10 forward

See the full prosecution history — every USPTO and applicant action on this file, in order.

Log in to unlock

Chain of title

⤢ drag to zoom2008201020122014201620182020202220242026Owner 3
Titlehover for detail · click to open

See the full assignment history — every owner this patent has passed through, with recordation dates and reel/frame numbers.

Log in to unlock

Term & fees

See the term timeline — pendency span, in-force span, the maintenance fees paid and both computed expiry dates.

Log in to unlock

Priority chain

1 priority documents
›Priority documents — 1
TypeDocumentDate
related publicationUS 20080208501 A128 Aug 2008

Worldwide family

9 members · 6 offices
US2EP1KR1CN2WO1DE2
this patentIP5 & PCTother officessolid = grantedhover for detail · click to open
Members
9
DOCDB simple family 36608587
Offices
6
US · EP · KR · CN · WO
Granted
3 of 9
grant date present
Non-English titles
7
shown as filed, never translated
›IP5 & PCT — 7 members
OfficePublicationKindPublishedFiledStatusTitle
USUS-2008208501-A1A128 Aug 200811 May 2006publishedMethod For Determining and Correcting Incorrect Orientations and Offsets of the Sensors of an Inertial Measurement Unit in a Land Vehicle
USthis patentUS-8065104-B2B222 Nov 201111 May 2006grantedMethod for determining and correcting incorrect orientations and offsets of the sensors of an inertial measurement unit in a land vehicle
EPEP-1904805-A1A12 Apr 200811 May 2006publishedProcede pour determiner et corriger des mauvaises orientations et des decalages des capteurs d'un mesureur inertiel dans un vehicule routierfr
KRKR-20080025705-AA21 Mar 200811 May 2006published지상 차량에서 관성 측정 유닛의 센서의 부정확한 배향 및오프셋을 수정 및 결정하는 방법ko
CNCN-101223417-AA16 Jul 200811 May 2006published用于确定和校正陆上运输工具中的惯性测量单元的传感器的错误定向和偏差的方法zh
CNCN-101223417-BB25 Apr 201211 May 2006granted用于确定和校正陆上运输工具中的惯性测量单元的传感器的错误定向和偏差的方法zh
WOWO-2007009825-A1A125 Jan 200711 May 2006publishedProcede pour determiner et corriger des mauvaises orientations et des decalages des capteurs d'un mesureur inertiel dans un vehicule routierfr
›Other offices — 2 members
OfficePublicationKindPublishedFiledStatusTitle
DEDE-102005033237-A1A125 Jan 200715 Jul 2005publishedVerfahren zur Bestimmung und Korrektur von Fehlorientierungen und Offsets der Sensoren einer Inertial Measurement Unit in einem Landfahrzeugde
DEDE-102005033237-B4B420 Sep 200715 Jul 2005grantedVerfahren zur Bestimmung und Korrektur von Fehlorientierungen und Offsets der Sensoren einer Inertial Measurement Unit in einem Landfahrzeugde

Validity challenges

See the validity challenges on record — reexaminations, IPRs and PGRs, with their institution decisions and outcomes.

Log in to unlock

Citations

See every patent this one cites and every patent that cites it back — publication, assignee, and how each one was found.

Log in to unlock