WO2023058079A1 - 経路生成装置及び方法 - Google Patents

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

Info

Publication number
WO2023058079A1
WO2023058079A1 PCT/JP2021/036574 JP2021036574W WO2023058079A1 WO 2023058079 A1 WO2023058079 A1 WO 2023058079A1 JP 2021036574 W JP2021036574 W JP 2021036574W WO 2023058079 A1 WO2023058079 A1 WO 2023058079A1
Authority
WO
WIPO (PCT)
Prior art keywords
route
information
moving
vehicle
dynamic
Prior art date
Application number
PCT/JP2021/036574
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 PCT/JP2021/036574 priority Critical patent/WO2023058079A1/ja
Priority to JP2023545219A priority patent/JP7401034B2/ja
Publication of WO2023058079A1 publication Critical patent/WO2023058079A1/ja

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/10—Path keeping
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W60/00—Drive control systems specially adapted for autonomous road vehicles
    • 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
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles

Definitions

  • the present invention relates to a route generation device and method for mobile operation control or support.
  • the conventional route generation device considers the target lateral acceleration accompanying lane changes (lateral acceleration that causes discomfort to the driver) in order to select the least cost travel route, it does not reduce the number of lane changes. there is a possibility. Frequent lane changes deteriorate the ride comfort of the vehicle, so there is a problem that the generated travel route (i.e. moving route) is not comfortable for the user riding in the vehicle (i.e. moving object).
  • the present invention has been made to solve the problems described above, and provides a route generation apparatus and method that suppresses lane changes and generates a route that is comfortable for a user on board a mobile object.
  • the purpose is to
  • the route generation device is Movement of the moving body using position information of the moving body, peripheral information of the moving body, and a plurality of route points respectively set on a plurality of paths of the moving body on a plurality of paths of one passage.
  • a route generation device for generating a route, Map information including information about passing points of the moving object and one or more moving route candidates for the moving object obtained from the plurality of route points are dynamically obtained using the position information and the peripheral information.
  • a dynamic information acquisition unit that adds information to generate dynamic coordinate vector information corresponding to each of the moving route candidates; weighting a predetermined positive value corresponding to the dynamic information to a predetermined standard cost between path points belonging to the dynamic coordinate vector information, and calculating the sum of the standard costs; Giving a predetermined positive weight according to the frequency of course changes of the moving body to the sum of the reference costs, and a moving route generation unit that selects a moving route having a smaller sum of the reference costs from among the plurality of moving route candidates.
  • the route generation method includes: The information processing device Movement of the moving body using position information of the moving body, peripheral information of the moving body, and a plurality of route points respectively set on a plurality of paths of the moving body on a plurality of paths of one passage.
  • a route generation method for generating a route, Map information including information about passing points of the moving object and one or more moving route candidates for the moving object obtained from the plurality of route points are dynamically obtained using the position information and the peripheral information.
  • FIG. 1 is a schematic configuration diagram of a route generation device according to Embodiment 1;
  • FIG. 1 is a block configuration diagram of a route generation device according to Embodiment 1;
  • FIG. 1 is an example of a travel route defined by a lattice structure (lattice) according to Embodiment 1; It is an example of coordinate vector information in Embodiment 1.
  • FIG. It is an example of a reference cost of a travel route defined by a lattice structure, which is used for cost calculation of the travel route in Embodiment 1.
  • FIG. 4 is a flow chart showing the processing order of the route generation device according to Embodiment 1; 4 is a flow chart of internal processing of movement route generation in the movement route generation unit of Embodiment 1.
  • FIG. 2 is a configuration diagram of hardware included in the route generation device according to Embodiment 1.
  • FIG. 2 is a configuration diagram of hardware included in the route generation device according to Embodiment 1.
  • FIG. 1 is a schematic configuration diagram of a route generation device according to Embodiment 1.
  • a vehicle will be described as an example of a moving body.
  • a vehicle path is, for example, a road, and a vehicle course is, for example, a driving lane.
  • the vehicle that is the object of operation support by the route generation device is described as "self-vehicle”, and the moving route of the vehicle is described as "running route”.
  • the user is assumed to mean an occupant of the own vehicle.
  • Own vehicle 1 is a vehicle in which a person (user) boards.
  • the own vehicle 1 is an ordinary passenger car, an electric wheelchair, a PMV (Personal Mobility Vehicle), a two-wheeled vehicle, a bus, a taxi, or the like.
  • the own vehicle 1 may be a combination of a vehicle (tractor) having power for traveling and a vehicle towed by the towing vehicle having no power.
  • the self-vehicle 1 has power (for example, an engine, a motor, etc.) and wheels for running, a wheel steering mechanism (for example, steering, etc.) for changing the moving direction, and a braking mechanism for decelerating or stopping. (eg, brakes, etc.).
  • the vehicle 1 has a display device (such as a display) for presenting the travel route of the vehicle 1 to the user, and a guidance device (such as a speaker) for providing voice guidance.
  • a display device such as a display
  • a guidance device such as a speaker
  • the communication device 2 is an input/output interface of the route generation device 100 .
  • the communication device 2 is used to acquire various sensor information D1 input from the own vehicle 1 . It is also used to output the vehicle control information D2 generated by the route generating device 100 to the host vehicle 1.
  • the communication device 2 includes, for example, various sensors provided in the own vehicle 1 (for example, GNSS (Global Navigation Satellite System), IMU (Internal Measurement Unit), Road Side Unit) information reception machine, monocular camera, stereo camera, LiDAR (Light Detection and Ranging), millimeter wave radar, ultrasonic sensor, etc.) are connected.
  • GNSS Global Navigation Satellite System
  • IMU Internal Measurement Unit
  • Road Side Unit information reception machine
  • monocular camera stereo camera
  • LiDAR Light Detection and Ranging
  • millimeter wave radar ultrasonic sensor, etc.
  • the communication device 2 may have a receiving device and a transmitting device.
  • the communication device 2 may be connected to an external network using a receiving device and a transmitting device.
  • the receiving device and the transmitting device are devices capable of connecting to an external network, such as a NIC (Network Interface Card) or a modem.
  • NIC Network Interface Card
  • the communication network 3 is a wired or wireless network, such as CAN (Controller Area Network) (registered trademark), LAN (Local Area Network), the Internet, or a telephone line.
  • CAN Controller Area Network
  • LAN Local Area Network
  • the Internet or a telephone line.
  • the route generating device 100 may be mounted on the own vehicle 1, it is not limited to this, and may be configured by a server computer located at a location different from the own vehicle 1. Alternatively, it may be composed of a portable computer owned by a user on board the own vehicle 1 .
  • the various sensor information D1 acquired from the own vehicle 1 may be transmitted via the communication network 3 connected to the communication device 2, for example, and input to the route generation device 100 on the computer.
  • the vehicle control information D2 generated by the route generation device 100 on the computer may be sent to the own vehicle 1 via the communication network 3, for example, in the same manner as the various sensor information D1.
  • the various sensors are not necessarily mounted on the own vehicle 1. For example, various sensor information collected from other vehicles existing in the vicinity of the own vehicle 1 is input to the own vehicle 1 via the communication network 3. You can also
  • FIG. 2 is a block diagram showing a configuration example of the route generation device according to the first embodiment.
  • the route generation device 100 includes a recognition unit 200, a map information analysis unit 201, a static information acquisition unit 202, a coordinate vector generation unit 203, a peripheral information/self information analysis unit 204, a dynamic information acquisition unit 205, a movement It is composed of a route generation unit 206 , a movement/stop judgment unit 207 and a vehicle control unit 208 .
  • the recognizing unit 200 receives various sensor information D1 output by the own vehicle 1, that is, the vehicle on which the user rides, recognizes the various information output from the various sensors, and outputs information corresponding to the various sensor information 1. do. Henceforth, vehicles other than the own vehicle 1 are called other vehicles.
  • information corresponding to the various sensor information D1 output by the own vehicle for example, road information D3 obtained from the roadside device (for example, speed limit information regarding the own vehicle 1, lane regulation information due to construction etc., intersection information, traffic light information, stop line information, etc.), for example, the position information D4 of the vehicle 1 obtained from GNSS or IMU (for example, the position, moving speed, acceleration, course direction, etc.
  • the road information 3 may be included in the surrounding information 5.
  • the road information 3 may be obtained using the surrounding information 5.
  • speed limit information which is the road information 3, from the road sign regarding the speed limit acquired by the surrounding information 5. This is effective when direct acquisition of the road information 3 is impeded (for example, there is no roadside device near the vehicle 1).
  • the map information analysis unit 201 uses the map information D6 held by the map data 210, the road information D3, and the position information D4 of the own vehicle 1, from all the map information D6 registered in the map data 210, For example, the map information D6 of the range necessary for route generation from the starting point to the destination point is obtained and output as static information D7.
  • the starting point is, for example, the place where the own vehicle is located when evaluating the cost of the travel route, which will be described later.
  • the map data 210 may be held inside the route generation device 100 , or the map data 210 outside the route generation device 100 may be supplied to the inside of the route generation device 100 using the communication device 104 . good too.
  • the static information acquisition unit 202 uses the static information D7, based on the information in the static information 7, such as the road shape information regarding the road width and the number of running lanes, and the speed limit information regarding the own vehicle 1, Point information D8 of all routes on which the own vehicle 1 can travel is acquired.
  • the obtained point information D8 is converted into parameters applicable to the coordinate vector generation unit 203, which will be described later, and output.
  • the coordinate vector generation unit 203 generates point information D8 and a lattice D9, which has a lattice structure and is composed of a plurality of route points forming a plurality of travel routes on a plurality of travel lanes of one road, which will be described later. Based on this, a plurality of travel routes that can be traced at each point in the point information D8 are generated, and the generated travel routes are output as coordinate vector information D10.
  • the lattice D9 may be held inside the path generation device 100, or the lattice 9 outside the path generation device 100 may be supplied to the interior of the path generation device 100 using the communication device 104. .
  • the number may be omitted and simply referred to as "lattice".
  • FIG. 3 is an example of the lattice D9 of the travel route in the first embodiment.
  • the vehicle travels in two lanes, and the traveling directions of the first lane LANE1 and the second lane LANE2 are the same.
  • An arrow drawn in the second lane LANE2 indicates the traveling direction of the vehicle.
  • the circles in FIG. 3 are logically set point marks called route points (waypoints), which are expressed as route points p[x, y].
  • x indicates the driving lane number
  • y indicates the order in which the cars are arranged in the traveling direction.
  • p[x, y] may be used as an ID representing the positional relationship of each route point.
  • Lattice D9 is a rectangle connecting adjacent path points p[x,y] (for example, connecting p[1,0] and p[2,0] and p[1,1] and p[2,1] It is table data defined by a lattice structure in which a plurality of basic shapes are connected to each other.
  • a route point p[x, y] of the lattice D9 can be associated with each point in the point information D8. Further, the path points of the lattice D9 are, for example, configured to have an angle at which the course can be changed safely (for example, the course change angle is set to 20 degrees or less) according to the speed limit information regarding the own vehicle 1. .
  • the number of lanes on the travel route is not limited to two, and may be three or more, and the number of lanes may increase or decrease in the middle of the travel route.
  • roads are not limited to being outdoors, and may be indoors (for example, indoor parking lots, passages in facilities, tunnels, etc.). Note that the lattice does not necessarily have to be a lattice structure.
  • a single lane does not form a grid, but line segments connecting adjacent route points can be regarded as a grid.
  • the structure connecting a plurality of route points expresses the basic structure of the travel route, and it goes without saying that this structure (the structure connecting a plurality of route points) is a lattice.
  • the distance between each route point of the lattice D9 shown in FIG. be able to.
  • the distance between route points in the direction of travel (for example, between p[1,0] and p[1,1]) is 3 m, and the distance between lanes is 3 m.
  • the distance between path points (for example, between p[1,1] and p[2,1]) is set to 2m, but may be set to a shorter distance.
  • the lattice D9 shown in FIG. None if the driving route has curves (eg, curves, roundabouts, etc.), the lines connecting the route points may consist of curves.
  • the basic shape of the lattice need not be a tetragonal lattice (quadrilateral), and may be composed of polygons such as triangles and hexagons.
  • the travel route is composed of three dimensions (for example, a route that includes vertical movement such as a grade crossing, a multi-story parking lot, a slope, etc.)
  • the lattice is formed of a three-dimensional lattice such as a cube or a regular tetrahedron.
  • the distances between path points need not be equal, and the basic shapes need not be of the same type.
  • the distances between route points may be uneven, the basic shape may be a mixture of two-dimensional and three-dimensional configurations, and traffic conditions (for example, changes in road shape due to construction, increase or decrease in traffic volume, etc.).
  • FIG. 4 shows an example of the coordinate vector information D10 generated on the lattice D9 shown in FIG.
  • the coordinate vector information D10 is a set of route points that follow a solid line portion from the route point of the starting point (start) to the route point of the destination point (goal). More specifically, an example of the coordinate vector information D10 starts from the route point p[1,0] at the starting point of the first lane LANE1, and the route point p[2,1] ⁇ p[2,2]. ⁇ p[2,3] ⁇ p[1,4] to the route point [1,5] of the destination point of the first lane LANE1.
  • the set P of path points is ⁇ P
  • Fig. 5 shows an example of the standard cost of the lattice D9 used to calculate the cost of the travel route.
  • Numerical values shown between path points in FIG. 5 are reference cost values of the lattice D9, and are set as predetermined positive numerical values.
  • the method of setting the standard cost of the lattice D9 is set based on, for example, traffic regulations such as driving in the left lane with priority (key left) in countries with left-hand traffic rules, or customs in traffic.
  • the reference cost for traveling on the second lane LANE2 is set to a larger value (eg, 2) than the reference cost for traveling on the first lane LANE1 (that is, the left lane) (eg, 1). are doing.
  • the first lane LANE1 can be preferentially driven. Note that these are only examples, and the numerical value of the standard cost of the lattice D9 can be arbitrarily set according to the conditions of the driving route (for example, the width of the lane, the difference in the slope angle of the lane, etc.).
  • the vehicle 1 may change lanes in order to avoid the obstacle. Further, when another vehicle approaches the vehicle 1 from behind, the vehicle 1 may change lanes to give way to the driving lane.
  • a larger standard cost eg, 5 in FIG. 5
  • a larger reference cost may be set in order to suppress lane changes immediately before or after an obstacle.
  • lane changes other than obstacles include, for example, right and left turns, driving time, increased number of lane changes after that, depending on the situation of passengers including the user, and the like.
  • the reference cost between route points may be set to a higher reference cost than traveling on the same lane.
  • the peripheral information/self-information analysis unit 204 acquires the position information D4 of the own vehicle 1 and the peripheral information D5 of the own vehicle 1 in real time (for example, at short intervals of 1 msec), and analyzes using the information,
  • the ever-changing vehicle state of the own vehicle 1 for example, running at 40 km/h, stopping at a traffic light, changing course, accelerating, running behind another vehicle, etc.
  • target information D11 for example, running at 40 km/h, stopping at a traffic light, changing course, accelerating, running behind another vehicle, etc.
  • the dynamic information acquisition unit 205 associates the dynamic information D11 with the point information D8. Specifically, for point information 8 included in coordinate vector information D10, dynamic information D11 corresponding to each route point (for example, vehicle state of host vehicle 1, surrounding information such as other vehicles, obstacles, traffic lights, etc.). By adding information on the vehicle state of the own vehicle 1 that changes from moment to moment to the point information 8, the coordinate vector information 10 can be made real-time. Coordinate vector information 10 to which dynamic information 11 is added by this process is output as dynamic coordinate vector information D12.
  • the movement path generation unit 206 weights the reference cost of the lattice D9 in real time according to the dynamic information D11. Specifically, for the standard cost of the lattice D9 shown in FIG. 5, for example, information about obstacles acquired by the dynamic information 11 Other vehicles traveling in the area, etc.) or information on the risk area is used, and the weighting factor set for each information is used to weight the reference cost in real time. Next, using the weighted lattice reference cost, from the reference cost of the travel route passing through each route point, for example, a travel route with the smallest sum of the reference costs is selected and output as travel route data D13. do.
  • determination information D14 output by the movement/stop determination unit 207 may be reinputted (looped back) and reflected (recalculated).
  • the sum of the standard costs of the travel route may be calculated using risk areas (for example, points with many on-street parked vehicles, points with frequent traffic jams and their times, etc.).
  • risk areas for example, points with many on-street parked vehicles, points with frequent traffic jams and their times, etc.
  • the reference cost of the travel route is increased by increasing the weight of the reference cost between route points. By controlling the weight of the standard cost in this way, it is possible to generate a travel route that avoids the risk area.
  • the vehicle 1 can change lanes.
  • a certain section after changing lanes for example, a section that passes a predetermined distance, a predetermined number of route points, etc.
  • a weight penalty may be given to the total cost of the travel route to prohibit or suppress another lane change.
  • the total cost of the travel route can be increased by multiplying the total cost of the travel route by a positive constant weight (for example, 1.2). Further, if the distance to the next lane change after the lane change is less than a certain value, a penalty may be given to the total cost of the travel route.
  • a travel route that minimizes the frequency of lane changes (for example, the total number of lane changes from the departure point to the destination point, the average number of lane changes per predetermined time period, etc.) may be selected. In this way, it is possible to generate a travel route based on various lane change conditions according to conditions such as the travel characteristics of the vehicle or the length of the travel route.
  • the rule set 211 holds a set of traffic laws to be complied with expressed by logical expressions.
  • traffic regulations are expressed by the following logical formula. Assume that the propositional symbols representing "the traffic signal indicates a red light”, “the traffic signal indicates a yellow signal”, and “enter the intersection” are "A”, "B", and “C”, respectively.
  • a traffic regulation that states that "you must not enter an intersection when the traffic light indicates red or yellow” is expressed by a logical expression such as Equation (1).
  • the rule set 211 may include rules other than traffic laws (eg, customs in traffic, rules for driving on private roads within a facility, etc.) as long as they are to be complied with. Note that the rule set 211 may be held inside the route generation device 100 or may be supplied from the outside.
  • the movement/stop determination unit 207 uses the dynamic information 11, the travel route data D13, and the rule set 211 to determine the operation control (for example, travel, stop, avoidance, following, etc.) of the own vehicle 1, and Determination information D14, which is the determination result, is generated and output.
  • the vehicle control unit 208 operates according to the determination information D14 output by the movement/stop determination unit 207 to control the power, steering mechanism, etc. of the own vehicle 1 (for example, run, decelerate, stop, follow other vehicles, change the travel route, etc.). ), and outputs the control signal as vehicle control information D2.
  • the own vehicle 1 receives the vehicle control information D2, and controls the power of the own vehicle 1, the wheel steering mechanism for changing the direction of movement, and the braking mechanism for decelerating or stopping the vehicle. .
  • the own vehicle 1 is not an automatic driving vehicle (that is, a vehicle driven by the user)
  • the driving route generated using the display device is presented to the user on the screen, or voice guidance is provided using the guidance device. It is possible to Therefore, it goes without saying that the effects of the present invention are the same as in the case of an automatic driving vehicle, even when the user himself/herself drives the vehicle.
  • the communication network 3 may be used to notify other vehicles other than the own vehicle 1 of the generated travel route data 13 . By notifying other vehicles of the travel route of own vehicle 1, there is an effect of promoting smooth traffic for other vehicles.
  • FIG. 6 is a flow chart showing the processing order of the route generation device 100 according to the first embodiment. Details of the operation will be described below with reference to the flow chart of FIG. It should be noted that “unit” in each step below may be read as “step”, “processing”, or "process”.
  • step ST101 the move/stop determination unit 207 uses the rule set 211 to construct the initial state of the travel route of the move/stop determination unit 207 (step ST101). Specifically, for example, an initial setting for confirming the lane in which the vehicle can travel (that is, the vehicle is permitted to travel) according to traffic regulations, depending on the type of vehicle (eg, passenger car, motorcycle, bus, etc.) is.
  • step ST101 an initial setting for confirming the lane in which the vehicle can travel (that is, the vehicle is permitted to travel) according to traffic regulations, depending on the type of vehicle (eg, passenger car, motorcycle, bus, etc.) is.
  • the static information acquisition unit 202 acquires the static information D7 and forms the static information D7 so that it can be used inside the route generation device 100 (step ST102).
  • the content of the static information 7 is formed into an array variable, and formed into a shape that can be easily processed by a computer.
  • step ST103 the coordinate vector generation unit 203 generates coordinate vector information D10 (step ST103). After the processing of step ST103, the process proceeds to step ST104.
  • step ST104 the peripheral information/self-information analysis unit 204 acquires the dynamic information D11 using the position information D4 of the own vehicle 1 and the peripheral information D5 of the own vehicle 1, and the dynamic information D11 is sent to the route generation device. It is shaped so that it can be used inside 100 (step ST104).
  • the contents of the dynamic information 11 are formed into a shape that can be easily processed by a computer, such as converting the contents of the dynamic information 11 into an array variable.
  • the dynamic information acquisition unit 205 associates the dynamic information D11 with the coordinate vector information D10. For example, the correspondence is performed by calculating the nearest route point from the position of the own vehicle 1, the coordinates of the obstacle, and the coordinates of each route point. Note that if there is no route point within the distance within the threshold, there is no corresponding route point. However, sections where lane changes are not permitted under traffic regulations (e.g., intersections, overtaking prohibited sections, before crosswalks, before stop lines, etc.), or sections where lane changes should not be made (e.g., curves with poor visibility, etc.) gives only straight line information. Further, it is determined whether or not the lane can be changed based on whether or not the next route point exists in the direction normal to the direction of travel from the route points on the road where the lane can be changed.
  • traffic regulations e.g., intersections, overtaking prohibited sections, before crosswalks, before stop lines, etc.
  • sections where lane changes should not be made e.g., curves with poor visibility,
  • Equation (2) the presence or absence of a combination of values (a, b) that satisfies Equation (2) is checked from the IDs of all route points on the same road and in adjacent lanes. It is defined that a lane change is possible for combinations that
  • d is the moving direction vector of the host vehicle 1
  • h is the normal vector of d
  • p0 is the position vector of the current route point
  • p1 is the normal vector of the position vector of the next route point.
  • margin is a lane change determination threshold regarding a distance margin between route points in the direction of travel
  • width is a lane change determination threshold regarding a distance to an adjacent lane, each of which takes a predetermined positive value.
  • the movement route generation unit 206 uses the dynamic coordinate vector information D12 to calculate the reference cost of the lattice D9 shown in FIG. Other vehicles traveling at a lower speed than the own vehicle, etc.), or set a weight according to the risk area, and weight the standard cost. Specifically, a weight is set for passing through each route point in the coordinate vector information D10 according to the obstacle or the risk area, and the reference cost is multiplied by the weight.
  • step ST106 the process proceeds to step ST107.
  • FIG. 7 is a flowchart of the internal processing of moving route generation in step ST106.
  • the dynamic coordinate vector information D12 is referred to acquire the standard cost of the lattice D9 (step ST106A).
  • step ST106B the process proceeds to step ST106B.
  • step ST106B the dynamic coordinate vector information D12 is referenced, a weight is set for passing through each route point in the coordinate vector information D10 according to the obstacle or the risk area, and each standard cost is multiplied by the weight (step ST106B). For example, a large weight is set when passing through a route point near an obstacle.
  • step ST106C the process proceeds to step ST106C.
  • step ST106C the sum C SUM (k) of costs for each travel route candidate from the route point of the departure point to the route point of the destination point is calculated according to the formula (3) based on the weighted reference cost. (Step ST106C). After the processing of step ST106C, the process proceeds to step ST106D.
  • k is a number indicating the dynamic coordinate vector information (that is, the travel route candidate), and C p[x, y] (k) is the route point p[x, y] belonging to the k-th dynamic coordinate vector information. ], w p[x,y] (k), is the weighting factor of the path point p[x,y] belonging to the k-th dynamic coordinate vector information.
  • step ST106D a penalty is given by equation (4) to C SUM (k) obtained by equation (3) ( ⁇ (k) and ⁇ (k) are multiplied by C SUM (k)) (step ST106D).
  • step ST106E the process proceeds to step ST106E.
  • step ST106E a travel route that minimizes the total cost ⁇ SUM (k) of penalized travel routes is selected (step ST106E). After the process of step ST106E, this flowchart is terminated (END).
  • FIG. 8 is a specific example of cost calculation of a travel route using a lattice in the movement route generation unit 206 of the first embodiment.
  • the obstacle HZD in FIG. 8 is, for example, another vehicle.
  • the obstacle HZD that is, another vehicle
  • the margin in Equation (2) is set to, for example, the distance between adjacent route points. That is, if there is an obstacle HZD between route points, no lane change is performed between those route points.
  • the number k of the dynamic coordinate vector information is omitted.
  • the weight is 50 in the path from p[1,0] to p[1,1] and the path from p[1,3] to p[1,4] (1 is multiplied by 50 and labeled as 50), and the path from p[2,2] to p[1,4] has a weight of 100 (in FIG. 8, the basic cost of 5 is multiplied by 100 and labeled as 500 display), a weight is set according to the risk of each route.
  • the weighted reference cost is simply abbreviated as "weighted cost”.
  • the two obstacles are regarded as one continuous obstacle.
  • a driving path is generated for the obstacles. Therefore, after avoiding the first obstacle, the lane is not changed again to the first lane LANE1, so frequent lane changes can be suppressed.
  • the penalty for suppressing frequent lane changes is defined as follows.
  • FIG. 8(a) shows the case where the obstacle HZD does not exist on the travel route of the own vehicle 1.
  • the set P of path points indicated by the coordinate vector information D10 is ⁇ P
  • the set P of path points indicated by the coordinate vector information D10 is ⁇ P
  • the weighted cost from p[1,0] to p[2,1] is five.
  • the weighted cost from p[2,1] to p[2,2] is two.
  • the weighted cost from p[2,2] to p[2,3] is two.
  • the weighted cost from p[2,3] to p[1,4] is five.
  • the set P of path points indicated by the coordinate vector information D10 is ⁇ P
  • the weighted cost from p[1,0] to p[2,1] is five.
  • the weighted cost from p[2,1] to p[2,2] is two.
  • the weighted cost from p[2,2] to p[2,3] is two.
  • the weighted cost from p[2,3] to p[2,4] is two.
  • pattern (b) has a smaller total cost, but pattern (b) changes lanes again before passing through two route points after changing lanes, so frequent lane changes are possible.
  • the pattern of the travel route that minimizes the total cost ⁇ SUM of the penalized travel route is the pattern (c).
  • the traveling route of the pattern (c) thus generated is output as the traveling route data D13.
  • the travel route with the pattern (c) requires a longer distance to change lanes again after changing lanes. In other words, the frequency of lane changes of the host vehicle is reduced. Therefore, it is possible to improve the comfort of the user who gets on the own vehicle 1 .
  • the weights between route points change. is done. Note that the cost recalculation does not need to be calculated from the route point of the original starting point. For example, the route point closest to the vehicle 1 at the present time may be calculated as a new starting point, and the amount of processing required for recalculation can be reduced.
  • the movement/stop determination unit 207 uses the dynamic information 11, the travel route data D13, and the rule set 211 to perform the movement/stop determination process for the own vehicle 1 (step ST107).
  • FIG. 9 shows an example of the movement/stop determination process of the own vehicle 1 based on the travel route data D13 generated by the route generation device 100 of the first embodiment.
  • a traffic light 300 another vehicle (another vehicle 301) that is traveling in the same lane as the own vehicle 1 (indicated by 1a, 1b, and 1c in FIG. 9) or that is stopped, and the opposite lane of the own vehicle 1
  • the travel route data D13 generated in the presence of another vehicle an oncoming vehicle 302 traveling from the opposite direction
  • a stop line 303, and an intersection 305 having crosswalks 304a and 304b the movement and It performs stop judgment processing.
  • the vehicle 1 travels in the north direction, turns right at the intersection 305, and proceeds in the east direction.
  • FIG. 10 is an example of movement/stop judgment processing of the first embodiment expressed by BT.
  • a known technology such as a state machine may be used as the format.
  • FIG. 11 is a flowchart of the traffic light stop determination process, which is part of the route determination process in step ST107.
  • FIG. 12 is a flowchart of the intersection stop determination process, which is part of the route determination process in step ST107. In order to simplify the explanation of this process, it is limited to a normal case where the traffic light 300 indicates a red signal, a yellow signal, or a green signal. If the signal 300 indicates an arrow display or a blinking display, it will be omitted.
  • step ST201 using the dynamic information 11 and the travel route data D13, the distance Ns from the current position of the vehicle 1 to the nearest traffic signal (for example, the traffic signal 300) in the traveling direction of the vehicle 1 is calculated. It is calculated and compared with the threshold value Nd (step ST201).
  • the threshold value Nd is set to a value that allows the host vehicle 1 to stop safely and quickly.
  • the threshold Nd is set as a distance calculated from the current running speed of the vehicle 1 and the upper limit of the deceleration acceleration at which the vehicle can safely stop.
  • step ST201 If the distance Ns is greater than the threshold Nd (Yes in step ST201), it is determined that the distance from the own vehicle 1 to the traffic light 300 is sufficient, so the process proceeds to step ST202.
  • step ST202 the vehicle 1 is instructed to travel (step ST202). Details of the travel instruction in step ST202 will be described later. After the travel instruction process of step ST202, the process proceeds to the intersection stop judgment process of FIG.
  • step ST201 if the distance Ns is equal to or less than the threshold value Nd (No in step ST201), it is determined that the distance from the own vehicle 1 to the traffic light 300 is short, so the process proceeds to step ST203.
  • step ST203 the dynamic information 11, the travel route data D13, and the rule set 211 are used to confirm the instruction content of the traffic light 300. If the traffic signal 300 indicates a red light or a yellow light (Yes in step ST203), it is determined that the vehicle 1 should stop, so the process proceeds to step ST204.
  • step ST204 the host vehicle 1 is instructed to stop (step ST204).
  • the stop instruction includes a deceleration instruction that allows the vehicle 1 to safely stop at least up to the stop line 303 in front of the pedestrian crossing 304a.
  • step 107 is completed (END).
  • step ST203 if the instruction content of the traffic light 300 is other than a red light or a yellow light (that is, a green light) (No in step ST203), it is determined that the vehicle 1 can proceed, so the process proceeds to step ST202.
  • step ST205 it is determined whether or not there is an obstacle such as a pedestrian (for example, a person, a bicycle, etc.) who is crossing or about to start crossing the crosswalks 304a, 304b in the intersection 300 or in the vicinity of the intersection 300. (Step ST205). If there is a pedestrian or the like (Yes in step ST205), it is determined that the vehicle 1 should stop, so the process proceeds to step ST206. If there is no pedestrian or the like (No in step ST205), the process proceeds to step ST207.
  • a pedestrian for example, a person, a bicycle, etc.
  • step ST206 the host vehicle 1 is instructed to stop (step ST206).
  • the stop instruction includes a deceleration instruction that allows the vehicle 1 to safely stop at least up to the stop line 303 in front of the pedestrian crossing 304a.
  • a deceleration instruction that enables a safe stop is included before the pedestrian crossing 304b and at a position that does not affect the passage of other vehicles.
  • step ST207 it is determined whether or not there is another vehicle (for example, the oncoming vehicle 302) traveling in the opposite direction of the host vehicle 1 (step ST207). If there is an oncoming vehicle 302 (Yes in step ST207), it is determined that the host vehicle 1 should stop, so the process proceeds to step ST208.
  • another vehicle for example, the oncoming vehicle 302 traveling in the opposite direction of the host vehicle 1
  • step ST208 the host vehicle 1 is instructed to stop (step ST208).
  • the stop instruction includes a deceleration instruction that allows the host vehicle 1 to safely stop at least before it enters the intersection and at a position that does not affect the passage of other vehicles, including the oncoming vehicle 301.
  • the process of step ST107 is completed (END).
  • step ST207 if there is no oncoming vehicle 302 (No in step ST207), it is determined in step ST205 that there are no pedestrians on the crosswalks 304a and 304b. Therefore, since it is judged that the own vehicle 1 can proceed, it transfers to step ST209.
  • step ST209 the vehicle 1 is instructed to travel (step ST209).
  • the travel instruction may be the same as the travel instruction in step ST202 described above, or may be changed as appropriate according to the dynamic information 11 and the travel route data D13.
  • FIG. 13 is a flow chart of the travel instruction process, which is the internal process of step ST202 (or step ST209). The travel instruction processing will be described with reference to FIG. 13 .
  • step ST301 using the dynamic information 11 and the travel route data D13, it is confirmed whether or not there is an obstacle on the route point of the travel route of the own vehicle 1. If there is an obstacle on the route point of the travel route (Yes in step ST301), the process proceeds to step ST302.
  • step ST302 dynamic information 11 and travel route data D13 are used to confirm whether an obstacle (for example, another vehicle 301) is stopped or whether the travel speed is slower than the travel speed of own vehicle 1. If the obstacle is stopped (Yes in step ST302), it is determined that the vehicle 1 should avoid the obstacle, so the process proceeds to step ST303.
  • an obstacle for example, another vehicle 301
  • the process proceeds to step ST303.
  • step ST303 the action mode of the own vehicle 1 is set to "avoidance", and the course change instruction and the traveling speed control are performed for the own vehicle 1 according to the dynamic information 11 and the traveling route data D13. (Step ST303). After the processing of step ST303, the travel instruction processing is completed (END).
  • step ST302 if the traveling speed of the obstacle is faster than the traveling speed of the own vehicle 1 (No in step ST302), the own vehicle 1 does not need to avoid the obstacle at this point, so the process proceeds to step ST304.
  • step ST304 the action mode of the vehicle 1 is set to "follow", and the vehicle 1 travels at a speed that follows the preceding other vehicle according to the dynamic information 11 and the travel route data D13.
  • Control for example, setting the speed limit of own vehicle 1 as the upper limit and running at a speed that maintains a predetermined constant distance, etc.
  • step ST304 the travel instruction processing is completed (END).
  • step ST305 using the dynamic information 11 and the travel route data D13, it is confirmed whether or not the position of the own vehicle 1 is outside the intersection and there is no lane change (step ST305). If the position of the vehicle 1 is outside the intersection and there is no lane change (Yes in step ST305), the vehicle 1 does not need to avoid or follow at this point, so the process proceeds to step ST306.
  • step ST306 the action mode of own vehicle 1 is set to "driving", and traveling speed control is performed on own vehicle 1 according to dynamic information 11 and traveling route data D13 (step ST306).
  • step ST306 the travel instruction processing is completed (END).
  • step ST305 if the position of the own vehicle 1 is inside the intersection or if there is a lane change (No in step ST305), the own vehicle 1 may avoid the oncoming vehicle 302 or an obstacle on the travel route within the intersection. Since it is determined that there is a possibility of object avoidance, the process proceeds to step ST307.
  • step ST307 the dynamic information 11 and the travel route data D13 are used to check whether there are any obstacles (for example, parked vehicles 301, oncoming vehicles 302, etc.) around the vehicle 1 (step ST307). ). If there are no obstacles around the own vehicle 1 (Yes in step ST307), the own vehicle 1 does not need to avoid obstacles, so the process proceeds to step ST306. On the other hand, if there is an obstacle around the vehicle 1 (No in step ST307), the vehicle 1 needs to avoid the obstacle, so the process proceeds to step ST308.
  • obstacles for example, parked vehicles 301, oncoming vehicles 302, etc.
  • step ST308 the action mode of the vehicle 1 is set to "avoidance", and the vehicle 1 is instructed to change course and travel speed in accordance with the dynamic information 11 and the travel route data D13. (Step ST308). After the processing of step ST308, the travel instruction processing is completed (END).
  • step ST107 the movement/stop determination process of step ST107 is completed, and the process proceeds to step ST108.
  • step ST108 the movement/stop determination unit 207 uses the dynamic information 11, the travel route data D13, and the rule set 211 to check whether there is another travel route pattern that requires consideration. If another pattern exists (Yes in step ST108), the process returns to the process of moving route generation section 206 in step ST106.
  • the determination information D14 may be input again to the moving route generating section 206. FIG. By using the determination information D14, the travel route data D13 can be recalculated, and the travel route data D13 can be generated with higher accuracy according to the situation of the own vehicle 1.
  • step ST108 it is determined whether the host vehicle 1 should move or stop corresponding to the dynamic information 11 and the travel route data D13, and the determination result is displayed. It is output as judgment information D14. After this process, the process proceeds to step ST109.
  • step ST109 the vehicle control unit 208 generates a control signal for controlling the operation of the own vehicle 1 (for example, running, decelerating, stopping, following another vehicle, changing the travel route, etc.) according to the determination information D14. , and outputs the control signal as the vehicle control information D2.
  • a control signal for controlling the operation of the own vehicle 1 for example, running, decelerating, stopping, following another vehicle, changing the travel route, etc.
  • Each process in the flowcharts shown in FIGS. 6 and 11 to 13 is executed in real time according to the processing order at execution intervals (for example, 5 millisecond intervals) according to the processing power of the computer. can be done.
  • Each configuration of the route generation device 100 shown in FIG. 2 can be implemented by, for example, a computer, which is an information processing device including a processor.
  • 14 is a configuration diagram of hardware included in the route generation device according to Embodiment 1.
  • the path generation device 100 is composed of a processor 400 , a volatile memory device 401 , a nonvolatile memory device 402 , a communication device 403 and a communication path 404 .
  • the computer containing the processor 400 is, for example, a stationary computer such as a personal computer or a server computer, a portable computer such as a smart phone or a tablet computer, or a microcomputer embedded in an in-vehicle information system such as a car navigation system. , and SoC (System on Chip).
  • a stationary computer such as a personal computer or a server computer
  • a portable computer such as a smart phone or a tablet computer
  • a microcomputer embedded in an in-vehicle information system such as a car navigation system.
  • SoC System on Chip
  • the processor 400 controls the route generation device 100 as a whole.
  • the processor 400 is a CPU (Central Processing Unit), FPGA (Field Programmable Gate Array), DSP (Digital Signal Processor), or the like.
  • Processor 400 may be a single processor or multiple processors.
  • the path generation device 100 may have a processing circuit such as an ASIC (Application Specific Integrated Circuit) other than a computer.
  • the processing circuit may be a single circuit or multiple circuits.
  • the volatile storage device 401 is the main storage device of the route generation device 100 .
  • the volatile storage device 401 is RAM (Random Access Memory).
  • the non-volatile storage device 402 is an auxiliary storage device for the route generation device 100 .
  • the non-volatile storage device 402 is a ROM (Read Only Memory), HDD (Hard Disk Drive), or SSD (Solid State Drive).
  • the communication device 403 is an input/output interface of the route generation device 100 .
  • the communication device 403 is used to acquire various sensor information D1 input from the own vehicle 1 . It is also used to output the vehicle control information D2 generated by the route generating device 100 to the host vehicle 1.
  • FIG. Note that the communication device 403 may not be provided inside the route generation device 100, and may be the same as or equivalent to the communication device 2 shown in FIG.
  • Processor 400 uses volatile storage 401 (e.g., RAM) as working memory, and computer programs (i.e., path generation program).
  • the route generation program may be supplied from outside the route generation device 100 through the communication device 403 .
  • the path generation program may also be distributed by computer-readable non-volatile storage media (for example, CD (Compact Disc), DVD (Digital Versatile Disc), flash memory, etc.).
  • the cost of the travel route is corrected by giving a penalty to reduce the frequency of lane changes according to the dynamically changing road conditions when the vehicle is traveling. to select the route with the lowest cost. Therefore, it is possible to suppress the change of the driving lane and generate a driving route that is comfortable for the user on board the vehicle.
  • the route with the lowest total cost of the travel route has been described, but the present invention is not limited to this.
  • the route with the second smallest sum of costs may be selected, or the route with the sum of costs smaller than a threshold value may be selected.
  • the frequency of lane changes decreases, resulting in comfortable travel for the user on board the vehicle.
  • Embodiment 2 In the first embodiment described above, the method of generating a route when the vehicle is traveling has been exemplified, but the present invention is not limited to this. For example, it can be applied to a route generation method for passage of mobile objects such as aircraft (eg, helicopters, passenger drones, etc.) or vessels (eg, passenger ships, submersibles, etc.). This will be described as a second embodiment, which is a modification of the first embodiment.
  • aircraft eg, helicopters, passenger drones, etc.
  • vessels eg, passenger ships, submersibles, etc.
  • roads which are passages for mobile objects
  • routes or passages such as waterways
  • road information should be read as passage information.
  • the traffic regulations stored in the rule set 211 may be replaced with traffic regulations related to each moving object, such as aircraft-related regulations or ship-related regulations.
  • a lane change can be read as a course change
  • a map can be read as a route map.
  • the various sensor information D1 may include, for example, information obtained from sonar, beacon devices, and the like.
  • the obstacles may include weather conditions (for example, thunderclouds, turbulence, icebergs, ocean currents, fog, volcanic ash, etc.). Since it is difficult to stop an aircraft (excluding aircraft that can be stopped in the air, such as helicopters), only avoidance and follow-up routes are generated.
  • weather conditions for example, thunderclouds, turbulence, icebergs, ocean currents, fog, volcanic ash, etc.
  • the cost of the movement route is reduced by giving a penalty to reduce the frequency of course changes in response to dynamic changes in the movement of the mobile body. Fixed it to choose the least cost movement path. Therefore, it is possible to suppress course changes and generate a moving route that is comfortable for the user on board the moving object.
  • any component of the embodiment can be modified or any component of the embodiment can be omitted.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Traffic Control Systems (AREA)

