JP2022071594A - Mobile detection device, and control system - Google Patents

Mobile detection device, and control system Download PDF

Info

Publication number
JP2022071594A
JP2022071594A JP2020180641A JP2020180641A JP2022071594A JP 2022071594 A JP2022071594 A JP 2022071594A JP 2020180641 A JP2020180641 A JP 2020180641A JP 2020180641 A JP2020180641 A JP 2020180641A JP 2022071594 A JP2022071594 A JP 2022071594A
Authority
JP
Japan
Prior art keywords
vehicle
unconnected
unit
moving body
reliability
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2020180641A
Other languages
Japanese (ja)
Other versions
JP7447763B2 (en
Inventor
武男 加藤
Takeo Kato
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Central R&D Labs Inc
Original Assignee
Toyota Central R&D Labs Inc
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Toyota Central R&D Labs Inc filed Critical Toyota Central R&D Labs Inc
Priority to JP2020180641A priority Critical patent/JP7447763B2/en
Publication of JP2022071594A publication Critical patent/JP2022071594A/en
Application granted granted Critical
Publication of JP7447763B2 publication Critical patent/JP7447763B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Traffic Control Systems (AREA)

Abstract

To reduce power consumption without reducing reliability of mobile information detected from an image in a situation that the risk of interference between mobiles is recognized.SOLUTION: When detecting mobile information D including a position and a velocity of a non-connected vehicle from an image capturing the non-connected vehicle with designated accuracy, a mobile detection device 9 sets a reliability target in accordance with an approach degree of the non-connected vehicle to a determination point which is set on a travel route of the non-connected vehicle, and performs control so that the detection accuracy of the mobile information D is closer to the reliability target.SELECTED DRAWING: Figure 4

Description

本発明は、移動体検出装置、及び管制システムに関する。 The present invention relates to a mobile body detection device and a control system.

特許文献1には、路側に設置したカメラによって検出した各々の車両の現在位置及び速度を用いて、各々の車両の合流地点への到着時刻を予測し、道路上に設置した表示装置を通じて車両の運転手に加減速の指示情報を提示する合流情報提供装置が開示されている。 In Patent Document 1, the arrival time of each vehicle at the confluence is predicted using the current position and speed of each vehicle detected by a camera installed on the roadside, and the vehicle is predicted through a display device installed on the road. A merging information providing device that presents acceleration / deceleration instruction information to a driver is disclosed.

特開2015-52902号公報Japanese Unexamined Patent Publication No. 2015-52902

カメラで撮像した画像を画像処理することによって車両のような移動体を検出する場合、例えば位置や速度といった物体の状態を表す情報を検出することができる。こうした場合において、検出した移動体の状態を表す情報の確からしさ、すなわち移動体情報の信頼度を高くしようとすると、画像処理に伴うプロセッサの演算量が増加し、これに伴い消費電力も増加する。 When a moving object such as a vehicle is detected by image processing the image captured by the camera, it is possible to detect information representing the state of the object such as position and speed. In such a case, if an attempt is made to increase the certainty of the information indicating the state of the detected moving object, that is, the reliability of the moving object information, the amount of calculation of the processor associated with the image processing increases, and the power consumption also increases accordingly. ..

一方、例えば合流地点で交差する道路のうち、片方の道路にしか車両が走行していない場合や、交差する各々の道路を走行する車両の合流地点への到達時間がまったく異なる場合のように、明らかに車両同士が合流地点で干渉する危険性がない場合には、検出する移動体情報の信頼度は低くても構わない。 On the other hand, for example, when a vehicle is traveling on only one of the roads that intersect at a confluence, or when vehicles traveling on each intersecting road have completely different arrival times at the confluence. If there is clearly no risk of vehicles interfering with each other at the confluence, the reliability of the detected moving object information may be low.

これに対して、特許文献1に記載の合流情報提供装置では、車両同士が干渉する危険性の有無に関わらず、常に検出可能な最高の信頼度で画像から移動体情報を検出しようとしているため、明らかに車両同士が合流地点で干渉する危険性がない場合には無駄な電力を消費していることになる。 On the other hand, the merging information providing device described in Patent Document 1 tries to detect moving object information from an image with the highest reliability that can always be detected regardless of whether or not there is a risk of vehicle interference. Obviously, if there is no danger of the vehicles interfering with each other at the confluence, it means that wasteful power is being consumed.

本発明は、上記に示した問題点を鑑みてなされたものであり、検出可能な最高の信頼度で画像から移動体情報を検出し続ける場合と比較して、移動体同士が干渉する危険性が認められる状況での画像から検出した移動体情報の信頼度を低下させることなく、消費電力を低減することができる移動体検出装置、及び管制システムを提供することを目的とする。 The present invention has been made in view of the problems shown above, and there is a risk that the moving objects will interfere with each other as compared with the case where the moving object information is continuously detected from the image with the highest detectable reliability. It is an object of the present invention to provide a mobile body detection device and a control system capable of reducing power consumption without deteriorating the reliability of mobile body information detected from an image in a situation where the above is recognized.

第1態様に係る移動体検出装置は、移動体同士が干渉しないように移動体の交通管制を行う管制装置とデータ通信を行うことができない非コネクテッド移動体を撮像した画像から、前記非コネクテッド移動体の位置及び速度を含む移動体情報を指定された精度で検出する移動体検出部と、前記非コネクテッド移動体の走行経路上に設定された判定地点に対する前記非コネクテッド移動体の接近度に応じて信頼度目標を設定し、前記精度を前記信頼度目標に近づけるように前記移動体検出部に指示する制御を行う信頼度制御部と、を備える。 The mobile body detection device according to the first aspect is the non-connected movement from an image of a non-connected mobile body that cannot perform data communication with a control device that controls the traffic of the mobile body so that the mobile bodies do not interfere with each other. According to the degree of proximity of the non-connected mobile body to the determination point set on the traveling path of the non-connected mobile body and the mobile body detection unit that detects the mobile body information including the position and speed of the body with a specified accuracy. The mobile body detection unit is provided with a reliability control unit that sets a reliability target and instructs the moving object detection unit to bring the accuracy closer to the reliability target.

第2態様に係る移動体検出装置は、第1態様に係る移動体検出装置において、前記移動体検出部で検出された前記非コネクテッド移動体の位置を前記画像の画像座標系から、移動体の経路が点列で表された地図データにおける地図座標系に変換する座標変換部と、前記地図データから点列毎の走路情報を取得する走路情報取得部と、前記座標変換部で地図座標系に変換された前記非コネクテッド移動体の位置、前記非コネクテッド移動体の速度、及び前記走路情報取得部で取得した前記経路の走路情報から前記非コネクテッド移動体の走行経路を予測し、予測した走行経路を表す経由点毎に前記非コネクテッド移動体の干渉時間を予測する走行経路予測部と、前記走行経路予測部で予測した走行経路を表す各々の経由点のうち、何れかの経由点を前記判定地点として設定する判定地点設定部と、前記判定地点設定部で設定された前記判定地点における干渉時間に基づき、前記判定地点に対する前記非コネクテッド移動体の接近度を評価する接近度評価部と、を備え、前記信頼度制御部は、前記接近度評価部で評価された接近度に応じて前記信頼度目標を設定する制御を行う。 The moving body detection device according to the second aspect is the moving body detecting device according to the first aspect, in which the position of the non-connected moving body detected by the moving body detecting unit is determined from the image coordinate system of the image of the moving body. A coordinate conversion unit that converts a route into a map coordinate system in map data represented by a point sequence, a track information acquisition unit that acquires track information for each point sequence from the map data, and a coordinate conversion unit that converts the route into a map coordinate system. The travel route of the unconnected moving body is predicted from the converted position of the unconnected moving body, the speed of the unconnected moving body, and the traveling route information of the route acquired by the traveling route information acquisition unit, and the predicted traveling route is predicted. The determination is made to determine which of the travel route prediction unit that predicts the interference time of the unconnected moving object for each transit point representing the travel route and each transit point that represents the travel route predicted by the travel route prediction unit. A determination point setting unit set as a point and an approach evaluation unit for evaluating the approach degree of the unconnected moving object to the determination point based on the interference time at the determination point set by the determination point setting unit. The reliability control unit controls to set the reliability target according to the approach degree evaluated by the approach degree evaluation unit.

第3態様に係る移動体検出装置は、第2態様に係る移動体検出装置において、前記判定地点設定部が、前記非コネクテッド移動体の走行経路を表す各々の経由点のうち、前記非コネクテッド移動体の走行経路と、前記非コネクテッド移動体と異なる他の移動体の走行経路と、に基づいて前記管制装置で特定された前記非コネクテッド移動体と前記他の移動体との干渉地点を前記判定地点として設定する。 In the moving body detection device according to the second aspect, the moving body detecting device according to the third aspect is the non-connected movement among the waypoints in which the determination point setting unit represents the traveling route of the non-connected moving body. The determination of the interference point between the non-connected moving body and the other moving body specified by the control device based on the traveling path of the body and the traveling path of another moving body different from the unconnected moving body. Set as a point.

第4態様に係る移動体検出装置は、第2態様に係る移動体検出装置において、前記接近度評価部が、前記非コネクテッド移動体の前記判定地点における干渉時間、及び前記非コネクテッド移動体と異なる他の移動体の前記判定地点における干渉時間から、前記非コネクテッド移動体の接近度を評価する。 In the mobile body detection device according to the second aspect, in the mobile body detection device according to the fourth aspect, the proximity evaluation unit is different from the interference time at the determination point of the non-connected mobile body and the non-connected mobile body. The degree of approach of the unconnected mobile body is evaluated from the interference time of the other mobile body at the determination point.

第5態様に係る移動体検出装置は、第4態様に係る移動体検出装置において、前記走路情報取得部が、前記移動体検出部で前記画像から検出された前記非コネクテッド移動体の位置及び速度に含まれる誤差の度合いを表す信頼度が点列毎に付与された前記地図データから、点列毎の走路情報を前記信頼度と共に取得し、前記走行経路予測部は、予測した前記非コネクテッド移動体の走行経路上における各経由点での前記信頼度を反映した前記非コネクテッド移動体の位置及び速度を用いて、前記非コネクテッド移動体の走行経路上における経由点毎に前記非コネクテッド移動体の干渉時間を予測する。 In the moving body detection device according to the fourth aspect, the moving body detecting device according to the fifth aspect is the position and speed of the non-connected moving body detected from the image by the running track information acquisition unit in the moving body detecting unit. From the map data in which the reliability indicating the degree of the error included in is given for each point sequence, the track information for each point sequence is acquired together with the reliability, and the travel route prediction unit predicts the unconnected movement. Using the position and speed of the unconnected moving body reflecting the reliability at each waypoint on the traveling path of the body, the unconnected moving body can be used at each waying point on the traveling path of the unconnected moving body. Predict the interference time.

第6態様に係る移動体検出装置は、第5態様に係る移動体検出装置において、前記走路情報取得部から前記地図データの点列を構成する各点に付与された前記信頼度を取得すると共に、前記信頼度制御部から前記信頼度目標を取得し、前記信頼度目標に応じて、前記地図データの点列を構成する各点に付与された前記信頼度を補正する信頼度補正部を備え、前記走行経路予測部は、予測した前記非コネクテッド移動体の走行経路上における各経由点での前記信頼度補正部で補正された前記信頼度を反映した前記非コネクテッド移動体の位置及び速度を用いて、前記非コネクテッド移動体の走行経路上における経由点毎に前記非コネクテッド移動体の干渉時間を予測する。 The mobile body detection device according to the sixth aspect acquires the reliability given to each point constituting the point sequence of the map data from the track information acquisition unit in the mobile body detection device according to the fifth aspect. The reliability correction unit is provided, which acquires the reliability target from the reliability control unit and corrects the reliability given to each point constituting the point sequence of the map data according to the reliability target. , The traveling route prediction unit determines the position and speed of the unconnected moving object reflecting the reliability corrected by the reliability correction unit at each waypoint on the traveling route of the predicted unconnected moving object. It is used to predict the interference time of the unconnected moving body for each waypoint on the traveling path of the unconnected moving body.

第7態様に係る移動体検出装置は、第1態様~第6態様の何れかの態様に係る移動体検出装置において、光、音、振動、空気の流れ、圧力、及び熱の少なくとも1つの再生エネルギーを利用して、自装置で消費する電力以上の電力を発電する動力生成部を備える。 The moving body detecting device according to the seventh aspect is the reproduction of at least one of light, sound, vibration, air flow, pressure, and heat in the moving body detecting device according to any one of the first to sixth aspects. It is equipped with a power generation unit that uses energy to generate more power than the power consumed by its own device.

第8態様に係る管制システムは、移動体同士が干渉しないように移動体の交通管制を行う管制装置と、移動体の経路に沿って設置され、前記管制装置とデータ通信を行うことができない非コネクテッド移動体の画像を撮像する撮像センサと、前記画像から、前記非コネクテッド移動体の位置及び速度を含む移動体情報を指定された精度で検出する移動体検出部、及び前記非コネクテッド移動体の走行経路上に設定された判定地点に対する前記非コネクテッド移動体の接近度に応じて信頼度目標を設定し、前記精度を前記信頼度目標に近づけるように前記移動体検出部に指示する制御を行う信頼度制御部を備えた移動体検出装置と、を含む。 The control system according to the eighth aspect is a control device that controls the traffic of the moving body so that the moving bodies do not interfere with each other, and a non-control device that is installed along the path of the moving body and cannot perform data communication with the control device. An imaging sensor that captures an image of a connected mobile body, a mobile body detection unit that detects moving body information including the position and speed of the unconnected moving body from the image with specified accuracy, and a non-connected moving body. A reliability target is set according to the degree of approach of the non-connected moving body to a determination point set on the travel route, and control is performed to instruct the moving body detection unit to bring the accuracy closer to the reliability target. Includes a mobile detector with a reliability control unit.

第9態様に係る管制システムは、第8態様に係る管制システムにおいて、前記移動体検出装置が、前記移動体検出部で検出された前記非コネクテッド移動体の位置を前記画像の画像座標系から、移動体の経路が点列で表された地図データにおける地図座標系に変換する座標変換部と、前記地図データから点列毎の走路情報を取得する走路情報取得部と、前記座標変換部で地図座標系に変換された前記非コネクテッド移動体の位置、前記非コネクテッド移動体の速度、及び前記走路情報取得部で取得した前記経路の走路情報から前記非コネクテッド移動体の走行経路を予測し、予測した走行経路を表す経由点毎に前記非コネクテッド移動体の干渉時間を予測する走行経路予測部と、前記走行経路予測部で予測した走行経路を表す各々の経由点のうち、何れかの経由点を前記判定地点として設定する判定地点設定部と、前記判定地点設定部で設定された前記判定地点における干渉時間に基づき、前記判定地点に対する前記非コネクテッド移動体の接近度を評価する接近度評価部と、を備え、前記信頼度制御部は、前記接近度評価部で評価された接近度に応じて前記信頼度目標を設定する制御を行う。 In the control system according to the eighth aspect, the control system according to the ninth aspect is the position of the unconnected moving body detected by the moving body detection unit from the image coordinate system of the image. A coordinate conversion unit that converts the path of a moving object into a map coordinate system in map data represented by a point sequence, a track information acquisition unit that acquires track information for each point sequence from the map data, and a map by the coordinate conversion unit. The traveling route of the unconnected moving body is predicted and predicted from the position of the unconnected moving body converted into the coordinate system, the speed of the unconnected moving body, and the running route information of the route acquired by the running track information acquisition unit. One of a travel route prediction unit that predicts the interference time of the unconnected moving object for each transit point that represents the travel route, and a transit point that represents the travel route predicted by the travel route prediction unit. An approach evaluation unit that evaluates the degree of approach of the non-connected moving object to the determination point based on the interference time at the determination point set by the determination point setting unit and the determination point setting unit that sets And, the reliability control unit controls to set the reliability target according to the approach degree evaluated by the approach degree evaluation unit.

第10態様に係る管制システムは、第9態様に係る管制システムにおいて、前記管制装置が、前記非コネクテッド移動体の走行経路と、前記非コネクテッド移動体と異なる他の移動体の走行経路と、に基づいて、前記非コネクテッド移動体と前記他の移動体との干渉地点を特定し、前記移動体検出装置の前記判定地点設定部は、前記非コネクテッド移動体の走行経路を表す各々の経由点のうち、前記干渉地点に対応した経由点を前記判定地点として設定する。 The control system according to the tenth aspect is the control system according to the ninth aspect, wherein the control device has a travel path of the non-connected mobile body and a travel path of another moving body different from the non-connected mobile body. Based on this, an interference point between the unconnected moving body and the other moving body is specified, and the determination point setting unit of the moving body detecting device is a waypoint of each waypoint representing a traveling route of the unconnected moving body. Of these, the waypoint corresponding to the interference point is set as the determination point.

第11態様に係る管制システムは、第9態様に係る管制システムにおいて、前記移動体検出装置の前記接近度評価部が、前記非コネクテッド移動体の前記判定地点における干渉時間、及び前記非コネクテッド移動体と異なる他の移動体の前記判定地点における干渉時間から、前記非コネクテッド移動体の接近度を評価する。 In the control system according to the eleventh aspect, in the control system according to the ninth aspect, the proximity evaluation unit of the mobile detection device has an interference time at the determination point of the unconnected mobile body and the non-connected mobile body. The degree of approach of the unconnected mobile body is evaluated from the interference time of another mobile body different from the above at the determination point.

第12態様に係る管制システムは、第11態様に係る管制システムにおいて、前記移動体検出装置の前記走路情報取得部が、前記移動体検出部で前記画像から検出された前記非コネクテッド移動体の位置及び速度に含まれる誤差の度合いを表す信頼度が点列毎に付与された前記地図データから、点列毎の走路情報を前記信頼度と共に取得し、前記走行経路予測部は、予測した前記非コネクテッド移動体の走行経路上における各経由点での前記信頼度を反映した前記非コネクテッド移動体の位置及び速度を用いて、前記非コネクテッド移動体の走行経路上における経由点毎に前記非コネクテッド移動体の干渉時間を予測する。 In the control system according to the twelfth aspect, in the control system according to the eleventh aspect, the position of the unconnected moving body detected by the moving body detecting unit from the image by the track information acquisition unit of the moving body detecting device. And, from the map data in which the reliability indicating the degree of the error included in the speed is given for each point sequence, the track information for each point sequence is acquired together with the reliability, and the travel route prediction unit predicts the non. Using the position and speed of the unconnected moving body that reflects the reliability at each waypoint on the traveling path of the connected moving body, the unconnected movement is made for each waying point on the traveling path of the unconnected moving body. Predict body interference time.

第13態様に係る管制システムは、第12態様に係る管制システムにおいて、前記移動体検出装置が、前記走路情報取得部から前記地図データの点列を構成する各点に付与された前記信頼度を取得すると共に、前記信頼度制御部から前記信頼度目標を取得し、前記信頼度目標に応じて、前記地図データの点列を構成する各点に付与された前記信頼度を補正する信頼度補正部を備え、前記走行経路予測部は、予測した前記非コネクテッド移動体の走行経路上における各経由点での前記信頼度補正部で補正された前記信頼度を反映した前記非コネクテッド移動体の位置及び速度を用いて、前記非コネクテッド移動体の走行経路上における経由点毎に前記非コネクテッド移動体の干渉時間を予測する。 The control system according to the thirteenth aspect is the control system according to the twelfth aspect, in which the moving body detection device obtains the reliability given to each point constituting the point sequence of the map data from the track information acquisition unit. At the same time, the reliability target is acquired from the reliability control unit, and the reliability correction given to each point constituting the point sequence of the map data is corrected according to the reliability target. The traveling route prediction unit includes a unit, and the traveling route prediction unit is a position of the unconnected moving object reflecting the reliability corrected by the reliability correction unit at each waypoint on the traveling route of the predicted unconnected moving object. And the speed are used to predict the interference time of the unconnected moving body for each waypoint on the traveling path of the unconnected moving body.

第14態様に係る管制システムは、第8態様~第13態様の何れかの態様に係る管制システムにおいて、前記移動体検出装置が、光、音、振動、空気の流れ、圧力、及び熱の少なくとも1つの再生エネルギーを利用して、自装置で消費する電力以上の電力を発電する動力生成部を備える。 The control system according to the fourteenth aspect is the control system according to any one of the eighth to thirteenth aspects, wherein the moving body detection device has at least light, sound, vibration, air flow, pressure, and heat. It is equipped with a power generation unit that uses one renewable energy to generate more power than the power consumed by the own device.

本発明によれば、検出可能な最高の信頼度で画像から移動体情報を検出し続ける場合と比較して、移動体同士が干渉する危険性が認められる状況での画像から検出した移動体情報の信頼度を低下させることなく、消費電力を低減することができる。 According to the present invention, the moving body information detected from the image in a situation where there is a risk of the moving bodies interfering with each other as compared with the case where the moving body information is continuously detected from the image with the highest detectable reliability. It is possible to reduce the power consumption without lowering the reliability of the.

管制システムのシステム構成例を示す図である。It is a figure which shows the system configuration example of the control system. 遵守車両の制御装置における機能構成例を示す図である。It is a figure which shows the functional composition example in the control device of a compliant vehicle. 遵守車両及び非コネクテッド車両が有する運転機能の相違点をまとめた図である。It is the figure which summarized the difference of the driving function which a compliant vehicle and a non-connected vehicle have. 移動体検出装置及び管制装置の機能構成例を示す図である。It is a figure which shows the functional composition example of a moving body detection device and a control device. 管制走行ルート地図の内容例を示す図である。It is a figure which shows the content example of the control driving route map. 干渉地点の例を示す図である。It is a figure which shows the example of the interference point. 干渉地点情報の一例を示す図である。It is a figure which shows an example of the interference point information. 移動体検出装置の撮像センサによって撮像される画像例について説明する図である。It is a figure explaining the example of the image imaged by the image pickup sensor of a moving body detection device. 画像における車両の位置を、管制走行ルート地図上の経由点に写像した写像例を示す図である。It is a figure which shows the mapping example which copied the position of the vehicle in the image to the waypoint on the control travel route map. 非コネクテッド車両の走行経路の一例を示す図である。It is a figure which shows an example of the traveling path of a non-connected vehicle. 遵守車両の大域経路の一例を示す図である。It is a figure which shows an example of the global route of a observing vehicle. 管制装置における電気系統の要部構成例を示す図である。It is a figure which shows the example of the composition of the main part of the electric system in a control device. 移動体検出装置における電気系統の要部構成例を示す図である。It is a figure which shows the example of the composition of the main part of an electric system in a moving body detection device. 遵守車両の制御装置における電気系統の要部構成例を示す図である。It is a figure which shows the example of the composition of the main part of the electric system in the control device of a compliant vehicle. 管制処理の流れの一例を示すフローチャートである。It is a flowchart which shows an example of the flow of the control process. 干渉地点における車両の干渉時間の一例を示す図である。It is a figure which shows an example of the interference time of a vehicle at an interference point. 状態sx=0に設定された干渉地点での仮想交通ルールを模式化した模式図である。It is a schematic diagram which schematicized the virtual traffic rule at the interference point set in the state s x = 0. 状態sx=1に設定された干渉地点での仮想交通ルールを模式化した模式図である。It is a schematic diagram which schematicized the virtual traffic rule at the interference point set in the state s x = 1. 走行制御処理の流れの一例を示すフローチャートである。It is a flowchart which shows an example of the flow of a traveling control process. 移動体検出処理の流れの一例を示すフローチャートである。It is a flowchart which shows an example of the flow of a moving body detection process. 接近度の評価例を示す図である。It is a figure which shows the evaluation example of the degree of approach. 管制システムの変形例に係る移動体検出装置及び管制装置の機能構成例を示す図である。It is a figure which shows the functional composition example of the moving body detection device and the control device which concerns on the modification of the control system. 判定地点における車両同士の干渉状況を説明する図である。It is a figure explaining the interference situation between vehicles at a determination point. 接近度の他の評価例を示す図である。It is a figure which shows the other evaluation example of the approach degree. 信頼度生成装置の機能構成例を示す図である。It is a figure which shows the functional configuration example of the reliability generation apparatus. 車両の位置の検出誤差例を示す図である。It is a figure which shows the example of the detection error of the position of a vehicle. 座標の逆変換例を示す図である。It is a figure which shows the example of the inverse transformation of coordinates. 画像から車両の速度を算出する例を示す図である。It is a figure which shows the example which calculates the speed of a vehicle from an image. 管制システムの他の変形例に係る移動体検出装置及び管制装置の機能構成例を示す図である。It is a figure which shows the functional composition example of the moving body detection device and the control device which concerns on other modification of the control system. 移動体検出装置に動力生成部を追加した場合の機能構成例を示す図である。It is a figure which shows the functional configuration example when the power generation part is added to the moving body detection device.

以下、本実施の形態について図面を参照しながら説明する。なお、同じ構成要素及び同じ処理には全図面を通して同じ符号を付与し、重複する説明を省略する。 Hereinafter, the present embodiment will be described with reference to the drawings. The same components and the same processing are given the same reference numerals throughout the drawings, and duplicate description will be omitted.

図1は、本実施の形態に係る管制システム1のシステム構成例を示す図である。管制システム1は、管制システム1による管制対象となる車両7、それぞれ経路6に沿って設置される複数の無線通信装置3及び移動体検出装置9、並びに管制装置10を含み、各々の無線通信装置3及び移動体検出装置9は、通信網5を通じて管制装置10と接続されている。 FIG. 1 is a diagram showing a system configuration example of the control system 1 according to the present embodiment. The control system 1 includes a vehicle 7 to be controlled by the control system 1, a plurality of wireless communication devices 3 and a mobile body detection device 9 installed along a route 6, and a control device 10, and each wireless communication device. 3 and the mobile body detection device 9 are connected to the control device 10 through the communication network 5.

車両7が備える運転に関する機能である運転機能の相違により、車両7は複数の種類に分類される。例えば車両7のうち、無線設備を備え、走行中に例えば最も近い場所に設置されている何れか1つの無線通信装置3に無線接続することで、通信網5を通じて管制装置10とデータ通信を行う車両7はコネクテッド車両に分類され、無線設備を備えておらず、管制装置10とデータ通信を行うことができない車両7は非コネクテッド車両に分類される。 The vehicle 7 is classified into a plurality of types according to the difference in the driving function, which is a function related to the driving provided in the vehicle 7. For example, data communication is performed with the control device 10 through the communication network 5 by wirelessly connecting to any one of the wireless communication devices 3 of the vehicle 7, which is equipped with wireless equipment and is installed at the nearest location, for example, while traveling. The vehicle 7 is classified as a connected vehicle, and the vehicle 7 which does not have radio equipment and cannot perform data communication with the control device 10 is classified as a non-connected vehicle.

無線通信装置3は、コネクテッド車両と管制装置10の間のデータ中継装置としての役割を果たす。無線通信装置3は、コネクテッド車両との無線通信が可能な範囲内であればその設置場所に制約はないが、例えば車道と並行して設けられた歩道や車道の中央分離帯、及び信号設備のように、車道からできるだけ近い場所に設置されることが好ましい。また、無線通信装置3の設置台数に制約はない。 The wireless communication device 3 serves as a data relay device between the connected vehicle and the control device 10. The installation location of the wireless communication device 3 is not restricted as long as it is within the range where wireless communication with the connected vehicle is possible, but for example, a sidewalk provided in parallel with the roadway, a median strip of the roadway, and a signal facility. As such, it is preferable to install it as close as possible to the roadway. Further, there is no limitation on the number of wireless communication devices 3 installed.

通信網5は、無線通信装置3及び移動体検出装置9で収集した車両7の各種情報を管制装置10に伝送すると共に、管制装置10で生成されたコネクテッド車両の管制情報を、管制装置10が指定した無線通信装置3に伝送する。管制情報は管制装置10からの指示によってすべての無線通信装置3に伝送され、各々のコネクテッド車両に通知されることもある。なお、通信網5は、有線回線であっても無線回線であってもよい。 The communication network 5 transmits various information of the vehicle 7 collected by the wireless communication device 3 and the mobile body detection device 9 to the control device 10, and the control device 10 transmits the control information of the connected vehicle generated by the control device 10. It is transmitted to the designated wireless communication device 3. The control information is transmitted to all the wireless communication devices 3 according to the instruction from the control device 10, and may be notified to each connected vehicle. The communication network 5 may be a wired line or a wireless line.

管制装置10は、車両7同士の交通効率を低下させることなく、車両7同士が接触する危険性が認められる予め定めた範囲(以降、「干渉範囲」という)まで接近するような箇所、すなわち干渉地点Xで干渉を回避させる交通管制を行う装置である。ここで「干渉」とは、車両7同士が接触する状況を示すだけでなく、車両7同士が干渉範囲まで接近する状況をいう。 The control device 10 is a place that approaches a predetermined range (hereinafter referred to as "interference range") where there is a risk of contact between the vehicles 7 without deteriorating the traffic efficiency between the vehicles 7, that is, interference. It is a device that performs traffic control to avoid interference at point X. Here, "interference" not only indicates a situation in which the vehicles 7 are in contact with each other, but also means a situation in which the vehicles 7 approach each other within the interference range.

管制装置10は、管制対象となる各々の車両7から、車両7の状態を表す移動体情報を受信し、各々の車両7が行う移動に関する判断を制約する制約条件(以降、「仮想交通ルール」という)を、車両7同士が干渉地点Xで干渉しないように制約条件の受信機能を有する車両7毎に生成して、制約条件の受信機能を有する各車両7に送信する。 The control device 10 receives moving object information indicating the state of the vehicle 7 from each vehicle 7 to be controlled, and restricts the judgment regarding the movement performed by each vehicle 7 (hereinafter, "virtual traffic rule"". Is generated for each vehicle 7 having a constraint condition receiving function so that the vehicles 7 do not interfere with each other at the interference point X, and is transmitted to each vehicle 7 having a constraint condition receiving function.

車両7の状態とは、車両7の動き、車両7に対して行われた制御内容、及び車両7に備わっている各機能の動作状況等、計測及び収集可能な車両7に関する項目を項目毎に表した情報の集合体である。 The state of the vehicle 7 is an item related to the vehicle 7 that can be measured and collected, such as the movement of the vehicle 7, the control content performed on the vehicle 7, and the operation status of each function provided in the vehicle 7. It is a collection of represented information.

なお、管制装置10が車両7に送信する仮想交通ルールは、車両7の管制情報の一例であり、詳細内容については後ほど説明する。 The virtual traffic rule transmitted by the control device 10 to the vehicle 7 is an example of the control information of the vehicle 7, and the details will be described later.

管制装置10は、コネクテッド車両であれば無線通信装置3を通じて移動体情報を受信することができるが、非コネクテッド車両の場合には無線設備を備えていないため、無線通信装置3を通じて移動体情報を受信することができない。 The control device 10 can receive mobile information through the wireless communication device 3 if it is a connected vehicle, but since it does not have wireless equipment in the case of a non-connected vehicle, the mobile information can be received through the wireless communication device 3. Cannot receive.

したがって、管制装置10は、移動体検出装置9を通じて非コネクテッド車両の移動体情報を取得する。 Therefore, the control device 10 acquires the moving body information of the non-connected vehicle through the moving body detecting device 9.

移動体検出装置9は無線通信装置3と同様に、例えば車道と並行して設けられた歩道や車道の中央分離帯、及び信号設備のように非コネクテッド車両の移動体情報が得られる範囲に設置される。移動体検出装置9は、例えば光学的に撮像を行う撮像センサ9Aを用いて、車線における非コネクテッド車両や非コネクテッド車両周辺の交通環境を撮像し、非コネクテッド車両に関する移動体情報を収集する装置である。本実施の形態における移動体検出装置9の取り付け位置、撮像方向、及び撮像される画像の撮像範囲(視野角)は固定とする。なお、以降では後述する図8において、画像に対して符号50を付しているため、画像を「画像50」と表すことにする。 Similar to the wireless communication device 3, the mobile detection device 9 is installed in a range where mobile information of a non-connected vehicle can be obtained, such as a sidewalk provided in parallel with a roadway, a median strip of the roadway, and signal equipment. Will be done. The moving object detection device 9 is a device that uses, for example, an image pickup sensor 9A that optically captures images to image the traffic environment around a non-connected vehicle or a non-connected vehicle in a lane and collects moving body information about the non-connected vehicle. be. The mounting position of the moving object detection device 9 in the present embodiment, the imaging direction, and the imaging range (viewing angle) of the image to be captured are fixed. Since the reference numeral 50 is attached to the image in FIG. 8 described later, the image will be referred to as “image 50”.

コネクテッド車両は、運転機能の相違によって更に複数の種類の車両に分類されることがあるが、一例として、本実施の形態に係るコネクテッド車両は遵守車両とする。 The connected vehicle may be further classified into a plurality of types of vehicles depending on the difference in driving function, but as an example, the connected vehicle according to the present embodiment is a compliant vehicle.

遵守車両とは、管制装置10から仮想交通ルールを受信し、車両7に取り付けられたセンサ等から得られる交通環境情報を参照しながら、受信した仮想交通ルールを満たし、かつ、車両7同士の干渉を自律的に回避するように、車両7自らの判断によって車両7を制御しながら走行する自動運転機能を備えた車両7のことである。なお、本実施の形態に係る自動運転とは、運転手ではなく自動運転機能が走行に関する責任を負うレベル3以上の区分に分類される運転を指す。 A compliant vehicle is a vehicle that receives a virtual traffic rule from the control device 10, satisfies the received virtual traffic rule while referring to traffic environment information obtained from a sensor or the like attached to the vehicle 7, and interferes with each other. It is a vehicle 7 having an automatic driving function of traveling while controlling the vehicle 7 at the discretion of the vehicle 7 so as to autonomously avoid the above. The automatic driving according to the present embodiment refers to driving classified into a level 3 or higher category in which the automatic driving function is responsible for driving, not the driver.

以降では、特に断りがない場合、管制装置10が交通管制を行う範囲内に遵守車両と非コネクテッド車両が走行している例について説明する。遵守車両及び非コネクテッド車両を区別して説明する必要がない場合には総称して「車両7」と表し、区別して説明する場合には、それぞれ遵守車両7Aと非コネクテッド車両7Dのように表す。非コネクテッド車両7Dは非コネクテッド移動体の一例である。また、車両7のうち注目する2台の車両を「車両P」及び「車両Q」で表すことがある。 Hereinafter, unless otherwise specified, an example in which a compliant vehicle and a non-connected vehicle are traveling within the range in which the control device 10 controls traffic will be described. When it is not necessary to distinguish between the compliant vehicle and the non-connected vehicle, they are collectively referred to as "vehicle 7", and when they are described separately, they are represented as the compliant vehicle 7A and the non-connected vehicle 7D, respectively. The unconnected vehicle 7D is an example of a non-connected moving object. Further, the two vehicles of interest among the vehicles 7 may be represented by "vehicle P" and "vehicle Q".

図2は、遵守車両7Aの制御装置20における機能構成例を示す図である。 FIG. 2 is a diagram showing an example of a functional configuration in the control device 20 of the compliant vehicle 7A.

図2に示すように、遵守車両7Aの制御装置20は、位置推定部21、状態管理部22、無線通信部23、局所経路計画部24、及び制御部25の各機能部と、車両走行ルート地図26を含む。 As shown in FIG. 2, the control device 20 of the compliant vehicle 7A includes each functional unit of the position estimation unit 21, the state management unit 22, the wireless communication unit 23, the local route planning unit 24, and the control unit 25, and the vehicle travel route. Includes map 26.

位置推定部21は遵守車両7Aの位置を推定する。具体的には、位置推定部21は、遵守車両7Aに取り付けられた例えばレーザレンジファインダやカメラのように、遵守車両7Aが走行する周辺環境の形状や、道路上の状況を捉える外界センサ91から外形形状データを取得し、取得した外形形状データと、例えば予め用意している環境外形データ(自己位置推定用地図)をマッチングさせ、一致する地点を遵守車両7Aの現在位置として推定するマップマッチングを用いて遵守車両7Aの位置を推定する。位置推定部21における遵守車両7Aの位置の推定方法に制約はなく、例えばGPS(Global Positioning System)を用いた遵守車両7Aの位置の推定等、他の推定方法を用いてもよい。位置推定部21は、推定した遵守車両7Aの位置を位置情報として状態管理部22及び局所経路計画部24に通知する。 The position estimation unit 21 estimates the position of the compliant vehicle 7A. Specifically, the position estimation unit 21 is from an external sensor 91 that captures the shape of the surrounding environment in which the compliant vehicle 7A travels and the situation on the road, such as a laser range finder or a camera attached to the compliant vehicle 7A. Map matching that acquires the external shape data, matches the acquired external shape data with, for example, the environmental external shape data (self-position estimation map) prepared in advance, and estimates the matching point as the current position of the observing vehicle 7A. Use to estimate the position of the compliance vehicle 7A. There are no restrictions on the method of estimating the position of the compliant vehicle 7A in the position estimation unit 21, and other estimation methods such as estimation of the position of the compliant vehicle 7A using GPS (Global Positioning System) may be used. The position estimation unit 21 notifies the state management unit 22 and the local route planning unit 24 of the estimated position of the observing vehicle 7A as position information.

状態管理部22は、例えばナンバー情報及び車体番号のように遵守車両7Aを一意に識別するために用いられる情報を含んだ車両固有情報を管理する。また、状態管理部22は、例えば位置情報によって表される遵守車両7Aの位置、並びに、姿勢、速度、及び制御内容等を計測するセンサ(「内界センサ90」と呼ばれる)や外界センサ91で取得した周囲の交通環境に関するセンサ値を時系列に沿って収集し、遵守車両7Aの状態として管理する。 The state management unit 22 manages vehicle-specific information including information used for uniquely identifying the compliant vehicle 7A, such as number information and vehicle body number. Further, the state management unit 22 is a sensor (referred to as "inner world sensor 90") or an external world sensor 91 that measures, for example, the position of the observing vehicle 7A represented by the position information, the posture, the speed, the control content, and the like. The acquired sensor values related to the surrounding traffic environment are collected in chronological order and managed as the state of the compliant vehicle 7A.

状態管理部22は、車両固有情報と遵守車両7Aの状態を移動体情報として定期及び随時の少なくとも一方のタイミングで、無線通信部23及び局所経路計画部24に通知する。 The state management unit 22 notifies the wireless communication unit 23 and the local route planning unit 24 of the vehicle-specific information and the status of the compliant vehicle 7A as mobile body information at at least one of the timings of periodicity and occasion.

無線通信部23は、状態管理部22から受け付けた移動体情報を、無線通信装置3を通じて管制装置10に送信すると共に、無線通信装置3を通じて管制装置10から受信した管制情報を遅滞なく局所経路計画部24に通知する。 The wireless communication unit 23 transmits the mobile body information received from the state management unit 22 to the control device 10 through the wireless communication device 3, and the control information received from the control device 10 through the wireless communication device 3 is locally route-planned without delay. Notify department 24.

局所経路計画部24は、位置推定部21から受け付けた位置情報、状態管理部22から受け付けた移動体情報、無線通信部23から受け付けた管制情報、及び車両走行ルート地図26を用いて局所経路を計画し、制御部25に通知する。 The local route planning unit 24 uses the position information received from the position estimation unit 21, the mobile body information received from the state management unit 22, the control information received from the wireless communication unit 23, and the vehicle travel route map 26 to obtain a local route. Plan and notify the control unit 25.

局所経路計画部24は、遵守車両7Aが管制情報に含まれる仮想交通ルールを満たし、かつ、管制情報で指定された大域経路に沿って走行するという条件の下で、移動体情報に含まれる遵守車両7Aに取り付けられた外界センサ91の計測データから走行中の車道の状況を判断し、大域経路に対応した車道のどの位置を実際に走行しなければならないのかといった実経路を決定する。その上で、局所経路計画部24は、決定した実経路に沿って車両7を走行させるために従うべき各時刻における遵守車両7Aの速度や姿勢を設定する。 The local route planning unit 24 complies with the moving object information under the condition that the observing vehicle 7A satisfies the virtual traffic rule included in the control information and travels along the global route specified in the control information. From the measurement data of the external sensor 91 attached to the vehicle 7A, the condition of the traveling roadway is determined, and the actual route such as which position of the roadway corresponding to the global route should be actually traveled is determined. Then, the local route planning unit 24 sets the speed and posture of the observing vehicle 7A at each time to be followed in order to drive the vehicle 7 along the determined actual route.

このように、遵守車両7Aが仮想交通ルールを満たしながら、管制装置10によって指定された大域経路に沿って走行するという条件の下で決定した実経路を「局所経路」と呼び、局所経路には、局所経路に沿って遵守車両7Aを走行させるための制御内容が付加される。なお、大域経路の詳細内容については後ほど説明する。 In this way, the actual route determined under the condition that the observing vehicle 7A travels along the global route designated by the control device 10 while satisfying the virtual traffic rule is called a "local route", and the local route is referred to as a local route. , The control content for driving the observing vehicle 7A along the local route is added. The details of the global route will be described later.

車両走行ルート地図26は、遵守車両7Aが走行する車線を表す地図情報を含んでおり、局所経路の決定や、局所経路に沿って遵守車両7Aを走行させるための各時刻における遵守車両7Aの制御内容の設定に用いられる。 The vehicle travel route map 26 includes map information indicating the lane in which the compliant vehicle 7A travels, determines a local route, and controls the compliant vehicle 7A at each time to drive the compliant vehicle 7A along the local route. Used to set the content.

制御部25は局所経路計画部24から局所経路を受け付けると、局所経路に含まれる制御内容に従い遵守車両7Aのハンドル、アクセル、ブレーキ等を制御し、局所経路に沿った遵守車両7Aの自律走行を実現する。 When the control unit 25 receives the local route from the local route planning unit 24, it controls the steering wheel, accelerator, brake, etc. of the compliant vehicle 7A according to the control content included in the local route, and autonomously travels the compliant vehicle 7A along the local route. Realize.

制御部25が実施した制御に伴うハンドル、アクセル、ブレーキ等の操作量といった遵守車両7Aの制御内容は、各種制御量を計測するそれぞれの内界センサ90を通じて状態管理部22に通知され、遵守車両7Aの状態として状態管理部22で管理される。 The control content of the compliance vehicle 7A such as the amount of operation of the steering wheel, accelerator, brake, etc. associated with the control performed by the control unit 25 is notified to the state management unit 22 through each internal sensor 90 that measures various control amounts, and the compliance vehicle is notified. It is managed by the state management unit 22 as the state of 7A.

なお、遵守車両7Aは管制装置10から大域経路を受信しなくても、外界センサ91の計測データから走行中の車道の状況を判断し、仮想交通ルールを満たすような実経路を決定することができるが、ここでは一例として、遵守車両7Aは管制装置10から大域経路を受信して実経路、すなわち局所経路を決定するものとする。 Even if the observing vehicle 7A does not receive the global route from the control device 10, it can determine the condition of the traveling roadway from the measurement data of the external world sensor 91 and determine the actual route that satisfies the virtual traffic rule. However, here, as an example, it is assumed that the observing vehicle 7A receives the global route from the control device 10 and determines the actual route, that is, the local route.

一方、非コネクテッド車両7Dの場合、管制装置10とデータ通信を行う通信機能を備えていなければ、どのような機能構成であっても構わない。 On the other hand, in the case of the non-connected vehicle 7D, any functional configuration may be used as long as it does not have a communication function for data communication with the control device 10.

図3は、遵守車両7A及び非コネクテッド車両7Dが有する運転機能の相違点をまとめた図である。 FIG. 3 is a diagram summarizing the differences in driving functions of the compliant vehicle 7A and the non-connected vehicle 7D.

図3において、“〇”は対応する機能を備えていることを表し、“×”は対応する機能を備えていないことを表す。“〇/×”は対応する機能を備えていても備えていなくてもどちらでもよいことを表し、“-”は原則不要な機能であることを表す。仮想交通ルール伝達機能とは、管制装置10から受信した仮想交通ルールを、視覚、聴覚、及び触覚の少なくとも1つを利用して車両7の運転手に伝達する機能である。 In FIG. 3, “◯” indicates that the corresponding function is provided, and “×” indicates that the corresponding function is not provided. “○ / ×” indicates that the corresponding function may or may not be provided, and “-” indicates that the function is unnecessary in principle. The virtual traffic rule transmission function is a function of transmitting a virtual traffic rule received from the control device 10 to the driver of the vehicle 7 by using at least one of visual, auditory, and tactile senses.

非コネクテッド車両7Dは管制装置10との通信機能を備えていないため、通信機能の存在を前提とした仮想交通ルール受信、仮想交通ルール伝達機能、及び大域経路取得の各機能は備えていない。また、非コネクテッド車両7Dは、例えば自動運転機能のように必ずしも通信機能の存在を前提としていない機能については、該当する機能を備えていても備えていなくてもどちらでもよい。 Since the non-connected vehicle 7D does not have a communication function with the control device 10, it does not have each function of virtual traffic rule reception, virtual traffic rule transmission function, and global route acquisition on the premise of the existence of the communication function. Further, the non-connected vehicle 7D may or may not have the corresponding function for a function that does not necessarily presuppose the existence of a communication function, such as an automatic driving function.

以降では、説明の便宜上、移動体情報を区別して説明する必要がある場合、遵守車両7Aの移動体情報を「移動体情報A」、非コネクテッド車両7Dの移動体情報を「移動体情報D」ということにする。 Hereinafter, for convenience of explanation, when it is necessary to separately explain the moving body information, the moving body information of the compliant vehicle 7A is referred to as "moving body information A", and the moving body information of the non-connected vehicle 7D is referred to as "moving body information D". I will say that.

図4は、移動体検出装置9及び管制装置10の機能構成例を示す図である。まず、移動体検出装置9の機能について説明する。 FIG. 4 is a diagram showing a functional configuration example of the moving body detection device 9 and the control device 10. First, the function of the moving body detection device 9 will be described.

図4に示すように、移動体検出装置9は撮像センサ9A、移動体検出部9B、座標変換部9C、走路情報取得部9D、走行経路予測部9E、判定地点設定部9F、接近度評価部9G、及び信頼度制御部9Hを含む。 As shown in FIG. 4, the moving body detection device 9 includes an image pickup sensor 9A, a moving body detection unit 9B, a coordinate conversion unit 9C, a track information acquisition unit 9D, a travel route prediction unit 9E, a determination point setting unit 9F, and an approach evaluation unit. Includes 9G and reliability control unit 9H.

撮像センサ9Aは、非コネクテッド車両7Dや非コネクテッド車両7D周辺の交通環境を撮像した画像50を生成し、画像50を移動体検出部9Bに通知する。撮像センサ9Aは複数の撮像素子で構成され、各々の撮像素子がそれぞれ画像50の画素に対応した画素値を出力する。 The image pickup sensor 9A generates an image 50 that captures the traffic environment around the non-connected vehicle 7D and the non-connected vehicle 7D, and notifies the moving object detection unit 9B of the image 50. The image pickup sensor 9A is composed of a plurality of image pickup elements, and each image pickup element outputs a pixel value corresponding to the pixel of the image 50.

なお、撮像センサ9Aは、例えば指示されたタイミングで画像50の撮像を行う。例えば、1秒間隔で画像50の撮像を行う指示を受け付けた場合、撮像センサ9Aは1秒間隔で画像50の撮像を行うことになる。なお、撮像間隔を短く設定していけば、撮像センサ9Aが撮像する画像50は動画となる。 The image sensor 9A captures the image 50 at an instructed timing, for example. For example, when an instruction to capture an image 50 at 1-second intervals is received, the image pickup sensor 9A will capture the image 50 at 1-second intervals. If the imaging interval is set short, the image 50 captured by the imaging sensor 9A becomes a moving image.

移動体検出部9Bは、撮像センサ9Aで撮像された画像50から公知の移動体検出手法、例えばディープラーニングを用いた機械学習やパターンマッチングを用いて移動体(本実施の形態の場合、非コネクテッド車両7D)を検出し、画像50から得られる非コネクテッド車両7Dの位置及び速度を含む移動体情報Dを、後述する信頼度制御部9Hによって指定された精度で検出する。なお、移動体検出部9Bは信頼度制御部9Hからの指示により、撮像センサ9Aによる撮像のタイミングを制御することができる。 The moving body detection unit 9B uses a moving body detection method known from the image 50 captured by the image pickup sensor 9A, for example, machine learning using deep learning or pattern matching to move the moving body (in the case of the present embodiment, non-connected). The vehicle 7D) is detected, and the moving body information D including the position and speed of the unconnected vehicle 7D obtained from the image 50 is detected with the accuracy specified by the reliability control unit 9H described later. The moving body detection unit 9B can control the timing of imaging by the image pickup sensor 9A according to an instruction from the reliability control unit 9H.

移動体検出部9Bは、画像50から検出した移動体情報D(画像50上の移動体情報Dともいう)を座標変換部9Cに通知する。 The mobile body detection unit 9B notifies the coordinate conversion unit 9C of the mobile body information D (also referred to as the mobile body information D on the image 50) detected from the image 50.

座標変換部9Cは、移動体検出部9Bから受け付けた画像50上における非コネクテッド車両7Dの位置が、後述する管制走行ルート地図17上ではどの地点に対応するのかを表すために、画像50上の座標系(画像座標系)で表される非コネクテッド車両7Dの位置を、管制走行ルート地図17上の座標系(地図座標系)で表される地点に座標変換する。 The coordinate conversion unit 9C is on the image 50 in order to indicate which point the position of the non-connected vehicle 7D on the image 50 received from the moving object detection unit 9B corresponds to on the control travel route map 17 described later. The position of the unconnected vehicle 7D represented by the coordinate system (image coordinate system) is coordinate-converted to a point represented by the coordinate system (map coordinate system) on the controlled travel route map 17.

こうした座標変換は、撮像センサ9Aで撮像された各々の画像50から検出された非コネクテッド車両7Dの位置に対して行われるため、時系列に沿った管制走行ルート地図17上での非コネクテッド車両7Dの位置が得られる。 Since such coordinate conversion is performed for the position of the unconnected vehicle 7D detected from each image 50 captured by the image sensor 9A, the unconnected vehicle 7D on the controlled travel route map 17 along the time series is performed. Position is obtained.

また、画像50から検出された非コネクテッド車両7Dの速度も、管制走行ルート地図17上に座標変換された非コネクテッド車両7Dの位置に基づいて、管制走行ルート地図17上の各地点に対応した速度に変換される。 Further, the speed of the unconnected vehicle 7D detected from the image 50 is also the speed corresponding to each point on the controlled traveling route map 17 based on the position of the unconnected vehicle 7D coordinate-converted on the controlled traveling route map 17. Is converted to.

座標変換部9Cは、管制走行ルート地図17上での各地点における非コネクテッド車両7Dの速度、及び時系列に沿った管制走行ルート地図17上での非コネクテッド車両7Dの位置を地図上の移動体情報Dとして走行経路予測部9Eに通知する。 The coordinate conversion unit 9C sets the speed of the unconnected vehicle 7D at each point on the controlled travel route map 17 and the position of the unconnected vehicle 7D on the controlled travel route map 17 in chronological order as a moving object on the map. Notify the travel route prediction unit 9E as information D.

一方、走路情報取得部9Dは、例えば管制装置10に含まれる管制走行ルート地図17を読み込み、管制走行ルート地図17から車線8に関する走路情報を取得し、走行経路予測部9Eに通知する。 On the other hand, the track information acquisition unit 9D reads, for example, the control travel route map 17 included in the control device 10, acquires the track information related to the lane 8 from the control travel route map 17, and notifies the travel route prediction unit 9E.

図5は、地図データの一例である管制走行ルート地図17の内容例を示す図である。管制走行ルート地図17は、交通規則が変化しない区間を最小単位とした、各区間における走路情報の集合によって表現される道路構造データベースである。 FIG. 5 is a diagram showing a content example of the control travel route map 17 which is an example of map data. The control travel route map 17 is a road structure database represented by a set of track information in each section, with a section in which the traffic rule does not change as the minimum unit.

管制走行ルート地図17を構成する区間(図5の例の場合、地点K1から地点K2までの区間、地点K2から地点K3までの区間、地点K3から地点K7までの区間、地点K2から地点K5までの区間、地点K4から地点K5までの区間、及び地点K5から地点K6までの区間の6区間)には、それぞれ区間における制限速度、車線数、幅員、及び区間における車線が優先車線であるのか、それとも非優先車線であるのかといった車線優先度等の交通規則情報が設定されている。 Sections constituting the control driving route map 17 (in the case of the example of FIG. 5, the section from the point K1 to the point K2, the section from the point K2 to the point K3, the section from the point K3 to the point K7, and the section from the point K2 to the point K5. The speed limit, the number of lanes, the width, and the lane in the section are the priority lanes in each section), the section from point K4 to point K5, and the section from point K5 to point K6). Traffic rule information such as lane priority such as whether it is a non-priority lane is set.

