METHOD FOR COMPENSATING FOR AN INCLINATION

Information

  • Patent Application
  • 20180037082
  • Publication Number
    20180037082
  • Date Filed
    January 14, 2016
    8 years ago
  • Date Published
    February 08, 2018
    6 years ago
Abstract
A method for compensating for an inclination of a vehicle in at least one spatial direction. The vehicle has a vehicle body and an active chassis with a plurality of wheels, which are in contact with the roadway. Each wheel is joined to the vehicle body by way of an actuator, which can be adjusted in terms of its length, at a suspension point associated with the wheel. An inclination of the vehicle body in the at least one spatial direction is determined. For at least two wheels, respectively, a vertical distance to the suspension point of the vehicle body that is associated with the particular wheel is detected. Via the at least two determined distances, an inclination of the chassis in the at least one spatial direction is calculated by transformation of the vertical distance of the at least two wheels to the vehicle body.
Description

The invention relates to a method and a system for compensating for an inclination of a body of a vehicle.


The position of a vehicle changes during travel as a function of the inclination or position of a road that is traveled by the vehicle. Angles for registering the position of the vehicle can be recorded by sensors.


A method for controlling a system of a vehicle is described in the published document DE 10 2006 026 937 A1. A stability index is determined in this publication. Moreover, a first and a second observer are provided, who, on the basis of operating variables of the vehicle, determine a reference lateral speed as well as a lateral speed, from which an initial lateral speed as well as an initial longitudinal speed are determined.


A method for determining a target value for the curve inclination of a vehicle, when a curved section of a roadway is traveled, is known from the published document DE 10 2012 024 984 A1. The target value of the curve inclination of the vehicle is thereby determined as a function of a detected curvature of the roadway. Moreover, an optical surface condition of the curved section of the roadway is taken into account.


A method for the processing of sensor data in a vehicle is described in the published document DE 10 2012 216 205 A1, wherein vehicle dynamics and chassis sensor data of the vehicle are detected and filtered.


In addition, a method for identifying a downgrade or upgrade slope situation for a vehicle is known from the published document DE 10 2004 019 928 A1.


Against this background, a method and a system with the features of the independent patent claims are proposed. Embodiments of the method and the system ensue from the dependent patent claims and from the description.


The method according to the invention is provided for compensating for an inclination of a vehicle, which travels an inclined roadway, in at least one spatial direction. The vehicle has a vehicle body and an active chassis with a plurality of wheels that are in contact with the roadway. Each wheel is joined to the vehicle body via an actuator, which can be adjusted in the vertical direction in terms of its length in relation to the vehicle body, at a suspension point associated with the wheel. In the method, first of all, an inclination of the vehicle body in the at least one spatial direction is determined, wherein, for at least two wheels, a vertical distance to the suspension point associated with the respective wheel of the vehicle body is recorded in each instance. By way of the determined distances, an inclination of the chassis in the at least one spatial direction is calculated by transformation of the vertical distance of the at least two wheels to the vehicle body by using a transformation matrix:






T
=

[




l
v




l
v




-

l
h





-

l
h







t
v




-

t
v





t
h




-

t
h





]





Moreover, the inclination of the roadway in the at least one spatial direction is determined from a difference of the inclination of the vehicle body in the at least one spatial direction and the inclination of the chassis in the at least one spatial direction. Based on this, a value is determined in each instance for at least one angle φs as an angle of roll and/or θs as an angle of pitch, by which the roadway is inclined in the at least one spatial direction. Furthermore, a limit value φs,lim, θs,lim, respectively, for the value of the at least one angle φs, θs, is predetermined. In addition to this, translation ratios iVA, iHA for a distance of the at least one actuator in relation to the vehicle body and for a distance of the at least one wheel in relation to the vehicle body are taken into account. A target value for a change in the length of the at least one actuator for compensating for the inclination is determined by:








z
act



=


diag


(


i
VA

,

i
VA

,

i
HA

,

i
HA


)





T
T



[




φ

s
,
lim







θ

s
,
lim





]







The inclination of the chassis in the at least one spatial direction is determined by transformation of the vertical distances of the at least two wheels to the vehicle body by using the transformation matrix:






T
=

[




l
v




l
v




-

l
h





-

l
h







t
v




-

t
v





t
h




-

t
h





]





A front, longitudinal length lv hereby defines a distance of a particular front wheel from a center of gravity of the vehicle body in the longitudinal spatial direction. A rear, longitudinal length lh gives the distance of a particular rear wheel from the center of gravity in the longitudinal spatial direction. A front, transverse length tv gives the distance of the particular front wheel from the center of gravity in the transverse spatial direction. A rear, transverse length to gives the distance of the particular rear wheel from the center of gravity in the transverse spatial direction.


In the design, the translation ratios iVA, iHA are calculated by way of a usually constant, measureable distance of a respective actuator from the center of gravity of the vehicle body and of a particular wheel from the center of gravity of the vehicle body. In the process, the lengths lv, lh, tv, and th are to be taken into account for distances of the wheels.


Usually or in accordance with definition, a negative angle of pitch θs is determined for the presence of an upward slope travel and a positive angle of pitch θs is determined for the presence of a downward slope travel.


The respective limit value φs,lim, θs,lim for the value of the at least one angle φs, θs of the inclination of the roadway is predetermined in the case of the angle of inclination by:







φ

s
,
lim


=

