WO2013069054A1 - 自律走行システム - Google Patents

自律走行システム Download PDF

Info

Publication number
WO2013069054A1
WO2013069054A1 PCT/JP2011/006248 JP2011006248W WO2013069054A1 WO 2013069054 A1 WO2013069054 A1 WO 2013069054A1 JP 2011006248 W JP2011006248 W JP 2011006248W WO 2013069054 A1 WO2013069054 A1 WO 2013069054A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
area
boundary
travel
blockage
Prior art date
Application number
PCT/JP2011/006248
Other languages
English (en)
French (fr)
Inventor
幹雄 板東
川股　幸博
Original Assignee
株式会社 日立製作所
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 株式会社 日立製作所 filed Critical 株式会社 日立製作所
Priority to JP2013542686A priority Critical patent/JP5868420B2/ja
Priority to CA2854274A priority patent/CA2854274C/en
Priority to AU2011380820A priority patent/AU2011380820B2/en
Priority to US14/357,130 priority patent/US8983709B2/en
Priority to DE112011105829.2T priority patent/DE112011105829T5/de
Priority to PCT/JP2011/006248 priority patent/WO2013069054A1/ja
Publication of WO2013069054A1 publication Critical patent/WO2013069054A1/ja

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
    • 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, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/14—Adaptive cruise control
    • 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/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • 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/3453—Special cost functions, i.e. other than distance or default speed limit of road segments
    • G01C21/3461—Preferred or disfavoured areas, e.g. dangerous zones, toll or emission zones, intersections, manoeuvre types, segments such as motorways, toll roads, ferries
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/09—Arrangements for giving variable traffic instructions
    • G08G1/0962—Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/09—Arrangements for giving variable traffic instructions
    • G08G1/0962—Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
    • G08G1/0967—Systems involving transmission of highway information, e.g. weather, speed limits
    • G08G1/096708—Systems involving transmission of highway information, e.g. weather, speed limits where the received information might be used to generate an automatic action on the vehicle control
    • G08G1/096716—Systems involving transmission of highway information, e.g. weather, speed limits where the received information might be used to generate an automatic action on the vehicle control where the received information does not generate an automatic action on the vehicle control
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/09—Arrangements for giving variable traffic instructions
    • G08G1/0962—Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
    • G08G1/0967—Systems involving transmission of highway information, e.g. weather, speed limits
    • G08G1/096733—Systems involving transmission of highway information, e.g. weather, speed limits where a selection of the information might take place
    • G08G1/096758—Systems involving transmission of highway information, e.g. weather, speed limits where a selection of the information might take place where no selection takes place on the transmitted or the received information
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/09—Arrangements for giving variable traffic instructions
    • G08G1/0962—Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
    • G08G1/0967—Systems involving transmission of highway information, e.g. weather, speed limits
    • G08G1/096766—Systems involving transmission of highway information, e.g. weather, speed limits where the system is characterised by the origin of the information transmission
    • G08G1/096783—Systems involving transmission of highway information, e.g. weather, speed limits where the system is characterised by the origin of the information transmission where the origin of the information is a roadside individual element