更に、管制走行ルート地図17を構成する各区間は、仮想的に設定された経由点4の集合である経由点列によって車両7の経路6を表している。経由点4とは、経路6上における車両7の位置を表す指標の1つであり、各々の経由点4には経由点IDが一意に設定されているため、経由点IDから経路6上における車両7の位置が特定される。この経由点4が、管制走行ルート地図17における「地点」に相当する。管制走行ルート地図17における経由点4の位置情報は、3次元空間を規定する地図座標系によって表される。 Further, each section constituting the control travel route map 17 represents the route 6 of the vehicle 7 by a sequence of transit points which is a set of virtually set transit points 4. The waypoint 4 is one of the indexes indicating the position of the vehicle 7 on the route 6, and since the waypoint ID is uniquely set for each waypoint 4, the waypoint ID is on the route 6. The position of the vehicle 7 is specified. This waypoint 4 corresponds to a "point" in the control travel route map 17. The position information of the waypoint 4 in the control travel route map 17 is represented by the map coordinate system that defines the three-dimensional space.

また、管制走行ルート地図17の各々の経由点4には、例えば車両7が経路6上を安全に走行することができる最大加減速度が予め設定されていると共に、干渉地点Xを予め規定している干渉地点情報が含まれる。管制走行ルート地図17を構成する各区間の制限速度、車線数、幅員、交通規則情報、最大加減速度、及び干渉地点X等の情報は、例えば車線8の交通量のように秒単位や分単位で変化する動的な情報ではなく、車線8の構造が変更されるまで変化しない情報、すなわち車線8の静的な状況を表す走路情報の一例である。 Further, at each waypoint 4 of the control travel route map 17, for example, the maximum acceleration / deceleration at which the vehicle 7 can safely travel on the route 6 is set in advance, and the interference point X is defined in advance. Interference point information is included. Information such as speed limit, number of lanes, width, traffic rule information, maximum acceleration / deceleration, and interference point X of each section constituting the controlled travel route map 17 is in seconds or minutes like the traffic volume in lane 8. This is an example of information that does not change until the structure of the lane 8 is changed, that is, lane information that represents a static situation of the lane 8, rather than dynamic information that changes in.

