The present disclosure relates to a driving support apparatus configured to perform a lane keeping assist control for assisting traveling of a vehicle (own vehicle) in the vicinity of a center position of a lane by using a traveling trajectory of a preceding vehicle.
One of driving support apparatuses that are conventionally known is configured to perform a lane keeping assist control for performing a steering control in such a manner that an own vehicle travels in a travel lane.
For example, an apparatus (hereinafter, referred to as a “related-art apparatus”) as disclosed in Japanese Unexamined Patent Application Publication (Translation of PCT Application) No. 2011-514580 specifies, when performing the lane keeping assist control, a preceding vehicle traveling ahead of the own vehicle. The related-art apparatus performs the steering control in such a manner that the own vehicle travels along a traveling trajectory (hereinafter, referred to as a “preceding vehicle trajectory”) of the specified preceding vehicle.
However, when performing the lane keeping assist control by utilizing the preceding vehicle trajectory, the following problem may occur. For example, when a situation occurs in which an other vehicle enters ahead of the own vehicle, the related-art apparatus specifies the “other vehicle (also referred to as an “interrupting (or cutting-in) vehicle” for convenience)” as a new preceding vehicle. Then, the related-art apparatus performs the steering control in such a manner that the traveling position of the own vehicle is maintained near a preceding vehicle trajectory of the interrupting vehicle (i.e., the new preceding vehicle). At this time, since “a relatively-rapid traveling behavior in a road-width direction of the interrupting vehicle” affects (or is reflected on) the preceding vehicle trajectory, the traveling position of the own vehicle suddenly moves in the road-width direction. Therefore, when the interrupting vehicle enters ahead of the own vehicle, there is a problem that the own vehicle cannot travel stably along the travel lane. In the present specification, the other vehicle (that is, the following first other vehicle) entering ahead of (in front of) the own vehicle is referred to as the “interrupting vehicle” in both of the following cases (i) and (ii): (i) the first other vehicle enters between the own vehicle and a second other vehicle traveling ahead of the own vehicle; and (ii) the first other vehicle enters ahead of the own vehicle in a situation in which no second other vehicle is present ahead of the own vehicle.
One or more embodiments have been devised in view of the above-mentioned problem. Specifically, there is provided a driving support apparatus configured to, when an interrupting vehicle enters ahead of the own vehicle, start at an appropriate timing the lane keeping assist control based on the preceding vehicle trajectory of the interrupting vehicle to thereby have the own vehicle travel along the travel lane stably.
According to one embodiment, there is provided a driving support apparatus for an own vehicle, including:
a preceding vehicle trajectory obtaining unit (10, 10b, 16) configured to obtain a traveling trajectory of an other vehicle which travels ahead of the own vehicle; and
a lane keeping assist control unit (10, 10d, 40) configured to perform a lane keeping assist control for changing a steering angle of the own vehicle in such a manner that the own vehicle travels along a target traveling line set based on the traveling trajectory.
Further, when a specific state/situation occurs in which an interrupting/cutting-in vehicle is entering ahead of the own vehicle in (i) a situation in which no preceding vehicle is present ahead of the own vehicle, or (ii) a situation in which a preceding vehicle is present ahead of the own vehicle, the preceding vehicle trajectory obtaining unit is configured to obtain the traveling trajectory of the interrupting vehicle (Step 730).
In addition, when the specific state/situation occurs, while a deviation angle (θv) formed between a direction of the traveling trajectory of the interrupting vehicle and a traveling direction of the own vehicle is larger than a predetermined threshold (Th1), the lane keeping assist control unit is configured not to perform the lane keeping assist control based on the traveling trajectory of the interrupting vehicle, and is configured to have the preceding vehicle trajectory obtaining unit discard the traveling trajectory of the interrupting vehicle (“No” determination at Step 745, and Step 750).
Further, on and after the deviation angle becomes/is equal to or smaller than the predetermined threshold, the lane keeping assist control unit is configured to perform the lane keeping assist control based on the traveling trajectory of the interrupting vehicle obtained by the preceding vehicle trajectory obtaining unit (“Yes” determination at Step 745, Step 755, Step 760 and Step 765; “No” determination at Step 740, Step 760 and Step 765).
The above driving support apparatus is configured not to perform, when the interrupting vehicle is entering ahead of the own vehicle, the lane keeping assist control based on the traveling trajectory of the interrupting vehicle for a temporary period of time. The deviation angle (θv) becomes larger than the predetermined threshold (Th1) until a certain period of time elapses from a time point at which the interrupting vehicle starts to enter ahead of the own vehicle. Therefore, in this period, the driving support apparatus discards the traveling trajectory of the interrupting vehicle and does not perform the lane keeping assist control based on the traveling trajectory of the interrupting vehicle. Accordingly, even when the interrupting vehicle enters ahead of the own vehicle, the own vehicle can be made to travel stably along the travel lane without suddenly moving in the road-width direction.
After the interruption action/movement of the interrupting vehicle has substantially been completed, the above deviation angle becomes equal to or smaller than the predetermined threshold. Therefore, on and after the deviation angle becomes/is equal to or smaller than the predetermined threshold, the driving support apparatus performs the lane keeping assist control based on the traveling trajectory of the interrupting vehicle. Since the traveling trajectory of the interrupting vehicle has been discarded until the completion of the interruption action of the interrupting vehicle, the “relatively-rapid traveling behavior in the road-width direction of the interrupting vehicle” is not reflected on the traveling trajectory. Accordingly, the own vehicle can be made to travel along the travel lane stably.
In another aspect (e.g., Modification 1, and Modification 2, as described later) of the driving support apparatus, when the specific state/situation occurs in a situation in which a preceding vehicle is present ahead of the own vehicle and the lane keeping assist control unit is performing the lane keeping assist control based on the traveling trajectory of the preceding vehicle, the lane keeping assist control unit is configured to continue performing the lane keeping assist control based on the traveling trajectory of the preceding vehicle while the deviation angle is larger than the predetermined threshold (“No” determination at Step 745, and Step 750).
Further, on and after the deviation angle becomes/is equal to or smaller than the predetermined threshold, the lane keeping assist control unit is configured to perform the lane keeping assist control based on the traveling trajectory of the interrupting vehicle (“Yes” determination at Step 745, Step 755, Step 760 and Step 765; “No” determination at Step 740, Step 760 and Step 765).
In the present aspect, when the interrupting vehicle enters ahead of the own vehicle in the situation in which the preceding vehicle is present ahead of the own vehicle and the lane keeping assist control unit is performing the lane keeping assist control based on the traveling trajectory of that preceding vehicle, the lane keeping assist control unit continues performing the lane keeping assist control based on the traveling trajectory of the preceding vehicle while (as long as) the deviation angle (θv) is larger than the predetermined threshold (Th1). In the present aspect, on and after the interruption action of the interrupting vehicle has substantially been completed, the lane keeping assist control unit performs the lane keeping assist control based on the traveling trajectory of the interrupting vehicle. Therefore, even in the case where the interrupting vehicle enters ahead of the own vehicle while the lane keeping assist control is being performed based on the traveling trajectory of the preceding vehicle, the own vehicle can be made to travel stably along the travel lane without suddenly moving in the road-width direction.
In the above description, in order to facilitate understanding of the above one or more aspect of the embodiment, a name and/or reference numeral used in embodiments described below is enclosed in parentheses and assigned to each of the constituent features corresponding to the embodiments. However, each of the constituent features is not limited to the embodiments defined by the name and/or reference numeral.
Now, referring to the accompanying drawings, a description is given of embodiments. The accompanying drawings are illustrations of one or more specific embodiments in conformity with the principle thereof, but those illustrations are examples to be used for the understanding of the embodiment(s), and are not to be used to limit the interpretation of the present disclosure.
As illustrated in
Those ECUs are electric control units each including a microcomputer as a main part, and are connected to one another so as to be able to mutually transmit and receive information via a controller area network (CAN) (not shown). The microcomputer herein includes a CPU, a ROM, a RAM, a non-volatile memory, an interface I/F, and the like. The CPU executes instructions (programs and routines) stored in the ROM to realize various functions.
The driving support ECU 10 is electrically connected to sensors including switches described later and receives detection signals or output signals of the sensors, respectively. The sensors may be electrically connected to any of the ECUs other than the driving support ECU 10. In this case, the driving support ECU 10 receives the detection signals or the output signals of the sensors from the ECUs electrically connected to the sensors via the CAN.
An acceleration pedal operation amount sensor 11 detects an operation amount (accelerator opening) AP of an acceleration pedal 11a of the own vehicle and outputs a detection signal or an output signal representing the operation amount AP to the driving support ECU 10.
A brake pedal operation amount sensor 12 detects an operation amount BP of a brake pedal 12a of the own vehicle and outputs a detection signal or an output signal representing the operation amount BP to the driving support ECU 10.
A steering angle sensor 13 detects a steering angle θ of the own vehicle and outputs a detection signal or an output signal indicative of the steering angle θ to the driving support ECU 10.
A steering torque sensor 14 detects a steering torque Tra applied to a steering shaft US of the own vehicle by an operation of a steering wheel SW and outputs a detection signal or an output signal indicative of the steering torque Tra to the driving support ECU 10.
A vehicle speed sensor 15 detects a traveling speed SPD of the own vehicle and outputs a detection signal or an output signal indicative of the traveling speed SPD to the driving support ECU 10.
An ambient sensor 16 acquires at least information on a road ahead of the own vehicle and information on three-dimensional objects being present on the road. The three-dimensional objects include, for example, moving objects such as pedestrians, bicycles, vehicles and the like, and motionless objects such as power poles, trees, guardrails and the like. Hereinafter, the three-dimensional object will be referred to as a “target object”. The ambient sensor 16 includes a radar sensor 16a and a camera sensor 16b.
The radar sensor 16a transmits radio waves each having a millimeter wave band to an area surrounding the own vehicle including at least an area in front of the own vehicle, and receives radio waves reflected by the target object(s) being present within a radiation range. Hereinafter, the radio wave having the millimeter wave band will be referred to as a “millimeter wave” and the radio wave reflected by the target object will be referred to as a “reflected wave”. The radar sensor 16a determines the presence or absence of the target object, calculates parameters representing a relative relationship between the own vehicle and the target object, and outputs the determination results and the calculation results to the driving support ECU 10. The parameters representing the relative relationship between the own vehicle and the target object include a distance between the own vehicle and the target object, a relative speed of the target object with respect to the own vehicle, and the like.
Specifically, the radar sensor 16a includes a millimeter wave transmitting/receiving part (not shown) and a signal processing part (not shown). The signal processing part acquires, every time a certain period of time elapses, the parameters representing the relative relationship between the own vehicle and the target object based on a phase difference between the millimeter wave transmitted from the millimeter wave transmitting/receiving part and the reflected wave received by the millimeter wave transmitting/receiving part, a damping level of the received reflected wave with respect to the transmitted millimeter wave, a time from the transmission of the millimeter wave to the reception of the reflected wave and the like. The parameters include an inter-vehicle distance (i.e. a longitudinal distance) Dfx(n) of the detected target object(n), a relative vehicle speed Vfx(n) of the target object (n), a lateral distance Dfy(n) of the target object (n), a relative lateral speed Vfy(n) of the target object (n) and the like.
The inter-vehicle distance Dfx(n) is a distance between the own vehicle and the target object (n) (e.g., a preceding vehicle) along a central axis of the own vehicle (central axis extending in the front-rear direction of the own vehicle, that is, the x-axis described later).
The relative vehicle speed Vfx(n) is a difference between a speed Vs of the target object (n) (preceding vehicle) and a speed Vj of the own vehicle (that is, Vfx(n)=Vs−Vj). The speed Vs of the target object (n) is a speed of the target object (n) in the traveling direction of the own vehicle (that is, the x-axis described later).
The lateral distance Dfy(n) is a distance in a direction (that is, the y-axis described later) perpendicular to the central axis of the own vehicle between a central position of the target object (n) (e.g., a central position in the vehicle-width direction of the preceding vehicle) and the central axis of the own vehicle. Hereinafter, the lateral distance Dfy(n) will be referred to as a “lateral position”.
The relative lateral speed Vfy(n) is a speed of the central position of the target object (n) (e.g., central position in the vehicle-width direction of the preceding vehicle) in the direction (that is, the y-axis described later) perpendicular to the central axis of the own vehicle.
The camera sensor 16b includes a stereo camera (now shown) and an image processing part (not shown). The stereo camera takes a pair of right and left images of landscapes at a right side of the own vehicle ahead of (in front of) the own vehicle and at a left side of the own vehicle ahead of (in front of) the own vehicle. Based on the pair of right and left images, the image processing part determines the presence or absence of the target object, calculates the parameters representing the relative relationship between the own vehicle and the target object, and outputs the determination results and the calculation results to the driving support ECU 10. In this configuration, the driving support ECU 10 obtains/determines/defines the parameters representing the relative relationship between the own vehicle and the target object by synthesizing the following (i) and (ii):
(i) the parameters acquired by the radar sensor 16a, which represent the relative relationship between the own vehicle and the target object, and
(ii) the parameters acquired by the camera sensor 16b, which represent the relative relationship between the own vehicle and the target object.
The camera sensor 16b recognizes right and left lane lines of the road (that is, a lane in which the own vehicle is traveling) based on the pair of right and left images. The camera sensor 16b calculates a shape of the road and a positional relationship between the road and the own vehicle (e.g., a distance between the central position in the vehicle-width direction of the own vehicle and a left or right edge of the lane), and outputs the calculation results to the driving support ECU 10. The lane line includes a white line, a yellow line and the like. Hereinafter, an example where the lane line is the white line will be described.
Information on the target object which is acquired by the ambient sensor 16 will be referred to as “target object information”. The information includes the parameters representing the relative relationship between the own vehicle and the target object. The ambient sensor 16 repeatedly transmits the target object information to the driving support ECU 10 every time a certain sampling period of time elapses. The ambient sensor 16 does not necessarily include both the radar sensor and the camera, but may include only one of the radar sensor and the camera.
An operation switch 17 is a switch which is operated by a driver of the own vehicle. The driver can control whether or not to perform a lane keeping assist control described later by operating the operation switch 17. Further, the driver can control whether or not to perform a following-travel inter-vehicle-distance control such as an adaptive cruise control (ACC) described later by operating the operation switch 17.
A yaw rate sensor 18 detects a yaw rate YRt of the own vehicle and outputs a detection signal or output signal indicative of the yaw rate YRt to the driving support ECU 10.
The engine ECU 20 is electrically connected to engine actuators 21 of the engine 22. The engine actuators 21 include at least a throttle valve actuator (not shown) for changing an opening degree of the throttle valve of the engine 22. The engine ECU 20 can change an engine torque generated by the engine 22 by controlling activations of the engine actuators 21. The engine torque generated by the engine 22 is transmitted to drive wheels (not shown) through a transmission (not shown). Therefore, the engine ECU 20 can control a driving force supplied to the own vehicle (that is, to the drive wheels) by controlling the activations of the engine actuators 21 to thereby change an acceleration or an acceleration state. In a case where the own vehicle is a hybrid vehicle, the engine ECU 20 can control the driving force generated by one or both of “the engine and an electric motor” as the vehicle driving source. In a case where the own vehicle is an electric vehicle (battery vehicle), the engine ECU 20 can control the driving force generated by the electric motor as the vehicle driving source.
The brake ECU 30 is electrically connected to a brake actuator 31. The brake actuator 31 is provided in a hydraulic circuit provided between a master cylinder (not shown) for pressurizing hydraulic oil by a depression force of the brake pedal 12a and a friction brake mechanism 32 provided in right and left front and rear wheels of the own vehicle. The brake actuator 31 adjusts a hydraulic pressure supplied to a wheel cylinder (not shown) in each brake caliper 32b of the friction brake mechanism 32, depending on a command sent from the brake ECU 30. The wheel cylinder is activated by the hydraulic pressure to press a brake pad (not shown) on the brake disc 32a, thereby to generate a friction braking force on the brake disc 32a. Therefore, the brake ECU 30 can control an activation of the brake actuator 31 to control the braking force applied to the own vehicle (that is, to the wheels) to thereby change an acceleration or an acceleration state (or deceleration, that is, negative acceleration).
The steering ECU 40 is a control device of a known electric powered steering system and is electrically connected to a motor driver 41. The motor driver 41 is electrically connected to a steering motor 42. The steering motor 42 is assembled in a steering mechanism (not shown) including the steering wheel SW, the steering shaft US connected to the steering wheel SW, a steering gear mechanism (not shown) and the like. The steering motor 42 generates a torque by an electric power supplied from the motor driver 41 and uses the torque to apply a steering assist torque to the steering shaft US to thereby steer the right and left steered wheels. That is, the steering motor 42 can change a steering angle of the own vehicle.
Next, an outline of control performed by the embodiment apparatus will be described. The driving support ECU 10 is capable of performing the “adaptive cruise control (ACC)” and the “lane keeping assist control”.
When a preceding vehicle (referred to as an “ACC-target vehicle”) traveling immediately ahead of the own vehicle is present, the following-travel inter-vehicle-distance control has the own vehicle follow the preceding vehicle while maintaining an inter-vehicle distance between the preceding vehicle and the own vehicle at a predetermined distance, based on the target object information. In the following, the following-travel inter-vehicle-distance control is referred to as “Adaptive Cruise Control (ACC)”. The ACC itself is widely known (e.g., refer to Japanese Patent Application Laid-open No. 2014-148293, Japanese Patent Application Laid-open No. 2006-315491, Japanese Patent No. 4172434, and Japanese Patent No. 4929777). Thus, a brief description on the ACC is now given.
The driving support ECU 10 is configured to perform the ACC when the ACC is requested through the operation applied to the operation switch 17.
Specifically, the driving support ECU 10 selects the ACC-target vehicle, which the own vehicle should follow, based on the target object information acquired by the ambient sensor 16 when the ACC is requested. For example, the driving support ECU 10 determines whether or not a relative position of the target object (n) is present within a following-target vehicle area. The relative position of the target object (n) is determined based on the lateral distance Dfy(n) and the inter-vehicle distance Dfx(n) of the detected target object (n). The following-target vehicle area is an area previously determined such that, the longer the distance in the traveling direction of the own vehicle estimated based on the vehicle speed of the own vehicle and the yaw rate of the own vehicle becomes, the smaller the absolute value of the distance in the lateral direction with respect to the traveling direction becomes. Then, when the relative position of the target object (n) is present within the following-target vehicle area for a time equal to or longer than a predetermined time, the driving support ECU 10 selects the target object (n) as the ACC-target vehicle. If a plurality of target objects (n) are present whose relative positions are present within the following-target vehicle area for the time equal to or longer than the predetermined time, the driving support ECU 10 selects as the ACC-target vehicle the target object having the minimum inter-vehicle distance Dfx(n) from among those target objects.
Further, the driving support ECU 10 calculates a target acceleration Gtgt in accordance with any of the following Expressions (1) and (2). In the Expressions (1) and (2), Vfx(a) is a relative vehicle speed of the ACC-target vehicle (a) with respect to the own vehicle, k1 and k2 are predetermined positive gains or coefficients, and ΔD1 is an inter-vehicle distance difference obtained by subtracting a target inter-vehicle distance Dtgt from the inter-vehicle distance Dfx(a) of the ACC-target vehicle (a) (ΔD1=Dfx(a)−Dtgt). The target inter-vehicle distance Dtgt is calculated by multiplying a target inter-vehicle time Ttgt by the vehicle speed SPD of the own vehicle 100 (Dtgt=Ttgt×SPD). The target inter-vehicle time Ttgt is set by the driver using the operation switch 17.
The driving support ECU 10 determines the target acceleration Gtgt in accordance with the following Expression (1) when the value (k1×ΔD1+k2×Vfx(a)) is positive or zero. In the Expression (1), ka1 is a positive gain or coefficient for accelerating the own vehicle and is set to a value equal to or smaller than “1”.
Gtgt (for acceleration)=ka1×(k1×ΔD1+k2×Vfx(a)) (1)
On the other hand, when the value (k1×ΔD1+k2×Vfx(a)) is negative, the driving support ECU 10 determines the target acceleration Gtgt in accordance with the following Expression (2). In the Expression (2), kd1 is a gain or coefficient for decelerating the own vehicle and in this embodiment, is set to “1.”
Gtgt (for deceleration)=kd1×(k1×ΔD1+k2×Vfx(a)) (2)
When no target object is present within the following-target vehicle area, the driving support ECU 10 determines the target acceleration Gtgt based on the vehicle speed SPD of the own vehicle and a target vehicle speed in such a manner that the vehicle speed SPD of the own vehicle matches up with (becomes equal to) the target vehicle speed which is set depending on the target inter-vehicle time Ttgt.
The driving support ECU 10 controls the engine actuators 21 by using the engine ECU 20 and if necessary, and controls the brake actuator 31 by using the brake ECU 30 in such a manner that the acceleration of the own vehicle matches up with (becomes equal to) the target acceleration Gtgt. As described above, the driving support ECU 10 has, as a functional unit implemented by the CPU, a “ACC control unit 10a for performing the following-travel inter-vehicle-distance control such as the ACC”.
The driving support ECU 10 is configured to perform the lane keeping assist control when the lane keeping assist control is requested through the operation applied to the operation switch 17 while the following-travel inter-vehicle-distance control (ACC) is being performed.
In the lane keeping assist control, the driving support ECU 10 determines/sets/produces a target traveling line (target traveling path) by using one or both of a trajectory/locus of the preceding vehicle and the white lines. The target traveling line is set within the lane in which the own vehicle is currently traveling. Hereinafter, the trajectory/locus of the preceding vehicle is referred to as a “preceding vehicle trajectory”. The driving support ECU 10 applies the steering torque to the steering system to change the steering angle of the own vehicle in such a manner that a lateral position (i.e., a position in the vehicle-width direction of the own vehicle with respect to the lane) of the own vehicle is maintained in an immediate vicinity of (at a position close to) the target traveling line. In this manner, the steering operation of the driver can be assisted/supported. The lane keeping assist control is widely known (e.g., refer to Japanese Patent Application Laid-open No. 2008-195402, Japanese Patent Application Laid-open No. 2009-190464, Japanese Patent Application Laid-open No. 2010-6279, and Japanese Patent No. 4349210). The lane keeping assist control is also referred to as “Lane Trace Control (LTC)” or “Traffic Jam Assist (TJA)”. Hereinafter, the lane keeping assist control is sometimes simply referred to as “LTC”.
Next, an aspect of the LTC will be described in more detail. The LTC is performed by using the target traveling line determined based on the preceding vehicle trajectory. As illustrated in
The symbols shown in
dv: a distance in the y-axis direction (substantially in the road-width direction) between the current position (x=0, y=0) of the center position in the vehicle-width direction of the own vehicle 100, and the preceding vehicle trajectory L1.
θv: an angle of deviation (yaw angle) between the direction (tangential direction) of the preceding vehicle trajectory L1 at a position corresponding to the current position (x=0, y=0) of the own vehicle 100, and the traveling direction (“+” direction of the x-axis) of the own vehicle 100. Hereinafter, the angle of deviation θv is also referred to as a “first deviation angle”.
Cv: a curvature of the preceding vehicle trajectory L1 at a position (x=0, y=dv) corresponding to the current position (x=0, y=0) of the own vehicle 100.
Cv′: a change ratio of the curvature, that is, a curvature change amount per unit distance (Δx) at an any position (x=x0, x0 is an arbitrary value) of the preceding vehicle trajectory L1.
For example, the driving support ECU 10 stores (buffers) position coordinate data (position information) on the position of the preceding vehicle 101 in the RAM every time the certain sampling period of time elapses. In order to minimize data to be stored in the RAM, the driving support ECU 10 may store only a limited number of “relatively new position coordinate data sets of the preceding vehicle 110” which have been obtained within a certain period up to the current time point and which includes the latest position coordinate data set, and discard the position coordinate data sets older than the data sets obtained in that certain period. The driving support ECU 10 converts the position coordinate data of the preceding vehicle 101 stored in the RAM into the position coordinate data of the above-described x-y coordinate system where the current position of the own vehicle 100 is the origin (x=0, y=0). The driving support ECU 10 executes the above-mentioned converting process based on the differences between (i) the position and traveling direction of the own vehicle 100 at each time point at which the position coordinate data is acquired, and (ii) the position and traveling direction of the own vehicle 100 at the current time point. In
The driving support ECU 10 executes a curve fitting process by using the converted position coordinate data of the preceding vehicle 101 to obtain the preceding vehicle trajectory L1 of the preceding vehicle 101. For example, a cubic function f(x) is used in the fitting curve process. In the fitting process, for example, the least squares method is used. As described above, the driving support ECU 10 has, as a functional unit implemented by the CPU, a “preceding vehicle trajectory obtaining unit 10b for obtaining/extrapolating/determining the preceding vehicle trajectory L1 of the preceding vehicle”.
A method for obtaining the preceding vehicle trajectory L1 will be specifically described below. As illustrated in
f(x)=(⅙)Cv′×x3+(½)Cv×x2+74 v×x+dv (3)
When setting the preceding vehicle trajectory L1 as the target traveling line, the driving support ECU 10 acquires the target lane information necessary for performing the LTC, based on the coefficients a, b, c and d of the cubic function f(x) and the relationship shown in
The driving support ECU 10 calculates, every time a certain period of time elapses, a target steering angle θ* by applying the curvature Cv, the yaw angle θv and the distance dv to the following Expression (4). Further, the driving support ECU 10 controls the steering motor 42 by using the steering ECU 40 in such a manner that an actual steering angle θ of the own vehicle matches up with (becomes equal to) the target steering angle θ*. In the Expression (4), Klta1, Klta2 and Klta3 are predetermined control gains or coefficients.
θ*=Klta1×Cv+Klta2×θv+Klra3×dv (4)
The driving support ECU 10 may calculate a target yaw rate YRc* in accordance with the following Expression (4′). The target yaw rate YRc* is a yaw rate necessary for having the own vehicle 100 travel along the target traveling line. The driving support ECU 10 may calculate a target steering torque Tr* for realizing/generating the target yaw rate YRc* by using a lookup table, the target yaw rate YRc* and an actual yaw rate YRt of the own vehicle. In this configuration, the driving support ECU 10 controls the steering motor 42 by using the steering ECU 40 in such a manner that the actual steering torque Tra of the own vehicle matches up with (becomes equal to) the target steering torque Tr*. In the Expression (4′), K1, K2 and K3 are predetermined control gains or coefficients.
YRc*=K1×dv+K2×θv+K3×Cv (4′)
The above is the outline of the lane keeping assist control using the target traveling line determined based on the preceding vehicle trajectory.
Next, an aspect of the LTC will be described which is performed by using the target traveling line determined based on the white lines. As illustrated in
Further, the driving support ECU 10 calculates (i) a curve radius R and a curvature CL (=1/R) of the center line LM of the travel lane, and (ii) the position and the direction of the own vehicle 100 in the travel lane which is defined by the left white line LL and the right white line LR. Specifically, as illustrated in
In the Expression (4), the driving support ECU 10 replaces dv, θv, and Cv with dL, θL, and CL, respectively to thereby calculate the target steering angle θ*. The driving support ECU 10 controls the steering motor 42 by using the steering ECU 40 in such a manner that an actual steering angle θ of the own vehicle matches up with (becomes equal to) the target steering angle θ*. Alternatively, the driving support ECU 10 may control the steering motor 42 by using the Expression (4′).
The above is the outline of the lane keeping assist control using the target traveling line determined based on the white lines.
Further, the driving support ECU 10 may determine/extrapolate/obtain the target traveling line based on the combination of the preceding vehicle trajectory L1 and the center line LM of the travel lane. Specifically, as illustrated in
In accordance with the following situations (a) to (d), the driving support ECU 10 sets the target traveling line depending on the presence/absence of the preceding vehicle and the recognition state of the white lines, to perform the LTC.
(a) When the driving support ECU 10 has successfully recognized the left and right white lines to relatively far distance (from the current position to a first predetermined distance), the driving support ECU 10 sets the target traveling line based on the center line LM of the travel lane to thereby perform the LTC.
(b) When the preceding vehicle is present in the traveling direction of the own vehicle (ahead of the own vehicle) and the driving support ECU cannot recognize any of the left and right white lines, the driving support ECU 10 sets the target traveling line based on the preceding vehicle trajectory L1 of that preceding vehicle to thereby perform the LTC.
(c) When the preceding vehicle is present in the traveling direction of the own vehicle (ahead of the own vehicle) and the driving support ECU has recognized the left and right white lines in the vicinity of the own vehicle (from the current position to a second predetermined distance shorter than the first predetermined distance), the driving support ECU 10 sets the target traveling line based on the corrected preceding vehicle trajectory L2 obtained by correcting the preceding vehicle trajectory L1 with the center line LM of the recognized white lines to thereby perform the LTC.
(d) When no preceding vehicle is present in the traveling direction of the own vehicle (ahead of the own vehicle) and the driving support ECU cannot recognize the left and right white lines, the driving support ECU 10 cancels the LTC.
As described above, the driving support ECU 10 has, as a functional unit implemented by the CPU, a “LTC control unit (lane keeping assist control unit) 10d for performing the lane keeping assist control for changing the steering angle of the own vehicle in such a manner that the own vehicle travels along the target traveling line”.
Next, with reference to
First, a situation immediately before time t1 in
Therefore, at time t1, the driving support ECU 10 specifies the interrupting vehicle 102 as a new preceding vehicle. The driving support ECU 10 stores the position coordinate data of the specified interrupting vehicle 102 in the RAM. At time t1, the driving support ECU 10 converts the position coordinate data of the interrupting vehicle 102 to acquire the converted position coordinate data. In
The driving support ECU 10 calculates, as a first deviation angle θv, a magnitude of an angle formed between a direction DO of the preceding vehicle trajectory L1 and a traveling direction DS of the own vehicle 100 at the current position. Here, the direction DO of the preceding vehicle trajectory L1 is a tangential direction of the preceding vehicle trajectory L1, that is, a traveling direction of the interrupting vehicle 102. In the examples coordinate data from the oldest one.
Thereafter, every time the calculation timing of the preceding vehicle trajectory L1 arrives, the driving support ECU 10 repeatedly obtains the preceding vehicle trajectory L1 based on newly-obtained position coordinate data of the interrupting vehicle 102, and monitors/determines whether or not the first deviation angle θv is equal to or smaller than the first threshold Th1.
Therefore, as illustrated in
As described above, when the driving support ECU 10 determines that the interrupting vehicle 102 is entering ahead of the own vehicle 100, the driving support ECU 10 discards the preceding vehicle trajectory L1 of the interrupting vehicle 102 (and all or part of the position coordinate data of the interrupting vehicle 102 which was used for obtaining that preceding vehicle trajectory L1). Therefore, the driving support ECU 10 does not start the LTC based on the preceding vehicle trajectory L1 of the interrupting vehicle 102. Thereafter, when the first deviation angle θv becomes equal to or smaller than the first threshold Th1, the driving support ECU 10 determines that the interruption action of the interrupting vehicle 102 has been substantially completed. On and after that determination time point, the driving support ECU 10 performs the LTC based on the preceding vehicle trajectory L1 of the interrupting vehicle 102.
Next, a concrete operation of the CPU (hereinafter, simply referred to as the “CPU”) of the driving support ECU 10 will be described. As one routine for performing the LTC, the CPU is configured or programmed to execute a routine of
Therefore, as the predetermined calculation timing arrives, the CPU starts from a process of Step 700 in
The predetermined execution condition is satisfied when the following conditions 1 and 2 are both satisfied.
(condition 1): The execution of the LTC is being selected through the operation of the operation switch 17.
(condition 2): Up to the current calculation timing, the camera sensor 16b has not recognized the left white line and the right white line for setting the center line LM of the travel lane. That is, the CPU is not performing the LTC based on the center line LM of the travel lane at the current time point.
When the predetermined execution condition is not satisfied, the CPU makes a “No” determination at Step 705, and then, proceeds directly to Step 795 to tentatively terminate the present routine. In this case, the LTC is not started.
On the other hand, when the predetermined execution condition is satisfied, the CPU makes a “Yes” determination at Step 705, and proceeds to Step 710. Then, the CPU determines whether or not a preceding vehicle is present ahead of the own vehicle 100.
Here, it is assumed that no preceding vehicle is present ahead of the own vehicle at the previous calculation timing of the present routine, and no interrupting vehicle is present which is about to enter (cut in) ahead of the own vehicle in a period from the previous calculation timing to the current calculation timing of the present routine. In this situation, since no preceding vehicle is present ahead of the own vehicle, the CPU makes a “No” determination at Step 710, and proceeds directly to Step 795 to tentatively terminate the present routine.
On the other hand, it is assumed that an interrupting vehicle is entering ahead of the own vehicle in a period from the previous calculation timing to the current calculation timing. In this situation, since the preceding vehicle (that is, the interrupting vehicle) is present ahead of the own vehicle at the current time point, the CPU makes a “Yes” determination at Step 710, and proceeds to Step 715. At Step 715, the CPU selects the illustrated in
The driving support ECU 10 determines whether or not the first deviation angle θv is equal to or smaller than a first predetermined threshold Th1. As illustrated in
Further, in this case, in order to prevent “a relatively-rapid traveling behavior in the road-width direction of the interrupting vehicle 102” from affecting (being reflected on) the preceding vehicle trajectory L1 on and after the next calculation timing of the preceding vehicle trajectory L1, the driving support ECU 10 may execute the following process. The driving support ECU 10 may remove from the RAM the position coordinate data of the interrupting vehicle 102 which was used for the calculation of the preceding vehicle trajectory L1 at time t1. The position coordinate data to be removed here are, for example, the position coordinate data which are the source of the converted position coordinates (x1, y1), (x2, y2) and (x3, y3). In this configuration, the driving support ECU 10 may remove from the RAM all the position coordinate data of the interrupting vehicle 102, or remove from the RAM the predetermined number of pieces of the position preceding vehicle which is a target for obtaining the preceding vehicle trajectory L1. Hereinafter, the preceding vehicle which is the target for obtaining the preceding vehicle trajectory L1 is also referred to as a “trajectory-target vehicle”.
Specifically, at Step 715, the CPU acquires the traveling speed SPD of the own vehicle 100 from the vehicle speed sensor 15, and the yaw rate of the own vehicle 100 from the yaw rate sensor 18. Further, the CPU extrapolates the traveling direction of the own vehicle 100 based on the “acquired traveling speed SPD and yaw rate”. The CPU selects, as the trajectory-target vehicle, the nearest target object with respect to the own vehicle 100 in its traveling direction (i.e., the target object having the shortest distance away in the traveling direction of the own vehicle 100), based on the target object information transmitted from the ambient sensor 16.
Next, the CPU proceeds to Step 720 and determines whether or not a flag reset condition is satisfied. For example, the flag reset condition is satisfied when one of the following conditions 3 and 4 is satisfied.
(condition 3): Although the CPU did not select the trajectory-target vehicle at the previous calculation timing, the CPU selects newly the trajectory-target vehicle at the current calculation timing.
(condition 4): The trajectory-target vehicle selected at the current calculation timing is different from a vehicle selected as the trajectory-target vehicle at the previous calculation timing.
Now, the interrupting vehicle is entering ahead of the own vehicle in a period from the previous calculation timing to the current calculation timing. Therefore, the above-mentioned condition 3 is satisfied. Since the flag reset condition is satisfied, the CPU makes a “Yes” determination at Step 720, and proceeds to Step 725. The CPU sets the value of a flag F to zero at Step 725, and proceeds to Step 730.
As described above, the CPU stores the position coordinate data for each target object in the RAM in association with each target object, based on the target object information from the ambient sensor 16. At Step 730, the CPU acquires the position coordinate data corresponding to the trajectory-target vehicle selected at Step 715, among the pieces of the position coordinate data. The CPU calculates the converted position coordinate data based on the acquired position coordinate data. Further, the CPU executes the curve fitting process with respect to the converted position coordinate data to thereby obtain/calculate the preceding vehicle trajectory L1 of the trajectory-target vehicle.
Next, the CPU proceeds to Step 735, and determines whether or not a condition (hereinafter, referred to as an “accuracy condition”) regarding the accuracy of the preceding vehicle trajectory L1 is satisfied. The accuracy condition is a condition for determining whether or not the accuracy of the preceding vehicle trajectory L1 of the trajectory-target vehicle obtained at Step 730 is high. For example, the accuracy condition is satisfied when the trajectory-target vehicle selected at Step 715 has been detected by a plurality of the sensors (that is, both of the radar sensor 16a and the camera sensor 16b). This is because, when the trajectory-target vehicle has been detected by a plurality of the sensors, it is considered that the accuracy of the position coordinate data of the trajectory-target vehicle is high. As will be described later, the accuracy condition is not limited to the above example.
Now, it is assumed that the accuracy condition is satisfied. In this situation, the CPU makes a “Yes” determination at Step 735, and proceeds to Step 740 to determine whether or not the value of the flag F is zero. Since the interrupting vehicle is entering ahead of the own vehicle at the current time point, the value of the flag F is set to “zero” at Step 725. Therefore, the CPU makes a “Yes” determination at Step 740, and proceeds to Step 745 to determine whether or not the first deviation angle θv is equal to or smaller than the first threshold Th1.
Now, since the interrupting vehicle is entering ahead of the own vehicle as described above, the first deviation angle θv is larger than the first threshold Th1 as explained with reference to
In this situation, when the predetermined period of time elapses, the CPU resumes the process from Step 700. When the CPU proceeds to Step 705, the above-mentioned predetermined execution condition (all of the conditions 1 and 2) is again satisfied. Therefore, the CPU proceeds from Step 705 to Step 710. Further, the interrupting vehicle is present in this situation, and therefore, the preceding vehicle is present ahead of the own vehicle. Thus, the CPU proceeds from Step 710 to Step 715, and selects again the interrupting vehicle as the trajectory-target vehicle. Thereafter, the CPU proceeds to Step 720.
In this case, the trajectory-target vehicle has been selected at the previous calculation timing, and the trajectory-target vehicle selected at the current calculation timing is the same vehicle as the vehicle selected as the trajectory-target vehicle at the previous calculation timing. Therefore, neither of the above-mentioned condition 3 nor condition 4 is satisfied. That is, the flag reset condition is not satisfied. Thus, the CPU makes a “No” determination at Step 720 and proceeds directly to Step 730. As a result, the value of the flag F is maintained at “zero”.
The CPU again obtains/calculates the preceding vehicle trajectory L1 of the trajectory-target vehicle at Step 730, and then, determines whether or not the accuracy condition is satisfied at Step 735.
If the accuracy condition is satisfied, the CPU proceeds to Step 740. Further, since the flag F is maintained at zero at the current time point, the CPU proceeds to Step 745. It is assumed that the interrupting vehicle selected as the trajectory-target vehicle still continues the interruption action at the current time point. In this case, the first deviation angle θv is still larger than the first threshold Th1. Therefore, the CPU proceeds from Step 745 to Step 750. At Step 750, the CPU discards the preceding vehicle trajectory L1 obtained at step 730, and therefore, the CPU does not start the LTC based on the preceding vehicle trajectory L1 used as the target traveling line.
While the above-mentioned processes are repeated, the interrupting vehicle has substantially completed the interruption action. In this case, the first deviation angle θv becomes equal to or smaller than the first threshold Th1. Thus, when the CPU proceeds to Step 745, the CPU makes a “Yes” determination, and proceeds to Step 755 to set the value of the flag F to “1”.
Next, the CPU proceeds to Step 760 to set the preceding vehicle trajectory L1 obtained at Step 730 as the target traveling line. That is, the trajectory of the interrupting vehicle selected as the trajectory-target vehicle at Step 715 is set as the target traveling line. Then, the CPU proceeds to Step 765, and performs the LTC (steering control) based on the target traveling line set by using the preceding vehicle trajectory L1 of the interrupting vehicle. Thereafter, the CPU proceeds to Step 795 to tentatively terminate the present routine.
After the predetermined period of time elapses in this situation, the CPU resumes the process from Step 700. When the CPU proceeds to Step 705, the above-mentioned predetermined execution condition (all of the conditions 1 and 2) is again satisfied. Therefore, the CPU proceeds from Step 705 to Step 710. Further, in this situation, the preceding vehicle (interrupting vehicle) is present ahead of the own vehicle. Therefore, the CPU proceeds from Step 710 to Step 715. The CPU again selects the interrupting vehicle as the trajectory-target vehicle, and proceeds to Step 720.
In this situation, the trajectory-target vehicle has been selected at the previous calculation timing, and the trajectory-target vehicle selected at the current calculation timing is the same vehicle as the vehicle selected as the trajectory-target vehicle at the previous calculation timing. Therefore, neither of the above-mentioned condition 3 nor condition 4 is satisfied. That is, the flag reset condition is not satisfied. Thus, the CPU makes a “No” determination at Step 720, and proceeds directly to Step 730. As a result, the value of the flag F is maintained at “1”.
The CPU again obtains/calculates the preceding vehicle trajectory L1 of the trajectory-target vehicle at Step 730, and proceeds to Step 735 to determine whether or not the accuracy condition is satisfied.
If the accuracy condition is satisfied, the CPU proceeds to Step 740. In this case, since the value of the flag F is maintained at “1”, the CPU makes a No determination at Step 740, and proceeds directly to Step 760. Thereafter, the CPU proceeds to Step 765. As a result, the CPU continues performing the LTC based on the target traveling line which is the preceding vehicle trajectory L1 of the trajectory-target vehicle being the same as the vehicle (interrupting vehicle) selected as the trajectory-target vehicle at the previous calculation timing.
In addition, at the time point at which the CPU executes the process of Step 735, when the accuracy condition is not satisfied, the CPU makes a “No ” determination at Step 735, and proceeds to Step 750. Therefore, the LTC is not performed based on the preceding vehicle trajectory L1 of which the accuracy condition is not satisfied.
In this manner described above, when the interrupting vehicle 102 enters ahead of the own vehicle 100, the embodiment apparatus discards the preceding vehicle trajectory L1 of the interrupting vehicle 102 without performing the LTC based on the preceding vehicle trajectory L1 of the interrupting vehicle 102, while the first deviation angle θv is larger than the first threshold Th1. Therefore, while the interrupting vehicle 102 is entering ahead of the own vehicle 100, the LTC is not performed based on the preceding vehicle trajectory L1 which is influenced by the behavior of the interrupting vehicle 102. Accordingly, the own vehicle 100 can be made to travel stably along the travel lane without suddenly moving in the road-width direction. Meanwhile, on and after the first deviation angle θv becomes equal to or smaller than the first threshold Th1, that is, on and after the interrupting vehicle 102 has substantially completed the interruption action (interruption movement in the road-width direction), the embodiment apparatus performs the LTC based on the preceding vehicle trajectory L1 of the interrupting vehicle 102. The preceding vehicle trajectory L1 of the interrupting vehicle 102 and the position coordinate data which are the source of that preceding vehicle trajectory L1 have been discarded until the completion of the interruption movement of the interrupting vehicle 102. Therefore, the “relatively-rapid traveling behavior in the road-width direction of the interrupting vehicle 102” is not reflected on (does not impose an influence on, affects) the preceding vehicle trajectory L1. Accordingly, the own vehicle 100 can be made to travel along the travel lane stably.
The present disclosure is not limited to the above-mentioned embodiment, and various changes can be adopted within the scope of the present disclosure.
The routine as illustrated in
In this case, the execution condition at Step 705 may be replaced with a condition which is satisfied when all of the following condition 1, condition 2, and condition 3A described below are satisfied.
(condition 1): The execution of the LTC has been selected through the operation of the operation switch 17.
(condition 2): Up to the current calculation timing, the camera sensor 16b has not recognized the left white line and the right white line for setting the center line LM of the travel lane. That is, the CPU is not performing the LTC based on the center line LM of the travel lane at the current time point.
(condition 3A): A preceding vehicle (the “first preceding vehicle”) is present ahead of the own vehicle at the previous calculation timing, and the CPU is performing the LTC based on the preceding vehicle trajectory of the first preceding vehicle at the current time point.
Further, when the CPU according to the present modification proceeds to Step 750, the CPU discards the preceding vehicle trajectory L1 of the interrupting vehicle 102 obtained at Step 730, and does not perform the LTC based on the preceding vehicle trajectory L1 of the interrupting vehicle 102. In addition, at Step 750, the CPU continues performing the LTC based on the preceding vehicle trajectory L1 of the first preceding vehicle.
On the other hand, when the CPU makes a “Yes” determination at Step 745 and proceeds to Step 765 through Steps 755 and 760, the CPU performs the LTC based on the preceding vehicle trajectory L1 of the interrupting vehicle 102. According to the present modification, even if the interrupting vehicle 102 enters ahead of the own vehicle 100 in the above-mentioned situation (b), the own vehicle 100 can be made to travel stably along the travel lane without suddenly moving in the road-width direction.
The routine as illustrated in
In this case, the execution condition at Step 705 may be replaced with a condition which is satisfied when all of the following condition 1, condition 2B, and condition 3B described below are satisfied.
(condition 1): The execution of the LTC has been selected through the operation of the operation switch 17.
(condition 2B): Up to the current calculation timing, the camera sensor 16b has recognize the left white line and/or the right white line only in the vicinity of the own vehicle.
(condition 3B): A preceding vehicle (the “second preceding vehicle”) is present ahead of the own vehicle at the previous calculation timing, and the CPU is performing the LTC based on the corrected preceding vehicle trajectory L2′ obtained by correcting the preceding vehicle trajectory L1′ of the second preceding vehicle with the recognized white line(s).
When the CPU according to the present modification proceeds to Step 750, the CPU discards the preceding vehicle trajectory L1 of the interrupting vehicle 102 obtained at Step 730, and does not perform the LTC based on the corrected preceding vehicle trajectory L2 which is obtained by correcting the preceding vehicle trajectory L1 of the interrupting vehicle 102 with the white line(s). In addition, at Step 750, the CPU continues performing the LTC based on the corrected preceding vehicle trajectory L2′ obtained by correcting the preceding vehicle trajectory L1′ of the second preceding vehicle with the recognized white line(s).
On the other hand, when the CPU makes a “Yes” determination at Step 745 and proceeds to Step 765 through Steps 755 and 760, the CPU performs the LTC based on the corrected preceding vehicle trajectory L2 which is obtained by correcting the preceding vehicle trajectory L1 of the interrupting vehicle 102 with the white line(s). According to the present modification, even if the interrupting vehicle 102 enters ahead of the own vehicle 100 in the above-mentioned situation (c), the own vehicle 100 can be made to travel stably along the travel lane without suddenly moving in the road-width direction.
At Step 745, the CPU may replace “the traveling direction of the own vehicle used for the calculation of the first deviation angle θv ” with “the tangential direction of the center line LM at the current position of the own vehicle”. In this configuration, it is required that the center line LM has been extrapolated/recognized based on the recognized white lines. The driving support ECU 10 according to the present modification can more effectively determine whether or not the interrupting vehicle has substantially completed entering ahead of the own vehicle 100.
In place of or in addition to the accuracy condition used at Step 735, the following accuracy condition 1 and/or accuracy condition 2 may be used.
(accuracy condition 1): The length of the preceding vehicle trajectory L1 (that is, the distance between the latest position coordinate of the trajectory-target vehicle and the oldest position coordinate of the trajectory-target vehicle) is equal to or longer than a predetermined length threshold.
(accuracy condition 2): The inter-vehicle distance between the trajectory-target vehicle and the own vehicle is equal to or longer than a predetermined first distance, and is shorter than a predetermined second distance.
Regarding the accuracy condition 1, as the length of the preceding vehicle trajectory L1 is longer, the amount of the stored position information (coordinate values) of the preceding vehicle is larger. Therefore, it is considered that the accuracy of the preceding vehicle trajectory L1 obtained through the curve fitting process is high.
Regarding the accuracy condition 2, when the inter-vehicle distance between the own vehicle and the trajectory-target vehicle is extremely long or extremely short, the accuracy of the position coordinate data of the trajectory-target vehicle becomes lower (the error of the position information becomes larger). Therefore, when the inter-vehicle distance is within the above-mentioned predetermined range, it is considered that the accuracy of the preceding vehicle trajectory L1 obtained through the curve fitting process is high.
The above embodiment apparatus is configured to perform the LTC only while the ACC is being performed, However, an apparatus according to the present modification may be configured to perform the LTC even if the ACC is not being performed.
Number | Date | Country | Kind |
---|---|---|---|
2017-187488 | Sep 2017 | JP | national |