Abstract

移動体の走行車線変更を抑制し、移動体に搭乗しているユーザにとって快適な移動経路を生成する。　移動体の位置情報および周辺情報と、移動体の複数の進路にそれぞれ設定される複数の経路点とを用いて、移動体の移動経路を生成する経路生成装置であって、　移動体の通過地点に関する情報を含む地図情報と、複数の経路点とから得られる移動体の一つ以上の移動経路候補に、位置情報および周辺情報を用いて得られる動的情報を付加して、移動経路候補のそれぞれに対応した動的座標ベクトル情報を生成する動的情報取得部と、動的座標ベクトル情報に属する経路点間が有する基準コストに対し、動的情報に応じた正値を重み付けした上で基準コストの総和を計算し、基準コストの総和に対し、移動体の進路変更の頻度に応じた重みを与え、複数の移動経路候補のうち基準コストの総和が小さい移動経路を選択する移動経路生成部とを備える。

Description

経路生成装置及び方法
　本発明は、移動体運行制御あるいは支援のための経路生成装置及び方法に関する。
　車両に代表される移動体の運行制御あるいは支援を目的とし、車両の走行経路のコストに基づいて、最適な走行経路を生成する経路生成技術が提案されている。従来の経路生成装置として、例えば、車両の走行路の幅に対してグリッドが設定されており、目標横加速度に応じた走行経路のコストを設定し、最小コストの走行経路を生成する方法が開示されている（例えば、特許文献１）。
特開２０２０－１１１３０２号公報
　しかしながら、従来の経路生成装置は、最小コストの走行経路を選択するために、車線変更に伴う目標横加速度（運転者が不快となる横加速度）を考慮するものの、走行車線変更の回数は減少しない可能性がある。頻繁な走行車線変更は車両の乗り心地を悪化させるため、生成された走行経路（すなわち、移動経路）は、車両（すなわち、移動体）に搭乗しているユーザにとって快適とはならない問題がある。
　この発明は上記のような問題を解決するためになされたもので、走行車線変更を抑制し、移動体に搭乗しているユーザにとって快適な移動経路を生成する、経路生成装置及び方法を提供することを目的とする。
　本開示に係る経路生成装置は、
　移動体の位置情報と、前記移動体の周辺情報と、一つの通路の複数の進路上で前記移動体の複数の進路にそれぞれ設定される複数の経路点とを用いて、前記移動体の移動経路を生成する経路生成装置であって、
　前記移動体の通過地点に関する情報を含む地図情報と、前記複数の経路点とから得られる前記移動体の一つ以上の移動経路候補に、前記位置情報および前記周辺情報を用いて得られる動的情報を付加して、前記移動経路候補のそれぞれに対応した動的座標ベクトル情報を生成する動的情報取得部と、
　前記動的座標ベクトル情報に属する経路点間が有する所定の基準コストに対し、前記動的情報に応じた所定の正値を重み付けした上で当該基準コストの総和を計算し、
前記基準コストの総和に対し、前記移動体の進路変更の頻度に応じた所定の正値の重みを与え、
複数の移動経路候補のうち前記基準コストの総和が小さい移動経路を選択する移動経路生成部とを備えるものである。
　また、本開示に係る経路生成方法は、
　情報処理装置が、
　移動体の位置情報と、前記移動体の周辺情報と、一つの通路の複数の進路上で前記移動体の複数の進路にそれぞれ設定される複数の経路点とを用いて、前記移動体の移動経路を生成する経路生成方法であって、
　前記移動体の通過地点に関する情報を含む地図情報と、前記複数の経路点とから得られる前記移動体の１つ以上の移動経路候補に、前記位置情報および前記周辺情報を用いて得られる動的情報を付加して、前記移動経路候補のそれぞれに対応した動的座標ベクトル情報を生成する動的情報取得ステップと、
　前記動的座標ベクトル情報に属する経路点間が有する所定の基準コストに対し、前記動的情報に応じた所定の正値を重み付けした上で当該基準コストの総和を計算し、
前記基準コストの総和に対し、前記移動体の進路変更の頻度に応じた所定の正値の重みを与え、
複数の移動経路候補のうち前記基準コストの総和が小さい移動経路を選択する移動経路生成ステップとを備えるものである。
　本開示によれば、移動体に搭乗しているユーザにとって快適な移動経路を生成する効果を有する。
実施の形態１における経路生成装置の概略構成図である。 実施の形態１における経路生成装置のブロック構成図である。 実施の形態１における格子構造（ラティス）により定義される走行経路の一例である 実施の形態１における座標ベクトル情報の一例である。 実施の形態１における走行経路のコスト計算に用いる、格子構造（ラティス）により定義される走行経路の基準コストの一例である。 実施の形態１における経路生成装置の処理順序を示すフローチャートである。 実施の形態１の移動経路生成部における、移動経路生成の内部処理のフローチャートである。 実施の形態１の移動経路生成部における、走行経路のコスト算出の一例である。 実施の形態１の経路生成装置により生成された走行経路データによる、自車両の走行・停止判断処理の一例である。 実施の形態１の走行・停止判断処理をビヘイビアツリーにより表現した一例である 実施の形態１における信号機停止判断処理のフローチャートである。 実施の形態１における交差点判断処理のフローチャートである。 実施の形態１における走行指示処理のフローチャートである。 実施の形態１における経路生成装置が有するハードウェアの構成図である。
実施の形態１．
＜構成＞
　実施の形態１における経路生成装置について図１～図１４を用いて説明する。図１は、実施の形態１における経路生成装置の概略構成図である。本実施の形態１では、移動体の一例として車両を挙げて説明する。車両の通路は、例えば道路であり、車両の進路は、例えば走行車線である。また、当該経路生成装置による運行支援の対象である車両を「自車両」と記すと共に、当該車両の移動経路を「走行経路」として記す。特に指定が無い限り、ユーザは、自車両に搭乗する乗員を意味するものとして説明する。
　自車両１は、人（ユーザ）が搭乗する車両である。例えば、自車両１は、普通乗用車、電動車いす、ＰＭＶ（Ｐｅｒｓｏｎａｌ　Ｍｏｂｉｌｉｔｙ　Ｖｅｈｉｃｌｅ）、二輪車、バス、タクシーなどである。また、自車両１は、走行するための動力を有する車両（牽引車）と、当該牽引車によって牽引される、動力を有さない車両との組合せであってもよい。
　自車両１は、走行するための動力（例えば、エンジン、モータ、など）および車輪と、移動方向を変更するための車輪の操舵機構（例えば、ステアリング、など）、減速または停止させるための制動機構（例えば、ブレーキ、など）とを有する。また、自車両１は、ユーザに対し、自車両１の走行経路を画面呈示するための表示装置（例えば、ディスプレイ、など）、音声案内するためのガイダンス装置（例えば、スピーカ、など）を有してもよい。
　通信装置２は、経路生成装置１００の入出力インタフェースである。例えば、通信装置２は、自車両１から入力される各種センサ情報Ｄ１を取得するために用いられる。また、経路生成装置１００で生成された車両制御情報Ｄ２を自車両１へ出力するために用いられる。
　より具体的には、通信装置２には、例えば、自車両１に備えられた各種センサ（例えば、ＧＮＳＳ（Ｇｌｏｂａｌ　Ｎａｖｉｇａｔｉｏｎ　Ｓａｔｅｌｌｉｔｅ　Ｓｙｓｔｅｍ）、ＩＭＵ（Ｉｎａｒｔｉａｌ　Ｍｅａｓｕｒｅｍｅｎｔ　Ｕｎｉｔ）、路側装置（Ｒｏａｄ　Ｓｉｄｅ　Ｕｎｉｔ）情報受信機、単眼カメラ、ステレオカメラ、ＬｉＤＡＲ（Ｌｉｇｈｔ　Ｄｅｔｅｃｔｉｏｎ　ａｎｄ　Ｒａｎｇｉｎｇ）、ミリ波レーダ、超音波センサ、など）が接続される。
　また、通信装置２は、受信装置と送信装置とを有してもよい。通信装置２は、受信装置と送信装置とを用いて、外部のネットワークに接続されてもよい。ここで、受信装置と送信装置とは、外部のネットワークを接続可能とする装置であり、例えば、ＮＩＣ（Ｎｅｔｗｏｒｋ　Ｉｎｔｅｒｆａｃｅ　Ｃａｒｄ）、あるいはモデムである。
　通信網３は、有線あるいは無線のネットワークであり、例えば、ＣＡＮ（Ｃｏｎｔｒｏｌｌｅｒ　Ａｒｅａ　Ｎｅｔｗｏｒｋ）（登録商標）、ＬＡＮ（Ｌｏｃａｌ　Ａｒｅａ　Ｎｅｔｗｏｒｋ）、インターネット、あるいは電話回線である。
　なお、経路生成装置１００は、自車両１に搭載されていてもよいが、これに限らず、自車両１とは別の場所にあるサーバコンピュータにより構成されてもよい。あるいは、自車両１に搭乗中のユーザが持つ携帯型コンピュータにより構成されてもよい。この場合、自車両１から取得した各種センサ情報Ｄ１は、例えば、通信装置２に接続された通信網３を介してデータ伝送を行い、コンピュータ上の経路生成装置１００に入力されればよい。また、コンピュータ上の経路生成装置１００で生成された車両制御情報Ｄ２は、各種センサ情報Ｄ１の場合と同様に、例えば、通信網３を介して自車両１へ送出すればよい。更に、各種センサは必ずしも自車両１に搭載されている必要は無く、例えば、自車両１の近傍に存在する他車両から収集された各種センサ情報を、通信網３を介して自車両１へ入力することもできる。
　図２は実施の形態１における経路生成装置の構成例を示すブロック図である。図２において、経路生成装置１００は、認知部２００、地図情報解析部２０１、静的情報取得部２０２、座標ベクトル生成部２０３、周辺情報・自己情報解析部２０４、動的情報取得部２０５、移動経路生成部２０６、移動・停止判断部２０７、車両制御部２０８で構成される。
　認知部２００は、自車両１、すなわち、ユーザが搭乗する車両が出力する各種センサ情報Ｄ１が入力され、各種センサから出力される各種情報をそれぞれ認識し、各種センサ情報  １に対応した情報を出力する。以降、自車両１以外の車両を他車両と称する。自車両１が出力する各種センサ情報Ｄ１に対応した情報として、例えば、路側装置から得られる道路情報Ｄ３（例えば、自車両１に関する制限速度情報、工事等による車線規制情報、交差点情報、信号機情報、停止線情報、など）と、例えば、ＧＮＳＳあるいはＩＭＵより得られる、自車両１の位置情報Ｄ４（例えば、自車両１の位置、移動速度、加速度、進路方向、など）と、カメラ等あるいはＬｉＤＡＲより得られる自車両１の周辺情報Ｄ５（例えば、走行車線情報、障害物、他車両、信号機との相対距離情報、道路標識、路面標示、など）とを認識し、それぞれ出力する。なお、周辺情報  ５に道路情報  ３が含まれてもよい。言い換えれば、周辺情報  ５を用いて道路情報  ３を取得してもよい。例えば、周辺情報  ５により取得された制限速度に関する道路標識から、道路情報  ３である制限速度の情報を取得することができる。これは、道路情報  ３の直接取得に支障がある場合（例えば、路側装置が自車両１近傍に無い、など）に有効である。
　地図情報解析部２０１は、地図データ２１０が保持する地図情報Ｄ６と、道路情報Ｄ３と、自車両１の位置情報Ｄ４とを用いて、地図データ２１０に登録されている全ての地図情報Ｄ６から、例えば、出発地点から目的地点までの経路生成に必要な範囲の地図情報Ｄ６を取得し、静的情報Ｄ７として出力する。ここで、出発地点とは、例えば、後述する走行経路のコストを評価する際、自車両が位置する場所である。なお、地図データ２１０は、経路生成装置１００の内部に保持されてもよいし、通信装置１０４を用いて、経路生成装置１００の外部の地図データ２１０が経路生成装置１００の内部へと供給されてもよい。
　静的情報取得部２０２は、静的情報Ｄ７を用いて、静的情報  ７中の情報、例えば、道路幅及び走行帯数に関する道路形状情報と、自車両１に関する制限速度情報とに基づいて、自車両１が走行可能な全ての経路の地点情報Ｄ８を取得する。得られた地点情報Ｄ８は、後述する座標ベクトル生成部２０３に適用可能なパラメータに変換され、出力される。
　座標ベクトル生成部２０３は、地点情報Ｄ８と、後述する、格子構造を為しており、１つの道路の複数の走行車線上で複数の走行経路を構成する複数の経路点から成るラティスＤ９とに基づいて、地点情報Ｄ８中の各地点で辿ることができる複数の走行経路を生成し、生成された走行経路を座標ベクトル情報Ｄ１０として出力する。なお、ラティスＤ９は、経路生成装置１００の内部に保持されてもよいし、通信装置１０４を用いて、経路生成装置１００の外部のラティス  ９が経路生成装置１００の内部へと供給されてもよい。以降、ラティスＤ９の構造を説明する際、番号を省略して単に「ラティス」と称する場合がある。
　図３は、実施の形態１における走行経路のラティスＤ９の一例である。図３において、車両の走行車線数は二車線であり、第１車線ＬＡＮＥ１及び第２車線ＬＡＮＥ２の進行方向は同一である。第２車線ＬＡＮＥ２中に記載した矢印は、車両の進行方向を示す。図３中の丸印は、経路点（ｗａｙｐｏｉｎｔ）と呼ばれる、論理的に設定された地点マークであり、経路点ｐ［ｘ，ｙ］と表現される。ここで、ｘは走行車線番号を示し、ｙは進行方向に並んだ順番を示す。なお、ｐ［ｘ，ｙ］は、各経路点の位置関係を表すＩＤとして用いてもよい。ラティスＤ９は、近接する経路点ｐ［ｘ，ｙ］を結ぶ四角形（例えば、ｐ［１，０］とｐ［２，０］とｐ［１，１］とｐ［２，１］とを結ぶ長方形）を基本形状とし、この基本形状を複数個連結した格子構造で定義されたテーブルデータである。
　ラティスＤ９の経路点ｐ［ｘ，ｙ］は、地点情報Ｄ８中の各地点に対応付けることができる。また、ラティスＤ９の経路点は、例えば、自車両１に関する制限速度情報に応じて、安全に進路変更が可能な角度（例えば、進路変更角度が２０度以下とする）となるように構成される。なお、走行経路の車線数は二車線に限定されることは無く、三車線以上であってもよいし、走行経路の途中で車線数が増減してもよい。また、道路は屋外の場合に限らず、屋内（例えば、屋内駐車場、施設内の通路、トンネル、など）であってもよい。なお、ラティスは必ずしも格子構造である必要はない。例えば、走行車線が一車線の場合は格子を構成しないが、近接経路点を結ぶ線分は格子と見做すことができる。つまり、複数の経路点を結んだ構成は走行経路の基本的な構造を表現しており、この構成（複数の経路点を結んだ構成）がラティスであることは言うまでもない。
　また、図３に示したラティスＤ９の各経路点の間隔（すなわち、経路点間距離）は、例えば、自車両１の形状、大きさ、制限速度情報などに応じて、任意の数値に設定することができる。本実施の形態では、例えば、自車両１を普通乗用車とした場合、進行方向（例えば、ｐ［１，０］とｐ［１，１］との間）の経路点間距離を３ｍ、車線間（例えば、ｐ［１，１］とｐ［２，１］との間）の経路点間距離を２ｍに設定されるが、更に短い距離に設定されてもよい。
　なお、本実施の形態の動作説明を簡単にするため、図３に示したラティスＤ９は、経路点の格子を二次元（すなわち、平面）の長方形で構成しているが、これに限ることは無い。例えば、走行経路に曲線（例えば、カーブ、環状交差点、など）がある場合、経路点間を繋ぐ線は曲線で構成されてもよい。また、ラティスの基本形状は四方格子（四角形）である必要は無く、例えば、三角形、六角形などの多角形で構成されてもよい。また、走行経路が三次元で構成される場合（例えば、立体交差、立体駐車場、スロープ、など、上下方向の移動を含む経路）、ラティスは立方体、正四面体などの三次元の格子で形成されてもよい。更に、経路点間の距離は等間隔である必要は無いし、基本形状は同一の種類である必要も無い。換言するならば、経路点間の距離は不等間隔であってもよいし、基本形状も二次元構成と三次元構成が混在してもよく、交通状況（例えば、工事による道路の形状変化、交通量の増減、など）に合わせて適宜変更することができる。
　図４に、図３に示したラティスＤ９上に生成された、座標ベクトル情報Ｄ１０の一例を示す。図４において、座標ベクトル情報Ｄ１０は、出発地点（ｓｔａｒｔ）の経路点から目的地点（ｇｏａｌ）の経路点までの実線部分を辿る経路点の集合である。より具体的に言えば、座標ベクトル情報Ｄ１０の一例は、第１車線ＬＡＮＥ１の出発地点の経路点ｐ［１，０］を出発し、経路点ｐ［２，１］→ｐ［２，２］→ｐ［２，３］→ｐ［１，４］を経て、第１車線ＬＡＮＥ１の目的地点の経路点［１，５］へ至る経路点の集合Ｐである。経路点の集合Ｐは、｛Ｐ｜ｐ［１，０］，ｐ［２，１］，ｐ［２，２］，ｐ［２，３］，ｐ［１，４］，ｐ［１，５］｝と表現される。
　図５に、走行経路のコスト計算に用いるラティスＤ９の基準コストの一例を示す。図５中の経路点間に記された数値は、ラティスＤ９の基準コストの値であり、所定の正数値で設定される。ラティスＤ９の基準コストの設定方法は、例えば、左側通行ルールの国では、左側車線を優先して走行する（キープレフト）といった交通法規、あるいは交通における慣習に基づいて設定される。図５では、第１車線ＬＡＮＥ１（すなわち、左側車線）を走行する場合の基準コスト（例えば、１）よりも、第２車線ＬＡＮＥ２を走行する場合の基準コストを大きな値（例えば、２）に設定している。第１車線ＬＡＮＥ１の基準コストよりも第２車線ＬＡＮＥ２の基準コストを大きな値にすることで、第１車線ＬＡＮＥ１を優先して走行することができる。なお、これらは一例にすぎず、ラティスＤ９の基準コストの数値は、走行経路の状況（例えば、車線の幅の大小、車線の勾配角の違い、など）によって任意に設定することができる。
　また、走行経路のコスト算出時において、自車両１の進行方向の走行経路上に障害物（例えば、路上駐車車両、街路樹、落石、水たまり、あるいは、大型トラック・自転車など、自車両１より低速で走行する他車両、など）が存在する場合、障害物を回避するために自車両１の車線変更が行われる場合がある。また、自車両１の後方から他車両が接近した場合、走行車線を譲るために自車両１の車線変更が行われる場合がある。車線変更する場合、経路点間の基準コストは、同一車線上を走行するよりも大きい基準コスト（図５では、例えば、５）が設定される。また、障害物の直前あるいは直後の車線変更を抑制するために、更に大きい基準コストが設定されてもよい。
　なお、障害物以外での車線変更には、例えば、右左折、走行時間、その後の車線変更数が多くなる、ユーザを含む乗員の状況に応じて、などが挙げられる。この場合も経路点間の基準コストは、同一車線上を走行するよりも大きい基準コストが設定されてもよい。
　周辺情報・自己情報解析部２０４は、自車両１の位置情報Ｄ４、および自車両１の周辺情報Ｄ５をリアルタイム（例えば、１ｍｓｅｃの短時間毎）に取得すると共に、それら情報を用いて解析し、その解析結果である、自車両１の時々刻々変化する車両状態（例えば、４０ｋｍ／ｈで走行中、信号で停止中、進路変更中、加速中、他車両の後方を走行中、など）を動的情報Ｄ１１として出力する。
　動的情報取得部２０５は、動的情報Ｄ１１と地点情報Ｄ８とを対応付ける。具体的には、座標ベクトル情報Ｄ１０に含まれる地点情報  ８に対し、各経路点に対応した動的情報Ｄ１１（例えば、自車両１の車両状態、他車両、障害物、信号機などの周辺情報、など）を付加する。地点情報  ８に時々刻々変化する自車両１の車両状態の情報を付加することで、座標ベクトル情報  １０にリアルタイム性を持たせることができる。本処理により動的情報  １１が付加された座標ベクトル情報  １０を、動的座標ベクトル情報Ｄ１２として出力する。
　移動経路生成部２０６は、動的座標ベクトル情報Ｄ１２を用いて、ラティスＤ９の基準コストに対し、動的情報Ｄ１１に応じてリアルタイムに重み付けを行う。具体的には、図５に示したラティスＤ９の基準コストに対し、例えば、動的情報  １１により取得された障害物に関する情報（例えば、道路上に停車している他車両、自車両よりも低速で走行する他車両、など）、あるいはリスク領域に関する情報を用いて、それら情報別に設定されている重み係数により、基準コストに対してリアルタイムに重み付けを行う。次に、重み付けされたラティスの基準コストを用い、各経路点を通過する場合の走行経路の基準コストから、例えば、基準コストの総和が最小となる走行経路を選択し、走行経路データＤ１３として出力する。
　なお、走行経路データＤ１３の算出において、後述する、移動・停止判断部２０７が出力する判断情報Ｄ１４を再入力（ループバック）して反映（再計算）しても良い。また、リスク領域（例えば、路上駐車車両が多い地点、渋滞が頻繁に発生する地点およびその時刻、など）を用いて走行経路の基準コストの総和を算出しても良い。リスク領域近傍では、例えば、経路点間の基準コストの重みを大きくすることで走行経路の基準コストを増加させる。このような基準コストの重みの制御により、リスク領域を避ける走行経路を生成することができる。
　これら車線変更条件において、車線変更しない経路と車線変更した経路とで、出発地点の経路点から目的地点の経路点までの走行経路の基準コストの総和（以降、走行経路のコストの総和と略する）に差が生じる場合、自車両１を車線変更させることができる。ただし、頻繁な車線変更は車両の乗り心地を悪化させるので、危険回避の場合を除き、車線変更後の一定区間（例えば、所定の距離、所定の数の経路点を通過する区間、など）は、走行経路のコストの総和に対して重み（ペナルティ）を与えることにより、再度の車線変更を禁止あるいは抑制してもよい。
　移動経路（走行経路）のコストの総和に対して、進路変更（走行車線変更、または車線変更）の頻度に応じてペナルティを与える方法、すなわち、再度の車線変更を抑制する方法として、例えば、一定区間内で再度車線変更する場合、走行経路のコストの総和に正の定数の重み（例えば、１．２）を乗算することで、走行経路のコストの総和を大きくすることができる。また、車線変更後、次の車線変更までの距離が一定以下の場合、走行経路のコストの総和にペナルティを与えてもよい。更に、車線変更の頻度（例えば、出発地点から目的地点までの車線変更回数の合計、所定の時間あたりの車線変更の平均回数、など）が最小となる走行経路を選択してもよい。このように、車両の走行特性、あるいは走行経路の長さ等の状況に応じ、様々な車線変更条件に基づいて、走行経路を生成することが可能である。
　上記のように、リスク領域、障害物などに合わせて、リアルタイムに経路点間の基準コストの重みを変更することで、突然のリスク領域・障害物の出現に際しても、頻繁な車線変更が少ない快適な走行経路を生成することができる。すなわち、リアルタイムに自車両１の頻繁な車線変更を抑制することができるので、自車両１に搭乗するユーザの快適性を向上することができる。
　ルールセット２１１は、論理式で表現された順守すべき交通法規の集合を保持する。例えば、交通法規は以下のような論理式で表現される。「信号機の指示が赤信号である」、信号機の指示が黄色信号である」、「交差点に進入する」、を表す命題記号をそれぞれ「Ａ」、「Ｂ」、「Ｃ」とする。「信号機が赤信号または黄色信号を指示する場合、交差点に進入してはならない」という交通法規は、式（１）のような論理式で表現される。
Figure JPOXMLDOC01-appb-M000001
　ここで、「｜」は論理和を意味し、「！」は否定を意味する。なお、後述の論理体系構築が可能であれば、他の表現方法としてもよい。ルールセット２１１は、順守すべきものであれば、交通法規以外のルール（例えば、交通における慣習、施設内の私道通行ルール、など）を含めてもよい。なお、ルールセット２１１は、経路生成装置１００の内部に保持されてもよいし、外部から供給されてもよい。
　移動・停止判断部２０７は、動的情報  １１と走行経路データＤ１３とルールセット２１１とを用いて、自車両１の動作制御（例えば、走行・停止・回避・追随、など）を判断し、その判断結果である判断情報Ｄ１４を生成し、出力する。
　車両制御部２０８は、移動・停止判断部２０７が出力する判断情報Ｄ１４に従って、自車両１が備える動力、操舵機構など運転制御（例えば、走行、減速、停止、他車両追従、走行経路変更、など）を行うための制御信号を生成し、その制御信号を車両制御情報Ｄ２として出力する。
　自車両１は、車両制御情報Ｄ２を受信し、自車両１が有する動力と、移動方向を変更するための車輪の操舵機構と、減速または停止させるための制動機構とをそれぞれ制御して走行する。なお、自車両１が自動走行車両ではない場合（すなわち、ユーザ自身が運転する車両）、ユーザに対し、表示装置を用いて生成された走行経路を画面呈示したり、ガイダンス装置を用いて音声案内したりすることが可能である。よって、ユーザ自身が運転する場合でも、本発明の効果は自動走行車両の場合と同じく奏功することは言うまでもない。更に、通信網３を用いて、生成された走行経路データ  １３を自車両１以外の他車両に通知してもよい。自車両１の走行経路を他車両に通知することで、他車両に対して円滑な交通を促す効果を奏する。
＜処理動作＞
　次に本実施の形態１の動作について説明する。図６は実施の形態１における経路生成装置１００の処理順序を示すフローチャートである。以下、図６のフローチャートを用いて動作の詳細を説明する。なお、以下の各ステップにおける「部」を、「ステップ」または「処理」または「工程」と読み替えてもよい。
　まず、静的情報受信時の処理を行う。ステップＳＴ１０１では、移動・停止判断部２０７が、ルールセット２１１を用いて、移動・停止判断部２０７の走行経路の初期状態を構築する（ステップＳＴ１０１）。具体的には、例えば、車両の種別（例えば、普通乗用車、二輪車、バス、など）による、交通法規上で当該車両が走行可能な（すなわち、走行が許可されている）車線を確認する初期設定である。ステップＳＴ１０１の処理後、ステップＳＴ１０２へ移行する。
　ステップＳＴ１０２では、静的情報取得部２０２が、静的情報Ｄ７を取得すると共に、静的情報Ｄ７を経路生成装置１００の内部で使用できるように成形する（ステップＳＴ１０２）。静的情報  ７の成形方法として、例えば、静的情報  ７の内容を配列変数化するなど、計算機で処理し易い形状に成形する。ステップＳＴ１０２の処理後、ステップＳＴ１０３へ移行する。
　ステップＳＴ１０３では、座標ベクトル生成部２０３が、座標ベクトル情報Ｄ１０を生成する（ステップＳＴ１０３）。ステップＳＴ１０３の処理後、ステップＳＴ１０４へ移行する。
　続いて、動的情報受信時の処理を行う。ステップＳＴ１０４では、周辺情報・自己情報解析部２０４が、自車両１の位置情報Ｄ４と自車両１の周辺情報Ｄ５とを用いて動的情報Ｄ１１を取得すると共に、動的情報Ｄ１１を経路生成装置１００の内部で使用できるように成形する（ステップＳＴ１０４）。動的情報  １１の成形方法として、例えば、動的情報  １１の内容を配列変数化するなど、計算機で処理し易い形状に成形する。ステップＳＴ１０４の処理後、ステップＳＴ１０５へ移行する。
　ステップＳＴ１０５では、動的情報取得部２０５が、動的情報Ｄ１１と座標ベクトル情報Ｄ１０とを対応付ける。対応付けは、例えば、自車両１の位置、障害物の座標と各経路点の座標から一番近い経路点を算出することで行う。なお、閾値内の距離に経路点が存在しない場合、対応する経路点は無しとする。ただし、交通法規上で車線変更不可の区間（例えば、交差点内、追い越し禁止区間、横断歩道前、停止線前、など）、あるいは、車線変更すべきでない区間（例えば、見通しの悪いカーブ、など）では直線情報のみ付与する。また、車線変更可能な道路上の経路点から、進行方向に対して法線方向に次の経路点が存在するか否かで車線変更可否を判断する。
　具体的には、同じ道路上、かつ車線が隣接している車線内の全ての経路点のＩＤから、式（２）を満たす値（ａ，ｂ）の組合せの存在の有無を確認し、存在する組合せについては車線変更可能であると定義する。
Figure JPOXMLDOC01-appb-M000002
 　ここで、ｄは自車両１の移動方向ベクトル、ｈはｄの法線ベクトル、ｐ０は現在の経路点の位置ベクトル、ｐ１は次の経路点の位置ベクトルの法線ベクトルである。また、ｍａｒｇｉｎは、進行方向の経路点間の距離マージンに関する車線変更判定閾値、ｗｉｄｔｈは、隣接車線までの距離に関する車線変更判定閾値であり、それぞれ所定の正値をとる。ステップＳＴ１０５の処理後、ステップＳＴ１０６へ移行する。