図6は、干渉地点Xの例を示す図である。干渉地点Xには例えば図6(A)に示すように、優先車線8Aと非優先車線8Bが交差する交差点や、一般道や高速道路でみられるような、図6(B)に示す優先車線8Aと非優先車線8Bが合流する合流点が含まれる。干渉地点Xとは、車両7同士が干渉範囲まで接近するような箇所のことであるため、干渉地点Xは必ずしも点で表されるわけではなく、一定の大きさを有する領域で表されることもある。すなわち干渉地点Xは干渉領域の一例である。 FIG. 6 is a diagram showing an example of the interference point X. At the interference point X, for example, as shown in FIG. 6 (A), an intersection where the priority lane 8A and the non-priority lane 8B intersect, or the priority lane shown in FIG. It includes a confluence where 8A and non-priority lane 8B meet. Since the interference point X is a place where the vehicles 7 approach each other to the interference range, the interference point X is not necessarily represented by a point, but is represented by a region having a certain size. There is also. That is, the interference point X is an example of an interference region.

図7は、干渉地点情報の一例を示す図であり、干渉地点情報は、例えば干渉地点X毎に干渉地点Xを一意に識別するための干渉地点ID、干渉地点Xの位置、干渉地点Xに対応する経由点4を一意に識別するための経由点ID、並びに、干渉地点Xの1つ手前の経由点4の位置及び経由点IDを、同じ干渉地点Xを共有する優先車線8Aと非優先車線8Bのそれぞれについて規定した情報である。 FIG. 7 is a diagram showing an example of the interference point information, and the interference point information is, for example, an interference point ID for uniquely identifying the interference point X for each interference point X, a position of the interference point X, and an interference point X. The waypoint ID for uniquely identifying the corresponding waypoint 4, and the position and waypoint ID of the waypoint 4 immediately before the interference point X are not prioritized with the priority lane 8A sharing the same interference point X. This is the information specified for each of the lanes 8B.

前述した遵守車両7Aにおける車両走行ルート地図26も管制走行ルート地図17と同じ情報で構成されるが、車両走行ルート地図26は、車両7が実際に走行する上で必要になるような、管制走行ルート地図17には含まれない情報を含んでもよい。 The vehicle travel route map 26 in the above-mentioned compliant vehicle 7A is also composed of the same information as the control travel route map 17, but the vehicle travel route map 26 is such that the vehicle travel route map 26 is necessary for the vehicle 7 to actually travel. Information that is not included in the route map 17 may be included.

なお、管制走行ルート地図17に必ずしも干渉地点情報が含まれている必要はなく、例えば管制走行ルート地図17に含まれる経由点列の情報から干渉地点情報を生成してもよい。また、移動体検出装置9は管制装置10の管制走行ルート地図17から走路情報を取得するのではなく、予め移動体検出装置9の内部に管制装置10と同じ管制走行ルート地図17を備えてもよい。 It should be noted that the control travel route map 17 does not necessarily include the interference point information, and for example, the interference point information may be generated from the information of the waypoint sequence included in the control travel route map 17. Further, the mobile body detection device 9 does not acquire the track information from the control travel route map 17 of the control device 10, but may provide the same control travel route map 17 as the control device 10 inside the mobile body detection device 9 in advance. good.

座標変換部9Cから地図上の移動体情報Dを受け付け、走路情報取得部9Dから車線8の走路情報を受け付けた走行経路予測部9Eは、それぞれ管制走行ルート地図17上における非コネクテッド車両7Dの位置及び速度、並びに、車線8の走路情報から、画像50が検出された非コネクテッド車両7Dの走行経路を予測すると共に、予測した走行経路を表す経由点4毎に非コネクテッド車両7Dの干渉時間tを予測する。なお、走行経路とは、車両7が今後走行すると考えられる経路6のことをいう。 The travel route prediction unit 9E, which has received the moving body information D on the map from the coordinate conversion unit 9C and the track information of the lane 8 from the track information acquisition unit 9D, is the position of the non-connected vehicle 7D on the controlled travel route map 17, respectively. From the speed and the track information of the lane 8, the travel path of the unconnected vehicle 7D in which the image 50 is detected is predicted, and the interference time t of the non-connected vehicle 7D is calculated for each waypoint 4 representing the predicted travel route. Predict. The travel route refers to a route 6 in which the vehicle 7 is considered to travel in the future.

経由点4における非コネクテッド車両7Dの干渉時間tとは、非コネクテッド車両7Dが経由点4を通過すると考えられる期間のことである。この期間に他の車両7が経由点4を通過すると非コネクテッド車両7Dと他の車両7が干渉することから「干渉時間t」という。 The interference time t of the non-connected vehicle 7D at the waypoint 4 is a period during which the non-connected vehicle 7D is considered to pass through the waypoint 4. When the other vehicle 7 passes through the waypoint 4 during this period, the non-connected vehicle 7D and the other vehicle 7 interfere with each other, so that it is called "interference time t".

なお、干渉時間tが例えば12時30分15秒というように特定の時間ではなく、12時30分15秒から12時31分50秒までの間というように期間によって表されるのは、撮像センサ9Aで撮像した画像50から検出した移動体情報Dには誤差が含まれているためである。 It should be noted that the interference time t is not a specific time such as 12:30:15, but is represented by a period such as between 12:30:15 and 12:31:50 for imaging. This is because the moving body information D detected from the image 50 captured by the sensor 9A contains an error.

図8は、移動体検出装置9の撮像センサ9Aによって撮像される画像50について説明する図である。図8のうち、図8(A)は車線8を走行する車両P及び車両Qを移動体検出装置9で撮像している状況を示している図であり、図8(B)は、図8(A)に示した状況で撮像された画像50の一例を示している。 FIG. 8 is a diagram illustrating an image 50 captured by the image pickup sensor 9A of the mobile body detection device 9. Of FIGS. 8, FIG. 8A is a diagram showing a situation in which a vehicle P and a vehicle Q traveling in the lane 8 are imaged by the moving body detection device 9, and FIG. 8B is a diagram showing a situation in which the vehicle is imaged by the moving body detection device 9. An example of the image 50 captured in the situation shown in (A) is shown.

撮像センサ9A上に被写体の像を結像させるため、移動体検出装置9には撮像センサ9Aのレンズが装着されているが、レンズに歪みがあると車両Pと車両Qの大きさが同じであっても、レンズを通して撮像された画像50内での車両Pと車両Qの大きさが異なる場合がある。また、移動体検出装置9から車両P及び車両Qまでのそれぞれの距離が異なる場合にも、車両Pと車両Qの大きさが同じであっても画像50内での車両Pと車両Qの大きさが異なる場合がある。 In order to form an image of the subject on the image pickup sensor 9A, the lens of the image pickup sensor 9A is attached to the moving object detection device 9, but if the lens is distorted, the sizes of the vehicle P and the vehicle Q are the same. Even so, the sizes of the vehicle P and the vehicle Q in the image 50 captured through the lens may be different. Further, even when the distances from the moving object detection device 9 to the vehicle P and the vehicle Q are different, the sizes of the vehicle P and the vehicle Q in the image 50 are the same even if the sizes of the vehicle P and the vehicle Q are the same. May be different.

そのため、図8(B)の画像50の例では、実際には同じ大きさの車両Pと車両Qであっても、車両Qが車両Pより小さく表示されている。なお、枠55P及び枠55Qは、それぞれ移動体検出装置9の移動体検出部9Bで画像50から検出した車両P及び車両Qの位置を表す枠線である。車両P及び車両Qの具体的な位置は、例えば枠55P及び枠55Qにそれぞれ存在する2本の対角線の交点の座標で表してもよい。画像50には座標軸X1及び座標軸Y1で表される画像座標系が適用されている。 Therefore, in the example of the image 50 of FIG. 8B, the vehicle Q is displayed smaller than the vehicle P even if the vehicle P and the vehicle Q are actually the same size. The frame 55P and the frame 55Q are frame lines representing the positions of the vehicle P and the vehicle Q detected from the image 50 by the moving body detecting unit 9B of the moving body detecting device 9, respectively. The specific positions of the vehicle P and the vehicle Q may be represented by, for example, the coordinates of the intersections of the two diagonal lines existing in the frame 55P and the frame 55Q, respectively. An image coordinate system represented by the coordinate axis X1 and the coordinate axis Y1 is applied to the image 50.

実際には同じ大きさの車両Pと車両Qであっても、車両Pに比べて車両Qが画像50内で小さく表示されているということは、撮像センサ9Aにおいて車両Qを撮像している画素1つあたりの撮像範囲の幅が、車両Pを撮像している画素1つあたりの撮像範囲の幅よりも長いことを表している。こうした撮像センサ9Aの各々の画素が撮像する撮像範囲の幅を「画素の解像度」という。画像50内の各々の画素に対応する撮像センサ9Aの画素の解像度は、画像50内のどの場所を撮像しているかによって画素毎に異なる。1つの画素の撮像範囲が狭いほど、予め定めた大きさの範囲をより多くの画素で撮像することになるため、画像50上では大きく撮像される(図8(B)の車両P)。一方、1つの画素の撮像範囲が広いほど、予め定めた大きさの範囲をより少ない画素で撮像することになるため、画像50上では小さく撮像される(図8(B)の車両Q)。 Even if the vehicle P and the vehicle Q are actually the same size, the fact that the vehicle Q is displayed smaller in the image 50 than that of the vehicle P means that the image pickup sensor 9A is capturing the image of the vehicle Q. It represents that the width of the image pickup range per one is longer than the width of the image pickup range per pixel that is imaging the vehicle P. The width of the image pickup range captured by each pixel of the image pickup sensor 9A is referred to as "pixel resolution". The resolution of the pixel of the image pickup sensor 9A corresponding to each pixel in the image 50 differs for each pixel depending on which place in the image 50 is being imaged. The narrower the imaging range of one pixel, the larger the image is captured on the image 50 because a range of a predetermined size is captured by more pixels (vehicle P in FIG. 8B). On the other hand, the wider the imaging range of one pixel, the smaller the imaging range of the predetermined size is captured by the smaller number of pixels, so that the image is captured smaller on the image 50 (vehicle Q in FIG. 8B).

すなわち画像50において、車両Qよりも大きく表示された車両Pは、車両Qよりも高解像度で撮像されているため、画像50から検出した車両Pの位置と、車線8上における実際の車両Pの位置との誤差は、車両Qの位置の誤差よりも小さくなる。 That is, in the image 50, the vehicle P displayed larger than the vehicle Q is imaged with a higher resolution than the vehicle Q, so that the position of the vehicle P detected from the image 50 and the actual vehicle P on the lane 8 The error from the position is smaller than the error from the position of the vehicle Q.

したがって、移動体検出装置9の移動体検出部9Bで画像50から検出した車両P及び車両Qの位置を、移動体検出装置9の座標変換部9Cで管制走行ルート地図17上の地点に座標変換する場合、図8(B)の画像50内で車両Qに比べて大きく表示されている車両Pの座標変換後における管制走行ルート地図17上での位置の誤差は、車両Qの座標変換後における管制走行ルート地図17上での位置の誤差に比べて小さくなる傾向がある。 Therefore, the positions of the vehicle P and the vehicle Q detected from the image 50 by the moving body detecting unit 9B of the moving body detecting device 9 are coordinate-converted to the points on the control travel route map 17 by the coordinate conversion unit 9C of the moving body detecting device 9. In this case, the position error on the control travel route map 17 after the coordinate conversion of the vehicle P, which is displayed larger than the vehicle Q in the image 50 of FIG. 8B, is the error after the coordinate conversion of the vehicle Q. It tends to be smaller than the position error on the control travel route map 17.

図9は、図8(B)に示した画像50における車両P及び車両Qの位置を、それぞれ管制走行ルート地図17上の最も近い経由点4に写像した例を示す図である。一例として、経由点4Aが座標変換後の車両Pの位置を表し、経由点4Bが座標変換後の車両Qの位置を表しているものとする。画像50から検出した車両Pの位置の誤差の関係から、実際の車両Pの位置は、車両Qの位置を表す経由点4Bを囲む領域Zqよりも狭い領域Zp内に含まれることになる。すなわち地図座標系における車両Pの位置の誤差は、車両Qの位置の誤差よりも小さくなる。なお、地図座標系は座標X2、Y2、及びZ2を用いた三次元座標系として表されるが、説明の便宜上、図9では地面に沿った面であるX2-Y2平面上での経路6を表している。 FIG. 9 is a diagram showing an example in which the positions of the vehicle P and the vehicle Q in the image 50 shown in FIG. 8B are mapped to the nearest waypoint 4 on the control travel route map 17, respectively. As an example, it is assumed that the waypoint 4A represents the position of the vehicle P after the coordinate conversion, and the waypoint 4B represents the position of the vehicle Q after the coordinate conversion. Due to the error in the position of the vehicle P detected from the image 50, the actual position of the vehicle P is included in the region Z p narrower than the region Z q surrounding the waypoint 4B representing the position of the vehicle Q. .. That is, the error in the position of the vehicle P in the map coordinate system is smaller than the error in the position of the vehicle Q. The map coordinate system is represented as a three-dimensional coordinate system using the coordinates X2, Y2, and Z2, but for convenience of explanation, in FIG. 9, the path 6 on the X2-Y2 plane, which is a surface along the ground, is shown. Represents.

このように、撮像センサ9Aで撮像した画像50から検出した移動体情報Dには誤差が含まれるため、その誤差の範囲と、非コネクテッド車両7Dの速度の変動を考慮すれば、経由点4における非コネクテッド車両7Dの干渉時間tは幅を持った期間で表される。 As described above, since the moving body information D detected from the image 50 captured by the image pickup sensor 9A includes an error, if the range of the error and the fluctuation of the speed of the unconnected vehicle 7D are taken into consideration, the waypoint 4 is reached. The interference time t of the unconnected vehicle 7D is expressed by a period having a width.

なお、画像50からは非コネクテッド車両7Dが今後どのような走行経路を走行するかはわからないため、走行経路予測部9Eは、管制走行ルート地図17上の車線8が分岐する場合には車線8が分岐する毎に枝分かれするすべての経路6の組み合わせを非コネクテッド車両7Dの走行経路として取り扱う。 Since it is not possible to know from the image 50 what kind of travel route the unconnected vehicle 7D will travel in the future, the travel route prediction unit 9E will use the lane 8 when the lane 8 on the control travel route map 17 branches. The combination of all the routes 6 that branch each time it branches is treated as the travel route of the unconnected vehicle 7D.

図10は、車両Pが非コネクテッド車両7Dである場合の走行経路の一例を示す図である。図10に示すように、管制走行ルート地図17において車両Pの走行先が2つに分岐している場合、走行経路予測部9Eは、車両Pが分岐点で何れの方向に分岐するか不明であるため、経路6P-1及び経路6P-2を共に車両Pの走行経路として予測する。 FIG. 10 is a diagram showing an example of a traveling route when the vehicle P is a non-connected vehicle 7D. As shown in FIG. 10, when the travel destination of the vehicle P is branched into two in the control travel route map 17, the travel route prediction unit 9E is unclear in which direction the vehicle P branches at the branch point. Therefore, both the route 6P-1 and the route 6P-2 are predicted as the traveling route of the vehicle P.

走行経路予測部9Eは予測した非コネクテッド車両7Dの走行経路上における経由点4毎の干渉時間tを接近度評価部9Gに通知すると共に、予測した非コネクテッド車両7Dの走行経路を判定地点設定部9Fに通知する。また、走行経路予測部9Eは、予測した非コネクテッド車両7Dの走行経路、及び非コネクテッド車両7Dの移動体情報Dを、通信網5を通じて管制装置10に送信する。 The travel route prediction unit 9E notifies the proximity evaluation unit 9G of the interference time t for each waypoint 4 on the travel route of the predicted non-connected vehicle 7D, and determines the predicted travel route of the non-connected vehicle 7D as a determination point setting unit. Notify 9F. Further, the travel route prediction unit 9E transmits the predicted travel route of the non-connected vehicle 7D and the mobile body information D of the non-connected vehicle 7D to the control device 10 through the communication network 5.

これにより、管制装置10では後ほど説明するように、遵守車両7Aの走行経路と移動体情報A、及び非コネクテッド車両7Dの走行経路と移動体情報Dから、遵守車両7Aと非コネクテッド車両7Dとの干渉地点Xを特定する。特定された遵守車両7Aと非コネクテッド車両7Dとの干渉地点Xは、通信網5を通じて管制装置10から移動体検出装置9の判定地点設定部9Fに送信される。 As a result, as will be described later, in the control device 10, the compliant vehicle 7A and the non-connected vehicle 7D are separated from the traveling route and the moving body information A of the compliant vehicle 7A and the traveling route and the moving body information D of the non-connected vehicle 7D. Identify the point of interference X. The interference point X between the specified compliant vehicle 7A and the non-connected vehicle 7D is transmitted from the control device 10 to the determination point setting unit 9F of the mobile body detection device 9 through the communication network 5.

干渉地点Xを受信した判定地点設定部9Fは、管制装置10から受信した干渉地点Xに基づいて、非コネクテッド車両7Dの走行経路を表す各々の経由点4のうち、何れかの経由点4を判定地点Yとして設定する。判定地点Yとは、非コネクテッド車両7Dの接近状態を判定するための対象となる経由点4のことである。具体的には、判定地点Yとは、非コネクテッド車両7Dが走行経路を安全に走行する上で、非コネクテッド車両7Dの干渉時間tを可能な範囲で精度よく予測する必要がある経由点4のことである。 The determination point setting unit 9F that has received the interference point X sets any of the waypoints 4 among the waypoints 4 representing the traveling paths of the non-connected vehicle 7D based on the interference point X received from the control device 10. Set as the determination point Y. The determination point Y is a waypoint 4 that is a target for determining the approaching state of the non-connected vehicle 7D. Specifically, the determination point Y is the waypoint 4 at which it is necessary to accurately predict the interference time t of the non-connected vehicle 7D within the possible range in order for the non-connected vehicle 7D to safely travel on the travel route. That is.

判定地点設定部9Fは、設定した判定地点Yを接近度評価部9Gに通知する。 The determination point setting unit 9F notifies the approach degree evaluation unit 9G of the set determination point Y.

接近度評価部9Gは、非コネクテッド車両7Dの走行経路上における経由点4毎の干渉時間tのうち、判定地点設定部9Fから受け付けた判定地点Yに対応した経由点4の干渉時間tに基づき、判定地点Yに対する非コネクテッド車両7Dの接近度を評価する。 The approach evaluation unit 9G is based on the interference time t of the waypoint 4 corresponding to the determination point Y received from the determination point setting unit 9F among the interference times t for each waypoint 4 on the travel path of the non-connected vehicle 7D. , The degree of approach of the non-connected vehicle 7D to the determination point Y is evaluated.

接近度とは、非コネクテッド車両7Dの判定地点Yに対する接近状態を表す値であり、例えば接近度が大きいほど、非コネクテッド車両7Dが判定地点Yに近づいている状態を表す。接近度評価部9Gは、評価した接近度を信頼度制御部9Hに通知する。 The approach degree is a value indicating an approach state of the non-connected vehicle 7D to the determination point Y. For example, the larger the approach degree, the closer the non-connected vehicle 7D is to the determination point Y. The proximity evaluation unit 9G notifies the reliability control unit 9H of the evaluated approach degree.

信頼度制御部9Hは、接近度評価部9Gから接近度を受け付けると、接近度に応じて信頼度目標を設定し、移動体検出部9Bに対して、非コネクテッド車両7Dの移動体情報Dの検出精度を信頼度目標に近づけるように指示する制御を行う。 When the reliability control unit 9H receives the approach degree from the approach degree evaluation unit 9G, the reliability target is set according to the approach degree, and the moving object information D of the non-connected vehicle 7D is set with respect to the moving object detecting unit 9B. Control is performed to instruct the detection accuracy to approach the reliability target.

信頼度目標とは、移動体検出部9Bが画像50から検出する非コネクテッド車両7Dの移動体情報Dの検出精度の目標値であり、移動体検出部9Bは、指示された信頼度目標の値が大きいほど、画像50から検出する移動体情報Dの検出精度を高くする。 The reliability target is a target value of the detection accuracy of the moving body information D of the non-connected vehicle 7D detected by the moving body detecting unit 9B from the image 50, and the moving body detecting unit 9B is a value of the instructed reliability target. The larger the value, the higher the detection accuracy of the moving object information D detected from the image 50.

このように、信頼度制御部9Hは、接近度に応じて変化する信頼度目標を用いて、移動体検出部9Bにおける移動体情報Dの検出精度を制御する。 In this way, the reliability control unit 9H controls the detection accuracy of the moving body information D in the moving body detecting unit 9B by using the reliability target that changes according to the degree of approach.

なお、移動体検出装置9は、必ずしも撮像センサ9Aを備える必要はなく、移動体検出装置9から撮像センサ9Aだけを分離し、撮像センサ9Aを取り除いた移動体検出装置9の移動体検出部9Bに撮像センサ9Aで撮像した画像50を入力するようにしてもよい。 The moving body detection device 9 does not necessarily have to include the image pickup sensor 9A, and the moving body detection unit 9B of the moving body detection device 9 in which only the image pickup sensor 9A is separated from the moving body detection device 9 and the image pickup sensor 9A is removed. The image 50 captured by the image pickup sensor 9A may be input to the image 50.

次に、管制装置10の機能について説明する。 Next, the function of the control device 10 will be described.

図4に示すように、管制装置10は、目的地設定部11、通信部12、大域経路計画部13、干渉地点特定部15、及び仮想交通ルール生成部16の各機能部と、管制走行ルート地図17を含む。 As shown in FIG. 4, the control device 10 includes each functional unit of the destination setting unit 11, the communication unit 12, the global route planning unit 13, the interference point identification unit 15, and the virtual traffic rule generation unit 16, and the control travel route. Includes map 17.

通信部12は、遵守車両7Aから無線通信装置3を通じて移動体情報Aを受信すると共に、後述する仮想交通ルール生成部16で生成した仮想交通ルールを含む管制情報を、管制情報の送信先として指定された各々の遵守車両7Aに送信する。 The communication unit 12 receives the mobile body information A from the compliant vehicle 7A through the wireless communication device 3, and designates the control information including the virtual traffic rule generated by the virtual traffic rule generation unit 16 described later as the transmission destination of the control information. It is transmitted to each compliance vehicle 7A that has been made.

遵守車両7Aは、管制装置10によって指定された大域経路に沿って走行する車両7であるため、管制装置10が大域経路を計画する必要がある。 Since the observing vehicle 7A is a vehicle 7 traveling along the global route designated by the control device 10, it is necessary for the control device 10 to plan the global route.

そのため、目的地設定部11は、遵守車両7Aが向かおうとしている目的地と遵守車両7Aの車両固有情報を受け付け、遵守車両7Aの車両固有情報と目的地を対応付けて大域経路計画部13に通知する。 Therefore, the destination setting unit 11 receives the vehicle-specific information of the compliance vehicle 7A and the destination to which the compliance vehicle 7A is heading, and associates the vehicle-specific information of the compliance vehicle 7A with the destination to the global route planning unit 13. Notice.

遵守車両7Aの目的地及び車両固有情報は管制装置10の操作者が目的地設定部11に設定してもよいが、遵守車両7Aから目的地を含む移動体情報Aを受信し、目的地設定部11が、受信した移動体情報Aに含まれる車両固有情報と目的地を対応付けて大域経路計画部13に通知してもよい。 The destination and vehicle-specific information of the compliant vehicle 7A may be set in the destination setting unit 11 by the operator of the control device 10, but the moving body information A including the destination is received from the compliant vehicle 7A and the destination is set. The unit 11 may notify the global route planning unit 13 by associating the vehicle-specific information included in the received moving object information A with the destination.

大域経路計画部13は、目的地設定部11から受け付けた遵守車両7Aの車両固有情報と目的地、通信部12から受け付けた移動体情報Aに含まれる遵守車両7Aの位置情報と車両固有情報、及び管制走行ルート地図17に基づいて、遵守車両7A毎に管制走行ルート地図17上で遵守車両7Aの現在位置から目的地までの経路6である大域経路を探索する。すなわち大域経路は、管制走行ルート地図17を構成する各区間の経由点列をつないだ経路6として表される。 The global route planning unit 13 includes vehicle-specific information and destination of the compliant vehicle 7A received from the destination setting unit 11, position information and vehicle-specific information of the compliant vehicle 7A included in the moving body information A received from the communication unit 12. And, based on the control travel route map 17, a global route which is a route 6 from the current position of the compliance vehicle 7A to the destination is searched on the control travel route map 17 for each compliance vehicle 7A. That is, the global route is represented as a route 6 connecting the route points of each section constituting the control travel route map 17.

