The present invention relates to a vehicle control device, a vehicle control method, and a vehicle control program.
Priority is claimed on Japanese Patent Application Nos. 2015-141383, filed Jul. 15, 2015 and 2016-025271, filed Feb. 12, 2016, the content of which is incorporated herein by reference.
In the related art, a recommended operation amount generation device for a vehicle including a nearby vehicle detection means that detects a nearby vehicle with respect to a subject vehicle, a vehicle state detection means that detects a state of the subject vehicle, a nearby vehicle behavior prediction means that predicts a behavior of the nearby vehicle, an evaluation function construction means that constructs an evaluation function for calculating a desirability of a driving operation for the subject vehicle from an output of the nearby vehicle detection means and an output of the vehicle state detection means, and a recommended operation amount calculation means that calculates an operation desirable for the subject vehicle from an output of the nearby vehicle behavior prediction means and an output of the evaluation function construction means is known (see, for example, Patent Literature 1). In this device, the nearby vehicle behavior prediction means includes a subject-vehicle model with a prediction response of the subject vehicle as an output, an other-vehicle model with a prediction response of the nearby vehicle as an output, and a vehicle information extraction function group for calculating information required for calculation of the subject-vehicle model and the other-vehicle model from information of a vehicle including the subject vehicle, and is configured by coupling the other-vehicle model and the subject-vehicle model in the vehicle information extraction function group.
[Patent Literature 1]
Japanese Unexamined Patent Application, First Publication No. 2004-152125
However, in the related art, the number of vehicles that are monitoring targets is limited in lane change, and only one target position for lane change can be set. As a result, a degree of freedom of lane change control may be lowered.
An aspect of the present invention has been made in view of such circumstances, and an object thereof is to provide a vehicle control device, a vehicle control method, and a vehicle control program capable of increasing a degree of freedom of lane change control.
(1) A vehicle control device according to an aspect of the present invention includes a detection unit configured to detect a position of a nearby vehicle traveling around a subject vehicle; and a target position candidate setting unit configured to set a lane change target position candidate in a target area as a candidate for a lane change target position set as a relative position with respect to the nearby vehicle traveling in an adjacent lane adjacent to a subject lane, by referring to a detection result of the detection unit, a number of lane change target position candidates varying according to a number of nearby vehicles traveling in the target area in the adjacent lane.
(2) In the aspect (1), the target position candidate setting unit may set the lane change target position candidate between the nearby vehicles traveling in the target area.
(3) In the aspect (1) or (2), the target position candidate setting unit may set an area behind a front reference vehicle which is closest to the subject vehicle among the nearby vehicles traveling in the adjacent lane and traveling in front of a preceding vehicle traveling immediately in front of the subject vehicle in the subject lane, as the target area.
(4) In any one of the aspects (1) to (3), the target position candidate setting unit may set an area in front of a rear reference vehicle which is closest to the subject vehicle among the nearby vehicles traveling in the adjacent lane and traveling behind a following vehicle traveling immediately behind the subject vehicle in the subject lane, as the target area.
(5) In any one of the aspects (1) to (4), the vehicle control device may further include a virtual vehicle setting unit configured to set a virtual vehicle obtained by virtually simulating the nearby vehicle on a lane that is a lane change destination of the subject vehicle, and the target position candidate setting unit may regard the virtual vehicle set by the virtual vehicle setting unit as the nearby vehicle and set the lane change target position candidate within the target area.
(6) In the aspect (5), the vehicle control device may include an estimation unit configured to estimate whether or not the nearby vehicle is about to change lanes, and the virtual vehicle setting unit may set the virtual vehicle when the estimation unit estimates that the nearby vehicle is about to change lane to the lane that is the lane change destination of the subject vehicle.
(7) In the aspect (6), the virtual vehicle setting unit may set the virtual vehicle when the estimation unit estimates that a nearby vehicle present in a lane different from the lane in which the subject vehicle travels is about to change a lane to the lane that is the lane change destination of the subject vehicle.
(8) A vehicle control device according to an aspect of the present invention includes: a detection unit configured to detect a position of a nearby vehicle traveling around a subject vehicle; an estimation unit configured to estimate whether or not a nearby vehicle present on a lane different from a lane on which the subject vehicle travels detected by the detection unit is about to change a lane to a lane that is a lane change destination of the subject vehicle; a virtual vehicle setting unit configured to set a virtual vehicle obtained by virtually simulating the nearby vehicle on the lane that is the lane change destination of the subject vehicle when the estimation unit estimates that the nearby vehicle is about to change lane; and a target position candidate setting unit configured to set a lane change target position candidate in front of or behind the virtual vehicle as a candidate for a lane change target position set in an adjacent lane adjacent to a subject lane by referring to a detection result of the detection unit and the virtual vehicle set by the virtual vehicle setting unit.
(9) A vehicle control method according to an aspect of the present invention includes detecting a position of a nearby vehicle traveling around a subject vehicle; and setting a lane change target position candidate in a target area as a candidate for a lane change target position set as a relative position with respect to the nearby vehicle traveling in an adjacent lane adjacent to a subject lane, by referring to a detection result, a number of lane change target position candidates varying according to a number of nearby vehicles traveling in the target area in the adjacent lane.
(10) A vehicle control program according to an aspect of the present invention includes causing a computer of a vehicle control device including a detection unit configured to detect a position of a nearby vehicle traveling around a subject vehicle to execute: setting a lane change target position candidate in a target area as a candidate for a lane change target position set as a relative position with respect to the nearby vehicle traveling in an adjacent lane adjacent to a subject lane, by referring to a detection result of the detection unit, a number of lane change target position candidates varying according to a number of nearby vehicles traveling in the target area in the adjacent lane.
(11) A vehicle control device according to an aspect of the present invention includes: a detection unit configured to detect a position of a nearby vehicle traveling around a subject vehicle; and a target position candidate setting unit configured to set a target area for setting a candidate for a lane change target position set as a relative position with respect to the nearby vehicle traveling in an adjacent lane adjacent to a subject lane, by referring to a detection result of the detection unit, to an area being behind a front reference vehicle which is closest to the subject vehicle among the nearby vehicles traveling in the adjacent lane and traveling in front of a preceding vehicle traveling immediately in front of the subject vehicle in the subject lane, the area also being in front of a rear reference vehicle which is closest to the subject vehicle among the nearby vehicles traveling in the adjacent lane and traveling behind a following vehicle traveling immediately behind the subject vehicle in the subject lane.
According to the aspects (1), (2), (9) and (10), it is possible to increase a degree of freedom of lane change control by setting a lane change target position candidate in a target area as a candidate for a lane change target position set as a relative position with respect to the nearby vehicle traveling in an adjacent lane adjacent to a subject lane, the number of lane change target position candidates varying according to the number of nearby vehicles traveling in the target area in the adjacent lane.
According to the aspect (3), it is possible to prevent the lane change target position candidate from being set in front of the front reference vehicle, that is, at a position considered to be difficult to change lanes, by setting the area behind the front reference vehicle which is closest to the subject vehicle among the nearby vehicles traveling in the adjacent lane and traveling in front of a preceding vehicle traveling immediately in front of the subject vehicle in the subject lane, as the target area.
According to the aspect (4), it is possible to prevent the lane change target position candidate from being set behind the rear reference vehicle, that is, at a position considered to be difficult to change lanes.
According to the aspects (5) to (7), it is possible to prevent the lane change target position candidate from being set at a position considered to be difficult to change lane to by regarding the virtual vehicle as the nearby vehicle and setting the lane change target position candidate within the target area.
According to the aspect (8), it is possible to prevent the lane change target position candidate from being set at a position considered to be difficult to change lane and to increase a degree of freedom of the lane change control by setting the lane change target position candidate set in the adjacent lane adjacent to the subject lane in front of or behind the virtual vehicle.
According to the aspect (11), it is possible to prevent the lane change target position candidate from being set at a position considered to be difficult to change lanes, such as in front of the front reference vehicle or behind the rear reference vehicle, by setting the target area for setting the candidate for the lane change target position set as the relative position with respect to the nearby vehicle traveling in the adjacent lane adjacent to the subject lane, to an area being behind the front reference vehicle which is closest to the subject vehicle among the nearby vehicles traveling in the adjacent lane and traveling in front of a preceding vehicle traveling immediately in front of the subject vehicle in the subject lane, the area also being in front of a rear reference vehicle which is closest to the subject vehicle among the nearby vehicles traveling in the adjacent lane and traveling behind a following vehicle traveling immediately behind the subject vehicle in the subject lane.
Hereinafter, embodiments of a vehicle control device, a vehicle control method, and a vehicle control program according to the present invention will be described with reference to the drawings.
As illustrated in
The radars 30-1 and 30-4 described above are, for example, long-distance millimeter-wave radars of which the detection range in a depth direction is wider than that of other radars. Further, the radars 30-2, 30-3, 30-5, and 30-6 are intermediate-distance millimeter wave radars of which the detection range in the depth direction is narrower than that of the radars 30-1 and 30-4. Hereinafter, the finders 20-1 to 20-7 are simply referred to as a “finder 20” when not particularly distinguished, and the radars 30-1 to 30-6 are simply referred to as a “radar 30” when not particularly distinguished. The radar 30 detects an object rising, for example, a frequency modulated continuous (FM-CW) scheme.
The camera 40 is, for example, a digital camera using a solid-state imaging device such as a charge coupled device (CCD) or a complementary metal oxide semiconductor (CMOS). The camera 40 is attached to an upper portion of a front windshield, a rear surface of a rearview mirror, or the like. For example, the camera 40 periodically repeatedly images in front of the subject vehicle M.
The configuration illustrated in
The navigation device 50 includes a global navigation satellite system (GNSS) receiver or map information (navigation map), a touch panel type display device functioning as a user interface, a speaker, a microphone, and the like. The navigation device 50 specifies a position of the subject vehicle M using the GNSS receiver and derives a route from the position to a destination designated by the user. The route derived by the navigation device 50 is stored in a storage unit 130 as route information 134. The position of the subject vehicle M may be identified or supplemented by an inertial navigation system (INS) using the output of the vehicle sensor 60. Further, when the vehicle control device 100 is executing a manual driving mode, the navigation device 50 performs guidance through voice or a navigation display for the route to the destination. A configuration for specifying the position of the subject vehicle M may be provided independently of the navigation device 50. Further, the navigation device 50 may be realized, for example, by a function of a terminal device such as a smartphone or a tablet terminal possessed by the user. In this case, transmission and reception of information is performed between the terminal device and the vehicle control device 100 through wireless or communication.
The vehicle sensor 60 includes a vehicle speed sensor that detects a speed of the subject vehicle M (vehicle speed), an acceleration sensor that detects an acceleration, a yaw rate sensor that detects an angular velocity around a vertical axis, and a direction sensor that detects a direction of the subject vehicle M.
The operation device 70 includes, for example, an accelerator pedal, a steering wheel, a brake pedal, a shift lever, and the like. The operation detection sensor 72 that detects the presence or absence or the amount of an operation of the driver is attached to the operation device 70. The operation detection sensor 72 includes, for example, an accelerator opening degree sensor, a steering torque sensor, a brake sensor, a shift position sensor, and the like. The operation detection sensor 72 outputs a degree of accelerator opening, a steering torque, a brake pedal amount, a shift position, and the like as detection results to the travel control unit 120. Alternatively, the detection result of the operation detection sensor 72 may be directly output to the travel driving force output device 90, the steering device 92, or the brake device 94.
The changeover switch 80 is a switch that is operated by a driver or the like. The changeover switch 80 may be a mechanical switch or may be a graphical user interface (GUI) switch that is provided in the touch panel type display device of the navigation device 50. The changeover switch 80 receives a switching instruction to switch between a manual driving mode in which the driver manually drives and an automatic driving mode in which the vehicles travels in a state in which the driver does not perform operations (or the amount of an operation is smaller than in the manual driving mode or an operation frequency is lower than that in the manual driving mode), and generates a control mode designation signal for designating a control mode of the travel control unit 120 as any one of the automatic driving mode and the manual driving mode.
The travel driving force output device 90 includes, for example, one or both of an engine and a traveling motor. When the travel driving force output device 90 includes only an engine, the travel driving force output device 90 further includes an engine electronic control unit (ECU) that controls the engine. The engine ECU controls the travel driving force (torque) for causing the vehicle to travel, for example, by adjusting a degree of throttle opening, a shift stage, or the like according to information input from the travel control unit 120. When the travel driving force output device 90 includes only a traveling motor, the travel driving force output device 90 includes a motor ECU that drives the traveling motor. The motor ECU controls the travel driving force for causing the vehicle to travel, for example, by adjusting a duty ratio of a PWM signal to be applied to the traveling motor. When the travel driving force output device 90 includes both an engine and a traveling motor, both an engine ECU and a motor ECU cooperate to control the travel driving force.
The steering device 92 includes, for example, an electric motor that can change directions of steered wheels by applying a force on a rack and pinion facility or the like, a steering angle sensor that detects a steering angle (or actual steering angle), and the like. The steering device 92 drives the electric motor according to information input from the travel control unit 120.
The brake device 94 includes a master cylinder to which a brake operation of the brake pedal is transmitted as hydraulic pressure, a reservoir tank that stores brake fluid, a brake actuator that adjusts a braking force that is output to each wheel, and the like. The brake device 94 controls the brake actuator or the like so that a brake torque having a desired magnitude is output to each wheel according to information input from the travel control unit 120. The brake device 94 is not limited to an electronic control brake device that is operated by the above-described hydraulic pressure, and may be an electronic control brake device that is operated by an electric actuator.
Hereinafter, the vehicle control device 100 will be described. The vehicle control device 100 includes, for example, an outside world recognition unit 102, a subject-vehicle position recognition unit 104, an action plan generation unit 106, a lane change control unit 110, a travel control unit 120, a control switching unit 122, and a storage unit 130. Some or all of the outside world recognition unit 102, the subject-vehicle position recognition unit 104, the action plan generation unit 106, the lane change control unit 110, the travel control unit 120, and the control switching unit 122 may be software functional units that function by a processor such as a central processing unit (CPU) executing a program. Further, some or all of these may be hardware functional units such as large scale integration (LSI) or application specific integrated circuit (ASIC). Further, the storage unit 130 is realized by a read only memory (ROM), a random access memory (RAM), a hard disk drive (HDD), a flash memory, or the like. The program may be stored in the storage unit 130 in advance or may be downloaded from an external device via an in-vehicle Internet facility or the like. Further, a portable storage medium having the program stored thereon may be installed in the storage unit 130 by being mounted on a drive device (not illustrated).
The outside world recognition unit 102 recognizes a state such as a position and a speed of a nearby vehicle on the basis of outputs of the finder 20, the radar 30, the camera 40, and the like. The nearby vehicle in this embodiment is a vehicle that travels around the subject vehicle M and is a vehicle that travels in the same direction as that of the subject vehicle M. The position of the nearby vehicle may be represented by a representative point such as a centroid or a corner of another vehicle or may be represented by an area expressed by an outline of another vehicle. The “state” of the nearby vehicle may include an acceleration of the nearby vehicle, and an indication of whether or not the nearby vehicle is changing lane (or whether or not the nearby vehicle is about to change lane) on the basis of the information of various devices described above. The outside world recognition unit 102 recognizes whether or not the nearby vehicle is changing lane (or whether or not the nearby vehicle is about to change lane) based on the history of the position of the nearby vehicle, the operation state of the direction indicator, or the like. Further, in addition to nearby vehicles, the outside world recognition unit 102 may also recognize a position of a guardrail, a utility pole, a parked vehicle, a pedestrian, and other objects. Hereinafter, a combination of the finder 20, the radar 30, the camera 40, and the outside world recognition unit 102 is referred to as a “detection unit DT” that detects a nearby vehicle. The detection unit DT may further recognize a state of a position, a speed, or the like of a nearby vehicle through communication with the nearby vehicle.
The subject-vehicle position recognition unit 104 recognizes a lane (subject lane) which the subject vehicle M is traveling, and a relative position of the subject vehicle M with respect to the travel lane on the basis of map information 132 stored in the storage unit 130, and information input from the finder 20, the radar 30, the camera 40, the navigation device 50, or the vehicle sensor 60. The map information 132 is, for example, map information with higher accuracy than the navigation map included in the navigation device 50, and includes information on a center of the lane or information on boundaries of the lane.
The action plan generation unit 106 generates an action plan in a predetermined section. The predetermined section is, for example, a section passing through a toll road such as a highway in a route derived by the navigation device 50. The present invention is not limited thereto, and the action plan generation unit 106 may generate an action plan for an arbitrary section.
The action plan includes, for example, a plurality of events that are executed sequentially. Examples of the events include a deceleration event for decelerating the subject vehicle M, an acceleration event for accelerating the subject vehicle M, a lane keeping event for causing the subject vehicle M to travel so that the subject vehicle M does not deviate from a travel lane, a lane change event for changing travel lane, an overtaking event for causing the subject vehicle M to overtake a preceding vehicle, a branch event for changing a lane to a desired lane at a branch point or causing the subject vehicle M to travel so that the subject vehicle M does not deviate from a current travel lane, and a merging event for accelerating and decelerating the subject vehicle M at a lane merging point and changing the driving lane. For example, when there is a junction (a branch point) in a toll road (for example, a highway), it is necessary for the vehicle control device 100 to change lanes so that the subject vehicle M travels in the direction of the destination or keep in a lane in the automatic driving mode. Accordingly, when it is determined that there is a junction on a route by referring to the map information 132, the action plan generation unit 106 sets a lane change event for changing lane to a desired lane in which the vehicle can proceed in the direction of the destination, between the current position (coordinates) of the subject vehicle M and the position (coordinates) of the junction.
The lane change control unit 110 performs control when the lane change event included in the action plan by the action plan generation unit 106 is performed. The lane change control unit 110 includes, for example, a target position candidate setting unit 111, an other-vehicle position change estimation unit 112, a lane changeable period derivation unit 113, a control plan generation unit 114, and a target position determination unit 115.
The target position candidate setting unit 111 refers to the position of the nearby vehicle detected by the detection unit DT to first set a target area of a large frame that is a lane change target, and set the lane change target position candidate as a relative position with respect to the nearby vehicle traveling in an adjacent lane adjacent to the travel lane (subject lane) which the subject vehicle M travels within the target area.
First, the target position candidate setting unit 111 sets, as the target area Ar, an area being behind a nearby vehicle m4 (a front reference vehicle) which is closest to the subject vehicle M among the nearby vehicles traveling in the adjacent lane L2 and traveling in front of a nearby vehicle m1 (a preceding vehicle) traveling immediately in front of the subject vehicle M in the subject lane L1, the area also being in front of a nearby vehicle m7 (a rear reference vehicle) which is closest to the subject vehicle M among the nearby vehicles traveling in the adjacent lane L2 and traveling behind the nearby vehicle m2 (a following vehicle) traveling immediately behind the subject vehicle M in the subject lane L1.
Here, the “nearby vehicle traveling in front of the preceding vehicle” may mean a nearby vehicle of which a front end portion is in front of a front end portion of the preceding vehicle or may mean a nearby vehicle of which a rear end portion is in front of a rear end portion of the preceding vehicle. Further, the “nearby vehicle traveling in front of the preceding vehicle” may mean a nearby vehicle of which a reference point such as a centroid is located in front of the reference point, the front end portion, or the rear end portion of the preceding vehicle.
On the other hand, a “nearby vehicle traveling behind a following vehicle” may mean a nearby vehicle of which a front end portion is behind a front end portion of the following vehicle or may mean a nearby vehicle of which a rear end portion is behind a rear end portion of the following vehicle. Further, the “nearby vehicle traveling behind the following vehicle” may mean a nearby vehicle of which a reference point such as a centroid is located behind the reference point, the front end portion, or the rear end portion of the following vehicle.
Accordingly, the target position candidate setting unit 111 can prevent the lane change target position candidate T from being set to a position considered difficult to change a lane to, such as in front of a nearby vehicle traveling in front of the preceding vehicle or behind a nearby vehicle traveling behind the following vehicle. This is because a behavior of the subject vehicle M for lane change is greatly limited by a behavior of the preceding vehicle or the following vehicle at such a position. As a result, the target position candidate setting unit 111 can prevent the subject vehicle M from being forced into an unreasonable behavior at the time of lane change.
The target position candidate setting unit 111 sets the lane change target position candidates T1, T2, and T3 between two nearby vehicles (m4 and m5, m5 and m6, and m6 and m7) traveling in a relationship of immediately in front and immediately behind (in a relationship in which there is no nearby vehicle therebetween) among the nearby vehicles m4 to m7 traveling in the target area Ar. Therefore, the number of lane change target position candidates T is changed according to the number of nearby vehicles traveling in the target area Ar in the adjacent lane L2. When the number of nearby vehicles traveling in the target area Ar is n, n−1 lane change target position candidates T are set.
Accordingly, the target position candidate setting unit 111 sets a plurality of candidates of lane change destinations according to a distribution of the nearby vehicles, such that a degree of freedom of the lane change control can be increased. As a result, it is possible to set an optimal lane change target position T# later.
Here, it is also assumed that any one of the front reference vehicle, the rear reference vehicle, the preceding vehicle, and the following vehicle may not be detected by the detection unit DT. This will be described below.
Although the front reference vehicle and the rear reference vehicle have been defined as being included in the target area Ar for convenience in the above description, the front reference vehicle and the rear reference vehicle may be defined as vehicles not included in the target area Ar and the process may be performed. In this case, the target position candidate setting unit 111 may set the lane change target position candidate T not only between two nearby vehicles traveling in a relationship of immediately in front or immediately behind (in a relationship in which there is no nearby vehicle therebetween), but also between the front side boundary Arf of the target area Ar and a nearby vehicle immediately behind the boundary and between the rear side boundary Arr of the target area Ar and a nearby vehicle immediately in front of the boundary.
The other-vehicle position change estimation unit 112 selects nearby vehicles (three nearby vehicles in the following example) that are highly likely to interfere with the lane change among the nearby vehicles detected by the detection unit DT, and estimates a future change in a position of the selected vehicle. Hereinafter, the nearby vehicles highly likely to interfere with the lane change are referred to as monitoring target vehicles mA, mB, and mC.
The lane changeable period derivation unit 113 derives a lane changeable period P for the lane change target position candidate T on the basis of the change in the positions of the monitoring target vehicles mA, mB, and mC estimated by the other-vehicle position change estimation unit 112. Process of the lane changeable period derivation unit 113 will be described in detail below.
The control plan generation unit 114 generates a control plan for a lane change on the basis of the change in the positions of the monitoring target vehicles mA, mB, and mC estimated by the other-vehicle position change estimation unit 112 for each lane change target position candidate T set by the target position candidate setting unit 111.
The target position determination unit 115 determines the lane change target position T# on the basis of the control plan generated by the control plan generation unit 114 for each lane change target position candidate T set by the target position candidate setting unit 111.
Hereinafter, a process of determining a lane change target position will be described with reference to the flowchart.
First, the target position candidate setting unit 111 selects one lane change target position candidate T (step S200). Then, the other-vehicle position change estimation unit 112 specifies the monitoring target vehicles mA, mB, and mC corresponding to the lane change target position candidate T (step S202; see
Next, the other-vehicle position change estimation unit 112 estimates a future change in positions of the monitoring target vehicles mA, mB and mC (step S204).
The future change in the position can be estimated on the basis of various models such as a constant speed model in which a vehicle is assumed to travel while maintaining a current speed, and a constant acceleration model in which a vehicle is assumed to travel while maintaining the current acceleration. Further, the other-vehicle position change estimation unit 112 may consider a steering angle of the monitoring target vehicle, or may estimate the change in the position on the assumption that a vehicle is traveling while keeping in a current travel lane without considering the steering angle. In the following description, the monitoring target vehicle is assumed to travel while keeping in a travel lane and keeping a current speed, and the change in the position is estimated.
Then, the lane changeable period derivation unit 113 derives the lane changeable period P (step S206). The process will be described in detail below with reference to another flowchart, and a principle that is a basis of the process that is executed by the lane changeable period derivation unit 113 will first be described.
First, a relationship (position distribution) between the subject vehicle M and the monitoring target vehicles mA, mB, and mC is categorized into six patterns as shown below, for example. Hereinafter, a vehicle shown on the left-hand-side indicates a preceding vehicle. Patterns (a) and (b) show examples in which a lane is changed without changing a relative position with respect to nearby vehicles, pattern (c) shows an example in which a relative position with respect to the nearby vehicles is lowered (relatively decelerated) and the lane change is performed, and patterns (d), (e), and (f) show an example in which a relative position with respect to nearby vehicles is raised (relatively accelerated) and the lane change is performed.
Since pattern (f) is based on the lane change target position candidate T not set by the target position candidate setting unit 111 in the first embodiment, pattern (f) is a reference example herein.
For respective patterns (a) to (f), the change in positions of the monitoring target vehicles mA, mB and mC is further categorized on the basis of the speed of the monitoring target vehicles.
Start point in time: Any time
End point in time: An earlier point in time between a point in time at which mC catches up with mA or a point in time at which mC catches up with mB
Start point in time: A point in time when mB overtakes the subject vehicle M
End point in time: An earlier point in time between a point in time when mC catches up with mA and a point in time when mC catches up with mB
Start point in time: A point in time when the subject vehicle M overtakes mC
End point in time: An earlier point in time between a point in time when mC catches up with mA and a point in time when mC catches up with mB
Start point in time: A point in time when mA overtakes mC
End point in time: A point in time when mC catches up with mB (mC catching up with mA is not considered from restrictions of the start point in time)
In pattern (f), when the speed is mC>mB>mA, when mB>mC>mA, and when mC>mA>mB, lane change is impossible.
First, the lane changeable period derivation unit 113 categorizes positional distributions between the subject vehicle M and the monitoring target vehicles mA, mB and mC (step S300). Then, the lane changeable period derivation unit 113 determines the start point in time of the lane changeable period on the basis of the change in positions of the monitoring target vehicles mA, mB, and mC estimated by the other-vehicle position change estimation unit 112 (step S302).
Here, in order to determine the start point in time of the lane change as described above, there are elements such as “a point in time at which the monitoring target vehicle mB overtakes the subject vehicle M” and “a point in time at which the subject vehicle M overtakes the monitoring target vehicle mC”, and in order to solve this, it is necessary to assume acceleration and deceleration of the subject vehicle M. In this regard, the lane changeable period derivation unit 113, for example, regards the subject vehicle M as decelerating by a predetermined degree (for example, about 20%) from the current speed of the subject vehicle M when the subject vehicle M decelerates, derives a speed change curve within a range in which sudden deceleration does not occur, and determines a “point in time when the monitoring target vehicle mB overtakes the subject vehicle M” together with a change in the position of the monitoring target vehicle mB. The lane changeable period derivation unit 113 derives a speed change curve having a statutory speed as an upper limit within a range in which sudden acceleration from the current speed of the subject vehicle M does not occur when the subject vehicle M accelerates, and determines a “point in time when the subject vehicle M overtakes the monitoring target vehicle mC” together with a change in the position of the monitoring target vehicle mC.
Then, the lane changeable period derivation unit 113 determines the end point in time of the lane changeable period on the basis of the change in positions of the monitoring target vehicles mA, mB, and mC estimated by the other-vehicle position change estimation unit 112 (step S304). The lane changeable period derivation unit 113 derives the lane changeable period on the basis of the start point in time determined in step S302 and the end point in time determined in step S304 (step S306).
Referring back to
Further, when the subject vehicle M needs to change lane after the subject vehicle M has overtaken the monitoring target vehicle mC, the control plan generation unit 114 generates a control plan so that the lane change is started at a point (CP in
With such control, the lane change control unit 110 can realize smooth lane change control.
In a case in which the processes of steps S200 to S208 have been performed on all the lane change target position candidates T, the target position determination unit 115 determines the lane change target position T# by evaluating the corresponding control plan (step S212).
The target position determination unit 115, for example, determines the lane change target position T# from the viewpoint of safety or efficiency. The target position determination unit 115 refers to the control plan corresponding to each of the lane change target position candidates T to preferentially select a position at which an interval between front and rear vehicles at the time of the lane change is large, a position at which a speed is close to a statutory speed, or a position at which an acceleration or deceleration required at the time of the lane change is low, as the lane change target position T#. Thus, one lane change target position T# and the control plan are determined.
The lane change control unit 110 generates a trajectory for changing lane on the basis of the determined lane change target position T# and the control plan. The trajectory is a set (locus) of points obtained by sampling future target positions assumed to be reached at predetermined time intervals. Details will be described below.
The travel control unit 120 sets a control mode an automatic driving mode or a manual driving mode under the control of the control switching unit 122, and controls a control target according to the set control mode. In the automatic driving mode, the travel control unit 120 reads action plan information 136 generated by the action plan generation unit 106, and controls the control target on the basis of an event included in the read action plan information 136. When this event is a lane change event, the travel control unit 120 determines the amount of control (for example, a rotation speed) of the electric motor in the steering device 92 and the amount of control (for example, a degree of throttle opening of an engine or a shift stage) of the ECU in the travel driving force output device 90 according to the control plan generated by the control plan generation unit 114. The travel control unit 120 outputs information indicating the amount of control determined for each event to the corresponding control target. Accordingly, each device (90, 92, 94) that is a control target can control the subject device according to the information indicating the amount of control input from the travel control unit 120. Further, the travel control unit 120 appropriately adjusts the determined amount of control on the basis of a detection result of the vehicle sensor 60.
Further, in the manual driving mode, the travel control unit 120 controls the control target on the basis of an operation detection signal output by the operation detection sensor 72. For example, the travel control unit 120 may output the operation detection signal output by the operation detection sensor to each device that is the control target as it is.
The control switching unit 122 switches the control mode of the subject vehicle M in the travel control unit 120 from the automatic driving mode to the manual driving mode or from the manual driving mode to the automatic driving mode on the basis of the action plan information 136 generated by the action plan generation unit 106. Further, the control switching unit 122 switches the control mode of the subject vehicle M in the travel control unit 120 from the automatic driving mode to the manual driving mode or from the manual driving mode to the automatic driving mode on the basis of the control mode designation signal input from the changeover switch 80. That is, the control mode of the travel control unit 120 can be arbitrarily changed during traveling or stopping by an operation of a driver or the like.
Further, the control switching unit 122 switches the control mode of the subject vehicle M in the travel control unit 120 from the automatic driving mode to the manual driving mode on the basis of an operation detection signal input from the operation detection sensor 72. For example, when the amount of an operation included in the operation detection signal exceeds a threshold value, that is, when the operation device 70 receives an operation with an amount of an operation exceeding the threshold value, the control switching unit 122 switches the control mode of the travel control unit 120 from automatic driving mode to the manual driving mode. For example, when the subject vehicle M is automatically traveling due to the travel control unit 120 being set to the automatic driving mode, and when a steering wheel, an accelerator pedal, or a brake pedal is operated with an amount of an operation exceeding the threshold value by the driver, the control switching unit 122 switches the control mode of the travel control unit 120 from the automatic driving mode to the manual driving mode. Accordingly, the vehicle control device 100 can perform switching to the manual driving mode immediately without an operation of the changeover switch 80, through an operation immediately performed by the driver when an object such as a person jumps into a road or a preceding vehicle suddenly stops. As a result, the vehicle control device 100 can respond to an operation of the driver at the time of emergency, thereby improving the safety during traveling.
According to the vehicle control device 100 of this embodiment described above, the target position candidate setting unit 111 can prevent the lane change target position candidate T from being set to a position considered difficult to change lanes, such as in front of a nearby vehicle traveling in front of the preceding vehicle or behind a nearby vehicle traveling behind the following vehicle. As a result, the target position candidate setting unit 111 can prevent the subject vehicle M from being forced into an unreasonable behavior at the time of the lane change.
Further, according to the vehicle control device 100 of this embodiment, the target position candidate setting unit 111 sets a plurality of candidates of lane change destinations according to a distribution of the nearby vehicles, such that a degree of freedom of the lane change control can be increased. As a result, it is possible to set an optimal lane change target position later.
Further, according to the vehicle control device 100 of this embodiment, the lane changeable period derivation unit 113 can assist in various processes such as generation of the control plan for lane change by deriving the lane changeable period P in which the lane can be changed to the lane change target position candidate T set as a relative position with respect to the nearby vehicle traveling in the adjacent lane L2 adjacent to the subject lane L1 on the basis of the change in the position of the nearby vehicle (monitoring target vehicle).
Further, according to the vehicle control device 100 of this embodiment, the control plan generation unit 114 derives a restriction on the speed for changing lane to the lane change target position T# within the lane changeable period P derived by the lane changeable period derivation unit 113 and generates the control plan under the derived restrictions on the speed, thereby preventing occurrence of a situation in which an unrealizable control plan can be established.
Further, according to the vehicle control device 100 of this embodiment, the lane changeable period derivation unit 113 derives the lane changeable period P using a different scheme according to the position distribution between the subject vehicle M and the monitoring target vehicles, thereby deriving the lane changeable period P using an appropriate scheme according to the position distribution between the subject vehicle M and the monitoring target vehicles.
The vehicle control device 100 may further include a travel aspect determination unit 108 and a travel trajectory generation unit 109 in addition to the above-described functional units.
When a lane keeping event included in the action plan is executed by the travel control unit 120, the travel aspect determination unit 108 determines a traveling aspect of any one of constant speed traveling, following traveling, decelerating traveling, curved traveling, obstacle avoidance traveling, and the like. For example, when there are no other vehicles in front of the subject vehicle M, the travel aspect determination unit 108 may determine the travel aspect to be constant speed traveling. Further, when the vehicle follows the preceding vehicle, the travel aspect determination unit 108 may determine the travel aspect to be following traveling. Further, when the outside world recognition unit 102 recognizes deceleration of the preceding vehicle or when an event such as stopping or parking is performed, the travel aspect determination unit 108 may determine the travel aspect to be decelerating traveling. Further, when the outside world recognition unit 102 recognizes that the subject vehicle M has arrived at a curved road, the travel aspect determination unit 108 may determine the travel aspect to be curved traveling. Further, when an obstacle is recognized in front of the subject vehicle M by the outside world recognition unit 102, the travel aspect determination unit 108 may determine the travel aspect to be the obstacle avoidance traveling.
The travel trajectory generation unit 109 generates a trajectory on the basis of the travel aspect determined by the travel aspect determination unit 108. The trajectory is a set (locus) of points obtained by sampling future target positions assumed to be reached at predetermined time intervals when the subject vehicle M travels on the basis of the travel aspect determined by the travel aspect determination unit 108. The travel trajectory generation unit 109 calculates the target speed of the subject vehicle M on the basis of at least the speed of a target OB present in front of the subject vehicle M recognized by the outside world recognition unit 102 or the subject-vehicle position recognition unit 104, and the distance between the subject vehicle O and the target OB. The travel trajectory generation unit 109 generates a trajectory on the basis of the calculated target speed. The target OB includes a preceding vehicle, a point such as a merging point, a branch point, or a target point, an object such as an obstacle, and the like.
Hereinafter, the generation of the trajectory, particularly, in both a case in which the presence of the target OB is not considered and a case in which the presence of the target OB is considered will be described.
For example, when the travel aspect is determined to be constant speed traveling by the travel aspect determination unit 108 described above, the travel trajectory generation unit 109 may set a plurality of target positions K at equal intervals to generate a trajectory as illustrated in (A) of
Further, when the travel aspect is determined to be deceleration traveling by the travel aspect determination unit 108 (including a case in which a preceding vehicle decelerates in the follow-up traveling), the travel trajectory generation unit 109 may generate a trajectory in which an interval is wider between the target positions K at which an arrival time is earlier and is narrower between the target positions K at which the arrival time is later, as illustrated in (B) of
Further, as illustrated in (C) of
A second embodiment will be described below.
When the monitoring target vehicle mC catches up with mB, the lane change possibility determination unit 116 generates a locus of a displacement of the subject vehicle M using a point at which the monitoring target vehicle mC catches up with mB as an end point (step S402). Then, the lane change possibility determination unit 116 determines whether or not the monitoring target vehicle mC will catch up with mA before the monitoring target vehicle mC catches up with mB (step S404).
When the monitoring target vehicle mC catches up with mA before the monitoring target vehicle mC catches up with mB (see an upper right diagram of
When the subject vehicle M is in front of the monitoring target vehicle mC at a time in time at which the monitoring target vehicle mC catches up with the mA, the lane change possibility determination unit 116 determines whether or not the locus of the subject vehicle M satisfies the restrictions of speed and acceleration (step S408). The restrictions on the speed and the acceleration are defined as, for example, the speed being within a range of speed in which a statutory speed is an upper limit and about 60% of the statutory speed is a lower limit, and an acceleration and a deceleration being lower than respective set threshold values.
When the locus of the subject vehicle M satisfies the restrictions of speed and acceleration, the lane change possibility determination unit 116 determines that lane change is possible (step S410). On the other hand, when the locus of the subject vehicle M does not satisfy the restrictions of speed and acceleration, the lane change possibility determination unit 116 determines that the lane change is impossible (step S412).
When a negative determination is obtained in step S400, the lane change possibility determination unit 116 determines whether or not the monitoring target vehicle mC will catch up with mA (step S414). When the monitoring target vehicle mC catches up with mA (see a lower middle diagram or the like in
On the other hand, when the monitoring target vehicle mC does not catch up with mA (see an upper left drawing or the like in
According to the vehicle control device 100A of this embodiment described above, it is possible to achieve the same effects as those of the first embodiment, and to more appropriately determine whether or not lane change is possible by determining whether or not the nearby vehicle traveling immediately after the lane change target position T# set as a relative position with respect to the nearby vehicle traveling in the adjacent lane L2 adjacent to the subject lane L1 will catch up with another nearby vehicle, and determining whether or not the lane change is possible on the basis of a result of the determination.
Hereinafter, a third embodiment will be described.
The lane change trigger is generated, for example, when a switch operation or the like for lane change is performed by the driver. Further, the lane change trigger nay be automatically generated according to a state of the vehicle.
A fourth embodiment will be described below. The vehicle control device 100 according to the first embodiment sets a lane change target position candidate without considering nearby vehicles traveling in a lane adjacent to a lane in which the subject vehicle M is about to change lane. On the other hand, the vehicle control device 100C of the fourth embodiment sets the lane change target position candidate in consideration of the nearby vehicles traveling in the lane adjacent to the lane in which the subject vehicle M is about to change lane, which is different from in the first embodiment. The difference will be mainly described below.
As in the first embodiment, an outside world recognition unit 102 of the vehicle control device 100C estimates whether or not a nearby vehicle is changing lane (whether or not a nearby vehicle is about to change lane) on the basis of a history of a position of the nearby vehicle, an operation state of a direction indicator, or the like. The outside world recognition unit 102 is an example of an “estimation unit”.
The virtual vehicle setting unit 117 sets a virtual vehicle obtained by virtually simulating a nearby vehicle in a predetermined state when there is a nearby vehicle determined to change a lane to a lane that is a lane change destination of the subject vehicle M by the outside world recognition unit 102. The predetermined state is, for example, a state in which a speed of the nearby vehicle at the present point in time is maintained. The predetermined state may be a speed lower or higher than the speed of the nearby vehicle at the present point in time.
The target position candidate setting unit 111 refers to the position of the nearby vehicle detected by the detection unit DT, regards the virtual vehicle set by the virtual vehicle setting unit 117 as the nearby vehicle, and sets the lane change target position candidate.
First, in the fourth embodiment, the target position candidate setting unit 111 sets an area including the nearby vehicle mB and the nearby vehicle mC traveling in the adjacent lane L2 as the target area Ar. A scheme of setting the target area Ar may be the same as in the first embodiment. The target position candidate setting unit 111 sets the lane change target position candidates T1 and T2 at positions at which the subject vehicle M can safely change lane without interfering with, for example, the nearby vehicle mB and the nearby vehicle mC. The target position candidate setting unit 111 sets the lane change target position candidate T1, for example, between the nearby vehicles mB and mC. The target position candidate setting unit 111 sets the lane change target position candidate T2 behind the nearby vehicle mC, for example. When there is no area in which the subject vehicle M may perform the lane change behind the nearby vehicle mC, the target position candidate setting unit 111 does not set the lane change target position candidate T2 and sets only the lane change target position candidate T1.
Therefore, the number of lane change target position candidates T is changed according to the number of nearby vehicles traveling in the target area Ar in the adjacent lane L2. Further, a size of the area in which the lane change target position candidate T is formed varies according to a size of an area between nearby vehicles traveling in the target area Ar in the adjacent lane L2.
When the virtual vehicle is set by the virtual vehicle setting unit 117, the target position candidate setting unit 111 regards the virtual vehicle as a nearby vehicle and sets the lane change target position candidate T in the target area Ar.
The target position candidate setting unit 111 regards the set virtual vehicle mXVt as the nearby vehicle that is located between the nearby vehicles mB and mC in the adjacent lane L2 and travels at such a position. The target position candidate setting unit 111 sets the lane change target position candidate T in the target area Ar on the basis of the nearby vehicles mB and mC and the virtual vehicle mXVt. In this case, for example, the target position candidate setting unit 111 sets the lane change target position candidates T (T1−1, T1−2, and T2) at a position between the nearby vehicles mB and mC, a position between the nearby vehicle mC and the virtual vehicle mXVt, and a position behind the nearby vehicle mC. However, when there is not a sufficient area for lane change of the subject vehicle M at the position between the nearby vehicle mB and the virtual vehicle mXVt or the position between the nearby vehicle mC and the virtual vehicle mXVt, the target position candidate setting unit 111 excludes the position from the lane change target position candidates T.
Thus, when there is a nearby vehicle estimated to change a lane to the lane that is the lane change destination of the subject vehicle M, the vehicle control device 100 sets the virtual vehicle obtained by virtually simulating the nearby vehicle in the lane that is the lane change destination, and sets the lane change target position candidate on the basis of nearby vehicles traveling in the lane that is the lane change destination and the virtual vehicle. As a result, the vehicle control device 100 can increase a degree of freedom of the lane change control while preventing the candidate for the lane change target position from being set at a position considered to be difficult to change lane.
Further, even when a nearby vehicle is not traveling in the adjacent lane L2, the vehicle control device 100 may set a virtual vehicle in the adjacent lane L2 when a nearby vehicle traveling in the third lane L3 is estimated to change lane to the adjacent lane L2.
When the virtual vehicle is set by the virtual vehicle setting unit 117, the target position candidate setting unit 111 regards the virtual vehicle as a nearby vehicle and sets the lane change target position candidate T in the target area Ar.
The target position candidate setting unit 111 regards the set virtual vehicle mXVt as a nearby vehicle in the adjacent lane L2. For example, the target position candidate setting unit 111 sets lane change target position candidates T (T1 and T2) in front of and behind the virtual vehicle mXVt.
Thus, when the nearby vehicle traveling in the third lane is estimated to be about to change the lane to the lane that is a lane change destination, the vehicle control device 100 sets the virtual vehicle in the lane that is a lane change destination and regards the virtual vehicle as the nearby vehicle traveling in the lane that is a lane change destination, thereby preventing the lane change target position candidate from being set at the position considered to be difficult to change lane.
The vehicle control device 100 may set the virtual vehicle in the adjacent lane L2 when the nearby vehicle traveling in the subject lane L1 is estimated to be about to change the lane to the adjacent lane L2. When the virtual vehicle is set, the target position candidate setting unit 111 regards the virtual vehicle as a nearby vehicle and sets the lane change target position candidate T in the target area Ar.
The target position candidate setting unit 111 regards the set virtual vehicle mAVt as a nearby vehicle in the adjacent lane L2. For example, the target position candidate setting unit 111 may set the lane change target position candidate T1 obtained by changing the lane change target position candidate T such that it does not interfere with the virtual vehicle mAVt, behind the virtual vehicle mAVt.
Thus, in the vehicle control device 100, even when the nearby vehicle traveling in the subject lane L1 is estimated to change the lane to the adjacent lane L2, the target position candidate setting unit 111 sets the virtual vehicle in the lane that is the lane change destination, regards the set virtual vehicle as the nearby vehicle, and sets the lane change target position candidate T in the target area Ar, thereby preventing the lane change target position candidate from being set at a position considered to be difficult to change lane.
Although the outside world recognition unit 102 estimates whether or not the nearby vehicle is changing lane (whether or not the nearby vehicle is about to change lane) on the basis of the operation state of the direction indicator or the like in the example described above, the outside world recognition unit 102 may estimate the lane change of the nearby vehicle on the basis of a distance to a lane decrease position or an arrival time when the lane decrease in front of the subject vehicle M is detected on the basis of the position of the subject vehicle acquired from the navigation device 50 and the map information 132 or the information input from the finder 20, the radar 30, the camera 40, or the like.
The outside world recognition unit 102 searches for the map information 132 on the basis of the position of the subject vehicle M acquired from the navigation device 50, and determines whether or not there is a point VP (see
Further, the outside world recognition unit 102 may detect a decrease in the lane in front of the subject vehicle M on the basis of the image obtained by imaging the front of the subject vehicle M using the camera 40.
The outside world recognition unit 102 may estimate the lane change of the nearby vehicle using the history of the position of the nearby vehicle, an operating state of the direction indicator, the position of the subject vehicle acquired from the navigation device 50, the map information 132, and the information input from the finder 20, the radar 30, the camera 40, or the like in parallel.
According to the fourth embodiment described above, the vehicle control device 100 sets the number of lane change target position candidates T varying according to the number of nearby vehicles traveling in the target area Ar in the adjacent lane, in the target area Ar. More specifically, when there is a nearby vehicle determined to change a lane to the lane that is the lane change destination of the subject vehicle M, the vehicle control device 100 sets the virtual vehicle obtained by virtually simulating the nearby vehicle in the adjacent lane, and sets the lane change target position candidate on the basis of the nearby vehicles traveling in the adjacent lane and the virtual vehicle. As a result, the vehicle control device 100 can increase a degree of freedom of the lane change control while improving safety.
Although the modes for carrying out the present invention have been described above by way of embodiments, the present invention is not limited to these embodiments at all, and various modifications and substitutions may be made without departing from the scope of the present invention.
Number | Date | Country | Kind |
---|---|---|---|
2015-141383 | Jul 2015 | JP | national |
2016-025271 | Feb 2016 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2016/069866 | 7/5/2016 | WO | 00 |