　ステップＳＴ１０６では、移動経路生成部２０６が、動的座標ベクトル情報Ｄ１２を用い、図５に示したラティスＤ９の基準コストに対し、例えば、障害物（例えば、道路上に停車している他車両、自車両よりも低速で走行する他車両、など）、あるいはリスク領域に合わせた重みを設定し、基準コストの重み付けを行う。具体的には、障害物あるいはリスク領域に合わせて、座標ベクトル情報Ｄ１０の各経路点を通過する場合の重みを設定し、基準コストに重みを乗じる。
　続いて、出発地点の経路点ｐ［１，０］から、目的地点の経路点ｐ［１，５］に至るまで、走行経路のコストの総和を算出する。そして、走行経路のコストの総和が最小になる走行経路を算出し、その走行経路を走行経路データＤ１３として出力する（ステップＳＴ１０６）。ステップＳＴ１０６の処理後、ステップＳＴ１０７へ移行する。
　図７は、ステップＳＴ１０６の移動経路生成の内部処理のフローチャートである。まず、ステップＳＴ１０６Ａでは、動的座標ベクトル情報Ｄ１２を参照し、ラティスＤ９の基準コストを取得する（ステップＳＴ１０６Ａ）。ステップ１０６Ａの処理後、ステップＳＴ１０６Ｂへ移行する。
　ステップＳＴ１０６Ｂでは、動的座標ベクトル情報Ｄ１２を参照し、障害物あるいはリスク領域に合わせて、座標ベクトル情報Ｄ１０の各経路点を通過する場合の重みを設定し、各基準コストに重みを乗じる（ステップＳＴ１０６Ｂ）。例えば、障害物近傍の経路点を通過する場合の重みを大きく設定する。ステップＳＴ１０６Ｂの処理後、ステップＳＴ１０６Ｃへ移行する。
　ステップＳＴ１０６Ｃでは、重み付けされた基準コストに基づいて、式（３）に従い、出発地点の経路点から目的地点の経路点に至るまで、走行経路候補毎のコストの総和CＳＵＭ（ｋ）を算出する（ステップＳＴ１０６Ｃ）。ステップＳＴ１０６Ｃの処理後、ステップＳＴ１０６Ｄへ移行する。
Figure JPOXMLDOC01-appb-M000003
　ここで、ｋは動的座標ベクトル情報（すなわち、走行経路候補）を示す番号、Cｐ［ｘ，ｙ］（ｋ）は、ｋ番目の動的座標ベクトル情報に属する経路点ｐ［ｘ，ｙ］の基準コスト、ｗｐ［ｘ，ｙ］（ｋ）は、ｋ番目の動的座標ベクトル情報に属する経路点ｐ［ｘ，ｙ］の重み係数である。
　ステップＳＴ１０６Ｄでは、式（３）で得られたCＳＵＭ（ｋ）に対し、式（４）によりペナルティを与える（α（ｋ）およびβ（ｋ）をCＳＵＭ（ｋ）へ乗算する）（ステップＳＴ１０６Ｄ）。ステップＳＴ１０６Ｄの処理後、ステップＳＴ１０６Ｅへ移行する。
Figure JPOXMLDOC01-appb-M000004
　ステップＳＴ１０６Ｅでは、ペナルティが与えられた走行経路のコストの総和Ｃ＾ＳＵＭ（ｋ）が最小となる走行経路を選択する（ステップＳＴ１０６Ｅ）。
ステップＳＴ１０６Ｅの処理後、本フローチャートを終了（ＥＮＤ）する。
　図８は、実施の形態１の移動経路生成部２０６における、ラティスを用いた走行経路のコスト算出の具体的な一例である。図８中の障害物ＨＺＤは、例えば、他車両である。説明を簡単にするため、障害物ＨＺＤ（すなわち、他車両）は、静止中（停車中）とする。自車両１の車線変更条件として、式（２）のｍａｒｇｉｎを、例えば、隣接する経路点間の距離とする。すなわち、経路点間に障害物ＨＺＤがある場合、その経路点間では車線変更は行われない。また、動的座標ベクトル情報の番号ｋは省略する。
　また、障害物ＨＺＤの周囲はリスク領域と判断されるため、障害物ＨＺＤの周囲のラティスの経路に大きな重みが設定される。リスク領域の周囲の状況に応じて、経路点間のコストに大きな重みが設定されることで、自車両１がその経路点間を通過することを抑制できる。図８の例では、例えば、ｐ［１，０］からｐ［１，１］の経路、およびｐ［１，３］からｐ［１，４］の経路では重みが５０（図８では、１の基準コストが５０倍され、５０と表示）、また、ｐ［２，２］からｐ［１，４］の経路では重みが１００（図８では、５の基準コストが１００倍され、５００と表示）というように、各経路のリスクに応じた重みが設定されている。以降、重み付けされた基準コストを、単に「重み付きコスト」と省略する。
　リスク領域を含めてラティスの経路に大きな重みが設定されることで、自車両１からリスク領域までの距離の余裕を持った計算を行うことができ、頻繁な車線変更を抑制することができる。例えば、自車両１の第１車線ＬＡＮＥ１上に連続かつ近接して２つの障害物が存在する場合を考える。リスク領域を考慮しない場合、自車両１が１つ目の障害物を回避するためにＬＡＮＥ２に車線変更後、再度、第１車線ＬＡＮＥ１に車線変更（戻る）する可能性がある。故に、２つ目の障害物を回避するために、再度、第２車線ＬＡＮＥ２に車線変更する必要が生じる。一方、リスク領域を考慮した場合、１つ目の障害物と２つ目の障害物とのリスク領域が重なり合うことで、２つの障害物は連続した一体の障害物と見做され、この一体の障害物に対して走行経路が生成される。よって、１つ目の障害物を回避した後、再度、第１車線ＬＡＮＥ１へ車線変更することが無くなるので、頻繁な車線変更を抑制することができる。
　更に、頻繁な車線変更を抑制するためのペナルティが以下のように定義される。車線変更頻度のペナルティαとして、出発地点から目的地点までの走行経路において、例えば、車線変更後、経路点を２か所通過するまでに再度車線変更する場合、その条件を満たすごとに走行経路のコストの総和を１．２倍する。すなわち、当該車線変更の条件を満たす回数をｎとすると、α＝（１．２）＾ｎとなる。例えば、ｎ＝２回の場合は、α＝（１．２）＾２＝１．４４となる（条件を満たす回数が無い、すなわちｎ＝０回の場合、α＝１．０とする）。また、出発地点から目的地点までの進路変更回数の合計値に１を加えた値をペナルティβとして与える。例えば、進路変更回数の合計値が５回の場合、β＝６となる（進路変更回数が０回の場合、β＝１となる）。なお、これら走行経路のコストの総和に対するペナルティの与え方については、一例にすぎない。別の方法として、車線変更の所定の時間あたりの平均回数に応じてペナルティを与えてもよく、様々な方法をとることが可能である。
　図８（ａ）は、自車両１の走行経路上に障害物ＨＺＤが存在しない場合である。図８（ａ）において、座標ベクトル情報Ｄ１０が示す経路点の集合Ｐは、｛Ｐ｜ｐ［１，０］，ｐ［１，１］，ｐ［１，２］，ｐ［１，３］，ｐ［１，４］，ｐ［１，５］｝である。ｐ［１，０］からｐ［１，１］までの重み付きコストは１、ｐ［１，１］からｐ［１，２］までの重み付きコストは１、ｐ［１，２］からｐ［１，３］までの重み付きコストは１、ｐ［１，３］からｐ［１，４］までの重み付きコストは１、ｐ［１，４］からｐ［１，５］までの重み付きコストは１、であるので、走行経路のコストの総和ＣＳＵＭは、ＣＳＵＭ＝５である。
　一方、自車両１の走行経路上に障害物ＨＺＤが存在する場合、上述の車線変更条件と重みの設定条件より、最小コストの可能性がある走行経路の候補は、２パタンの走行経路が考えられる。図８（ｂ）および（ｃ）は、自車両１の走行経路上に障害物ＨＺＤが存在する場合の走行経路の２パタンである。
　図８（ｂ）において、座標ベクトル情報Ｄ１０が示す経路点の集合Ｐは、｛Ｐ｜ｐ［１，０］，ｐ［２，１］，ｐ［２，２］，ｐ［２，３］，ｐ［１，４］，ｐ［１，５］｝である。ｐ［１，０］からｐ［２，１］までの重み付きコストは５である。ｐ［２，１］からｐ［２，２］までの重み付きコストは２である。ｐ［２，２］からｐ［２，３］までの重み付きコストは２である。ｐ［２，３］からｐ［１，４］までの重み付きコストは５である。ｐ［１，４］からｐ［１，５］までの重み付きコストは１である。よって、走行経路のコストの総和ＣＳＵＭは、ＣＳＵＭ＝１５である。
　図８（ｃ）において、座標ベクトル情報Ｄ１０が示す経路点の集合Ｐは、｛Ｐ｜ｐ［１，０］，ｐ［２，１］，ｐ［２，２］，ｐ［２，３］，ｐ［２，４］，ｐ［１，５］｝である。ｐ［１，０］からｐ［２，１］までの重み付きコストは５である。ｐ［２，１］からｐ［２，２］までの重み付きコストは２である。ｐ［２，２］からｐ［２，３］までの重み付きコストは２である。ｐ［２，３］からｐ［２，４］までの重み付きコストは２である。ｐ［２，４］からｐ［１，５］までの重み付きコストは５である。よって、走行経路のコストの総和ＣＳＵＭは、ＣＳＵＭ＝１６である。
　図８において、（ｂ）のパタンの走行経路のコストの総和がＣＳＵＭ＝１５である一方、（ｃ）のパタンでは走行経路のコストの総和はＣＳＵＭ＝１６である。単純比較では、（ｂ）のパタンの方がコストの総和が小さいが、（ｂ）のパタンでは、車線変更後に経路点を２か所通過する前に再度車線変更を行うので、頻繁な車線変更のペナルティとしてコストの総和ＣＳＵＭが１．２倍される（すなわち、α＝１．２）。また、車線変更の回数の合計は２回であり、β＝３となる）。よって、（ｂ）のパタンのペナルティが与えられた走行経路のコストの総和はＣ＾ＳＵＭ＝１．２×３×１５＝５４となる。一方、（ｃ）のパタンでは、頻繁な車線変更のペナルティは与えられない（すなわち、α＝１．０）。また、車線変更の回数の合計は２回であり、β＝３となる。よって、（ｃ）のパタンのペナルティが与えられた走行経路のコストの総和はＣ＾ＳＵＭ＝１．０×３×１６＝４８となる。
　よって、ペナルティが与えられた走行経路のコストの総和Ｃ＾ＳＵＭが最小となる走行経路のパタンは、（ｃ）のパタンとなる。以上、生成された（ｃ）のパタンの走行経路が、走行経路データＤ１３として出力される。
　上述したように、（ｂ）のパタンの走行経路と比較して、（ｃ）のパタンの走行経路では、車線変更後の再度の車線変更までの距離が長くなる。言い換えれば、自車両の車線変更の頻度が少なくなる。よって、自車両１に搭乗するユーザの快適性を向上することができる。
　停車中の他車両が動き出した場合、すなわち障害物ＨＺＤの移動に伴って、経路点間の重みが変化するので、走行経路の重み付きコストの再設定と、走行経路のコストの総和の再計算が為される。なお、コスト再計算には、元の出発地点の経路点から計算する必要は無い。例えば、現時点における自車両１の最近傍の経路点を、新たな出発地点として計算すればよく、再計算のための処理量を削減することができる。
　ステップＳＴ１０７では、移動・停止判断部２０７が、動的情報  １１と走行経路データＤ１３とルールセット２１１とを用いて、自車両１の移動・停止判断の処理を行う（ステップＳＴ１０７）。
　移動・停止判断部２０７の処理について、具体例を用いて詳述する。図９は、本実施の形態１の経路生成装置１００により生成された走行経路データＤ１３による、自車両１の移動・停止判断処理の一例である。具体的には、信号機３００、自車両１（図９では、１ａ、１ｂ、１ｃで示す）と同一車線上を走行中、あるいは停止中の他車両（他車両３０１）、自車両１の反対車線の対向方向から進行する他車両（対向車３０２）、停止線３０３、横断歩道３０４ａ、３０４ｂを有する交差点３０５、が存在する中で生成された走行経路データＤ１３に基づいて、自車両１の移動・停止判断処理を行うものである。図９において、自車両１の走行経路は、北方向に進行し、交差点３０５を右折して東方向に進むものである。
　自車両１の移動・停止判断には、例えば、ビヘイビアツリー（Ｂｅｈａｖｉｏｒ　Ｔｒｅｅ、以下、ＢＴと略する）のようにグラフ構造で表現されるフォーマットを用いることができる。図１０は、本実施の形態１の移動・停止判断処理をＢＴにより表現した一例である。なお、フォーマットにはＢＴの他、例えば、ステートマシンなどの公知技術を用いてもよい。
　図１１は、ステップＳＴ１０７の経路決定処理の一部である、信号機停止判断処理のフローチャートである。図１２は、ステップＳＴ１０７の経路決定処理の一部である、交差点停止判断処理のフローチャートである。なお、本処理の説明を簡単にするため、信号機３００の指示が赤信号、黄信号、緑信号の通常の場合に限定する。なお、信号機３００の指示が、矢印表示、点滅表示などの場合は省略するが、通常の場合と同様、交通法規に則った処理を行えば良い。
　まず、図１１に示した信号機停止判断処理を行う。ステップＳＴ２０１では、動的情報  １１と走行経路データＤ１３とを用いて、自車両１の現在位置から、自車両１の進行方向上に存在する最も近い信号機（例えば、信号機３００）までの距離Ｎｓを計算し、閾値Ｎｄと比較する（ステップＳＴ２０１）。ここで、閾値Ｎｄは、自車両１が安全かつ速やかに停止できる値に設定される。具体的には、閾値Ｎｄは、現在の自車両１の走行速度と、安全に停止できる減速加速度の上限とから計算される距離で設定される。
　距離Ｎｓが閾値Ｎｄより大きい場合（ステップＳＴ２０１のＹｅｓ）、自車両１から信号機３００までの距離が十分にあると判断されるので、ステップＳＴ２０２へ移行する。
　ステップＳＴ２０２では、自車両１に対して、走行指示が為される（ステップＳＴ２０２）。ステップＳＴ２０２の走行指示の詳細については、後述する。ステップＳＴ２０２の走行指示処理後、図１２の交差点停止判断処理へ移行する。
　一方、距離Ｎｓが閾値Ｎｄ以下の場合（ステップＳＴ２０１のＮｏ）、自車両１から信号機３００までの距離が短いと判断されるので、ステップＳＴ２０３へ移行する。
　ステップＳＴ２０３では、動的情報  １１と走行経路データＤ１３とルールセット２１１とを用いて、信号機３００の指示内容を確認する。信号機３００の指示内容が赤信号、あるいは黄信号の場合（ステップＳＴ２０３のＹｅｓ）、自車両１は停止すべきと判断されるので、ステップＳＴ２０４へ移行する。
　ステップＳＴ２０４では、自車両１に対し、停止指示が為される（ステップＳＴ２０４）。なお、当該停止指示には、自車両１が少なくとも横断歩道３０４ａ手前の停止線３０３までに、安全に停止可能とする減速指示が含まれる。ステップＳＴ２０４の処理後、ステップ１０７の処理を完了（ＥＮＤ）する。
　一方、信号機３００の指示内容が赤信号以外、あるいは黄信号以外（すなわち、緑信号）の場合（ステップＳＴ２０３のＮｏ）、自車両１は進行可能と判断されるので、ステップＳＴ２０２へ移行する。
　続いて、図１２に示した交差点停止判断処理を行う。ステップＳＴ２０５では、交差点３００内、あるいは交差点３００の近傍において、横断歩道３０４ａ、３０４ｂを横断中、あるいは横断開始しようとしている歩行者等（例えば、人、自転車、など）の障害物の有無を判断する（ステップＳＴ２０５）。歩行者等が存在する場合（ステップＳＴ２０５のＹｅｓ）、自車両１は停止すべきと判断されるので、ステップＳＴ２０６へ移行する。歩行者等が存在しない場合（ステップＳＴ２０５のＮｏ）、ステップＳＴ２０７へ移行する。
　ステップＳＴ２０６では、自車両１に対して、停止指示が為される（ステップＳＴ２０６）。なお、当該停止指示には、自車両１が少なくとも横断歩道３０４ａの手前の停止線３０３までに安全に停止可能な減速指示が含まれる。あるいは、横断歩道３０４ｂの手前、かつ、他車両の通行に影響を及ぼさない位置に、安全に停止可能な減速指示が含まれる。ステップＳＴ２０６の処理後、ステップＳＴ１０７の処理を完了（ＥＮＤ）する。
　ステップＳＴ２０７では、自車両１の反対車線の対向方向から進行する他車両（例えば、対向車３０２）が存在するか否かを判定する（ステップＳＴ２０７）。対向車３０２が存在する場合（ステップＳＴ２０７のＹｅｓ）、自車両１は停止すべきと判断されるので、ステップＳＴ２０８に移行する。
　ステップＳＴ２０８では、自車両１に対して、停止指示が為される（ステップＳＴ２０８）。なお、当該停止指示には、自車両１が、少なくとも交差点内に進入する手前まで、かつ、対向車３０１を含む他車両の通行に影響を及ぼさない位置に、安全に停止可能な減速指示が含まれる。ステップＳＴ２０８の処理後、ステップＳＴ１０７の処理を完了（ＥＮＤ）する。
　一方、対向車３０２が存在しない場合（ステップＳＴ２０７のＮｏ）、ステップＳＴ２０５にて横断歩道３０４ａ、３０４ｂに歩行者等も存在しない判断が為されている。よって、自車両１は進行可能と判断されるので、ステップＳＴ２０９へ移行する。
　ステップＳＴ２０９では、自車両１に対して、走行指示が為される（ステップＳＴ２０９）。なお、当該走行指示は、上述したステップＳＴ２０２の走行指示と同一であってもよいし、動的情報  １１と走行経路データＤ１３とに応じて適宜変更してもよい。
　図１３は、ステップＳＴ２０２（あるいは、ステップＳＴ２０９）の内部処理である、走行指示処理のフローチャートである。図１３を用いて、走行指示処理を説明する。
　ステップＳＴ３０１では、動的情報  １１と走行経路データＤ１３とを用いて、自車両１の走行経路の経路点上に障害物が有るかどうかを確認する。走行経路の経路点上に障害物がある場合（ステップＳＴ３０１のＹｅｓ）、ステップＳＴ３０２へ移行する。
　ステップＳＴ３０２では、動的情報  １１と走行経路データＤ１３とを用いて、障害物（例えば、他車両３０１）が停止中、または、自車両１の走行速度よりも遅いか否かを確認する。障害物が停止している場合（ステップＳＴ３０２のＹｅｓ）、自車両１は障害物を回避すべきと判断されるので、ステップＳＴ３０３へ移行する。
　ステップＳＴ３０３では、自車両１の行動モードが「回避」に設定され、自車両１に対して、動的情報  １１と走行経路データＤ１３とに応じた進路変更指示と走行速度制御とが為される（ステップＳＴ３０３）。ステップＳＴ３０３の処理後、走行指示処理を完了（ＥＮＤ）する。
　一方、障害物の走行速度が、自車両１の走行速度よりも速い場合（ステップＳＴ３０２のＮｏ）、自車両１は障害物を現時点で回避する必要は無いため、ステップＳＴ３０４へ移行する。
　ステップＳＴ３０４では、自車両１の行動モードが「追従」に設定され、自車両１に対して、動的情報  １１と走行経路データＤ１３とに応じて、先行する他車両に追従するような走行速度制御（例えば、自車両１の制限速度を上限とし、所定の一定距離を保持するような速度で走行する、など）が為される（ステップＳＴ３０４）。ステップＳＴ３０４の処理後、走行指示処理を完了（ＥＮＤ）する。
　ステップＳＴ３０５では、動的情報  １１と走行経路データＤ１３とを用いて、自車両１の位置が交差点外、かつ、車線変更無しか否かを確認する（ステップＳＴ３０５）。自車両１の位置が交差点外であり、かつ、車線変更も無い場合（ステップＳＴ３０５のＹｅｓ）、自車両１は現時点で回避も追従も必要無いため、ステップＳＴ３０６へ移行する。
　ステップＳＴ３０６では、自車両１の行動モードが「走行」に設定され、自車両１に対して、動的情報  １１と走行経路データＤ１３とに応じた走行速度制御が為される（ステップＳＴ３０６）。ステップＳＴ３０６の処理後、走行指示処理を完了（ＥＮＤ）する。
　一方、自車両１の位置が交差点内、あるいは、車線変更が有る場合（ステップＳＴ３０５のＮｏ）、自車両１は、交差点内において、対向車３０２の回避の可能性、あるいは、走行経路上の障害物回避の可能性があると判断されるので、ステップＳＴ３０７へ移行する。
　ステップＳＴ３０７では、動的情報  １１と走行経路データＤ１３とを用いて、自車両１の周辺に障害物（例えば、駐車車両３０１、対向車３０２、など）が無いか否かを確認する（ステップＳＴ３０７）。自車両１の周辺に障害物が無い場合（ステップＳＴ３０７のＹｅｓ）、自車両１は障害物回避の必要が無いため、ステップＳＴ３０６へ移行する。一方、自車両１の周辺に障害物がある場合（ステップＳＴ３０７のＮｏ）、自車両１は障害物回避の必要があるため、ステップＳＴ３０８へ移行する。
　ステップＳＴ３０８では、自車両１の行動モードが「回避」に設定され、自車両１に対して、動的情報  １１と走行経路データＤ１３とに応じた進路変更指示と走行速度制御とが為される（ステップＳＴ３０８）。ステップＳＴ３０８の処理後、走行指示処理を完了（ＥＮＤ）する。
　以上、ステップＳＴ１０７の移動・停止判断処理を完了し、ステップＳＴ１０８へ移行する。
　ステップＳＴ１０８では、移動・停止判断部２０７が、動的情報  １１と走行経路データＤ１３とルールセット２１１とを用いて、検討が必要な走行経路の他のパタンが無いかどうか確認する。他のパタンが存在する場合（ステップＳＴ１０８のＹｅｓ）、ステップＳＴ１０６の移動経路生成部２０６の処理に戻る。ステップＳＴ１０６の処理に戻る場合、移動経路生成部２０６に判断情報Ｄ１４を再入力してもよい。判断情報Ｄ１４を用いることで、走行経路データＤ１３の再計算を行うことができ、自車両１の状況に応じた、更に精度の高い走行経路データＤ１３を生成することができる。
　一方、検討が必要な走行経路の他のパタンが無い場合（ステップＳＴ１０８のＮｏ）、動的情報  １１と走行経路データＤ１３とに対応した自車両１の移動・停止を判断し、その判断結果を判断情報Ｄ１４として出力する。本処理後、ステップＳＴ１０９へ移行する。
　最後に、ステップＳＴ１０９では、車両制御部２０８が、判断情報Ｄ１４に従って、自車両１の運転制御（例えば、走行、減速、停止、他車両追従、走行経路変更、など）を行う制御信号を生成し、その制御信号を車両制御情報Ｄ２として出力する。
　なお、図６および、図１１から図１３のそれぞれに示したフローチャートにおける各処理は、コンピュータの処理能力に応じた実行間隔（例えば、５ミリ秒間隔）により、その処理順序に従ってリアルタイムに実行することができる。
＜ハードウェア構成＞
　図２に示される経路生成装置１００の各構成は、例えば、プロセッサを内蔵する情報処理装置であるコンピュータで実現可能である。図１４は、実施の形態１における経路生成装置が有するハードウェアの構成図である。図１４において、経路生成装置１００は、プロセッサ４００、揮発性記憶装置４０１、不揮発性記憶装置４０２、通信装置４０３、及び通信路４０４とで構成される。
　プロセッサ４００を内蔵するコンピュータは、例えば、パーソナルコンピュータ、サーバ型コンピュータなどの据え置き型コンピュータ、スマートフォン、タブレット型コンピュータなどの可搬型コンピュータ、あるいは、カーナビゲーションシステムなどの車載情報システムの機器組み込み用途のマイクロコンピュータ、及びＳｏＣ（Ｓｙｓｔｅｍ　ｏｎ　Ｃｈｉｐ）などである。
　プロセッサ４００は、経路生成装置１００の全体を制御する。例えば、プロセッサ４００は、ＣＰＵ（Ｃｅｎｔｒａｌ　Ｐｒｏｃｅｓｓｉｎｇ　Ｕｎｉｔ）、ＦＰＧＡ（Ｆｉｅｌｄ　Ｐｒｏｇｒａｍｍａｂｌｅ　Ｇａｔｅ　Ａｒｒａｙ）、ＤＳＰ（Ｄｉｇｉｔａｌ　Ｓｉｇｎａｌ　Ｐｒｏｃｅｓｓｏｒ）などである。プロセッサ４００は、単一のプロセッサでもマルチプロセッサでもよい。また、経路生成装置１００は、コンピュータ以外にＡＳＩＣ（Ａｐｐｌｉｃａｔｉｏｎ　Ｓｐｅｃｉｆｉｃ　Ｉｎｔｅｇｒａｔｅｄ　Ｃｉｒｃｕｉｔ）などの処理回路を有してもよい。処理回路は、単一回路又は複合回路でもよい。
　揮発性記憶装置４０１は、経路生成装置１００の主記憶装置である。例えば、揮発性記憶装置４０１は、ＲＡＭ（Ｒａｎｄｏｍ　Ａｃｃｅｓｓ　Ｍｅｍｏｒｙ）である。
　不揮発性記憶装置４０２は、経路生成装置１００の補助記憶装置である。例えば、不揮発性記憶装置４０２は、ＲＯＭ（Ｒｅａｄ　Ｏｎｌｙ　Ｍｅｍｏｒｙ）、ＨＤＤ（Ｈａｒｄ　Ｄｉｓｋ　Ｄｒｉｖｅ）、又はＳＳＤ（Ｓｏｌｉｄ　Ｓｔａｔｅ　Ｄｒｉｖｅ）である。
　通信装置４０３は、経路生成装置１００の入出力インタフェースである。例えば、通信装置４０３は、自車両１から入力される各種センサ情報Ｄ１を取得するために用いられる。また、経路生成装置１００で生成された車両制御情報Ｄ２を自車両１へ出力するために用いられる。なお、通信装置４０３は、経路生成装置１００の内部に備えられていなくてもよく、図１に示した通信装置２と同一、あるいは同等の装置を用いてもよい。
　プロセッサ４００は、作業用メモリとして揮発性記憶装置４０１（例えば、ＲＡＭ）を使用し、不揮発性記憶装置４０２（例えば、ＲＯＭ）から、通信路４０４を通じて読み出されたコンピュータ・プログラム（すなわち、経路生成プログラム）に従って動作する。なお、経路生成プログラムは、通信装置４０３を通じ、経路生成装置１００の外部から供給されてもよい。また、経路生成プログラムは、コンピュータで読み取り可能な不揮発性記憶媒体（例えば、ＣＤ（Ｃｏｍｐａｃｔ　Ｄｉｓｃ）、ＤＶＤ（Ｄｉｇｉｔａｌ　Ｖｅｒｓａｔｉｌｅ　Ｄｉｓｃ）、フラッシュメモリ、など）により配布されてもよい。
　以上のように、本実施の形態１によれば、車両走行時の道路状況が動的に変化する状況に応じて、車線変更の頻度が少なくなるようにペナルティを与えて走行経路のコストを修正し、最小コストの走行経路を選択するようにした。よって、走行車線変更を抑制し、車両に搭乗しているユーザにとって快適となる走行経路を生成することができる。
　以上の実施の形態では、走行経路のコストの総和が最小のものを選択する場合について説明したがこれに限らない。例えば、走行経路のコストの総和が２番目に小さいものを選択する、または、走行経路のコストの総和が閾値より小さいものを選択するようにしてもよい。走行経路のコストの総和が小さいものほど車線変更の頻度が少なくなり、車両に搭乗しているユーザにとって快適となる走行となる。
実施の形態２．
　上記した実施の形態１では、車両走行時の経路生成方法について例示したが、これに限らない。例えば、航空機（例えば、ヘリコプター、乗用ドローン、など）、あるいは船舶（例えば、旅客船、潜水艇、など）などの移動体の通行のための経路生成方法にも適用可能である。これを実施の形態１の変形例である実施の形態２として説明する。
　航空機あるいは船舶を対象とする経路生成の場合、例えば、移動体の通路である道路を航路、あるいは水路などの通路と読み替える、すなわち、道路情報は通路情報と読み替えればよい。また、ルールセット２１１に記憶する交通法規は、例えば、航空機の関連法規、あるいは船舶の関連法規など、各移動体に関連した通行規則に置き換えればよい。また、車線変更を進路変更、地図を航路図とそれぞれ読み替えればよい。各種センサ情報Ｄ１は、例えば、ソナー、ビーコン装置などから得られる情報を含めてもよい。
　移動体が航空機あるいは船舶である場合、障害物の対象に、気象条件（例えば、雷雲、乱気流、氷山、海流、霧、火山灰、など）も含まれてもよい。なお、航空機については停止が困難なので（空中停止が可能な航空機、例えば、ヘリコプターなどを除く）、回避、追従のみの経路生成となる。
　以上のように、本実施の形態２によれば、移動体の移動時の状況が動的に変化する状況に応じて、進路変更の頻度が少なくなるようにペナルティを与えて移動経路のコストを修正し、最小コストの移動経路を選択するようにした。よって、進路変更を抑制し、移動体に搭乗しているユーザにとって快適となる移動経路を生成することができる。
　上記以外にも、本開示はその開示の範囲内において、実施の形態の任意の構成要素の変形、もしくは実施の形態の任意の構成要素の省略が可能である。
１、１ａ、１ｂ、１ｃ　自車両、２　通信装置、３　通信網、１００　経路生成装置、
２００　認知部、２０１　地図情報解析部、２０２　静的情報取得部、２０３　座標ベクトル生成部、２０４　周辺情報・自己情報解析部、２０５　動的情報取得部、２０６　移動経路生成部、２０７　移動・停止判断部、２０８　車両制御部、２１０　地図データ、２１１　ルールセット、
３００　信号機、３０１　他車両、３０２　対向車、３０３　停止線、３０４ａ、３０４ｂ　横断歩道、３０５　交差点、
４００　プロセッサ、４０１　揮発性記憶装置、４０２　不揮発性記憶装置、４０３　通信装置、４０５　通信路