図11は、共に遵守車両7Aである車両P及び車両Qの大域経路の一例を示す図である。複数の経路6の中から車両Pの現在位置と車両Pの目的地をつなぐ1つの経路6Pが車両Pの大域経路として計画され、車両Qの現在位置と車両Qの目的地をつなぐ1つの経路6Qが車両Qの大域経路として計画された状況を表している。 FIG. 11 is a diagram showing an example of a global route of vehicle P and vehicle Q, both of which are compliant vehicles 7A. One route 6P connecting the current position of the vehicle P and the destination of the vehicle P is planned as a global route of the vehicle P from among the plurality of routes 6, and one route connecting the current position of the vehicle Q and the destination of the vehicle Q. 6Q represents the situation planned as the global route of vehicle Q.

大域経路計画部13における遵守車両7Aの大域経路の探索に用いる探索方法はどのような方法であってもよく、例えばダイクストラ探索といった公知の探索方法が用いられる。 The search method used in the search for the global route of the observing vehicle 7A in the global route planning unit 13 may be any method, and a known search method such as Dijkstra search is used.

大域経路計画部13は、計画した大域経路を干渉地点特定部15に通知する。 The global route planning unit 13 notifies the interference point identification unit 15 of the planned global route.

干渉地点特定部15は、大域経路計画部13から受け付けた遵守車両7Aの大域経路と、移動体検出装置9から受信した非コネクテッド車両7Dの走行経路及び移動体情報Dに基づいて、遵守車両7Aの大域経路と非コネクテッド車両7Dの走行経路が干渉する干渉地点Xを特定する。干渉地点特定部15は、特定した干渉地点Xと遵守車両7Aの大域経路を仮想交通ルール生成部16に通知する。 The interference point identification unit 15 is based on the global route of the compliant vehicle 7A received from the global route planning unit 13, the traveling route of the non-connected vehicle 7D received from the moving object detection device 9, and the moving object information D, and the observing vehicle 7A. The interference point X where the global route of the above and the traveling route of the unconnected vehicle 7D interfere with each other is specified. The interference point specifying unit 15 notifies the virtual traffic rule generation unit 16 of the identified interference point X and the global route of the observing vehicle 7A.

仮想交通ルール生成部16は、通信部12から受け付けた遵守車両7Aの移動体情報A、及び干渉地点特定部15から受け付けた遵守車両7Aの大域経路と大域経路における干渉地点Xの位置情報を用いて、遵守車両7Aに対する仮想交通ルールを生成する。 The virtual traffic rule generation unit 16 uses the moving body information A of the observing vehicle 7A received from the communication unit 12 and the position information of the interference point X in the global route and the global route of the compliant vehicle 7A received from the interference point identification unit 15. Then, a virtual traffic rule for the compliant vehicle 7A is generated.

具体的には、仮想交通ルール生成部16は、遵守車両7Aの大域経路における干渉地点Xで干渉しあう遵守車両7Aと非コネクテッド車両7Dについて、各々の干渉地点Xにおける干渉時間tを推定し、各干渉地点Xにおいて、車両7同士の交通効率を低下させることなく干渉地点Xでの車両7同士の干渉が回避されるような通過優先順位を遵守車両7Aに対して規定する。 Specifically, the virtual traffic rule generation unit 16 estimates the interference time t at each interference point X for the observing vehicle 7A and the non-connected vehicle 7D that interfere with each other at the interference point X in the global route of the observing vehicle 7A. At each interference point X, a passing priority is specified for the observing vehicle 7A so that interference between the vehicles 7 at the interference point X is avoided without deteriorating the traffic efficiency between the vehicles 7.

仮想交通ルール生成部16は、遵守車両7Aに対して大域経路と仮想交通ルールを含んだ管制情報を生成し、通信部12に対して遵守車両7Aと対応付けられた管制情報の送信依頼を行う。これにより、無線通信装置3から遵守車両7Aと対応付けられた管制情報が送信されることになる。 The virtual traffic rule generation unit 16 generates control information including the global route and the virtual traffic rule for the compliant vehicle 7A, and requests the communication unit 12 to transmit the control information associated with the compliant vehicle 7A. .. As a result, the control information associated with the compliance vehicle 7A is transmitted from the wireless communication device 3.

なお、管制走行ルート地図17は必ずしも管制装置10に含まれている必要はなく、通信網5を通じて外部装置から取得するようにしてもよい。また、仮想交通ルールについての詳細な生成方法については後ほど説明することにする。 The control travel route map 17 does not necessarily have to be included in the control device 10, and may be acquired from an external device through the communication network 5. In addition, the detailed generation method of the virtual traffic rule will be described later.

次に、移動体検出装置9、及び管制装置10における各々の電気系統の要部構成例について説明する。 Next, an example of a main part configuration of each electric system in the mobile body detection device 9 and the control device 10 will be described.

図12は、管制装置10における電気系統の要部構成例を示す図である。図12に示すように、管制装置10は例えばコンピュータ30を用いて構成される。 FIG. 12 is a diagram showing an example of a configuration of a main part of an electric system in the control device 10. As shown in FIG. 12, the control device 10 is configured by using, for example, a computer 30.

コンピュータ30は、図4に示した管制装置10に係る各機能部の処理を担うプロセッサの一例であるCPU(Central Processing Unit)31、コンピュータ30を管制装置10として機能させる管制プログラムを記憶するROM(Read Only Memory)32、CPU31の一時的な作業領域として使用されるRAM(Random Access Memory)33、不揮発性メモリ34、及び入出力インターフェース(I/O)35を備える。そして、CPU31、ROM32、RAM33、不揮発性メモリ34、及びI/O35がバス36を介して各々接続されている。 The computer 30 is a CPU (Central Processing Unit) 31 which is an example of a processor responsible for processing of each functional unit related to the control device 10 shown in FIG. 4, and a ROM (ROM) for storing a control program which causes the computer 30 to function as the control device 10. It includes a Read Only Memory) 32, a RAM (Random Access Memory) 33 used as a temporary work area of the CPU 31, a non-volatile memory 34, and an input / output interface (I / O) 35. The CPU 31, ROM 32, RAM 33, non-volatile memory 34, and I / O 35 are each connected via the bus 36.

不揮発性メモリ34は、不揮発性メモリ34に供給される電力が遮断されても、記憶したデータが維持される記憶装置の一例であり、例えば半導体メモリが用いられるが、ハードディスクを用いてもよい。また、不揮発性メモリ34は、必ずしもコンピュータ30に内蔵されている必要はなく、例えばUSB(Universal Serial Bus)メモリやメモリカードのようにコンピュータ30に着脱可能な可搬型の記憶媒体を用いてもよい。管制走行ルート地図17は、例えば不揮発性メモリ34に記憶される。 The non-volatile memory 34 is an example of a storage device in which the stored data is maintained even if the power supplied to the non-volatile memory 34 is cut off. For example, a semiconductor memory is used, but a hard disk may be used. Further, the non-volatile memory 34 does not necessarily have to be built in the computer 30, and a portable storage medium that can be attached to and detached from the computer 30 such as a USB (Universal Serial Bus) memory or a memory card may be used. .. The control travel route map 17 is stored in, for example, the non-volatile memory 34.

I/O35には、例えば通信ユニット37、入力ユニット38、及び表示ユニット39が接続される。 For example, a communication unit 37, an input unit 38, and a display unit 39 are connected to the I / O 35.

通信ユニット37は通信網5に接続され、無線通信装置3及び移動体検出装置9や、通信網5と接続された外部装置との間でデータ通信を行う通信プロトコルを備える。 The communication unit 37 is connected to the communication network 5 and includes a communication protocol for performing data communication between the wireless communication device 3 and the mobile detection device 9, and an external device connected to the communication network 5.

入力ユニット38は、管制装置10の操作者からの指示を受け付けてCPU31に通知するユニットであり、例えばボタン、タッチパネル、キーボード、及びマウス等が用いられる。指示が音声で行われる場合には、入力ユニット38としてマイクが用いられることがある。 The input unit 38 is a unit that receives an instruction from the operator of the control device 10 and notifies the CPU 31, for example, a button, a touch panel, a keyboard, a mouse, and the like are used. When the instruction is given by voice, a microphone may be used as the input unit 38.

表示ユニット39は、CPU31によって処理された情報を表示する装置であり、例えば液晶ディスプレイ、有機EL(Electro Luminescence)ディスプレイ、及びプロジェクタ等が用いられる。 The display unit 39 is a device that displays information processed by the CPU 31, and for example, a liquid crystal display, an organic EL (Electro Luminescence) display, a projector, or the like is used.

管制装置10が無人のデータセンター等に設置されている場合のように情報の表示を必要としない状況では、表示ユニット39がI/O35に接続されないこともある。また、必要に応じてプリンタユニットのような他のユニットをI/O35に接続してもよい。 In a situation where information display is not required, such as when the control device 10 is installed in an unmanned data center or the like, the display unit 39 may not be connected to the I / O 35. Further, another unit such as a printer unit may be connected to the I / O 35 as needed.

図13は、移動体検出装置9における電気系統の要部構成例を示す図である。図13に示すように、移動体検出装置9は例えばコンピュータ40を用いて構成される。 FIG. 13 is a diagram showing an example of a main part configuration of an electric system in the mobile body detection device 9. As shown in FIG. 13, the mobile body detection device 9 is configured by using, for example, a computer 40.

コンピュータ40は、図4に示した移動体検出装置9に係る各機能部の処理を担うプロセッサの一例であるCPU41、コンピュータ40を移動体検出装置9として機能させる検出プログラムを記憶するROM42、CPU41の一時的な作業領域として使用されるRAM43、不揮発性メモリ44、並びに、撮像センサ9A及び通信ユニット9Jが接続されたI/O45を備える。そして、CPU41、ROM42、RAM43、不揮発性メモリ44、及びI/O45がバス46を介して各々接続されている。 The computer 40 is a CPU 41 which is an example of a processor which handles processing of each functional unit related to the mobile body detection device 9 shown in FIG. 4, a ROM 42 which stores a detection program which causes the computer 40 to function as the mobile body detection device 9, and a CPU 41. It includes a RAM 43 used as a temporary work area, a non-volatile memory 44, and an I / O 45 to which an image pickup sensor 9A and a communication unit 9J are connected. The CPU 41, ROM 42, RAM 43, non-volatile memory 44, and I / O 45 are each connected via the bus 46.

通信ユニット9Jは通信網5に接続され、管制装置10や通信網5と接続された外部装置との間でデータ通信を行う通信プロトコルを備える。 The communication unit 9J is connected to the communication network 5 and includes a communication protocol for performing data communication between the control device 10 and the communication network 5 and the connected external device.

図14は、遵守車両7Aの制御装置20における電気系統の要部構成例を示す図である。遵守車両7Aの制御装置20も移動体検出装置9や管制装置10と同様に、例えばコンピュータ80を用いて構成される。 FIG. 14 is a diagram showing an example of a configuration of a main part of an electric system in the control device 20 of the compliant vehicle 7A. The control device 20 of the compliant vehicle 7A is also configured by using, for example, a computer 80, like the moving body detection device 9 and the control device 10.

コンピュータ80は、図2に示した遵守車両7Aの制御装置20に係る各機能部の処理を担うプロセッサの一例であるCPU81、コンピュータ80を遵守車両7Aの制御装置20として機能させる制御プログラムを記憶するROM82、CPU81の一時的な作業領域として使用されるRAM83、不揮発性メモリ84、及びI/O85を備える。そして、CPU81、ROM82、RAM83、不揮発性メモリ84、及びI/O85がバス86を介して各々接続されている。 The computer 80 stores a CPU 81, which is an example of a processor that handles processing of each functional unit related to the control device 20 of the compliant vehicle 7A shown in FIG. 2, and a control program that causes the computer 80 to function as the control device 20 of the compliant vehicle 7A. The ROM 82, the RAM 83 used as a temporary work area of the CPU 81, the non-volatile memory 84, and the I / O 85 are provided. The CPU 81, ROM 82, RAM 83, non-volatile memory 84, and I / O 85 are each connected via the bus 86.

I/O85には、例えば通信ユニット87、入力ユニット88、表示ユニット89、内界センサ90、外界センサ91、及び走行装置92が接続される。 For example, a communication unit 87, an input unit 88, a display unit 89, an internal sensor 90, an external sensor 91, and a traveling device 92 are connected to the I / O 85.

通信ユニット87は無線通信装置3との間でデータ通信を行う通信プロトコルを備える。 The communication unit 87 includes a communication protocol for performing data communication with the wireless communication device 3.

入力ユニット88は、遵守車両7Aの運転手からの指示を受け付けてCPU81に通知するユニットであり、例えばボタン、タッチパネル、及びポインティングデバイス等が用いられる。指示が音声で行われる場合には、入力ユニット88としてマイクが用いられることがある。 The input unit 88 is a unit that receives an instruction from the driver of the compliant vehicle 7A and notifies the CPU 81, and for example, a button, a touch panel, a pointing device, or the like is used. When the instruction is given by voice, a microphone may be used as the input unit 88.

表示ユニット89は、CPU81によって処理された情報を表示する装置であり、例えば液晶ディスプレイ、有機ELディスプレイ、及びプロジェクタ等が用いられる。 The display unit 89 is a device that displays information processed by the CPU 81, and for example, a liquid crystal display, an organic EL display, a projector, or the like is used.

走行装置92は、CPU81の指示に従い、例えばハンドル、アクセル、及びブレーキのように遵守車両7Aの走行状態に影響を与える操作装置の操作量を調整する装置であると共に、操作装置の操作量を遵守車両7Aの状態としてCPU81に通知する。内界センサ90及び外界センサ91の機能については、既に説明した通りである。 The traveling device 92 is a device that adjusts the operating amount of an operating device that affects the traveling state of the observing vehicle 7A, such as a steering wheel, an accelerator, and a brake, according to the instruction of the CPU 81, and also complies with the operating amount of the operating device. Notify the CPU 81 of the status of the vehicle 7A. The functions of the inner world sensor 90 and the outer world sensor 91 are as described above.

次に、車両7の交通管制を行う管制装置10の動作について説明する。 Next, the operation of the control device 10 for controlling the traffic of the vehicle 7 will be described.

図15は、各車両7から移動体情報を受け付けた場合に、管制装置10のCPU31によって実行される管制処理の流れの一例を示すフローチャートである。 FIG. 15 is a flowchart showing an example of the flow of control processing executed by the CPU 31 of the control device 10 when the moving body information is received from each vehicle 7.

管制処理を規定する管制プログラムは、例えば管制装置10のROM32に予め記憶されている。管制装置10のCPU31は、ROM32に記憶される管制プログラムを読み込み、管制処理を実行する。 The control program that defines the control process is stored in advance in, for example, the ROM 32 of the control device 10. The CPU 31 of the control device 10 reads the control program stored in the ROM 32 and executes the control process.

なお、以降では説明の便宜上、2台の車両7(車両P及び車両Q)に注目して管制装置10の動作について説明するが、管制対象となる車両7が3台以上の場合であっても、各々の車両7について同様の処理を行えばよい。また、一例として、車両P及び車両Qの少なくとも一方は遵守車両7Aとする。 In the following, for convenience of explanation, the operation of the control device 10 will be described by focusing on two vehicles 7 (vehicle P and vehicle Q), but even when the number of vehicles 7 to be controlled is three or more. , The same processing may be performed for each vehicle 7. Further, as an example, at least one of the vehicle P and the vehicle Q is a compliant vehicle 7A.

ステップS10において、CPU31は、受け付けた移動体情報の内容に基づいて、車両P及び車両Qの種類を判定する。例えばCPU31は、無線通信装置3から受信した移動体情報Aに対応する車両7は遵守車両7Aであると判定すればよい。また、CPU31は、移動体検出装置9から受信した移動体情報Dに対応する車両7は非コネクテッド車両7Dであると判定すればよい。 In step S10, the CPU 31 determines the types of the vehicle P and the vehicle Q based on the contents of the received moving body information. For example, the CPU 31 may determine that the vehicle 7 corresponding to the mobile information A received from the wireless communication device 3 is a compliant vehicle 7A. Further, the CPU 31 may determine that the vehicle 7 corresponding to the moving body information D received from the moving body detection device 9 is a non-connected vehicle 7D.

なお、CPU31は、移動体情報Dと共に移動体検出装置9から非コネクテッド車両7Dの走行経路を受信する。 The CPU 31 receives the traveling path of the non-connected vehicle 7D from the moving body detection device 9 together with the moving body information D.

ステップS20において、CPU31は、遵守車両7Aから受信した移動体情報Aに含まれる車両7の位置情報と遵守車両7Aの目的地に基づいて、遵守車両7Aの大域経路を生成する。 In step S20, the CPU 31 generates a global route of the compliant vehicle 7A based on the position information of the vehicle 7 included in the moving body information A received from the compliant vehicle 7A and the destination of the compliant vehicle 7A.

ステップS30において、CPU31は、車両Pの経路6を示す経由点4が、車両Qの経路6を示す経由点4から干渉範囲以内まで接近するような地点、すなわち車両Pと車両Qの干渉地点Xを特定する。具体的には、CPU31は、車両Pの大域経路若しくは走行経路(単に「車両Pの経路6」という)と、車両Qの大域経路若しくは走行経路(単に「車両Qの経路6」という)が交差または合流する地点の経由点4や、車両Pの経路6と車両Qの経路6が干渉範囲以内まで接近して並走するような領域の経由点4を、車両Pと車両Qの干渉地点Xとして特定する。 In step S30, the CPU 31 determines a point where the waypoint 4 indicating the route 6 of the vehicle P approaches within the interference range from the waypoint 4 indicating the route 6 of the vehicle Q, that is, an interference point X between the vehicle P and the vehicle Q. To identify. Specifically, in the CPU 31, the global route or travel route of vehicle P (simply referred to as "route 6 of vehicle P") and the global route or travel route of vehicle Q (simply referred to as "route 6 of vehicle Q") intersect. Alternatively, the waypoint 4 at the point where the vehicle P and the vehicle Q interfere with each other, or the waypoint 4 in the area where the route 6 of the vehicle P and the route 6 of the vehicle Q approach each other within the interference range and run in parallel. Specify as.

その上で、CPU31は、車両P及び車両Qの何れか一方の経路6が移動体検出装置9から取得した非コネクテッド車両7Dの走行経路である場合、特定した干渉地点Xを移動体検出装置9に送信する。 Further, when the path 6 of either the vehicle P or the vehicle Q is the travel path of the non-connected vehicle 7D acquired from the mobile body detection device 9, the CPU 31 determines the specified interference point X as the mobile body detection device 9. Send to.

なお、図7に示したような干渉地点情報を参照することができる場合、CPU31は、車両Pと車両Qの各々の経路6に、干渉地点情報で干渉地点Xとして設定されている同一の経由点が含まれていれば、当該経由点4によって表される地点を車両Pと車両Qの干渉地点Xとしてもよい。 When the interference point information as shown in FIG. 7 can be referred to, the CPU 31 performs the same route set as the interference point X in the interference point information on each route 6 of the vehicle P and the vehicle Q. If the point is included, the point represented by the waypoint 4 may be the interference point X between the vehicle P and the vehicle Q.

ステップS40において、CPU31は、ステップS30で特定した車両Pと車両Qの各干渉地点Xについて、車両Pと車両Qの移動体情報を用いて車両Pと車両Qの干渉時間tを算出する。 In step S40, the CPU 31 calculates the interference time t between the vehicle P and the vehicle Q for each interference point X between the vehicle P and the vehicle Q specified in step S30, using the moving body information of the vehicle P and the vehicle Q.

干渉時間tは、車両P及び車両Qのそれぞれの現在位置から干渉地点Xまでの経路6に沿った距離(以降、「干渉地点Xまでの距離」という)と、車両P及び車両Qのそれぞれの速度から算出することができる。しかしながら、既に説明したように、移動体検出装置9が画像50から算出した非コネクテッド車両7Dの位置及び速度には検出誤差が含まれる。また、遵守車両7Aであっても交通事情等により一定の速度で走行することはできないため、実際には車両P及び車両Qの速度は変動し、速度から推定される各時刻における予想位置も変動する。 The interference time t is the distance along the route 6 from the current position of each of the vehicle P and the vehicle Q to the interference point X (hereinafter referred to as "distance to the interference point X") and each of the vehicle P and the vehicle Q. It can be calculated from the speed. However, as already described, the position and speed of the unconnected vehicle 7D calculated by the moving object detection device 9 from the image 50 include a detection error. In addition, even the compliant vehicle 7A cannot travel at a constant speed due to traffic conditions, etc., so the speeds of the vehicle P and the vehicle Q actually fluctuate, and the predicted position at each time estimated from the speed also fluctuates. do.

したがって、“v”を車両P及び車両Qにおけるそれぞれの速度、“l”を干渉地点Xまでの距離、“δ1”及び“δ2”を車両P及び車両Qの速度変化に対応する正数のマージン、“ε”を他の値よりも0に近い正定数とすれば、車両P及び車両Qの速度の変動量を考慮した干渉地点Xにおける干渉時間tは(1)式で算出される。 Therefore, "v" is the respective speeds of the vehicle P and the vehicle Q, "l" is the distance to the interference point X, and "δ 1 " and "δ 2 " are positive numbers corresponding to the speed changes of the vehicle P and the vehicle Q. If the margin of "ε" is a positive constant closer to 0 than other values, the interference time t at the interference point X in consideration of the fluctuation amount of the speed of the vehicle P and the vehicle Q is calculated by the equation (1). ..

Figure 2022071594000002
Figure 2022071594000002

なお、tbeginは車両P及び車両Qが最も早く干渉地点Xを通過する場合の時刻であり、tendは、車両P及び車両Qが最も遅く干渉地点Xを通過する場合の時刻である。このように、車両P及び車両Qの干渉地点Xにおける干渉時間tは、tbegin以上tend未満の期間で表される。以降では、車両Pの干渉地点Xにおける干渉時間tを「干渉時間tp」と表し、車両Qの干渉地点Xにおける干渉時間tを「干渉時間tq」と表す。また、tbeginを干渉時間tの開始時間といい、tendを干渉時間tの終了時間という。 Note that t begin is the time when the vehicle P and the vehicle Q pass the interference point X earliest, and t end is the time when the vehicle P and the vehicle Q pass the interference point X the latest. As described above, the interference time t at the interference point X of the vehicle P and the vehicle Q is represented by a period of t begin or more and less than t end . Hereinafter, the interference time t at the interference point X of the vehicle P is referred to as “interference time t p ”, and the interference time t at the interference point X of the vehicle Q is referred to as “interference time t q ”. Further, t begin is referred to as a start time of the interference time t, and t end is referred to as an end time of the interference time t.

図16は、特定の干渉地点Xに対する車両Pの干渉時間tpと、車両Qの干渉時間tqの一例を示す図である。 FIG. 16 is a diagram showing an example of the interference time t p of the vehicle P and the interference time t q of the vehicle Q with respect to the specific interference point X.

このようにして、CPU31は干渉地点Xについて、車両Pの干渉時間tp及び車両Qの干渉時間tqを算出する。 In this way, the CPU 31 calculates the interference time t p of the vehicle P and the interference time t q of the vehicle Q for the interference point X.

ステップS50において、CPU31は、ステップS30で特定した車両Pと車両Qの干渉地点Xにおける通過優先順位を設定する。 In step S50, the CPU 31 sets the passage priority at the interference point X between the vehicle P and the vehicle Q specified in step S30.

通過優先順位が上、すなわち通過優先順位が優先に設定された車両7は、干渉地点Xを優先的に通過することができ、通過優先順位が下、すなわち通過優先順位が非優先に設定された車両7は、通過優先順位が優先に設定された車両7の干渉地点Xにおける干渉時間tの間は、当該干渉地点Xに進入しないようにする制約が設定される。 The vehicle 7 having a higher passing priority, that is, a passing priority set to be prioritized, can pass the interference point X preferentially, and has a lower passing priority, that is, a passing priority is set to non-priority. The vehicle 7 is set with a constraint not to enter the interference point X during the interference time t at the interference point X of the vehicle 7 whose passage priority is set to be prioritized.

このように、干渉地点Xにおける通過優先順位と干渉時間tを対応付け、車両Pと車両Qが走行することができる時間と場所を制約することで、干渉地点Xにおいて車両Pと車両Qの干渉が回避されることになる。 In this way, by associating the passage priority with the interference time t at the interference point X and limiting the time and place where the vehicle P and the vehicle Q can travel, the interference between the vehicle P and the vehicle Q at the interference point X is restricted. Will be avoided.

干渉地点Xにおける通過優先順位と、通過優先順位が優先に設定された車両7の干渉時間tの対応付け、すなわち通過優先順位が非優先に設定された車両7にとっての干渉地点Xへの進入禁止時間が仮想交通ルールとなる。仮想交通ルールは、車両7が干渉地点Xで他の車両7と干渉しないように、干渉時間tと干渉地点Xの位置情報を用いて車両7が走行することができる時間と場所を制約することから時空間制約の一例である。 Correspondence between the passage priority at the interference point X and the interference time t of the vehicle 7 whose passage priority is set to priority, that is, the vehicle 7 whose passage priority is set to non-priority is prohibited from entering the interference point X. Time becomes a virtual traffic rule. The virtual traffic rule limits the time and place where the vehicle 7 can travel by using the interference time t and the position information of the interference point X so that the vehicle 7 does not interfere with another vehicle 7 at the interference point X. This is an example of spatiotemporal constraints.

以降では、干渉地点Xにおいて通過優先順位が優先に設定されているのか、それとも非優先に設定されているのかを表す状態を“sx”で表す。干渉地点Xにおける状態sxは“0”または“1”の値をとり、CPU31は、干渉地点Xにおいて車両Pが優先の場合には状態sx=0に設定し、車両Qが優先の場合には状態sx=1に設定する。 Hereinafter, the state indicating whether the passage priority is set to priority or non-priority at the interference point X is represented by “s x ”. The state s x at the interference point X takes a value of "0" or "1", and the CPU 31 sets the state s x = 0 when the vehicle P has priority at the interference point X, and when the vehicle Q has priority. Is set to the state s x = 1.

図17は、状態sx=0に設定された干渉地点Xでの仮想交通ルールを模式化した模式図である。 FIG. 17 is a schematic diagram schematically showing a virtual traffic rule at the interference point X in which the state s x = 0 is set.

この場合、車両Pの干渉時間tpがtp begin以上tp end未満までの期間で表されるとすれば、車両Pは、干渉時間tpの間は干渉地点Xを車両Qに優先して通過することができる。しかしながら、車両Qは、干渉時間tpに干渉地点Xに進入すると車両Pと干渉する恐れがあるため、干渉時間tpの間は干渉地点Xへ進入しないようにする必要がある。 In this case, if the interference time t p of the vehicle P is represented by a period from t p begin or more to less than t p end , the vehicle P gives priority to the interference point X over the vehicle Q during the interference time t p . Can pass through. However, if the vehicle Q enters the interference point X at the interference time t p , it may interfere with the vehicle P. Therefore, it is necessary to prevent the vehicle Q from entering the interference point X during the interference time t p .

