WO2022070290A1 - 走行経路生成装置及び走行経路生成方法 - Google Patents

走行経路生成装置及び走行経路生成方法 Download PDF

Info

Publication number
WO2022070290A1
WO2022070290A1 PCT/JP2020/037070 JP2020037070W WO2022070290A1 WO 2022070290 A1 WO2022070290 A1 WO 2022070290A1 JP 2020037070 W JP2020037070 W JP 2020037070W WO 2022070290 A1 WO2022070290 A1 WO 2022070290A1
Authority
WO
WIPO (PCT)
Prior art keywords
lane
lane marking
marking
travel route
information
Prior art date
Application number
PCT/JP2020/037070
Other languages
English (en)
French (fr)
Inventor
祐子 大曲
雅也 遠藤
知輝 鵜生
Original Assignee
三菱電機株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 三菱電機株式会社 filed Critical 三菱電機株式会社
Priority to US18/006,786 priority Critical patent/US20230294700A1/en
Priority to JP2022553288A priority patent/JP7353511B2/ja
Priority to PCT/JP2020/037070 priority patent/WO2022070290A1/ja
Priority to CN202080105238.4A priority patent/CN116113567A/zh
Priority to DE112020007646.6T priority patent/DE112020007646T5/de
Publication of WO2022070290A1 publication Critical patent/WO2022070290A1/ja

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18163Lane change; Overtaking manoeuvres
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W10/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/20Conjoint control of vehicle sub-units of different type or different function including control of steering systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/10Path keeping
    • B60W30/12Lane keeping
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/50Context or environment of the image
    • G06V20/56Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/588Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/10Number of lanes
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/30Road curve radius
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/53Road markings, e.g. lane marker or crosswalk