Claims (10)

  1. 　移動体の位置情報と、前記移動体の周辺情報と、一つの通路の複数の進路上で前記移動体の複数の進路にそれぞれ設定される複数の経路点とを用いて、前記移動体の移動経路を生成する経路生成装置であって、
    　前記移動体の通過地点に関する情報を含む地図情報と、前記複数の経路点とから得られる前記移動体の一つ以上の移動経路候補に、前記位置情報および前記周辺情報を用いて得られる動的情報を付加して、前記移動経路候補のそれぞれに対応した動的座標ベクトル情報を生成する動的情報取得部と、
    　前記動的座標ベクトル情報に属する経路点間が有する所定の基準コストに対し、前記動的情報に応じた所定の正値を重み付けした上で当該基準コストの総和を計算し、
    前記基準コストの総和に対し、前記移動体の進路変更の頻度に応じた所定の正値の重みを与え、
    複数の移動経路候補のうち前記基準コストの総和が小さい移動経路を選択する移動経路生成部とを備えた経路生成装置。
  2. 　前記移動経路生成部が、進路変更後の一定区間は、再度の進路変更を禁止あるいは抑制することを特徴とする請求項１に記載の経路生成装置。
  3. 　前記移動体の進路変更の頻度が、進路変更の総回数であることを特徴とする請求項１に記載の経路生成装置。
  4. 　前記移動体の進路変更の頻度が、所定の時間あたりの進路変更の平均回数であることを特徴とする請求項１に記載の経路生成装置。
  5. 　前記動的情報と、前記移動経路と、移動体の通行規則を保持するルールセットとを用いて、前記移動体の動作を制御する判断情報を出力する移動・停止判断部を備え、
    　前記移動経路生成部が、前記判断情報を用いて前記移動経路を生成するための再計算を行うことを特徴とする、請求項１から４までのいずれか１項に記載の経路生成装置。
  6. 　情報処理装置が、
    　移動体の位置情報と、前記移動体の周辺情報と、一つの通路の複数の進路上で前記移動体の複数の進路にそれぞれ設定される複数の経路点とを用いて、前記移動体の移動経路を生成する経路生成方法であって、
    　前記移動体の通過地点に関する情報を含む地図情報と、前記複数の経路点とから得られる前記移動体の１つ以上の移動経路候補に、前記位置情報および前記周辺情報を用いて得られる動的情報を付加して、前記移動経路候補のそれぞれに対応した動的座標ベクトル情報を生成する動的情報取得ステップと、
    　前記動的座標ベクトル情報に属する経路点間が有する所定の基準コストに対し、前記動的情報に応じた所定の正値を重み付けした上で当該基準コストの総和を計算し、
    前記基準コストの総和に対し、前記移動体の進路変更の頻度に応じた所定の正値の重みを与え、
    複数の移動経路候補のうち前記基準コストの総和が小さい移動経路を選択する移動経路生成ステップとを備えた経路生成方法。
  7. 　前記移動経路生成ステップが、進路変更後の一定区間は、再度の進路変更を禁止あるいは抑制することを特徴とする請求項６に記載の経路生成方法。
  8. 　前記移動体の進路変更の頻度が、進路変更の総回数であることを特徴とする請求項６に記載の経路生成方法。
  9. 　前記移動体の進路変更の頻度が、所定の時間あたりの進路変更の平均回数であることを特徴とする請求項６に記載の経路生成方法。
  10. 　前記動的情報と、前記移動経路と、移動体の通行規則を保持するルールセットとを用いて、前記移動体の動作を制御する判断情報を出力する移動・停止判断ステップを備え、
    　前記移動経路生成ステップが、前記判断情報を用いて前記移動経路を生成するための再計算を行うことを特徴とする、請求項６から９までのいずれか１項に記載の経路生成方法。