一方、図18は、状態sx=1に設定された干渉地点Xでの仮想交通ルールを模式化した模式図である。 On the other hand, FIG. 18 is a schematic diagram schematically showing a virtual traffic rule at the interference point X set in the state s x = 1.

この場合、車両Qの干渉時間tqがtq begin以上tq end未満までの期間で表されるとすれば、車両Qは、干渉時間tqの間は干渉地点Xを車両Pに優先して通過することができる。しかしながら、車両Pは、干渉時間tqに干渉地点Xに進入すると車両Qと干渉する恐れがあるため、干渉時間tqの間は干渉地点Xへ進入しないようにする必要がある。 In this case, if the interference time t q of the vehicle Q is represented by the period from t q begin to less than t q end , the vehicle Q gives priority to the interference point X over the vehicle P during the interference time t q . Can pass through. However, if the vehicle P enters the interference point X at the interference time t q , it may interfere with the vehicle Q. Therefore, it is necessary to prevent the vehicle P from entering the interference point X during the interference time t q .

すなわち干渉地点Xでの通過優先順位が非優先に設定された車両7は、同じ干渉地点Xにおいて通過優先順位が優先に設定された車両7の干渉時間tに当該干渉地点Xへ進入しないようにすれば、車両7同士の干渉を回避して目的地まで到達することができる。 That is, the vehicle 7 whose passage priority is set to non-priority at the interference point X does not enter the interference point X during the interference time t of the vehicle 7 whose passage priority is set to be prioritized at the same interference point X. Then, it is possible to avoid the interference between the vehicles 7 and reach the destination.

このように、仮想交通ルールは、干渉地点Xにおける状態sxと干渉地点Xにおける進入禁止時間(干渉地点Xにおいて通過優先順位が優先に設定されている車両7の干渉時間t)の組み合わせを干渉地点X毎に設定した情報によって表される。 In this way, the virtual traffic rule interferes with the combination of the state s x at the interference point X and the entry prohibition time at the interference point X (interference time t of the vehicle 7 whose passage priority is set to be prioritized at the interference point X). It is represented by the information set for each point X.

干渉地点Xにおいて、車両P及び車両Qの通過優先順位をどのように決定するかは、目的関数C(S)を評価することによって行われる。 How to determine the passage priority of the vehicle P and the vehicle Q at the interference point X is performed by evaluating the objective function C (S).

目的関数C(S)は干渉地点Xで干渉する車両7の種類の組み合わせ毎に予め用意されており、不揮発性メモリ34に記憶される。CPU31は、ステップS10で判定した車両P及び車両Qの種類の組み合わせに対応した目的関数C(S)を用いて、車両P及び車両Qの通過優先順位を決定する。目的関数C(S)は、車両7が移動することによって発生する交通コストを表す関数である。交通コストとは、個々の車両7に対するコストだけでなく、車両7が走行することで他の車両7の走行に与える影響も加味したコストであり、車両7の交通効率を表す。 The objective function C (S) is prepared in advance for each combination of types of vehicles 7 that interfere at the interference point X, and is stored in the non-volatile memory 34. The CPU 31 determines the passing priority of the vehicle P and the vehicle Q by using the objective function C (S) corresponding to the combination of the types of the vehicle P and the vehicle Q determined in step S10. The objective function C (S) is a function representing the traffic cost generated by the movement of the vehicle 7. The traffic cost is a cost that takes into account not only the cost for each vehicle 7 but also the influence that the vehicle 7 travels on the travel of other vehicles 7, and represents the traffic efficiency of the vehicle 7.

したがって、CPU31は、目的関数C(S)が最小となるような状態ベクトルSを設定する。目的関数C(S)が最小になれば交通コストも最小となるため、管制システム1が管制を行う範囲の交通効率が向上する。 Therefore, the CPU 31 sets the state vector S so that the objective function C (S) is minimized. If the objective function C (S) is minimized, the traffic cost is also minimized, so that the traffic efficiency within the range controlled by the control system 1 is improved.

なお、目的関数C(S)における状態ベクトルSは、管制システム1が管理する範囲内に車両Pと車両Qの干渉地点XがN地点(Nは正の整数)ある場合において、各干渉地点Xにおける状態sxを要素としたベクトルである。すなわち状態ベクトルSはS=(s1, s2,・・, si,・・,sN)で表される。 The state vector S in the objective function C (S) is the interference point X when the interference points X between the vehicle P and the vehicle Q are N points (N is a positive integer) within the range managed by the control system 1. It is a vector whose element is the state s x in. That is, the state vector S is represented by S = (s 1 , s 2 , ..., si , ···, s N ).

ここでは一例として、車両Pが遵守車両7Aで、車両Qが非コネクテッド車両7Dである場合の干渉地点Xにおける通過優先順位の決定方法について説明する。 Here, as an example, a method of determining the passage priority at the interference point X when the vehicle P is the compliant vehicle 7A and the vehicle Q is the non-connected vehicle 7D will be described.

この場合、CPU31は、例えば(2)式で表されるような目的関数C2(S)を用いる。 In this case, the CPU 31 uses the objective function C2 (S) as represented by the equation (2), for example.

Figure 2022071594000003
Figure 2022071594000003

ここで、Csingle(S)は、各干渉地点Xを通過する車両P及び車両Qに対する管制制御を特徴付けるコストである。Cconsistency(S)は、車両P及び車両Qに設定される通過優先順位の時間方向の一貫性に関するコストである。Cmulti(S)は、干渉地点X間の整合性や相互作用に関するコストである。ωc及びωmは、目的関数C2(S)に対してCconsistency(S)、及びCmulti(S)が与える影響度を調整するための重みである。 Here, C single (S) is a cost that characterizes the control control for the vehicle P and the vehicle Q passing through each interference point X. C consistency (S) is a cost related to the temporal consistency of the passing priority set for the vehicle P and the vehicle Q. C multi (S) is a cost related to consistency and interaction between interference points X. ω c and ω m are weights for adjusting the degree of influence of C consistency (S) and C multi (S) on the objective function C2 (S).

func1(S)は、車両Qが干渉地点Xに近い位置にいる場合において、車両Qの通過優先順位と干渉回避の妥当性を表したコストであり、(3)式及び(4)式で表される。 C func1 (S) is a cost showing the passage priority of the vehicle Q and the validity of avoiding the interference when the vehicle Q is near the interference point X, and is expressed in the equations (3) and (4). expressed.

Figure 2022071594000004
Figure 2022071594000004

すなわち車両Qが干渉地点Xから離れている場合には、干渉地点Xにおける干渉時間tが早い車両7を優先的に通過させるとコストが低く設定される一方で、管制装置10によって交通管制を行うことができない車両Qが干渉地点Xに近づいている場合には、車両Qの通過を優先させるとコストが低く設定される。これは、車両Qが干渉地点Xに近づいている場合には、運転手が手動で運転している車両Qの通過を優先させた方が、遵守車両7Aである車両Pを優先させた場合よりも干渉を回避することができる可能性が高くなるためである。車両Qが干渉地点Xに近い位置にいるとは、干渉地点Xから車両Qまでの距離lqが、手動運転では干渉の回避に急な操作が必要になると考えられる予め定めた閾値D1以下になっている状況をいう。また、(2)式においてωf1は、目的関数C2(S)に対してCfunc1(S)が与える影響度を調整するための重みである。 That is, when the vehicle Q is far from the interference point X, the cost is set low if the vehicle 7 having the earlier interference time t at the interference point X is preferentially passed, while the traffic control is performed by the control device 10. When the vehicle Q that cannot be used is approaching the interference point X, the cost is set low if the passage of the vehicle Q is prioritized. This is because when the vehicle Q is approaching the interference point X, giving priority to the passage of the vehicle Q manually driven by the driver gives priority to the vehicle P which is the compliant vehicle 7A. This is because there is a high possibility that interference can be avoided. The fact that the vehicle Q is close to the interference point X means that the distance l q from the interference point X to the vehicle Q is equal to or less than a predetermined threshold value D 1 in which it is considered that a sudden operation is required to avoid the interference in manual operation. It means the situation that has become. Further, in the equation (2), ω f1 is a weight for adjusting the degree of influence of C func1 (S) on the objective function C2 (S).

なお、非コネクテッド車両7Dの場合、移動体情報Dは移動体検出装置9の撮像センサ9Aで撮像された画像50から推定され、撮像センサ9Aの画素には解像度の違いが発生している。したがって、移動体情報Dから算出した干渉地点Xにおける非コネクテッド車両7Dの干渉時間tは、移動体情報Aから算出した遵守車両7Aの干渉時間tよりも誤差が大きくなる傾向を示す。 In the case of the non-connected vehicle 7D, the moving body information D is estimated from the image 50 captured by the image pickup sensor 9A of the moving body detection device 9, and the pixels of the image pickup sensor 9A have different resolutions. Therefore, the interference time t of the non-connected vehicle 7D at the interference point X calculated from the mobile body information D tends to have a larger error than the interference time t of the observing vehicle 7A calculated from the mobile body information A.

そこで、(2)式のCsingle(S)の代わりに、Csingle(S)を修正したC^ single(S)を用いてもよい。C^ single(S)は(5)式で表される。 Therefore, instead of C single (S) in Eq. (2), C ^ single (S) modified from C single (S) may be used. C ^ single (S) is expressed by equation (5).

Figure 2022071594000005
Figure 2022071594000005

ここで、σは移動体情報Dを用いて算出した非コネクテッド車両7Dにおける干渉時間tの予測誤差であり正数で表される。すなわち移動体情報Dを用いて非コネクテッド車両7Dが最も早く干渉地点Xを通過する時刻として算出した時刻tq beginよりも更に予測誤差σだけ早く干渉地点Xを通過しても、また、非コネクテッド車両7Dが最も遅く干渉地点Xを通過する時刻として算出したtq endよりも更に予測誤差σだけ遅く干渉地点Xを通過しても車両P及び車両Qが干渉しないように、当初算出した干渉時間tよりも更に幅を持たせた干渉時間tに基づいて、Csingle(S)を補正する。 Here, σ is a prediction error of the interference time t in the unconnected vehicle 7D calculated by using the mobile body information D, and is represented by a positive number. That is, even if the unconnected vehicle 7D passes through the interference point X earlier by the prediction error σ than the time t q begin calculated as the time when the unconnected vehicle 7D passes the interference point X earliest using the moving object information D, the unconnected vehicle also passes through the interference point X. The initially calculated interference time so that the vehicle P and the vehicle Q do not interfere with each other even if the vehicle 7D passes through the interference point X later than the t q end calculated as the time when the vehicle 7D passes the interference point X at the latest. The C single (S) is corrected based on the interference time t having a wider width than t.

図15のステップS60において、CPU31は遵守車両7Aに対して、ステップS30で特定した車両Pと車両Qの干渉地点X、ステップS40で算出した各干渉地点Xにおける干渉時間t、及びステップS50で設定した各干渉地点Xにおける状態sxを用いて仮想交通ルールを生成する。具体的には、CPU31は、各干渉地点Xの位置を表す位置情報(例えば干渉地点ID)と、各干渉地点Xにおける状態sxと、状態sx及び干渉時間tから得られる各干渉地点Xへの進入禁止時間を対応付けた仮想交通ルールを生成する。 In step S60 of FIG. 15, the CPU 31 sets the interference point X between the vehicle P and the vehicle Q specified in step S30, the interference time t at each interference point X calculated in step S40, and step S50 with respect to the compliant vehicle 7A. A virtual traffic rule is generated using the state s x at each interference point X. Specifically, the CPU 31 receives position information (for example, an interference point ID) representing the position of each interference point X, a state s x at each interference point X, a state s x , and each interference point X obtained from the interference time t. Generate a virtual traffic rule associated with the no-entry time.

ステップS70において、CPU31は、大域経路及び仮想交通ルールを含む管制情報を生成し、生成した管制情報を、無線通信装置3を通じて遵守車両7Aに送信する制御を行う。 In step S70, the CPU 31 generates control information including the global route and the virtual traffic rule, and controls the generated control information to be transmitted to the observing vehicle 7A through the wireless communication device 3.

この場合、CPU31は、最新の移動体情報Aから遵守車両7Aの位置を把握し、遵守車両7Aの現在位置に最も近い無線通信装置3から管制情報が送信されるように、管制情報を送信する無線通信装置3を指定する。無線通信装置3の位置情報は、例えば不揮発性メモリ34に予め記憶されている。以上により、図15に示した管制処理を終了する。 In this case, the CPU 31 grasps the position of the compliant vehicle 7A from the latest mobile information A, and transmits the control information so that the control information is transmitted from the wireless communication device 3 closest to the current position of the compliant vehicle 7A. The wireless communication device 3 is designated. The position information of the wireless communication device 3 is stored in advance in, for example, the non-volatile memory 34. As a result, the control process shown in FIG. 15 is completed.

一方、図19は、管制装置10から管制情報を受信した場合に、遵守車両7Aの制御装置20におけるCPU81によって実行される走行制御処理の流れの一例を示すフローチャートである。 On the other hand, FIG. 19 is a flowchart showing an example of a flow of traveling control processing executed by the CPU 81 in the control device 20 of the compliant vehicle 7A when the control information is received from the control device 10.

遵守車両7Aの走行制御処理を規定する制御プログラムは、例えば遵守車両7Aの制御装置20におけるROM82に予め記憶されている。遵守車両7Aの制御装置20におけるCPU81は、ROM82に記憶される制御プログラムを読み込み、遵守車両7Aの走行制御処理を実行する。 The control program that defines the travel control process of the compliant vehicle 7A is stored in advance in, for example, the ROM 82 in the control device 20 of the compliant vehicle 7A. The CPU 81 in the control device 20 of the compliant vehicle 7A reads the control program stored in the ROM 82 and executes the traveling control process of the compliant vehicle 7A.

ステップS100において、CPU81は、自身の遵守車両7Aにおける最新の位置情報を取得する。 In step S100, the CPU 81 acquires the latest position information on its own compliant vehicle 7A.

ステップS110において、CPU81は、自身の遵守車両7Aにおける最新の移動体情報を取得する。 In step S110, the CPU 81 acquires the latest moving object information in its own compliant vehicle 7A.

ステップS120において、CPU81は、ステップS100で取得した遵守車両7Aの位置情報、ステップS110で取得した遵守車両7Aの移動体情報A、及び管制装置10から受信した管制情報を用いて局所経路を生成する。 In step S120, the CPU 81 generates a local route using the position information of the observing vehicle 7A acquired in step S100, the moving body information A of the observing vehicle 7A acquired in step S110, and the control information received from the control device 10. ..

具体的には、CPU81は、移動体情報Aに含まれる車線8上の状況を表す外界センサ91のセンサ値や、遵守車両7Aの状態を表す内界センサ90のセンサ値から、他の車両7と干渉しないように走行することができる大域経路に沿った実経路、すなわち局所経路を決定する。この際、CPU81は、管制情報に含まれる仮想交通ルールを参照して、非優先に設定されている干渉地点Xでは干渉地点Xと対応付けられている進入禁止時間に当該干渉地点Xへ進入しないような局所経路を遵守車両7Aが走行するように、目標位置、目標姿勢、及び目標速度といった遵守車両7Aの制御内容を決定する。 Specifically, the CPU 81 determines the other vehicle 7 from the sensor value of the outside world sensor 91 indicating the situation on the lane 8 included in the moving object information A and the sensor value of the inside world sensor 90 indicating the state of the observing vehicle 7A. Determine the actual route, that is, the local route, along the global route that can be traveled so as not to interfere with. At this time, the CPU 81 does not enter the interference point X during the entry prohibition time associated with the interference point X at the interference point X set to be non-priority with reference to the virtual traffic rule included in the control information. The control contents of the observing vehicle 7A such as the target position, the target attitude, and the target speed are determined so that the observing vehicle 7A travels on such a local route.

CPU81は、遵守車両7Aの目標位置及び目標姿勢から局所経路を計算した上で、仮想交通ルールを満たすように遵守車両7Aが局所経路を走行するための目標速度を計算してもよい。また、CPU81は、遵守車両7Aの目標位置、目標姿勢、及び目標速度を一緒に計算してもよい。 The CPU 81 may calculate the local route from the target position and the target posture of the observing vehicle 7A, and then calculate the target speed for the observing vehicle 7A to travel on the local route so as to satisfy the virtual traffic rule. Further, the CPU 81 may calculate the target position, the target posture, and the target speed of the compliant vehicle 7A together.

CPU81は、局所経路をパラメトリック曲線で表現し、パラメトリック曲線の曲率やパラメトリック曲線上を安全に走行することのできる速度等の制約条件を満たすようにパラメトリック曲線を最適化してもよい。 The CPU 81 may represent a local route as a parametric curve, and may optimize the parametric curve so as to satisfy constraints such as the curvature of the parametric curve and the speed at which the vehicle can safely travel on the parametric curve.

ステップS130において、CPU81は、ステップS120で生成した局所経路に沿って遵守車両7Aを移動させるための制御内容に従い、例えばハンドル、アクセル、ブレーキといった遵守車両7Aの走行を制御する走行装置の操作量を制御し、計画した局所経路通りに遵守車両7Aを走行させる。 In step S130, the CPU 81 controls the operation amount of the traveling device that controls the traveling of the compliant vehicle 7A such as the steering wheel, the accelerator, and the brake according to the control content for moving the compliant vehicle 7A along the local route generated in step S120. Control and drive the compliance vehicle 7A according to the planned local route.

以上により、図19に示す遵守車両7Aの走行制御処理を終了する。 As a result, the traveling control process of the compliant vehicle 7A shown in FIG. 19 is completed.

次に、移動体検出装置9の機能について説明する。 Next, the function of the moving body detection device 9 will be described.

図20は、撮像センサ9Aで画像50を撮像した場合に、移動体検出装置9のCPU41によって実行される移動体検出処理の流れの一例を示すフローチャートである。 FIG. 20 is a flowchart showing an example of the flow of the mobile body detection process executed by the CPU 41 of the mobile body detection device 9 when the image 50 is imaged by the image pickup sensor 9A.

移動体検出処理を規定する移動体検出プログラムは、例えば移動体検出装置9のROM42に予め記憶されている。移動体検出装置9のCPU41は、ROM42に記憶される移動体検出プログラムを読み込み、移動体検出処理を実行する。 The moving body detection program that defines the moving body detection process is stored in advance in, for example, the ROM 42 of the moving body detection device 9. The CPU 41 of the mobile body detection device 9 reads the mobile body detection program stored in the ROM 42 and executes the mobile body detection process.

まず、ステップS300において、CPU41は、例えば公知の移動体検出手法を用いて画像50に車両7が含まれるか否かを判定する。 First, in step S300, the CPU 41 determines whether or not the vehicle 7 is included in the image 50 by using, for example, a known mobile object detection method.

画像50に車両7が含まれていれば、CPU41は、画像50の撮像間隔、及び時間的に隣り合う画像50に含まれる車両7の位置の変化量に基づき、車両7の位置及び速度を含む移動体情報を指定された精度で検出する。 If the image 50 includes the vehicle 7, the CPU 41 includes the position and speed of the vehicle 7 based on the imaging interval of the images 50 and the amount of change in the position of the vehicle 7 included in the images 50 adjacent in time. Detects moving object information with the specified accuracy.

移動体情報の検出精度は、例えば撮像センサ9Aで撮像する画像50の解像度や撮像間隔を調整することで制御可能である。画像50の解像度を高くしたり、画像50の撮像間隔を短くしたりするほど、車両7の位置及び速度を詳細に検出することができるため、移動体情報の検出精度は高くなる。 The detection accuracy of the moving object information can be controlled by, for example, adjusting the resolution and the imaging interval of the image 50 captured by the imaging sensor 9A. The higher the resolution of the image 50 and the shorter the imaging interval of the image 50, the more detailed the position and speed of the vehicle 7 can be detected, so that the detection accuracy of the moving object information becomes higher.

また、画像50から車両7の移動体情報を検出する場合に、車両7の状態を表す微分方程式の解を求める等、演算を繰り返し行って方程式の解を収束させる繰り返し処理が必要になることがあるが、繰り返し処理における演算の繰り返し回数を調整することによっても、移動体情報の検出精度を制御することができる。演算の繰り返し回数を多くするほど、移動体情報の真値と画像50から検出した移動体情報との誤差が少なくなり、移動体情報の検出精度は高くなる。 Further, when detecting the moving body information of the vehicle 7 from the image 50, it may be necessary to repeatedly perform an operation such as finding a solution of a differential equation representing the state of the vehicle 7 to converge the solution of the equation. However, it is also possible to control the detection accuracy of the moving object information by adjusting the number of repetitions of the calculation in the iterative processing. As the number of repetitions of the calculation increases, the error between the true value of the moving body information and the moving body information detected from the image 50 becomes smaller, and the detection accuracy of the moving body information becomes higher.

CPU41は、指定された検出精度に対応した検出設定、すなわち指定された検出精度を実現する画像50の解像度、撮像間隔、及び移動体情報の検出に係る演算の繰り返し回数等の組み合わせを規定する予め設定された検出設定を参照して、画像50の解像度、撮像間隔、及び演算の繰り返し回数等を検出設定で指定された値に調整することで移動体情報の検出精度を制御する。 The CPU 41 prescribes a combination of detection settings corresponding to the specified detection accuracy, that is, the resolution of the image 50 that realizes the specified detection accuracy, the imaging interval, the number of repetitions of the calculation related to the detection of the moving object information, and the like. The detection accuracy of the moving object information is controlled by adjusting the resolution of the image 50, the imaging interval, the number of repetitions of the calculation, and the like to the values specified in the detection settings with reference to the set detection settings.

こうして画像50から検出した車両7の位置は画像座標系上での位置であるため、ステップS310において、CPU41は、画像座標系における車両7の位置を、地図座標系上の位置に座標変換する。 Since the position of the vehicle 7 detected from the image 50 in this way is the position on the image coordinate system, in step S310, the CPU 41 coordinates-converts the position of the vehicle 7 in the image coordinate system to the position on the map coordinate system.

その後、CPU41は、座標変換後の地図座標系上の車両7が非コネクテッド車両7Dであるか否かを判定する。そのため、CPU41は、管制装置10から遵守車両7Aの移動体情報Aに含まれる位置情報を収集する。 After that, the CPU 41 determines whether or not the vehicle 7 on the map coordinate system after the coordinate conversion is the unconnected vehicle 7D. Therefore, the CPU 41 collects the position information included in the moving body information A of the observing vehicle 7A from the control device 10.

CPU41は、車両7の位置と、管制装置10から受信した遵守車両7Aの位置情報で表される位置が、同じ車両7であると認められる車両一致判定範囲以内にある場合、車両7は遵守車両7Aであると判定する。すなわちCPU41は、車両7の位置と、管制装置10から受信した遵守車両7Aの位置情報で表される位置との距離が車両一致判定範囲を超えている場合に、車両7が非コネクテッド車両7Dであると判定する。 When the position of the vehicle 7 and the position represented by the position information of the compliant vehicle 7A received from the control device 10 are within the vehicle matching determination range recognized as the same vehicle 7, the CPU 41 is the compliant vehicle. It is determined that it is 7A. That is, when the distance between the position of the vehicle 7 and the position represented by the position information of the observing vehicle 7A received from the control device 10 exceeds the vehicle matching determination range, the CPU 41 determines that the vehicle 7 is a non-connected vehicle 7D. Judge that there is.

ステップS320において、CPU41は、管制走行ルート地図17から取得した車線8の走路情報、及び管制走行ルート地図17上における非コネクテッド車両7Dの位置及び速度から、画像50が検出された非コネクテッド車両7Dの走行経路を予測する。 In step S320, the CPU 41 of the non-connected vehicle 7D in which the image 50 is detected from the lane information of the lane 8 acquired from the controlled traveling route map 17 and the position and speed of the unconnected vehicle 7D on the controlled traveling route map 17. Predict the driving route.

図10に示したように、管制走行ルート地図17において経路6が2つに分岐している場合、非コネクテッド車両7Dは分岐点で何れの方向に分岐するか不明であるため、CPU41は、分岐する両方の経路6を車両Pの走行経路として予測する。しかしながら、例えば分岐点の手前の地点で非コネクテッド車両7Dの速度が減速した場合、分岐点を直進するよりも折れ曲がる蓋然性が高いことから、CPU41は、折れ曲がる方向に進む経路6だけを非コネクテッド車両7Dの走行経路として予測してもよい。 As shown in FIG. 10, when the route 6 is branched into two in the control travel route map 17, it is unknown in which direction the unconnected vehicle 7D branches at the branch point, so that the CPU 41 branches. Both routes 6 are predicted as travel routes of the vehicle P. However, for example, when the speed of the unconnected vehicle 7D slows down at a point before the branch point, it is more likely that the unconnected vehicle 7D will bend than going straight through the branch point. It may be predicted as a traveling route of.

ステップS330において、CPU41は、ステップS320で予測した走行経路上における経由点4毎の非コネクテッド車両7Dの干渉時間tを予測する。具体的には、CPU41は、管制走行ルート地図17上における非コネクテッド車両7Dの現在位置、非コネクテッド車両7Dの速度、並びに、予測した走行経路上における非コネクテッド車両7Dの速度や走行位置を規制する最大加減速度、制限速度、車線数、及び交通規則情報といった走路情報を用いて、走行経路上における経由点4毎の非コネクテッド車両7Dの干渉時間tを予測する。 In step S330, the CPU 41 predicts the interference time t of the unconnected vehicle 7D for each waypoint 4 on the travel route predicted in step S320. Specifically, the CPU 41 regulates the current position of the unconnected vehicle 7D on the controlled travel route map 17, the speed of the unconnected vehicle 7D, and the speed and the traveling position of the unconnected vehicle 7D on the predicted travel route. Using track information such as maximum acceleration / deceleration, speed limit, number of lanes, and traffic rule information, the interference time t of the unconnected vehicle 7D for each waypoint 4 on the travel route is predicted.

なお、CPU41は、走行経路上における経由点4毎の非コネクテッド車両7Dの干渉時間tではなく、走行経路上における経由点4毎に、非コネクテッド車両7Dが経由点4に存在する確率を予測してもよい。 The CPU 41 predicts the probability that the non-connected vehicle 7D exists at the waypoint 4 at each waypoint 4 on the wayway, not at the interference time t of the unconnected vehicle 7D at each waypoint 4 on the wayway. You may.

