PARKING ASSIST DEVICE
A parking assist device detecting a parking stall line from an image, which is captured by a capturing portion; setting a parking target position on the basis of the parking stall line; and assisting the vehicle to travel to the parking target position; the parking assist device includes a vehicle detecting portion for detecting a movement of the vehicle, a memorizing portion for memorizing the movement detected by the vehicle detecting portion, as a vehicle moving trajectory, a temporary parking target position estimating portion for assuming a temporary parking target position on the basis of variations of the vehicle moving trajectory, which has been memorized by the memorizing portion, and a parking stall line searching area setting portion for setting a parking stall line searching area, within which a parking stall line is searched on the basis of the temporary parking target position.
Latest AISIN SEIKI KABUSHIKI KAISHA Patents:
This is a Continuation Application of U.S. application Ser. No. 11/312,454 filed Dec. 21, 2005, which is based on and claims priority under 35 U.S.C. §119 to Japanese Patent Application 2004-369136, filed on Dec. 21, 2004; the entire disclosure of the prior application is considered part of the disclosure of the accompanying Continuation Application and is hereby incorporated by reference.
FIELD OF THE INVENTIONThe present invention relates to a parking assist device for assisting a parking operation.
BACKGROUNDA known parking assist device disclosed in JP59-201082A assists a vehicle to be parked into a parking stall as follows. First, the known parking assist device detects an actual steering angle by means of a steering sensor, and then, on the basis of a detected vehicle position and a predetermined data, which relates to a parking operation and previously inputted into the parking assist device. Then, the parking assist device calculates a required steering angle, which is required for the parking operation and displaying the required steering angle, is calculated, and further, and finally the parking assist device displays an instructing angle, which is required for operating the steering in order to park the vehicle into the parking stall, on a simple display means. Because the parking assist device disclosed in JP59-201082A calculates the steering angle on the basis of only the steering sensor, an error on detecting relative positions between the vehicle and the parking stall has been occurred. In consideration of such errors, parking assist devices disclosed in JP6-111198A, JP11-208420A, JP2000-079860A and JP2003-205807A, detect a parking target position after processing a rear image that is captured by, for example a CCD camera (charge-coupled device camera).
Specifically, the parking assist device disclosed in JP6-111198A captures a predetermined area around the vehicle including a parking stall by means of the CCD camera, calculates distances from the vehicle to the parking stall in each azimuth, and selects a single distance which is shortest, and set it as an entrance of the parking stall. Specifically, the parking assist device disclosed in JP11-208420A superposes an image that indicating a temporary parking target position of the vehicle on the captured image and sets a parking target position by adjusting the temporary parking target position by a position adjusting means such as a touch panel. More specifically, the parking assist device disclosed in JP2000-079860A sets a specific area of window in the vicinity of a white line and recognizes a parking stall depending on feature and the geometrical arrangement of the white line. Furthermore, in the light of a driving characteristic of a driver who generally passes in front of a parking target position and then turns the vehicle in order to park the vehicle into the target position, the parking assist device disclosed in JP2003-205807A assumes a parking target position on the basis of a running state of the vehicle before the parking operation and a moving locus and sets an initial displaying position within an adjusting frame for setting a target of the parking.
However, because the known parking assist device disclosed in JP6-111198A uses the image captured by the camera without applying any process, the parking target position cannot be detected accurately due to external elements such as a parking stall line of another parking stall, an image of another vehicle, which can be an obstacle, and a shadow of a building. In such case, it may be considered that an accurate parking target position can be obtained by executing the calculating operation over and over again, however, such measure is not general for the image data processing operation. The known parking assist device disclosed in JP2000-079860A processes within a certain area of the captured image, which is regulated by the window, in order to detect the parking stall line, so that another vehicle that may be an obstacle or element such as a background image, which may result in disturbance (brightness, a shadow of the vehicle and dirt on a road surface), can be eliminated. However, because the known parking assist device disclosed in JP2000-079860A needs to move the vehicle until the guide line reaches the target parking stall, the user need to do an extra operation. Thus, the level of easiness to park the vehicle by means of the parking assist device, which can rotates the wheel automatically, has been reduced.
Further, according to the known parking assist device disclosed in JP11-208420A, the driver need to adjust the temporary parking target position in order to set the parking target position correctly, as a result, the driver also need to do an extra operation, for example moving the temporary parking target position in a vertical direction and in a horizontal direction for each 2 dots, and setting the angle of the parking target position.
Furthermore, according to the known parking assist device disclosed in JP2003-205807A, because the vehicle moving locus may differs depending on levels of driving techniques or situations of the parking stall, for example, a position of another vehicle, which is parked in the vicinity of the target parking stall, it can be determined that the driver intends to park the vehicle into one of the left and the right parking stalls, however, the parking target position may be out of the parking stall. Thus, the driver need to adjust the adjusting frame displayed on the display by position adjusting means such as a touch panel in order to readjust the parking target position, as a result, it takes some time for the driver to set the parking target position.
A need thus exists to provide a parking assist device that can set a parking target position with high speed and high accuracy and can reduce burden on the user for setting the parking target position of the parking assist device.
SUMMARY OF THE INVENTIONAccording to an aspect of the present invention, a parking assist device detecting a parking stall line, which indicates a parking stall within a parking space, from an image, which is captured by a capturing means; setting a parking target position on the basis of the parking stall line; and assisting the vehicle to travel to the parking target position; the parking assist device includes a vehicle detecting means for detecting a movement of the vehicle, a memorizing means for memorizing the movement, which has been detected by the vehicle detecting means, as a vehicle moving trajectory, a temporary parking target position estimating means for assuming a temporary parking target position on the basis of variations of the vehicle moving trajectory, which has been memorized by the memorizing means, and a parking stall line searching area setting means for setting a parking stall line searching area, within which a parking stall line is searched on the basis of the temporary parking target position, which is assumed by the temporary parking target position estimating means.
The foregoing and additional features and characteristics of the present invention will become more apparent from the following detailed description considered with reference to the accompanying drawings, wherein:
An embodiment of a parking assist device according to the present invention will be explained hereinbelow in accordance with attached drawings.
The rear camera 2 (e.g., serving as a capturing means) is attached to the rear portion of the vehicle. Specifically, the rear camera is attached, for example, at the central portion in a vehicle width direction and above the number plate. The rear camera 2 is provided in a manner where its optical axis is tilted downward. The rear camera 2 includes a wide-angle lens, which covers a wide angle of view, such as 140 degrees, and captures a rear view within a distance of 8 meter from the rear end of the vehicle.
The display 3 is mounted to a center console or a panel within the interior of the vehicle 1. Further, the display 3 displays an image captured by the rear camera 2 and superposes a parking target frame W on the displayed image. The parking assist ECU 4 detects a parking stall line within the image captured by the rear camera 2 in order to set a parking target position K. The parking assist ECU 4 further assists the vehicle 1 to travel to the parking target position k. A configuration of the parking assist ECU 4 will be described later in detail. The steering angle sensor 5, which is attached inside the steering, detects the steering angle when the steering is rotated, and then outputs steering angle signals to the parking assist ECU 4. The steering angle sensor 5 detects a rotation amount of a steering column shaft by means of an optical sensor or the like.
The shift lever reverse switch 6 is housed in the shift lever. Specifically, the shift lever reverse switch 6 is turned on when the shift is positioned to the reversed mode, and turned off when the shift is not positioned to the reversed mode. The rear-right wheel speed sensor 7 and the rear-left wheel speed sensor 8 include an active wheel speed sensor, which is attached to a wheel of the vehicle 1, and the steering actuator 9 outputs a force by which a load used for rotating the steering can be lightened.
A configuration of the parking assist ECU 4 will be explained.
The vehicle detecting device 17 detects a vehicle, which is moving, and the memory 28 memorizes a vehicle moving trajectory detected by the vehicle detecting device 17. In this embodiment, the vehicle moving trajectory includes the steering angle of the vehicle 1 and he wheel speed of the vehicle 1. In consideration of data capacity, the memory 28 always stores data of the latest trajectory (e.g., trajectory within seven meters), and once the memory reaches full capacity, old data will be deleted in order make the space for latest data. Thus, latest data can be sequentially memorized. The temporary parking target position estimating device 18 assumes a temporary parking target position k on the basis of a variation of the vehicle moving trajectory. The parking stall line searching area setting device 19 sets a parking stall line searching area S, which is used for searching a parking stall line T, on the basis of the temporary parking target position k. The parking stall line detecting device 20 detects the parking stall line T within a parking stall line searching area S. The parking target position setting device 21 set a parking target position K on the basis of the detected parking stall line T.
The guide route calculating device 22 calculates a guide route, which is used for guiding the vehicle to the parking target position K. The steering wheel operation amount calculating device 23 calculates a steering wheel operation amount of the vehicle 1 on the basis of the guide route. The steering wheel controlling device 24 automatically controls the operation of the steering wheel of the vehicle 1 on the basis of the steering wheel operation amount.
The steering angle sensor 5, the shift lever reverse switch 6, the rear-right wheel speed sensor 7, the rear-left wheel speed sensor 8 and the like are connected to the CPU 11, and each of them outputs detecting signals. Further, the steering actuator 9 is connected to the CPU 11 in order to adjust a force, which is used for rotating the steering, on the basis of control signals, which are outputted by the steering wheel controlling device 24. Thus, the steering wheel can be automatically operated.
Preceding an explanation of the processes of the parking assist ECU 4, a projection transformation for displaying a parking target position, which is required for image recognition, and a method for detecting a moving amount of a vehicle in order to recognize a moving locus of the vehicle 1, will be explained.
P=C[R/T] Formula 2
In these formulas, P indicates a projection transformation matrix of 3×4, C indicates a inner parameter of the camera, R indicates a rotational movement and T indicates a parallel movement. The parking target position calculated by the world coordinate system is transformed into the image coordinate system by the above formulas and then superposed on the camera image displayed on the display 3 in graphical plots.
The “ds” indicates a minor moving distance and calculated on the basis of the rotation amount of the wheel that is detected by the vehicle wheel speed sensors 7 and 8 provided at the rear right and left wheels. The “R” indicates a turning radius of the vehicle 1 and calculated on the basis of a value detected by the steering angle sensor 5. The “a” indicates an accumulated moving distance from a position where the parking operation is started.
For example, as shown in
In a step 1 (herein below referred to as S1) in
In S2 in
When the driver positions the shift lever to the reversed mode in order to back the vehicle 1 into the parking stall G2, because the shift lever reverse switch 6 is turned on (S2:Yes), the parking assist ECU 4 goes to S3 and executes a calculation in order to assume the parking target position. In other words, considering that a right-left direction of the vehicle 1 as an X axis, and a front-rear direction of the vehicle 1 as Z axis, on the basis of values of dX, dZ, Ix1, Iz1 and Iz2, which are indicated in
Specifically, the parking assist ECU 4 reads the vehicle moving trajectory of steering angle and the vehicle wheel speed from the memory 28 and calculates deflection angle θ of the vehicle 1 per unit time. Then, the parking assist ECU 4 determines whether or not the vehicle 1 moves forward from the deflection angle θ and the vehicle 1 turns with describing an arc. Generally, when the vehicle 1 is backed into the parking stall, which is positioned on the left hand, the driver of the vehicle 1 moves the vehicle 1 forward passing in front of the parking stalls G and turns the vehicle 1 in a right direction. On the other hand, when the vehicle 1 is backed into the parking stall, which is positioned on the right hand, the driver of the vehicle moves the vehicle forward assign through the parking stalls G and turns the vehicle 1 in a left direction. Thus, it can be predicted from the turning direction whether the vehicle 1 will be parked into the parking stall G on the left hand or the parking stall F on the right hand. In this embodiment, it is predicted that the vehicle 1 will be parked into the parking stall G2.
When the vehicle 1 is parked into the parking stall G2 located on the left hand, the driver moves the vehicle 1 backward from the vehicle position B, turns the steering wheel in a left direction, then moves the vehicle 1 straight-backward, as a result, the vehicle 1 can be parked into a parking stall G, which is located so as to be orthogonal relative to the Z axis of the vehicle position A. As shown in
Then, the process goes to S4 and executes a process for detecting the parking stall lines. Generally a right parking stall line TR and a left parking stall line TL, which are used for compartmentalizing the parking stall G, are approximately predetermined of their lengths, widths, distances therebetween. As shown in
Intensity differences and geometrical characteristics within the right parking stall line searching area SR and the left parking stall line searching area SL, which are superposed on the rear image captured by the rear camera as described above, are calculated, and on the basis of the calculated values, positions of the right parking stall line TR and the left parking stall line TL and positions of end points thereof are detected. Further, on the basis of these detected positions, a parking target position K is set as shown in
Then, in S5 illustrated in the flowchart in
Then, in S7, a guide route, which is used for guiding the vehicle 1 from the vehicle position B to the parking target position K, is calculated. Then, the process proceeds to S8, and it is determined whether or not the driver adjusts the position of the parking target position K depending on whether or not the position adjusting switch 25 has been operated. When it is determined that the parking target position K has been adjusted by use of the position adjusting switch 25 (S8:YES), the process goes back to S7 and the guide route, which is used for guiding the vehicle 1 from the vehicle position B to an adjusted parking target position K′, is calculated.
On the other hand, if it is determined that the parking target position K has not been adjusted by use of the position adjusting switch 25 (S8:NO), the driver turns on the confirmation switch 27 in order to determine that the parking target position K is confirmed. If the confirmation switch 27 has not been turned on (S9:NO), the process goes back to S8 and standby until the parking target position K is adjusted. Then, when it is detected that the confirmation switch 27 is turned on (S9:YES), the process proceeds to S10, and an announcement such as “parking assist operation now starts” is output from the speaker 16 in order to notify the driver of starting the operation.
In S11, the parking assist ECU 4 inputs a speed signal, which is detected and output by the rear-right wheel speed sensor 7 and the rear-left wheel speed sensor 8, input a steering angle signal detected and output by the steering angle sensor 5 in order to calculate the moving amount of the vehicle 1, and then a position of the vehicle 1 relative to the guide route is detected. In S12, a target steering angle relative to the guide route is calculated, and in S13, the steering actuator 9 is controlled on the basis of the target steering angle. In this configuration, the steering wheel of the vehicle 1 is automatically rotated, and, when the driver stomps on the accelerator, the vehicle 1 starts moving in a rear direction toward the parking target position K.
Then, in S14, it is determined whether or not the vehicle reaches the parking target position K. If it is determined that the vehicle 1 does not reach the parking target position K (S14:NO), the process goes back to S11 and continues to control the steering wheel. On the other hand, if it is determined that the vehicle 1 reaches the parking target position K (S14:YES), it is determined that the parking operation is finished, and then the parking assist operation is finished.
According to the parking assist ECU 4 in this embodiment, the movement of the vehicle can be detected by the vehicle detecting device 17, the steering angle and the vehicle wheel speed are memorized in the memory 28 as the vehicle moving trajectory. Further, the temporary parking target position estimating device 18 reads the vehicle moving trajectory from the memory 28 and obtains information about how the vehicle has moved, in order to assume the temporary parking target position k. Because the moving locus of the vehicle 1 may differ depending on driving characteristics of the driver or a situation of the parking, the temporary parking target position k may not be included in the parking stall G2. The parking assist ECU 4 of this embodiment sets the parking target position K as follows. First, the parking stall line searching area setting device 19 sets the parking stall line searching area S within which the parking stall line T will be searched on the basis of the temporary parking target position k. After the image captured by the rear camera 2 is inputted into the parking assist ECU 4, the parking stall line T is detected within the parking stall line searching area S I the image. At this point, because the parking stall line T is detected only from the parking stall line searching area S, disturbances (such as differences of levels of brightness, shadow of other vehicles C1 and C2, dirt on the load surface and the like), which occurs outside the parking stall line searching area S, can be eliminated, as a result, an accuracy on detecting the parking stall line T can be enhanced, and the number of the calculations for detecting the parking stall line T can be reduced. Thus, the parking stall line T can be determined by correcting the temporary parking target position k on the basis of the parking stall line T. Thus, the parking target position K can be determined with high accuracy, as a result, chances that the driver resets the parking target position K by means of the position adjusting switch 25 can be reduced. Further, because the parking stall line T can be detected from the parking stall line searching area S, comparing to a case when the parking stall line T is detected from an entire image, a time for detecting the parking stall line T can be shortened, as a result, a time for setting the parking target position K can also be shortened. Thus, according to the parking assist ECU 4, the parking target position K can be set with high accuracy and high speed, as a result, hassles for the user when the parking target position K is set can be reduced.
Further, according to the parking assist ECU 4 of the embodiment, in consideration of the driving characteristics, for example, temporally stopping the vehicle 1 by the side of the parking stall G2 so as to be perpendicular to the parking stall G2 when the driver intends to park the vehicle 1 into the parking stall G2, the temporary parking target position estimating device 19 calculates a first point, at which the vehicle 1 temporally stops, a deflection angle θ at which the vehicle 1 rotates from the first position, and a moving distance of the vehicle 1 from the first position to a second position, at which the vehicle 1 turns at the predetermined deflection angle θ, on the basis of the vehicle moving trajectory. Then, on the basis of these values, the temporally stop position (first position), the deflection angle θ and the moving distance; an angle of the parking stall G2 relative to the vehicle 1 is assumed, as a result, the temporary parking target position k is assumed. In this configuration, chances that the parking stall line T of the parking stall becomes out of the parking stall line setting area S can be reduced, as a result, chances that the parking stall line T is not detected or incorrectly detected can be reduced.
Furthermore, according to the parking assist ECU 4 of the embodiment, when the driver positions the shift lever to the reversed mode, the shift lever reverse switch 6 is turned on. Once the shift lever reverse switch 6 is turned on, the parking assist instruction is inputted into the temporary parking target position estimating device 19, and the temporary parking target position k is assumed by the temporary parking target position estimating device 19. On the basis of the assumed temporary parking target position k, in order to assist a parking operation of the vehicle 1, the parking stall line T is detected, and the parking target position is set. Thus, because the temporary parking target position k is assumed when the shift lever reverse switch 6 is turned on, in other words, the turned-on operation of the shift lever reverse switch 6 is considered as a trigger; chances that the temporary parking target position k is assumed when, for example, the driver doesn't need the parking assist operation, can be reduced, as a result, needless calculations can be reduced.
Furthermore, according to the parking assist ECU 4 of the embodiment, the left parking stall line searching area SL and the right parking stall line searching area SR are set separately, and each of the left parking stall line searching area SL and the right parking stall line searching area SR is scanned in order to detect the left parking stall line TL and the right parking stall line TR. Thus, elements such as intensity differences, which occur within an area defined between the right parking stall line TR and the left parking stall line TL, can be eliminate, as a result, an accuracy on detecting the right parking stall line TR and the left parking stall line TL can be enhanced. Further, the number of the calculations can be reduced; as a result, calculation costs can also be reduced.
Further, according to the parking assist ECU 4 of the embodiment, when the guide route calculating device 22 calculates the guide route by which the vehicle 1 is guided to move to the parking target position K, the steering wheel operation amount calculating device 23 calculates the steering wheel operation amount for the vehicle 1 on the basis of the guide route. Then, the steering wheel controlling device 24 automatically controls the steering wheel of the vehicle 1 on the basis of the steering wheel operation amount in order to park the vehicle 1 into the parking stall G2. In this configuration, even a driver who is not good at parking can park the vehicle 1 into the parking stall G2 without any trouble.
The present invention is not limited to the above embodiment, and can be altered as following examples or applied to many cases.
In the above embodiment, the right parking stall line searching area SR and the left parking stall line searching area SL are set separately, however, only one parking stall line searching area S, which includes both the right parking stall line searching area SR and the left parking stall line searching area SL, may be set as shown in
In the above embodiment, a case when the parking stall G2 is located on the left hand of the vehicle is explained, however, the present invention can be applied to a case when the parking stall G is located on right and left sides of the vehicle 1. In this case, even when a lot of parking stalls are not occupied, a parking stall GX, into which the driver intends to park the vehicle 1, can be assumed on the basis of the temporally stop position, the deflection angle and the moving distance, and then the temporary parking target position k is assumed. Then the parking stall line searching area S can be set, and finally the parking target position K can be set with high accuracy.
In the above embodiment, the shift lever reverse switch 6 is housed in the shift lever and automatically turned on and off when the shift lever is positioned to the reversed mode, however, this parking assist instruction switch can be provided, for example, at the center console, and can be turned on and off manually by the driver.
In the above embodiment, the temporary parking target position k is assumed on the basis of the temporally stop position, the deflection angle and the moving distance, however, the temporary parking target position k may be assumed on the basis of, for example only the deflection angle. In this configuration, the calculation costs can be reduced.
The principles, preferred embodiment and mode of operation of the present invention have been described in the foregoing specification. However, the invention which is intended to be protected is not to be construed as limited to the particular embodiments disclosed. Further, the embodiments described herein are to be regarded as illustrative rather than restrictive. Variations and changes may be made by others, and equivalents employed, without departing from the spirit of the present invention. Accordingly, it is expressly intended that all such variations, changes and equivalents which fall within the spirit and scope of the present invention as defined in the claims, be embraced thereby.
Claims
1. A parking assist device for assisting a vehicle to travel to a parking target position, comprising:
- a vehicle movement detector which detects movement of the vehicle;
- a storage device which stores the movement detected by the vehicle movement detector as a vehicle moving trajectory;
- a temporary parking target position estimator which estimates a temporary parking target position based on variation of the vehicle moving trajectory;
- a parking stall line searching area setting device which sets a parking stall line searching area within which the parking stall line is searched on the basis of the temporary parking target position which is estimated;
- a parking stall line detecting device which detects the parking stall line within the parking stall line searching area by an image recognition from an image captured by an imaging device; and
- a parking target position setting device witch sets a parking target position on the basis of the parking stall line;
- wherein the parking stall line searching area setting device sets a single parking stall line searching area in which both a right parking stall line and a left parking stall line are included.
Type: Application
Filed: Dec 4, 2009
Publication Date: Apr 1, 2010
Applicant: AISIN SEIKI KABUSHIKI KAISHA (Aichi-ken)
Inventors: Yu Tanaka (Aichi-Ken), Toshiaki Kakinami (Aichi-ken)
Application Number: 12/631,480
International Classification: B60Q 1/48 (20060101);