PCT/JP2021/036574 2021-10-04 2021-10-04 経路生成装置及び方法 WO2023058079A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/JP2021/036574 WO2023058079A1 (ja) 2021-10-04 2021-10-04 経路生成装置及び方法
JP2023545219A JP7401034B2 (ja) 2021-10-04 2021-10-04 経路生成装置及び方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2021/036574 WO2023058079A1 (ja) 2021-10-04 2021-10-04 経路生成装置及び方法

Publications (1)

Publication Number Publication Date
WO2023058079A1 true WO2023058079A1 (ja) 2023-04-13

Family

ID=85803246

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/036574 WO2023058079A1 (ja) 2021-10-04 2021-10-04 経路生成装置及び方法

Country Status (2)

Country Link
JP (1) JP7401034B2 (ja)
WO (1) WO2023058079A1 (ja)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009008573A (ja) * 2007-06-29 2009-01-15 Panasonic Corp ナビゲーション装置、ナビゲーション方法、及び、ナビゲーションプログラム
JP2017083213A (ja) * 2015-10-23 2017-05-18 本田技研工業株式会社 ナビサーバおよびナビシステム
WO2019225720A1 (ja) * 2018-05-23 2019-11-28 株式会社ミックウェア 情報処理システム、経路探索方法、およびプログラム

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009008573A (ja) * 2007-06-29 2009-01-15 Panasonic Corp ナビゲーション装置、ナビゲーション方法、及び、ナビゲーションプログラム
JP2017083213A (ja) * 2015-10-23 2017-05-18 本田技研工業株式会社 ナビサーバおよびナビシステム
WO2019225720A1 (ja) * 2018-05-23 2019-11-28 株式会社ミックウェア 情報処理システム、経路探索方法、およびプログラム