Definitions

  • the present application relates to a travel route generation device and a travel route generation method.
  • a vehicle control device that generates a traveling route for changing lanes and changes the lane of the own vehicle.
  • a traveling route for changing lanes is generated in advance at the start of lane change based on the lane marking information of the lane change destination acquired at the start of lane change.
  • the lane marking information ahead of the maximum distance that can be detected by the camera or radar has low accuracy, and as in Patent Document 1, the distant part in the travel path generated in advance at the start of the lane change is reliable. There was the problem of being low. Further, when the lane marking information cannot be acquired due to an obstacle or the like at the start of the lane change, there is a problem that the accuracy of the traveling route generated in advance at the start of the lane change is low.
  • the present application provides a travel route generation device and a travel route generation method capable of accurately generating a travel route for changing a lane by using the latest lane marking information obtained during a lane change. I am aiming.
  • the traveling route generator is Each recognizable single or multiple lane lane marking in front of the own vehicle, including the own lane that is the lane in which the own vehicle is traveling and the lane adjacent to the own lane, based on the position of the own vehicle.
  • a lane marking information acquisition unit that acquires lane marking information regarding the position and shape of the lane marking
  • a travel path recognition unit that determines the correspondence between each lane and its own lane based on the lane information of each lane.
  • whether or not the lane marking information of each lane marking is valid lane marking information that can be used to generate a lane change driving route that is a driving route for changing lanes.
  • Judgment lane marking information validity judgment unit and During the lane change, one lane marking from the left lane marking and the right lane marking of the own lane is used as a reference section based on the validity determination result of the lane marking information of each lane marking by the lane marking information validity determination unit.
  • the reference lane line selection section to be selected as a line, and It is provided with a travel route generation unit that generates the lane change travel route, which is a travel route for changing the lane, based on the lane marking information of the reference lane during the lane change.
  • the traveling route generation method is Each recognizable single or multiple lane lane marking in front of the own vehicle, including the own lane that is the lane in which the own vehicle is traveling and the lane adjacent to the own lane, based on the position of the own vehicle.
  • the lane marking information acquisition step for acquiring lane marking information regarding the position and shape of the lane marking
  • a travel path recognition step for determining the correspondence between each lane and the own lane based on the lane information of each lane.
  • whether or not the lane marking information of each lane marking is valid lane marking information that can be used to generate a lane change driving route that is a driving route for changing lanes.
  • Judgment lane marking information valid judgment step and During the lane change, one lane marking from the left lane marking and the right lane marking of the own lane is used as a reference section based on the validity determination result of the lane marking information of each lane marking in the lane marking information validity determination step.
  • the reference lane selection step to select as a line, and It is provided with a travel route generation step for generating the lane change travel route, which is a travel route for changing the lane, based on the lane marking information of the reference lane during the lane change.
  • the travel route generation device and the travel route generation method According to the travel route generation device and the travel route generation method according to the present application, the latest lane marking information of each lane that is sequentially obtained during the lane change, and the lane markings on the left and right sides of the own lane based on the validity determination result.
  • a lane change driving route is generated based on the lane marking information of the reference lane marking selected from. Therefore, it is possible to accurately generate a lane change traveling route based on the latest lane marking information obtained sequentially during the lane change.
  • FIG. 1 It is a schematic block diagram of the traveling route generation apparatus which concerns on Embodiment 1.
  • FIG. It is a hardware block diagram of the travel path generation apparatus which concerns on Embodiment 1.
  • FIG. It is a hardware block diagram of the travel path generation apparatus which concerns on Embodiment 1.
  • FIG. It is a flowchart explaining the schematic process of the traveling route generation apparatus which concerns on Embodiment 1. It is a figure explaining the own vehicle coordinate system and the like which concerns on Embodiment 1. It is a figure explaining the division line information which concerns on Embodiment 1.
  • FIG. It is a figure explaining the lane marking information of own lane which concerns on Embodiment 1, and own vehicle travel route. It is a figure explaining the lane change which concerns on Embodiment 1.
  • FIG. 1 It is a schematic block diagram of the traveling route generation apparatus which concerns on Embodiment 1.
  • FIG. It is a hardware block diagram of the travel path generation apparatus which concerns on Embodiment 1.
  • FIG. It is a flow
  • FIG. It is a time chart explaining the change of the correspondence relation between the own lane and each section line by the lane change which concerns on Embodiment 1.
  • FIG. It is a figure for demonstrating the validity determination of the division line information which concerns on Embodiment 1. It is a figure for demonstrating the result of the validity determination of the lane marking information which concerns on Embodiment 1.
  • FIG. It is a figure for demonstrating the generation of the lane change traveling path which concerns on Embodiment 2.
  • FIG. 1 is a schematic block diagram of the traveling route generation device 10.
  • the travel route generation device 10 is a processing unit such as a division line information acquisition unit 11, a travel route recognition unit 12, a division line information validity determination unit 13, a reference division line selection unit 14, a travel route generation unit 15, and a steering control unit 16. It is equipped with.
  • Each process of the travel route generation device 10 is realized by a processing circuit provided in the travel route generation device 10. Specifically, as shown in FIG. 2, the traveling route generation device 10 inputs / outputs external signals to / from an arithmetic processing unit 90 such as a CPU (Central Processing Unit), a storage device 91, and an arithmetic processing unit 90. It is equipped with a device 92 and the like.
  • an arithmetic processing unit 90 such as a CPU (Central Processing Unit), a storage device 91, and an arithmetic processing unit 90. It is equipped with a device 92 and the like.
  • the storage device 91 includes a RAM (Random Access Memory) configured to be able to read and write data from the arithmetic processing device 90, a ROM (Read Only Memory) configured to be able to read data from the arithmetic processing device 90, and the like. Has been done.
  • various storage devices such as a flash memory, an EEPROM (Electrically Erasable Programmable Read Only Memory), a hard disk, and a DVD device may be used.
  • the input / output device 92 is provided with a communication device, an A / D converter, an input / output port, a drive circuit, and the like.
  • the input / output device 92 is connected to a peripheral monitoring device 31, a vehicle speed detection device 32, a steering device 24, a driving support system 25, and the like, and communicates with these devices.
  • the arithmetic processing unit 90 executes software (program) stored in the storage device 91 such as a ROM, and enters the storage device 91 and the input. It is realized by cooperating with other hardware of the travel path generation device 10 such as the output device 92.
  • the setting data such as the determination value used by each of the processing units 11 to 16 and the like is stored in a storage device 91 such as a ROM as a part of the software (program).
  • a storage device 91 such as a ROM as a part of the software (program).
  • the travel path generator 10 may include dedicated hardware 93, such as a single circuit, a composite circuit, a programmed processor, a parallel programmed processor, an ASIC, as a processing circuit.
  • dedicated hardware 93 such as a single circuit, a composite circuit, a programmed processor, a parallel programmed processor, an ASIC, as a processing circuit.
  • An FPGA, a GPU, an AI chip, or a circuit combining these may be provided.
  • FIG. 4 is a schematic flowchart for explaining a processing procedure (travel route generation method) of the travel route generation device 10 according to the present embodiment.
  • the processing of the flowchart of FIG. 4 is repeatedly executed at predetermined calculation cycles by the arithmetic processing unit 90 executing software (program) stored in the storage device 91.
  • the calculation cycle is set to, for example, 0.01 seconds.
  • the lane marking information acquisition unit 11 has a recognizable single or a plurality of lanes in front of the own vehicle, including the own lane in which the own vehicle is traveling and a lane adjacent to the own lane.
  • the lane marking information acquisition process (lane lane information acquisition step) for acquiring the lane marking information regarding the position and shape of each lane marking with respect to the position of the own vehicle is executed.
  • the lane marking information acquisition unit 11 detects a recognizable lane marking based on the detection information of the peripheral monitoring device 31 and acquires the lane marking information.
  • the peripheral monitoring device 31 includes a camera that monitors the front of the vehicle. Various known image processes are performed on the image captured by the camera, and the lane markings are recognized.
  • the lane marking is mainly a white line, but the lane marking is not limited to the white line, and roadside objects such as guardrails, poles, shoulders, and walls may be recognized as the lane marking.
  • a laser radar may be used as the peripheral monitoring device 31, and a white line may be recognized from a point where the brightness of the reflection of the laser radar is high.
  • the lane marking information acquisition unit 11 acquires lane marking information regarding the position and shape of each recognized lane marking in the own vehicle coordinate system.
  • the coordinate system of the own vehicle is a coordinate system in which the front direction and the lateral direction of the own vehicle are two coordinate axes X and Y.
  • the origin of the own vehicle coordinate system is set at the center of the own vehicle such as the neutral steer point.
  • the left side in the horizontal direction is positive and the right side is negative.
  • the division line information acquisition unit 11 uses the division line information of each division line as the distance between the own vehicle and the portion of the division line located in the lateral direction of the own vehicle.
  • the information including the lane marking distance K0, the lane marking angle K1 which is the inclination of the portion of the lane marking located in the lateral direction of the own vehicle with respect to the traveling direction of the own vehicle, and the curvature K2 of the lane marking is acquired.
  • the lane marking information further includes the curvature change rate K3 of the lane marking. Using the parameters K0 to K3 of these lane marking information, the position of each lane marking in the own vehicle coordinate system can be calculated by the following equation.
  • each lane marking is approximated by an approximate expression in which the lateral position Y of the lane marking in the own vehicle coordinate system is expressed by a cubic polynomial with the position X in the front direction as a variable, and the coefficient of each degree is the lane marking. It is acquired as parameters K0 to K3 representing line information. In addition, it may be approximated by a quadratic polynomial without a cubic term of the curvature change rate K3.
  • the lane marking information acquisition unit 11 acquires not only the lane markings on the left and right of the own lane but also the lane marking information of the lane adjacent to the own lane.
  • the division line information acquisition unit 11 transmits information related to the accuracy of the division line information of each division line to the division line information validity determination unit 13. For example, the original lane markings (white lines, etc.) detected by the peripheral monitoring device 31 and used to calculate the lane marking information (in this example, the coefficients K0, K1, K2, K3 of the approximate curve of the equation (1)). Information on the length (in this example, the distance in front of the own vehicle) is transmitted to the lane marking information validity determination unit 13. Further, information on the degree of coincidence between the original lane marking and the approximation curve detected by the peripheral monitoring device 31, that is, the approximation accuracy is also transmitted to the lane marking information validity determination unit 13. In addition, information on the certainty of recognition of the detected original lane marking is also transmitted to the lane marking information validity determination unit 13.
  • step S02 of FIG. 4 the travel path recognition unit 12 executes a travel path recognition process (travel path recognition step) for determining the correspondence between each lane marking and the own lane based on the lane marking information of each lane marking. do.
  • the travel path recognition unit 12 also determines the correspondence between each lane and the adjacent lane adjacent to the own lane based on the lane information of each lane. Further, the travel path recognition unit 12 determines whether or not the own vehicle straddles the lane marking that separates the lane before the lane change and the lane after the lane change, based on the lane marking information of each lane marking.
  • the lane recognition unit 12 changes the correspondence between each lane and the own lane so that when the own vehicle crosses the lane, the lane changes from the lane before the lane to the lane after the lane. do.
  • the determination result is transmitted to the section line information validity determination unit 13, the traveling route generation unit 15, and the like, which will be described later.
  • the travel path recognition unit 12 has the lane marking information (in this example, the lane marking distance K0, the lane marking) of the lane marking (left first lane marking L1) on the left side of the own lane. Based on the line angle K1, the curvature K2 of the lane marking, and the curvature change rate K3) of the lane marking, the shape of the lane marking on the left side of the own vehicle in the own vehicle coordinate system corresponding to the current position of the own vehicle is recognized.
  • the travel path recognition unit 12 has lane marking information (in this example, lane marking distance K0, lane marking angle K1, lane marking curvature K2, and lane marking) on the right lane marking line (right first lane marking R1). The shape of the lane marking on the right side of the own vehicle is recognized based on the curvature change rate K3).
  • the travel path recognition unit 12 recognizes the correspondence between the own lane and each lane marking based on the lane marking distance K0 of each lane marking acquired this time.
  • the travel path recognition unit 12 determines that the lane marking closest to the own vehicle on the right side of the lane marking is the lane marking on the right side of the own lane (right first lane marking R1) within the lane marking distance K0 of each lane marking. Recognize that, of the lane marking distance K0 of each lane marking, the lane marking closest to the own vehicle on the left side of the own lane is the lane marking on the left side of the own lane (left first lane marking L1).
  • the travel path recognition unit 12 sets the lane marking with the smallest lane marking distance K0 among the lane markings having a positive lane marking distance K0 as the left lane corresponding to the left lane marking of the own lane.
  • the lane marking line L1 is recognized
  • the lane marking with the second smallest lane marking distance K0 is recognized as the left second lane marking L2
  • the lane marking with the third smallest lane marking distance K0 is recognized as the left third lane marking L3.
  • the traveling path recognition unit 12 sets the lane marking having the smallest absolute value of the lane marking distance K0 among the lane markings having a negative lane marking distance K0 as the first right lane marking corresponding to the right lane marking of the own lane.
  • the lane marking line R1 is recognized, the lane marking line having the second smallest absolute value of the lane marking distance K0 is recognized as the right second lane marking line R2, and the lane marking line having the third smallest absolute value of the lane marking distance K0 is recognized as the third right lane marking line. Recognized as lane marking R3.
  • FIGS. 8 and 9 show the behavior when the own vehicle traveling in the center lane of a road with three lanes on each side changes lanes to the right lane.
  • FIG. 8 shows the behavior of the own vehicle when the road is used as a reference
  • FIG. 9 shows a time chart of the division line distance K0 of each section line.
  • the own vehicle is traveling in the central lane, and the lane marking distance K0 of the left first lane L1 and the lane marking distance K0 of the right first lane R1 are half the lane width W2 of the central lane. It has become.
  • the absolute value of the lane marking distance K0 of the right first lane marking R1 decreases, and the lane marking distance K0 of the left first lane marking L1 increases.
  • the division line distance K0 of the division line recognized as the right first division line R1 becomes a positive value, and among the division lines in which the division line distance K0 has a positive value, the division line distance K0 is the smallest lane marking line and is recognized as the left first lane marking line L1. Further, at time t1, the division line distance K0 of the division line recognized as the left first division line L1 is the second division line distance K0 among the division lines in which the division line distance K0 is a positive value. It becomes a small lane marking line and is recognized as the left second lane marking line L2.
  • the division line distance K0 of the division line recognized as the right second division line R2 is the most absolute value of the division line distance K0 among the division lines in which the division line distance K0 is a negative value. It becomes a small lane marking line and is recognized as the first lane marking line R1 on the right.
  • the travel path recognition unit 12 deviates from the previously acquired lane marking distance K0R1_old of the right first lane marking R1 and the newly acquired lane marking distance K0R1 of the right first lane marking R1.
  • ⁇ K0R1 is within the range corresponding to the lane width when the lane is changed to the right lane (condition 1), or the lane marking distance K0L1_old of the left first lane L1 acquired last time is acquired this time.
  • the range corresponding to the lane width of condition 1 is set to -W3- ⁇ W to -W3 + ⁇ W.
  • W3 is set to the lane width of the lane to which the lane is changed on the right side. It is set to the deviation from.
  • the range corresponding to the lane width of the condition 2 is set to ⁇ W2- ⁇ W to ⁇ W2 + ⁇ W.
  • W2 is set to the lane width of the own lane before the lane change. Is set to the deviation of. ⁇ W may be set to a predetermined value such as 0.1 m, or may be set to a predetermined ratio such as 10% of the lane width W3 or the lane width W2.
  • the travel path recognition unit 12 has the right first section line R1 acquired last time, the section line distance K0R1_old is closer to 0 than the determination value ⁇ Wm, and the previously acquired right first section line R1 has.
  • the deviation ⁇ K0R1 between the lane marking distance K0R1_old of the line R1 and the lane marking distance K0R1 of the right first lane marking R1 acquired this time is within the range corresponding to the lane width when the lane is changed to the right ( Condition 1), or the previously acquired division line distance K0L1_old of the left first division line L1 is closer to the lane width W2 than the judgment value ⁇ Wm, and the previously acquired division line distance K0L1_old of the left first division line L1 and this time.
  • condition 2 When the deviation ⁇ K0L1 from the acquired lane marking distance K0L1 of the left first lane line L1 is within the range corresponding to the lane width when the lane is changed to the right side (condition 2), the own vehicle is on the right side. It may be determined that the lane has been changed to the right lane by straddling the lane markings.
  • ⁇ K0R1 K0R1-K0R1_old
  • ⁇ K0L1 K0L1-K0L1_old Condition 1) - ⁇ Wm ⁇ K0R1_old ⁇ Wm And -W3- ⁇ W ⁇ K0R1 ⁇ -W3 + ⁇ W Or condition 2) W2- ⁇ Wm ⁇ K0L1_old ⁇ W2 + ⁇ Wm And -W2- ⁇ W ⁇ K0L1 ⁇ -W2 + ⁇ W If is true, Judging that the lane has changed to the right lane ... (3)
  • ⁇ Wm may be set to the same value as ⁇ W or may be set to a different value.
  • the speed at which the own vehicle approaches the lane marking line may be calculated based on the vehicle speed and the lane marking angle K1 of the lane marking line, and ⁇ Wm and ⁇ W may be set according to the approaching speed to the lane marking line. For example, when the approach speed to the lane marking is high, the amount of change in the lane marking distance K0 between the calculation cycles becomes large, and before and after straddling the lane marking, the lane marking distance K0 changes beyond the determination range, and the division line distance K0 changes. There is a possibility that the line straddle determination is not performed, but by changing the determination range according to the approach speed to the lane marking line, it is possible to reliably determine the lane crossing determination.
  • the driving path recognition unit 12 has a deviation ⁇ K0L1 between the previously acquired lane marking distance K0L1_old of the left first lane line L1 and the newly acquired lane marking distance K0L1 of the left first lane line L1. ,
  • the range corresponds to the lane width when the lane is changed to the left lane (Condition 3), or the lane marking distance K0R1_old of the right first lane R1 acquired last time and the right lane acquired this time.
  • the range corresponding to the lane width of condition 3 is set to W1- ⁇ W to W1 + ⁇ W.
  • W1 is set to the lane width of the lane to which the left lane is changed. It is set to the deviation from.
  • the range corresponding to the lane width of the condition 4 is set to W2- ⁇ W to W2 + ⁇ W.
  • ⁇ W may be set to a predetermined value such as 0.1 m, or may be set to a predetermined ratio such as 10% of the lane width W1 or the lane width W2.
  • the travel path recognition unit 12 has the left first section line L1 acquired last time, the section line distance K0L1_old is closer to 0 than the determination value ⁇ Wm, and the left first section previously acquired.
  • the deviation ⁇ K0L1 between the lane marking distance K0L1_old of the line L1 and the lane marking distance K0L1 of the left first lane marking L1 acquired this time is within the range corresponding to the lane width when the lane is changed to the left side ( Condition 3), or the previously acquired division line distance K0R1_old of the right first division line R1 is closer to the lane width W2 than the judgment value ⁇ Wm, and the previously acquired division line distance K0R1_old of the right first division line R1 and this time.
  • condition 4 When the deviation ⁇ K0R1 from the acquired lane marking distance K0R1 of the right first lane line R1 is within the range corresponding to the lane width when the lane is changed to the left side (condition 4), the own vehicle is on the left side. It may be determined that the lane has been changed to the left lane by straddling the lane markings.
  • step S03 of FIG. 4 the lane marking information validity determination unit 13 generates a lane change traveling route, which is a traveling route for changing the lane for each of the lane marking information of each lane marking, while the lane change of the own vehicle is in progress. It is determined whether or not the lane marking information is valid and can be used for (the lane marking information validity determination step).
  • the lane marking information validity determination unit 13 continuously determines the validity of the lane marking information of each lane marking every time the lane marking information of each lane marking is obtained during the lane change.
  • the own vehicle is equipped with a driving support system 25 that automatically changes lanes.
  • the driving support system 25 determines that the vehicle is changing lanes to the right or left lane for driving to the destination or due to the surrounding driving conditions and is executing the lane change, the lane change is being executed. Is determined.
  • the driving support system 25 determines that the lane change is to be carried out, the driving support system 25 turns on the turn signal according to the direction of the lane change.
  • the lane marking information validity determination unit 13 determines whether or not each lane marking information is valid based on the lane marking information of each lane marking recognized by the travel path recognition unit 12.
  • FIG. 10 is a diagram showing an example of the division line information validity determination process. There are 3 lanes on each side, and the right lane branches off in the middle. During the period from time t0 to time t2, the own vehicle has changed lanes from the center lane to the right lane. At time t1, the own vehicle straddles the lane marking that separates the center lane and the right lane by changing lanes.
  • the lane marking information validity determination unit 13 validates the lane marking information of each lane marking based on the information related to the accuracy of the lane marking information of each lane marking transmitted from the lane marking information acquisition unit 11. Judge the sex. For example, the lane marking information validity determination unit 13 determines the length VR of the original lane marking (white line, etc.) detected by the peripheral monitoring device 31 such as a camera or a laser radar for the lane marking information of each lane marking (in this example). , When the distance VR in front of the own vehicle is longer than the determination length VRth, it is determined that the lane marking information is valid, and when the length VR is shorter than the determination length VRth, the lane marking information is Determined to be invalid.
  • the original lane marking VR is long and the lane marking information in front of the own vehicle is highly reliable, and the lane marking information is judged to be effective and used for generating the lane change driving route. Can be done.
  • the lengths of the original lane markings of the left first lane line L1, the right first lane line R1, and the right second lane line R2 are VRL1, VRR1. Since VRR2 is longer than the determination distance VRth, it is determined that the lane marking information of these lane markings L1, R1, and R2 is valid. On the other hand, since the length VRL2 of the original division line of the left second division line L2 is shorter than the determination distance VRth, it is determined that the division line information of this division line L2 is invalid.
  • the lane marking information validity determination unit 13 determines the validity of the lane marking information of each lane marking every time the lane marking information of each lane marking is obtained even after the time t0 during the lane change.
  • the determination distance VRth may be gradually shortened as the elapsed time or the mileage after the lane change increases. It should be noted that the lane marking information is determined to be invalid for the lane marking for which the lane marking information has not been acquired.
  • the division line information validity determination unit 13 may determine the validity of the division line information based on the approximation accuracy of the approximate curve for the division line information of each division line, and is based on the certainty of detection of the original division line. Therefore, the validity of the lane marking information may be determined.
  • the division line information validity determination unit 13 determines whether each division line is a division line of a branch road based on the curvature value K2 of the division line information of each division line, and determines whether each division line is a division line of each division line. The validity of the lane marking information is judged. The lane marking information validity determination unit 13 determines that the lane marking information of the lane marking of the branch road is invalid if the vehicle is not planned to travel on the branch road due to a lane change. When the lane marking information validity determination unit 13 plans to travel on a branch road by changing lanes, the lane marking information validity determination unit 13 determines that the lane marking information of the lane marking of the branch road is valid. In the example of FIG.
  • the curvature value K2R2 of the right second division line R2 is different from the curvature values K2R1, K2L1 and K2L2 of the other division lines by the judgment curvature value or more, and is bent to the right. , It is determined that it is a lane marking of a branch road branching to the right side, and since there is no plan to travel on the right branch road, it is determined that the lane marking information of the right second lane marking R2 is invalid.
  • the shape of the road obtained from the map data may be used to determine whether the road is a branch road.
  • the driving path recognition unit 12 corresponds to each lane and the own lane so that the own lane changes from the central lane before straddling to the right lane after straddling. You are changing the relationship. As described with reference to FIG. 9, the left lane marking line in the central lane is changed from the left first lane marking L1 to the left second lane marking L2, and the right lane marking in the center lane is changed from the right first lane marking R1. It has been changed to the left first lane L1 and the right lane of the right lane has been changed from the right second lane R2 to the right first lane R1.
  • the lane marking information validity determination unit 13 determines the validity of the lane marking information of each lane marking whose correspondence with the own lane has been changed by the same method as before the change.
  • the right first lane marking R1 is determined to be the lane marking of the branch road, and is subsequently determined to be invalid.
  • the determination result of the effectiveness of each section line is associated with each section line associated with the own lane and stored in a storage device such as a RAM. Since each lane marking associated with the own lane changes before and after the time t2 straddling the lane marking, the effectiveness determination result is shifted to the left. As shown in FIG. 11, the effectiveness determination result at each time point during the lane change may be stored in the storage device 91, or only the latest effectiveness determination result may be stored in the storage device 91. good.
  • Reference division line selection unit 14 In step S04 of FIG. 4, the reference lane marking unit 14 changes the lane, and based on the valid determination result of the lane marking information of each lane marking by the lane marking information validity determining unit 13, the lane marking on the left side of the own lane.
  • the reference lane marking process (reference lane selection step) for selecting one lane from (left first lane L1) and right lane (right first lane R1) as a reference lane is executed.
  • the reference lane marking unit 14 continuously refers to one lane line from the left lane and the right lane of the own lane each time the validity determination result of each lane is obtained during the lane change. Select as a lane marking.
  • one lane marking is used as the reference division from the left lane marking and the right lane marking of the changed lane. Select as a line.
  • the reference division line selection unit 14 selects one of the division lines as the reference division line.
  • the reference division line selection unit 14 may be selected as the reference division line when the left first division line L1 and the right first division line R1 have a higher degree of effectiveness.
  • the longer of the original division line length VRL1 of the left first division line L1 and the original division line length VRL1 of the right first division line R1 may be selected as the reference division line.
  • the reference division line selection unit 14 selects one of the determination division lines determined to be valid as the reference division line. .. When it is determined that both the left first division line L1 and the right first division line R1 are not valid, the reference division line selection unit 14 does not select the reference division line. If the reference lane marking is not selected, the lane change driving route is not generated. For example, when the lane change is started, the lane change is not started. During the lane change, the lane change may be interrupted to generate a route along the road, or the lane change may be based on the reference lane that was previously generated when the reference lane was selected. May be continued.
  • Travel route generator 15 In step S05 of FIG. 4, the travel route generation unit 15 generates a travel route generation process, which is a travel route for changing a lane, based on the lane marking information of the reference lane while changing lanes. (Traveling route generation step) is executed. The travel route generation unit 15 periodically generates a lane change travel route based on the latest lane marking information of the reference lane marking acquired during the lane change.
  • FIG. 13 shows an example of changing lanes from the center lane to the right lane.
  • the own vehicle has changed lanes from the center lane to the right lane.
  • the own vehicle straddles the lane marking that separates the center lane and the right lane by changing lanes.
  • step S21 the travel route generation unit 15 generates an own lane travel route, which is a travel route when traveling along the own lane without changing the lane, based on the division line information of the reference lane.
  • the own lane is determined to be the lane before the lane change, and the reference lane marking is set to the left lane marking or the right lane marking of the lane before the lane change.
  • the own lane travel route is a travel route when traveling along the lane before the lane change.
  • the own lane is determined to be the lane after the lane change, and the reference lane marking is set to the lane marking on the left side or the lane marking on the right side of the lane after the lane change.
  • the own lane travel route is a travel route when traveling along the lane after the lane change.
  • the traveling route generation unit 15 draws an approximate curve of the reference lane marking represented by the lane marking information of the reference lane marking in the lateral direction of the own vehicle and the lane of the own lane.
  • the shift width ⁇ Wsft according to the width Wown is shifted to generate the own lane traveling route.
  • the traveling route generation unit 15 shifts the approximate curve of the reference lane marking in the own vehicle coordinate system shown in the equation (1) laterally by the shift width ⁇ Wsft, and travels in the own lane. Set the route Young.
  • the positive / negative of the shift width ⁇ Wsft is changed according to whether the reference lane marking line is the right lane marking line or the left lane marking line so that the own lane traveling route Young is set in the center of the own lane.
  • K0b is the division line distance of the reference division line
  • K1b is the division line angle of the reference division line
  • K2b is the curvature of the reference division line
  • K3b is the curvature change rate of the reference division line. Is.
  • the lane width Wown of the own lane is set based on the lane marking information of the left first lane L1 and the right first lane R1 of the own lane. For example, as shown in the following equation, the lane width Wown of the own lane is set to the difference between the lane marking distance K0L1 of the left first lane marking L1 and the lane marking distance K0R1 of the right first lane marking R1.
  • the lane width Wown of the own lane may be set to the lane width of the corresponding lane acquired in the past. However, it may be set to the lane width obtained from the map data, or may be set to the standard lane width.
  • step S22 the travel route generation unit 15 determines whether or not the lane change is being executed, and if it is determined that the lane change is being executed, the process proceeds to step S23 and it is determined that the lane change is not being executed. If so, the process proceeds to step S26. Since the lane change is not being executed in step S26, the travel route generation unit 15 sets the own lane travel route Young as the final target travel route.
  • step S23 the driving route generation unit 15 starts the lane change, and based on the determination result of the driving road recognition unit 12, the lane before the lane change and the lane after the lane change. It is determined whether or not the own vehicle has crossed the lane marking, and if it is determined that the vehicle has not crossed the lane marking, the process proceeds to step S24 and it is determined that the lane marking has been crossed. If so, the process proceeds to step S25.
  • step S24 before crossing the lane marking, the travel route generation unit 15 generates a lane change travel route that gradually approaches the travel route of the lane after the lane change from the own lane travel route.
  • the travel route generation unit 15 determines the total lateral movement distance Wd, which is the distance for laterally moving the own vehicle from the start to the end of the lane change, based on the lane marking information of each lane marking. calculate. For example, as shown in the following equation, the travel route generation unit 15 adjusts to half the total value of the lane width Wbf of the lane before the lane change and the lane width Waf of the lane after the lane change according to the lane change direction. The value obtained by multiplying +1 or -1 is calculated as the total lateral movement distance Wd. Before crossing the lane marking, the lane before changing lanes is the own lane.
  • the travel route generation unit 15 sets the difference between the lane marking distance K0 on the left side of the lane before the lane change and the lane marking distance K0 on the right side of the lane before the lane change to the lane before the lane change. Calculated as the width Wbf. Further, the traveling route generation unit 15 sets the difference between the lane marking distance K0 on the left side of the lane after the lane change and the lane marking distance K0 on the right side of the lane after the lane change to the lane after the lane change. It is calculated as the lane width Waf of.
  • the lane width Wbf of the lane before the lane change is the lane width of the corresponding lane acquired in the past. It may be set, it may be set to the lane width obtained from the map data, or it may be set to the standard lane width. If one or both lane markings of the right lane and the left lane after the lane change cannot be obtained, the lane width Waf of the lane after the lane change is the lane of the corresponding lane acquired in the past. It may be set to the width, it may be set to the lane width of the corresponding lane obtained from the map data, or it may be set to the standard lane width.
  • the travel route generation unit 15 sets the lateral travel distance Ychg of the own vehicle with respect to the own lane travel route Young, and the forward travel distance Xchg of the own vehicle from the start time of the lane change ( Hereinafter, the vehicle is gradually changed from 0 to the total lateral travel distance Wd according to the forward travel distance Xchg after the start of the lane change), and the lateral travel distance Ychg is added to the own lane travel route Young.
  • the travel route generation unit 15 calculates the lateral travel distance Ychg based on the forward travel distance Xchg after the start of the lane change and the total lateral travel distance Wd using the following equation. ..
  • L is a target moving distance in the forward direction from the start time to the end time of the lane change, and is changed according to the vehicle speed of the own vehicle detected by the vehicle speed detection device 32.
  • Xrun is the forward movement distance of the own vehicle from the start time of the lane change to the current position of the own vehicle, and is calculated by integrating the movement distance of the own vehicle from the start time of the lane change.
  • X is a position in the front direction of the coordinate system of the own vehicle with respect to the current position of the own vehicle.
  • the moving distance Ychg of is calculated. As a result, the position X in each front direction and the lateral movement distance Ychg at the position X in each front direction are calculated.
  • the polynomial in ⁇ of the equation (9) is a polynomial with (Xchg / L) as a variable, and gradually changes from 0 to 1 as (Xchg / L) increases from 0 to 1.
  • map data or the like in which the relationship between Xchg / L and the coefficient changing from 0 to 1 is preset may be used.
  • the travel route generation unit 15 adds the lateral travel distance Ychg to the own lane travel route Young to calculate the lane change travel route YLC.
  • YLC Young + Ychg ⁇ ⁇ ⁇ (10)
  • the lane change travel route YLC is calculated by adding the lane travel route Young and the lateral travel distance Ychg calculated using the equation (9).
  • the position X in each front direction and the lane change traveling route YLC (horizontal position) in the position X in each front direction in the coordinate system of the own vehicle based on the current position of the own vehicle are calculated.
  • the travel route generation unit 15 sets the lane change travel route YLC as the final target travel route.
  • the travel route generation unit 15 After straddling the lane markings in step S25, the travel route generation unit 15 generates a lane change travel route that gradually approaches the own lane travel route from the travel route of the lane before the lane change.
  • the travel route generation unit 15 moves its own vehicle laterally from the start to the end of the lane change based on the lane marking information of each lane line as before crossing the lane marking.
  • the total lateral movement distance Wd is calculated.
  • the traveling route generation unit 15 calculates the total lateral movement distance Wd using the equation (8). After straddling the lane marking, the lane after changing lanes is the own lane.
  • the travel route generation unit 15 sets the lateral travel distance Ychg of the own vehicle with respect to the own lane travel route Young in the entire lateral direction according to the forward travel distance Xchg after the start of the lane change.
  • the value obtained by multiplying the travel distance Wd by -1 is gradually changed to 0, and the lateral travel distance Ychg is added to the own lane travel route Young to generate the lane change travel route YLC.
  • the travel route generation unit 15 calculates the lateral travel distance Ychg based on the forward travel distance Xchg after the start of the lane change and the total lateral travel distance Wd using the following equation. ..
  • the moving distance Ychg of is calculated.
  • the position X in each front direction and the lateral movement distance Ychg at the position X in each front direction are calculated.
  • the travel route generation unit 15 adds the lateral travel distance Ychg to the own lane travel route Young to calculate the lane change travel route YLC.
  • YLC Young + Ychg ⁇ ⁇ ⁇ (12)
  • the lane change travel route YLC is calculated by adding the lane travel route Young and the lateral travel distance Ychg calculated using the equation (11).
  • the position X in each front direction and the lane change traveling route YLC (horizontal position) in the position X in each front direction in the coordinate system of the own vehicle based on the current position of the own vehicle are calculated.
  • the travel route generation unit 15 sets the lane change travel route YLC as the final target travel route.
  • the central lane is determined to be the own lane before crossing the lane marking (before time t1), and the driving in the own lane generated based on the reference lane marking of the own lane that has been determined to be valid.
  • the route Young is set in the center of the central lane, and the lateral travel distance Ychg that gradually changes from 0 to the total lateral travel distance Wd is added to the own lane travel route Young to calculate the lane change travel route YLC. ..
  • the right lane is determined to be the own lane, and the own lane traveling route Young generated based on the reference lane marking of the own lane that has been determined to be valid is
  • the lane change travel route YLC is calculated by adding the lateral travel distance Ychg that is set in the center of the right lane and gradually changes from the value obtained by multiplying the total lateral travel distance Wd by -1 to the own lane travel route Young. Has been done.
  • Steering control unit 16 The steering control unit 16 controls the steering angle of the wheels based on the target travel route (lane change travel route YLC when changing lanes, own lane travel route Young when not changing lanes) generated by the travel route generation unit 15. Steering control processing (steering control step) for performing steering control is executed.
  • the steering control unit 16 calculates a command value of the steering angle of the wheel that causes the own vehicle to travel along the target travel path based on the target travel path, the vehicle speed, and the like, and transmits the command value to the steering device 24.
  • Lane change control may be provided as part of the autonomous driving function of the autonomous driving vehicle.
  • the steering device 24 is an electric power steering device, and controls the steering angle of the wheels by the driving force of the electric motor.
  • the steering device 24 drives and controls the electric motor so that the actual steering angle follows the command value of the steering angle.
  • Embodiment 2 Next, the travel route generation device 10 and the travel route generation method according to the second embodiment will be described. The description of the same components as those in the first embodiment will be omitted.
  • the basic configuration and processing of the traveling route generation device 10 according to the present embodiment are the same as those of the first embodiment. In the present embodiment, a part of the processing of the traveling route generation unit 15 is different from the first embodiment.
  • the travel route generation unit 15 cannot acquire the lane marking information of one of the lane marking on the left side and the lane marking on the right side of the own lane after straddling the lane marking, the lane change unit 15 has acquired in the past.
  • the own lane travel route is closer to the left lane or the right lane where the lane information can be obtained, than when it is generated based on the lane information of the left lane and the right lane. To generate.
  • the own lane travel route is generated closer to the side of the lane marking where the lane marking information can be acquired, so that even if the width of the lane is narrowed, the own lane is generated. Vehicles can be driven in narrow lanes.
  • the traveling route generation unit 15 corresponds to the approximate curve of the reference lane marking represented by the lane marking information of the reference lane marking in the lateral direction of the own vehicle according to the lane width Wown of the own lane.
  • the shift width ⁇ Wsft is shifted to generate a driving route in the own lane.
  • the traveling route generation unit 15 shifts the approximate curve of the reference lane line in the own vehicle coordinate system shown in the equation (1) laterally by the shift width ⁇ Wsft. Set the own lane travel route Young.
  • the travel route generation unit 15 cannot acquire the lane marking information of one of the lane marking on the left side and the lane marking on the right side of the own lane after straddling the lane marking, the lane change unit 15 has acquired in the past.
  • the shift width ⁇ Wsft is made smaller than in the case of generating based on the lane marking information of the left lane and the right lane of the rear lane.
  • the travel route generation unit 15 calculates the lane based on the lane marking information on the left and right sides of the lane after the lane change acquired in the past when one of the lane marking information cannot be acquired. Shift the value obtained by subtracting the lane width Wcmp from the half value of the lane width Waf_old of the changed lane and multiplying it by +1 or -1 depending on whether the lane line for which lane marking information cannot be obtained is on the right side or the left side. Calculated as width ⁇ Wsft. Further, the traveling route generation unit 15 may limit the absolute value of the shift width ⁇ Wsft to the lower limit by the width corresponding to the vehicle width of the own vehicle so that the shift width ⁇ Wsft does not become too narrow.
  • the travel route generation unit 15 may set a value obtained by subtracting the shift width Wcmp from the standard lane width as the shift width ⁇ Wsft.
  • the standard lane width may be set according to the type of road on which the vehicle is traveling, may be obtained from map data, or may be set to the lane width of another lane calculated based on the lane marking information. You may.
  • the travel route generation unit 15 cannot acquire the lane marking information of one of the lane marking on the left side and the lane marking on the right side of the own lane after straddling the lane marking, it has acquired it in the past. Compared with the case of generating based on the lane marking information on the left side lane and the right side lane after changing lanes, the total lateral movement distance Wd is changed by the shift width Wcmp of the own lane travel route.
  • the travel route generation unit 15 has a width Wcmp from half the total value of the lane width Wbf of the lane before the lane change and the lane width Waf_old of the lane after the lane change acquired in the past. Is multiplied by +1 or -1 according to the lane change direction, and the value is calculated as the total lateral movement distance Wd.
  • the travel route generation unit 15 uses the equation (11) to move laterally based on the forward travel distance Xchg and the total lateral travel distance Wd after the start of the lane change.
  • the moving distance Ychg is calculated.
  • the travel route generation unit 15 calculates the lane change travel route YLC by adding the lateral travel distance Ychg to the own lane travel route Young using the equation (12).
  • FIG. 14 shows an example of a traveling route generation process according to the present embodiment.
  • the own vehicle has changed lanes from the center lane to the right lane.
  • the own vehicle straddles the lane marking that separates the center lane and the right lane by changing lanes.
  • the lane marking information for the lane marking has been obtained, and the lane after the lane change is based on the lane marking information on the left side lane and the right side lane.
  • the lane width Waf of is acquired.
  • the lane width Waf of the lane after the last acquired lane change is stored.
  • the left lane marking of the own lane set in the right lane is selected as the reference lane marking, and the own lane driving route is generated based on the lane marking information of the reference lane marking.
  • the value obtained by subtracting the shift width Wcmp from the lane width Waf_old of the lane after the lane change acquired in the past is set as the shift width ⁇ Wsft. ing.
  • the own lane travel route is generated closer to the left side by the shift width Wcmp than in the case of being generated based on the lane width Waf_old of the lane after the lane change acquired in the past. Therefore, as shown by the dotted line, the right lane end of the right lane is closer to the left side, and even if the lane width is reduced, the own vehicle can be driven in the narrowed lane. ..
  • the lane changing traveling route is appropriately generated even after the correction by the gathering width Wcmp. Before and after the correction by the gathering width Wcmp, it is possible to suppress the discontinuity of the lane change traveling route.
  • Embodiment 3 Next, the travel route generation device 10 and the travel route generation method according to the third embodiment will be described. The description of the same components as those in the first embodiment will be omitted.
  • the basic configuration and processing of the traveling route generation device 10 according to the present embodiment are the same as those of the first embodiment. In the present embodiment, a part of the processing of the traveling route generation unit 15 is different from the first embodiment.
  • the straddling lane markings disappear and the number of lanes decreases, and the lane width of the own lane increases significantly. May be done. Also in this case, in the method of the first embodiment, since the own lane traveling route is generated in the central portion of the own lane where the lane width is increased, there is no big problem in generating the own lane traveling route. However, in the method of the first embodiment, the lane width Waf of the lane after the lane change is greatly increased, and the lane width Wbf of the lane before the lane change cannot be acquired. The lane width is set to Wbf_old. Therefore, the absolute value of the total lateral movement distance Wd calculated by the equation (8) is greatly increased, and the generated lane change traveling route becomes inappropriate.
  • the travel route generation unit 15 straddles the lane marking and then has the lane width Wown (n-1) of the own lane acquired last time and the lane width Wown (n) of the own lane acquired this time. ),
  • the lateral distance of the own lane travel path with respect to the own vehicle when the amount of variation ⁇ Wown of the lane width becomes equal to or greater than the preset determination variation amount Thw and then becomes equal to or greater than the determination variation amount Thw.
  • the total lateral movement distance Wd is changed accordingly.
  • the travel route generation unit 15 has the lane width Wown (n-1) of the own lane acquired last time and the own lane acquired this time after straddling the lane markings.
  • the value is twice the lateral distance Ytmp of the own lane travel route with respect to the own vehicle. Is calculated as the total lateral movement distance Wd.
  • the traveling route generation unit 15 uses the equation (11) to move the forward distance Xchg after the start of the lane change, and the total lateral travel distance Wd calculated by the equation (15).
  • the lateral movement distance Ychg is calculated based on.
  • the travel route generation unit 15 calculates the lane change travel route YLC by adding the lateral travel distance Ychg to the own lane travel route Young as shown in the equation (12).
  • the own lane traveling route Young is changed from the center of the right lane before the lane marking disappears to the center of one lane after the lane marking disappears.
  • the total lateral movement distance Wd When the total lateral movement distance Wd is not corrected by the lateral distance Ytpm of the own lane travel path with respect to the own vehicle as in the present embodiment, the total lateral movement distance Wd becomes too large and before and after the lane marking disappears.
  • the lane change driving route becomes discontinuous. An inappropriate lane changing driving route is formed.
  • the total lateral movement distance Wd when the total lateral movement distance Wd is corrected by the lateral distance Ytpm of the own lane travel path with respect to the own vehicle, the total lateral movement distance Wd can be appropriately reduced, and the lanes before and after the lane marking disappears. It is possible to suppress the discontinuity of the changed driving route and form an appropriate lane changing driving route.
  • the travel route generation device described above includes a navigation device such as a PND (Portable Navigation Device), a communication terminal including a mobile terminal such as a mobile phone, a smartphone, and a tablet, a function of an application installed in the navigation device, and a server. Can also be applied to a travel route generation system constructed as a system by appropriately combining the above. In this case, each function or each component of the traveling route generator described above may be distributed and arranged in each device for constructing the system, or may be centrally arranged in any one of the devices. good.
  • Travel route generation device 11 Lane line information acquisition unit, 12 Lane recognition unit, 13 Lane information validity determination unit, 14 Reference lane line selection unit, 15 Travel route generation unit, 16 Steering control unit, Wd All lateral movement Distance, Xchg forward travel distance, YLC lane change travel route, Ychg lateral travel distance, Young own lane travel route

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Multimedia (AREA)
  • Theoretical Computer Science (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Human Computer Interaction (AREA)
  • Traffic Control Systems (AREA)

Abstract

車線変更中に得られた最新の区画線情報を用いて、車線変更するための走行経路を精度よく生成することができる走行経路生成装置及び走行経路生成方法を提供する。自車両の車線変更中に、各区画線の区画線情報について、車線変更走行経路の生成に用いることができる有効な区画線情報であるか否かを判定し、有効判定結果に基づいて、自車線の左側の区画線及び右側の区画線から基準区画線を選択し、基準区画線の区画線情報に基づいて、車線変更走行経路を生成する走行経路生成装置(10)及び走行経路生成方法。

Description

走行経路生成装置及び走行経路生成方法
 本願は、走行経路生成装置及び走行経路生成方法に関するものである。
 従来、車線変更を行う走行経路を生成し、自車両を車線変更させる車両制御装置が知られている。例えば、特許文献1では、車線変更を行うための走行経路が、車線変更開始時に取得した車線変更先の区画線情報に基づいて、車線変更の開始時に予め生成される。
特開2017-056779号公報
 しかしながら、カメラ又はレーダで検知できる最大距離よりも前方の区画線情報は、精度が低く、特許文献1のように、車線変更の開始時に予め生成された走行経路における遠方の部分は、信頼性が低いという問題があった。また、車線変更の開始時に、障害物等により区画線情報が取得できていない場合は、車線変更の開始時に予め生成された走行経路の精度が低いという問題があった。
 そこで、本願は、車線変更中に得られた最新の区画線情報を用いて、車線変更するための走行経路を精度よく生成することができる走行経路生成装置及び走行経路生成方法を提供することを目的としている。
 本願に係る走行経路生成装置は、
 自車両が走行している車線である自車線及び前記自車線に隣接する車線を含む、自車両の前方の認識可能な単数又は複数の車線の区画線について、自車両の位置を基準とする各区画線の位置及び形状に関する区画線情報を取得する区画線情報取得部と、
 各区画線の前記区画線情報に基づいて、各区画線と自車線との対応関係を判定する走行路認識部と、
 自車両の車線変更中に、各区画線の前記区画線情報について、車線変更するための走行経路である車線変更走行経路の生成に用いることができる有効な前記区画線情報であるか否かを判定する区画線情報有効判定部と、
 車線変更中に、前記区画線情報有効判定部による各区画線の前記区画線情報の有効判定結果に基づいて、前記自車線の左側の区画線及び右側の区画線から1つの区画線を基準区画線として選択する基準区画線選択部と、
 車線変更中に、前記基準区画線の前記区画線情報に基づいて、車線変更するための走行経路である前記車線変更走行経路を生成する走行経路生成部と、を備えたものである。
 本願に係る走行経路生成方法は、
 自車両が走行している車線である自車線及び前記自車線に隣接する車線を含む、自車両の前方の認識可能な単数又は複数の車線の区画線について、自車両の位置を基準とする各区画線の位置及び形状に関する区画線情報を取得する区画線情報取得ステップと、
 各区画線の前記区画線情報に基づいて、各区画線と自車線との対応関係を判定する走行路認識ステップと、
 自車両の車線変更中に、各区画線の前記区画線情報について、車線変更するための走行経路である車線変更走行経路の生成に用いることができる有効な前記区画線情報であるか否かを判定する区画線情報有効判定ステップと、
 車線変更中に、前記区画線情報有効判定ステップにおける各区画線の前記区画線情報の有効判定結果に基づいて、前記自車線の左側の区画線及び右側の区画線から1つの区画線を基準区画線として選択する基準区画線選択ステップと、
 車線変更中に、前記基準区画線の前記区画線情報に基づいて、車線変更するための走行経路である前記車線変更走行経路を生成する走行経路生成ステップと、を備えたものである。
 本願に係る走行経路生成装置及び走行経路生成方法によれば、車線変更中に逐次得られた最新の各区画線の区画線情報、及び有効判定結果に基づいて自車線の左側及び右側の区画線から選択された基準区画線の区画線情報に基づいて、車線変更走行経路が生成される。よって、車線変更中に逐次得られた最新の自車線の区画線情報に基づいて、精度よく車線変更走行経路を生成することができる。
実施の形態1に係る走行経路生成装置の概略ブロック図である。 実施の形態1に係る走行経路生成装置のハードウェア構成図である。 実施の形態1に係る走行経路生成装置のハードウェア構成図である。 実施の形態1に係る走行経路生成装置の概略処理を説明するフローチャートである。 実施の形態1に係る自車両座標系等を説明する図である。 実施の形態1に係る区画線情報を説明する図である。 実施の形態1に係る自車線の区画線情報、及び自車両走行経路を説明する図である。 実施の形態1に係る車線変更を説明する図である。 実施の形態1に係る車線変更による自車線と各区画線の対応関係の変化を説明するタイムチャートである。 実施の形態1に係る区画線情報の有効判定を説明するための図である。 実施の形態1に係る区画線情報の有効判定の結果を説明するための図である。 実施の形態1に係る走行経路生成処理を説明するためのフローチャートである。 実施の形態1に係る車線変更走行経路の生成を説明するための図である。 実施の形態2に係る車線変更走行経路の生成を説明するための図である。 実施の形態3に係る車線変更走行経路の生成を説明するための図である。 実施の形態3に係る車線変更走行経路の生成を説明するための図である。
実施の形態1.
 実施の形態1に係る走行経路生成装置10及び走行経路生成方法について図面を参照して説明する。図1は、走行経路生成装置10の概略ブロック図である。
 走行経路生成装置10は、区画線情報取得部11、走行路認識部12、区画線情報有効判定部13、基準区画線選択部14、走行経路生成部15、及び操舵制御部16等の処理部を備えている。走行経路生成装置10の各処理は、走行経路生成装置10が備えた処理回路により実現される。具体的には、図2に示すように、走行経路生成装置10は、CPU(Central Processing Unit)等の演算処理装置90、記憶装置91、演算処理装置90に外部の信号を入出力する入出力装置92等を備えている。
 演算処理装置90として、ASIC(Application Specific Integrated Circuit)、IC(Integrated Circuit)、DSP(Digital Signal Processor)、FPGA(Field Programmable Gate Array)、GPU(Graphics Processing Unit)、AI(Artificial Intelligence)チップ、各種の論理回路、及び各種の信号処理回路等が備えられてもよい。また、演算処理装置90として、同じ種類のもの又は異なる種類のものが複数備えられ、各処理が分担して実行されてもよい。記憶装置91として、演算処理装置90からデータを読み出し及び書き込みが可能に構成されたRAM(Random Access Memory)、演算処理装置90からデータを読み出し可能に構成されたROM(Read Only Memory)等が備えられている。なお、記憶装置91として、フラッシュメモリ、EEPROM(Electrically Erasable Programmable Read Only Memory)、ハードディスク、DVD装置等の各種の記憶装置が用いられてもよい。
 入出力装置92には、通信装置、A/D変換器、入出力ポート、駆動回路等が備えられる。入出力装置92は、周辺監視装置31、車速検出装置32、操舵装置24、運転支援システム25等に接続され、これらの装置と通信を行う。
 そして、走行経路生成装置10が備える各処理部11~16等の各機能は、演算処理装置90が、ROM等の記憶装置91に記憶されたソフトウェア(プログラム)を実行し、記憶装置91及び入出力装置92等の走行経路生成装置10の他のハードウェアと協働することにより実現される。なお、各処理部11~16等が用いる判定値等の設定データは、ソフトウェア(プログラム)の一部として、ROM等の記憶装置91に記憶されている。以下、走行経路生成装置10の各機能について詳細に説明する。
 或いは、走行経路生成装置10は、処理回路として、図3に示すように、専用のハードウェア93、例えば、単一回路、複合回路、プログラム化されたプロセッサ、並列プログラム化されたプロセッサ、ASIC、FPGA、GPU、AIチップ、又はこれらを組み合わせた回路等が備えられてもよい。
 図4は、本実施の形態に係る走行経路生成装置10の処理の手順(走行経路生成方法)を説明するための概略フローチャートである。図4のフローチャートの処理は、演算処理装置90が記憶装置91に記憶されたソフトウェア(プログラム)を実行することにより、所定の演算周期毎に繰り返し実行される。演算周期は、例えば、0.01秒に設定される。
1.区画線情報取得部11
 図4のステップS01で、区画線情報取得部11は、自車両が走行している車線である自車線及び自車線に隣接する車線を含む、自車両の前方の認識可能な単数又は複数の車線の区画線について、自車両の位置を基準とする各区画線の位置及び形状に関する区画線情報を取得する区画線情報取得処理(区画線情報取得ステップ)を実行する。
 区画線情報取得部11は、周辺監視装置31の検出情報に基づいて、認識可能な区画線を検出し、区画線情報を取得する。周辺監視装置31は、車両の前方を監視するカメラが含まれる。カメラが撮像した画像に対して公知の各種の画像処理が行われ、車線の区画線が認識される。区画線は、主には白線であるが、白線に限らず、ガードレール、ポール、路肩、壁等の路側物が区画線として認識されてもよい。また、周辺監視装置31として、レーザレーダが用いられてもよく、レーザレーダの反射の輝度が高い点から白線が認識されてもよい。
 区画線情報取得部11は、自車両座標系において、認識した各区画線の位置及び形状に関する区画線情報を取得する。図5に示すように、自車両の座標系は、自車両の前方向及び横方向を2つの座標軸X、Yとした座標系である。自車両座標系の原点は、ニュートラルステアポイント等の自車両の中央に設定される。横方向の左側が正であり、右側が負である。
 本実施の形態では、図6に示すように、区画線情報取得部11は、各区画線の区画線情報として、自車両と自車両の横方向に位置する区画線の部分との間の距離である区画線距離K0と、自車両の進行方向に対する自車両の横方向に位置する区画線の部分の傾きである区画線角度K1と、区画線の曲率K2と、を含む情報を取得する。本実施の形態では、区画線情報に、区画線の曲率変化率K3が更に含まれる。これらの区画線情報のパラメータK0~K3を用いて、自車両座標系における各区画線の位置は、次式により算出できる。すなわち、各区画線は、自車両座標系における区画線の横方向の位置Yを、前方向の位置Xを変数とした3次の多項式で表した近似式で近似され、各次数の係数が区画線情報を表すパラメータK0~K3として取得される。なお、曲率変化率K3の3次の項のない、2次の多項式で近似されてもよい。
Figure JPOXMLDOC01-appb-M000001
 図5に示すように、区画線情報取得部11は、自車線の左右の区画線だけなく、自車線に隣接する車線の区画線の区画線情報も取得する。
<有効性の判定に用いられる情報>
 区画線情報取得部11は、各区画線の区画線情報の精度に関わる情報を、区画線情報有効判定部13に伝達する。例えば、周辺監視装置31により検出され、区画線情報(本例では、式(1)の近似曲線の係数K0、K1、K2、K3)の算出に用いられた元の区画線(白線等)の長さ(本例では、自車両の前方の距離)の情報が、区画線情報有効判定部13に伝達される。また、周辺監視装置31により検出された元の区画線と近似曲線との一致度合い、すなわち近似精度の情報も、区画線情報有効判定部13に伝達される。また、検出された元の区画線の認識の確からしさの情報も、区画線情報有効判定部13に伝達される。
2.走行路認識部12
 図4のステップS02で、走行路認識部12は、各区画線の区画線情報に基づいて、各区画線と自車線との対応関係を判定する走行路認識処理(走行路認識ステップ)を実行する。本実施の形態では、走行路認識部12は、各区画線の区画線情報に基づいて、各区画線と自車線に隣接する隣接車線との対応関係も判定する。また、走行路認識部12は、各区画線の区画線情報に基づいて、車線変更前の車線と車線変更後の車線とを区画する区画線を、自車両が跨いだか否かを判定する。走行路認識部12は、自車両が区画線を跨いだときに、自車線が、跨ぐ前の車線から跨いだ後の車線に変化するように、各区画線と自車線との対応関係を変更する。判定結果は、後述する区画線情報有効判定部13、走行経路生成部15等に伝達される。
 本実施の形態では、図7に示すように、走行路認識部12は、自車線の左側の区画線(左第1区画線L1)の区画線情報(本例では、区画線距離K0、区画線角度K1、区画線の曲率K2、及び区画線の曲率変化率K3)に基づいて、自車両の現在位置に対応する自車両座標系における自車両の左側の区画線の形状を認識する。走行路認識部12は、自車線の右側の区画線(右第1区画線R1)の区画線情報(本例では、区画線距離K0、区画線角度K1、区画線の曲率K2、及び区画線の曲率変化率K3)に基づいて、自車両の右側の区画線の形状を認識する。
<区画線距離K0に基づく右側及び左側の各区画線の認識>
 走行路認識部12は、今回取得した各区画線の区画線距離K0に基づいて、自車線と各区画線との対応関係を認識する。
 走行路認識部12は、各区画線の区画線距離K0の内、自車両の右側において自車両に最も近い区画線が、自車線の右側の区画線(右第1区画線R1)であると認識し、各区画線の区画線距離K0の内、自車両の左側において自車両に最も近い区画線が、自車線の左側の区画線(左第1区画線L1)であると認識する。
 本実施の形態では、走行路認識部12は、区画線距離K0が正の値である区画線の内、区画線距離K0が最も小さい区画線を、自車線の左側区画線に対応する左第1区画線L1と認識し、区画線距離K0が2番目に小さい区画線を左第2区画線L2と認識し、区画線距離K0が3番目に小さい区画線を左第3区画線L3と認識する。また、走行路認識部12は、区画線距離K0が負の値である区画線の内、区画線距離K0の絶対値が最も小さい区画線を、自車線の右側区画線に対応する右第1区画線R1と認識し、区画線距離K0の絶対値が2番目に小さい区画線を右第2区画線R2と認識し、区画線距離K0の絶対値が3番目に小さい区画線を右第3区画線R3と認識する。
 図8及び図9に、片側3車線の道路の中央車線を走行していた自車両が、右側車線に車線変更を行う場合の挙動を示す。図8に、道路を基準にした場合の自車両の挙動を示し、図9に、各区間線の区画線距離K0のタイムチャートを示す。時刻t0では、自車両は中央車線を走行しており、左第1区画線L1の区画線距離K0と右第1区画線R1の区画線距離K0とは、中央車線の車線幅W2の半分になっている。その後、右側の車線変更を開始したので、右第1区画線R1の区画線距離K0の絶対値が減少していき、左第1区画線L1の区画線距離K0が増加していく。
 そして、時刻t1で、右第1区画線R1と認識されていた区画線の区画線距離K0が、正の値になり、区画線距離K0が正の値である区画線の内、区画線距離K0が最も小さい区画線になり、左第1区画線L1と認識される。また、時刻t1で、左第1区画線L1と認識されていた区画線の区画線距離K0が、区画線距離K0が正の値である区画線の内、区画線距離K0が2番目にも小さい区画線になり、左第2区画線L2と認識される。また、時刻t1で、右第2区画線R2と認識されていた区画線の区画線距離K0が、区画線距離K0が負の値である区画線の内、区画線距離K0の絶対値が最も小さい区画線になり、右第1区画線R1と認識される。
<右側の区画線の跨ぎ判定>
 例えば、走行路認識部12は、次式に示すように、前回取得された右第1区画線R1の区画線距離K0R1_oldと今回取得された右第1区画線R1の区画線距離K0R1との偏差ΔK0R1が、右側車線への車線変更を行った場合の車線幅に対応する範囲になった場合(条件1)、又は前回取得された左第1区画線L1の区画線距離K0L1_oldと今回取得された左第1区画線L1の区画線距離K0L1との偏差ΔK0L1が、右側車線への車線変更を行った場合の車線幅に対応する範囲になった場合(条件2)に、自車両が右側の区画線を跨ぎ、右側車線に車線変更したと判定する。
 ΔK0R1=K0R1-K0R1_old
 ΔK0L1=K0L1-K0L1_old
 条件1)-W3-ΔW≦ΔK0R1≦-W3+ΔW
  又は
 条件2)-W2-ΔW≦ΔK0L1≦-W2+ΔW
  が成立した場合、
      右側車線に車線変更したと判定    ・・・(2)
 条件1の車線幅に対応する範囲は、-W3-ΔW~-W3+ΔWに設定される。W3は、右側の車線変更先の車線の車線幅に設定され、例えば、前回取得された右第1区画線R1の区画線距離K0R1_oldと前回取得された右第2区画線R2の区画線距離K0R2_oldとの偏差に設定される。条件2の車線幅に対応する範囲は、-W2-ΔW~-W2+ΔWに設定される。W2は、車線変更前の自車線の車線幅に設定され、例えば、前回取得された左第1区画線L1の区画線距離K0L1_oldと前回取得された右第1区画線R1の区画線距離K0R1_oldとの偏差に設定される。ΔWは、0.1m等の所定値に設定されたり、車線幅W3又は車線幅W2の10%等の所定割合に設定されたりする。
 更に、走行路認識部12は、次式に示すように、前回取得された右第1区画線R1の区画線距離K0R1_oldが判定値ΔWmより0に近く、且つ、前回取得された右第1区画線R1の区画線距離K0R1_oldと今回取得された右第1区画線R1の区画線距離K0R1との偏差ΔK0R1が、右側への車線変更を行った場合の車線幅に対応する範囲になった場合(条件1)、又は前回取得された左第1区画線L1の区画線距離K0L1_oldが判定値ΔWm以上車線幅W2に近く、且つ、前回取得された左第1区画線L1の区画線距離K0L1_oldと今回取得された左第1区画線L1の区画線距離K0L1との偏差ΔK0L1が、右側への車線変更を行った場合の車線幅に対応する範囲になった場合(条件2)に、自車両が右側の区画線を跨ぎ、右側車線に車線変更したと判定してもよい。
 ΔK0R1=K0R1-K0R1_old
 ΔK0L1=K0L1-K0L1_old
 条件1)-ΔWm≦K0R1_old≦ΔWm
  且つ -W3-ΔW≦ΔK0R1≦-W3+ΔW
  又は
 条件2)W2-ΔWm≦K0L1_old≦W2+ΔWm
  且つ -W2-ΔW≦ΔK0L1≦-W2+ΔW
  が成立した場合、
      右側車線に車線変更したと判定     ・・・(3)
 ΔWmは、ΔWと同じ値に設定されてもよいし、異なる値に設定されてもよい。或いは、車速と該当区画線の区画線角度K1とに基づいて、自車両が区画線に近づく速度を演算し、その区画線への接近速度に応じて、ΔWm及びΔWが設定されてもよい。例えば、区画線への接近速度が大きいと、演算周期間の区画線距離K0の変化量が大きくなり、区画線の跨ぎの前後で、判定範囲を超えて、区画線距離K0が変化し、区画線の跨ぎ判定が行われない可能性があるが、判定範囲を区画線への接近速度に応じて変化させることにより、確実に区画線の跨ぎを判定することができる。