ステップS340において、CPU41は通信ユニット9Jを通じて、ステップS320で予測した非コネクテッド車両7Dの走行経路、及び非コネクテッド車両7Dの移動体情報Dを管制装置10に送信する。 In step S340, the CPU 41 transmits the travel path of the non-connected vehicle 7D predicted in step S320 and the moving body information D of the non-connected vehicle 7D to the control device 10 through the communication unit 9J.

これにより、既に図15で説明したように,管制装置10で遵守車両7Aと移動体検出装置9で検出された非コネクテッド車両7Dとの干渉地点Xが特定され、管制装置10から移動体検出装置9に非コネクテッド車両7Dの干渉地点Xが送信される。 As a result, as already described with reference to FIG. 15, the interference point X between the compliant vehicle 7A and the non-connected vehicle 7D detected by the mobile body detection device 9 is specified by the control device 10, and the mobile body detection device is identified from the control device 10. The interference point X of the unconnected vehicle 7D is transmitted to 9.

管制装置10から干渉地点Xを受信すると、ステップS350において、CPU41は、管制装置10から受信した干渉地点Xに基づいて、非コネクテッド車両7Dの走行経路を表す各々の経由点4のうち、何れかの経由点4を判定地点Yとして設定する。 Upon receiving the interference point X from the control device 10, in step S350, the CPU 41 is one of the respective waypoints 4 representing the travel path of the non-connected vehicle 7D based on the interference point X received from the control device 10. The waypoint 4 of is set as the determination point Y.

CPU41は、干渉地点Xを判定地点Yに設定してもよく、干渉地点Xから予め定めた範囲内(「干渉地点Xの近傍」という)にある走行経路上の経由点4を判定地点Yに設定してもよい。例えばCPU41は、非コネクテッド車両7Dの現在位置から見て干渉地点Xの手前にある走行経路上の経由点4を判定地点Yに設定してもよい。 The CPU 41 may set the interference point X as the determination point Y, and set the waypoint 4 on the travel path within a predetermined range from the interference point X (referred to as “near the interference point X”) as the determination point Y. It may be set. For example, the CPU 41 may set the waypoint 4 on the travel path in front of the interference point X when viewed from the current position of the unconnected vehicle 7D as the determination point Y.

ステップS360において、CPU41は、判定地点Yにおける非コネクテッド車両7Dの干渉時間tと、基準時間Tを比較することで非コネクテッド車両7Dの接近度を評価する。「基準時間T」とは、接近度の程度を表すための基準となる時間である。 In step S360, the CPU 41 evaluates the approach degree of the non-connected vehicle 7D by comparing the interference time t of the non-connected vehicle 7D at the determination point Y with the reference time T. The "reference time T" is a reference time for expressing the degree of approach.

図21は、判定地点Yに対する非コネクテッド車両7Dの接近度の評価例を示す図である。 FIG. 21 is a diagram showing an evaluation example of the degree of approach of the non-connected vehicle 7D to the determination point Y.

図21(A)に示すように、CPU41は判定地点Yの干渉時間tに基づき、非コネクテッド車両7Dが判定地点Yを最も早く通過する場合の時間を表す干渉時間tの開始時間tbeginと現在時刻t0との差が基準時間Tを超える場合、非コネクテッド車両7Dは判定地点Yに接近していないと評価する。その上で、干渉時間tの開始時間tbeginと現在時刻t0との差が基準時間Tの場合にCPU41が設定する接近度を「基準接近度」とすれば、CPU41は、この場合の接近度を開始時間tbeginと現在時刻t0との差が大きくなるにつれて基準接近度より低く設定する。 As shown in FIG. 21 (A), the CPU 41 has a start time t begin and a present time of the interference time t representing the time when the non-connected vehicle 7D passes the determination point Y earliest based on the interference time t of the determination point Y. When the difference from the time t 0 exceeds the reference time T, it is evaluated that the non-connected vehicle 7D is not close to the determination point Y. Then, if the approach degree set by the CPU 41 when the difference between the start time t begin of the interference time t and the current time t 0 is the reference time T is set as the "reference approach degree", the CPU 41 approaches in this case. The degree is set lower than the reference approach degree as the difference between the start time t begin and the current time t 0 increases.

また、図21(B)に示すように、CPU41は判定地点Yの干渉時間tに基づき、非コネクテッド車両7Dが判定地点Yを最も早く通過する場合の干渉時間tの開始時間tbeginと現在時刻t0との差が基準時間T未満しかない場合、非コネクテッド車両7Dは判定地点Yに接近していると評価し、この場合の接近度を開始時間tbeginと現在時刻t0との差が小さくなるにつれて基準接近度より高く設定する。 Further, as shown in FIG. 21B, the CPU 41 has a start time t begin and a current time of the interference time t when the non-connected vehicle 7D passes the determination point Y earliest based on the interference time t of the determination point Y. If the difference from t 0 is less than the reference time T, it is evaluated that the non-connected vehicle 7D is approaching the judgment point Y, and the degree of approach in this case is the difference between the start time t begin and the current time t 0 . As it becomes smaller, it is set higher than the standard approach.

ステップS360で非コネクテッド車両7Dが判定地点Yに接近していると評価した場合、非コネクテッド車両7Dが遵守車両7Aと干渉する可能性のある判定地点Yを安全に走行するためには、判定地点Yにおける干渉時間tを可能な範囲で精度よく予測する必要がある。そのためには、非コネクテッド車両7Dの位置及び速度を含む移動体情報Dを可能な範囲で精度よく予測する必要がある。 When it is evaluated in step S360 that the non-connected vehicle 7D is close to the judgment point Y, in order for the non-connected vehicle 7D to safely drive at the judgment point Y where the non-connected vehicle 7D may interfere with the observing vehicle 7A, the judgment point is required. It is necessary to predict the interference time t in Y as accurately as possible. For that purpose, it is necessary to accurately predict the moving body information D including the position and speed of the unconnected vehicle 7D to the extent possible.

一方、ステップS360で非コネクテッド車両7Dは判定地点Yに接近していないと評価した場合、非コネクテッド車両7Dが判定地点Yを通過するまでに余裕があり、非コネクテッド車両7Dが走行経路を安全に走行する上で差し迫った危険はない。したがって、非コネクテッド車両7Dが判定地点Yに接近している場合よりも、判定地点Yにおける干渉時間tの予測精度は低くて構わない。 On the other hand, when it is evaluated in step S360 that the non-connected vehicle 7D is not close to the determination point Y, there is a margin for the non-connected vehicle 7D to pass the determination point Y, and the non-connected vehicle 7D can safely follow the travel route. There is no imminent danger in driving. Therefore, the accuracy of predicting the interference time t at the determination point Y may be lower than when the non-connected vehicle 7D is closer to the determination point Y.

したがって、ステップS370において、CPU41は、接近度の値に比例した信頼度目標を設定する。 Therefore, in step S370, the CPU 41 sets a reliability target proportional to the value of the degree of proximity.

既に説明したように、信頼度目標は画像50から検出する移動体情報Dの検出精度の度合いを表し、信頼度目標が大きい値に設定されるほど、画像50から検出する移動体情報Dの検出精度が高くなる。 As described above, the reliability target represents the degree of detection accuracy of the moving body information D detected from the image 50, and the larger the reliability target is set, the more the detection of the moving body information D detected from the image 50. The accuracy is high.

具体的には、CPU41は、画像50から検出する移動体情報Dの検出精度が、設定した信頼度目標に対応する検出精度となるように、検出設定を参照して画像50の解像度、撮像間隔、及び移動体情報Dの検出に係る演算の繰り返し回数等を信頼度目標に対応した値に調整することで移動体情報Dの検出精度を制御する。 Specifically, the CPU 41 refers to the detection setting so that the detection accuracy of the moving object information D detected from the image 50 becomes the detection accuracy corresponding to the set reliability target, and the resolution and the imaging interval of the image 50 are taken into consideration. , And the detection accuracy of the moving body information D is controlled by adjusting the number of repetitions of the calculation related to the detection of the moving body information D to a value corresponding to the reliability target.

したがって、接近度が基準接近度より大きい値に設定されている場合には、接近度が基準接近度の場合に設定される信頼度目標(「基準信頼度目標」という)で画像50から非コネクテッド車両7Dの移動体情報Dを検出する場合よりも画像50の解像度が高くなると共に、撮像間隔が短くなり、移動体情報Dの検出に係る演算の繰り返し回数も多くなる。これに伴い、CPU41や撮像センサ9Aの負荷が増加し、CPU41や撮像センサ9Aの消費電力も増加することになるが、非コネクテッド車両7Dの移動体情報Dの検出精度は高くなる。 Therefore, when the approach degree is set to a value larger than the reference approach degree, the image 50 is unconnected with the reliability target (referred to as “reference reliability target”) set when the approach degree is the reference approach degree. The resolution of the image 50 is higher than that in the case of detecting the moving object information D of the vehicle 7D, the imaging interval is shortened, and the number of repetitions of the calculation related to the detection of the moving object information D is increased. Along with this, the load on the CPU 41 and the image sensor 9A increases, and the power consumption of the CPU 41 and the image sensor 9A also increases, but the detection accuracy of the moving body information D of the non-connected vehicle 7D becomes high.

なお、撮像センサ9Aの単位時間あたりの負荷は、画像50の解像度が高くなるほど高くなり、撮像間隔が短くなるほど高くなる。CPU41の単位時間あたりの負荷も、画像50の解像度が高くなるほど高くなり、撮像間隔が短くなるほど高くなる。また、CPU41の演算量が多くなるほど高くなる。 The load per unit time of the image pickup sensor 9A increases as the resolution of the image 50 increases, and increases as the image pickup interval becomes shorter. The load per unit time of the CPU 41 also increases as the resolution of the image 50 increases, and increases as the imaging interval becomes shorter. Further, the larger the calculation amount of the CPU 41, the higher the calculation amount.

一方、接近度が基準接近度より小さい値に設定されている場合には、基準検出精度で画像50から非コネクテッド車両7Dの移動体情報Dを検出する場合よりも画像50の解像度が低くなると共に、撮像間隔が長くなり、移動体情報Dの検出に係る演算の繰り返し回数も少なくなる。これに伴い、CPU41や撮像センサ9Aの負荷が減少し、CPU41や撮像センサ9Aの消費電力も低減することになるが、非コネクテッド車両7Dの移動体情報Dの検出精度は低くなる。 On the other hand, when the approach degree is set to a value smaller than the reference approach degree, the resolution of the image 50 becomes lower than the case where the moving object information D of the unconnected vehicle 7D is detected from the image 50 with the reference detection accuracy. , The imaging interval becomes long, and the number of repetitions of the calculation related to the detection of the moving object information D also decreases. Along with this, the load on the CPU 41 and the image sensor 9A is reduced, and the power consumption of the CPU 41 and the image sensor 9A is also reduced, but the detection accuracy of the moving body information D of the non-connected vehicle 7D is lowered.

CPU41が非コネクテッド車両7Dの移動体情報Dの検出精度に関して上記のような制御を行うことで、非コネクテッド車両7Dが判定地点Yを通過するまで基準時間T以上ある場合や、非コネクテッド車両7Dが判定地点Yを通過した後は、非コネクテッド車両7Dが判定地点Yに接近している状態よりもCPU41や撮像センサ9Aの負荷が減少する。したがって、移動体検出装置9における最高の検出精度で画像50から非コネクテッド車両7Dの移動体情報Dを検出し続ける場合と比較して、移動体検出装置9の消費電力を低減することができる。しかも、非コネクテッド車両7Dが判定地点Yに接近するほど、画像50から検出する非コネクテッド車両7Dの移動体情報Dの検出精度が高くなるため、移動体検出装置9における最高の検出精度で画像50から非コネクテッド車両7Dの移動体情報Dを検出し続ける場合と比較しても、非コネクテッド車両7Dが判定地点Yに接近した状況で画像50から検出した移動体情報Dの信頼度は低下することがない。 When the CPU 41 controls the detection accuracy of the moving object information D of the non-connected vehicle 7D as described above, the non-connected vehicle 7D has a reference time T or more until the non-connected vehicle 7D passes the determination point Y, or the non-connected vehicle 7D has a reference time T or more. After passing through the determination point Y, the load on the CPU 41 and the image sensor 9A is reduced as compared with the state where the non-connected vehicle 7D is close to the determination point Y. Therefore, the power consumption of the mobile body detection device 9 can be reduced as compared with the case where the mobile body information D of the unconnected vehicle 7D is continuously detected from the image 50 with the highest detection accuracy in the mobile body detection device 9. Moreover, the closer the unconnected vehicle 7D is to the determination point Y, the higher the detection accuracy of the moving body information D of the non-connected vehicle 7D detected from the image 50. Therefore, the image 50 has the highest detection accuracy in the moving body detecting device 9. Even when compared with the case where the moving body information D of the non-connected vehicle 7D is continuously detected, the reliability of the moving body information D detected from the image 50 is lowered when the non-connected vehicle 7D approaches the determination point Y. There is no.

なお、非コネクテッド車両7Dが撮像センサ9Aの撮像範囲外まで走行して画像50から非コネクテッド車両7Dが検出されなくなった場合には、再び画像50に非コネクテッド車両7Dが含まれるようになるまで画像50から非コネクテッド車両7Dを検出する必要がない。したがって、CPU41は、画像50から検出する非コネクテッド車両7Dの移動体情報Dの検出精度が設定可能な範囲で最低の検出精度となるように信頼度目標を設定すればよい。 If the unconnected vehicle 7D travels outside the imaging range of the image sensor 9A and the unconnected vehicle 7D is no longer detected from the image 50, the image is taken until the image 50 includes the unconnected vehicle 7D again. There is no need to detect the unconnected vehicle 7D from 50. Therefore, the CPU 41 may set the reliability target so that the detection accuracy of the moving body information D of the non-connected vehicle 7D detected from the image 50 is the lowest within the configurable range.

また、CPU41は、画像50の解像度、撮像間隔、及び移動体情報Dの検出に係る演算の繰り返し回数等を制御するのに加え、管制装置10に画像50から検出した非コネクテッド車両7Dの移動体情報Dを送信する間隔を制御して、管制装置10との通信負荷を低減することで、移動体検出装置9の消費電力を低減してもよい。 Further, the CPU 41 controls the resolution of the image 50, the imaging interval, the number of repetitions of the calculation related to the detection of the moving body information D, and the like, and also controls the moving body of the non-connected vehicle 7D detected from the image 50 by the control device 10. The power consumption of the mobile body detection device 9 may be reduced by controlling the interval at which the information D is transmitted to reduce the communication load with the control device 10.

以上により、図20に示した移動体検出処理を終了する。 As a result, the moving body detection process shown in FIG. 20 is completed.

<管制システムの変形例1>
上記では、判定地点Yにおける非コネクテッド車両7Dの干渉時間tと、基準時間Tを比較することで非コネクテッド車両7Dの接近度を評価する管制システム1について説明したが、判定地点Yに対する非コネクテッド車両7Dの接近度の評価方法はこれに限られない。ここでは、判定地点Yにおける非コネクテッド車両7Dの干渉時間tと、判定地点Yにおける非コネクテッド車両7Dと異なる他の車両7(例えば遵守車両7A)の干渉時間tから非コネクテッド車両7Dの接近度を評価する例について説明する。
<Modification example 1 of control system>
In the above, the control system 1 for evaluating the approach degree of the non-connected vehicle 7D by comparing the interference time t of the non-connected vehicle 7D at the determination point Y and the reference time T has been described, but the non-connected vehicle with respect to the determination point Y has been described. The 7D approach evaluation method is not limited to this. Here, the degree of approach of the non-connected vehicle 7D is determined from the interference time t of the non-connected vehicle 7D at the determination point Y and the interference time t of another vehicle 7 (for example, the observing vehicle 7A) different from the non-connected vehicle 7D at the determination point Y. An example to be evaluated will be described.

図22は、管制システム1の変形例1に係る移動体検出装置9及び管制装置10の機能構成例を示す図である。 FIG. 22 is a diagram showing a functional configuration example of the mobile body detection device 9 and the control device 10 according to the modification 1 of the control system 1.

図22に示す管制システム1の機能構成例が図4に示した管制システム1の機能構成例と異なる点は、管制装置10の仮想交通ルール生成部16から遵守車両7Aの走行経路上における経由点4毎の干渉時間tが移動体検出装置9の接近度評価部9Gに送信されている点である。 The difference between the functional configuration example of the control system 1 shown in FIG. 22 and the functional configuration example of the control system 1 shown in FIG. It is a point that the interference time t for each of 4 is transmitted to the proximity evaluation unit 9G of the moving object detection device 9.

なお、管制装置10のCPU31は、図15に示した管制処理のステップS30において、特定した干渉地点Xを遵守車両7Aの大域経路と共に移動体検出装置9に送信するものとする。また、管制装置10のCPU31は、図15に示した管制処理のステップS40において、干渉地点Xの干渉時間tだけでなく遵守車両7Aの大域経路上における経由点4毎の通過時間を干渉時間tとして移動体検出装置9に送信するものとする。 It should be noted that the CPU 31 of the control device 10 shall transmit the specified interference point X to the mobile body detection device 9 together with the global route of the observing vehicle 7A in the control process step S30 shown in FIG. Further, in the control process step S40 shown in FIG. 15, the CPU 31 of the control device 10 determines not only the interference time t of the interference point X but also the passage time of each way point 4 on the global path of the observing vehicle 7A as the interference time t. It shall be transmitted to the moving body detection device 9.

これに対して、移動体検出装置9のCPU41は、図20に示した移動体検出処理のステップS350で判定地点Yを設定した後、ステップS360において、判定地点Yにおける非コネクテッド車両7Dの干渉時間tと、判定地点Yにおける遵守車両7Aの干渉時間tを比較することで、非コネクテッド車両7Dの接近度を評価する。 On the other hand, the CPU 41 of the moving object detection device 9 sets the determination point Y in step S350 of the moving object detection process shown in FIG. 20, and then in step S360, the interference time of the non-connected vehicle 7D at the determination point Y. By comparing t with the interference time t of the observing vehicle 7A at the determination point Y, the approach degree of the non-connected vehicle 7D is evaluated.

図23は、判定地点Yにおける車両Pと車両Qの干渉状況を説明する図である。説明の便宜上、図23の車両Pを非コネクテッド車両7Dとし、車両Qを遵守車両7Aとする。 FIG. 23 is a diagram for explaining the interference state between the vehicle P and the vehicle Q at the determination point Y. For convenience of explanation, the vehicle P in FIG. 23 is referred to as a non-connected vehicle 7D, and the vehicle Q is referred to as a compliant vehicle 7A.

図23(A)に示すように、判定地点Yにおける車両Pの干渉時間tと車両Qの干渉時間tが離れており、車両Pが判定地点Yを車両Qより先に通過することが明らかな場合、又は、車両Pが判定地点Yを車両Qより後に通過することが明らかな場合には、CPU41は、非コネクテッド車両7Dの接近度を低く設定する。 As shown in FIG. 23A, the interference time t of the vehicle P at the determination point Y and the interference time t of the vehicle Q are separated, and it is clear that the vehicle P passes the determination point Y before the vehicle Q. In this case, or when it is clear that the vehicle P passes the determination point Y after the vehicle Q, the CPU 41 sets the degree of approach of the non-connected vehicle 7D to be low.

また、図23(B)に示すように判定地点Yにおける車両Pの干渉時間tと車両Qの干渉時間tが接近しており、車両Pと車両Qが判定地点Yで干渉する恐れがある場合には、CPU41は、非コネクテッド車両7Dの接近度を高く設定する。 Further, as shown in FIG. 23B, when the interference time t of the vehicle P at the determination point Y and the interference time t of the vehicle Q are close to each other, and there is a possibility that the vehicle P and the vehicle Q may interfere with each other at the determination point Y. The CPU 41 sets a high degree of proximity of the non-connected vehicle 7D.

図24は、非コネクテッド車両7Dの接近度の設定例を具体的に示した図であり、図24(A)が図23(A)に示した判定地点Yにおける車両Pと車両Qの干渉時間tの時間的なずれを表し、図24(B)が図23(B)に示した判定地点Yにおける車両Pと車両Qの干渉時間tの時間的なずれを表している。 FIG. 24 is a diagram specifically showing an example of setting the approach degree of the non-connected vehicle 7D, in which FIG. 24A shows the interference time between the vehicle P and the vehicle Q at the determination point Y shown in FIG. 23A. FIG. 24 (B) represents the time lag of t, and FIG. 24 (B) shows the time lag of the interference time t between the vehicle P and the vehicle Q at the determination point Y shown in FIG. 23 (B).

図24(A)に示すように、CPU41は、判定地点Yにおける車両Pの干渉時間tと車両Qの干渉時間tが重複していない場合に、非コネクテッド車両7Dは判定地点Yに接近していないと評価する。この場合、CPU41は、車両Pの干渉時間tと車両Qの干渉時間tが離れるほど接近度を基準接近度より低く設定する。 As shown in FIG. 24A, when the CPU 41 does not overlap the interference time t of the vehicle P at the determination point Y and the interference time t of the vehicle Q, the non-connected vehicle 7D is close to the determination point Y. Evaluate that there is no. In this case, the CPU 41 sets the approach degree to be lower than the reference approach degree as the interference time t of the vehicle P and the interference time t of the vehicle Q are separated from each other.

一方、図24(B)に示すように、CPU41は、判定地点Yにおける車両Pの干渉時間tと車両Qの干渉時間tが重複している場合に、非コネクテッド車両7Dは判定地点Yに接近していると評価する。この場合、CPU41は、車両Pの干渉時間tと車両Qの干渉時間tの重複範囲が広くなるほど接近度を基準接近度より高く設定する。 On the other hand, as shown in FIG. 24B, when the CPU 41 overlaps the interference time t of the vehicle P at the determination point Y and the interference time t of the vehicle Q, the unconnected vehicle 7D approaches the determination point Y. Evaluate that you are doing. In this case, the CPU 41 sets the approach degree higher than the reference approach degree as the overlapping range of the interference time t of the vehicle P and the interference time t of the vehicle Q becomes wider.

このように判定地点Yに対する非コネクテッド車両7Dの接近度を評価する本変形例1に係る管制システム1によれば、非コネクテッド車両7Dの判定地点Yに対する干渉時間tの開始時間tbeginと現在時刻t0との差が基準時間T未満になったとしても、非コネクテッド車両7Dが判定地点Yで他の車両7と干渉する恐れがない場合には、接近度が基準接近度未満に設定される。 According to the control system 1 according to the present modification 1 for evaluating the approach degree of the non-connected vehicle 7D to the determination point Y in this way, the start time t begin and the current time of the interference time t with respect to the determination point Y of the non-connected vehicle 7D. Even if the difference from t 0 is less than the reference time T, the approach degree is set to less than the reference approach degree if there is no possibility that the unconnected vehicle 7D interferes with the other vehicle 7 at the determination point Y. ..

したがって、本変形例1に係る管制システム1は、判定地点Yにおける非コネクテッド車両7Dの干渉時間tと、基準時間Tを比較することで非コネクテッド車両7Dの接近度を評価する場合に比べて、更に移動体検出装置9の消費電力を低減することができる。しかも、非コネクテッド車両7Dが判定地点Yで他の車両7と干渉する恐れがある場合には、非コネクテッド車両7Dの接近度が基準接近度より高く設定されるため、画像50から検出する移動体情報Dの信頼度は確保される。 Therefore, the control system 1 according to the present modification 1 compares the interference time t of the non-connected vehicle 7D at the determination point Y with the reference time T to evaluate the approach degree of the non-connected vehicle 7D. Further, the power consumption of the mobile body detection device 9 can be reduced. Moreover, when the unconnected vehicle 7D may interfere with another vehicle 7 at the determination point Y, the approach degree of the non-connected vehicle 7D is set higher than the reference approach degree, so that the moving object detected from the image 50 is detected. The reliability of information D is ensured.

<管制システムの変形例2>
管制走行ルート地図17で表される経路6上の各経由点4において、各々の経由点4に対応した場所を撮像する撮像センサ9Aにおける画素の解像度の違いにより、画像50から検出される非コネクテッド車両7Dの位置や速度といった移動体情報Dにどの程度の誤差が発生するかという誤差情報は、移動体検出装置9を用いて車両7同士が干渉しないように交通管制を行う管制装置10が交通管制を行う上で考慮しなければならない情報である。
<Modification example 2 of the control system>
Non-connected detected from the image 50 due to the difference in pixel resolution in the image sensor 9A that images the location corresponding to each waypoint 4 at each waypoint 4 on the route 6 represented by the controlled travel route map 17. The error information on how much error occurs in the moving body information D such as the position and speed of the vehicle 7D is obtained by the control device 10 that controls the traffic so that the vehicles 7 do not interfere with each other by using the moving body detecting device 9. This is information that must be taken into consideration when performing control.

こうした誤差情報は、非コネクテッド車両7Dの移動体情報Dの検出精度に影響を与えることから、移動体情報Dの信頼度を表す一例でもある。 Since such error information affects the detection accuracy of the moving body information D of the non-connected vehicle 7D, it is also an example showing the reliability of the moving body information D.

ここでは、経路6上の経由点4毎に移動体情報Dが有する誤差情報、すなわち信頼度が付与された管制走行ルート地図17(以降、「信頼度付き管制走行ルート地図17A」という)を用いて予測した非コネクテッド車両7Dの走行経路上における経由点4毎の干渉時間tから非コネクテッド車両7Dの接近度を評価する例について説明する。 Here, the error information possessed by the moving body information D for each waypoint 4 on the route 6, that is, the controlled travel route map 17 to which reliability is given (hereinafter referred to as “reliable controlled travel route map 17A”) is used. An example of evaluating the approach degree of the unconnected vehicle 7D from the interference time t for each waypoint 4 on the travel path of the unconnected vehicle 7D predicted will be described.

まず、管制走行ルート地図17の経由点4に付加される信頼度の生成方法について説明する。 First, a method of generating the reliability added to the waypoint 4 of the control travel route map 17 will be described.

図25は、管制走行ルート地図17の経由点4に付加される信頼度を生成する信頼度生成装置60の機能構成例を示す図である。 FIG. 25 is a diagram showing a functional configuration example of the reliability generation device 60 that generates the reliability added to the waypoint 4 of the control travel route map 17.

図25に示すように、信頼度生成装置60は、物体検出部62、誤差推定部64、解像度算出部65、座標逆変換部67、及び信頼度算出部68の各機能部と、撮像センサ9A、撮像画像DB61、正解座標DB63、管制走行ルート地図17、及び信頼度DB69を含む。 As shown in FIG. 25, the reliability generation device 60 includes the functional units of the object detection unit 62, the error estimation unit 64, the resolution calculation unit 65, the coordinate inverse conversion unit 67, and the reliability calculation unit 68, and the image sensor 9A. , Captured image DB 61, correct coordinate DB 63, control travel route map 17, and reliability DB 69.

