Travel plan creation device, travel plan creation method, and travel plan creation computer program
The travel plan creation device optimizes vehicle entry times and speeds at connection points without traffic lights, addressing simultaneous arrivals and enhancing safety and efficiency.
Patent Information
- Application Number
- JP2022151733
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2022-09-22
- Publication Date
- 2025-01-17
- Estimated Expiration
- 2042-09-22
AI Technical Summary
At connection points where traffic lights are not installed, autonomous vehicles may arrive simultaneously from different directions, leading to vehicles stopping without entering the connection point to allow the other vehicle to go first, potentially causing traffic congestion and inefficiencies.
A travel plan creation device that specifies an entry time range for vehicles to enter connection points, adjusting travel speed changes to ensure timely arrival within this range, and includes features like rear vehicle detection and occupant presence checks to optimize lane changes and avoid collisions.
Enables smooth and efficient travel through lane connection points by optimizing vehicle entry times and speeds, reducing congestion and enhancing safety by avoiding simultaneous arrivals and unnecessary stops.
Smart Images

Figure 0007616183000004 
Figure 0007616183000005 
Figure 0007616183000006
Abstract
Description
[Technical field]
[0001] The present disclosure relates to a travel plan creation device, a travel plan creation method, and a computer program for creating a travel plan for a vehicle. [Background technology]
[0002] At a junction (e.g., an intersection) where one lane connects to another lane, it is preferable to control the traffic flow so that vehicles do not enter from both lanes at the same time in order to prevent collisions between vehicles entering from each lane. One example of controlling the traffic flow at a junction is control by traffic lights.
[0003] Patent Document 1 describes a driving assistance device that improves the prediction accuracy of the predicted arrival time at an intersection and appropriately performs driving assistance using the signal cycle of traffic lights. [Prior art documents] [Patent documents]
[0004] [Patent Document 1] JP 2009-048458 A Summary of the Invention [Problem to be solved by the invention]
[0005] Some connection points may not have traffic lights and require autonomous driving by traffic participants. If vehicles that are driving automatically using a cruise control device arrive at such a connection point from different directions at the same time, a situation may occur in which both vehicles continue to stop without entering the connection point in an attempt to let the other vehicle enter first.
[0006] An object of the present disclosure is to provide a driving plan creation device that can create a driving plan for smoothly traveling through lane connection points. [Means for solving the problem]
[0007] The gist of the present disclosure is as follows.
[0008] (1) An identification unit that identifies an entry time range indicating a time range during which it is recommended for the vehicle to enter a connection point where a lane in which a vehicle is traveling is connected to another lane different from the lane in front of the vehicle, and a generation unit that generates a driving plan including a change in a driving speed of the vehicle from a current position of the vehicle to the connection point so that the vehicle arrives at the connection point within the approach time range; A driving plan creation device comprising:
[0009] (2) The driving schedule creation device according to (1) above, wherein the entry time range is a time range defined by the elapsed time from the start of a predetermined cycle that is repeated from a predetermined time.
[0010] (3) The identification unit further identifies, for the connection point, an avoidance time range indicating a time range during which it is recommended to avoid the vehicle from entering the connection point from the driving lane; The creation unit creates the travel plan so as not to reach the connection point within the avoidance time range. A driving schedule creation device according to (1) or (2) above.
[0011] (4) The driving schedule creation device according to any one of (1) to (3) above, wherein the identification unit identifies the connection point where no traffic light that controls the entry of the vehicle is installed, and identifies the entry time range for the connection point.
[0012] (5) A driving plan creation device according to any one of (1) to (4) above, wherein the identification unit identifies the entry time range by referring to a storage device mounted on the vehicle that pre-stores the entry time range for each lane connected to the connection point, and identifying the lane connected to the connection point based on the current position and traveling direction of the vehicle.
[0013] (6) The driving schedule creation device according to any one of (1) to (5) above, further comprising a driving control unit that executes driving control including at least acceleration and deceleration control of the vehicle in accordance with the driving plan.
[0014] (7) A rear vehicle detection unit detects the presence or absence of a rear vehicle traveling behind the vehicle from rear data representing a rear situation of the vehicle, The driving control unit does not execute driving control according to the driving plan when there is no rear vehicle. The driving schedule creation device according to (6) above.
[0015] (8) An occupant detection unit detects whether or not an occupant other than a driver who can perform driving operations of the vehicle is in the vehicle from the vehicle interior data representing the situation inside the vehicle interior of the vehicle, The driving control unit does not execute driving control according to the driving plan when no passenger other than the driver is on board. A driving schedule creation device according to (6) or (7) above.
[0016] (9) The identification unit further identifies whether the connection point is a stop connection point where a vehicle is required to stop before entering the driving lane, The driving control unit does not execute driving control according to the driving plan when the connection point is the temporary stop connection point. A driving schedule creation device according to any one of (6) to (8) above.
[0017] (10) A driving plan creation device that creates a driving plan for a vehicle, For a connection point where a driving lane in which the vehicle is traveling is connected to another lane different from the driving lane in front of the vehicle, an entry time range indicating a time range in which it is recommended for the vehicle to enter the connection point from the driving lane; creating the driving plan including a transition of the driving speed of the vehicle from the current position of the vehicle to the connection point so as to arrive at the connection point within the approach time range; A driving plan creation method including the steps of:
[0018] (11) For a connection point where a lane in which a vehicle is traveling is connected to another lane different from the lane in which the vehicle is traveling ahead of the vehicle, an entry time range indicating a time range in which the vehicle is recommended to enter the connection point from the lane in which the vehicle is traveling; creating a driving plan including a transition of a driving speed of the vehicle from a current position of the vehicle to the connection point so as to arrive at the connection point within the approach time range; A computer program for creating a travel plan, the computer program causing a computer mounted on the vehicle to execute the above.
[0019] According to the driving schedule creation device according to the present disclosure, it is possible to create a driving schedule for smoothly driving through a point where lanes connect. [Brief description of the drawings]
[0020] [Figure 1] 1 is a schematic configuration diagram of a vehicle in which a driving schedule creation device is implemented. [Diagram 2] FIG. 2 is a hardware schematic diagram of the driving schedule creation device. [Diagram 3] FIG. 2 is a functional block diagram of a processor included in the driving schedule creation device. [Figure 4] (a) is a schematic diagram illustrating a first example of a connection point, (b) is a diagram illustrating the approach time range in the first example of the connection point, and (c) is a time chart of the approach time range in the first example of the connection point. [Diagram 5] FIG. 1A is a schematic diagram illustrating a second example of a connection point; FIG. 1B is a diagram illustrating an approach time range and an avoidance time range in the second example of the connection point; and FIG. 1B is a time chart of the approach time range and the avoidance time range in the second example of the connection point. [Figure 6] (a) is a schematic diagram illustrating a third example of a connection point, (b) is a diagram illustrating the approach time range in the third example of a connection point, and (c) is a time chart of the approach time range in the third example of a connection point. [Figure 7]FIG. 13 is a diagram for explaining setting of a scheduled arrival time to a connection point. [Figure 8] FIG. 2 is a diagram showing the transition of the vehicle's traveling speed until the vehicle reaches a connection point. [Figure 9] 13 is a flowchart of a travel plan creation process. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0021] Hereinafter, a driving plan creation device capable of creating a driving plan for smoothly driving through a lane connection point will be described in detail with reference to the drawings. The driving plan creation device specifies an entry time range for a connection point, which indicates a time range in which it is recommended for a vehicle to enter the connection point from the driving lane. The connection point is a point where the driving lane in which the vehicle is traveling connects with another lane different from the driving lane ahead of the vehicle. Then, the driving plan creation device creates a driving plan including a transition of the vehicle's traveling speed from the current position of the vehicle to the connection point so that the vehicle arrives at the connection point within the entry time range.
[0022] FIG. 1 is a schematic configuration diagram of a vehicle in which a driving schedule creation device is implemented.
[0023] The vehicle 1 has a peripheral camera 2, an in-vehicle camera 3, a meter display 4, a GNSS receiver 5, a storage device 6, and a driving plan creation device 7. The peripheral camera 2, the in-vehicle camera 3, the meter display 4, the GNSS receiver 5, the storage device 6, and the driving plan creation device 7 are communicatively connected via an in-vehicle network that complies with a standard such as a controller area network.
[0024] The peripheral camera 2 is an example of a peripheral sensor for generating peripheral data showing the situation around the vehicle 1. The peripheral camera 2 has a two-dimensional detector composed of an array of photoelectric conversion elements sensitive to visible light, such as CCD or C-MOS, and an imaging optical system that forms an image of the area to be photographed on the two-dimensional detector. The peripheral camera 2 has a front peripheral camera 2-1 and a rear peripheral camera 2-2. The front peripheral camera 2-1 is disposed, for example, at the front upper part of the vehicle interior, facing forward, and the rear peripheral camera 2-2 is disposed, for example, at the rear upper part of the vehicle interior, facing backward. The front peripheral camera 2-1 and the rear peripheral camera 2-2 photograph the situation around the vehicle 1 through the windshield and the rear window, respectively, at a predetermined photographing period (for example, 1 / 30 seconds to 1 / 10 seconds). The front peripheral camera 2-1 and the rear peripheral camera 2-2 output front data and rear data showing the situations in front and rear as peripheral data. In addition, vehicle 1 may have a sensor other than the peripheral camera 2 as a peripheral sensor, for example, a LiDAR (Light Detection And Ranging) sensor that generates a distance image as peripheral data, in which each pixel has a value corresponding to the distance to the object represented by that pixel, based on the surrounding conditions of vehicle 1.
[0025] The interior camera 3 is an example of an interior sensor for generating an interior image showing the situation inside the vehicle 1. The interior camera 3 has a two-dimensional detector composed of an array of photoelectric conversion elements sensitive to infrared light, such as a CCD or C-MOS, and an imaging optical system that forms an image of an area to be photographed on the two-dimensional detector. The interior camera 3 also has a light source that emits infrared light. The interior camera 3 is attached, for example, at the front of the vehicle interior, facing the rear of the vehicle interior. The interior camera 3 irradiates infrared light into the vehicle interior at a predetermined photographing period (for example, 1 / 30 to 1 / 10 seconds) and outputs images showing the situation inside the vehicle interior in a time series. The vehicle 1 may have, as an interior sensor, a sensor other than the interior camera 3, for example, a seating sensor that measures the weight applied to the seat surface of each seat and outputs a sensor signal according to the weight.
[0026] The meter display 4 is an example of an output device, and has, for example, a liquid crystal display. The meter display 4 displays information about the created trip plan in a manner that is visible to the driver in accordance with a signal received from the trip plan creation device 7 via the in-vehicle network.
[0027] The GNSS receiver 5 receives GNSS signals from GNSS (Global Navigation Satellite System) satellites at predetermined intervals, and determines the self-position of the vehicle 1 based on the received GNSS signals. The GNSS receiver 5 outputs positioning signals representing the positioning results of the self-position of the vehicle 1 based on the GNSS signals to the driving schedule creation device 7 at predetermined intervals via the in-vehicle network. The GNSS receiver 5 also detects the current time from time information included in the GNSS signals.
[0028] The storage device 6 is an example of a storage unit, and includes, for example, a hard disk device or a non-volatile semiconductor memory. The storage device 6 stores map data including information about lanes on which the vehicle 1 is traveling and connection points. The information about the connection points includes an entry time range for each lane connected to the connection point.
[0029] The driving schedule creation device 7 creates a driving schedule including a change in the driving speed of the vehicle 1 to the connection point, based on information about the connection point included in the map data stored in the storage device 6.
[0030] 2 is a hardware schematic diagram of the driving schedule creation device 7. The driving schedule creation device 7 includes a communication interface 71, a memory 72, and a processor 73.
[0031] The communication interface 71 is an example of a communication unit, and has a communication interface circuit for connecting the driving schedule creation device 7 to an in-vehicle network. The communication interface 71 supplies the received data to the processor 73. In addition, the communication interface 71 outputs the data supplied from the processor 73 to the outside.
[0032] The memory 72 includes a volatile semiconductor memory and a non-volatile semiconductor memory. The memory 72 stores various data used in processing by the processor 73, such as acceleration / deceleration conditions that determine the range of change (acceleration / deceleration) of the traveling speed. The memory 72 also stores various application programs, such as a travel plan creation program that executes a travel plan creation process.
[0033] The processor 73 is an example of a control unit, and includes one or more processors and their peripheral circuits. The processor 73 may further include other arithmetic circuits, such as a logic arithmetic unit, a numerical arithmetic unit, or a graphics processing unit.
[0034] FIG. 3 is a functional block diagram of the processor 73 included in the driving schedule creation device 7. As shown in FIG.
[0035] The processor 73 of the driving plan creation device 7 has, as functional blocks, an identification unit 731, a creation unit 732, a rear vehicle detection unit 733, an occupant detection unit 734, and a driving control unit 735. Each of these units of the processor 73 is a functional module implemented by a program executed on the processor 73. A computer program that realizes the functions of each unit of the processor 73 may be provided in a form recorded on a computer-readable portable recording medium such as a semiconductor memory, a magnetic recording medium, or an optical recording medium. Alternatively, each of these units of the processor 73 may be implemented in the driving plan creation device 7 as an independent integrated circuit, a microprocessor, or firmware.
[0036] The identification unit 731 identifies an entry time range indicating a time range during which it is recommended for vehicle 1 to enter a connection point where the lane in which vehicle 1 is traveling connects with another lane different from the lane in which vehicle 1 is traveling ahead of vehicle 1.
[0037] The identification unit 731 identifies a connection point ahead of the driving lane by referring to the map data stored in the storage device 6 in the vicinity of the vehicle's own position represented by the positioning signal received from the GNSS receiver 5, and identifies the entry time range for the driving lane at the connection point.
[0038] Information about the connection point may be stored in a map server (not shown). In this case, the identification unit 731 transmits the positioning signal acquired from the GNSS receiver 5 to the map server via the communication interface 71 and a data communication module (not shown) connected to the in-vehicle network. The map server transmits map data representing the situation in the vicinity of the position represented by the transmitted positioning signal to the driving plan creation device 7. The identification unit 731 identifies a connection point ahead in the driving lane based on the map data acquired from the map server, and identifies the entry time range for the connection point.
[0039] 4-6 are diagrams for explaining the first to third examples of connection points and the approach time ranges for the connection points. In the first to third examples of connection points, no traffic lights are installed to control the entry of vehicles at any of the connection points. However, the driving schedule creation device 1 can create driving plans even for connection points that have traffic lights installed.
[0040] A connection point CP1 shown in Fig. 4(a) is a first example of a connection point. The connection point CP1 is an intersection where a road having lanes L11 and L12 is connected to a road having lanes L13 and L14, a road having lanes L15 and L16, and a road having lanes L17 and L18.
[0041] The storage device 6 stores map data including information indicating, for each of the lanes L11, L13, L15, and L17 through which a vehicle can enter the connection point CP1, the entry time range during which it is recommended for the vehicle to enter the connection point CP1 from that lane.
[0042] The entry time range is defined by the elapsed time from the start of a predetermined cycle (e.g., 30 seconds) that is repeated from a predetermined time (e.g., 00:00:00 on Jan. 1, 2000). In the example shown in Fig. 4(b) and (c), the entry time range from lanes L11 and L13 to the connection point CP1 is set to 15 seconds (0:00-0:15) from the start of each cycle. Also, the entry time range from lanes L15 and L17 to the connection point CP1 is set to 5 seconds (0:20-0:25) from 20 seconds after the start of each cycle.
[0043] At connection point CP1 with the entry time range set in this way, it is recommended that vehicles enter from lanes L11 and L13 for 15 seconds from the start of each cycle, and that vehicles enter from lanes L15 and L17 for 5 seconds starting 20 seconds after the start. If each vehicle drives through connection point CP1 according to the entry time range, vehicles that arrive at connection point CP1 within the entry time range can be expected to enter connection point CP1 without waiting for vehicles entering from other lanes to pass.
[0044] In the first example of the connection point, the same entry time range is set for entry from a certain lane regardless of the lane to be exited from the connection point CP1, but different entry time ranges may be set depending on the lane to be exited. For example, at the connection point CP1, the entry time range for entry from lane L11 to exit to lane L18 may be set to 19 seconds (0:00-0:19) from the start of each period. By setting it in this way, a vehicle that has entered from lane L11 can reliably exit to lane L18 at least during the time range (0:15-0:19) in which entry from other lanes connected to the connection point CP1 is not recommended. Note that a vehicle that has entered from lane L11 may exit to lane L18 if it is confirmed that no vehicle has entered from lane L13, even if it is during the time range (0:00-0:15) in which entry from lane L13 is recommended.
[0045] A connection point CP2 shown in FIG. 5(a) is a second example of a connection point. The connection point CP2 is an intersection where a road having lanes L21 and L22 is connected to a road having lanes L23 and L24, a road having lanes L25 and L26, and a road having lanes L27 and L28. Stop lines are provided on lanes L25 and L27 before the connection point CP2, and vehicles are required to stop temporarily before entering the connection point CP2. The connection point CP2 corresponds to a stop connection point where vehicles are required to stop temporarily before entering when entering from lanes L25 and L27.
[0046] The storage device 6 stores map data including information indicating the entry time range for each of the lanes L21, L23, L25, and L27 through which a vehicle can enter the connection point CP2, as well as the avoidance time range within which it is recommended that a vehicle avoid entering the connection point CP2 from the corresponding lane.
[0047] The avoidance time range is defined by the elapsed time from the start of a predetermined cycle that is repeated from a predetermined time, in the same way as the entry time range. In the example shown in Fig. 5(b) and (c), the entry time range is set in the same way as for the connection point CP1. No avoidance time range is set for entry into the connection point CP2 from lanes L21 and L23. The avoidance time range for entry into the connection point CP2 from lanes L25 and L27 is set to 16 seconds (0:02-0:18) starting 2 seconds after the start of each cycle.
[0048] At the connection point CP2 where the entry time range and avoidance time range are set in this way, vehicles are recommended to avoid entering from lanes L25 and L27 for 16 seconds starting 2 seconds after the start of each period. Therefore, vehicles traveling on lanes L21 and L23 can enter the connection point CP2 more safely during this time range.
[0049] When the avoidance time range is set in this way, the time range for entering the connection point CP2 from the lanes L25 and L27 is limited. Since a temporary stop is required to enter the connection point CP2 from the lanes L25 and L27, it is relatively easy to comply with the avoidance time range.
[0050] The connection point CP3 shown in Fig. 6(a) is a third example of a connection point. The connection point CP3 is a point set as a lane change point on lanes L31 and L32 that are traveling in the same direction. In this example, the lanes L31 and L32 after passing the connection point CP3 are lanes L33 and L34, respectively. The connection point CP3 does not have to be visibly indicated on the road by road signs, road markings, etc.
[0051] The storage device 6 stores map data including information indicating an entry time range for each lane to be exited from the connection point CP3 for each of the lanes L31, L32 through which the vehicle can enter the connection point CP3.
[0052] 6(b) and (c), a vehicle traveling on lane L31 can always go straight to lane L33 in each cycle and can change lanes to lane L34 for 2 seconds (0:03-0:05) from 3 seconds after the start of the cycle. Also, a vehicle traveling on lane L32 can go straight to lane L34 for 2 seconds (0:00-0:02) from the start of the cycle and can never change lanes to lane L33.
[0053] At the connection point CP3 for which the entry time ranges are set in this manner, the entry time range for moving from lane L31 to lane L34 and the entry time range for moving from lane L32 to lane L34 do not overlap. Therefore, vehicles traveling on lanes L31 and L32 can enter the connection point CP3 toward lane L34 more safely.
[0054] Returning to FIG. 3, the creation unit 732 creates a driving plan for the vehicle 1 so that the vehicle 1 arrives at the connection point within the approach time range. The creation unit 732 estimates a standard arrival time to the connection point based on the distance from the current position of the vehicle 1 to the connection point and the change in the driving speed of the vehicle 1 to the connection point included in the current driving plan. The creation unit 732 sets an expected arrival time based on the relationship between the estimated standard arrival time and the approach time range of the connection point. The creation unit 732 can set the expected arrival time between the earliest arrival time and the latest arrival time that are set before and after the standard arrival time. The earliest arrival time and the latest arrival time are limit values of the arrival time for the vehicle 1 to travel safely and without causing discomfort to the occupants of the vehicle 1. The creation unit 732 can set the earliest arrival time and the latest arrival time by adding, for example, a maximum shortened time (e.g., −2 seconds) and a maximum extended time (e.g., 5 seconds) that are determined according to the distance from the current position of the vehicle 1 to the connection point and the speed of the vehicle 1 to the standard arrival time. The creation unit 732 creates a driving plan so that the vehicle arrives at the connection point at the scheduled arrival time that has been set.
[0055] FIG. 7 is a diagram for explaining the setting of the estimated arrival time to the connection point. In FIG. 7, the approach time range of the connection point is from time t 1s From time t 1e The other periods such as P2 are set in the same manner.
[0056] In (1) of Fig. 7, the creation unit 732 can set the standard arrival time SAT1 between the earliest arrival time EAT1 and the latest arrival time LAT1. The standard arrival time SAT1 is included in the approach time range in the period P1. In this case, the creation unit 732 sets the standard arrival time SAT1 as the scheduled arrival time.
[0057] In (2) of FIG. 7, the creation unit 732 can set the standard arrival time SAT2 between the earliest arrival time EAT2 and the latest arrival time LAT2. The earliest arrival time EAT2 and the standard arrival time SAT2 are included in a time range that is not the approach time range in the cycle P1. The latest arrival time LAT2 is included in the approach time range in the cycle P2. In this case, the creation unit 732 sets the latest arrival time LAT2 to the expected arrival time.
[0058] In (3) of FIG. 7, the creation unit 732 can set the standard arrival time SAT3 between the earliest arrival time EAT3 and the latest arrival time LAT3. The standard arrival time SAT3 and the latest arrival time LAT3 are included in a time range that is not the approach time range in the cycle P1. The earliest arrival time EAT3 is included in the approach time range in the cycle P1. At this time, the creation unit 732 sets the earliest arrival time EAT3 to the expected arrival time.
[0059] In (4) of FIG. 7, the creation unit 732 can set the standard arrival time SAT4 between the earliest arrival time EAT4 and the latest arrival time LAT4. The standard arrival time SAT4 is included in a time range that is not the entry time range in the cycle P1. The earliest arrival time EAT4 is included in the entry time range in the cycle P1. The latest arrival time LAT4 is included in the entry time range in the cycle P2. The creation unit 732 can set the earliest arrival time EAT4 or the latest arrival time LAT4 as the estimated arrival time. In this case, the creation unit 732 can create a safer driving plan by setting the latest arrival time LAT4 as the estimated arrival time.
[0060] Fig. 8 is a diagram showing the transition of the vehicle's traveling speed until it reaches the connection point. In the graph G shown in Fig. 8, the vertical axis represents the vehicle's speed, and the horizontal axis represents the distance from the vehicle to the connection point (the closer it is to the right), and the vehicle travels at a first speed (e.g., 6 m / s) to a point (hereinafter, referred to as "point D0") that is a distance D0 (e.g., 80 m) from the connection point. The creation unit 732 creates a driving plan so that the speed of the vehicle when it reaches the connection point is a second speed (e.g., 0 m / s).
[0061] [1] shows an example of the transition of the vehicle's traveling speed in a standard travel plan. In [1], the vehicle travels to a predetermined point at a first speed, and from the predetermined point, it accelerates at a first acceleration (e.g., -0.36 m / s 2 ) while changing (decelerating) its speed from the first speed and arriving at the connection point at the second speed.
[0062] The creation unit 732 calculates the time (e.g., 16.7 seconds) required to change the first speed to the second speed at the first acceleration, and calculates the distance D2 (e.g., 50 m) that the vehicle will travel during that time. The point (point D2) that is the distance D2 from the connection point corresponds to the specified point in [1]. In [1], the estimated arrival time at the connection point is the time when the vehicle traveled at point D0 plus the total of the travel time from point D0 to point D2 (e.g., 5.0 seconds) and the travel time from point D2 to the connection point (e.g., 21.7 seconds). Hereafter, in the explanation of FIG. 8, the estimated arrival time will be explained by indicating the travel time.
[0063] [2] shows an example of the transition of the vehicle's traveling speed in a trip plan in which the estimated arrival time is changed to a time earlier than the estimated arrival time in a standard trip plan. In [2], the vehicle travels to a predetermined point at a first speed, and from the predetermined point, the vehicle travels at a second acceleration (e.g., −0.5 m / s 2 ) while changing (decelerating) its speed from the first speed and arriving at the connection point at the second speed.
[0064] The creation unit 732 calculates the time (e.g., 12.0 seconds) required to change the first speed to the second speed at the second acceleration, and calculates the distance D3 (e.g., 36 m) that the vehicle travels during that time. The point (point D3) that is the distance D3 from the connection point corresponds to the specified point in [2]. In [2], the travel time from point D0 to the connection point is the sum of the travel time from point D0 to point D3 (e.g., 7.3 seconds) and the travel time from point D3 to the connection point (e.g., 19.3 seconds).
[0065] [3] shows a first example of a transition in the travel speed of a vehicle in a trip plan in which the estimated arrival time is changed to a time later than the estimated arrival time in a standard trip plan. In [3], the vehicle travels to a predetermined point at a first speed, and from the predetermined point, the vehicle travels at a third acceleration (e.g., −0.3 m / s 2 ) while changing (decelerating) its speed from the first speed and arriving at the connection point at the second speed.
[0066] The creation unit 732 calculates the time (e.g., 20.0 seconds) required to change the first speed to the second speed at the third acceleration, and calculates the distance D1 (e.g., 60 m) that the vehicle travels during that time. The point (point D1) that is the distance D1 from the connection point corresponds to the specified point in [3]. In [3], the travel time from point D0 to the connection point is the sum of the travel time from point D0 to point D1 (e.g., 3.3 seconds) and the travel time from point D1 to the connection point (e.g., 23.3 seconds).
[0067] [4] shows a second example of the transition of the vehicle's travel speed in a trip plan in which the estimated arrival time is changed to a time later than the estimated arrival time in the standard trip plan. In [4], the vehicle accelerates at a fourth acceleration (e.g., −0.4 m / s ) having an absolute value greater than that of the first acceleration from point D2, where the speed change starts in the standard trip plan. 2 ) to a predetermined first point at which the speed becomes a third speed (e.g., 2 m / s) that is slower than the first speed and faster than the second speed. The vehicle then travels from the predetermined first point to a predetermined second point at the third speed, and travels from the predetermined point to a connection point while changing (decelerating) the speed at a fourth acceleration.
[0068] The creation unit 732 calculates the time (e.g., 10.0 seconds) required to change the first speed to the third speed at the fourth acceleration, and calculates the distance (e.g., 40 m) that the vehicle will travel in that time. The creation unit 732 calculates the distance D4 (e.g., 10 m) from the connection point to the point where the vehicle's speed becomes the third speed by subtracting the distance (e.g., 40 m) traveled by the vehicle during the speed change from the distance (e.g., 50 m) to the connection point at point D2 where the speed change started. The point (point D4) that is the distance D4 from the connection point corresponds to the predetermined first point in [4].
[0069] The creation unit 732 calculates the time (e.g., 5.0 seconds) required to change the third speed to the second speed at the fourth acceleration, and calculates the distance D5 (e.g., 5 m) that the vehicle travels during that time. The point (point D5) that is the distance D5 from the connection point corresponds to the predetermined second point in [4]. In [4], the travel time from point D0 to the connection point is the sum (e.g., 22.5 seconds) of the travel time from point D0 to point D2 (e.g., 5.0 seconds), the travel time from point D2 to point D4, the travel time from point D4 to point D5 (e.g., 2.5 seconds), and the travel time from point D5 to the connection point.
[0070] The creation unit 732 determines the transition of the driving speed so that the difference between the set estimated arrival time and the current time becomes the required time, and creates a driving plan.
[0071] The creation unit 732 can calculate a driving plan for changing the current state of the vehicle 1 (time t, distance d, speed v, acceleration a) to an arbitrary state (time t', distance d', speed v', acceleration a') that satisfies predetermined constraint conditions according to the following formula. Assuming that the jerk (jerk), snap (jerk / acceleration), and crackle (degree of change in snap) are finite, the jerk, snap, and crackle can be obtained from the current state, the state when reaching the connection point, and the time required for that state transition (t'-t) based on the following formula. The creation unit 732 creates a driving plan according to the obtained jerk, snap, and crackle.
[0072]
number
[0073]
number
[0074]
number
[0075] If an avoidance time range is specified for the connection point, the creation unit 732 further creates a driving plan so as not to arrive at the connection point within the avoidance time range. For example, in the second example of the connection point shown in Fig. 5, the standard arrival time and the earliest arrival time of a vehicle heading to the connection point CP2 from the lane L25 are included in the avoidance time range, and the latest arrival time is included in a time range that is neither the entry time range nor the avoidance time range. In this case, the creation unit 732 sets the estimated arrival time to a time that is earlier than the latest arrival time among times included in a time range that is neither the entry time range nor the avoidance time range.
[0076] The creation unit 732 may acquire in advance a driving route created to reach a specified destination from the current position of the vehicle 1 indicated by the positioning signal output by the GNSS receiver 5. The creation unit 732 may also create the driving route in advance according to a predetermined route search method such as the Dijkstra algorithm, with reference to the map information stored in the storage device 6. The creation unit 732 can identify the lane exiting from the connection point by referring to the driving route, and create a driving plan to appropriately reach the connection point in which an entry time range that differs depending on the lane to be exited is set.
[0077] The creation unit 732 may output the created driving plan via an output device. For example, the creation unit 732 causes the meter display 4 to display information related to the driving plan in a manner that is visible to the driver. The information related to the driving plan includes, for example, a difference between a vehicle speed according to a standard driving plan for arriving at a connection point at a standard arrival time and a vehicle speed according to a current driving plan. By outputting such information, the driver can understand the reason for a behavior different from the behavior according to the standard driving plan. In addition, the creation unit 732 may cause the distance to a connection point, an entry time range set at a connection point, an avoidance time range, and the like to be output as information related to the driving plan.
[0078] When the vehicle 1 is being driven manually, the driver can control the speed of the vehicle 1 based on the information related to the driving plan output by the creation unit 732.
[0079] 3, the rear vehicle detection unit 733 detects the presence or absence of a rear vehicle traveling behind the vehicle 1 from a peripheral image showing the situation behind the vehicle 1. The rear vehicle detection unit 733 receives rear data from the rear peripheral camera 2-2 via the communication interface 71. The rear vehicle detection unit 733 detects a rear vehicle traveling behind the vehicle 1 by inputting the received rear data to a classifier that has been trained in advance to detect rear vehicles.
[0080] The classifier may be a convolutional neural network (CNN) having multiple convolution layers connected in series from the input side to the output side, such as YOLO (You Only Look Once) or SSD (Single Shot MultiBox Detector). A large number of images including a rear vehicle are input to the CNN as training data in advance, and the CNN operates as a classifier that detects a rear vehicle from an image by learning. In addition, a machine learning algorithm such as a support vector machine (SVM) or AdaBoost may be used for the classifier. When the classifier is an SVM, the SVM is trained to determine support vectors for identifying whether or not a rear vehicle is included in various areas of the rear data, and the SVM operates as a classifier that detects a rear vehicle.
[0081] The occupant detection unit 734 detects whether or not an occupant other than the driver who can perform driving operations of the vehicle 1 is in the vehicle from the vehicle interior data that indicates the situation inside the vehicle interior. The occupant detection unit 734 receives an interior image from the vehicle interior camera 3 via the communication interface 71. The occupant detection unit 734 detects whether or not an occupant other than the driver is in the vehicle by inputting the received interior image into a classifier that has been trained in advance to detect occupants. The classifier can use CNN or other machine learning algorithms.
[0082] When the vehicle 1 has a seating sensor as an in-vehicle sensor, the occupant detection unit 734 may detect the presence or absence of an occupant based on a sensor signal received from the seating sensor via the communication interface 71.
[0083] The driving control unit 735 executes driving control including at least acceleration / deceleration control of the vehicle 1 according to the driving plan. The driving control unit 735 outputs a control signal to a driving mechanism (not shown) of the vehicle 1 via the communication interface 71 so that the vehicle 1 drives at a speed according to the travel speed transition included in the driving plan. The driving mechanism includes, for example, a drive source such as an engine or a motor that supplies power to the vehicle 1, and a brake that reduces the travel speed of the vehicle 1.
[0084] After arriving at the connection point, the driving control unit 735 confirms that there are no vehicles entering from other lanes, and controls the driving of the vehicle 1 so that the vehicle 1 enters the connection point.
[0085] The driving control unit 735 detects the presence or absence of another vehicle entering the connection point from the forward data that indicates the situation ahead of the vehicle 1. The driving control unit 735 receives the forward data from the front surroundings camera 2-1 via the communication interface 71. The driving control unit 735 detects another vehicle entering the connection point by inputting the received forward data to a classifier that has been trained in advance to detect other vehicles. The classifier may use CNN or other machine learning algorithms.
[0086] The driving control unit 735 executes driving control of the vehicle 1 so that the vehicle 1 enters the connection point when there is no other vehicle entering the connection point, and stops the vehicle 1 without entering the connection point when there is another vehicle entering the connection point. The driving control unit 735 may control a steering mechanism that steers the vehicle 1 in addition to the drive source and brakes.
[0087] When the rear vehicle detection unit 733 has not detected a rear vehicle, the driving control unit 735 may not execute driving control according to the driving plan created by the creation unit 732. At this time, the creation unit 732 executes driving control according to, for example, a standard driving plan for arriving at a connection point at a standard arrival time.
[0088] The entry time range set for the connection point indicates the time range in which the entry of the vehicle into the connection point is recommended, and does not prohibit entry at other times. A vehicle that has arrived at the connection point can enter the connection point if there are no vehicles entering from other lanes at that time. If the vehicle arrives at the connection point at the standard arrival time without executing the driving control according to the driving plan, there is a possibility that the vehicle can enter the connection point between the arrival time and the entry time range immediately thereafter, but there is also a possibility that the vehicle will behave unnaturally, such as making an unnecessary stop before the connection point. Such vehicle behavior may give a suspicious impression to the rear vehicle, so it is preferable not to execute the driving control according to the driving plan when the rear vehicle is not detected.
[0089] If the occupant detection unit 734 has not detected an occupant other than the driver, the driving control unit 735 does not need to execute driving control in accordance with the driving plan created by the creation unit 732.
[0090] The unnatural behavior of the vehicle that may occur when the vehicle reaches the connection point at the standard arrival time without executing the driving control according to the driving plan may give a suspicious impression to passengers other than the driver. Therefore, it is preferable not to execute the driving control according to the driving plan when no passengers other than the driver are detected.
[0091] When the identifying unit 731 determines that the connection point is a temporary stop connection point, the traveling control unit 735 does not need to execute traveling control in accordance with the traveling plan created by the creating unit 732.
[0092] At a stop connection point, even if the vehicle arrives within the approach time range, the vehicle cannot enter the connection point without stopping. In other words, at a stop connection point, smooth travel at the connection point cannot be achieved even by driving control according to the driving plan. Therefore, it is preferable to arrive at the connection point at the standard arrival time without executing driving control according to the driving plan, as this may allow the vehicle to enter the connection point earlier.
[0093] 5 is a flowchart of the driving plan creation process. When the distance from the vehicle 1 to the connection point falls below a predetermined distance threshold, the processor 73 of the driving plan creation device 7 executes the driving plan creation process described below.
[0094] First, the identification unit 731 of the processor 73 of the driving schedule creation device 7 identifies an entry time range for a connection point that connects to another lane ahead of the driving lane in which the vehicle 1 is traveling (step S1).
[0095] Next, the creation unit 732 of the processor 73 creates a driving plan including the change in the driving speed of vehicle 1 from the current position of vehicle 1 to the connection point so that the connection point is reached within the entry time range (step S2), and terminates the driving plan creation process.
[0096] By executing the driving plan creation process in this manner, a driving plan can be created for smooth driving through lane connection points.
[0097] According to a variant, information on the connection points may be provided by information providers installed in the vicinity of each connection point. The information provider is, for example, a bulletin board on which a two-dimensional barcode in which information on the connection points is embedded is written. The two-dimensional barcode has embedded therein information (e.g., distance from the installation position, latitude, longitude, etc.) that identifies the location of the connection point ahead of the installation position, and information that indicates the entry time range when entering the identified connection point from the lane in which the two-dimensional barcode is installed.
[0098] For example, for connection point CP1 shown in FIG. 4(a), the entry time range for entering lane L11 and exiting lanes L14, L16, and L18 is embedded in the two-dimensional barcode placed just before connection point CP1 on lane L11.
[0099] In addition to the information indicating the entry time range, information indicating the avoidance time range may also be embedded in the two-dimensional barcode.
[0100] In this variant, the identification unit 731 identifies a connection point ahead in the driving lane by decoding a two-dimensional barcode generated by the peripheral camera 2 from the peripheral data in which the two-dimensional barcode is represented, and identifies the entry time range for the connection point.
[0101] It should be understood that those skilled in the art can make various changes, substitutions, and alterations thereto without departing from the spirit and scope of the present disclosure. [Explanation of symbols]
[0102] 1 vehicle 7. Driving plan creation device 731 Specific part 732 Creation Department 733 Rear vehicle detection unit 734 Occupant detection unit 735 Driving Control Unit
Claims
1. A determination unit that determines an entry time range indicating a time range during which the vehicle is recommended to enter a connection point from a travel lane in which the vehicle is traveling to a connection point where the travel lane is connected to another lane different from the travel lane in front of the vehicle; a generation unit that generates a driving plan including a change in a driving speed of the vehicle from a current position of the vehicle to the connection point so that the vehicle arrives at the connection point within the approach time range; Equipped with The identification unit is a driving schedule creation device that identifies the connection point where no traffic light that controls the entry of the vehicle is installed, and identifies the entry time range for the connection point.
2. A determination unit that determines an entry time range indicating a time range during which it is recommended for the vehicle to enter a connection point where a lane in which the vehicle is traveling is connected to another lane different from the lane in which the vehicle is traveling, the connection point. a generation unit that generates a driving plan including a change in a driving speed of the vehicle from a current position of the vehicle to the connection point so that the vehicle arrives at the connection point within the approach time range; Equipped with The identification unit is a driving plan creation device that identifies the entry time range by referring to a storage device mounted on the vehicle that pre-stores the entry time range for each lane connected to the connection point, and identifying the lane connected to the connection point based on the current position and travel direction of the vehicle.
3. A determination unit that determines an entry time range indicating a time range during which it is recommended for the vehicle to enter a connection point from a travel lane in which the vehicle is traveling to a connection point where the travel lane is connected to another lane different from the travel lane in front of the vehicle; a generation unit that generates a driving plan including a change in a driving speed of the vehicle from a current position of the vehicle to the connection point so that the vehicle arrives at the connection point within the approach time range; a travel control unit that executes travel control including at least acceleration / deceleration control of the vehicle in accordance with the travel plan; a rear vehicle detection unit that detects the presence or absence of a rear vehicle traveling behind the vehicle from rear data that represents a situation behind the vehicle; Equipped with The driving control unit is a driving plan creation device that does not execute driving control according to the driving plan when there is no rear vehicle.
4. A determination unit that determines an entry time range indicating a time range during which it is recommended for the vehicle to enter a connection point where a lane in which the vehicle is traveling is connected to another lane different from the lane in which the vehicle is traveling, the connection point. a generation unit that generates a driving plan including a change in a driving speed of the vehicle from a current position of the vehicle to the connection point so that the vehicle arrives at the connection point within the approach time range; a travel control unit that executes travel control including at least acceleration / deceleration control of the vehicle in accordance with the travel plan; an occupant detection unit that detects whether or not an occupant other than a driver who can perform driving operations of the vehicle is in the vehicle from vehicle interior data that represents a situation inside the vehicle interior of the vehicle; Equipped with The driving control unit is a driving plan creation device that does not execute driving control according to the driving plan when no passengers other than the driver are on board.
5. A determination unit that determines an entry time range indicating a time range during which it is recommended for the vehicle to enter a connection point from a travel lane in which the vehicle is traveling to a connection point where the travel lane is connected to another lane different from the travel lane in front of the vehicle; a generation unit that generates a driving plan including a change in a driving speed of the vehicle from a current position of the vehicle to the connection point so that the vehicle arrives at the connection point within the approach time range; a travel control unit that executes travel control including at least acceleration / deceleration control of the vehicle in accordance with the travel plan; Equipped with The identification unit further identifies whether the connection point is a stop connection point where a vehicle is required to stop before entering the driving lane, The driving control unit does not execute driving control according to the driving plan when the connection point is the temporary stop connection point. Driving plan creation device.
6. The driving schedule creation device according to any one of claims 1 to 5, wherein the entry time range is a time range defined by the elapsed time from a start of a predetermined cycle that is repeated from a predetermined time.
7. The identification unit further identifies, for the connection point, an avoidance time range indicating a time range during which it is recommended to avoid the vehicle from entering the connection point from the driving lane, The creation unit creates the travel plan so as not to reach the connection point within the avoidance time range. A driving schedule creation device according to any one of claims 1 to 5.
8. A travel plan creation device that creates a travel plan for a vehicle, For a connection point where a driving lane in which the vehicle is traveling is connected to another lane different from the driving lane in front of the vehicle, an entry time range indicating a time range in which it is recommended for the vehicle to enter the connection point from the driving lane; creating the driving plan including a transition of the vehicle's driving speed from the current position of the vehicle to the connection point so as to arrive at the connection point within the approach time range; In the identification, the connection point where a traffic signal that controls the entry of the vehicle is not installed is identified, and the entry time range is identified for the connection point. A driving plan creation method including the steps of:
9. Specifying an entry time range indicating a time range during which the vehicle is recommended to enter a connection point from a travel lane in which the vehicle is traveling to a connection point where the travel lane is connected to another lane different from the travel lane in front of the vehicle; creating a driving plan including a transition of a driving speed of the vehicle from a current position of the vehicle to the connection point so as to arrive at the connection point within the approach time range; causing a computer mounted on the vehicle to execute the above steps; The identifying step includes identifying the connection point where no traffic light is installed to control the entry of the vehicle, and identifying the entry time range for the connection point.
Citation Information
Patent Citations
Driving support device and driving support system
JP2009048458A
Intersection nonstop travel control method
JP2013045196A
Automatic travel control device
JP2018173800A
Control device and control system
JP2022108200A