<左側の区画線の跨ぎ判定>
 走行路認識部12は、次式に示すように、前回取得された左第1区画線L1の区画線距離K0L1_oldと今回取得された左第1区画線L1の区画線距離K0L1との偏差ΔK0L1が、左側車線への車線変更を行った場合の車線幅に対応する範囲になった場合(条件3)、又は前回取得された右第1区画線R1の区画線距離K0R1_oldと今回取得された右第1区画線R1の区画線距離K0R1との偏差ΔK0R1が、左側車線への車線変更を行った場合の車線幅に対応する範囲になった場合(条件4)に、自車両が左側の区画線を跨ぎ、左側車線に車線変更したと判定する。
 ΔK0L1=K0L1-K0L1_old
 ΔK0R1=K0R1-K0R1_old
 条件3)W1-ΔW≦ΔK0L1≦W1+ΔW
  又は
 条件4)W2-ΔW≦ΔK0R1≦W2+ΔW
  が成立した場合、
      左側車線に車線変更したと判定    ・・・(4)
 条件3の車線幅に対応する範囲は、W1-ΔW~W1+ΔWに設定される。W1は、左側の車線変更先の車線の車線幅に設定され、例えば、前回取得された左第2区画線L2の区画線距離K0L2_oldと前回取得された左第1区画線L1の区画線距離K0L1_oldとの偏差に設定される。条件4の車線幅に対応する範囲は、W2-ΔW~W2+ΔWに設定される。ΔWは、0.1m等の所定値に設定されたり、車線幅W1又は車線幅W2の10%等の所定割合に設定されたりする。
 更に、走行路認識部12は、次式に示すように、前回取得された左第1区画線L1の区画線距離K0L1_oldが判定値ΔWmより0に近く、且つ、前回取得された左第1区画線L1の区画線距離K0L1_oldと今回取得された左第1区画線L1の区画線距離K0L1との偏差ΔK0L1が、左側への車線変更を行った場合の車線幅に対応する範囲になった場合(条件3)、又は前回取得された右第1区画線R1の区画線距離K0R1_oldが判定値ΔWm以上車線幅W2に近く、且つ、前回取得された右第1区画線R1の区画線距離K0R1_oldと今回取得された右第1区画線R1の区画線距離K0R1との偏差ΔK0R1が、左側への車線変更を行った場合の車線幅に対応する範囲になった場合(条件4)に、自車両が左側の区画線を跨ぎ、左側車線に車線変更したと判定してもよい。
 ΔK0L1=K0L1-K0L1_old
 ΔK0R1=K0R1-K0R1_old
 条件3)-ΔWm≦K0L1_old≦ΔWm
  且つ W1-ΔW≦ΔK0L1≦W1+ΔW
  又は
 条件4)-W2-ΔWm≦K0R1_old≦-W2+ΔWm
  且つ W2-ΔW≦ΔK0R1≦W2+ΔW
  が成立した場合、
      左側車線に車線変更したと判定    ・・・(5)
