The invention relates to the detection of a motion of a motor vehicle. The subject matter of the invention is, in particular, a sensor device for detecting the motion state of a motor vehicle. In addition, the invention relates to a method for detecting the motion state of a motor vehicle.
The detection of motions of a motor vehicle is considered particularly significant in the automobile industry. Motion variables such as, for example, the longitudinal speed of a vehicle, constitute important information for the driver of the vehicle. In addition, motion variables serve as input signals for vehicle movement dynamics control systems with which the safety and comfort of the vehicle are improved. A conventional vehicle movement dynamics control system generally comprises in this context wheel speed sensors, from whose measured values the longitudinal speed of the vehicle is derived, and a sensor for detecting the yaw rate of the vehicle, and sensors for detecting the transverse acceleration and, if appropriate, the longitudinal acceleration.
DE 10 2004 060 677 A1, which is incorporated by reference, discloses an optical device for obtaining the speed of a motor vehicle, in which device images of the underlying surface of the vehicle are recorded in a sequence. The speed of the vehicle is obtained on the basis of displacement of objects or structural features within the images. In addition to the longitudinal speed, it is also possible to obtain the transverse speed of the motor vehicle in this context, the transverse speed frequently being inaccessible to measurement by means of the vehicle sensor system and constituting a useful input variable for vehicle movement dynamics control systems.
Such a device generally requires additional lighting of the roadway surface, as a result of which the expenditure on integration into a motor vehicle is increased. In addition, the device is relatively susceptible to soiling of the camera or of the lighting device, which occurs to a greater degree owing to the installation position on the underfloor of the motor vehicle. As a result, the availability of the device can be adversely affected. Furthermore, the device can only detect speed components in the plane of the roadway but not perpendicularly thereto.
An object of the present invention is therefore to permit improved detection of motions of a motor vehicle, permitting, in particular, more reliable detection of motion.
According to a first aspect of the invention, a sensor device for detecting a motion state of a motor vehicle is proposed. The sensor device comprises at least one laser unit which has a light source for emitting coherent light which is transmitted in the direction of a roadway surface when the sensor device is arranged on the motor vehicle, and which has an interference detector which is designed to detect at least one measurement variable which characterizes interference between the light scattered at the surface and the light of the light source. The measurement variable represents a speed component of the sensor device and/or a distance between the sensor device and the roadway surface. The laser unit is coupled to an evaluation device which is designed to determine, from the measurement variable, at least one variable which characterizes the motion state of the vehicle.
According to a second aspect of the invention, a method for detecting a motion state of a motor vehicle having a sensor device is proposed. The method provides that:
The invention permits contactless determination of the motion state of the motor vehicle. This permits the motion state of the vehicle to be determined reliably and independently of disruptive influences. In addition, the optical measurement method permits the variable which characterizes the motion state of the vehicle to be obtained very precisely.
The variable which characterizes the motion state of the vehicle may be, in particular, one or more speed components of the vehicle and/or one or more rotational angles of the vehicle. The latter can be determined on the basis of the distance between the sensor device and the roadway surface, said distance being the distance along the light beam measured by the sensor device. Furthermore, rotational angle speeds, in particular the yaw rate, pitching rate and/or rolling rate of the vehicle, can be determined. This can be done using detected speed components and/or by deriving corresponding rotational angles over time.
The light transmitted in the direction of the roadway surface by the light source is scattered back at least partially to the light source.
In order to achieve a compact and uncomplicated design of the sensor device, the location of the interference is therefore preferably the light source, in particular a laser resonator of the light source. Such interference leads to a change in the operating state of the laser which can be detected with a detector. This is also referred to as a self-mixing effect.
In one embodiment of the sensor device and of the method, the sensor device comprises at least one sensor cluster having a plurality of laser units which are coupled to the evaluation device, wherein the laser units emit light in various direction. The sensor cluster preferably comprises three laser units.
By means of the three laser units, which each transmit light in a specific direction, it is advantageously possible to determine three speed components of the sensor device and/or three distances between the sensor device and the roadway surface. On the basis of the three speed components it is possible, in particular, to determine the translatory speed of the sensor device in relation to the roadway in the three spatial directions. If in each case the distance from the roadway surface is obtained by means of the laser units, the position of the sensor device in relation to the roadway surface can be determined therefrom.
In a further embodiment of the sensor device and of the method, the laser units of the sensor cluster are arranged in a common housing which can be mounted on an underside of a bodywork of a vehicle, which underside faces the roadway surface when the motor vehicle is operating.
One advantage of this embodiment is that the laser units of the sensor cluster are arranged in a common housing, resulting in a compact and cost-effective design of the sensor cluster. In addition, the sensor cluster in this configuration can be mounted particularly easily on the vehicle since it is not necessary to attach and orient each laser unit individually.
One development of the sensor device and of the method is distinguished by the fact that the evaluation device is designed to obtain a speed component of the sensor cluster from each of the measurement variables detected by means of the laser units of the sensor cluster, and to determine at least one speed component of the motor vehicle on the basis of the obtained speed components.
The speed component of the motor vehicle may be a speed component of the center of gravity of the vehicle, which is particularly suitable for characterizing the vehicle movement dynamics state of the motor vehicle. In particular, the longitudinal speed of the vehicle and/or the transverse speed of the vehicle can be determined in relation to the center of gravity of the vehicle.
The motion at one point on the motor vehicle, in particular the motion of the sensor device, can be decomposed into the translational speed of the center of gravity of the vehicle and of a rotational motion of the respective point in relation to the center of gravity of the vehicle, which translational speed can be described by the rotation rates of the vehicle and/or of the vehicle bodywork. The rotation rates of the vehicle comprise a yaw rate, which characterizes the rotational speed about the vertical axis of the vehicle, a rolling rate, which characterizes a rotational speed about the longitudinal axis of the vehicle, and a pitching rate, which characterizes the rotational speed about the transverse axis of the vehicle. At least one rotation rate is preferably used to determine the speed of the center of gravity of the vehicle on the basis of the obtained speed components of the sensor cluster.
As a result, a configuration of the sensor device and of the method provides that the evaluation device is designed to use at least one rotational rate of the motor vehicle in the determination of the speed component of the motor vehicle.
One configuration of the invention which permits, in particular, at least one speed component of the motor vehicle to be obtained, includes the fact that the evaluation device is designed to determine at least one speed component of the motor vehicle and/or a second rotation rate from the measurement variable detected in the sensor clusters and the first rotation rate detected by means of the device.
In addition to the two sensor clusters, a device for determining a rotation rate is advantageously used here to obtain a component of the vehicle speed and/or a further rotation rate of the vehicle. As a result, the motion state of the motor vehicle including one or more speed components and at least two rotation rates can be determined with a relatively simple sensor configuration.
An associated configuration of the sensor device and of the method is distinguished by the fact that the device for determining the rotation rate is a rotation rate sensor, in particular a yaw rate sensor.
The rotation rate sensor is configured, for example, as a micromechanical rotation rate sensor. The yaw rate is a particularly important variable for characterizing the vehicle movement dynamics state of the motor vehicle, in particular with regard to the stability of the driving state. For this reason, in this configuration the yaw rate is measured directly, while in particular a further rotation rate, such as for example the rolling rate, can be calculated from the obtained measurement variables.
In a further embodiment of the sensor device and of the method, an additional sensor, which detects a measurement variable according to another measurement principle, is dispensed with. In this embodiment, the sensor device comprises three sensor clusters which are coupled to the evaluation device, wherein the evaluation device is designed to determine, from the measurement variables obtained with the three sensor clusters, at least one speed component of the motor vehicle and/or at least one rotation rate of the vehicle.
In addition, one configuration of the sensor device and of the method comprises a first sensor cluster having a plurality of laser units—in particular three thereof—wherein the frequencies of the light emitted by the laser units can be modulated according to a modulation schema in such a way that in each case a distance can be obtained from the detected measurement variable in the evaluation device, wherein the evaluation device is designed to determine at least one rotational angle and/or at least one rotation rate of the vehicle from the obtained distances.
This configuration advantageously makes use of the possibility of determining, from the distances obtained by means of the laser units of the first sensor cluster, the position of the sensor cluster in relation to the roadway and/or a rotational angle of the vehicle bodywork in relation to the roadway. In addition, the corresponding rotation rate, which can likewise be determined in this configuration can also be calculated from the rotational angle. The calculation of the rotation rate is carried out, in particular, by deriving the rotational angle over time.
An associated configuration of the sensor device and of the method is defined in that the frequencies of the light emitted by the laser units can be modulated according to a modulation schema in such a way that, in addition to the distance, in each case a speed component of the first sensor cluster can be obtained from the detected measurement variable.
One advantage of this configuration is that, in addition to the distances between the sensor cluster and the roadway surface, it is also possible to obtain speed components of the sensor device in relation to the roadway surface. This can be done by means of a suitable modulation schema.
A further associated configuration of the sensor device and of the method includes the fact that the evaluation device is designed to determine at least one speed component of the motor vehicle from the speed components obtained with the first sensor cluster and the rotation rate.
The precision when determining the speed of the center of gravity can be improved by taking into account at least one further rotation rate. For this reason, in one embodiment of the sensor device and of the method there is provision that the evaluation device is designed to use, for obtaining the speed component of the motor vehicle, a further rotation rate which is obtained by means of a rotation rate sensor.
The rotation rate may advantageously be, in particular, the yaw rate of the vehicle. The rotation rate sensor is configured in this case as a yaw rate sensor.
One alternative configuration dispenses with the use of an additional rotation rate sensor which operates according to another measurement principle than the laser units of the sensor device. This configuration comprises a second sensor cluster which is connected to the evaluation device, wherein speed components of the second sensor cluster can be obtained from the measurement variable detected in the second sensor cluster, wherein the evaluation device is designed to obtain at least one further rotation rate of the vehicle from the obtained speed components of the first and second sensor clusters, and to use the further rotation rate to obtain the speed component of the motor vehicle.
The preceding presentation of the sensor device reveals that it is suitable, in particular, for use in a motor vehicle. In addition to the sensor device, the invention also makes available a motor vehicle which comprises a sensor device of the previously described type.
The previously mentioned advantages, particularities and expedient developments of the invention, and further advantages, particularities and expedient developments of the invention, also become clear on the basis of exemplary embodiments which are described below with reference to the figures.
In the drawings:
a is a schematic illustration of a motor vehicle having a sensor cluster in a horizontal section,
The basic method of functioning of the laser units 108a, b, c is illustrated by way of example on the basis of
If the resonator 301 and the roadway surface 104 move with a speed component νLi relative to one another in the direction of the measuring light beam 103 owing to a movement of the vehicle 101, the scattered light beam 305 experiences a Doppler shift. This is a change in the frequency of the light or of the wavelength as a function of the specified speed component νLi. Owing to the feeding back of the scattered light beam 305 into the resonator 301, a self-mixing effect occurs within the resonator 301. This means that the laser amplification is modulated with a frequency which depends on the Doppler shift of the scattered light beam 305, and therefore also on the described speed component. The change Δg in the laser amplification over time is described as a function of the speed component νLi of the relative motion between the resonator 301 and the roadway surface 104 in the direction of the measuring light beam 103i by means of the following equation:
Here, κ denotes a laser-specific coupling coefficient which has a value between zero and one, f0 represents the frequency of the light emitted from the laser unit 108i, c represents the speed of light, and t represents time. Equation (1) is obtained, for example, from the theory of the Self-Mixing Effect in M. H. Koelink et al., “Laser Doppler velocimeter based on the self-mixing effect in a fibre-coupled semiconductor laser: theory”, Applied Optics, Vol. 31, 1992, pages 3401-3408, which is incorporated by reference.
The periodic modulation of the laser amplification leads to corresponding periodic modulation of the intensity of the light emitted by the resonator 301. The speed component νLi can be obtained from the frequency with which the measured intensity periodically changes. In order to measure the intensity of the light emitted by the resonator 301, the photo diode 306 is provided, said photo diode 306 detecting light which emerges from the resonator 301 through the rear mirror 303. Such a diode 306 is generally used to keep the intensity of the laser light constant or control it and is therefore generally already a component of the equipment of commercially available laser diodes. In the present application, the photo diode 306 is connected to the evaluation device 110 which obtains the frequency of the changes in intensity from the time profile of the measured intensity and determines the speed component νLi on the basis of this frequency.
By means of the three laser units 108a, b, c of the sensor cluster 102 it is therefore possible to obtain three speed components νLi (i=a, b, c) which are evaluated by the evaluation device 110. For the evaluation which is to be performed, it is favorable to consider a sensor coordinate system 401 which is illustrated in
In the sensor coordinate system 401, the directions {right arrow over (n)}i of the measuring light beams 103a, b, c of the sensor cluster 102 are specified by the angles αi and δi which are obtained from the fixed installation position of the sensor cluster 102 and can be stored as parameters in the non-volatile memory of the evaluation device 110 and are illustrated in
The speed components measured by means of the sensor cluster 102 correspond to the components of the speed {right arrow over (ν)} of the sensor cluster 102 in these directions i.e. using the scalar product, the following applies
νLi={right arrow over (ν)}·{right arrow over (n)}i(i=a,b,c) (3)
A linear equation system, from which the components of the speed vector {right arrow over (ν)}=(νx, νy, νz) along the three axes of the sensor coordinate system 401 can be obtained from the corresponding equations for the three speed components νLa, νLb and νLc, which can be obtained with the laser units 108a, b, c of the sensor cluster 102. Said components correspond to the components of the speed of the sensor cluster 102 in the center of gravity system 402 since the latter is merely shifted and rotated with respect to the sensor coordinate system 401. The evaluation device 110 obtains the translational speed νCM of the center of gravity CM of the vehicle related to the sensor coordinate system 401 and/or to the center of gravity system 402, from the speed {right arrow over (ν)}. This is done using the relationship which is known per se:
{right arrow over (ν)}={right arrow over (ν)}CM−{right arrow over (ω)}×{right arrow over (x)} (4)
Here, {right arrow over (x)} denotes the connecting vector starting from the sensor cluster 102 to the center of gravity CM of the vehicle. In order to enable the evaluation device 110 to calculate the speed {right arrow over (ν)}CM of the center of gravity, the components of the connecting vector {right arrow over (x)} between the sensor cluster 102 and the center of gravity CM of the vehicle are stored in one embodiment as parameters in the non-volatile memory of the evaluation device 110 after they have been previously determined for a typical load state of the vehicle 101. Changes in the position of the center of gravity CM due to changed loading are ignored in this configuration. The variable {right arrow over (ω)}=[dφ/dt,dθ/dt,dψ/dt] which is contained in equation (4) denotes the angular speed of the vehicle 101, the components of which are the rolling rate dφ/dt of the vehicle 101, the pitching rate dθ/dt of the vehicle 101 and the yaw rate dψ/dt of the vehicle 101.
Since the sensor coordinate system 401 and the center of gravity system 402 are initialized fixed to the vehicle, the xy-planes of these systems are rotated about the current pitching angle and rolling angle due to rolling motions and pitching motions of the vehicle bodywork 105 with respect to the roadway surface 104. However, the vehicle movement dynamics state of the vehicle 101 is usually characterized by speed components, in particular a longitudinal speed νCM,xh and a transverse speed νCM,yh of the vehicle which are related to a horizontal system. This involves a coordinate system whose x-y plane runs parallel to the plane of the roadway or lies in the plane of the roadway. A horizontalized system whose origin is initialized perpendicularly below the center of gravity CM of the vehicle 101 in the plane of the roadway at the time of consideration is generally used. The x axis runs forward in the plane of the roadway in the longitudinal direction of the vehicle, the y axis runs to the left in the plane 104 of the roadway in the transverse direction of the vehicle, and the z axis runs upward perpendicularly with respect to the surface 104 of the roadway in the vertical direction of the vehicle. Between the speed {right arrow over (ν)}CM of the center of gravity related to the center of gravity system 402 and the center of gravity speed {right arrow over (ν)}CMh=(νCM,xh, νCM,yh, νCM,zh) related to the horizontalized system there is the following relationship
{right arrow over (ν)}CM=Sy(θ)Sx(φ){right arrow over (ν)}CMh or {right arrow over (ν)}CMh=Sy(−θ)Sx(−φ){right arrow over (ν)}CM (5)
Here, the matrix Sy(θ) describes a rotation about the instantaneous y axis through the pitching angle θ, and the matrix Sx(φ) denotes a rotation about the instantaneous x axis through the rolling angle φ, and the following applies:
In order to determine the speed {right arrow over (ν)}CM of the center of gravity in the center of gravity system 402, the knowledge of the rotation rates of the vehicle 101, i.e. the yaw rate, the rolling rate and the pitching rate, is therefore necessary, and furthermore knowledge of the rolling angle and of the pitching angle of the vehicle 101 are necessary to obtain the speed of the center of gravity in the horizontalized system {right arrow over (ν)}CMh.
In order to determine the motion of the vehicle in accordance with its three translatory and three rotational degrees of freedom, in one embodiment—illustrated schematically in
{right arrow over (ν)}i−{right arrow over (ν)}j={right arrow over (ω)}×{right arrow over (r)}ij(i,j=a,b,c) (7)
Here, {right arrow over (r)}ij={right arrow over (r)}i−{right arrow over (r)}j denotes the connecting vector between the sensor cluster i and the sensor cluster j. For the pairs (i,j)=(a,b),(a,c),(b,c) equation (7) leads to three vector equations. These correspond to an equation system with 9 equations, from which three equations are selected and are used by the evaluation device 110 as the basis for obtaining the rotation rates of the vehicle 101. The rotation rates are then used by the evaluation device 110 to determine the centre of gravity speed {right arrow over (ν)}CM of the vehicle 101 in the center of gravity system 402. This is done on the basis of equation (4) using the speed {right arrow over (ν)}i (i=a,b,c) which is obtained for a sensor cluster 102a, b, c. Alternatively, initially two or three values can also be determined for the center of gravity speed {right arrow over (ν)}CM using the speed {right arrow over (ν)}i, which is obtained for the further sensor clusters 102a, b, c and the speed νCM of the center of gravity can be derived from the individual values. This increases the accuracy of the determination of speed and permits plausibility checking, during which the three obtained values are compared with one another in order to detect a faulty measurement when the distances are too large.
Furthermore, integration of the rolling rate and of the pitch rate over time allows the rolling angle and the pitching angle to be obtained. The integration can begin, for example, at an ignition start which is signaled to the evaluation device 110, and can be carried out on the basis of the preconditions that the rolling angle and pitching angle have the value zero at the ignition start. In this configuration, by using the rolling angle and the pitching angle, the evaluation device 110 determines, on the basis of equation (5), the longitudinal speed {right arrow over (ν)}CM,xh of the vehicle and the transverse speed {right arrow over (ν)}CM,yh of the vehicle as well as, if appropriate, the vertical speed {right arrow over (ν)}CM,zh of the center of gravity CM of the vehicle in the horizontalized system.
Output signals of the evaluation device 110 which is connected to the three sensor clusters 102a, b, c are, for example, the components of the translational speed {right arrow over (ν)}CM of the center of gravity of the vehicle in the center of gravity system 402 which constitute good approximation values for the translational speed {right arrow over (ν)}CMh in the horizontalized system during the small rolling motions and pitching motions of the vehicle 101. If there is provision for the rotational angles of the vehicle 101 to be determined by integration of the rotation rates, the speed {right arrow over (ν)}CMh can also be output as an output variable by the evaluation device 110 in the horizontalized system. Further output variables represent the three obtained rotation rates of the vehicle 101.
A further embodiment which is illustrated schematically in
The rotation rate sensor 601 is preferably a yaw rate sensor, since the yaw rate has the greatest influence on the vehicle movement dynamics, and direct measurement of the yaw rate independently of other variables is therefore advantageous. In addition, the yaw rate generally serves as an input variable of vehicle movement dynamics control systems, so that it is also advantageous in this respect to measure this variable directly. However, instead of the yaw rate sensor, it is also possible to use a rolling rate sensor or a pitching rate sensor. The rotation rate sensor used can be configured in a manner which is known per se to a person skilled in the art, in particular as a micromechanical rotation rate sensor which is known per se.
Output signals of the evaluation device 110 are in this configuration, for example, the components of the translational speed {right arrow over (ν)}CM of the center of gravity of the vehicle in the center of gravity system 402 or—if there is provision for the rotational angles of the vehicle 101 to be determined by integration of the rotation rates—the translational speed {right arrow over (ν)}CMh in the horizontalized system. Further output variables are the two rotation rates of the vehicle 101, which are not measured directly by means of the rotation rate sensor 601. When a yaw rate sensor is used, these are the rolling rate and the pitching rate of the vehicle 101.
Ignoring the rolling motions and pitching motions of the vehicle 101, it is also possible to use a sensor configuration of a speed cluster 102 and a rotation rate sensor 601 in order to determine the previously mentioned variables approximately. This sensor configuration is illustrated schematically in
As long as the vehicle 101 is subjected at most to small longitudinal and transverse accelerations, the rolling and pitching motions of the vehicle 101 are small. In a further configuration, there may therefore be provision for the rolling motions and pitching motions of the vehicle bodywork 105 to be ignored owing to spring compression, so that the rolling angle and pitching angle as well as the rolling rate and pitching rate of the vehicle 101 can be set to the value zero. In this configuration, the motor vehicle 101 is equipped with a sensor cluster 102 and a yaw rate sensor whose measurement signals are fed as input signals to the evaluation device in addition to the measurement signals of the sensor cluster 102. From the measurement signals of the sensor cluster 102, the evaluation device 110 determines here the speed {right arrow over (ν)} of the sensor cluster. An approximation value of the translational speed νCM of the center of gravity CM of the vehicle is then obtained using the yaw rate dψ/dt . This is done according to the relationship
which is acquired from equation (4) by ignoring the rolling rate and pitching rate of the vehicle 101. The variable x denotes here the x component of the vector {right arrow over (x)} in the sensor coordinate system 401, i.e. the distance of the center of gravity CM of the vehicle, measured in the longitudinal direction of the vehicle, from the sensor cluster 102, the variable y denotes the y components of the vector {right arrow over (x)} in the sensor coordinate system 401, i.e. the distance of the center of gravity CM of the vehicle, measured in the transverse direction of the vehicle, from the sensor cluster 102. The output signals of the evaluation device 110 comprise, in this configuration, the components of the approximated translational speed νCM of the center of gravity CM of the vehicle in the center of gravity system 402, which can be used at the same time as approximation values for the components of the speed {right arrow over (ν)}CMh of the center of gravity in the horizontalized system.
In one configuration, the sensor cluster 102 can also be positioned at the center of gravity CM of the vehicle 101 or perpendicularly below the center of gravity CM of the vehicle 101. In this case, the translatory speeds can be measured directly by ignoring the rolling motions and pitching motions of the vehicle 101, and it is no longer necessary to take into account any rotational components.
Likewise, the vehicle 101 can be equipped, in addition to the yaw rate sensor, with a rolling rate sensor and/or with a pitching rate sensor so that, in addition to the yaw rate, further rotation rates can be measured and taken into account in the calculation of the translational speed {right arrow over (ν)}CM of the center of gravity CM of the vehicle. By integrating the measured rotation rates over time, it is also possible to obtain the corresponding rotational angles and use them to determine the vehicle speed {right arrow over (ν)}CMh the horizontalized system from the speed {right arrow over (ν)}CM in the center of gravity system 402, so that the components of the vehicle speed {right arrow over (ν)}CMh can be output in the horizontalized system by the evaluation device 110.
In further embodiments, a sensor cluster 102 of the previously described type is also used. In addition, a device is provided with which rolling angles and pitching angles of the vehicle bodywork 105 are determined. In order to obtain the rolling angle and the pitching angle, it is possible here to provide, in particular, travel sensors on spring elements of a chassis of the vehicle 101, which spring elements support the vehicle bodywork 105 with respect to the wheels 106. The travel sensors are each assigned here to a spring element and they measure the distance of spring travel which the bodywork 105 executes at the corresponding spring element. In the case of a four-wheeled vehicle 101, at least three travel sensors are provided at, in each case one vehicle wheel 106 in order to determine the specified variables in a manner known to a person skilled in the art. A fourth travel sensor permits the variables to be obtained in a redundant way, so that more precise determination is possible. From the spring travel values measured by the travel sensors, the evaluation device 110, to which the measurement signals of the travel sensors are fed, obtains the pitching angle and the rolling angle of the vehicle 101. In addition, the rolling rate and the pitching rate of the vehicle 101 can be obtained in the evaluation device 110 by deriving the rolling angle and the pitching angle over time. Said rolling rate and pitching rate are then used to determine, from the obtained speed {right arrow over (ν)} of the sensor cluster 102 the translational speed {right arrow over (ν)}CM of the center of gravity CM of the vehicle using the relationship (4). On the basis of the obtained rolling angle and the obtained pitching angle the vehicle speed {right arrow over (ν)}CMh can be calculated in the horizontalized system. Output signals of the evaluation device 110 therefore represent the components of the vehicle speed {right arrow over (ν)}CMh in the horizontalized system, the rotation rates of the vehicle 101 and, if appropriate, the rotational angles of the vehicle 101 in this configuration.
A further embodiment of the invention provides for the use of a sensor cluster 701 which is illustrated schematically in
The frequency of the transmitted laser light is modulated according to the FMCW (Frequency Modulated Continuous Wave) principle, which is known per se, in order to use a laser unit 702i of the distance cluster 701 to determine not only the speed component {right arrow over (ν)}i but also the distance dLi which the respective measuring light beam 703i travels between the laser unit 702i or the resonator contained therein and the roadway surface. The frequency modulation is carried out by means of the control device 705 by correspondingly changing the current flowing through the laser diode. In one configuration, linear modulation according to a delta function is provided, as illustrated schematically in the diagram in
δf1=fD−fτ (9)
When the frequency decreases, the frequency shift (Y2 is obtained from the sum of the two portions, i.e. the following applies:
δf2=fD+fτ (10)
As a result, the two portions of the frequency shift can be obtained by evaluating the differential frequency during an increasing frequency and a decreasing frequency. In this context the following applies:
The speed component νLi and the distance dLi can be obtained from the equations (11) and (12) by means of the laser unit 702i. For the speed component νLi the following applies here:
where λ denotes the wavelength of the emitted laser light, and the following applies for the distance dLi:
where fswing denotes the frequency swing, i.e. the difference between the minimum and the maximum values of the modulated frequency, and T denotes the period length of the frequency modulation.
The distance cluster 102 can be used, as described above, to determine not only the distances dLi but also speeds νLi. The speed components (i=a,b,c) which are obtained by means of the distance cluster 701 correspond to those which can also be determined by means of the speed cluster 102. For this reason, an individual sensor cluster 701 can be used to determine speeds νLi and distances dLi.
However, it can also be provided that, instead of a single sensor cluster, a distance cluster 701 is used to determine these variables, with which distance cluster 701 the distances dLi are detected, and a separate speed cluster 102 of the previously described type is used to determine the speeds νLi. The distance cluster 701 and the speed cluster 102 can be integrated in a common housing in this configuration. In addition, the two sensor clusters 701, 102 can have a common evaluation device 704.
The distance obtained by means of a laser unit 702i of the distance cluster 701 corresponds to the absolute value of a connecting vector {right arrow over (d)}Li between the distance cluster 701 and the point on the roadway surface 104 at which the corresponding measuring light beam 703a, b, c impinges. The connecting vector is given by {right arrow over (d)}Li=dLi·{right arrow over (n)}Li, where the vector {right arrow over (n)}Li as given in equation (2), for the measuring light beams 103a, b, c, which describes the directions of the measuring light beams 703a, b, c. The three connecting vectors {right arrow over (d)}La, {right arrow over (d)}Lb and {right arrow over (d)}Lc span a plane which corresponds to the plane of the roadway. The evaluation device 704 can therefore determine from the obtained distances dLa, dLb and dLC, in particular, the rotational angles between the x-y plane of the sensor coordinate system 401 and the plane of the roadway. These rotational angles correspond to the rolling angle and the pitching angle of the vehicle bodywork 105, since the plane of the roadway is oriented parallel to the x-y plane of the horizontalized coordinate system.
In one configuration, for example a unit normal vector of the plane which is spanned by the measuring light beams 703a, b, c can be determined in order to determine the rotational angles. Such a unit normal vector is obtained by using the vector product, for example, by means of
where ∥•∥ denotes the absolute value. The unit normal vector {right arrow over (H)} corresponds to a unit vector of the horizontalized system in the z direction, given in the sensor coordinate system 401. Accordingly, the following applies:
{right arrow over (e)}
z
=S
y(−θ)Sx(−φ){right arrow over (H)} (16)
In this equation, {right arrow over (e)}z=(0,0,1)T denotes the unity vector in the z direction in the sensor coordinate system 401. The vector equation (16) comprises an equation system for determining the rolling angle φ and the pitching angle θ of the vehicle bodywork 105. By using {right arrow over (H)}=(h1,h2,h3) the following is obtained here as a solution:
In equation (18), the x component of {right arrow over (H)} is to be inserted into the physical unit in which the normalization has been carried out for {right arrow over (H)}, which may have been done, for example in centimeters or meters.
After the evaluation device 704 has determined the rolling angle and the pitching angle of the vehicle 101 on the basis of the measurement signals of the distance cluster 701, the rolling rate and the pitching rate of the vehicle 101 are calculated by deriving the rolling angle and the pitching angle over time. In order to determine the speed of the center of gravity in the center of gravity system 402 or in the horizontalized system, knowledge of the yaw rate of the vehicle 101 is additionally necessary as well as the rolling rate and the pitching rate. This knowledge is detected by means of a yaw rate sensor 901 in a configuration which is illustrated schematically in
{right arrow over (ν)}La−{right arrow over (ν)}Lb={right arrow over (ω)}×{right arrow over (r)}dist (19)
where {right arrow over (r)}dist denotes the connecting vector from the distance cluster 701 to the additional sensor cluster.
On the basis of the rolling rate, the pitching rate and the yaw rate, the evaluation device 704 then calculates, from the speed {right arrow over (ν)}La determined by means of the distance cluster 102 and/or from the speed {right arrow over (ν)}Lb obtained by means of the additional sensor cluster, the speed {right arrow over (ν)}CM of the center of gravity CM of the vehicle by using the relationship (4). On the basis of the rolling angle obtained by means of the distance cluster 701 and the obtained pitching angle it is possible, in a further step, to calculate the vehicle speed {right arrow over (ν)}CM from the speed {right arrow over (ν)}CMh in the horizontalized system in the evaluation device 704. Output signals of the evaluation device 704 therefore constitute in this configuration the components of the vehicle speed {right arrow over (ν)}CMh in the horizontalized system, the rotation rates of the vehicle 101 and, if appropriate, the rotational angles of the vehicle 101.
The previously described sensor configurations have in common the fact that the evaluation device 110, 704 can determine either the vehicle speed {right arrow over (ν)}CM in the centralized system or the speed {right arrow over (ν)}CM of the vehicle 101 in the center of gravity system 402, which speed {right arrow over (ν)}CM corresponds approximately to the speed {right arrow over (ν)}CMh in the horizontalized coordinate system. The obtained speed components can be used directly by further systems of the vehicle 101 such as, for example, driver information systems or control systems such as, for example, a vehicle movement dynamics control system. Furthermore, further vehicle movement dynamics variables can be derived from the obtained variables and can be used in further vehicle systems. In particular, the transverse acceleration of the vehicle 101 can be calculated from the vehicle transverse speed νCM,yh by derivation over time, so that there is no need for an additional transverse acceleration sensor, which is a customary component of conventional vehicle movement dynamics control systems. Furthermore, the attitude angle β of the vehicle 101 can be obtained from the longitudinal speed νCM,xh and the transverse speed νCM,yh of the vehicle, for which attitude angle β the following applies:
The attitude angle is particularly suitable for characterizing the driving state, in particular in critical driving situations, and can therefore be used, for example by vehicle movement dynamics controllers to stabilize the vehicle 101. However, with a conventional sensor system the attitude angle cannot be reliably obtained, so that the execution of vehicle movement dynamics control processes on the basis of the present invention can be significantly improved by making the attitude angle available.
Furthermore, in a number of previously described configurations, the yaw rate, the rolling rate and the pitching rate of the vehicle 101 can be obtained. These variables can also be made available to further devices of the vehicle 101. Examples of these devices are once again vehicle movement dynamics controllers whose control algorithms can include these variables or chassis controllers and further driving assistance systems and passive safety systems which compensate, for example, rolling motions and/or pitching motions of the vehicle bodywork 105.
Although the invention has been described in detail in the drawings and the preceding illustration, the illustrations are to be understood as being illustrative or exemplary and not restrictive; in particular, the invention is not restricted to the exemplary embodiments explained. Further variants of the invention and their embodiments emerge for a person skilled in the art from the preceding disclosure, the figures and the patent claims. Terms used in the patent claims such as “comprise”, “have”, “include”, “contain” and the like do not preclude further elements or steps. The use of the indefinite article does not preclude a plurality. An individual device can execute the functions of a plurality of units or devices which are specified in the patent claims.
Number | Date | Country | Kind |
---|---|---|---|
10 2007 044 722.3 | Sep 2007 | DE | national |
10 2008 011 194.5 | Feb 2008 | DE | national |
10 2007 015 863.1 | Mar 2008 | DE | national |
10 2008 038 615.4 | Aug 2008 | DE | national |
This application is the U.S. national phase application of PCT International Application No. PCT/EP2008/062354, filed Sep. 17, 2008, which claims priority to German Patent Application No. DE 10 2007 044 722.3, filed Sep. 18, 2007, German Patent Application No. 10 2008 011 194.5, filed Feb. 26, 2008, German Patent Application No. 10 2008 015 863.1, filed Mar. 26, 2008, and German Patent Application No. 10 2008 038 615.4, filed Aug. 12, 2008, the contents of such applications being incorporated herein by reference.
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/EP08/62354 | 9/17/2008 | WO | 00 | 7/6/2010 |