WO2019021421A1 - 運転支援車両の自己位置補正方法及び自己位置補正装置 - Google Patents

運転支援車両の自己位置補正方法及び自己位置補正装置 Download PDF

Info

Publication number
WO2019021421A1
WO2019021421A1 PCT/JP2017/027257 JP2017027257W WO2019021421A1 WO 2019021421 A1 WO2019021421 A1 WO 2019021421A1 JP 2017027257 W JP2017027257 W JP 2017027257W WO 2019021421 A1 WO2019021421 A1 WO 2019021421A1
Authority
WO
WIPO (PCT)
Prior art keywords
lane
vehicle
self
position correction
correction target
Prior art date
Application number
PCT/JP2017/027257
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 KR1020207002178A priority Critical patent/KR102138094B1/ko
Priority to EP17918879.2A priority patent/EP3660456B1/en
Priority to CA3071227A priority patent/CA3071227C/en
Priority to MYPI2020000446A priority patent/MY181900A/en
Priority to US16/626,379 priority patent/US10953896B2/en
Priority to JP2019532294A priority patent/JP6717433B2/ja
Priority to RU2020108220A priority patent/RU2725703C1/ru
Priority to CN201780092997.XA priority patent/CN110892230B/zh
Priority to BR112020001558-0A priority patent/BR112020001558A2/pt
Priority to PCT/JP2017/027257 priority patent/WO2019021421A1/ja
Publication of WO2019021421A1 publication Critical patent/WO2019021421A1/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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • G01C21/30Map- or contour-matching
    • 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
    • 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
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • G01C21/36Input/output arrangements for on-board computers
    • G01C21/3626Details of the output of route guidance instructions
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • G01C21/36Input/output arrangements for on-board computers
    • G01C21/3667Display of a road map
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/0088Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/09Arrangements for giving variable traffic instructions
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/123Traffic control systems for road vehicles indicating the position of vehicles, e.g. scheduled vehicles; Managing passenger vehicles circulating according to a fixed timetable, e.g. buses, trains, trams

