The invention relates to a parking assistance for a vehicle.
The invention also relates to a parking space measuring module for a vehicle.
The invention also relates to a method for measuring a parking space for a vehicle.
The object of this invention is to create a parking assistance and a parking space measuring module as well as a method that will permit measurement of a parking space, in particular for automatic driving or steering of the vehicle or assisting the driver during his steering activity in maneuvering into a parking space in a relatively simple and convenient manner.
This object is achieved by a parking assistance for a vehicle which is characterized in that the parking assistance permits autonomous driving or steering with a vehicle on a path for maneuvering into a parking space or assists a driver of a vehicle in a parking maneuver on the path for maneuvering into the parking space by means of a steering torque applied to the steering wheel, whereby the driver is guided into the parking space by at least one artificial steering stop, preferably one or two artificial steering stops on the path for maneuvering into the parking space, and the parking space is measured by means of a lateral distance measurement and a determination of position for the signals of wheel rpm sensors and a steering angle sensor.
In one embodiment according to this invention, convenient instructions are given to the driver by means of haptic feedback. In doing so, it remains ensured that the driver will implement or intentionally agree with the instructions while parking.
In an alternative embodiment according to this invention, the vehicle is automatically steered on a certain path into a parking gap.
This object is achieved by a parking space measuring module for a vehicle, in particular for a parking assistance according to this invention, whereby a parking space is measured by means of a lateral distance measurement and a position determination from signals from wheel rpm sensors and a steering angle sensor.
This object is achieved by a method for measuring a parking space for a vehicle, in particular for a parking assistance according to this invention, which is characterized in that measurement of the parking space is performed by a lateral distance measurement and a position determination from a steering angle, preferably a steering angle measured by a steering angle sensor, and a path change information, preferably a path measured on the basis of wheel rpm sensors.
This invention is used in particular for measuring a parking space for parking in reverse, where the parking space is recognized and measured via the sensor signals as the vehicle passes by the parking space.
According to this invention, the parking space is measured by dividing the process into the following steps:
This means that tolerance ranges are defined after an initially approximate detection of the parking space. Then the front of the vehicle is aligned (linear equation). Next a deviation in the measured signals from the determined signals is determined. Depending on the deviations, the corner positions have been determined. Finally the parking space is determined and/or measured, i.e., its size and position in relation to the vehicle to be parked are determined.
According to this invention, the signals of the wheel rpm sensors are interrupt signals of the rear wheel rpm sensors of the wheels of a rear axle (rear wheels) and, depending on the extent of these signals, which are preferably averaged, a path change of the rear axle midpoint is determined, in particular with regard to a Cartesian coordinate system.
According to this invention, a Cartesian coordinate system is defined as a “lower” Cartesian coordinate system in an initialization phase for a parking procedure.
According to this invention, path change of the midpoint of the rear axle of the vehicle and a steering angle □actual measured by the steering angle sensor for a continuous determination of position and yaw angle (Ψ) is calculated in relation to a coordinate system set at the start.
According to this invention a current position of the vehicle is determined in the following steps:
According to this invention, an x-y position of the object surfaces bordering the parking space is calculated in relation to a global coordinate system on the basis of a continuously determined position and a continuously determined yaw angle (Ψ) in relation to a coordinate system set at the start and a distance d from the lateral distance measurement.
According to this invention, recognition of the parking space and/or the object surfaces bordering the parking space is performed independently of stored values or intermediate values essentially only on the basis of a change in a distance d from the lateral distance measurement.
According to this invention, measured values and/or sensor signals of the lateral distance measurement and/or position determination are at least partially filtered.
According to this invention, a (global) Cartesian coordinate system is defined for a parking operation and a tolerance range for the x coordinate is preselected or determined as a function of jumps in the distance value d at the beginning of the parking space and at the end of the parking in which a corner of the objects or vehicles bordering the parking space could lie.
According to this invention, fronts of the vehicles bordering the parking space (vehicle fronts in front of and behind the parking space) are determined from the measured values and the values outside of the tolerance range (i.e., without the values in the tolerance ranges) and the vehicle fronts of the vehicle in front and the vehicle in the back are described as a linear equation, whereby these equations are each preferably determined by the method of the least error squares.
According to this invention, the exact exposition at the corner is determined from the deviations in the measured values from the straight lines determined. Then the X coordinate of the corner thus found is inserted into the linear equation to determine the Y position of the corner.
According to this invention, the fronts of the vehicles bordering the parking space (vehicle fronts in front of and behind the parking space) are determined and a shape of a driving path border (curb) is deduced from the vehicle fronts thereby determined.
According to this invention, determining the parking space includes the following steps:
The invention will now be illustrated in greater detail as an example on the basis of an exemplary embodiment and figures (
In the figures:
According to this invention, signals from the wheel rpm sensors, preferably the interrupt signals of the rear wheel rpm sensors (Wheel_Interrupts_RL and Wheel_Interrupts_RR) are used to determine a change in path of the rear axle head point in relation to a global Cartesian coordinate system.
The observed wheel rpm sensor signals are averaged for this purpose.
The global Cartesian coordinate system is defined in an initialization phase for the entire algorithm.
The path, i.e., the change in path of the rear axle midpoint is calculated together with the measured steering angle □actual (rad) by a steering angle sensor for continuous determination of position and yaw angle (Ψ) in relation to a coordinate system set at the start. This situation is depicted in
The current position of the vehicle is advantageously determined with the help of three recursive equations.
First with the help of the wheel rpm sensor signals and a scaling factor (scaling factor Mm_per—100_teeth) the distance Δs, is calculated preferably in units of cm by which the vehicle has moved since the last scanning step, here in particular a last program run-through of a regulating program (the last software loop).
If this distance is known, then with the help of the steering angle on the wheel and the wheel base 1 of the vehicle (see
The new yaw angle is obtained from the following recursive formula:
Now the current actual x position xactual and the actual y position yactual of the rear axle midpoint can be determined from the yaw angle and the steering angle:
xist(k+1)=xist(k)+Δs*cos(δist(k))*cos(Ψist(k+1)) (3)
yist(k+1)=yist(k)+Δs*cos(δist(k))*sin(Ψist(k+1)) (4)
With this position information, the parking space can be measured by a laterally oriented sensor (see
In
The x-y position of the object surfaces detected can be calculated in relation to the global coordinate system from the distance d measured laterally together with the change in position of the rear axle midpoint and the yaw angle Ψ.
If there are multiple measured y values for one x value, then these values are averaged or the y value extending the farthest into the path of the vehicle (worst case) is the value used.
The parking space corners are detected independently of these stored values merely on the basis of the change in the distance d measured by the sensor.
In order for individual “false” measured values (freak values) not to be recognized as corners, there is a filtering, in particular only “weak” filtering of the signal to smooth out the freak values. At the same time, there is also filtering of the signal, in particular a “strong” filtering to smooth out the actual corners. The difference between these signals corresponds to the recognition quality of the corners and is compared with a threshold value. On exceeding the threshold value, it is assumed that a corner has been passed.
A tolerance range for the x coordinate within which the corner could be situated is assumed about the recognized corner position. The calculated positions of the object surface measured in a defined x range in front of the tolerance range of the first corner are then considered part of the first vehicle front.
The data between the two corner areas is counted by analogy with the parking space which starts after the second corner to the second vehicle front.
On the basis of the recognized ranges vehicle front 1,7, parking space 4, vehicle front 2,8 the coordinates of the parking space can then be calculated from the stored measured data.
The vehicle fronts of the vehicle in front and the vehicle behind are described in simplified terms as a linear equation. These equations are preferably determined by the method of least error squares.
The deviation in the measured y coordinates from the vehicle front linear equations in the tolerance range is averaged and used to obtain information about the beginning and end of the parking space.
When a deviation threshold is exceeded, the two x coordinates xedge1, xedge2 of the parking space corners are each determined. The y coordinates of the two parking space corners yedge1, yedge2 are calculated by inserting xedge1, xedge2 into the respective equations of the vehicle fronts.
To better distribute an available computation power over the entire measurement process, it is divided among the following states:
The forward parking trajectory (forward path) may be calculated once without further measurements. Further measurements during the parking operation may be utilized to update the calculation of the second vehicle front. In this case however recalculation of the trajectory (path) is necessary.
This method also offers the advantage of omitting a curb measurement. In this case, the curb is deduced from the vehicle fronts 7, 8.
Number | Date | Country | Kind |
---|---|---|---|
10 2004 011 407.2 | Mar 2004 | DE | national |
10 2005 006 965.7 | Feb 2005 | DE | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/EP05/50822 | 2/25/2005 | WO | 7/12/2007 |