WO2022149302A1 - 制御システム、車載装置、および管制装置 - Google Patents
制御システム、車載装置、および管制装置 Download PDFInfo
- Publication number
- WO2022149302A1 WO2022149302A1 PCT/JP2021/031311 JP2021031311W WO2022149302A1 WO 2022149302 A1 WO2022149302 A1 WO 2022149302A1 JP 2021031311 W JP2021031311 W JP 2021031311W WO 2022149302 A1 WO2022149302 A1 WO 2022149302A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- vehicle
- time
- travelable
- track
- unit
- Prior art date
Links
- 238000004364 calculation method Methods 0.000 claims description 68
- 230000005540 biological transmission Effects 0.000 claims description 27
- 230000009471 action Effects 0.000 claims description 13
- 230000006872 improvement Effects 0.000 abstract description 2
- 238000000034 method Methods 0.000 description 58
- 230000006854 communication Effects 0.000 description 42
- 238000004891 communication Methods 0.000 description 41
- 230000008569 process Effects 0.000 description 27
- 238000012545 processing Methods 0.000 description 24
- 238000001514 detection method Methods 0.000 description 22
- 238000010586 diagram Methods 0.000 description 21
- 230000000694 effects Effects 0.000 description 12
- 238000012937 correction Methods 0.000 description 10
- 230000006870 function Effects 0.000 description 8
- 102220515663 Zinc finger protein Helios_S13A_mutation Human genes 0.000 description 5
- 230000001133 acceleration Effects 0.000 description 4
- 230000033001 locomotion Effects 0.000 description 4
- 230000001360 synchronised effect Effects 0.000 description 4
- 102220515664 Zinc finger protein Helios_S13D_mutation Human genes 0.000 description 2
- 238000013459 approach Methods 0.000 description 2
- 230000001934 delay Effects 0.000 description 2
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 230000001771 impaired effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 102200012170 rs10084168 Human genes 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
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/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/09—Taking automatic action to avoid collision, e.g. braking and steering
-
- 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
- B60W60/001—Planning or execution of driving tasks
- B60W60/0015—Planning or execution of driving tasks specially adapted for safety
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/166—Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes
Definitions
- the present invention relates to a control system, an in-vehicle device, and a control device.
- Patent Document 1 As an existing technique for realizing automatic driving of a vehicle, there is a technique described in Japanese Patent Application Laid-Open No. 2020-4590 (Patent Document 1).
- the subject of this publication is “providing an aspect of automatic driving of vehicle control assistance", and as a solution, "the automatic driving control assist method of a vehicle is based on at least one sensor arranged separately from the vehicle in the environment.”
- the environment sensed result regarding the environment showing the related information of a plurality of objects including the vehicle in the environment is obtained. It includes a step of determining and a step of assisting the control of the driving behavior of the vehicle by providing the vehicle-side control device associated with the vehicle with the environmental sensing result.
- the vehicle control device has an acquisition unit that acquires the communication cycle of communication processing between a plurality of communication devices, and a delay time of the acquired communication cycle based on a predetermined communication cycle in advance.
- the speed is equal to or higher than the set threshold value, or when retransmission control is performed in the communication process between a plurality of communication devices, the speed of the vehicle at a predetermined timing at which the vehicle starts braking so that the vehicle does not collide with an object. It is provided with a control unit for dropping the speed or increasing the deceleration at a predetermined timing.
- Patent Document 1 for a vehicle that cannot be automatically driven independently and needs assistance in vehicle control, the control device assists the vehicle control by transmitting information on the traveling track to the vehicle, and the vehicle is the track. It is possible to automatically control the vehicle by following the information.
- a threshold value for communication delay is set based on the communication cycle between the control device and the in-vehicle device, and when the communication delay exceeds the threshold value, the vehicle is decelerated or stopped, thereby ensuring the safety of vehicle control. Can be guaranteed.
- the valid time (that is, the allowable communication delay amount) of the information transmitted by the control device to the in-vehicle device does not always match the communication cycle. For example, in the case of a right turn at an intersection, the permissible communication delay is short when an oncoming vehicle is approaching, and the permissible communication delay is long when an oncoming vehicle is not approaching. Therefore, if the threshold value of the communication delay is set to a predetermined fixed value, the threshold value is set pessimistically for safety, and there is a problem that deceleration or stop of the vehicle frequently occurs.
- the present invention has been made in view of the above problems, and an object of the present invention is a control system capable of guaranteeing the safety of vehicle control and suppressing the number of times of deceleration or stop of the vehicle.
- the purpose is to provide an in-vehicle device and a control device.
- the control system for solving the above-mentioned problems is a control system composed of a time-synchronized in-vehicle device and a control device, in which the vehicle is an obstacle in a traveling track in a target area through which a vehicle equipped with the in-vehicle device passes.
- the travelable time calculation unit that calculates the travelable time that guarantees that the vehicle does not collide with the vehicle
- the travelability determination unit that determines the validity of the travelable time, and the travelable time are valid.
- the vehicle-mounted device has a track-following unit that allows the vehicle-mounted device to follow the traveling track.
- the in-vehicle device for solving the above-mentioned problem is an in-vehicle device that is time-synchronized with a control device installed outside the vehicle, and the vehicle is in a traveling track in a target area through which the vehicle equipped with the in-vehicle device passes.
- the receiving unit that receives the travelable time that guarantees that the vehicle does not collide with an obstacle from the control device, the travelability determination unit that determines the validity of the received travelable time, and the travelable time are effective. If it is determined to be present, the vehicle-mounted device has a track-following unit that allows the vehicle-mounted device to follow the traveling track.
- control device for solving the above problem is a control device that is time-synchronized with the in-vehicle device, and the vehicle collides with an obstacle in a traveling track in a target area through which the vehicle equipped with the in-vehicle device passes. It has a travelable time calculation unit that calculates a travelable time that guarantees that the vehicle does not travel, and a transmission unit that transmits the travelable time to the vehicle-mounted device in order to determine the effectiveness of the travelable time.
- the vehicle since the vehicle is controlled in consideration of the delay actually generated in the communication between the in-vehicle device and the control device, the safety of the vehicle control can be guaranteed.
- the travelable time is calculated based on the situation of obstacles when the travel track is generated, the allowable communication delay is allowed when there are no obstacles on the travel track or when the obstacles are not approaching. The time becomes longer, and it becomes possible to suppress the number of times the vehicle decelerates or stops.
- FIG. It is a figure which showed the structure of the control system 0 in Example 1.
- FIG. It is a figure which showed the functional block composition of the control system 0 and the outline of the whole operation flow in Example 1.
- FIG. It is a figure which showed the example of the time synchronization method performed in the time synchronization unit 11 included in the in-vehicle device 1, the control device 2, and the infrastructure sensor 3, respectively.
- FIG. 1 It is a figure which showed the outline of the processing flow of the runnability determination unit 13. It is a figure which showed the outline about the calculation process of T_follow of a runnability determination unit 13. It is a figure which showed the outline of the processing flow in the orbit tracking part 14. It is a figure which showed the functional block composition of the control system 0 in Example 2.
- FIG. It is a figure which showed the example of the request information 151 generated by the original travel possibility determination unit 15. It is a figure which showed the functional block composition of the control system 0 in Example 3.
- FIG. It is a figure which showed the outline of the processing flow of the runnability determination part 13 in Example 3.
- FIG. It is a figure which showed the functional block composition of the control system 0 in Example 4.
- FIG. It is a figure which showed the outline of the processing flow in the track calculation unit 22 with travelable time in Example 4.
- FIG. It is a figure which schematically showed the outline of the travelable time update processing performed by the track calculation unit 22 with travelable time in Example
- This embodiment relates to a control system, and particularly to a control system for realizing automatic driving in which a vehicle follows a traveling track (tracking) and autonomously travels.
- FIG. 1 is a diagram showing a configuration of control system 0 in the first embodiment.
- the control system 0 includes an in-vehicle device 1, a control device 2, and an infrastructure sensor 3.
- the in-vehicle device 1 cannot be automatically driven independently and needs assistance for vehicle control, and automatically operates by receiving information for assisting vehicle control from the control device 2.
- the in-vehicle device 1 can be automatically driven (independently) using information acquired by a sensor mounted on a vehicle (own vehicle) or map information under a predetermined situation, but is specific to a specific intersection or the like. Under the circumstances, automatic driving cannot be performed independently, and automatic driving is performed by receiving (acquiring) information assisting vehicle control from the control device 2.
- the control device 2 has a role of generating information that assists vehicle control based on the information from the infrastructure sensor 3 and transmitting the generated information to the in-vehicle device 1 by wireless communication.
- the control device 2 is a control device other than the infrastructure sensor 3 and the in-vehicle device 1, and is specifically a server, a cloud, an RSU (Road Side Unit), or the like.
- the infrastructure sensor 3 is a sensor capable of measuring information such as the speed and distance of an obstacle in a target area through which a vehicle equipped with an in-vehicle device 1 such as a camera, a LIDAR sensor, a radar, and other sensing devices pass.
- an in-vehicle device 1 such as a camera, a LIDAR sensor, a radar, and other sensing devices pass.
- FIG. 2 is a diagram showing an outline of the functional block configuration and the overall operation flow of the control system 0 in the first embodiment.
- the in-vehicle device 1, the control device 2, and the infrastructure sensor 3 each have a time synchronization unit 11, and synchronize the time with each other.
- the infrastructure sensor 3 has a sensing unit 31 and a sensing data transmission unit 33.
- the sensing unit 31 generates the sensing data 32.
- the sensing unit 31 is a CMOS (Complementary MOS) imaging sensor
- the sensing data 32 is pixel information data.
- the sensing data transmission unit 33 outputs the sensing data 32 to the control device 2.
- the control device 2 has a sensing data receiving unit 21, a track calculation unit 22 with a travelable time, and a track information transmission unit 24 with a travelable time.
- the sensing data receiving unit 21 receives the sensing data 32 from the infrastructure sensor 3 and inputs the sensing data 32 to the track calculation unit 22 with a travelable time.
- the track calculation unit 22 with a travelable time outputs track information 23 with a travelable time based on the sensing data 32.
- the track information transmission unit 24 with a travelable time outputs the track information 23 with a travelable time to the in-vehicle device 1.
- the in-vehicle device 1 (specifically, a control unit that performs vehicle control) has a track information receiving unit 12 with a travelable time, a travelability determination unit 13, and a track tracking unit 14.
- the track information receiving unit 12 with a travelable time receives the track information 23 with a travelable time from the control device 2, and inputs the track information 23 with a travelable time to the travel possibility determination unit 13.
- the travelability determination unit 13 determines whether or not the vehicle equipped with the in-vehicle device 1 can travel according to the track information 23 with travel time (that is, whether the track information 23 with travel time is valid). Only when it is determined that the vehicle can travel, the track information 23 with the travelable time is output to the track tracking unit 14.
- the track tracking unit 14 receives the track information 23 with a travelable time, it outputs control information 19 for moving the vehicle equipped with the in-vehicle device 1 according to the received track information 23 with a travelable time.
- the control device 2 provides track information that assists vehicle control based on the information from the infrastructure sensor 3 for the in-vehicle device 1 that cannot be automatically operated independently and requires assistance in vehicle control.
- the vehicle-mounted device 1 realizes automatic operation of the vehicle equipped with the vehicle-mounted device 1.
- FIG. 3A is a diagram showing an example of a time synchronization method performed by the time synchronization unit 11 included in the vehicle-mounted device 1, the control device 2, and the infrastructure sensor 3, respectively.
- the time synchronization unit 11 is composed of a GNSS information acquisition unit 110 and an absolute time calculation unit 111.
- the GNSS information acquisition unit 110 included in the time synchronization unit 11 receives data including the transmission time expressed in absolute time from the GNSS (Global Navigation Satellite System).
- the absolute time calculation unit 111 can calculate the error of the clock mounted on the own device by receiving data from four or more artificial satellites. Therefore, it is possible to calculate the current absolute time from the time transmitted by the satellite, which is the absolute time, and the clock error. As a result, all the times inside the vehicle-mounted device 1, the control device 2, and the infrastructure sensor 3 are synchronized with the absolute time.
- FIG. 3B is a diagram showing an example of a method of time synchronization between the in-vehicle device 1 and the control device 2.
- the time synchronization unit 11 of the vehicle-mounted device 1 is composed of a correction information transmission / reception unit 112 and a time correction unit 113.
- the time synchronization unit 11 of the control device 2 is composed of a correction information transmission / reception unit 112 and a time correction unit 113.
- the correction information transmission / reception unit 112 included in the time synchronization unit 11 of the in-vehicle device 1 transmits a communication message inquiring about the time inside the control device 2 to the control device 2.
- the correction information transmission / reception unit 112 included in the time synchronization unit 11 of the control device 2 receives a communication message from the vehicle-mounted device 1 and transmits the time information inside the control device 2 to the vehicle-mounted device 1.
- the time correction unit 113 included in the time synchronization unit 11 of the in-vehicle device 1 measures the time from the transmission of the communication message to the reception of the time information from the control device 2 to the control device 2. Correct the communication delay time of. As a result, the time inside the vehicle-mounted device 1 and the control device 2 is synchronized. Similarly, the times of the control device 2 and the infrastructure sensor 3 are also synchronized.
- the sensing unit 31 is a CMOS image sensor mounted inside the infrastructure sensor 3, and receives seven images (frames) per second.
- FIG. 4 is a diagram showing an example of sensing data 32 in this embodiment.
- the sensing data 32 is an integer value of 0 to 255 for each pixel value (RGB) in a two-dimensional array of 1920 ⁇ 1080 based on the information received by the sensing unit 31 (CMOS image sensor) mounted inside the infrastructure sensor 3. It is a set of frames expressed in. Seven frames are generated per second.
- the image may be compressed in other representation formats (YUV), compressed during communication or encoding, and expanded as needed, or compressed into a predetermined video data format such as the MPEG (Moving Picture Experts Group) format. You may.
- YUV representation formats
- MPEG Motion Picture Experts Group
- the sensing data transmission unit 33 transmits the sensing data 32 to the control device 2.
- the sensing data receiving unit 21 receives the sensing data 32 and passes it to the track calculation unit 22 with a travelable time.
- FIG. 5 is a diagram showing a functional block configuration and a processing flow of the track calculation unit 22 with a travelable time, which inputs the sensing data 32 and outputs the track information 23 with a travelable time.
- the track calculation unit 22 with travelable time is composed of an obstacle detection unit 221, a track calculation unit 223, and a travelable time calculation unit 225.
- the obstacle detection unit 221 analyzes the sensing data 32 and generates an obstacle detection result 222 indicating the presence or absence of an obstacle in the vicinity of the vehicle (in the target area through which the vehicle equipped with the in-vehicle device 1 passes) and its position (the obstacle detection result 222). Details will be explained later).
- the track calculation unit 223 reaches the destination of the vehicle equipped with the in-vehicle device 1 and the road information 2231 including at least one of the road width, the road length, the radius of curvature and the number of lanes peculiar to the road in charge of the control device 2.
- the track information 224 representing the information of the traveling track to be followed in the vehicle control of the in-vehicle device 1 is generated (details). Will be explained later).
- the travelable time calculation unit 225 is a time zone in which the vehicle equipped with the in-vehicle device 1 can travel at each point (WayPoint) on the travel track included in the track information 224.
- the track information 23 with a travelable time to which the information indicating the above is added is generated (details will be described later).
- FIG. 6 is a diagram showing an example of the obstacle detection result 222 generated by the obstacle detection unit 221.
- the obstacle detection unit 221 analyzes the sensing data 32 and calculates the identifier (ID), type (class), coordinates (position), moving speed, and moving direction of the object included in the sensing data 32. For example, in the case of FIG. 6, the oncoming vehicle is detected as an obstacle of ID1 and the crossing pedestrian is detected as an obstacle of ID2, and the types are detected as automobiles and pedestrians, respectively.
- the movement direction is expressed by using a unit direction vector of norm (L2 norm) 1 parallel to the xy coordinate plane in the coordinate system used inside the infrastructure sensor 3.
- L2 norm unit direction vector of norm
- DNN Deep Neural Network
- other known image recognition / processing techniques may be used.
- FIG. 7 is a diagram showing an example of the track information 224 generated by the track calculation unit 223.
- the track calculation unit 223 performs the obstacle detection result 222. Based on either one or both of the vehicle route information 2232 and the vehicle route information 2231 and the road information 2231, track information 224 representing information on the traveling track to be followed in the vehicle control of the vehicle-mounted device 1 is generated.
- the generation of the orbit information 224 is realized by using a technique for detecting a white line from image data and other known techniques.
- the generated orbit is represented by a set of points on the orbit called WayPoint.
- WayPoint For example, in the case of FIG. 7, in the orbit information 224, five waypoints exist on the generated orbit and are numbered as WP0, WP1, ..., WP4 in the order of proximity to the in-vehicle device 1, and WP0, ..., WP4. For each, the coordinates (x-coordinate, y-coordinate) of each WayPoint are specified.
- WP0 corresponds to the current position of the in-vehicle device 1.
- the current method of acquiring the position of the vehicle-mounted device 1 may be either the method of notifying the track calculation unit 223 from the vehicle-mounted device 1 or the analysis and identification of the sensing data 32.
- the origin may be any origin such as the road end point or the position of the vehicle.
- FIG. 8 is a diagram showing an outline of the processing flow of the travelable time calculation unit 225.
- step S2251 the obstacle detection result 222 is acquired.
- step S2252 the orbit information 224 is acquired.
- step S2253 it is confirmed whether or not the acquired orbit information 224 includes unprocessed orbit information, and if it is included, the process proceeds to step S2254, and if it is not included, the process ends.
- step S2254 the time conditions (travelable start time and travelable end time) for not colliding with an obstacle when following a track (guaranteed not to collide with an obstacle) are calculated (details will be described later).
- step S2255 one unprocessed orbit information is selected from the orbit information included in the acquired orbit information 224, and the process proceeds to step S2253.
- the travelable time calculation unit 225 calculates the travelable time by such a procedure.
- FIG. 9 is a diagram showing an example of the track information 23 with a travelable time generated by the travelable time calculation unit 225.
- the track information 23 with a travelable time for each way point included in the track information 224 generated by the track calculation unit 223, the vehicle equipped with the in-vehicle device 1 without any obstacle in the vicinity of the way point is the way.
- This is track information with added information on the time zone during which the vehicle may travel near the point (guaranteeing that it does not collide with obstacles).
- the time zone in which the vehicle may travel near the Way Point is expressed by a set of the travelable start time (ST) and the travelable end time (FT).
- FIG. 10 is a diagram schematically showing the control system 0 and the surrounding situation in the example of FIG.
- the travelable time calculation unit 225 refers to the obstacle detection result 222 for each Way Point included in the track information 224 calculated by the track calculation unit 223, and sets the time zone in which no obstacle exists in each Way Point. Calculate the runnable start time ST and the runnable end time FT. For example, as shown in FIG. 10, when an oncoming vehicle whose moving direction coincides with WP3 or its surroundings is detected 100 m in front of WP3 and the moving speed is 10 m / s, the oncoming vehicle is WP3 10 seconds later. Pass through.
- the vehicle can run within 10 seconds and cannot run after 10 seconds. From the above, based on the current time T0, the runnable start time ST3 of WP3 is calculated as T0, and the runnable end time FT3 of WP3 is calculated as T0 + 10 seconds.
- the travelable time calculation unit 225 calculates the travelable start time ST and the travelable end time FT based on the distance between the obstacle and each waypoint and the moving speed of the obstacle.
- Whether or not the movement directions match can be identified by using the vector inner product calculation in linear algebra.
- T_margin 1 second and FT3 may be T0 + (10-T_margin) seconds.
- the travelable time calculation unit 225 calculates the travelable start time ST and the travelable end time FT for other WayPoints in the same manner.
- the track information transmission unit 24 with a travelable time transmits the track information 23 with a travelable time to the in-vehicle device 1.
- the track information receiving unit 12 with a travelable time receives the track information 23 with a travelable time and passes it to the travel possibility determination unit 13.
- FIG. 11 is a diagram showing an outline of the processing flow of the travelability determination unit 13.
- step S131 the track information 23 with the travelable time is acquired.
- step S132 the distance D between each WayPoint is calculated.
- D [i] is the Euclidean distance between WayPointi and WayPointi-1, WayPoint.
- step S133 the time T_follow at which the vehicle equipped with the in-vehicle device 1 reaches each waypoint is calculated.
- T_follow ⁇ T_follow [1], T_follow [2],..., T_follow [4] ⁇ , where T_follow [i] represents the time to reach Way Point i.
- the method of deriving T_follow will be described later.
- step S134 0 is assigned to the index i of the WayPoint to be processed.
- step S135 the magnitude of the index i and (number of WayPoints-1) is compared, and if the index i is smaller, the process proceeds to step S136, and if not, the process proceeds to step S139.
- step S136 the context of the runnable start time ST of WayPointi and the time of T_follow [i] is compared. If ST is earlier (closer to the current time), the process proceeds to step S137, otherwise step S. Proceed to S13A.
- step S137 the context of the runnable end time FT of WayPointi and the time of T_follow [i] is compared, and if T_follow [i] is earlier (closer to the current time), the process proceeds to step S138, and so on. If not, the process proceeds to step S13A.
- step S138 1 is added to the index i, and the process proceeds to step S135.
- step S139 1 is substituted for the trajectory tracking flag.
- step S13A 0 is assigned to the trajectory tracking flag.
- the travelability determination unit 13 satisfies the travelable start time ST and the travelable end time FT set at each Way Point on the travel track by the vehicle equipped with the in-vehicle device 1 ( It is possible to judge whether or not it is possible to run (between the ST and FT), in other words, it is possible to judge the effectiveness of the runnable start time ST and the runnable end time FT that constitute the runnable time. Become.
- T_follow may be compared with ST + T_margin or FT-T_margin.
- FIG. 12 is a diagram showing an outline of a T_follow calculation process (step S133 in FIG. 11) of the runnability determination unit 13.
- step S1331 0 is assigned to the index j representing the WayPoint to be processed.
- step S1332 the magnitude of the index j and (number of WayPoints-1) is compared, and if the index j is smaller, the process proceeds to step S1333, and if not, the process ends.
- T_follow [j] is calculated.
- T_follow [j] is the time when the vehicle equipped with the in-vehicle device 1 arrives at Way Point j.
- Initial speed V0 [j-1] (vehicle-mounted device 1 in Way Point j-1) between Way Points separated by a distance D [j] (D [j] is the distance between Way Point j-1 and Way Point j).
- the time required for traveling by the uniform acceleration motion at the acceleration a of the vehicle equipped with the in-vehicle device 1 is as follows (Equation 2).
- T_follow [0] is the time inside the vehicle-mounted device 1 at the moment when the travelability determination unit 13 starts the calculation of the above T_follow
- V0 [0] is the time of the vehicle equipped with the vehicle-mounted device 1 in WP0. The current speeds are measured by the in-vehicle device 1.
- the acceleration a of the vehicle equipped with the in-vehicle device 1 can be arbitrarily set by the in-vehicle device 1, and may be, for example, a value obtained by multiplying the maximum design acceleration of the vehicle equipped with the in-vehicle device 1 by 0.8. ..
- step S1334 1 is added to the index j.
- step S1335 the speed V0 [j] of the vehicle equipped with the in-vehicle device 1 in WayPointj is calculated. This is done using the speed V0 [j-1] of the vehicle equipped with the in-vehicle device 1 in the previous Waypoint j-1 and the T_follow [j] and T_follow [j-1] calculated in step S1333 as follows. It can be calculated as shown in (Equation 4).
- step S1332 After calculating the speed V0 [j] of the vehicle equipped with the in-vehicle device 1, the process proceeds to step S1332.
- the calculation of the arrival time T_follow of each WayPoint is the time when the track information 23 with the travelable time arrives at the travelability determination unit 13 and the calculation is started (vehicle-mounted device 1). It should be noted that it starts from T_follow [0], which is the time inside).
- the determination of the travelability determination unit 13 is performed based on the communication delay actually generated between the in-vehicle device 1 and the control device 2, and the control device 2 guarantees the safety of the vehicle equipped with the in-vehicle device 1. It is possible to complete the running (tracking) within the time required.
- the travelable time zone (time between ST and FT) becomes long, so even if the communication delay occurs longer than usual, the process shown in FIG. 11
- the travel possibility determination unit 13 substitutes 1 for the track tracking flag according to the flow, the vehicle-mounted device 1 can perform track tracking.
- FIG. 13 is a diagram showing an outline of the processing flow in the track following unit 14.
- step S141 the track information 23 with the travelable time and the track tracking flag are acquired.
- step S142 it is confirmed whether or not the track tracking flag is 1, and if the track tracking flag is 1 (that is, the vehicle equipped with the in-vehicle device 1 travels set at each Way Point on the travel track). It is possible to run by satisfying the possible start time ST and the runnable end time FT (between the ST and FT), in other words, the runnable start time ST and the runnable end time FT that constitute the runnable time are valid. If), the process proceeds to step S143, and if the track tracking flag is not 1 (that is, the vehicle equipped with the in-vehicle device 1 has the travelable start time ST and the travelable end time FT set at each Way Point on the travel track). Is not possible (between the ST and FT), in other words, when the runnable start time ST and the runnable end time FT constituting the runnable time are not valid, the process ends.
- step S143 the acquired track information 23 with travelable time is converted into a control value.
- step S144 the control value generated in step S143 is output as control information 19.
- the determination of the control value in step S143 and the generation of the control information 19 in step S144 can be realized by a method installed in a known advanced driver-assistance systems.
- the track following unit 14 performs track following control (permits the in-vehicle device 1 to follow the traveling track) only when the traveling possibility determining unit 13 determines that the tracking is possible. Can be done.
- the control system 0 of the first embodiment is the target area through which the vehicle equipped with the vehicle-mounted device 1 passes in the control system 0 composed of the time-synchronized vehicle-mounted device 1 and the control device 2.
- the travelable time calculation unit 225 that calculates the travelable time that guarantees that the vehicle does not collide with an obstacle on the travel track
- the travel possibility determination unit 13 that determines the effectiveness of the travelable time, and the above.
- the vehicle-mounted device 1 has a track tracking unit 14 that allows the vehicle-mounted device 1 to follow the travel track.
- the travelability determination unit 13 satisfies the travelable start time and the travelable end time set at each point on the travel track that constitutes the travelable time of the vehicle equipped with the vehicle-mounted device 1. Determine whether or not the vehicle can travel.
- the control system 0 of the first embodiment has a means for synchronizing the time between the control device 2 and the vehicle-mounted device 1, and the vehicle-mounted device 1 in the traveling track where the vehicle equipped with the vehicle-mounted device 1 is scheduled to pass.
- the in-vehicle device 1 is mounted based on the means for calculating the time zone for guaranteeing that the mounted vehicle does not collide with an obstacle and the communication delay generated until the in-vehicle device 1 receives the travel track information from the control device 2.
- the vehicle includes means for determining whether or not the vehicle can travel within the time zone, and means for the vehicle-mounted device 1 to follow the travel track information when the determination is possible.
- the safety of the vehicle control is guaranteed by controlling the vehicle in consideration of the delay actually generated in the communication between the in-vehicle device 1 and the control device 2, and the obstacle on the traveling track is impaired.
- the permissible communication delay time is lengthened, which has the effect of suppressing the number of decelerations and stops of the vehicle equipped with the in-vehicle device 1.
- Example 2 The control system and method according to the second embodiment of the present invention will be described.
- the difference from the first embodiment is that the in-vehicle device 1 can request the control device 2 to assist the automatic driving.
- the same components as those in the first embodiment are designated by the same reference numerals and the description thereof will be omitted.
- FIG. 14 is a diagram showing a functional block configuration of the control system 0 including the vehicle-mounted device 1, the control device 2, and the infrastructure sensor 3 in the second embodiment.
- the configuration of the infrastructure sensor 3 is the same as that of the first embodiment.
- the in-vehicle device 1 includes an original travelability determination unit 15 and a request transmission unit 16 in addition to the components in the first embodiment, and the control device 2 constitutes a request reception unit 25 in addition to the components in the first embodiment. Make it an element.
- FIG. 15 is a diagram showing an example of request information 151 generated by the original travelability determination unit 15.
- the request information 151 includes a flag indicating whether or not to request the control device 2 to assist in vehicle control.
- the original travelability determination unit 15 determines whether or not the vehicle equipped with the in-vehicle device 1 can travel independently. For example, based on the route information to the destination and the current position of the vehicle, the vehicle with the lane keeping function cannot travel by itself due to a right or left turn, or the vehicle's sensor is broken and the vehicle cannot travel by itself. By the determination, it is determined whether or not the vehicle can travel alone (in other words, whether or not the vehicle equipped with the in-vehicle device 1 has an action that cannot be safely carried out (traveled) independently).
- the vehicle determines whether or not the vehicle can travel based on at least one of the position information of the vehicle equipped with the in-vehicle device 1, the surrounding driving environment information, and the traveling plan. Alternatively, it may be determined whether or not the vehicle can travel from the map data including information on the shape of the road and the intersection.
- the request transmission unit 16 transmits the request information 151 shown in FIG. 15 to the control device 2.
- the request information 151 includes a flag indicating whether or not assistance by the control device 2 is necessary, and the request transmission unit 16 substitutes 1 for the flag (of the request information 151 generated by the original travelability determination unit 15).
- the request information 151 is transmitted to the control device 2.
- the request transmission unit 16 requests the control device 2. You may put it out. This is because there is a large delay in communication between the in-vehicle device 1 and the control device 2, and although it was possible to travel at the time when the control device 2 calculated, it was possible due to the approach of an obstacle or the like to the vehicle equipped with the in-vehicle device 1.
- the control device 2 regenerates the track information 23 with a travelable time using the latest sensing data 32 and transmits it to the in-vehicle device 1. It has the effect of making it possible.
- the request receiving unit 25 receives the request information 151 from the vehicle-mounted device 1, and inputs the request information 151 to the track calculation unit 22 with a travelable time.
- the control device 2 generates the above-mentioned track information 23 with travelable time (including the travelable start time ST and the travelable end time FT in the travel track) (in response to the request from the in-vehicle device 1).
- the generated track information 23 with a travelable time is transmitted to the in-vehicle device 1 by the track information transmission unit 24 with a travelable time.
- the control system 0 of the second embodiment determines from the traveling track whether or not the vehicle equipped with the in-vehicle device 1 has an action that cannot be safely executed (traveled) independently.
- the propriety determination unit 15, and the request transmission unit 16 that requests the control device 2 for the travelable time including the travelable start time and the travelable end time in the travel track when it is determined that there is an action that cannot be performed. Have.
- the control device 2 if there is no request from the in-vehicle device 1, the control device 2 does not need to calculate the track information 23 with the travelable time, so that the processing load of the control device 2 can be reduced. become. Further, since the communication between the in-vehicle device 1 and the control device 2 is limited to the request from the in-vehicle device 1, the number and frequency of communication between the in-vehicle device 1 and the control device 2 are reduced, and the communication load and the communication delay are caused. It becomes possible to continue control (track tracking) while reducing the effect on vehicle control.
- Example 3 The control system and method according to the third embodiment of the present invention will be described.
- the difference from the first embodiment is that when the vehicle equipped with the in-vehicle device 1 is stopped in an emergency, the in-vehicle device 1 is mounted using only the coordinate information of the Way Point regardless of the travelable start time ST and the travelable end time FT. The point is that the vehicle will continue to drive.
- the same components as those in the first embodiment are designated by the same reference numerals and the description thereof will be omitted.
- FIG. 16 is a diagram showing a functional block configuration of the control system 0 including the vehicle-mounted device 1, the control device 2, and the infrastructure sensor 3 in the third embodiment.
- the vehicle-mounted device 1 in the third embodiment has an emergency stop unit 17 and a speed limiting unit 18 in addition to the components in the first embodiment.
- the emergency stop unit 17 has a function of applying a brake to stop the vehicle equipped with the in-vehicle device 1 in an emergency when the in-vehicle device 1 approaches some obstacle and a collision is predicted, regardless of whether or not the vehicle follows the track. ..
- the method of predicting a collision and applying a brake can be carried out by a method mounted on a known advanced driver-assistance system.
- the speed limiting unit 18 has a function of limiting the maximum speed of the vehicle equipped with the in-vehicle device 1 and a function of releasing the limitation.
- the maximum speed when speed limiting is set to 5 km / h so that the vehicle can stop immediately when an obstacle is detected.
- the speed is set to 5 km / h, but the speed is not limited to this.
- the method for limiting the maximum speed may be any method such as a known digital tachograph, and since it is not directly related to this embodiment, a detailed description of the method is omitted.
- FIG. 17 is a diagram showing an outline of the processing flow of the runnability determination unit 13 in the third embodiment. Steps S131 to S139 and S13A in FIG. 17 are the same as steps S131 to S139 and S13A in FIG. 11 described in the first embodiment.
- step S13B the vehicle single obstacle detection result is acquired.
- step S13C it is confirmed from the acquired vehicle independent obstacle detection result whether or not there is an obstacle on the traveling track, and if there is an obstacle on the traveling track, the process ends and an obstacle is found on the traveling track. If it does not exist, the process proceeds to step S13D.
- step S13D the speed limit of the vehicle equipped with the in-vehicle device 1 is set to an arbitrary speed, and 1 is substituted for the track tracking flag.
- the track tracking cannot be started or ended within the travelable time due to an emergency stop determined by the emergency stop unit 17 of the in-vehicle device 1 while following the travel track (in other words, the current travel track).
- the travelable start time ST and the travelable end time FT of the travelable time of the travel track cannot be observed, if there is no obstacle on the travel track (that is, the condition of emergency stop is canceled).
- the vehicle-mounted device 1 (The track following unit 14) can continue the automatic operation independently by passing through the traveling track while decelerating (running at a low speed).
- the track following unit 14 is of the current traveling track due to an emergency stop of the vehicle equipped with the in-vehicle device 1 while following the traveling track. If the travelable time cannot be observed, the vehicle equipped with the in-vehicle device 1 is installed regardless of the travelable time after the emergency stop condition is canceled (unless there is an obstacle on the travel track). Passes through the traveling track while decelerating.
- the vehicle equipped with the in-vehicle device 1 stops and stands by during the period from the occurrence of the emergency stop to the evacuation of an obstacle or the like, so that the travelable start time ST and the travelable start time ST and the travelable time can be set.
- the runnable end time FT is no longer satisfied, safety is achieved by driving slowly (decelerating or running at low speed) while eliminating the need for recommunication with the control device 2 and recalculation by the control device 2. It is possible to continue vehicle control while ensuring and avoid delays due to recommunication and recalculation.
- Example 4 The control system and method according to the fourth embodiment of the present invention will be described.
- the difference from the first embodiment is that the control device 2 generates the track information with a travelable time by adding the track information with a travelable time generated for another vehicle linked with the control device 2.
- the same components as those in the first embodiment are designated by the same reference numerals and the description thereof will be omitted.
- FIG. 18 is a diagram showing a functional block configuration of the control system 0 including the vehicle-mounted device 1, the control device 2, and the infrastructure sensor 3 in the fourth embodiment.
- the control device 2 in the fourth embodiment has a track calculation result storage unit 26 with a travelable time as a component in addition to the component in the first embodiment.
- the track calculation result storage unit 26 with travel time stores the track information 23 with travel time (of a plurality of vehicles to be controlled) generated (calculated) by the track calculation unit 22 with travel time.
- FIG. 19 is a diagram showing an outline of the processing flow in the track calculation unit 22 with a travelable time in the fourth embodiment. Steps S2251 to S2255 of FIG. 19 are the same as steps S2251 to S2255 of FIG. 8 described in the first embodiment.
- step S2251 the obstacle detection result 222 is acquired.
- step S2252 the orbit information 224 is acquired.
- step S2253 it is confirmed whether or not the acquired orbit information 224 includes unprocessed orbit information, and if it is included, the process proceeds to step S2254, and if it is not included, the process ends.
- step S2254 the time condition for not colliding with an obstacle (guaranteeing that it does not collide with an obstacle) when following the trajectory is calculated.
- step S2257 the travelable time update process is performed with reference to the track calculation result storage unit 26 with travelable time. The details of the travelable time update process will be described later.
- step S2255 one unprocessed orbit information is selected from the orbit information included in the acquired orbit information 224, and the process proceeds to step S2253.
- the track calculation unit 22 with a travelable time refers to the track information 224 acquired in step S2252 with respect to another vehicle (vehicle-mounted device 1) stored in the track calculation result storage unit 26 with a travelable time.
- the time during which the vehicle does not collide with an obstacle when following the orbit is calculated.
- FIG. 20 is a diagram schematically showing an outline of a travelable time update process (step S2257 in FIG. 19) performed by the track calculation unit 22 with travelable time in the fourth embodiment.
- the number of vehicles equipped with the in-vehicle device 1 is two, but the number is not limited to this.
- WP_A indicates the travel track calculated for vehicle A
- WP_B indicates the travel track calculated for vehicle B
- the travel time (ST and FT) of WP_A is from the travel time (ST and FT) of WP_B. Is also calculated before.
- the runnable time (ST and FT) for WP_B first check whether each waypoint included in WP_A is close to each waypoint included in WP_B. In the case of FIG. 20, since WP_B3 of WP_B is 70 cm away from WP_A1 of WP_A, it is determined that they are close to each other.
- the proximity determination is determined to be proximity if the distance between the WPs is closer than the threshold value based on a separately set threshold value, and the threshold value is, for example, 1 m.
- the track calculation unit 22 with a travelable time refers to the track information 23 with a travelable time regarding WP_A, and since the FT of WP_A1 is T3, the vehicle A travels in the vicinity of WP_A1 or WP_B3 by T3. It can be seen that it has been completed or has not started running near WP_A1 or WP_B3. Therefore, the track calculation unit 22 with a travelable time sets the ST of WP_B3, which is close to WP_A1, to the value after T3. Even if there is another vehicle equipped with the in-vehicle device 1, the travelable time can be updated by referring to the track information with the travelable time of the other vehicle.
- the control device 2 can travel by associating the travelable time calculated for the plurality of vehicle-mounted devices 1 with the travel track and storing the travelable time. It has a time calculation result storage unit (track calculation result storage unit 26 with travelable time).
- the track information 23 with the travelable time is generated in consideration of the travel track and the travel time of another vehicle, it is ensured that a plurality of vehicles exist at the same point at the same time. It has the effect of making it avoidable (in other words, ensuring exclusive controllability).
- the safety of the vehicle control is guaranteed and the vehicle travels by performing the vehicle control in consideration of the delay actually generated in the communication between the in-vehicle device 1 and the control device 2.
- the allowable communication delay time is lengthened to suppress the number of decelerations and stops of the vehicle equipped with the in-vehicle device 1. Has an effect.
- the control device 2 if there is no request from the in-vehicle device 1, the control device 2 does not need to calculate the track information 23 with the travelable time, so that the processing load of the control device 2 is reduced. It becomes possible to do. Further, since the communication between the in-vehicle device 1 and the control device 2 is limited to the request from the in-vehicle device 1, the number and frequency of communication between the in-vehicle device 1 and the control device 2 are reduced, and the communication load and the communication delay are caused. It is possible to continue control (track tracking) while reducing the impact on vehicle control.
- the vehicle equipped with the in-vehicle device 1 stops and stands by during the period from the occurrence of the emergency stop to the evacuation of an obstacle or the like, so that the vehicle can travel for a travelable time.
- the vehicle travels slowly (decelerates or runs at low speed) without the need for recommunication with the control device 2 and recalculation by the control device 2. This makes it possible to continue vehicle control while ensuring safety and avoid delays due to recommunication and recalculation.
- the track information 23 with the travelable time is generated in consideration of the travel track and the travel time of another vehicle, a plurality of vehicles exist at the same point at the same time. It has the effect of ensuring that this can be avoided (in other words, ensuring exclusive controllability).
- the present invention is not limited to the above-described embodiment, but includes various modifications.
- the above-described embodiment has been described in detail in order to explain the present invention in an easy-to-understand manner, and is not necessarily limited to the one including all the described configurations.
- it is possible to replace a part of the configuration of one embodiment with the configuration of another embodiment and it is also possible to add the configuration of another embodiment to the configuration of one embodiment.
- each of the above configurations, functions, processing units, processing means, etc. may be realized by hardware by designing a part or all of them by, for example, an integrated circuit. Further, each of the above configurations, functions, and the like may be realized by software by the processor interpreting and executing a program that realizes each function. Information such as programs, tables, and files that realize each function can be stored in a memory, a hard disk, a storage device such as an SSD (Solid State Drive), or a recording medium such as an IC card, an SD card, or a DVD.
- SSD Solid State Drive
- control lines and information lines indicate those that are considered necessary for explanation, and do not necessarily indicate all the control lines and information lines in the product. In practice, it can be considered that almost all configurations are interconnected.
- Control system 1 In-vehicle device 2
- Control device 3 Infrastructure sensor 11
- Time synchronization unit 110 GNSS information acquisition unit 111 Absolute time calculation unit 112
- Correction information transmission / reception unit 113 Time correction unit 12
- Time correction unit 12 Track information reception unit with travelable time 13
- Travelability determination unit 14 Track follower 15
- Independent travelability judgment unit 16 Request transmission unit 17
- Emergency stop unit 18 Speed limit unit 19
- Control information 21 Sensing data reception unit 22 Track calculation unit with travelable time 221 Obstacle detection unit 222 Obstacle detection result 223
- Road information 2232 Vehicle route information 224 Track information 225 Travelable time calculation unit 23 Track information with travelable time 24 Track information transmission unit with travelable time 25
- Request reception unit 26 Track calculation result storage unit with travelable time (traveling) Possible time calculation result storage unit)
- 31 Sensing unit 32 Sensing data 33 Sensing data transmission unit
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Human Computer Interaction (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
Description
<制御システムの構成>
図1は、実施例1における制御システム0の構成を示した図である。
制御システム0は、車載装置1と管制装置2とインフラセンサ3からなる。
図2は、実施例1における制御システム0の機能ブロック構成ならびに全体動作フロー概要を示した図である。
図3Aは、車載装置1と管制装置2とインフラセンサ3にそれぞれ含まれる時刻同期部11において行う時刻同期の方法の例を示した図である。この例においては、時刻同期部11は、GNSS情報取得部110と絶対時刻算出部111で構成される。
本実施例においてはインフラセンサ3をフルハイビジョンでフレームレート7pのカメラとした場合で説明する。センシング部31は、インフラセンサ3の内部に搭載されたCMOSイメージセンサであり、1秒間に7枚の画像(フレーム)を受像する。
図4は、本実施例におけるセンシングデータ32の例を示した図である。
センシングデータ32は、インフラセンサ3の内部に搭載したセンシング部31(CMOSイメージセンサ)で受像した情報を基に、1920×1080の2次元配列で各画素値(RGB)を0~255の整数値で表現したフレームの集合である。前記フレームは1秒間に7枚生成される。画像はこれ以外の表現形式(YUV)や、通信や符号化時に圧縮されて必要に応じて展開されても良く、またMPEG(Moving Picture Experts Group)形式などの所定のビデオデータ形式に圧縮されていてもよい。
センシングデータ送信部33は、センシングデータ32を管制装置2に送信する。
センシングデータ受信部21は、センシングデータ32を受信し、走行可能時間付き軌道算出部22に渡す。
図5は、センシングデータ32を入力とし走行可能時間付き軌道情報23を出力とする走行可能時間付き軌道算出部22の機能ブロック構成ならびに処理フローを示した図である。
図6は、障害物検知部221により生成した障害物検知結果222の例を示した図である。
図7は、軌道算出部223が生成する軌道情報224の例を示した図である。
図8は、走行可能時間算出部225の処理フローの概要を示した図である。
図9は、走行可能時間算出部225が生成する走行可能時間付き軌道情報23の例を示した図である。走行可能時間付き軌道情報23は、軌道算出部223が生成した軌道情報224に含まれる各Way Pointに対し、当該Way Pointの付近に障害物が存在せず車載装置1を搭載した車両が当該Way Pointの付近の走行をしてもよい(障害物に衝突しないことを保証する)時間帯の情報を追加した軌道情報である。Way Pointの付近の走行をしてもよい時間帯は、走行可能開始時刻(ST)と走行可能終了時刻(FT)の組で表現する。
図10は、図9の例における制御システム0および周囲の状況を模式的に表した図である。
走行可能時間付き軌道情報送信部24は、走行可能時間付き軌道情報23を車載装置1に送信する。
走行可能時間付き軌道情報受信部12は、走行可能時間付き軌道情報23を受信し、走行可能性判定部13に渡す。
図11は、走行可能性判定部13の処理フローの概要を示した図である。
ステップS131において、走行可能時間付き軌道情報23を取得する。
図12は、走行可能性判定部13のT_followの算出処理(図11のステップS133)に関する概要を示した図である。
T_follow[j]は、車載装置1を搭載した車両がWay Point jに到着する時刻である。距離D[j](D[j]はWay Point j-1とWay Point jの間の距離)だけ離れたWay Point間を、初速V0[j-1](Way Point j-1における車載装置1を搭載した車両の速度)、車載装置1を搭載した車両の加速度aで等加速度運動により走行するためにかかる時間は、以下の(数2)である。
図13は、軌道追従部14における処理フローの概要を示した図である。
ステップS141にて、走行可能時間付き軌道情報23と軌道追従フラグを取得する。
以上で説明したように、本実施例1の制御システム0は、時刻同期された車載装置1と管制装置2で構成される制御システム0において、前記車載装置1を搭載した車両が通過する対象領域内の走行軌道において前記車両が障害物に衝突しないことを保証する走行可能時間を算出する走行可能時間算出部225と、前記走行可能時間の有効性を判定する走行可能性判定部13と、前記走行可能時間が有効であると判定された場合、前記車載装置1に前記走行軌道の追従を許可する軌道追従部14と、を有する。
本発明の実施例2における制御システムおよび方法について説明する。実施例1と異なる点は、車載装置1から管制装置2に自動運転の補助を行うよう要求を出すことができる点である。なお、実施例1と同様の構成については、同一の符号を付してその説明を省略する。
図14は、実施例2における車載装置1と管制装置2とインフラセンサ3からなる制御システム0の機能ブロック構成を示した図である。インフラセンサ3の構成は実施例1と同様である。車載装置1は、実施例1における構成要素に加えて独自走行可否判定部15と要求送信部16を構成要素とし、管制装置2は、実施例1における構成要素に加えて要求受信部25を構成要素とする。
図15は、独自走行可否判定部15が生成する要求情報151の例を示した図である。要求情報151は、管制装置2に車両制御の補助を要求するか否かを示すフラグを含む。
独自走行可否判定部15は、車載装置1を搭載した車両単独で走行できるかどうかを判定する。例えば、目的地までの経路情報と車両の現在位置から、レーンキープの機能を有する車両が右左折などによって車両単独で走行できない、または、車両のセンサが壊れたため車両単独で走行できない等といったことを判定することにより、車両単独で走行できるかどうか(換言すれば、車載装置1を搭載した車両が単独で安全に実施(走行)できない行動があるか否か)を判定する。前記判定は、例えば従来公知の方法に従い、少なくとも車載装置1を搭載した車両の位置情報、周囲の走行環境情報、及び走行計画のいずれか一つの情報に基づいて走行可能か否かを判定してもよいし、道路の形状や交差点に関する情報を含んだ地図データから走行可能か否かを判定してもよい。
要求受信部25は、車載装置1から要求情報151を受け取り、前記要求情報151を走行可能時間付き軌道算出部22に入力する。これにより、管制装置2は、(車載装置1からの要求に応じて)前述した走行可能時間付き軌道情報23(走行軌道における走行可能開始時刻STおよび走行可能終了時刻FTを含む)を生成し、生成した走行可能時間付き軌道情報23を走行可能時間付き軌道情報送信部24によって車載装置1に送信する。
以上で説明したように、本実施例2の制御システム0は、前記車載装置1を搭載した車両が単独で安全に実施(走行)できない行動があるか否かを前記走行軌道から判定する独自走行可否判定部15と、実施できない行動があると判定された場合、前記管制装置2に前記走行軌道における走行可能開始時刻および走行可能終了時刻を含む前記走行可能時間を要求する要求送信部16と、を有する。
本発明にかかる実施例3における制御システムおよび方法について説明する。実施例1と異なる点は、車載装置1を搭載した車両が緊急停止した場合には走行可能開始時刻STおよび走行可能終了時刻FTにかかわらずWay Pointの座標情報のみを用いて車載装置1を搭載した車両が運転を継続する点である。なお、実施例1と同様の構成については、同一の符号を付してその説明を省略する。
図16は、実施例3における車載装置1と管制装置2とインフラセンサ3からなる制御システム0の機能ブロック構成を示した図である。
緊急停止部17は、車載装置1が何らかの障害物に接近して衝突が予測される場合に、軌道追従の有無によらずブレーキをかけて車載装置1を搭載した車両を緊急停止させる機能を持つ。衝突の予測およびブレーキをかける方法は、公知の先進運転支援システム(Advanced driver-assistance systems)に搭載された方法により実施可能である。
速度制限部18は、車載装置1を搭載した車両の最高速度を制限する機能および前記制限を解除する機能を持つ。本実施例においては、障害物を検知した場合に直ちに停止可能とするよう、速度制限を行う場合の最高速度を時速5kmとする。なお、本実施例では時速5kmとしたが、これに限らない。最高速度を制限する方法は、公知のデジタルタコグラフなど何らかの方法によればよく、本実施例に直接関連しないため、方法に関する詳細な説明は割愛する。
図17は、実施例3における走行可能性判定部13の処理フローの概要を示した図である。図17のステップS131からステップS139、S13Aまでは、実施例1で説明した図11のステップS131からステップS139、S13Aまでと同じである。
以上で説明したように、本実施例3の制御システム0は、前記軌道追従部14は、前記走行軌道の追従中に前記車載装置1を搭載した車両の緊急停止によって、現在の前記走行軌道の前記走行可能時間を守れない場合、前記緊急停止の条件が解除された後(走行軌道上に障害物が存在しなければ)、前記走行可能時間によらずに、前記車載装置1を搭載した車両を減速させながら前記走行軌道を通過させる。
本発明にかかる実施例4における制御システムおよび方法について説明する。実施例1と異なる点は、管制装置2が当該管制装置2と連携する別の車両のために生成した走行可能時間付き軌道情報を加味して走行可能時間付き軌道情報を生成する点にある。なお、実施例1と同様の構成については、同一の符号を付してその説明を省略する。
図18は、実施例4における車載装置1と管制装置2とインフラセンサ3からなる制御システム0の機能ブロック構成を示した図である。
走行可能時間付き軌道算出結果保存部26は、走行可能時間付き軌道算出部22で生成(算出)した(制御対象の複数の車両の)走行可能時間付き軌道情報23を保存しておく。
図19は、実施例4における走行可能時間付き軌道算出部22における処理フローの概要を示した図である。図19のステップS2251からステップS2255までは、実施例1で説明した図8のステップS2251からステップS2255までと同じである。
図20は、実施例4における走行可能時間付き軌道算出部22が行う走行可能時間更新処理(図19のステップS2257)の概要を模式的に示した図である。本実施例4における制御システム0は車載装置1を搭載した車両の台数を2台としているが、これに限らない。
以上で説明したように、本実施例4の制御システム0は、前記管制装置2は、複数の前記車載装置1に対して算出した前記走行可能時間を前記走行軌道と紐付けて保存する走行可能時間算出結果保存部(走行可能時間付き軌道算出結果保存部26)を有する。
実施例1における制御システムおよび方法によれば、車載装置1と管制装置2の間の通信において実際に発生した遅延を考慮して車両制御を行うことにより車両制御の安全性を保証するとともに、走行軌道上に障害物等が存在しない場合および障害物等が接近していない場合においては許容される通信遅延時間を長くすることにより車載装置1を搭載した車両の減速や停止の発生回数を抑制する効果を有する。
1 車載装置
2 管制装置
3 インフラセンサ
11 時刻同期部
110 GNSS情報取得部
111 絶対時刻算出部
112 補正情報送受信部
113 時刻補正部
12 走行可能時間付き軌道情報受信部
13 走行可能性判定部
14 軌道追従部
15 独自走行可否判定部
16 要求送信部
17 緊急停止部
18 速度制限部
19 制御情報
21 センシングデータ受信部
22 走行可能時間付き軌道算出部
221 障害物検知部
222 障害物検知結果
223 軌道算出部
2231 道路情報
2232 車両経路情報
224 軌道情報
225 走行可能時間算出部
23 走行可能時間付き軌道情報
24 走行可能時間付き軌道情報送信部
25 要求受信部
26 走行可能時間付き軌道算出結果保存部(走行可能時間算出結果保存部)
31 センシング部
32 センシングデータ
33 センシングデータ送信部
Claims (9)
- 時刻同期された車載装置と管制装置で構成される制御システムにおいて、
前記車載装置を搭載した車両が通過する対象領域内の走行軌道において前記車両が障害物に衝突しないことを保証する走行可能時間を算出する走行可能時間算出部と、
前記走行可能時間の有効性を判定する走行可能性判定部と、
前記走行可能時間が有効であると判定された場合、前記車載装置に前記走行軌道の追従を許可する軌道追従部と、を有する、制御システム。 - 請求項1に記載の制御システムにおいて、
前記走行可能性判定部は、前記車載装置を搭載した車両が前記走行可能時間を構成する前記走行軌道上の各点に設定された走行可能開始時刻と走行可能終了時刻を満たして走行可能であるか否かを判定する、制御システム。 - 請求項1に記載の制御システムにおいて、
前記車載装置を搭載した車両が単独で安全に実施できない行動があるか否かを前記走行軌道から判定する独自走行可否判定部と、
実施できない行動があると判定された場合、前記管制装置に前記走行軌道における走行可能開始時刻および走行可能終了時刻を含む前記走行可能時間を要求する要求送信部と、を有する、制御システム。 - 請求項1に記載の制御システムにおいて、
前記軌道追従部は、前記走行軌道の追従中に前記車載装置を搭載した車両の緊急停止によって、現在の前記走行軌道の前記走行可能時間を守れない場合、前記緊急停止の条件が解除された後、前記走行可能時間によらずに、前記車載装置を搭載した車両を減速させながら前記走行軌道を通過させる、制御システム。 - 請求項1に記載の制御システムにおいて、
前記管制装置は、複数の前記車載装置に対して算出した前記走行可能時間を前記走行軌道と紐付けて保存する走行可能時間算出結果保存部を有する、制御システム。 - 車両外部に設置した管制装置と時刻同期される車載装置であって、
前記車載装置を搭載した車両が通過する対象領域内の走行軌道において前記車両が障害物に衝突しないことを保証する走行可能時間を前記管制装置から受信する受信部と、
受信した前記走行可能時間の有効性を判定する走行可能性判定部と、
前記走行可能時間が有効であると判定された場合、前記車載装置に前記走行軌道の追従を許可する軌道追従部と、を有する、車載装置。 - 請求項6に記載の車載装置であって、
前記車載装置を搭載した車両が単独で安全に実施できない行動があるか否かを前記走行軌道から判定する独自走行可否判定部と、
実施できない行動があると判定された場合、前記管制装置に前記走行軌道における走行可能開始時刻および走行可能終了時刻を含む前記走行可能時間を要求する要求送信部と、を有する、車載装置。 - 車載装置と時刻同期される管制装置であって、
前記車載装置を搭載した車両が通過する対象領域内の走行軌道において前記車両が障害物に衝突しないことを保証する走行可能時間を算出する走行可能時間算出部と、
前記走行可能時間の有効性を判定するために前記走行可能時間を前記車載装置へ送信する送信部と、を有する、管制装置。 - 請求項8に記載の管制装置であって、
前記送信部は、前記車両が単独で安全に実施できない行動があると判定され、前記車載装置から要求があった場合に、前記走行軌道における走行可能開始時刻および走行可能終了時刻を含む前記走行可能時間を前記車載装置へ送信する、管制装置。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202180084003.6A CN116615367A (zh) | 2021-01-05 | 2021-08-26 | 控制***、车载装置和管制装置 |
US18/266,616 US20240092352A1 (en) | 2021-01-05 | 2021-08-26 | Control system, in-vehicle device, and coordination device |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021-000559 | 2021-01-05 | ||
JP2021000559A JP7482049B2 (ja) | 2021-01-05 | 2021-01-05 | 制御システム、車載装置、および管制装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2022149302A1 true WO2022149302A1 (ja) | 2022-07-14 |
Family
ID=82357846
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2021/031311 WO2022149302A1 (ja) | 2021-01-05 | 2021-08-26 | 制御システム、車載装置、および管制装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20240092352A1 (ja) |
JP (1) | JP7482049B2 (ja) |
CN (1) | CN116615367A (ja) |
WO (1) | WO2022149302A1 (ja) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2017173905A (ja) * | 2016-03-18 | 2017-09-28 | 株式会社デンソー | 車両用通信制御装置 |
JP2020006763A (ja) * | 2018-07-05 | 2020-01-16 | 株式会社デンソー | 車両の運転支援制御装置、車両の運転支援システムおよび車両の運転支援制御方法 |
JP2020091663A (ja) * | 2018-12-05 | 2020-06-11 | トヨタ自動車株式会社 | 車両用表示制御装置 |
-
2021
- 2021-01-05 JP JP2021000559A patent/JP7482049B2/ja active Active
- 2021-08-26 WO PCT/JP2021/031311 patent/WO2022149302A1/ja active Application Filing
- 2021-08-26 CN CN202180084003.6A patent/CN116615367A/zh active Pending
- 2021-08-26 US US18/266,616 patent/US20240092352A1/en active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2017173905A (ja) * | 2016-03-18 | 2017-09-28 | 株式会社デンソー | 車両用通信制御装置 |
JP2020006763A (ja) * | 2018-07-05 | 2020-01-16 | 株式会社デンソー | 車両の運転支援制御装置、車両の運転支援システムおよび車両の運転支援制御方法 |
JP2020091663A (ja) * | 2018-12-05 | 2020-06-11 | トヨタ自動車株式会社 | 車両用表示制御装置 |
Also Published As
Publication number | Publication date |
---|---|
JP7482049B2 (ja) | 2024-05-13 |
US20240092352A1 (en) | 2024-03-21 |
JP2022105922A (ja) | 2022-07-15 |
CN116615367A (zh) | 2023-08-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110949388B (zh) | 车辆控制装置、车辆控制方法及存储介质 | |
EP3644294B1 (en) | Vehicle information storage method, vehicle travel control method, and vehicle information storage device | |
US20180056998A1 (en) | System and Method for Multi-Vehicle Path Planning Technical Field | |
JP7314798B2 (ja) | 撮像装置、画像処理装置、及び、画像処理方法 | |
US20160318518A1 (en) | Travel control apparatus | |
US11059481B2 (en) | Vehicle control system, vehicle control method, and vehicle control program | |
CN110167811B (zh) | 车辆控制***、车辆控制方法及存储介质 | |
CN112644494B (zh) | 车辆控制装置、车辆控制方法及存储介质 | |
US11370420B2 (en) | Vehicle control device, vehicle control method, and storage medium | |
CN110271542B (zh) | 车辆控制装置、车辆控制方法及存储介质 | |
US10940860B2 (en) | Vehicle control device, vehicle control method, and storage medium | |
JP7207256B2 (ja) | 車両制御システム | |
JP7000202B2 (ja) | 車両制御システム、車両制御方法、およびプログラム | |
CN112640332B (zh) | 一种通信方法及装置 | |
JP2018203017A (ja) | 車両制御装置、車両制御方法、およびプログラム | |
CN111301412A (zh) | 队列行驶*** | |
US20220105957A1 (en) | Vehicle traveling control apparatus | |
CN112462751B (zh) | 车辆控制装置、车辆控制方法及存储介质 | |
CN114261405A (zh) | 车辆控制装置、车辆控制方法以及存储介质 | |
WO2022149302A1 (ja) | 制御システム、車載装置、および管制装置 | |
JP6583697B2 (ja) | 周辺監視装置、制御装置、周辺監視方法、およびプログラム | |
JP7012693B2 (ja) | 情報処理装置、車両システム、情報処理方法、およびプログラム | |
CN114954511A (zh) | 车辆控制装置、车辆控制方法以及存储介质 | |
CN113291297A (zh) | 车辆控制装置、车辆控制方法及存储介质 | |
CN112429001A (zh) | 车辆控制装置、车辆控制方法及存储介质 |
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: 21917527 Country of ref document: EP Kind code of ref document: A1 |
|
WWE | Wipo information: entry into national phase |
Ref document number: 18266616 Country of ref document: US |
|
WWE | Wipo information: entry into national phase |
Ref document number: 202180084003.6 Country of ref document: CN |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 21917527 Country of ref document: EP Kind code of ref document: A1 |