3.区画線情報有効判定部13
 図4のステップS03で、区画線情報有効判定部13は、自車両の車線変更中に、各区画線の区画線情報のそれぞれについて、車線変更するための走行経路である車線変更走行経路の生成に用いることができる有効な区画線情報であるか否かを判定する(区画線情報有効判定ステップ)を実行する。区画線情報有効判定部13は、車線変更中、各区画線の区画線情報が得られる毎に、継続的に、各区画線の区画線情報について、有効性を判定する。
 本実施の形態では、自車両が車線変更を自動で行う運転支援システム25を搭載している場合を想定する。運転支援システム25が、目的地への走行のため、或いは周囲の走行状況から右側又は左側車線に車線変更を行うと判定し、車線変更を実行している場合に、車線変更の実行中であると判定される。なお、運転支援システム25は、車線変更の実施を判断した場合、その車線変更の方向に応じた方向指示器をオンにする。
 なお、運転者の車線変更指示を起点として車線変更の運転支援を行うシステムを想定した場合は、方向指示器の操作、又は他の手段により検知した運転者の車線変更の要求があった場合に、車線変更の実行中であると判定される。
 区画線情報有効判定部13は、走行路認識部12で認識した各区画線の区画線情報に基づいて、各区画線情報が有効か否かを判定する。図10は、区画線情報有効判定処理の1例を示す図である。片側3車線であり、右側車線が途中で分岐している。時刻t0から時刻t2までの期間で、自車両が中央車線から右側車線に車線変更している。時刻t1において、自車両が、車線変更により中央車線と右側車線とを区画する区画線を跨いでいる。
 本実施の形態では、区画線情報有効判定部13は、区画線情報取得部11から伝達された各区画線の区画線情報の精度に関わる情報に基づいて、各区画線の区画線情報の有効性を判定する。例えば、区画線情報有効判定部13は、各区画線の区画線情報について、カメラ又はレーザレーダ等の周辺監視装置31により検出された元の区画線(白線等)の長さVR(本例では、自車両の前方の距離VR)が、判定長さVRthよりも長い場合に、区画線情報が有効であると判定し、長さVRが判定長さVRthよりも短い場合に、区画線情報が無効であると判定する。
 この構成によれば、元の区画線の長さVRが長く、自車両の前方の区画線情報の信頼性が高い区画線情報を有効であると判定し、車線変更走行経路の生成に用いるようにできる。
 例えば、図10の例では、車線変更を開始した時刻t0において、左第1区画線L1、右第1区画線R1、及び右第2区画線R2の元の区画線の長さVRL1、VRR1、VRR2が、判定距離VRthよりも長いので、これらの区画線L1、R1、R2の区画線情報が有効であると判定される。一方、左第2区画線L2の元の区画線の長さVRL2が、判定距離VRthよりも短いので、この区画線L2の区画線情報が無効であると判定される。
 区画線情報有効判定部13は、車線変更中、時刻t0以降も、各区画線の区画線情報が得られる毎に、各区画線の区画線情報の有効性を判定する。車線変更後の経過時間又は走行距離が増加するに従って、判定距離VRthが次第に短くされてもよい。なお、区画線情報が取得できていない区画線については、区画線情報は無効であると判定される。
 区画線情報有効判定部13は、各区画線の区画線情報について、近似曲線の近似精度に基づいて、区画線情報の有効性が判定されてよく、元の区画線の検出の確からしさに基づいて、区画線情報の有効性が判定されてよい。
 本実施の形態では、区画線情報有効判定部13は、各区画線の区画線情報の曲率値K2に基づいて、各区画線が分岐路の区画線であるかを判断し、各区画線の区画線情報の有効判定を行う。区画線情報有効判定部13は、車線変更により分岐路を走行する計画でない場合は、分岐路の区画線の区画線情報を無効であると判定する。区画線情報有効判定部13は、車線変更により分岐路を走行する計画である場合は、分岐路の区画線の区画線情報を有効であると判定する。図10の例では、時刻t01で、右第2区画線R2の曲率値K2R2が、他の区画線の曲率値K2R1、K2L1、K2L2よりも判定曲率値以上異なっており、右側に曲がっているので、右側に分岐する分岐路の区画線であると判定され、右側の分岐路を走行する計画がないので、右第2区画線R2の区画線情報が無効であると判定されている。分岐路であるかの判定に、地図データから得た道路の形状が用いられてもよい。
 自車両が区画線を跨いだ時刻t1において、走行路認識部12は、自車線が、跨ぐ前の中央車線から跨いだ後の右側車線に変化するように、各区画線と自車線との対応関係を変更している。図9を用いて説明したように、中央車線の左側区画線が、左第1区画線L1から左第2区画線L2に変更され、中央車線の右側区画線が、右第1区画線R1から左第1区画線L1に変更され、右側車線の右側区画線が、右第2区画線R2から右第1区画線R1に変更されている。そして、区画線情報有効判定部13は、自車線との対応関係が変更された各区画線の区画線情報について、変更前と同様の方法により有効性を判定する。なお、時刻t1では、右第1区画線R1が、分岐路の区画線と判定され、引き続き無効と判定される。
 図11に示すように、各区間線の有効性の判定結果は、自車線と対応付けられた各区画線と関連付けられ、RAM等の記憶装置に記憶される。区画線を跨いだ時刻t2の前後で、自車線と対応付けられた各区画線が変化しているので、有効性の判定結果が、左側にシフトしている。なお、図11に示すように、車線変更中の各時点の有効性の判定結果を記憶装置91に記憶してもよいし、最新の有効性の判定結果のみを記憶装置91に記憶してもよい。