このうち撮像センサ9A、撮像画像DB61、物体検出部62、正解座標DB63、管制走行ルート地図17、及び信頼度DB69は必ずしも信頼度生成装置60に含まれる必要はなく、外部の装置に備えられているものを利用してもよい。また「DB」はデータベース(Database)の略語である。撮像センサ9Aは、管制システム1で用いられる設置済みの移動体検出装置9の撮像センサ9Aを用いることが好ましいが、移動体検出装置9と異なる別の装置の撮像センサ9Aを用いてもよい。ここでは一例として、管制システム1で用いられる設置済みの移動体検出装置9の撮像センサ9Aを用いるものとする。 Of these, the image pickup sensor 9A, the image pickup image DB 61, the object detection unit 62, the correct coordinate DB 63, the control travel route map 17, and the reliability DB 69 do not necessarily have to be included in the reliability generation device 60, and are provided in an external device. You may use what you have. Further, "DB" is an abbreviation for database. As the image pickup sensor 9A, it is preferable to use the image pickup sensor 9A of the installed mobile body detection device 9 used in the control system 1, but an image pickup sensor 9A of another device different from the mobile body detection device 9 may be used. Here, as an example, it is assumed that the image sensor 9A of the installed moving object detection device 9 used in the control system 1 is used.

撮像センサ9Aで車線8を走行する1台の車両7を撮像した後、撮像センサ9Aで撮像された画像50が撮像画像DB61に記憶される。 After the image pickup sensor 9A captures an image of one vehicle 7 traveling in the lane 8, the image 50 captured by the image pickup sensor 9A is stored in the image pickup image DB 61.

物体検出部62は撮像画像DB61から1つの画像50を取得し、移動体検出装置9の移動体検出部9Bと同様に公知の移動体検出手法を用いて、取得した画像50から車両7を検出する。 The object detection unit 62 acquires one image 50 from the captured image DB 61, and detects the vehicle 7 from the acquired image 50 by using a known moving object detection method similar to the moving object detection unit 9B of the moving object detection device 9. do.

誤差推定部64は、物体検出部62で画像50から検出された車両7の位置と、画像50における車両7の正解位置情報を用いて、物体検出部62で検出された画像50上における車両7の位置の検出誤差を推定する。 The error estimation unit 64 uses the position of the vehicle 7 detected from the image 50 by the object detection unit 62 and the correct position information of the vehicle 7 in the image 50, and the vehicle 7 on the image 50 detected by the object detection unit 62. Estimate the detection error of the position of.

車両7を撮像した撮像センサ9Aにおける画素の解像度の違いにより、画像50から得られる車両7の見かけ上の位置と実際の位置に対応した画像50上の位置の間には誤差が生じる。したがって、誤差推定部64は、画像50から検出した位置に車両7がいる場合に、画素の解像度の違いがなければ実際には画像50上のどの位置に車両7が表示されるかといった車両7の実際の位置情報を用いて、物体検出部62で検出された画像50上における車両7の位置の検出誤差を推定する。車両7の位置に対応した画像50内での実際の位置情報が正解位置情報であり、正解位置情報は車両7の位置毎に予め作成されて正解座標DB63に記憶されている。 Due to the difference in pixel resolution in the image sensor 9A that images the vehicle 7, an error occurs between the apparent position of the vehicle 7 obtained from the image 50 and the position on the image 50 corresponding to the actual position. Therefore, when the vehicle 7 is located at the position detected from the image 50, the error estimation unit 64 determines at which position on the image 50 the vehicle 7 is actually displayed if there is no difference in pixel resolution. The detection error of the position of the vehicle 7 on the image 50 detected by the object detection unit 62 is estimated by using the actual position information of. The actual position information in the image 50 corresponding to the position of the vehicle 7 is the correct position information, and the correct position information is created in advance for each position of the vehicle 7 and stored in the correct coordinate DB 63.

図26は、車両7の位置の検出誤差例を示す図である。図26(A)は、画像50から検出した車両7の位置を枠55で表した図である。図26(B)は、画像50から検出した車両7の位置に対応した正解位置情報を示す図であり、枠55Aが図26(A)の画像50から検出した車両7の正解位置を示している。 FIG. 26 is a diagram showing an example of a detection error of the position of the vehicle 7. FIG. 26A is a diagram showing the position of the vehicle 7 detected from the image 50 by the frame 55. FIG. 26B is a diagram showing correct position information corresponding to the position of the vehicle 7 detected from the image 50, and the frame 55A shows the correct position of the vehicle 7 detected from the image 50 of FIG. 26 (A). There is.

したがって、図26(C)に示すように、誤差推定部64は画像50から検出した車両7の位置と、正解位置情報で表される車両7の正解位置を比較し、その差分を画像50から検出した車両7の位置の検出誤差とする。画像50における車両7の位置の検出誤差は、画像50から検出した車両7の位置と正解位置との差分に対応した画素数によって表される。 Therefore, as shown in FIG. 26C, the error estimation unit 64 compares the position of the vehicle 7 detected from the image 50 with the correct position of the vehicle 7 represented by the correct position information, and the difference is obtained from the image 50. It is assumed that the detected position of the vehicle 7 is a detection error. The detection error of the position of the vehicle 7 in the image 50 is represented by the number of pixels corresponding to the difference between the position of the vehicle 7 detected from the image 50 and the correct position.

一方、解像度算出部65は、解像度を撮像センサ9Aの画素毎に算出する。そのため、解像度算出部65は、撮像センサ9Aの撮像範囲に含まれる経路6上の各経由点4における位置情報を管制走行ルート地図17から取得し、地図座標系で表される各経由点4の位置情報を座標逆変換部67に通知する。 On the other hand, the resolution calculation unit 65 calculates the resolution for each pixel of the image pickup sensor 9A. Therefore, the resolution calculation unit 65 acquires the position information at each waypoint 4 on the path 6 included in the image pickup range of the image pickup sensor 9A from the control travel route map 17, and of each waypoint 4 represented by the map coordinate system. Notify the position information to the coordinate inverse conversion unit 67.

座標逆変換部67は、地図座標系で表された位置を画像座標系で表される位置に変換する機能部であり、これにより、管制走行ルート地図17から取得した経路6上の各経由点4の位置が、画像50内の位置に変換される。本実施の形態では、地図座標系で表された位置を画像座標系で表される位置に変換することを「逆変換」という。 The coordinate inverse conversion unit 67 is a functional unit that converts the position represented by the map coordinate system into the position represented by the image coordinate system, thereby each waypoint on the route 6 acquired from the controlled travel route map 17. The position of 4 is converted to the position in the image 50. In the present embodiment, the conversion of the position represented by the map coordinate system to the position represented by the image coordinate system is referred to as "reverse transformation".

図27は座標の逆変換例を示した図である。図27(A)は、地図座標系で表される経路6上の経由点4の例を示す図である。図27(B)は、図27(A)における経路6上の経由点4が存在する範囲の画像50を移動体検出装置9で撮像した場合に、経路6上の各経由点4が画像50内のどの位置に表示されるのかを表す画像50の例である。 FIG. 27 is a diagram showing an example of inverse conversion of coordinates. FIG. 27 (A) is a diagram showing an example of a waypoint 4 on a route 6 represented by a map coordinate system. In FIG. 27 (B), when the image 50 in the range where the way point 4 on the path 6 exists in FIG. 27 (A) is imaged by the mobile body detection device 9, each way point 4 on the path 6 is the image 50. It is an example of the image 50 which shows the position in which it is displayed.

解像度算出部65は、座標逆変換部67から画像50上における経由点4の位置情報を受け付けると、経由点4の撮像を担う撮像センサ9Aの画素の解像度(以降、「経由点4の解像度」ともいう)を経由点4毎に算出する。これにより、管制走行ルート地図17上の経路6に対応する画素の解像度が得られる。 When the resolution calculation unit 65 receives the position information of the waypoint 4 on the image 50 from the coordinate inverse conversion unit 67, the resolution of the pixel of the image sensor 9A responsible for imaging the waypoint 4 (hereinafter, "resolution of the waypoint 4"). Also called) is calculated for each waypoint 4. As a result, the resolution of the pixel corresponding to the route 6 on the control travel route map 17 can be obtained.

具体的には、経由点4の解像度を算出するためには地図座標系で表された管制走行ルート地図17上の位置と、画像座標系で表された画像50上の位置の写像関係を定義する必要がある。この写像関係は、撮像センサ9Aにおける内部パラメータと外部パラメータから計算することが可能である。また、移動体検出装置9の撮像範囲内にマークを置いて移動体検出装置9でマークを撮像し、実空間でのマークの位置、すなわち、地図座標系でのマークの位置と、画像50内でのマークの位置、すなわち、画像座標系でのマークの位置を記録し、この対応付けから地図座標系と画像座標系の写像関係を定義してもよい。 Specifically, in order to calculate the resolution of the waypoint 4, the mapping relationship between the position on the control travel route map 17 represented by the map coordinate system and the position on the image 50 represented by the image coordinate system is defined. There is a need to. This mapping relationship can be calculated from the internal parameters and the external parameters of the image sensor 9A. Further, a mark is placed in the imaging range of the moving object detection device 9 and the mark is imaged by the moving object detecting device 9, and the position of the mark in the real space, that is, the position of the mark in the map coordinate system and the inside of the image 50. The position of the mark in, that is, the position of the mark in the image coordinate system may be recorded, and the mapping relationship between the map coordinate system and the image coordinate system may be defined from this correspondence.

解像度算出部65は予め定義された地図座標系と画像座標系の写像関係を参照して、それぞれ地図座標系で表される車両7が位置する経由点4(特定経由点4)の位置と、経路6に沿って特定経由点4と隣接する隣接経由点4の位置を、画像座標系で表される画像50内の位置に逆変換する。その上で解像度算出部65は、地図座標系における特定経由点4と隣接経由点4の経由点間距離を管制走行ルート地図17の情報を用いて算出し、経由点間距離を画像50内における特定経由点4と隣接経由点4に対応した各々の画素間の距離で除すことで特定経由点4の解像度を算出する。なお、画像50内の画素間の距離は、例えば各々の画素を結ぶ直線と接触する画素数で表される。 The resolution calculation unit 65 refers to the mapping relationship between the map coordinate system and the image coordinate system defined in advance, and refers to the position of the waypoint 4 (specific waypoint 4) where the vehicle 7 represented by the map coordinate system is located, respectively. The positions of the adjacent waypoints 4 adjacent to the specific waypoints 4 along the route 6 are inversely converted to the positions in the image 50 represented by the image coordinate system. Then, the resolution calculation unit 65 calculates the distance between the specific waypoints 4 and the adjacent waypoints 4 in the map coordinate system using the information of the control travel route map 17, and the distance between the waypoints is in the image 50. The resolution of the specific waypoint 4 is calculated by dividing by the distance between the pixels corresponding to the specific waypoint 4 and the adjacent waypoint 4. The distance between the pixels in the image 50 is represented by, for example, the number of pixels in contact with a straight line connecting each pixel.

車両7は経路6に沿って移動することから、経路6上における各経由点4の解像度を算出すれば十分であるが、画像50に含まれる各画素の解像度を算出することもできる。例えば解像度算出部65は、解像度の算出対象である画素(特定画素)と、特定画素に隣接する隣接画素が表す画像座標系上の位置を、地図座標系と画像座標系の写像関係を参照してそれぞれ地図座標系上の地点に変換し、地図座標系における特定画素に対応した地点と隣接画素に対応した地点の距離を算出すれば、この距離が特定画素の解像度となる。したがって、解像度算出部65は、画像50内の各々の画素について上記の演算を繰り返すことで、画像50内のすべての画素の解像度を算出することができる。 Since the vehicle 7 moves along the route 6, it is sufficient to calculate the resolution of each waypoint 4 on the route 6, but it is also possible to calculate the resolution of each pixel included in the image 50. For example, the resolution calculation unit 65 refers to the position on the image coordinate system represented by the pixel (specific pixel) for which the resolution is calculated and the adjacent pixel adjacent to the specific pixel, with reference to the mapping relationship between the map coordinate system and the image coordinate system. If each is converted into a point on the map coordinate system and the distance between the point corresponding to the specific pixel and the point corresponding to the adjacent pixel in the map coordinate system is calculated, this distance becomes the resolution of the specific pixel. Therefore, the resolution calculation unit 65 can calculate the resolution of all the pixels in the image 50 by repeating the above calculation for each pixel in the image 50.

信頼度算出部68は、誤差推定部64で推定された、画像50から検出した車両7の位置の検出誤差と、解像度算出部65で算出された、画像50内における各経由点4の解像度を用いて、画像50から検出された車両7の位置に最も近い画像50上の経由点4、すなわち画像50から検出された車両7の位置に対応した経由点4を特定する。信頼度算出部68は、画像50から検出した車両7の位置の検出誤差に、当該車両7の位置に対応した経由点4の解像度を乗じることで、経由点4における車両7の位置の検出誤差を具体的な距離で表す。 The reliability calculation unit 68 determines the detection error of the position of the vehicle 7 detected from the image 50 estimated by the error estimation unit 64 and the resolution of each waypoint 4 in the image 50 calculated by the resolution calculation unit 65. It is used to identify the waypoint 4 on the image 50 that is closest to the position of the vehicle 7 detected from the image 50, that is, the waypoint 4 corresponding to the position of the vehicle 7 detected from the image 50. The reliability calculation unit 68 multiplies the detection error of the position of the vehicle 7 detected from the image 50 by the resolution of the waypoint 4 corresponding to the position of the vehicle 7, so that the detection error of the position of the vehicle 7 at the waypoint 4 is obtained. Is represented by a specific distance.

一方で、時系列に沿って撮像センサ9Aで撮像された時間的に隣接する画像50に対して、例えばオプティカルフローを適用することで画像50から車両7の速度が算出される。 On the other hand, the speed of the vehicle 7 is calculated from the image 50 by applying, for example, an optical flow to the temporally adjacent images 50 captured by the image sensor 9A in chronological order.

図28はオプティカルフローを用いて画像50から車両7の速度を算出する例について説明した図である。 FIG. 28 is a diagram illustrating an example of calculating the speed of the vehicle 7 from the image 50 using optical flow.

時系列に沿って撮像された時間的に隣接する図28(A)に示す画像50と図28(B)に示す画像50が存在する場合、一方の画像50に表示されている同じ車両7が、他方の画像50ではどの位置に移動しているのかといった車両7の位置の対応付けを画素単位で行い、各々の画像50の間で画素毎の対応関係を求める(図28(C))。画素毎の対応関係から得られる車両7を表す画素の移動量の平均と画像50の撮像間隔から、車両7の速度を算出することができる。 When the images 50 shown in FIG. 28 (A) and the images 50 shown in FIG. 28 (B) that are temporally adjacent to each other are present, the same vehicle 7 displayed in one of the images 50 is used. In the other image 50, the position of the vehicle 7 is associated with each other, such as which position the vehicle 7 is moving to, and the correspondence between the images 50 is obtained for each pixel (FIG. 28 (C)). The speed of the vehicle 7 can be calculated from the average of the movement amounts of the pixels representing the vehicle 7 obtained from the correspondence relationship for each pixel and the imaging interval of the image 50.

しかしながら、車両7に画素分解能未満の移動量があったとしても、画像50からこの移動量を検出することができないため、算出した車両7の速度には誤差が含まれる。具体的には、画像50の撮像間隔を“Tint”とした場合、車両7を表す画素の移動量の最大誤差は1/Tint[画素/秒]となる。 However, even if the vehicle 7 has a movement amount less than the pixel resolution, the movement amount cannot be detected from the image 50, so that the calculated speed of the vehicle 7 includes an error. Specifically, when the imaging interval of the image 50 is "T int ", the maximum error of the movement amount of the pixel representing the vehicle 7 is 1 / T int [pixel / sec].

したがって、信頼度算出部68は、画像50内における車両7の位置に対応した経由点4の解像度に画素の移動量の最大誤差を乗じることで、画像50から検出された車両7の位置に対応した経由点4における速度の検出誤差を算出する。 Therefore, the reliability calculation unit 68 corresponds to the position of the vehicle 7 detected from the image 50 by multiplying the resolution of the waypoint 4 corresponding to the position of the vehicle 7 in the image 50 by the maximum error of the movement amount of the pixels. The speed detection error at the transit point 4 is calculated.

信頼度算出部68は、車両7の位置に対応した経由点4に、信頼度算出部68で算出した車両7の位置の検出誤差と車両7の速度の検出誤差を含む信頼度を対応付けて信頼度DB69に記憶する。信頼度付き管制走行ルート地図17Aの各経由点4には、信頼度DB69に記憶された各経由点4に対応する信頼度が付加される。 The reliability calculation unit 68 associates the waypoint 4 corresponding to the position of the vehicle 7 with the reliability including the detection error of the position of the vehicle 7 calculated by the reliability calculation unit 68 and the detection error of the speed of the vehicle 7. Stored in the reliability DB 69. A reliability corresponding to each waypoint 4 stored in the reliability DB 69 is added to each waypoint 4 of the controlled travel route map 17A with reliability.

ここでは一例として、管制走行ルート地図17上の1つの経由点4に信頼度を対応付ける方法について説明したが、走行する車両7を繰り返し撮像センサ9Aで撮像することで、車両7の位置が異なる複数の画像50が得られる。したがって、各々の画像50における車両7の位置に対応した経由点4に信頼度生成装置60で算出した信頼度を付加することで、1台の移動体検出装置9で撮像された画像50に含まれる経路6上のすべての経由点4に信頼度が付加される。また、管制システム1に含まれるすべての移動体検出装置9の撮像センサ9Aで撮像した画像50に対して信頼度生成装置60で経由点4の信頼度を算出すれば、管制走行ルート地図17に含まれるすべての経路6の経由点4に信頼度が付加される。 Here, as an example, a method of associating reliability with one waypoint 4 on the control travel route map 17 has been described, but by repeatedly imaging the traveling vehicle 7 with the image pickup sensor 9A, the positions of the vehicle 7 are different. Image 50 is obtained. Therefore, by adding the reliability calculated by the reliability generation device 60 to the waypoint 4 corresponding to the position of the vehicle 7 in each image 50, it is included in the image 50 captured by one moving body detection device 9. Reliability is added to all waypoints 4 on the route 6. Further, if the reliability of the waypoint 4 is calculated by the reliability generation device 60 for the image 50 captured by the image sensor 9A of all the moving body detection devices 9 included in the control system 1, the control travel route map 17 can be obtained. Reliability is added to the waypoints 4 of all included routes 6.

移動体検出装置9は、このようにして生成された信頼度付き管制走行ルート地図17Aを参照し、非コネクテッド車両7Dの走行経路上における経由点4毎の信頼度を反映した車両7の位置及び速度を用いて、走行経路上における経由点4毎に非コネクテッド車両7Dの干渉時間tを予測してもよい。 The moving body detection device 9 refers to the controlled travel route map 17A with reliability generated in this manner, and refers to the position of the vehicle 7 and the position of the vehicle 7 reflecting the reliability of each waypoint 4 on the travel route of the non-connected vehicle 7D. The speed may be used to predict the interference time t of the unconnected vehicle 7D for each waypoint 4 on the travel path.

図29は、信頼度付き管制走行ルート地図17Aを用いる移動体検出装置9及び管制装置10の機能構成例を示す図である。 FIG. 29 is a diagram showing a functional configuration example of the moving body detection device 9 and the control device 10 using the controlled travel route map 17A with reliability.

図29に示す管制システム1の機能構成例が図22に示した管制システム1の機能構成例と異なる点は、管制走行ルート地図17が信頼度付き管制走行ルート地図17Aに置き換えられ、移動体検出装置9に信頼度補正部9Kが追加された点である。 The difference between the functional configuration example of the control system 1 shown in FIG. 29 and the functional configuration example of the control system 1 shown in FIG. 22 is that the control travel route map 17 is replaced with the controlled travel route map 17A with reliability, and the moving object is detected. This is the point that the reliability correction unit 9K is added to the device 9.

信頼度付き管制走行ルート地図17Aの各経由点4に付与されている信頼度は、画像50から検出される車両7の位置及び速度の検出誤差を可能な範囲で正確に表している。したがって、本実施形態に係る移動体検出装置9のように、信頼度目標に応じて画像50から検出する非コネクテッド車両7Dの移動体情報Dの検出精度を制御する場合には、信頼度付き管制走行ルート地図17Aから取得した信頼度をそのまま利用すると、検出した移動体情報Dの検出精度が信頼度目標に対応した検出精度を超えてしまうことがある。 The reliability given to each waypoint 4 of the controlled travel route map 17A with reliability accurately represents the detection error of the position and speed of the vehicle 7 detected from the image 50 to the extent possible. Therefore, when controlling the detection accuracy of the moving body information D of the non-connected vehicle 7D detected from the image 50 according to the reliability target as in the moving body detecting device 9 according to the present embodiment, the control with reliability is performed. If the reliability acquired from the travel route map 17A is used as it is, the detection accuracy of the detected moving object information D may exceed the detection accuracy corresponding to the reliability target.

したがって、本変形例2に係る移動体検出装置9には、信頼度付き管制走行ルート地図17Aの各経由点4に付与されている信頼度を信頼度目標に応じて補正する信頼度補正部9Kが追加されている。 Therefore, in the moving body detection device 9 according to the present modification 2, the reliability correction unit 9K that corrects the reliability given to each waypoint 4 of the controlled travel route map 17A with reliability according to the reliability target. Has been added.

信頼度補正部9Kは、走路情報取得部9Dを通じて信頼度付き管制走行ルート地図17Aから経路6を構成する各経由点4に付与された信頼度を取得すると共に、信頼度制御部9Hから信頼度目標を取得し、信頼度目標に応じて各経由点4に付与された信頼度を補正する。その上で、信頼度補正部9Kは、補正した信頼度(「補正信頼度」という)を走行経路予測部9Eに通知する。 The reliability correction unit 9K acquires the reliability given to each waypoint 4 constituting the route 6 from the controlled travel route map 17A with reliability through the track information acquisition unit 9D, and also acquires the reliability from the reliability control unit 9H. The target is acquired, and the reliability given to each waypoint 4 is corrected according to the reliability target. Then, the reliability correction unit 9K notifies the traveling route prediction unit 9E of the corrected reliability (referred to as “correction reliability”).

例えば、信頼度制御部9Hから取得した信頼度目標が信頼度目標の最大値の1/2である場合、信頼度補正部9Kは、各経由点4に付与された信頼度を1/2にすればよい。各経由点4に付与された信頼度を1/2にするということは、各経由点4における位置及び速度の検出誤差を2倍にすることである。また、各経由点4に付与された信頼度と、信頼度目標を比較し、小さい方の値を補正信頼度としてもよい。 For example, when the reliability target acquired from the reliability control unit 9H is 1/2 of the maximum value of the reliability target, the reliability correction unit 9K reduces the reliability given to each waypoint 4 to 1/2. do it. To halve the reliability given to each waypoint 4 means to double the detection error of the position and speed at each waypoint 4. Further, the reliability assigned to each waypoint 4 may be compared with the reliability target, and the smaller value may be used as the correction reliability.

走行経路予測部9Eは、補正信頼度を反映した非コネクテッド車両7Dの位置及び速度を用いて、走行経路を表す経由点4毎に非コネクテッド車両7Dの干渉時間tを予測する。なお、補正信頼度を反映した非コネクテッド車両7Dの位置及び速度とは、補正信頼度によって表される検出誤差を考慮した、各経由点4における非コネクテッド車両7Dの位置及び速度のことである。 The travel route prediction unit 9E predicts the interference time t of the non-connected vehicle 7D at each waypoint 4 representing the travel route by using the position and speed of the unconnected vehicle 7D reflecting the correction reliability. The position and speed of the non-connected vehicle 7D reflecting the corrected reliability is the position and speed of the non-connected vehicle 7D at each waypoint 4 in consideration of the detection error represented by the corrected reliability.

このように本変形例2に係る管制システム1によれば、経由点4毎に異なる信頼度を用いて非コネクテッド車両7Dの干渉時間tを予測することができるため、移動体検出装置9は、信頼度が付与されていない管制走行ルート地図17を用いて干渉時間を予測する場合と比較して、判定地点Yにおける非コネクテッド車両7Dの干渉時間tを正確に予測することができる。その結果、移動体検出装置9は、信頼度が付与されていない管制走行ルート地図17を用いて干渉時間を予測する場合と比較して、信頼度目標を高く設定する時間を短くすることができる場合があるため、移動体検出装置9の消費電力を更に低減することができる。 As described above, according to the control system 1 according to the second modification, the interference time t of the non-connected vehicle 7D can be predicted by using different reliability for each waypoint 4, so that the mobile body detecting device 9 can be used. The interference time t of the unconnected vehicle 7D at the determination point Y can be accurately predicted as compared with the case where the interference time is predicted using the controlled travel route map 17 to which the reliability is not given. As a result, the moving body detection device 9 can shorten the time for setting a high reliability target as compared with the case where the interference time is predicted using the controlled travel route map 17 to which the reliability is not given. Therefore, the power consumption of the mobile body detecting device 9 can be further reduced.

以上、本実施形態に係る管制システム1について説明したが、移動体検出装置9は経路6に沿って複数設置されることから、商用電源で移動体検出装置9を動作させた場合、各々の移動体検出装置9の合計消費電力量は経済的に無視できない値となる。したがって、移動体検出装置9は光、音、振動、空気の流れ、圧力、及び熱の少なくとも1つの再生エネルギーを利用して、自装置で消費する電力以上の電力を発電する動力生成部9Lを備えるようにしてもよい。 Although the control system 1 according to the present embodiment has been described above, since a plurality of mobile body detection devices 9 are installed along the route 6, when the mobile body detection device 9 is operated by a commercial power source, each movement is performed. The total power consumption of the body detection device 9 is economically not negligible. Therefore, the mobile body detection device 9 uses at least one renewable energy of light, sound, vibration, air flow, pressure, and heat to generate a power generation unit 9L that generates more power than the power consumed by the own device. You may be prepared.

図30は、図4に示した管制システム1の移動体検出装置9に動力生成部9Lを追加した図である。 FIG. 30 is a diagram in which a power generation unit 9L is added to the moving body detection device 9 of the control system 1 shown in FIG.

