The present invention relates to a vehicle control system, a vehicle control method, and a vehicle control program.
Priority is claimed on Japanese Patent Application No. 2016-050734, filed Mar. 15, 2016, the content of which is incorporated herein by reference.
In recent years, research has been performed on a technology (hereinafter, automated driving) of automatically controlling at least one of acceleration, deceleration and steering of a host vehicle such that the host vehicle travels along a route to a destination. In this regard, various technologies have also been disclosed in automated driving when a vehicle joins a main line from a branch line of an expressway or the like (for example, see Patent Literature 1).
Japanese Unexamined Patent Application, First Publication No. 2015-102893
However, in the technology of the related art, there was a case in which a timing of determination of whether merging from a branch line to a main line is possible is late.
An aspect of the present invention is directed to providing a vehicle control system, a vehicle control method, and a vehicle control program, in which determination of whether merging is possible can be rapidly performed.
(1) A vehicle control system according to an aspect of the present invention includes an acquisition unit that acquires traffic condition information of a main line to which a host vehicle is going to join from a branch line; a first controller that determines whether the host vehicle is able to join the main line on the basis of the traffic condition information acquired by the acquisition unit and a length of a mergeable section in a merging place from the branch line to the main line; and a second controller that automatically controls at least acceleration and deceleration of the host vehicle such that the host vehicle travels from the branch line toward the main line in a case it is determined by the first controller that the host vehicle is able to join the main line.
(2) In the aspect of (1), by referring to a correspondence information in which both of the information obtained from the traffic condition information and the length of the mergeable section are made to respectively correspond with a success probability of merging from the branch line to the main line, the first controller may derive the success probability corresponding to the traffic condition information acquired by the acquisition unit, and may determine whether the host vehicle is able to join the main line on the basis of the derived success probability.
(3) In the aspect of (3), the success probability of merging may be a probability on the basis of a ratio between the length of the mergeable section and a traveling distance which the host vehicle travels from the branch line to the main line.
(4) In the aspect of (2) or (3), in the correspondence information, a speed of the host vehicle may be further made to correspond with the success probability, and by obtaining the speed of the host vehicle and by referring to the correspondence information by using the acquired speed of the host vehicle, the first controller may derive the success probability and determine whether the host vehicle is able to join the main line on the basis of the derived success probability.
(5) In the aspect of any one of (1) to (4), the vehicle control system may further include a switching controller that restricts a control of the second controller in a merging in a case it is determined by the first controller that the host vehicle is not able to join the main line.
(6) In the aspect of any one of (1) to (5), the traffic condition information may include an average speed of traveling vehicles on the main line and information from which an inter-vehicle distance of the traveling vehicles is able to be derived.
(7) A vehicle control system according to another aspect of the present invention includes an acquisition unit that acquires traffic condition information of a main line to which a host vehicle is going to join from a branch line; and a derivation part that derives a traveling distance corresponding to the traffic condition information acquired by the acquisition unit by referring to correspondence information in which information obtained from the traffic condition information and information of a traveling distance, which relates to a distance in which the vehicle travels in order to join to the main line, correspond to each other, and that derives a length of a mergeable section required for the host vehicle to join the main line on the basis of the derived traveling distance.
(8) In the aspect of (7), the correspondence information may be information in which information obtained from the traffic condition information and information of the traveling distance correspond to each other, and by referring to the correspondence information, the derivation part may derive the traveling distance corresponding to the speed of the host vehicle and the traffic condition information acquired by the acquisition unit.
(9) A method installed on a computer configured to control a vehicle according to an aspect of the present invention includes acquiring traffic condition information of a main line to which a host vehicle is going to join from a branch line; determining whether the host vehicle is able to join the main line on the basis of the acquired traffic condition information and a length of a mergeable section in which the host vehicle is able to join the main line from the branch line; and automatically controlling at least acceleration and deceleration of the host vehicle such that the host vehicle travels from the branch line toward the main line in a case it is determined that the host vehicle is able to join the main line.
(10) A vehicle control program according to an aspect of the present invention is installed in an in-vehicle computer and configured to perform: acquiring traffic condition information of a main line to which a host vehicle is going to join from a branch line; determining whether the host vehicle is able to join the main line on the basis of the acquired traffic condition information and a length of a mergeable section in which the host vehicle is able to join the main line from the branch line; and automatically controlling at least acceleration and deceleration of the host vehicle such that the host vehicle travels from the branch line toward the main line in a case it is determined that the host vehicle is able to join the main line.
According to the aspects of (1) to (10), determination of whether merging is possible can be rapidly performed.
Hereinafter, embodiments of a vehicle control system, a vehicle control method, and a vehicle control program of the present invention will be described with reference to the accompanying drawings.
As shown in
The finders 20-1 to 20-7 use, for example, light detection and ranging or laser imaging detection and ranging (LIDAR) configured to measure scattered radiation with respect to radiated light and measure a distance to an object. For example, the finder 20-1 is attached to a front grille or the like, and the finders 20-2 and 20-3 are attached to side surfaces of a vehicle body, door mirrors, the insides of headlights, the vicinity of side lights, or the like. The finder 20-4 is attached to a trunk lid or the like, and the finders 20-5 and 20-6 are attached to side surfaces of the vehicle body, insides of tail lamps, or the like. The above-mentioned finders 20-1 to 20-6 have, for example, detection regions of about 150 degrees in a horizontal direction. In addition, the finder 20-7 is attached to a roof or the like.
The finder 20-7 has, for example, a detection region of 360 degrees in the horizontal direction.
The radars 30-1 and 30-4 are, for example, long-distance millimeter wave radars having a detection region in a depth direction that is wider than that of other radars. In addition, the radars 30-2, 30-3, 30-5 and 30-6 are middle-range millimeter wave radars having a detection region in the depth direction that is narrower than that of the radars 30-1 and 30-4.
Hereinafter, when the finders 20-1 to 20-7 are not distinguished from each other, they are simply referred to as “finders 20,” and when the radars 30-1 to 30-6 are not distinguished from each other, they are simply referred to as “radars 30.” The radar 30 detects an object using, for example, a frequency modulated continuous wave (FM-CW) method.
The camera 40 is a digital camera using a solid imaging element such as a charge coupled device (CCD), a complementary metal oxide semiconductor (CMOS), or the like. The camera 40 is attached to an upper section of a front windshield, a back surface of a rear-view mirror, or the like. For example, the camera 40 periodically repeatedly images a side in front of the host vehicle M. The camera 40 may be a stereo camera including a plurality of cameras.
Further, the configuration shown in
In addition to the finders 20, the radars 30 and the camera 40, the navigation device 50, a vehicle sensor 60, a display 62, a speaker 64, an operation device (a manipulator) 70 such as an accelerator pedal, a brake pedal, a shift lever (or a paddle shift), a steering wheel, or the like, an operation detecting sensor 72 such as an accelerator opening sensor, a brake pedaling amount sensor (a brake switch), a shift position sensor, a steering angle sensor (or a steering torque sensor), or the like, a communication device 75, a selector switch 80, a driving force output apparatus 90 configured to output a driving force for traveling, a steering apparatus 92, a brake apparatus 94, and the vehicle control system 100 are mounted on the host vehicle M.
These devices or instruments are connected to each other by a multiplex communication line such as a controller area network (CAN) communication line or the like, a serial communication line, a wireless communication network, or the like. The exemplified operation device is merely an example, a joystick, a button, a dial switch, a graphical user interface (GUI) switch, or the like, may be mounted on the host vehicle M. Further, the vehicle control system in the claims may include not only the vehicle control system 100 but also a configuration other than the vehicle control system 100 (the finders 20 or the like) among the configurations shown in
The navigation device 50 has a global navigation satellite system (GNSS) receiver, map information (navigation map), a touch panel type display device serving as a user interface, a speaker, a microphone, or the like. The navigation device 50 identifies a position of the host vehicle M using a GNSS receiver, and derives a route from a position thereof to a destination designated by a user.
The route derived by the navigation device 50 is provided to a target lane determining part 110 of the vehicle control system 100. A position of the host vehicle M may be identified or complemented by the inertial navigation system (INS) using the output of the vehicle sensors 60.
In addition, the navigation device 50 performs guidance for a route to a destination using speech or navigation display when the vehicle control system 100 operates in a manual driving mode.
Further, the configuration for identifying the position of the host vehicle M may be installed independently from the navigation device 50.
In addition, the navigation device 50 may be realized by a function of a terminal device such as a smartphone, a tablet terminal, or the like, owned by a user. In this case, transmission and reception of information through wireless or wired communication between the terminal device and the vehicle control system 100 are performed.
The vehicle sensor 60 includes a vehicle speed sensor configured to detect a vehicle speed, an acceleration sensor configured to detect an acceleration, a yaw rate sensor configured to detect an angular speed around a vertical axis, an azimuth sensor configured to detect a direction of the host vehicle M, and so on.
The display 62 displays information as an image. The display 62 includes, for example, a liquid crystal display (LCD), an organic electroluminescence (EL) display device, a head-up display, or the like. The display 62 may be a display included in the navigation device 50, or a display of an installment panel configured to display a state (a speed or the like) of the host vehicle M. The speaker 64 outputs information as speech.
The operation detecting sensor 72 detects an operation amount of the operation device 70. For example, the operation detecting sensor 72 outputs an accelerator opening degree, a brake pedaling amount, a shift position, a steering angle, a steering torque, or the like, as detection results, to the vehicle control system 100. Further, instead of this, the detection results of the operation detecting sensor 72 according to a driving mode may be directly output to the driving force output apparatus 90, the steering apparatus 92, or the brake apparatus 94.
The communication device 75 performs wireless communication using an inter-vehicle communication network or the like that uses a cellular communication network, a Wi-Fi network, dedicated short range communications (DSRC), and so on. The communication device 75 acquires information from an information providing server before the host vehicle M travels or during traveling by, for example, connecting the communication device 75 to the Internet via a radio base station. For example, the communication device 75 acquires traffic condition information from the information providing server that observes a traffic state of a road.
The traffic condition information includes information on lanes being blocked due to roadwork, traffic accidents, traffic congestion, or the like, or information related to a traffic volume of a road. The information related to the traffic volume of the road includes, for example, information such as the number of vehicles passing through a certain section per unit time, a density of vehicle per a unit section, a vehicle-to-vehicle gap time for each lane, an average speed of traveling vehicles per each lane, and so on.
The vehicle-to-vehicle gap time is, at a certain time, a time required for a reference position (for example, a center of gravity, a center of a rear wheel shaft, or the like) of a vehicle traveling at rear of a merging target area candidate cTAg(k), which will be described below, to arrive at a point where a reference position (for example, a center of gravity, a center of a rear wheel shaft, or the like) of a vehicle traveling in front of a merging target area candidate cTAg(k) was present. Hereinafter, reference character δ(k) is attached to the vehicle-to-vehicle gap time of each of the merging target area candidates cTAg(k) and will be described.
The selector switch 80 is a switch operated by an occupant in the vehicle. The selector switch 80 receives an operation of an occupant in the vehicle, generates a driving mode designating signal that designates a driving mode of the host vehicle M, and outputs the driving mode designating signal to a switching controller 170. The selector switch 80 may be either a graphical user interface (GUI) switch or a mechanical switch.
The driving force output apparatus 90 outputs a traveling driving force (torque) for driving the vehicle to a driving wheel. The driving force output apparatus 90 includes, for example, an engine, a gear box, and an engine electric control unit (ECU) configured to control the engine when the host vehicle M is an automobile using an internal combustion engine as a power source. In addition, when the host vehicle M is an electric automobile using an electric motor as a power source, the driving force output apparatus 90 includes a traveling motor and a motor ECU configured to control the traveling motor. In addition, when the host vehicle M is a hybrid automobile, the driving force output apparatus 90 includes an engine, a gear box, an engine ECU, a traveling motor and a motor ECU.
When the driving force output apparatus 90 includes only an engine, the engine ECU adjusts a throttle opening degree, a shift stage, or the like, of the engine according to the information input from a traveling controller 160, which will be described below.
When driving force output apparatus 90 includes only a traveling motor, the motor ECU adjusts a duty ratio of a PWM signal provided to the traveling motor according to the information input from the traveling controller 160.
When the driving force output apparatus 90 includes an engine and a traveling motor, both of the engine ECU and the motor ECU cooperate with each other to control the traveling driving force according to the information input from the traveling controller 160.
The steering apparatus 92 includes, for example, a steering ECU and an electric motor. The electric motor changes a direction of a steered wheel by applying a force to, for example, a rack and pinion mechanism.
The steering ECU changes the direction of the steered wheel by driving the electric motor according to the information input from the vehicle control system 100 or the information of the input steering angle or steering torque.
The brake apparatus 94 is an electric servo brake apparatus including, for example, a brake caliper, a cylinder configured to transmit a hydraulic pressure to the brake caliper, an electric motor configured to generate a hydraulic pressure in the cylinder, and a braking controller.
The braking controller of the electric servo brake apparatus controls the electric motor according to the information input from the traveling controller 160, and a brake torque according to a braking operation is output to the wheels.
The electric servo brake apparatus may include a mechanism configured to transmit a hydraulic pressure generated by an operation of a brake pedal to a cylinder via a master cylinder as a backup.
Further, the brake apparatus 94 is not limited to the above-mentioned electric servo brake apparatus and may be an electronically controlled hydraulic brake apparatus. The electronically controlled hydraulic brake apparatus controls an actuator according to the information input from the traveling controller 160, and transmits the hydraulic pressure of the master cylinder to the cylinder.
In addition, the brake apparatus 94 may include a regeneration brake using a traveling motor that may be included in the driving force output apparatus 90. The regeneration brake uses the electric power generated by the traveling motor that may be included in the driving force output apparatus 90.
Hereinafter, the vehicle control system 100 will be described. The vehicle control system 100 is realized by, for example, one or more processors or hardware having an equivalent function. The vehicle control system 100 may be a configuration in which a processor such as a central processing unit (CPU) or the like, a storage device, and an electronic control unit (ECU), a micro-processing unit (MPU), or the like, to which a communication interface is connected by an internal bus, are combined.
The vehicle control system 100 includes, for example, the target lane determining part 110, an automated driving controller 120 and a storage 180.
The automated driving controller 120 includes, for example, a host vehicle position recognition part 122, an outside recognition part 124, an action plan generating part 126, a trajectory generating part 130, the traveling controller 160 and the switching controller 170.
Some or all of parts of the target lane determining part 110 and the automated driving controller 120 are realized as a processor executes a program (software). In addition, some of all of them may be realized by hardware such as a large scale integration (LSI), an application specific integrated circuit (ASIC), or the like, or may be realized by combination of software and hardware.
The communication device 75 and the outside recognition part 124, which are described above, are an example of “an acquisition unit.”
For example, information such as high accuracy map information 182, target lane information 184, action plan information 186, correspondence information 188, and so on, are stored in the storage 180.
The storage 180 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 executed by the processor may be previously stored on the storage 180, or may be downloaded from an external device via in-vehicle Internet equipment or the like.
In addition, the program may be installed on the storage 180 when a portable recording medium on which the program is stored is mounted on a drive device (not shown).
In addition, the vehicle control system 100 may be constituted by a plurality of computer devices that are decentralized.
The target lane determining part 110 is realized by, for example, the MPU. The target lane determining part 110 divides a route provided from the navigation device 50 into a plurality of blocks (for example, divided by each 100 [m] in a vehicle advance direction), and determines a target lane at each block with reference to the high accuracy map information 182. For example, the target lane determining part 110 performs determination that the host vehicle is traveling on which number of lane from the left. The target lane determining part 110 determines a target lane such that the host vehicle M can travel along a reasonable traveling route for advancing to a lane branched off, for example, when a branching point, a merging point, or the like, is present in the route. The target lane determined by the target lane determining part 110 is stored in the storage 180 as the target lane information 184.
The high accuracy map information 182 is map information that is more accurate than that of a navigation map provided in the navigation device 50. The high accuracy map information 182 includes, for example, information on centers of lanes, information on boundaries of lanes, or the like.
In addition, the high accuracy map information 182 may include road information, address information (address/zip code), facility information, telephone number information, and so on. The road information includes information that represents a kind of road such as an expressway, a toll road, a national road or a prefectural road, and information such as the number of lanes of a road, a width of each lane, an inclination of a road, a position of a road (three-dimensional coordinates including a longitude, a latitude and a height), a curvature of a curve of a lane, positions of merging and branching points of lanes, marks provided on a road, and so on.
The host vehicle position recognition part 122 of the automated driving controller 120 recognizes a lane on which the host vehicle M is traveling (a target lane) and a relative position of the host vehicle M with respect to the target lane on the basis of the high accuracy map information 182 stored in the storage 180 and the information input from the finders 20, the radars 30, the camera 40, the navigation device 50 or the vehicle sensor 60.
Further, instead of this, the host vehicle position recognition part 122 may recognize a position of a reference point of the host vehicle M with respect to any one of side end portions of an own traffic lane L1 as a relative position of the host vehicle M with respect to the target lane. The relative position of the host vehicle M recognized by the host vehicle position recognition part 122 is provided to the target lane determining part 110.
The outside recognition part 124 recognizes a state such as a position, a speed, an acceleration, or the like, of a neighboring vehicle on the basis of the information input from the finders 20, the radars 30, the camera 40, and so on.
The neighboring vehicle is a vehicle that is traveling around the host vehicle M, and a vehicle that is traveling in the same direction as the host vehicle M. A position of the neighboring vehicle may be represented as a reference point including a center of gravity, a corner, or the like, of another vehicle, or may be represented as a region expressed as a profile of another vehicle.
“The state” of the neighboring vehicle may include whether acceleration or lane change of the neighboring vehicle is being performed (or whether the lane change is to be performed) that is ascertained on the basis of information from the various instruments.
In addition, the outside recognition part 124 may recognize a position of a guard rail, an electric pole, a parked vehicle, a pedestrian, and other substance, in addition to a neighboring vehicle.
The action plan generating part 126 sets a start point of automated driving and/or a destination of automated driving. The start point of automated driving may be a current position of the host vehicle M or may be a point at which an operation of instructing automated driving is performed. The action plan generating part 126 generates an action plan in a section between the start point and the destination of automated driving. Further, there is no limitation thereto, and the action plan generating part 126 may generate an action plan in an arbitrary section.
The action plan is constituted by, for example, a plurality of events, which are performed in sequence.
The event includes, for example, a deceleration event of decelerating the host vehicle M, an acceleration event of accelerating the host vehicle M, a lane keeping event of causing the host vehicle M to travel and not to deviate from a target lane, a lane change event of changing target lanes, an overtaking event of causing the host vehicle M to overtake a preceding vehicle, a branching event of changing to a predetermined lane at an branching point or causing the host vehicle M to travel such that it does not deviate from the current target lane, a merging event of accelerating and decelerating the host vehicle M at a merging lane to join the main line and changing target lanes, and so on.
The action plan generating part 126 sets a lane change event, a branching event, or a merging event at a place in which the target lane determined by the target lane determining part 110 is switched.
The information that represents the action plan generated by the action plan generating part 126 is stored in the storage 180 as the action plan information 186.
For example, the action plan generating part 126 may change an event set to a driving section to which the host vehicle M will travel when a speed of a neighboring vehicle recognized by the outside recognition part 124 while the vehicle is traveling exceeds a threshold value or when a moving direction of a neighboring vehicle that is traveling on a lane adjacent to the own traffic lane is oriented toward a direction of the own traffic lane.
For example, in the case in which an event is set such that a lane change event is performed after a lane keeping event, when it is determined that a vehicle is advancing at a speed of a threshold value or more from the rear in a lane to which the lane change is possible during the lane keeping event according to the recognition results of the outside recognition part 124, the action plan generating part 126 may change the event after the lane keeping event from a lane change event to a deceleration event, a lane keeping event, or the like. As a result, the vehicle control system 100 enables safe automated traveling of the host vehicle M even when a variation occurs in an outside state.
The traveling state determining unit 132 determines a traveling aspect of any one of constant speed traveling, following traveling, deceleration traveling, curve traveling, obstacle avoidance traveling, and so on, when a lane keeping event is executed.
For example, the traveling state determining unit 132 may determine the traveling aspect as constant speed traveling when another vehicle is not present in front of the host vehicle M.
In addition, the traveling state determining unit 132 may determine the traveling aspect as following traveling when the host vehicle follows a preceding vehicle.
In addition, the traveling state determining unit 132 may determine the traveling aspect as deceleration traveling when deceleration of preceding vehicle is recognized by the outside recognition part 124 or when an event such as stopping, parking, or the like, is executed.
In addition, the traveling state determining unit 132 may determine the traveling aspect as curve traveling when it is recognized by outside recognition part 124 that the host vehicle M is approaching a curve road.
In addition, the traveling state determining unit 132 may determine the traveling aspect as obstacle avoidance traveling when an obstacle in front of the host vehicle M is recognized by the outside recognition part 124.
The trajectory candidate generating part 134 generates trajectory candidates on the basis of the traveling aspect determined by the traveling state determining unit 132. The trajectory of the embodiment is a collection of target positions (trajectory points) at which a reference position (for example, a center of gravity, a center of a rear wheel shaft, or the like) of the host vehicle M is assumed to reach at predetermined intervals (or each of predetermined traveling distances) in the future.
The trajectory candidate generating part 134 calculates a target speed of the host vehicle M on the basis of at least a speed of an object OB present in front of the host vehicle M recognized by the outside recognition part 124 and a distance between the host vehicle M and the object OB.
The trajectory candidate generating part 134 generates one or more trajectories on the basis of the calculated target speed. The object OB includes a preceding vehicle, a point such as a merging point, a branching point, a target point, or the like, a body such as an obstacle or the like, and so on.
Further, in
When the traveling aspect is determined as constant speed traveling by the traveling state determining unit 132, as shown in part (A) of
When the traveling aspect is determined as deceleration traveling by the traveling state determining unit 132 (including when a preceding vehicle decelerates in following traveling), as shown in part (B) of
When the traveling aspect is determined as curve traveling by the traveling state determining unit 132, as shown in part (C) of
In addition, as shown in part (D) of
The evaluation/selection part 136 performs, for example, evaluation from two viewpoints of planning and safety and selects the trajectory output to the traveling controller 160 with respect to the trajectory candidates generated by the trajectory candidate generating part 134. From a viewpoint of planning, for example, a trajectory is highly evaluated when trackability with respect to an already generated plan (for example, an action plan) is higher, and when the entire length of the trajectory is shorter. For example, when changing lanes to the right is desired, the trajectory which changes the lane to the left once and returns is evaluated low. From a viewpoint of safety, for example, it is evaluated higher as a distance between the host vehicle M and a body (a neighboring vehicle or the like) is larger and variation or the like in acceleration and deceleration or steering angle is smaller.
The lane change controller 140 is operated when the lane change event, the branching event, the merging event, or the like, is executed, i.e., when lane change in a broad sense is executed.
First, the lane change controller 140 selects two neighboring vehicles from neighboring vehicles which are traveling on an adjacent lane, which is the lane adjacent to a lane (an own traffic lane) on which the host vehicle M is traveling, and that is the lane to which the lane change is performed, and sets a lane change target area TAs between the neighboring vehicles (step S100).
Hereinafter, a neighboring vehicle that is traveling in front of the lane change target area TAs on the adjacent lane is referred to as a preceding reference vehicle mB, and a neighboring vehicle that is traveling at rear of the lane change target area TAs on the adjacent lane is referred to as a following reference vehicle mC and neighboring vehicles will be described. The lane change target area TAs is a relative position on the basis of a positional relationship between the host vehicle M, the preceding reference vehicle mB and the following reference vehicle mC.
In the case of
Next, the lane change controller 140 determines whether a primary condition for determining whether lane change to the lane change target area TAs (i.e., between the preceding reference vehicle mB and the following reference vehicle mC) is possible is satisfied (step S102).
For example, the primary condition is that none of a part of the neighboring vehicle is present in a forbidden region RA formed on the adjacent lane and each of TTCs (Time-to-Collision) between the host vehicle M, the preceding reference vehicle mB and the following reference vehicle mC is larger than a threshold value.
Further, this determination condition is an example of a case in which the lane change target area TAs is set to a side of the host vehicle M.
When the primary condition is not satisfied, the processing of the lane change controller 140 returns to step S100 and the lane change target area TAs is reset.
Here, speed control for moving the host vehicle to a side of the lane change target area TAs may be performed by waiting until a timing when the primary condition is satisfied and the target area TAs can be set or by changing the lane change target area TAs.
As shown in
When a neighboring vehicle is not present in the forbidden region RA, for example, the lane change controller 140 assumes an extension line FM and an extension line RM virtually extending from a front end and a rear end of the host vehicle M, respectively, toward the lane L2 to which the lane change is to be performed.
The lane change controller 140 calculates a time to collision TTC(B) between the extension line FM and the preceding reference vehicle mB, and a following reference vehicle TTC(C) between the extension line RM and the following reference vehicle mC.
The time to collision TTC(B) is a time derived by dividing a distance between the extension line FM and the preceding reference vehicle mB by a relative speed between the host vehicle M and the preceding reference vehicle mB.
The time to collision TTC(C) is a time derived by dividing a distance between the extension line RM and the following reference vehicle mC by a relative speed between the host vehicle M and the following reference vehicle mC.
The trajectory candidate generating part 134 determines that the primary condition is satisfied when the time to collision TTC(B) is larger than a threshold value Th(B) and the time to collision TTC(C) is larger than a threshold value Th(C).
The threshold values Th(B) and Th(C) may be the same value or may be different values.
When the primary condition is satisfied, the lane change controller 140 generates trajectory candidates for lane change using the trajectory candidate generating part 134 (step S104).
For example, the trajectory candidate generating part 134 smoothly connects the current position of the host vehicle M with a position of the preceding reference vehicle mB in a certain time in the future, a center of a lane to which lane change is to be performed and an end point for the lane change using a polynomial curve line of a spline curve line or the like, and disposes a predetermined number of trajectory points K at equal intervals or non-equal intervals on the curve line.
Here, the trajectory candidate generating part 134 generates a trajectory such that at least one of the trajectory points K is disposed in the lane change target area TAs.
Next, the evaluation/selection part 136 determines whether trajectory candidates that satisfy a setting condition have been generated (step S106). The setting condition means that, for example, an evaluation value of a threshold value or more is obtained from the viewpoint of the above-mentioned planning or safety.
When trajectory candidates that satisfy the setting condition are generated, for example, the evaluation/selection part 136 performs the lane change by selecting a trajectory candidate having the highest evaluation value and outputting the trajectory information to the traveling controller 160 (step S108).
Meanwhile, when a trajectory that satisfies the setting condition is not generated, the processing returns to step S100. Here, like the case in which a negative determination is obtained in step S102, processing of becoming a standby state or resetting the lane change target area TAs may be performed.
The traveling controller 160 shown in
The trajectory candidate generating part 134 and the traveling controller 160, which are described above, are an example of “a second controller.”
The switching controller 170 switches a driving mode on the basis of an operation of instructing acceleration, deceleration or steering with respect to the operation device 70, in addition to switching a driving mode on the basis of the driving mode designating signal input from the selector switch 80.
For example, the switching controller 170 may switch the driving mode from an automated driving mode to a manual driving mode when a state in which the operation amount input from the operation detecting sensor 72 exceeds a threshold value is maintained for a reference time or more.
In addition, the switching controller 170 may switch the driving mode from the automated driving mode to the manual driving mode in the vicinity of a destination of automated driving.
The switching controller 170 performs switching of the control mode on the basis of the driving mode designating signal input from the selector switch 80 when the control mode is switched from the manual driving mode to the automated driving mode. In addition, after the control mode is switched from the automated driving mode to the manual driving mode, the control of returning to the automated driving mode may be performed when an operation of instructing acceleration, deceleration or steering with respect to the operation device 70 is not detected for a predetermined time.
Hereinafter, merging control will be described. As shown in
The merging controller 150 is started by the traveling state determining unit 132, for example, when the host vehicle M starts to travel along a branch line (an acceleration lane) that merges onto a main line. The merging controller 150 is an example of “a first controller.”
The merging target area candidate setting part 151 sets one or more merging target area candidates cTAg that are candidates of a merging target area TAg which the host vehicle M uses as a target when joining the main line.
The merging target area TAg is a relative position set between neighboring vehicles that are traveling on the main line to which the host vehicle M will join.
As shown in
Hereinafter, these are represented as the merging target area candidates cTAg(k) (k=1 to n-1). Here, n is an arbitrary natural number.
The merging target area candidate setting part 151 may select n neighboring vehicles m according to an arbitrary restriction such as for selecting a total of 10 neighboring vehicles m, for example, 5 neighboring vehicles m traveling in front of the host vehicle M in a direction of advance and 5 neighboring vehicles m traveling in rear of the host vehicle M in the direction of advance.
In addition, the merging target area candidate setting part 151 may set the merging target area candidates cTAg by excluding a case in which an inter-vehicle distance between the neighboring vehicles m that are traveling immediately in front of and immediately in rear of the host vehicle is shorter than a reference distance or a case in which the inter-vehicle distance is equal to or shorter than a reference distance after a reference time has elapsed while the relative speed has been considered.
Hereinafter, a distance between the merging target area candidates cTAg(k) and the host vehicle M is represented as x(k), and an average speed of the neighboring vehicles m that are traveling on the lane L1 is represented as VH. The average speed VH is, for example, information included in the traffic condition information acquired by the communication device 75. In addition, the average speed VH may be acquired by obtaining an average of speeds of the neighboring vehicles m recognized by the outside recognition part 124.
In addition, ε in
The distance ε may be derived on the basis of, for example, information such as the number of lanes of a road, widths of lanes, positions of a merging points of lanes, and so on, included in the high accuracy map information 182.
In addition, the distance ε may be derived on the basis of a length, a shape, or the like, of a road partition line recognized by the outside recognition part 124.
Hereinafter, the distance ε will be referred to as “a merging road length ε” and will be described.
The derivation part 152 derives a merging road length ε at a boundary point between a main line to which the host vehicle M is going to join and a branch line by using the high accuracy map information 182, and derives a success probability of merging by referring to the correspondence information 188 stored in the storage 180 and by on the basis of the derived merging road length ε and a vehicle-to-vehicle gap time δ(k) included in the traffic condition information acquired by the communication device 75.
The determination part 153 determines whether the host vehicle M is able to join the main line on the basis of the success probability derived by the derivation part 152 at each of the merging target area candidates cTAg(k).
Hereinafter, a sequence of processing of the merging controller 150 will be described in accordance with a flowchart.
First, the derivation part 152 derives a merging road length ε at a boundary point between a main line to which the host vehicle M is going to join and a branch line by using the high accuracy map information 182 (step S200).
Next, the derivation part 152 waits until traffic condition information is acquired by the communication device 75 (step S202), and, when the traffic condition information is acquired by the communication device 75, derives a success probability by referring to the correspondence information 188 stored in the storage 180 and by on the basis of the derived merging road length ε and the vehicle-to-vehicle gap time δ(k) included in the traffic condition information acquired by the communication device 75 (step S204).
The merging road length ε(k) represent, for example, distances at predetermined intervals such as ε(1)=10 m and ε(2)=20 m. Further, the correspondence information 188 may be a table corresponding to the map, and may be a function using the vehicle-to-vehicle gap time δ(k), the merging road length ε(k), the speed v of the host vehicle M, and the average speed VH of the vehicles on the main line as elements.
In the following examples, it will be described as being a map.
For example, the derivation part 152 selects a map having values that coincide with or are closest to both of the derived merging road length c and the vehicle-to-vehicle gap time δ(k) included in the traffic condition information with reference to the high accuracy map information 182.
Further, numerical values of the success probability shown in
For example, on the map, areas in which success probabilities are equal are represented by the same pattern (color, graduation).
The map represents results obtained by performing the best speed control when the best merging target area Tag is selected. “The best merging target area TAg(k)” is a merging target area in which a traveling distance RD(k) is shortest among the plurality of merging target area candidates cTAg(k).
In addition, the success probability derived from each map is a ratio between the merging road length ε(k) and the traveling distance RD(k), which is required for arrival at the best merging target area TAg(k), for example, in a case conditions such as (1) all vehicles that are traveling on the main line to which a branch line merges are traveling at the average speed VH, (2) inter-vehicle distances between the vehicles that are traveling on the main line are equidistant (i.e., a vehicle-to-vehicle gap time δ(k) is constant), and (3) a speed (or an acceleration or the like) of the host vehicle M at a point at which a merging event is started is constant, are assumed.
For example, the success probability may be represented by ε/RD(k), (1-RD(k)/ε), or the like. That is, the success probability varies with a tendency such that the success probability decreases as the traveling distance RD(k) with respect to the merging road length ε(k) increases, and the success probability increases as the traveling distance RD(k) decreases.
In addition, a region B in
With regard to a respective average speed VH and a speed v of the host vehicle M, respectively, the increase/decrease tendency of the success probability discontinuously varies. That is, the increase/decrease tendency of the traveling distance RD(k) which is the basis of the success probability discontinuously varies with regard to the respective average speed VH and the speed v of the host vehicle M.
A horizontal axis in
In addition, in the vicinity of a central value of 90 km/h, as the average speed VH increase, a value obtained by differentiating the trend of the success probability variation changes from a negative value to a positive value, and then changes from the positive value to the negative value. In the case of such tendency, it means that there are at least two candidates having extreme values at which the success probability is minimized, and a speed v of the host vehicle M upon merging is set to a speed corresponding to any one of these extreme values.
For example, among the two candidates for the speed v of the host vehicle M, the candidate having a larger speed is excluded because it exceeds an upper limit value of a legal speed limit or the like, and the other candidate is employed.
The above-mentioned map is a map in which the vehicle-to-vehicle gap time δ(k), the merging road length ε(k), the speed v of the host vehicle M and the average speed VH of the vehicles on the main line are used as parameters (elements), and in which success probability values obtained through simulation while independently changing at least these parameters are drawn in a contour map shape.
For example, a traveling time required from the current position of the host vehicle M upon merging to the merging target area candidates cTAg(k) is derived at each of the merging target area candidates cTAg(k) while assuming that the host vehicle M is traveling on the basis of a movement model in which a future state is predictable, such as a constant acceleration model, a constant jerk (jerk degree) model, or the like.
Here, when the host vehicle M is traveling on the basis of the assumed movement model, the upper limit speed may be set with respect to a speed that can be output by the host vehicle M. The upper limit speed is, for example, a legal speed limit or the like.
Then, the traveling distance RD(k) to arrival at the merging target area candidates cTAg(k) is derived at each of the merging target area candidates cTAg(k) on the basis of the derived traveling time and the movement model of the host vehicle M.
The processing performed previously will be described in detail in the following processing of S214.
Next, electing a merging target area candidates cTAg(k) which has the shortest traveling distance RD(k) among the each of the traveling distance RD(k) derived for the respective merging target area candidates cTAg(k), and, regarding to this merging target area candidates cTAg(k), a map is generated in which the elected traveling distance RD(k) is replaced with a probability based on a ratio with respect to the merging road length ε(k). That is, the correspondence information 188 is information in which maps having the best conditions are previously stored.
Further, in the maps in the correspondence information 188, in each of the merging target area candidates cTAg(k) on the merging lane, the traveling distance RD(k) is derived while assuming the case in which an initial position displacement d(k) is largest.
As shown in
Further, the reference position Y of each of the merging target area candidates cTAg(k) will be described as an intermediate position between vehicles in front of and in rear of the host vehicle which is interposed therebetween.
For example, when the host vehicle M adjusts a position thereof while accelerating from the rear of the merging target area candidate cTAg(k), as shown in
In addition, when the host vehicle M adjusts a position thereof while decelerating or maintaining a speed from the front of the merging target area candidate cTAg(k), as shown in
Since the initial position displacement d(k) is one of external factors that are relatively invariable under control of the host vehicle M, upon generation of a map, in order to maximize the initial position displacement d(k), the reference position G1 of the host vehicle M is set in a direction so that a traveling distance is further increased when coinciding with the reference position Y of the merging target area candidate cTAg(k).
Accordingly, the traveling distance RD(k) can be derived by assuming circumstances in which the merging is most difficult. That is, low success probability can be previously derived by assuming the circumstances in which the merging is most difficult.
As a result, the automated driving controller 120 can control the host vehicle M more safely.
The determination part 153 determines whether the host vehicle M can join the main line on the basis of the success probability derived by the derivation part 152 (step S206).
For example, the determination part 153 determines that the host vehicle M cannot join the main line by deciding that the traveling distance RD(k) for adjusting the speed is not enough when the success probability derived by the derivation part 152 is a threshold value or less.
In this case, the determination part 153 causes the switching controller 170 to perform switching processing such that the driving mode is changed from the automated driving mode to the manual driving mode while informing a driver of that the merging event cannot be performed with the automated driving using the display 62 or the speaker 64 (step S208).
Accordingly, the vehicle control system 100 can change an operation of the host vehicle M to a driver before the host vehicle M enters a merging road on which a speed is adjusted.
In addition, when it is determined by the determination part 153 that the host vehicle M cannot join the main line, the target lane determining part 110 may change a part of a route provided from the navigation device 50 and set a target lane to another lane.
Accordingly, the vehicle control system 100 can cause the host vehicle M to travel to a destination in a state in which the automated driving is continued using, for example, a route that bypasses another merging point or a route on which a merging point is not present.
Meanwhile, the determination part 153 determines that the host vehicle M can join the main line by deciding that the traveling distance RD(k) for adjusting a speed is sufficient when the success probability derived by the derivation part 152 is the threshold value or more.
Next, when the host vehicle M can join the main line, the merging target area candidate setting part 151 selects n neighboring vehicles m that are traveling on a lane of the main line adjacent to a branch line (step S210), and sets one or more merging target area candidates cTAg between the selected neighboring vehicles m (step S212).
Next, the derivation part 152 derives the traveling distance RD(k) at each of the merging target area candidates cTAg(k) set by the merging target area candidate setting part 151 (step S214).
For example, the derivation part 152 derives a speed v(k, t) and an arrival time T{cTAg(k)} of the host vehicle M under the following restrictions of (1) to (3).
(1) The host vehicle M is traveling on the basis of a movement model in which a future state is predictable, such as a constant acceleration model, a constant jerk (jerk degree) model, or the like, and an upper limit speed is determined. The upper limit speed is, for example, a legal speed limit.
(2) A speed (variation) v(k, t) of the host vehicle M corresponding to the merging target area candidate cTAg(k) coincides with the average speed VH at the time the host vehicle M arrives at the merging target area candidate cTAg(k).
(3) Duration to an arrival time T{cTAg(k)}, a value obtained by integrating a difference between the speed v(k, t) of the host vehicle M and VH coincides with a distance x(k) between the merging target area candidate cTAg(k) and the host vehicle M.
Then, the derivation part 152 derives the traveling distance RD(k) until the host vehicle M arrives at the merging target area candidate cTAg(k) on the basis of the speed v (k, t) and the arrival time T{cTAg(k)} of the host vehicle, which were derived.
Here, like the movement model of the host vehicle M, the vehicles that are traveling immediately in front of and immediately at rear of the merging target area candidate cTAg(k) are assumed to travel on the basis of the movement model in which a future state is predictable, such as a constant acceleration model, a constant jerk (jerk degree) model, or the like.
[Math. 1]
x(k)=∫0T{cTAg(k)}{v(k,t)−VH}dt (1)
For example, the derivation part 152 derives the speed v(k, t) that satisfies the conditions by searching a pattern that matches with the conditions while variously changing an acceleration duration, a constant speed duration and a deceleration duration shown in
In addition, the map corresponding to a pattern of the parameter such as x(k), v0, VH, or the like, and the speed v(k, t) is stored in the storage 180, and the derivation part 152 may derive the speed v(k, t) by applying the parameters to the map.
In addition, the derivation part 152 may hold a map having coarse accuracy, and may perform searching using the speed v(k, t) derived from the coarse map as an origin.
This also applies to each of embodiment, which will be described below.
The derivation part 152 derives the traveling distance RD(k) until the host vehicle M arrives at the merging target area candidate cTAg(k) on the basis of the speed v(k, t) and the arrival time T{cTAg(k)} of the host vehicle, which were derived. The traveling distance RD(k) is obtained by Equation (2).
[Math. 2]
RD(k)=∫0T{cTAg(k)}v(k,t)dt (2)
Next, the merging target area candidate setting part 151 determines a merging target area candidate cTAg(k) in which the traveling distance RD(k) derived for each of the merging target area candidates cTAg(k) is smallest as a merging target area TAg(k) to which the host vehicle M should enter during merging (step S216).
Then, the merging target area candidate setting part 151 generates trajectory candidates directed toward the merging target area TAg(k) using the trajectory candidate generating part 134.
Here, the trajectory candidate generating part 134 generates trajectory candidates directed toward the merging target area TAg(k) using the speed v of the host vehicle M assumed upon derivation of the traveling distance RD(k). Then, the evaluation/selection part 136 determines a trajectory using for control among the trajectory candidates, and the merging is performed as the traveling controller 160 controls a control object on the basis of this trajectory.
According to the vehicle control system 100 of the above-mentioned first embodiment, traffic condition information of the main line to which the host vehicle M is going to join from the branch line is acquired, it is determined whether merging to the main line is possible on the basis of the acquired traffic condition information and the merging road length ε, and when it is determined that the merging to the main line is possible, by automatically controlling at least acceleration and deceleration of the host vehicle M such that the host vehicle M is traveling from the branch line to the main line, it is possible to rapidly perform a determination of whether the merging is possible.
As a result, for example, when it is determined that the merging is not possible, an operation right of the host vehicle can be quickly delegated to a driver.
Hereinafter, a second embodiment will be described. The second embodiment is distinguished from the first embodiment in that, in the correspondence information 188 previously stored in the storage 180, the map configured to derive the traveling distance RD(k) corresponds to the vehicle-to-vehicle gap time δ(k) only. Hereinafter, this difference will be mainly described.
In the correspondence information 188, the derivation part 152 according to the second embodiment selects a map corresponding to the vehicle-to-vehicle gap time δ(k) having a value that coincides with or is closest to the vehicle-to-vehicle gap time δ(k) included in the traffic condition information acquired by the communication device 75, and derives the traveling distance RD(k) by using this map.
For example, in the example in
The speed v of the host vehicle M set in the map is determined by referring to, for example, the information shown in
For example, the derivation part 152 determines the traveling distance RD(k) by interpreting a speed within a range (a region C in
The determination part 153 according to the second embodiment determines whether the host vehicle M can join the main line by comparing the traveling distance RD(k) derived using the map with the merging road length ε derived using the high accuracy map information 182 by the derivation part 152.
For example, the determination part 153 determines that the host vehicle M cannot join the main line when the traveling distance RD(k) is longer than the merging road length ε, and determines that the host vehicle M can join the main line when the traveling distance RD(k) is shorter than the merging road length ε.
According to the vehicle control system 100 A of the above-mentioned second embodiment, like the above-mentioned first embodiment, determination of whether the merging is possible can be rapidly performed. As a result, for example, when it is determined that the merging is impossible, an operation right of the host vehicle can be quickly delegated to a driver.
Hereinabove, although the aspects for implementing the present invention have been described using the embodiments, the present invention is not limited to the above-mentioned embodiments and various modifications and substitutions may be made without departing from the scope of the present invention.
20 Finder
30 Radar
40 Camera
50 Navigation device
60 Vehicle sensor
62 Display
64 Speaker
70 Operation device
72 Operation detecting sensor
75 Communication device
80 Selector switch
90 Driving force output apparatus
92 Steering apparatus
94 Brake apparatus
100 Vehicle control system
110 Target lane determining part
120 Automated driving controller
122 Host vehicle position recognition part
124 Outside recognition part
126 Action plan generating part
130 Trajectory generating part
132 Traveling state determining unit
134 Trajectory candidate generating part
136 Evaluation/selection part
140 Lane change controller
150 Merging controller
151 Merging target area candidate setting part
152 Derivation part
153 Determination part
160 Traveling controller
170 Switching controller
180 Storage
M Host vehicle
Number | Date | Country | Kind |
---|---|---|---|
2016-050734 | Mar 2016 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2017/009225 | 3/8/2017 | WO | 00 |