4.基準区画線選択部14
 図4のステップS04で、基準区画線選択部14は、車線変更中に、区画線情報有効判定部13による各区画線の区画線情報の有効判定結果に基づいて、自車線の左側の区画線(左第1区画線L1)及び右側の区画線(右第1区画線R1)から1つの区画線を基準区画線として選択する基準区画線選択処理(基準区画線選択ステップ)を実行する。基準区画線選択部14は、車線変更中、各区間線の有効性の判定結果が得られる毎に、継続的に、自車線の左側の区画線及び右側の区画線から1つの区画線を基準区画線として選択する。また、自車両が区画線を跨ぎ、各区画線と自車線との対応関係が変化した場合は、変化後の自車線の左側の区画線及び右側の区画線から、1つの区画線を基準区画線として選択する。
 基準区画線選択部14は、左第1区画線L1及び右第1区画線R1の双方が有効であると判定された場合は、いずれか一方の区画線を基準区画線として選択する。この場合は、基準区画線選択部14は、左第1区画線L1及び右第1区画線R1の有効性の度合いが高い方が、基準区画線として選択されてもよい。例えば、左第1区画線L1の元の区画線の長さVRL1と、右第1区画線R1の元の区画線の長さVRL1との長い方が、基準区画線として選択されてもよい。
 基準区画線選択部14は、左第1区画線L1及び右第1区画線R1の一方が有効であると判定された場合は、有効と判定された一方の区画線を基準区画線として選択する。基準区画線選択部14は、左第1区画線L1及び右第1区画線R1の双方が有効でないと判定された場合は、基準区画線の選択を行わない。基準区画線の選択が行われない場合は、車線変更走行経路の生成が行われない。例えば、車線変更の開始時は、車線変更が開始されない。車線変更中は、車線変更が中断され、道路に沿って走行する走行経路が生成されてもよいし、以前に基準区画線が選択されていた時に生成された基準区画線に基づいて、車線変更が継続されてもよい。
