1. Field of the Invention
The present invention relates to a parking device, more particularly to an automatic parallel parking device.
2. Description of the Related Art
A conventional automatic parallel parking system uses many ultrasonic detectors to detect respective distances to each of a first obstacle and a second obstacle, and roughly estimates positions of the first and second obstacles based on the distances detected by the ultrasonic detectors. Although the ultrasonic detectors can detect whether obstacles are present in a specific range, they cannot detect accurate positions of the obstacles such that the automatic parking system is unable to make accurate determinations before a vehicle is parked automatically.
Furthermore, the conventional automatic parking system uses a pre-established algorithm to generate an automatic parking path. Generally, two steering positions for parking a vehicle are planned when the conventional automatic parking system uses this algorithm to generate the parking path. Consequently, a large parking space is needed. When the parking space is small, the system will determine that parking is not possible, that is, not possible with use of only the planned two steering positions.
Therefore, the object of the present invention is to provide an automatic parallel parking device, which is able to facilitate automatic parallel parking in a small parking space.
Accordingly, an automatic parallel parking device of the present invention comprises an ultrasonic positioning module and a central controlling unit.
The ultrasonic positioning module includes a plurality of ultrasonic sensor units disposed at different locations of the vehicle, and a computation unit. Each of the ultrasonic sensor units detects a distance to each of the first obstacle and the second obstacle. The computation unit has a pre-established space positioning matrix and pre-established approximate coordinate data, and estimates a first actual coordinate position of the first obstacle and a second actual coordinate position of the second obstacle based on the distances detected by the ultrasonic sensor units. Based on the space positioning matrix and the approximate coordinate data, the computation unit further estimates parking space dimension data of the parking space based on at least the first and second actual coordinate positions of the first and second obstacles.
The central controlling unit is coupled to the ultrasonic positioning module. The central controlling unit has a pre-established parking path algorithm and a pre-established minimal parking space. The central controlling unit is associated with various controls of the vehicle, and receives the first and second actual coordinate positions of the first and second obstacles and the parking space dimension data from the computation unit of the ultrasonic positioning module.
When the parking space is not smaller than the minimal parking space, the central controlling unit generates a parking path including at least two different steering wheel positions on the basis of the first and second actual coordinates of the first and second obstacles, the parking space dimension data, and the parking path algorithm, subsequently controls the vehicle to park in the parking space along the parking path, and finally utilizes a horizontal displacement of the vehicle to determine whether the vehicle is parked in the parking space.
Other features and advantages of the present invention will become apparent in the following detailed description of the preferred embodiment with reference to the accompanying drawings, of which:
Referring to
The automatic parallel parking device 5 comprises an ultrasonic positioning module 51, a central controlling unit 52, a vehicle body sensor unit 53, an image capturing unit 54, an image display unit 55, and an adjusting on-off unit 56.
Referring to
The space positioning matrix 41 is represented by
where ({circumflex over (x)}, ŷ, {circumflex over (z)}) is an estimated coordinate position of one of the first obstacle and the second obstacle, (x1, y1, z1), (x2, y2, z2), . . . , and (xn, yn, zn) are coordinate positions respectively of the ultrasonic sensor units 3, and {circumflex over (ρ)}1, {circumflex over (ρ)}2, . . . , and {circumflex over (ρ)}n are the distances detected respectively by the ultrasonic sensor units 3 and said one of the first obstacle and the second obstacle.
The actual coordinate position of each of the first obstacle and the second obstacle is calculated by
where δx, δy, and δz are errors between the estimated coordinate position and the actual coordinate position of said one of the first obstacle and the second obstacle in the x, y, and, z directions, respectively, ρ1, ρ2, . . . , and ρn are the distances detected respectively by the ultrasonic sensor units 3, δρ is a matrix formed by a difference between (a) distances between the ultrasonic sensor units 3 and said one of the first and second actual coordinate position and (b) distances between the ultrasonic sensor units 3 and the estimated coordinate position of said one of the first obstacle and the second obstacle, H is the space positioning matrix 41, δp is a matrix formed using δx, δy, and δz, and x, y, and z are components of the actual coordinate position.
The distances (ρ1, ρ2, . . . , ρn) detected by the ultrasonic sensor units 3 are transmitted to the computation unit 4. Subsequently, the distances (ρ1, ρ2, . . . , ρn), the estimated coordinate position ({circumflex over (x)}, ŷ, {circumflex over (z)}), and the respective coordinate positions of the ultrasonic sensor units 3, (x1, y1, z1), (x2, y2, z2), . . . , and (xn, yn, zn) are substituted into Equation (2), and then undergo an inverse matrix operation of Equation (3) so as to obtain errors, δx, δy and δz, between the estimated coordinate positions and the actual coordinate positions. The errors δx, δy, and δz are then substituted into Equation (4) to obtain the actual coordinate position (x, y, z). The actual coordinate position of said one of the first obstacle and the second obstacle is calculated by recursive substitution.
it is noted that the aforesaid Equations for calculating the actual coordinate position undergo a significant number of recursive computations, i.e., the actual coordinate position (x, y, z) for each of the first obstacle and the second obstacle undergoes a significant number of estimations, and the errors δx, δy, and δz become smaller and smaller in the recursive computations until the errors are smaller than a threshold, value. Accordingly, the actual coordinate position (x, y, z) for each of the first obstacle and the second obstacle can be estimated accurately.
In this embodiment, two measured values are taken for input fuzzy, i.e., a fuzzy table is utilized to obtain a K value, in order to reduce the recursive computations, before using the aforesaid conditions to estimate the actual coordinate position (x, y, z) for each of the first obstacle and the second obstacle. The K value is substituted into the following condition for defuzzification,
Then, a weight calculation is adopted to obtain an initialized guessed position as follows:
({circumflex over (x)},ŷ)=(1−K′)·(x2=ρ2·sin θ,y2+ρ2·cos θ)+K′·(x1+ρ1·sin θ,y1+ρ1·cos θ) (6)
where θ is a turning angle after the vehicle moves.
Then, the initialized guessed position is substituted into Equation (2) for recursive computations, such that the number of the recursive computations can be effectively reduced.
Referring to
Referring to
where L is a length of the vehicle, Rmin
Referring to
The image capturing unit 54 is used for capturing an image of an area behind the vehicle.
The image display unit 55 is coupled to the central controlling unit 52 and the image capturing unit 54, and compares the parking path and the image of the area behind the vehicle.
The adjusting on-off unit 56 is coupled to the central controlling unit 52 and receives a setting adjustment and correction control from a user. The adjusting on-off unit 56 controls on and off states of the central controlling unit 52. In this embodiment, the image display unit 55 and the adjusting on-off unit 56 are implemented by touchscreen display systems, which can be directly controlled by the user. The pre-established approximate coordinate data 42 includes a pre-set coordinate position of the first obstacle and a pre-set coordinate position of the second obstacle. For example, when the user activates the adjusting on-off unit 56 when at the initial position, since most parallel parking situations are similar in nature, it is possible to have pre-established rough approximations of the positions of the first and second obstacles, that is, the pre-set coordinate positions of the first and second obstacles.
The operators of the automatic parallel parking device 5 of the present invention will now be described.
The vehicle is driven to the initial position, after which the automatic parallel parking device 5 is turned on through the adjusting on-off unit 56. Subsequently, a parking environment map is established by the ultrasonic positioning module 51 and the image capturing unit 54.
Next, the vehicle is automatically braked and the user is instructed to place the vehicle in reverse. The image display unit 55 subsequently displays a predetermined parking space and compares this with an image of an actual parking environment. The adjusting on-off unit 56 is used to verify the parking space. The central controlling unit 52 generates a parking path including at least two different steering wheel positions on the basis of the first and second actual coordinate positions of the first and second obstacles, the parking space dimension data, and the parking path algorithm 521. The number of the steering wheel positions of the parking path is inversely related to the dimensions of the parking space.
As can be known from the above, the turning angle, α, between the initial position and the turning position is determined by the parking path algorithm 521. At this time, for determining the turning position(s), it is necessary only that the resulting distance between the vehicle and each of the first and second obstacles be equal to b0. That is, during each turn after the first turn, the turning radius is determined by what will be the resulting distances between the vehicle and the front and rear obstacles.
Finally, the central controlling unit 52 controls a steering device, an accelerator, brakes, and other mechanisms of the vehicle to perform automatic parking, during which it is continually detected whether the user is intervening in the operation of the vehicle or whether an additional obstacle appears suddenly. If such detection occurs, the automatic parallel parking device 5 gives control over to the user. The user subsequently uses the adjusting on-off unit 56 to confirm a parking path, and then the automatic parallel parking device 5 starts again so as to finish parking.
While the present invention has been described in connection with what is considered the most practical and preferred embodiment, it is understood that this invention is not limited to the disclosed embodiment but is intended to cover various arrangements included within the spirit and scope of the broadest interpretation so as to encompass all such modifications and equivalent arrangements.
Number | Date | Country | Kind |
---|---|---|---|
098132922 | Sep 2009 | TW | national |