Definitions

  • the present invention relates to a system in which a moving body such as an automobile or a train travels autonomously.
  • the vehicle travels while judging the area where each vehicle can move and setting a route to avoid an obstacle.
  • a topological map that represents road connection conditions with dots and lines is used to set points that are end points of inaccessible areas and to avoid the points. Efficient and safe autonomous driving is enabled by driving according to the driving route on the map.
  • a travelable space is recognized, a travel route in the space is set, and movement according to the travel route allows free and efficient in the space. Realize action.
  • autonomous traveling is realized using a single map data.
  • an area using a topological map (topological area) in which road connections are represented by points and lines and an area (metric area) using a metric map representing a travelable space are obtained. Even in the case of coexistence, it is possible to perform blockage management limited to the topological area and blockage management limited to the metric area.
  • the blocking method at the boundary between the topological region and the metric region is not considered in the prior art.
  • the boundary between the topological area and the metric area exists such that the boundary point of the topological map is connected to the boundary side of the metric map.
  • the boundary point of the topological map and the boundary edge of the metric map connected to it are simply occluded in order to guarantee safe operation. No vehicle can pass the boundary.
  • the operation efficiency may be lowered by stopping the vehicle that may originally enter or issuing a detour instruction to a vehicle that does not require detour. There is a risk of doing.
  • the problem of such a decrease in operation efficiency is that, as blockage management at the boundary between the topological area and the metric area, the corresponding boundary points and boundary sides are not blocked all but divided into a plurality of areas.
  • the problem is solved by opening the blockage of the non-existent area.
  • the operation of moving objects can be safely and efficiently performed by setting in detail the blockage area at the boundary where the map representation method changes from topological to metric or vice versa. It can be carried out.
  • the configuration of the target autonomous traveling system is shown in FIG.
  • the autonomous traveling system includes a plurality of management vehicles 101 and an operation management unit 102 that is a center for managing the vehicles.
  • the operation management unit 102 has a map database 103 in which a topological area and a metric area are mixed.
  • the data structure of the map database 103 As the data structure of the map database 103, the data structure of the topological area is shown in FIG. 2, and the data structure of the metric area is shown in FIG.
  • the topological area refers to an area managed by a topological map in which road shapes and road connections are represented by a network of dots and lines.
  • the map data of the topological area includes a link ID 201 that uniquely represents a link in the topological map, a link start point 202 that represents the start point coordinates of the link represented by the link ID 201, and a link end point 203 that represents the end point coordinates of the link represented by the link ID 201.
  • a link division number 204 that represents the number of sublinks obtained by dividing the link represented by the link ID 201; a sublink ID 205 that uniquely represents each of the sublinks obtained by dividing the link represented by the link ID 201; and a starting point for each sublink.
  • a sublink start point 206 and a sublink end point 207 representing coordinates and end point coordinates are stored.
  • the metric area is an area managed by a metric map representing a space where the vehicle can travel, such as a road shape, and is an area represented independently of the topological area.
  • the map data of the metric area includes a metric ID 301 that uniquely represents the metric area in the map database, a metric shape 302 that represents the shape of the area indicated by the metric ID 301, and the total number of links connected to the area indicated by the metric ID 301.
  • the number of connection links 303, the connection link 304 representing the link ID of each link connected to the metric area, the connection node 305 that is the coordinates of the node connected to the metric area of the connection link 304, Connection points 306 representing coordinates on the metric area are stored.
  • the area number 307 indicating the number of areas obtained by dividing the metric area indicated by the metric ID 301 into a plurality of areas
  • the area ID 308 uniquely indicating each area obtained by dividing the area indicated by the metric ID 301
  • the area ID 308 are indicated.
  • An area shape 309 representing the shape of the region is stored. It is assumed that each area is an area in which the metric area is divided into a plurality of areas in advance so that no overlap or discontinuity occurs, and each area is divided into rectangular areas by, for example, latitude and longitude values.
  • FIG. 4 shows a representation example of the metric area.
  • IDs of topological area links 4011 and 4012 are set as connection links 304
  • topological area nodes 4013 and 4014 are set as connection nodes.
  • 6 points of nodes 4015 for each lane indicated by black circles are set as connection points.
  • the road shape or the shape of the travelable area is represented by a road end / boundary end line or point sequence, or the travel area plane is represented by a polygon as shown in FIG. 4 (c).
  • the represented map can also be cited as a map representation of the metric area. Also in the map representation of these metric areas, the link of the topological area represented by the broken line is the connection link 304, the node of the topological area represented by the white circle is the connection node 305, and the point of the metric area corresponding to the connection node By setting the coordinates of the points 4016 and 4017 to the connection point 306, the connection between the topological area and the metric area is defined.
  • a vehicle position management unit 104 that periodically stores and updates the position of each managed vehicle 101, and a vehicle passage monitoring unit that monitors the managed vehicle 101 passing through the boundary between the topological region and the metric region.
  • a blockage area calculation / setting unit 106 that determines a blockage area, which will be described later
  • a vehicle travel plan unit 107 that plans a future travel route of the management vehicle 101
  • the communication unit 108 includes a block area database 109 that stores the block area set by the block area calculation / setting unit 106, and a memory area 110 that stores position information of each vehicle.
  • a user 111 such as an operation management operator of the operation management unit 102 can set and store the priority order and destination of each managed vehicle 101 in real time.
  • FIGS. FIG. 5 shows the data structure of the closed area set as the topological area in the closed area database 109.
  • the link ID 501 and the sub link ID 502 have the same values as the link ID 201 of the map database 103 and the sub link ID 205 of each sub link obtained by dividing the link.
  • the identification number of the management vehicle that closes the sublink represented by each sublink ID 502 is stored in the blocked vehicle number 503.
  • a plurality of blocked vehicle numbers 503 can be set for one sublink ID 502 and are registered in the order of priority of managed vehicles. The maximum number that can be registered is equal to the maximum number of managed vehicles.
  • FIG. 6 shows the data structure of the block area set as the metric area in the block area database 109.
  • the metric ID 301 of the map database 103 and the area ID 308 of each area obtained by dividing the metric area The metric ID 601 and the area ID 602 have the same value.
  • the identification number of the management vehicle that blocks the area represented by each area ID 602 is stored in the blocked vehicle number 603.
  • a plurality of blocked vehicle numbers 603 can be set for one area ID 602, which are also registered in the order of priority of managed vehicles, and the maximum number that can be registered is equal to the maximum number of managed vehicles.
  • a road-to-vehicle communication unit 112 that performs communication between the operation management unit 102 and the managed vehicle 101, an exercise plan unit 113 that plans vehicle motion based on a travel plan from the operation management unit 102, The motion control unit 114 that controls the vehicle based on the motion plan of the vehicle, the map database 115 that is the same as the map database 103 that the operation management unit 102 has, and the vehicle position that calculates the position of the vehicle using a sensor such as GPS A calculation unit 116 is included.
  • communication between the management vehicle 101 and the operation management unit 102 is performed via a road device 117.
  • This road device has a vehicle detection function such as a monitoring camera or a beacon.
  • FIG. 7 shows a processing flow of the vehicle position calculation unit 116.
  • step 901 information of sensors that collect data for determining the position of the vehicle such as a GPS, a gyro sensor, an acceleration sensor, and a speed sensor (not shown) is acquired at a certain cycle.
  • step 902 an absolute position indicating latitude / longitude is calculated using the obtained sensor information.
  • the absolute position may be calculated by correcting the result of dead reckoning navigation using an inertial sensor such as a gyro sensor, an acceleration sensor, or a speed sensor using a positioning calculation result by GPS or the like in addition to direct measurement by GPS. .
  • step 903 map data near the calculated absolute position is acquired from the map database 115.
  • the management vehicle 101 checks whether there is boundary passing information indicating the passing state of the management vehicle at the boundary between the topological area and the metric area in the map database 115. If there is no boundary passing information, the process proceeds to step 905, where the boundary passing is performed. If there is information, the process proceeds to step 906.
  • the vehicle boundary passage information is received from the road-to-vehicle communication unit 112 from the road device 117 that receives the result obtained by the vehicle passage monitoring unit 105 of the operation management unit 102 or notifies that the vehicle has passed the boundary. Is received by the road-to-vehicle communication unit 112. Examples of the road device 117 that sends a signal notifying that the vehicle has passed the boundary include a beacon and a monitoring camera.
  • step 905 it is determined whether or not the position of the host vehicle is on the metric area. At this time, since there is no boundary passage information, the passage of the boundary is determined according to the absolute position of the vehicle. If the current vehicle position is not on the metric area, the process proceeds to step 907. If the absolute position is on the metric area, the process proceeds to step 908.
  • step 906 boundary passing information indicating whether or not the host vehicle has passed the boundary is confirmed. If the boundary passing information is “passing” indicating that the host vehicle has passed the region boundary, In step 910, it is confirmed whether or not the position of the own vehicle at the previous measurement is within the topological area. If the area where the own vehicle was at the previous measurement is within the topological area, the current position is a metric. If it is determined that the current vehicle is in the metric area, it is determined that the current position is in the topological area, and the process proceeds to step 907. On the other hand, if the boundary passing information is “not passed” indicating that the host vehicle has not passed the region boundary in step 906, the process proceeds to step 911.
  • step 911 it is confirmed whether the position of the own vehicle at the previous measurement is in the metric area. If the position of the own vehicle at the previous measurement is in the metric area, it is determined that the current position is in the metric area. If not, it is determined that the current position is in the topological region, and the process proceeds to step 907.
  • the calculated absolute position is projected onto the topological area.
  • Projection of the absolute position on the topological area may be performed by dropping a perpendicular foot onto the topological area from the absolute position coordinates indicating the current position.
  • the absolute position is projected onto the metric area.
  • a description example of the three types of metric areas shown in FIG. First, when the metric area is expressed by using a plurality of topological networks as in the metric area expression of FIG. 4A, the projection is performed by dropping a perpendicular foot onto each topological network in the same manner as the topological area, The point where the distance between the absolute position and the projected point is the closest is taken as the projected point.
  • the boundary shape of the traveling area is represented by a point sequence as in the metric region expression of FIG. 4B, a polygon connecting points located on the outermost side of the point sequence is considered, and the absolute position with respect to the polygon plane is considered. What is necessary is just to obtain a projection point.
  • a point obtained by projecting the absolute position to the polygon plane may be obtained.
  • step 909 the position of the projection point calculated in steps 907 and 908 is converted into the coordinates on the map in the map database 115 and output as the vehicle position.
  • the own vehicle position calculation unit 116 sequentially calculates the own vehicle position by repeating the above processing flow.
  • the calculated absolute position and own vehicle position of each managed vehicle 101 are sent from the road-to-vehicle communication unit 112 to the communication unit 108 of the operation management unit 102 via the road device 117.
  • the boundary passing information is sent to the operation management unit 102 together with the absolute position and the own vehicle position of each managed vehicle 101.
  • the communication unit 108 sends the absolute position and the own vehicle position of each managed vehicle 101 sent from the road device 117 to the vehicle position management unit 104.
  • the vehicle position management unit 104 stores the latest absolute position and own vehicle position of the received management vehicle in the memory area 110. Further, when boundary passing information is sent from the road device 117, the information is stored in the memory area 110 together with the latest absolute position and own vehicle position of the managed vehicle.
  • FIG. 9 shows the data structure of the memory area 110. Following the total number of managed vehicles 701, a certain memory is allocated to each managed vehicle, and the priority 703, destination 704, own vehicle position 705 and absolute position of the managed vehicle linked to the managed vehicle number 702 706 and boundary passage information 707 are stored. Further, the value of the own vehicle position 705 is retracted to the previous own vehicle position 708 before being updated to the latest information on the own vehicle position. Information on all managed vehicles 101 is collected in the memory area 110. The priority order 703 and the destination 704 of each managed vehicle are determined in advance by the user 111, and can be changed, set and saved in real time thereafter.
  • the vehicle position management unit 104 stores information sent from each managed vehicle in the memory area 110 and then sends a message to the vehicle passage monitoring unit 105 that the information on the managed vehicle has been updated.
  • the vehicle passage monitoring unit 105 checks whether each managed vehicle has passed the boundary from the position of each managed vehicle stored in the memory area 110 and the value of the boundary passage information, and if the latest vehicle transmitted from the managed vehicle 101 is checked. When there is a discrepancy between the own vehicle position and the previous vehicle position and the value of the boundary passage information, the value of the boundary passage information is assumed to be correct and the own vehicle position is corrected.
  • the processing flow of the vehicle passage monitoring unit 105 is shown in FIG.
  • the vehicle passage monitoring unit 105 always waits for a message from the vehicle position management unit 104 (step 1001), and proceeds to step 1002 when a message is received.
  • step 1002 information on the own vehicle position 705 and boundary passing information 707 and the previous own vehicle position 708 is acquired for one unchecked managed vehicle stored in the memory area 110.
  • step 1003 it is checked whether there is a contradiction between the own vehicle position of the management vehicle and the area where the previous vehicle position exists and the boundary passage information. As a possibility of this contradiction, the own vehicle position calculation unit 116 of the management vehicle 101 calculates the own vehicle position without receiving the information on the road device 117, and the operation management unit 102 receives the information of the road device 117.
  • step 1004. If there is no contradiction, the process proceeds to step 1005. In step 1004, since the own vehicle position calculated by the management vehicle 101 is incorrect, the operation management unit 102 corrects the own vehicle position.
  • FIG. 11 shows a processing flow of processing for correcting the own vehicle position of the managed vehicle.
  • the boundary passage information is determined in step 1101. If the boundary passage information is “pass”, the process proceeds to step 1103 to determine whether the previous vehicle position is in the topological region, and is determined to be in the topological region. In the case (step 1103: Yes), the process proceeds to step 1105, and when it is determined that it is in the metric area (step 1103: No), the process proceeds to step 1104.
  • step 1101 If it is determined in step 1101 that the boundary passage information is “non-passing”, the process proceeds to step 1102 to determine whether the previous vehicle position is in the metric region, and if it is determined to be in the metric region (step 1102: If “Yes”, the process proceeds to step 1105, and if it is determined to be within the topological area (step 1102: No), the process proceeds to step 1104.
  • step 1106 the vehicle position is corrected by writing the vehicle position calculated in step 1104 or step 1105 to the vehicle position in the memory area 110.
  • step 1005 whether the total number of managed vehicles 701 stored in the memory area 110 is compared with the number of managed vehicles 101 checked so far, and all managed vehicles 101 have been checked. Judging. If all managed vehicles 101 are checked, the process proceeds to step 1006. If there is an unchecked managed vehicle 101, the process returns to step 1002. In step 1006, a message is sent to the blockage area calculation / setting unit 106 notifying that all the managed vehicles 101 have been checked.
  • the blockage area calculation / setting unit 106 calculates the blockage area set for each management vehicle on the map database 103 from the vehicle positions of all the management vehicles 101 stored in the memory area 110 and the map information of the map database 103. And set in the closed area database 109.
  • step 1201 it is checked whether a message is sent from the vehicle passage monitoring unit 105. If the message has not been sent, the process waits until the timing for checking the reception of the message again. If the message has been sent, the process proceeds to step 1202.
  • step 1202 the own vehicle position 705 and the absolute position 706 of the management vehicle 101 are acquired from the memory area 110 in descending order of priority 703, and the process proceeds to step 1203.
  • step 1203 map data around the current position of the managed vehicle is acquired from the map database 103 using the information of the own vehicle position 705 of the managed vehicle acquired in step 1202, and the process proceeds to step 1204.
  • step 1204 a blockage range is set on the map data in the vicinity of the management vehicle acquired in step 1203 for the own vehicle position 705 of the management vehicle acquired in step 1202, and the blockage region database 109 is set as the blockage range. Save to
  • FIG. 13 shows a detailed processing flow for setting the closed area in step 1204.
  • step 1301 it is determined whether the area where the own vehicle position 705 of the management vehicle 101 exists is a topological area or a metric area.
  • the process proceeds to step 1302.
  • the process proceeds to step 1310.
  • step 1302 a value obtained by subtracting the total blocked area setting distance, which is the distance where the blocked area has already been set from the own vehicle position of the management vehicle, from the threshold value that is the maximum distance value when setting the blocked area, that is, the blocked area. Is determined to be longer than the distance from the end point of the sublink included in the already set blocked area to the next sublink end point.
  • the total blocked area setting distance is calculated by calculating the sum of the lengths of the sublinks that have already set the blocked area. If the remaining distance in which the blockage area can be set is longer than the distance to the next sublink end point, the process proceeds to step 1303. If the remaining distance in which the blockage area can be set is shorter than the distance to the next sublink end point, the next sublink cannot be further added as a blockage area, and the process proceeds to step 1313.
  • step 1303 the sublink next to the sublink already included in the blocked area is set as the blocked area, added to the blocked area, and the process proceeds to step 1304.
  • step 1304 it is determined whether the node at the end point of the sublink newly added to the blockage area is a branch node or a connection node serving as a boundary point of the map area. If the end point of the sublink is a boundary point existing at the boundary of the map area, the process proceeds to step 1305. If the end point of the sublink is a branch node where the link branches, the process proceeds to step 1306. If it is neither a branch node nor a map area boundary point, the process returns to step 1302.
  • step 1305 since the boundary of the map area and the block area overlap, the boundary point of the topological area and the boundary edge of the connected metric area are set as the block area, and the process proceeds to step 1313.
  • step 1306 it is determined whether or not the operation management unit 102 has set a travel route (or at least the next link to which the managed vehicle 101 travels) on which the managed vehicle is scheduled to travel. If the management vehicle 101 does not have a travel route scheduled to travel in the future, the link to be traveled next cannot be specified, so the expansion of the blockage area is stopped and the process proceeds to step 1307. If a travel route on which the management vehicle is scheduled to travel is set, the process proceeds to step 1308. In step 1307, the blockage is closed up to the node where the blockage region has already been set, and the process proceeds to step 1313.
  • step 1308 for each link connected to the branch node, a blocked area has already been set by another managed vehicle (that is, a higher-priority managed vehicle) in the sub-link connected to the branch node.
  • blockage is not set for all the sublinks connected to the branch node, the process proceeds to step 1309.
  • step 1309 according to the travel route of the management vehicle 101 from the branch node, a blockage area is set for the first sublink of the link to be connected next, and the process returns to step 1302.
  • step 1310 an area covering a certain range centering on the position of the management vehicle 101 is selected and set as a closed area, and the process proceeds to step 1311.
  • the shape of a certain range is assumed to be one continuous planar shape such as a circle, an ellipse, a rectangle, or a polygon.
  • step 1311 it is determined whether or not the boundary of the metric area exists in the area set as the blocked area. Whether or not a metric area boundary exists in the area is determined by whether or not the connection point 306 is included in this area. If there is no metric area boundary in the blocked area, the process proceeds to step 1313. However, if there is a metric region boundary within the blocked region, the process proceeds to step 1312. In step 1312, the boundary of the metric area included in the area set as the blocked area is set as the boundary of the blocked area, and the inside of the metric area including the end of the plane is reset as the blocked area, and the process proceeds to step 1313. In step 1313, the set blocked area and the managed vehicle number of the managed vehicle are stored in the blocked area database 109, and the process ends.
  • a blocked area is set for each sublink within a predetermined distance on the link scheduled to travel ahead of the host vehicle position, and the managed vehicle in the metric area
  • the closed region is set in a predetermined shape.
  • a closed area is set at the boundary between these areas.
  • step 1205 it is determined whether the setting of the blocked area is completed for all the management vehicles 101.
  • the process proceeds to step 1206. If there is a managed vehicle 101 for which the setting of the blockage area has not been completed, the process returns to step 1202 and the process is repeated for the remaining managed vehicles.
  • step 1206 a map area is selected from the map database 103, and the process proceeds to step 1207.
  • the selection order of map areas may be determined in advance.
  • step 1207 it is determined with reference to the blocked area database 109 whether or not a blocked area is set at the boundary of the map area selected in step 1206. If no block area is set at the boundary of the map area, the process proceeds to step 1212. If a closed area is set at the boundary of the map area, the process proceeds to step 1208.
  • step 1208 the vehicle position and the management of each of the managed vehicles in which the blocked area is set in the topological area among all the managed vehicles that set the blocked area with respect to the boundary of the target map area from the blocked area database 109.
  • step 1209 the set blockage area is divided into a plurality of areas based on the position of the management vehicle 101 acquired in step 1208 in the section within the topological area and closest to the boundary of the map area. Control goes to step 1210.
  • FIG. 14 shows a flowchart of the block area dividing process in step 1209.
  • FIG. 15 shows an example of blockage area division.
  • step 1400 it is checked whether or not a management vehicle to be processed is obtained. If there is no management vehicle to be processed, that is, if there is no management vehicle on the topological area side, the blockage area is not further divided. The process is terminated as it is.
  • step 1401 a link on the topological area side connected to the boundary point registered as the block area of the target area boundary is selected, and the process proceeds to step 1402.
  • a link connected to the boundary point is searched from the map database 103. In the example shown in FIG.
  • the node 1501 on the boundary border AB of the region is a boundary point
  • the link on the topological region side to be connected is a link 1503 having nodes 1501 and 1502 as end points.
  • one of the managed vehicles obtained in step 1208 having a closed area set at this area boundary is selected in ascending order of the managed vehicle number.
  • the topological network distance is the sum of the link distances from the boundary point to the position of the target managed vehicle on the topological network.
  • the topological network distance is the sum of the distance from the node 1501 to the node 1502, the distance from the node 1502 to the node 1505, and the distance from the node 1505 to the position of the management vehicle 1504. Become.
  • step 1404 it is determined whether the topological network distance D (id) calculated in step 1403 is smaller than the smallest value (Dmin) among the topological network distances calculated so far in this process. ) Is equal to or greater than Dmin, the process proceeds to step 1405, and if it is smaller than Dmin, the process proceeds to step 1406. In step 1405, the topological network distance D (id) calculated in step 1403 is equal to the smallest value Dmin among the topological network distances calculated so far, and the priority order 703 of the selected vehicle acquired in step 1403 ( It is determined whether or not (p (id)) is larger than the priority 703 (pmin) of the managed vehicle having the smallest topological network distance calculated so far.
  • step 1406 If this determination result is true, the process proceeds to step 1406. If the topological network distance of the selected vehicle is greater than the topological network distance calculated so far or the priority 703 is low, the process proceeds to step 1407. In step 1406, the topological network distance calculated in step 1403 is stored as the minimum distance, the management vehicle number and its priority order 703 are stored, and the process proceeds to step 1407. Prior to this processing, it is assumed that Dmin and pmin are initialized to appropriate values. In step 1407, it is determined whether all the target managed vehicles have been selected by selecting all target managed vehicles. If the processing has been performed for all target managed vehicles, the process proceeds to step 1408. Return to 1402 and repeat the process.
  • step 1408 the vehicle number having the smallest topological network distance from the boundary point is selected, and the process proceeds to step 1409.
  • step 1409 a point obtained by orthogonally projecting the own vehicle position of the management vehicle selected in step 1408 on the link connected to the boundary point selected in step 1401 or its extension line is obtained, and the process proceeds to step 1410.
  • a point 1507 obtained by orthogonally projecting the position of the selected management vehicle 1504 with respect to the link 1503 connected to the boundary point and its extension line 1506 is obtained.
  • step 1410 a straight line L ( ⁇ ) that forms an angle ⁇ with a link connected to the boundary point or an extension line around the orthogonally projected point is obtained, and the process proceeds to step 1411.
  • ⁇ straight line L
  • a straight line 1508 that forms an angle with a straight line 1506 around a point 1507 obtained by orthogonally projecting the position of the management vehicle 1504 as a boundary point is obtained.
  • step 1411 an intersection between the straight line L ( ⁇ ) obtained in step 1410 and the boundary side where the blockage area is set is obtained, set as a division point, and the process proceeds to step 1412. At this time, if it does not intersect with the boundary side, an unusable value is set to the dividing point.
  • an intersection 1509 between the straight line 1508 and the boundary side AB is obtained.
  • step 1412 when the total number of division points becomes larger than the predetermined maximum number of divisions, the process is terminated.
  • step 1410 If the total number of division points is smaller than the predetermined maximum number of divisions, the process returns to step 1410 and the processing from step 1410 to step 1412 is repeated.
  • the boundary side can be simply equally divided by changing the angle ⁇ according to the distance between the selected vehicle position and the boundary side.
  • step 1210 the position of the management vehicle 101 around the boundary of the map area acquired in step 1208 is taken into consideration and defined as one or more small areas through the boundary division processing in step 1209. Open / close of the closed area at the boundary of the map area is set, and the process proceeds to step 1211.
  • FIG. 16 shows a flow of processing for releasing the blockage of each block area at the map area boundary in step 1210 in units of small areas.
  • step 1601 the dividing point of the boundary side set in step 1209 is acquired. A small area is formed between these dividing points on the boundary side. If the boundary side is not divided by the processing in step 1209, the boundary side end is regarded as a dividing point, and the boundary side itself is treated as a small area.
  • a table shown in FIG. 8 is created for each small area. In this table, serial numbers are set in a column 801 in the order of acquisition of small areas. In each row, the coordinates of the start point 802 and end point 803 of each small area are set. This uses the coordinates of the dividing points located at both ends of the small area. Then, the blockage status 804 of each small area is set. Initially, all “non-blocking” is set in the blocking state 804.
  • step 1602 one managed vehicle existing in the metric area is selected from the vehicles in the vicinity of the blockage area acquired in step 1208, the position of the own vehicle is acquired, and the process proceeds to step 1603.
  • step 1603 a straight line Lp parallel to the topological region side link connected to the boundary point is obtained from the own vehicle position of the management vehicle selected in step 1602, and the process proceeds to step 1604.
  • step 1604 the intersection of the straight line Lp and the boundary side is obtained, the number of the small area including the intersection is selected, and the process proceeds to step 1605.
  • step 1605 the block of the small area number 804 acquired in step 1604 is set to block, and the process proceeds to step 1606.
  • step 1606 all the vehicles existing in the metric area are selected from the vehicles acquired in step 1208, it is determined whether the processing from step 1602 to step 1605 has been performed, and all the target vehicles are selected. If so, the process ends. If there is a target vehicle that has not been selected, the process returns to step 1602 to repeat the process.
  • the boundary edge of the map area is divided into a plurality of small areas according to the positional relationship between the paper management vehicle on the topological area side approaching the boundary edge and the boundary line, and the length of each small area is determined. To decide.
  • FIG. 17 shows an example of the process shown in FIG. It is assumed that the side AB of the plane 1701 of the metric region is a boundary side, and a closed region is set for the boundary side by the process of step 1204. Then, it is assumed that the boundary side AB is divided into five small areas of AC, CO, OD, DE, and EB by the management vehicle 1702 in the topological area by the processing of step 1209. Further, when there are three managed vehicles 1703, 1704, and 1705 in the metric area section acquired in the process of step 1602, links of the topological network connected to the boundary point O from the own vehicle position of each managed vehicle. A small region including a point that intersects with the side AB is drawn as a closed region. In the case of the example in FIG. 17, since the boundary line and the parallel line intersect in the small areas AC and EB, “blocking” is set as the blocking state of these small areas.
  • step 1211 a certain distance from a line segment whose end points are the coordinates of the start point 802 and the end point 803 of the small area where the non-blocking state is set and the blockage is released is set.
  • the metric area in the range is also released from the blocked area, the blocked area in the metric area is reset, the area database is updated, and the process proceeds to step 1212.
  • the shape of the blockage to be released may be a shape such as a circle, an ellipse, a rectangle, or a polygon including a line segment whose end points are the coordinates of the start point 802 and the end point 803 of the small region.
  • step 1212 it is determined whether or not the release of the closed area has been completed at the boundaries of all the map areas. If the release of the closed area has been completed at the boundaries of all the map areas, the process proceeds to step 1213. If there is a map area for which release of the closed area has not been completed, the process returns to step 1206 to repeat the process. In step 1213, a message indicating that the blockage release process has been completed is transmitted to the vehicle travel planning unit 107.
  • the boundary side where the blockage region is set is divided into a plurality of regions to set the blockage status of the blockage region in more detail.
  • the vehicle travel planning unit 107 receives the message from the blockage area calculation / setting unit 106 and stores the information on the own vehicle position of each managed vehicle stored in the memory area 110 and the map database 103 and the blockage area database 109.
  • the information is used to plan the travel route of each managed vehicle.
  • the travel route plan is based on the passing points corresponding to the travel route from the management vehicle's own vehicle position within the blocked area set by each managed vehicle to the destination or blocked area end point set for the managed vehicle. Expressed in series. In the case of the topological region, the positions of the nodes included in the travel route are arranged in the passing order.
  • target points that pass every certain distance are determined, and the positions are arranged in the order of passage.
  • the position of the boundary point that is, the position of the end point of the link connected to the metric area is set in the metric area. If there is a small area where no blockage is set on the boundary side, the small area is moved to that area and the point is registered as a passing point. The registered passing points are transmitted to each vehicle through the communication unit 108.
  • FIG. 18 shows a flow for creating a travel route plan in the vehicle travel planning unit 107.
  • step 1801 one managed vehicle is selected from all managed vehicles in the order of priority 703, and the process proceeds to step 1802.
  • step 1802 information on the destination 704 and the own vehicle position 705 corresponding to the managed vehicle number 702 of the managed vehicle selected in step 1801 from the memory area 110 is acquired, and further, the topological area and metric area in the closed area database 109 are acquired. From the information of each blocked area, a blocked area including the management vehicle number of the selected managed vehicle is extracted from the blocked vehicle numbers 503 and 603, and the blockage is set in the blocked area. All sublink IDs 502 or area IDs 602 are acquired, and the process proceeds to step 1803.
  • step 1803 it is determined whether or not a map area boundary exists in the extracted occlusion area. Whether the boundary of the map area exists is determined by reading the area shape of the area corresponding to the area ID acquired in step 1802 from the data corresponding to the metric ID of the metric area, and connecting points in the area. Or whether the connection point is included in the link corresponding to the link ID acquired in step 1802. When the boundary of the map area exists within the closed area, the process proceeds to step 1804, and when not present, the process proceeds to step 1808. In step 1804, it is determined whether or not the own vehicle position 705 of the managed vehicle selected in step 1801 exists on the topological area. If it exists on the topological area, the process proceeds to step 1805, and if it exists on the metric area, the process proceeds to step 1808.
  • step 1805 the travel route of the vehicle having higher priority than the managed vehicle selected in step 1801 is acquired. Since the travel plan creation process is performed in order from the management vehicle with the highest priority, the travel route of the management vehicle with the higher priority is already set, so if the information on the travel route 709 is acquired from the memory area 110, good. If the travel route is acquired, the process proceeds to step 1806. In step 1806, it is determined whether the range obtained by orthogonally projecting the range of the travel route acquired in step 1805 onto the boundary side and the blockage range of the blockage region acquired in step 1802 are overlapped. The overlap with the blockage range may be determined by whether or not the points obtained by orthogonally projecting all the waypoints set for the route travel to the boundary side are within the small area where “non-blockage” is set in the blockage state. .
  • step 1807 if a small area whose occlusion status is “non-occluded” that does not overlap with the occluded area in the occluded area that is an orthogonal projection of the range of the travel route is extracted, 1 in the extracted small area The point is set as the end point of the closed area, and the process proceeds to step 1808.
  • step 1808 a travel route to the end point of the closed area or the destination is generated. As a result, even when the management vehicle travels beyond the blockage area, it is possible to pass through the small area without obstructing the travel route of the management vehicle having a higher priority.
  • the blockage set by the managed vehicle with the higher priority is set with priority, and the blockage set by the managed vehicle with the higher priority is set.
  • a travel route that bypasses the small area where is set is generated.
  • the travel route to be generated is the shortest route from the vehicle position determined by the Dijkstra method to the destination in the topological region, and in the metric region, for example, the metric region is divided into fine meshes, and the mesh including the vehicle position is used. It can be generated by connecting meshes that are not included in the blockage area set in the metric area up to the mesh that includes the end point of the destination or blockage area.
  • step 1809 it is confirmed whether the travel route has been set for all the management vehicles. If not, the process returns to step 1801, and the processing in step 1808 is repeated. If the travel route is set for all the management vehicles, the process is terminated.
  • the traveling route of the management vehicle having a high priority is orthogonally projected on the boundary side, but the topological region side connected to the boundary point is connected in the same manner as when the blockage situation is set for each small region.
  • the travel route may be projected onto the boundary side in parallel with the link.
  • FIG. 19 shows an example of travel route generation. It is assumed that a certain management vehicle 1901 exists between the nodes n6 to n7. If, at a certain time, the blocked area of the management vehicle 1901 continues to the node n3, the set route is [n7, n3]. Thereafter, it is assumed that the management vehicle 1901 moves between the waypoint w0 and the node n3, and that the boundary side AB is all set in the closed area of the management vehicle 1901. At this time, it is assumed that the travel route of the management vehicle having a higher priority than the management vehicle 1901 is acquired and the travel route 1903 is as shown by the bold arrow in the figure.
  • the small area of the section CD overlaps the small area of the blockage area by the management vehicle 1901 on the boundary side.
  • One point on the area, here, the intermediate point w1 of the side AC in the small area of the section AC is defined as the end point of the first closed area. [W0, w1] including this end point is set as a route.
  • the management vehicle 1901 enters the metric area section from the small area of the section AC the route to the destination 1902 is set within the blockage area, and the travel route of [w2, w3, destination 1902] is set. Is done.
  • the boundary side AB of the metric area is all blocked as a blocked area, and when the management vehicle 1901 enters the metric area section from the connection point n0, it is before the connection point n0 until the blockage by another management vehicle is released. It was necessary to pause.
  • part of the blockage by other managed vehicles is solved, and the travel route is not the connection point n0, and w1 on the small area where there is no blockage by other managed vehicles is set. Since the vehicle is set so as to pass, the management vehicle can be efficiently driven without causing unnecessary pause.
  • the travel routes of all the managed vehicles are set, the travel routes are sent from the communication unit 108 to the respective managed vehicles 101 through the road device 117.
  • the travel route received from the road-to-vehicle communication unit 112 is sent to the motion planning unit 113, and the motion plan unit 113 sequentially reaches each target point on the travel route along the travel route. Make a steering plan.
  • the motion control unit 114 controls the vehicle motion based on the steering plan set up by the motion planning unit 113 to realize autonomous traveling.

Abstract

　車両の走行範囲を点と線で表わしたトポロジカル領域の地図と走行範囲を面で表わした地図で表したメトリック領域の地図とが混在する地図データベースと、車両の位置を管理する車両位置管理部と、地図の境界付近に車両が存在する場合、この境界を閉塞して他の車両が他の地図内に進入しないよう車両の走行を計画する車両走行計画部を含む運行管理部を有し、地図の境界部分を複数の領域に分割し、進行方向前方に車両が存在しない分割領域の境界の閉塞を開放する閉塞設定部を備え、車両走行計画部は、優先度の高い車両の走行経路計画が閉塞していない境界上の点を目標点として、優先度の高い車両の走行予定のエリアを避けて走行経路を求める自律走行システム。

Description

自律走行システム
　本発明は、自動車や電車などの移動体が自律的に走行するシステムに関する。
　従来の自律走行システムでは、各車両が移動可能な領域を判断し、障害物を回避する経路を設定しながら走行していた。さらに、特開２００８－９６３８号公報に記載の発明では、路面の接続状況を点と線で表わしたトポロジカル地図を用いて、通行不可領域の端点となる点を設定し、その点を回避するトポロジカル地図上の走行経路に従って走行することで効率的かつ安全な自律走行を可能にしている。
　また、特開２０１０－７３０８０号公報に記載の発明では、走行可能な空間を認識し、その空間中での走行経路を設定し、その走行経路に従い移動することで空間中の自由かつ効率的な行動を実現している。これらの従来技術では、単一の地図データを用いて自律走行を実現している。またこれら従来技術を組み合わせて用いることで、点と線で道路の繋がりが表わされたトポロジカル地図を用いる領域（トポロジカル領域）と走行可能な空間を表わしたメトリック地図を用いる領域（メトリック領域）が混在する場合でも、それぞれトポロジカル領域内に限られた閉塞管理および、メトリック領域内に限られた閉塞管理を行うことは可能である。
特開２００８－９６３８号公報 特開２０１０－７３０８０号公報
　しかし、トポロジカル領域とメトリック領域の境界における閉塞方法は、従来技術では考慮されていない。トポロジカル領域とメトリック領域との境界は、トポロジカル地図の境界点がメトリック地図の境界辺に接続する形で存在する。単純な閉塞方法としては、トポロジカル領域とメトリック領域の境界付近に車両が存在すれば、安全な運行を保証するため単純にトポロジカル地図の境界点とこれに接続するメトリック地図の境界辺を閉塞し、どの車両も境界を通過できないようにすることができる。しかし、このような方法では、境界付近に存在する車両の位置によっては、本来進入してもよい車両を停止させたり、迂回が必要ない車両まで迂回指示を出したりするなどにより、運行効率が低下する虞がある。
　このような運行効率の低下の問題は、トポロジカル領域とメトリック領域の境界における閉塞管理として、対応する境界点および境界辺を全て閉塞するのではなく、その境界辺を複数の領域に分割し、車両の存在しない領域の閉塞を開放することで解決される。
　複数種類の地図を有する自律走行システムにおいて、地図の表現方法がトポロジカルからメトリックへ、もしくはその逆方向に変化する境界における閉塞領域を詳細に設定することで、移動体の運行を安全かつ効率的に行うことができる。
自律走行システムの概略構成を示す図である。 地図データベースにおけるトポロジカル領域のデータ構造を示す図である。 地図データベースにおけるメトリック領域のデータ構造を示す図である。 メトリック領域における地図の表現方法の例を示す図である。 閉塞領域データベースにおけるトポロジカル領域のデータ構造を示す図である。 閉塞領域データベースにおけるメトリック領域のデータ構造を示す図である。 メモリ領域のデータ構造を示す図である。 地図領域の境界における小領域の閉塞状況のテーブルである。 自車位置算出部における処理のフローチャートである。 車両通過監視部における処理のフローチャートである。 管理車両位置の決定処理のフローチャートである。 閉塞領域算出・設定部における処理のフローチャートである。 閉塞領域設定の処理のフローチャートである。 境界分割のフローチャートである。 地図領域の境界分割を説明する図である。 地図領域の境界における小領域の閉塞を解放する処理のフローチャートである。 小領域における閉塞の解放を説明する図である。 走行経路の計画の作成処理のフローチャートである。 経路計画の例を示す図である。
　以下、本発明を用いた自律走行システムの詳細を説明する。
　対象とする自律走行システムの構成を図１に示す。自律走行システムは、複数の管理車両１０１とこれを管理するセンターである運行管理部１０２からなる。運行管理部１０２は、トポロジカル領域とメトリック領域が混在した地図データベース１０３を持つ。地図データベース１０３のデータ構造として、トポロジカル領域のデータ構造を図２に示し、メトリック領域のデータ構造を図３に示す。
　トポロジカル領域は、道路形状および道路の繋がりを点と線のネットワークで表わしたトポロジカル地図により管理される領域のことをいう。トポロジカル領域の地図データには、トポロジカル地図内のリンクを一意に表わすリンクＩＤ２０１と、リンクＩＤ２０１で表わされるリンクの始点座標を表わすリンク始点２０２、リンクＩＤ２０１で表わされるリンクの終点座標を表わすリンク終点２０３と、リンクＩＤ２０１で表わされるリンクを分割したサブリンクの数を表わすリンク分割数２０４と、リンクＩＤ２０１で表わされるリンクを分割したサブリンクのそれぞれ一意に表わすサブリンクＩＤ２０５と、各サブリンク毎の始点座標および終点座標を表わすサブリンク始点２０６とサブリンク終点２０７が保存されている。
　メトリック領域は、道路形状などのように車両が走行できる空間を表わしたメトリック地図により管理される領域であり、トポロジカル領域とは独立に表わされている領域である。メトリック領域の地図データには、地図データベース内のメトリック領域を一意に表わすメトリックＩＤ３０１と、メトリックＩＤ３０１で示される領域の形状を表わすメトリック形状３０２と、メトリックＩＤ３０１で示される領域に接続するリンクの総数である接続リンク数３０３と、メトリック領域に接続する各リンクについてそのリンクＩＤを表わす接続リンク３０４と、接続リンク３０４のメトリック領域と接続しているノードの座標である接続ノード３０５と、接続ノード３０５のメトリック領域上の座標を表わす接続点３０６が保存されている。更に、メトリックＩＤ３０１で示されるメトリック領域を複数の領域に分割したエリアの数を表わすエリア数３０７と、メトリックＩＤ３０１で示される領域を分割した各エリアを一意に示すエリアＩＤ３０８と、エリアＩＤ３０８で表わされる領域の形状を表わすエリア形状３０９が保存されている。なお、各エリアは互いに重複や不連続が生じないように予めメトリック領域を複数に分割した領域であるものとし、各エリアは例えば、緯度経度の値により矩形領域で区切られているものとする。
　接続点により外部のトポロジカル領域との繋がりが規定されている領域内はメトリック領域として取り扱われる。図４にメトリック領域の表現例を示す。図４（ａ）のように、通常道路には１本しかないトポロジカルネットワークが、道路内に複数車線が存在し、その車線形状を反映して車線毎にトポロジカルなネットワークが存在する場合は、この道路区間をメトリック領域として分類することができる。メトリック領域のＤＢには、接続リンク３０４としてトポロジカル領域のリンク４０１１、リンク４０１２のＩＤが設定され、接続ノードとしてトポロジカル領域のノード４０１３やノード４０１４が設定される。一方、接続点は、黒丸で表わされた車線毎のノード４０１５の６点が設定される。また、図４（ｂ）のように道路形状あるいは走行可能領域の形状を道路端／境界端の線もしくは点列で表わした地図、あるいは図４（ｃ）のように走行領域の平面をポリゴンで表わした地図などもメトリック領域の地図表現として挙げられる。これらメトリック領域の地図表現でも、破線で表わされたトポロジカル領域のリンクが接続リンク３０４に、白丸で表わされたトポロジカル領域のノードが接続ノード３０５に、また接続ノードに対応するメトリック領域の地点４０１６や地点４０１７の座標が接続点３０６に設定されることにより、トポロジカル領域とメトリック領域との繋がりが規定される。
　運行管理部１０２では、各管理車両１０１の位置を定期的に保存、更新する車両位置管理部１０４と、管理車両１０１がトポロジカル領域とメトリック領域との境界を通過するのを監視する車両通過監視部１０５と、後述する閉塞領域を決定する閉塞領域算出・設定部１０６と、管理車両１０１の今後の走行経路を計画する車両走行計画部１０７と、運行管理部１０２と管理車両１０１間の通信を行う通信部１０８と、閉塞領域算出・設定部１０６にて設定された閉塞領域を記憶する閉塞領域データベース１０９、および各車両の位置情報等を保存するメモリ領域１１０を持つ。メモリ領域１１０には、運行管理部１０２の運行管理オペレータなどのユーザ１１１により、各管理車両１０１の優先順位、目的地をリアルタイムに設定、記憶できるようになっている。
　閉塞領域データベース１０９のデータ構造を図５および図６に示す。図５は、閉塞領域データベース１０９におけるトポロジカル領域に設定された閉塞領域のデータ構造を示している。まず該当するトポロジカル領域に関し、地図データベース１０３のリンクＩＤ２０１およびそのリンクを分割した各サブリンクのサブリンクＩＤ２０５と同じ値をそれぞれリンクＩＤ５０１およびサブリンクＩＤ５０２に持つ。また各サブリンクＩＤ５０２で表わされるサブリンクを閉塞する管理車両の識別番号を閉塞車両番号５０３に記憶する。閉塞車両番号５０３は、１つのサブリンクＩＤ５０２に対して複数設定することができ、管理車両の優先順位順に登録され、登録可能な最大数は管理車両の最大数と等しい。
　図６は、閉塞領域データベース１０９におけるメトリック領域に設定された閉塞領域のデータ構造を示しており、該当するメトリック領域について、地図データベース１０３のメトリックＩＤ３０１およびそのメトリック領域を分割した各エリアのエリアＩＤ３０８と同じ値をそれぞれメトリックＩＤ６０１およびエリアＩＤ６０２に持つ。また各エリアＩＤ６０２で表わされるエリアを閉塞する管理車両の識別番号を閉塞車両番号６０３に記憶する。閉塞車両番号６０３は、１つのエリアＩＤ６０２に対して複数設定することができ、やはり管理車両の優先順位順に登録され、登録可能な最大数は管理車両の最大数と等しい。
　また、各管理車両１０１では、運行管理部１０２と管理車両１０１間の通信を行う路車間通信部１１２と、運行管理部１０２からの走行計画に基づき車両の運動を計画する運動計画部１１３と、その車両の運動計画に基づき車両を制御する運動制御部１１４と、運行管理部１０２が持つ地図データベース１０３と同一の地図データベース１１５と、車両の位置をＧＰＳなどのセンサを用いて算出する自車位置算出部１１６を持つ。また、管理車両１０１と運行管理部１０２との通信は路上装置１１７を介して行われる。この路上装置には監視カメラやビーコンなどのような車両の検知機能が付いている。
　このような構成の自律走行システムにより、複数台の管理車両１０１がメトリック領域とトポロジカル領域の境界付近に存在する場合に、安全かつ効率的に走行するように制御を行う。
　以下に自律走行システムの処理を説明する。管理車両１０１では、自車位置算出部１１６で算出した各車両の位置を、路車間通信部１１２を通して運行管理部１０２へ送る。図７に自車位置算出部１１６の処理フローを示す。ステップ９０１では、図示されていないＧＰＳやジャイロセンサ、加速度センサ、速度センサなどの自車位置を決定するデータを収集するセンサの情報をある周期で取得する。ステップ９０２では、得られたセンサの情報を用いて緯度・経度を示す絶対位置を算出する。絶対位置の算出には、ＧＰＳによる直接計測の他、ＧＰＳなどによる測位演算結果を用いてジャイロセンサ、加速度センサ、速度センサなどの慣性センサによる推測航法の結果を補正することで算出しても良い。
　ステップ９０３では、算出した絶対位置近傍の地図データを地図データベース１１５から取得する。ステップ９０４では、管理車両１０１が地図データベース１１５のトポロジカル領域とメトリック領域の境界における管理車両の通過状態を示す境界通過情報の有無を確認し、境界通過情報が無い場合ステップ９０５へ移行し、境界通過情報がある場合はステップ９０６へ移行する。ここで、車両の境界通過情報は、路車間通信部１１２から運行管理部１０２の車両通過監視部１０５で得られた結果を受信するかもしくは、車両が境界を通過したことを知らせる路上装置１１７からの信号を路車間通信部１１２が受信することで得られる。車両が境界を通過したことを知らせる信号を送る路上装置１１７としてはビーコンや監視カメラなどが挙げられる。
　ステップ９０５では、自車両の位置がメトリック領域上に存在するかどうかを判断する。この時、境界通過情報が無いため、車両の絶対位置に従い境界の通過を判断する。現在の自車両位置がメトリック領域上に無い場合、ステップ９０７へ移行し、メトリック領域上に絶対位置がある場合、ステップ９０８へ移行する。
　一方、ステップ９０６では、自車両が境界を通過したかどうかを示す境界通過情報を確認し、境界通過情報が、自車両が領域境界を通過したことを示す“通過”である場合、次にステップ９１０へ移行し、ステップ９１０では、前回計測時における自車両の存在位置がトポロジカル領域内であったか確認し、前回計測時に自車両が存在した領域がトポロジカル領域内であった場合は、現在位置はメトリック領域内に存在すると判断してステップ９０８へ、前回計測時に自車両が存在した領域がメトリック領域内であった場合は、現在位置がトポロジカル領域内に存在すると判断してステップ９０７へ移行する。また、ステップ９０６で、境界通過情報が、自車両が領域境界を通過しなかったことを示す“未通過”である場合、ステップ９１１へ移行する。ステップ９１１では、前回計測時における自車両の存在位置がメトリック領域内であったか確認し、前回計測時における自車両の存在位置がメトリック領域内であった場合、現在位置はメトリック領域内に存在すると判断してステップ９０８へ、そうでなければ現在位置はトポロジカル領域内に存在すると判断してステップ９０７へ移行する。
　ステップ９０７では、算出した絶対位置をトポロジカル領域上に射影する。トポロジカル領域上への絶対位置の射影は、現在位置を示す絶対位置の座標からトポロジカル領域上へ垂線の足を下ろせば良い。またステップ９０８ではメトリック領域上に絶対位置を射影する。メトリック領域上への絶対位置の射影については、図４に示す３種類のメトリック領域の表現例について説明する。まず図４（ａ）のメトリック領域表現のように、トポロジカルネットワークを複数用いてメトリック領域が表現されている場合は、トポロジカル領域と同じ方法で各トポロジカルネットワーク上へ垂線の足を下ろして射影し、絶対位置と射影した先の点との距離が最も近い点を射影点とする。また、図４（ｂ）のメトリック領域表現のように、走行領域の境界形状を点列で表わす場合、点列の最も外側に位置する点を結んだポリゴンを考え、そのポリゴン平面に対する絶対位置の射影点を求めればよい。同様に図４（ｃ）のメトリック領域表現の場合も、ポリゴン平面に対して絶対位置を射影した点を求めればよい。なおポリゴン平面に対する絶対位置の射影する場合、管理車両１０１が周辺の環境を計測できる機能を備えている場合、周辺環境の形状とポリゴン形状のマッチングを行うことで平面上の位置を決定してもよい。
　ステップ９０９ではステップ９０７、ステップ９０８で計算した射影点の位置を地図データベース１１５中の地図上の座標に変換し、自車位置として出力する。自車位置算出部１１６では、以上の処理フローを繰り返すことで逐次自車位置を算出する。算出された各管理車両１０１の絶対位置および自車位置は、路車間通信部１１２から路上装置１１７を経て運行管理部１０２の通信部１０８に送られる。この時、路上装置１１７内に境界通過情報が存在する場合、各管理車両１０１の絶対位置および自車位置と共にその境界通過情報が運行管理部１０２へ送られる。
　運行管理部１０２では、通信部１０８が路上装置１１７から送られてきた各管理車両１０１の絶対位置および自車位置を車両位置管理部１０４へ送る。車両位置管理部１０４では受信した管理車両の最新の絶対位置および自車位置をメモリ領域１１０へ保存する。また、路上装置１１７から境界通過情報が送られてきている場合には、管理車両の最新の絶対位置および自車位置と共にメモリ領域１１０へ保存する。
　図９にメモリ領域１１０のデータ構造を示す。総管理車両数７０１に続き、各管理車両に一定のメモリが割り当てられ、管理車両番号７０２に紐付けられている管理車両の優先順位７０３、目的地７０４、地図上の自車位置７０５および絶対位置７０６および境界通過情報７０７が保存される。また自車位置７０５の値は、最新の自車位置の情報に更新する前に、前回の自車位置７０８へ退避する。メモリ領域１１０には全ての管理車両１０１の情報が集約されている。各管理車両の優先順位７０３、目的地７０４はユーザ１１１が事前に決定し、その後もリアルタイムに変更・設定・保存が可能である。
　車両位置管理部１０４はメモリ領域１１０に各管理車両から送られてきた情報を保存した後、管理車両の情報が更新された旨のメッセージを車両通過監視部１０５へ送る。車両通過監視部１０５では、メモリ領域１１０に保存された各管理車両の位置と境界通過情報の値から各管理車両が境界を通過したかどうかをチェックし、もし管理車両１０１から送信された最新の自車位置及び前回の自車位置と境界通過情報の値との間に矛盾がある場合、境界通過情報の値を正しいものとして、自車位置を補正する。
　車両通過監視部１０５の処理フローを図１０に示す。車両通過監視部１０５は常に車両位置管理部１０４からのメッセージを待ち続け（ステップ１００１）、メッセージを受信した場合にステップ１００２に移行する。ステップ１００２では、メモリ領域１１０に保存された管理車両内、未チェックの管理車両１つについて自車位置７０５および境界通過情報７０７と前回の自車位置７０８の情報を取得する。ステップ１００３では、管理車両の自車位置及び前回の自車位置が存在する領域と境界通過情報の間に矛盾が無いかをチェックする。この矛盾が生じる可能性としては、管理車両１０１の自車位置算出部１１６にて路上装置１１７の情報を受け取れずに自車位置を計算し、かつ運行管理部１０２では路上装置１１７の情報を受け取れた場合などが挙げられる。メモリ領域１１０に保存された管理車両の自車位置と境界通過情報の間に矛盾がある場合、車両位置に誤りがあるものとし、ステップ１００４へ移行する。また矛盾が無い場合には、ステップ１００５へ移行する。ステップ１００４では、管理車両１０１が計算した自車位置が間違っていることになるため、運行管理部１０２にて自車位置の補正を行う。
　この管理車両の自車位置を補正する処理の処理フローを図１１に示す。まずステップ１１０１にて境界通過情報の判断を行い、境界通過情報が“通過”である場合には、ステップ１１０３に進んで前回の車両位置がトポロジカル領域内か判断し、トポロジカル領域内と判断された場合（ステップ１１０３：Ｙｅｓ）はステップ１１０５へ移行し、メトリック領域内と判断された場合（ステップ１１０３：Ｎｏ）はステップ１１０４へ移行する。また、ステップ１１０１で境界通過情報が“未通過”と判断された場合には、ステップ１１０２に進んで前回の車両位置がメトリック領域内か判断し、メトリック領域内と判断された場合（ステップ１１０２：Ｙｅｓ）はステップ１１０５へ移行し、トポロジカル領域内と判断された場合（ステップ１１０２：Ｎｏ）はステップ１１０４へ移行する。
　ステップ１１０４におけるトポロジカル領域への自車位置のマップマッチングおよびステップ１１０５におけるメトリック領域への自車位置のマップマッチングの処理は、それぞれ自車位置算出部１１６におけるステップ９０７、ステップ９０８の処理と同様にして行われる。ステップ１１０６では、ステップ１１０４もしくはステップ１１０５において算出した自車位置をメモリ領域１１０の自車位置へ書き込むことで自車位置の補正を行う。
　図１０の処理フローの説明に戻り、ステップ１００５では、メモリ領域１１０に保存された総管理車両数７０１とこれまでチェックした管理車両１０１の数を比較して、全ての管理車両１０１をチェックしたかを判断する。全ての管理車両１０１をチェックした場合は、ステップ１００６へ移行し、未チェックの管理車両１０１がある場合は、ステップ１００２へ戻る。ステップ１００６では、閉塞領域算出・設定部１０６に対して、全ての管理車両１０１のチェックが終了した状態になっている旨を通知するメッセージを送る。
　閉塞領域算出・設定部１０６では、メモリ領域１１０に保存されている全管理車両１０１の車両位置および地図データベース１０３の地図情報から、地図データベース１０３上で各管理車両に設定される閉塞領域を算出し、閉塞領域データベース１０９に設定する。
　閉塞領域算出・設定部１０６の処理フローを図１２に示す。ステップ１２０１にて車両通過監視部１０５からメッセージが送られてきたかをチェックする。メッセージが送られていない場合は再びメッセージの受信をチェックするタイミングまで待機し、メッセージが送られてきた場合にはステップ１２０２に進む。ステップ１２０２では、優先順位７０３が高い順に管理車両１０１の自車位置７０５および絶対位置７０６をメモリ領域１１０から取得して、ステップ１２０３に移行する。ステップ１２０３では、ステップ１２０２で取得した管理車両の自車位置７０５の情報を用いて、地図データベース１０３から管理車両の現在位置周辺の地図データを取得し、ステップ１２０４に移行する。ステップ１２０４では、ステップ１２０２で取得した管理車両の自車位置７０５に対して、ステップ１２０３で取得した管理車両近傍の地図データ上に閉塞範囲を設定し、その閉塞範囲を閉塞領域として閉塞領域データベース１０９へ保存する。
　ステップ１２０４における閉塞領域設定の詳細な処理フローを図１３に示す。ステップ１３０１において、管理車両１０１の自車位置７０５が存在する領域がトポロジカル領域かメトリック領域かを判定する。管理車両１０１の自車位置７０５がトポロジカル領域内に存在する場合は、ステップ１３０２に移行する。管理車両１０１の自車位置７０５がメトリック領域内に存在する場合は、ステップ１３１０に移行する。
　ステップ１３０２では、管理車両の自車位置から閉塞領域が既に設定された距離である総閉塞領域設定距離を、閉塞領域を設定する際の最大距離の値である閾値から引いた値、即ち閉塞領域を設定することのできる残りの距離が、既に設定されている閉塞領域に含まれるサブリンクの端点から次のサブリンク端点までの距離より長いかを判定する。総閉塞領域設定距離は、既に閉塞領域を設定したサブリンクの長さの和を求めることで計算される。次のサブリンク端点までの距離よりも閉塞領域を設定することのできる残りの距離が長い場合はステップ１３０３へ移行する。また次のサブリンク端点までの距離よりも閉塞領域を設定することのできる残りの距離が短い場合は、次のサブリンクを更に閉塞領域として加えることができないため、ステップ１３１３へ移行する。
　ステップ１３０３では、既に閉塞領域に含まれているサブリンクの次のサブリンクを閉塞領域として設定して閉塞領域に追加し、ステップ１３０４へ移行する。ステップ１３０４では、新たに閉塞領域に加えたこのサブリンクの端点のノードが分岐ノードもしくは地図領域の境界点となる接続ノードであるかを判定する。サブリンクの端点が地図領域の境界に存在する境界点である場合にはステップ１３０５へ移行し、サブリンクの端点がリンクの分岐する分岐ノードであればステップ１３０６へ移行し、サブリンクの端点が分岐ノードでも地図領域の境界点でもない場合にはステップ１３０２へ戻る。
　ステップ１３０５では、地図領域の境界と閉塞領域が重なることになるため、トポロジカル領域の境界点および接続するメトリック領域の境界辺を閉塞領域として設定し、ステップ１３１３へ移行する。ステップ１３０６では、管理車両が走行する予定の走行経路（あるいは、少なくとも管理車両１０１が向かう次のリンク）が運行管理部１０２にて設定されているかを判断する。管理車両１０１に今後走行する予定の走行経路が設定されていない場合、次に走行する予定のリンクを特定できないことから、閉塞領域の拡張を止めてステップ１３０７へ移行する。また管理車両が走行する予定の走行経路が設定されている場合、ステップ１３０８へ移行する。ステップ１３０７では、既に閉塞領域を設定したノードまでで閉塞を閉じ、ステップ１３１３へ移行する。
　ステップ１３０８では、分岐ノードにつながる各リンクについて、分岐ノードに接続しているサブリンクの中に、別の管理車両（即ち、より以上に優先順位の高い管理車両）により既に閉塞領域が設定されているサブリンクが存在するかどうかを確認する。既に閉塞されているサブリンクが分岐ノードに接続していた場合、この分岐ノードで他の閉塞領域と隣接することになるため、閉塞領域の拡張を止めてステップ１３０７へ移行する。一方、分岐ノードに接続する全てのサブリンクにおいて閉塞が設定されていない場合、ステップ１３０９へ移行する。ステップ１３０９では、分岐ノードからの管理車両１０１の走行経路に従い、次に接続するリンクの最初のサブリンクに対して閉塞領域を設定し、ステップ１３０２へ戻る。
　次にステップ１３０１における判定で、管理車両の自車位置がメトリック領域内にあると判断された場合の処理を説明する。ステップ１３１０では、管理車両１０１の位置を中心としたある範囲にかかるエリアを選択して閉塞領域に設定し、ステップ１３１１に移行する。この時、ある範囲の形は、円、楕円、矩形、多角形等の連続した１つの平面形状であるものとする。
　ステップ１３１１では閉塞領域としたエリア内にメトリック領域の境界が存在するかを判断する。エリア内にメトリック領域の境界が存在するかどうかは、接続点３０６がこのエリアに含まれるかどうかで判断する。閉塞領域としたエリア内にメトリック領域の境界が存在しない場合、ステップ１３１３へ移行する。しかし閉塞領域としたエリア内にメトリック領域の境界が存在する場合、ステップ１３１２に移行する。ステップ１３１２では、閉塞領域としたエリアに含まれるメトリック領域の境界を閉塞領域の境界とし、平面の端を含むメトリック領域の内側までを閉塞領域として再設定し、ステップ１３１３へ移行する。ステップ１３１３では、設定された閉塞領域と管理車両の管理車両番号を閉塞領域データベース１０９へ保存し、処理を終了する。
　以上の処理により、原則としてトポロジカル領域内の管理車両については、自車位置前方の走行予定のリンク上に所定距離の範囲内でサブリンク単位に閉塞領域が設定され、メトリック領域内の管理車両に対しては、所定の形状で閉塞領域が設定される。またトポロジカル領域とメトリック領域の近くに存在する管理車両については、これら領域の境界部分に閉塞領域が設定されることになる。
　図１２の説明に戻り、ステップ１２０４にて閉塞領域の設定が終了した後、ステップ１２０５では、全ての管理車両１０１について閉塞領域の設定が終了したかを判断する。全ての管理車両の閉塞領域の設定が終わっている場合、ステップ１２０６へ移行する。閉塞領域の設定が終わっていない管理車両１０１が存在する場合、ステップ１２０２へ戻り、残りの管理車両について処理を繰り返す。
　次に、ステップ１２０６では、地図データベース１０３から地図領域を選択して、ステップ１２０７へ移行する。地図領域の選択順序は予め決めておいて良い。ステップ１２０７では、ステップ１２０６で選択した地図領域について、その境界部分に閉塞領域が設定されているかどうかを、閉塞領域データベース１０９を参照して判断する。地図領域の境界に閉塞領域が設定されていない場合、ステップ１２１２に移行する。地図領域の境界に閉塞領域が設定されている場合には、ステップ１２０８へ移行する。ステップ１２０８では、閉塞領域データベース１０９から、対象としている地図領域の境界に対し閉塞領域を設定した全ての管理車両の内、自車位置がトポロジカル領域内に存在するものについて自車位置およびそれぞれの管理車両番号７０２を全て取得し、ステップ１２０９に移行する。ステップ１２０９では、ステップ１２０８で取得した管理車両１０１の内、トポロジカル領域内の区間に存在し最も地図領域の境界に近い車両位置を基に、設定された閉塞領域を複数の領域に分割して、ステップ１２１０に移行する。
　図１４に、ステップ１２０９における閉塞領域の分割処理のフローチャートを示す。また、図１５に閉塞領域分割の例を示す。ステップ１４００において、処理対象とする管理車両が得られているか調べ、処理対象とする管理車両が無い、即ち、トポロジカル領域側に管理車両が存在しない場合には、閉塞領域を更に分割することはせずにそのまま処理を終了する。次に、ステップ１４０１において、対象とする領域境界の閉塞領域として登録されている境界点に接続するトポロジカル領域側のリンクを選択し、ステップ１４０２へ移行する。境界点に接続するリンクは地図データベース１０３から検索する。図１５に示す例では、領域の境界辺ＡＢ上のノード１５０１が境界点であり、接続するトポロジカル領域側のリンクはノード１５０１とノード１５０２を端点として持つリンク１５０３である。ステップ１４０２では、ステップ１２０８で得られた、この領域境界に閉塞領域を設定した全ての管理車両の中から管理車両番号の小さい順に１つ選択する。ステップ１４０３では、選択した管理車両（管理車両番号＝id）の優先順位７０３（ｐ(id)）およびトポロジカルネットワーク距離（Ｄ(id)）を計算し、ステップ１４０４へ移行する。ここでトポロジカルネットワーク距離は、対象としている管理車両のトポロジカルネットワーク上の位置までの境界点からのリンク距離の総和とする。図１５では、選択された車両が１５０４の場合、トポロジカルネットワーク距離は、ノード１５０１からノード１５０２までの距離およびノード１５０２からノード１５０５までの距離およびノード１５０５から管理車両１５０４の位置までの距離の総和となる。
　ステップ１４０４では、ステップ１４０３で計算されたトポロジカルネットワーク距離Ｄ(id)が、この処理でこれまで計算されたトポロジカルネットワーク距離の中で最も小さい値（Ｄmin）よりも小さいかを判断し、Ｄ(id)の値がＤminと同じか大きい場合はステップ１４０５へ移行し、Ｄminより小さい値の場合はステップ１４０６へ移行する。ステップ１４０５では、ステップ１４０３で計算されたトポロジカルネットワーク距離Ｄ(id)が、これまで計算されたトポロジカルネットワーク距離の中で最も小さい値Ｄminと等しく、かつステップ１４０３で取得した選択車両の優先順位７０３（ｐ(id)）がこれまで計算された中で最も小さいトポロジカルネットワーク距離となる管理車両の優先順位７０３（ｐmin）よりも大きいかどうかを判断する。この判断結果が真ならステップ１４０６へ移行し、選択車両のトポロジカルネットワーク距離がこれまで計算されたトポロジカルネットワーク距離よりも大きいもしくは優先順位７０３が低い場合はステップ１４０７へ移行する。ステップ１４０６では、ステップ１４０３で計算したトポロジカルネットワーク距離を最小距離として記憶し、さらに管理車両番号とその優先順位７０３を記憶し、ステップ１４０７へ移行する。なお、この処理に先立ち、Ｄmin、ｐminは適切な値に初期化されているものとする。ステップ１４０７では全ての対象管理車両を選択し処理が完了したか判断し、全ての対象管理車両について処理が行われた場合には、ステップ１４０８へ移行し、対象管理車両が残っている場合はステップ１４０２へ戻って処理を繰り返す。
　ステップ１４０８では境界点からのトポロジカルネットワーク距離が最小となった車両番号を選択し、ステップ１４０９へ移行する。ステップ１４０９では、ステップ１４０１で選択した境界点と接続するリンクもしくはその延長線上に対してステップ１４０８で選択した管理車両の自車位置を正射影した点を求め、ステップ１４１０へ移行する。図１５では、境界点と接続するリンク１５０３とその延長線１５０６に対して、選択された管理車両１５０４の位置を正射影した点１５０７を求める。ステップ１４１０では、正射影した点を中心として、境界点と接続するリンクもしくはその延長線とある角度θをなす直線Ｌ(θ)を求め、ステップ１４１１へ移行する。図１５では、境界点を管理車両１５０４の位置を正射影した点１５０７を中心に直線１５０６とある角度をなす直線１５０８を求める。ステップ１４１１では、ステップ１４１０にて求めた直線Ｌ(θ)と閉塞領域が設定されている境界辺との交点を求め、分割点として設定し、ステップ１４１２へ移行する。この時、境界辺と交わらない場合は、分割点に不可値を設定する。図１５では、直線１５０８と境界辺ＡＢとの交点１５０９を求めることになる。ステップ１４１２では、分割点の総数が予め決められた最大分割数より大きくなった場合に処理を終了する。分割点の総数が予め決められた最大分割数より小さい場合は、ステップ１４１０に戻り、ステップ１４１０からステップ１４１２までの処理を繰り返す。この方法において、角度θが全て等しい場合、遠くの境界の小領域は大きく、近くの境界の小領域は細かく分割することができる。また、角度θを選択された車両位置と境界辺との距離に応じて変更することで、境界辺を単純に等分割することも可能である。
　図１２のフローの説明に戻り、ステップ１２１０では、ステップ１２０８で取得した地図領域の境界周辺の管理車両１０１の位置を考慮して、ステップ１２０９の境界分割処理を経て１つ以上の小領域として定義された地図領域の境界における閉塞領域の開放／閉塞を設定し、ステップ１２１１へ移行する。
　ステップ１２１０における地図領域境界の各閉塞領域の閉塞を小領域の単位で解放する処理のフローを図１６に示す。ステップ１６０１では、ステップ１２０９にて設定した境界辺の分割点を取得する。境界辺上のこれらの分割点の間が小領域となる。なおステップ１２０９の処理で境界辺が分割されなかった場合には、境界辺端を分割点と見なし、境界辺自体を小領域として扱う。そして各小領域について図８に示すテーブルを作成する。このテーブルでは、列８０１に小領域の取得順にその通し番号を設定する。各行にはそれぞれの小領域の始点８０２と終点８０３の座標を設定する。これは小領域の両端に位置する分割点の座標が用いられる。そして各小領域の閉塞状況８０４を設定する。閉塞状況８０４には最初、全て‘非閉塞’が設定される。
　次にステップ１６０２では、ステップ１２０８において取得した、閉塞領域近傍の車両の中からメトリック領域内に存在する管理車両を１つ選択し、その自車位置を取得してステップ１６０３へ移行する。ステップ１６０３では、ステップ１６０２にて選択した管理車両の自車位置から、境界点に接続するトポロジカル領域側のリンクに対し平行な直線Ｌpを求めて、ステップ１６０４へ移行する。ステップ１６０４では、直線Ｌpと境界辺の交点を求め、その交点を含む小領域の番号を選び、ステップ１６０５へ移行する。ステップ１６０５では、ステップ１６０４で取得した小領域番号８０４の行に閉塞設定し、ステップ１６０６へ移行する。ステップ１６０６では、ステップ１２０８において取得した車両の中からメトリック領域内に存在する全ての車両が選択され、ステップ１６０２からステップ１６０５の処理が行われたかを判断し、全ての対象車両が選択されている場合は処理を終了する。また選択されていない対象車両が存在する場合は、ステップ１６０２へ戻り、処理を繰り返す。
　このようにして、地図領域の境界辺を、この境界辺に接近してくるトポロジカル領域側の紙管理車両と境界線との位置関係により複数の小領域に分割し、それぞれの小領域の長さを決定する。
　図１６に示した処理の一例を図１７に示す。メトリック領域の平面１７０１の辺ＡＢが境界辺となっており、この境界辺に対しステップ１２０４の処理によって閉塞領域が設定されているとする。そしてステップ１２０９の処理によりトポロジカル領域内の管理車両１７０２により境界辺ＡＢがＡＣ、ＣＯ、ＯＤ、ＤＥ、ＥＢの５つの小領域に分割されるものとする。更にステップ１６０２の処理で取得したメトリック領域区間の管理車両が、管理車両１７０３、１７０４、１７０５の３台であった場合、それぞれの管理車両の自車位置から、境界点Ｏに繋がるトポロジカルネットワークのリンクと平行に線を引き、辺ＡＢと交わった点を含む小領域を閉塞領域とする。この図１７の例の場合、小領域ＡＣ、ＥＢで境界辺と平行線が交わるため、これら小領域の閉塞状況として‘閉塞’が設定される。
　再び図１２のフローの説明に戻り、ステップ１２１１では、閉塞状況に‘非閉塞’が設定され閉塞が解放された小領域の各始点８０２および終点８０３の座標を端点とする線分からある一定距離の範囲のメトリック領域についても閉塞領域から開放して、メトリック領域における閉塞領域を再設定し、領域データベースを更新してステップ１２１２へ移行する。解放する閉塞の形状は小領域の始点８０２および終点８０３の座標を端点とする線分を含む、円、楕円、矩形、多角形などの形状で良い。
　ステップ１２１２では、全ての地図領域の境界において閉塞領域の解放が終了したかどうかを判断する。全ての地図領域の境界において閉塞領域の解放が終了している場合は、ステップ１２１３へ移行する。閉塞領域の解放が終了していない地図領域が存在する場合は、ステップ１２０６へ戻り処理を繰り返す。そして、ステップ１２１３にて車両走行計画部１０７へ閉塞解放処理が終了したことを示すメッセージを送信する。
　このようにして、トポロジカル領域とメトリック領域の境界における境界点とこれに対応する境界辺を全て閉塞してしまい、どの車両も境界を通過できなくなることで、本来進入してもよい車両を停止させたり、迂回が必要ない車両まで迂回指示を出したりすることを防ぐため、閉塞領域が設定された境界辺を複数の領域に分割して閉塞領域の閉塞状況をより詳細に設定するようにし、車両の存在しない領域の閉塞を開放することによって、地図の表現方法がトポロジカルからメトリックへ、もしくはその逆方向に変化する境界において、移動体の安全な運行を保証するとともに、運行効率の低下を防ぐことができる。
　車両走行計画部１０７は、閉塞領域算出・設定部１０６からのメッセージを受け、メモリ領域１１０に保存されている各管理車両の自車位置の情報と地図データベース１０３および閉塞領域データベース１０９に格納された情報を用いて、各管理車両の走行経路の計画を立てる。走行経路の計画は、各管理車両が設定した閉塞領域内における管理車両の自車位置から、その管理車両に対して設定されている目的地もしくは閉塞領域端点までの走行経路に対応する通過点の系列で表わされる。トポロジカル領域の場合は走行経路に含まれるノードの位置を通過順に並べる。また、メトリック領域の地図領域の境界線およびメトリック領域内では、ある一定距離ごとに通過する目標となる点（ウェイポイント）を定め、その位置を通過順に並べる。また、地図領域の境界辺において閉塞領域算出・設定部１０６により設定された閉塞領域内に境界点が存在する場合、境界点の位置つまりメトリック領域に接続するリンクの終点の位置を、メトリック領域の境界辺において閉塞が設定されていない小領域があればその小領域に移し、その点を通過点として登録する。登録された通過点は通信部１０８を通して各車両へ送信される。
　車両走行計画部１０７における走行経路の計画の作成フローを図１８に示す。ステップ１８０１では、全ての管理車両の中から優先順位７０３の順に管理車両を１つ選択し、ステップ１８０２へ移行する。ステップ１８０２では、メモリ領域１１０の中からステップ１８０１で選択した管理車両の管理車両番号７０２に対応する目的地７０４および自車位置７０５の情報を取得し、さらに閉塞領域データベース１０９におけるトポロジカル領域、メトリック領域それぞれの閉塞領域の情報の中から、閉塞車両番号５０３、６０３の中に、選択された管理車両の管理車両番号が含まれている閉塞領域を抽出し、その閉塞領域において閉塞が設定されているサブリンクＩＤ５０２あるいはエリアＩＤ６０２を全て取得して、ステップ１８０３へ移行する。
　ステップ１８０３では、抽出した閉塞領域の内に地図領域の境界が存在するかを判断する。地図領域の境界が存在するか否かの判断は、ステップ１８０２で取得したエリアＩＤに対応するエリアのエリア形状をメトリック領域のメトリックＩＤに対応したデータの中から読み出し、その領域の中に接続点が含まれるかどうか、もしくはステップ１８０２で取得したリンクＩＤに対応するリンクに接続点が含まれるかどうかで判断する。地図領域の境界が閉塞領域内に存在する場合はステップ１８０４へ移行し、存在しない場合はステップ１８０８へ移行する。ステップ１８０４では、ステップ１８０１で選択した管理車両の自車位置７０５がトポロジカル領域上に存在するかどうかを判断する。トポロジカル領域上に存在する場合は、ステップ１８０５へ移行し、メトリック領域上に存在する場合はステップ１８０８へ移行する。
　ステップ１８０５では、ステップ１８０１で選択した管理車両よりも優先順位の高い車両の走行経路を取得する。走行計画の作成処理は優先順位の高い管理車両から順に処理されるため、優先順位の高い管理車両の走行経路は既に設定されていることから、メモリ領域１１０から走行経路７０９の情報を取得すれば良い。走行経路を取得すればステップ１８０６へ移行する。ステップ１８０６では、ステップ１８０５で取得した走行経路の範囲を境界辺へ正射影した範囲と、ステップ１８０２で取得した閉塞領域の閉塞範囲との重なりを判断する。閉塞範囲との重なりは、経路走行に設定されたウェイポイントを全て境界辺に正射影した点が、閉塞状況に‘非閉塞’が設定されている小領域内にあるかどうかで判断すれば良い。
　次にステップ１８０７では、走行経路の範囲を正射影した範囲と閉塞領域において閉塞範囲とが重ならない、閉塞状況が‘非閉塞’の小領域が抽出されれば、抽出された小領域上の１点を閉塞領域の端点として設定し、ステップ１８０８へ移行する。ステップ１８０８では、閉塞領域の端点もしくは目的地までの走行経路を生成する。これにより、閉塞領域を越えて管理車両が走行した場合でも、より優先度の高い管理車両の走行経路を妨害することなく小領域を通過させることが出来るようになる。また閉塞領域の端点が設定されていない場合、即ち、ステップ１８０６において走行経路の範囲を正射影した範囲と閉塞範囲とが重ならない閉塞状況が‘非閉塞’の小領域が抽出されなかった場合には、接続点までの走行経路を生成する。
　これにより、複数の管理車両による小領域の閉塞が重なるような場合でも、優先順位の高い管理車両が設定する閉塞が優先されて設定されることになり、優先順位の高い管理車両が設定する閉塞を設定した小領域を迂回する走行経路が生成されることになる。
　生成する走行経路は、トポロジカル領域においては、ダイクストラ法により求めた自車位置から目的地までの最短経路とし、メトリック領域においては例えば、メトリック領域を細かなメッシュに区切り、自車位置を含むメッシュから目的地又は閉塞領域の端点を含むメッシュまで、メトリック領域に設定された閉塞領域に含まれないメッシュを繋ぐことで生成できる。次にステップ１８０９にて全ての管理車両に走行経路が設定されたかを確認し、設定されていない場合はステップ１８０１へ戻り、ステップ１８０８での処理を繰り返す。全ての管理車両に走行経路が設定されている場合は、処理を終了する。
　なお、上記の説明では、優先順位の高い管理車両の走行経路を境界辺に正射影していたが、小領域毎に閉塞状況を設定する際と同様に、境界点に接続するトポロジカル領域側のリンクと平行に、走行経路を境界辺へ投影する様にしても良い。
　図１９に走行経路生成の一例を示す。ある管理車両１９０１がノードｎ６～ノードｎ７の間に存在したとする。ある時間において、管理車両１９０１の閉塞領域がノードｎ３まで続いていたとすると、設定される経路は［ｎ７、ｎ３］となる。その後、ウェイポイントｗ０からノードｎ３の間に管理車両１９０１が移動し、また境界辺ＡＢが全て管理車両１９０１の閉塞領域に設定されているものとする。この時、管理車両１９０１よりも優先順位の高い管理車両の走行経路を取得し、図の太線矢印に示すような走行経路１９０３であったとする。この優先順位の高い管理車両の走行経路１９０３を境界辺ＡＢに正射影すると、境界辺における管理車両１９０１による閉塞領域の小領域の内、区間ＣＤの小領域と範囲が重なるため、重なりの無い小領域上の１点、ここでは区間ＡＣの小領域における辺ＡＣの中間点ｗ１を一つ目の閉塞領域の端点とする。そして、この端点を含む［ｗ０、ｗ１］が経路に設定される。その後、管理車両１９０１が区間ＡＣの小領域からメトリック領域区間に入った場合、閉塞領域の範囲内で目的地１９０２までの経路が設定され、［ｗ２、ｗ３、目的地１９０２］の走行経路が設定される。
　従来は、メトリック領域の境界辺ＡＢが全て閉塞領域として閉塞され、管理車両１９０１が接続点ｎ０からメトリック領域区間に進入する際に、他の管理車両による閉塞が解かれるまで接続点ｎ０の手前で一時停止している必要があった。しかし、閉塞領域算出・設定部１０６を設けることで、他の管理車両による閉塞の一部が解かれ、走行経路が接続点ｎ０ではなく、他の管理車両による閉塞が無い小領域上のｗ１を通るように設定されるので、無駄な一時停止をせず、効率よく管理車両を走行させることができる。
　車両走行計画部１０７では、全ての管理車両の走行経路が設定されれば、その走行経路を通信部１０８から路上装置１１７を通して各管理車両１０１へ送る。各管理車両では、路車間通信部１１２から受けた走行経路を運動計画部１１３に送り、運動計画部１１３にて走行経路に沿って走行経路上の各目標点に順に到達できるように速度計画および操舵計画を立てる。また、運動制御部１１４では運動計画部１１３で立てた操舵計画に基づき、車両運動を制御し、自律走行を実現する。
１０１　管理車両
１０２　運行管理部
１０３、１１５　地図データベース
１０４　車両位置管理部
１０５　車両通過監視部
１０６　閉塞領域算出・設定部
１０７　車両走行計画部
１０８　通信部
１０９　閉塞領域データベース
１１０　メモリ領域
１１２　路車間通信部
１１３　運動計画部
１１４　運動制御部
１１６　自車位置算出部
１１７　路上装置

Claims (7)

  1. 　車両の走行範囲が点と線で表わされた第１の区間と、車両の走行範囲が面で表わされた第２の区間の地図が混在する地図データベースと、
    　複数の車両の位置を管理する車両位置管理部と、
    　第１の区間と第２の区間の境界周辺における車両の有無を判断し、境界周辺に車両が存在する場合に、その境界を他の車両が進入しないように閉塞状態に設定する閉塞設定部と、
    を備えた運行管理部を有し、
    　前記運行管理部から各車両に対し走行経路を通知する自律走行システムにおいて、
    　前記閉塞設定部は、閉塞状態が設定された前記境界を複数の領域に分割し、分割した各領域について通過する車両が存在しない分割領域の境界の閉塞を開放し、
    　第１の区間と第２の区間の境界に設定されている分割領域の閉塞状態に基づいて車両の走行経路を計画する車両走行計画部と、
    を有することを特徴とする自律走行システム。
  2. 　請求項１に記載の閉塞設定部において、境界を複数の領域に分割する際は、当該境界に近付く車両と該境界との位置関係によって、境界の複数に分割する領域の長さを決定することを特徴とする自律走行システム。
  3. 　請求項１または２に記載の自律走行システムにおいて、前記閉塞設定部は、各車両には優先度が設定されており、前記小領域に対する閉塞状態の設定は優先度の高い車両が設定する閉塞が優先されること特徴とする自律走行システム。
  4. 　請求項１－３に記載の自律走行システムのいずれかにおいて、前記車両走行計画部は、前記第１の区間と第２の区間の境界における接点座標が優先度の高い車両により閉塞されていた場合、優先度の高い車両が閉塞していない境界のある１点を目標点として走行経路計画を立てることを特徴とする自律走行システム。
  5. 　請求項４に記載の自律走行システムにおいて、前記車両走行計画部は、優先度の高い車両の走行経路を取得し、優先度の高い車両により閉塞状態が設定された分割された境界の領域を避けて前記目標点を設定して走行経路を生成することを特徴とする自律走行システム。
  6. 　請求項１に記載の運行管理装置において、路面の表現が点と線で表わされた区間から面で表わされた区間に入ったこと、もしくは路面が面で表わされた区間から点と線で表わされた区間に入ったことを検知する車両通過監視部を有することを特徴とする自律走行システム。
  7. 　請求項１に記載の車両位置管理部において、地図データベースを用いて、路面が点と線で表わされた区間には線上もしくは点上の自車位置を計算する自車位置推定を行い、面で表わされた区間では面上の自車位置推定に切り替わることを特徴とする自律走行システム。
PCT/JP2011/006248 2011-11-09 2011-11-09 自律走行システム WO2013069054A1 (ja)

Priority Applications (6)

Application Number Priority Date Filing Date Title
JP2013542686A JP5868420B2 (ja) 2011-11-09 2011-11-09 自律走行システム
CA2854274A CA2854274C (en) 2011-11-09 2011-11-09 Autonomous travel system
AU2011380820A AU2011380820B2 (en) 2011-11-09 2011-11-09 Autonomous travel system
US14/357,130 US8983709B2 (en) 2011-11-09 2011-11-09 Autonomous travel system
DE112011105829.2T DE112011105829T5 (de) 2011-11-09 2011-11-09 Autonomes Fahrsystem
PCT/JP2011/006248 WO2013069054A1 (ja) 2011-11-09 2011-11-09 自律走行システム

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2011/006248 WO2013069054A1 (ja) 2011-11-09 2011-11-09 自律走行システム

Publications (1)

Publication Number Publication Date
WO2013069054A1 true WO2013069054A1 (ja) 2013-05-16

Family

ID=48288645

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2011/006248 WO2013069054A1 (ja) 2011-11-09 2011-11-09 自律走行システム

Country Status (6)

Country Link
US (1) US8983709B2 (ja)
JP (1) JP5868420B2 (ja)
AU (1) AU2011380820B2 (ja)
CA (1) CA2854274C (ja)
DE (1) DE112011105829T5 (ja)
WO (1) WO2013069054A1 (ja)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015129366A1 (ja) * 2014-02-25 2015-09-03 アイシン・エィ・ダブリュ株式会社 経路探索システム、経路探索方法、コンピュータプログラム及びコストテーブルのデータ構造
US9304515B2 (en) 2014-04-24 2016-04-05 Lenovo Enterprise Solutions (Singapore) Pte. Ltd. Regional operation modes for autonomous vehicles
US9349284B2 (en) 2014-04-24 2016-05-24 International Business Machines Corporation Regional driving trend modification using autonomous vehicles
CN110065495A (zh) * 2018-01-24 2019-07-30 努托诺米有限公司 车辆的速度行为规划
JP6678831B1 (ja) * 2019-03-12 2020-04-08 三菱電機株式会社 制御装置および制御方法
US10852734B2 (en) 2017-08-25 2020-12-01 Toyota Jidosha Kabushiki Kaisha Autonomous driving device

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3069204B1 (en) * 2013-11-12 2023-05-17 Husqvarna AB Improved navigation for a robotic working tool
US9031758B1 (en) * 2014-03-04 2015-05-12 Nissan North America, Inc. On-board vehicle control system and method for determining whether a vehicle is within a geographical area of interest
US10122790B2 (en) 2015-09-22 2018-11-06 Veniam, Inc. Systems and methods for vehicle traffic management in a network of moving things
US11235777B2 (en) * 2015-10-15 2022-02-01 Harman International Industries, Incorporated Vehicle path prediction and target classification for autonomous vehicle operation
US9958865B2 (en) * 2015-12-18 2018-05-01 GM Global Technology Operations LLC Systems and methods to enable or disable autonomous driving
US10127814B2 (en) * 2017-02-03 2018-11-13 Ford Global Technologies, Llc Advanced V2X event dissemination
CN107168334B (zh) * 2017-06-26 2020-07-07 上海联适导航技术有限公司 一种路径规划方法及机器人
US20200174490A1 (en) * 2017-07-27 2020-06-04 Waymo Llc Neural networks for vehicle trajectory planning
US11050556B2 (en) * 2018-07-13 2021-06-29 Micron Technology, Inc. Secure vehicular communication
CN115328108A (zh) * 2021-04-23 2022-11-11 南京泉峰科技有限公司 智能割草设备及其运行控制方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0683445A (ja) * 1992-08-31 1994-03-25 Shinko Electric Co Ltd 自動走行移動体による無人搬送システムにおける走行経路選定方法
JPH09508740A (ja) * 1994-10-24 1997-09-02 キャタピラー インコーポレイテッド 自律走行車両システムにおける資源に対するアクセスを管理するシステム及び方法
JP2000285373A (ja) * 1999-03-31 2000-10-13 Toshiba Corp 車両走行システムおよび車両自動走行方法
JP2010073080A (ja) * 2008-09-22 2010-04-02 Komatsu Ltd 無人車両の走行経路生成方法

Family Cites Families (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5914711A (ja) * 1982-07-13 1984-01-25 株式会社クボタ 無人走行作業車
US5202833A (en) * 1989-08-28 1993-04-13 Chrysler Corp Method of controlling the partial lock-up of a torque converter in an electronic automatic transmission system
US5528888A (en) * 1993-12-27 1996-06-25 Fuji Jukogyo Kabushiki Kaisha Autonomous mowing vehicle and apparatus for detecting boundary of mowed field
US5659596A (en) * 1995-04-12 1997-08-19 International Business Machines Corporation System for location of communication end users
US7050061B1 (en) * 1999-06-09 2006-05-23 3Dlabs Inc., Ltd. Autonomous address translation in graphic subsystem
GB2358843B (en) * 2000-02-02 2002-01-23 Logical Technologies Ltd An autonomous mobile apparatus for performing work within a pre-defined area
JP3882554B2 (ja) * 2001-09-17 2007-02-21 日産自動車株式会社 ナビゲーション装置
GB0126499D0 (en) * 2001-11-03 2002-01-02 Dyson Ltd An autonomous machine
US6574553B1 (en) * 2001-12-11 2003-06-03 Garmin Ltd. System and method for calculating a navigation route based on adjacent cartographic map databases
US6975923B2 (en) * 2002-10-01 2005-12-13 Roke Manor Research Limited Autonomous vehicle guidance on or near airports
EP1586423B1 (en) * 2002-12-10 2011-10-05 Honda Motor Co., Ltd. Robot control device, robot control method, and robot control program
US7010425B2 (en) * 2003-03-31 2006-03-07 Deere & Company Path planner and a method for planning a path of a work vehicle
US7327250B2 (en) * 2003-07-25 2008-02-05 Qualcomm Incorporated System for providing a virtual vehicle boundary
JP2008009638A (ja) 2006-06-28 2008-01-17 Murata Mach Ltd 走行台車システムおよび走行台車の走行制御方法
US8209075B2 (en) * 2007-07-31 2012-06-26 Deere & Company Method and system for generating end turns
US8204654B2 (en) * 2008-03-20 2012-06-19 Deere & Company System and method for generation of an inner boundary of a work area
US8961695B2 (en) * 2008-04-24 2015-02-24 Irobot Corporation Mobile robot for cleaning
EP2343617A4 (en) * 2008-09-03 2013-11-20 Murata Machinery Ltd ROUTE PLANNING METHOD, ROUTE PLANNING UNIT, AND AUTONOMOUS MOBILE DEVICE
EP3550393B1 (en) * 2009-11-06 2023-03-01 iRobot Corporation Method and system for covering a surface by an autonomous robot
US20110153541A1 (en) * 2009-12-22 2011-06-23 Caterpillar Inc. Systems and methods for machine control in designated areas
JP4885336B2 (ja) * 2010-02-12 2012-02-29 三菱電機株式会社 地図表示装置
US20110295423A1 (en) * 2010-05-27 2011-12-01 Noel Wayne Anderson Condition based keep-out for machines
US20120078417A1 (en) * 2010-09-28 2012-03-29 International Business Machines Corporartion Detecting Energy and Environmental Leaks In Indoor Environments Using a Mobile Robot

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0683445A (ja) * 1992-08-31 1994-03-25 Shinko Electric Co Ltd 自動走行移動体による無人搬送システムにおける走行経路選定方法
JPH09508740A (ja) * 1994-10-24 1997-09-02 キャタピラー インコーポレイテッド 自律走行車両システムにおける資源に対するアクセスを管理するシステム及び方法
JP2000285373A (ja) * 1999-03-31 2000-10-13 Toshiba Corp 車両走行システムおよび車両自動走行方法
JP2010073080A (ja) * 2008-09-22 2010-04-02 Komatsu Ltd 無人車両の走行経路生成方法

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015129366A1 (ja) * 2014-02-25 2015-09-03 アイシン・エィ・ダブリュ株式会社 経路探索システム、経路探索方法、コンピュータプログラム及びコストテーブルのデータ構造
JP2015158467A (ja) * 2014-02-25 2015-09-03 アイシン・エィ・ダブリュ株式会社 経路探索システム、経路探索方法、コンピュータプログラム及びコストテーブルのデータ構造
US10126743B2 (en) 2014-02-25 2018-11-13 Aisin Aw Co., Ltd. Vehicle navigation route search system, method, and program
US9304515B2 (en) 2014-04-24 2016-04-05 Lenovo Enterprise Solutions (Singapore) Pte. Ltd. Regional operation modes for autonomous vehicles
US9349284B2 (en) 2014-04-24 2016-05-24 International Business Machines Corporation Regional driving trend modification using autonomous vehicles
US9361795B2 (en) 2014-04-24 2016-06-07 International Business Machines Corporation Regional driving trend modification using autonomous vehicles
US10852734B2 (en) 2017-08-25 2020-12-01 Toyota Jidosha Kabushiki Kaisha Autonomous driving device
US11625038B2 (en) 2017-08-25 2023-04-11 Toyota Jidosha Kabushiki Kaisha Autonomous driving device
US11747814B2 (en) 2017-08-25 2023-09-05 Toyota Jidosha Kabushiki Kaisha Autonomous driving device
CN110065495A (zh) * 2018-01-24 2019-07-30 努托诺米有限公司 车辆的速度行为规划
US11927957B2 (en) 2018-01-24 2024-03-12 Motional Ad Llc Speed behavior planning for vehicles
JP6678831B1 (ja) * 2019-03-12 2020-04-08 三菱電機株式会社 制御装置および制御方法
WO2020183608A1 (ja) * 2019-03-12 2020-09-17 三菱電機株式会社 制御装置および制御方法

Also Published As

Publication number Publication date
DE112011105829T5 (de) 2014-08-07
JP5868420B2 (ja) 2016-02-24
US8983709B2 (en) 2015-03-17
AU2011380820A1 (en) 2014-05-29
CA2854274C (en) 2015-10-13
CA2854274A1 (en) 2013-05-16
JPWO2013069054A1 (ja) 2015-04-02
US20140316635A1 (en) 2014-10-23
AU2011380820B2 (en) 2014-11-13

Similar Documents

Publication Publication Date Title
JP5868420B2 (ja) 自律走行システム
US11454973B2 (en) Mapped driving paths for autonomous vehicle
JP6451848B2 (ja) 運転計画装置、走行支援装置、運転計画方法
KR102094622B1 (ko) 씬 평가 장치, 주행 지원 장치, 씬 평가 방법
KR102053552B1 (ko) 운전 계획 장치, 주행 지원 장치, 운전 계획 방법
US8947259B2 (en) Vehicle wrong-way travel detection device
KR102092484B1 (ko) 씬 평가 장치, 주행 지원 장치, 씬 평가 방법
CN108604419B (zh) 车辆的行驶控制方法及车辆的行驶控制装置
KR20180100194A (ko) 경로 이탈 인식 방법, 단말 및 저장 매체
CN113066298B (zh) 车辆行驶控制方法、装置、车辆、服务器、存储介质
WO2021168845A1 (zh) 导航方法及装置
JP2023513425A (ja) 車両挙動予測方法及び装置、電子機器、記憶媒体
RU2660425C1 (ru) Устройство вычисления маршрута движения
CN115079702B (zh) 一种混合道路场景下的智能车辆规划方法和系统
WO2016103921A1 (ja) 情報処理装置
Asghar et al. Vehicle localization based on visual lane marking and topological map matching
BR112020001645A2 (pt) método de assistência de deslocamento e dispositivo de assistência de deslocamento
CN115265564A (zh) 一种车道线标注方法及装置
JP6780541B2 (ja) 迂回推奨領域推定システム、迂回推奨領域推定プログラムおよびナビゲーション装置。
JP6443551B2 (ja) シーン評価装置、走行支援装置、シーン評価方法
CN110758232A (zh) 一种车辆转向灯控制方法、车辆及存储介质
JP2021196874A (ja) 走行支援方法及び走行支援装置
JP6428219B2 (ja) 経路案内システム、方法およびプログラム
Asghar et al. Map Relative Localization Based on Visual and Topological Map Matching
JP2022167449A (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: 11875349

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2013542686

Country of ref document: JP

Kind code of ref document: A

ENP Entry into the national phase

Ref document number: 2854274

Country of ref document: CA

WWE Wipo information: entry into national phase

Ref document number: 14357130

Country of ref document: US

WWE Wipo information: entry into national phase

Ref document number: 1120111058292

Country of ref document: DE

Ref document number: 112011105829

Country of ref document: DE

ENP Entry into the national phase

Ref document number: 2011380820

Country of ref document: AU

Date of ref document: 20111109

Kind code of ref document: A

122 Ep: pct application non-entry in european phase

Ref document number: 11875349

Country of ref document: EP

Kind code of ref document: A1