5.走行経路生成部15
 図4のステップS05で、走行経路生成部15は、車線変更中に、基準区画線の区画線情報に基づいて、車線変更するための走行経路である車線変更走行経路を生成する走行経路生成処理(走行経路生成ステップ)を実行する。走行経路生成部15は、車線変更中、取得した最新の基準区画線の区画線情報に基づいて、定期的に、車線変更走行経路を生成する。
 この構成によれば、車線変更中に逐次得られた最新の各区画線の区画線情報、及び有効判定結果に基づいて自車線の左側及び右側の区画線から選択された基準区画線の区画線情報に基づいて、車線変更走行経路が生成される。よって、車線変更中に逐次得られた最新の自車線の区画線情報に基づいて、精度よく車線変更走行経路を生成することができる。
 図12のフローチャートを用いて、本実施の形態に係る走行経路生成処理を説明する。図12の処理は、所定の演算周期毎に実行される。図13に、中央車線から右側車線に車線変更を行う場合の例を示す。時刻t0から時刻t2までの期間で、自車両が中央車線から右側車線に車線変更している。時刻t1において、自車両が、車線変更により中央車線と右側車線とを区画する区画線を跨いでいる。
<自車線走行経路の生成>
 ステップS21で、走行経路生成部15は、基準区画線の区画線情報に基づいて、車線変更を行わず自車線に沿って走行する場合の走行経路である自車線走行経路を生成する。区画線を跨ぐ前は、自車線は、車線変更前の車線に判定され、基準区画線は、車線変更前の車線の左側の区画線又は右側の区画線に設定される。自車線走行経路は、車線変更前の車線に沿って走行する場合の走行経路になる。区画線を跨いだ後は、自車線は、車線変更後の車線に判定され、基準区画線は、車線変更後の車線の左側の区画線又は右側の区画線に設定される。自車線走行経路は、車線変更後の車線に沿って走行する場合の走行経路になる。
 本実施の形態では、走行経路生成部15は、図7に示すように、基準区画線の区画線情報によって表される基準区画線の近似曲線を、自車両の横方向に、自車線の車線幅Wownに応じたシフト幅ΔWsftだけシフトさせて、自車線走行経路を生成する。例えば、走行経路生成部15は、次式に示すように、式(1)に示した自車両座標系における基準区画線の近似曲線を、シフト幅ΔWsftだけ横方向にシフトさせて、自車線走行経路Yownを設定する。自車線走行経路Yownが、自車線の中央に設定されるように、基準区画線が自車線の右側区画線又は左側区画線であるに応じて、シフト幅ΔWsftの正負を変化させている。ここで、K0bは、基準区画線の区画線距離であり、K1bは、基準区画線の区画線角度であり、K2bは、基準区画線の曲率であり、K3bは、基準区画線の曲率変化率である。
Figure JPOXMLDOC01-appb-M000002
 走行経路生成部15は、自車線の車線幅Wownは、自車線の左第1区画線L1及び右第1区画線R1の区画線情報に基づいて設定される。例えば、次式に示すように、自車線の車線幅Wownは、左第1区画線L1の区画線距離K0L1と右第1区画線R1の区画線距離K0R1との差に設定される。
Figure JPOXMLDOC01-appb-M000003
 左第1区画線L1及び右第1区画線R1の双方の区画線情報が得られない場合は、自車線の車線幅Wownは、過去に取得された該当車線の車線幅に設定されてもよいし、地図データから得られた車線幅に設定されてもよいし、標準的な車線幅に設定されてもよい。
 ステップS22で、走行経路生成部15は、車線変更の実行中であるか否かを判断し、車線変更の実行中であると判定した場合、ステップS23に進み、車線変更の実行中でないと判定した場合は、ステップS26に進む。ステップS26で、車線変更の実行中でないので、走行経路生成部15は、自車線走行経路Yownを、最終的な目標走行経路に設定する。
<区画線の跨ぎ判定>
 一方、車線変更の実行中である場合は、ステップS23で、走行経路生成部15は、車線変更の開始後、走行路認識部12の判定結果に基づいて、車線変更前の車線と車線変更後の車線とを区画する区画線を、自車両が跨いだか否かを判定し、区画線を跨ぐ前であると判定した場合は、ステップS24に進み、区画線を跨いだ後であると判定した場合は、ステップS25に進む。
<区画線を跨ぐ前の車線変更走行経路の生成>
 ステップS24で、区画線を跨ぐ前は、走行経路生成部15は、自車線走行経路から車線変更後の車線の走行経路に次第に近づく車線変更走行経路を生成する。
 本実施の形態では、走行経路生成部15は、各区画線の区画線情報に基づいて、車線変更の開始から終了までに自車両を横方向に移動させる距離である全横方向移動距離Wdを算出する。例えば、走行経路生成部15は、次式に示すように、車線変更前の車線の車線幅Wbfと車線変更後の車線の車線幅Wafとの合計値の半分値に、車線変更方向に応じた+1又は-1を乗算した値を、全横方向移動距離Wdとして算出する。区画線を跨ぐ前は、車線変更前の車線は、自車線である。走行経路生成部15は、車線変更前の車線の左側の区画線の区画線距離K0と車線変更前の車線の右側の区画線の区画線距離K0との差を、車線変更前の車線の車線幅Wbfとして算出する。また、走行経路生成部15は、車線変更後の車線の左側の区画線の区画線距離K0と車線変更後の車線の右側の区画線の区画線距離K0との差を、車線変更後の車線の車線幅Wafとして算出する。
Figure JPOXMLDOC01-appb-M000004
 車線変更前の車線の右側区画線及び左側区画線の一方又は双方の区画線情報が得られない場合は、車線変更前の車線の車線幅Wbfは、過去に取得された該当車線の車線幅に設定されてもよいし、地図データから得られた車線幅に設定されてもよいし、標準的な車線幅に設定されてもよい。また、車線変更後の車線の右側区画線及び左側区画線の一方又は双方の区画線情報が得られない場合は、車線変更後の車線の車線幅Wafは、過去に取得された該当車線の車線幅に設定されてもよいし、地図データから得られた該当車線の車線幅に設定されてもよいし、標準的な車線幅に設定されてもよい。
 走行経路生成部15は、区画線を跨ぐ前は、自車線走行経路Yownに対する自車両の横方向への移動距離Ychgを、車線変更の開始時点からの自車両の前方向への移動距離Xchg(以下、車線変更開始後の前方向移動距離Xchgと称す)に応じて、0から全横方向移動距離Wdまで次第に変化させ、自車線走行経路Yownに横方向への移動距離Ychgを加算して、車線変更走行経路YLCを生成する。
 本実施の形態では、走行経路生成部15は、次式を用いて、車線変更開始後の前方向移動距離Xchg、及び全横方向移動距離Wdに基づいて、横方向の移動距離Ychgを算出する。
Figure JPOXMLDOC01-appb-M000005
 ここで、Lは、車線変更の開始時点から終了時点までの前方向の目標移動距離であり、車速検出装置32により検出された自車両の車速に応じて変化される。Xrunは、車線変更の開始時点から現在の自車両の位置までの自車両の前方向の移動距離であり、車線変更の開始時点からの自車両の移動距離を積算して算出される。Xは、現在の自車両の位置を基準とした自車両の座標系の前方向の位置である。走行経路生成部15は、0から車線変更終了位置Xend(=L-Xrun)まで、前方向の位置Xを次第に増加させ、各前方向の位置Xにおいて、式(9)を用いて、横方向の移動距離Ychgを算出する。その結果、各前方向の位置Xと、各前方向の位置Xにおける横方向の移動距離Ychgとが算出される。
 式(9)の{}の中の多項式は、(Xchg/L)を変数とした多項式であり、(Xchg/L)が0から1まで増加するに従って、0から1まで次第に変化する。a、b、c、d、eは、多項式の各次数の係数であり、熟練ドライバーの車線変更を模して予め設定される。例えば、a=b=c=0、d=10、e=-15、f=6に設定される。
 なお、式(9)の多項式の代わりに、Xchg/Lと、0から1まで変化する係数との関係が予め設定されたマップデータなどが用いられてもよい。
 そして、走行経路生成部15は、次式に示すように、自車線走行経路Yownに横方向の移動距離Ychgを加算して、車線変更走行経路YLCを算出する。
 YLC=Yown+Ychg    ・・・(10)
 走行経路生成部15は、0から車線変更終了位置Xend(=L-Xrun)まで、前方向の位置Xを次第に増加させ、各前方向の位置Xにおいて、式(6)を用いて算出した自車線走行経路Yownと式(9)を用いて算出した横方向の移動距離Ychgとを加算して、車線変更走行経路YLCを算出する。その結果、現在の自車両の位置を基準とした自車両の座標系における、各前方向の位置Xと、各前方向の位置Xにおける車線変更走行経路YLC(横方向の位置)とが算出される。そして、走行経路生成部15は、車線変更走行経路YLCを最終的な目標走行経路に設定する。
