WO2017200003A1 - 自動運転支援装置及びコンピュータプログラム - Google Patents

自動運転支援装置及びコンピュータプログラム Download PDF

Info

Publication number
WO2017200003A1
WO2017200003A1 PCT/JP2017/018516 JP2017018516W WO2017200003A1 WO 2017200003 A1 WO2017200003 A1 WO 2017200003A1 JP 2017018516 W JP2017018516 W JP 2017018516W WO 2017200003 A1 WO2017200003 A1 WO 2017200003A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
trajectory
automatic driving
control
distance
Prior art date
Legal status (The legal status 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 status listed.)
Ceased
Application number
PCT/JP2017/018516
Other languages
English (en)
French (fr)
Inventor
雅夫 眞浦
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Aisin AW Co Ltd
Original Assignee
Aisin AW Co Ltd
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 Aisin AW Co Ltd filed Critical Aisin AW Co Ltd
Priority to CN201780028514.XA priority Critical patent/CN109070886B/zh
Priority to DE112017001438.7T priority patent/DE112017001438B8/de
Priority to US16/095,582 priority patent/US10858012B2/en
Publication of WO2017200003A1 publication Critical patent/WO2017200003A1/ja
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D15/00—Steering not otherwise provided for
    • B62D15/02—Steering position indicators ; Steering position determination; Steering aids
    • B62D15/025—Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00—Details 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/0098—Details of control systems ensuring comfort, safety or stability not otherwise provided for
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/10—Path keeping
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/10—Path keeping
    • B60W30/12—Lane keeping
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/18—Propelling the vehicle
    • B60W30/18009—Propelling the vehicle related to particular drive situations
    • B60W30/18163—Lane change; Overtaking manoeuvres
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2552/00—Input parameters relating to infrastructure
    • B60W2552/30—Road curve radius
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2556/00—Input parameters relating to data
    • B60W2556/45—External transmission of data to or from the vehicle
    • B60W2556/50—External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network