{






φ

s
,
max







if






φ
s


>

φ

s
,
max










φ

s
,
min







if






φ
s


<

φ

s
,
min








otherwise






φ
s










and in the case of the angle of pitch by:







θ

s
,
lim


=

{






θ

s
,
max







if






θ
s


>

θ

s
,
max










θ

s
,
min







if






θ
s


<

θ

s
,
min








otherwise






θ
s










As a rule, a value of θs,min in the case of upward slope travel is chosen to be greater than a value of θs,max in the case of downward slope travel.


In the scope of the method, for the determination of the inclination of the vehicle body, a first coordinate system that is fixed relative to the vehicle body is used, and, for the determination of the inclination of the chassis, a second, chassis-fixed coordinate system is used. A third, inertial coordinate system is used as a reference coordinate system, which is defined in relation to the force of gravity.


In the design, the inclination of the vehicle body in relation to the reference coordinate system is described via a quaternion.


Moreover, it is possible to use a strapdown algorithm, with which it is provided that, for the determination of a corrected acceleration of the vehicle, an acceleration measured by sensor is corrected by a centrifugal acceleration and by the gravitational acceleration. A velocity of the vehicle on a planar surface is determined from this and the inclination of the vehicle body is calculated.


The system according to the invention is designed for compensating for an inclination of a vehicle that travels on an inclined roadway in at least one spatial direction. The vehicle has a vehicle body and an active chassis with a plurality of, usually four, wheels, which are in contact with the roadway. The system has a plurality of sensors and a control unit. Each wheel is joined to the vehicle body via an actuator, which can be adjusted in terms of its length, at a suspension point associated with the wheel. At least one first sensor is designed for the purpose of determining an inclination of the vehicle body in the at least one spatial direction. At least one second sensor is designed for the purpose of recording, for at least two wheels, a vertical distance to the suspension point associated with the respective wheel of the vehicle body. The control unit is designed for the purpose of calculating, via determined distances of the at least two wheels, an inclination of the chassis in the at least one spatial direction by transformation of the vertical distance of the at least two wheels to the vehicle body by using a transformation matrix:






T
=

[




l
v




l
v




-

l
h





-

l
h







t
v




-

t
v





t
h




-

t
h





]





Moreover, the control unit is designed for the purpose of determining the inclination of the roadway in the at least one spatial direction from a difference of the inclination of the vehicle body in the at least one spatial direction and the inclination of the chassis in the at least one spatial direction and of determining, in each instance, a value for at least one angle φs, θs by which the roadway is inclined in the at least one spatial direction. In addition, it is provided that, in each instance, a limit value φs,lim, θs,lim for the value of the at least one angle φs, θs is predetermined. The control unit is, in addition, designed for the purpose of taking into account translation ratios iVA, iHA for a distance of the at least one actuator in relation to the vehicle body and for a distance of the at least one wheel in relation to the vehicle body. Furthermore, the control unit is designed for the purpose of determining a target value for a change in a length of the at least one actuator by way of:








z
act



=


diag


(


i
VA

,

i
VA

,

i
HA

,

i
HA


)





T
T



[




φ

s
,
lim







θ

s
,
lim





]







The at least one second sensor is designed as a distance sensor, by means of which a distance of a particular wheel to the vehicle body is to be determined. In an embodiment, the actuators, which can be adjusted in terms of their length, are also designed as components of the system.


By means of the method and the system, it is possible to achieve a check and accordingly a regulation and/or control of the horizontal leveling or of the horizontal alignment of the vehicle body of the vehicle for upward slope travel as well as for downward slope travel on a roadway to be traveled, but also when a lateral inclination of the roadway exists. In accordance therewith, lengths of the actuators of the active chassis of the vehicle are adjusted by the target values and compensated for by alignment of the inclination of the vehicle body to {right arrow over (zact)} the inclination of the roadway. In the process, it needs to be identified, first of all, whether the vehicle is traveling on an upward slope and accordingly on an uphill oriented roadway or else on a downward slope and accordingly on a downhill oriented roadway. Based on this, an action for horizontal alignment of the vehicle body is taken, wherein, in the case of upward slope travel at a negative angle of pitch, a stronger horizontal alignment of the vehicle body is made than in the case downward slope travel at a positive angle of pitch. Accordingly, in the case of downward slope travel, the inclination of the roadway is to be compensated for to a lesser extent than in the case of upward slope travel.


In the case of an upward slope, the vehicle is raised at the rear by the actuators and lowered at the front, as a result of which a better view and an increased comfort is achieved for occupants of the vehicle. In contrast to this, in the case of downward slope travel, the vehicle is raised at the front by the actuators and lowered at the rear, usually to a lesser extent, however, than in the case upward slope travel in order not to impair the view of the occupants and in order to ensure a ground clearance of the vehicle during a transition from upward slope travel or downward slope travel to the horizontally oriented roadway. Accordingly, the occupants of the vehicle can sit up straighter and, in the case of inclined roadways, need to support themselves less strongly in the cabin of the vehicle. Usually, the view for the driver is markedly improved.


In the scope of the method, the angle of pitch and/or the angle of roll of the vehicle body of the vehicle in relation to the inertial coordinate system is estimated. At least one of these angles gives the inclination of the vehicle body in relation to the horizontal, which is defined via the axes in the spatial directions xref, yref, zref of the inertial coordinate system. Via the distance sensors, such as, for example, the wheel deflection sensors, the angle of the roadway in the direction of pitch and roll of the vehicle is determined—usually calculated—from the angles of the vehicle body in the inertial coordinate system. On the basis of the value and sign of the respective angle, it is identified whether the vehicle is situated on a slope and whether what is involved is upward slope travel or downward slope travel.


A negative angle of pitch indicates upward slope travel, whereas a positive angle of pitch indicates downward slope travel. The determined angle of pitch of the vehicle body is converted into a feedforward control, wherein, when there is a positive angle of pitch, the two front actuators of the chassis are extended and the two rear actuators retracted. In contrast to this, when a negative angle of pitch is identified, the front actuators of the chassis are retracted and the two rear actuators are extended.


In order to achieve that, in the case of downward slope travel, the vehicle body is not aligned so strongly horizontally, the calculated angle of pitch in the inertial system is limited, so that, for the angle of pitch for correction or compensation of the inclination of the vehicle body, no negative values that are too large are obtained as result for the angle of pitch and, accordingly, no horizontal alignment that is too strong ensues during downward slope travel or downgrade travel.


The mentioned procedures are to be implemented for forward drive of the vehicle. For reverse drive, either no alignment of the vehicle body or at most a horizontal alignment of the vehicle body or a reverse change of a length of the actuators in relation to forward drive is provided. If upward slope travel in reverse is to be carried out, a stronger horizontal alignment is implemented. If downward slope travel in reverse is to be carried out, only a minor horizontal alignment needs to be achieved in order to afford the occupants a good view.


Additionally or alternatively, in an embodiment, in the case of a horizontal alignment of the vehicle body for upward or downward slope travel, a horizontal alignment is implemented when there is lateral inclination of the roadway. In accordance therewith, for compensation of an inclination of the vehicle body in relation to the inertial coordinate system, an adjustment of the respective lengths of the actuators is to be combined with consideration of an angle of pitch and angle of roll. For compensation of a lateral inclination as inclination in terms of an angle of roll, the procedure to be followed is analogous to the case of the angle of pitch. In accordance therewith, a feedforward control for the actuators is calculated from the angle of roll in relation to the inertial coordinate system, with no distinction being made between a lateral inclination to the left or to the right. In this case, a value of θs,max is usually just as large as a value of θs,min.


Regardless of which angle, that is, the angle of pitch and/or the angle of roll, in which direction is taken into account, a compensation for the inclination of the roadway is to be implemented with the active chassis.


In a possible implementation of the method, a respective angle and accordingly the angle of pitch and/or the angle of roll of the vehicle, usually of the vehicle body of the vehicle, are or is determined in relation to the inertial coordinate system in the direction of pitch and/or in the direction of roll and differentiated via the sign of the angle between upward slope travel and downward slope travel or, for a roadway inclined in the lateral inclination direction, between an inclination to the left or to the right. In the process, it is also possible to compensate for the direction of pitch and the direction of roll in combination. Any possibly existing inclination of the vehicle body is to be compensated for in relation to the inertial coordinate system and accordingly in relation to a horizontal plane, which is aligned and/or defined via the Earth's field of gravity.


In the scope of the method, in order to align the vehicle body of the vehicle to the horizontal—or horizontally—it is not absolutely essential to align said vehicle body exactly parallel to the horizon. A measure of a horizontal alignment that needs to be made is to be determined in the embodiment in an applicable manner and hence defined. A measure of this kind is to be chosen depending, for example to 50%, on an initial position of the vehicle body parallel to the horizon. The measure for the inclination can be adjusted via the limit values φs,lim, θs,lim.


Further advantages and embodiments of the invention ensue from the description and the appended drawings.


It is obvious that the features mentioned above and to be discussed below can be used not only in the combination given in each instance, but also in other combinations or alone, without departing from the scope of the present invention.





The invention is illustrated schematically in the drawings on the basis of embodiments and will be described schematically and in detail with reference to the drawings.



FIG. 1 shows, in schematic illustration, an example for a vehicle with an embodiment of the system according to the invention.



FIG. 2 shows a diagram relating to an embodiment of the method according to the invention.



FIG. 3 shows, in schematic illustration, a detail of the vehicle from FIG. 1.



FIG. 4 shows the vehicle from FIG. 1 for different variants of the embodiment of the method according to the invention.





The figures are described in a coherent and overall manner, where identical reference numbers refer to the same components.


Illustrated schematically in FIG. 1 are a vehicle 2, constructed as a vehicle, and a roadway 4, constructed as a street, on which the vehicle 2 moves when traveling. In this case, the vehicle 2 comprises a vehicle body 6 and four wheels 8, 10, which are provided for locomotion of the vehicle 2 and of which only a front left wheel 8 and a rear left wheel 10 are shown in FIG. 1. Each wheel 8, 10 is joined to the vehicle body 6 via at least one active actuator 12, 14, wherein the wheels 8, 10 and the actuators 12, 14 are designed as components of an active chassis of the vehicle 2.


The embodiment of the system according to the invention 16 comprises, as components, a control unit 18, at least one first sensor 19 for determination of the inclination of the vehicle body 6, and a plurality of—in this case, four—second sensors, designed as distance sensors 20, 22, only two of which are illustrated in FIG. 1, wherein a distance sensor 20, 22 of this kind is associated with each wheel 8, 10. The at least one first sensor 19 and the distance sensors 20, 22 are designed, at the same time, as components of a sensor arrangement of the system 16. Furthermore, the sensor arrangement and accordingly the system 16 comprise sensors, which are not illustrated further, for determination—as a rule, for measurement—of at least one kinetic variable, usually a velocity and/or acceleration, of the vehicle 2 and/or of the vehicle body 6.


The embodiment of the method according to the invention described below on the basis of, among other things, the diagram of FIG. 2 is to be implemented with the embodiment of the system according to the invention 16 illustrated schematically in FIG. 1, wherein steps of the embodiment of the method are to be checked by the control unit 18 and accordingly controlled and/or regulated.


Moreover, three coordinate systems 24, 26, 28 as well as diverse—in this case, geometric—parameters are illustrated in FIG. 1.


In this case, a first, vehicle body-fixed coordinate system 24 is associated with the vehicle body 6 of the vehicle 2, with its origin lying at the center of gravity 25 of the vehicle body 6. The first coordinate system 24 comprises a first axis in the spatial direction xa, which is oriented longitudinally to the vehicle body 6 as well as parallel to a direction of travel of the vehicle 2. A second axis is oriented in the spatial direction ya transversely to the vehicle body 6 as well as parallel to the axes of the vehicle 2 that extend between each two wheels 8, 10 of the vehicle 2. A third axis is oriented in the spatial direction za parallel to a vertical axis of the vehicle body 6. All three mentioned axes and accordingly spatial directions xa, ya, za are oriented perpendicularly to one another. In this case, it is provided in an embodiment that the two first-mentioned axes and accordingly the spatial directions xa and ya span a horizontal plane of the vehicle 2 in which the center of gravity 25 lies.


Furthermore, FIG. 1 shows two examples of vertically oriented distances dza,VL, dza,HL. A first distance dza,VL relates to a distance between the front left wheel 8 and the vehicle body 6. A second distance dza,HL relates to a distance between the rear left wheel 10 and the vehicle body 6. These distances dza,VL dza,HL are oriented along the actuators 12, 14 and are recorded by the distance sensors 20, 22 associated with the wheels 8, 10.


The distances of the wheels 8, 10 from the center of gravity 25 of the vehicle body 6 in a plane parallel to the horizontal plane are to be defined here via the lengths or side lengths tv, th, lh, lv. In this case, for the front left wheel 8, a front, transverse length tv, which gives the distance of the wheel 8 from the center of gravity 25 in the transverse spatial direction, and a front, longitudinal length lv, which gives the distance of the wheel 8 from the center of gravity 25 in the longitudinal spatial direction, are to be taken into account. For the rear left wheel 10, a rear, transverse length th, which gives the distance of the wheel 10 from the center of gravity 25 in the transverse spatial direction, and a rear, longitudinal length lh, which gives the distance of the wheel 10 from the center of gravity 25 in the longitudinal spatial direction, are to be taken into account.


A further vertically oriented distance dza,VR relates to a distance between a front right wheel, which is not shown here, and the vehicle body 6. An additional distance dza,HR in vertical direction relates to a distance between a rear right wheel, which is not shown here, and the vehicle body 6. The described distances dza,VL, dza,HL, dza,VR, dza,HR or distances between the wheels 8, 10 and the vehicle body 6 are given in the embodiment in relation to the horizontal plane, in which the center of gravity 25 lies.


Furthermore, for the front right wheel, the first, transverse length tv, which gives the distance of the front right wheel from the center of gravity 25 in the transverse spatial direction, and the front, longitudinal length lv, which gives the distance of the front right wheel from the center of gravity 25 in the longitudinal spatial direction, are to be taken into account. For the rear right wheel, the rear, transverse length th, which gives the distance of this wheel from the center of gravity 25 in the transverse spatial direction, and the rear, longitudinal length lh, which gives the distance of the rear right wheel from the center of gravity 25 in the longitudinal spatial direction, are to be taken into account, wherein, in FIG. 1, the rear, transverse length that is to be taken into account for the rear right wheel is not drawn.


A second, chassis-fixed coordinate system 26 is associated with the roadway 4 and comprises a first axis in the spatial direction xs parallel to an intended direction of travel or longitudinal direction of the roadway 4, a second axis in the spatial direction ys, which is oriented parallel to a lateral direction of the roadway 4, and a third axis in the spatial direction zs, wherein all mentioned axes are oriented perpendicularly to one another. An inclination and accordingly a position of the roadway 4 is to be defined here on the basis of a lateral angle or angle of roll φs, which defines an inclination of the roadway 4 in the lateral direction, and on the basis of a longitudinal angle or angle of pitch θs, which defines an inclination of the roadway 4 in the longitudinal direction and accordingly, for example, an upgrade or a downgrade.


A third coordinate system 28 is designed as a reference coordinate system and comprises a first axis in the spatial direction xref, a second axis in the spatial direction yref, and a third axis in the spatial direction zref, which are all oriented perpendicularly to one another.


Shown, moreover, are, for the first coordinate system 24, an angle of roll φa, which defines a rotation of the vehicle body 6 around the first axis oriented in the spatial direction xa, an angle of pitch θa, which defines a rotation of the vehicle body 6 around the second axis in the spatial direction ya, and an heading angle ψa, which defines a rotation of the vehicle body 6 around the third axis oriented in the spatial direction za.


The first coordinate system 24 [xa, ya, za], which is fixed to the vehicle body at the center of gravity 25 of the vehicle body 6 of the vehicle 2 follows translational and rotational movements of the vehicle body 6. The third, inertial coordinate system 28 [xref, yref, zref] is employed as a reference coordinate system, wherein it is taken into account that the gravitational acceleration g acts exclusively in the spatial direction zref parallel to a gravitational vector.


In an embodiment of the method, for estimation of an inclination or a position of the vehicle body 6, the angle of pitch θa and the angle of roll φa are given in relation to the third coordinate system 28, designed as a reference coordinate system.


The angles [θa, φa, ψa] enclosed between the coordinate system 24 fixed to the vehicle body and the reference system or inertial coordinate systems 28 are also referred to as the inertial angle of pitch θa, the inertial angle of roll φa, and the inertial heading angle ψa. The orientation thereof in the direction of pitch and direction of roll is referred to as the inclination of the vehicle body 6, from which the angle of pitch θa and the angle of roll φa are determined.


In order to be able to estimate the inclination or position of the vehicle body 6, the acceleration {right arrow over (a)}=[{umlaut over (x)}a, ÿa, {umlaut over (z)}a]T of the vehicle body 6 or of the vehicle 2 along the spatial directions xa, ya, za and the rates of rotation {right arrow over (ω)}=[{dot over (ψ)}a, {dot over (φ)}a, {dot over (Θ)}a]T are measured and accordingly determined by using the sensor arrangement for determination of the inertia with six degrees of freedom (IMU, inertial measurement unit), wherein the sensor arrangement can also be employed independently of the implementation of the method in the vehicle 2.


For estimation of the inclination of the vehicle body 6, it needs to be taken into account, first of all, which physical boundary conditions are to be applied to the variables {right arrow over (a)} and {right arrow over (ω)} that are to be determined by the sensor arrangement, for example, by way of measurement. From measurement signals of acceleration sensors of the sensor arrangement, three different physical variables are derived:

    • the centrifugal acceleration {right arrow over (azf)}, which depends on the rates of rotation {right arrow over (ω)} and the planar velocity {right arrow over (vplane)}=[vplane,x,vplane,y,vplane,z]T of the vehicle 2:





{right arrow over (azf)}={right arrow over (ω)}×{right arrow over (vplane)}  (3)

    • the change in the adjusted, planar velocity {right arrow over (vplane)} and accordingly acceleration {right arrow over (avp)} of the vehicle 2 and/or of the vehicle body 6 in the spatial direction of an axis of a respective acceleration sensor in the horizontal plane of the vehicle:





{right arrow over (avp)}=R{right arrow over ({dot over (v)}plane)}  (4)





the gravitational acceleration {right arrow over (agv)}=R[0,0,−g]T  (5)


In the above formulas, {right arrow over (vplane)} is the velocity of the vehicle 2 in the horizontal plane and R is Euler's rotation matrix (6), which is calculated taking into consideration Euler's angle in a rotation sequence of the angle of roll φ, the angle of pitch θ, and the heading angle ψ. In this case, vplane,x is the conventional velocity of the vehicle vVehicle in the longitudinal direction or direction of travel of the vehicle 2, which is measured via a rotational velocity of the wheels 8, 10 and displayed on the tachometer.









R
=

(




cos





θ





cos





ψ




cos





θ





sin





ψ





-
sin






θ







sin





φsin





θ





cos





ψ

-

cos





φsin





ψ






sin





φsin





θ





sin





ψ

+

cos





φcos





ψ





sin





φcos





θ







cos





φsin





θ





cos





ψ

+

sin





φsin





ψ






cos





φsin





θ





cos





ψ

-

sin





φcos





ψ





cos





φcos





θ




)





(
6
)







The angle φ that is to be determined respectively, that is, φa (for the vehicle body), φf (for the chassis), or φs (for the roadway), and θ, that is, θa (for the vehicle body), θf (for the chassis), or θs (for the roadway), can usually be determined via two different methods of calculation or calculational approaches:

    • by time integration of the rates of rotation {right arrow over (ω)} measured by the sensor arrangement or
    • by elimination of the centrifugal acceleration {right arrow over (azf)} and the change in the planar velocity {right arrow over (vplane)} and accordingly the acceleration {right arrow over (avp)} of the vehicle 2 from the accelerations measured by the sensor arrangement, {right arrow over (agv)}={right arrow over (a)}−{right arrow over (azf)}−{right arrow over (avp)}, and calculation of the angles via trigonometric functions








θ
a

=

atan




a
gv

,
x



a
gv

,
z




,


φ
a

=

atan





a
gv

,
y



a
gv

,
z


.







As already indicated on the basis of Equation (5), {right arrow over (agv)} is a vector with the three elements [agv,x, agv,y, agv,z]T=[g*sin θ, −g*sin φ*cos θ, −g*cos φ*cos θ]T, where, in contrast, the gravitational acceleration g=9, 81 m/s2 is used in this case as a scalar, which, depending on the inclination of the vehicle body 6, which is described by Euler's rotation matrix R (6), acts on different elements of the vector {right arrow over (agv)}. If the vehicle body 6 is not inclined, then {right arrow over (agv)}=[0,0, −g]T. For an angle of roll φa=90° and an angle of pitch θa=0°, {right arrow over (agv)}=[0, −g, 0]T. If {right arrow over (agv)} is known, then the angle of pitch θa and the angle of roll φa can be calculated via the above-described atan functions.


However, it needs to be taken into account for the calculations that are to be carried out that, on account of time-variable offset errors of rates of rotation sensors, an integration of the rates of rotation in a stationary manner is not precise under circumstances. This means that calculated angles exhibit a low-frequency drift and only high-frequency portions of measurement signals can be used. In contrast to this, high-frequency interferences need to be taken into account for angles determined via acceleration sensors, because changes in velocity that are difficult to record, which occur, for example, during travel over potholes cannot be eliminated from the measurement signals.


In the embodiment described here, an inclination filter or position filter based on quaternions is used as filter algorithm. It is equally possible to employ a Kalman filter for merging the two methods of calculation. In this way, the two above-mentioned methods of calculation are combined, as a result of which a signal that can be used at both low frequencies and high frequencies is provided.


A quaternion is a four-dimensional vector {right arrow over (q)}=[q1, q2, q3, q4]T, via which the orientation of a rigid body—in this case, the body of the vehicle body 6—is to be described. If a rigid body is rotated in relation to a reference system by the angle χ around the axis {right arrow over (r)}=[rx, ry, rz]T, wherein {right arrow over (r)} is a unit vector, then this orientation is defined in relation to the reference system by the quaternion {right arrow over (q)}=








[


cos


χ
2


,


-

r
x



sin


χ
2


,


-

r
y



sin


χ
2


,


-

r
z



sin


χ
2



]

T

.




This is utilized, first of all, for the time integration of the rates of rotation {right arrow over (ω)} measured by the sensor arrangement, wherein the vehicle body 6 is rotated in relation to the inertial reference system at, in the present case, the rate of rotation {right arrow over (ω)}=[ωx, ωy, ωz]T. Starting from an initial position {right arrow over (qL)} of the vehicle body 6, the change in the position or inclination on account of the rates of rotation is defined by Equation (7):





{right arrow over ({dot over (q)}ω)}=½{right arrow over (qL)}custom-character[0,ωxyz]  (7)


Here, the operator custom-character symbolizes a quaternion multiplication. In a time-discrete case, it is necessary to solve a resulting differential equation, for example, by an Euler integration (8):





{right arrow over (qω,k)}={right arrow over (qL,k-1)}+{right arrow over ({dot over (q)}ω)}Δt  (8)


wherein Δt corresponds to a step width between two points in time k and k−1.


In order to define an orientation of the vehicle body 6 from the acceleration a measured by the sensor arrangement and the resulting, adjusted gravitational acceleration agv=[agv,x,agv,y,agv,z]T=[g*sin θ, −g*sin φ*cos θ, −g*cos φ*cos θ]T with quaternions, the following optimization problem (9) needs to be solved:












q
a



=


min


q
L




4






f




(



q
L



,


a
gv




)









with








f




(



q
L



,


a
gv




)


=

[





2


(



q

L
,
2




q

a
,
4



-


q

L
,
1




q

L
,
3




)


-

a

gv
,
x









2


(



q

L
,
1




q

L
,
2



-


q

L
,
3




q

L
,
4




)


-

a

gv
,
y









2


(

0
,

5
-

q

L
,
2

2

-

q

L
,
3

2



)


-

a

gv
,
z






]






(
9
)







A direct calculation of the inclination is not possible, because an infinite number of solutions exist around an axis of rotation that is oriented parallel with respect to the gravitational vector. Used for time-discrete solution of the optimization problem is a gradient-based approach (10):











q

a
,
k




=



q

L
,

k
-
1





-

μ



V



f




(



q

L
,

k
-
1





,


a
gv




)










f




(



q

L
,

k
-
1





,


a
gv




)












(
10
)







with an adjustable step width μ.


In order to merge information about the inclination that results from the measured rates of rotation {right arrow over (qω,k)} and from the accelerations {right arrow over (qa,k)}, the two quaternions {right arrow over (qa,k)}, {right arrow over (qL,k)} are added in a weighted manner by Equation (11):





{right arrow over (qL,k)}=γ{right arrow over (qa,k)}+(1−γ){right arrow over (qω,k)}  (11)


where 0≦γ≦1 is an adjustable parameter. The angle of pitch and the angle of roll are then calculated with Equations (12a), (12b):










θ

a
,
k


=

-


sin

-
1




(


2


q

L
,
k
,
2




q

L
,
k
,
4



+


q

L
,
k
,
1




q

L
,
k
,
3




)







(

12

a

)







φ

a
,
k


=

atan


(



2


q

L
,
k
,
3




q

L
,
k
,
4



-

2


q

L
,
k
,
1




q

L
,
k
,
2






2


q

L
,
k
,
1

2


+

2


q

L
,
k
,
4

2


-
1


)






(

12

b

)







For elimination of the centrifugal acceleration {right arrow over (azf)} and the change {right arrow over (avp)} in the planar velocity {right arrow over (vplane)} from the accelerations measured by the sensor arrangement, the angles of pitch and the angles of roll are to be taken into account, which, in turn, are calculated by use of the gravitational acceleration vector {right arrow over (agv)}.


For implementation of the embodiment of the method, a so-called strapdown approach is used, which is illustrated in the diagram in FIG. 2. Individual steps 40, 42, 44, 46, 48 of the method will be described below in detail.


At the start of the method, values of the acceleration {right arrow over (a)} and the rate of rotation {right arrow over (ω)} determined by sensor are provided. These values are used in a first step 40 to carry out a “correction of the centrifugal force,” wherein the accelerations measured by the sensor arrangement are corrected by the contribution of the centrifugal force {right arrow over (azf)}={right arrow over (ω)}×{right arrow over (vplane)}. In this case, a first corrected acceleration {right arrow over (a)}−{right arrow over (azf)} is determined. This first corrected acceleration {right arrow over (a)}−{right arrow over (azf)} is corrected, taking into consideration values for the angle of roll φa and the angle of pitch θa, in a second step 42 with implementation of a “correction of the force of gravity” by use of the gravitational acceleration as a result of which the acceleration in the horizontal plane is obtained.


In the scope of the method, two possibilities for calculating the planar velocity {right arrow over (vplane)} are provided.


A “determination of the velocities” is carried out in a third step 44 taking into consideration the acceleration {right arrow over (avp)} of the vehicle 2, the measured velocity v of the vehicle 2, and the steering angle δsteer thereof, wherein the first planar velocity of the vehicle {right arrow over (vInt)}, [vInt,x,vInt,y,vInt,z]T is determined by integration (13):





{right arrow over (vInt)}=∫{right arrow over (avp)}dt  (13)


and the acceleration {right arrow over (avp)} the vehicle 2 is calculated and accordingly determined. This planar velocity {right arrow over (vInt)} is used, in turn, in a closed control loop for “correction of the centrifugal force” in the first step 40.


For the velocity vplane,x in the spatial direction of a longitudinal axis of the vehicle 2, the velocity vVehicle, measured via the rotational speeds of the wheels in the direction xa of the vehicle 2, is available. By further using a single-lane model, it is further possible to calculate an effective velocity vy,ESM in relation to the lateral axis of the vehicle from the steering angle δsteer and the measured velocity vVehicle. For the vertical velocity vplane,z, no further methods of measurement or calculation are available. The alternatively determined second planar velocity of the vehicle (14):





{right arrow over (valt)}=[vVehicle,vy,ESM,0]T  (14)


and the velocity {right arrow over (vInt)} calculated by integration (13) can be merged by a suitable filter algorithm, such as, for example, by a Kalman filter (15), via a calculation procedure that comprises a weighting factor τ:





{right arrow over (vplane)}=τ{right arrow over (vInt)}+(1−τ){right arrow over (valt)} with 0≦τ≦1  (15)


In a fourth step 46 for the “correction of the planar velocity change,” values of the measured velocity vVehicle, the steering angles δsteer, the angle θa, φa, and the acceleration {right arrow over (a)}−{right arrow over (azf)}, corrected by the centrifugal acceleration {right arrow over (azf)}, are taken into account, wherein the corrected acceleration is corrected by the contribution of the change in the planar velocity {right arrow over (avp,alt)}=R{right arrow over ({dot over (v)}alt)}. In order to prevent a negative feedback, the derivative of a vector of the velocity {right arrow over (valt)} is used instead of the velocity {right arrow over (vplane)} determined in accordance with the calculation procedure (15).


In a fifth step 48, taking into consideration the rate of rotation ω and the gravitational acceleration {right arrow over (agv)} of the vehicle 2, the angle of pitch θa as well as the angle of roll φa and accordingly the inclination or position of the vehicle body 6 of the vehicle 2 are calculated by using the above-described inclination filter based on quaternions. Via the above-described procedure, the angle of pitch θa and the angle of roll φa are determined in relation to the inertial coordinate system 28 and used in a closed control loop for the “correction of the force of gravity” in the second step 42 as well as for the “correction of the planar velocity change” in the third step 44.


Starting from the inclination of the vehicle body 6 determined in the fifth step 48, the inclination and accordingly the position of the roadway 4 are determined, wherein the distances {right arrow over (dza)}=[dza,VL, dza,VR, dza,HL, dza,HR]T between the wheels 8, 10 and the vehicle body 6 are employed as measured variables, as a result of which, first of all, the angle of pitch θf and the angle of roll φf of the chassis of the vehicle 2 are calculated, wherein a calculation to be carried out depends on a transformation matrix (16):









T
=

[




l
v




l
v




-

l
h





-

l
h







t
v




-

t
v





t
h




-

t
h





]





(
16
)







where a geometric position of the center of gravity 25 will be or is defined in relation to the positions of the wheels 8, 10. In this case, the first column gives the distance of the front left wheel 8, the second column gives the distance of the front right wheel, the third column gives the distance of the rear left wheel 10, and the fourth column gives the distance of the rear right wheel from the center of gravity 25 within the horizontal plane.


The inclination of the chassis is then determined via the vectorial relation (17):










[




φ
f






θ
f




]

=

T



dz
a








(
17
)







By subtraction of the inclination of the chassis from the inclination of the vehicle body 6, the inclination of the roadway 4 in relation to the first coordinate system 24 fixed to the vehicle body is calculated via the vectorial relation (18):










[




φ
s






θ
s




]

=


[




Φ
a






θ
a




]

-

[




φ
f






θ
f




]






(
18
)







Because any deflection of the wheels 8, 10 is very small in comparison to the distance that is to be taken into account, said wheel deflection is ignored in the above calculation.


Because the angles φa and θa are estimated values for the inclination of the vehicle body 6 in relation to the vector and φf and θf define the relative angle between the vehicle body 6 and the surface of the roadway 4, φs and θs also provide angles as estimated variables for the inclination of the roadway 4 or street in relation to the gravitational vector.


For implementation of the method, a compensation of the inclination of the roadway 4 is to be applied to the active chassis of the vehicle 2 by correction of an inclination of the vehicle body 6 and, subsequently, the vehicle body 6 is to be aligned with the horizon or horizontally.


In this regard, it is to be predetermined on the basis of target values for a change in length of the actuators 12, 14 to what extent such a compensation of the inclination or a horizontal leveling of the vehicle body is to be done. In this way, through adjustment of respective lengths of the actuators 12, 14 to the target values during upward slope travel or uphill travel, a stronger horizontal leveling is to be provided in qualitative terms than for downward slope or downhill travel.


In the case of upward slope travel, the vehicle body 6 of the vehicle 2 is raised at the rear and lowered at the front, as a result of which a view of the occupants is to be improved and a comfort is to be increased. In the case of downward slope travel, the vehicle body 6 is raised at the front and lowered at the rear, although, in this case, in comparison to upward slope travel, a substantially lesser compensation of the inclination is to be done in order not to worsen the view of the occupants and in order to ensure a ground clearance of the vehicle body 6 during a transition from downward slope travel or downhill travel to the horizontal.


It is also conceivable to align the vehicle body 6 horizontally laterally to the direction of travel of the vehicle 2, wherein a compensation of the inclination of the vehicle body 6 in the lateral direction can also be limited by specifying target values in order to avoid driving situations in which, for example, a ground clearance might be limited.


For implementation of the method, the calculated angle of inclination of the roadway φs and θs is limited, first of all, by specifying target or limit values φs,lim, θs,lim:










φ

s
,
lim


=

{






φ

s
,
max







if






φ
s


>

φ

s
,
max










φ

s
,
min







if






φ
s


<

φ

s
,
min








otherwise






φ
s










(
19
)







θ

s
,
lim


=

{






θ

s
,
max







if






θ
s


>

θ

s
,
max










θ

s
,
min







if






θ
s


<

θ

s
,
min








otherwise






θ
s










(
20
)







Afterwards, the angles of inclination φs, θs are converted to target values {right arrow over (zact)}=[zact,VL, zact,VR, zact,HL, zact,HR]T for the change in length of the actuators 12, 14 of the active chassis. A conversion of the limited angle of pitch and angle of roll of the roadway 4 to the target values for lengths of the actuators 12, 14 is carried out by use of the transformation matrix T and by way of known translation ratios between actuator-related and wheel-related distances, iVA=








z

act
,
VL



dz

a
,
VL



=


z

act
,
VR



dz

a
,
VR








and






i
HA

=



z

act
,
HL



dz

a
,
HL



=


z

act
,
HR



dz

a
,
HR








for the front axle and the rear axle of the vehicle 2, as a result of which a diagonal matrix diag(iVA,iVA,iHA,iHA) is formed. In this case, the following relation with the transposed transformation matrix (16) is used for the actuator-related target values:











z
act



=



diag


(


i
VA

,

i
VA

,

i
HA

,

i
HA


)



T
T




[




φ

s
,

l

im








θ

s
,
lim





]






(
21
)







In the above formulas, the maximum or minimum angles φs,max, θs,max, φs,min, and θs,min are adjustable matching parameters or target values, which can be varied depending on the driving situation in each case.


In an applied example, the following initial values are predetermined:






i
VA
=i
HA=1; tv=th=0,5; lv=lh=1,5  (22)





φs,lim=1/180π; θs,lim=0  (23)


There results from this:





{right arrow over (zact)}=[0,026 0,026−0,026−0,026]T  (24)


This means that the front actuators 12 are moved 2.6 cm upwards and the rear actuators 14 are moved 2.6 cm downwards, wherein lengths of the respective actuators 12, 14 can be varied in accordance with the lengths given here.



FIG. 3 shows, in schematic illustration, a detail of the vehicle 2 in the area of the wheel 8 arranged at the front left, which, in this case, is joined via the actuator 12 associated with this wheel 8 at a suspension point 50 of the vehicle body 6 of the vehicle 2. Moreover, FIG. 3 shows the transverse distance tv of the wheel 8 from the center of gravity 25. Here, too, a transverse distance tv,act of the actuator 12 from the center of gravity 25 is indicated by a double arrow. A distance dza,VL of the wheel 8 to the vehicle body 6 as well as a distance zact,VL of the actuator 12 from the suspension point 50 of the vehicle body 6 are also illustrated here.


Accordingly, for the rear left wheel 10, the distance dza,HL thereof to the vehicle body as well as the distance thereof to from the center of gravity 25 are to be taken into account. For the actuator 14, which is associated with the rear left wheel 10, correspondingly a distance zact,HL to a suspension point of the vehicle body 6 as well as th,act from the center of gravity 25 are to be taken into account.


In FIG. 4a, the vehicle 2 is illustrated schematically for upward slope travel on the roadway 4, in FIG. 4b in the horizontal plane of the roadway 4, and in FIG. 4c for downward slope travel, wherein in all three FIGS. 4a, 4b, 4c, a direction of travel of the vehicle 2 forwards is indicated by an arrow 52. Moreover, in FIGS. 4a, 4b and 4c, a front right wheel 54 of the vehicle 2 and a rear right wheel 56 of the vehicle 2 are illustrated. In this case, it is provided that the front right wheel 54 is joined via an actuator 58 at a suspension point of the vehicle body 6 of the vehicle 2, whereas the rear right wheel 56 is joined via an actuator 60 at a suspension point of the vehicle body 6.


With reference to the illustration of FIG. 1 and/or FIG. 3, the front right wheel 54 exhibits the distance dza,VR to the vehicle body 6 and the distance tv from the center of gravity 25. The actuator 58 associated with the front right wheel 54 exhibits a distance zact,VR to the vehicle body 6 and a distance tv,act from the center of gravity 25 of the vehicle body. Accordingly, the rear right wheel 56 exhibits the distance dza,HR to the suspension point of the vehicle body 6 and the distance to from the center of gravity 25. The actuator 60 associated with the rear right wheel 56 exhibits a distance zact,HR to a suspension point of the vehicle body 6 and a distance th,act from the center of gravity 25 of the vehicle body 6.


Taking into consideration the above-described steps of the method according to the invention, the actuators 14, 60, which join the rear wheels 10, 56 at the rear axle of the vehicle 2 to the vehicle body 6 thereof, are lengthened by a greater distance for upward slope travel (FIG. 4a) in comparison to the two actuators 12, 58, which join the front wheels 8, 54 at the front axle of the vehicle 2 to the vehicle body 6 thereof. During a drive on a horizontally oriented roadway (FIG. 4b), the lengths of the actuators 12, 14, 58, 60 are adjusted to be equal in length. For downward slope travel, which is indicated on the basis of FIG. 4c, the actuators 12, 58, which join the two front wheels 8, 54 to the vehicle body 6 of the vehicle 2, are lengthened by a greater distance than the actuators 14, 60, which join the wheels 10, 56 of the rear axle of the vehicle 2 to the vehicle body 6 thereof. However, the lengthening of the actuators 12, 58 at the front axle in comparison to the actuators 14, 60 at the rear axle in the case of downward slope travel is less than the lengthening of the actuators 14, 60 in comparison to the actuators 12, 58 in the case of upward slope travel.

Claims
  • 1-11. (canceled)
  • 12. A method for compensating for an inclination of a vehicle in at least one spatial direction, comprising: wherein the vehicle has a vehicle body and an active chassis with a plurality of wheels, which are in contact with the roadway;wherein each wheel is joined to the vehicle body by an actuator, which can be adjusted in terms of its length, at a suspension point associated with the wheel;wherein an inclination of the vehicle body in the at least one spatial direction is determined, wherein, for at least two wheels, a respective vertical distance to the suspension point of the vehicle body associated with the particular wheel is detected;wherein, via the at least two determined distances, an inclination of the chassis in the at least one spatial direction is calculated by transformation of the vertical distance of the at least two wheels to the vehicle body by using a transformation matrix
  • 13. The method according to claim 12, wherein the inclination of the chassis in the at least one spatial direction is determined by transformation of the vertical distances of the at least two wheels from a center of gravity of the vehicle body by using the transformation matrix
  • 14. The method according to claim 13, wherein the translation ratios IVA, iHA are calculated by way of a distance of an actuator from the center of gravity of the vehicle body in each case, and of a wheel from the center of gravity of the vehicle body in each case.
  • 15. The method according to claim 12, wherein, in the presence of an upward slope travel, a negative angle of pitch θs is determined, and, in the presence of downward slope travel, a positive angle of pitch θs is determined.
  • 16. The method according to claim 12, wherein the respective limit value φs,lim, θs,lim for the value of the at least one angle φs, θs is predetermined by:
  • 17. The method according to claim 16, wherein a value of θs,min in the case of upward slope travel is chosen to be greater than a value of θs,max in the case of downward slope travel.
  • 18. The method according to claim 12, wherein, for the determination of the inclination of the vehicle body, a first, coordinate system that is fixed relative to the vehicle body is used, and, for the determination of the inclination of the chassis, a second chassis-fixed coordinate system is used, and wherein a third, inertial coordinate system is used as reference coordinate system, which is established in relation to the force of gravity.
  • 19. The method according to claim 18, wherein the inclination of the vehicle body in relation to the reference coordinate system is described via a quaternion.
  • 20. The method according to claim 12, wherein a strapdown algorithm is used, with which it is provided that, for the determination of a corrected acceleration of the vehicle, an acceleration measured by sensor is corrected by a centrifugal acceleration and by the gravitational acceleration and, from this, a velocity of the vehicle on a planar surface is determined, and that the inclination of the vehicle body is calculated.
  • 21. A system for compensating for an inclination of a vehicle in at least one spatial direction, wherein the vehicle has a vehicle body and an active chassis with a plurality of wheels, which are in contact with the roadway, wherein the system has a plurality of sensors and a control unit; wherein each wheel is joined to the vehicle body by way of an actuator, which can be adjusted in terms of its length, at a suspension point associated with the wheel;wherein at least a first sensor is designed for the purpose of determining an inclination of the vehicle body in the at least one spatial direction, wherein at least one second sensor is designed to record, for at least two wheels, respectively, a vertical distance to the suspension point of the vehicle body associated with the particular wheel,wherein the control unit is designed for the purpose of calculating, via at least two determined distances of the at least two wheels, an inclination of the chassis in the at least one spatial direction by transformation of the vertical distance of the at least two wheels to the vehicle body by using a transformation matrix
  • 22. The system according to claim 21, in which the at least one second sensor is designed as a distance sensor.
Priority Claims (1)
Number Date Country Kind
10 2015 002 603.8 Feb 2015 DE national
PCT Information
Filing Document Filing Date Country Kind
PCT/EP2016/000061 1/14/2016 WO 00