<区画線を跨いだ後の車線変更走行経路の生成>
 ステップS25で、区画線を跨いだ後は、走行経路生成部15は、車線変更前の車線の走行経路から自車線走行経路に次第に近づく車線変更走行経路を生成する。
 本実施の形態では、走行経路生成部15は、区画線を跨ぐ前と同様に、各区画線の区画線情報に基づいて、車線変更の開始から終了までに自車両を横方向に移動させる距離である全横方向移動距離Wdを算出する。例えば、走行経路生成部15は、式(8)を用いて、全横方向移動距離Wdを算出する。区画線を跨いだ後は、車線変更後の車線は、自車線である。
 走行経路生成部15は、区画線を跨いだ後は、自車線走行経路Yownに対する自車両の横方向への移動距離Ychgを、車線変更開始後の前方向移動距離Xchgに応じて、全横方向移動距離Wdに-1を乗算した値から0まで次第に変化させ、自車線走行経路Yownに横方向への移動距離Ychgを加算して、車線変更走行経路YLCを生成する。
 本実施の形態では、走行経路生成部15は、次式を用いて、車線変更開始後の前方向移動距離Xchg、及び全横方向移動距離Wdに基づいて、横方向の移動距離Ychgを算出する。
Figure JPOXMLDOC01-appb-M000006
 走行経路生成部15は、0から車線変更終了位置Xend(=L-Xrun)まで、前方向の位置Xを次第に増加させ、各前方向の位置Xにおいて、式(11)を用いて、横方向の移動距離Ychgを算出する。その結果、各前方向の位置Xと、各前方向の位置Xにおける横方向の移動距離Ychgとが算出される。
 そして、走行経路生成部15は、次式に示すように、自車線走行経路Yownに横方向の移動距離Ychgを加算して、車線変更走行経路YLCを算出する。
 YLC=Yown+Ychg    ・・・(12)
 走行経路生成部15は、0から車線変更終了位置Xend(=L-Xrun)まで、前方向の位置Xを次第に増加させ、各前方向の位置Xにおいて、式(6)を用いて算出した自車線走行経路Yownと式(11)を用いて算出した横方向の移動距離Ychgとを加算して、車線変更走行経路YLCを算出する。その結果、現在の自車両の位置を基準とした自車両の座標系における、各前方向の位置Xと、各前方向の位置Xにおける車線変更走行経路YLC(横方向の位置)とが算出される。そして、走行経路生成部15は、車線変更走行経路YLCを最終的な目標走行経路に設定する。
 図13に示す例では、区画線を跨ぐ前(時刻t1より前)は、中央車線が自車線に判定されており、有効判定された自車線の基準区画線に基づいて生成された自車線走行経路Yownは、中央車線の中央に設定され、自車線走行経路Yownに、0から全横方向移動距離Wdまで次第に変化する横方向移動距離Ychgが加算されて車線変更走行経路YLCが算出されている。
 一方、区画線を跨いだ後(時刻t1より後)は、右側車線が自車線に判定されており、有効判定された自車線の基準区画線に基づいて生成された自車線走行経路Yownは、右側車線の中央に設定され、自車線走行経路Yownに、全横方向移動距離Wdに-1を乗算した値から0まで次第に変化する横方向移動距離Ychgが加算されて車線変更走行経路YLCが算出されている。
 このように、区画線を跨ぐ前後において、有効判定された最新の自車線の区画線情報に基づいて、精度よく車線変更走行経路を生成することができる。
6.操舵制御部16
 操舵制御部16は、走行経路生成部15により生成された目標走行経路(車線変更中は車線変更走行経路YLC、車線変更中以外は自車線走行経路Yown)に基づいて、車輪の操舵角を制御する操舵制御を行う操舵制御処理(操舵制御ステップ)を実行する。
<操舵制御>
 操舵制御部16は、目標走行経路及び車速等に基づいて、自車両を目標走行経路に沿って走行させる車輪の操舵角の指令値を算出し、操舵装置24に伝達する。車線変更制御は、自動運転車両の自動運転機能の一部として設けられてもよい。
 操舵装置24は、電動パワーステアリング装置であり、電動モータの駆動力により車輪の操舵角を操作する。操舵装置24は、実際の操舵角が、操舵角の指令値に追従するように、電動モータを駆動制御する。
実施の形態2.
 次に、実施の形態2に係る走行経路生成装置10及び走行経路生成方法について説明する。上記の実施の形態1と同様の構成部分は説明を省略する。本実施の形態に係る走行経路生成装置10の基本的な構成及び処理は実施の形態1と同様である。本実施の形態では、走行経路生成部15の処理の一部が実施の形態1と異なる。
 本実施の形態では、走行経路生成部15は、区画線を跨いだ後、自車線の左側の区画線及び右側の区画線の一方の区画線情報が取得できない場合は、過去に取得した車線変更後の車線の左側の区画線及び右側の区画線の区画線情報に基づいて生成する場合よりも、自車線走行経路を、区画線情報が取得できた左側の区画線又は右側の区画線に寄せて生成する。
 区画線情報を取得できていない区画線の側は、区画線が検出できていないだけで、車両が実際に走行できる車線の幅が狭くなっている可能性がある。この構成によれば、区画線を跨いだ後、自車線走行経路が、区画線情報が取得できた区画線の側に寄せて生成されるので、車線の幅が狭くなっている場合でも、自車両を、狭くなっている車線を走行させることができる。
 実施の形態1と同様に、走行経路生成部15は、基準区画線の区画線情報によって表される基準区画線の近似曲線を、自車両の横方向に、自車線の車線幅Wownに応じたシフト幅ΔWsftだけシフトさせて、自車線走行経路を生成する。例えば、走行経路生成部15は、式(6)に示したように、式(1)に示した自車両座標系における基準区画線の近似曲線を、シフト幅ΔWsftだけ横方向にシフトさせて、自車線走行経路Yownを設定する。
 本実施の形態では、走行経路生成部15は、区画線を跨いだ後、自車線の左側の区画線及び右側の区画線の一方の区画線情報が取得できない場合は、過去に取得した車線変更後の車線の左側の区画線及び右側の区画線の区画線情報に基づいて生成する場合よりも、シフト幅ΔWsftを小さくする。
 例えば、走行経路生成部15は、次式に示すように、一方の区画線情報が取得できない場合は、過去に取得した車線変更後の車線の左側及び右側の区画線情報に基づいて算出した車線変更後の車線の車線幅Waf_oldの半分値から寄せ幅Wcmpだけ減算した値に、区画線情報を取得できない区画線が右側又は左側であるかに応じた+1又は-1を乗算した値を、シフト幅ΔWsftとして算出する。また、走行経路生成部15は、シフト幅ΔWsftが狭くなり過ぎないように、シフト幅ΔWsftの絶対値を、自車両の車幅に応じた幅により下限制限してもよい。
Figure JPOXMLDOC01-appb-M000007
 或いは、走行経路生成部15は、標準的な車線幅から寄せ幅Wcmpだけ減算した値を、シフト幅ΔWsftとして設定してもよい。標準的な車線幅は、走行している道路の種別によって設定されてもよいし、地図データから取得されてもよいし、区画線情報に基づいて算出された他の車線の車線幅に設定されてもよい。
 また、本実施の形態では、走行経路生成部15は、区画線を跨いだ後、自車線の左側の区画線及び右側の区画線の一方の区画線情報を取得できない場合は、過去に取得した車線変更後の車線の左側の区画線及び右側の区画線の区画線情報に基づいて生成する場合よりも、全横方向移動距離Wdを、自車線走行経路の寄せ幅Wcmpだけ変化させる。
 この構成によれば、自車線走行経路の寄せ幅Wcmpに対応させて、全横方向移動距離Wdを変化させ、車線変更走行経路を適切に生成することができる。
 例えば、走行経路生成部15は、次式に示すように、車線変更前の車線の車線幅Wbfと過去に取得した車線変更後の車線の車線幅Waf_oldとの合計値の半分値から寄せ幅Wcmpを変化させた値に、車線変更方向に応じた+1又は-1を乗算した値を、全横方向移動距離Wdとして算出する。
Figure JPOXMLDOC01-appb-M000008
 そして、実施の形態1と同様に、走行経路生成部15は、式(11)を用いて、車線変更開始後の前方向移動距離Xchg、及び全横方向移動距離Wdに基づいて、横方向の移動距離Ychgを算出する。そして、走行経路生成部15は、式(12)を用いて、自車線走行経路Yownに横方向の移動距離Ychgを加算して、車線変更走行経路YLCを算出する。
 図14に、本実施の形態に係る走行経路生成処理の例を示す。片側3車線であり、右側車線の右側の区画線が途中でなくなり、取得できなくなっている。時刻t0から時刻t2までの期間で、自車両が中央車線から右側車線に車線変更している。時刻t1において、自車両が、車線変更により中央車線と右側車線とを区画する区画線を跨いでいる。
 右側車線の右側の区画線がなくなる前は、当該区画線の区画線情報が取得できており、右側車線の左側の区画線及び右側の区画線の区画線情報に基づいて、車線変更後の車線の車線幅Wafが取得されている。最後に取得された車線変更後の車線の車線幅Wafが記憶される。
 時刻t1で、区画線を跨いだ後、右側車線に設定された自車線の左側区画線が基準区画線として選択され、基準区画線の区画線情報に基づいて、自車線走行経路が生成されている。この際、自車線の右側区画線の区画線情報が取得されていないため、過去に取得された車線変更後の車線の車線幅Waf_oldから寄せ幅Wcmpだけ減算した値が、シフト幅ΔWsftとして設定されている。その結果、自車線走行経路は、過去に取得された車線変更後の車線の車線幅Waf_oldに基づいて生成される場合よりも、寄せ幅Wcmpだけ左側に寄って生成されている。そのため、点線で示すように、右側車線の右側の車線端が左側に寄っており、車線幅が減少している場合でも、自車両を、狭くなっている車線内を走行させることができている。
 また、寄せ幅Wcmpに対応させて、全横方向移動距離Wdが変化され、車線変更走行経路が生成されているので、寄せ幅Wcmpによる補正後も車線変更走行経路が適切に生成されていると共に、寄せ幅Wcmpによる補正の前後において、車線変更走行経路が不連続になることを抑制することができている。
実施の形態3.
 次に、実施の形態3に係る走行経路生成装置10及び走行経路生成方法について説明する。上記の実施の形態1と同様の構成部分は説明を省略する。本実施の形態に係る走行経路生成装置10の基本的な構成及び処理は実施の形態1と同様である。本実施の形態では、走行経路生成部15の処理の一部が実施の形態1と異なる。
 図15に示すように、車線数が減少する区間で、車線変更が行われる場合、区画線を跨いだ後に、跨いだ区画線がなくなって車線数が減少し、自車線の車線幅が大きく増加する場合がある。この場合も、実施の形態1の方法では、自車線走行経路は、車線幅が増加した自車線の中央部に生成されるため、自車線走行経路の生成には大きな問題は生じない。しかし、実施の形態1の方法では、車線変更後の車線の車線幅Wafが大きく増加し、車線変更前の車線の車線幅Wbfは、取得できなくなるため、過去に取得した車線変更前の車線の車線幅Wbf_oldに設定される。そのため、式(8)により算出される全横方向移動距離Wdの絶対値が大きく増加し、生成される車線変更走行経路が不適切なものになる。
 そこで、本実施の形態では、走行経路生成部15は、区画線を跨いだ後、前回取得された自車線の車線幅Wown(n-1)と今回取得された自車線の車線幅Wown(n)との間の車線幅の変動量ΔWownが、予め設定された判定変動量Thw以上になった後、判定変動量Thw以上になったときの自車両に対する自車線走行経路の横方向の距離Ytmpに応じて、全横方向移動距離Wdを変化させる。
 本実施の形態では、走行経路生成部15は、次式に示すように、区画線を跨いだ後、前回取得された自車線の車線幅Wown(n-1)と今回取得された自車線の車線幅Wown(n)との間の車線幅の変動量ΔWownが、予め設定された判定変動量Thw以上になったときに、自車両に対する自車線走行経路の横方向の距離Ytmpの2倍値を、全横方向移動距離Wdとして算出する。
Figure JPOXMLDOC01-appb-M000009
 そして、実施の形態1と同様に、走行経路生成部15は、式(11)を用いて、車線変更開始後の前方向移動距離Xchg、及び式(15)により算出した全横方向移動距離Wdに基づいて、横方向の移動距離Ychgを算出する。実施の形態1と同様に、走行経路生成部15は、式(12)に示すように、自車線走行経路Yownに横方向の移動距離Ychgを加算して、車線変更走行経路YLCを算出する。
 図15に示すように、時刻t1で区画線を跨いだ後、時刻t2で跨いだ区画線がなくなり、自車線の車線幅Wownが大きく増加し、車線幅の変動量ΔWownが、予め設定された判定変動量Thw以上になっている。このとき、自車線走行経路Yownは、区画線がなくなる前の右側車線の中心から、区画線がなくなった後の一車線の中心に変更されている。
 本実施の形態のように、自車両に対する自車線走行経路の横方向の距離Ytmpにより全横方向移動距離Wdを補正しない場合は、全横方向移動距離Wdが大きくなりすぎ、区画線がなくなる前後で車線変更走行経路が不連続になる不適切な車線変更走行経路が形成される。一方、自車両に対する自車線走行経路の横方向の距離Ytmpにより全横方向移動距離Wdを補正した場合は、全横方向移動距離Wdを適切に減少させることができ、区画線がなくなる前後で車線変更走行経路が不連続になることを抑制し、適切な車線変更走行経路を形成することができる。
 一方、図16に示すように、時刻t1で区画線を跨いだ後、時刻t2で跨いだ区画線がなくなり、自車線走行経路が、自車両に対して車線変更方向とは反対側に変化する場合でも、自車両に対する自車線走行経路の横方向の距離Ytmp、及び全横方向移動距離Wdの負号が反転し、適切に車線変更走行経路が生成される。
