WO2023140041A1 - 運転支援装置及びコンピュータプログラム - Google Patents
運転支援装置及びコンピュータプログラム Download PDFInfo
- Publication number
- WO2023140041A1 WO2023140041A1 PCT/JP2022/047398 JP2022047398W WO2023140041A1 WO 2023140041 A1 WO2023140041 A1 WO 2023140041A1 JP 2022047398 W JP2022047398 W JP 2022047398W WO 2023140041 A1 WO2023140041 A1 WO 2023140041A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- vehicle
- parking lot
- trajectory
- condition
- candidate
- 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
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
-
- 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/06—Automatic manoeuvring for parking
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0011—Planning or execution of driving tasks involving control alternatives for a single driving scenario, e.g. planning several paths to avoid obstacles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0025—Planning or execution of driving tasks specially adapted for specific operations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/36—Input/output arrangements for on-board computers
- G01C21/3679—Retrieval, searching and output of POI information, e.g. hotels, restaurants, shops, filling stations, parking facilities
- G01C21/3685—Retrieval, searching and output of POI information, e.g. hotels, restaurants, shops, filling stations, parking facilities the POI's being parking facilities
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/14—Traffic control systems for road vehicles indicating individual free spaces in parking areas
- G08G1/141—Traffic control systems for road vehicles indicating individual free spaces in parking areas with means giving the indication of available parking spaces
- G08G1/143—Traffic control systems for road vehicles indicating individual free spaces in parking areas with means giving the indication of available parking spaces inside the vehicles
-
- G—PHYSICS
- G16—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS
- G16Y—INFORMATION AND COMMUNICATION TECHNOLOGY SPECIALLY ADAPTED FOR THE INTERNET OF THINGS [IoT]
- G16Y10/00—Economic sectors
- G16Y10/40—Transportation
-
- G—PHYSICS
- G16—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS
- G16Y—INFORMATION AND COMMUNICATION TECHNOLOGY SPECIALLY ADAPTED FOR THE INTERNET OF THINGS [IoT]
- G16Y40/00—IoT characterised by the purpose of the information processing
- G16Y40/60—Positioning; Navigation
-
- 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/027—Parking aids, e.g. instruction means
- B62D15/0285—Parking performed automatically
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/14—Traffic control systems for road vehicles indicating individual free spaces in parking areas
- G08G1/145—Traffic control systems for road vehicles indicating individual free spaces in parking areas where the indication depends on the parking areas
- G08G1/146—Traffic control systems for road vehicles indicating individual free spaces in parking areas where the indication depends on the parking areas where the parking area is a limited parking space, e.g. parking garage, restricted space
Definitions
- the present invention relates to a driving support device and a computer program that support driving a vehicle in a parking lot.
- the vehicle When moving to a destination by vehicle, generally, the vehicle is parked in a parking lot attached to the destination or in the vicinity of the destination, and the vehicle is parked in the parking lot.
- the vehicle In the case of assisting movement to such a destination, although the distance traveled by a vehicle in a parking lot is shorter than that on a road, there are many possible trajectory candidates for the vehicle, and it is difficult to select the optimum trajectory from among them.
- Japanese Patent Application Laid-Open No. 2018-39294 discloses that when generating a running track for a vehicle running in a parking lot, a running track running in a narrow aisle is a running track running near the center, while a running track running in a wide aisle is set to a running track that runs in a position biased to either the left or right.
- the traveling trajectory for traveling in a wide aisle is a traveling trajectory that is biased to either the left or right, but compared to the case of traveling near the center, traveling in a position that is biased to either the left or right does not necessarily result in a suitable traveling trajectory.
- Patent Document 1 does not have a means for appropriately evaluating and correcting the once-generated traveling trajectory even when the traveling trajectory that causes such factors is generated.
- the present invention has been made in order to solve the above-mentioned conventional problems, and the object of the present invention is to provide a driving support device and a computer program that make it possible to perform driving support based on a more appropriate traveling trajectory than in the past by evaluating the eligibility as a traveling trajectory of a candidate traveling trajectory once generated when a vehicle travels in a parking lot, and modifying the candidate traveling trajectory once generated according to the evaluation result by changing the generation conditions.
- the first driving support device includes parking lot network acquisition means for acquiring an in-parking network that is a network indicating routes that the vehicle can select in the parking lot when the vehicle is parked in the parking lot; approach trajectory candidate acquisition means for generating and acquiring, based on a first condition, an approach trajectory candidate, which is a candidate for the vehicle's travel trajectory from the entrance of the parking lot to the parking position where the vehicle is parked, using the in-parking network; and the approach trajectory candidate.
- condition determination means for determining whether or not the candidate path satisfies an eligibility condition indicating eligibility as a vehicle travel path
- travel path correction means for, when the condition determination means determines that the path does not satisfy the eligibility condition, correcting the approach path candidate determined not to satisfy the eligibility condition based on a second condition different from the first condition
- driving assistance means for performing driving assistance based on the modified approach path candidate.
- a second driving support device includes parking lot network acquisition means for acquiring a parking lot network, which is a network showing routes that the vehicle can select in the parking lot when exiting the parking lot; exiting trajectory candidate acquisition means for generating and acquiring, based on a first condition, exit trajectory candidates, which are candidates for the vehicle's running trajectory from the parking position where the vehicle is parked to an exit of the parking lot, using the parking lot network; running track correction means for correcting the exiting track candidate determined not to satisfy the qualifying condition based on a second condition different from the first condition when the condition determining means determines that the qualifying condition is not satisfied; and driving support means for performing driving support based on the modified exiting track candidate.
- parking lot network acquisition means for acquiring a parking lot network, which is a network showing routes that the vehicle can select in the parking lot when exiting the parking lot
- exiting trajectory candidate acquisition means for generating and acquiring, based on a first condition, exit trajectory candidates, which are candidates for the vehicle's running trajectory from the parking position where the vehicle is parked to
- a computer program is a program for generating support information used for driving support implemented in a vehicle.
- the computer comprises a parking lot network acquiring means for acquiring an in-parking lot network, which is a network indicating a route that the vehicle can select in the parking lot when the vehicle is parked in the parking lot; an approach trajectory candidate acquiring means for generating and acquiring an approach trajectory candidate, which is a candidate for the vehicle travel trajectory from the entrance of the parking lot to the parking position where the vehicle is parked, based on a first condition using the in-parking network; running trajectory correction means for correcting the candidate approach trajectory determined not to satisfy the qualification condition based on a second condition different from the first condition when the condition decision means determines that the qualification condition is not satisfied; and driving support means for performing driving support based on the corrected approach trajectory candidate.
- candidates for a vehicle travel trajectory from the entrance of the parking lot to the parking position where the vehicle is parked are once generated using the network in the parking lot, the eligibility of the generated travel trajectory candidate is evaluated as a travel trajectory, and the once generated travel trajectory candidate is corrected by changing the generation conditions according to the evaluation result, thereby reducing inappropriate operations such as forward/backward switching and turning the steering wheel in particular, and more appropriate driving than before. It becomes possible to perform driving support based on the trajectory.
- the second driving support device by using the network in the parking lot to temporarily generate candidates for the vehicle travel trajectory from the parking position of the vehicle to the exit of the parking lot, the generated candidates for the travel trajectory are evaluated for suitability as the travel trajectory, and the once generated candidates for the travel trajectory are corrected by changing the generation conditions according to the evaluation results.
- FIG. 1 is a schematic configuration diagram showing a driving support system according to an embodiment
- FIG. 1 is a block diagram showing the configuration of a driving support system according to this embodiment
- FIG. 1 is a block diagram showing a navigation device according to an embodiment
- FIG. 4 is a flowchart of an automatic driving support program according to the embodiment
- 1 is a diagram showing an example of a parking lot network built in a parking lot where vehicles are parked
- FIG. 4 is a diagram showing an example of a travel route to a parking position candidate for parking the vehicle
- FIG. 4 is a diagram showing areas from which high-precision map information is acquired
- It is a figure explaining the calculation method of a dynamic traveling track.
- 4 is a flowchart of a sub-processing program of static traveling trajectory generation processing
- FIG. 1 is a block diagram showing the configuration of a driving support system according to this embodiment
- FIG. 1 is a block diagram showing a navigation device according to an embodiment
- FIG. 4 is a flowchart
- FIG. 10 is a diagram showing an example of exclusion from candidates for a travel trajectory in a parking lot
- FIG. 4 is a diagram showing an example of a candidate for a calculated travel trajectory
- FIG. 4 is a diagram showing an example of a candidate for a calculated travel trajectory
- FIG. 4 is a diagram showing an example of a travel track for traveling in a conditional travel prohibited area
- FIG. 2 is a diagram showing an example of a travel route to a destination parking lot
- 15 is a diagram showing an example of a lane network constructed for the travel route shown in FIG. 14;
- FIG. 1 is a schematic configuration diagram showing a driving support system 2 according to this embodiment.
- FIG. 2 is a block diagram showing the configuration of the driving support system 2 according to this embodiment.
- the driving support system 2 basically has a server device 4 provided in the information distribution center 3, and a navigation device 1 mounted on the vehicle 5 and performing various types of support related to automatic driving of the vehicle 5. Also, the server device 4 and the navigation device 1 are configured to be able to transmit and receive electronic data to and from each other via a communication network 6 . Note that, instead of the navigation device 1, another vehicle-mounted device mounted on the vehicle 5 or a vehicle control device that controls the vehicle 5 may be used.
- the vehicle 5 is a vehicle capable of assisted driving by automatic driving support, in which the vehicle automatically travels along a preset route or road without depending on the user's driving operation, in addition to manual driving driving based on the user's driving operation.
- automatic driving support may be performed for all road sections, or may be configured to be performed only while the vehicle is traveling on a specific road section (for example, a highway with a gate (manned, unmanned, or free of charge) at the boundary).
- a specific road section for example, a highway with a gate (manned, unmanned, or free of charge) at the boundary.
- the automatic driving section where automatic driving assistance of the vehicle is performed includes not only all road sections including general roads and highways but also parking lots, and it is explained that automatic driving assistance is basically performed from the time the vehicle starts running until it finishes running (until the vehicle is parked).
- the vehicle 5 may be a vehicle capable of only assisted driving by automatic driving assistance.
- vehicle control in automatic driving support for example, the current position of the vehicle, the lane in which the vehicle is traveling, and the positions of surrounding obstacles are detected at any time, and vehicle control such as steering, drive source, and brake is automatically performed so that the vehicle travels along the traveling trajectory generated by the navigation device 1 as described later at a speed according to the similarly generated speed plan.
- vehicle control such as steering, drive source, and brake is automatically performed so that the vehicle travels along the traveling trajectory generated by the navigation device 1 as described later at a speed according to the similarly generated speed plan.
- lane changes, right/left turns, and parking operations are also performed by performing vehicle control by the above-described automatic driving assistance.
- the navigation device 1 is an in-vehicle device that is mounted on the vehicle 5 and that displays a map of the vehicle's surroundings based on map data possessed by the navigation device 1 or map data acquired from the outside, inputs the user's destination, displays the current position of the vehicle on the map image, and provides movement guidance along a set guidance route.
- various types of support information relating to automatic driving support are generated particularly when the vehicle performs assisted driving with automatic driving support.
- the support information includes, for example, a recommended travel trajectory for the vehicle (including a recommended lane movement mode), selection of a parking position for parking the vehicle at the destination, and a speed plan indicating the vehicle speed when traveling. Details of the navigation device 1 will be described later.
- the server device 4 executes route search in response to a request from the navigation device 1. Specifically, information necessary for route search such as a departure point and a destination is transmitted from the navigation device 1 to the server device 4 together with a route search request (however, in the case of a re-search, information regarding the destination does not necessarily need to be transmitted). After receiving the route search request, the server device 4 searches for a route using the map information held by the server device 4, and specifies a recommended route from the departure point to the destination. After that, the specified recommended route is transmitted to the navigation device 1 that made the request. Then, the navigation device 1 can provide the received information about the recommended route to the user, or use the recommended route to generate various kinds of support information about automatic driving support as described later.
- the server device 4 has high-precision map information and facility information, which are higher-precision map information, in addition to the normal map information used for the route search.
- the high-precision map information includes, for example, information on the lane shape of the road (road shape and curvature for each lane, lane width, etc.) and division lines drawn on the road (roadway center line, lane boundary line, roadway outer line, guidance line, etc.). In addition, information on intersections and the like are also included.
- facility information is more detailed information about facilities that is stored separately from the information about facilities included in the map information, and includes, for example, a floor map of the facility, information about the entrance of the parking lot, information about the layout of the aisles and parking spaces provided in the parking lot, information about the division lines that divide the parking spaces, and connection information indicating the connection relationship between the entrance of the parking lot and the lanes.
- the server device 4 distributes high-precision map information and facility information in response to a request from the navigation device 1, and the navigation device 1 uses the high-precision map information and facility information distributed from the server device 4 to generate various types of support information related to automatic driving support as described later.
- the high-precision map information is basically map information only for roads (links) and their surroundings, but may be map information including areas other than roads.
- the above-described route search processing does not necessarily have to be performed by the server device 4, and may be performed by the navigation device 1 as long as it has map information.
- the high-precision map information and facility information may be stored in advance in the navigation device 1 instead of being distributed from the server device 4 .
- the communication network 6 includes a large number of base stations located all over the country and communication companies that manage and control each base station, and is configured by connecting the base stations and communication companies to each other by wire (optical fiber, ISDN, etc.) or wirelessly.
- the base station has a transceiver (transmitter/receiver) for communicating with the navigation device 1 and an antenna. While the base station performs wireless communication between communication companies, it serves as a terminal of the communication network 6 and has a role of relaying the communication of the navigation device 1 within the radio wave range (cell) of the base station to the server device 4. - ⁇
- the server device 4 includes a server control unit 11, a server-side map DB 12 as information recording means connected to the server control unit 11, a high-precision map DB 13, a facility DB 14, and a server-side communication device 15.
- the server control unit 11 is a control unit (MCU, MPU, etc.) that controls the entire server device 4, and includes a CPU 21 as an arithmetic device and a control device, a RAM 22 that is used as a working memory when the CPU 21 performs various arithmetic processing, a ROM 23 that stores control programs, etc., and an internal storage device such as a flash memory 24 that stores programs read from the ROM 23.
- the server control unit 11 has various means as a processing algorithm together with an ECU of the navigation device 1, which will be described later.
- the server-side map DB 12 is storage means for storing server-side map information, which is the latest version of map information registered based on input data or input operations from the outside.
- the server-side map information is composed of various information necessary for route search, route guidance, and map display, including road networks.
- network data including nodes and links indicating a road network, link data related to roads (links), node data related to node points, intersection data related to each intersection, point data related to points such as facilities, map display data for displaying maps, search data for searching routes, search data for searching points, and the like.
- the high-precision map DB 13 is storage means for storing high-precision map information 16, which is map information with higher accuracy than the server-side map information.
- the high-precision map information 16 is map information that stores more detailed information particularly about the road on which the vehicle travels. In this embodiment, for example, regarding the road, information about the lane shape (road shape and curvature for each lane, lane width, etc.) and division lines drawn on the road (roadway center line, lane boundary line, roadway outer line, guidance line, etc.) is included.
- information specifying the traffic classification of each lane in the direction of travel and the connection of roads (specifically, the correspondence relationship between the lanes included in the road before passing the intersection and the lanes included in the road after passing the intersection) is also stored.
- the speed limit set for the road is also stored.
- the facility DB 14 is storage means for storing more detailed facility information than the facility information stored in the server-side map information.
- the facility information 17 includes information specifying the position of the entrance/exit of the parking lot, information specifying the layout of the parking space in the parking lot, information relating to the division lines that divide the parking space, information relating to passages through which vehicles and pedestrians can pass, crosswalks in the parking lot, and information relating to passage spaces provided for pedestrians.
- Information specifying the floor map of the facility is included for the facility other than the parking lot.
- the floor map includes, for example, information specifying the locations of doorways, corridors, stairs, elevators, and escalators.
- the facility information 17 may be information generated by 3D models of parking lots and facilities.
- the facility DB 14 also includes connection information 18 indicating the connection relationship between the lanes included in the approach road facing the entrance of the parking lot and the entrance of the parking lot, and road outer shape information 19 specifying the area through which the vehicle can pass between the approach road and the entrance of the parking lot. Details of each piece of information stored in the facility DB 14 will be described later.
- the high-precision map information 16 is basically map information only for roads (links) and their surroundings, but may be map information including areas other than roads.
- the server-side map information stored in the server-side map DB 12 and the information stored in the high-precision map DB 13 and facility DB 14 are different map information, but the information stored in the high-precision map DB 13 and facility DB 14 may be part of the server-side map information. Further, the high-precision map DB 13 and the facility DB 14 may not be divided into one database.
- the server-side communication device 15 is a communication device for communicating with the navigation device 1 of each vehicle 5 via the communication network 6.
- traffic information consisting of traffic information, traffic regulation information, traffic accident information, etc. transmitted from the Internet network, a traffic information center such as a VICS (registered trademark: Vehicle Information and Communication System) center, etc.
- VICS Vehicle Information and Communication System
- FIG. 3 is a block diagram showing the navigation device 1 according to this embodiment.
- the navigation device 1 includes a current position detection unit 31 that detects the current position of the vehicle in which the navigation device 1 is mounted, a data recording unit 32 that records various data, a navigation ECU 33 that performs various arithmetic processing based on the input information, an operation unit 34 that receives operations from the user, a liquid crystal display 35 that displays a map of the surroundings of the vehicle for the user and information related to the guidance route (planned travel route of the vehicle) set by the navigation device 1, and a route. It has a speaker 36 for outputting voice guidance regarding guidance, a DVD drive 37 for reading a DVD as a storage medium, and a communication module 38 for communicating with an information center such as a probe center or a VICS center.
- an information center such as a probe center or a VICS center.
- the navigation device 1 is connected to an exterior camera 39 and various sensors installed in the vehicle on which the navigation device 1 is mounted via an in-vehicle network such as CAN. Further, it is also connected to a vehicle control ECU 40 that performs various controls on the vehicle in which the navigation device 1 is mounted so as to be capable of two-way communication.
- an in-vehicle network such as CAN.
- vehicle control ECU 40 that performs various controls on the vehicle in which the navigation device 1 is mounted so as to be capable of two-way communication.
- the current position detection unit 31 includes a GPS 41, a vehicle speed sensor 42, a steering sensor 43, a gyro sensor 44, etc., and is capable of detecting the current vehicle position, direction, vehicle speed, current time, and the like.
- the vehicle speed sensor 42 is a sensor for detecting the moving distance and speed of the vehicle, generates a pulse according to the rotation of the driving wheels of the vehicle, and outputs the pulse signal to the navigation ECU 33 . Then, the navigation ECU 33 calculates the rotational speed of the drive wheels and the movement distance by counting the generated pulses.
- the navigation device 1 does not need to include all of the above four types of sensors, and the navigation device 1 may be configured to include only one or more of these sensors.
- the data recording unit 32 also includes a hard disk (not shown) as an external storage device and recording medium, and a recording head (not shown) as a driver for reading out the map information DB 45, cache 46, and predetermined programs recorded in the hard disk and writing predetermined data to the hard disk.
- the data recording unit 32 may have a flash memory, a memory card, or an optical disk such as a CD or DVD instead of the hard disk.
- the server device 4 searches for a route to the destination, so the map information DB 45 may be omitted. Even if the map information DB 45 is omitted, map information can be acquired from the server device 4 as necessary.
- the map information DB 45 is storage means that stores, for example, link data related to roads (links), node data related to node points, search data used for processing related to searching and changing routes, facility data related to facilities, map display data for displaying maps, intersection data related to intersections, search data for searching for points, and the like.
- the cache 46 is storage means for storing the high-precision map information 16, the facility information 17, the connection information 18, and the road outline information 19 distributed from the server device 4 in the past.
- the storage period can be set as appropriate, but may be a predetermined period (eg, one month) after being stored, or may be until the vehicle's ACC power supply (accessory power supply) is turned off. Also, after the amount of data stored in the cache 46 reaches the upper limit, the oldest data may be sequentially deleted.
- the navigation ECU 33 uses the high-precision map information 16, the facility information 17, the connection information 18, and the road contour information 19 stored in the cache 46 to generate various types of support information related to automatic driving support. Details will be described later.
- the navigation ECU (electronic control unit) 33 is an electronic control unit that controls the entire navigation device 1. It is used as a working memory when the CPU 51 performs various arithmetic processing, as well as a RAM 52 that stores route data when a route is searched, a ROM 53 that stores a control program, an automatic driving support program (see FIG. 4), etc., and a flash memory 54 that stores programs read from the ROM 53. internal storage.
- the navigation ECU 33 has various means as processing algorithms.
- the parking lot network acquisition means acquires the parking lot network, which is a network indicating a route that the vehicle can select in the parking lot when the vehicle is parked in the parking lot.
- the approach trajectory candidate acquirer generates and acquires an approach trajectory candidate, which is a candidate for the vehicle travel trajectory from the entrance of the parking lot to the parking position where the vehicle is parked, based on the first condition, using the network within the parking lot.
- the condition determination means determines whether or not the candidate approach track satisfies eligibility conditions indicating eligibility as a vehicle travel track.
- the traveling trajectory modifying means modifies the approach trajectory candidate determined not to satisfy the qualifying condition based on a second condition different from the first condition when the condition determining means determines that the qualifying condition is not satisfied.
- the driving assistance means performs driving assistance based on the modified approach trajectory candidate.
- the operation unit 34 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 33 performs control to execute various corresponding operations based on switch signals output by pressing of each switch or the like.
- the operation unit 34 may have a touch panel provided on the front surface of the liquid crystal display 35 . It may also have a microphone and a voice recognition device.
- the liquid crystal display 35 displays map images including roads, traffic information, operation guidance, operation menus, key guidance, guidance information along the guidance route (planned travel route), news, weather forecast, time, mail, TV programs, and the like.
- a HUD or HMD may be used instead of the liquid crystal display 35 .
- the speaker 36 outputs voice guidance for driving along the guidance route (planned driving route) and traffic information guidance based on instructions from the navigation ECU 33 .
- the DVD drive 37 is a drive capable of reading data recorded on recording media such as DVDs and CDs. Then, based on the read data, music and video are reproduced, the map information DB 45 is updated, and so on.
- a card slot for reading and writing a memory card may be provided instead of the DVD drive 37 .
- the communication module 38 is a communication device for receiving traffic information, probe information, weather information, etc. transmitted from a traffic information center, for example, a VICS center, a probe center, etc., and corresponds to, for example, a mobile phone or a DCM. It also includes a vehicle-to-vehicle communication device that communicates between vehicles and a road-to-vehicle communication device that communicates with a roadside unit. It is also used for transmitting/receiving route information searched by the server device 4, high-precision map information 16, facility information 17, connection information 18, and road outline information 19 to/from the server device 4.
- a traffic information center for example, a VICS center, a probe center, etc.
- a vehicle-to-vehicle communication device that communicates between vehicles
- a road-to-vehicle communication device that communicates with a roadside unit. It is also used for transmitting/receiving route information searched by the server device 4, high-precision map information 16, facility information 17, connection information 18, and road
- the exterior camera 39 is composed of a camera using a solid-state imaging device such as a CCD, is mounted above the front bumper of the vehicle, and is installed with the optical axis directed downward at a predetermined angle from the horizontal. Then, the exterior camera 39 captures an image of the forward direction of the vehicle when the vehicle travels in the automatic driving section.
- the navigation ECU 33 performs image processing on the captured image to detect lane markings drawn on the road on which the vehicle travels and obstacles such as other vehicles in the vicinity, and based on the detection results, generates various types of support information related to automatic driving support. For example, when an obstacle is detected, a new travel trajectory for avoiding or following the obstacle is generated.
- the exterior camera 39 may be configured to be arranged at the rear or side of the vehicle instead of the front.
- sensors such as millimeter wave radars and laser sensors, vehicle-to-vehicle communication, and road-to-vehicle communication may be used instead of cameras.
- the vehicle control ECU 40 is an electronic control unit that controls the vehicle in which the navigation device 1 is mounted.
- the vehicle control ECU 40 is connected to each drive unit of the vehicle such as steering, brake, accelerator, etc.
- the automatic driving support of the vehicle is performed by controlling each drive unit.
- the override is performed by the user during the automatic driving support, it is detected that the override has been performed.
- the navigation ECU 33 transmits various types of assistance information related to automatic driving assistance generated by the navigation device 1 to the vehicle control ECU 40 via CAN after the vehicle starts running. Then, the vehicle control ECU 40 uses the received various types of assistance information to carry out automatic driving assistance after the start of travel.
- the support information includes, for example, a travel track on which the vehicle is recommended to travel, a speed plan indicating the vehicle speed during travel, and the like.
- FIG. 4 is a flowchart of an automatic driving support program according to this embodiment.
- the automatic driving support program is executed when the vehicle starts running with automatic driving support after the ACC power supply (accessory power supply) of the vehicle is turned on, and is a program for performing support driving with automatic driving support according to the support information generated by the navigation device 1. 4, 9 and 17 are stored in the RAM 52 and ROM 53 of the navigation device 1 and executed by the CPU 51.
- the CPU 51 acquires the destination that the user wants to move to.
- the destination is set by the user's operation accepted by the navigation device 1 .
- the destination may be a parking lot or a point other than the parking lot. However, if the destination is a point other than the parking lot, the parking lot where the user parks at the destination is also acquired. If the destination has a dedicated parking lot or an affiliated parking lot, that parking lot is used as the parking lot for the user to park. On the other hand, if there is no dedicated parking lot or affiliated parking lot, a parking lot around the destination is used as the parking lot for the user to park. When there are a plurality of parking lot candidates, all of the candidate parking lots may be acquired as the parking lot where the user parks, or one of the parking lots selected by the user may be acquired as the parking lot where the user parks.
- the CPU 51 acquires candidates for parking positions (parking spaces) that are recommended for the user to park in the parking lot where the user parks, which was acquired in S1.
- information on vacant parking spaces is acquired from a server that manages parking lots, and parking spaces that are easy for the user to stop (for example, parking spaces close to the entrance of the parking lot, parking spaces close to the entrance of the destination, parking spaces to the left and right of which no other vehicles are parked, etc.) are determined as candidate parking positions recommended for the user to park from among the vacant parking spaces in the parking lot.
- all vacant parking spaces in the parking lot may be candidates for the parking position.
- the CPU 51 searches for a recommended travel route for the vehicle from the current position of the vehicle to the parking position candidate (hereinafter referred to as the parking position candidate) acquired in S2.
- the search for the travel route in S3 is performed by the server device 4 in particular in this embodiment.
- the CPU 51 first transmits a route search request to the server device 4 .
- the route search request includes a terminal ID that identifies the navigation device 1 that sent the route search request, and information that identifies the departure point (for example, the current position of the vehicle) and the parking position candidate acquired in S2. Thereafter, the CPU 51 receives searched route information transmitted from the server device 4 in response to the route search request.
- the searched route information is information (for example, a link string included in the traveling route) specifying a recommended traveling route from the departure point to the parking position candidate searched by the server device 4 using the latest version of the map information based on the transmitted route search request.
- the search is performed using the known Dijkstra method.
- the server device 4 uses the facility information 17 stored in the facility DB 14 to construct links and nodes (construction of a network within the parking lot) in the same manner as roads within the parking lot where the user parks using the facility information 17 stored in the facility DB 14 when searching for a recommended driving route within the parking lot from the entrance of the parking lot to the parking position candidate in particular in S3.
- the facility information 17 includes information specifying the position of the entrance/exit of the parking lot, information specifying the arrangement of the parking spaces in the parking lot, information on the demarcation lines that divide the parking spaces, information on passages through which vehicles and pedestrians can pass, information on pedestrian crossings and passage spaces provided for pedestrians, and the like.
- the information is used to specify the route that the vehicle can take in the parking lot, and the network within the parking lot is constructed.
- the parking lot network may be constructed in advance for each parking lot nationwide and stored in the facility DB 14 .
- FIG. 5 shows an example of the parking lot network constructed for the parking lot in S3 above.
- parking lot nodes 58 are set at entrances and exits of parking lots, intersections where vehicles can pass through, corners of paths through which vehicles can pass (i.e., connection points between paths), and ends of paths.
- the parking lot link 59 is set for a passage through which a vehicle can pass between the parking lot nodes 58 . Basically, it is set with respect to the center of the aisle. It should be noted that the parking link 59 is allowed to straddle areas where vehicles are permitted to pass when there are no pedestrians, such as crosswalks and passage spaces provided for pedestrians.
- the parking lot link 59 also has information specifying the direction in which the vehicle can pass through the aisles in the parking lot. For example, FIG.
- the cost and direction are set in the same way as the road link.
- a cost corresponding to the contents of the parking lot node 58 is set, and a direction in which a vehicle can pass through the parking lot node 58 is set.
- a cost is set using the time required for movement or the length of the link as a reference value. That is, a higher cost is calculated for the parking link 59 that requires a longer time or distance for movement.
- the server device 4 when the current position of the vehicle is inside the parking lot and the destination is outside the parking lot, the server device 4 also constructs the parking lot network shown in FIG.
- the server device 4 uses Dijkstra's method to calculate the total cost from the current position of the vehicle to the parking lot entrance (if the current position of the vehicle is inside the parking lot and the destination is outside the parking lot, it also goes through the exit of the parking lot) to the parking lot candidate, and the route with the smallest total value is the recommended driving route for the vehicle.
- the recommended travel route is not limited to one, and when there are a plurality of candidates for the travel route in the parking lot, a plurality of candidates are acquired as the recommended travel route for the vehicle. For example, as shown in FIG.
- a specific driving trajectory is generated for each driving route in the static driving trajectory generation process (S5) described later (a plurality of driving trajectories may be generated for one driving route), and the generated driving trajectories are compared.
- a final travel route is determined from among the routes.
- the server device 4 refers to the connection information 18 that indicates the connection relationship between the lanes included in the road facing the entrance of the parking lot where the user parks (hereinafter referred to as the entrance road) and the entrance of the parking lot, and when the direction of travel from the entrance road to the parking lot is limited (for example, only left-turn entry is allowed), the above travel route is searched in consideration of the entrance direction.
- search means other than the Dijkstra method may be used.
- the search for the travel route in S3 may be performed by the navigation device 1 instead of the server device 4.
- the CPU 51 acquires the high-precision map information 16 for the area including the vehicle travel route acquired in S3.
- the high-precision map information 16 is stored in the high-precision map DB 13 of the server device 4 divided into rectangular shapes (for example, 500 m x 1 km) as shown in FIG. Therefore, for example, when a route 63 is acquired as a vehicle travel route as shown in FIG. However, when the distance to the parking lot where the user parks is particularly long, for example, the high-precision map information 16 may be acquired only for the secondary mesh where the vehicle is currently located, or the high-precision map information 16 may be acquired for only the area within a predetermined distance (for example, within 3 km) from the current position of the vehicle.
- a predetermined distance for example, within 3 km
- the high-precision map information 16 includes, for example, information about the lane shape of the road and the division lines drawn on the road (roadway center line, lane boundary line, roadway outer line, guidance line, etc.). In addition, information on intersections, information on parking lots, etc. are also included.
- the high-precision map information 16 is basically obtained from the server device 4 in units of rectangular areas as described above, but when there is the high-precision map information 16 of the area already stored in the cache 46, it is obtained from the cache 46. ⁇ Also, the high-precision map information 16 acquired from the server device 4 is temporarily stored in the cache 46 .
- the CPU 51 also acquires the facility information 17 for the parking lot where the user specified in S1 parks. Furthermore, connection information 18 indicating the connection relationship between the entrance of the parking lot and the lane included in the entrance road facing the entrance of the parking lot where the user parks, and road outer shape information 19 specifying the area through which the vehicle can pass between the entrance road and the entrance of the parking lot where the user parks are similarly acquired.
- the facility information 17 includes, for example, information specifying the position of the entrance/exit of the parking lot, information specifying the arrangement of the parking spaces in the parking lot, information on the division lines that divide the parking spaces, information on passages that vehicles and pedestrians can pass through, crosswalks in the parking lot, and information on passage spaces provided for pedestrians.
- the facility information 17 may be information generated by a 3D model of a parking lot.
- the facility information 17, the connection information 18, and the road contour information 19 are basically acquired from the server device 4, but are acquired from the cache 46 when the corresponding information is already stored in the cache 46.
- the facility information 17, the connection information 18, and the road shape information 19 acquired from the server device 4 are temporarily stored in the cache 46.
- the CPU 51 executes static traveling trajectory generation processing (Fig. 9), which will be described later.
- the static traveling trajectory generation process generates a recommended traveling trajectory for traveling along the recommended traveling route of the vehicle from the current position of the vehicle searched in S3 to the parking position candidate.
- the travel trajectory for each travel route is compared and one most recommended travel trajectory is selected (that is, one travel route is also determined).
- a static running trajectory is generated based on the high-precision map information 16, the facility information 17, the connection information 18, and the road outer shape information 19 acquired in S4, and the parking position for parking the vehicle is also determined from among the parking position candidates acquired in S2 based on the generated static running trajectory.
- the static travel trajectory is the first travel trajectory on which the vehicle is recommended to travel on the lane from the travel start point to the approach road facing the entrance of the parking lot of the destination (including the travel trajectory on which the vehicle is recommended to travel from the current position of the vehicle to the exit of the parking lot when the current position of the vehicle is in the parking lot, and the travel trajectory on which the vehicle is recommended to travel from the exit of the parking lot to the approach road facing the entrance of the parking lot of the destination), and the travel trajectory from the approach road to the entrance of the parking lot. and a third travel trajectory along which the vehicle is recommended to travel from the entrance of the parking lot to the parking position (parking space) where the vehicle is parked.
- the first travel trajectory for the section from the current position of the vehicle to a predetermined distance ahead along the traveling direction may be generated.
- the predetermined distance can be changed as appropriate, the static travel trajectory is generated for at least the area outside the range (detection range) where the road conditions around the vehicle can be detected by the exterior camera 39 or other sensors.
- the CPU 51 generates a speed plan for the vehicle when traveling on the static travel trajectory generated in S5, based on the high-precision map information 16 acquired in S4. For example, considering the speed limit information and speed change points on the planned travel route (for example, intersections, curves, railroad crossings, pedestrian crossings, etc.), the recommended travel speed of the vehicle when traveling on the static travel trajectory is calculated.
- the planned travel route for example, intersections, curves, railroad crossings, pedestrian crossings, etc.
- the speed plan generated in S6 is stored in the flash memory 54 or the like as support information used for automatic driving support. Further, the acceleration plan indicating the acceleration/deceleration of the vehicle necessary for realizing the speed plan generated in S6 may also be generated as support information used for automatic driving support.
- the CPU 51 performs image processing on the captured image captured by the exterior camera 39 to determine whether or not there are any factors affecting the running of the own vehicle, particularly around the own vehicle, as surrounding road conditions.
- the "factors that affect the running of the own vehicle" to be determined in S7 are dynamic factors that change in real time, and static factors such as those based on the road structure are excluded. For example, other vehicles running or parked in front of the own vehicle in the direction of travel, pedestrians positioned in front of the direction of travel of the own vehicle, construction sections in front of the direction of travel of the own vehicle, and the like correspond. On the other hand, intersections, curves, railroad crossings, merging sections, lane reduction sections, etc. are excluded.
- 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 real-time position of each vehicle traveling on roads all over the country may be managed by an external server, and the CPU 51 may acquire the positions of other vehicles located around the own vehicle from the external server and perform the determination process of S7.
- the CPU 51 In S8, the CPU 51 generates a new trajectory as a dynamic travel trajectory for returning to the static travel trajectory by avoiding or following the "factor affecting travel of the own vehicle" detected in S7 from the current position of the vehicle.
- the dynamic travel trajectory is generated for sections including "factors that affect travel of the own vehicle".
- the length of the section changes depending on the content of the factor. For example, if the "factor that affects the running of the own vehicle" is another vehicle (front vehicle) running ahead of the vehicle, as shown in FIG.
- a following trajectory which is a trajectory that follows the forward vehicle 69 for a predetermined distance behind the forward vehicle 69 (or runs parallel to the forward vehicle 69) without overtaking the forward vehicle 69, may be generated as the dynamic travel trajectory.
- the CPU 51 first calculates the first trajectory L1 necessary for the vehicle to start turning the steering wheel, move to the right lane, and return the steering position to the straight-ahead direction.
- the lateral acceleration (lateral G) that occurs when the vehicle changes lanes is calculated based on the current speed of the vehicle.
- an upper limit value for example, 0.2 G
- a trajectory that is as smooth as possible and that shortens the distance required for lane changes is calculated using a clothoid curve or arc.
- Another condition is to maintain an appropriate inter-vehicle distance D or more with respect to the forward vehicle 69 .
- a second trajectory L2 is calculated until the vehicle travels in the right lane at the maximum speed limit, overtakes the forward vehicle 69, and maintains an appropriate inter-vehicle distance D or more with the forward vehicle 69.
- FIG. The second track L2 is basically a straight track, and the length of the track is calculated based on the vehicle speed of the preceding vehicle 69 and the speed limit of the road.
- a third trajectory L3 required for starting turning of the steering wheel, returning to the left lane, and returning the steering position to the straight-ahead direction is calculated.
- the lateral acceleration (lateral G) that occurs when the vehicle changes lanes is calculated based on the current vehicle speed.
- an upper limit value e.g., 0.2 G
- a trajectory that is as smooth as possible and that shortens the distance required to change lanes is calculated using a clothoid curve or arc.
- Another condition is to maintain an appropriate inter-vehicle distance D or more with respect to the forward vehicle 69 .
- the area for which the dynamic travel trajectory is generated is at least within the range (detection range) where the road conditions around the vehicle can be detected by the exterior camera 39 and other sensors.
- the CPU 51 reflects the dynamic travel trajectory newly generated in S8 on the static travel trajectory generated in S5. Specifically, from the current position of the vehicle to the end of the section containing "factors that affect the running of the own vehicle", the costs of each of the static and dynamic trajectories are calculated, and the trajectory with the lowest cost is selected. As a result, part of the static travel trajectory will be replaced with the dynamic travel trajectory as needed. Depending on the situation, there may be cases where the replacement of the dynamic travel trajectory is not performed, that is, even if the dynamic travel trajectory is reflected, the static travel trajectory generated in S5 does not change. Furthermore, if the dynamic travel trajectory and the static travel trajectory are the same trajectory, the static travel trajectory generated in S5 may not change even if the replacement is performed.
- the CPU 51 corrects the vehicle speed plan generated in S6 based on the content of the reflected dynamic trajectory for the static trajectory after the dynamic trajectory is reflected in S9. If the result of the reflection of the dynamic traveling trajectory does not change from the static traveling trajectory generated in S5, the process of S10 may be omitted.
- the CPU 51 calculates a control amount for the vehicle to travel at a speed according to the static travel trajectory generated in S5 (the trajectory after reflection if the dynamic travel trajectory is reflected in S9) according to the speed plan generated in S6 (the plan after correction if the speed plan is corrected in S10).
- control amounts for accelerator, brake, gear and steering are calculated respectively.
- the processing of S11 and S12 may be performed by the vehicle control ECU 40 that controls the vehicle instead of the navigation device 1.
- the CPU 51 reflects the control amount calculated in S11. Specifically, the calculated control amount is transmitted to the vehicle control ECU 40 via CAN.
- the vehicle control ECU 40 controls the accelerator, brake, gear and steering based on the received control amount.
- driving support control in which the static traveling trajectory generated in S5 (or the trajectory after reflection when the dynamic trajectory is reflected in S9) travels at a speed according to the speed plan generated in S6 (or the modified plan when the speed plan is modified in S10).
- the CPU 51 determines whether the vehicle has traveled a certain distance since the static travel trajectory was generated in S5. For example, assume that the fixed distance is 1 km.
- the process returns to S4.
- the static travel trajectory is generated again for a section along the travel route within a predetermined distance from the current position of the vehicle (S4 to S6).
- the static travel trajectory is repeatedly generated for a section within a predetermined distance along the travel route from the current position of the vehicle.
- the static travel trajectory to the destination may be generated all at once at the start of travel.
- FIG. 9 is a flow chart of a sub-processing program of static running trajectory generation processing.
- the CPU 51 acquires the current position of the vehicle detected by the current position detection section 31. It is desirable to specify the current position of the vehicle in detail using, for example, highly accurate GPS information or highly accurate location technology.
- the high-precision location technology is a technology that detects the white line and road surface paint information captured by the camera installed in the vehicle by image recognition, and furthermore, compares the detected white line and road surface paint information with the high-precision map information 16, for example, to detect the driving lane and the vehicle position with high precision.
- the high-precision location technology is a technology that detects the white line and road surface paint information captured by the camera installed in the vehicle by image recognition, and furthermore, compares the detected white line and road surface paint information with the high-precision map information 16, for example, to detect the driving lane and the vehicle position with high precision.
- the lane in which the vehicle travels is also specified.
- a specific position in the parking lot for example, a parking space where the vehicle is located
- the CPU 51 calculates the recommended travel path for traveling along the recommended travel route from the current position of the vehicle searched in S3 to the parking position candidate.
- a driving trajectory is generated for each route, and a final driving route is also determined from among the plurality of routes by comparing the generated driving trajectories.
- the CPU 51 acquires the parking lot network of the parking lot where the user parks, which was acquired in S1, and uses the parking lot network and the facility information 17 to determine the possible driving trajectory (traveling trajectory) from the parking lot entrance where the vehicle enters the destination parking lot (however, if the vehicle is already in the parking lot, the current position of the vehicle in the parking lot) along the route until the vehicle is parked in a parking space that is a parking position candidate. candidate).
- the parking lot network of the parking lot where the user is located is obtained, and similarly using the parking lot network, for each traveling route searched in S3 above, the possible travel trajectory for the vehicle to move from the current position along that route to the exit of the parking lot is also calculated. That is, in S22, candidates for the running track are calculated for the portion of the running route searched in S3, which is for the parking lot.
- the parking lot network is a network specifying routes that can be selected by vehicles in the parking lot, and consists of parking lot nodes 58 and parking lot links 59 as shown in FIG.
- the facility information 17 includes information specifying the position of the entrance/exit of the parking lot, information specifying the arrangement of parking spaces in the parking lot, information relating to the division lines that divide the parking spaces, information relating to passages through which vehicles and pedestrians can pass, information relating to pedestrian crossings and passage spaces provided for pedestrians, and the like.
- the traveling speed in the parking lot is assumed to be a slow speed (for example, 10 km/h), and the possible turning radius range of the vehicle is specified based on the vehicle data.
- a traveling trajectory during turning is calculated using a clothoid curve or an arc to connect the trajectory as smoothly as possible. Furthermore, basically, when traveling along an aisle, the running trajectory is set so as to run in the center of the aisle (that is, on the parking lot link 59 of the parking lot network). In particular, the first condition is to run in the center of the aisle (that is, on the parking lot link 59 of the parking lot network). At S22, a running track is generated based on the first condition. Further, the candidates for the generated travel trajectory are not limited to one travel trajectory for one travel route, and when there are a plurality of travel trajectories that the vehicle can take when traveling along the same travel route, a plurality of travel trajectories are generated. However, as shown in FIG.
- a traveling trajectory in which a part of the vehicle body enters a parking space other than the parking space where the vehicle is parked and the parking space to be parked, or a traveling trajectory in which a part of the vehicle body enters outside the parking lot area (for example, a public road) is excluded from the objects to be generated.
- step S22 an entry track candidate, which is a candidate for the vehicle running track from the entrance of the parking lot to the parking position where the vehicle is parked, and an exit track candidate, which is a candidate for the vehicle running track from the parking position where the vehicle is parked to the parking lot exit, are generated.
- FIG. 11 is an example of a candidate for the travel trajectory 71 calculated for the travel route 61 shown in FIG.
- FIG. 12 shows an example of a candidate for the travel track 72 calculated for the travel route 62 shown in FIG.
- the running track 71 and the running track 72 are both for entering from the entrance of the same parking lot and parking in the same parking space 60, but their shapes are significantly different.
- the running track 71 is shorter in terms of overall length, the running track 71 needs to be turned in order to enter the parking space 60 .
- the traveling track such as the traveling track 71 that causes the turning back often occurs because of the condition that the vehicle travels along the aisle in the center of the aisle (i.e., on the parking lot link 59 of the parking lot network).
- the traveling trajectory that does not satisfy the qualifying conditions as a travel trajectory with a turn is corrected based on the new second condition excluding the first condition that the vehicle travels in the center of the passage (that is, on the parking lot link 59 of the parking lot network), and the revised travel trajectory is also added as a candidate for the travel trajectory. Details will be described later.
- the CPU 51 calculates the cost of traveling the vehicle, taking into account the vehicle behavior when traveling on the candidate travel trajectory generated in S22 and the candidate travel trajectory added in S23.
- the cost is calculated for each of the plurality of candidates for the traveling trajectory. The method of calculating the cost in S24 will be described in detail below.
- the final cost is calculated for each travel track candidate by adding the costs calculated based on the following elements (1) to (6).
- Moving distance (regardless of whether forward or backward): moving distance [m] x 1.0 (2) Retreat movement distance ... movement distance [m] x 10.0 (3) Number of times to switch between forward and backward: number of times x 10.0 (4) Amount of turning angle: Turning angle x 0.1 (5) Number of times the turning direction of the steering wheel is switched: number of times x 5.0 (6)
- the cost is determined by the travel distance of the travel track. Specifically, the longer the total length of the travel track, the higher the cost calculated, that is, the less likely it is to be selected as a recommended travel track.
- the cost is determined by the distance traveled in retreating, especially in the traveling trajectory. Specifically, the longer the retreating distance, the higher the calculated cost. Note that the coefficient is 10 times as large as that in (1), and there is a possibility that the running track with a short overall length but with a long retraction distance will be more costly than the running track with a long overall length.
- the cost is determined according to the number of times forward and reverse are switched within the travel trajectory. Specifically, the greater the number of times forward and reverse are switched, the higher the cost calculated, that is, the less likely it is to be selected as a recommended travel trajectory.
- the cost is determined according to the turning angle amount of the vehicle required when traveling on the traveling track. Specifically, it can be seen that the larger the turning angle amount, that is, the larger the steering operation amount, the higher the cost calculated, that is, the less likely it is to be selected as the recommended traveling track.
- the cost is determined according to the number of times the steering turning direction is switched within the travel trajectory. Specifically, the higher the number of times the steering turning direction is switched, the higher the cost is calculated.
- the cost is determined by the distance traveled in the conditional no-travel area of the travel track. Specifically, the longer the distance traveled in the conditional no-travel area, the higher the calculated cost. Basically, if even a part of the vehicle body enters the conditional travel prohibited area, it is considered that the vehicle is traveling in the conditional travel prohibited area.
- the "conditional travel prohibition area” is an area in which the vehicle is permitted to pass if no obstacle exists in the area, but the vehicle is not permitted to pass in the state where the obstacle exists in the area. Obstacles include, for example, pedestrians, wheelchairs, etc.
- the "conditionally prohibited area” specifically corresponds to crosswalks provided in parking lots and passage spaces provided for pedestrians (however, passages dedicated to pedestrians where vehicles are prohibited from entering are excluded).
- the facility information 17 includes information specifying the conditional travel prohibited area. For example, as shown in FIG. 13, when a part of the running track travels in a passage space 75 provided for pedestrians, the cost is added according to the distance L traveled in the passage space 75 . Note that the coefficient is 10 times larger than (1), and there is a possibility that the running track that runs in the conditionally prohibited travel area will cost more than the running track with a long overall length, even if the total length is short.
- the cost may be calculated by considering only some of the elements (1) to (6) above instead of considering all the elements (1) to (6) above. For example, the total cost of (1), (2), (3), and (5) may be calculated.
- the CPU 51 compares the costs of the candidates for the travel trajectory calculated in S24, and selects the travel trajectory for which the minimum cost is calculated among the candidates for the travel trajectory from the entrance of the parking lot of the destination to the parking position where the vehicle is parked as the recommended travel trajectory of the vehicle from the entrance of the parking lot of the destination to the parking position where the vehicle is parked.
- the parking position for parking the vehicle is also determined from among the parking position candidates acquired in S2. Specifically, the parking space located at the end point of the selected travel track becomes the parking position where the vehicle is parked.
- the travel route is determined as one along with the travel trajectory.
- the traveling trajectory for which the minimum cost is calculated from among the candidates for the traveling trajectory from the current position of the vehicle in the parking lot to the parking lot exit is selected as the recommended traveling trajectory for the vehicle from the current position of the vehicle in the parking lot to the parking lot exit.
- the parking position and travel track for parking are selected in consideration of the burden associated with traveling the vehicle to the destination, but the parking position and travel route may also be selected in consideration of the burden associated with traveling the vehicle when returning home from the destination.
- the parking position and travel route may also be selected in consideration of the burden associated with traveling the vehicle when returning home from the destination.
- the parking position and travel route may also be selected in consideration of the burden associated with traveling the vehicle when returning home from the destination.
- the parking position and travel route may also be selected in consideration of the burden associated with traveling the vehicle when returning home from the destination.
- the parking position and travel route may also be selected in consideration of the burden associated with traveling the vehicle when returning home from the destination.
- the CPU 51 constructs a lane network for the portion of the road where the vehicle travels, of the recommended travel route for the vehicle from the current position of the vehicle searched in S3 to the parking position candidate, based on the high-precision map information 16 acquired in S4.
- the high-precision map information 16 includes lane shape, lane marking information, and intersection information.
- the lane shape and lane marking information includes information specifying the number of lanes, where and how the number of lanes increases or decreases, traffic divisions in the direction of travel for each lane, road connections (specifically, correspondence between lanes included in the road before passing the intersection and lanes included in the road after passing the intersection), guidance lines (white guide lines) in the intersection, and the like.
- the lane network generated in S26 is a network indicating lane movements that the vehicle can select when traveling along the route candidate searched in S3. If there are a plurality of candidates for the travel route searched in S3, the lane network is constructed for the plurality of candidate routes. In addition, the lane network is constructed for the section from the current position of the vehicle (however, if the current position of the vehicle is a parking lot, the exit road facing the exit of the parking lot) to the approach road facing the entrance of the parking lot where the user parks at the destination.
- the traveling route is a route in which the vehicle goes straight from the current position of the vehicle, turns right at the next intersection 81, further turns right at the next intersection 82, and turns left into a parking lot 83 to be parked.
- the candidate route shown in FIG. 14 for example, when turning right at the intersection 81, it is possible to enter the right lane or enter the left lane.
- FIG. 15 shows a lane network constructed for such candidate routes that allow lane movement.
- the lane network divides candidate routes for which static travel trajectories are to be generated into a plurality of sections (groups). Specifically, the entry position of an intersection, the exit position of an intersection, and the position where lanes increase or decrease are classified as boundaries.
- a node point (hereinafter referred to as a lane node) 85 is set for each lane positioned at the boundary of each divided section. Further, a link (hereinafter referred to as a lane link) 86 connecting the lane nodes 85 is set.
- the start position of the lane network (i.e., start node) is the current position of the vehicle (driving start point), and the end position (i.e., end node) of the lane network is defined as a node near the entrance of the parking lot (hereinafter referred to as the entry point) newly generated based on the node position of the entrance of the parking lot set in the parking network, among the approach roads facing the entrance of the parking lot where the vehicle is parked.
- the lane network includes information specifying the corresponding relationship between the lanes included in the road before passing the intersection and the lanes included in the road after passing the intersection, that is, the lanes that can be moved after passing the intersection with respect to the lanes before passing the intersection, by connecting the lane nodes and lane links at the intersection. Specifically, it indicates that the vehicle can move between the lanes corresponding to the lane nodes connected by the lane links, among the lane nodes set on the road before passing through the intersection and the lane nodes set on the road after passing through the intersection.
- the high-precision map information 16 stores lane flags indicating the corresponding relationship of lanes for each combination of roads entering and leaving the intersection for each road connected to the intersection.
- the CPU 51 refers to the lane flags to form connections between lane nodes and lane links at intersections.
- the CPU 51 connects the lane network constructed at S26 and the parking lot network constructed at S22. Specifically, a new node is set near the entrance of the parking lot on the basis of the node position of the entrance of the parking lot set in the parking network on the approach road facing the entrance of the parking lot where the vehicle is parked, and the newly set node and the node of the entrance of the parking lot are connected by a link.
- the CPU 51 sets a movement start point at which the vehicle starts to move for the lane node located at the starting point of the lane network, and sets a movement target point for the vehicle to move to for the end point of the lane network, that is, the lane node connected to the entrance of the parking lot (lane node provided corresponding to the entry point).
- the CPU 51 refers to the constructed lane network and searches for a route that continuously connects the movement start point to the movement target point. For example, using Dijkstra's method, the recommended lane movement mode of the vehicle is specified when the vehicle moves along the route that minimizes the total lane cost.
- the lane cost is set, for example, by using the length of the lane link 86 or the time required for movement as a reference value, and considering the presence or absence of lane changes and the number of lane changes.
- search means other than the Dijkstra's method may be used as long as it is possible to search for a route continuously connecting from the movement start point to the movement target point.
- the CPU 51 uses the high-precision map information 16, facility information 17, connection information 18, and road shape information 19 acquired in S4 to generate a specific running trajectory for traveling along the route specified by the lane network.
- the traveling track in the section with lane change the lane change position is set so that the lane change is as infrequent as possible and the lane change is performed at a recommended position away from the intersection by a predetermined distance.
- the lateral acceleration (lateral G) generated in the vehicle is calculated, and a trajectory that connects as smoothly as possible using a clothoid curve or an arc is calculated on the condition that the lateral G does not interfere with automatic driving support and does not exceed an upper limit value (for example, 0.2 G) that does not cause discomfort to the occupants of the vehicle.
- an upper limit value for example, 0.2 G
- the track that passes through the center of the lane is used as the recommended running track for the vehicle.
- the CPU 51 calculates the recommended travel trajectory, especially when entering the parking lot from the approach road, when the vehicle moves along the recommended travel route from the current position of the vehicle searched in S3 to the parking position candidate.
- the CPU 51 identifies an area through which the vehicle can pass (hereinafter referred to as a passing area) between the approach road 88 and the parking lot 83 based on the road shape information acquired in S3.
- a passing area an area through which the vehicle can pass (hereinafter referred to as a passing area) between the approach road 88 and the parking lot 83 based on the road shape information acquired in S3.
- a rectangular area of width x length y is a passage area through which the vehicle can pass between the approach road 88 and the parking lot 83 .
- a trajectory which is as smooth as possible and which shortens the distance required for entry as much as possible is calculated using a clothoid curve or an arc.
- the CPU 51 After that, in S31, the CPU 51 generates a static travel trajectory, which is a recommended travel trajectory for the vehicle, by connecting the travel trajectories calculated in S25, S29, and S30.
- the static travel trajectory generated in S31 includes a first travel trajectory on which the vehicle is recommended to travel in the lane from the travel start point to the approach road facing the entrance of the parking lot, a second travel trajectory on which the vehicle is recommended to travel from the approach road to the entrance of the parking lot, and a third travel trajectory on which the vehicle is recommended to travel from the entrance of the parking lot to the parking position (parking space) where the vehicle is parked.
- the static travel trajectory generated in S31 is stored in the flash memory 54 or the like as support information used for automatic driving support. After that, the process proceeds to S6.
- the trajectory for driving in the parking lot, the trajectory for driving on the road, and the trajectory for entering the parking lot from the road are individually generated (S25, S29, S30), but it is also possible to connect the network in the parking lot to the lane network and generate the driving trajectory including all the movement of the vehicle from the current position of the vehicle to the parking position candidate in the parking lot at once.
- FIG. 17 is a flow chart of a sub-processing program for travel track addition processing.
- the CPU 51 determines whether or not the travel trajectory to be processed satisfies eligibility conditions indicating the eligibility as a vehicle travel trajectory.
- the eligibility conditions are (a) no backward movement during the preparation stage for entering the parking space, (b) the backward distance of the vehicle is within a threshold value, (c) the number of times the vehicle switches forward and backward is within the threshold value, and (d) the number of times the turning direction of the steering wheel is switched is within the threshold value.
- the eligibility conditions are (a) no backward movement during the preparation stage for entering the parking space, (b) the backward distance of the vehicle is within a threshold value, (c) the number of times the vehicle switches forward and backward is within the threshold value, and (d) the number of times the turning direction of the steering wheel is switched is within the threshold value.
- the CPU 51 calculates a reverse start position for allowing the vehicle to enter the parking space, which is a parking position candidate. For example, as shown in FIG. 18, when the parking space 60 is a parking position candidate and the vehicle is parked from the left side of the parking space 60, a trajectory that is as smooth as possible and that shortens the distance required to enter the parking space 60 is calculated using a clothoid curve or an arc, and the start point X of the trajectory is set as the reverse start position. It should be noted that the retreat start position does not have to be one point, and may be a plurality of points.
- the traveling position when traveling along the passage is shifted to the right or left with respect to the center of the passage, so it is desirable to calculate not only the reverse start position when traveling in the center of the passage but also the reverse start position when traveling on the right side or left side of the passage.
- the upper diagram in FIG. 18 shows the reverse start position when traveling in the center of the passage
- the lower diagram in FIG. 18 is an example of the reverse start position when traveling leftward from the center of the passage.
- the CPU 51 traces the travel trajectory to be processed in the direction opposite to the direction of travel from the location that was determined to not satisfy the qualifying condition in S41 to the entrance side of the parking lot (starting point side of the travel trajectory), and searches for locations where the travel trajectory can be corrected.
- the “location that causes the determination that the eligibility condition is not satisfied” is, for example, a location where backward movement (i.e., turning back) occurred in the entry preparation stage for the traveling track that was determined not to satisfy the condition (a).
- the travel track that is determined not to satisfy the condition (b) is a location where the vehicle is to be retreated by a distance equal to or greater than the threshold distance.
- the traveling track determined not to satisfy the condition (c) is a location where forward and backward switching occurs continuously.
- the traveling track determined not to satisfy the condition (d) is a location where the turning direction of the steering wheel is continuously switched.
- the traveling trajectory is corrected by shifting the traveling position when traveling along the passage to the right or left with respect to the center of the passage (that is, on the parking lot link 59 of the parking lot network). Therefore, the location where the traveling trajectory can be corrected in S43 is a location where the traveling position can be shifted to the right or left with respect to the center of the passage (that is, on the parking lot link 59 of the parking lot network). Further, in S43, a correction portion is searched for a correction for satisfying the qualifying condition of the traveling track, that is, a correction for eliminating the cause of not satisfying the qualifying condition. For example, if the factor determined not to satisfy the eligibility condition is backing up (that is, turning back) in the stage of preparing to enter the parking space, a correction location that can be corrected to eliminate the turning back is searched.
- the CPU 51 generates a travel trajectory in which the location searched in S43 is corrected.
- a plurality of patterns of correction for satisfying the eligibility condition are searched for, a plurality of traveling trajectories corrected by the respective correction patterns are generated.
- the corrected traveling trajectory 95 can be set such that the passage 92 where the vehicle first travels when entering the parking lot from the entrance of the parking lot and the passage 93 where the vehicle travels after turning right after that travel in the center, and when turning right from the passage 93 and entering the passage 91, the turning start timing is delayed to enter the passage 91 to the left of the center, and the vehicle travels straight to reach the reverse start position calculated in S42.
- the running track 95 does not have a turnaround at the stage of preparing to enter the parking space 60, and satisfies the eligibility condition.
- a second correction pattern as shown in FIG. 20, there is a method in which the traveling position of the passage 93 is shifted to the left with respect to the center of the passage (that is, on the parking lot link 59 of the parking lot network) to extend the straight distance of 91.
- the modified traveling trajectory 96 runs in the center of the aisle 92 on which the vehicle first travels after entering the parking lot from the entrance of the parking lot, and when turning right from the aisle 92 to enter the aisle 93, delays the turning start timing and enters the aisle 93 to the left of the center, travels on the left side of the aisle 93, turns right, enters the center of the aisle 91, travels straight, turns slightly to the left in front of the parking space 60, and in S42. It is possible to set the traveling trajectory to reach the calculated reverse start position.
- the running track 96 does not have a turnaround at the stage of preparing to enter the parking space 60, and satisfies the eligibility condition.
- a combination of the first correction pattern and the second correction pattern may be used to shift the running positions of the aisle 91 and the aisle 93 to the left with respect to the center of the aisle (i.e., on the parking lot link 59 of the parking lot network), as shown in FIG.
- the corrected traveling trajectory 97 is such that the first passageway 92 that is driven after entering the parking lot from the entrance of the parking lot runs in the center, and when turning right from the passageway 92 to enter the passageway 93, the turning start timing is delayed to enter the passageway 93 to the left of the center, and after traveling on the left side of the passageway 93, the turning start timing is delayed again when turning right to enter the passageway 91, and the turning start timing is delayed again to enter the passageway 91 to the left side of the center. It is possible to set the traveling track to reach the reverse start position calculated in S42 by going straight.
- the traveling track 97 does not have a turnaround at the stage of preparing to enter the parking space 60, and satisfies the eligibility condition.
- the second condition is that the eligibility conditions (a) to (d) are satisfied as described above, and the second condition excludes the first condition, that is, driving in the center of the passage (that is, on the parking lot link 59 of the parking lot network).
- the traveling trajectory once generated at S22 is corrected based on the second condition.
- the CPU 51 adds the travel trajectory corrected in S44 as a new travel trajectory candidate.
- a plurality of travel trajectories corrected by the respective correction patterns are added.
- the running track 71 shown in FIG. 11 the running track 95 shown in FIG. 19, the running track 96 shown in FIG. 20, and the running track 97 shown in FIG. 21 are added as running track candidates.
- the cost indicating the suitability as a traveling track is calculated for each candidate of the traveling track including the newly added candidate of the traveling track, and the candidate of the traveling track with the lowest cost is selected as the recommended traveling track (S24, S25).
- the traveling track 71 has a longer backward movement distance than the traveling track 95, and the number of times of switching forward and backward and the number of times of switching the turning direction of the steering are also large. That is, if the costs based on the above (2), (3), and (5) are compared, the traveling track 95 has a lower cost. Therefore, the corrected travel trajectory 95 is more likely to be selected as the recommended vehicle travel trajectory than the travel trajectory 71 . However, the corrected traveling trajectory does not necessarily result in a lower cost, and the corrected traveling trajectory may result in a higher cost.
- the driving trajectory of the vehicle from the parking position where the vehicle is parked to the exit of the parking lot includes a factor that does not satisfy the qualifying condition such as turning back
- the driving trajectory is traced to the exit side (advance direction side) of the parking lot from the factor, and the driving position is shifted to the right or left side from the center of the aisle to search for a correction point of the driving trajectory that can eliminate the factor (S43), and the corrected driving trajectory that eliminates the factor is newly added as a candidate for the driving trajectory (S44, S45).
- the parking lot network which is a network showing the routes that the vehicle can select in the parking lot
- S3 the parking lot network
- an approach trajectory candidate which is a candidate of the vehicle travel trajectory from the entrance of the parking lot to the parking position where the vehicle is parked, is generated and acquired based on the first condition (S22), and the approach trajectory candidate is the vehicle.
- the candidate approach trajectory determined not to satisfy the qualification condition is corrected based on a second condition that differs from the first condition (S42 to S45), and driving assistance is provided based on the corrected approach trajectory candidate.
- Evaluate the eligibility as a travel trajectory for and modify the generated travel trajectory candidates according to the evaluation results by changing the generation conditions. In particular, it is possible to reduce inappropriate operations such as switching between forward and backward travel and turning the steering wheel, making it possible to provide driving support based on a more appropriate travel trajectory than in the past.
- the trajectory on the entrance side of the parking lot is corrected from the location that is the cause of not satisfying the qualifying conditions.
- the parking lot network is a network in which links are set to aisles on which vehicles can travel in the parking lot, nodes are set at the connection points of the aisles, and the links are connected by the nodes.
- the first condition is a trajectory that travels on the links, so it is possible to generate an approach trajectory candidate using the parking lot network.
- the second condition is a condition for correcting the trajectory to meet the qualifying conditions by excluding the first condition, it is possible to correct the traveling trajectory to meet the qualifying conditions by excluding the first condition, which is the condition for generating the first approach trajectory candidate.
- the eligibility conditions include at least one of the following: no backing up during the preparation stage for entering the parking space, the number of times the vehicle switches between forward and backward movement is within the threshold, and the number of times the turning direction of the steering wheel is switched is within the threshold. Therefore, by correcting the running trajectory that accompanies the vehicle behavior that is not suitable as the running trajectory, it becomes possible to provide driving assistance based on a more appropriate running trajectory than in the past.
- the parking lot network is acquired (S3)
- the parking lot network is acquired (S3).
- the exit trajectory candidate which is a candidate for the vehicle trajectory from the parking position of the vehicle to the parking lot exit, is generated and acquired based on the first condition (S22).
- the candidate exit trajectory determined not to satisfy the qualifying condition is corrected based on a second condition different from the first condition (S42 to S45), and since driving assistance is provided based on the modified candidate exit trajectory, a candidate trajectory for the vehicle from the parking position of the vehicle to the exit of the parking lot is generated using the network in the parking lot, the eligibility of the generated trajectory candidate as a trajectory is evaluated, and the conditions for generating the once generated trajectory candidate are determined according to the evaluation results.
- a plurality of parking position candidates are acquired, and the parking position is finally determined from among the plurality of candidates at the timing of generating the static traveling trajectory in S5.
- the vehicle starts running on a road, but it is also applicable when the running start point is in a parking lot.
- the recommended travel path from the travel start point to the exit of the parking lot is also derived in S25.
- the traveling trajectory after correction when the traveling trajectory is corrected in S23, not only the traveling trajectory after correction but also the traveling trajectory before correction is subject to cost calculation (S24), but only the traveling trajectory after correction may be subject to cost calculation. Also, if there are no other candidates for the travel trajectory, the travel trajectory after correction may be generated as a static travel trajectory without calculating the cost.
- the cost for the travel path to the parking position is calculated only for the vehicle traveling (S24), but the cost may be calculated taking into account the walking to the destination after getting off the vehicle. That is, even if it is easy for the vehicle to travel to the parking position, a higher cost may be calculated for the travel path to the parking position where the burden of walking to the destination after that is large.
- vehicle control is performed (S11, S12) for traveling according to the generated travel trajectory after the travel trajectory to the parking position is generated, but it is also possible to omit the processing related to vehicle control after S11.
- the navigation device 1 may be a device that guides the user to a recommended parking position or a travel trajectory without controlling the vehicle based on the travel trajectory.
- the static travel trajectory that is finally generated is information that specifies a specific trajectory (a set of coordinates or a line) on which the vehicle travels, but it may be information to the extent that the road, lane, and passage on which the vehicle travels can be specified without specifying the specific trajectory. Further, it is also possible to specify only the road on which the vehicle travels and the parking position where the vehicle is parked in the parking lot without specifying the specific travel track.
- the lane network and the parking lot network are generated using the high-precision map information 16 and the facility information 17 (S3, S22, S26), but each network targeting roads and parking lots nationwide may be stored in the DB in advance and read from the DB as necessary.
- the high-precision map information possessed by the server device 4 includes both information on the lane shape of the road (road shape, curvature, lane width, etc. for each lane) and information on the division lines drawn on the road (roadway center line, lane boundary line, roadway outer line, guidance line, etc.), but it may contain only information on the division line, or may contain only information on the lane shape of the road. For example, even if only information about lane markings is included, it is possible to estimate information corresponding to information about lane shape of the road based on information about lane markings.
- the "information about lane markings" may be information specifying the type and arrangement of the lane markings themselves that divide the lanes, information specifying whether or not it is possible to change lanes between adjacent lanes, or information directly or indirectly specifying the shape of the lanes.
- part of the static travel trajectory is replaced with the dynamic travel trajectory as a means of reflecting the dynamic travel trajectory on the static travel trajectory (S9), but the trajectory may be corrected so that the static travel trajectory approaches the dynamic travel trajectory instead of replacing.
- the vehicle control ECU 40 controls all of the operations related to the behavior of the vehicle, such as accelerator operation, brake operation, and steering wheel operation, as automatic driving support for automatically driving without depending on the user's driving operation.
- the automatic driving assistance may be performed by the vehicle control ECU 40 controlling at least one of the accelerator operation, the brake operation, and the steering wheel operation, which are operations related to the behavior of the vehicle.
- manual driving by a user's driving operation will be explained assuming that the user performs all operations related to the behavior of the vehicle, such as accelerator operation, brake operation, and steering wheel operation.
- the driving assistance of the present invention is not limited to automatic driving assistance related to automatic driving of vehicles.
- voice or screen for example, lane change guidance, recommended vehicle speed guidance, etc.
- the user's driving operation may be assisted by displaying the static traveling trajectory and the dynamic traveling trajectory on the navigation screen.
- the automatic driving support program (FIG. 4) is configured to be executed by the navigation device 1, but it may be configured to be executed by an on-vehicle device other than the navigation device 1 or the vehicle control ECU 40.
- the vehicle-mounted device and the vehicle control ECU 40 are configured to acquire the current position of the vehicle, map information, and the like from the navigation device 1 and the server device 4 .
- the server device 4 may execute some or all of the steps of the automatic driving support program (FIG. 4). In that case, the server device 4 corresponds to the driving support device of the present application.
- the present invention can also be applied to mobile phones, smart phones, tablet terminals, personal computers, etc. (hereinafter referred to as mobile terminals, etc.). Also, it is possible to apply to a system composed of a server, a mobile terminal, and the like. In that case, each step of the above-described automatic driving support program (see FIG. 4) may be configured to be executed by either the server or the mobile terminal. However, when the present invention is applied to a mobile terminal or the like, it is necessary that a vehicle capable of executing automatic driving assistance and the mobile terminal or the like are communicably connected (whether wired or wireless).
- navigation device driving support device
- driving support system driving support system
- 3... information distribution center 4... server device
- 5... vehicle 16... high-precision map information, 17... facility information, 18... connection information, 19... road contour information, 33... navigation ECU, 40... vehicle control ECU, 51... CPU, 58... parking lot node, 59... parking lot link, 75... pedestrian passage space, 95-97... corrected traveling trajectory
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Human Computer Interaction (AREA)
- Computing Systems (AREA)
- Accounting & Taxation (AREA)
- Business, Economics & Management (AREA)
- Development Economics (AREA)
- Economics (AREA)
- General Business, Economics & Management (AREA)
- Operations Research (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
Description
現在位置検出部31は、GPS41、車速センサ42、ステアリングセンサ43、ジャイロセンサ44等からなり、現在の車両の位置、方位、車両の走行速度、現在時刻等を検出することが可能となっている。ここで、特に車速センサ42は、車両の移動距離や車速を検出する為のセンサであり、車両の駆動輪の回転に応じてパルスを発生させ、パルス信号をナビゲーションECU33に出力する。そして、ナビゲーションECU33は発生するパルスを計数することにより駆動輪の回転速度や移動距離を算出する。尚、上記4種類のセンサをナビゲーション装置1が全て備える必要はなく、これらの内の1又は複数種類のセンサのみをナビゲーション装置1が備える構成としても良い。
次に、右側の車線を制限速度を上限に走行して前方車両69を追い越し、且つ前方車両69との間を適切な車間距離D以上とするまでの第2の軌道L2を算出する。尚、第2の軌道L2は基本的に直線の軌道であり、また軌道の長さは、前方車両69の車速と道路の制限速度に基づいて算出される。
続いて、ステアリングの旋回を開始して左側の車線へと戻り、且つステアリングの位置が直進方向に戻るのに必要な第3の軌道L3を算出する。尚、第3の軌道L3は車両の現在の車速に基づいて車線変更を行う際に生じる横方向の加速度(横G)を算出し、横Gが自動運転支援に支障が生じることなく、また車両の乗員に不快感を与えない上限値(例えば0.2G)を超えないことを条件として、クロソイド曲線や円弧を用いてできる限り円滑で、且つできる限り車線変更に必要な距離が短くなる軌道を算出する。また、前方車両69との間に適切な車間距離D以上を維持することについても条件とする。
尚、動的走行軌道は、車外カメラ39やその他のセンサで取得した車両周辺の道路状況に基づいて生成されるので、動的走行軌道が生成される対象となる領域は、少なくとも車外カメラ39やその他のセンサによって車両周辺の道路状況を検出することが可能な範囲(検出範囲)内となる。
(1)移動距離(前進後退問わず)・・・移動距離[m]×1.0
(2)後退移動距離・・・移動距離[m]×10.0
(3)前進と後退を切り替える回数・・・回数×10.0
(4)旋回角度量・・・旋回角度×0.1
(5)ステアリングの旋回方向を切り替える回数・・・回数×5.0
(6)条件付き走行禁止領域を走行する距離・・・移動距離[m]×10.0
また、第2の修正パターンとしては、図20に示すように通路93の走行位置を通路の中央(即ち駐車場内ネットワークの駐車場リンク59上)に対して左側にずらして91の直進距離を延ばす方法が挙げられる。その結果、修正された走行軌道96は、駐車場の入口から駐車場に進入して最初に走行する通路92は中央を走行し、通路92から右折して通路93へと進入する際に旋回開始タイミングを遅らせて通路93の中央よりも左側へと進入し、そのまま通路93の左寄りを走行した後に右折して通路91の中央へと進入し、直進した後に駐車スペース60の前でやや左側に旋回して前記S42で算出された後退開始位置に到達する走行軌道とすることが可能となる。走行軌道96は駐車スペース60への進入準備段階での切り返しが存在しなくなり適格条件を満たすこととなる。
また、第3の修正パターンとしては、上記第1の修正パターンと第2の修正パターン組み合わせで、図21に示すように通路91の走行位置と通路93の走行位置を夫々通路の中央(即ち駐車場内ネットワークの駐車場リンク59上)に対して左側にずらす方法が挙げられる。その結果、修正された走行軌道97は、駐車場の入口から駐車場に進入して最初に走行する通路92は中央を走行し、通路92から右折して通路93へと進入する際に旋回開始タイミングを遅らせて通路93の中央よりも左側へと進入し、そのまま通路93の左寄りを走行した後に右折して通路91へと進入する際に再び旋回開始タイミングを遅らせて通路91の中央よりも左側へと進入し、そのまま直進して前記S42で算出された後退開始位置に到達する走行軌道とすることが可能となる。走行軌道97は駐車スペース60への進入準備段階での切り返しが存在しなくなり適格条件を満たすこととなる。
尚、上記のように(a)~(d)の適格条件を満たすことが第2条件となり、第2条件では第1条件である通路の中央(即ち駐車場内ネットワークの駐車場リンク59上)を走行する条件は除かれる。前記S44では第2条件に基づいて前記S22で一旦生成された走行軌道の修正を行う。
また、適格条件を満たさないと判定された進入軌道候補について、適格条件を満たさない要因となる箇所よりも駐車場の入口側の軌道を修正するので、適格条件を満たさない要因を解消したより適切な走行軌道への修正が可能となる。
また、駐車場内ネットワークは、駐車場内において車両が走行可能な通路にリンクを設定し、通路同士の接続点にノードを設定し、リンクを前記ノードで連結したネットワークであって、第1条件は、リンク上を走行する軌道とするので、駐車場内ネットワークを用いた進入軌道候補の生成が可能となる。
また、第2条件は、第1条件を除くことで適格条件を満たす軌道に修正する為の条件であるので、最初の進入軌道候補を生成した条件である第1条件を除外することで適格条件を満たす走行軌道への修正が可能となる。
また、適格条件は、駐車スペースへの進入準備段階での後退の発生がないこと、車両の後退距離が閾値以内、前進と後退を切り替える回数が閾値以内、ステアリングの旋回方向を切り替える回数が閾値以内の少なくとも一以上を含むので、走行軌道として適さない車両挙動を伴う走行軌道を修正することにより、従来に比べてより適切な走行軌道に基づく運転支援を行うことが可能となる。
また、車両が駐車場で駐車を行う場合に、駐車場内において車両が選択し得る経路を示したネットワークである駐車場内ネットワークを取得し(S3)、駐車場内ネットワークを用いて、車両の駐車位置から駐車場の出口までの車両の走行軌道の候補である退出軌道候補を、第1条件に基づいて生成して取得し(S22)、退出軌道候補が車両の走行軌道としての適格性を示す適格条件を満たすか否かを判定し(S41)、適格条件を満たさないと判定された場合に、適格条件を満たさないと判定された退出軌道候補を第1条件と異なる第2条件に基づいて修正し(S42~S45)、修正後の退出軌道候補に基づいて運転支援を行うので、駐車場内ネットワークを用いて車両の駐車位置から駐車場の出口までの車両の走行軌道の候補を一旦生成するとともに、生成した走行軌道の候補に対して走行軌道としての適格性を評価し、評価結果に応じて一旦生成された走行軌道の候補について生成条件を変えて修正することにより、特に前後進の切り替えやハンドル切り返し等の不適な操作を減らして、従来に比べてより適切な走行軌道に基づく運転支援を行うことが可能となる。
例えば、本実施形態では、駐車位置の候補を複数取得し、S5の静的走行軌道の生成を行なうタイミングで複数の候補の内から駐車位置を最終的に決定するが、最初に車両を駐車する駐車位置を一に決定し、その後に決定した駐車位置までの走行軌道を生成するようにしても良い。
Claims (7)
- 車両が駐車場で駐車を行う場合に、前記駐車場内において車両が選択し得る経路を示したネットワークである駐車場内ネットワークを取得する駐車場内ネットワーク取得手段と、
前記駐車場内ネットワークを用いて、駐車場の入口から車両を駐車する駐車位置までの車両の走行軌道の候補である進入軌道候補を、第1条件に基づいて生成して取得する進入軌道候補取得手段と、
前記進入軌道候補が車両の走行軌道としての適格性を示す適格条件を満たすか否かを判定する条件判定手段と、
前記条件判定手段によって前記適格条件を満たさないと判定された場合に、前記適格条件を満たさないと判定された前記進入軌道候補を前記第1条件と異なる第2条件に基づいて修正する走行軌道修正手段と、
修正後の前記進入軌道候補に基づいて運転支援を行う運転支援手段と、を有する運転支援装置。 - 前記走行軌道修正手段は、前記適格条件を満たさないと判定された前記進入軌道候補について、前記適格条件を満たさない要因となる箇所よりも駐車場の入口側の軌道を修正する請求項1に記載の運転支援装置。
- 前記駐車場内ネットワークは、駐車場内において車両が走行可能な通路にリンクを設定し、前記通路同士の接続点にノードを設定し、前記リンクを前記ノードで連結したネットワークであって、
前記第1条件は、前記リンク上を走行する軌道とすることである請求項1に記載の運転支援装置。 - 前記第2条件は、前記第1条件を除くことで前記適格条件を満たす軌道に修正する為の条件である請求項1に記載の運転支援装置。
- 前記適格条件は、駐車スペースへの進入準備段階での後退の発生がないこと、車両の後退距離が閾値以内、前進と後退を切り替える回数が閾値以内、ステアリングの旋回方向を切り替える回数が閾値以内の少なくとも一以上を含む請求項1乃至請求項4のいずれかに記載の運転支援装置。
- 車両が駐車する駐車場から退出する場合に、前記駐車場内において車両が選択し得る経路を示したネットワークである駐車場内ネットワークを取得する駐車場内ネットワーク取得手段と、
前記駐車場内ネットワークを用いて、車両が駐車する駐車位置から駐車場の出口までの車両の走行軌道の候補である退出軌道候補を、第1条件に基づいて生成して取得する退出軌道候補取得手段と、
前記退出軌道候補が車両の走行軌道としての適格性を示す適格条件を満たすか否かを判定する条件判定手段と、
前記条件判定手段によって前記適格条件を満たさないと判定された場合に、前記適格条件を満たさないと判定された前記退出軌道候補を前記第1条件と異なる第2条件に基づいて修正する走行軌道修正手段と、
修正後の前記退出軌道候補に基づいて運転支援を行う運転支援手段と、を有する運転支援装置。 - コンピュータを、
車両が駐車場で駐車を行う場合に、前記駐車場内において車両が選択し得る経路を示したネットワークである駐車場内ネットワークを取得する駐車場内ネットワーク取得手段と、
前記駐車場内ネットワークを用いて、駐車場の入口から車両を駐車する駐車位置までの車両の走行軌道の候補である進入軌道候補を、第1条件に基づいて生成して取得する進入軌道候補取得手段と、
前記進入軌道候補が車両の走行軌道としての適格性を示す適格条件を満たすか否かを判定する条件判定手段と、
前記条件判定手段によって前記適格条件を満たさないと判定された場合に、前記適格条件を満たさないと判定された前記進入軌道候補を前記第1条件と異なる第2条件に基づいて修正する走行軌道修正手段と、
修正後の前記進入軌道候補に基づいて運転支援を行う運転支援手段と、
して機能させる為のコンピュータプログラム。
Priority Applications (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202280089481.0A CN118696209A (zh) | 2022-01-24 | 2022-12-22 | 驾驶辅助装置及计算机程序 |
| EP22922191.6A EP4404171A4 (en) | 2022-01-24 | 2022-12-22 | DRIVING ASSISTANCE DEVICE AND COMPUTER PROGRAM |
| US18/709,143 US20250002006A1 (en) | 2022-01-24 | 2022-12-22 | Driving assistance device and computer program |
Applications Claiming Priority (4)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2022-008427 | 2022-01-24 | ||
| JP2022008427 | 2022-01-24 | ||
| JP2022146915A JP7740178B2 (ja) | 2022-01-24 | 2022-09-15 | 運転支援装置及びコンピュータプログラム |
| JP2022-146915 | 2022-09-15 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| WO2023140041A1 true WO2023140041A1 (ja) | 2023-07-27 |
Family
ID=87348210
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| PCT/JP2022/047398 Ceased WO2023140041A1 (ja) | 2022-01-24 | 2022-12-22 | 運転支援装置及びコンピュータプログラム |
Country Status (3)
| Country | Link |
|---|---|
| US (1) | US20250002006A1 (ja) |
| EP (1) | EP4404171A4 (ja) |
| WO (1) | WO2023140041A1 (ja) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20250224246A1 (en) * | 2024-01-05 | 2025-07-10 | Valeo Schalter Und Sensoren Gmbh | Global map based deep reinforcement learning for parking |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US12522215B2 (en) * | 2023-03-31 | 2026-01-13 | Torc Robotics, Inc. | Lane change path generation using piecewise clothoid segments |
| JP7646278B1 (ja) * | 2023-09-13 | 2025-03-17 | パナソニックオートモーティブシステムズ株式会社 | 駐車支援方法、駐車支援装置および駐車支援プログラム |
| KR20250143194A (ko) * | 2024-03-21 | 2025-10-01 | 현대자동차주식회사 | 자율 주행 차량 및 그의 제어 방법 |
| US20250334415A1 (en) * | 2024-04-26 | 2025-10-30 | Zoox, Inc. | Generating local graph data |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2018039294A (ja) | 2016-09-05 | 2018-03-15 | 日産自動車株式会社 | 駐車支援方法及び駐車支援装置 |
| JP2019128844A (ja) * | 2018-01-25 | 2019-08-01 | アイシン精機株式会社 | 駐車装置 |
| WO2019225270A1 (ja) * | 2018-05-23 | 2019-11-28 | 日立オートモティブシステムズ株式会社 | 駐車管理システム、車両制御装置、および、管制センタ |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114207687A (zh) * | 2019-07-26 | 2022-03-18 | 株式会社电装 | 停车辅助装置 |
-
2022
- 2022-12-22 WO PCT/JP2022/047398 patent/WO2023140041A1/ja not_active Ceased
- 2022-12-22 EP EP22922191.6A patent/EP4404171A4/en active Pending
- 2022-12-22 US US18/709,143 patent/US20250002006A1/en active Pending
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2018039294A (ja) | 2016-09-05 | 2018-03-15 | 日産自動車株式会社 | 駐車支援方法及び駐車支援装置 |
| JP2019128844A (ja) * | 2018-01-25 | 2019-08-01 | アイシン精機株式会社 | 駐車装置 |
| WO2019225270A1 (ja) * | 2018-05-23 | 2019-11-28 | 日立オートモティブシステムズ株式会社 | 駐車管理システム、車両制御装置、および、管制センタ |
Non-Patent Citations (1)
| Title |
|---|
| See also references of EP4404171A4 |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20250224246A1 (en) * | 2024-01-05 | 2025-07-10 | Valeo Schalter Und Sensoren Gmbh | Global map based deep reinforcement learning for parking |
Also Published As
| Publication number | Publication date |
|---|---|
| EP4404171A4 (en) | 2024-12-11 |
| EP4404171A1 (en) | 2024-07-24 |
| US20250002006A1 (en) | 2025-01-02 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP7347522B2 (ja) | 運転支援装置及びコンピュータプログラム | |
| US12528463B2 (en) | Driving assistance device | |
| JP7439726B2 (ja) | 運転支援装置及びコンピュータプログラム | |
| US12365342B2 (en) | Drive assistance device and computer program | |
| WO2023140041A1 (ja) | 運転支援装置及びコンピュータプログラム | |
| JP7439529B2 (ja) | 運転支援装置及びコンピュータプログラム | |
| US20240416954A1 (en) | Driving assistance device and computer program | |
| JP7443992B2 (ja) | 運転支援装置及びコンピュータプログラム | |
| US20240318969A1 (en) | Driving assistance device and computer program | |
| JP7683517B2 (ja) | 運転支援装置及びコンピュータプログラム | |
| JP2023080504A (ja) | 運転支援装置及びコンピュータプログラム | |
| JP7739909B2 (ja) | 運転支援装置及びコンピュータプログラム | |
| JP7533279B2 (ja) | 経路探索装置及びコンピュータプログラム | |
| JP7800246B2 (ja) | 運転支援装置及びコンピュータプログラム | |
| JP7768073B2 (ja) | 運転支援装置及びコンピュータプログラム | |
| JP7552288B2 (ja) | 運転支援装置及びコンピュータプログラム | |
| JP7740178B2 (ja) | 運転支援装置及びコンピュータプログラム | |
| JP7800348B2 (ja) | 運転支援装置及びコンピュータプログラム | |
| EP4660036A1 (en) | Driving assistance device and computer program | |
| CN118696209A (zh) | 驾驶辅助装置及计算机程序 | |
| JP2025117189A (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: 22922191 Country of ref document: EP Kind code of ref document: A1 |
|
| WWE | Wipo information: entry into national phase |
Ref document number: 2022922191 Country of ref document: EP |
|
| ENP | Entry into the national phase |
Ref document number: 2022922191 Country of ref document: EP Effective date: 20240418 |
|
| WWE | Wipo information: entry into national phase |
Ref document number: 18709143 Country of ref document: US |
|
| WWE | Wipo information: entry into national phase |
Ref document number: 202280089481.0 Country of ref document: CN |
|
| NENP | Non-entry into the national phase |
Ref country code: DE |