Definitions

  • the present disclosure relates to a self-position correction method and a self-position correction device for a driving assistance vehicle.
  • the position of the correction object is specified based on the image captured by the camera mounted on the vehicle, and the distance to the correction object is measured. Therefore, when the object to be corrected can not be photographed properly, the self position correction can not be performed, and a problem arises that the correction opportunity is missed.
  • the present disclosure has been made in view of the above problems, and it is an object of the present disclosure to provide a self-position correction method and a self-position correction device for a driving assistance vehicle that can increase the opportunity to correct the self position on a map. .
  • the present disclosure selects the lane in which the vehicle travels based on the in-vehicle sensor that acquires the peripheral information of the vehicle, the acquired information of the in-vehicle sensor, and the map information, and And a controller for correcting the self position correction method of the driving support vehicle. Then, in the lane selection control for selecting the lane in which the host vehicle travels, first, the self position correction target on the planned travel route is specified based on the map information. Next, when reaching the correction point where the specified self-position correction target exists, it is determined whether the in-vehicle sensor can recognize the self-position correction target from the lane in which the host vehicle is traveling. Then, when it is determined that the self position correction target can not be recognized from the lane in which the host vehicle travels, the lane is changed to a lane in which the self position correction target can be recognized before reaching the correction point.
  • the present disclosure can increase the opportunity to correct its own position on the map.
  • FIG. 1 is an entire system configuration diagram showing a self position correction system of a first embodiment.
  • 5 is a flowchart showing a flow of position correction support control processing executed by the vehicle control ECU of the first embodiment.
  • 5 is a flowchart showing a flow of self position correction control processing executed by the vehicle control ECU of the first embodiment.
  • 5 is a flowchart showing a flow of basic lane selection control processing executed by the vehicle control ECU of the first embodiment. It is a flow chart which shows a flow of target course follow check processing within basic lane selection control processing. It is a flow chart which shows a flow of return confirmation processing from an overtaking lane in basic lane selection control processing. It is a flow chart which shows a flow of overtaking confirmation processing in basic lane selection control processing.
  • Example 1 a mode for carrying out a self-position correction method and a self-position correction device of a driving assistance vehicle of the present disclosure will be described based on Example 1 shown in the drawings.
  • the self position correction method and the self position correction device in the first embodiment have a self position correction system that corrects the position of the vehicle on the map while traveling, and automatically change the lane to follow the target lane. Applied to a driving support vehicle capable of automatic driving.
  • the configuration of the first embodiment will be described as "overall system configuration of self position correction system”, “detailed configuration of lane selection control unit”, “position correction support control processing configuration”, “self position correction control processing configuration”, “basic It divides into lane selection control processing composition ", and explains.
  • the self-position correction system 1 includes an external sensor 11, an internal sensor 12, a GPS receiver 13, a map database 14, and a navigation system 15. Furthermore, the vehicle control ECU 20, the drive actuator 31, and the notification actuator 32 are provided.
  • the external sensor 11 is a sensor (in-vehicle sensor) provided on the own vehicle for acquiring surrounding information of the own vehicle while traveling.
  • the external sensor 11 of the first embodiment is a generally used stereo camera.
  • the stereo camera which is the external sensor 11 has a photographing range (recognizable area) in which a total of four white lines can be photographed, two at the left and the right at the center of the vehicle at the maximum.
  • the peripheral information of the vehicle acquired by the external sensor 11 is output to the vehicle control ECU 20 and the navigation system 15 via the CAN communication line 10.
  • the external sensor 11 may be a clearance sonar using an ultrasonic wave, a laser range finder using an infrared laser, or the like.
  • the internal sensor 12 is a sensor which is provided in the own vehicle and detects the traveling state of the own vehicle.
  • the internal sensor 12 is a vehicle speed sensor, a yaw angle sensor, a steering angle sensor or the like.
  • the vehicle information acquired by the internal sensor 12 is output to the vehicle control ECU 20 and the navigation system 15 via the CAN communication line 10.
  • the GPS receiving unit 13 receives signals from three or more GPS satellites, extracts data necessary for positioning on the signals, and acquires GPS information indicating the position of the vehicle.
  • the GPS information acquired by the GPS reception unit 13 is output to the vehicle control ECU 20 and the navigation system 15 via the CAN communication line 10.
  • the map database 14 is stored in an on-vehicle memory (not shown), and travel information such as slopes and speed limits, road peripheral information such as signs and poles, structures (tunnels, bridges, footbridges etc.) indicators such as white lines and stop lines It is a database provided with map information in which information etc. were written. Information of the map database 14 is referenced from the vehicle control ECU 20 and the navigation system 15 via the CAN communication line 10.
  • the navigation system 15 estimates the position (self position) of the vehicle on the map using various information input from the external sensor 11, the internal sensor 12, the GPS receiving unit 13, and the map database 14. Then, based on the estimated own position information, destination information set on the map by the driver of the vehicle, and the like, a planned travel route to the destination is generated. Further, the driver is informed of the planned travel route generated.
  • the travel route information and the self-position information generated by the navigation system 15 are output to the vehicle control ECU 20 via the CAN communication line 10.
  • the vehicle control ECU 20 uses the external sensor 11, the internal sensor 12, the GPS receiving unit 13, the map database 14, the navigation system 15, and various information input from the on-vehicle memory (not shown) It is an integrated controller that outputs a control command for traveling along.
  • the control command output from the vehicle control ECU 20 is input to the drive actuator 31 or the notification actuator 32 as necessary.
  • the vehicle control ECU 20 includes a self position correction control unit 21 and a lane selection control unit 22.
  • the self position correction control unit 21 uses the external sensor 11, the internal sensor 12, the GPS receiving unit 13, the map database 14, the navigation system 15, and various types of information input from the in-vehicle memory to estimate the self position estimated by the navigation system 15. Perform self-position correction control to correct In this self position correction control, it is determined whether or not the self position correction target (for example, a white line having a curvature change point) can be recognized based on an image captured by the external sensor 11 which is a stereo camera. If the self position correction target can be recognized, the self position correction target (first white line) recognized based on the image captured by the external sensor 11 and the self position correction target (second white line identified based on the map database 14 ) And match.
  • the self position correction target for example, a white line having a curvature change point
  • the self position on the map is corrected.
  • this self-position correction is performed at a predetermined interval (here, every time a certain distance is traveled).
  • the travel distance of the section in which the self position correction can not be performed is integrated.
  • lane selection control by the lane selection control unit 22 is performed.
  • the lane selection control unit 22 is a basic lane for selecting a basic lane on which the vehicle basically travels based on various information input from the external sensor 11 and the internal sensor 12 and travel route information input from the navigation system 15. Perform selection control. In addition, this lane selection control unit 22 specifies the self position correction target of the traveling destination based on the map information obtained by referring to the map database 14, and it is necessary to change the lane for recognizing the self position correction target. It is determined whether or not it is, and lane selection control is performed to change lanes as necessary.
  • the drive actuators 31 are various actuators that drive an accelerator, a brake, and a steering that operate the vehicle based on a travel control command.
  • the notification actuator 32 automatically executes a lane change according to the lane selection control by the lane selection control unit 22, a report control command is input, and the lane change is performed based on the report control command (lane It is an actuator that drives a notification device that notifies the driver of implementing a change, the reason for performing a lane change, and the like.
  • the notification device is a speaker capable of outputting an arbitrary sound.
  • the lane selection control unit 22 of the first embodiment includes a correction target identification unit 23, a correction target recognition determination unit 24, a lane selection unit 25, and a basic lane selection unit 26. There is.
  • the correction target identification unit 23 refers to the map database 14 to acquire map information. Further, travel route information is acquired from the navigation system 15. Then, based on the map information and the travel route information, the self position correction target on the planned travel route is searched, and the self position correction target existing within a predetermined range based on the host vehicle is specified.
  • the “self-position correction target” is an object to be used as a measurement reference of positional displacement amount when correcting the position of the vehicle on the map.
  • the self position correction target is, for example, a white line having a predetermined curvature change point within a predetermined range, a marker, or the like.
  • the correction target recognition determination unit 24 detects an external sensor from the lane (current lane) in which the vehicle is currently traveling when the vehicle reaches the correction point where the self position correction target specified by the correction target specifying unit 23 exists. 11. Whether or not the self position correction target can be recognized is determined. That is, when the host vehicle has reached the correction point without changing the lane, it is determined whether or not the self position correction target can be recognized based on the image captured by the external sensor 11. The correction target recognition determination unit 24 performs the above determination based on the imaging range (recognizable range) of the external sensor 11 and the map information. Further, the “correction point” is an area of a predetermined range including the position where the self position correction target exists.
  • the self position correction target is determined before the own vehicle reaches the correction point. And outputs a travel control command to change the lane to a recognizable lane.
  • the travel control command to maintain the traveling of the currently running lane Output Note that these travel control commands are input to the drive actuator 31.
  • a notification control instruction to notify the driver of the lane change via the notification device is issued. Output.
  • the notification control command is input to the notification actuator 32.
  • the basic lane selection unit 26 selects a lane on which a road having a plurality of lanes is traveling, and outputs a travel control command for causing the lane to travel.
  • the travel control command is input to the drive actuator 31.
  • the basic lane selection unit 26 selects a lane to be followed by the planned traveling route acquired from the navigation system 15 as a target lane, and outputs a traveling control command to cause the target lane to travel. For example, when traveling along the central lane of a three-lane road and the planned travel route is branched to the left, it is necessary to travel the left lane before the branch point. In this case, the left lane is selected as the target lane, and a travel control command to change the lane to the target lane (left lane) is output.
  • the basic lane selection unit 26 selects the traveling lane adjacent to the passing lane as the target lane, and the target lane is selected.
  • a travel control command to change the lane to the lane (traveling lane) is output.
  • the lane to carry out overtaking is also a traveling lane. For this reason, control for returning to the original lane is not performed, and a travel control command to continue traveling on the currently traveling lane is output.
  • the basic lane selection unit 26 selects an overtaking lane when passing another vehicle ahead of the host vehicle as a target lane, and outputs a travel control command to change the lane to the target lane (overtaking lane).
  • the judgment criteria that can be passed are that the right lane adjacent to the lane in which the vehicle is currently traveling (the current lane) is present, and the relative velocity with the vehicle speed of the vehicle is less than the threshold vehicle speed ahead of the current lane. It is assumed that other vehicles exist.
  • the right lane is selected as the target lane, and a travel control command to change the lane to the target lane (right lane) is output.
  • FIG. 2 is a flowchart showing a flow of position correction support control processing executed by the vehicle control ECU of the first embodiment.
  • the position correction support control process of the first embodiment will be described below with reference to FIG.
  • step S1 it is determined whether the uncorrected distance recorded in the on-vehicle memory exceeds a preset threshold distance D [km]. In the case of YES (correction unimplemented distance> D [km]), the process proceeds to step S2. If NO (corrected distance ⁇ D [km]), the error of the self position on the map is small and it is not necessary to correct the self position. After updating, the process proceeds to step S20.
  • the “uncorrected distance” is a travel distance after the previous self position correction on the map, and is calculated by the following equation (1). The "uncorrected distance” continues to be loaded while the vehicle is traveling and is reset along with the correction.
  • Corrected unimplemented distance Corrected unimplemented distance + vehicle speed ⁇ (current time-previous time) ...
  • the threshold distance D [km] is a distance at which it is determined that the estimation error of the self position estimated based on the vehicle speed and the yaw rate exceeds a predetermined value, and is set based on an experiment or the like.
  • step S2 following the determination that the correction unimplemented distance> D [km] in step S1, it is determined that the self position correction is necessary, up to a predetermined distance X [m] on the planned traveling route ahead of the vehicle. In the range, it is determined whether or not there is a self position correction target that can be recognized by the external sensor 11 even while keeping the travel in the lane currently traveled (the current lane). In the case of YES (the self position correction target is present), the process proceeds to step S3. In the case of NO (no self position correction target), the process proceeds to step S4.
  • the presence or absence of the self position correction target is determined based on the map information written in the map database 14 and the traveling route information of the own vehicle acquired from the navigation system 15.
  • predetermined distance X [m] is a distance that can tolerate a state in which correction is not positively performed even if the uncorrected distance exceeds the threshold distance D [km]. For example, the threshold distance D [km] Half distance.
  • step S3 following the determination that there is a target of position correction that can be recognized by maintaining the current lane within the predetermined distance in step S2, if traveling of the current lane is continued, a predetermined distance X [m in front of the vehicle]
  • the travel control command for maintaining the travel of the lane currently traveled (the current lane) is output, assuming that the self position correction target can be recognized before traveling.
  • the target lane is set to the current lane, and the travel of the current lane is continued.
  • step S4 following the determination that there is no recognizable self position correction target in the current lane maintenance within the predetermined distance in step S2, it is on the planned travel route ahead of the own vehicle and closest to the own vehicle
  • the self position correction target existing at the position is specified, and the process proceeds to step S5.
  • the self position correction target is specified based on the map information written in the map database 14 and the traveling route information of the own vehicle acquired from the navigation system 15. Further, the search range of the self position correction target at this time is the entire route range from the current position of the vehicle to the destination.
  • step S5 following the identification of the self position correction target in step S4, the lane at which the vehicle is currently traveling (the current lane at the time of reaching the correction point where the self position correction target specified in step S4 exists) ), It is determined whether or not the self-position correction target can be recognized. If YES (recognizable), the process proceeds to step S6. In the case of NO (impossible to recognize), the process proceeds to step S7.
  • the “correction point” is a region of a predetermined range including the position where the self position correction target exists.
  • it is determined based on the self position information of the vehicle acquired from the navigation system 15 and the recognizable area of the external sensor 11 whether or not the current lane is a lane in which the self position correction target can be recognized.
  • step S6 following the determination that it is possible to recognize the self position correction target from the current lane when the correction point is reached in step S5, it is possible to recognize the self position correction target even if the traveling of the current lane is continued.
  • the traveling control command for maintaining the traveling of the lane currently traveled (the own lane) is output, and the process proceeds to step S10. That is, in this step S6, although there is no self position correction target that can be recognized in the current lane maintenance within the predetermined distance X [m] ahead of the host vehicle, the current lane is selected even if the predetermined distance X [m] is exceeded. By continuing to travel, it is determined that it is possible to recognize the self-maintenance correction object from the current lane. As a result, the target lane is set to the current lane, and the travel of the current lane is continued.
  • step S7 following the determination that it is impossible to recognize the self position correction target from the current lane when the correction point is reached in step S5, although the self position correction target is present on the planned traveling route, The driver is instructed to change the lane to a lane (correction target recognition lane) that can recognize the self position correction target as the self position correction target can not be recognized if the traveling of the lane is continued.
  • the notification control command to notify to is output, and it progresses to step S8.
  • the notification device is a speaker that outputs a voice
  • the reporting device informs the driver of the implementation of the lane change and the reason by voice.
  • step S8 following the notification of the lane change in step S7, a travel control command for changing the lane to a lane in which the self position correction target can be recognized (correction target recognition lane) is output, and the process proceeds to step S10.
  • the target lane is set as the correction target recognition lane, and the lane is changed.
  • the change of the lane is determined based on the peripheral information of the vehicle acquired by the external sensor 11 and the vehicle information acquired by the internal sensor 12. If the lane change can not be performed within a predetermined time due to the influence of the surrounding environment of the own vehicle, etc., the lane change execution is stopped, and the process returns to step S1.
  • step S10 following the output of either the traveling control instruction for maintaining the current lane in step S3 or step S6 or the traveling control instruction for changing the lane in step S8, the position of the vehicle on the map is corrected.
  • the self position correction control process is performed, and the process proceeds to step S20.
  • the self position correction control process in step S10 matches the peripheral information of the vehicle acquired by the external sensor 11 with the peripheral information of the vehicle acquired from the map database 14, and on the map based on the result, Is a process of correcting the self position of Details of the self-position correction control process will be described later.
  • step S20 following the execution of the self position correction control process in step S10, a basic lane selection control process of selecting a lane after self position correction is performed, and the process proceeds to return.
  • the basic lane selection control process in step S20 the lane selection necessary to follow the planned traveling route, the lane selection for returning from the overtaking lane to the traveling lane, and the lane selection necessary for overtaking the preceding vehicle are selected. Choose a lane to drive based on the three perspectives of In addition, when it is not determined that the lane change is necessary in any of the viewpoints, the travel of the lane currently being traveled is maintained, and the unnecessary lane change is not performed. The details of the basic lane selection control process will be described later.
  • step S4 to step S8 in the position correction support control processing shown in FIG. 2 selects the lane on which the vehicle travels based on the acquired information of the external sensor 11 and the map information of the map database 14. It corresponds to "lane selection control”. That is, in the position correction support control process, after the “lane selection control” is performed, the self position correction control process is performed to correct the self position on the map.
  • FIG. 3 is a flowchart showing a flow of self position correction control processing executed by the vehicle control ECU of the first embodiment.
  • the self-position correction control process of the first embodiment will be described based on FIG.
  • step S11 it is determined whether the vehicle has reached the correction point. In the case of YES (already reached), the process proceeds to step S12. In the case of NO (not reached), the correction non-implemented distance is integrated and recorded in the on-vehicle memory, and the time is updated, and then step S11 is repeated.
  • whether or not the correction point has been reached is determined based on the map information acquired from the map database 14 and the self-position information of the vehicle acquired from the navigation system 15.
  • step S12 following the determination that the correction point has been reached in step S11, it is determined based on sensor information from the external sensor 11 whether or not the self position correction target has been recognized. If YES (recognized), the process proceeds to step S13. If NO (cannot be recognized), the process proceeds to step S17.
  • the self-position correction target is, for example, a white line
  • the curvatures of the plurality of points set on the detected white line are measured based on the image information. Then, when there is a set of measurement points whose curvature difference at each point is larger than the predetermined value K, it is determined that the self position correction target has been recognized.
  • step S13 following the determination that the self position correction target is recognized in step S12, the first self position correction target recognized based on the image captured by the external sensor 11 and the first specified based on the map database 14 [2] Match the self position correction target, and proceed to step S14.
  • step S14 following the execution of matching in step S13, it is determined whether the matching is successful. In the case of YES (matching success), the process proceeds to step S15. In the case of NO (matching failure), the process proceeds to step S17.
  • whether or not the matching is successful depends on the positional shift amount obtained as a result of the matching (the position of the self position correction target obtained from the image information and the position of the self position correction target obtained from the map information It is judged on the basis of whether or not the deviation amount) is within a predetermined range.
  • the positional deviation amount can be estimated according to the traveling distance and the traveling time while the position correction is not performed. Therefore, when the positional deviation amount is out of the predetermined range, it can be determined that the matching has failed.
  • step S15 following the determination of matching success in step S14, the self-position is corrected so that the positional shift amount becomes zero, based on the positional shift information obtained as a result of the matching, and the process proceeds to step S16.
  • the new self position information after correction is input to the navigation system 15.
  • step S16 following the correction of the self-position information in step S15, the uncorrected distance is rewritten to "zero" and recorded in the on-vehicle memory, and the process proceeds to step S18.
  • step S17 following the determination that the self-position correction target can not be recognized in step S12 or the determination of the matching failure in step S14, it is determined that correction of the self-position information can not be appropriately performed.
  • the execution distance is integrated and recorded in the on-vehicle memory, and the time is updated, and the process proceeds to step S18.
  • a new integrated value is calculated and updated according to the above-mentioned equation (1) as the uncorrected distance.
  • step S18 following the zero setting of the correction non-execution distance in step S16 or the update of the correction non-execution distance in step S17, the time recorded as the previous time is rewritten to the current time and recorded in the on-vehicle memory.
  • FIG. 4 is a flowchart showing a flow of basic lane selection control processing executed by the vehicle control ECU according to the first embodiment. The flow of the basic lane selection control process shown in FIG. 4 will be described below.
  • step S21 target route tracking confirmation processing is executed, and the process proceeds to step S22.
  • the “target route following confirmation process” can follow the planned traveling route set by the navigation system 14 while traveling in the lane (current lane) in which the vehicle is currently traveling. Is a process to confirm the The route following lane selection flag and the route following lane are set according to the confirmation result. The details of the target route tracking confirmation process will be described later.
  • step S22 following the execution of the target route tracking confirmation processing in step S21, the route tracking lane selection flag set in the target route tracking confirmation processing is determined. If the route following lane selection flag is "true”, the process proceeds to step S23. If the route following lane selection flag is "false”, the process proceeds to step S24.
  • the vehicle changes the target lane to the route following lane set in the target route follow-up check processing, and performs travel control so that the current lane becomes the target lane.
  • the "route following lane” is a lane selected to follow the planned traveling route.
  • the “return confirmation process from the overtaking lane” is a process of confirming whether or not to return to the traveling lane while traveling on the overtaking lane. A return flag from the overtaking lane and a return lane are set according to the check result. The details of the return confirmation process from the overtaking lane will be described later.
  • step S25 following the execution of the return confirmation process from the overtaking lane in step S24, the return flag from the overtaking lane set in the return confirmation process from the overtaking lane is determined. If the return flag from the overtaking lane is "true”, the process proceeds to step S26. If the return flag from the overtaking lane is "false”, the process proceeds to step S27.
  • step S26 following the determination that the return flag from the overtaking lane is "true” in step S25, a travel control command for changing the lane to the return lane is output, and the process proceeds to the end.
  • the vehicle changes the target lane to the return lane set in the return confirmation process from the overtaking lane, and performs travel control so that the current lane becomes the target lane.
  • the "returning lane” is a lane to be selected after the passing vehicle ahead has ended.
  • step S27 following the determination that the return flag from the overtaking lane is "false” in step S25, an overtaking confirmation process is executed, and the process proceeds to step S28.
  • the "overtaking confirmation process” is a process of confirming whether or not to pass another vehicle traveling ahead of the own vehicle.
  • the overtaking execution flag and the overtaking lane are set according to the confirmation result. The details of the overtaking confirmation process will be described later.
  • step S28 following the execution of the overtaking confirmation process in step S27, the overtaking execution flag set in the overtaking confirmation process is determined. If the overtaking execution flag is "true”, the process proceeds to step S29. If the overtaking execution flag is "false”, the process proceeds to step S30.
  • the vehicle changes the target lane to the overtaking lane set in the overtaking confirmation processing, and performs travel control so that the current lane becomes the target lane.
  • the "overtaking lane” is a lane to be selected when passing another vehicle ahead of the own vehicle.
  • the vehicle sets the currently traveling lane (the current lane) as the target lane, and continues the traveling of the current lane.
  • FIG. 5 is a flowchart showing a flow of target route follow-up confirmation processing in the basic lane selection control processing.
  • the target route following process of the first embodiment will be described based on FIG.
  • step S211 travel route information of the vehicle is acquired from the navigation system 15, and the process proceeds to step S212.
  • step S212 following the acquisition of the travel route information in step S211, there is a need for turning to the left or right or left within a range up to a predetermined distance Z [m] on the planned travel route ahead of the vehicle. Determine if it is or not. In the case of YES (necessity of turning etc.), the process proceeds to step S213. In the case of NO (no need for turning or the like), it is possible to follow the planned traveling route without checking the lane, and the process proceeds to step S218.
  • “predetermined distance Z [m]” can be arbitrarily set, but here, it is set to the minimum distance required for the vehicle to change lanes.
  • step S213 following the determination that it is necessary to turn the vehicle left or right in step S212, it is determined that the lane in which the vehicle is currently traveling (the current lane) is not continuous with the turn or left branch. In the case of YES (the current lane is not continuous to the turn etc.), the process proceeds to step S214. In the case of NO (the current lane follows the turn etc.), the process proceeds to step S217.
  • step S214 following the determination that the current lane in step S213 is not continuous to the right / left turn etc., if traveling on the current lane is continued, it is not possible to appropriately turn right or left or branch right. Assuming that the route can not be followed, it is determined whether the planned travel route ahead of the vehicle is to turn to the right or to the right. In the case of YES (turn right or branch in the right direction), the process proceeds to step S215. In the case of NO (left turn or left branch), the process proceeds to step S216.
  • step S215 following the determination that the planned traveling route ahead of the host vehicle is branched right or right in step S214, the route following lane selection flag is set to "true” and the route following lane is set to the right lane Go to the end.
  • the “right lane” is the lane located at the rightmost side of the road on which the vehicle is traveling.
  • step S216 following the determination that the planned travel route ahead of the host vehicle in step S214 is to turn left or branch left, the route following lane selection flag is set to "true", and the route following lane is set to the left lane. Go to the end.
  • the "left lane” is the lane located on the leftmost side of the road on which the vehicle is traveling.
  • step S217 following the determination that the current lane is continuous to the right / left turn etc. in step S213, it is possible to appropriately turn left / right or branch left and right while continuing traveling on the current lane, and scheduled travel Assuming that the route can be followed, the route-following lane selection flag is set to “true”, the route-following lane is set to the current lane (the lane currently being traveled), and the process goes to the end.
  • step S2128 following the determination that there is no need to turn left or right in step S212, the route following lane selection flag is set to "false", since the planned traveling route can be followed while maintaining traveling on the current lane. Set and go to the end. At this time, "route following lane” is not set.
  • FIG. 6 is a flowchart showing a flow of return confirmation processing from an overtaking lane in the basic lane selection control processing.
  • the flow of the return confirmation process from the overtaking lane shown in FIG. 6 will be described.
  • step S241 it is determined whether the lane in which the vehicle is currently traveling (current lane) is an overtaking lane. If YES (the overtaking lane), the process proceeds to step S242. In the case of NO (driving lane), it is determined that return from the overtaking lane is unnecessary, and the process proceeds to step S245.
  • the "overtaking lane” is a lane on which the vehicle is traveling is a plurality of lanes, and is the lane positioned on the right side among them.
  • the “traveling lane” is a lane other than the lane located on the right side of the road where the vehicle is traveling is a plurality of lanes.
  • step S243 following the acquisition of the surrounding information in step S242, it is determined whether overtaking of the overtaking target vehicle is completed. In the case of YES (pass over completed), the process proceeds to step S244. In the case of NO (pass-through incomplete), the process proceeds to step S245.
  • step S244 following the determination of completion of overtaking in step S243, the return flag from the overtaking lane is set to "true", the return lane is set to the left lane, and the process proceeds to the end.
  • the “left lane” is a lane adjacent to the left side of the lane (the overtaking lane) on which the vehicle is currently traveling.
  • step S245 following the determination with the traveling lane in step S241 or the determination with passing incomplete in step S243, it is possible to maintain the traveling of the currently traveling lane (the current lane), Set the return flag from the overtaking lane to "false” and go to the end. At this time, "return lane” is not set.
  • FIG. 7 is a flowchart showing a flow of overtaking confirmation processing in the basic lane selection control processing.
  • the overtaking confirmation process of the first embodiment will be described based on FIG. 7.
  • step S 271 it is determined whether there is a right lane adjacent to the right of the lane in which the host vehicle is currently traveling (the current lane). If YES (there is a right lane), the process proceeds to step S272. In the case of NO (no right lane), it is determined that the overtaking operation can not be performed, and the process proceeds to step S275.
  • step S272 following the determination of the presence of the right lane in step S271, peripheral information of the vehicle is acquired by the external sensor 11, the internal sensor 12 or the like, and the process proceeds to step S273.
  • step S273 following the acquisition of the surrounding information in step S272, is there any other vehicle whose relative speed with the vehicle speed of the vehicle is lower than the threshold vehicle speed ahead of the lane (current lane) where the vehicle is currently traveling? Decide whether or not. If YES (the relative speed is lower than the threshold vehicle speed), the process proceeds to step S274. If NO (the relative speed is lower than the threshold vehicle speed and there is no other vehicle), it is determined that there is no need for overtaking and the process proceeds to step S275.
  • step S274 following the determination that there is another vehicle whose relative speed is less than the threshold vehicle speed in step S273, the other vehicle ahead can be overtaken, and the overtaking execution flag is set to "true", and the overtaking lane is set.
  • the “right lane” is a lane adjacent to the right of the lane in which the vehicle is currently traveling (the current lane).
  • step S275 following the determination in step S271 that there is no right lane, or the determination in step S273 that there is no other vehicle whose relative speed is less than the threshold vehicle speed, the overtaking execution flag is set to "false”. Set and go to the end. At this time, the overtaking lane is not set.
  • GNSS global positioning satellite system
  • GPS Global Positioning System
  • the recognition result of the self position correction target (white line or sign having a curvature change point) obtained from the on-vehicle sensor such as a stereo camera is matched with the self position correction target on the map data stored in advance.
  • Techniques for correcting self position are known. That is, for example, when traveling on a curve, the actual traveling position calculated from the actually traveled actual position is compared with the virtual traveling position calculated from the estimated self position, and the estimated self position is corrected from the deviation amount It is a method.
  • the self-position correction target is recognized by the on-board sensor mounted on the vehicle, there is a limit to the recognizable range of the on-board sensor. Therefore, for example, even if the self position correction target exists at a position near the own vehicle, if the self position correction target deviates from the recognizable area of the on-vehicle sensor, the self position correction target can not be appropriately recognized. As a result, the position of the vehicle can not be corrected, and a problem arises that the correction opportunity is missed.
  • such self-position correction must be performed periodically. That is, when the position correction by matching the self position correction target recognized by the sensor as described above with the map data can not be performed, the self position is estimated using the vehicle speed or the yaw rate detected by the in-vehicle sensor (dead reckoning) However, there is a measurement error in the detection value of the in-vehicle sensor. Therefore, in dead reckoning, positional deviation due to measurement error occurs. Thereby, as the dead reckoning is continued, the deviation (error) between the actual vehicle position and the map data is accumulated, and the deviation from the correct position becomes large.
  • the self-position correction is performed if the self-position correction target can not be appropriately recognized. I can not Further, the on-vehicle sensor has a limit in the recognizable area, and when the self-position correction target deviates from the recognizable area of the on-vehicle sensor, it can not be properly recognized, and the correction opportunity is lost.
  • FIG. 8 is an explanatory view showing a traveling condition of the vehicle before the self position correction
  • FIG. 9 is an explanatory view showing an area which can be recognized by an external sensor when the central lane traveling is continued
  • FIG. FIG. 11 is an explanatory view showing a traveling condition of the vehicle
  • FIG. 11 is an explanatory view showing an area that can be recognized by an external sensor when traveling in the leftmost lane.
  • the lane selection operation of the first embodiment will be described below with reference to FIGS. 8 to 11.
  • a driving assistance vehicle (hereinafter referred to as “the vehicle S”) capable of autonomous driving to which the self-position correction method of the first embodiment is applied is the central lane r2 of the road R with three lanes on one side.
  • the vehicle S a driving assistance vehicle capable of autonomous driving to which the self-position correction method of the first embodiment is applied.
  • the vehicle S a driving assistance vehicle capable of autonomous driving to which the self-position correction method of the first embodiment is applied is the central lane r2 of the road R with three lanes on one side.
  • a low-speed vehicle ahead of the road R joins the road R from the left side while traveling in the leftmost lane r1 as a condition of traveling the central lane r2 of the road R with three lanes. Make a lane change to central lane r2 to overtake. Then, because the planned travel route is a route, in order to avoid unnecessary lane changes, the central lane r2 is continued to travel without changing lanes back to the original lane (leftmost lane r1). Is considered.
  • step S2 the step shown in FIG. 2 is performed when the uncorrected distance, which is the distance traveled since the previous self position correction was performed, exceeds the threshold distance D [km].
  • the process proceeds from step S1 to step S2.
  • the self position correction target that can be recognized even if the vehicle S continues traveling in the central lane r2, which is the current lane currently being traveled, is a predetermined distance on the planned traveling route ahead of the vehicle S It is determined whether it exists in the range up to X [m].
  • the “self position correction target” is a white line L2 having a curvature change point in the case shown in FIG.
  • the own vehicle S has a limit in the recognizable area N by the external sensor 11.
  • This recognizable area N is a range surrounded by a dashed dotted line in FIG. A range in which a total of four white lines can be photographed). Therefore, in the state shown in FIG.
  • the target position correction target (white line L2) can not be recognized from the central lane r2 which is the current lane, and the range to the predetermined distance X [m] on the planned traveling route ahead of the vehicle S It is determined that there is no self position correction target (white line L2) that can be recognized even if the travel in the current lane (center lane r2) is maintained. However, in practice, the self position correction target (white line L2) is present on the planned traveling route.
  • step S2 proceeds from step S2 to step S4 to step S5, and the self position correction target (white line L2) on the planned traveling route is specified, and the self position is determined from the current lane (center lane r2) when reaching the correction point P. It is determined whether or not the correction target (white line L2) can be recognized.
  • step S5 the driver is notified that the lane change to the lane (in the case of FIG. 8, the leftmost lane r1 in the case of FIG. 8) can be performed by outputting the notification control command and recognizing the self position correction target (white line L2).
  • a travel control command for changing the lane to the lane (the leftmost lane r1) capable of recognizing the self position correction target (white line L2) is output.
  • step S10 the self position correction control process of step S10 is performed. That is, in the flowchart shown in FIG. 3, it is determined in step S11 whether or not the vehicle S has reached the correction point P. As shown in FIG. 11, if the correction point P is reached, the process proceeds to step S12, it is determined whether or not the self position correction target (white line L2) is recognized, and if it can be recognized, the process proceeds to step S13.
  • a white line L2 (first self position correction target) based on map information shown by a solid line in FIG. 11 and a white line L3 (second self position correction target) based on image information captured by the external sensor 11 shown by a broken line in FIG. And match. Then, if the matching is successful, the process proceeds from step S14 to step S15, and based on the positional deviation amount ⁇ W, the position on the map of the vehicle S is corrected so that the positional deviation amount ⁇ W becomes zero. Therefore, the position of the vehicle S on the map can be appropriately corrected.
  • step S18 the correction non-implemented distance is set to zero, the previous correction time is updated to the current time, and the basic lane selection control process is executed. Then, while suppressing the occurrence of unnecessary lane change according to the environment information around the vehicle after position correction, the planned traveling route, the speed of the forward vehicle, etc., the appropriate lane is selected and traveled.
  • the self position correction target (white line L2) is present at the traveling destination of the vehicle S, but when traveling in the current lane (center lane r2) continues, the self position correction target (white line)
  • L2 deviates from the recognizable area N of the external sensor 11, before reaching the correction point P, the lane is changed to a lane (the leftmost lane r1) capable of recognizing the self position correction target (white line L2).
  • the self position correction target (white line L2) can be recognized, the position of the vehicle S on the map is corrected.
  • the traveling lane selection control (the processing of steps S4 to S8 shown in FIG. 2) is executed. That is, in this traveling lane selection control (processing of step S4 to step S8 shown in FIG. 2), the position correction on the map of the vehicle S is preset at predetermined intervals (every time the threshold distance D [km] is traveled) Is executed when it can not be implemented.
  • the lane change for including the self position correction target in the recognizable area N of the external sensor 11 is not performed when the position correction of the vehicle S is performed at appropriate intervals, and based on the vehicle speed and the yaw rate. It is executed when it is determined that the estimated error of the estimated position of the vehicle S exceeds the predetermined value. Therefore, while suppressing the occurrence of unnecessary lane changes, it is possible to increase the opportunity for correcting the self position.
  • a self that can be recognized even while keeping traveling in the current lane (center lane r2) within a range up to a predetermined distance X [m] on the planned traveling route ahead of the vehicle S If there is a position correction target (white line L2), the process proceeds from step S2 to step S3 in the flowchart shown in FIG. That is, in the lane selection control (the processing of steps S4 to S8 shown in FIG. 2), the current lane (center lane r2) is within a range up to a predetermined distance X [m] on the planned traveling route ahead of the vehicle S. This is executed when there is no self position correction target (white line L2) that can be recognized even while keeping the traveling in the above.
  • the self-position correction target (white line L2) which can be recognized even while keeping traveling in the current lane (center lane r2) is present within a predetermined distance X [m] ahead of the vehicle S
  • the lane selection control (the process of steps S4 to S8 shown in FIG. 2) is not executed, and the execution of the lane change is restricted, and the traveling of the current lane (central lane r2) is continued. Therefore, even if the self position correction target that can be recognized by the lane change exists within a predetermined distance X [m] from the vehicle position, the lane change for recognizing the self position correction target may be restricted. It is possible to suppress the occurrence frequency of lane change.
  • the lane change for overtaking and the like it is possible to regulate the lane change for overtaking and the like, and prevent a decrease in the opportunity for correction. That is, for example, when the lane change is performed in accordance with overtaking or the like despite the presence of the self position correction target recognizable from the current lane within the range of the predetermined distance X [m] ahead of the vehicle S, for example Because of the influence of the lane change, the current lane may be changed, and as a result, it may not be possible to recognize the self position correction target. At that time, it is conceivable that a lane change for recognizing the self position correction target is required. In addition, depending on the position of the self position correction target, it is possible that the lane change for recognizing the self area correction target is not in time, and the opportunity for correction is lost.
  • the notification control command is output before the lane change is performed, and the self position correction target is The driver is informed that lane change to a recognizable lane is to be performed.
  • a lane on which the vehicle S travels is selected based on acquired information and map information of an on-vehicle sensor (external sensor 11) for acquiring peripheral information of the vehicle S and the on-vehicle sensor (external sensor 11); It is a self-position correction method of a driving assistance vehicle provided with the controller (vehicle control ECU20) which corrects self-position on a map,
  • the self position correction target (white line L2) on the planned travel route is specified based on the map information (step S4).
  • the self position correction target (local sensor r2) is traveled by the on-vehicle sensor (external sensor 11) from the lane (center lane r2) where the vehicle S travels. It is judged whether or not the white line L2) can be recognized (step S5), When it is determined that the self position correction target (white line L2) can not be recognized from the lane (center lane r2) on which the vehicle S travels, the self position correction target (white line L2) is reached before reaching the correction point P.
  • the lane is changed to a lane (the leftmost lane r1) that can be recognized (step S8).
  • the vehicle S can be actively moved to a position (the leftmost lane r1) at which the vehicle S can be recognized (white line L2), and the opportunity to correct the vehicle's position on the map Can be increased.
  • step S4 to S8 The lane selection control (steps S4 to S8) is executed when self position correction on the map can not be performed at predetermined intervals (every threshold distance D [km]) (step S1). did.
  • predetermined intervals every threshold distance D [km]
  • step S4 to S8 the vehicle travels in a lane (central lane r2) currently traveled by the vehicle S within a predetermined range X [m] ahead of the vehicle S
  • the configuration is performed (step S2) when there is no self position correction target (white line L2) that can be recognized even if it is maintained (white line L2).
  • the controller (vehicle control ECU 20) automatically changes the lane in which the vehicle S travels, When performing the lane change to the lane in which the self position correction target (white line L2) can be recognized, the driver is notified of the implementation of the lane change (step S7).
  • the driver is notified of the implementation of the lane change (step S7).
  • a lane on which the vehicle S travels is selected based on acquired information and map information of an onboard sensor (external sensor 11) for acquiring peripheral information of the vehicle S and the onboard sensor (external sensor 11), And a controller (vehicle control ECU 20) for correcting a self position on a map.
  • the controller (vehicle control ECU 20) A correction target specifying unit 23 for specifying a self position correction target (white line L2) on the planned traveling route based on the map information; When reaching the correction point P where the self position correction target (white line L2) specified by the correction target specifying unit 23 is reached, the on-vehicle sensor (external sensor 11) starts from the lane (center lane r2) where the vehicle S travels.
  • a correction target recognition determination unit 24 that determines whether or not the self position correction target (white line L2) can be recognized by Before reaching the correction point P when it is determined that the correction target recognition determination unit 24 can not recognize the self position correction target (white line L2) from the lane (central lane r2) on which the vehicle S travels.
  • a lane selection unit 25 for changing the lane to a lane (the leftmost lane r1) capable of recognizing the self position correction target (white line L2).
  • the vehicle S can be actively moved to a position (the leftmost lane r1) at which the vehicle S can be recognized (white line L2), and the opportunity to correct the vehicle's position on the map Can be increased.
  • the travel control command to change the lane to a lane where the self position correction target can be recognized is output.
  • Etc. are controlled automatically to show an example of changing lanes. That is, in the first embodiment, an "automatic driving vehicle that automatically executes a lane change based on a command from the controller" is used as "a driving assistance vehicle", and "doing a lane change" is performed without intervention of the driver's driving operation. An example is shown in which lane change is performed based on a command from the controller.
  • the present invention is not limited to this, and the self-position correction method and the self-position correction device of the first embodiment can be applied even to a manually operated vehicle in which the lane change is performed by the driver's driving operation.
  • the driver changes lanes by displaying characters on the in-vehicle display, voice output from a speaker, flashing light of in-vehicle lamp, etc. Prompt.
  • “lane change may be performed” by assisting the lane change to the lane in which the self position correction target can be recognized.
  • lane selection control (processing of step S4 to step S8 shown in FIG. 2) is executed when the uncorrected distance exceeds the threshold distance D [km], and the lane is changed as necessary.
  • An example is shown.
  • the timing of executing the lane selection control is not limited to this.
  • lane selection control (processing of steps S4 to S8 shown in FIG. 2) may be executed so that position correction of the vehicle S can be periodically performed. In this case, first, the planned traveling route is read, and the self position correction target existing on the planned traveling route is specified based on the map information.
  • a reference lane for example, a central lane for three lanes on one side
  • a lane is appropriately selected so as to guide a lane on which periodic self position correction is possible based on the determination result.
  • Example 1 Although the example which alert
  • notification may be made by displaying characters on the in-vehicle display, blinking light emission of an in-vehicle lamp, or the like. Also, the notification may not necessarily be made.
  • the lane selection control (the process of steps S4 to S8 shown in FIG. 2) is performed based on the uncorrected distance.
  • the present invention is not limited to this.
  • lane selection control processing of steps S4 to S8 shown in FIG. 2 may be executed based on the time when correction is not performed. That is, the lane selection control may be executed when the self position correction is not performed for a predetermined time.
  • the white line having the inflection point is shown as the self position correction target, but the present invention is not limited to this.
  • it may be a sign or a structure on a road. It can be recognized by the external sensor 11 and can be specified from the map information.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Mechanical Engineering (AREA)
  • Transportation (AREA)
  • Human Computer Interaction (AREA)
  • Business, Economics & Management (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Game Theory and Decision Science (AREA)
  • Medical Informatics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

地図上の自己位置補正を行う機会を増やすことができる運転支援車両の自己位置補正方法を提供すること。 自車(S)の周辺情報を取得する外部センサ(11)の取得情報及び地図情報に基づいて自車(S)が走行する車線を選択する車線選択制御(ステップS4~ステップS8)では、地図情報に基づいて予定走行経路上の自己位置補正対象(白線L2)を特定し、この自己位置補正対象(白線L2)が存在する補正地点(P)への到達時、自車(S)が走行する中央車線(r2)から外部センサ(11)によって自己位置補正対象(白線L2)を認識できるか否かを判断し、自車(S)が走行する中央車線(r2)からは自己位置補正対象(白線L2)を認識できないと判断したとき、補正地点(P)に到達する前に、自己位置補正対象(白線L2)を認識可能な最左車線(r1)へ車線変更する構成とした。

Description

運転支援車両の自己位置補正方法及び自己位置補正装置
 本開示は、運転支援車両の自己位置補正方法及び自己位置補正装置に関するものである。
 従来、地図上の自車の位置(自己位置)を補正する際、自車から走行経路上に存在する看板等の補正対象物までの距離を用いる自己位置補正方法が知られている(例えば、特許文献1参照)。
特開2014-134469号公報
 ところで、従来の自己位置補正方法では、自車に搭載したカメラで撮影された画像に基づいて補正対象物の位置を特定し、当該補正対象物までの距離を測定する。そのため、補正対象物を適切に撮影することができない場合、自己位置補正を行うことができず、補正機会を逃すという問題が生じる。
 本開示は、上記問題に着目してなされたもので、地図上の自己位置を補正する機会を増やすことができる運転支援車両の自己位置補正方法及び自己位置補正装置を提供することを目的とする。
 上記目的を達成するため、本開示は、自車の周辺情報を取得する車載センサと、車載センサの取得情報及び地図情報に基づいて自車が走行する車線を選択し、地図上の自己位置を補正するコントローラと、を備えた運転支援車両の自己位置補正方法である。
 そして、自車が走行する車線を選択する車線選択制御では、まず、地図情報に基づき、予定走行経路上の自己位置補正対象を特定する。
 次に、特定した自己位置補正対象が存在する補正地点への到達時、自車が走行する車線から車載センサによって自己位置補正対象を認識できるか否かを判断する。
 そして、自車が走行する車線からは自己位置補正対象を認識できないと判断したとき、補正地点に到達する前に、自己位置補正対象を認識可能な車線へ車線変更する。
 よって、本開示では、地図上の自己位置を補正する機会を増やすことができる。
実施例1の自己位置補正システムを示す全体システム構成図である。 実施例1の車両制御ECUにて実行される位置補正支援制御処理の流れを示すフローチャートである。 実施例1の車両制御ECUにて実行される自己位置補正制御処理の流れを示すフローチャートである。 実施例1の車両制御ECUにて実行される基本車線選択制御処理の流れを示すフローチャートである。 基本車線選択制御処理内での目標経路追従確認処理の流れを示すフローチャートである。 基本車線選択制御処理内での追越車線からの復帰確認処理の流れを示すフローチャートである。 基本車線選択制御処理内での追越確認処理の流れを示すフローチャートである。 自己位置補正前の車両の走行状況を示す説明図である。 中央車線走行継続時の外部センサによる認識可能領域を示す説明図である。 車線変更後の車両の走行状況を示す説明図である。 最左車線走行時の外部センサによる認識可能領域を示す説明図である。
 以下、本開示の運転支援車両の自己位置補正方法及び自己位置補正装置を実施するための形態を、図面に示す実施例1に基づいて説明する。
 (実施例1)
 まず、構成を説明する。
実施例1における自己位置補正方法及び自己位置補正装置は、走行中に地図上の自車の位置を補正する自己位置補正システムを搭載し、目標車線に追従するように自動的に車線変更を実施する自動運転が可能な運転支援車両に適用したものである。以下、実施例1の構成を、「自己位置補正システムの全体システム構成」、「車線選択制御部の詳細構成」、「位置補正支援制御処理構成」、「自己位置補正制御処理構成」、「基本車線選択制御処理構成」に分けて説明する。
 [自己位置補正システムの全体システム構成]
 実施例1の自己位置補正システム1は、図1に示すように、外部センサ11と、内部センサ12と、GPS受信部13と、地図データベース14と、ナビゲーションシステム15と、を備えている。さらに、車両制御ECU20と、駆動用アクチュエータ31と、報知用アクチュエータ32と、を備えている。
 外部センサ11は、自車に設けられ、走行中の自車の周囲情報を取得するためのセンサ(車載センサ)である。この実施例1の外部センサ11は、一般的に使用されているステレオカメラである。この外部センサ11であるステレオカメラは、最大で自車を中心とした左右二本ずつ、合計四本の白線を撮影可能な撮影範囲(認識可能領域)を有する。外部センサ11によって取得された自車の周辺情報は、CAN通信線10を介して、車両制御ECU20及びナビゲーションシステム15に出力される。なお、外部センサ11としては、ステレオカメラの他に、超音波を利用するクリアランスソナーや、赤外線レーザを用いるレーザレンジファインダ等であってもよい。
 内部センサ12は、自車に設けられ、自車の走行状態を検出するためのセンサである。ここでは、内部センサ12は、車速センサ、ヨー角センサ、操舵角センサ等である。内部センサ12によって取得された自車情報は、CAN通信線10を介して、車両制御ECU20及びナビゲーションシステム15に出力される。
 GPS受信部13は、三個以上のGPS衛星からの信号を受信し、この信号にのせられた測位に必要なデータを抽出し、自車の位置を示すGPS情報を取得する。GPS受信部13によって取得されたGPS情報は、CAN通信線10を介して、車両制御ECU20及びナビゲーションシステム15に出力される。
 地図データベース14は、図示しない車載メモリに記憶され、勾配や制限速度等の走行情報や、標識や電柱、構造物(トンネル、橋梁、歩道橋等)等の道路周辺情報、白線、停止線等の指標情報等が書き込まれた地図情報を備えたデータベースである。地図データベース14の情報は、CAN通信線10を介して、車両制御ECU20及びナビゲーションシステム15から参照される。
 ナビゲーションシステム15は、外部センサ11、内部センサ12、GPS受信部13、地図データベース14から入力された各種情報を用いて、地図上の自車の位置(自己位置)を推定する。そして、推定した自己位置情報や、自車のドライバーによって地図上に設定された目的地情報等に基づき、目的地までの予定走行経路を生成する。さらに、ドライバーに対して生成した予定走行経路の案内を行う。このナビゲーションシステム15によって生成された走行経路情報及び自己位置情報は、CAN通信線10を介して、車両制御ECU20に出力される。
 車両制御ECU20(コントローラ)は、外部センサ11、内部センサ12、GPS受信部13、地図データベース14、ナビゲーションシステム15、図示しない車載メモリから入力された各種情報を用いて、自車を予定走行経路に沿って走行させるための制御指令を出力する統合コントローラである。この車両制御ECU20から出力された制御指令は、必要に応じて駆動用アクチュエータ31又は報知用アクチュエータ32に入力される。また、この車両制御ECU20は、自己位置補正制御部21と、車線選択制御部22と、を有している。
 自己位置補正制御部21は、外部センサ11、内部センサ12、GPS受信部13、地図データベース14、ナビゲーションシステム15、車載メモリから入力された各種情報を用いて、ナビゲーションシステム15にて推定した自己位置を補正する自己位置補正制御を行う。
この自己位置補正制御では、ステレオカメラである外部センサ11で撮影した画像に基づいて自己位置補正対象(例えば、曲率変化点を有する白線)を認識できるか否かを判断する。自己位置補正対象を認識できる場合には、外部センサ11で撮影した画像に基づいて認識した自己位置補正対象(第1白線)と、地図データベース14に基づいて特定した自己位置補正対象(第2白線)とをマッチングする。そして、このマッチングの結果得られた位置ずれ情報に基づき、地図上の自己位置を補正する。なお、この自己位置補正は、所定の間隔(ここでは、一定距離を走行するごと)で実行する。しかし、自己位置補正を行えなかった場合には、自己位置補正を行えない区間の走行距離を積算する。この積算距離が所定値を超えたとき、車線選択制御部22による車線選択制御を実施する。
 車線選択制御部22は、外部センサ11及び内部センサ12から入力された各種情報や、ナビゲーションシステム15から入力された走行経路情報に基づき、自車が基本的に走行する基本車線を選択する基本車線選択制御を行う。また、この車線選択制御部22は、地図データベース14を参照して得られる地図情報に基づいて走行先の自己位置補正対象を特定し、この自己位置補正対象を認識するための車線変更が必要か否かを判断し、必要に応じて車線変更を行う車線選択制御を行う。
 駆動用アクチュエータ31は、走行制御指令に基づいて車両を動作させるアクセル、ブレーキ、ステアリングを駆動する各種アクチュエータである。
 報知用アクチュエータ32は、車線選択制御部22による車線選択制御に応じて車線変更を自動的に実施するときに報告制御指令が入力され、この報告制御指令に基づいて車線変更を実施する旨(車線変更を実施すること、車線変更を実施する理由等)をドライバーに報知する報知装置を駆動するアクチュエータである。ここで、報知装置は、任意の音声を出力可能なスピーカである。
 [車線選択制御部の詳細構成]
 実施例1の車線選択制御部22は、図1に示すように、補正対象特定部23と、補正対象認識判断部24と、車線選択部25と、基本車線選択部26と、を有している。
 補正対象特定部23は、地図データベース14を参照して地図情報を取得する。また、ナビゲーションシステム15から走行経路情報を取得する。そして、地図情報と走行経路情報に基づき、予定走行経路上の自己位置補正対象を探索し、自車を基準とした所定範囲内に存在する自己位置補正対象を特定する。
ここで、「自己位置補正対象」とは、地図上の自車の位置を補正する際に位置ずれ量の測定基準にするための対象物である。この自己位置補正対象は、例えば、所定範囲内に所定の曲率変化点を有する白線や、標識等である。
 補正対象認識判断部24は、補正対象特定部23によって特定された自己位置補正対象が存在する補正地点に自車が到達したとき、自車が現在走行中の車線(現車線)から、外部センサ11によって自己位置補正対象を認識できるか否かを判断する。すなわち、自車が車線変更を行うことなく補正地点に到達したとき、外部センサ11で撮影した画像に基づいて自己位置補正対象を認識できるか否かを判断する。
なお、この補正対象認識判断部24は、外部センサ11の撮影範囲(認識可能範囲)と地図情報に基づいて、上記の判断を行う。また、「補正地点」とは、自己位置補正対象が存在する位置を含む所定範囲の領域である。
 車線選択部25は、補正対象認識判断部24によって、補正地点到達時、現車線からは自己位置補正対象を認識できないと判断したとき、自車が補正地点に到達する前に、自己位置補正対象を認識可能な車線への車線変更を行う走行制御指令を出力する。また、この車線選択部25は、補正対象認識判断部24によって、補正地点到達時、現車線から自己位置補正対象を認識できると判断したとき、現在走行中の車線の走行を維持させる走行制御指令を出力する。なお、これらの走行制御指令は、駆動用アクチュエータ31に入力される。
さらに、この車線選択部25は、自己位置補正対象を認識可能な車線への車線変更を行う走行制御指令を出力する際、報知装置を介して車線変更の実施をドライバーに報知する報知制御指令を出力する。なお、この報知制御指令は、報知用アクチュエータ32に入力される。
 基本車線選択部26は、複数の車線を有する道路を走行中の車線を選択し、当該車線を走行させる走行制御指令を出力する。この走行制御指令は、駆動用アクチュエータ31に入力される。
 ここで、この基本車線選択部26では、ナビゲーションシステム15から取得した予定走行経路に追従させる車線を目標車線に選択し、この目標車線を走行させる走行制御指令を出力する。例えば、三車線道路の中央車線を走行中、予定走行経路が左分岐する場合、分岐点の手前で左車線を走行する必要がある。この場合、左車線を目標車線に選択し、この目標車線(左車線)に車線変更する走行制御指令を出力する。
 また、この基本車線選択部26では、自車が追越車線(前方車両を追い越すために選択された車線)を走行中、この追越車線に隣接する走行車線を目標車線に選択し、この目標車線(走行車線)に車線変更する走行制御指令を出力する。ただし、例えば三車線道路の最左側車線を走行中に他車両を追い越すことが分かっている場合は、追い越しを実施する車線も走行車線である。このため、元の車線に復帰する制御は行わず、現在走行中の車線での走行を継続させる走行制御指令を出力する。
 さらに、この基本車線選択部26では、自車前方の他の車両を追い越す際の追越車線を目標車線に選択し、この目標車線(追越車線)に車線変更する走行制御指令を出力する。なお、追越可能な判断基準は、自車が現在走行中の車線(現車線)に隣接する右車線が存在し、現車線の前方に、自車の車速との相対速度が閾値車速以下の他車両が存在することとする。このとき、右車線を目標車線に選択し、この目標車線(右車線)に車線変更する走行制御指令を出力する。
 [位置補正支援制御処理構成]
 図2は、実施例1の車両制御ECUにて実行される位置補正支援制御処理の流れを示すフローチャートである。以下、図2に基づき、実施例1の位置補正支援制御処理を説明する。
 ステップS1では、車載メモリに記録された補正未実施距離が、予め設定した閾値距離D[km]を上回っているか否かを判断する。YES(補正未実施距離>D[km])の場合はステップS2へ進む。NO(補正未実施距離≦D[km])の場合は、地図上の自己位置の誤差は小さく、自己位置補正は不要であるとして補正未実施距離を積算して車載メモリに記録すると共に時刻を更新してからステップS20へ進む。
ここで、「補正未実施距離」とは、前回地図上の自己位置補正を行ってからの走行距離であり、以下の式(1)により算出する。この「補正未実施距離」は、車両走行中に積載し続け、補正の実施と共にリセットされる。
  補正未実施距離=補正未実施距離+車速×(現在時刻-前回時刻)…(1)
また、閾値距離D[km]は、車速とヨーレートに基づいて推定した自己位置の推定誤差が所定値を上回ると判断される距離であり、実験等に基づいて設定する。
 ステップS2では、ステップS1での補正未実施距離>D[km]との判断に続き、自己位置補正が必要であるとして、自車の前方の予定走行経路上の所定距離X[m]までの範囲内に、自車が現在走行中の車線(現車線)での走行を維持したままであっても外部センサ11によって認識可能な自己位置補正対象が存在するか否かを判断する。YES(自己位置補正対象あり)の場合はステップS3へ進む。NO(自己位置補正対象なし)の場合はステップS4へ進む。
ここで、自己位置補正対象の有無は、地図データベース14に書き込まれている地図情報と、ナビゲーションシステム15から取得した自車の走行経路情報に基づいて判断する。また、自己位置補正対象が現車線での走行を維持したままでも認識可能であるか否かは、ナビゲーションシステム15から取得した自車の自己位置情報及び外部センサ11の認識可能領域に基づいて判断する。また、「所定距離X[m]」とは、補正未実施距離が閾値距離D[km]を超えても積極的に補正しない状態を許容できる距離であり、例えば、閾値距離D[km]の半分の距離とする。
 ステップS3では、ステップS2での所定距離内に現車線維持で認識可能な自己位置補正対象ありとの判断に続き、現車線の走行を継続していれば、自車前方の所定距離X[m]を走行するまでの間に自己位置補正対象を認識可能であるとして、自車が現在走行中の車線(現車線)の走行を維持させる走行制御指令を出力し、ステップS10へ進む。これにより、目標車線を現車線に設定し、現車線の走行を継続する。
 ステップS4では、ステップS2での所定距離内には現車線維持での認識可能な自己位置補正対象なしとの判断に続き、自車の前方の予定走行経路上であって、自車に最も近い位置に存在する自己位置補正対象を特定し、ステップS5へ進む。
ここで、自己位置補正対象は、地図データベース14に書き込まれている地図情報と、ナビゲーションシステム15から取得した自車の走行経路情報に基づいて特定する。また、このときの自己位置補正対象の探索範囲は、自車の現在地から目的地までの全経路範囲とする。
 ステップS5では、ステップS4での自己位置補正対象の特定に続き、このステップS4にて特定した自己位置補正対象が存在する補正地点への到達時点で、自車が現在走行中の車線(現車線)から、当該自己位置補正対象を認識可能であるか否かを判断する。YES(認識可能)の場合にはステップS6へ進む。NO(認識不可能)の場合にはステップS7へ進む。
ここで、「補正地点」とは、自己位置補正対象が存在する位置を含む所定範囲の領域である。また、現車線が自己位置補正対象を認識可能な車線であるか否かは、ナビゲーションシステム15から取得した自車の自己位置情報及び外部センサ11の認識可能領域に基づいて判断する。
 ステップS6では、ステップS5での補正地点到達時点で現車線から自己位置補正対象を認識可能との判断に続き、現車線の走行を継続していても、自己位置補正対象を認識可能であるとして、自車が現在走行中の車線(自車線)の走行を維持させる走行制御指令を出力し、ステップS10へ進む。すなわち、このステップS6では、自車前方の所定距離X[m]内には現車線維持では認識可能な自己位置補正対象は存在しないものの、当該所定距離X[m]を超えても現車線を走行し続けることで、現車線から自己維持補正対象を認識できると判断する。これにより、目標車線を現車線に設定し、現車線の走行を継続する。
 ステップS7では、ステップS5での補正地点到達時点で現車線から自己位置補正対象を認識不可能との判断に続き、予定走行経路上に自己位置補正対象が存在しているにも拘らず、現車線の走行を継続してしまうと当該自己位置補正対象を認識できないとして、この自己位置補正対象を認識可能な車線(補正対象認識車線)への車線変更を行う旨を、報知装置を介してドライバーに報知する報知制御指令を出力し、ステップS8へ進む。
ここで、報知装置が音声を出力するスピーカである場合には、報告装置は、音声によってドライバーに車線変更の実施及びその理由を知らせる。
 ステップS8では、ステップS7での車線変更の報知に続き、自己位置補正対象を認識可能な車線(補正対象認識車線)への車線変更を行う走行制御指令を出力し、ステップS10へ進む。これにより、目標車線を補正対象認識車線に設定し、車線を変更する。
ここで、車線の変更は、外部センサ11によって取得した自車の周辺情報及び内部センサ12によって取得した自車情報に基づいて実行可否を判断する。なお、自車の周囲環境の影響等により所定時間内に車線変更が実行できない場合には、車線変更の実行を中止し、ステップS1へ戻る。
 ステップS10では、ステップS3又はステップS6での現車線維持との走行制御指令、又はステップS8での車線変更との走行制御指令のいずれかの出力に続き、地図上の自車の位置を補正する自己位置補正制御処理を実行し、ステップS20へ進む。なお、このステップS10における自己位置補正制御処理とは、外部センサ11によって取得した自車の周辺情報と、地図データベース14から得られる自車の周辺情報とをマッチングし、その結果に基づいて地図上の自己位置を補正する処理である。この自己位置補正制御処理の詳細については後述する。
 ステップS20では、ステップS10での自己位置補正制御処理の実行に続き、自己位置補正をした後の車線を選択する基本車線選択制御処理を実行し、リターンへ進む。なお、このステップS20における基本車線選択制御処理では、予定走行経路に追従するために必要な車線選択、追越車線から走行車線に復帰するための車線選択、前方車両を追い越すために必要な車線選択の三つの観点に基づいて走行すべき車線を選択する。また、いずれの観点でも車線変更が必要と判断されなかった場合には、現在走行中の車線の走行を維持させ、不要な車線変更を行わないようにする。この基本車線選択制御処理の詳細については後述する。
 なお、この図2に示す位置補正支援制御処理におけるステップS4~ステップS8までの処理が、外部センサ11の取得情報及び地図データベース14の地図情報に基づいて、自車が走行する車線を選択する「車線選択制御」に相当する。つまり、この位置補正支援制御処理では、「車線選択制御」を実行した後、自己位置補正制御処理を実行し、地図上の自己位置を補正する。
 [自己位置補正制御処理構成]
 図3は、実施例1の車両制御ECUにて実行される自己位置補正制御処理の流れを示すフローチャートである。以下、図3に基づき、実施例1の自己位置補正制御処理を説明する。
 ステップS11では、自車が補正地点に到達したか否かを判断する。YES(到達済み)の場合はステップS12へ進む。NO(未到達)の場合は補正未実施距離を積算して車載メモリに記録する共に時刻を更新してからステップS11を繰り返す。
ここで、補正地点に到達したか否かは、地図データベース14から取得した地図情報及びナビゲーションシステム15から取得した自車の自己位置情報に基づいて判断する。
 ステップS12では、ステップS11での補正地点に到達したとの判断に続き、外部センサ11からのセンサ情報に基づき、自己位置補正対象を認識したか否かを判断する。YES(認識した)場合にはステップS13へ進む。NO(認識できない)場合にはステップS17へ進む。
ここで、自己位置補正対象が例えば白線である場合には、以下の手順によって認識できたか否かを判断する。すなわち、まずステレオカメラである外部センサ11により、車両前方を撮影する。そして、取得した画像情報から車両前方に存在する白線(自己位置補正対象)を検出する。次に、画像情報に基づき、検出した白線上に設定した複数点の曲率を測定する。そして、各点の曲率の差が所定値Kよりも大きい測定点の組が存在するとき、自己位置補正対象を認識できたと判断する。
 ステップS13では、ステップS12での自己位置補正対象を認識したとの判断に続き、外部センサ11で撮影した画像に基づいて認識した第1自己位置補正対象と、地図データベース14に基づいて特定した第2自己位置補正対象とをマッチングし、ステップS14へ進む。
 ステップS14では、ステップS13でのマッチングの実行に続き、マッチングが成功したか否かを判断する。YES(マッチング成功)の場合にはステップS15へ進む。NO(マッチング失敗)の場合にはステップS17へ進む。
ここで、マッチングが成功したか否かは、マッチングを行った結果得られた位置ずれ量(画像情報から得られた自己位置補正対象の位置と、地図情報から得られた自己位置補正対象の位置とのずれ量)が、所定範囲に収まっているか否かに基づいて判断する。位置ずれ量は、位置補正を行っていない間の走行距離や走行時間に応じて推定できる。そのため、この位置ずれ量が所定範囲から外れている場合には、マッチングが失敗したと判断できる。
 ステップS15では、ステップS14でのマッチング成功との判断に続き、このマッチングの結果得られた位置ずれ情報に基づいて、位置ずれ量がゼロになるように自己位置を補正し、ステップS16へ進む。なお、補正後の新たな自己位置情報は、ナビゲーションシステム15に入力される。
 ステップS16では、ステップS15での自己位置情報の補正に続き、補正未実施距離を「ゼロ」に書き換えて車載メモリに記録し、ステップS18へ進む。
 ステップS17では、ステップS12での自己位置補正対象を認識できないとの判断、又はステップS14でのマッチング失敗との判断に続き、自己位置情報の補正を適切に行うことができなかったとして、補正未実施距離を積算して車載メモリに記録すると共に、時刻を更新し、ステップS18へ進む。
ここで、補正未実施距離は、上述の式(1)によって新たな積算値を算出し、更新する。
 ステップS18では、ステップS16での補正未実施距離のゼロ設定又はステップS17での補正未実施距離の更新に続き、前回時刻として記録した時刻を現在時刻に書き換えて車載メモリに記録し、エンドへ進む。
 [基本車線選択制御処理構成]
 図4は、実施例1の車両制御ECUにて実行される基本車線選択制御処理の流れを示すフローチャートである。以下、図4に示す基本車線選択制御処理の流れを説明する。
 ステップS21では、目標経路追従確認処理を実行し、ステップS22へ進む。
ここで、「目標経路追従確認処理」とは、自車が現在走行中の車線(現車線)を走行したままで、ナビゲーションシステム14によって設定された予定走行経路を追従することが可能か否かを確認する処理である。確認結果に応じて経路追従車線選択フラグ及び経路追従車線を設定する。なお、この目標経路追従確認処理の詳細については後述する。
 ステップS22では、ステップS21での目標経路追従確認処理の実行に続き、この目標経路追従確認処理にて設定された経路追従車線選択フラグを判断する。経路追従車線選択フラグが「true」の場合はステップS23へ進む。経路追従車線選択フラグが「false」の場合はステップS24へ進む。
 ステップS23では、ステップS22での経路追従車線選択フラグ=「true」との判断に続き、経路追従車線への車線変更を行う走行制御指令を出力し、エンドへ進む。これにより、自車は、目標車線を目標経路追従確認処理にて設定した経路追従車線に変更し、現車線が目標車線となるように走行制御を行う。ここで、「経路追従車線」とは、予定走行経路に追従するために選択する車線である。
 ステップS24では、ステップS22での経路追従車線選択フラグ=「false」との判断に続き、追越車線からの復帰確認処理を実行し、ステップS25へ進む。
ここで、「追越車線からの復帰確認処理」とは、追越車線を走行しているときに走行車線に復帰するか否かを確認する処理である。確認結果に応じて追越車線からの復帰フラグ及び復帰車線を設定する。なお、この追越車線からの復帰確認処理の詳細については後述する。
 ステップS25では、ステップS24での追越車線からの復帰確認処理の実行に続き、この追越車線からの復帰確認処理にて設定された追越車線からの復帰フラグを判断する。追越車線からの復帰フラグが「true」の場合はステップS26へ進む。追越車線からの復帰フラグが「false」の場合はステップS27へ進む。
 ステップS26では、ステップS25での追越車線からの復帰フラグ=「true」との判断に続き、復帰車線への車線変更を行う走行制御指令を出力し、エンドへ進む。これにより、自車は、目標車線を追越車線からの復帰確認処理にて設定した復帰車線に変更し、現車線が目標車線となるように走行制御を行う。ここで、「復帰車線」とは、前方車両の追い越しが終了した後に選択する車線である。
 ステップS27では、ステップS25での追越車線からの復帰フラグ=「false」との判断に続き、追越確認処理を実行し、ステップS28へ進む。
ここで、「追越確認処理」とは、自車の前方に走行している他車両を追い越すか否かを確認する処理である。確認結果に応じて追越実行フラグ及び追越車線を設定する。なお、この追越確認処理の詳細については後述する。
 ステップS28では、ステップS27での追越確認処理を実行に続き、この追越確認処理にて設定された追越実行フラグを判断する。追越実行フラグが「true」の場合はステップS29へ進む。追越実行フラグが「false」の場合はステップS30へ進む。
 ステップS29では、ステップS28での追越実行フラグ=「true」との判断に続き、追越車線への車線変更を行う走行制御指令を出力し、エンドへ進む。これにより、自車は、目標車線を追越確認処理にて設定した追越車線に変更し、現車線が目標車線となるように走行制御を行う。ここで、「追越車線」とは、自車の前方の他車を追い越す際に選択する車線である。
 ステップS30では、ステップS28での追越実行フラグ=「false」との判断に続き、自車が現在走行中の車線の走行を維持させる走行制御指令を出力し、エンドへ進む。これにより、自車は現在走行中の車線(現車線)を目標車線に設定し、現車線の走行を継続する。
 [目標経路追従処理]
 図5は、基本車線選択制御処理内での目標経路追従確認処理の流れを示すフローチャートである。以下、図5に基づき、実施例1の目標経路追従処理を説明する。
 ステップS211では、ナビゲーションシステム15から自車の走行経路情報を取得し、ステップS212へ進む。
 ステップS212では、ステップS211での走行経路情報の取得に続き、自車の前方の予定走行経路上の所定距離Z[m]までの範囲内に、右左折や左右への分岐の必要性があるか否かを判断する。YES(右左折等の必要あり)の場合はステップS213へ進む。NO(右左折等の必要なし)の場合は、車線の確認をしなくても予定走行経路を追従できるとしてステップS218へ進む。
ここで、「所定距離Z[m]」とは、任意に設定可能であるが、ここでは自車が車線変更を行うために要する最低距離に設定する。
 ステップS213では、ステップS212での右左折の必要ありとの判断に続き、自車が現在走行中の車線(現車線)が右左折路又は左右分岐路に連続していないことを判断する。YES(現車線は右左折路等に連続していない)の場合はステップS214へ進む。NO(現車線は右左折路等に連続している)の場合はステップS217へ進む。
 ステップS214では、ステップS213での現車線が右左折路等に連続していないとの判断に続き、現車線での走行を継続すると適切に右左折又は左右分岐を行うことができず、予定走行経路を追従することができないとして、自車の前方の予定走行経路が右折又は右方向へ分岐するか否かを判断する。YES(右折又は右方向へ分岐)の場合はステップS215へ進む。NO(左折又は左方向へ分岐)の場合はステップS216へ進む。
 ステップS215は、ステップS214での自車前方の予定走行経路が右折又は右方向へ分岐するとの判断に続き、経路追従車線選択フラグを「true」に設定し、経路追従車線を右車線に設定し、エンドへ進む。
ここで、「右車線」とは、自車が走行している道路の中で最も右側に位置する車線である。
 ステップS216では、ステップS214での自車前方の予定走行経路が左折又は左方向へ分岐するとの判断に続き、経路追従車線選択フラグを「true」に設定し、経路追従車線を左車線に設定し、エンドへ進む。
ここで、「左車線」とは、自車が走行している道路の中で最も左側に位置する車線である。
 ステップS217では、ステップS213での現車線が右左折路等に連続しているとの判断に続き、現車線での走行を継続したままで適切に右左折又は左右分岐することができ、予定走行経路を追従することができるとして、経路追従車線選択フラグを「true」に設定し、経路追従車線を現車線(現在走行中の車線)に設定し、エンドへ進む。
 ステップS218では、ステップS212での右左折の必要なしとの判断に続き、現車線での走行を維持したままで予定走行経路を追従することができるとして、経路追従車線選択フラグを「false」に設定し、エンドへ進む。なお、このとき「経路追従車線」は設定しない。
 [追越車線からの復帰確認処理]
 図6は、基本車線選択制御処理内での追越車線からの復帰確認処理の流れを示すフローチャートである。以下、図6に示す追越車線からの復帰確認処理の流れを説明する。
 ステップS241では、自車が現在走行中の車線(現車線)が追越車線であるか否かを判断する。YES(追越車線)の場合はステップS242へ進む。NO(走行車線)の場合は、追越車線からの復帰が不要としてステップS245へ進む。
ここで、「追越車線」とは、自車が走行している道路が複数車線であって、その中で最も右側に位置する車線である。また、「走行車線」とは、自車が走行している道路が複数車線であって、最も右側に位置する車線以外の車線である。
 ステップS242では、ステップS241での現車線=追越車線との判断に続き、外部センサ11や内部センサ12等により自車の周辺情報を取得し、ステップS243へ進む。
 ステップS243では、ステップS242での周辺情報の取得に続き、追越対象車両の追い越しが完了したか否かを判断する。YES(追越完了)の場合はステップS244へ進む。NO(追越未完了)の場合はステップS245へ進む。
 ステップS244では、ステップS243での追越完了との判断に続き、追越車線からの復帰フラグを「true」に設定し、復帰車線を左車線に設定し、エンドへ進む。
ここで、「左車線」とは、自車が現在走行中の車線(追越車線)の左側に隣接する車線である。
 ステップS245では、ステップS241での走行車線との判断、又はステップS243での追越未完了との判断に続き、現在走行中の車線(現車線)の走行を維持することが可能であるとして、追越車線からの復帰フラグを「false」に設定し、エンドへ進む。なお、このとき「復帰車線」は設定しない。
 [追越確認処理]
 図7は、基本車線選択制御処理内での追越確認処理の流れを示すフローチャートである。以下、図7に基づき、実施例1の追越確認処理を説明する。
 ステップS271では、自車が現在走行中の車線(現車線)の右側に隣接する右車線が存在するか否かを判断する。YES(右車線あり)の場合はステップS272へ進む。NO(右車線なし)の場合は、追い越し行為ができないとしてステップS275へ進む。
 ステップS272では、ステップS271での右車線ありとの判断に続き、外部センサ11や内部センサ12等により自車の周辺情報を取得し、ステップS273へ進む。
 ステップS273では、ステップS272での周辺情報の取得に続き、自車が現在走行中の車線(現車線)の前方に、自車の車速との相対速度が閾値車速以下の他車両が存在するか否かを判断する。YES(相対速度が閾値車速以下の他車両あり)の場合はステップS274へ進む。NO(相対速度が閾値車速以下の他車両なし)の場合は、追越行為の必要がないとしてステップS275へ進む。
 ステップS274では、ステップS273での相対速度が閾値車速以下の他車両ありとの判断に続き、前方の他車両を追い越すことが可能として、追越実行フラグを「true」に設定し、追越車線を右車線に設定し、エンドへ進む。
ここで、「右車線」とは、自車が現在走行中の車線(現車線)の右側に隣接する車線である。
 ステップS275では、ステップS271での右車線なしとの判断、又はステップS273での相対速度が閾値車速以下の他車両なしとの判断に続き、追い越しは実行しないとして追越実行フラグを「false」に設定し、エンドへ進む。なお、このとき「追越車線」は設定しない。
 次に、作用を説明する。
まず、地図上の自己位置補正の必要性とその課題を説明し、続いて、実施例1の運転支援車両の自己位置補正方法及び自己位置補正装置の作用を「車線選択作用」、「その他の特徴的作用」に分けて説明する。
 [地図上の自己位置補正の必要性とその課題]
 ナビゲーションシステムを用いて経路案内が可能な車両や、アクセルやブレーキ、ステアリング等を自動的に制御して自動運転を可能とする自動運転車等の運転支援車両を適切に制御するためには、地図上の自車の位置(自己位置)を正確に把握することが重要である。
 そして、自己位置を把握する技術の一つとして、GPS(Global Positioning System)等の衛星を用いた全球測位衛星システム(GNSS/Global Navigation Satellite System)がある。しかしながら、このGNSSでは、衛星が発信した信号を複数受信することで誤差を抑制するが、常時適切に信号を受信することは困難であり、その精度は十分ではない。
 そこで、ステレオカメラ等の車載センサから得られる自己位置補正対象(曲率変化点を有する白線や標識等)の認識結果と、予め記憶した地図データ上の自己位置補正対象とをマッチングさせ、地図上の自己位置を補正する技術が知られている。すなわち、例えば、カーブを走行する際、実際に走行した実自己位置から算出した実走行位置と、推定自己位置から算出された仮想走行位置とを比較し、そのずれ量から推定自己位置を補正する方法である。
 この場合、車載センサで認識した白線がカーブしていて曲率に変化点がある場合や、標識を認識できた場合等、自己位置補正対象を適切に認識できたときには、地図データとのマッチングを一意に固定することができるため、自己位置補正を行うことができる。しかし、車載センサで認識した白線が直線であって曲率に変化点がない場合や、標識を認識できなかった場合等、自己位置補正対象を適切に認識できなかったときには、地図データと自己位置補正対象とをマッチングすることができず、自己位置補正を行うことができないという問題が生じる。
 また、自己位置補正対象は、自車に搭載された車載センサによって認識するが、この車載センサの認識可能領域には限界がある。そのため、例えば自車の近傍位置に自己位置補正対象が存在したとしても、車載センサの認識可能領域から外れてしまうと、この自己位置補正対象を適切に認識することができない。その結果、自車の位置の補正を行うことができず、補正機会を逃すという問題が生じる。
 一方で、このような自己位置補正は定期的に行なわなければならない。すなわち、上述のようなセンサで認識した自己位置補正対象と地図データとのマッチングによる位置補正ができなかった場合、車載センサで検出した車速やヨーレートを使って自己位置を推定する(デッドレコニング)ことになるが、車載センサの検出値には測定誤差が存在する。そのため、デッドレコニングでは、測定誤差による位置ずれが生じる。これにより、このデッドレコニングを継続するにしたがって、実際の車両位置と地図データとのずれ(誤差)が蓄積され、正確な位置からのずれが大きくなってしまうからである。
 このように、地図上の自車の位置を正確に把握するためには、定期的な自己位置補正が必要であるものの、自己位置補正対象を適切に認識できなければ、自己位置補正を行うことができない。また、車載センサは認識可能領域に限界があり、自己位置補正対象が車載センサの認識可能領域から外れると、適切に認識することができず、補正機会が失われてしまうという課題がある。
 [車線選択作用]
 図8は、自己位置補正前の車両の走行状況を示す説明図であり、図9は、中央車線走行継続時の外部センサによる認識可能領域を示す説明図であり、図10は、車線変更後の車両の走行状況を示す説明図であり、図11は、最左車線走行時の外部センサによる認識可能領域を示す説明図である。以下、図8~図11を用いて、実施例1の車線選択作用を説明する。
 図8に示すように、実施例1の自己位置補正方法が適用された自動運転が可能な運転支援車両(以下、「自車S」という)が、片側三車線の道路Rの中央車線r2を走行している場合を考える。このとき、地図データベース14が備えた地図情報に基づく白線L1に対して、自車Sの地図上の位置が規定されている。
 なお、この図8に示すように、片側三車線の道路Rの中央車線r2を走行する状況としては、例えば、この道路Rに左側から合流し、最左車線r1を走行中、前方の低速車両を追い越すために中央車線r2に車線変更を行う。その後、予定走行経路が道なりであることから、不要な車線変更を避けるため、元の車線(最左車線r1)へ戻る車線変更を行うことなく中央車線r2を継続して走行する、といった状況が考えられる。
 そして、このように自車Sが中央車線r2を走行中、前回自己位置補正を行ってからの走行距離である補正未実施距離が閾値距離D[km]を上回った場合、図2に示すステップS1→ステップS2へと進む。そして、自車Sが現在走行中の現車線である中央車線r2での走行を維持したままであっても認識可能な自己位置補正対象が、自車Sの前方の予定走行経路上の所定距離X[m]までの範囲内に存在するか否かを判断する。
 ここで、「自己位置補正対象」は、図8に示す場合では、曲率変化点を有する白線L2である。なお、直線状態の白線の場合では、車両横方向の位置ずれは補正することが可能であるが、車両前後方向の位置ずれを補正することができないため、自己位置補正対象にはなり得ないとする。
一方、自車Sは、外部センサ11による認識可能領域Nに限界があり、この認識可能領域Nは図8では一点鎖線で囲んだ範囲(最大で自車Sを中心とした左右二本ずつ、合計4本の白線を撮影可能な範囲)である。そのため、図8に示す状態では、現車線である中央車線r2から自己位置補正対象(白線L2)は認識できず、自車Sの前方の予定走行経路上の所定距離X[m]までの範囲内には、現車線(中央車線r2)での走行を維持したままであっても認識可能な自己位置補正対象(白線L2)が存在しないと判断する。しかし、実際は、予定走行経路上には自己位置補正対象(白線L2)は存在する。
 そこで、ステップS2→ステップS4→ステップS5へと進み、予定走行経路上の自己位置補正対象(白線L2)を特定し、補正地点Pへの到達時点で、現車線(中央車線r2)から自己位置補正対象(白線L2)を認識可能であるか否かを判断する。
 しかし、中央車線r2の走行を継続した場合では、図9に示すように、自車Sが補正地点Pに到達したときであっても、自己位置補正対象(白線L2)は外部センサ11の認識可能領域Nから外れてしまい、認識することができない。そのため、ステップS5からステップS7→ステップS8へと進む。これにより、報知制御指令を出力し、自己位置補正対象(白線L2)を認識可能な車線(図8の場合では、最左車線r1)への車線変更を行う旨をドライバーに報知した上、補正地点Pに到達する前に自己位置補正対象(白線L2)を認識可能な車線(最左車線r1)への車線変更を行う走行制御指令を出力する。
 この結果、アクセル、ブレーキ、ステアリングを駆動する駆動用アクチュエータ31に走行制御指令が入力され、アクセル等が自動的に制御されて、図10に示すように、補正地点Pに到達前に最左車線r1へと車線変更を行う。これにより、図11に示すように、自車Sが補正地点Pに到達したときには、外部センサ11の認識可能領域N内に自己位置補正対象(白線L2)を含めることが可能となり、この自己位置補正対象(白線L2)を適切に認識することができる。
 そして、ステップS10の自己位置補正制御処理を実行する。すなわち、図3に示すフローチャートにおいて、ステップS11により補正地点Pに自車Sが到達したか否かを判断する。図11に示すように、補正地点Pに到達していればステップS12へと進み、自己位置補正対象(白線L2)を認識したか否かを判断し、認識できればステップS13へと進む。
 そして、図11において実線で示す地図情報に基づく白線L2(第1自己位置補正対象)と、図11において破線で示す外部センサ11で撮影した画像情報に基づく白線L3(第2自己位置補正対象)とをマッチングする。そして、マッチングが成功したらステップS14→ステップS15へと進み、位置ずれ量ΔWに基づいて、この位置ずれ量ΔWがゼロになるように自車Sの地図上の位置を補正する。よって、自車Sの地図上の位置を適切に補正することができる。
 その後、ステップS16→ステップS18へと進み、補正未実施距離をゼロに設定すると共に、前回補正時刻を現在の時刻に更新し、基本車線選択制御処理を実行する。そして、位置補正後の車両周囲の環境情報や、予定走行経路、前方車両の速度等に応じて不要な車線変更の発生を抑制しつつ、適切な車線を選択して走行していく。
 このように、実施例1では、自車Sの走行先に自己位置補正対象(白線L2)が存在するが、現車線(中央車線r2)での走行を継続すると、この自己位置補正対象(白線L2)が外部センサ11の認識可能領域Nから外れる場合には、補正地点Pに到達する前に自己位置補正対象(白線L2)を認識可能な車線(最左車線r1)へと車線変更する。そして、その後、自己位置補正対象(白線L2)を認識できた際、自車Sの地図上の位置を補正する。
つまり、現車線(中央車線r2)から自己位置補正対象(白線L2)を認識できない場合であっても、自己位置を補正することができる車線(最左車線r1)に積極的に移動させることで、自車Sの位置補正を可能にし、自己位置補正の機会を増やすことができる。
 また、この実施例1では、補正未実施距離が予め設定した閾値距離D[km]を上回っている場合に、走行車線選択制御(図2に示すステップS4~ステップS8の処理)を実行する。つまり、この走行車線選択制御(図2に示すステップS4~ステップS8の処理)は、自車Sの地図上の位置補正が、予め設定した所定間隔(閾値距離D[km]を走行するごと)に実施できないときに実行される。
 これにより、自己位置補正対象を外部センサ11の認識可能領域Nに含めるための車線変更は、適切な間隔で自車Sの位置補正ができている場合には行われず、車速とヨーレートに基づいて推定した自車Sの位置の推定誤差が所定値を上回ると判断される場合に実行される。そのため、不要な車線変更の発生を抑制しつつ、自己位置の補正機会を増やすことができる。
 [その他の特徴的作用]
 実施例1では、自車Sの前方の予定走行経路上の所定距離X[m]までの範囲内に、現車線(中央車線r2)での走行を維持したままであっても認識可能な自己位置補正対象(白線L2)が存在する場合には、図2に示すフローチャートにおいて、ステップS2→ステップS3に進む。すなわち、車線選択制御(図2に示すステップS4~ステップS8の処理)は、自車Sの前方の予定走行経路上の所定距離X[m]までの範囲内に、現車線(中央車線r2)での走行を維持したままでも認識可能な自己位置補正対象(白線L2)が存在しない場合に実行する。
 これにより、自車Sの前方の所定距離X[m]内に、現車線(中央車線r2)での走行を維持したままでも認識可能な自己位置補正対象(白線L2)が存在することが分かっているときには、車線選択制御(図2に示すステップS4~ステップS8の処理)は実行されず、車線変更の実施を規制して、現車線(中央車線r2)の走行が継続される。
そのため、車線変更をすれば認識できる自己位置補正対象が、自車位置から所定距離X[m]内に存在していても、当該自己位置補正対象を認識するための車線変更を規制することができ、車線変更の発生頻度を抑制することができる。
 さらに、追い越し等のための車線変更も規制し、補正の機会の低下を防止することができる。つまり、例えば自車Sの前方の所定距離X[m]の範囲に現車線から認識可能な自己位置補正対象が存在するにも拘わらず、追い越し等に伴って車線変更を行った場合、この追い越しのための車線変更の影響で現車線が変更され、結果的に自己位置補正対象を認識できなくなることがある。そのときには、自己位置補正対象を認識するための車線変更が必要になることが考えられる。また、自己位置補正対象の位置によっては、当該自己域補正対象を認識するための車線変更が間に合わず、補正の機会を失うことも考えられる。
 これに対し、自車Sの前方の所定距離X[m]内に、現車線(中央車線r2)での走行を維持したままであっても認識可能な自己位置補正対象が存在するときには、車線変更の実施を規制することで、車線変更を行うことなく自己位置補正対象を適切に認識することができる。これにより、不要な車線変更の発生を抑制しつつ、自車Sの位置補正を確実に実施することが可能となり、補正機会の低下を防止することができる。
 さらに、実施例1では、図2に示すように、自己位置補正対象を認識するために車線変更を実施する場合には、車線変更を行う前に報知制御指令を出力し、自己位置補正対象を認識可能な車線への車線変更を行う旨をドライバーに報知する。
 そのため、自車Sが走行する車線の変更を自動的に実施した場合であっても、ドライバーは車線変更を実施する理由を把握でき、ドライバーの不安を解消することができる。
 次に、効果を説明する。
 実施例1の運転支援車両の自己位置補正方法及び自己位置補正装置にあっては、下記に列挙する効果が得られる。
 (1) 自車Sの周辺情報を取得する車載センサ(外部センサ11)と、前記車載センサ(外部センサ11)の取得情報及び地図情報に基づいて前記自車Sが走行する車線を選択し、地図上の自己位置を補正するコントローラ(車両制御ECU20)と、を備えた運転支援車両の自己位置補正方法であって、
 前記自車Sが走行する車線を選択する車線選択制御(ステップS4~ステップS8)では、前記地図情報に基づき、予定走行経路上の自己位置補正対象(白線L2)を特定し(ステップS4)、
 特定した自己位置補正対象(白線L2)が存在する補正地点Pへの到達時、前記自車Sが走行する車線(中央車線r2)から前記車載センサ(外部センサ11)によって前記自己位置補正対象(白線L2)を認識できるか否かを判断し(ステップS5)、
 前記自車Sが走行する車線(中央車線r2)からは前記自己位置補正対象(白線L2)を認識できないと判断したとき、前記補正地点Pに到達する前に、前記自己位置補正対象(白線L2)を認識可能な車線(最左車線r1)へ車線変更する(ステップS8)構成とした。
 これにより、自車Sを、自己位置補正対象(白線L2)が認識可能な位置(最左車線r1)へ自車Sを積極的に移動させることができ、地図上の自己位置を補正する機会を増やすことができる。
 (2) 前記車線選択制御(ステップS4~ステップS8)は、地図上の自己位置補正を予め設定した所定間隔(閾値距離D[km]ごと)で実施できないときに実行する(ステップS1)構成とした。
 これにより、(1)の効果に加え、不要な車線変更の発生を抑制しつつ、自己位置の補正機会を増やすことができる。
 (3) 前記車線選択制御(ステップS4~ステップS8)は、前記自車Sの前方の所定範囲X[m]内に、前記自車Sが現在走行する車線(中央車線r2)での走行を維持したままでも認識可能な自己位置補正対象(白線L2)が存在しないときに実行する(ステップS2)構成とした。
 これにより、(1)又は(2)の効果に加え、不要な車線変更の発生を抑制しつつ、自己位置の補正機会を増やすことができる。
 (4) 前記コントローラ(車両制御ECU20)は、前記自車Sが走行する車線の変更を自動的に実施し、
 前記自己位置補正対象(白線L2)を認識可能な車線への車線変更を実施する際、前記車線変更の実施をドライバーに報知する(ステップS7)構成とした。
 これにより、(1)~(3)のいずれかの効果に加え、自動的に実行される車線変更に対するドライバーの不安を解消することができる。
 (5) 自車Sの周辺情報を取得する車載センサ(外部センサ11)と、前記車載センサ(外部センサ11)の取得情報及び地図情報に基づいて前記自車Sが走行する車線を選択し、地図上の自己位置を補正するコントローラ(車両制御ECU20)と、を備えた運転支援車両の自己位置補正装置であって、
 前記コントローラ(車両制御ECU20)は、
 前記地図情報に基づき、予定走行経路上の自己位置補正対象(白線L2)を特定する補正対象特定部23と、
 前記補正対象特定部23により特定された自己位置補正対象(白線L2)が存在する補正地点Pへの到達時、前記自車Sが走行する車線(中央車線r2)から前記車載センサ(外部センサ11)によって前記自己位置補正対象(白線L2)を認識できるか否かを判断する補正対象認識判断部24と、
 前記補正対象認識判断部24により前記自車Sが走行する車線(中央車線r2)からは前記自己位置補正対象(白線L2)を認識できないと判断されたとき、前記補正地点Pに到達する前に、前記自己位置補正対象(白線L2)を認識可能な車線(最左車線r1)へ車線変更する車線選択部25と、を備える構成とした。
 これにより、自車Sを、自己位置補正対象(白線L2)が認識可能な位置(最左車線r1)へ自車Sを積極的に移動させることができ、地図上の自己位置を補正する機会を増やすことができる。
 以上、本開示の運転支援車両の自己位置補正方法及び自己位置補正装置を実施例1に基づき説明してきたが、具体的な構成については、この実施例に限られるものではなく、請求の範囲の各請求項に係る発明の要旨を逸脱しない限り、設計の変更や追加などは許容される。
 実施例1では、現車線の走行を継続すると自己位置補正対象を認識することができないと判断した際、自己位置補正対象を認識可能な車線への車線変更を行う走行制御指令を出力し、アクセル等が自動的に制御されて車線変更を行う例を示した。つまり、実施例1では、「運転支援車両」として、コントローラからの指令に基づいて車線変更を自動的に実行する自動運転車とし、「車線変更をする」として、ドライバーの運転操作を介在させずに車線変更をコントローラからの指令に基づいて行うこととする例を示した。
 しかしながら、これ限らず、実施例1の自己位置補正方法及び自己位置補正装置は、車線変更をドライバーの運転操作によって行うマニュアル操作車両であっても適用することができる。このときには、現車線の走行を継続すると自己位置補正対象を認識することができないと判断した際、車載ディスプレイによる文字表示や、スピーカからの音声出力、車載ランプの点滅発光等によって車線変更をドライバーに促す。このように、自己位置補正対象を認識することが可能な車線への車線変更を支援することで「車線変更をする」こととしてもよい。
 また、実施例1では、補正未実施距離が閾値距離D[km]を上回っているときに車線選択制御(図2に示すステップS4~ステップS8の処理)を実行し、必要に応じて車線変更を実施する例を示した。しかし、車線選択制御(図2に示すステップS4~ステップS8の処理)を実行するタイミングについてはこれに限定されない。例えば、予定走行経路に沿って車線を設定する際、自車Sの位置補正を定期的に行えるように車線選択制御(図2に示すステップS4~ステップS8の処理)を実行してもよい。
この場合では、まず、予定走行経路を読み込み、当該予定走行経路上に存在する自己位置補正対象を地図情報に基づいて特定する。次に、予定走行経路に沿った基準車線(例えば、片側三車線では中央車線等)を設定する。そして、この基準車線から自己位置補正対象が認識可能かを判断し、この判断結果に基づいて、定期的な自己位置補正が可能な車線を案内するように適宜車線を選択する。
 さらに、実施例1では、自己位置補正対象を認識するための車線変更の前に、スピーカからの音声によってドライバーに車線変更を報知する例を示したが、これに限らない。例えば、車載ディスプレイによる文字表示や、車載ランプの点滅発光等によって報知してもよい。また、必ずしも報知しなくてもよい。
 また、実施例1では、補正未実施距離を基準にして車線選択制御(図2に示すステップS4~ステップS8の処理)を実行する例を示したが、これに限らない。例えば、補正を行わない時間を基準にして車線選択制御(図2に示すステップS4~ステップS8の処理)を実行するものであってもよい。
すなわち、所定時間の間、自己位置補正を行わない場合に、車線選択制御を実行するものであってもよい。
 また、実施例1では、自己位置補正対象として変曲点を有する白線とする例を示したが、これに限らない。例えば、標識や道路上の構造物等であってもよい。外部センサ11によって認識可能であって、地図情報から特定可能であればよい。

Claims (5)

  1.  自車の周辺情報を取得する車載センサと、前記車載センサの取得情報及び地図情報に基づいて前記自車が走行する車線を選択し、地図上の自己位置を補正するコントローラと、を備えた運転支援車両の自己位置補正方法であって、
     前記自車が走行する車線を選択する車線選択制御では、前記地図情報に基づき、予定走行経路上の自己位置補正対象を特定し、
     特定した自己位置補正対象が存在する補正地点への到達時、前記自車が走行する車線から前記車載センサによって前記自己位置補正対象を認識できるか否かを判断し、
     前記自車が走行する車線からは前記自己位置補正対象を認識できないと判断したとき、前記補正地点に到達する前に、前記自己位置補正対象を認識可能な車線へ車線変更する
     ことを特徴とする運転支援車両の自己位置補正方法。
  2.  請求項1に記載された運転支援車両の自己位置補正方法において、
     前記車線選択制御は、地図上の自己位置補正を予め設定した所定間隔で実施できないときに実行する
     ことを特徴とする運転支援車両の自己位置補正方法。
  3.  請求項1又は請求項2に記載された運転支援車両の自己位置補正方法において、
     前記車線選択制御は、前記自車の前方の所定範囲内に、前記自車が現在走行する車線での走行を維持したままでも認識可能な自己位置補正対象が存在しないときに実行する
     ことを特徴とする運転支援車両の自己位置補正方法。
  4.  請求項1から請求項3のいずれか一項に記載された運転支援車両の自己位置補正方法において、
     前記コントローラは、前記自車が走行する車線の変更を自動的に実施し、
     前記自己位置補正対象を認識可能な車線への車線変更を実施する際、前記車線変更の実施をドライバーに報知する
     ことを特徴とする運転支援車両の自己位置補正方法。
  5.  自車の周辺情報を取得する車載センサと、前記車載センサの取得情報及び地図情報に基づいて前記自車が走行する車線を選択し、地図上の自己位置を補正するコントローラと、を備えた運転支援車両の自己位置補正装置であって、
     前記コントローラは、
     前記地図情報に基づき、予定走行経路上の自己位置補正対象を特定する補正対象特定部と、
     前記補正対象特定部により特定された自己位置補正対象が存在する補正地点への到達時、前記自車が走行する車線から前記車載センサによって前記自己位置補正対象を認識できるか否かを判断する補正対象認識判断部と、
     前記補正対象認識判断部により前記自車が走行する車線からは前記自己位置補正対象を認識できないと判断されたとき、前記補正地点に到達する前に、前記自己位置補正対象を認識可能な車線への車線変更する車線選択部と、
     を備えることを特徴とする運転支援車両の自己位置補正装置。
PCT/JP2017/027257 2017-07-27 2017-07-27 運転支援車両の自己位置補正方法及び自己位置補正装置 WO2019021421A1 (ja)

Priority Applications (10)

Application Number Priority Date Filing Date Title
KR1020207002178A KR102138094B1 (ko) 2017-07-27 2017-07-27 운전 지원 차량의 자기 위치 보정 방법 및 자기 위치 보정 장치
EP17918879.2A EP3660456B1 (en) 2017-07-27 2017-07-27 Self-location-correction device and self-location-correction method for drive assist vehicle
CA3071227A CA3071227C (en) 2017-07-27 2017-07-27 Self-position correction method and self-position correction device for drive-assisted vehicle
MYPI2020000446A MY181900A (en) 2017-07-27 2017-07-27 Self-position correction method and self-position correction device for drive-assisted vehicle
US16/626,379 US10953896B2 (en) 2017-07-27 2017-07-27 Self-position correction method and self-position correction device for drive-assisted vehicle
JP2019532294A JP6717433B2 (ja) 2017-07-27 2017-07-27 運転支援車両の自己位置補正方法及び自己位置補正装置
RU2020108220A RU2725703C1 (ru) 2017-07-27 2017-07-27 Способ коррекции собственного местоположения и устройство коррекции собственного местоположения для транспортного средства с системой помощи при вождении
CN201780092997.XA CN110892230B (zh) 2017-07-27 2017-07-27 驾驶辅助车辆的自身位置校正方法以及自身位置校正装置
BR112020001558-0A BR112020001558A2 (pt) 2017-07-27 2017-07-27 método de correção de autoposicionamento e dispositivo de correção de autoposicionamento para veículo de condução assistida
PCT/JP2017/027257 WO2019021421A1 (ja) 2017-07-27 2017-07-27 運転支援車両の自己位置補正方法及び自己位置補正装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2017/027257 WO2019021421A1 (ja) 2017-07-27 2017-07-27 運転支援車両の自己位置補正方法及び自己位置補正装置

Publications (1)

Publication Number Publication Date
WO2019021421A1 true WO2019021421A1 (ja) 2019-01-31

Family

ID=65040019

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2017/027257 WO2019021421A1 (ja) 2017-07-27 2017-07-27 運転支援車両の自己位置補正方法及び自己位置補正装置

Country Status (10)

Country Link
US (1) US10953896B2 (ja)
EP (1) EP3660456B1 (ja)
JP (1) JP6717433B2 (ja)
KR (1) KR102138094B1 (ja)
CN (1) CN110892230B (ja)
BR (1) BR112020001558A2 (ja)
CA (1) CA3071227C (ja)
MY (1) MY181900A (ja)
RU (1) RU2725703C1 (ja)
WO (1) WO2019021421A1 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110556012A (zh) * 2019-09-16 2019-12-10 北京百度网讯科技有限公司 车道定位方法及车辆定位系统
JP7267383B1 (ja) 2021-11-05 2023-05-01 三菱電機株式会社 車両制御装置及び車両制御方法

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10921133B2 (en) * 2017-12-07 2021-02-16 International Business Machines Corporation Location calibration based on movement path and map objects
JP7303667B2 (ja) * 2019-05-31 2023-07-05 株式会社Subaru 自動運転支援装置
JP7121714B2 (ja) * 2019-09-17 2022-08-18 本田技研工業株式会社 車両制御システム
JP7141421B2 (ja) * 2020-03-16 2022-09-22 本田技研工業株式会社 車両制御装置、車両制御方法、およびプログラム
CN114923492A (zh) * 2022-04-22 2022-08-19 中国第一汽车股份有限公司 定位信息确定方法、装置、电子设备及存储介质

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005257314A (ja) * 2004-03-09 2005-09-22 Honda Motor Co Ltd 車両位置検出装置
JP2012122760A (ja) * 2010-12-06 2012-06-28 Aisin Aw Co Ltd 自車位置認識システム、自車位置認識プログラム、及び自車位置認識方法
JP2014134469A (ja) 2013-01-10 2014-07-24 Toyota Motor Corp 運転制御装置および運転制御方法
JP2017058235A (ja) * 2015-09-16 2017-03-23 株式会社デンソー 車両位置補正装置

Family Cites Families (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE19921437C2 (de) * 1999-05-08 2001-05-31 Daimler Chrysler Ag Verfahren und Vorrichtung zur Ermittlung der Straßengeometrie und der Position eines Fahrzeuges auf einer Straße
JP4059194B2 (ja) * 2003-12-25 2008-03-12 トヨタ自動車株式会社 車両の統合制御システム
KR100723834B1 (ko) * 2005-06-17 2007-05-31 한국전자통신연구원 차량항법시스템에서 차량위치를 보정하기 위한 장치 및방법
JP4724043B2 (ja) * 2006-05-17 2011-07-13 トヨタ自動車株式会社 対象物認識装置
JP5278378B2 (ja) * 2009-07-30 2013-09-04 日産自動車株式会社 車両運転支援装置及び車両運転支援方法
US20120245817A1 (en) * 2011-03-23 2012-09-27 Tk Holdings Inc. Driver assistance system
KR20130010718A (ko) * 2011-07-19 2013-01-29 현대모비스 주식회사 내비게이션 및 그의 주행차선에 기반한 경로 안내 방법
RU2566175C1 (ru) * 2011-08-31 2015-10-20 Ниссан Мотор Ко., Лтд. Устройство помощи при вождении транспортного средства
BR112015009456B1 (pt) * 2012-10-26 2020-06-02 Toyota Jidosha Kabushiki Kaisha Dispositivo de suporte de direcionamento e método de suporte de direcionamento
CN107636751B (zh) * 2015-06-15 2021-06-04 三菱电机株式会社 行驶车道判别装置和行驶车道判别方法
JP6606049B2 (ja) * 2015-10-28 2019-11-13 本田技研工業株式会社 自動運転システム及びナビケーションシステム
CN105489035B (zh) 2015-12-29 2018-03-30 大连楼兰科技股份有限公司 应用在主动驾驶技术中检测交通信号灯的方法
CN106767853B (zh) 2016-12-30 2020-01-21 中国科学院合肥物质科学研究院 一种基于多信息融合的无人驾驶车辆高精度定位方法
CN106842269A (zh) 2017-01-25 2017-06-13 北京经纬恒润科技有限公司 定位方法及系统

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005257314A (ja) * 2004-03-09 2005-09-22 Honda Motor Co Ltd 車両位置検出装置
JP2012122760A (ja) * 2010-12-06 2012-06-28 Aisin Aw Co Ltd 自車位置認識システム、自車位置認識プログラム、及び自車位置認識方法
JP2014134469A (ja) 2013-01-10 2014-07-24 Toyota Motor Corp 運転制御装置および運転制御方法
JP2017058235A (ja) * 2015-09-16 2017-03-23 株式会社デンソー 車両位置補正装置

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP3660456A4

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110556012A (zh) * 2019-09-16 2019-12-10 北京百度网讯科技有限公司 车道定位方法及车辆定位系统
CN110556012B (zh) * 2019-09-16 2022-03-08 北京百度网讯科技有限公司 车道定位方法及车辆定位系统
JP7267383B1 (ja) 2021-11-05 2023-05-01 三菱電機株式会社 車両制御装置及び車両制御方法
JP2023069180A (ja) * 2021-11-05 2023-05-18 三菱電機株式会社 車両制御装置及び車両制御方法

Also Published As

Publication number Publication date
MY181900A (en) 2021-01-12
KR102138094B1 (ko) 2020-07-27
CN110892230B (zh) 2021-04-27
EP3660456A4 (en) 2020-07-01
KR20200013069A (ko) 2020-02-05
RU2725703C1 (ru) 2020-07-03
JP6717433B2 (ja) 2020-07-01
US10953896B2 (en) 2021-03-23
CN110892230A (zh) 2020-03-17
CA3071227A1 (en) 2019-01-31
CA3071227C (en) 2020-08-04
US20200377117A1 (en) 2020-12-03
EP3660456A1 (en) 2020-06-03
JPWO2019021421A1 (ja) 2020-04-16
EP3660456B1 (en) 2021-08-18
BR112020001558A2 (pt) 2020-07-21

Similar Documents

Publication Publication Date Title
JP6717433B2 (ja) 運転支援車両の自己位置補正方法及び自己位置補正装置
JP4910510B2 (ja) 制御用情報記憶装置及びプログラム
CN107532916B (zh) 路径搜索装置及路径搜索方法
CN110998691B (zh) 行驶辅助方法及行驶辅助装置
JP4938351B2 (ja) 車両用測位情報更新装置
WO2014125757A1 (ja) 車両用運転支援システム及び運転支援実行方法
RU2760714C1 (ru) Способ содействия вождению и устройство содействия вождению
JP2017207340A (ja) 走行計画作成装置及びセンタ
JP7303667B2 (ja) 自動運転支援装置
JP2017151041A (ja) 走行支援装置及びセンタ
EP3816966A1 (en) Driving assistance method and driving assistance device
CN115698633A (zh) 用于运行用于引导机动车的辅助功能的方法
JP2019090834A (ja) 経路探索装置及び経路探索装置の経路探索方法
EP4019351A1 (en) Vehicle control method and device, vehicle and storage medium
CN110770542B (zh) 信息管理装置
CN111273653B (zh) 自动驾驶装置
RU2735752C1 (ru) Способ определения поворота направо/налево и устройство определения поворота направо/налево для транспортного средства с содействием вождению
JP7205798B2 (ja) 自動運転装置
KR102507172B1 (ko) 자율주행 차량의 측위정보 공유장치 및 그 제어방법
CN112009474B (zh) 自动驾驶辅助装置
WO2019235358A1 (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: 17918879

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2019532294

Country of ref document: JP

Kind code of ref document: A

ENP Entry into the national phase

Ref document number: 20207002178

Country of ref document: KR

Kind code of ref document: A

ENP Entry into the national phase

Ref document number: 3071227

Country of ref document: CA

NENP Non-entry into the national phase

Ref country code: DE

REG Reference to national code

Ref country code: BR

Ref legal event code: B01A

Ref document number: 112020001558

Country of ref document: BR

WWE Wipo information: entry into national phase

Ref document number: 2017918879

Country of ref document: EP

ENP Entry into the national phase

Ref document number: 2017918879

Country of ref document: EP

Effective date: 20200227

ENP Entry into the national phase

Ref document number: 112020001558

Country of ref document: BR

Kind code of ref document: A2

Effective date: 20200124