<転用例>
 以上で説明した走行経路生成装置は、PND(Portable Navigation Device)などのナビゲーション装置と、携帯電話、スマートフォン及びタブレットなどの携帯端末を含む通信端末と、これらにインストールされるアプリケーションの機能と、サーバとを適宜に組み合わせてシステムとして構築される走行経路生成システムにも適用することができる。この場合、以上で説明した走行経路生成装置の各機能あるいは各構成要素は、前記システムを構築する各機器に分散して配置されてもよいし、いずれかの機器に集中して配置されてもよい。
 本願は、様々な例示的な実施の形態及び実施例が記載されているが、1つ、または複数の実施の形態に記載された様々な特徴、態様、及び機能は特定の実施の形態の適用に限られるのではなく、単独で、または様々な組み合わせで実施の形態に適用可能である。従って、例示されていない無数の変形例が、本願明細書に開示される技術の範囲内において想定される。例えば、少なくとも1つの構成要素を変形する場合、追加する場合または省略する場合、さらには、少なくとも1つの構成要素を抽出し、他の実施の形態の構成要素と組み合わせる場合が含まれるものとする。
10 走行経路生成装置、11 区画線情報取得部、12 走行路認識部、13 区画線情報有効判定部、14 基準区画線選択部、15 走行経路生成部、16 操舵制御部、Wd 全横方向移動距離、Xchg 前方向の移動距離、YLC 車線変更走行経路、Ychg 横方向の移動距離、Yown 自車線走行経路

Claims (10)

  1.  自車両が走行している車線である自車線及び前記自車線に隣接する車線を含む、自車両の前方の認識可能な単数又は複数の車線の区画線について、自車両の位置を基準とする各区画線の位置及び形状に関する区画線情報を取得する区画線情報取得部と、
     各区画線の前記区画線情報に基づいて、各区画線と自車線との対応関係を判定する走行路認識部と、
     自車両の車線変更中に、各区画線の前記区画線情報について、車線変更するための走行経路である車線変更走行経路の生成に用いることができる有効な前記区画線情報であるか否かを判定する区画線情報有効判定部と、
     車線変更中に、前記区画線情報有効判定部による各区画線の前記区画線情報の有効判定結果に基づいて、前記自車線の左側の区画線及び右側の区画線から1つの区画線を基準区画線として選択する基準区画線選択部と、
     車線変更中に、前記基準区画線の前記区画線情報に基づいて、車線変更するための走行経路である前記車線変更走行経路を生成する走行経路生成部と、を備えた走行経路生成装置。
  2.  前記走行路認識部は、自車両が区画線を跨いだときに、自車線が、跨ぐ前の車線から跨いだ後の車線に変化するように、各区画線と自車線との対応関係を変更し、
     前記走行経路生成部は、前記基準区画線の前記区画線情報に基づいて、車線変更を行わず自車線に沿って走行する場合の走行経路である自車線走行経路を生成し、
     区画線を跨ぐ前は、前記自車線走行経路から車線変更後の車線の走行経路に次第に近づく前記車線変更走行経路を生成し、
     区画線を跨いだ後は、車線変更前の車線の走行経路から前記自車線走行経路に次第に近づく前記車線変更走行経路を生成する請求項1に記載の走行経路生成装置。
  3.  前記走行経路生成部は、各区画線の前記区画線情報に基づいて、車線変更の開始から終了までに自車両を横方向に移動させる距離である全横方向移動距離を算出し、
     区画線を跨ぐ前は、前記自車線走行経路に対する自車両の横方向への移動距離を、車線変更の開始時点からの自車両の前方向への移動距離に応じて、0から前記全横方向移動距離まで次第に変化させ、前記自車線走行経路に前記横方向への移動距離を加算して、前記車線変更走行経路を生成し、
     区画線を跨いだ後は、前記横方向への移動距離を、前記前方向の移動距離に応じて、前記全横方向移動距離に-1を乗算した値から0まで次第に変化させ、前記自車線走行経路に前記横方向への移動距離を加算して、前記車線変更走行経路を生成する請求項2に記載の走行経路生成装置。
  4.  前記区画線情報取得部は、各区画線の前記区画線情報として、自車両と自車両の横方向に位置する区画線の部分との間の距離である区画線距離を含む情報を取得し、
     前記走行経路生成部は、各区画線の前記区画線距離に基づいて、前記全横方向移動距離を算出する請求項3に記載の走行経路生成装置。
  5.  前記走行経路生成部は、区画線を跨いだ後、自車線の左側の区画線及び右側の区画線の一方の前記区画線情報が取得できない場合は、過去に取得した車線変更後の車線の左側の区画線及び右側の区画線の前記区画線情報に基づいて生成する場合よりも、前記自車線走行経路を、前記区画線情報が取得できた左側の区画線又は右側の区画線に寄せて生成する請求項2から4のいずれか一項に記載の走行経路生成装置。
  6.  前記走行経路生成部は、区画線を跨いだ後、前回取得された自車線の車線幅と今回取得された自車線の車線幅との間の車線幅の変動量が、予め設定された判定変動量以上になった後、前記判定変動量以上になったときの自車両に対する前記自車線走行経路の横方向の距離に応じて、前記全横方向移動距離を変化させる請求項4に記載の走行経路生成装置。
  7.  前記区画線情報取得部は、周辺監視装置により区画線を検出し、検出した区画線に基づいて、前記区画線情報を取得し、
     前記区画線情報有効判定部は、各区画線の区画線情報について、前記周辺監視装置により検出された区画線の自車両の前方の長さが、判定長さよりも長い場合に、前記区画線情報が有効であると判定し、前記長さが前記判定長さよりも短い場合に、前記区画線情報が有効でないと判定する請求項1から6のいずれか一項に記載の走行経路生成装置。
  8.  前記区画線情報取得部は、各区画線の前記区画線情報として、区画線の曲率を含む情報を取得し、
     前記区画線情報有効判定部は、前記曲率が、他の区画線の前記曲率よりも判定曲率値以上異なっている区画線の前記区画線情報を有効でないと判定する請求項1から7のいずれか一項に記載の走行経路生成装置。
  9.  前記車線変更走行経路に基づいて、車輪の操舵角を制御する操舵制御を行う操舵制御部を備えた請求項1から8のいずれか一項に記載の走行経路生成装置。
  10.  自車両が走行している車線である自車線及び前記自車線に隣接する車線を含む、自車両の前方の認識可能な単数又は複数の車線の区画線について、自車両の位置を基準とする各区画線の位置及び形状に関する区画線情報を取得する区画線情報取得ステップと、
     各区画線の前記区画線情報に基づいて、各区画線と自車線との対応関係を判定する走行路認識ステップと、
     自車両の車線変更中に、各区画線の前記区画線情報について、車線変更するための走行経路である車線変更走行経路の生成に用いることができる有効な前記区画線情報であるか否かを判定する区画線情報有効判定ステップと、
     車線変更中に、前記区画線情報有効判定ステップにおける各区画線の前記区画線情報の有効判定結果に基づいて、前記自車線の左側の区画線及び右側の区画線から1つの区画線を基準区画線として選択する基準区画線選択ステップと、
     車線変更中に、前記基準区画線の前記区画線情報に基づいて、車線変更するための走行経路である前記車線変更走行経路を生成する走行経路生成ステップと、を備えた走行経路生成方法。
PCT/JP2020/037070 2020-09-30 2020-09-30 走行経路生成装置及び走行経路生成方法 WO2022070290A1 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
US18/006,786 US20230294700A1 (en) 2020-09-30 2020-09-30 Traveling route generation apparatus and traveling route generation method
JP2022553288A JP7353511B2 (ja) 2020-09-30 2020-09-30 走行経路生成装置及び走行経路生成方法
PCT/JP2020/037070 WO2022070290A1 (ja) 2020-09-30 2020-09-30 走行経路生成装置及び走行経路生成方法
CN202080105238.4A CN116113567A (zh) 2020-09-30 2020-09-30 行驶路径生成装置以及行驶路径生成方法
DE112020007646.6T DE112020007646T5 (de) 2020-09-30 2020-09-30 Fahrweg-Erzeugungsvorrichtung und Fahrweg-Erzeugungsverfahren

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2020/037070 WO2022070290A1 (ja) 2020-09-30 2020-09-30 走行経路生成装置及び走行経路生成方法

Publications (1)

Publication Number Publication Date
WO2022070290A1 true WO2022070290A1 (ja) 2022-04-07

Family

ID=80951553

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2020/037070 WO2022070290A1 (ja) 2020-09-30 2020-09-30 走行経路生成装置及び走行経路生成方法

Country Status (5)

Country Link
US (1) US20230294700A1 (ja)
JP (1) JP7353511B2 (ja)
CN (1) CN116113567A (ja)
DE (1) DE112020007646T5 (ja)
WO (1) WO2022070290A1 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114877911A (zh) * 2022-07-08 2022-08-09 小米汽车科技有限公司 路径规划方法、装置、车辆及存储介质
JP7507816B2 (ja) 2022-08-12 2024-06-28 本田技研工業株式会社 車両制御装置、車両制御方法、およびプログラム

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20220281473A1 (en) * 2021-03-05 2022-09-08 Continental Automotive Systems, Inc. Driver Effort Augmentation to Indicate Trajectory Planner Feedback
KR102499334B1 (ko) * 2021-06-28 2023-02-14 (주)뷰런테크놀로지 라이다 센서를 이용하여 차선을 검출하는 방법 및 상기 방법을 수행하는 차선 검출 장치

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017084137A (ja) * 2015-10-28 2017-05-18 本田技研工業株式会社 道路区画線認識装置、車両制御装置、道路区画線認識方法、および道路区画線認識プログラム
JP2018177179A (ja) * 2017-04-12 2018-11-15 トヨタ自動車株式会社 車線変更支援装置
JP2018177180A (ja) * 2017-04-17 2018-11-15 トヨタ自動車株式会社 操舵支援装置
JP2018202966A (ja) * 2017-06-01 2018-12-27 本田技研工業株式会社 車両制御システム、車両制御方法、および車両制御プログラム
JP2019059363A (ja) * 2017-09-27 2019-04-18 トヨタ自動車株式会社 運転支援装置

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6593695B2 (ja) 2015-09-15 2019-10-23 日野自動車株式会社 車線変更操舵制御システム

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017084137A (ja) * 2015-10-28 2017-05-18 本田技研工業株式会社 道路区画線認識装置、車両制御装置、道路区画線認識方法、および道路区画線認識プログラム
JP2018177179A (ja) * 2017-04-12 2018-11-15 トヨタ自動車株式会社 車線変更支援装置
JP2018177180A (ja) * 2017-04-17 2018-11-15 トヨタ自動車株式会社 操舵支援装置
JP2018202966A (ja) * 2017-06-01 2018-12-27 本田技研工業株式会社 車両制御システム、車両制御方法、および車両制御プログラム
JP2019059363A (ja) * 2017-09-27 2019-04-18 トヨタ自動車株式会社 運転支援装置

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114877911A (zh) * 2022-07-08 2022-08-09 小米汽车科技有限公司 路径规划方法、装置、车辆及存储介质
CN114877911B (zh) * 2022-07-08 2022-10-04 小米汽车科技有限公司 路径规划方法、装置、车辆及存储介质
JP7507816B2 (ja) 2022-08-12 2024-06-28 本田技研工業株式会社 車両制御装置、車両制御方法、およびプログラム

Also Published As

Publication number Publication date
JPWO2022070290A1 (ja) 2022-04-07
CN116113567A (zh) 2023-05-12
DE112020007646T5 (de) 2023-09-21
US20230294700A1 (en) 2023-09-21
JP7353511B2 (ja) 2023-09-29

Similar Documents

Publication Publication Date Title
WO2022070290A1 (ja) 走行経路生成装置及び走行経路生成方法
US11181920B2 (en) Travel assistance method and travel assistance apparatus
RU2645388C2 (ru) Устройство определения неправильного распознавания
JP6580087B2 (ja) 走行軌道決定装置及び自動運転装置
CN110361021B (zh) 车道线拟合方法及***
JP6082415B2 (ja) 車両の走行制御装置
CN110998691B (zh) 行驶辅助方法及行驶辅助装置
JP6568559B2 (ja) 車両の走行制御装置
JP6269552B2 (ja) 車両走行制御装置
JP5907141B2 (ja) 車両の走行経路演算装置
US20140169630A1 (en) Driving assistance apparatus and driving assistance method
JP6610799B2 (ja) 車両の走行制御方法および走行制御装置
CN110758381B (zh) 生成转向轨迹的方法、装置、存储介质及电子设备
CN113771839B (zh) 一种自动泊车决策规划方法及***
JP2020032828A (ja) 車両用操舵装置
CN114834486A (zh) 一种规划车辆掉头路径的方法、装置及设备
KR20210027458A (ko) 주행 지원 방법 및 주행 지원 장치
EP3985641B1 (en) Travel assistance method and travel assistance device
CN114721384A (zh) 一种车道保持的轨迹规划方法
JP2018128906A (ja) 車両制御装置
RU2777141C1 (ru) Способ помощи при движении и устройство помощи при движении
WO2023002579A1 (ja) 走行軌道生成装置
JP6601297B2 (ja) 制御装置
JP2024064374A (ja) 地図情報出力装置及び地図情報出力方法
JP2023049128A (ja) 走行車線認識装置及び走行車線認識方法

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 20956218

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2022553288

Country of ref document: JP

Kind code of ref document: A

WWE Wipo information: entry into national phase

Ref document number: 112020007646

Country of ref document: DE

122 Ep: pct application non-entry in european phase

Ref document number: 20956218

Country of ref document: EP

Kind code of ref document: A1