移動体検出装置9が動力生成部9Lを備えることによって、移動体検出装置9は商用電源を用いることなく動作することが可能となる。しかしながら、再生エネルギーを利用して発電される電力は、商用電源から得られる電力に比べて小さい。したがって、移動体検出装置9が動力生成部9Lで発電した電力を消費して動作する場合、移動体検出装置9における消費電力の低減を検討する必要がある。 When the mobile body detection device 9 includes the power generation unit 9L, the mobile body detection device 9 can operate without using a commercial power source. However, the electric power generated by using the renewable energy is smaller than the electric power obtained from the commercial power source. Therefore, when the mobile body detection device 9 operates by consuming the power generated by the power generation unit 9L, it is necessary to consider reducing the power consumption in the mobile body detection device 9.

これに対して、上記に説明した移動体検出装置9を用いれば、移動体検出装置9における最高の検出精度で画像50から非コネクテッド車両7Dの移動体情報Dを検出し続ける場合と比較して、移動体検出装置9の消費電力を低減することができる。したがって、動力生成部9Lで発電される電力の範囲内で動作可能な移動体検出装置9を提供することも可能である。 On the other hand, if the mobile body detection device 9 described above is used, the mobile body information D of the non-connected vehicle 7D is continuously detected from the image 50 with the highest detection accuracy in the mobile body detection device 9. , The power consumption of the mobile body detecting device 9 can be reduced. Therefore, it is also possible to provide the mobile body detection device 9 that can operate within the range of the electric power generated by the power generation unit 9L.

以上、実施の形態を用いて本発明について説明したが、本発明は実施の形態に記載の範囲には限定されない。本発明の要旨を逸脱しない範囲で実施の形態に多様な変更または改良を加えることができ、当該変更または改良を加えた形態も本発明の技術的範囲に含まれる。例えば、本発明の要旨を逸脱しない範囲で処理の順序を変更してもよい。 Although the present invention has been described above using the embodiments, the present invention is not limited to the scope described in the embodiments. Various changes or improvements can be made to the embodiments without departing from the gist of the present invention, and the modified or improved embodiments are also included in the technical scope of the present invention. For example, the order of processing may be changed without departing from the gist of the present invention.

実施の形態では、一例として管制装置10における管制処理、遵守車両7Aにおける走行制御処理、及び移動体検出装置9における移動体検出処理をソフトウェアで実現する形態について説明したが、図15、図19、及び図20に示したフローチャートと同等の処理を、例えばASIC(Application Specific Integrated Circuit)、FPGA(Field Programmable Gate Array)、またはPLD(Programmable Logic Device)に実装し、ハードウェアで処理させるようにしてもよい。この場合、各々の処理をソフトウェアで実現した場合と比較して、処理の高速化が図られる。 In the embodiment, as an example, a mode in which the control process in the control device 10, the travel control process in the compliant vehicle 7A, and the mobile body detection process in the mobile body detection device 9 are realized by software has been described. And the same processing as the flowchart shown in FIG. 20 is implemented in, for example, ASIC (Application Specific Integrated Circuit), FPGA (Field Programmable Gate Array), or PLD (Programmable Logic Device). good. In this case, the processing speed can be increased as compared with the case where each processing is realized by software.

このように、管制装置10のCPU31、移動体検出装置9のCPU41、及び遵守車両7Aの制御装置20におけるCPU81を例えばASIC、FPGA、PLD、GPU(Graphics Processing Unit)、及びFPU(Floating Point Unit)といった特定の処理に特化した専用のプロセッサに置き換えてもよい。 As described above, the CPU 31 of the control device 10, the CPU 41 of the mobile detection device 9, and the CPU 81 in the control device 20 of the observing vehicle 7A are, for example, ASIC, FPGA, PLD, GPU (Graphics Processing Unit), and FPU (Floating Point Unit). It may be replaced with a dedicated processor specialized for a specific process such as.

また、上述した実施の形態では、管制プログラム、移動体検出プログラム、及び制御プログラムがそれぞれROM32、ROM42、及びROM82にインストールされている形態について説明したが、これに限定されるものではない。本発明に係る管制プログラム、移動体検出プログラム、及び制御プログラムは、コンピュータで読み取り可能な記憶媒体に記録された形態で提供することも可能である。例えば管制プログラム、移動体検出プログラム、及び制御プログラムをCD(Compact Disc)またはDVD(Digital Versatile Disc)等の光ディスクに記録した形態で提供してもよい。また、管制プログラム、移動体検出プログラム、及び制御プログラムをUSBメモリやメモリカード等の可搬型の半導体メモリに記録した形態で提供してもよい。 Further, in the above-described embodiment, the mode in which the control program, the mobile detection program, and the control program are installed in the ROM 32, ROM 42, and ROM 82, respectively, has been described, but the present invention is not limited thereto. The control program, the mobile detection program, and the control program according to the present invention can also be provided in a form recorded on a computer-readable storage medium. For example, the control program, the mobile detection program, and the control program may be provided in the form of being recorded on an optical disk such as a CD (Compact Disc) or a DVD (Digital Versaille Disc). Further, the control program, the mobile detection program, and the control program may be provided in the form of being recorded in a portable semiconductor memory such as a USB memory or a memory card.

更に、管制装置10、移動体検出装置9、及び遵守車両7Aの制御装置20は、通信網5に接続される外部装置からそれぞれ管制プログラム、移動体検出プログラム、及び制御プログラムをダウンロードするようにしてもよい。 Further, the control device 10, the mobile body detection device 9, and the control device 20 of the compliant vehicle 7A download the control program, the mobile body detection program, and the control program from the external device connected to the communication network 5, respectively. May be good.

1 管制システム、3 無線通信装置、4(4A、4B) 経由点(特定経由点、隣接経由点)、5 通信網、6(6P、6Q) 経路、7 車両、7A 遵守車両、7D 非コネクテッド車両、8 車線、8A 優先車線、8B 非優先車線、9 移動体検出装置、9A 撮像センサ、9B 移動体検出部、9C 座標変換部、9D 走路情報取得部、9E 走行経路予測部、9F 判定地点設定部、9G 接近度評価部、9H 信頼度制御部、9K 信頼度補正部、9L 動力生成部、10 管制装置、11 目的地設定部、12 通信部、13 大域経路計画部、15 干渉地点特定部、16 仮想交通ルール生成部、17 管制走行ルート地図、17A 信頼度付き管制走行ルート地図、20 制御装置、21 位置推定部、22 状態管理部、23 無線通信部、24 局所経路計画部、25 制御部、26 車両走行ルート地図、30(40、80) コンピュータ、31(41、81) CPU、32(42、82) ROM、33(43、83) RAM、34(44、84) 不揮発性メモリ、35(45、85) I/O、36(46、86) バス、37(87、9J) 通信ユニット、38(88) 入力ユニット、39(89) 表示ユニット、50 画像、55(55A、55P、55Q) 枠、60 信頼度生成装置、61 撮像画像DB、62 物体検出部、63 正解座標DB、64 誤差推定部、65 解像度算出部、67 座標逆変換部、68 信頼度算出部、69 信頼度DB、90 内界センサ、91 外界センサ、92 走行装置、P(Q) 車両、T 基準時間、X 干渉地点、Y 判定地点、t 干渉時間 1 Control system, 3 Wireless communication device, 4 (4A, 4B) waypoints (specific waypoints, adjacent way points), 5 communication networks, 6 (6P, 6Q) routes, 7 vehicles, 7A compliant vehicles, 7D unconnected vehicles , 8 lanes, 8A priority lane, 8B non-priority lane, 9 moving object detection device, 9A image sensor, 9B moving object detection unit, 9C coordinate conversion unit, 9D track information acquisition unit, 9E travel route prediction unit, 9F judgment point setting Unit, 9G proximity evaluation unit, 9H reliability control unit, 9K reliability correction unit, 9L power generation unit, 10 control device, 11 destination setting unit, 12 communication unit, 13 global route planning unit, 15 interference point identification unit , 16 virtual traffic rule generator, 17 controlled driving route map, 17A reliable controlled driving route map, 20 control device, 21 position estimation unit, 22 state management unit, 23 wireless communication unit, 24 local route planning unit, 25 control Department, 26 Vehicle travel route map, 30 (40, 80) computer, 31 (41, 81) CPU, 32 (42, 82) ROM, 33 (43, 83) RAM, 34 (44, 84) non-volatile memory, 35 (45, 85) I / O, 36 (46, 86) bus, 37 (87, 9J) communication unit, 38 (88) input unit, 39 (89) display unit, 50 images, 55 (55A, 55P, 55Q) Frame, 60 reliability generator, 61 image capture image DB, 62 object detection unit, 63 correct coordinate DB, 64 error estimation unit, 65 resolution calculation unit, 67 inverse coordinate conversion unit, 68 reliability calculation unit, 69 reliability DB, 90 internal sensor, 91 external sensor, 92 traveling device, P (Q) vehicle, T reference time, X interference area Point, Y judgment point, t Interference time

Claims (14)

移動体同士が干渉しないように移動体の交通管制を行う管制装置とデータ通信を行うことができない非コネクテッド移動体を撮像した画像から、前記非コネクテッド移動体の位置及び速度を含む移動体情報を指定された精度で検出する移動体検出部と、
前記非コネクテッド移動体の走行経路上に設定された判定地点に対する前記非コネクテッド移動体の接近度に応じて信頼度目標を設定し、前記精度を前記信頼度目標に近づけるように前記移動体検出部に指示する制御を行う信頼度制御部と、
を備えた移動体検出装置。
Mobile information including the position and speed of the unconnected mobile is obtained from an image of a non-connected mobile that cannot perform data communication with a control device that controls the traffic of the mobile so that the mobiles do not interfere with each other. A mobile detector that detects with the specified accuracy, and
A reliability target is set according to the degree of approach of the unconnected moving object to a determination point set on the traveling path of the unconnected moving object, and the moving object detecting unit sets the accuracy closer to the reliability target. The reliability control unit that controls instructing to
Mobile detection device equipped with.
前記移動体検出部で検出された前記非コネクテッド移動体の位置を前記画像の画像座標系から、移動体の経路が点列で表された地図データにおける地図座標系に変換する座標変換部と、
前記地図データから点列毎の走路情報を取得する走路情報取得部と、
前記座標変換部で地図座標系に変換された前記非コネクテッド移動体の位置、前記非コネクテッド移動体の速度、及び前記走路情報取得部で取得した前記経路の走路情報から前記非コネクテッド移動体の走行経路を予測し、予測した走行経路を表す経由点毎に前記非コネクテッド移動体の干渉時間を予測する走行経路予測部と、
前記走行経路予測部で予測した走行経路を表す各々の経由点のうち、何れかの経由点を前記判定地点として設定する判定地点設定部と、
前記判定地点設定部で設定された前記判定地点における干渉時間に基づき、前記判定地点に対する前記非コネクテッド移動体の接近度を評価する接近度評価部と、
を備え、
前記信頼度制御部は、前記接近度評価部で評価された接近度に応じて前記信頼度目標を設定する制御を行う
請求項1記載の移動体検出装置。
A coordinate conversion unit that converts the position of the unconnected moving object detected by the moving object detection unit from the image coordinate system of the image to the map coordinate system in the map data in which the path of the moving object is represented by a point sequence.
A track information acquisition unit that acquires track information for each point sequence from the map data,
Traveling of the unconnected moving body from the position of the unconnected moving body converted into the map coordinate system by the coordinate conversion unit, the speed of the unconnected moving body, and the running track information of the route acquired by the running track information acquisition unit. A travel route prediction unit that predicts a route and predicts the interference time of the unconnected moving object for each waypoint representing the predicted travel route.
A determination point setting unit that sets any of the transit points representing the travel route predicted by the travel route prediction unit as the determination point, and a determination point setting unit.
An approach evaluation unit that evaluates the degree of approach of the unconnected moving object to the determination point based on the interference time at the determination point set by the determination point setting unit.
Equipped with
The moving body detection device according to claim 1, wherein the reliability control unit controls to set the reliability target according to the approach degree evaluated by the approach degree evaluation unit.
前記判定地点設定部は、前記非コネクテッド移動体の走行経路を表す各々の経由点のうち、前記非コネクテッド移動体の走行経路と、前記非コネクテッド移動体と異なる他の移動体の走行経路と、に基づいて前記管制装置で特定された前記非コネクテッド移動体と前記他の移動体との干渉地点を前記判定地点として設定する
請求項2記載の移動体検出装置。
The determination point setting unit includes, among the respective waypoints representing the traveling paths of the unconnected moving body, the traveling path of the non-connected moving body and the traveling path of another moving body different from the non-connected moving body. 2. The moving body detection device according to claim 2, wherein an interference point between the non-connected moving body and the other moving body specified by the control device is set as the determination point.
前記接近度評価部は、前記非コネクテッド移動体の前記判定地点における干渉時間、及び前記非コネクテッド移動体と異なる他の移動体の前記判定地点における干渉時間から、前記非コネクテッド移動体の接近度を評価する
請求項2記載の移動体検出装置。
The proximity evaluation unit determines the approach degree of the non-connected mobile body from the interference time of the unconnected mobile body at the determination point and the interference time of another moving body different from the unconnected mobile body at the determination point. The mobile detection device according to claim 2 to be evaluated.
前記走路情報取得部は、前記移動体検出部で前記画像から検出された前記非コネクテッド移動体の位置及び速度に含まれる誤差の度合いを表す信頼度が点列毎に付与された前記地図データから、点列毎の走路情報を前記信頼度と共に取得し、
前記走行経路予測部は、予測した前記非コネクテッド移動体の走行経路上における各経由点での前記信頼度を反映した前記非コネクテッド移動体の位置及び速度を用いて、前記非コネクテッド移動体の走行経路上における経由点毎に前記非コネクテッド移動体の干渉時間を予測する
請求項4記載の移動体検出装置。
The track information acquisition unit is based on the map data to which a reliability indicating the degree of error included in the position and speed of the unconnected moving object detected from the image by the moving object detecting unit is given for each point sequence. , Acquire the track information for each point sequence together with the above reliability,
The traveling route prediction unit uses the position and speed of the unconnected moving object to reflect the reliability at each waypoint on the traveling path of the unconnected moving object, and travels the unconnected moving object. The moving body detection device according to claim 4, wherein the interference time of the unconnected moving body is predicted for each waypoint on the route.
前記走路情報取得部から前記地図データの点列を構成する各点に付与された前記信頼度を取得すると共に、前記信頼度制御部から前記信頼度目標を取得し、前記信頼度目標に応じて、前記地図データの点列を構成する各点に付与された前記信頼度を補正する信頼度補正部を備え、
前記走行経路予測部は、予測した前記非コネクテッド移動体の走行経路上における各経由点での前記信頼度補正部で補正された前記信頼度を反映した前記非コネクテッド移動体の位置及び速度を用いて、前記非コネクテッド移動体の走行経路上における経由点毎に前記非コネクテッド移動体の干渉時間を予測する
請求項5記載の移動体検出装置。
The reliability assigned to each point constituting the point sequence of the map data is acquired from the track information acquisition unit, and the reliability target is acquired from the reliability control unit, according to the reliability target. , A reliability correction unit for correcting the reliability given to each point constituting the point sequence of the map data is provided.
The travel route prediction unit uses the position and speed of the unconnected moving object that reflects the reliability corrected by the reliability correction unit at each waypoint on the travel route of the predicted unconnected moving object. The moving body detection device according to claim 5, wherein the interference time of the unconnected moving body is predicted for each waypoint on the traveling path of the unconnected moving body.
光、音、振動、空気の流れ、圧力、及び熱の少なくとも1つの再生エネルギーを利用して、自装置で消費する電力以上の電力を発電する動力生成部を備える
請求項1~請求項6の何れか1項に記載の移動体検出装置。
Claims 1 to 6 include a power generator that uses at least one renewable energy of light, sound, vibration, air flow, pressure, and heat to generate more power than the power consumed by the own device. The moving body detection device according to any one item.
移動体同士が干渉しないように移動体の交通管制を行う管制装置と、
移動体の経路に沿って設置され、前記管制装置とデータ通信を行うことができない非コネクテッド移動体の画像を撮像する撮像センサと、
前記画像から、前記非コネクテッド移動体の位置及び速度を含む移動体情報を指定された精度で検出する移動体検出部、及び前記非コネクテッド移動体の走行経路上に設定された判定地点に対する前記非コネクテッド移動体の接近度に応じて信頼度目標を設定し、前記精度を前記信頼度目標に近づけるように前記移動体検出部に指示する制御を行う信頼度制御部を備えた移動体検出装置と、
を含む管制システム。
A control device that controls the traffic of mobiles so that they do not interfere with each other,
An imaging sensor that is installed along the path of the moving object and captures an image of a non-connected moving object that cannot perform data communication with the control device.
From the image, the moving body detection unit that detects the moving body information including the position and speed of the unconnected moving body with a specified accuracy, and the non-connection point set on the traveling path of the unconnected moving body. A mobile detection device equipped with a reliability control unit that sets a reliability target according to the degree of proximity of a connected moving object and controls the moving object detection unit to instruct the accuracy to approach the reliability target. ,
Control system including.
前記移動体検出装置は、
前記移動体検出部で検出された前記非コネクテッド移動体の位置を前記画像の画像座標系から、移動体の経路が点列で表された地図データにおける地図座標系に変換する座標変換部と、
前記地図データから点列毎の走路情報を取得する走路情報取得部と、
前記座標変換部で地図座標系に変換された前記非コネクテッド移動体の位置、前記非コネクテッド移動体の速度、及び前記走路情報取得部で取得した前記経路の走路情報から前記非コネクテッド移動体の走行経路を予測し、予測した走行経路を表す経由点毎に前記非コネクテッド移動体の干渉時間を予測する走行経路予測部と、
前記走行経路予測部で予測した走行経路を表す各々の経由点のうち、何れかの経由点を前記判定地点として設定する判定地点設定部と、
前記判定地点設定部で設定された前記判定地点における干渉時間に基づき、前記判定地点に対する前記非コネクテッド移動体の接近度を評価する接近度評価部と、
を備え、
前記信頼度制御部は、前記接近度評価部で評価された接近度に応じて前記信頼度目標を設定する制御を行う
請求項8記載の管制システム。
The moving body detection device is
A coordinate conversion unit that converts the position of the unconnected moving object detected by the moving object detection unit from the image coordinate system of the image to the map coordinate system in the map data in which the path of the moving object is represented by a point sequence.
A track information acquisition unit that acquires track information for each point sequence from the map data,
Traveling of the unconnected moving body from the position of the unconnected moving body converted into the map coordinate system by the coordinate conversion unit, the speed of the unconnected moving body, and the running track information of the route acquired by the running track information acquisition unit. A travel route prediction unit that predicts a route and predicts the interference time of the unconnected moving object for each waypoint representing the predicted travel route.
A determination point setting unit that sets any of the transit points representing the travel route predicted by the travel route prediction unit as the determination point, and a determination point setting unit.
An approach evaluation unit that evaluates the degree of approach of the unconnected moving object to the determination point based on the interference time at the determination point set by the determination point setting unit.
Equipped with
The control system according to claim 8, wherein the reliability control unit controls to set the reliability target according to the approach degree evaluated by the approach degree evaluation unit.
前記管制装置は、前記非コネクテッド移動体の走行経路と、前記非コネクテッド移動体と異なる他の移動体の走行経路と、に基づいて、前記非コネクテッド移動体と前記他の移動体との干渉地点を特定し、
前記移動体検出装置の前記判定地点設定部は、前記非コネクテッド移動体の走行経路を表す各々の経由点のうち、前記干渉地点に対応した経由点を前記判定地点として設定する
請求項9記載の管制システム。
The control device is an interference point between the unconnected mobile body and the other mobile body based on the travel path of the unconnected mobile body and the travel path of another moving body different from the unconnected mobile body. Identify and
The determination point setting unit of the moving body detection device sets the waypoint corresponding to the interference point among the waypoints representing the traveling paths of the non-connected moving body as the determination point. Control system.
前記移動体検出装置の前記接近度評価部は、前記非コネクテッド移動体の前記判定地点における干渉時間、及び前記非コネクテッド移動体と異なる他の移動体の前記判定地点における干渉時間から、前記非コネクテッド移動体の接近度を評価する
請求項9記載の管制システム。
The proximity evaluation unit of the mobile detection device determines the non-connected mobile body from the interference time at the determination point of the non-connected mobile body and the interference time at the determination point of another moving body different from the non-connected mobile body. The control system according to claim 9, which evaluates the degree of proximity of a moving object.
前記移動体検出装置の前記走路情報取得部は、前記移動体検出部で前記画像から検出された前記非コネクテッド移動体の位置及び速度に含まれる誤差の度合いを表す信頼度が点列毎に付与された前記地図データから、点列毎の走路情報を前記信頼度と共に取得し、
前記走行経路予測部は、予測した前記非コネクテッド移動体の走行経路上における各経由点での前記信頼度を反映した前記非コネクテッド移動体の位置及び速度を用いて、前記非コネクテッド移動体の走行経路上における経由点毎に前記非コネクテッド移動体の干渉時間を予測する
請求項11記載の管制システム。
The track information acquisition unit of the mobile body detection device gives reliability for each point sequence indicating the degree of error included in the position and speed of the non-connected mobile body detected from the image by the mobile body detection unit. From the map data obtained, the track information for each point sequence is acquired together with the reliability.
The travel route prediction unit uses the position and speed of the unconnected moving body to reflect the reliability at each waypoint on the traveling path of the unconnected moving body, and travels the unconnected moving body. The control system according to claim 11, wherein the interference time of the unconnected moving object is predicted for each waypoint on the route.
前記移動体検出装置は、前記走路情報取得部から前記地図データの点列を構成する各点に付与された前記信頼度を取得すると共に、前記信頼度制御部から前記信頼度目標を取得し、前記信頼度目標に応じて、前記地図データの点列を構成する各点に付与された前記信頼度を補正する信頼度補正部を備え、
前記走行経路予測部は、予測した前記非コネクテッド移動体の走行経路上における各経由点での前記信頼度補正部で補正された前記信頼度を反映した前記非コネクテッド移動体の位置及び速度を用いて、前記非コネクテッド移動体の走行経路上における経由点毎に前記非コネクテッド移動体の干渉時間を予測する
請求項12記載の管制システム。
The moving body detection device acquires the reliability given to each point constituting the point sequence of the map data from the track information acquisition unit, and acquires the reliability target from the reliability control unit. A reliability correction unit for correcting the reliability given to each point constituting the point sequence of the map data is provided according to the reliability target.
The travel route prediction unit uses the position and speed of the unconnected moving body that reflects the reliability corrected by the reliability correction unit at each waypoint on the traveling route of the predicted unconnected moving body. The control system according to claim 12, wherein the interference time of the unconnected moving body is predicted for each waypoint on the traveling path of the unconnected moving body.
前記移動体検出装置は、光、音、振動、空気の流れ、圧力、及び熱の少なくとも1つの再生エネルギーを利用して、自装置で消費する電力以上の電力を発電する動力生成部を備える
請求項8~請求項13の何れか1項に記載の管制システム。
The mobile detection device includes a power generator that uses at least one renewable energy of light, sound, vibration, air flow, pressure, and heat to generate more power than the power consumed by the device. The control system according to any one of items 8 to 13.
JP2020180641A 2020-10-28 2020-10-28 Mobile object detection device and control system Active JP7447763B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2020180641A JP7447763B2 (en) 2020-10-28 2020-10-28 Mobile object detection device and control system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020180641A JP7447763B2 (en) 2020-10-28 2020-10-28 Mobile object detection device and control system

Publications (2)

Publication Number Publication Date
JP2022071594A true JP2022071594A (en) 2022-05-16
JP7447763B2 JP7447763B2 (en) 2024-03-12

Family

ID=81593695

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020180641A Active JP7447763B2 (en) 2020-10-28 2020-10-28 Mobile object detection device and control system

Country Status (1)

Country Link
JP (1) JP7447763B2 (en)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011164064A (en) * 2010-02-15 2011-08-25 Panasonic Corp Electromagnetic-wave detection device, portable device, and determination method of electric car and the hybrid car, and program therefor
JP2020095503A (en) * 2018-12-13 2020-06-18 住友電気工業株式会社 Information analysis device, information analysis method, information analysis system, and computer program

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011164064A (en) * 2010-02-15 2011-08-25 Panasonic Corp Electromagnetic-wave detection device, portable device, and determination method of electric car and the hybrid car, and program therefor
JP2020095503A (en) * 2018-12-13 2020-06-18 住友電気工業株式会社 Information analysis device, information analysis method, information analysis system, and computer program

Also Published As

Publication number Publication date
JP7447763B2 (en) 2024-03-12

Similar Documents

Publication Publication Date Title
US10422649B2 (en) Autonomous driving sensing system and method
US10642279B2 (en) Automotive drone deployment system
JP6832421B2 (en) Simulation-based evaluation method for sensing requirements of self-driving cars
US10379533B2 (en) System and method for autonomous vehicle fleet routing
EP3832422A1 (en) Electronic device and vehicle control method of electronic device, server and method for providing precise map data of server
US10139245B2 (en) Device for providing electric-moving-body information and method for providing electric-moving-body information
US20170116850A1 (en) Traffic prediction system, vehicle-mounted display apparatus, vehicle, and traffic prediction method
US11230297B2 (en) Pedestrian probability prediction system for autonomous vehicles
JP4705259B2 (en) Road information processing apparatus, method, road information processing software, navigation system and method, and road information database creation method
CN107339997A (en) The path planning apparatus and method of autonomous vehicle
US20180322777A1 (en) Method and system for creating a lane-accurate occupancy grid map for lanes
JP6757442B2 (en) Lane post-processing in self-driving cars
RU2661963C1 (en) Device for calculating route of motion
CN107533800A (en) Cartographic information storage device, automatic Pilot control device, control method, program and storage medium
JP2015212863A (en) Traffic signal control device, traffic signal control method, and computer program
KR20190141081A (en) A v2x communication-based vehicle lane system for autonomous vehicles
CN111044057A (en) Real-time map generation scheme based on previous driving trajectories for autonomous vehicles
JP2009500765A (en) Method for determining traffic information and apparatus configured to perform the method
JP2020521191A (en) Driving method along lanes without maps and positioning for autonomous driving of autonomous vehicles on highways
CN112985825B (en) Method for determining the ride stability of an autopilot system
JP2022071594A (en) Mobile detection device, and control system
CN114763156A (en) Method of cognitive situational awareness using event structure based on attention
JP7491023B2 (en) Control equipment and control system
JP2023502598A (en) Crash monitoring using statistical models
CN112740134B (en) Electronic device, vehicle control method of electronic device, server, and method of providing accurate map data of server

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20230315

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20231128

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20231129

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20231228

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20240130

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20240212

R150 Certificate of patent or registration of utility model

Ref document number: 7447763

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150