The disclosure of Japanese Patent Application No. 2003-183095 filed on Jun. 26, 2003, including the specification, drawings and abstract is incorporated herein by reference in its entirety.
1. Field of the Invention
The invention relates to vehicular driving assist apparatus and method for determining a locus of run to a target position and assisting the driving of a vehicle so that the vehicle follows the locus of run.
2. Description of the Related Art
A related-art technology for guiding a vehicle to a target position through the use of the automatic steering, the steering command, etc., is disclosed in, for example, Japanese Patent Application Laid-Open Publication No. 10-278825. In this related technology, a reference amount of operation of a brake pedal is pre-set in order to adjust the vehicle speed in accordance with the response speed of a steering actuator during the automatic steering. A deviation between the reference amount of operation and the actual amount of operation caused by the driver is calculated, and is indicated to the driver. Therefore, the vehicle speed is prevented from becoming excessively high and low, so that appropriate automatic parking control becomes possible.
In this technology, the vehicle speed is uniformly set. However, in an actual control, the vehicle speed in the case where the steering angle is changed by driving the steering actuator and the vehicle speed in the case where the steering angle is maintained do not need to be the same If the vehicle speed is uniformly set, there is a possibility that the driving to a target position may consume an inconveniently long time or that sufficient vehicle speed cannot be obtained despite a driver's desire for increased speed and thus controllability may become low.
As forms of the invention, driving assist apparatus and method for a vehicle described below are provided. The driving assist apparatus includes: a computing portion that computes a path that extends from an initial position of the vehicle to a target position of the vehicle and that includes a changing steer region where a steering angle is changed and a fixed steer region where the steering angle is fixed; an automatic steering portion that execute automatic steering of the vehicle in order to guide the vehicle along the path to the target position; an alarm device that gives an alarm to a driver if a vehicle speed exceeds a predetermined alarm vehicle speed during an operation of the automatic steering portion; and an alarm vehicle speed setting portion that sets the alarm vehicle speed, wherein the alarm vehicle speed setting portion sets the alarm vehicle speed higher for the fixed steer region than for the changing steer region.
The driving assist method includes the steps of: computing a path that extends from an initial position of the vehicle to a target position of the vehicle and that includes a changing steer region where a steering angle is changed and a fixed steer region where the steering angle is fixed; executing automatic steering of the vehicle in order to guide the vehicle along the path to the target position; giving an alarm to a driver if a vehicle speed exceeds a predetermined alarm vehicle speed during an operation of the automatic steering portion; and setting the alarm vehicle speed, wherein the alarm vehicle speed is set higher for the fixed steer region than for the changing steer region.
According to the driving assist apparatus and method, different alarm vehicle speeds are set for the fixed steer region and the changing steer region. In the changing steer region where a driving device of the automatic steering device drives a steering system, the alarm vehicle speed is set relatively low. Therefore, the load on the driving device is reduced, and high-accuracy steering is realized. Furthermore, in the fixed steer region where the driving device does not drive the steering system, the alarm vehicle speed is set relatively high so as to allow movement at a higher speed than in the changing steer region. Therefore, the time of travel to the target position can be reduced. Due to the changing of the alarm vehicle speed in accordance with the path, controllability improves.
The above mentioned embodiment and other embodiments, objects, features, advantages, technical and industrial significance of this invention will be better understood by reading the following detailed description of the exemplary embodiments of the invention, when considered in connection with the accompanying drawings, in which:
In the following description, the present invention will be described in more detail in terms of exemplary embodiments.
A driving assist apparatus in accordance with the invention will be described below with reference to a parking assist apparatus as an example.
A steering angle sensor 23 for detecting the amount of steer of a steering shaft 21 that transfers the movement of a steering wheel 22 to steering tire wheels 25, and a steering actuator 24 that provides steering force are connected to the steering shaft 21. In addition to providing a steering force during an automatic steering mode, the steering actuator 24 may serve as a power steering device that provides an assist steering force while a driver is steering. The steering control portion 11 controls the driving of the steering actuator 24.
The steering control portion 11 receives an output signal of the steering angle sensor 23, and also receives output signals of tire wheel speed sensors 41 that are provided for the individual tire wheels for detecting the rotation speeds thereof and an output signal of an acceleration sensor 42 that detects the acceleration of the vehicle.
The aforementioned image processing portion 10 receives an image signal, that is, an output signal of the back camera 32 disposed at a rear portion of the vehicle for acquiring mages in a rearward direction. The image processing portion 10 is connected to input means 31 for accepting a driver's input operation in conjunction with the parking assist, a monitor 34 for displaying information in the form of images to a driver, and a speaker 33 for presenting information in the form of sounds and voices.
Next, assist operations of the parking assist apparatus will be specifically described. Firstly, a first control form of assist operation will be described. In the first control form, an assist is performed for a generally termed garage parking operation as illustrated in
The control illustrated in
Specifically, a driver moves the vehicle to an arbitrary start position of parking assist, and recognizes a target position in a rearward image taken by the back camera 32 and displayed in the monitor 34. After that, the driver operates the input means 31 so as to start the parking assist control illustrated in
The parking assist ECU 1 compares the absolute value of the steering angle δ from an output of the steering angle sensor 23 with a threshold value δth (step S1). If the steering angle δ is less than or equal to the threshold value δth, and is therefore sufficiently small, the parking assist ECU 1 determines that the vehicle is in a neutral steering angle state, and permits transition to a parking assist control. Subsequently, the process proceeds to step S2. As indicated in
In step S2, the driver operates the input means 31 while watching a back camera 32-taken image displayed in the monitor 34. At this time, the driver sets a target parking position by moving a displayed parking frame to the target parking position in the display screen.
Through an image recognition process, the parking assist ECU 1 determines a vehicle position 200g at the target parking position, more specifically, the position of the reference point G and the direction of the vehicle at the position of the reference point G (step S4).
The position of the point G can be determined, for example, as relative coordinates with respect to the reference point A at the present vehicle position. The following description will be made with reference to a coordinate system as shown in
Next, a shortest path (hereinafter, referred to as “basic path”) P0 that is needed in order to reduce the deflection angle θ to zero is computed from the present position (initial position point A), the present deflection angle θ0 and the present steering angle δ (step S6).
This running locus P0 is set as changes in the curvature of turn (=the reciprocal of the radius of turn) with respect to the distance of run.
The shortest path P0 includes a path where the steering angle is increased (First path), a path where the increased steering angle is maintained (Second path), and a path where the steering angle is returned to neutral (Third path). In each one of the first path and the third path, the amount of change in the turning curvature with respect to the running distance (the rate of change in the turning curvature) is set at a constant value. The rate of change in the turning curvature is set so that even when the vehicle speed is equal to an upper limit value for the driving assist, the amount of change in the turning curvature is less than the amount of change in the curvature achieved by the maximum steering rate of the steering actuator 24. Therefore, a path that allows a steering operation without fail can be computed.
Representative examples of the locus set in this case are as follows. Firstly, the steering angle is increased while the rate of change in the steering angle with respect to the running distance from an initial position point B to a point C is kept at a fixed value. In this case, when the point C is reached, the steering angle and the turning curvature become equal to their respective set maximum values, and the turning radius becomes equal to a set minimum turning radius (Rmin) (curvature γmax=1/Rmin) (First path). From the point C to a point D, this steering angle (turning curvature, turning radius) is maintained (Second path). From the point D, the steering angle is reduced while the rate of change in the steering angle with respect to the running distance is kept constant. In this case, the steering angle changes to the neutral state, that is, the steering angle of O, when a point E is reached (Third path). The running locus P forms a clothoid curve where a section BC is an arc having a radius of Rmin, and a section CD is a curve having a curvature of γ0 at an end and a curvature of 1/Rmin at the other end, and a section DE is a curve having a curvature of 1/Rmin at an end and a curvature of 0 at the other end.
In some cases where the deflection angle θ is small, the running locus has no arc section. The amount of change Δθ in the deflection angle θ in the section BC is expressed as in equation (1).
In equation (1), γ(p) represents the curvature at a running distance p. That is, the amount of change Δθ in the deflection angle equals an area S0 indicated in
Next, the length of the basic path P0 in the direction X and the length thereof in the direction Z are determined (step S*). The lengths Xf, Zf of the basic path P0 in the directions X, Z can be determined as in equations (2) and (3).
In these equations, θ(p) is the deflection angle at a running distance p.
Subsequently, straight-line paths are added to the basic path P0 so as to set a target path P1 (step S10).
That is, as indicated in
X0=Lo×sin θ0+Xf (4)
Z0=L0×cos θ0+Zf+L3 (5)
Since all the terms except L0 and L3 are known, L0 and L3 can easily be determined from equations (4) and (5).
Subsequently in step S12, it is determined whether a path has been set successfully.
Specifically, it is determined that a path has been set, if neither one of L0 and L3 is negative, that is, if L0 and L3 are 0 or positive. The case where L0 is negative means a case where the length Xf of the basic path P0 in the direction X is greater than the distance (x0) between the point A and the point G in the direction X. The case where L3 is negative is a case where the length Zf of the basic path P0 in the direction Z is greater than a length obtained by subtracting the length L0×sin θ of the initial straight-line path in the direction Z from the distance z0 between the point A and the point G in the direction Z. If it is determined in step S12 that it is not possible to properly set a path that reaches the target position point G from the point A, the process proceeds to step S50. In step S50, it is indicated to the driver via the monitor 34 and the speaker 33 that the vehicle cannot reach the target position point G from the present point A. After that, the process ends. The driver can initiate the parking assist operation again after moving the vehicle 200 if necessary.
Next, alarm speeds Valarm and limit speeds Vlimit of the vehicle at various positions on the locus of run are set on the basis of the set target locus of run (step S14).
The alarm speed Valarm is a vehicle speed threshold value for instructing the driver to slow down via the speaker 33 and the monitor 34 if the vehicle speed exceeds this value. The limit speed Vlimit is a vehicle speed threshold value for stopping the control if the vehicle speed exceeds this value. Therefore, the alarm speed and the limit speed are set so that Vlimit>Valarm holds.
This embodiment is characterized in that the alarm speed Valarm and the limit speed Vlimit are changed in accordance with a set path. When the amount of change (dγ/dp) of the turning curvature γ with respect to unit running distance of the vehicle at the position of a running distance p from the initial position is defined as turning curvature rate ω(p), the limit speed Vlimit(p) and the alarm speed Valarm(p) at the running distance p are expressed as in the following equations (6) and (7).
In the equations, V1, V2, V3 and V4 are set so that V1>V2 and V3>V4.
Relationships between the running distance p on the target locus of run with the limit speed Vlimit(p) and the alarm speed Valarm(p) are indicated in
By changing the alarm speed Valarm and the limit speed Vlimit in accordance with the state of steering as described above, the vehicle speed is restrained from exceeding the range of vehicle speed limited by the capacity of the steering actuator 24. Therefore, the driving assist control is reliably executed. While the steering is not being changed, that is, a steering operation is not being performed, the vehicle speed is allowed to become higher than the aforementioned alarm speed, so that the time of travel to the target position can be reduced. Furthermore, since the changing of the alarm speed to the steering operation-purpose reduced value is accomplished at the position of a predetermined distance prior to the start of steering operation, the vehicle speed will become sufficiently low before the steering operation is started. Therefore, controllability improves.
The setting of limit speeds Vlimit and alarm speeds Valarm is followed by an actual assist control that starts at step S16. At this time, it is preferable that when the shift lever is set at the reverse position, the parking assist ECU 1 instruct a drive force system (not shown) to execute an engine torque increase control. The torque increase control is a control of causing a change to a high driving force state (state of increased torque) by operating the engine at a revolution speed that is higher than a normal idling speed. This control expands the range of vehicle speed where a driver can adjust the vehicle speed by using only the brake pedal without operating the accelerator, so as to improve the operability of the vehicle. If the driver operates the brake pedal, the braking force applied to each wheel is adjusted in accordance with the degree of depression of the pedal, and therefore the vehicle speed is correspondingly adjusted.
In the control of guiding the vehicle to the target position, the present position of the vehicle is first determined (step S16).
The present position can be determined on the basis of the movement of a characteristic point in the image taken by the back camera 32. The present position can also be determined on the basis of a change in the running distance based on output signals of the tire wheel speed sensors 41 and the acceleration sensor 42, and a change in the steering angle based on an output signal of the steering angle sensor 23.
Next, the present vehicle speed V is compared with the limit speed Vlimit(p) (step S18).
If it is determined that the vehicle speed V is higher than the limit speed Vlimit(p), the process proceeds to step S50. In step S50, it is indicated to the driver that the vehicle speed is above the set upper limit value, and the assist control is stopped.
Conversely, if it is determined that the present vehicle speed V is less than or equal to the limit speed Vlimit(p), the present vehicle speed V is compared with the alarm speed Valarm(p) (step S20).
If it is determined that the vehicle speed V is higher than the alarm speed Valarm(p), the process proceeds to step S40, in which the driver is prompted to slow down via the speaker 33 and the monitor 34. If it is determined in step S20 that the vehicle speed V is less than or equal to the alarm speed Valarm(p), the process skips step S40.
Then, a steering control is performed so as to obtain the turning curvature set on the basis of the set locus of the running distance-turning curvature relation set on the basis of the present position (running distance) determined in step S16 (step S22).
Specifically, the steer control portion 11, while monitoring the output of the steering angle sensor 23, controls the steering actuator 24 so as to drive the steering shaft 21 and change the steering angle of the steering tire wheels 25 to the set steering angle displacement. It is difficult to directly measure the turning curvature γ. Therefore, a relationship between the steering angle δ and the turning curvature γ of the vehicle may be determined beforehand, and the control may be performed on the basis of the relationship so as to achieve a steering angle δ corresponding to a desired turning curvature γ.
Since the vehicle is moved along a target path set as described above, the driver can concentrate on safety-checking surroundings on road and adjusting the vehicle speed. Furthermore, since each wheel receives a braking force corresponding to the amount of depression of the brake pedal accomplished by the driver, the driver can safely decelerate or stop the vehicle even if there exists an obstacle, a pedestrian, or the like on the road.
Furthermore, if the vehicle speed V exceeds the alarm speed Valarm, the driver is prompted to slow down. If the vehicle speed V exceeds the limit speed Vlimit and therefore it is determined that the path guidance by the parking assist apparatus 100 is difficult, the process is stopped. Thus, reliable guidance is possible.
In this embodiment, the limit speed Vlimit for the period of steering operation is set at a value such that the limit of the steering rate of the steering actuator 24 will not be exceeded. Conversely, during a non-steering operation period when the steering actuator 24 is not driven, the limit speed Vlimit is set relatively high, so that the vehicle speed V can be relatively high and the time of travel can be reduced. However, if the vehicle speed becomes high, the steering needed for the run of the vehicle cannot be achieved without an increase in the steering rate of the steering actuator 24. Therefore, the limit speed Vlimit and the alarm speed Valarm during a steering operation are determined on the basis of the steering rate of the steering actuator 24.
Still further, the alarm speed Valarm is reduced at a position of a predetermined distance prior to a position to start steering on a target path, a margin for sufficient deceleration is provided at the steering start position.
For example, a case where the vehicle speed is close to V3 at a postion of a sufficient distance prior to a start of steering will be considered. If in this case the alarm speed Valarm is changed at the time point of starting steering, there is possibility that the vehicle speed will exceed the limit speed Vlimit of V2 due to a downhill slope, variations in the engine output, etc., and therefore the control will be stopped, even though the vehicle speed does not reach the alarm speed Valarm prior to the start of steering.
In contrast, in this embodiment, the alarm speed Valarm is reduced to V4 before steering is started. Therefore, prior to the start of steering, the driver is allowed to reduce the vehicle speed sufficiently below the limit speed Vlimit of V2, so that frequent stops of the control will be avoided. Hence, controllability will improve, and the reliability in reaching the target position will improve.
After the steering control, it is determined whether there is a deviation of the present position from the target path. If there is a great deviation, it is determined that path correction is needed (step S24).
The deviation from the target path can be determined, for example, by accumulating the deviation of the present position from the target position or the deviation of the actual amount of steer from the target amount of steer with respect to the distance of run. If path correction is needed, the process proceeds to step S6, in which a path is set again.
Conversely, if there is only a small deviation from the target path, the process proceeds to step S26, in which it is determined whether the vehicle has reached the vicinity of the target parking position point G.
If it is determined in this step that the target parking position has not been reached, the process returns to step Si 16 in order to continue the assist control. Conversely, if it is determined that the target parking position has been reached, the process proceeds to step S28. In step 28, it is indicated to the driver via the monitor 34 and speaker 33 that the target parking position has been reached. After that, the process ends.
Thus, a basic path is determined, and a straight-line path is added to one of the two ends or each end of the basic path, so as to set a path. Therefore, the algorithm of path computation is simplified. Furthermore, since the calculation is simplified, the computation load is relatively small, and real-time computation can easily be performed by using a reduced computer resource. Furthermore, since there is no accuracy deterioration in calculation, high-accuracy guidance to the target position can be accomplished.
Next, a second control form of the assist operation will be described. Similar to the foregoing first control form, the second control form is provided for executing garage parking assist. This embodiment differs from the foregoing embodiment only in the method of setting a target path from a basic path P0. Specifically, as illustrated in the flowchart of the setting process in
x0=L0×sin θ0+ε×Xf (8)
z0=L0×cos θ0+ε×Zf+L3 (9)
As for ε, if Zf/Xf is less than or equal to z0/x0, that is, if the ratio between the length of the basic path P0 in the direction Z and the length thereof in the direction X is less than the ratio between the length of the target path in the direction Z and the length thereof in the direction X, and is elongated laterally (in the direction X), it is appropriate to set ε so as to satisfy ε≦x0/Xf. Conversely, if the basic path is elongated longitudinally (in the direction Z), the setting of, for example, ε=x0/Xf, causes the end point of the similarity-enlarged path to go beyond the target parking position point G, so that ε needs to be set at a smaller value. In this case, the maximum value of ε is a value that occurs when L3 is 0, and is expressed as in equation (10) based on equations (8) and (9).
The value of ε for use does not need to be the maximum value, but may be an arbitrary value less than that. If the similarity enlargement factor ε is set, the lengths of the straight-line paths can be calculated via equations (8) and (9). Thus, a target path P3 can be set.
As for the similarity-enlarged path P2 in the target path P3 set as described above, if the curvature at the position of a running distance p from the point A on the basic path P0 is expressed as γ(p), the curvature at the position of a running distance εp from the point A is expressed as γ(p)/ε. As indicated in
Through the similarity transformation, the maximum value of the curvature reduces from γmax on the basic path to 1/ε time γmax, that is, γmax/ε, and the steering rate ω reduces to 1/ε2. As a result, the load on the steering actuator 24 reduces, and the controllability of the steering control improves.
In this embodiment, too, since the limit vehicle speed Vlimit and the alarm vehicle speed Valarm are changed in accordance with a set path, the vehicle speed can be controlled within such a range that the automatic steering apparatus can precisely follow the vehicle speed. Furthermore, due to the similarity transformation, this embodiment is able to limit the steering rate within a lower range than the first embodiment. Therefore, in the second embodiment, the limit vehicle speed Vlimit and the alarm vehicle speed Valarm set for the time of a steering operation can be set to a higher speed side than in the first embodiment. As a result, the time of travel of the vehicle to a target position can be reduced.
In the foregoing embodiments, the alarm vehicle speed is changed prior to the transition to the changing steer region. However, the alarm speed may be changed substantially simultaneously with the transition to the changing steer region in the target path. In this case, it is preferable that the speed value V3 be sufficiently lower than the speed value V2. If the alarm speed is changed prior to the transition to the changing steer region, it is possible to set V3 higher than V2 as mentioned above, that is, the vehicle speed in the changing steer region can be increased.
Furthermore, in the foregoing embodiments, the control is stopped if the upper limit vehicle speed Vlimit is exceeded. It is also possible to install a system in which if the actual vehicle speed is likely to exceed Vlimit, the vehicle speed is controlled so as to be less than or equal to Vlimit by curbing the engine output. Therefore, the vehicle speed can reliably be curbed within a predetermined range, and the vehicle can reliably reach the target position.
In the foregoing embodiments, a basic path is similarity-transformed for garage parking. However, the above-described techniques, if appropriately combined, are basically applicable to the assist in parallel parking and other driving assists.
In the foregoing embodiment, if the initial steering angle (turning curvature) is substantially 0, a path is set, and if the initial steering angle (turning curvature) is great, the setting of a path is not carried out. However, if the initial steering angle is great, it is also possible to instruct the driver to perform stationary steering so as to reduce the initial steering angle substantially to 0. Due to this arrangement, even if the initial steering angle is not substantially 0, the assist control can be continued without a stop. Therefore, the operability during the assist control improves.
Although the basic path may be determined through computation, it is also possible to store quantities of state with respect to the deflection angel θ in the form of maps within the parking assist ECU 1. This arrangement eliminates the need to increase the computing power of the parking assist ECU 1, and allows quicker determination of a path.
The foregoing embodiments are embodiments of the parking assist apparatus having an automatic steering function. However, the invention is applicable not only to the technologies of automatic steering, but is also similarly applicable to technologies of performing steering guidance by indicating appropriate amounts of steer to the driver. Furthermore, the invention is applicable not only to the parking assist apparatus but also to a driving assist apparatus that induces movement in accordance with a path, a lane keep system, etc.
While the invention has been described with reference to exemplary embodiments thereof, it is to be understood that the invention is not limited to the exemplary embodiments or constructions. To the contrary, the invention is intended to cover various modifications and equivalent arrangements. In addition, while the various elements of the exemplary embodiments are shown in various combinations and configurations, which are exemplary, other combinations and configurations, including more, less or only a single element, are also within the spirit and scope of the invention.
Number | Date | Country | Kind |
---|---|---|---|
2003-183095 | Jun 2003 | JP | national |