WO2019186617A1 - 経路生成装置、経路生成方法及び走行制御装置 - Google Patents
経路生成装置、経路生成方法及び走行制御装置 Download PDFInfo
- Publication number
- WO2019186617A1 WO2019186617A1 PCT/JP2018/011998 JP2018011998W WO2019186617A1 WO 2019186617 A1 WO2019186617 A1 WO 2019186617A1 JP 2018011998 W JP2018011998 W JP 2018011998W WO 2019186617 A1 WO2019186617 A1 WO 2019186617A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- point
- route
- point sequence
- vehicle
- lane
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 9
- 238000004364 calculation method Methods 0.000 claims abstract description 99
- 239000000284 extract Substances 0.000 claims abstract description 33
- 238000000605 extraction Methods 0.000 claims abstract description 17
- 238000001514 detection method Methods 0.000 description 25
- 230000006870 function Effects 0.000 description 9
- 238000010586 diagram Methods 0.000 description 8
- 230000006399 behavior Effects 0.000 description 3
- 238000004519 manufacturing process Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- YREOLPGEVLLKMB-UHFFFAOYSA-N 3-methylpyridin-1-ium-2-amine bromide hydrate Chemical compound O.[Br-].Cc1ccc[nH+]c1N YREOLPGEVLLKMB-UHFFFAOYSA-N 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3407—Route searching; Route guidance specially adapted for specific applications
- G01C21/3415—Dynamic re-routing, e.g. recalculating the route when the user deviates from calculated route or after detecting real-time traffic data or accidents
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
- B60W30/18163—Lane change; Overtaking manoeuvres
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0011—Planning or execution of driving tasks involving control alternatives for a single driving scenario, e.g. planning several paths to avoid obstacles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/021—Determination of steering angle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/025—Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
- B62D15/0255—Automatic changing of lane, e.g. for passing another vehicle
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/38—Electronic maps specially adapted for navigation; Updating thereof
- G01C21/3863—Structures of map data
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/14—Yaw
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2556/00—Input parameters relating to data
- B60W2556/40—High definition maps
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2556/00—Input parameters relating to data
- B60W2556/45—External transmission of data to or from the vehicle
- B60W2556/50—External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/167—Driving aids for lane monitoring, lane changing, e.g. blind spot detection
Definitions
- the present invention relates to a route generation device that generates a target route of a vehicle, a route generation method, and a travel control device that controls the travel of the vehicle based on the generated target route when changing the lane in which the vehicle travels.
- a target passing position is calculated based on the position of the host vehicle.
- the position of the host vehicle is affected by the influence of disturbance on the host vehicle from the surrounding environment such as the road surface condition and wind, the influence of the error of the acquired position information of the host vehicle, the influence of the error of vehicle control, , You may be off the target route before starting the lane change.
- the device disclosed in Patent Document 1 uses the target route before starting the lane change and the lane The target route after starting the change becomes discontinuous, and the behavior of the host vehicle may become unstable.
- the present invention has been made to solve the above-described problem, and includes a route generation device, a route generation method, and a travel control device that prevent a target route of a vehicle from becoming discontinuous before and after starting a lane change.
- the purpose is to obtain.
- the route generation device and the travel control device are based on a position acquisition unit that acquires vehicle position information, vehicle position information, and map information acquired from outside, before the vehicle starts to change lanes.
- a lane change is performed based on a first route extraction unit that extracts a target route as a first point sequence when it is assumed that the vehicle continues to travel in a traveling lane, and vehicle position information and map information. Assuming that the vehicle is currently traveling in the adjacent lane on which the vehicle travels after completion, and extracting the target route as a second point sequence when assuming that the vehicle continues to travel in the adjacent lane And a route calculation unit that calculates a target route when the vehicle changes lanes based on the first point sequence and the second point sequence as a third point sequence.
- the third point sequence is located between the first point sequence and the second point sequence As described above, and calculates a third point sequence.
- the vehicle travels before starting the lane change based on the step of acquiring the vehicle position information and the vehicle position information and the map information acquired from the outside.
- the third point sequence between the point sequence So as to be positioned, and calculates a third point sequence.
- a route generation device it is possible to obtain a route generation device, a route generation method, and a travel control device that suppress the discontinuity of the target route of the vehicle before and after the start of lane change.
- FIG. 1 is a block diagram illustrating an example of a schematic configuration of a route generation device 110 and a travel control device 100 according to Embodiment 1 of the present invention.
- FIG. 2 is a block diagram showing an example of a schematic configuration when the traveling control apparatus 100 according to the first embodiment of the present invention is mounted on the host vehicle 1.
- the host vehicle 1 is a vehicle to be controlled by the travel control device 100.
- the travel control system 10 is mounted on the host vehicle 1 and controls the travel of the host vehicle 1.
- the traveling control system 10 may be an automatic driving system.
- the travel control device 100 is a part of the travel control system 10 and controls the steering amount when changing the lane in which the host vehicle 1 travels in response to an instruction from the travel control system 10.
- the host vehicle 1 has changed the lane.
- the case where the lane in which the host vehicle 1 is traveling joins another lane is also included in the lane change.
- the present time indicates a time point when the traveling control device 100 starts processing. That is, the current time is a time when the travel control device 100 starts an operation for changing lanes.
- the future refers to after the vehicle 1 completes the lane change.
- FIG. 2 the case where the traveling control apparatus 100 is mounted on the host vehicle 1 is illustrated. However, at least a part of the traveling control device 100 may be installed outside the host vehicle 1 and connected to the host vehicle 1 via a network.
- the traveling control device 100 includes a route generation device 110 and a control amount calculation unit 120.
- the route generation device 110 generates a route when the host vehicle 1 changes lanes.
- the route generation device 110 includes a position acquisition unit 111, a first route extraction unit 112, a second route extraction unit 113, and a route calculation unit 114.
- a speed detection unit 210, a yaw rate detection unit 220, a position detection unit 230, a map distribution unit 240, and a steering unit 300 are connected to the travel control device 100.
- the speed detection unit 210, the yaw rate detection unit 220, the position detection unit 230, and the map distribution unit 240 are external devices that generate information input to the travel control device 100.
- the speed detection unit 210 is a vehicle speed sensor mounted on the host vehicle 1 and detects the traveling speed of the host vehicle 1.
- the yaw rate detector 220 is a yaw rate sensor mounted on the host vehicle 1 and detects the yaw rate of the host vehicle 1.
- the position detection unit 230 is, for example, a GPS receiver including a GPS (Global Positioning System) antenna, receives information from the satellite, and detects the two-dimensional position information of the host vehicle 1 and the traveling direction.
- the position detection unit 230 can be realized by combining LiDAR (Laser Imaging Detection and Ranging) and map information.
- the position detection unit 230 can be realized by combining a GPS receiver, LiDAR, and map information.
- the map distribution unit 240 distributes information on a high-precision map around the host vehicle 1.
- the high-precision map holds the coordinates of the point sequence on the center line of each lane of the road. Moreover, this point sequence becomes the route of the host vehicle 1 when traveling in each lane.
- the point sequence held by the high-accuracy map is not limited to the point sequence representing the center line of each lane, and may be any point sequence that serves as a target route when the host vehicle 1 travels in each lane.
- FIG. 3 is a flowchart illustrating an example of an operation flow of the route generation device 110 and the travel control device 100 according to the first embodiment.
- the travel control device 100 is a part of the travel control system 10 that controls the travel of the host vehicle 1, and starts the operation in response to an instruction from the travel control system 10.
- step S101 the traveling control device 100 determines whether or not it is possible to change the lane from the lane in which the host vehicle 1 is currently traveling to the adjacent lane. For example, when there is a vehicle that becomes an obstacle around the host vehicle 1, when there is no lane next to the lane in which the host vehicle 1 is currently traveling, or when the driver is prohibited from changing the lane The traveling control device 100 determines that the lane change is impossible. If it is determined in step S101 that the lane cannot be changed, the operation of the travel control device 100 returns to step S101. On the other hand, when it is determined in step S101 that the lane can be changed, the operation of the traveling control device 100 proceeds to step S111.
- step S111 the position acquisition unit 111 acquires the position information of the host vehicle 1 detected by the position detection unit 230, and corrects the acquired position information as necessary.
- the position detection unit 230 detects the position information of the host vehicle 1 at a predetermined time interval. However, if the host vehicle 1 has moved between the time when the position detection unit 230 detects the position information of the host vehicle 1 and the present time, an error in the position information generated by this movement may not be ignored. Therefore, the position acquisition unit 111 detects the vehicle detected by the position detection unit 230 based on the traveling speed of the host vehicle 1 detected by the speed detection unit 210 and the yaw rate of the host vehicle 1 detected by the yaw rate detection unit 220.
- the position information of the vehicle 1 is corrected and output as the current position information of the host vehicle 1. That is, the position acquisition unit 111 corrects the position information of the host vehicle 1 detected by the position detection unit 230 in consideration of the behavior of the host vehicle 1 and outputs the corrected position information as the current position information of the host vehicle 1. When the position detection unit 230 detects the position information of the host vehicle 1 at a time interval that is short enough to ignore the movement of the host vehicle 1, the position acquisition unit 111 does not need to correct the position information.
- the first route extraction unit 112 based on the position information of the host vehicle 1 output from the position acquisition unit 111 and the high-accuracy map information distributed from the map distribution unit 240, It recognizes the lane in which the host vehicle 1 is currently traveling.
- the lane in which the host vehicle 1 is currently traveling may be described as a traveling lane.
- the travel lane is a lane in which the host vehicle 1 travels before the lane is changed.
- the first route extraction unit 112 extracts the first route.
- the first route is a target route when it is assumed that the host vehicle 1 continues to travel in the travel lane.
- the high-precision map holds the coordinates of the point sequence on the center line of each lane of the road.
- the first route extraction unit 112 extracts the first route as a point sequence by extracting the point sequence on the center line of the traveling lane from the information of the high-precision map based on the position information of the host vehicle 1.
- a point sequence representing the first route is referred to as a first point sequence.
- Each point in the first point sequence becomes a target passing point of the host vehicle 1 when it is assumed that the host vehicle 1 continues to travel in the travel lane after the present. Since the host vehicle 1 is controlled to travel along a line connecting the first point sequence, the line connecting the first point sequence can also be considered as the first route.
- step S113 the second route extraction unit 113, based on the position information of the host vehicle 1 output from the position acquisition unit 111 and the high-accuracy map information distributed from the map distribution unit 240, It recognizes a lane that is adjacent to the lane in which the host vehicle 1 is currently traveling and that the host vehicle 1 travels after changing the lane.
- the lane in which the vehicle 1 travels after changing the lane may be described as an adjacent lane.
- the second route extraction unit 113 extracts the second route.
- the second route is a target route when it is assumed that the host vehicle 1 is currently traveling in an adjacent lane, and further, the host vehicle 1 is assumed to continue traveling in the adjacent lane after the present.
- the route calculation unit 114 includes the position information of the host vehicle 1 output from the position acquisition unit 111 and the first point representing the first route extracted by the first route extraction unit 112. Based on the sequence and the second point sequence representing the second route extracted by the second route extraction unit 113, a target route for changing the lane in which the host vehicle 1 travels is calculated.
- a target route for changing the lane in which the host vehicle 1 travels is referred to as a third route.
- the route calculation unit 114 obtains the third route as a point sequence by calculating the position of the point sequence of the target passing point when changing the lane in which the host vehicle 1 travels.
- a point sequence representing the third path is referred to as a third point sequence.
- the third route is a target route from when the host vehicle 1 starts changing lanes until the lane change is completed.
- the third route is generated between the first route and the second route. Details of the operation of the route calculation unit 114 will be described later.
- the third route calculated by the route calculation unit 114 becomes the output of the route generation device 110. Therefore, the operation from step S111 to step S114 is the operation of the route generation device 110.
- step S 120 the control amount calculation unit 120 obtains a control amount for controlling the steering so that the host vehicle 1 follows the third route obtained by the route calculation unit 114, and returns to the steering unit 300. Output. That is, the control amount calculation unit 120 calculates a target rudder angle such that the host vehicle 1 travels along the third route obtained by the route generation device 110 and outputs the target rudder angle to the steering unit 300.
- step S140 the traveling control apparatus 100 determines whether or not the lane change has been completed. If it is determined in step S140 that the lane change has not been completed, the operation of the travel control device 100 returns to step S120. Therefore, the operation of the control amount calculation unit 120 in step S120 is repeatedly performed until the lane change is completed. On the other hand, when it is determined in step S140 that the lane change has been completed, the operation of travel control device 100 ends.
- step S140 the traveling control device 100 can determine whether or not the lane change has been completed by determining whether or not a predetermined time has elapsed since the start of the lane change. .
- step S140 the travel control device 100 determines whether or not the lane change has been completed by determining whether or not the host vehicle 1 has traveled a predetermined distance after starting the lane change. You can also Or in step S140, the traveling control apparatus 100 can also determine whether the change of the lane was completed using the positional information on the own vehicle 1.
- FIG. The travel control device 100 and the travel control device 100 of the present embodiment operate as described above.
- the steering unit 300 is an external device that is an output destination of the target rudder angle obtained by the travel control device 100.
- the steering unit 300 includes a steering mechanism including a motor, and a control circuit or processor that controls the motor.
- the steering unit 300 operates the motor based on the target rudder angle obtained by the travel control device 100, and moves the vehicle 1 in the lateral direction.
- the lateral direction is a direction that intersects at right angles to the traveling direction of the host vehicle and is a direction parallel to the road surface.
- FIG. 4 is a system configuration diagram illustrating an example of a system configuration for realizing the route generation device 110 and the travel control device 100 according to the first embodiment.
- the own vehicle 1 is equipped with a GPS receiver 2, a map distribution device 3, a speed sensor 4, a yaw rate sensor 5, a driving support ECU 6 (Ectronic Control Unit), a steering ECU 7, and a steering mechanism 8.
- the GPS receiver 2 functions as the position detection unit 230.
- the GPS receiver 2 acquires satellite information via a GPS antenna, obtains position information and traveling direction information of the host vehicle 1, and transmits the information to the map distribution device 3 and the driving support ECU 6.
- the speed sensor 4 functions as the speed detection unit 210.
- the map distribution device 3 functions as the map distribution unit 240.
- the map distribution device 3 transmits map information around the host vehicle 1 to the driving support ECU 6 based on the position information of the host vehicle 1 received from the GPS receiver 2.
- the transmitted map information includes at least the coordinates of the point sequence on the center line of each lane of the road around the host vehicle 1.
- the driving assistance ECU 6 realizes a function of the traveling control system 10 that controls the traveling of the host vehicle 1 such as ADAS (Advanced Driver Assistance System).
- the functions realized by the driving support ECU 6 include the functions of the travel control device 100.
- the driving support ECU 6 can be rephrased as ADAS-ECU.
- FIG. 5 is a diagram illustrating an example of the configuration of the driving support ECU 6 and the steering ECU 7 in the route generation device 110 and the travel control device 100 according to the first embodiment.
- the processor 401 is connected to the memory 402 via the data bus 403.
- the processor 401 reads out and executes the program stored in the memory 402, thereby realizing the functions of the driving assistance ECU 6 and the steering ECU 7.
- the driving assistance ECU 6 and the steering ECU 7 may include a dedicated electronic circuit, or may be configured only by a dedicated electronic circuit.
- the driving support ECU 6 can be rephrased as a driving support circuit.
- the steering ECU 7 can also be called a steering circuit.
- FIG. 6 is a flowchart illustrating an example of an operation flow of the route calculation unit 114 in the route generation device 110 according to the first embodiment.
- FIG. 6 is a flowchart showing an operation flow of the route calculation unit 114 in step S114 of FIG.
- FIG. 7 is a plan view for explaining a route generated by the route calculation unit 114 in the route generation device 110 according to the first embodiment.
- the + Y direction is the traveling direction of the host vehicle 1 when the lane change is started
- the + X direction is a direction perpendicular to the + Y direction and going from the traveling lane to the adjacent lane.
- FIG. 7 is the traveling direction of the host vehicle 1 when the lane change is started.
- the lane between the lane marking 21a and the lane marking 21c is a travel lane
- the lane between the lane marking 21b and the lane marking 21c is an adjacent lane.
- Time T0 is the time when the host vehicle 1 starts to change lanes. Therefore, the time from the present to the time T0 is a waiting time until the host vehicle 1 starts changing the lane.
- the length of the standby time is appropriately set by the traveling control system 10. When T0 is set to 0, the host vehicle 1 starts changing lanes from the present time.
- step S1141 the route calculation unit 114 extracts the nearest point O (T0) of the host vehicle 1 at the time T0 from the first point sequence representing the target passing point on the first route 22a.
- the nearest point O (T0) of the host vehicle 1 at time T0 is a point ahead of the position 1a of the host vehicle 1 at the time T0 and closest to the position 1a.
- the front is the traveling direction of the host vehicle 1 at that time.
- the forward direction at time T0 is the + X direction.
- step S1142 the route calculation unit 114 obtains the position 1b when the host vehicle 1 continues to travel from the present time to the time Te in the travel lane. That is, in step S1142, the route calculation unit 114 obtains the position 1b when the host vehicle 1 continues to travel from the present time to the time Te along the first route 22a. At this time, the route calculation unit 114 acquires information on the traveling speed of the host vehicle 1 from the current time to the time Te from the traveling control system 10.
- the position 1b at the time Te of the host vehicle 1 illustrated in FIG. 7 is illustrated as an aid for explanation. Therefore, the position in the X direction at the illustrated position 1b is not necessarily accurate.
- the position 1b is a predetermined position of the host vehicle 1.
- the time Te is the time when the host vehicle 1 completes the lane change.
- the travel control system 10 appropriately sets the length of time from when the host vehicle 1 starts to change lanes to when it is completed.
- the route calculation unit 114 extracts the nearest point O (Te) of the host vehicle 1 at the time Te from the first point sequence.
- the nearest point O (Te) of the host vehicle 1 at time Te is a point ahead of the position 1b of the host vehicle 1 at time Te and closest to the position 1b.
- step S1143 the path calculation unit 114 extracts a sequence of points located from the nearest point O (T0) at time T0 to the nearest point O (Te) at time Te from the first point sequence.
- a sequence of reference points B (t) is generated.
- the reference point B (t) is a target passing point of the host vehicle 1 at time t between time T0 and time Te when traveling on the first route 22a.
- the reference point B (t) can be obtained using the traveling speed of the host vehicle 1.
- O (T0) and B (T0) are the same point, and O (Te) and B (Te) are the same point.
- step S1145 the route calculation unit 114 calculates a distance W (t) between the reference point B (t) and the corresponding point C (t) corresponding to the reference point B (t). The distance W (t) is obtained for each of the reference points B (t).
- step S1146 the route calculation unit 114 generates a coefficient Xlc (t) for generating a third route.
- FIG. 8 is a diagram for explaining the coefficient Xlc (t) generated by the route calculation unit 114 in the route generation device 110 according to the first embodiment.
- the horizontal axis represents time t
- the vertical axis represents the magnitude of the coefficient Xlc (t).
- the magnitude of the coefficient Xlc (t) changes according to the elapsed time from when the own vehicle 1 starts changing lanes at time T0 until the own vehicle 1 completes changing lanes at time Te.
- the trajectory of the change in the magnitude of the coefficient Xlc (t) with respect to the elapsed time from when the host vehicle 1 starts changing the lane until the lane change is completed is a clothoid curve.
- the coefficient Xlc (t) is called a clothoid coefficient.
- the coefficient Xlc (t) is said to change in a clothoid shape with respect to the elapsed time.
- the coefficient Xlc (t) is 0 at time T0 and 1 at time Te.
- step S1147 the route calculation unit 114 calculates the position of the target point R (t) constituting the third point sequence that becomes the target passing point when the lane in which the host vehicle 1 travels is changed.
- the route calculation unit 114 generates one target point R (t) for each of the reference points B (t).
- the route calculation unit 114 calculates the position of the target point R (t) so that the target point R (t) is positioned on a line segment connecting the corresponding reference point B (t) and the corresponding point C (t). To do.
- the route calculation unit 114 sets the target point so that the distance P (t) between the reference point B (t) and the target point R (t) is the distance represented by the following equation (1).
- the position of R (t) is calculated.
- the ratio changes according to the elapsed time after the host vehicle 1 starts changing lanes, and the locus of the change becomes a clothoid curve. Since the coefficient Xlc (T0) at time T0 is 0, the reference point B (T0) at time T0 matches the target point R (T0) at time T0. Since the coefficient Xlc (Te) at time Te is 1, the corresponding point C (Te) at time Te coincides with the target point R (Te) at time Te.
- the third point sequence that is the sequence of the target points R (t) obtained as described above becomes the third route that is the target route when the lane in which the host vehicle 1 travels is changed. Or the line which connected the 3rd point sequence becomes the 3rd course.
- the magnitude of the coefficient Xlc (t) depends only on the elapsed time since the host vehicle 1 started the lane change, and does not affect the travel distance of the host vehicle 1. Not. Therefore, the distance required for the own vehicle 1 to change the lane is longer when the traveling speed of the own vehicle 1 is fast, and shorter when the traveling speed of the own vehicle 1 is slow. As a result, an appropriate target route can be generated regardless of the traveling speed of the host vehicle 1.
- FIG. 9 is another diagram for explaining a route generated by the route calculation unit 114 in the route generation device 110 of the first embodiment.
- FIG. 9 shows the third path 22c as a line connecting the third point sequence.
- the route calculation unit 114 operates as described above.
- the route generation device 110 is configured to extract the reference point B (t) from the first point sequence and extract the corresponding point C (t) from the second point sequence. It may be configured as follows. That is, the route generation device 110 may be configured to extract the reference point B (t) from the second point sequence and extract the corresponding point C (t) from the first point sequence.
- the route calculation unit 114 ensures that the distance P (t) between the reference point B (t) and the target point R (t) is a distance represented by the following equation (2). Then, the position of the target point R (t) is calculated.
- the route generation device 110 is configured to extract the reference point B (t) from the first point sequence, but generates the reference point B (t) separately from the first point sequence. It may be configured to do so.
- the route generation device 110 may be configured to generate the reference point B (t) between the first point sequences. That is, the route generation device 110 according to the present embodiment generates the reference point B (t) so as to be positioned on one of the line connecting the first point sequence and the line connecting the second point sequence, Any configuration may be used as long as the corresponding point C (t) is generated so as to be positioned on the other line of the line connecting the first point sequence and the line connecting the second point sequence.
- FIG. 10 is a plan view for explaining another example of a route generated by the route calculation unit 114 in the route generation device 110 according to the first embodiment.
- the same reference numerals as those in FIG. 7 denote the same components.
- FIG. 10 shows a situation in which the distance between the first route and the second route changes as the host vehicle 1 travels. For example, when the traveling lane and the adjacent lane merge, the distance between the first route and the second route changes.
- the route generation device 110 according to the present exemplary embodiment has a relationship between the reference point B (t) and the target point R (t) with respect to the distance W (t) between the reference point B (t) and the corresponding point C (t).
- the route generation device 110 is a route that allows a smooth lane change even in a situation where the distance between the first route and the second route changes as shown in FIG. It can be easily generated. Further, the travel control device 100 of the present embodiment can smoothly change the lane even in a situation where the distance between the first route and the second route changes as shown in FIG. .
- the route generation device 110 and the travel control device 100 of the present embodiment operate as described above. According to the route generation device 110 and the travel control device 100 of the present embodiment, even if the position of the host vehicle 1 is not on the target route before starting the lane change, the vehicle before the lane change is started. The target route and the target route after starting the lane change are not discontinuous. Therefore, according to the route generation device 110 and the travel control device 100 of the present embodiment, the host vehicle 1 can change lanes with a stable behavior.
- the route generation device 110 and the travel control device 100 of the present embodiment generate a third route so as to connect the first route and the second route between the first route and the second route. To do. Therefore, according to the route generation device 110 and the travel control device 100 of the present embodiment, the generated target route is not discontinuous even in the above case. As a result, the own vehicle 1 can change the lane smoothly, and the discomfort felt by the passenger is reduced.
- the route generation device 110 and the travel control device 100 have the reference point B (t) and the target with respect to the distance W (t) between the reference point B (t) and the corresponding point C (t).
- the target route is generated such that the ratio of the distance P (t) to the point R (t) changes according to the elapsed time since the host vehicle 1 started changing the lane. Therefore, according to the route generation device 110 and the travel control device 100 of the present embodiment, it is possible to change the lane on the appropriate target route regardless of the travel speed of the host vehicle 1.
- the route generation device 110 and the travel control device 100 according to the present embodiment generate the target route so that the above-described trajectory of the change in the distance ratio becomes a clothoid curve. Therefore, the own vehicle 1 can change the lane more smoothly.
- Embodiment 2 Each point of the first point sequence representing the first route may be shifted in the traveling direction of the host vehicle 1 as compared with each point of the second point sequence representing the second route. It is done. Even in such a case, the route generation device can extract the sequence of the reference points B (t) from one of the first point sequence and the second point sequence. At this time, the route generation device obtains a straight line passing through a plurality of points included in the other of the first point sequence and the second point sequence, and lowers the straight line from the reference point B (t) to the obtained straight line. A vertical leg can be generated as the corresponding point C (t).
- the configurations of the route generation device 110 and the travel control device 100 according to the second embodiment of the present invention are the same as those shown in FIG.
- the flow of operations of the route generation device 110 and the travel control device 100 according to the second embodiment of the present invention is the same as that shown in FIGS. 3 and 6.
- the route generation device 110 and the travel control device 100 of the first embodiment, and the route generation device 110 and the travel control device 100 of the present embodiment are only the method for generating the corresponding point C (t) in step S1144 of FIG. Different.
- FIG. 11 is a plan view for explaining a route generated by the route calculation unit 114 in the route generation device 110 according to the second embodiment.
- the + Y direction is the traveling direction of the host vehicle 1 when the lane change is started
- the + X direction is a direction perpendicular to the + Y direction and going from the traveling lane to the adjacent lane.
- the same reference numerals as those in FIG. 7 are the same.
- the lane between the lane marking 21a and the lane marking 21c is a travel lane
- the lane between the lane marking 21b and the lane marking 21c is an adjacent lane.
- step S1143 of FIG. 6 the path calculation unit 114 extracts a sequence of points located from the nearest point O (T0) at time T0 to the nearest point O (Te) at time Te from the first point sequence. As a result, a sequence of reference points B (t) is generated.
- the operation of the route calculation unit 114 is the same as the operation of the route calculation unit 114 of the first embodiment.
- step S1144 the route calculation unit 114 generates a corresponding point C (t) for each of the extracted reference points B (t). This operation is performed according to the route calculation of the first embodiment. This is different from the operation of the unit 114.
- FIG. 12 is a flowchart illustrating an example of an operation flow in which the route calculation unit 114 obtains the corresponding point C (t) in the route generation device 110 according to the second embodiment.
- FIG. 11 shows details of the operation of the route calculation unit 114 in step S1144 of FIG.
- the path calculation unit 114 selects two points in the order of nearest neighbors from the second point sequence for each of the extracted reference points B (t), N1 (t), N2 Extract as (t). That is, the route calculation unit 114 sets the points closest to the extracted reference point B (t) and the second closest point in the second point sequence as the neighboring points N1 (t) and N2 (t). Extract.
- step S1144b the route calculation unit 114 calculates a straight line Lst (t) passing through the neighboring points N1 (t) and N2 (t).
- step S1144c the route calculation unit 114 calculates a perpendicular line Lver (t) from the reference point B (t) to the straight line Lst (t). That is, the route calculation unit 114 calculates a straight line Lver (t) that passes through the reference point B (t) and intersects the straight line Lst (t) at a right angle.
- the route generation device 110 and the travel control device 100 according to the present embodiment are configured such that the position of each point in the first point sequence representing the first route and the position of each point in the second point sequence representing the second route. Even when there is a deviation, it is possible to easily generate an optimal target route when changing lanes, and to reduce the passenger's uncomfortable feeling. Further, the route generation device 110 and the travel control device 100 of the present embodiment also have the effects described in the first embodiment.
- the route calculation unit 114 may search for a point closest to the reference point B (t) on the second route 22b and set the searched point as the corresponding point C (t).
- the route calculation unit 114 may be configured to obtain an intersection between the perpendicular Lver (t) and the second route 22b and use the obtained intersection as a corresponding point C (t).
- the route generation device 110 according to the present embodiment also extracts the reference point B (t) from the second point sequence and is adjacent to the first point sequence.
- the configuration may be such that the points N1 (t) and N2 (t) are extracted.
- the route generation device 110 according to the present embodiment may also be configured to generate the reference point B (t) between the first point sequences.
- the configuration of the route generation device 110 and the travel control device 100 according to the third embodiment of the present invention is the same as that shown in FIG.
- the flow of operations of the route generation device 110 and the travel control device 100 according to the second embodiment of the present invention is the same as that shown in FIGS. 3, 6, and 12.
- the route generation device 110 and the travel control device 100 of the second embodiment and the route generation device 110 and the travel control device 100 of the present embodiment are only the method of generating the reference point B (t) in step S1143 of FIG. Different.
- the route calculation unit 114 extracts the nearest point O (T0) of the host vehicle 1 at time T0 from the first point sequence.
- the route calculation unit 114 extracts the nearest point O (Te) of the host vehicle 1 at time Te from the first point sequence.
- the operation of the route calculation unit 114 is the same as the operation of the route calculation unit 114 of the first embodiment.
- the nearest point O (T0) is the nearest point O (T0) of the first point sequence at time T0.
- the nearest point O (Te) is the nearest point of the first point sequence at time Te.
- the route calculation unit 114 generates a reference point B (t). The operation of the route calculation unit 114 in step S1143 is different from the operation of the route calculation unit 114 of the first embodiment.
- FIG. 15 is a flowchart illustrating an example of an operation flow in which the route calculation unit 114 obtains the reference point B (t) in the route generation device 110 according to the third embodiment.
- FIG. 12 shows details of the operation of the route calculation unit 114 in step S1143 of FIG.
- the route calculation unit 114 extracts one point that is the nearest to the nearest point O (T0) of the first point sequence from the second point sequence, and the second point at time T0.
- the nearest neighbor point N (T0) of the point sequence In step S1143a, the path calculation unit 114 extracts one point that is the nearest to the nearest point O (Te) of the first point sequence from the second point sequence, and the second point at the time Te.
- the nearest neighbor point N (Te) of the point sequence is a flowchart illustrating an example of an operation flow in which the route calculation unit 114 obtains the reference point B (t) in the route generation device 110 according to the third embodiment.
- FIG. 12 shows details of the operation of the route calculation unit
- step S1143b the path calculation unit 114 obtains the number of points existing between the point O (T0) and the point O (Te) in the first point sequence.
- step S1143c the path calculation unit 114 obtains the number of points existing between the point N (T0) and the point N (Te) in the second point sequence.
- step S1143d the path calculation unit 114 compares the number of points in the first point sequence obtained in step S1143b with the number of points in the second point sequence obtained in step S1143c. When the number of points in the first point sequence is equal to or greater than the number of points in the second point sequence, the operation of the route calculation unit 114 proceeds to step S1143e.
- step S1143e the route calculation unit 114 extracts a point existing between the point O (T0) and the point O (Te) as the reference point B (t) in the first point sequence.
- step S1143d when the number of points in the first point sequence is less than the number of points in the second point sequence, the operation of the path calculation unit 114 proceeds to step S1143f.
- step S1143f the path calculation unit 114 extracts a point existing between the point N (T0) and the point N (Te) in the second point sequence as the reference point B (t).
- the path calculation unit 114 calculates the reference point B (from the point sequence having the larger number of points existing in the predetermined section from the first point sequence and the second point sequence. The column of t) is extracted.
- the path calculation unit 114 includes a sequence of reference points B (t) from a sequence of points having a higher density of points in a predetermined section of the first sequence of points and the second sequence of points. To extract.
- the operation of the route calculation unit 114 after step S1144 is the same as the operation of the route calculation unit 114 of the second embodiment.
- the route calculation unit 114 operates as described above.
- the arrangement interval of each point included in the first point sequence is different from the arrangement interval of each point included in the second point sequence. Even when the vehicle is in the lane, it is possible to easily generate an optimal target route when changing lanes, and to reduce the passenger's uncomfortable feeling.
- the route generation device 110 and the travel control device 100 according to the present embodiment obtain the reference point B (t) from the point sequence having the narrower point arrangement interval out of the first point sequence and the second point sequence.
- the target point R (t) is generated corresponding to each of the reference points B (t).
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Human Computer Interaction (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Navigation (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
車線変更を開始する前後で車両の目標経路が不連続となることを抑制する経路生成装置(110)及び走行制御装置(100)を得る。位置取得部(111)は、車両の位置情報を取得する。第1の経路抽出部(112)は、車線変更を開始する前に車両が走行している車線を車両が走行し続けると仮定した場合の目標経路を第1の点列として抽出する。第2の経路抽出部(113)は、車線変更を完了した後に車両が走行する隣接車線を車両が現在走行していると仮定し、車両が隣接車線を走行し続けると仮定した場合の目標経路を第2の点列として抽出する。経路演算部(114)は、車両が車線変更を行う際の目標経路を表す第3の点列が、第1の点列と第2の点列との間に位置するように、第3の点列を算出する。
Description
この発明は、車両が走行する車線を変更する際に、車両の目標経路を生成する経路生成装置、経路生成方法、及び生成された目標経路に基づいて車両の走行を制御する走行制御装置に関する。
近年、車両の走行を制御する技術が種々提案されている。そのうちの1つとして、現在走行している車線から隣の車線へと車両が移動する車線変更を制御する装置が開発されている。たとえば、特許文献1では、取得された自車両の位置情報に基づいて、進路変更の途中の自車の目標通過位置を演算し、続いて、算出された目標通過位置を自車位置と仮定して、次の目標通過位置を逐次算出することで、進路を変更する際の自車の目標経路を生成する装置が記載されている。
特許文献1に開示された装置では、目標経路を生成する際に、自車両の位置を基準として目標通過位置を算出する。しかしながら、路面の状態や風の影響など、周囲の環境から自車両が受ける外乱の影響、取得される自車両の位置情報の誤差の影響、車両制御の誤差の影響等によって、自車両の位置は、車線変更を開始する前の目標経路から外れている場合がある。車線変更を開始する際に、自車両の位置が、車線変更を開始する前の目標経路上にない場合、特許文献1に開示された装置では、車線変更を開始する前の目標経路と、車線変更を開始した後の目標経路とが不連続となり、自車両の挙動が不安定となる恐れがあった。
この発明は上記の問題を解決するためになされたものであって、車線変更を開始する前後で車両の目標経路が不連続となることを抑制する経路生成装置、経路生成方法及び走行制御装置を得ることを目的とする。
この発明における経路生成装置及び走行制御装置は、車両の位置情報を取得する位置取得部と、車両の位置情報と外部から取得される地図情報とに基づいて、車線変更を開始する前に車両が走行している車線を車両が走行し続けると仮定した場合の目標経路を第1の点列として抽出する第1の経路抽出部と、車両の位置情報と地図情報とに基づいて、車線変更を完了した後に車両が走行する隣接車線を車両が現在走行していると仮定し、車両が隣接車線を走行し続けると仮定した場合の目標経路を第2の点列として抽出する第2の経路抽出部と、第1の点列と第2の点列とに基づいて車両が車線変更を行う際の目標経路を第3の点列として算出する経路演算部とを備え、経路演算部は、第1の点列と第2の点列との間に第3の点列が位置するように、第3の点列を算出するものである。
また、この発明における経路生成方法は、車両の位置情報を取得するステップと、車両の位置情報と外部から取得される地図情報とに基づいて、車線変更を開始する前に車両が走行している車線を車両が走行し続けると仮定した場合の目標経路を第1の点列として抽出するステップと、車両の位置情報と地図情報とに基づいて、車線変更を完了した後に車両が走行する隣接車線を車両が現在走行していると仮定し、車両が隣接車線を走行し続けると仮定した場合の目標経路を第2の点列として抽出するステップと、第1の点列と第2の点列とに基づいて車両が車線変更を行う際の目標経路を第3の点列として算出するステップとを備え、目標経路を第3の点列として算出するステップにおいて、第1の点列と第2の点列との間に第3の点列が位置するように、第3の点列を算出するものである。
この発明によれば、車線変更を開始する前後で車両の目標経路が不連続となることを抑制する経路生成装置、経路生成方法及び走行制御装置を得ることができる。
実施の形態1.
図1は、本発明の実施の形態1の経路生成装置110及び走行制御装置100の概略構成の一例を示すブロック図である。また、図2は、本発明の実施の形態1の走行制御装置100を自車両1に搭載した場合の概略構成の一例を示すブロック図である。自車両1は、走行制御装置100の制御対象となる車両である。走行制御システム10は、自車両1に搭載され、自車両1の走行を制御する。走行制御システム10は、自動運転システムであっても良い。走行制御装置100は、走行制御システム10の一部であり、走行制御システム10からの指示を受けて、自車両1が走行する車線を変更する際の操舵量を制御する。
図1は、本発明の実施の形態1の経路生成装置110及び走行制御装置100の概略構成の一例を示すブロック図である。また、図2は、本発明の実施の形態1の走行制御装置100を自車両1に搭載した場合の概略構成の一例を示すブロック図である。自車両1は、走行制御装置100の制御対象となる車両である。走行制御システム10は、自車両1に搭載され、自車両1の走行を制御する。走行制御システム10は、自動運転システムであっても良い。走行制御装置100は、走行制御システム10の一部であり、走行制御システム10からの指示を受けて、自車両1が走行する車線を変更する際の操舵量を制御する。
ここで、自車両1が現在走行している車線と、将来走行する車線とが同一ではない場合に、自車両1は車線を変更したことになる。自車両1が走行している車線が他の車線と合流する場合も、車線変更に含まれる。なお、現在とは、走行制御装置100が処理を開始する時点を指す。すなわち、現在とは、走行制御装置100が車線変更のための動作を開始する時点である。一方、将来とは、自車両1が車線変更を完了した後を指す。図2では、走行制御装置100が、自車両1に搭載される場合を例示した。しかし、走行制御装置100の少なくとも一部が自車両1の外部に設置され、ネットワークを介して自車両1と接続されることもある。
走行制御装置100は、経路生成装置110及び制御量演算部120を備える。経路生成装置110は、自車両1が車線を変更する際の経路を生成する。また、経路生成装置110は、位置取得部111、第1の経路抽出部112、第2の経路抽出部113、及び経路演算部114を備える。走行制御装置100には、速度検出部210、ヨーレート検出部220、位置検出部230、地図配信部240、及び操舵部300が接続される。速度検出部210、ヨーレート検出部220、位置検出部230、及び地図配信部240は、走行制御装置100に入力される情報を生成する外部装置となる。速度検出部210は、自車両1に搭載された車速センサであり、自車両1の走行速度を検出する。ヨーレート検出部220は、自車両1に搭載されたヨーレートセンサであり、自車両1のヨーレートを検出する。
位置検出部230は、例えば、GPS(Global Positioning System)アンテナを含むGPS受信機であり、衛星からの情報を受信して、自車両1の2次元位置情報と、進行方向とを検出する。別の例としては、位置検出部230は、LiDAR(Laser Imaging Detection and Ranging)と地図情報とを組み合わせて実現することができる。さらに、位置検出部230は、GPS受信機、LiDAR、及び地図情報を組み合わせ実現することもできる。地図配信部240は、自車両1の周辺の高精度地図の情報を配信する。ここで、高精度地図は、道路の各車線の中心線上の点列の座標を保持している。また、この点列が、各車線を走行する場合の自車両1の経路となる。なお、高精度地図が保持する点列は、各車線の中心線を表す点列に限定されず、自車両1が各車線を走行する際の目標経路となる点列であれば良い。
次に、経路生成装置110及び走行制御装置100の動作について述べる。図3は、実施の形態1の経路生成装置110及び走行制御装置100の動作の流れの一例を示すフローチャートである。以降では、図3も用いて、経路生成装置110及び走行制御装置100の動作について述べる。前述の通り、走行制御装置100は、自車両1の走行を制御する走行制御システム10の一部であり、走行制御システム10からの指示を受けて、動作を開始する。
まず、ステップS101において、走行制御装置100は、自車両1が現在走行している車線から隣の車線に車線を変更することが可能か否かを判定する。たとえば、自車両1の周辺に障害物となる車両が存在する場合、自車両1が現在走行している車線の隣の車線が存在しない場合、又は運転者により車線の変更を禁止されている場合は、走行制御装置100は、車線の変更が不可能であると判定する。ステップS101において、車線の変更が不可能であると判定されると、走行制御装置100の動作は、ステップS101に戻る。一方、ステップS101において、車線の変更が可能であると判定されると、走行制御装置100の動作は、ステップS111に進む。
次にステップS111において、位置取得部111は、位置検出部230で検出された自車両1の位置情報を取得するとともに、取得した位置情報を必要に応じて補正する。位置検出部230では、所定の時間間隔で自車両1の位置情報を検出する。しかし、位置検出部230が自車両1の位置情報を検出してから現在までの間に自車両1が移動していると、この移動によって発生する位置情報の誤差が無視できない場合がある。したがって、位置取得部111は、速度検出部210で検出された自車両1の走行速度、及びヨーレート検出部220で検出された自車両1のヨーレートに基づいて、位置検出部230で検出された自車両1の位置情報を補正し、現在の自車両1の位置情報として出力する。すなわち、位置取得部111は、自車両1の挙動を考慮して、位置検出部230で検出された自車両1の位置情報を補正し、現在の自車両1の位置情報として出力する。なお、自車両1の移動を無視できる程度に短い時間間隔で位置検出部230が自車両1の位置情報を検出する場合には、位置取得部111は位置情報の補正を行う必要はない。
次に、ステップS112において、第1の経路抽出部112は、位置取得部111から出力された自車両1の位置情報と、地図配信部240から配信された高精度地図の情報とに基づいて、自車両1が現在走行している車線を認識する。以降において、自車両1が現在走行している車線は、走行車線と記載されることがある。走行車線は、車線を変更する前に自車両1が走行する車線である。また、ステップS112において、第1の経路抽出部112は、第1の経路を抽出する。第1の経路は、自車両1が走行車線を走行し続けると仮定した場合の目標経路である。前述の通り、高精度地図は、道路の各車線の中心線上の点列の座標を保持している。第1の経路抽出部112は、自車両1の位置情報に基づいて、走行車線の中心線上の点列を高精度地図の情報から抽出することで、第1の経路を点列として抽出する。第1の経路を表す点列を第1の点列と呼ぶ。第1の点列の各点は、自車両1が現在以降も走行車線を走行し続けると仮定した場合の自車両1の目標通過地点となる。自車両1は、第1の点列を結んだ線に沿って走行するように制御されるので、第1の点列を結んだ線を第1の経路と考えることもできる。
次に、ステップS113において、第2の経路抽出部113は、位置取得部111から出力された自車両1の位置情報と、地図配信部240から配信された高精度地図の情報とに基づいて、自車両1が現在走行している車線に隣接し、自車両1が車線を変更した後に走行する車線を認識する。以降において、車線を変更した後に自車両1が走行する車線は、隣接車線と記載されることがある。また、ステップS113において、第2の経路抽出部113は、第2の経路を抽出する。第2の経路は、自車両1が隣接車線を現在走行していると仮定し、さらに、自車両1が隣接車線を現在以降も走行し続けると仮定した場合の目標経路である。第2の経路抽出部113は、自車両1の位置情報に基づいて、隣接車線の中心線上の点列を高精度地図の情報から抽出することで、第2の経路を点列として抽出する。第2の経路を表す点列を第2の点列と呼ぶ。第2の点列の各点は、自車両1が隣接車線を現在以降も走行し続けると仮定した場合の自車両1の目標通過地点となる。自車両1は、第2の点列を結んだ線に沿って走行するように制御されるので、第2の点列を結んだ線を第2の経路と考えることもできる。
次に、ステップS114において、経路演算部114は、位置取得部111から出力される自車両1の位置情報と、第1の経路抽出部112で抽出される第1の経路を表す第1の点列と、第2の経路抽出部113で抽出される第2の経路を表す第2の点列とに基づいて、自車両1が走行する車線を変更する際の目標経路を算出する。自車両1が走行する車線を変更する際の目標経路を第3の経路と呼ぶ。経路演算部114は、自車両1が走行する車線を変更する際の目標通過地点の点列の位置を算出することで、第3の経路を点列として求める。第3の経路を表す点列を第3の点列と呼ぶ。自車両1は、第3の点列を結んだ線に沿って走行するように制御されるので、第3の点列を結んだ線を第3の経路と考えることもできる。第3の経路は、自車両1が車線変更を開始してから、車線変更を完了するまでの目標経路となる。第3の経路は、第1の経路と第2の経路との間に生成される。経路演算部114の動作の詳細は後述される。経路演算部114で算出された第3の経路が、経路生成装置110の出力となる。したがって、ステップS111からステップS114までの動作が、経路生成装置110の動作となる。
次に、ステップS120において、制御量演算部120は、経路演算部114で求められた第3の経路に自車両1が追従するように、ステアリングを制御する制御量を求め、操舵部300へと出力する。すなわち、制御量演算部120は、経路生成装置110で求められた第3の経路に沿って自車両1が走行するような目標舵角を求め、操舵部300へと出力する。次に、ステップS140において、走行制御装置100は、車線の変更が完了したか否かを判定する。ステップS140において、車線の変更が完了していないと判定されると、走行制御装置100の動作は、ステップS120に戻る。したがって、ステップS120における制御量演算部120の動作は、車線の変更が完了するまで繰り返し行われることになる。一方、ステップS140において、車線の変更が完了したと判定されると、走行制御装置100の動作は終了する。
例えば、ステップS140において、走行制御装置100は、車線の変更を開始してから所定の時間が経過したか否かを判定することによって、車線の変更が完了したか否かを判定することができる。または、ステップS140において、走行制御装置100は、車線の変更を開始してから自車両1が所定の距離を走行したか否かを判定することによって、車線の変更が完了したか否かを判定することもできる。または、ステップS140において、走行制御装置100は、自車両1の位置情報を用いて、車線の変更が完了したか否かを判定することもできる。本実施の形態の走行制御装置100及び走行制御装置100は、以上のように動作する。
操舵部300は、走行制御装置100で求められた目標舵角の出力先となる外部装置である。操舵部300は、モータを含む操舵機構、及びモータを制御する制御回路又はプロセッサを備え、走行制御装置100で求められた目標舵角に基づいてモータを動作させ、自車両1の横方向の運動を制御する。なお、横方向とは、自車両の進行方向に対して直角に交わる方向であり、路面に対して平行な方向である。
図4は、実施の形態1の経路生成装置110及び走行制御装置100を実現するためのシステム構成の一例を示すシステム構成図である。自車両1には、GPS受信機2、地図配信装置3、速度センサ4、ヨーレートセンサ5、運転支援ECU6(Elctronic Control Unit)、操舵ECU7、及び操舵機構8が搭載される。GPS受信機2は、位置検出部230として機能する。GPS受信機2は、GPSアンテナを介して衛星情報を取得し、自車両1の位置情報と進行方向の情報を求めて、地図配信装置3及び運転支援ECU6に送信する。速度センサ4は、速度検出部210として機能する。速度センサ4は、自車両1の走行速度を検出し、運転支援ECU6に送信する。ヨーレートセンサ5は、ヨーレート検出部220として機能する。ヨーレートセンサ5は、自車両1のヨーレートを検出し、運転支援ECU6に送信する。
地図配信装置3は、地図配信部240として機能する。地図配信装置3は、GPS受信機2から受信した自車両1の位置情報に基づいて、自車両1の周辺の地図情報を運転支援ECU6に送信する。前述の通り、送信される地図情報には、少なくとも自車両1の周辺の道路の各車線の中心線上の点列の座標が含まれる。運転支援ECU6は、ADAS(Advanced Driver Assistance System)等、自車両1の走行を制御する走行制御システム10の機能を実現する。運転支援ECU6が実現する機能には、走行制御装置100の機能が含まれる。運転支援ECU6は、ADAS-ECUと言い換えることができる。運転支援ECU6は、GPS受信機2から取得した自車両1の位置情報及び進行方向の情報と、速度センサ4から取得した自車両1の走行速度と、ヨーレートセンサ5から取得した自車両1のヨーレートと、地図配信装置3から取得した地図情報とに基づいて、操舵ECU7に制御指令を送信する。操舵ECU7及び操舵機構8は、操舵部300として機能する。操舵ECU7は、運転支援ECU6からの制御指令に基づいて操舵機構8の動作を制御し、自車両1の横方向の運動を制御する。
図5は、実施の形態1の経路生成装置110及び走行制御装置100における運転支援ECU6及び操舵ECU7の構成の一例を示す図である。運転支援ECU6及び操舵ECU7において、プロセッサ401は、データバス403を介してメモリ402と接続される。プロセッサ401は、メモリ402に記憶されるプログラムを読み出して実行することで、運転支援ECU6及び操舵ECU7の機能を実現する。なお、運転支援ECU6及び操舵ECU7は、他に専用の電子回路を備えても良いし、専用の電子回路のみで構成されても良い。すなわち、運転支援ECU6は、運転支援回路と言い換えることもできる。また、操舵ECU7は、操舵回路と言い換えることもできる。
次に、経路演算部114の動作について更に説明する。図6は、実施の形態1の経路生成装置110において、経路演算部114の動作の流れの一例を示すフローチャートである。図6は、図3のステップS114における経路演算部114の動作の流れを示すフローチャートである。また、図7は、実施の形態1の経路生成装置110において、経路演算部114が生成する経路を説明するための平面図である。なお、図7において、+Y方向は、車線変更を開始する時点の自車両1の進行方向であり、+X方向は、+Y方向に垂直であり走行車線から隣接車線へと向かう方向である。また、図7において、区画線21aと区画線21cとの間の車線が走行車線であり、区画線21bと区画線21cとの間の車線が隣接車線である。以降では、図6及び図7も用いて、経路演算部114の動作について説明する。説明に当たり、時刻を表す変数をtとして、現在の時刻をt=0とする。
まず、ステップS1141において、経路演算部114は、自車両1が走行車線を現在から時刻T0まで走行し続けた場合の位置1aを求める。すなわち、ステップS1141において、経路演算部114は、自車両1が第1の経路22aに沿って現在から時刻T0まで走行し続けた場合の位置1aを求める。この時、経路演算部114は、現在から時刻T0までの自車両1の走行速度の情報を走行制御システム10から取得する。なお、図7に図示されている自車両1の時刻T0における位置1aは、説明の補助として図示されたものである。したがって、図示された位置1aにおけるX方向の位置は、必ずしも正確なものではない。位置1aは、自車両1の所定箇所の位置とする。また、時刻T0は、自車両1が車線変更を開始する時刻である。したがって、現在から時刻T0までの時間は、自車両1が車線の変更を開始するまでの待機時間である。待機時間の長さは、走行制御システム10によって適宜設定される。T0を0にすると、自車両1は、現在から車線の変更を開始する。
また、ステップS1141において、経路演算部114は、第1の経路22aにおける目標通過地点を表す第1の点列の中から、時刻T0における自車両1の最近傍点O(T0)を抽出する。時刻T0における自車両1の最近傍点O(T0)は、自車両1の時刻T0における位置1aよりも前方であり、しかも位置1aに最も近い点である。なお、前方とは、その時点における自車両1の進行方向である。時刻T0における前方は、+X方向である。
次に、ステップS1142において、経路演算部114は、自車両1が走行車線を現在から時刻Teまで走行し続けた場合の位置1bを求める。すなわち、ステップS1142において、経路演算部114は、自車両1が第1の経路22aに沿って現在から時刻Teまで走行し続けた場合の位置1bを求める。この時、経路演算部114は、現在から時刻Teまでの自車両1の走行速度の情報を走行制御システム10から取得する。なお、図7に図示されている自車両1の時刻Teにおける位置1bは、説明の補助として図示されたものである。したがって、図示された位置1bにおけるX方向の位置は、必ずしも正確なものではない。位置1bは、自車両1の所定箇所の位置とする。また、時刻Teは、自車両1が車線の変更を完了する時刻である。自車両1が車線の変更を開始してから完了するまでの時間の長さは、走行制御システム10によって適宜設定される。また、ステップS1142において、経路演算部114は、第1の点列のなかから、時刻Teにおける自車両1の最近傍点O(Te)を抽出する。時刻Teにおける自車両1の最近傍点O(Te)は、自車両1の時刻Teにおける位置1bよりも前方であり、しかも位置1bに最も近い点である。
次に、ステップS1143において、経路演算部114は、第1の点列の中から、時刻T0における最近傍点O(T0)から時刻Teにおける最近傍点O(Te)までに位置する点の列を抽出することで、基準点B(t)の列を生成する。基準点B(t)は、第1の経路22aを走行する場合の、時刻T0から時刻Teまでの間の時刻tにおける自車両1の目標通過地点となる。基準点B(t)は、自車両1の走行速度を用いて求めることができる。なお、O(T0)とB(T0)とは同一の点となり、O(Te)とB(Te)とは同一の点となる。
次に、ステップS1144において、経路演算部114は、抽出した基準点B(t)のそれぞれに対して、第2の点列の中から最近傍となる1点を対応点C(t)として抽出することで、基準点B(t)に対応する対応点C(t)を生成する。なお、第1の点列と同様に、第2の点列は、第2の経路22bにおける目標通過地点を表す。すなわち、経路演算部114は、第1の点列に含まれる各点と、第2の点列に含まれる各点との組み合わせの中から、最も近くに位置する2点の組み合わせを抽出して、基準点B(t)及び対応点C(t)とする。例えば、経路演算部114は、第2の点列の中から、基準点B(T0)に最も近い対応点C(T0)を抽出し、基準点B(T0)と対応点C(T0)とを対応付ける。また、経路演算部114は、第2の点列の中から、基準点B(Te)に最も近い対応点C(Te)を抽出し、基準点B(Te)と対応点C(Te)とを対応付ける。この結果、基準点B(t)と対応点C(t)とは1対1に対応する。
次に、ステップS1145において、経路演算部114は、基準点B(t)と、この基準点B(t)に対応する対応点C(t)との間の距離W(t)を算出する。距離W(t)は、基準点B(t)のそれぞれに対して求められる。次に、ステップS1146において、経路演算部114は、第3の経路を生成するための係数Xlc(t)を生成する。図8は、実施の形態1の経路生成装置110において、経路演算部114が生成する係数Xlc(t)を説明するための図である。図8において、横軸は時刻tを表し、縦軸は係数Xlc(t)の大きさを表す。
係数Xlc(t)の大きさは、時刻T0に自車両1が車線変更を開始してから、自車両1が時刻Teに車線変更を完了するまでの経過時間に応じて変化する。自車両1が車線変更を開始してから車線変更を完了するまでの経過時間に対する、係数Xlc(t)の大きさの変化の軌跡は、クロソイド曲線となる。変化の軌跡がクロソイド曲線となる時、係数Xlc(t)をクロソイド係数と呼ぶ。また、変化の軌跡がクロソイド曲線となる時、係数Xlc(t)の大きさは、経過時間に対してクロソイド状に変化すると言う。係数Xlc(t)は、時刻T0では0であり、時刻Teでは1となる。
次に、ステップS1147において、経路演算部114は、自車両1が走行する車線を変更する際の目標通過地点となる第3の点列を構成する目標点R(t)の位置を算出する。経路演算部114は、基準点B(t)のそれぞれに対して目標点R(t)を1つ生成する。経路演算部114は、目標点R(t)が、対応する基準点B(t)及び対応点C(t)を結ぶ線分上に位置するように、目標点R(t)の位置を算出する。また、経路演算部114は、基準点B(t)と目標点R(t)との間の距離P(t)が、下記の式(1)で表される距離となるように、目標点R(t)の位置を算出する。
この結果、基準点B(t)と対応点C(t)との間の距離W(t)に対する、基準点B(t)と目標点R(t)との間の距離P(t)の比率は、自車両1が車線変更を開始してからの経過時間に応じて変化し、変化の軌跡はクロソイド曲線となる。なお、時刻T0における係数Xlc(T0)が0となるので、時刻T0における基準点B(T0)と時刻T0における目標点R(T0)とは一致する。また、時刻Teにおける係数Xlc(Te)が1となるので、時刻Teにおける対応点C(Te)と時刻Teにおける目標点R(Te)とは一致する。
以上のようにして求められた目標点R(t)の列である第3の点列が、自車両1が走行する車線を変更する際の目標経路である第3の経路となる。又は、第3の点列を結んだ線が、第3の経路となる。ここで、図8に示すように、係数Xlc(t)の大きさは、自車両1が車線変更を開始してからの経過時間のみに依存しており、自車両1の走行距離には影響されない。したがって、自車両1が車線の変更に要する距離は、自車両1の走行速度が速い場合には長くなり、自車両1の走行速度が遅い場合には短くなる。この結果、自車両1の走行速度に依らず、適切な目標経路を生成することが可能となる。
図9は、実施の形態1の経路生成装置110において、経路演算部114が生成する経路を説明するための別の図である。図9は、第3の経路22cを第3の点列を結んだ線として表したものである。経路演算部114は、以上のように動作する。なお、本実施の形態の経路生成装置110は、第1の点列から基準点B(t)を抽出し、第2の点列から対応点C(t)を抽出する構成であるが、逆の構成であっても良い。すなわち、経路生成装置110は、第2の点列から基準点B(t)を抽出し、第1の点列から対応点C(t)を抽出する構成であっても良い。この場合には、経路演算部114は、基準点B(t)と目標点R(t)との間の距離P(t)が、下記の式(2)で表される距離となるように、目標点R(t)の位置を算出する。
また、本実施の形態の経路生成装置110は、第1の点列から基準点B(t)を抽出する構成であったが、第1の点列とは別に基準点B(t)を生成する構成であっても良い。例えば、経路生成装置110は、第1の点列の間に基準点B(t)を生成する構成であっても良い。すなわち、本実施の形態の経路生成装置110は、第1の点列を結ぶ線及び第2の点列を結ぶ線の一方の線上に位置するように、基準点B(t)を生成し、第1の点列を結ぶ線及び第2の点列を結ぶ線の他方の線上に位置するように、対応点C(t)を生成する構成であれば良い。
図10は、実施の形態1の経路生成装置110において、経路演算部114が生成する経路の別の例を説明するための平面図である。図10において、図7と同一の符号を付したものは同一のものである。図10は、自車両1の走行に伴って、第1の経路と第2の経路との間の距離が変化する状況を表している。例えば、走行車線と隣接車線とが合流する場合、第1の経路と第2の経路との間の距離が変化する。本実施の形態の経路生成装置110は、基準点B(t)と対応点C(t)との間の距離W(t)に対する、基準点B(t)と目標点R(t)との間の距離P(t)の比率の変化の軌跡がクロソイド曲線となるように、自車両1が車線を変更する際の目標経路を生成する。したがって、本実施の形態の経路生成装置110は、図10のように第1の経路と第2の経路との間の距離が変化する状況においても、滑らかな車線の変更を可能とする経路を容易に生成することができる。また、本実施の形態の走行制御装置100は、図10のように第1の経路と第2の経路との間の距離が変化する状況においても、滑らかに車線を変更することが可能となる。
本実施の形態の経路生成装置110及び走行制御装置100は、以上のように動作する。本実施の形態の経路生成装置110及び走行制御装置100によれば、自車両1の位置が、車線変更を開始する前の目標経路上にない場合であっても、車線変更を開始する前の目標経路と、車線変更を開始した後の目標経路とが不連続とはならない。したがって、本実施の形態の経路生成装置110及び走行制御装置100によれば、自車両1は安定した挙動での車線の変更が可能となる。
例えば、路面に部分的に凸凹が存在する場合、突発的な横風の影響を受けた場合、又はカントが大きい路面で定常的な横位置偏差が生じている場合などにおいては、自車両1の位置が、目標経路から外れることが考えられる。本実施の形態の経路生成装置110及び走行制御装置100は、第1の経路と第2の経路との間に、第1の経路と第2の経路とを繋ぐように第3の経路を生成する。したがって、本実施の形態の経路生成装置110及び走行制御装置100によれば、上記のような場合においても、生成される目標経路が不連続とはならない。その結果、自車両1は滑らかな車線の変更が可能となり、搭乗者が感じる違和感は低減される。
また、本実施の形態の経路生成装置110及び走行制御装置100は、基準点B(t)と対応点C(t)との間の距離W(t)に対する、基準点B(t)と目標点R(t)との間の距離P(t)の比率が、自車両1が車線の変更を開始してからの経過時間に応じて変化するように、目標経路を生成する。したがって、本実施の形態の経路生成装置110及び走行制御装置100によれば、自車両1の走行速度に依らず、適切な目標経路での車線の変更が可能となる。さらに、本実施の形態の経路生成装置110及び走行制御装置100は、前述の距離の比率の変化の軌跡が、クロソイド曲線となるように目標経路を生成する。したがって、自車両1はさらに滑らかな車線の変更が可能となる。
実施の形態2.
第1の経路を表す第1の点列の各点は、第2の経路を表す第2の点列の各点と比較して、自車両1の進行方向の位置にずれが生じる場合が考えられる。このような場合でも、経路生成装置は、第1の点列及び第2の点列のうちの一方の点列から基準点B(t)の列を抽出することができる。この時、経路生成装置は、第1の点列及び第2の点列のうちの他方の点列に含まれる複数の点を通る直線を求め、求めた直線へ基準点B(t)から下ろした垂線の足を対応点C(t)として生成することができる。
第1の経路を表す第1の点列の各点は、第2の経路を表す第2の点列の各点と比較して、自車両1の進行方向の位置にずれが生じる場合が考えられる。このような場合でも、経路生成装置は、第1の点列及び第2の点列のうちの一方の点列から基準点B(t)の列を抽出することができる。この時、経路生成装置は、第1の点列及び第2の点列のうちの他方の点列に含まれる複数の点を通る直線を求め、求めた直線へ基準点B(t)から下ろした垂線の足を対応点C(t)として生成することができる。
本発明の実施の形態2の経路生成装置110及び走行制御装置100の構成は、図1に示されたものと同様である。また、本発明の実施の形態2の経路生成装置110及び走行制御装置100の動作の流れは、図3及び図6に示されたものと同様である。実施の形態1の経路生成装置110及び走行制御装置100と、本実施の形態の経路生成装置110及び走行制御装置100とは、図6のステップS1144における対応点C(t)の生成方法のみが異なる。
図11は、実施の形態2の経路生成装置110において、経路演算部114が生成する経路を説明するための平面図である。なお、図11において、+Y方向は、車線変更を開始する時点の自車両1の進行方向であり、+X方向は、+Y方向に垂直であり走行車線から隣接車線へと向かう方向である。また、図11において、図7におけるものと同一の符号を付したものは、同一のものである。また、図11において、区画線21aと区画線21cとの間の車線が走行車線であり、区画線21bと区画線21cとの間の車線が隣接車線である。図11は、第1の経路22aを表す第1の点列のY方向の位置と、第2の経路22bを表す第2の点列のY方向の位置とが異なる場合を表している。図6のステップS1143において、経路演算部114は、第1の点列の中から、時刻T0における最近傍点O(T0)から時刻Teにおける最近傍点O(Te)までに位置する点の列を抽出することで、基準点B(t)の列を生成する。この経路演算部114の動作は、実施の形態1の経路演算部114の動作と同様である。
次に、ステップS1144において、経路演算部114は、抽出した基準点B(t)のそれぞれに対して、対応点C(t)を生成するのであるが、この動作は実施の形態1の経路演算部114の動作とは異なる。図12は、実施の形態2の経路生成装置110において経路演算部114が対応点C(t)を求める動作の流れの一例を示すフローチャートである。図11は、図6のステップS1144における経路演算部114の動作の詳細を示したものである。まず、ステップS1144aにおいて、経路演算部114は、抽出した基準点B(t)のそれぞれに対して、第2の点列の中から最近傍となる順に2点を近傍点N1(t)、N2(t)として抽出する。すなわち、経路演算部114は、第2の点列の中で、抽出した基準点B(t)に最も近い点と、2番目に近い点とを近傍点N1(t)、N2(t)として抽出する。
次に、ステップS1144bにおいて、経路演算部114は、近傍点N1(t)及びN2(t)を通る直線Lst(t)を算出する。次に、ステップS1144cにおいて、経路演算部114は、基準点B(t)から直線Lst(t)への垂線Lver(t)を算出する。すなわち、経路演算部114は、基準点B(t)を通り、直線Lst(t)と直角に交わる直線Lver(t)を算出する。次に、ステップS1144dにおいて、経路演算部114は、直線Lst(t)と垂線Lver(t)との交点を求め、求められた交点を対応点C(t)とする。すなわち、経路演算部114は、直線Lst(t)へ基準点B(t)から下ろした垂線Lver(t)の足を対応点C(t)として生成する。以上が、本実施の形態の経路生成装置110において、経路演算部114が対応点C(t)を生成する動作である。なお、図11に示された通り、第2の点列を結んだ線を第2の経路22bと考えると、経路演算部114は、第2の経路22b上で基準点B(t)に最も近い点を、対応点C(t)として生成していることになる。
対応点C(t)を求めてからの経路演算部114の動作は、図6に示した動作と同様である。すなわち、経路演算部114は、ステップS1145において、基準点B(t)と対応点C(t)との間の距離W(t)を算出し、ステップS1146において、第3の経路を生成するための係数Xlc(t)を生成し、ステップS1147において、第3の点列を構成する目標点R(t)の位置を算出する。本実施の形態の経路生成装置110及び走行制御装置100において、経路演算部114は以上のように動作する。本実施の形態の経路生成装置110及び走行制御装置100は、第1の経路を表す第1の点列の各点の位置と、第2の経路を表す第2の点列の各点の位置とにずれが生じている場合であっても、車線変更の際に最適な目標経路を容易に生成することができ、搭乗者の違和感を低減することができる。また、本実施の形態の経路生成装置110及び走行制御装置100は、実施の形態1で述べた効果も有する。
図13は、実施の形態2の経路生成装置110において、経路演算部114が生成する経路の別の例を説明するための平面図である。図13において、図11と同一の符号を付したものは同一のものである。図13は、カーブ路において経路演算部114が生成する目標経路を示す平面図である。経路演算部114の動作は、上述の通りである。図13に示すように、第1の点列における各点の間隔と、第2の点列における各点の間隔とが同じであった場合、カーブ路においては、第1の点列における各点の位置と、第2の点列における各点の位置とがずれてしまう。これは、第1の点列はカーブの外側に位置しており、第2の点列はカーブの内側に位置しているためである。このような場合であっても、本実施の形態の経路生成装置110及び走行制御装置100は、道路の形状に沿った最適な目標経路を容易に生成することができる。
ここで、第2の経路22bは、図13で例示されたように、第2の点列を結んだ曲線であると考えることができる。一方で、第2の経路22bは、第2の点列の隣接する点の間を直線で結んだ折れ線であると考えることもできる。第2の経路22bが折れ線であると考えた場合には、対応点C(t)は、第2の経路22b上に位置することになる。一方、第2の経路22bが曲線であると考えた場合、本実施の形態の経路演算部114は、第2の経路22b上で基準点B(t)に最も近い点の近似点を、対応点C(t)として生成していることになる。すなわち、本実施の形態の経路演算部114は、第2の経路22b上で基準点B(t)に最も近い点を近似的に求め、対応点C(t)として生成していると考えることができる。
経路演算部114は、第2の経路22b上で基準点B(t)に最も近い点を探索し、探索された点を対応点C(t)とする構成であっても良い。また、経路演算部114は、垂線Lver(t)と第2の経路22bとの交点を求め、求められた交点を対応点C(t)とする構成であっても良い。また、本実施の形態1における経路生成装置110と同様に、本実施の形態の経路生成装置110も、第2の点列から基準点B(t)を抽出し、第1の点列から近傍点N1(t)、N2(t)を抽出する構成であっても良い。また、本実施の形態の経路生成装置110も、第1の点列の間に基準点B(t)を生成する構成であっても良い。
実施の形態3.
第1の経路を表す第1の点列に含まれる各点の配置間隔は、第2の経路を表す第2の点列に含まれる各点の配置間隔とは異なっている場合が考えられる。このような場合には、経路生成装置は、第1の点列及び第2の点列のうち、所定区間に存在する点の数が多い方の点列から基準点B(t)の列を抽出することができる。
第1の経路を表す第1の点列に含まれる各点の配置間隔は、第2の経路を表す第2の点列に含まれる各点の配置間隔とは異なっている場合が考えられる。このような場合には、経路生成装置は、第1の点列及び第2の点列のうち、所定区間に存在する点の数が多い方の点列から基準点B(t)の列を抽出することができる。
本発明の実施の形態3の経路生成装置110及び走行制御装置100の構成は、図1に示されたものと同様である。また、本発明の実施の形態2の経路生成装置110及び走行制御装置100の動作の流れは、図3、図6及び図12に示されたものと同様である。実施の形態2の経路生成装置110及び走行制御装置100と、本実施の形態の経路生成装置110及び走行制御装置100とは、図6のステップS1143における基準点B(t)の生成方法のみが異なる。
図14は、実施の形態3の経路生成装置110において、経路演算部114が生成する経路を説明するための平面図である。なお、図14において、+Y方向は、車線変更を開始する時点の自車両1の進行方向であり、+X方向は、+Y方向に垂直であり走行車線から隣接車線へと向かう方向である。また、図14において、図11におけるものと同一の符号を付したものは、同一のものである。また、図14において、区画線21aと区画線21cとの間の車線が走行車線であり、区画線21bと区画線21cとの間の車線が隣接車線である。図14は、第1の経路22aを表す第1の点列に含まれる各点の配置間隔と、第2の経路22aを表す第2の点列に含まれる各点の配置間隔とが異なる場合を表している。
図6のステップS1141において、経路演算部114は、第1の点列の中から、時刻T0における自車両1の最近傍点O(T0)を抽出する。また、ステップS1142において、経路演算部114は、第1の点列の中から、時刻Teにおける自車両1の最近傍点O(Te)を抽出する。この経路演算部114の動作は、実施の形態1の経路演算部114の動作と同様である。なお、最近傍点O(T0)は、時刻T0における第1の点列の最近傍点O(T0)となる。また、最近傍点O(Te)は、時刻Teにおける第1の点列の最近傍点となる。次に、ステップS1143において、経路演算部114は、基準点B(t)を生成する。このステップS1143における経路演算部114の動作が、実施の形態1の経路演算部114の動作とは異なる。
図15は、実施の形態3の経路生成装置110において経路演算部114が基準点B(t)を求める動作の流れの一例を示すフローチャートである。図12は、図6のステップS1143における経路演算部114の動作の詳細を示したものである。まず、ステップS1143aにおいて、経路演算部114は、第1の点列の最近傍点O(T0)に対して最近傍となる1点を第2の点列の中から抽出し、時刻T0における第2の点列の最近傍点N(T0)とする。また、ステップS1143aにおいて、経路演算部114は、第1の点列の最近傍点O(Te)に対して最近傍となる1点を第2の点列の中から抽出し、時刻Teにおける第2の点列の最近傍点N(Te)とする。
次に、ステップS1143bにおいて、経路演算部114は、第1の点列において、点O(T0)から点O(Te)までの間に存在する点の数を求める。次に、ステップS1143cにおいて、経路演算部114は、第2の点列において、点N(T0)から点N(Te)までの間に存在する点の数を求める。次に、ステップS1143dにおいて、経路演算部114は、ステップS1143bで求めた第1の点列における点の数と、ステップS1143cで求めた第2の点列における点の数とを比較する。第1の点列における点の数が、第2の点列における点の数以上である場合には、経路演算部114の動作は、ステップS1143eに進む。ステップS1143eにおいて、経路演算部114は、第1の点列において、点O(T0)から点O(Te)までの間に存在する点を基準点B(t)として抽出する。
一方、ステップS1143dにおいて、第1の点列における点の数が、第2の点列における点の数未満である場合には、経路演算部114の動作は、ステップS1143fに進む。ステップS1143fにおいて、経路演算部114は、第2の点列において、点N(T0)から点N(Te)までの間に存在する点を基準点B(t)として抽出する。以上のように、本実施の形態の経路演算部114は、第1の点列及び第2の点列のうち、所定の区間に存在する点の数が多い方の点列から基準点B(t)の列を抽出する。言い換えると、本実施の形態の経路演算部114は、第1の点列及び第2の点列のうち、所定の区間における点の密度が高い方の点列から基準点B(t)の列を抽出する。ステップS1144以降の経路演算部114の動作は、実施の形態2の経路演算部114の動作と同様である。
本実施の形態の経路生成装置110及び走行制御装置100において、経路演算部114は以上のように動作する。本実施の形態の経路生成装置110及び走行制御装置100によれば、第1の点列に含まれる各点の配置間隔と、第2の点列に含まれる各点の配置間隔とが異なっている場合であっても、車線変更の際に最適な目標経路を容易に生成することができ、搭乗者の違和感を低減することができる。また、本実施の形態の経路生成装置110及び走行制御装置100は、第1の点列及び第2の点列のうち、点の配置間隔が狭い方の点列から基準点B(t)を抽出し、基準点B(t)のそれぞれに対応して目標点R(t)を生成する。したがって、本実施の形態の経路生成装置110及び走行制御装置100によれば、車線変更の際の目標経路を表す第3の点列において、目標点R(t)の配置密度を低下させることなく、適切な経路生成が可能となる。また、本実施の形態の経路生成装置110及び走行制御装置100は、実施の形態1及び実施の形態2で述べた効果も有する。
1、1a、1b 自車両、2 GPS受信機、3 地図配信装置、4 速度センサ、5 ヨーレートセンサ、6 運転支援ECU、7 操舵ECU、8 操舵機構、10 走行制御システム、21a、21b、21c 区画線、22a 第1の経路、22b 第2の経路、100 走行制御装置、110 経路生成装置、111 位置取得部、112 第1の経路抽出部、113 第2の経路抽出部、114 経路演算部、120 制御量演算部、210 速度検出部、220 ヨーレート検出部、230 位置検出部、240 地図配信部、300 操舵部。
Claims (9)
- 車両が車線変更を行う際の目標経路を生成する経路生成装置であって、
前記車両の位置情報を取得する位置取得部と、
前記車両の位置情報と外部から取得される地図情報とに基づいて、前記車線変更を開始する前に前記車両が走行している車線を前記車両が走行し続けると仮定した場合の目標経路を第1の点列として抽出する第1の経路抽出部と、
前記車両の位置情報と前記地図情報とに基づいて、前記車線変更を完了した後に前記車両が走行する隣接車線を前記車両が現在走行していると仮定し、前記車両が前記隣接車線を走行し続けると仮定した場合の目標経路を第2の点列として抽出する第2の経路抽出部と、
前記第1の点列と前記第2の点列とに基づいて前記車両が前記車線変更を行う際の目標経路を第3の点列として算出する経路演算部とを備え、
前記経路演算部は、前記第1の点列と前記第2の点列との間に前記第3の点列が位置するように、前記第3の点列を算出する経路生成装置。 - 前記経路演算部は、
前記第1の点列を結ぶ線及び前記第2の点列を結ぶ線のうちの一方の線上に、複数の基準点を生成し、
前記第1の点列を結ぶ線及び前記第2の点列を結ぶ線のうちの他方の線上に、前記基準点に1対1に対応する複数の対応点を生成し、
前記基準点と前記対応点とを結ぶ線分上に、前記第3の点列に含まれる1点を目標点として生成するとともに、
前記基準点と前記対応点との間の距離に対する、前記基準点と前記目標点との間の距離の比率が、前記車両が前記車線変更を開始してからの経過時間に応じて変化するように前記目標点の位置を算出する、
請求項1に記載の経路生成装置。 - 前記経路演算部は、前記車両が前記車線変更を開始してからの経過時間に対して、距離の比率の変化の軌跡がクロソイド曲線となるように前記目標点の位置を算出する、請求項2に記載の経路生成装置。
- 前記経路演算部は、前記第1の点列及び前記第2の点列の一方の点列から前記基準点を抽出し、前記第1の点列及び前記第2の点列の他方の点列から前記基準点のそれぞれに最も近い点を前記対応点として抽出する、請求項2または請求項3に記載の経路生成装置。
- 前記経路演算部は、前記第1の点列及び前記第2の点列の一方の点列から前記基準点を抽出し、前記第1の点列及び前記第2の点列の他方の点列を結んだ線上で、前記基準点のそれぞれに最も近い点を前記対応点として算出する、請求項2または請求項3に記載の経路生成装置。
- 前記経路演算部は、前記第1の点列及び前記第2の点列の一方の点列から前記基準点を抽出し、前記第1の点列及び前記第2の点列の他方の点列に含まれる複数の点を結んだ直線に、前記基準点から下ろした垂線の足を前記対応点として算出する、請求項2または請求項3に記載の経路生成装置。
- 前記経路演算部は、前記第1の点列及び前記第2の点列のうち、所定の区間に存在する点の数が多い方の点列から前記基準点を抽出する、請求項5または請求項6に記載の経路生成装置。
- 請求項1から請求項7のいずれか1項に記載の経路生成装置と、
前記経路生成装置で求められた前記目標経路に沿って前記車両が走行する目標舵角を前記車両の制御量として算出する制御量演算部と
を備える走行制御装置。 - 車両が車線変更を行う際の目標経路を生成する経路生成方法であって、
前記車両の位置情報を取得するステップと、
前記車両の位置情報と外部から取得される地図情報とに基づいて、前記車線変更を開始する前に前記車両が走行している車線を前記車両が走行し続けると仮定した場合の目標経路を第1の点列として抽出するステップと、
前記車両の位置情報と前記地図情報とに基づいて、前記車線変更を完了した後に前記車両が走行する隣接車線を前記車両が現在走行していると仮定し、前記車両が前記隣接車線を走行し続けると仮定した場合の目標経路を第2の点列として抽出するステップと、
前記第1の点列と前記第2の点列とに基づいて前記車両が前記車線変更を行う際の目標経路を第3の点列として算出するステップとを備え、
前記目標経路を前記第3の点列として算出するステップにおいて、前記第1の点列と前記第2の点列との間に前記第3の点列が位置するように、前記第3の点列を算出する経路生成方法。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018546054A JP6428985B1 (ja) | 2018-03-26 | 2018-03-26 | 経路生成装置、経路生成方法及び走行制御装置 |
US16/980,863 US11365977B2 (en) | 2018-03-26 | 2018-03-26 | Route generation device, route generation method and travel control device |
CN201880091088.9A CN111886168B (zh) | 2018-03-26 | 2018-03-26 | 路径生成装置、路径生成方法以及行驶控制装置 |
DE112018007128.6T DE112018007128B4 (de) | 2018-03-26 | 2018-03-26 | Routenerzeugungsvorrichtung, routenerzeugungsverfahren und fahrsteuerungsvorrichtung |
PCT/JP2018/011998 WO2019186617A1 (ja) | 2018-03-26 | 2018-03-26 | 経路生成装置、経路生成方法及び走行制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2018/011998 WO2019186617A1 (ja) | 2018-03-26 | 2018-03-26 | 経路生成装置、経路生成方法及び走行制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2019186617A1 true WO2019186617A1 (ja) | 2019-10-03 |
Family
ID=64480470
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2018/011998 WO2019186617A1 (ja) | 2018-03-26 | 2018-03-26 | 経路生成装置、経路生成方法及び走行制御装置 |
Country Status (5)
Country | Link |
---|---|
US (1) | US11365977B2 (ja) |
JP (1) | JP6428985B1 (ja) |
CN (1) | CN111886168B (ja) |
DE (1) | DE112018007128B4 (ja) |
WO (1) | WO2019186617A1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2022259552A1 (ja) * | 2021-06-11 | 2022-12-15 | 日産自動車株式会社 | 車両制御方法及び車両制御装置 |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE112020000925T5 (de) * | 2019-02-25 | 2021-11-04 | Mobileye Vision Technologies Ltd. | Systeme und verfahren zur fahrzeugnavigation |
CN110641463A (zh) * | 2019-10-30 | 2020-01-03 | 山东理工大学 | 一种农业机械自动转向装置 |
JP7276112B2 (ja) * | 2019-12-19 | 2023-05-18 | トヨタ自動車株式会社 | 車線変更決定装置 |
JP7521490B2 (ja) * | 2021-06-04 | 2024-07-24 | トヨタ自動車株式会社 | 情報処理サーバ、情報処理サーバの処理方法、プログラム |
US20240326816A1 (en) * | 2023-03-31 | 2024-10-03 | Torc Robotics, Inc. | Lane change path generation using piecewise clothoid segments |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10297516A (ja) * | 1997-04-28 | 1998-11-10 | Nissan Motor Co Ltd | 車両の自動操舵装置 |
JP2008149855A (ja) * | 2006-12-15 | 2008-07-03 | Toyota Motor Corp | 車両の目標進路変更軌跡生成装置 |
JP2015058890A (ja) * | 2013-09-20 | 2015-03-30 | 株式会社デンソー | 走行軌道生成装置、および走行軌道生成プログラム |
JP2017081425A (ja) * | 2015-10-28 | 2017-05-18 | 本田技研工業株式会社 | 車両制御装置、車両制御方法、および車両制御プログラム |
JP2018017713A (ja) * | 2016-11-25 | 2018-02-01 | 株式会社ゼンリン | 制御システム及び制御システムに用いられる地図データのデータ構造 |
JP2018024345A (ja) * | 2016-08-10 | 2018-02-15 | 株式会社Subaru | 車両の走行制御装置 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102006040334A1 (de) | 2006-08-29 | 2008-03-06 | Robert Bosch Gmbh | Verfahren für die Spurerfassung mit einem Fahrerassistenzsystem und Fahrerassistenzsystem |
JP2009040267A (ja) | 2007-08-09 | 2009-02-26 | Toyota Motor Corp | 走行制御装置 |
JP5251467B2 (ja) * | 2008-12-04 | 2013-07-31 | 日産自動車株式会社 | 車両用の情報提供装置及び情報提供方法 |
DE102010002067A1 (de) | 2010-02-18 | 2011-08-18 | ZF Lenksysteme GmbH, 73527 | Fahrerassistenzverfahren für ein Kraftfahrzeug mit einer Spurführungsassistenzfunktion |
WO2016110732A1 (ja) * | 2015-01-05 | 2016-07-14 | 日産自動車株式会社 | 目標経路生成装置および走行制御装置 |
DE112016003285B4 (de) * | 2015-07-22 | 2022-12-22 | Honda Motor Co., Ltd. | Routengenerator, Routenerzeugungsverfahren und Routenerzeugungsprogramm |
WO2017047261A1 (ja) | 2015-09-17 | 2017-03-23 | 日立オートモティブシステムズ株式会社 | 車線変更制御装置 |
JP6638556B2 (ja) * | 2016-05-20 | 2020-01-29 | アイシン・エィ・ダブリュ株式会社 | 自動運転支援装置及びコンピュータプログラム |
-
2018
- 2018-03-26 DE DE112018007128.6T patent/DE112018007128B4/de active Active
- 2018-03-26 US US16/980,863 patent/US11365977B2/en active Active
- 2018-03-26 JP JP2018546054A patent/JP6428985B1/ja active Active
- 2018-03-26 CN CN201880091088.9A patent/CN111886168B/zh active Active
- 2018-03-26 WO PCT/JP2018/011998 patent/WO2019186617A1/ja active Application Filing
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10297516A (ja) * | 1997-04-28 | 1998-11-10 | Nissan Motor Co Ltd | 車両の自動操舵装置 |
JP2008149855A (ja) * | 2006-12-15 | 2008-07-03 | Toyota Motor Corp | 車両の目標進路変更軌跡生成装置 |
JP2015058890A (ja) * | 2013-09-20 | 2015-03-30 | 株式会社デンソー | 走行軌道生成装置、および走行軌道生成プログラム |
JP2017081425A (ja) * | 2015-10-28 | 2017-05-18 | 本田技研工業株式会社 | 車両制御装置、車両制御方法、および車両制御プログラム |
JP2018024345A (ja) * | 2016-08-10 | 2018-02-15 | 株式会社Subaru | 車両の走行制御装置 |
JP2018017713A (ja) * | 2016-11-25 | 2018-02-01 | 株式会社ゼンリン | 制御システム及び制御システムに用いられる地図データのデータ構造 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2022259552A1 (ja) * | 2021-06-11 | 2022-12-15 | 日産自動車株式会社 | 車両制御方法及び車両制御装置 |
CN117425588A (zh) * | 2021-06-11 | 2024-01-19 | 日产自动车株式会社 | 车辆控制方法及车辆控制装置 |
JP7521701B2 (ja) | 2021-06-11 | 2024-07-24 | 日産自動車株式会社 | 車両制御方法及び車両制御装置 |
US12049271B1 (en) | 2021-06-11 | 2024-07-30 | Nissan Motor Co., Ltd. | Vehicle control method and vehicle control device |
Also Published As
Publication number | Publication date |
---|---|
JP6428985B1 (ja) | 2018-11-28 |
US11365977B2 (en) | 2022-06-21 |
CN111886168B (zh) | 2023-04-07 |
US20210003410A1 (en) | 2021-01-07 |
CN111886168A (zh) | 2020-11-03 |
DE112018007128T5 (de) | 2020-11-05 |
JPWO2019186617A1 (ja) | 2020-04-30 |
DE112018007128B4 (de) | 2022-04-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6428985B1 (ja) | 経路生成装置、経路生成方法及び走行制御装置 | |
RU2732634C1 (ru) | Способ помощи в путешествии и устройство помощи в путешествии | |
CN110121449B (zh) | 车辆控制装置、车辆控制方法及存储介质 | |
EP3243685B1 (en) | Target vehicle speed generation device and drive control device | |
US10001782B2 (en) | Target pathway generating device and driving control device | |
US11474525B2 (en) | Method and apparatus for method for dynamic multi-segment path and speed profile shaping | |
JP7349561B2 (ja) | 地図情報補正方法、運転支援方法及び地図情報補正装置 | |
JP2018177121A (ja) | 自動運転システム | |
KR20190016690A (ko) | 차량의 주행 제어 방법 및 장치 | |
JPWO2020025991A1 (ja) | 走行軌跡補正方法、走行制御方法、及び走行軌跡補正装置 | |
JP6610799B2 (ja) | 車両の走行制御方法および走行制御装置 | |
CN110959100A (zh) | 行驶辅助方法及行驶辅助装置 | |
RU2743519C1 (ru) | Способ помощи при вождении и устройство помощи при вождении | |
US12084109B2 (en) | Vehicle control device | |
JP7276112B2 (ja) | 車線変更決定装置 | |
EP3985641B1 (en) | Travel assistance method and travel assistance device | |
JP7202982B2 (ja) | 運転支援方法及び運転支援装置 | |
EP4119409A1 (en) | Travel route setting method and travel route setting device | |
CN110770542B (zh) | 信息管理装置 | |
CN115379975A (zh) | 车辆运动控制装置及车辆运动控制方法 | |
JP7433091B2 (ja) | 走行経路の設定方法、及び、走行経路の設定装置 | |
JP7506999B2 (ja) | 走行支援方法、及び、走行支援装置 | |
JP7475188B2 (ja) | 走行支援方法、及び、走行支援装置 | |
WO2023032092A1 (ja) | 車両制御方法及び車両制御装置 | |
JP7321034B2 (ja) | 走行支援方法及び走行支援装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
ENP | Entry into the national phase |
Ref document number: 2018546054 Country of ref document: JP Kind code of ref document: A |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 18912805 Country of ref document: EP Kind code of ref document: A1 |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 18912805 Country of ref document: EP Kind code of ref document: A1 |