Method for measuring the gradient of a roadway
The method and system address inaccuracies in existing road inclination detection by using a strapdown algorithm and quaternion-based tilt filter to calculate road inclination from vehicle body and chassis differences, ensuring accurate detection and recognition of steep curves for enhanced vehicle stability.
Patent Information
- Application Number
- DE102015002601
- Authority / Receiving Office
- DE · DE
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2015-02-28
- Publication Date
- 2024-11-14
- Estimated Expiration
- 2035-02-28
AI Technical Summary
Existing methods for detecting the inclination of a road surface during vehicle travel rely on model-based relationships that change over the service life of the vehicle, leading to inaccuracies and inefficiencies.
A method and system that utilize a strapdown algorithm and a single-track model to determine the inclination of a road by calculating the difference in inclinations between the vehicle's body and chassis, using sensors to measure vertical distances and angles, and employing a quaternion-based tilt filter to correct acceleration measurements, allowing for accurate detection of road inclination and recognition of steep curves.
Enables precise detection of road inclination and identification of steep curves, improving vehicle stability control by providing reliable data for chassis adjustments and enhancing safety during dynamic driving conditions.
Smart Images

Figure 00000000_0000_ABST
Abstract
Description
[0001] The invention relates to a method and a system for detecting an inclination of a roadway.
[0002] The position of a vehicle changes during a journey depending on the incline or orientation of the road the vehicle is traveling on. Angles used to determine the vehicle's position can be detected by sensors.
[0003] A method for controlling a vehicle system is described in DE 10 2006 026 937 A1. A stability index is determined. Furthermore, a first and a second observer are provided, which, based on vehicle operating variables, determine a reference lateral velocity and a lateral velocity, from which an initial lateral velocity and an initial longitudinal velocity are determined.
[0004] A method for determining a vehicle's target curve inclination when driving on a curved road section is known from DE 10 2012 024 984 A1. The vehicle's target curve inclination is determined based on a detected road curvature. Furthermore, the optical surface quality of the curved road section is taken into account.
[0005] A method for processing sensor data in a vehicle is described in the document DE 10 2012 216 205 A1, whereby driving dynamics data and chassis sensor data of the vehicle are recorded and filtered.
[0006] A method for estimating a road angle is known from US Pat. No. 8,170,726 B2. This method uses both body sensors and suspension travel sensors, and data from these sensors is merged to determine the road angle.
[0007] The document DE 10 2005 046 776 A1 describes a roll stability control system using a four-wheel drive, which also uses body sensors and spring travel sensors.
[0008] Document DE 103 27 593 A1 describes a system for detecting a vehicle global position and a vehicle relative position using suspension sensors.
[0009] Against this background, a method and a system with the features of the independent patent claims are presented. Embodiments of the method and system are set out in the dependent patent claims and the description.
[0010] The method according to the invention is provided for detecting an inclination of a roadway traveled by a vehicle in at least one spatial direction, wherein the vehicle has a body and a chassis with several, usually four, wheels for driving it, which are in contact with the roadway. In this case, an inclination of the body in the at least one spatial direction is determined. In addition, a vertical distance to the body is detected for at least one wheel, wherein an inclination of the chassis in the at least one spatial direction is calculated using the at least one determined distance. The inclination of the roadway in the at least one spatial direction is determined, usually calculated, from a difference between the inclination of the body in the at least one spatial direction and the inclination of the chassis in the at least one spatial direction.
[0011] The inclination of the body, the chassis, and the road surface are determined as a function of at least one angle. A roll angle ϕ and / or a pitch angle θ is used as the at least one angle. The roll angle ϕ is the roll angle ϕ a of the structure, ϕ f of the chassis and ϕ s the roadway and the pitch angle θ a of the structure, θ f of the chassis and θ s the roadway must be taken into account.
[0012] In an embodiment, the inclination of the chassis in the at least one spatial direction is determined by transforming the vertical distance of the at least one wheel to the body with a transformation matrix T=[tv−tvth−thlvlv−lh−lh] whose elements are arranged in at least one column, e.g. four columns, and at least one row, e.g. two rows. Values for the elements of the transformation matrix of length tv , t h , I v , I h , usually side lengths, of the sides of at least one rectangle, wherein the center of gravity of the body is arranged at a first of two opposite corners of the at least one rectangle and the at least one wheel is arranged at a second of the two opposite corners, wherein the values of the transformation matrix are dependent on a distance of the at least one wheel from the center of gravity of the body, extending in a horizontal plane. In this embodiment, it is provided that the lengths t to be taken into account v , t h , I v , I h also lie in the horizontal plane.
[0013] Furthermore, the inclination of the chassis is determined by transforming the distance dz a,VL , dz a,VR , dz a,HL , dz a,HRof at least one wheel, usually all four wheels, is determined by the structure in the vertical direction perpendicular to the horizontal plane with the transformation matrix.
[0014] A first, body-fixed coordinate system is used to determine the inclination of the superstructure, and a second, chassis-fixed coordinate system is used to determine the inclination of the chassis. Furthermore, a third, inertial coordinate system is used as a reference coordinate system, which is based on the gravitational force or gravitational acceleration. agv→ In one embodiment, the inclination of the structure with respect to the reference coordinate system is described by a quaternion.
[0015] To carry out the procedure, a strapdown algorithm is used, which is intended to determine a corrected or adjusted acceleration avp→ of the vehicle in the horizontal plane a sensor-measured acceleration a by a centrifugal acceleration azf→ and the gravitational acceleration agv→ is corrected and a speed vLevel→ of the vehicle in at least one spatial direction in the horizontal plane and that the inclination of the body is calculated.
[0016] In addition, a value of a roll angle ϕ s to describe an inclination of the roadway in the transverse direction as a spatial direction with a reference value provided for this purpose, whereby it is determined that the vehicle is driving through a steep curve if the value is greater than the reference value.
[0017] The system according to the invention or a corresponding arrangement is designed to detect an inclination of a roadway on which a vehicle is to travel, in at least one spatial direction. The vehicle, e.g., a motor vehicle, has a body and a chassis with a plurality of wheels in contact with the roadway. The system comprises a plurality of sensors and a control device, wherein at least a first sensor is designed to determine an inclination of the body in at least one spatial direction. At least one second sensor is designed to detect or determine a vertical distance from the body for at least one wheel.The control device is designed to calculate an inclination of the chassis in the at least one spatial direction using the at least one determined vertical distance and to determine, usually calculate, the inclination of the roadway in the at least one spatial direction from a difference between the inclination of the body in the at least one spatial direction and the inclination of the chassis in the at least one spatial direction.
[0018] The at least one second sensor is designed as a distance sensor for measuring a distance.
[0019] The method can be used, among other things, to detect the longitudinal and transverse inclination of a road surface being traveled by a vehicle. Furthermore, a banked curve can be identified based on the detected transverse inclination of the road surface.
[0020] The inclination or position of the roadway, usually a road, is calculated from an inertial inclination or position of the vehicle body, which is determined by sensors, and an inclination or position of the vehicle's chassis. The inclination between the body and the chassis is calculated using displacement sensors to detect distances, e.g., spring travel, between wheels as components of the vehicle's chassis and the body, taking into account the following equations or formulas (1) and (2): ϕs=ϕa−ϕf (Roll angle_road = Roll angle_body - Roll angle_chassis) θs=θa−θf (Pitch angle_road = Pitch angle_body - Pitch angle_chassis)
[0021] Here, the roll angle ϕ s in the transverse direction of the road as an indicator for the detection of the banked curve.
[0022] In one embodiment of the method, four geometric variables or parameters are used, in this case the distance between one of the vehicle's wheels and the vehicle's center of gravity, extending in the horizontal plane. Such distances do not change over the vehicle's lifetime. Vertically oriented distances between the wheels and the body are determined during travel.
[0023] In contrast, other methods for detecting a steep curve or an incline use model-based relationships with a large number of vehicle-specific parameters that change over the vehicle's lifetime.
[0024] In another embodiment, a single-track model is used, thereby improving the quality of the estimation. This is possible even if the parameters of the single-track model are not precisely known or change over the lifetime, since these have only a minor influence on the estimated values to be determined for an algorithm used in the method, e.g., the strapdown algorithm.
[0025] Further advantages and embodiments of the invention will become apparent from the description and the accompanying drawings.
[0026] It is understood that the features mentioned above and those to be explained below can be used not only in the combination specified in each case, but also in other combinations or on their own, without departing from the scope of the present invention.
[0027] The invention is illustrated schematically in the drawings using embodiments and is described schematically and in detail with reference to the drawings. Fig. 1 shows a schematic representation of an example of a vehicle with an embodiment of the system according to the invention. Fig. 2 shows a diagram of an embodiment of the method according to the invention.
[0028] The figures are described coherently and comprehensively; the same reference numbers refer to the same components.
[0029] In Fig. 1, a vehicle 2 designed as a motor vehicle and a roadway 4 designed as a road, on which the vehicle 2 moves during a journey, are schematically shown. The vehicle 2 comprises a body 6 and four wheels 8, 10 provided for the propulsion of the vehicle 2, of which Fig. 1, only a front left wheel 8 and a rear left wheel 10 are shown. Each wheel 8, 10 is connected to the body 6 via at least one spring 12, 14 and is designed as a component of a chassis of the vehicle 2.
[0030] The embodiment of the system 16 according to the invention comprises, as components, a control device 18, at least one first sensor 19 for determining the inclination of the body 6, and several second sensors, here four, designed as displacement sensors 20, 22, with each spring 12, 14 being assigned such a displacement sensor 20, 22. The at least one first sensor 19 and the displacement sensors 20, 22 are simultaneously designed as components of a sensor arrangement of the system 16. Furthermore, the sensor arrangement and thus the system 16 comprise sensors (not shown in detail) for determining, generally measuring, at least one kinetic variable, usually a speed and / or acceleration, of the vehicle 2 and / or the body 6.
[0031] The following, among other things, based on the diagram from Fig. 2 described embodiment of the method according to the invention is comparable to the Fig. 1 schematically illustrated embodiment of the system 16 according to the invention, wherein steps of the embodiment of the method are to be controlled and thus controlled and / or regulated by the control device 18.
[0032] In addition, Fig. 1 shows three coordinate systems 24, 26, 28 as well as various geometric parameters.
[0033] A first, body-fixed coordinate system 24 is assigned to the body 6 of the vehicle 2, with its origin located at the center of gravity 25 of the body 6. The first coordinate system 24 comprises a first axis in the spatial direction x a , which is oriented longitudinally to the body 6 and parallel to a direction of travel of the vehicle 2. A second axis is in the spatial direction y a, which is oriented transversely to the body 6 and parallel to axes of the vehicle 2, which extend between two wheels 8, 10 of the vehicle 2. A third axis is in the spatial direction z a oriented parallel to a vertical axis of structure 6. All three axes mentioned and thus spatial directions x a , y a , e.g. a are oriented perpendicular to each other. The design provides that the first two axes and thus the spatial directions x a and y a a horizontal plane of the vehicle 2 in which the center of gravity 25 lies.
[0034] Furthermore, Fig. 1 two examples of vertically oriented distances dz designed as spring travels a , VL , dz a , HL . A first distance dz a , VL refers to a distance between the wheel 8 front left and the body 6. A second distance dz a , HLrefers to a distance between the wheel 10 rear left and the body 6. These spring travels or distances dz a , VL , dz a , HL are oriented along the springs 12, 14 and are to be detected by the position sensors 20, 22 assigned to the springs 12, 14.
[0035] Distances of the wheels 8, 10 to the center of gravity 25 of the body 6 in a plane parallel to the horizontal plane are here over the lengths or side lengths or distances t v , t h , I h , l v Here, for the front left wheel 8, a front transverse distance t v , which describes the distance of the wheel 8 from the center of gravity 25 in the transverse spatial direction, and a front, longitudinal distance I v , which describes the distance of the wheel 8 from the center of gravity 25 in the longitudinal spatial direction. For the rear left wheel 10, a rear, transverse distance t h, which describes the distance of the wheel 10 from the center of gravity 25 in the transverse spatial direction, and a rear, longitudinal distance I h , which describes the distance of the wheel 10 from the center of gravity 25 in the longitudinal spatial direction.
[0036] A further spring travel or a further vertically oriented distance dz a,VR refers to a distance between a wheel not shown here on the front right and the body 6. An additional spring travel or an additional distance dz a,HR in the vertical direction refers to a distance between a wheel not shown here at the rear right and the body 6. The described distances dz a,VL , dz a,HL , dz a,VR , dz a,HR or distances between the wheels 8, 10 and the body 6 are referred to the horizontal plane in which the center of gravity 25 lies.
[0037] Furthermore, for the front right wheel, the front transverse distance t v , which describes the distance of the front right wheel from the center of gravity 25 in the transverse spatial direction, and the front longitudinal distance I v , which describes the distance of the front right wheel from the center of gravity 25 in the longitudinal direction. For the rear right wheel, the rear transverse distance t h , which describes the distance of this wheel from the center of gravity 25 in the transverse spatial direction, and the rear, longitudinal distance I h , which describes the distance of the rear right wheel from the center of gravity 25 in the longitudinal spatial direction, where Fig. 1 the rear transverse section to be taken into account for the rear right wheel is not shown.
[0038] A second, chassis-fixed coordinate system 26 is assigned to the roadway 4 and comprises a first axis in the spatial direction x s parallel to an intended direction of travel or longitudinal direction of the roadway 4, a second axis in the spatial direction y s , which is oriented parallel to a transverse direction of the roadway 4, and a third axis in the spatial direction z s , where all axes are oriented perpendicular to each other. An inclination and thus a position of the roadway 4 is determined here by means of a transverse angle or roll angle ϕ s , which describes an inclination of the roadway 4 in the transverse direction, and based on a longitudinal angle or pitch angle θ s , which describes an inclination of the roadway 4 in the longitudinal direction and thus, for example, an incline or a decline.
[0039] A third coordinate system 28 is designed as a reference coordinate system and comprises a first axis in the spatial direction x ref, a second axis in the spatial direction y ref and a third axis in spatial direction z ref , all of which are oriented perpendicular to each other.
[0040] In addition, the first coordinate system 24 is assigned a roll angle ϕ a , which causes a rotation of the structure 6 around the first, in the spatial direction x a oriented axis, a pitch angle θ a , which causes a rotation of the structure 6 around the second, in the spatial direction y a oriented axis, and a yaw angle Ψ a , which causes a rotation of the structure 6 around the third, in the spatial direction z a oriented axis is shown.
[0041] The first, fixed coordinate system 24 [x a , y a , e.g. a ] in the center of gravity 25 of the body 6 of the vehicle 2 follows translational and rotational movements of the body 6. The third, inertial coordinate system 28 [x ref , y ref , e.g. ref] is used as a reference coordinate system, taking into account that the gravitational acceleration g is only in the spatial direction z ref acts parallel to a gravitational vector.
[0042] In the embodiment of the method, to estimate an inclination or position of the structure 6, the pitch angle θ a and the roll angle ϕ a related to the third coordinate system 28, which is designed as a reference coordinate system.
[0043] The angles [θ a , θ a , Ψ a ] are also called inertial pitch angle θ a , inertial roll angle ϕ a and inertial yaw angle Ψ a The inclination of the structure 6 refers to its orientation in the pitch and roll directions, from which the pitch angle θ a and the roll angle ϕa be determined.
[0044] To estimate the inclination or position of the structure 6, the acceleration a→=[x¨a,y¨a,z¨a]T of the body 6 or the vehicle 2 along the spatial directions x a , y a , e.g. a and the rotation rates ω→=[ψ˙a,ϕa,Θa]T measured and thus determined with the sensor arrangement for determining the inertia with six degrees of freedom (IMU - Inertial Measurement Unit), whereby the sensor arrangement can also be used independently of the implementation of the method in the vehicle 2.
[0045] To estimate the inclination of the structure 6, it is first necessary to consider the physical boundary conditions of the quantities to be determined by the sensor arrangement, for example by measuring a→ and ω→ are exposed to. Three different physical quantities are derived from measurement signals from acceleration sensors in the sensor array: - the rotation rates ω→ and the level speed vPlane→=[VPlane,x,VPlane,yVPlane,z]T Centrifugal acceleration dependent on the vehicle 2 azf→: azf→=ω→×vPlane→ - the change in the adjusted, level speed vLevel→ and thus acceleration avp→ of the vehicle 2 and / or the body 6 in the spatial direction of an axis of a respective acceleration sensor in the horizontal plane of the vehicle: avp→=R v˙plane→ −the gravitational acceleration agv→=R[0,0,−g]T
[0046] In the above formulas vLevel→ is the speed of the vehicle 2 in the horizontal plane and R is the Euler rotation matrix (6), which is calculated taking into account the Euler angles in a rotation sequence of the roll angle ϕ, the pitch angle θ and the yaw angle ψ. Here, V Ebene,x the usual speed of the vehicle V Fzg in the longitudinal or driving direction of the vehicle 2, which is measured via a rotational speed of the wheels 8, 10 and displayed on the speedometer. R=(cosθcosψcosθsinψ−sinθsinϕsinθcosψ−cosϕsinψsinϕsinθsinψsinϕcosθcosϕsinθcosψ+sinϕsinψcosϕsinθcosψ−sinϕcosψcosϕcosθ)
[0047] The angles ϕ to be determined, ie ϕ a (for the structure), ϕ f (for the chassis) or ϕ s (for the roadway), and θ, ie θ a (for the structure), θ f (for the chassis) or θ s(for the roadway) can usually be determined using two different calculation methods or approaches: - through Integration of the rotation rates measured by the sensor arrangement ω→, or - by eliminating centrifugal acceleration azf→ and the change in the plane speed vLevel→ and thus the acceleration avp→ of the vehicle 2 from the accelerations measured by the sensor arrangement agv→=a→−azf→−avp→ and calculation of angles using trigonometric functions θa=atanagv,xagv,z,ϕa=atanagv,yagv,z.
[0048] As already indicated by equation (5), agv→ a vector with the three elements [agv,x,agv,y,agv,z]T=[g∗sinθ,−g*sinϕ*cosθ, −g*cosϕ*cos0]T, whereas the acceleration due to gravity g = 9.81 m / s 2 is used here as a scalar, which, depending on the inclination of the structure 6, which is described by the Euler rotation matrix R (6), refers to different elements of the vector agv→ If the structure 6 is not inclined, agv=[0,0,−g]T At a roll angle ϕ a = 90° and a pitch angle θ a = 0° is agv→=[0,−g,0]T Is agv→ known, the pitch angle θ a and the roll angle ϕ a can be calculated using the atan functions described above.
[0049] However, it must be taken into account when performing the calculations that, due to time-varying offset errors in yaw rate sensors, integration of the yaw rates may be inaccurate in a steady-state situation. This means that calculated angles drift at low frequencies, and only high-frequency components of the measurement signals are usable. However, high-frequency interference must be expected for angles determined using acceleration sensors, since difficult-to-detect changes in speed, such as those that occur when driving over potholes, cannot be eliminated from the measurement signals.
[0050] In the embodiment described here, a quaternion-based tilt filter or position filter is used as the filter algorithm. It is also possible to use a Kalman filter to merge both calculation methods. This combines both of the aforementioned calculation methods, providing a signal that can be used for both low-frequency and high-frequency applications.
[0051] A quaternion is a four-dimensional vector q→=[q1,q2,q3,q4]T which describes the orientation of a rigid body, here structure 6. If a rigid body is relative to a reference system by the angle χ and the axis r→=[rx,ry,rz]T rotated, whereby r→ is a unit vector, this orientation relative to the reference system is determined by the quaternion q→=[cosx2,−rxsinx2,−rysinx2,−rzsinx2]T described.
[0052] This will initially be for the temporal the rotation rates measured by the sensor arrangement ω→ used, whereby the structure 6 is related to the inertial reference system in this case with the rotation rate ω→=[ωx,ωy,ωz]T rotates. Starting from a starting position qL→ of the structure 6, the change in position or inclination due to the rotation rates is given by equation (7): q˙ω→=12qL→⊗[0,ωx,ωy,ωz] The operator ⊗ here symbolizes a quaternion multiplication. In a discrete-time case, a resulting differential equation is, for example, by Euler integration (8): qω,k→=qL,k−1→+q˙ω→Δt to solve, where Δt corresponds to a step size between two times k and k- 1.
[0053] In order to determine the orientation of the structure 6 from the acceleration measured by the sensor arrangement a→ and resulting adjusted [a gv,x , a gv,y , a gv,z ] T = [g ∗ sinθ, -g ∗ sin ϕ ∗ cosθ, -g ∗ cosϕ* cos θ] T to be described with quaternions is the following optimization problem (9): qa→=minqL∈ℜ4f→(qL→,agv→) with f→(qL→,agv→)=[2(qL,2qa,4−qL,1qL,3)−agv,x2(qL,1qL,2−qL,3qL,4)−agv,y2(0.5−qL,22−qL,32)−agv,v] A direct calculation of the inclination is not possible because infinitely many solutions exist around a rotation axis oriented parallel to the gravitational vector. A gradient-based approach (10) is used for the discrete-time solution of the optimization problem: qa,k→=qL,k-1→−μ∇f→(qL,k-1→,agv→)‖∇f→(qL,k-1→,agv→)‖ with an adjustable step size µ is used.
[0054] To obtain information about the inclination derived from the measured rotation rates qω,k→ and from the accelerations qa,k→ resulting, the two quaternions are qa,k→,qL,k→ weighted by equation (11): qL,k→=γqa,k→+(1-γ)qω,k→ where 0 ≤ γ ≤ 1 is an adjustable parameter. The pitch and roll angles are then calculated using equations (12a), (12b): θa,k=−sin−1(2qL,k.2qL,k,4+qL,k,1qL,k,3) ϕa,k=atan(2qL,k,3qL,k,4−2qL,k,1qL,k,22qL,k,12+2qL,k,42−1) calculated.
[0055] To eliminate centrifugal acceleration azf→ and the change avp→ the level speed vLevel→ From the accelerations measured by the sensor arrangement, the pitch and roll angles must be taken into account, which in turn are calculated using the gravitational acceleration vector agv→ be calculated.
[0056] To carry out the embodiment of the method, a so-called strapdown approach is used, which is shown in the diagram from Fig. 2. Individual steps 40, 42, 44, 46, 48 of the method are described in more detail below.
[0057] At the beginning of the procedure, sensor-determined acceleration values a→ and the rotation rate ω→ With these values, a “centrifugal force correction” is carried out in a first step 40, whereby the accelerations measured by the sensor arrangement are adjusted by the proportion of the centrifugal force azf→=ω→×vPlane→ A first corrected acceleration a→−azf→ This first corrected acceleration a→−azf→ is calculated taking into account values for the roll angle ϕ a and the pitch angle θ ain a second step 42 by performing a “gravitational force correction” with the gravitational acceleration agv→ corrected, resulting in the acceleration avp→ in the horizontal plane.
[0058] Within the framework of the procedure, two possibilities are available to determine the level speed vLevel→ to calculate.
[0059] A “determination of the speeds” is carried out in a third step 44 taking into account the acceleration avp→ of vehicle 2, the measured speed v of vehicle 2 and its steering angle δ lenk carried out, whereby the first level speed of the vehicle vint=[vint,x,vint,y,vint,z]T through integration (13): vint→=∫avp→dt the acceleration avp→ of vehicle 2 is calculated and thus determined. This level speed vint→ is in turn used in a closed control loop to “correct the centrifugal force” in the first step 40.
[0060] For the speed v Ebene,x In the spatial direction of a longitudinal axis of the vehicle 2, the speed V measured via the wheel speeds is Fzg in direction x a of vehicle 2. With the help of a single-track model, it is also possible to use the steering angle δ lenk and the measured speed V Fzg a speed v acting relative to the transverse axis of the motor vehicle y,ESM to calculate. For the vertical velocity v Ebene,z No other measurement or calculation method is available. The alternatively determined second level speed of the vehicle (14): valt→=[vFzg,vy,ESM,0]T and the speed calculated by integration (13) vint→ can be determined by a suitable filter algorithm, such as a Kalman filter (15), using a calculation rule that includes a weighting factor τ: vPlane→=τvInt→+(1−τ)valt→ with 0≤τ≤1 be merged.
[0061] In a fourth step 46 for “correcting the plane speed change”, values of the measured speed v Fzg , the steering angle δ lenk , the angle θ a , ϕ a and the centrifugal acceleration aaf→ corrected acceleration a→−azf→ taken into account, whereby the corrected acceleration is determined by the proportion of the change in the plane speed avp,alt→=R v˙alt→ To avoid negative feedback, the derivative of a velocity vector valt→ instead of the speed determined according to the calculation rule (15) vLevel→ used.
[0062] In a fifth step 48, taking into account the rotation rate ω→ and gravitational acceleration agv→ of vehicle 2 the pitch angle θ a and the roll angle ϕ a and thus the inclination or position of the body 6 of the vehicle 2 is calculated using the previously described quaternion-based inclination filter. Using the procedure described above, the pitch angle θ a and the roll angle ϕ a determined with respect to the inertial coordinate system 28 and used in a closed control loop for “correcting the gravitational force” in the second step 42 and for “correcting the flat speed change” in the third step 44.
[0063] Based on the inclination of the body 6 determined in the fifth step 48, the inclination and thus the position of the roadway 4 is determined, whereby the distances dzz→=[dza,VL, dza,VR, dza,HL, dza,HR]T between the wheels 8, 10 and the body 6 are taken into account as measured quantities, whereby the pitch angle θ f and the roll angle ϕ f of the chassis of the vehicle 2, wherein a calculation to be carried out depends on a transformation matrix (16): T=[tv−tvth−thlvlv−lh−lh] which describes a geometric position of the center of gravity 25 relative to the positions of the wheels 8, 10. The first column describes the distance of the front left wheel 8, the second column the distance of the front right wheel, the third column the distance of the rear left wheel 10, and the fourth column the distance of the rear right wheel to the center of gravity 25 within the horizontal plane.
[0064] The inclination of the chassis is then determined via the vectorial relationship (17): [ϕfθf]=Tdza→ certainly.
[0065] By subtracting the inclination of the chassis from the inclination of the body 6, the inclination of the roadway 4 in relation to the body-fixed, first coordinate system 24 is determined via the vectorial relationship (18): [ϕsθs]=[ϕaθa]−[ϕfθf] calculated. Since tire deflection of wheels 8, 10 is very small compared to the suspension travel and thus a distance to be considered, this is neglected in the above calculation.
[0066] Since the angles ϕ a and θ a are vector-related estimates for the inclination of the structure 6 and ϕ f and θ f describe the relative angles between the structure 6 and the surface of the roadway 4, are denoted by ϕ s and θ s Angles are also available as estimated values for the inclination of the roadway 4 or road relative to the gravitational vector.
[0067] In a further embodiment, the method can be used, among other things, to detect a banked curve that is to be negotiated. This is a curve inclined toward the inside of the vehicle 2, which is used, for example, on racetracks to increase speed in the curve. However, some control algorithms are not adapted to driving in banked curves, which is why detection of such a curve is required.
[0068] The roll angle ϕ described above, determined by estimation s indicates how much the road surface 4 is inclined in the transverse direction of the vehicle 2. If the estimated value is compared with a threshold value, an indicator (19) IStear curve={1, if |ϕs|≥ϕmin, Steep curve0 otherwise which takes the value 1 as soon as the roll angle ϕ s for the transverse slope of the carriageway 4 a reference value Φ min , Steilkurvehas been exceeded. Furthermore, a control strategy for a chassis stabilization system affected by the banked curve must be adapted to this situation. For example, the level control of an air suspension system must be suspended for the duration of the drive through the banked curve in order to avoid reacting to the increased acceleration in the z-axis direction, which is only present in the banked curve.
Claims
[1] Method for detecting an inclination of a roadway (4) traveled by a vehicle (2) in at least one spatial direction, wherein the vehicle (2) has a body (6) and a chassis with a plurality of wheels (8, 10) in contact with the roadway (4), wherein an inclination of the body (6) in the at least one spatial direction is determined, wherein a vertical distance to the body (6) is detected for at least one wheel (8, 10), wherein an inclination of the chassis in the at least one spatial direction is calculated using the at least one determined distance, and wherein the inclination of the roadway (4) in the at least one spatial direction is determined from a difference between the inclination of the body (6) in the at least one spatial direction and the inclination of the chassis in the at least one spatial direction, wherein the inclination of the body (6) and the roadway (4) is determined as a function of at least one roll angle ϕ,where an estimated value of the roll angle ϕ, s for describing an inclination of the roadway (4) in the transverse direction with a reference value Φ min,Steilkurve is compared, whereby it is determined that the vehicle (2) is driving through a steep curve when an amount of the value of the roll angle ϕ s greater than the reference value Φ min,Steilkurve is. [2] Method according to claim 1, in which the inclination of the chassis in the at least one spatial direction is determined by transforming the vertical distance of the at least one wheel (8, 10) to the body (6) with a transformation matrix whose elements are arranged in at least one column and at least one row, wherein values for the elements of the transformation matrix are dependent on lengths of the sides of at least one rectangle, wherein the center of gravity (25) of the body (6) is arranged at a first of two opposite corners of the at least one rectangle and the at least one wheel (8, 10) is arranged at a second of the two opposite corners. [3] Method according to claim 1 or 2, wherein the inclination of the chassis is determined by transforming the vertically oriented distance of the at least one wheel (8, 10) from the body (6) with the transformation matrix. [4] Method according to one of the preceding claims, in which a first, body-fixed coordinate system (24) is used to determine the inclination of the body (6) and a second, chassis-fixed coordinate system (26) is used to determine the inclination of the chassis, and in which a third, inertial coordinate system (28) is used as a reference coordinate system which is related to the gravitational force. [5] Method according to claim 4, wherein the inclination of the structure (6) with respect to the reference coordinate system is described via a quaternion. [6] Method according to one of the preceding claims, in which a strapdown algorithm is used, with which it is provided that in order to determine a corrected acceleration of the vehicle (2), a sensor-measured acceleration is corrected by a centrifugal acceleration and the gravitational acceleration and from this a speed of the vehicle (2) in a plane is determined, and that the inclination of the body (6) is calculated. [7] System for detecting an inclination of a roadway (4) on which a vehicle (2) is to travel in at least one spatial direction, wherein the vehicle (2) has a body (6) and a chassis with a plurality of wheels (8, 10) that are in contact with the roadway (4), wherein the system (16) has a plurality of sensors (19, 20, 22) and a control device (18), wherein at least a first sensor (19) is designed to determine an inclination of the body (6) in at least one spatial direction, wherein at least a second sensor (20, 22) is designed to detect a vertical distance to the body (6) for at least one wheel (8, 10), wherein the control device (16) is designed toto calculate an inclination of the chassis in the at least one spatial direction over the at least one determined distance and to determine the inclination of the roadway (4) in the at least one spatial direction from a difference between the inclination of the body (6) in the at least one spatial direction and the inclination of the chassis in the at least one spatial direction, wherein the inclination of the body (6) and the roadway (4) is determined as a function of at least one roll angle ϕ, wherein a value of the roll angle ϕ determined by estimation, s for describing an inclination of the roadway (4) in the transverse direction with a reference value ϕmin,banked curve, wherein it is determined that the vehicle (2) is driving through a banked curve when an amount of the value of the roll angle ϕ s greater than the reference value ϕ min,Steilkurve is. [8] System according to claim 7, wherein the at least one second sensor (20, 22) is designed as a displacement sensor.
Citation Information
Patent Citations
roll stability control using a four-wheel drive
DE102005046776A1
Method for controlling a system of a vehicle
DE102006026937A1
Method for determining target inclination curve of motor vehicle during driving on curved track section, involves determining target inclination curve of motor vehicle in response to determined current road curvature
DE102012024984A1
Fusion of chassis sensor data with vehicle dynamics data
DE102012216205A1
system and method for determining the attitude of a motor vehicle
DE10327593A1