Definitions

  • the present invention relates to an automatic driving support device and a computer program that perform automatic driving support in a vehicle.
  • the traveling by the automatic driving support basically performs control so that the vehicle travels as much as possible along a predetermined target traveling track (for example, the center line of the lane on which the vehicle should travel).
  • a predetermined target traveling track for example, the center line of the lane on which the vehicle should travel.
  • the present invention has been made to solve the conventional problems, and generates a control trajectory having a shape corresponding to the assistance content of the automatic driving support when the vehicle is driven by the automatic driving support. It is an object of the present invention to provide an automatic driving support apparatus and a computer program that can perform automatic driving support appropriately and continuously.
  • an automatic driving support apparatus is an automatic driving support apparatus that generates support information used for automatic driving support performed in a vehicle, and is a target driving for a road on which the vehicle runs.
  • a travel trajectory setting means for setting a target travel trajectory that is a trajectory, and a position on the target travel trajectory that is ahead of the traveling direction based on the support content of the automatic driving support performed in the vehicle with respect to the trajectory generation start point
  • a control target point setting means for setting a control target point; and a control trajectory generation means for generating a control trajectory for the vehicle to travel using a trajectory that travels from the trajectory generation start point to the control target point.
  • “automatic driving assistance” refers to a function of performing or assisting at least a part of the driver's vehicle operation on behalf of the driver.
  • the computer program according to the present invention is a program for generating support information used for automatic driving support performed in a vehicle.
  • the computer sets a travel trajectory setting means for setting a target travel trajectory that is a target travel trajectory for the road on which the vehicle travels, and a trajectory generation start point on the target travel trajectory.
  • Control target point setting means for setting a control target point at a position ahead of the direction of travel based on the content of automatic driving support implemented in the vehicle, and a trajectory that travels from the trajectory generation start point to the control target point Used to function as control trajectory generation means for generating a control trajectory for the vehicle to travel.
  • the control trajectory having a shape corresponding to the assistance content of the automatic driving assistance is generated. It becomes possible to do. Accordingly, it is possible to prevent a control trajectory having a small turning radius from being generated, for example, in a state where automatic driving assistance that is inappropriate for traveling by sudden turning is performed. Further, it is possible to prevent the generation of a control trajectory that frequently causes a change in the vehicle direction in a state where automatic driving assistance is performed in which it is inappropriate that the vehicle body angle is frequently displaced. As a result, it is possible to appropriately and continuously carry out automatic driving support.
  • FIG. 1 is a block diagram showing a navigation device 1 according to this embodiment.
  • the navigation device 1 includes a current position detection unit 11 that detects a current position of a vehicle on which the navigation device 1 is mounted, a data recording unit 12 that records various data, Based on the input information, the navigation ECU 13 that performs various arithmetic processes, the operation unit 14 that receives operations from the user, and a guide route (vehicles) set on the map around the vehicle and the navigation device 1 for the user
  • a liquid crystal display 15 for displaying information related to the scheduled travel route
  • a speaker 16 for outputting voice guidance for route guidance
  • a DVD drive 17 for reading a DVD as a storage medium
  • VICS registered trademark: Vehicle Information
  • communication module that communicates with an information center such as a communication system.
  • the navigation device 1 has a Le 18, a.
  • the navigation device 1 is connected to an in-vehicle camera 19 and various sensors installed on a vehicle on which the navigation device 1 is mounted via an in-vehicle network such as CAN.
  • the vehicle control ECU 20 that performs various controls on the vehicle on which the navigation device 1 is mounted is also connected so as to be capable of bidirectional communication.
  • Various operation buttons 21 mounted on the vehicle such as an automatic driving start button are also connected.
  • the current position detection unit 11 includes a GPS 22, a vehicle speed sensor 23, a steering sensor 24, a gyro sensor 25, and the like, and can detect the current vehicle position, direction, vehicle traveling speed, current time, and the like.
  • the vehicle speed sensor 23 is a sensor for detecting a moving distance and a vehicle speed of the vehicle, generates a pulse according to the rotation of the driving wheel of the vehicle, and outputs a pulse signal to the navigation ECU 13.
  • navigation ECU13 calculates the rotational speed and moving distance of a driving wheel by counting the generated pulse.
  • the navigation device 1 does not have to include all the four types of sensors, and the navigation device 1 may include only one or more types of sensors.
  • the data recording unit 12 reads out a hard disk (not shown) as an external storage device and a recording medium, a map information DB 31, an obstacle information DB 32, a predetermined program, and the like recorded on the hard disk and stores predetermined data on the hard disk And a recording head (not shown) which is a driver for writing.
  • the data recording unit 12 may include a flash memory, a memory card, an optical disk such as a CD or a DVD, instead of the hard disk.
  • the map information DB 31 may be stored in an external server, and the navigation device 1 may be configured to acquire by communication.
  • the map information DB 31 displays, for example, link data 34 relating to roads (links), node data 35 relating to node points, search data 36 used for processing relating to route search and change, facility data relating to facilities, and maps.
  • the link data 34 includes, for each link constituting the road, the width of the road to which the link belongs, a gradient, a cant, a bank, a road surface state, a link shape between nodes (for example, a curve shape on a curve road).
  • Complementary point data for identifying the data merge sections, road structure, number of road lanes, places where the number of lanes decreases, places where the width becomes narrower, crossings, etc.
  • general roads such as national roads, prefectural roads, narrow streets, highway automobile national roads
  • toll roads such as urban expressways, automobile roads, general toll roads, and toll bridges are recorded.
  • information for identifying the direction of travel for each lane and the connection of roads (specifically, which lane is connected to which road at the branch) Is also remembered.
  • the speed limit set on the road is also stored.
  • node data 35 actual road branch points (including intersections, T-junctions, etc.) and the coordinates (positions) of node points set for each road according to the radius of curvature, etc.
  • the search data 36 various data used for route search processing for searching for a route from the departure place (for example, the current position of the vehicle) to the set destination is recorded. Specifically, the cost of quantifying the appropriate degree as a route to an intersection (hereinafter referred to as an intersection cost), the cost of quantifying the appropriate degree as a route to a link constituting a road (hereinafter referred to as a link cost), etc. Cost calculation data used for calculating the search cost is stored.
  • the obstacle information DB 32 is a storage means for storing obstacle information related to obstacles distributed by an external server. Further, obstacle information relating to obstacles located around the own vehicle detected by the vehicle outside camera 19 or sensor of the own vehicle is also stored.
  • the obstacle whose obstacle information is stored in the obstacle information DB 32 is an object (factor) that affects the automatic driving support performed in the vehicle as will be described later, for example, other vehicles traveling around the vehicle, This includes parked vehicles, construction sections, and congested vehicles that stop on the road.
  • the obstacle information includes, for example, the type of the obstacle, the position coordinates on the map of the obstacle (information for specifying the range when the range is crossed), and information for specifying the content of the obstacle.
  • navigation ECU13 implements automatic driving assistance using the map information memorized by map information DB31 and the obstacle information memorized by obstacle information DB32 as mentioned below.
  • the vehicle in addition to the manual driving traveling that travels based on the user's driving operation, the vehicle automatically travels along a predetermined route or road regardless of the user's driving operation.
  • Assisted driving with automatic driving assistance is possible.
  • the vehicle control in the automatic driving support for example, the current position of the vehicle, the lane in which the vehicle travels, and the positions of surrounding obstacles are detected at any time, and the vehicle control ECU 20 travels along a route set in advance. Vehicle control such as steering, drive source, and brake is automatically performed.
  • the lane change and the left / right turn are configured by the automatic driving control. However, the lane change or the right / left turn may not be performed by the automatic driving control. good.
  • any one of the following two types of automatic driving assistance is basically performed except under special circumstances such as turning left and right, joining, and branching.
  • “Lane maintenance support” Control in which the vehicle travels near the center of the lane without departing from the lane (for example, lane keeping assist).
  • “Lane change support” Control for moving from the currently traveling lane to a different lane. It should be noted that which of the above assistances (1) and (2) is to be implemented is determined based on a target travel path that is a target travel path set for a road on which the vehicle travels. In parallel with the controls (1) and (2) above, control for keeping the distance between the vehicle and the vehicle ahead is constant (for example, 10 m), control for traveling at a constant speed (for example, 80% of the limit speed), etc. Is also implemented.
  • the automatic driving support may be performed for all road sections, or the vehicle travels on a specific road section (for example, a highway with a gate (whether manned or unpaid) regardless of whether it is manned or paid). It is good also as a structure performed only between.
  • the automatic driving section in which the automatic driving support of the vehicle is performed is all road sections including general roads and highways, and the automatic driving support is basically performed while the vehicle travels on the road. explain.
  • automatic driving support is not always performed, but automatic driving support is selected by the user (for example, an automatic driving start button is turned on), and automatic driving support is performed. It is performed only in a situation where it is determined that it is possible to cause the vehicle to travel. Details of the automatic driving support will be described later.
  • the navigation ECU (Electronic Control Unit) 13 is an electronic control unit that controls the entire navigation device 1.
  • the CPU 41 as an arithmetic device and a control device, and a working memory when the CPU 41 performs various arithmetic processes.
  • an internal storage device such as a flash memory 44 for storing the program.
  • the navigation ECU 13 has various means as processing algorithms.
  • the travel track setting means sets a target travel track that is a target travel track for a road on which the vehicle travels.
  • the control target point setting means sets the control target point at a position on the target travel trajectory and ahead of the traveling direction based on the support content of the automatic driving support performed in the vehicle with respect to the trajectory generation start point.
  • the control trajectory generating means generates a control trajectory that causes the vehicle to travel using a trajectory that travels from the trajectory generation start point to the control target point.
  • the operation unit 14 is operated when inputting a departure point as a travel start point and a destination as a travel end point, and has a plurality of operation switches (not shown) such as various keys and buttons. Then, the navigation ECU 13 performs control to execute various corresponding operations based on switch signals output by pressing the switches.
  • the operation unit 14 may have a touch panel provided on the front surface of the liquid crystal display 15. Moreover, you may have a microphone and a speech recognition apparatus.
  • the liquid crystal display 15 displays map images including roads, traffic information, operation guidance, operation menus, key guidance, guidance information along the guidance route, news, weather forecast, time, mail, TV program, and the like.
  • the In place of the liquid crystal display 15, HUD or HMD may be used.
  • the speaker 16 outputs voice guidance for guiding traveling along the guidance route and traffic information guidance based on an instruction from the navigation ECU 13.
  • the DVD drive 17 is a drive that can read data recorded on a recording medium such as a DVD or a CD. Based on the read data, music and video are reproduced, the map information DB 31 is updated, and the like. A card slot for reading / writing a memory card may be provided instead of the DVD drive 17.
  • the communication module 18 is a communication device for receiving traffic information, probe information, weather information, and the like transmitted from a traffic information center, for example, a VICS center or a probe center. .
  • a vehicle-to-vehicle communication device that performs communication between vehicles and a road-to-vehicle communication device that performs communication with roadside devices are also included.
  • the vehicle exterior camera 19 is constituted by a camera using a solid-state imaging device such as a CCD, for example, and is installed above the front bumper of the vehicle and installed with the optical axis direction downward from the horizontal by a predetermined angle. And the vehicle outside camera 19 images the front of the traveling direction of the vehicle when the vehicle travels in the automatic driving section.
  • the vehicle control ECU 20 detects an obstacle such as a lane marking drawn on the road on which the vehicle travels and other vehicles around by performing image processing on the captured image, and based on the detection result.
  • a sensor such as a millimeter wave radar or a laser sensor, vehicle-to-vehicle communication, or road-to-vehicle communication may be used instead of the camera.
  • the vehicle control ECU 20 is an electronic control unit that controls a vehicle on which the navigation device 1 is mounted. Further, the vehicle control ECU 20 is connected to each drive unit of the vehicle such as a steering, a brake, and an accelerator, and in this embodiment, the vehicle is controlled by controlling each drive unit after the automatic driving support is started in the vehicle. Carry out automatic driving support. Further, when an override is performed by the user during the automatic driving support, it is detected that the override has been performed.
  • the navigation ECU 13 transmits an instruction signal related to automatic driving support to the vehicle control ECU 20 via the CAN after the start of traveling.
  • vehicle control ECU20 implements the automatic driving assistance after a driving
  • the content of the instruction signal is information for instructing a track on which the vehicle travels, a traveling vehicle speed, and the like.
  • FIG. 2 is a flowchart of the automatic driving support program according to the present embodiment.
  • the automatic driving support program is executed after the vehicle's ACC power supply (accessory power supply) is turned on, and when the vehicle starts running by the automatic driving support, and follows the set target driving trajectory. It is a program that implements automatic driving support for vehicles to run. 2, 5 and 9 are stored in the RAM 42 and the ROM 43 provided in the navigation device 1 and executed by the CPU 41.
  • step (hereinafter abbreviated as S) 1 in the automatic driving support program the CPU 41 acquires a route on which the vehicle is scheduled to travel in the future (hereinafter referred to as a planned travel route).
  • a planned travel route a route on which the vehicle is scheduled to travel in the future
  • the navigation device 1 has set a guide route
  • the planned travel route of the vehicle travels the route from the current position of the vehicle to the destination among the guide routes currently set in the navigation device 1.
  • the guide route is a recommended route from the starting point to the destination set by the navigation device 1, and is searched using, for example, a known Dijkstra method.
  • the guide route is not set in the navigation device 1, the route that travels along the road from the current position of the vehicle is set as the planned travel route.
  • the CPU 41 acquires lane information related to the lane of the planned travel route from the map information DB 31. Specifically, information that identifies the number of lanes included in the roads that make up the planned travel route, the direction of travel for each lane, and the connection of the roads (which lane is connected to which road at the branch) is acquired. Is done.
  • the CPU 41 determines a target travel trajectory 50, which is a target travel trajectory for a road on which the vehicle will travel in the future, based on the planned travel route acquired in S1 and the lane information acquired in S2.
  • the target travel path 50 is basically set along the traveling direction of the vehicle with respect to the center line of the lane recommended for travel among the lanes included in the road constituting the planned travel route. For example, in the example shown in FIG. 3, the vehicle travels in a two-lane road on one side, and the target travel path 50 is set for the center line of the left lane where travel is recommended. On the other hand, in the example shown in FIG.
  • the lane is newly increased to the left side, and the vehicle then turns left or branches to the left, and the lane increase point is relative to the center line of the left lane.
  • the target travel track 50 is set, and after the lane increases, the target travel track 50 is set for the center line of the increased lane.
  • the target travel trajectory may be set for all routes of the planned travel route, but the target travel trajectory may be set only for a predetermined distance (for example, 300 m) from the current position of the vehicle. In that case, the processes of S1 to S3 are repeated every time the vehicle travels a predetermined distance.
  • the CPU 41 sets an initial value for the parameter X n ⁇ 1 indicating the previous exclusion range distance.
  • the initial value is 5 m, for example, but the value can be changed as appropriate. You may change an initial value based on the assistance content of the automatic driving assistance currently implemented in the vehicle.
  • the exclusion range distance is a parameter used when generating a control trajectory for causing the vehicle to travel as described later (S6). Details will be described later.
  • the parameter X n-1 is stored in the RAM 42 or the like.
  • steps S5 to S9 are repeatedly executed at regular intervals (for example, 100 msec) while the ACC power supply (accessory power supply) of the vehicle is ON. Then, after the ACC power supply of the vehicle is turned off, the automatic driving support program ends.
  • the CPU 41 determines whether or not automatic driving support is being implemented in the current vehicle.
  • the automatic driving support can be switched on / off by, for example, an operation of an automatic driving start button by a user.
  • the implementation may be stopped when it becomes difficult to implement the automatic driving support (for example, when the lane line that divides the lane in which the vehicle travels disappears).
  • the CPU 41 executes a control trajectory generation process (FIG. 5) described later.
  • the control trajectory generation processing is processing for generating a control trajectory that is a trajectory that the vehicle will travel in the future.
  • the control trajectory is generated for the section from the current position of the vehicle to the front of the stop distance (the distance necessary for the driver to stop after determining that the driver applies the brake) along the traveling direction.
  • the control trajectory is a trajectory for traveling as much as possible along the target travel trajectory set in S3. For example, when the current position of the vehicle is on or around the target travel trajectory, the target travel is continued. If the current position of the vehicle deviates from the target travel trajectory, the trajectory goes toward the target travel trajectory.
  • the CPU 41 reads the parameter X n ⁇ 1 indicating the previous exclusion range distance stored in the RAM 42, and the exclusion range distance X used to generate the control trajectory in S6 performed most recently. Of n , the exclusion range distance Xn set at the beginning (running time is 0) is substituted.
  • the CPU 41 calculates a control amount for the vehicle to travel along the control track generated in S6. Specifically, the control amounts of the accelerator, the brake, the gear, and the steering are calculated.
  • the CPU 41 reflects the control amount calculated in S8. Specifically, the calculated control amount is transmitted to the vehicle control ECU 20 via the CAN.
  • the vehicle control ECU 20 performs vehicle control of the accelerator, the brake, the gear, and the steering based on the received control amount. As a result, it is possible to perform driving support control in which the vehicle travels along the generated control track.
  • FIG. 5 is a flowchart of a sub-processing program for the control trajectory generation process.
  • the CPU 41 calculates the “stop distance” of the current vehicle from the current vehicle speed of the vehicle.
  • the “stop distance” is a distance required from when the driver determines that the brake is applied until the vehicle stops, and is a distance obtained by adding a braking distance for stopping at a deceleration of 0.2 G to the free running distance. To do. Since a specific method for calculating the stop distance is known, the details are omitted.
  • the CPU 41 sets 0 (0 means current time) as an initial value for the running time t that is a parameter.
  • the traveling time t is stored in the RAM 42 or the like.
  • the CPU 41 substitutes the parameter X n ⁇ 1 indicating the previous exclusion range distance into the parameter X t ⁇ 1 indicating the latest exclusion range distance.
  • the parameter X n ⁇ 1 indicating the previous exclusion range distance is set in S4 or S7.
  • the parameter X t-1 is stored in the RAM 42 or the like.
  • the control target point setting process is a process of setting a control target point, which is a target point when generating a control trajectory.
  • the control target point is set at a position on the target travel path and ahead of the traveling direction by a distance based on the support content of the automatic driving support performed on the vehicle from the start point of the track generation.
  • the trajectory generation start point is a vehicle position predicted at the current travel time t (t hours after the current time), and is specified in S17 described later. In particular, when the traveling time t is 0, which is an initial value, the trajectory generation start point is the current position of the vehicle.
  • the CPU 41 generates a trajectory (hereinafter referred to as a travel trajectory) from the trajectory generation start point to the control target point set in S14.
  • a trajectory in which the vehicle travels from a trajectory generation start point to a control target point within a predetermined steering angle at the current vehicle speed is generated as a travel trajectory.
  • the trajectory generation start point is a predicted vehicle position at the current traveling time t (t hours after the current time). Further, the direction of the vehicle at the trajectory generation start point is specified in S17 described later.
  • the CPU 41 reads the running time t from the RAM 42 and adds 100 msec.
  • the CPU 41 assumes that the vehicle has traveled along the travel path from the trajectory generation start point of the travel trajectory generated in S15 at the current vehicle speed t (current time).
  • the position and direction of the vehicle at time t) are predicted.
  • a point separated by a travel distance when traveling for 100 ms at the vehicle speed of the current vehicle along the travel trajectory generated in S15 from the trajectory generation start point is defined as a current travel time t (from the current time t
  • the position of the vehicle at (after time) is defined as a current travel time t (from the current time t
  • the position of the vehicle at (after time) is defined as a current travel time t (from the current time t
  • the tangential direction of the traveling track at the predicted position of the vehicle is the direction of the vehicle at the current traveling time t (t time after the current time).
  • the CPU 41 determines whether or not the travel distance calculated in S18 is greater than or equal to the stop distance calculated in S11.
  • the current position of the vehicle is set as the trajectory generation start point 51 and the control target point 52 on the target travel trajectory 50. Is set. Then, a traveling track 53 from the track generation start point 51 to the control target point 52 is generated. Further, assuming that the vehicle has traveled 100 msec along the generated travel track 53, a vehicle position 54 100 msec after the current time is predicted. Next, as shown in FIG. 7, the vehicle position 54 after 100 msec (that is, the predicted position of the vehicle when the travel time t is 100 msec) is set as a new trajectory generation start point 51 and a new one on the target travel trajectory 50.
  • a control target point 52 is set. Similarly, a traveling track 53 from the track generation start point 51 to the control target point 52 is generated. Further, assuming that the vehicle has traveled 100 msec along the generated travel track 53, a position 55 of the vehicle 200 msec after the current time is predicted. Similarly, the position of the vehicle after 300 msec from the current time, the position of the vehicle after 400 msec,... Are predicted until the travel distance of the vehicle is determined to be equal to or greater than the stop distance.
  • the process proceeds to S20.
  • a trajectory is generated as a control trajectory 60.
  • the control track 60 may be generated by connecting a part of the traveling track 53 generated in S15. That is, the trajectory connecting the travel trajectory 53 from the trajectory generation start point 51 to the predicted vehicle position 54 shown in FIG. 6 and the travel trajectory 53 from the trajectory generation start point 51 to the predicted vehicle position 55 shown in FIG. 60 may be generated.
  • FIG. 9 is a flowchart of a sub-processing program for the control target point setting process.
  • the CPU 41 sets temporary target positions at predetermined intervals on the target travel path set in S3.
  • the temporary target position is a point that is a candidate for a control target point. If a larger number of temporary target positions are set at narrow intervals, it is possible to select a more optimal control target point, but the processing load on the CPU 41 increases.
  • the interval for setting the temporary target position is, for example, 1 m.
  • the temporary target position may be set for all the target traveling tracks, or the temporary target position may be set only for the target traveling track around the current position of the vehicle.
  • the CPU 41 obtains the assistance contents for the automatic driving assistance currently being implemented in the vehicle.
  • automatic driving assistance of either “lane keeping driving assistance” or “lane change assistance” is basically performed. .
  • the CPU 41 reads a parameter X t ⁇ 1 indicating the nearest exclusion range distance stored in the RAM 42.
  • the parameter X t ⁇ 1 indicating the nearest exclusion range distance is set in S13 or S31 described later.
  • the CPU 41 determines whether the support content of the automatic driving support currently implemented in the vehicle is “lane keeping support” or “lane change support” based on the acquisition result of S22. To do.
  • the CPU 41 determines whether or not the latest exclusion range distance Xt ⁇ 1 acquired in S23 is greater than 5 m.
  • the most recent exclusion range distance Xt ⁇ 1 is the control target point setting process (S14) executed most recently in the control target point setting process (S14) executed in the past when the current control trajectory is generated.
  • the traveling time t is 0, that is, when the control target point setting process is first executed when generating the current control trajectory, the exclusion range distance set when the previous control trajectory is generated is set. (S7, S13).
  • the exclusion range distance is a distance that defines the size of a range to be excluded from the selection target of the control target point (hereinafter referred to as an exclusion range) when selecting the control target point from the temporary target position as will be described later.
  • an exclusion range a distance that defines the size of a range to be excluded from the selection target of the control target point (hereinafter referred to as an exclusion range) when selecting the control target point from the temporary target position as will be described later.
  • the range within the exclusion range distance centered on the trajectory generation start point is set as the exclusion range.
  • the CPU 41 determines whether or not the latest exclusion range distance Xt ⁇ 1 acquired in S23 is greater than 10 m.
  • an exclusion range that is a range to be excluded from the control target point selection targets is set when a control target point is selected from a plurality of temporary target positions. If the exclusion range is set wide, it takes a long time to correct the trajectory when the current position of the vehicle deviates from the target travel trajectory, but it becomes a control trajectory that draws a more gentle turn with little change in the vehicle direction. On the other hand, if the exclusion range is set narrow, the trajectory can be corrected in a short time when the current position of the vehicle deviates from the target travel trajectory, but it tends to be a control trajectory that draws a sharp turn.
  • a basically narrow exclusion range 61 (for example, within 5 m centering on the trajectory generation start point 51) is set as shown in FIG. (S26).
  • a narrow exclusion range 61 is set.
  • the exclusion range is set wide (for example, the exclusion range distance> 5 m) in the process at the previous traveling time t is narrow.
  • the exclusion range is gradually narrowed in multiple steps (S27). Specifically, every time the travel time t is added by 100 ms, the exclusion range distance is shortened by 1 m (however, the minimum is 5 m).
  • the control target point is suddenly changed from far away to the vicinity of the trajectory generation start point 51, the turning radius of the generated control trajectory may suddenly decrease (lateral acceleration increases suddenly).
  • the exclusion range when the exclusion range is narrowed, the above problem can be solved by narrowing the exclusion range step by step.
  • the exclusion range when the exclusion range is widened, the above-mentioned problem does not occur. Therefore, the exclusion range may be widened in one step instead of multiple steps.
  • a basically wide exclusion range (for example, within 20 m centering on the trajectory generation start point 51) is set at the initial stage as shown in FIG. (S29). Thereafter, every time the travel time t is added by 100 ms for continuing the “lane change support”, the exclusion range distance is shortened by 1 m (S30, where the minimum is 10 m).
  • the travel position is changed relatively slowly, and the angle of the vehicle body with respect to the lane is changed, unless it is necessary to change the lane quickly. It is preferable to move without wearing too much.
  • an exclusion range 61 wider than “lane keeping travel support” is set.
  • the lane change control can be performed more smoothly by widening the exclusion range. Note that when the exclusion range is narrowed from the initial stage, the turning radius of the control trajectory generated by narrowing in a stepwise manner is reduced suddenly (laterally) as in the case of “lane keeping driving support”. (Acceleration suddenly increases).
  • FIG. 12 is a diagram showing a specific setting example of the exclusion range accompanying the displacement at the running time t.
  • “lane keeping travel support” is implemented as automatic driving support when the travel time t is 0 (current time) to 100 ms
  • “lane change support” is performed when the travel time t is 200 ms to 1400 ms.
  • a case will be described as an example where the “lane keeping travel support” is performed again after the travel time t is 1500 ms.
  • the exclusion range distance is 5 m, and the track generation starts.
  • An area within 5 m centering on the point 51 is set as an exclusion range (S26).
  • the exclusion range distance is gradually shortened from 20 m and the exclusion range is gradually narrowed (S30). However, since the exclusion range distance is 10 m, the lower limit is maintained without further shortening after the exclusion range distance reaches 10 m.
  • the exclusion range distance is gradually increased from 10 m to 5 m in multiple steps. Switch. Specifically, every time travel time t is added by 100 ms, the exclusion range distance is shortened by 1 m. Accordingly, the exclusion range is gradually narrowed (S27). And after exclusion range distance reaches
  • the CPU 41 reads the parameter X t ⁇ 1 indicating the latest exclusion range distance stored in the RAM 42, and uses the current exclusion range distance X t set in any one of S26, S27, S29, and S30. Assign (update).
  • the temporary target position that is a candidate for the control target point is outside the exclusion range set in S26, S27, S29, and S30, and within a predetermined distance (for example, within 300 m) from the trajectory generation start point 51.
  • a certain temporary target position is assumed. For example, in the example shown in FIG.
  • the CPU 41 generates a trajectory (hereinafter referred to as a reaching trajectory) that reaches the temporary target position to be processed from the trajectory generation start point. Specifically, a trajectory connected from the trajectory generation start point to the temporary target position to be processed so as to have the largest turning radius is generated as an arrival trajectory. Further, in S32, the CPU 41 calculates the minimum turning radius among the turns included in the generated arrival trajectory. That is, in S32, the minimum turning radius required to reach the temporary target position to be processed from the trajectory generation start point is calculated.
  • the trajectory generation start point is a vehicle position predicted at the current travel time t (t hours after the current time), and is specified in S17. In particular, when the traveling time t is 0, which is an initial value, the trajectory generation start point is the current position of the vehicle.
  • the CPU 41 determines whether or not the turning radius calculated in S32 is greater than or equal to a threshold value.
  • the CPU 41 sets the temporary target position to be processed as the control target point. That is, the temporary target position that is close to the trajectory generation start point outside the exclusion range is set as the control target position with priority. However, when there is an obstacle ahead of the traveling direction of the vehicle, it is desirable to exclude the temporary target position that is the arrival trajectory overlapping with the obstacle from the target of the control target point. Information about the obstacle is acquired from the obstacle information DB 32.
  • the temporary target position to be processed is changed to another temporary target position next to the trajectory generation start point. After switching, the process of S32 is executed again. Then, as a result of executing the processes of S32 and S33 for all the temporary target positions to be processed, if there is no temporary target position whose turning radius is equal to or greater than the threshold value, the process proceeds to S35.
  • the CPU 41 sets the temporary target position having the largest turning radius calculated in S32 among the temporary target positions to be processed as the control target point.
  • the temporary target position closest to the trajectory generation start point is set as the control target point among the corresponding temporary target positions.
  • the temporary target position 62 when the temporary target position 62 is set at a predetermined interval with respect to the target travel path 50 as shown in FIG. 14, the temporary target position 62 outside the exclusion range 61 is set.
  • the arrival trajectory L1 reaching the point P1 is generated for the point P1 closest to the trajectory generation start point 51, and it is determined whether or not the turning radius is equal to or greater than a threshold value. If the turning radius of the arrival trajectory L1 is less than the threshold value, the arrival trajectory L2 reaching the point P2 is generated for the next point P2 closest to the trajectory generation start point 51, and the turning radius is greater than or equal to the threshold value. Is determined.
  • the turning radius of the arrival trajectory L2 is less than the threshold value
  • the arrival trajectory L3 reaching the point P3 is generated for the next point P3 close to the trajectory generation start point 51, and the turning radius is greater than or equal to the threshold value. Is determined.
  • a temporary target position 62 having a turning radius equal to or larger than the threshold and closest to the trajectory generation start point 51 is set as a control target point.
  • the temporary target position 62 having the largest turning radius is set as the control target point among the temporary target positions 62 outside the exclusion range 61.
  • the navigation device 1 and the computer program executed by the navigation device 1 set the target travel track 50 that is the target travel track for the road on which the vehicle travels ( S3)
  • a control target point 52 is set at a position on the target traveling track 50 and ahead of the traveling direction by a distance based on the support content of the automatic driving support implemented in the vehicle from the track generation start point 51 (S14). Since the control track 60 that causes the vehicle to travel is generated using the trajectory that travels from the trajectory generation start point 51 to the control target point 52 (S20), when the vehicle is traveling with automatic driving support, It becomes possible to generate a control trajectory having a shape corresponding to the support content of the automatic driving support.
  • “lane keeping driving assistance” and “lane change assistance” are specifically described as examples of automatic driving assistance performed on the vehicle, but other automatic driving assistance is performed. In some cases, it can be implemented.
  • there are automatic driving support that performs control for keeping the distance between the vehicle ahead and a vehicle at a constant distance (for example, 10 m) and control for traveling at a constant speed (for example, 80% of the speed limit).
  • a constant distance for example, 10 m
  • a constant speed for example, 80% of the speed limit
  • the exclusion range distance is basically set to 5 m when “lane keeping driving support” is performed, and the exclusion range distance is set when “lane change support” is performed.
  • the distance is basically set to 10 to 20 m, the distance can be changed as appropriate.
  • the exclusion range distance may be set to a shorter distance (for example, 2.5 m).
  • the exclusion range distance when “lane change support” is continuously implemented, the exclusion range distance is gradually shortened with time, but “lane maintenance travel support” is continuously implemented. Similarly, the exclusion range distance may be set to be gradually shortened with time. Furthermore, even if “lane change support” is continuously performed, the exclusion range distance may be fixed without shortening.
  • the vehicle control ECU 20 automatically controls all of the accelerator operation, the brake operation, and the handle operation, which are operations related to the behavior of the vehicle, among the operations of the vehicle, without depending on the driving operation of the user. It has been explained as an automatic driving support for running. However, the vehicle control ECU 20 may control the automatic driving support by controlling at least one of the accelerator operation, the brake operation, and the steering wheel operation, which is an operation related to the behavior of the vehicle among the operations of the vehicle.
  • manual driving by the user's driving operation will be described as a case where the user performs all of the accelerator operation, the brake operation, and the steering wheel operation, which are operations related to the behavior of the vehicle, among the operations of the vehicle.
  • the navigation device 1 executes the automatic driving support program (FIG. 2).
  • the vehicle control ECU 20 may execute the automatic driving support program (FIG. 2).
  • the vehicle control ECU 20 is configured to acquire the current position of the vehicle, map information, and the like from the navigation device 1.
  • the present invention can be applied to a device having a route search function.
  • the present invention can be applied to a mobile phone, a smartphone, a tablet terminal, a personal computer, and the like (hereinafter referred to as a mobile terminal).
  • the present invention can be applied to a system including a server and a mobile terminal.
  • each step of the above-described automatic driving support program may be configured to be implemented by either a server or a portable terminal.
  • the present invention is applied to a portable terminal or the like, it is necessary that the vehicle capable of performing automatic driving support and the portable terminal or the like be connected so as to be communicable (wired wireless is not a problem).
  • the automatic driving support device can also have the following configuration, and in that case, the following effects can be obtained.
  • the first configuration is as follows.
  • An automatic driving assistance device (1) for generating assistance information used for automatic driving assistance carried out in a vehicle in which a target traveling path (50) that is a target traveling path for a road on which the vehicle travels is set.
  • the control target point setting means (41) for setting (52) and the trajectory that travels from the trajectory generation start point to the control target point the control trajectory generation that generates the control trajectory (60) that the vehicle travels And means (41).
  • the automatic driving support device having the above-described configuration, it is possible to generate a control trajectory having a shape corresponding to the support content of the automatic driving support when the vehicle is traveling by the automatic driving support. Accordingly, it is possible to prevent a control trajectory having a small turning radius from being generated, for example, in a state where automatic driving assistance that is inappropriate for traveling by sudden turning is performed. Further, it is possible to prevent the generation of a control trajectory that frequently causes a change in the vehicle direction in a state where automatic driving assistance is performed in which it is inappropriate that the vehicle body angle is frequently displaced. As a result, it is possible to appropriately and continuously carry out automatic driving support.
  • the second configuration is as follows.
  • the trajectory generation start point (51) is a predicted position of the vehicle after a predetermined time assumed to travel along the trajectory traveling from the current position of the vehicle or the trajectory generation start point to the control target point (52). .
  • a trajectory toward the target travel trajectory is generated starting from the vehicle position after a predetermined time in addition to the current position of the vehicle, and final control is performed from each generated trajectory. Since the trajectory is generated, it is possible to generate a more appropriate control trajectory for traveling along the target travel trajectory using the positional relationship between the position of the vehicle and the target travel trajectory over time.
  • the third configuration is as follows.
  • the control trajectory generating means (41) connects the current position of the vehicle and the predicted position of the vehicle after a predetermined time assumed to travel along the trajectory traveling from the trajectory generation start point (51) to the control target point.
  • a trajectory is generated as the control trajectory.
  • a trajectory toward the target travel trajectory is generated using the current position of the vehicle and the vehicle position after a predetermined time as starting points, and the generated trajectories are connected to form a final trajectory. Since the control trajectory is generated, it is possible to generate an appropriate control trajectory for traveling along the target travel trajectory using the positional relationship between the vehicle position and the target travel trajectory with time.
  • the fourth configuration is as follows.
  • the control target point setting means (41) sets the control target point (52) by giving priority to a position near the trajectory generation start point (51) outside the exclusion range.
  • the control target point is set at a position that is a predetermined distance or more away from the trajectory generation start point, so that control hunting can be prevented from occurring.
  • control target point is set close to the trajectory generation start point, there is a possibility that a deviation occurs between the generated control trajectory and the vehicle control to be performed, but such a problem can be solved. Further, since the control target point is set as close to the track generation start point as possible within a range that prevents the occurrence of control hunting, the control track along the target travel track can be generated as much as possible.
  • the fifth configuration is as follows.
  • the control target point setting means (41) is configured so that a minimum turning radius of a trajectory reaching the control target point (52) from the trajectory generation start point (51) is equal to or greater than a threshold value. Set. According to the automatic driving assistance device having the above-described configuration, it is possible to appropriately perform the traveling control related to the automatic driving assistance of the traveling vehicle and generate a control trajectory that does not cause a burden on the occupant of the traveling vehicle. It becomes possible.
  • the sixth configuration is as follows.
  • the exclusion range setting means (41) changes from the first distance corresponding to the first support to the second support when the content of the automatic driving support performed in the vehicle is switched from the first support to the second support.
  • the exclusion range distance is switched stepwise in a plurality of steps to the corresponding second distance. According to the automatic driving assistance apparatus having the above-described configuration, it is possible to prevent the turning radius of the generated control trajectory from changing suddenly when the content of the automatic driving assistance performed in the vehicle is switched.
  • the seventh configuration is as follows.
  • the exclusion range setting means (41) when the first distance is longer than the second distance, switches the exclusion range distance in stages from the first distance to the second distance, When the second distance is shorter than the first distance, the exclusion range distance is switched from the first distance to the second distance in one step.
  • the automatic driving assistance apparatus having the above configuration, when the content of the automatic driving assistance performed in the vehicle is switched, the turning radius of the generated control trajectory is suddenly reduced (that is, the lateral acceleration is suddenly increased). Can be prevented.
  • the turning radius of the generated control trajectory to be increased, it is possible to quickly generate a control trajectory having a shape corresponding to the support content of the automatic driving support after switching.
  • the eighth configuration is as follows.
  • the exclusion range setting means (41) gradually shortens the exclusion range distance when the same automatic driving support is continuously performed in the vehicle.
  • the automatic driving assistance device having the above-described configuration, when performing lane change control, the travel position is changed relatively slowly at first, and the control amount is gradually increased, so that smoother lane change control is possible. Become.
  • the ninth configuration is as follows.
  • the automatic driving support implemented in the vehicle includes a lane maintaining driving support for driving while maintaining the same lane, and a lane changing support for changing the lane to a different lane, and the lane changing support is the lane maintaining driving.
  • the exclusion range distance is set longer than the assistance.
  • the automatic driving assistance device having the above-described configuration, when the lane keeping running assistance is performed in the vehicle, the running position is corrected quickly by setting the control target point to a close position, and the vehicle is shifted from the lane center. Can suppress wandering.
  • the travel position is changed relatively slowly by setting the control target point to a distant position, and the vehicle moves without making the body angle excessively relative to the lane. It is possible to generate a control trajectory.
  • Navigation device 1
  • Navigation ECU 41
  • CPU 42
  • RAM 43
  • ROM 45
  • target travel trajectory 51
  • trajectory generation start point 52
  • control target point 53
  • travel trajectory 60
  • control trajectory 61
  • exclusion range 62

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Combustion & Propulsion (AREA)
  • Chemical & Material Sciences (AREA)
  • Human Computer Interaction (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Traffic Control Systems (AREA)
  • Navigation (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

自動運転支援の支援内容に応じた形状を有する制御軌道を生成することを可能にした自動運転支援装置及びコンピュータプログラムを提供する。具体的には、車両が走行する道路に対して目標とする走行軌道である目標走行軌道（５０）を設定し、目標走行軌道（５０）上であって軌道生成開始点（５１）に対して車両において実施されている自動運転支援の支援内容に基づく進行方向前方の位置に、制御目標地点（５２）を設定し、軌道生成開始点（５１）から制御目標地点（５２）へと走行する軌道を用いて、車両に走行させる制御軌道（６０）を生成するように構成する。

Description

自動運転支援装置及びコンピュータプログラム
　本発明は、車両において自動運転支援を行う自動運転支援装置及びコンピュータプログラムに関する。
　近年、車両の走行形態として、ユーザの運転操作に基づいて走行する手動走行以外に、ユーザの運転操作の一部又は全てを車両側で実行することにより、ユーザによる車両の運転を補助する自動運転支援システムについて新たに提案されている。自動運転支援システムでは、例えば、車両の現在位置、車両が走行する車線、周辺の他車両の位置を随時検出し、予め設定された経路に沿って走行するようにステアリング、駆動源、ブレーキ等の車両制御が自動で行われる。
　また、自動運転支援による走行は基本的に予め決められた目標走行軌道（例えば車両が走行すべき車線の中心線）にできる限り沿って車両を走行させる制御を行う。例えば、特開２０１３－１１２０６７号公報には、車両の走行位置が目標走行軌道である走行進路から外れている場合に、外れた走行進路上に所定間隔で配置された目標通過点の内、自車の現在位置から所定範囲内にある目標通過点を固定目標通過点として設定し、車両の現在位置から固定目標通過点を通過する新たな走行進路を生成する技術について提案されている。
特開２０１３－１１２０６７号公報（第８－９頁、図５）
　ここで、車両において実施される自動運転支援の支援内容には様々な種類が存在する。例えば、同一の車線を維持して走行する車線維持走行支援や、異なる車線へと車線変更する為の車線変更支援がある。そして、上記特許文献１の技術では、車両において実施されている自動運転支援の支援内容にかかわらず、車両の現在位置から所定範囲内にある目標通過点を固定目標通過点としていた。
　その結果、上記特許文献１の技術では、車両において実施されている自動運転支援の支援内容に適さない新たな走行進路が生成される場合があった。例えば、他車両の接近や車線変更の実施等の様々な理由によって、予め設定されていた走行進路から車両の走行位置が大きく外れた場合には、目標走行軌道に戻る為に急旋回を伴う新たな走行進路が生成される虞がある。そのような場合には、自動運転支援を適切に行うことができなくなる可能性があった。
　本発明は前記従来における問題点を解消するためになされたものであり、自動運転支援による車両の走行が行われている場合において、自動運転支援の支援内容に応じた形状を有する制御軌道を生成することが可能であり、自動運転支援を適切に継続して実施することを可能にした自動運転支援装置及びコンピュータプログラムを提供することを目的とする。
　前記目的を達成するため本発明に係る自動運転支援装置は、車両において実施する自動運転支援に用いる支援情報を生成する自動運転支援装置であって、車両が走行する道路に対して目標とする走行軌道である目標走行軌道を設定する走行軌道設定手段と、前記目標走行軌道上であって軌道生成開始点に対して車両において実施されている自動運転支援の支援内容に基づく進行方向前方の位置に、制御目標地点を設定する制御目標地点設定手段と、前記軌道生成開始点から前記制御目標地点へと走行する軌道を用いて、車両に走行させる制御軌道を生成する制御軌道生成手段と、を有する。
　尚、「自動運転支援」とは、運転者の車両操作の少なくとも一部を運転者に代わって行う又は補助する機能をいう。
　また、本発明に係るコンピュータプログラムは、車両において実施する自動運転支援に用いる支援情報を生成するプログラムである。具体的には、コンピュータを、車両が走行する道路に対して目標とする走行軌道である目標走行軌道を設定する走行軌道設定手段と、前記目標走行軌道上であって軌道生成開始点に対して車両において実施されている自動運転支援の支援内容に基づく進行方向前方の位置に、制御目標地点を設定する制御目標地点設定手段と、前記軌道生成開始点から前記制御目標地点へと走行する軌道を用いて、車両に走行させる制御軌道を生成する制御軌道生成手段と、して機能させる。
　前記構成を有する本発明に係る自動運転支援装置及びコンピュータプログラムによれば、自動運転支援による車両の走行が行われている場合において、自動運転支援の支援内容に応じた形状を有する制御軌道を生成することが可能となる。従って、例えば急旋回による走行が不適な自動運転支援が行われている状態には、旋回半径の小さい制御軌道が生成されることを防止できる。また、車体の角度が頻繁に変位することが不適な自動運転支援が行われている状態には、頻繁な車両方位の変化を招く制御軌道が生成されることを防止できる。その結果、自動運転支援を適切に継続して実施することが可能となる。
本実施形態に係るナビゲーション装置を示したブロック図である。 本実施形態に係る自動運転支援プログラムのフローチャートである。 車両の走行する道路に対して設定される目標走行軌道の例を示した図である。 車両の走行する道路に対して設定される目標走行軌道の例を示した図である。 制御軌道生成処理のサブ処理プログラムのフローチャートである。 走行時刻ｔが１００ｍｓｅｃの場合において予測される車両の位置を示した図である。 走行時刻ｔが２００ｍｓｅｃの場合において予測される車両の位置を示した図である。 制御軌道の生成方法について説明した図である。 制御目標地点設定処理のサブ処理プログラムのフローチャートである。 車両において車線維持走行支援が行われている場合に設定される除外範囲を示した図である。 車両において車線変更支援が行われている場合に設定される除外範囲を示した図である。 走行時刻ｔの変位に伴う除外範囲の具体的な設定例を示した図である。 目標走行軌道上に設定される仮目標位置を示した図である。 仮目標位置の内から制御目標地点を選択する選択方法について説明した図である。
　以下、本発明に係る自動運転支援装置を、ナビゲーション装置に具体化した一実施形態に基づき図面を参照しつつ詳細に説明する。先ず、本実施形態に係るナビゲーション装置１の概略構成について図１を用いて説明する。図１は本実施形態に係るナビゲーション装置１を示したブロック図である。
　図１に示すように本実施形態に係るナビゲーション装置１は、ナビゲーション装置１が搭載された車両の現在位置を検出する現在位置検出部１１と、各種のデータが記録されたデータ記録部１２と、入力された情報に基づいて、各種の演算処理を行うナビゲーションＥＣＵ１３と、ユーザからの操作を受け付ける操作部１４と、ユーザに対して車両周辺の地図やナビゲーション装置１で設定されている案内経路（車両の走行予定経路）に関する情報等を表示する液晶ディスプレイ１５と、経路案内に関する音声ガイダンスを出力するスピーカ１６と、記憶媒体であるＤＶＤを読み取るＤＶＤドライブ１７と、プローブセンタやＶＩＣＳ（登録商標：Vehicle Information and Communication System）センタ等の情報センタとの間で通信を行う通信モジュール１８と、を有する。また、ナビゲーション装置１はＣＡＮ等の車載ネットワークを介して、ナビゲーション装置１の搭載された車両に対して設置された車外カメラ１９や各種センサが接続されている。更に、ナビゲーション装置１の搭載された車両に対する各種制御を行う車両制御ＥＣＵ２０とも双方向通信可能に接続されている。また、自動運転開始ボタン等の車両に搭載された各種操作ボタン２１についても接続されている。
　以下に、ナビゲーション装置１が有する各構成要素について順に説明する。
　現在位置検出部１１は、ＧＰＳ２２、車速センサ２３、ステアリングセンサ２４、ジャイロセンサ２５等からなり、現在の車両の位置、方位、車両の走行速度、現在時刻等を検出することが可能となっている。ここで、特に車速センサ２３は、車両の移動距離や車速を検出する為のセンサであり、車両の駆動輪の回転に応じてパルスを発生させ、パルス信号をナビゲーションＥＣＵ１３に出力する。そして、ナビゲーションＥＣＵ１３は発生するパルスを計数することにより駆動輪の回転速度や移動距離を算出する。尚、上記４種類のセンサをナビゲーション装置１が全て備える必要はなく、これらの内の１又は複数種類のセンサのみをナビゲーション装置１が備える構成としても良い。
　また、データ記録部１２は、外部記憶装置及び記録媒体としてのハードディスク（図示せず）と、ハードディスクに記録された地図情報ＤＢ３１や障害物情報ＤＢ３２や所定のプログラム等を読み出すとともにハードディスクに所定のデータを書き込む為のドライバである記録ヘッド（図示せず）とを備えている。尚、データ記録部１２をハードディスクの代わりにフラッシュメモリやメモリーカードやＣＤやＤＶＤ等の光ディスクを有しても良い。また、地図情報ＤＢ３１は外部のサーバに格納させ、ナビゲーション装置１が通信により取得する構成としても良い。
　ここで、地図情報ＤＢ３１は、例えば、道路（リンク）に関するリンクデータ３４、ノード点に関するノードデータ３５、経路の探索や変更に係る処理に用いられる探索データ３６、施設に関する施設データ、地図を表示するための地図表示データ、各交差点に関する交差点データ、地点を検索するための検索データ等が記憶された記憶手段である。
　また、リンクデータ３４としては、道路を構成する各リンクに関してリンクの属する道路の幅員、勾（こう）配、カント、バンク、路面の状態、ノード間のリンク形状（例えばカーブ道路ではカーブの形状）を特定する為の形状補完点データ、合流区間、道路構造、道路の車線数、車線数の減少する箇所、幅員の狭くなる箇所、踏切り等を表すデータが、コーナに関して、曲率半径、交差点、Ｔ字路、コーナの入口及び出口等を表すデータが、道路属性に関して、降坂路、登坂路等を表すデータが、道路種別に関して、国道、県道、細街路等の一般道のほか、高速自動車国道、都市高速道路、自動車専用道路、一般有料道路、有料橋等の有料道路を表すデータがそれぞれ記録される。特に本実施形態では、道路の車線数に加えて、車線毎の進行方向の通行区分や道路の繋がり（具体的には、分岐においてどの車線がどの道路に接続されているか）を特定する情報についても記憶されている。更に、道路に設定されている制限速度についても記憶されている。
　また、ノードデータ３５としては、実際の道路の分岐点（交差点、Ｔ字路等も含む）や各道路に曲率半径等に応じて所定の距離毎に設定されたノード点の座標（位置）、ノードが交差点に対応するノードであるか等を表すノード属性、ノードに接続するリンクのリンク番号のリストである接続リンク番号リスト、ノードにリンクを介して隣接するノードのノード番号のリストである隣接ノード番号リスト、各ノード点の高さ（高度）等に関するデータ等が記録される。
　また、探索データ３６としては、出発地（例えば車両の現在位置）から設定された目的地までの経路を探索する経路探索処理に使用される各種データについて記録されている。具体的には、交差点に対する経路として適正の程度を数値化したコスト（以下、交差点コストという）や道路を構成するリンクに対する経路として適正の程度を数値化したコスト（以下、リンクコストという）等の探索コストを算出する為に使用するコスト算出データが記憶されている。
　また、障害物情報ＤＢ３２は、外部のサーバによって配信された障害物に関する障害物情報が記憶される記憶手段である。また、自車両の車外カメラ１９やセンサによって検出した自車両の周囲に位置する障害物に関する障害物情報についても記憶される。ここで、障害物情報ＤＢ３２に障害物情報が記憶される障害物は、車両において後述のように実施される自動運転支援に影響する対象物（要因）であり、例えば周辺を走行する他車両、路上に停車する駐車車両、工事区間、渋滞車両等が該当する。また、障害物情報は例えば障害物の種類と、障害物の地図上の位置座標（範囲に跨る場合には範囲を特定する情報）と、障害物の内容を特定する情報とを含む。そして、ナビゲーションＥＣＵ１３は、後述のように地図情報ＤＢ３１に記憶された地図情報や障害物情報ＤＢ３２に記憶された障害物情報を用いて自動運転支援を実施する。
　ここで、車両の走行形態としては、ユーザの運転操作に基づいて走行する手動運転走行に加えて、ユーザの運転操作によらず車両が予め設定された経路や道なりに沿って自動的に走行を行う自動運転支援による支援走行が可能である。尚、自動運転支援における車両制御では、例えば、車両の現在位置、車両が走行する車線、周辺の障害物の位置を随時検出し、車両制御ＥＣＵ２０によって予め設定された経路に沿って走行するようにステアリング、駆動源、ブレーキ等の車両制御が自動で行われる。尚、本実施形態の自動運転支援による支援走行では、車線変更や右左折についても自動運転制御により行う構成とするが、車線変更や右左折の一部については自動運転制御では行わない構成としても良い。
　具体的に本実施形態では、右左折、合流、分岐等の特殊な状況下を除いて基本的に以下の２種類のいずれかの自動運転支援を行う。
　（１）『車線維持走行支援』・・・車両が車線を逸脱することなく車線の中心付近を走行させる制御（例えばレーン・キーピング・アシスト）。
　（２）『車線変更支援』・・・現在走行する車線から異なる車線へと移動させる制御。
　尚、上記（１）、（２）のいずれの支援を実施するかは、車両が走行する道路に対して設定された目標とする走行軌道である目標走行軌道に基づいて決定される。また、上記（１）、（２）の制御と平行して、前方車両との車間距離を一定距離（例えば１０ｍ）に保つ制御や一定速度（例えば制限速度の８０％）で走行する制御等についても実施される。
　また、自動運転支援は全ての道路区間に対して行っても良いし、特定の道路区間（例えば境界にゲート（有人無人、有料無料は問わない）が設けられた高速道路）を車両が走行する間のみ行う構成としても良い。以下の説明では車両の自動運転支援が行われる自動運転区間は、一般道や高速道路を含む全ての道路区間とし、車両が道路上を走行する間において基本的に上記自動運転支援が行われるとして説明する。但し、車両が自動運転区間を走行する場合には必ず自動運転支援が行われるのではなく、ユーザにより自動運転支援を行うことが選択され（例えば自動運転開始ボタンをＯＮする）、且つ自動運転支援による走行を行わせることが可能と判定された状況でのみ行われる。尚、自動運転支援の詳細については後述する。
　一方、ナビゲーションＥＣＵ（エレクトロニック・コントロール・ユニット）１３は、ナビゲーション装置１の全体の制御を行う電子制御ユニットであり、演算装置及び制御装置としてのＣＰＵ４１、並びにＣＰＵ４１が各種の演算処理を行うにあたってワーキングメモリとして使用されるとともに、経路が探索されたときの経路データ等が記憶されるＲＡＭ４２、制御用のプログラムのほか、後述の自動運転支援プログラム（図２参照）等が記録されたＲＯＭ４３、ＲＯＭ４３から読み出したプログラムを記憶するフラッシュメモリ４４等の内部記憶装置を備えている。尚、ナビゲーションＥＣＵ１３は、処理アルゴリズムとしての各種手段を有する。例えば、走行軌道設定手段は、車両が走行する道路に対して目標とする走行軌道である目標走行軌道を設定する。制御目標地点設定手段は、目標走行軌道上であって軌道生成開始点に対して車両において実施されている自動運転支援の支援内容に基づく進行方向前方の位置に、制御目標地点を設定する。制御軌道生成手段は、軌道生成開始点から制御目標地点へと走行する軌道を用いて、車両に走行させる制御軌道を生成する。
　操作部１４は、走行開始地点としての出発地及び走行終了地点としての目的地を入力する際等に操作され、各種のキー、ボタン等の複数の操作スイッチ（図示せず）を有する。そして、ナビゲーションＥＣＵ１３は、各スイッチの押下等により出力されるスイッチ信号に基づき、対応する各種の動作を実行すべく制御を行う。尚、操作部１４は液晶ディスプレイ１５の前面に設けたタッチパネルを有しても良い。また、マイクと音声認識装置を有しても良い。
　また、液晶ディスプレイ１５には、道路を含む地図画像、交通情報、操作案内、操作メニュー、キーの案内、案内経路に沿った案内情報、ニュース、天気予報、時刻、メール、テレビ番組等が表示される。尚、液晶ディスプレイ１５の代わりに、ＨＵＤやＨＭＤを用いても良い。
　また、スピーカ１６は、ナビゲーションＥＣＵ１３からの指示に基づいて案内経路に沿った走行を案内する音声ガイダンスや、交通情報の案内を出力する。
　また、ＤＶＤドライブ１７は、ＤＶＤやＣＤ等の記録媒体に記録されたデータを読み取り可能なドライブである。そして、読み取ったデータに基づいて音楽や映像の再生、地図情報ＤＢ３１の更新等が行われる。尚、ＤＶＤドライブ１７に替えてメモリーカードを読み書きする為のカードスロットを設けても良い。
　また、通信モジュール１８は、交通情報センタ、例えば、ＶＩＣＳセンタやプローブセンタ等から送信された交通情報、プローブ情報、天候情報等を受信する為の通信装置であり、例えば携帯電話機やＤＣＭが該当する。また、車車間で通信を行う車車間通信装置や路側機との間で通信を行う路車間通信装置も含む。
　また、車外カメラ１９は、例えばＣＣＤ等の固体撮像素子を用いたカメラにより構成され、車両のフロントバンパの上方に取り付けられるとともに光軸方向を水平より所定角度下方に向けて設置される。そして、車外カメラ１９は、車両が自動運転区間を走行する場合において、車両の進行方向前方を撮像する。また、車両制御ＥＣＵ２０は撮像された撮像画像に対して画像処理を行うことによって、車両が走行する道路に描かれた区画線や周辺の他車両等の障害物を検出し、検出結果に基づいて車両の自動運転支援を行う。尚、車外カメラ１９は車両前方以外に後方や側方に配置するように構成しても良い。また、障害物を検出する手段としてはカメラの代わりにミリ波レーダやレーザセンサ等のセンサや車車間通信や路車間通信を用いても良い。
　また、車両制御ＥＣＵ２０は、ナビゲーション装置１が搭載された車両の制御を行う電子制御ユニットである。また、車両制御ＥＣＵ２０にはステアリング、ブレーキ、アクセル等の車両の各駆動部と接続されており、本実施形態では特に車両において自動運転支援が開始された後に、各駆動部を制御することにより車両の自動運転支援を実施する。また、自動運転支援中にユーザによってオーバーライドが行われた場合には、オーバーライドが行われたことを検出する。
　ここで、ナビゲーションＥＣＵ１３は、走行開始後にＣＡＮを介して車両制御ＥＣＵ２０に対して自動運転支援に関する指示信号を送信する。そして、車両制御ＥＣＵ２０は受信した指示信号に応じて走行開始後の自動運転支援を実施する。尚、指示信号の内容は、車両が走行する軌道や走行車速等を指示する情報である。
　続いて、上記構成を有する本実施形態に係るナビゲーション装置１においてＣＰＵ４１が実行する自動運転支援プログラムについて図２に基づき説明する。図２は本実施形態に係る自動運転支援プログラムのフローチャートである。ここで、自動運転支援プログラムは、車両のＡＣＣ電源(accessory power supply)がＯＮされた後であって自動運転支援による車両の走行が開始された場合に実行され、設定された目標走行軌道に沿って走行する為の車両の自動運転支援を実施するプログラムである。また、以下の図２、図５及び図９にフローチャートで示されるプログラムは、ナビゲーション装置１が備えているＲＡＭ４２やＲＯＭ４３に記憶されており、ＣＰＵ４１により実行される。
　先ず、自動運転支援プログラムではステップ（以下、Ｓと略記する）１において、ＣＰＵ４１は、車両が今後走行する予定にある経路（以下、走行予定経路という）を取得する。尚、車両の走行予定経路は、ナビゲーション装置１において案内経路が設定されている場合には、ナビゲーション装置１において現在設定されている案内経路の内、車両の現在位置から目的地までの経路を走行予定経路とする。尚、案内経路はナビゲーション装置１によって設定された出発地から目的地までの推奨経路であり、例えば公知のダイクストラ法を用いて探索される。一方、ナビゲーション装置１において案内経路が設定されていない場合には、車両の現在位置から道なりに走行する経路を走行予定経路とする。
　次に、Ｓ２においてＣＰＵ４１は、地図情報ＤＢ３１から走行予定経路の車線に関する車線情報を取得する。具体的には、走行予定経路を構成する道路に含まれる車線数、車線毎の進行方向の通行区分や道路の繋がり（分岐においてどの車線がどの道路に接続されているか）を特定する情報が取得される。
　続いて、Ｓ３においてＣＰＵ４１は、前記Ｓ１で取得した走行予定経路と前記Ｓ２で取得した車線情報とに基づいて、今後に車両が走行する道路に対して目標とする走行軌道である目標走行軌道５０を設定する。尚、目標走行軌道５０は、基本的には走行予定経路を構成する道路に含まれる車線の内、走行が推奨される車線の中心線に対して車両の進行方向に沿って設定される。例えば、図３に示す例では片側２車線の道路を車両が道なりに走行する場合であり、走行が推奨される左側の車線の中心線に対して目標走行軌道５０が設定される。一方で、図４に示す例では、車線が左側に新たに増加する場合であって、車両がその後に左折又は左分岐する場合であり、車線の増加地点までは左側の車線の中心線に対して目標走行軌道５０が設定され、車線が増加した後は増加した車線の中心線に対して目標走行軌道５０が設定される。尚、走行予定経路の全経路を対象として上記目標走行軌道を設定しても良いが、車両の現在位置から所定距離（例えば３００ｍ）以内のみを対象として上記目標走行軌道を設定しても良い。その場合には、上記Ｓ１～Ｓ３の処理は車両が所定距離走行する度に繰り返し実施される。
　次に、Ｓ４においてＣＰＵ４１は、前回の除外範囲距離を示すパラメータＸｎ－１に初期値を設定する。初期値は例えば５ｍとするが、その値は適宜変更可能である。車両において現在実施されている自動運転支援の支援内容に基づいて初期値を変更しても良い。ここで、除外範囲距離は後述のように車両に走行させる制御軌道を生成する際（Ｓ６）に用いられるパラメータである。詳細については後述する。尚、パラメータＸｎ－１はＲＡＭ４２等に記憶される。
　以下のＳ５～Ｓ９の処理は、車両のＡＣＣ電源(accessory power supply)がＯＮされている間において一定周期（例えば１００ｍｓｅｃ）毎に繰り返し実行される。そして、車両のＡＣＣ電源がＯＦＦされた後に当該自動運転支援プログラムを終了する。
　先ず、Ｓ５においてＣＰＵ４１は現在の車両において自動運転支援が実施されているか否かを判定する。尚、自動運転支援は例えばユーザによる自動運転開始ボタン等の操作によって実施のＯＮ／ＯＦＦを切り替えることが可能である。また、自動運転支援を実施することが困難な状況（例えば車両が走行する車線を区画する区画線が消失した場合等）となった際に実施が中止される場合もある。
　そして、自動運転支援が実施されていると判定された場合（Ｓ５：ＹＥＳ）には、Ｓ６へと移行する。それに対して、自動運転支援が実施されていないと判定された場合（Ｓ５：ＮＯ）には、制御軌道の生成や生成された制御軌道に基づく自動運転支援を行うことなく当該自動運転支援プログラムを終了する。
　Ｓ６においてＣＰＵ４１は、後述の制御軌道生成処理（図５）を実行する。ここで、制御軌道生成処理は、今後に車両に走行させる軌道である制御軌道を生成する処理である。尚、制御軌道は後述のように車両の現在位置から進行方向に沿って停止距離（運転者がブレーキをかけると判断してから停止するまでに必要な距離）前方までの区間を対象として生成される。また、制御軌道は前記Ｓ３で設定された目標走行軌道にできる限り沿って走行する為の軌道であり、例えば車両の現在位置が目標走行軌道上又は周辺にある場合には、継続して目標走行軌道周辺に留まる軌道となり、一方で車両の現在位置が目標走行軌道から外れていた場合には、目標走行軌道上へと向かう軌道となる。
　続いて、Ｓ７においてＣＰＵ４１は、ＲＡＭ４２に格納された前回の除外範囲距離を示すパラメータＸｎ－１を読み出し、直近に実施された前記Ｓ６で制御軌道を生成するのに用いられた除外範囲距離Ｘｎの内、特に最初（走行時刻が０）に設定された除外範囲距離Ｘｎを代入する。
　次に、Ｓ８においてＣＰＵ４１は、前記Ｓ６で生成された制御軌道に沿って車両が走行する為の制御量を演算する。具体的には、アクセル、ブレーキ、ギヤ及びステアリングの制御量が夫々演算される。
　その後、Ｓ９においてＣＰＵ４１は、Ｓ８において演算された制御量を反映する。具体的には、演算された制御量を、ＣＡＮを介して車両制御ＥＣＵ２０へと送信する。車両制御ＥＣＵ２０では受信した制御量に基づいてアクセル、ブレーキ、ギヤ及びステアリングの各車両制御が行われる。その結果、車両が生成された制御軌道に沿って走行する走行支援制御が可能となる。
　そして、一定周期（例えば１００ｍｓｅｃ）毎に上記Ｓ５～Ｓ９の処理を繰り返し実行することによって、直近に検出された車両の現在位置や方位から目標走行軌道に沿って走行させる為の最適な制御軌道の生成及び制御軌道に沿って走行させる為の自動運転支援を実施することが可能となる。
　次に、前記Ｓ６において実行される制御軌道生成処理のサブ処理について図５に基づき説明する。図５は制御軌道生成処理のサブ処理プログラムのフローチャートである。
　先ず、Ｓ１１においてＣＰＵ４１は、車両の現在の車速から現在の車両の“停止距離”を算出する。尚、“停止距離”は運転者がブレーキをかけると判断してから停止するまでに必要な距離であり、空走距離に０．２Ｇの減速度で停止する為の制動距離を加算した距離とする。尚、停止距離の具体的な算出方法については公知であるので詳細は省略する。
　次に、Ｓ１２においてＣＰＵ４１は、パラメータである走行時刻ｔに初期値として０（０は現在時刻を意味する）を設定する。尚、走行時刻ｔはＲＡＭ４２等に記憶される。
　続いて、Ｓ１３においてＣＰＵ４１は、直近の除外範囲距離を示すパラメータＸｔ－１に前回の除外範囲距離を示すパラメータＸｎ－１を代入する。尚、前回の除外範囲距離を示すパラメータＸｎ－１は前記Ｓ４又はＳ７で設定される。尚、パラメータＸｔ－１はＲＡＭ４２等に記憶される。
　その後、Ｓ１４においてＣＰＵ４１は、後述の制御目標地点設定処理（図９）を実行する。ここで、制御目標地点設定処理は、制御軌道を生成する際の目標点である制御目標地点を設定する処理である。尚、制御目標地点は、後述のように目標走行軌道上であって軌道生成開始点から車両において実施されている自動運転支援の支援内容に基づく距離だけ進行方向前方の位置に設定される。また、軌道生成開始点は現時点の走行時刻ｔ（現在時刻からｔ時間後）において予測される車両の位置であり、後述のＳ１７で特定される。特に走行時刻ｔが初期値である０の場合は、軌道生成開始点は車両の現在位置となる。
　次に、Ｓ１５においてＣＰＵ４１は、軌道生成開始点から前記Ｓ１４で設定された制御目標地点までの軌道（以下、走行軌道という）を生成する。具体的には車両が軌道生成開始点から制御目標地点までを、現在の車速で所定の操舵角以内で走行する軌道を走行軌道として生成する。また、軌道生成開始点は現時点の走行時刻ｔ（現在時刻からｔ時間後）において予測される車両の位置である。また、軌道生成開始点における車両の方位は後述のＳ１７で特定される。
　その後、Ｓ１６においてＣＰＵ４１は、ＲＡＭ４２から走行時刻ｔを読み出し、１００ｍｓｅｃ加算する。
　続いて、Ｓ１７においてＣＰＵ４１は、車両が前記Ｓ１５で生成された走行軌道の軌道生成開始点から走行軌道に沿って現在の車両の車速で走行したと仮定して、現時点の走行時刻ｔ（現在時刻からｔ時間後）における車両の位置と方位を予測する。具体的には、軌道生成開始点から前記Ｓ１５で生成された走行軌道に沿って現在の車両の車速で１００ｍｓ走行した場合の走行距離だけ離れた地点を、現時点の走行時刻ｔ（現在時刻からｔ時間後）における車両の位置とする。また、予測された車両の位置における走行軌道の接線方向が現時点の走行時刻ｔ（現在時刻からｔ時間後）における車両の方位となる。
　その後、Ｓ１８においてＣＰＵ４１は、走行時刻ｔ＝０（即ち現在時刻）の車両の位置から前記Ｓ１７で予測された現時点の走行時刻ｔにおける車両の位置までの車両の走行距離を算出する。尚、車両は過去に走行時刻ｔ毎に予測された各車両の位置を繋ぐ軌道を走行すると仮定して走行距離を算出する。
　次に、Ｓ１９においてＣＰＵ４１は、前記Ｓ１８で算出された走行距離が前記Ｓ１１で算出された停止距離以上であるか否かを判定する。
　そして、前記Ｓ１８で算出された走行距離が前記Ｓ１１で算出された停止距離未満であると判定された場合（Ｓ１９：ＮＯ）には、Ｓ１４へと戻る。そして、Ｓ１６で加算後の走行時刻ｔ（現在時刻からｔ時間後）において予測される新たな車両の位置を軌道生成開始点として、制御目標地点の設定及び走行軌道の生成を再度行う。そして、前記Ｓ１８で算出された走行距離が前記Ｓ１１で算出された停止距離以上と判定されるまで、走行時刻ｔを１００ｍｓｅｃずつ加算して前記Ｓ１４～Ｓ１８の処理を繰り返し実行する
　例えば、図６に示すように先ず走行時刻ｔが初期値である０（即ち現在時刻）の場合には、車両の現在位置を軌道生成開始点５１として、目標走行軌道５０上に制御目標地点５２が設定される。そして、軌道生成開始点５１から制御目標地点５２までの走行軌道５３が生成される。更に、生成された走行軌道５３に沿って車両が１００ｍｓｅｃ走行したと仮定して現在時刻から１００ｍｓｅｃ後の車両位置５４が予測される。
　次に、図７に示すように１００ｍｓｅｃ後の車両位置５４（即ち走行時刻ｔが１００ｍｓｅｃの場合において予測される車両の位置）を新たな軌道生成開始点５１として、目標走行軌道５０上に新たな制御目標地点５２が設定される。そして、同様に軌道生成開始点５１から制御目標地点５２までの走行軌道５３が生成される。更に、生成された走行軌道５３に沿って車両が１００ｍｓｅｃ走行したと仮定して現在時刻から２００ｍｓｅｃ後の車両の位置５５が予測される。
　以下同様にして現在時刻から３００ｍｓｅｃ後の車両の位置、４００ｍｓｅｃ後の車両の位置、・・・・が車両の走行距離が停止距離以上と判定されるまで予測される。
　そして、前記Ｓ１８で算出された走行距離が前記Ｓ１１で算出された停止距離以上であると判定された場合（Ｓ１９：ＹＥＳ）には、Ｓ２０へと移行する。Ｓ２０でＣＰＵ４１は、前記Ｓ１４～Ｓ１８の処理を繰り返し実行することによって特定された各走行時刻ｔ（ｔ＝０、１００ｍｓｅｃ、２００ｍｓｅｃ、３００ｍｓｅｃ、・・・）における車両の位置を繋いだ軌道を制御軌道として生成する。尚、各走行時刻ｔにおける車両の位置を繋ぐ際には、各位置における車両の方位についても考慮する。各位置における車両の方位は前記Ｓ１７で特定されている。また、旋回回数が少なく旋回半径ができる限り大きくなるように繋ぐのが望ましい。
　例えば、図８に示すように目標走行軌道５０に対して現在時刻（走行時刻ｔ＝０）の車両の位置５１、現在時刻から１００ｍｓｅｃ後（走行時刻ｔ＝１００ｍｓｅｃ）の車両の位置５４、２００ｍｓｅｃ後（走行時刻ｔ＝２００ｍｓｅｃ）の車両の位置５５、３００ｍｓｅｃ後（走行時刻ｔ＝３００ｍｓｅｃ）の車両の位置５６が特定されている場合には、各車両の位置５１、５４、５５、５６を繋いだ軌道を制御軌道６０として生成する。
　尚、前記Ｓ１５で生成された走行軌道５３の一部を繋げて制御軌道６０を生成しても良い。即ち、図６に示す軌道生成開始点５１から予測車両位置５４までの走行軌道５３と、図７に示す軌道生成開始点５１から予測車両位置５５までの走行軌道５３とを繋げた軌道を制御軌道６０として生成しても良い。
　次に、前記Ｓ１４において実行される制御目標地点設定処理のサブ処理について図９に基づき説明する。図９は制御目標地点設定処理のサブ処理プログラムのフローチャートである。
　先ず、Ｓ２１においてＣＰＵ４１は、前記Ｓ３で設定された目標走行軌道上に所定間隔で仮目標位置を設定する。仮目標位置は制御目標地点の候補となる点である。仮目標位置を狭い間隔でより多数設定すればより最適な制御目標地点を選択することが可能であるが、一方でＣＰＵ４１の処理負担は増加する。仮目標位置を設定する間隔は例えば１ｍとする。尚、目標走行軌道の全軌道に対して仮目標位置を設定しても良いし、車両の現在位置周辺の目標走行軌道のみに対して仮目標位置を設定しても良い。
　次に、Ｓ２２においてＣＰＵ４１は、車両において現在実施されている自動運転支援の支援内容を取得する。尚、本実施形態では、上述したように右左折、合流、分岐等の特殊な状況下を除いて基本的に『車線維持走行支援』と『車線変更支援』のいずれかの自動運転支援を行う。
　また、Ｓ２３においてＣＰＵ４１は、ＲＡＭ４２に格納された直近の除外範囲距離を示すパラメータＸｔ－１を読み出す。尚、直近の除外範囲距離を示すパラメータＸｔ－１は、前記Ｓ１３又は後述のＳ３１で設定される。
　続いて、Ｓ２４においてＣＰＵ４１は、前記Ｓ２２の取得結果に基づいて車両において現在実施されている自動運転支援の支援内容が、『車線維持走行支援』と『車線変更支援』のいずれかであるか判定する。
　そして、車両において現在実施されている自動運転支援の支援内容が『車線維持走行支援』であると判定された場合（Ｓ２４：ＹＥＳ）には、Ｓ２５へと移行する。一方、車両において現在実施されている自動運転支援の支援内容が『車線変更支援』であると判定された場合（Ｓ２４：ＮＯ）には、Ｓ２８へと移行する。
　Ｓ２５においてＣＰＵ４１は、前記Ｓ２３で取得された直近の除外範囲距離Ｘｔ－１が５ｍより大きいか否かを判定する。尚、直近の除外範囲距離Ｘｔ－１は、今回の制御軌道を生成するに際して過去に実施された制御目標地点設定処理（Ｓ１４）の内、特に直近に実施された制御目標地点設定処理（Ｓ１４）で設定された除外範囲距離を示す値である。但し、走行時刻ｔが０の場合、即ち今回の制御軌道を生成するに際して最初に制御目標地点設定処理が実行された場合には、前回の制御軌道を生成する際に設定された除外範囲距離を示す値となる（Ｓ７、Ｓ１３）。また、除外範囲距離は、後述のように仮目標位置から制御目標地点を選択するに際して、制御目標地点の選択対象から除外する範囲（以下、除外範囲という）の大きさを定義する距離であり、具体的には軌道生成開始点を中心とした除外範囲距離内の範囲を除外範囲とする。
　そして、直近の除外範囲距離Ｘｔ－１が５ｍより大きいと判定された場合（Ｓ２５：ＹＥＳ）には、Ｓ２７へと移行する。それに対して、直近の除外範囲距離Ｘｔ－１が５ｍ以下であると判定された場合（Ｓ２５：ＮＯ）には、Ｓ２６へと移行する。
　Ｓ２６においてＣＰＵ４１は、今回の除外範囲距離Ｘｔを５ｍに設定する。その後、Ｓ３１へと移行する。
　Ｓ２７においてＣＰＵ４１は、今回の除外範囲距離Ｘｔを『Ｘｔ－１－１ｍ』と『５ｍ』の内、大きい方の値とする。その後、Ｓ３１へと移行する。
　一方、Ｓ２８においてＣＰＵ４１は、前記Ｓ２３で取得された直近の除外範囲距離Ｘｔ－１が１０ｍより大きいか否かを判定する。
　そして、直近の除外範囲距離Ｘｔ－１が１０ｍより大きいと判定された場合（Ｓ２８：ＹＥＳ）には、Ｓ３０へと移行する。それに対して、直近の除外範囲距離Ｘｔ－１が１０ｍ以下であると判定された場合（Ｓ２８：ＮＯ）には、Ｓ２９へと移行する。
　Ｓ２９においてＣＰＵ４１は、今回の除外範囲距離Ｘｔを２０ｍに設定する。その後、Ｓ３１へと移行する。
　一方、Ｓ３０においてＣＰＵ４１は、今回の除外範囲距離Ｘｔを『Ｘｔ－１－１ｍ』と『１０ｍ』の内、大きい方の値とする。その後、Ｓ３１へと移行する。
　上記Ｓ２６、Ｓ２７、Ｓ２９、Ｓ３０の処理を実行することによって、複数の仮目標位置から制御目標地点を選択するに際して、制御目標地点の選択対象から除外する範囲である除外範囲が設定される。尚、除外範囲を広く設定すると、車両の現在位置が目標走行軌道から外れていた場合には軌道の修正に時間がかかるが、より緩やかで車両方位の変化の少ない旋回を描く制御軌道となる。一方で、除外範囲を狭く設定すると、車両の現在位置が目標走行軌道から外れていた場合に短時間で軌道の修正が可能となるが、急な旋回を描く制御軌道になり易い。
　ここで、車両において『車線維持走行支援』が行われている場合には、図１０に示すように基本的に狭い除外範囲６１（例えば軌道生成開始点５１を中心とした５ｍ内）が設定される（Ｓ２６）。車両において『車線維持走行支援』が行われている場合には、比較的機敏に走行位置を修正できた方が、車線中央からずれることが少なくなり、ふらつきを抑えることができる。従って、『車線維持走行支援』が行われている場合においては、制御目標地点を比較的近い位置に設定した方が優位になることが多い。従って、基本的に狭い除外範囲６１を設定する。
　但し、車両において『車線維持走行支援』が行われている場合であっても、前回の走行時刻ｔにおける処理で除外範囲が広く（例えば除外範囲距離＞５ｍ）設定されていた場合については、狭い除外範囲に一度に切り替えるのではなく、複数段階で徐々に除外範囲を狭く切り替える（Ｓ２７）。具体的には、走行時刻ｔが１００ｍｓ加算される毎に除外範囲距離を１ｍずつ短くする（但し最小は５ｍとする）。ここで、制御目標地点を軌道生成開始点５１の遠方から近傍へと急に変化させると、生成される制御軌道の旋回半径が急に小さく（横加速度が急に大きく）なる虞がある。本実施形態では、除外範囲を狭くする場合には段階的に狭くすることによって上記問題を解消することが可能となる。尚、逆に除外範囲を広くする場合においては上記問題が生じないので複数段階で広げるのではなく１段階で広げても良い。
　一方、車両において『車線変更支援』が行われている場合には、初期段階では図１１に示すように基本的に広い除外範囲（例えば軌道生成開始点５１を中心とした２０ｍ内）が設定される（Ｓ２９）。その後、『車線変更支援』を継続するにあたって走行時刻ｔが１００ｍｓ加算される毎に除外範囲距離を１ｍずつ短くする（Ｓ３０、但し最小は１０ｍとする）。ここで、車両において『車線変更支援』が行われている場合には、急いで車線変更する必要がある場合を除いて、比較的緩やかに走行位置を変化させ、車線に対して車体の角度をつけすぎずに移動することが好ましい。従って、『車線変更支援』が行われている場合においては、制御目標地点を比較的遠い位置に設定した方が優位になることが多い。そこで、『車線維持走行支援』よりも広い除外範囲６１を設定する。特に、車線変更の制御開始時は除外範囲を広くすることによって、よりスムーズな車線変更制御が可能となる。尚、除外範囲を初期段階から狭くする場合には、『車線維持走行支援』が行われている場合と同様に段階的に狭くすることによって生成される制御軌道の旋回半径が急に小さく（横加速度が急に大きく）ことを防止する。
　ここで、図１２は走行時刻ｔの変位に伴う除外範囲の具体的な設定例を示した図である。尚、図１２では、走行時刻ｔが０（現在時刻）～１００ｍｓの間において自動運転支援として『車線維持走行支援』が実施され、走行時刻ｔが２００ｍｓ～１４００ｍｓの間において『車線変更支援』が実施され、走行時刻ｔが１５００ｍｓ以降において再び『車線維持走行支援』が実施される場合を例に挙げて説明する。
　図１２に示すように先ず自動運転支援の内容が『車線維持走行支援』が行われている走行時刻ｔが０（現在時刻）～１００ｍｓの間においては、除外範囲距離が５ｍとなり、軌道生成開始点５１を中心とした５ｍ内が除外範囲として設定される（Ｓ２６）。その後に、走行時刻ｔが２００ｍｓのタイミングで自動運転支援の内容が『車線維持走行支援』から『車線変更制御』へと切り替わると、除外範囲距離は５ｍから２０ｍへと１段階で切り替わり、軌道生成開始点５１を中心とした２０ｍ内が除外範囲として設定される（Ｓ２９）。そして、走行時刻ｔが２００ｍｓ～１４００ｍｓの間においては『車線変更支援』が継続して実施されるので、除外範囲距離が２０ｍから徐々に短くなり、除外範囲も徐々に狭くなる（Ｓ３０）。但し、下限は除外範囲距離が１０ｍであるので、除外範囲距離が１０ｍに到達した後はそれ以上短くすることなく維持される。また、走行時刻ｔが１５００ｍｓのタイミングで自動運転支援の内容が『車線変更制御』から『車線維持走行支援』へと切り替わると、その後は除外範囲距離が１０ｍから５ｍへと複数段階で段階的に切り替わる。具体的には、走行時刻ｔが１００ｍｓ加算される毎に除外範囲距離を１ｍずつ短くする。それに伴って除外範囲も徐々に狭くなる（Ｓ２７）。そして、除外範囲距離が５ｍに到達した後はそれ以上短くすることなく維持される。
　その後、Ｓ３１においてＣＰＵ４１は、ＲＡＭ４２に格納された直近の除外範囲距離を示すパラメータＸｔ－１を読み出し、前記Ｓ２６、Ｓ２７、Ｓ２９、Ｓ３０のいずれかで設定された今回の除外範囲距離Ｘｔを代入（更新）する。
　そして、以下のＳ３２及びＳ３３の処理は、前記Ｓ２１で設定された仮目標位置の内、制御目標地点の候補となる仮目標位置を対象に、軌道生成開始点から近い順に仮目標位置毎に実行する。尚、制御目標地点の候補となる仮目標位置は、前記Ｓ２６、Ｓ２７、Ｓ２９、Ｓ３０で設定された除外範囲の外にあって、且つ軌道生成開始点５１から所定距離以内（例えば３００ｍ以内）にある仮目標位置とする。例えば、図１３に示す例では、目標走行軌道５０に対して仮目標位置６２が所定間隔（例えば１ｍ間隔）で設定されているが、軌道生成開始点５１から今回の除外範囲距離Ｘｔ以内の除外範囲６１内にある仮目標位置６２については制御目標地点の候補から除かれる。そして、除外範囲６１外にある仮目標位置６２の内、最も軌道生成開始点５１に近い地点Ｐ１を対象に先ずＳ３２及びＳ３３の処理が行われる。その後、Ｐ２、Ｐ３、・・・の順にＳ３２及びＳ３３の処理が行われる。
　先ず、Ｓ３２においてＣＰＵ４１は、軌道生成開始点から処理対象の仮目標位置へと到達する軌道（以下、到達軌道という）を生成する。具体的には軌道生成開始点から処理対象の仮目標位置までを、最も旋回半径が大きくなるように繋いだ軌道を到達軌道として生成する。更に、前記Ｓ３２においてＣＰＵ４１は、生成した到達軌道に含まれる旋回の内、最小の旋回半径を算出する。即ち、前記Ｓ３２では軌道生成開始点から処理対象の仮目標位置へと到達するのに必要な最小の旋回半径が算出される。尚、軌道生成開始点は現時点の走行時刻ｔ（現在時刻からｔ時間後）において予測される車両の位置であり、前記Ｓ１７で特定される。特に走行時刻ｔが初期値である０の場合は、軌道生成開始点は車両の現在位置となる。
　次に、Ｓ３３においてＣＰＵ４１は、前記Ｓ３２で算出された旋回半径が閾値以上であるか否かを判定する。尚、閾値は、走行する車両の自動運転支援に係る走行制御を適切に行うことができ、且つ走行中の車両の乗員に負担が生じない条件を満たす最小の旋回半径とする。例えば、横加速度が０．２Ｇ以下であることを条件とすると、閾値は以下の式（１）により算出される。
　　　　閾値＝車速２／（０．２Ｇ×９．８０６６５）・・・・（１）
　そして、前記Ｓ３２で算出された旋回半径が閾値以上であると判定された場合（Ｓ３３：ＹＥＳ）には、Ｓ３４へと移行する。そして、Ｓ３４においてＣＰＵ４１は、処理対象の仮目標位置を制御目標地点に設定する。即ち、除外範囲の外で軌道生成開始点から近い位置にある仮目標位置を優先して制御目標位置に設定することとなる。但し、車両の進行方向前方に障害物がある場合には、障害物と重複する到達軌道となる仮目標位置は、制御目標地点の対象から除外するのが望ましい。尚、障害物に関する情報は障害物情報ＤＢ３２から取得する。
　一方、前記Ｓ３２で算出された旋回半径が閾値未満であると判定された場合（Ｓ３３：ＮＯ）には、処理対象となる仮目標位置を次に軌道生成開始点に近い他の仮目標位置へと切り替えた後にＳ３２の処理を再度実行する。そして、処理対象となる全ての仮目標位置を対象として前記Ｓ３２及びＳ３３の処理を実行した結果、旋回半径が閾値以上となる仮目標位置が存在しない場合には、Ｓ３５へと移行する。
　Ｓ３５においてＣＰＵ４１は、処理対象の仮目標位置の内、前記Ｓ３２で算出された旋回半径の最も大きい仮目標位置を制御目標地点に設定する。尚、対象が複数ある場合には該当する複数の仮目標位置の内、最も軌道生成開始点に近い仮目標位置を制御目標地点に設定する。
　上記Ｓ３２～Ｓ３５の処理を行った結果、図１４に示すように目標走行軌道５０に対して仮目標位置６２が所定間隔で設定されている場合には、除外範囲６１外にある仮目標位置６２の内、最も軌道生成開始点５１に近い地点Ｐ１を対象に地点Ｐ１に到達する到達軌道Ｌ１が生成され、旋回半径が閾値以上か否か判定される。そして、到達軌道Ｌ１の旋回半径が閾値未満である場合には、次に軌道生成開始点５１に近い地点Ｐ２を対象に地点Ｐ２に到達する到達軌道Ｌ２が生成され、旋回半径が閾値以上か否か判定される。更に、到達軌道Ｌ２の旋回半径が閾値未満である場合には、次に軌道生成開始点５１に近い地点Ｐ３を対象に地点Ｐ３に到達する到達軌道Ｌ３が生成され、旋回半径が閾値以上か否か判定される。以下同様にして、軌道生成開始点５１に近い順に各地点へ到達する到達軌道の旋回半径が閾値以上であるか否か判定される。そして、旋回半径が閾値以上であって、軌道生成開始点５１に最も近い仮目標位置６２を制御目標地点に設定する。一方、旋回半径が閾値以上となる仮目標位置６２が存在しない場合には、除外範囲６１外にある仮目標位置６２の内、最も旋回半径の大きい仮目標位置６２を制御目標地点に設定する。
　以上詳細に説明した通り、本実施形態に係るナビゲーション装置１及びナビゲーション装置１で実行されるコンピュータプログラムでは、車両が走行する道路に対して目標とする走行軌道である目標走行軌道５０を設定し（Ｓ３）、目標走行軌道５０上であって軌道生成開始点５１から車両において実施されている自動運転支援の支援内容に基づく距離だけ進行方向前方の位置に、制御目標地点５２を設定し（Ｓ１４）、軌道生成開始点５１から制御目標地点５２へと走行する軌道を用いて、車両に走行させる制御軌道６０を生成する（Ｓ２０）ので、自動運転支援による車両の走行が行われている場合において、自動運転支援の支援内容に応じた形状を有する制御軌道を生成することが可能となる。従って、例えば急旋回による走行が不適な自動運転支援が行われている状態には、旋回半径の小さい制御軌道が生成されることを防止できる。また、車体の角度が頻繁に変位することが不適な自動運転支援が行われている状態には、頻繁な車両方位の変化を招く制御軌道が生成されることを防止できる。その結果、自動運転支援を適切に継続して実施することが可能となる。
　尚、本発明は前記実施形態に限定されるものではなく、本発明の要旨を逸脱しない範囲内で種々の改良、変形が可能であることは勿論である。
　例えば、本実施形態では、車両に対して行われる自動運転支援として特に『車線維持走行支援』と『車線変更支援』を例に挙げて説明しているが、それ以外の自動運転支援が行われる場合においても実施可能である。例えば、前方車両との車間距離を一定距離（例えば１０ｍ）に保つ制御、一定速度（例えば制限速度の８０％）で走行する制御を行う自動運転支援がある。それらの支援内容に応じて除外範囲距離を適宜設定することにより、自動運転支援の支援内容に応じた形状を有する制御軌道を生成することが可能となる。
　また、本実施形態では、『車線維持走行支援』が行われている場合には除外範囲距離を基本的に５ｍに設定し、『車線変更支援』が行われている場合には除外範囲距離を基本的に１０ｍ～２０ｍに設定しているが、その距離は適宜変更可能である。例えば、障害物が近くにある場合には除外範囲距離をより短い距離（例えば２．５ｍ）に設定しても良い。
　また、本実施形態では、『車線変更支援』が継続して実施される場合において除外範囲距離を時間経過に伴って徐々に短く設定しているが、『車線維持走行支援』が継続して実施される場合においても同様に除外範囲距離を時間経過に伴って徐々に短く設定しても良い。更に、『車線変更支援』が継続して実施された場合であっても、除外範囲距離を短くすることなく固定の距離としても良い。
　また、本実施形態では、車両の操作のうち、車両の挙動に関する操作である、アクセル操作、ブレーキ操作及びハンドル操作の全てを車両制御ＥＣＵ２０が制御することをユーザの運転操作によらずに自動的に走行を行う為の自動運転支援として説明してきた。しかし、自動運転支援を、車両の操作のうち、車両の挙動に関する操作である、アクセル操作、ブレーキ操作及びハンドル操作の少なくとも一の操作を車両制御ＥＣＵ２０が制御することとしても良い。一方、ユーザの運転操作による手動運転とは車両の操作のうち、車両の挙動に関する操作である、アクセル操作、ブレーキ操作及びハンドル操作の全てをユーザが行うこととして説明する。
　また、本実施形態では、自動運転支援プログラム（図２）をナビゲーション装置１が実行する構成としているが、車両制御ＥＣＵ２０が実行する構成としても良い。その場合には、車両制御ＥＣＵ２０は車両の現在位置や地図情報等をナビゲーション装置１から取得する構成とする。
　また、本発明はナビゲーション装置以外に、経路探索機能を有する装置に対して適用することが可能である。例えば、携帯電話機、スマートフォン、タブレット端末、パーソナルコンピュータ等（以下、携帯端末等という）に適用することも可能である。また、サーバと携帯端末等から構成されるシステムに対しても適用することが可能となる。その場合には、上述した自動運転支援プログラム（図２参照）の各ステップは、サーバと携帯端末等のいずれが実施する構成としても良い。但し、本発明を携帯端末等に適用する場合には、自動運転支援が実行可能な車両と携帯端末等が通信可能に接続（有線無線は問わない）される必要がある。
　また、本発明に係る自動運転支援装置を具体化した実施例について上記に説明したが、自動運転支援装置は以下の構成を有することも可能であり、その場合には以下の効果を奏する。
　例えば、第１の構成は以下のとおりである。
　車両において実施する自動運転支援に用いる支援情報を生成する自動運転支援装置（１）であって、車両が走行する道路に対して目標とする走行軌道である目標走行軌道（５０）を設定する走行軌道設定手段（４１）と、前記目標走行軌道上であって軌道生成開始点（５１）から車両において実施されている自動運転支援の支援内容に基づく距離だけ進行方向前方の位置に、制御目標地点（５２）を設定する制御目標地点設定手段（４１）と、前記軌道生成開始点から前記制御目標地点へと走行する軌道を用いて、車両に走行させる制御軌道（６０）を生成する制御軌道生成手段（４１）と、を有する。
　上記構成を有する自動運転支援装置によれば、自動運転支援による車両の走行が行われている場合において、自動運転支援の支援内容に応じた形状を有する制御軌道を生成することが可能となる。従って、例えば急旋回による走行が不適な自動運転支援が行われている状態には、旋回半径の小さい制御軌道が生成されることを防止できる。また、車体の角度が頻繁に変位することが不適な自動運転支援が行われている状態には、頻繁な車両方位の変化を招く制御軌道が生成されることを防止できる。その結果、自動運転支援を適切に継続して実施することが可能となる。
　また、第２の構成は以下のとおりである。
　前記軌道生成開始点（５１）は、車両の現在位置又は前記軌道生成開始点から前記制御目標地点（５２）へと走行する軌道に沿って走行すると仮定した所定時間後の車両の予測位置である。
　上記構成を有する自動運転支援装置によれば、車両の現在位置に加えて所定時間後の車両位置を開始点としてそれぞれ目標走行軌道へと向かう軌道を生成し、生成した各軌道から最終的な制御軌道を生成するので、時間経過に伴う車両の位置と目標走行軌道の位置関係を用いて目標走行軌道に沿って走行させる為のより適切な制御軌道を生成することが可能となる。
　また、第３の構成は以下のとおりである。
　前記制御軌道生成手段（４１）は、車両の現在位置及び前記軌道生成開始点（５１）から前記制御目標地点へと走行する軌道に沿って走行すると仮定した所定時間後の車両の予測位置を繋いだ軌道を前記制御軌道として生成する。
　上記構成を有する自動運転支援装置によれば、車両の現在位置と所定時間後の車両位置とを開始点としてそれぞれ目標走行軌道へと向かう軌道を生成し、生成した各軌道を繋げて最終的な制御軌道を生成するので、時間経過に伴う車両の位置と目標走行軌道の位置関係を用いて目標走行軌道に沿って走行させる為の適切な制御軌道を生成することが可能となる。
　また、第４の構成は以下のとおりである。
　前記軌道生成開始点（５１）から車両において実施する自動運転支援の内容に基づいて設定された除外範囲距離内の範囲を除外範囲（６１）として設定する除外範囲設定手段（４１）を有し、前記制御目標地点設定手段（４１）は、前記除外範囲の外で前記軌道生成開始点（５１）から近い位置を優先して前記制御目標地点（５２）を設定する。
　上記構成を有する自動運転支援装置によれば、制御目標地点が軌道生成開始点に対して一定距離以上離れた位置に設定されるので、制御のハンチングが生じることを防止できる。例えば、制御目標地点を軌道生成開始点に対して接近して設定すると、生成される制御軌道と実施される車両制御との間でズレが生じる虞があるが、そのような問題を解消できる。また、制御のハンチングが生じることを防止する範囲でできる限り軌道生成開始点から近い位置に制御目標地点を設定するので、できる限り目標走行軌道に沿った制御軌道を生成することが可能となる。
　また、第５の構成は以下のとおりである。
　前記制御目標地点設定手段（４１）は、前記軌道生成開始点（５１）から前記制御目標地点（５２）へと到達する軌道の最小の旋回半径が閾値以上となることを条件として前記制御目標地点を設定する。
　上記構成を有する自動運転支援装置によれば、走行する車両の自動運転支援に係る走行制御を適切に行うことができ、且つ走行中の車両の乗員に負担が生じない制御軌道を生成することが可能となる。
　また、第６の構成は以下のとおりである。
　前記除外範囲設定手段（４１）は、車両において実施する自動運転支援の内容が第１支援から第２支援へと切り替わった場合に、前記第１支援に対応した第１距離から前記第２支援に対応した第２距離へと前記除外範囲距離を複数段階で段階的に切り替える。
　上記構成を有する自動運転支援装置によれば、車両において実施する自動運転支援の内容が切り替わった場合に、生成される制御軌道の旋回半径が急に変化することを防止することが可能となる。
　また、第７の構成は以下のとおりである。
　前記除外範囲設定手段（４１）は、前記第１距離が前記第２距離よりも長い場合には、前記第１距離から前記第２距離へと前記除外範囲距離を複数段階で段階的に切り替え、前記第２距離が前記第１距離よりも短い場合には、前記第１距離から前記第２距離へと前記除外範囲距離を１段階で切り替える。
　上記構成を有する自動運転支援装置によれば、車両において実施する自動運転支援の内容が切り替わった場合に、生成される制御軌道の旋回半径が急に小さくなる（即ち横加速度が急に大きく）ことを防止することが可能となる。一方で、生成される制御軌道の旋回半径が大きくなることは許容することによって、切り替わった後の自動運転支援の支援内容に応じた形状を有する制御軌道を迅速に生成することが可能となる。
　また、第８の構成は以下のとおりである。
　前記除外範囲設定手段（４１）は、車両において同一の自動運転支援が継続して行われる場合において、前記除外範囲距離を徐々に短くする。
　上記構成を有する自動運転支援装置によれば、車線変更制御を行う場合に、最初は比較的緩やかに走行位置を変化させ、徐々に制御量を大きくするので、よりスムーズな車線変更制御が可能となる。
　また、第９の構成は以下のとおりである。
　車両において実施する自動運転支援は、同一の車線を維持して走行する車線維持走行支援と、異なる車線へと車線変更する為の車線変更支援とがあって、前記車線変更支援は前記車線維持走行支援よりも前記除外範囲距離が長く設定される。
　上記構成を有する自動運転支援装置によれば、車両において車線維持走行支援が行われている場合には制御目標地点を近い位置に設定することによって、機敏に走行位置を修正し、車線中央からずれやふらつきを抑えることができる。一方、車両において車線変更支援が行われている場合には制御目標地点を遠い位置に設定することによって、比較的緩やかに走行位置を変化させ、車線に対して車体の角度をつけすぎずに移動させる制御軌道を生成することが可能となる。
　　１　　　　　　　　ナビゲーション装置
　　１３　　　　　　　ナビゲーションＥＣＵ
　　４１　　　　　　　ＣＰＵ
　　４２　　　　　　　ＲＡＭ
　　４３　　　　　　　ＲＯＭ
　　５０　　　　　　　目標走行軌道
　　５１　　　　　　　軌道生成開始点
　　５２　　　　　　　制御目標地点
　　５３　　　　　　　走行軌道
　　６０　　　　　　　制御軌道
　　６１　　　　　　　除外範囲
　　６２　　　　　　　仮目標位置

Claims (10)

  1. 　車両において実施する自動運転支援に用いる支援情報を生成する自動運転支援装置であって、
    　車両が走行する道路に対して目標とする走行軌道である目標走行軌道を設定する走行軌道設定手段と、
    　前記目標走行軌道上であって軌道生成開始点に対して車両において実施されている自動運転支援の支援内容に基づく進行方向前方の位置に、制御目標地点を設定する制御目標地点設定手段と、
    　前記軌道生成開始点から前記制御目標地点へと走行する軌道を用いて、車両に走行させる制御軌道を生成する制御軌道生成手段と、を有する自動運転支援装置。
  2. 　前記軌道生成開始点は、車両の現在位置又は前記軌道生成開始点から前記制御目標地点へと走行する軌道に沿って走行すると仮定した所定時間後の車両の予測位置である請求項１に記載の自動運転支援装置。
  3. 　前記制御軌道生成手段は、車両の現在位置及び前記軌道生成開始点から前記制御目標地点へと走行する軌道に沿って走行すると仮定した所定時間後の車両の予測位置を繋いだ軌道を前記制御軌道として生成する請求項１又は請求項２に記載の自動運転支援装置。
  4. 　前記軌道生成開始点から車両において実施する自動運転支援の内容に基づいて設定された除外範囲距離内の範囲を除外範囲として設定する除外範囲設定手段を有し、
    　前記制御目標地点設定手段は、前記除外範囲の外で前記軌道生成開始点から近い位置を優先して前記制御目標地点を設定する請求項１乃至請求項３のいずれかに記載の自動運転支援装置。
  5. 　車両において実施する自動運転支援は、同一の車線を維持して走行する車線維持走行支援と、異なる車線へと車線変更する為の車線変更支援とがあって、
    　前記車線変更支援は前記車線維持走行支援よりも前記除外範囲距離が長く設定される請求項４に記載の自動運転支援装置。
  6. 　前記制御目標地点設定手段は、前記軌道生成開始点から前記制御目標地点へと到達する軌道の最小の旋回半径が閾値以上となることを条件として前記制御目標地点を設定する請求項４又は請求項５に記載の自動運転支援装置。
  7. 　前記除外範囲設定手段は、車両において実施する自動運転支援の内容が第１支援から第２支援へと切り替わった場合に、前記第１支援に対応した第１距離から前記第２支援に対応した第２距離へと前記除外範囲距離を複数段階で段階的に切り替える請求項４乃至請求項６のいずれかに記載の自動運転支援装置。
  8. 　前記除外範囲設定手段は、
    　　　前記第１距離が前記第２距離よりも長い場合には、前記第１距離から前記第２距離へと前記除外範囲距離を複数段階で段階的に切り替え、
    　　　前記第２距離が前記第１距離よりも短い場合には、前記第１距離から前記第２距離へと前記除外範囲距離を１段階で切り替える請求項７に記載の自動運転支援装置。
  9. 　前記除外範囲設定手段は、車両において同一の自動運転支援が継続して行われる場合において、前記除外範囲距離を徐々に短くする請求項４乃至請求項８のいずれかに記載の自動運転支援装置。
  10. 　車両において実施する自動運転支援に用いる支援情報を生成するコンピュータプログラムであって、
    　コンピュータを、
    　　　車両が走行する道路に対して目標とする走行軌道である目標走行軌道を設定する走行軌道設定手段と、
    　　　前記目標走行軌道上であって軌道生成開始点に対して車両において実施されている自動運転支援の支援内容に基づく進行方向前方の位置に、制御目標地点を設定する制御目標地点設定手段と、
    　　　前記軌道生成開始点から前記制御目標地点へと走行する軌道を用いて、車両に走行させる制御軌道を生成する制御軌道生成手段と、
    して機能させる為のコンピュータプログラム。
PCT/JP2017/018516 2016-05-20 2017-05-17 自動運転支援装置及びコンピュータプログラム Ceased WO2017200003A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN201780028514.XA CN109070886B (zh) 2016-05-20 2017-05-17 自动驾驶支援装置以及存储介质
DE112017001438.7T DE112017001438B8 (de) 2016-05-20 2017-05-17 Autonome Fahrunterstützungsvorrichtung und Computerprogramm
US16/095,582 US10858012B2 (en) 2016-05-20 2017-05-17 Autonomous driving assistance device and computer program

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2016101234A JP6614025B2 (ja) 2016-05-20 2016-05-20 自動運転支援装置及びコンピュータプログラム
JP2016-101234 2016-05-20

Publications (1)

Publication Number Publication Date
WO2017200003A1 true WO2017200003A1 (ja) 2017-11-23

Family

ID=60325417

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2017/018516 Ceased WO2017200003A1 (ja) 2016-05-20 2017-05-17 自動運転支援装置及びコンピュータプログラム

Country Status (5)

Country Link
US (1) US10858012B2 (ja)
JP (1) JP6614025B2 (ja)
CN (1) CN109070886B (ja)
DE (1) DE112017001438B8 (ja)
WO (1) WO2017200003A1 (ja)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109976341A (zh) * 2019-03-21 2019-07-05 驭势科技（北京）有限公司 一种自动驾驶车辆附着路网的方法、车载设备及存储介质
US20190235516A1 (en) * 2018-01-26 2019-08-01 Baidu Usa Llc Path and speed optimization fallback mechanism for autonomous vehicles
US11097747B2 (en) * 2018-03-27 2021-08-24 Nissan Motor Co., Ltd. Method and device for controlling autonomously driven vehicle
US11104336B2 (en) * 2018-11-15 2021-08-31 Automotive Research & Testing Center Method for planning a trajectory for a self-driving vehicle
CN113602270A (zh) * 2021-08-16 2021-11-05 广州小鹏汽车科技有限公司 交通工具的控制方法、控制装置、交通工具及存储介质

Families Citing this family (24)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
BR112019004582B1 (pt) * 2016-09-09 2023-12-26 Nissan Motor Co., Ltd Método e aparelho de controle de deslocamento para um veículo
JP6873259B2 (ja) * 2017-09-29 2021-05-19 日立Astemo株式会社 自動運転制御装置及び方法
JP7081117B2 (ja) * 2017-11-06 2022-06-07 いすゞ自動車株式会社 操舵制御装置及び操舵制御方法
US10816990B2 (en) * 2017-12-21 2020-10-27 Baidu Usa Llc Non-blocking boundary for autonomous vehicle planning
US10816985B2 (en) * 2018-04-17 2020-10-27 Baidu Usa Llc Method on moving obstacle representation for trajectory planning
TWI726274B (zh) * 2019-01-19 2021-05-01 宏碁股份有限公司 影像感測系統及其調控方法
US11106212B2 (en) * 2019-03-26 2021-08-31 Baidu Usa Llc Path planning for complex scenes with self-adjusting path length for autonomous driving vehicles
JP7310272B2 (ja) * 2019-04-25 2023-07-19 株式会社アドヴィックス 車両の制御装置
JP7427869B2 (ja) 2019-04-25 2024-02-06 株式会社アドヴィックス 車両の制御装置
KR102715606B1 (ko) * 2019-06-11 2024-10-11 주식회사 에이치엘클레무브 운전자 보조 시스템, 그를 가지는 차량 및 그 제어 방법
CN110502012A (zh) * 2019-08-20 2019-11-26 武汉中海庭数据技术有限公司 一种他车轨迹预测方法、装置及存储介质
DE102019123900B3 (de) * 2019-09-05 2020-11-12 Dr. Ing. H.C. F. Porsche Aktiengesellschaft Verfahren für optimiertes autonomes Fahren eines Fahrzeugs
US11292470B2 (en) * 2020-01-06 2022-04-05 GM Global Technology Operations LLC System method to establish a lane-change maneuver
JP7226357B2 (ja) * 2020-02-05 2023-02-21 トヨタ自動車株式会社 走行経路の設定装置および設定方法
JP7406432B2 (ja) * 2020-03-31 2023-12-27 本田技研工業株式会社 移動体制御装置、移動体制御方法、およびプログラム
US11807240B2 (en) * 2020-06-26 2023-11-07 Toyota Research Institute, Inc. Methods and systems for evaluating vehicle behavior
JP7302582B2 (ja) * 2020-12-04 2023-07-04 トヨタ自動車株式会社 車両制御システム
CN112874524B (zh) * 2021-01-11 2022-08-23 广东科学技术职业学院 一种行驶车辆的方法、装置以及无人驾驶车辆
JP7567758B2 (ja) * 2021-03-30 2024-10-16 株式会社デンソー 自動運転制御装置、及び自動運転制御プログラム
US12148174B2 (en) * 2021-11-19 2024-11-19 Shenzhen Deeproute.Ai Co., Ltd Method for forecasting motion trajectory, storage medium, and computer device
JP2024072646A (ja) 2022-11-16 2024-05-28 株式会社ジェイテクト 操舵制御装置
WO2024253002A1 (ja) * 2023-06-06 2024-12-12 株式会社デンソー 自動駐車システム
JP2025006866A (ja) * 2023-06-30 2025-01-17 株式会社日立製作所 自律制御システムおよび自律制御方法
CN119428645B (zh) * 2023-08-03 2025-11-21 芜湖伯特利智能驾驶有限公司 基于视觉的eba减速度请求方法、系统及汽车

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001141467A (ja) * 1999-11-15 2001-05-25 Equos Research Co Ltd データベース修正装置及びデータベース修正方法
JP2009040267A (ja) * 2007-08-09 2009-02-26 Toyota Motor Corp 走行制御装置
JP2014218098A (ja) * 2013-05-01 2014-11-20 トヨタ自動車株式会社 運転支援装置および運転支援方法

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3104559B2 (ja) * 1995-02-08 2000-10-30 トヨタ自動車株式会社 車載用レーダ装置
JPH112067A (ja) 1997-06-10 1999-01-06 Osaka Shinku Kagaku Kk 引き戸取付補助具及び引き戸取付方法
JP4710976B2 (ja) * 2006-08-07 2011-06-29 トヨタ自動車株式会社 走行制御装置
DE102007061900B4 (de) 2007-12-20 2022-07-07 Volkswagen Ag Spurhalteassistenzsystem und -verfahren für ein Kraftfahrzeug
US8812226B2 (en) * 2009-01-26 2014-08-19 GM Global Technology Operations LLC Multiobject fusion module for collision preparation system
CN103858155B (zh) * 2011-09-26 2017-10-03 丰田自动车株式会社 车辆的驾驶支援系统
JP2013112068A (ja) 2011-11-25 2013-06-10 Toyota Motor Corp 走行進路生成装置および走行制御装置
JP5780133B2 (ja) 2011-11-25 2015-09-16 トヨタ自動車株式会社 走行進路生成装置および走行制御装置
DE102013017212A1 (de) 2013-10-16 2015-04-16 Audi Ag Kraftfahrzeug und Verfahren zur Steuerung eines Kraftfahrzeugs
CN105197010B (zh) * 2014-06-04 2018-03-27 长春孔辉汽车科技股份有限公司 辅助泊车系统以及辅助泊车控制方法
US9428187B2 (en) 2014-06-05 2016-08-30 GM Global Technology Operations LLC Lane change path planning algorithm for autonomous driving vehicle
JP6822365B2 (ja) * 2017-09-28 2021-01-27 トヨタ自動車株式会社 車両運転支援装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001141467A (ja) * 1999-11-15 2001-05-25 Equos Research Co Ltd データベース修正装置及びデータベース修正方法
JP2009040267A (ja) * 2007-08-09 2009-02-26 Toyota Motor Corp 走行制御装置
JP2014218098A (ja) * 2013-05-01 2014-11-20 トヨタ自動車株式会社 運転支援装置および運転支援方法

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20190235516A1 (en) * 2018-01-26 2019-08-01 Baidu Usa Llc Path and speed optimization fallback mechanism for autonomous vehicles
US10816977B2 (en) * 2018-01-26 2020-10-27 Baidu Usa Llc Path and speed optimization fallback mechanism for autonomous vehicles
US11097747B2 (en) * 2018-03-27 2021-08-24 Nissan Motor Co., Ltd. Method and device for controlling autonomously driven vehicle
US11104336B2 (en) * 2018-11-15 2021-08-31 Automotive Research & Testing Center Method for planning a trajectory for a self-driving vehicle
CN109976341A (zh) * 2019-03-21 2019-07-05 驭势科技（北京）有限公司 一种自动驾驶车辆附着路网的方法、车载设备及存储介质
CN113602270A (zh) * 2021-08-16 2021-11-05 广州小鹏汽车科技有限公司 交通工具的控制方法、控制装置、交通工具及存储介质

Also Published As

Publication number Publication date
CN109070886A (zh) 2018-12-21
DE112017001438T5 (de) 2018-12-06
JP6614025B2 (ja) 2019-12-04
DE112017001438B4 (de) 2022-06-30
CN109070886B (zh) 2021-09-21
US20190084579A1 (en) 2019-03-21
JP2017206181A (ja) 2017-11-24
US10858012B2 (en) 2020-12-08
DE112017001438B8 (de) 2022-08-25

Similar Documents

Publication Publication Date Title
JP6614025B2 (ja) 自動運転支援装置及びコンピュータプログラム
JP6638556B2 (ja) 自動運転支援装置及びコンピュータプログラム
JP6558239B2 (ja) 自動運転支援システム、自動運転支援方法及びコンピュータプログラム
JP7347522B2 (ja) 運転支援装置及びコンピュータプログラム
JP6545507B2 (ja) 自動運転支援システム、自動運転支援方法及びコンピュータプログラム
JP6553917B2 (ja) 自動運転支援システム、自動運転支援方法及びコンピュータプログラム
JP6558238B2 (ja) 自動運転支援システム、自動運転支援方法及びコンピュータプログラム
JP6474307B2 (ja) 自動運転支援システム、自動運転支援方法及びコンピュータプログラム
JP6604240B2 (ja) 自動運転支援装置及びコンピュータプログラム
JP6269104B2 (ja) 自動運転支援システム、自動運転支援方法及びコンピュータプログラム
JP7505448B2 (ja) 運転支援装置
JP6689102B2 (ja) 自動運転支援装置及びコンピュータプログラム
JP7405012B2 (ja) 運転支援装置及びコンピュータプログラム
JP7439529B2 (ja) 運転支援装置及びコンピュータプログラム
WO2015129365A1 (ja) 自動運転支援システム、自動運転支援方法及びコンピュータプログラム
WO2016159171A1 (ja) 自動運転支援システム、自動運転支援方法及びコンピュータプログラム
WO2016035485A1 (ja) 自動運転支援システム、自動運転支援方法及びコンピュータプログラム
WO2016159172A1 (ja) 自動運転支援システム、自動運転支援方法及びコンピュータプログラム
JP2017181391A (ja) コスト算出データのデータ構造
JP2015141051A (ja) 自動運転支援システム、自動運転支援方法及びコンピュータプログラム
JP7528450B2 (ja) 運転支援装置及びコンピュータプログラム
JP7683517B2 (ja) 運転支援装置及びコンピュータプログラム
JP6509623B2 (ja) 自動運転支援システム、自動運転支援方法及びコンピュータプログラム
JP2023080504A (ja) 運転支援装置及びコンピュータプログラム
JP7501039B2 (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: 17799427

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 17799427

Country of ref document: EP

Kind code of ref document: A1