Also Published As

Publication number Publication date
JPWO2023058079A1 (ja) 2023-04-13
JP7401034B2 (ja) 2023-12-19

Similar Documents

Publication Publication Date Title
US11532167B2 (en) State machine for obstacle avoidance
CN108073168B (zh) 对自主驾驶车辆进行决策的评估体系
JP7391879B2 (ja) ドライブエンベロープの決定
US11427191B2 (en) Obstacle avoidance action
JP6602352B2 (ja) 自律走行車用の計画フィードバックに基づく決定改善システム
EP3626568A1 (en) Adjusting speeds along a path for autonomous driving vehicles
CN111247495A (zh) 用于自动驾驶车辆的低速场景的行人交互系统
JP2022550279A (ja) 妨害物の回避
CN111328411A (zh) 用于自动驾驶车辆的行人概率预测系统
US11615702B2 (en) Determining vehicle path
CN111857118A (zh) 对停车轨迹分段以控制自动驾驶车辆停车
CN113316535A (zh) 车辆控制
US11480962B1 (en) Dynamic lane expansion
EP3995379B1 (en) Behavior prediction for railway agents for autonomous driving system
CN111615476A (zh) 用于自动驾驶车辆的基于螺旋曲线的竖直停车规划系统
CN113060118A (zh) 用于柔和降速的速度规划引导线
EP4052174A1 (en) Obstacle avoidance action
JP2021170165A (ja) 車両の走行制御装置
CN115593429A (zh) 自动驾驶车辆对紧急车辆的响应
US20230419830A1 (en) Determining right of way
JP7521862B2 (ja) 運転支援装置
JP2022156078A (ja) 交通システム
WO2023058079A1 (ja) 経路生成装置及び方法
CN115158359A (zh) 改进自主驾驶车辆的规划模块的方法及系统
JP7428294B2 (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: 21959823

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 2023545219

Country of ref document: JP

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 21959823

Country of ref document: EP

Kind code of ref document: A1