JP6798206B2 - Recommended route determination system for mobiles - Google Patents

Recommended route determination system for mobiles Download PDF

Info

Publication number
JP6798206B2
JP6798206B2 JP2016179560A JP2016179560A JP6798206B2 JP 6798206 B2 JP6798206 B2 JP 6798206B2 JP 2016179560 A JP2016179560 A JP 2016179560A JP 2016179560 A JP2016179560 A JP 2016179560A JP 6798206 B2 JP6798206 B2 JP 6798206B2
Authority
JP
Japan
Prior art keywords
state quantity
recommended route
vehicle
mobiles
information
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.)
Active
Application number
JP2016179560A
Other languages
Japanese (ja)
Other versions
JP2018044848A (en
Inventor
佐藤 国仁
国仁 佐藤
市川 健太郎
健太郎 市川
博充 浦野
博充 浦野
泰亮 菅岩
泰亮 菅岩
文洋 奥村
文洋 奥村
麻衣子 平野
麻衣子 平野
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 Motor Corp
Original Assignee
Toyota Motor Corp
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 Motor Corp filed Critical Toyota Motor Corp
Priority to JP2016179560A priority Critical patent/JP6798206B2/en
Publication of JP2018044848A publication Critical patent/JP2018044848A/en
Application granted granted Critical
Publication of JP6798206B2 publication Critical patent/JP6798206B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Instructional Devices (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)

Description

本発明は移動体の推奨ルート決定システムに関する。 The present invention relates to a recommended route determination system for mobile objects.

自動運転制御による走行を行うのに適した経路程、より低いコスト値が算出されるように設定された自動運転コストテーブルを用いてコスト値を算出し、算出されたコスト値に基づいて推奨経路を探索する、経路探索システムが公知である(例えば、特許文献1参照)。この特許文献1において、自動運転コストテーブルは、交通量の少ない経路程、より低いコスト値が算出されるように設定される。 The cost value is calculated using the automatic operation cost table set so that the lower the cost value is calculated for the route suitable for traveling by automatic operation control, and the recommended route is based on the calculated cost value. A route search system for searching for is known (see, for example, Patent Document 1). In Patent Document 1, the automatic driving cost table is set so that a lower cost value is calculated for a route with less traffic.

国際公開第2015/129366号International Publication No. 2015/129366

しかしながら、特許文献1には、経路の交通量をどのようにして評価するかについて、何ら開示されていない。出発地及び目的地がそれぞれ無数に考えられるので、経路も無数に考えられる。無数の経路の交通量をそれぞれ正確に把握するのは容易なことではない。経路の交通量を正確に把握できなければ、適切な推奨ルートを決定することは困難である。 However, Patent Document 1 does not disclose how to evaluate the traffic volume of a route. Since there are innumerable starting points and innumerable destinations, there are innumerable routes. It is not easy to accurately grasp the traffic volume of each of the innumerable routes. It is difficult to determine an appropriate recommended route without accurately grasping the traffic volume of the route.

本発明によれば、移動体の推奨ルート決定システムであって、道路地図情報を記憶するように構成されている道路地図記憶装置と、環境地図情報を記憶するように構成されている環境地図記憶装置であって、前記環境地図情報は、空間内の複数の位置をそれぞれ表す位置情報と、前記複数の位置のそれぞれの状態量変化性であって、それぞれ対応する前記位置情報と関連付けられた前記状態量変化性と、を有しており、前記状態量変化性は、対応する位置の状態量の時間に対する変化が小さいときには当該変化が大きいときに比べて小さい、環境地図記憶装置と、前記移動体の出発地の位置情報及び目的地の位置情報を獲得するように構成されている獲得部と、前記道路地図情報、並びに、前記移動体の出発地の位置情報及び目的地の位置情報を用いて、前記移動体の推奨ルートの一次候補を複数決定するように構成されている一次候補決定部と、前記環境地図情報を用いて、前記一次候補のルート状態量変化性をそれぞれ算出するように構成されている算出部と、前記一次候補のうち前記ルート状態量変化性が最小の一次候補上を移動する他移動体の数があらかじめ定められた設定数よりも少ないか否かを判断するように構成されている判断部と、前記他移動体の数が前記設定数よりも少ないと判断されたときには、前記ルート状態量変化性が最小の一次候補を前記移動体の推奨ルートに決定し、前記他移動体の数が前記設定数よりも多いと判断されたときには、前記ルート状態量変化性があらかじめ定められたしきい値よりも小さい前記一次候補のうちのいずれか1つを前記移動体の推奨ルートに決定する、ように構成されている推奨ルート決定部と、を備えた、移動体の推奨ルート決定システムが提供される。 According to the present invention, it is a recommended route determination system for a moving body, that is, a road map storage device configured to store road map information and an environmental map storage configured to store environmental map information. In the device, the environment map information is position information representing a plurality of positions in space, and state quantity changeability of each of the plurality of positions, and is associated with the corresponding position information. The state quantity changeability is smaller when the change of the state quantity of the corresponding position with respect to time is small than when the change is large, and the environmental map storage device and the movement. Using the acquisition unit configured to acquire the position information of the departure point of the body and the position information of the destination, the road map information, the position information of the departure point of the moving body, and the position information of the destination. Therefore, the route state quantity changeability of the primary candidate is calculated by using the primary candidate determination unit configured to determine a plurality of primary candidates of the recommended route of the moving body and the environment map information. To determine whether or not the number of the configured calculation unit and the number of other moving objects moving on the primary candidate having the smallest root state quantity changeability among the primary candidates is less than the predetermined number. When it is determined that the number of the other moving bodies is less than the set number, the primary candidate having the smallest change in the route state quantity is determined as the recommended route of the moving body. When it is determined that the number of the other moving bodies is larger than the set number, any one of the primary candidates whose root state quantity changeability is smaller than a predetermined threshold value is selected as the moving body. A recommended route determination system for a moving body is provided, which comprises a recommended route determination unit configured to determine the recommended route of the moving body.

より適切な推奨ルートをより簡単に決定することができる。 It is easier to determine a more appropriate recommended route.

本発明による実施例の概略全体である。It is the whole outline of the Example by this invention. 推奨ルート決定システムのブロック図である。It is a block diagram of a recommended route determination system. 車両の制御システムのブロック図である。It is a block diagram of a vehicle control system. 本発明による実施例の外部センサを説明する概略図である。It is the schematic explaining the external sensor of the Example by this invention. 環境地図情報の概念図である。It is a conceptual diagram of environmental map information. 状態量の時間に対する変化の一例を示すタイムチャートである。It is a time chart which shows an example of the change with respect to time of a state quantity. 状態量の時間に対する変化の別の例を示すタイムチャートである。It is a time chart which shows another example of the change of a state quantity with respect to time. 状態量の時間に対する変化の更に別の例を示すタイムチャートである。It is a time chart which shows still another example of the change of a state quantity with respect to time. 位置情報及び状態量の検出方法を説明する概略図である。It is the schematic explaining the detection method of the position information and the state quantity. 状態量変化性の算Calculation of state quantity changeability 一次候補の例を示す概略図である。It is the schematic which shows the example of the primary candidate. ルート状態量変化性とオーバーライド率との関係を示す線図である。It is a diagram which shows the relationship between the root state quantity changeability and an override rate. 本発明による実施例の推奨ルート決定制御ルーチンを示すフローチャートである。It is a flowchart which shows the recommended route determination control routine of the Example by this invention. 本発明による実施例の目標ルート設定制御ルーチンを示すフローチャートである。It is a flowchart which shows the target route setting control routine of the Example by this invention.

図1は本発明の実施例の概略全体図を示している。図1を参照すると、DCはデータセンタを、Vは移動体をそれぞれ示している。図1に示される例では移動体Vは車両である。別の実施例では、移動体は移動ロボットである。データセンタDCは移動体の推奨ルート決定システム10を備える。一方、車両は制御システム30をそれぞれ備える。図1に示されるように、データセンタDCと複数の車両Vとは、インターネットのような通信網NWを介して相互に通信可能になっている。 FIG. 1 shows a schematic overall view of an embodiment of the present invention. With reference to FIG. 1, DC represents a data center and V represents a mobile body. In the example shown in FIG. 1, the moving body V is a vehicle. In another embodiment, the moving body is a mobile robot. The data center DC includes a recommended route determination system 10 for a mobile body. On the other hand, each vehicle includes a control system 30. As shown in FIG. 1, the data center DC and a plurality of cars both V, and can communicate with each other via a communication network NW such as the Internet.

図2はデータセンタDCに設置された推奨ルート決定システム10のブロック図を示している。図2を参照すると、推奨ルート決定システム10は、道路地図記憶装置11、環境地図記憶装置12、通信装置13、及び、電子制御ユニット(ECU,Electronic Computer Unit)20を備える。 FIG. 2 shows a block diagram of the recommended route determination system 10 installed in the data center DC. Referring to FIG. 2, the recommended route determination system 10 includes a road map storage device 11, an environment map storage device 12, a communication device 13, and an electronic control unit (ECU, Electronic Computer Unit) 20.

道路地図記憶装置11は、道路地図情報を記憶するように構成されている。道路地図情報には、例えば、道路の位置情報、道路形状の情報(例えば、道路の幅、カーブと直線部の種別、カーブの曲率、交差点、合流点及び分岐点の位置など)などが含まれる。道路地図記憶装置11に記憶されている道路地図情報は電子制御ユニット20からの要求に応じて電子制御ユニット20に送信される。なお、道路には、移動体が移動可能な、屋内の通路なども含まれる。 The road map storage device 11 is configured to store road map information. Road map information includes, for example, road position information, road shape information (for example, road width, curve and straight line type, curve curvature, intersection, confluence and branch point positions, etc.). .. The road map information stored in the road map storage device 11 is transmitted to the electronic control unit 20 in response to a request from the electronic control unit 20. The road also includes an indoor passage where a moving body can move.

環境地図記憶装置12は、環境地図情報を記憶するように構成されている。環境地図情報については後述する。環境地図情報は電子制御ユニット20からの要求に応じて電子制御ユニット20に送信される。 The environmental map storage device 12 is configured to store environmental map information. Environmental map information will be described later. The environmental map information is transmitted to the electronic control unit 20 in response to a request from the electronic control unit 20.

通信装置13は、電子制御ユニット20が通信網NWを介して外部と通信できるようにするように構成されている。 The communication device 13 is configured so that the electronic control unit 20 can communicate with the outside via the communication network NW.

電子制御ユニット20は、CPU(Central Processing Unit)などを備えたコンピュータである。本発明による実施例では、電子制御ユニット20は、ROM(Read Only Memory)及びRAM(Random Access Memory)を含む記憶部21、獲得部22、一次候補決定部23、算出部24、判断部25、推奨ルート決定部26、及び、環境地図作成・更新部27を備える。 The electronic control unit 20 is a computer equipped with a CPU (Central Processing Unit) or the like. In the embodiment according to the present invention, the electronic control unit 20 includes a storage unit 21, an acquisition unit 22, a primary candidate determination unit 23, a calculation unit 24, a determination unit 25, including a ROM (Read Only Memory) and a RAM (Random Access Memory). It includes a recommended route determination unit 26 and an environment map creation / update unit 27.

獲得部22は、車両Vの出発地の位置情報及び目的地の位置情報を獲得するように構成されている。一方、一次候補決定部23は、道路地図情報、並びに、車両Vの出発地の位置情報及び目的地の位置情報を用いて、車両Vのルートの一次候補を複数決定するように構成されている。算出部24は、環境地図情報を用いて、一次候補の推奨ルート状態量変化性をそれぞれ算出するように構成されている。判断部25は、一次候補のうちルート状態量変化性が最小の一次候補上を走行する他車両の数があらかじめ定められた設定数よりも少ないか否かを判断するように構成されている。推奨ルート決定部26は、他車両の数が設定数よりも少ないと判断されたときには、ルート状態量変化性が最小の一次候補を車両Vの推奨ルートに決定し、他車両の数が設定数よりも多いと判断されたときには、ルート状態量変化性があらかじめ定められたしきい値よりも小さい一次候補のうちのいずれか1つを車両Vの推奨ルートに決定する、ように構成されている。環境地図作成・更新部27は、環境地図情報を作成して環境地図記憶装置12に記憶するとともに、環境地図記憶装置12に記憶されている環境地図情報を更新するように構成されている。 The acquisition unit 22 is configured to acquire the position information of the departure place and the position information of the destination of the vehicle V. On the other hand, the primary candidate determination unit 23 is configured to determine a plurality of primary candidates for the route of the vehicle V by using the road map information, the position information of the departure point of the vehicle V, and the position information of the destination. .. The calculation unit 24 is configured to calculate the recommended route state quantity changeability of the primary candidate by using the environmental map information. The determination unit 25 is configured to determine whether or not the number of other vehicles traveling on the primary candidate having the smallest route state quantity changeability among the primary candidates is less than a predetermined number. When the recommended route determination unit 26 determines that the number of other vehicles is less than the set number, the recommended route determination unit 26 determines the primary candidate having the smallest change in the route state quantity as the recommended route of the vehicle V, and the number of other vehicles is the set number. When it is determined that there are more than, one of the primary candidates whose route state quantity variability is smaller than the predetermined threshold value is determined as the recommended route of the vehicle V. .. The environment map creation / update unit 27 is configured to create environment map information and store it in the environment map storage device 12, and update the environment map information stored in the environment map storage device 12.

一方、図3は車両Vに搭載された制御システム30のブロック図を示している。図3を参照すると、車両Vの制御システム30は、外部センサ31、GPS受信機32、内部センサ33、道路地図記憶装置34、記憶装置35、通信装置36、HMI(Human Machine Interface)37、アクチュエータ38、及び、電子制御ユニット40を備える。 On the other hand, FIG. 3 shows a block diagram of the control system 30 mounted on the vehicle V. Referring to FIG. 3, the control system 30 of the vehicle V includes an external sensor 31, a GPS receiver 32, an internal sensor 33, a road map storage device 34, a storage device 35, a communication device 36, an HMI (Human Machine Interface) 37, and an actuator. 38 and an electronic control unit 40 are provided.

外部センサ31は自車両Vの外部又は周囲の情報を検出するように構成されている。外部センサ31はライダー(LIDAR:Laser Imaging Detection and Ranging)、レーダー(Radar)、及びカメラのうち少なくとも1つを備える。本発明による実施例では図4に示されるように、外部センサ31はライダー31a、レーダー31b、及びカメラ31cを備える。 The external sensor 31 is configured to detect information outside or around the own vehicle V. The external sensor 31 includes at least one of a lidar (Laser Imaging Detection and Ranking), a radar (Radar), and a camera. In the embodiment according to the present invention, as shown in FIG. 4, the external sensor 31 includes a rider 31a, a radar 31b, and a camera 31c.

ライダー31aはレーザー光を利用して自車両が走行している道路や外部の障害物を検出する装置である。図4に示される例では、4つのライダー31aが車両Vの四隅においてバンパーにそれぞれ取り付けられる。ライダー31aは、自車両Vの全周囲に向けてレーザー光を順次照射し、その反射光から道路上及び道路周辺の障害物までの距離を計測し、自車両Vの全周囲における道路及び障害物を三次元画像の形で検出する。ライダー31aにより検出された道路及び障害物の三次元画像は電子制御ユニット40へ送信される。一方、レーダー31bは、電波を利用して自車両Vの外部の障害物を検出する装置である。図4に示される例では4つのレーダー31bが車両Vの四隅においてバンパーにそれぞれ取り付けられる。レーダー31bは、レーダー31bから自車両Vの周囲に電波を発射し、その反射波から自車両Vの周囲の障害物までの距離を計測する。レーダー31bにより検出された障害物情報は電子制御ユニット40へ送信される。カメラ31cは図4に示される例では、車両Vのフロントガラスの内側に設けられた前方カメラを備える。前方カメラ31cは自車両Vの前方をカラー又はモノクロ撮影し、前方カメラ31cによるカラー又はモノクロ撮影情報は電子制御ユニット40へ送信される。 The rider 31a is a device that uses laser light to detect a road on which the vehicle is traveling or an external obstacle. In the example shown in FIG. 4, four riders 31a are attached to bumpers at the four corners of the vehicle V, respectively. The rider 31a sequentially irradiates the laser beam toward the entire circumference of the own vehicle V, measures the distance from the reflected light to the obstacle on the road and around the road, and measures the road and the obstacle around the entire circumference of the own vehicle V. Is detected in the form of a three-dimensional image. The three-dimensional images of roads and obstacles detected by the rider 31a are transmitted to the electronic control unit 40. On the other hand, the radar 31b is a device that detects an obstacle outside the own vehicle V by using radio waves. In the example shown in FIG. 4, four radars 31b are attached to bumpers at the four corners of the vehicle V, respectively. The radar 31b emits radio waves from the radar 31b around the own vehicle V, and measures the distance from the reflected wave to an obstacle around the own vehicle V. The obstacle information detected by the radar 31b is transmitted to the electronic control unit 40. In the example shown in FIG. 4, the camera 31c includes a front camera provided inside the windshield of the vehicle V. The front camera 31c photographs the front of the own vehicle V in color or monochrome, and the color or monochrome imaging information by the front camera 31c is transmitted to the electronic control unit 40.

GPS受信機32は、3個以上のGPS衛星からの信号を受信し、それにより自車両Vの絶対位置(例えば自車両Vの緯度及び経度)を検出するように構成されている。GPS受信機32により検出された自車両Vの絶対位置情報は電子制御ユニット40へ送信される。 The GPS receiver 32 is configured to receive signals from three or more GPS satellites and thereby detect the absolute position of the own vehicle V (for example, the latitude and longitude of the own vehicle V). The absolute position information of the own vehicle V detected by the GPS receiver 32 is transmitted to the electronic control unit 40.

内部センサ33は、自車両Vの走行状態を検出するように構成されている。自車両Vの走行状態は、自車両の速度、加速度、及び姿勢のうち少なくとも1つにより表される。内部センサ33は、車速センサ及びIMU(Inertial Measurement Unit)の一方又は両方を備える。本発明による実施例では内部センサ33は車速センサ及びIMUを備える。車速センサは、自車両Vの速度を検出する。IMUは例えば3軸のジャイロ及び3方向の加速度センサを備え、自車両Vの3次元の角速度及び加速度を検出し、それらに基づいて自車両Vの加速度及び姿勢を検出する。内部センサ33により検出された自車両Vの走行状態情報は電子制御ユニット40へ送信される。 The internal sensor 33 is configured to detect the traveling state of the own vehicle V. The traveling state of the own vehicle V is represented by at least one of the speed, acceleration, and posture of the own vehicle. The internal sensor 33 includes one or both of a vehicle speed sensor and an IMU (Inertial Measurement Unit). In the embodiment according to the present invention, the internal sensor 33 includes a vehicle speed sensor and an IMU. The vehicle speed sensor detects the speed of the own vehicle V. The IMU is equipped with, for example, a three-axis gyro and a three-direction acceleration sensor, detects the three-dimensional angular velocity and acceleration of the own vehicle V, and detects the acceleration and attitude of the own vehicle V based on them. The running state information of the own vehicle V detected by the internal sensor 33 is transmitted to the electronic control unit 40.

道路地図記憶装置34は、上述した道路地図記憶装置11と同様に、道路地図情報を記憶するように構成されている。道路地図記憶装置34に記憶されている道路地図情報は電子制御ユニット40からの要求に応じて電子制御ユニット20に送信される。 The road map storage device 34 is configured to store road map information in the same manner as the road map storage device 11 described above. The road map information stored in the road map storage device 34 is transmitted to the electronic control unit 20 in response to a request from the electronic control unit 40.

記憶装置35は、ライダー31aにより検出された障害物の三次元画像及びライダー31aの検出結果に基づき作成された自動運転専用の道路地図を記憶するように構成されている。これら障害物の三次元画像及び道路地図は常時又は定期的に更新される。 The storage device 35 is configured to store a three-dimensional image of an obstacle detected by the rider 31a and a road map dedicated to autonomous driving created based on the detection result of the rider 31a. Three-dimensional images and road maps of these obstacles are updated constantly or regularly.

通信装置36は、電子制御ユニット40が通信網NWを介して外部と通信できるようにするように構成されている。 The communication device 36 is configured so that the electronic control unit 40 can communicate with the outside via the communication network NW.

HMI37は、自車両Vの乗員と制御システム30との間で情報をやりとりするように構成されている。HMI37は、例えば、乗員に文字情報及び画像情報の少なくとも1つを提供するディスプレイ、乗員に音情報を提供するスピーカ、及び、乗員が操作する操作装置(例えば、ボタン、レバー、ダイアル、タッチパネルなど)を備える。 The HMI 37 is configured to exchange information between the occupant of the own vehicle V and the control system 30. The HMI 37 is, for example, a display that provides the occupant with at least one of text information and image information, a speaker that provides the occupant with sound information, and an operating device operated by the occupant (for example, a button, a lever, a dial, a touch panel, etc.). To be equipped with.

アクチュエータ38は、電子制御ユニット40からの制御信号に応じて自車両Vの走行操作を制御するように構成されている。車両Vの走行操作には車両Vの駆動、制動及び操舵が含まれる。アクチュエータ38は、駆動アクチュエータ、制動アクチュエータ、及び操舵アクチュエータのうちの少なくとも1つを備える。本発明による実施例ではアクチュエータ38は駆動アクチュエータ、制動アクチュエータ、及び操舵アクチュエータを備える。駆動アクチュエータは、車両Vの駆動力を提供するエンジン又は電気モータの出力を制御し、それにより車両Vの駆動操作を制御する。制動アクチュエータは、車両Vの制動装置を操作し、それにより車両Vの制動操作を制御する。操舵アクチュエータは、車両Vの操舵装置を操作し、それにより車両Vの操舵操作を制御する。 The actuator 38 is configured to control the traveling operation of the own vehicle V in response to a control signal from the electronic control unit 40. The traveling operation of the vehicle V includes driving, braking and steering of the vehicle V. The actuator 38 includes at least one of a drive actuator, a braking actuator, and a steering actuator. In the embodiment according to the present invention, the actuator 38 includes a drive actuator, a braking actuator, and a steering actuator. The drive actuator controls the output of the engine or electric motor that provides the driving force of the vehicle V, thereby controlling the driving operation of the vehicle V. The braking actuator operates the braking device of the vehicle V, thereby controlling the braking operation of the vehicle V. The steering actuator operates the steering device of the vehicle V, thereby controlling the steering operation of the vehicle V.

電子制御ユニット40は、上述した電子制御ユニット20と同様に、コンピュータである。本発明による実施例では、電子制御ユニット40は、ROM及びRAMを含む記憶部41、運転制御部42、及び、目標ルート設定部43を備える。 The electronic control unit 40 is a computer like the electronic control unit 20 described above. In the embodiment according to the present invention, the electronic control unit 40 includes a storage unit 41 including a ROM and a RAM, an operation control unit 42, and a target route setting unit 43.

運転制御部42は、車両運転を制御するように構成されている。一方、目標ルート設定部43は、車両Vの目標ルートを設定するように構成されている。 The driving control unit 42 is configured to control vehicle driving. On the other hand, the target route setting unit 43 is configured to set the target route of the vehicle V.

次に、本発明による実施例の環境地図情報を説明する。本発明による実施例の環境地図情報は、空間内の複数の位置をそれぞれ表す位置情報と、それぞれ対応する位置情報と関連付けられた状態量変化性と、を有する。本発明による実施例では、位置情報は経度及び緯度により表される。したがって、図5に示されるように、環境地図情報Mは二次元地図の形をなす。図5に示される例では、互いに同一形状の複数の区画SCが設けられており、複数の区画SCにそれぞれおいて、当該区画SCの位置情報に対応する状態量変化性が関連付けられている。すなわち、任意の位置の位置情報が入力されると、当該位置が属する区画SCが特定され、特定された区画SCに関連付けられた状態量変化性が出力される。なお、図5において、LGは経度、LTは緯度をそれぞれ表している。別の実施例(図示しない)では、位置情報は経度、緯度及び高度により表される。この場合、環境地図情報Mは三次元地図の形をなす。 Next, the environmental map information of the embodiment according to the present invention will be described. The environmental map information of the embodiment according to the present invention has position information representing each of a plurality of positions in the space, and state quantity variability associated with the corresponding position information. In the embodiment according to the present invention, the position information is represented by longitude and latitude. Therefore, as shown in FIG. 5, the environmental map information M is in the form of a two-dimensional map. In the example shown in FIG. 5, a plurality of compartments SC having the same shape are provided, and the state quantity variability corresponding to the position information of the compartment SC is associated with each of the plurality of compartments SC. That is, when the position information of an arbitrary position is input, the section SC to which the position belongs is specified, and the state quantity changeability associated with the specified section SC is output. In FIG. 5, LG represents longitude and LT represents latitude. In another embodiment (not shown), location information is represented by longitude, latitude and altitude. In this case, the environmental map information M is in the form of a three-dimensional map.

或る位置の状態量変化性は、当該或る位置の状態量に基づいて算出される。本発明による実施例では、或る位置の状態量は、当該或る位置に物体が存在する確率により表される。この場合、状態量は例えば、ゼロから1までの連続値の形で算出される。別の実施例(図示しない)では、状態量は離散値の形で算出される。 The state quantity changeability at a certain position is calculated based on the state quantity at the certain position. In the embodiment according to the present invention, the state quantity at a certain position is represented by the probability that an object exists at the certain position. In this case, the state quantity is calculated, for example, in the form of continuous values from zero to one. In another embodiment (not shown), the state quantity is calculated in the form of discrete values.

或る位置の状態量変化性は、当該或る位置の状態量の時間に対する変化のしやすさを表す数値である。具体的には、或る位置の状態量変化性は、当該或る位置の状態量の時間に対する変化が小さいときには当該変化が大きいときに比べて、小さい。本発明による実施例では、状態量変化性は連続値の形で算出される。別の実施例(図示しない)では、状態量変化性は離散値の形で算出される。次に、図6A、図6B、及び図6Cを参照して、状態量変化性を更に説明する。なお、図6A、図6B、及び図6Cには、同一の位置において種々の時間に検出された状態量がそれぞれプロットされている。 The state quantity changeability at a certain position is a numerical value indicating the ease of change of the state quantity at a certain position with time. Specifically, the state quantity changeability at a certain position is smaller when the change in the state quantity at a certain position with time is small than when the change is large. In the examples according to the present invention, the state quantity changeability is calculated in the form of continuous values. In another embodiment (not shown), the state quantity variability is calculated in the form of discrete values. Next, the state quantity changeability will be further described with reference to FIGS. 6A, 6B, and 6C. In addition, in FIG. 6A, FIG. 6B, and FIG. 6C, the state quantities detected at various times at the same position are plotted.

状態量変化性は、例えば、時間に対する状態量の変化の頻度や変化の程度などによって表される。図6Aに示される例の状態量は、図6Bに示される例の状態量に比べて、変化の頻度が低い。したがって、図6Aに示される例の状態量変化性は、図6Bに示される例の状態量変化性よりも小さい。一方、図6Aに示される例の状態量は、図6Cに示される例の状態量に比べて、変化の程度が小さい。したがって、図6Aに示される例の状態量変化性は、図6Cに示される例の状態量変化性よりも小さい。 The state quantity changeability is represented by, for example, the frequency of change of the state quantity with time and the degree of change. The state quantity of the example shown in FIG. 6A changes less frequently than the state quantity of the example shown in FIG. 6B. Therefore, the state quantity changeability of the example shown in FIG. 6A is smaller than the state quantity changeability of the example shown in FIG. 6B. On the other hand, the state quantity of the example shown in FIG. 6A has a smaller degree of change than the state quantity of the example shown in FIG. 6C. Therefore, the state quantity changeability of the example shown in FIG. 6A is smaller than the state quantity changeability of the example shown in FIG. 6C.

本発明による実施例では、上述したように、或る位置の状態量は当該或る位置に物体が存在する確率により表される。したがって、状態量変化性が比較的大きい位置においては、当該位置を物体(例えば、他車両、歩行者など)が通過する頻度が比較的高く、当該位置の状態は比較的不安定であるということがわかる。これに対し、状態量変化性が比較的小さい位置においては、当該位置を物体が通過する頻度が比較的低く、当該位置の状態は比較的安定しているということがわかる。このように、或る位置の状態量変化性は、当該或る位置の状態の安定性を表している。 In the embodiment according to the present invention, as described above, the state quantity at a certain position is represented by the probability that an object exists at the certain position. Therefore, at a position where the state quantity changeability is relatively large, an object (for example, another vehicle, a pedestrian, etc.) passes through the position relatively frequently, and the state at the position is relatively unstable. I understand. On the other hand, at a position where the state quantity changeability is relatively small, the frequency with which the object passes through the position is relatively low, and it can be seen that the state at the position is relatively stable. As described above, the state quantity changeability at a certain position represents the stability of the state at the certain position.

別の実施例(図示しない)では、或る位置の状態量は、或る位置に存在する物体の色又は輝度値により表される。状態量が物体の色により表わされる場合には、物体の色は、外部センサ31のカラーカメラ31cにより検出される。この場合、状態量は、例えばRGBモデルを用いて数値化される。一方、状態量が物体の輝度値により表わされる場合には、物体の輝度値は、外部センサ31のライダー31a、レーダー31b、及び、カラー又はモノクロカメラ31cのうちの少なくとも1つにより検出される。例えば、ライダー31aから発射されたレーザー光が物体に反射したときに得られる反射光の強度は当該物体の輝度値を表している。同様に、レーダー31bの反射波強度は物体の輝度値を表している。したがって、反射光強度又は反射波強度を検出することにより、物体の輝度値が検出される。 In another embodiment (not shown), the state quantity at a position is represented by the color or luminance value of the object present at the position. When the state quantity is represented by the color of the object, the color of the object is detected by the color camera 31c of the external sensor 31. In this case, the state quantity is quantified using, for example, an RGB model. On the other hand, when the state quantity is represented by the luminance value of the object, the luminance value of the object is detected by at least one of the lidar 31a, the radar 31b, and the color or monochrome camera 31c of the external sensor 31. For example, the intensity of the reflected light obtained when the laser light emitted from the rider 31a is reflected on the object represents the brightness value of the object. Similarly, the reflected wave intensity of the radar 31b represents the brightness value of the object. Therefore, the brightness value of the object is detected by detecting the reflected light intensity or the reflected wave intensity.

本発明による実施例では、例えば次のようにして環境地図情報Mが作成される。すなわち、まず、車両Vの外部センサ31、例えばライダー31aを用いて、空間内の複数の位置のそれぞれについて、当該位置を表す位置情報と、互いに異なる時刻における当該位置の状態量とが検出される。このことを、図7を参照して説明する。 In the embodiment according to the present invention, the environmental map information M is created as follows, for example. That is, first, the external sensor 31 of the vehicle V, for example, the rider 31a, is used to detect the position information representing the position and the state quantity of the position at different times for each of the plurality of positions in the space. .. This will be described with reference to FIG.

図7は、車両Vのライダー31aから照射されたレーザー光が物体OBJで反射した場合を示している。この場合、図7に黒丸で示されるように、位置PXに反射点が形成される。ライダー31aは、反射光から、ライダー31aに対する位置PXの相対位置情報を計測する。この計測結果から、位置PXに物体OBJが存在するということがわかる。本発明による実施例では状態量は上述したように物体存在確率により表わされるので、位置PXの状態量は1となる。また、ライダー31aに対する位置PXの相対位置情報と、車両Vの自己位置情報(絶対位置)とから、位置PXの絶対位置情報が算出される。更に、図7に白丸で示される反射点でない位置PYに物体が存在しないということがわかり、したがって位置PYの状態量すなわち物体存在確率はゼロとなる。また、位置PYの絶対位置情報が算出される。このようにして、位置PX,PYの絶対位置情報及び状態量が算出される。 FIG. 7 shows a case where the laser beam emitted from the rider 31a of the vehicle V is reflected by the object OBJ. In this case, a reflection point is formed at the position PX as shown by a black circle in FIG. The rider 31a measures the relative position information of the position PX with respect to the rider 31a from the reflected light. From this measurement result, it can be seen that the object OBJ exists at the position PX. In the embodiment according to the present invention, the state quantity is represented by the object existence probability as described above, so that the state quantity at the position PX is 1. Further, the absolute position information of the position PX is calculated from the relative position information of the position PX with respect to the rider 31a and the self-position information (absolute position) of the vehicle V. Further, it can be seen that the object does not exist at the position PY which is not the reflection point indicated by the white circle in FIG. 7, and therefore the state quantity of the position PY, that is, the object existence probability becomes zero. In addition, the absolute position information of the position PY is calculated. In this way, the absolute position information and the state quantity of the positions PX and PY are calculated.

本発明による実施例では、ライダー31aは物体情報を例えば数十msのインターバルで繰り返し検出する。言い換えると、ライダー31aは、互いに異なる複数の時刻における物体情報を検出する。したがって、互いに異なる複数の時刻における物体情報から、互いに異なる複数の時刻における状態量が算出される。あるいは、車両Vが一定の場所を複数回走行した場合にも、互いに異なる複数の時刻における物体情報が検出され、したがって互いに異なる複数の時刻における状態量が算出される。 In the embodiment according to the present invention, the rider 31a repeatedly detects the object information at intervals of, for example, several tens of ms. In other words, the rider 31a detects object information at a plurality of different times. Therefore, the state quantities at a plurality of different times are calculated from the object information at a plurality of different times. Alternatively, even when the vehicle V travels a certain place a plurality of times, the object information at a plurality of different times is detected, and therefore the state quantities at a plurality of different times are calculated.

次いで、検出された位置情報及び状態量がデータセンサDCに送信される。次いで、データセンサDCの環境地図作成・更新部27により、環境地図情報Mが作成される。具体的には、複数の区画SC(図5)のそれぞれの状態量変化性が算出される。本発明による実施例では、状態量の単位時間当たりの変化量が算出され、状態量の単位時間当たりの変化量に基づいて状態量変化性が算出される。このことを、図8を参照して説明する。 Next, the detected position information and state quantity are transmitted to the data sensor DC. Next, the environment map information M is created by the environment map creation / update unit 27 of the data sensor DC. Specifically, the state quantity changeability of each of the plurality of compartments SC (FIG. 5) is calculated. In the embodiment according to the present invention, the amount of change in the state quantity per unit time is calculated, and the state quantity changeability is calculated based on the amount of change in the state quantity per unit time. This will be described with reference to FIG.

図8には、同一の区画SCに属する位置の状態量であって、互いに異なる複数の時刻に検出された複数の状態量が、時間の関数としてプロットされている。この場合、まず時間幅dt1における状態量の変化量dSQ1(絶対値)、時間幅dt2における状態量の変化量dSQ2(絶対値),…が順次算出される。次いで、状態量の単位時間当たりの変化量dSQ1/dt1、dSQ2/dt2,…が順次算出される。次いで、状態量の単位時間当たりの変化量dSQ1/dt1,dSQ2/dt2,…を単純平均又は加重平均することにより、状態量変化性が算出される。加重平均が用いられる場合、一例では、検出時期がより新しい状態量の単位時間当たりの変化量dSQ/dtがより大きく重み付けされ、検出時期がより古い状態量の単位時間当たりの変化量dSQ/dtがより小さく重み付けされる。別の例では、検出時期がより新しい状態量の単位時間当たりの変化量dSQ/dtがより小さく重み付けされ、検出時期がより古い状態量の単位時間当たりの変化量dSQ/dtがより大きく重み付けされる。このような状態量変化性の算出が複数の区画SCについてそれぞれ行われる。なお、図8に示される例では、時間幅dt1,dt2,…は互いに等しい。別の実施例(図示しない)では、時間幅dt1,dt2,…は必ずしも互いに等しくない。 In FIG. 8, a plurality of state quantities of positions belonging to the same compartment SC and detected at a plurality of different times are plotted as a function of time. In this case, first, the change amount dSQ1 (absolute value) of the state quantity in the time width dt1 and the change amount dSQ2 (absolute value) of the state quantity in the time width dt2 are sequentially calculated. Next, the changes in the state quantity per unit time dSQ1 / dt1, dSQ2 / dt2, ... Are sequentially calculated. Next, the state quantity changeability is calculated by simply averaging or weighted averaging the changes in the state quantity per unit time dSQ1 / dt1, dSQ2 / dt2, ... When a weighted average is used, in one example, the amount of change dSQ / dt per unit time of a state quantity with a newer detection time is weighted more, and the amount of change dSQ / dt per unit time of a state quantity with an older detection time. Is weighted less. In another example, the amount of change dSQ / dt per unit time of a state quantity with a newer detection time is weighted less, and the amount of change dSQ / dt per unit time of a state quantity with an older detection time is weighted more. To. Such calculation of the state quantity changeability is performed for each of the plurality of compartments SC. In the example shown in FIG. 8, the time widths dt1, dt2, ... Are equal to each other. In another embodiment (not shown), the time widths dt1, dt2, ... Are not necessarily equal to each other.

別の実施例(図示しない)では、時間の関数としての複数の状態量がフーリエ変換され、その結果から状態量変化性が算出される。具体的には、一例では、あらかじめ定められたスペクトル(周波数)の強度が状態量変化性として算出される。別の例では、種々のスペクトルの強度を単純平均又は加重平均することにより状態量変化性が算出される。 In another embodiment (not shown), a plurality of state quantities as a function of time are Fourier transformed, and the state quantity changeability is calculated from the result. Specifically, in one example, the intensity of a predetermined spectrum (frequency) is calculated as the state quantity changeability. In another example, the state quantity variability is calculated by simple averaging or weighted averaging the intensities of the various spectra.

次いで、区画SCの位置情報と、対応する状態量変化性とが、関連付けられて環境地図記憶装置12内に記憶される。このようにして環境地図情報Mが作成される。 Next, the position information of the section SC and the corresponding state quantity changeability are associated and stored in the environment map storage device 12. In this way, the environmental map information M is created.

別の実施例(図示しない)では、複数の位置のそれぞれについて状態量変化性が算出される。次いで、区画SCに属する位置の状態量変化性を単純平均又は加重平均することにより、当該区画SCの状態量変化性が算出される。 In another embodiment (not shown), state quantity variability is calculated for each of the plurality of positions. Next, the state quantity changeability of the position belonging to the compartment SC is calculated by simple averaging or weighted averaging.

本発明による実施例では更に、環境地図作成・更新部27により、環境地図情報Mが更新される。すなわち、まず、車両Vにより、位置情報及び状態量が新たに検出され、データセンサDCに送信される。データセンタDCでは次いで、新たに検出された位置が属する区画SCが特定される。次いで、特定された区画SCに関連付けられている状態量変化性、すなわち環境地図情報Mの状態量変化性と、新たに検出された状態量とが例えば加重平均され、それによって状態量変化性が更新される。 In the embodiment according to the present invention, the environmental map information M is further updated by the environmental map creation / updating unit 27. That is, first, the vehicle V newly detects the position information and the state quantity, and transmits the position information and the state quantity to the data sensor DC. The data center DC then identifies the compartment SC to which the newly detected location belongs. Then, the state quantity changeability associated with the specified compartment SC, that is, the state quantity changeability of the environmental map information M and the newly detected state quantity are, for example, weighted averaged, whereby the state quantity changeability is increased. Will be updated.

本発明による実施例では、このような環境地図情報Mの更新は例えば、一定時間ごとに繰り返される。その結果、環境地図情報Mがより正確な状態に維持される。また、本発明による実施例では、位置情報及び状態量の検出及びデータセンタDCへの送信は複数の車両Vによって行われる。その結果、環境地図情報Mの作成及び更新がより高い精度でもって行われる。 In the embodiment according to the present invention, such updating of the environmental map information M is repeated, for example, at regular time intervals. As a result, the environmental map information M is maintained in a more accurate state. Further, in the embodiment according to the present invention, the detection of the position information and the state quantity and the transmission to the data center DC are performed by the plurality of vehicles V. As a result, the environment map information M is created and updated with higher accuracy.

別の実施例(図示しない)では、環境地図作成・更新部27が車両Vに搭載される。更に別の実施例(図示しない)では、環境地図作成・更新部27及び環境地図記憶装置12が車両Vに搭載される。 In another embodiment (not shown), the environment map creation / updating unit 27 is mounted on the vehicle V. In yet another embodiment (not shown), the environmental map creation / updating unit 27 and the environmental map storage device 12 are mounted on the vehicle V.

ところで、本発明による実施例では、車両Vにおいて、運転制御部42は、マニュアル運転又は自動運転を行う。具体的には、運転制御部42は、マニュアル運転中に、自動運転が可能であるか否かを判断する。次いで、運転制御部42は、自動運転が可能であると判断したときには、例えばHMI37を介し、自動運転が可能であるとの情報をドライバに提示する。次いで、ドライバがHMI37を介し自動運転を開始するための入力を行うと、運転制御部42は自動運転を開始する。すなわち、車両Vの走行操作である駆動、制動及び操舵がアクチュエータ38により制御される。もう少し詳しく説明すると、運転制御部42は自動運転時に、外部センサ31からの情報、GPS受信機32からの情報、内部センサ33からの情報、道路地図記憶装置34内の道路地図情報、記憶装置35内の自動運転専用の道路地図、目標ルートなどを用いて、例えば、自己位置を特定し、車両Vの周囲の障害物を特定し、位置及び時間の関数である進路を決定し、車両Vが進路に従って走行するようアクチュエータ38を制御する。一方、自動運転中に、ドライバがHMI37を介し自動運転を終了するための入力を行うと、運転制御部42は自動運転を終了する。すなわち、車両運転が自動運転からマニュアル運転に切り換えられる。この場合、車両Vの走行操作である駆動、制動及び操舵がドライバによって行われる。なお、自動運転時にドライバがオーバーライドを行ったとき、すなわちドライバがステアリングをあらかじめ定められたしきい量以上操作したとき、アクセルペダルをあらかじめ定められたしきい量以上踏み込んだとき、又は、ブレーキペダルをあらかじめ定められたしきい量以上踏み込んだときにも、自動運転が終了される。 By the way, in the embodiment according to the present invention, in the vehicle V, the operation control unit 42 performs manual operation or automatic operation. Specifically, the operation control unit 42 determines whether or not automatic operation is possible during manual operation. Next, when the operation control unit 42 determines that the automatic operation is possible, the operation control unit 42 presents information to the driver that the automatic operation is possible, for example, via the HMI 37. Next, when the driver inputs an input for starting the automatic operation via the HMI 37, the operation control unit 42 starts the automatic operation. That is, the driving, braking, and steering, which are the traveling operations of the vehicle V, are controlled by the actuator 38. To explain in a little more detail, the operation control unit 42 performs information from the external sensor 31, information from the GPS receiver 32, information from the internal sensor 33, road map information in the road map storage device 34, and storage device 35 during automatic operation. Using a road map dedicated to automatic driving, a target route, etc., for example, identify the self-position, identify obstacles around the vehicle V, determine the course that is a function of the position and time, and the vehicle V The actuator 38 is controlled so as to travel according to the course. On the other hand, during the automatic operation, when the driver inputs to end the automatic operation via the HMI 37, the operation control unit 42 ends the automatic operation. That is, vehicle driving is switched from automatic driving to manual driving. In this case, the driving, braking, and steering, which are the traveling operations of the vehicle V, are performed by the driver. When the driver overrides during automatic driving, that is, when the driver operates the steering wheel by a predetermined threshold or more, when the accelerator pedal is depressed by a predetermined threshold or more, or when the brake pedal is pressed. The automatic operation is also terminated when the driver depresses more than the predetermined threshold.

また、本発明による実施例では、目標ルート設定部43により目標ルートが設定されると、運転制御部42は、自動運転時には、車両Vが目標ルートに沿って走行するように車両Vの走行操作を制御する。これに対し、マニュアル運転時には、運転制御部42は、HMI37を用いて、目標ルートに沿ってドライバを案内する。 Further, in the embodiment according to the present invention, when the target route is set by the target route setting unit 43, the driving control unit 42 operates the vehicle V so that the vehicle V travels along the target route during automatic driving. To control. On the other hand, during manual operation, the operation control unit 42 uses the HMI 37 to guide the driver along the target route.

さて、本発明による実施例の推奨ルート決定システム10は、車両Vの推奨ルートを決定するように構成されている。おおまかに説明すると、車両Vから出発地の位置情報及び目的地の位置情報が推奨ルート決定システム10に送信されると、推奨ルート決定システム10は推奨ルートを決定し、推奨ルートの情報を車両Vに送信する。このような推奨ルートの決定及び送信が、複数の車両に対して行われる。 By the way, the recommended route determination system 10 of the embodiment according to the present invention is configured to determine the recommended route of the vehicle V. Roughly speaking, when the vehicle V transmits the position information of the departure place and the position information of the destination to the recommended route determination system 10, the recommended route determination system 10 determines the recommended route, and the information of the recommended route is transmitted to the vehicle V. Send to. The determination and transmission of such a recommended route is performed for a plurality of vehicles.

具体的に説明すると、推奨ルートを必要とする車両VのドライバはHMI37を介し出発地及び目的地を入力する。その結果、出発地の位置情報及び目的地の位置情報が推奨ルート決定システム10に送信される。別の実施例(図示しない)では、車両VのドライバがHMI37を介しルートの目的地を入力すると、出発地としての車両Vの現在地の位置情報及び目的地の位置情報が推奨ルート決定システム10に送信される。 Specifically, the driver of the vehicle V who needs the recommended route inputs the starting point and the destination via the HMI 37. As a result, the location information of the departure place and the location information of the destination are transmitted to the recommended route determination system 10. In another embodiment (not shown), when the driver of the vehicle V inputs the destination of the route via the HMI 37, the position information of the current location of the vehicle V as the departure point and the position information of the destination are sent to the recommended route determination system 10. Will be sent.

送信された出発地の位置情報及び目的地の位置情報は、推奨ルート決定システム10の獲得部22によって獲得される。次いで、推奨ルート決定システム10の一次候補決定部23が、道路地図記憶装置11の道路地図情報並びに出発地の位置情報及び目的地の位置情報を用いて、推奨ルートの一次候補を複数決定する。具体的には、出発地から目的地までのルートには無数の候補が存在しうる。そこで、一次候補決定部23は、これら無数の候補のなかから、例えば、走行距離、走行時間、道路の幅、などに基づいて、ルートの一次候補を複数決定する。 The transmitted location information of the departure place and the location information of the destination are acquired by the acquisition unit 22 of the recommended route determination system 10. Next, the primary candidate determination unit 23 of the recommended route determination system 10 determines a plurality of primary candidates for the recommended route by using the road map information of the road map storage device 11, the position information of the departure place, and the position information of the destination. Specifically, there can be innumerable candidates for the route from the starting point to the destination. Therefore, the primary candidate determination unit 23 determines a plurality of primary candidates for the route from among these innumerable candidates, for example, based on the mileage, the travel time, the width of the road, and the like.

図9には、一次候補の一例が示される。図9に示される例では、互いに異なる3つの一次候補RC(1),RC(2),RC(3)が示されている。なお、図9においてSLは出発地を、DSTは目的地を、それぞれ示している。 FIG. 9 shows an example of the primary candidate. In the example shown in FIG. 9, three different primary candidates RC (1), RC (2), and RC (3) are shown. In FIG. 9, SL indicates the starting point and DST indicates the destination.

次いで、推奨ルート決定システム10の算出部24が、環境地図情報Mを用いて、一次候補のルート状態量変化性をそれぞれ算出する。ルート状態量変化性は、ルート上の複数の中間点の状態量変化性を用いて算出される数値である。本発明による実施例では、これら中間点の状態量変化性を合計することにより、ルート状態量変化性が算出される。なお、一例では、一次候補の距離をそれぞれ(N+1)等分することにより、N個の中間点が形成される。別の例では、出発地から一次候補に沿って一定距離だけ進むごとに中間点が形成される。 Next, the calculation unit 24 of the recommended route determination system 10 calculates the route state quantity changeability of the primary candidate using the environment map information M, respectively. The root state quantity changeability is a numerical value calculated by using the state quantity changeability of a plurality of intermediate points on the route. In the embodiment according to the present invention, the root state quantity changeability is calculated by summing the state quantity changes at these intermediate points. In one example, N intermediate points are formed by dividing the distances of the primary candidates into equal parts (N + 1). In another example, an intermediate point is formed each time a certain distance is traveled along the primary candidate from the starting point.

次いで、推奨ルート決定システム10の判断部25が、一次候補のうちルート状態量変化性が最小の一次候補を特定する。ルート状態量変化性が最小の一次候補を第1順位候補と称すると、次いで判断部25は、第1順位候補上を走行する他車両の数があらかじめ定められた設定数よりも少ないか否かを判断する。本発明による実施例では、判断部25はまず、第1順位候補上を走行する他車両の数を算出し、次いで第1順位候補上を走行する他車両の数と設定数とを比較する。第1順位候補上を走行する他車両の数は例えば次のようにして算出される。すなわち、推奨ルート決定システム10から他車両に送信された推奨ルートが第1順位候補と少なくとも部分的に重なっているときには、当該他車両は第1順位候補上を走行すると考えることができる。したがって、第1順位候補と少なくとも部分的に重なっている推奨ルートが送信された他車両の数をカウントすれば、当該他車両の数は第1順位候補上を走行する他車両の数を表している。 Next, the determination unit 25 of the recommended route determination system 10 identifies the primary candidate having the smallest route state quantity changeability among the primary candidates. When the primary candidate having the smallest change in the route state quantity is referred to as the first rank candidate, the determination unit 25 then determines whether or not the number of other vehicles traveling on the first rank candidate is less than the predetermined number. To judge. In the embodiment according to the present invention, the determination unit 25 first calculates the number of other vehicles traveling on the first rank candidate, and then compares the number of other vehicles traveling on the first rank candidate with the set number. The number of other vehicles traveling on the first rank candidate is calculated as follows, for example. That is, when the recommended route transmitted from the recommended route determination system 10 to the other vehicle overlaps at least partially with the first ranking candidate, it can be considered that the other vehicle travels on the first ranking candidate. Therefore, if the number of other vehicles to which the recommended route that partially overlaps the first rank candidate is transmitted is counted, the number of the other vehicles represents the number of other vehicles traveling on the first rank candidate. There is.

次いで、推奨ルート決定システム10の推奨ルート決定部26が推奨ルートを決定する。本発明による実施例では、第1順位候補上を走行する他車両の数が設定数よりも少ないと判断されたときには、推奨ルート決定部26は第1順位候補を推奨ルートに決定する。これに対し、第1順位候補上を走行する他車両の数が設定数よりも多いと判断されたときには、推奨ルート決定部26はまず、一次候補のルート状態量変化性に基づいて、一次候補のなかから少なくとも1つの二次候補を決定する。具体的には、ルート状態量変化性があらかじめ定められたしきい値よりも小さい一次候補が二次候補に決定される。次いで、推奨ルート決定部26は、二次候補のうちのいずれか1つを推奨ルートに決定する。本発明による実施例では、二次候補のなかからランダムに選択された1つが推奨ルートに決定される。 Next, the recommended route determination unit 26 of the recommended route determination system 10 determines the recommended route. In the embodiment according to the present invention, when it is determined that the number of other vehicles traveling on the first rank candidate is less than the set number, the recommended route determination unit 26 determines the first rank candidate as the recommended route. On the other hand, when it is determined that the number of other vehicles traveling on the first rank candidate is larger than the set number, the recommended route determination unit 26 first determines the primary candidate based on the route state quantity changeability of the primary candidate. At least one secondary candidate is determined from among them. Specifically, the primary candidate whose root state quantity changeability is smaller than the predetermined threshold value is determined as the secondary candidate. Next, the recommended route determination unit 26 determines any one of the secondary candidates as the recommended route. In the embodiment according to the present invention, one randomly selected from the secondary candidates is determined as the recommended route.

或るルートのルート状態量変化性は、当該ルートの安定性を表している。具体的には、ルート状態量変化性が小さいルートは、ルート状態量変化性が大きいルートに比べて、より安定している。すなわち、車両運転により適している。そうすると、ルート状態量変化性が最小の第1位順位候補は一次候補のなかで最も安定しており、車両運転に最も適しているということになる。したがって、第1順位候補を推奨ルートに決定するのが好ましい。 The root state quantity changeability of a certain route represents the stability of the route. Specifically, a route having a small change in the root state quantity is more stable than a route having a large change in the root state quantity. That is, it is more suitable for vehicle driving. Then, the first-ranked candidate with the smallest route state quantity changeability is the most stable among the primary candidates, and is most suitable for vehicle driving. Therefore, it is preferable to determine the first ranking candidate as the recommended route.

ところが、或る車両のための第1順位候補は、当該車両のための一次候補のなかで最も安定したルートであるので、別の車両のための第1順位候補と重なる可能性が高い。このため、第1順位候補上を走行する他車両の数が過度に多くなるおそれがある。第1候補上を走行する他車両の数が過度に多くなると、第1候補の安定性が低下する。 However, since the first-ranked candidate for a certain vehicle is the most stable route among the primary candidates for the vehicle, there is a high possibility that it overlaps with the first-ranked candidate for another vehicle. Therefore, the number of other vehicles traveling on the first-ranked candidate may become excessively large. If the number of other vehicles traveling on the first candidate becomes excessively large, the stability of the first candidate decreases.

そこで本発明による実施例では、第1順位候補上を走行する他車両の数が少ないときには、第1順位候補を推奨ルートに決定している。その結果、最も安定したルートに沿った車両走行を確保することができる。一方、第1順位候補上を走行する他車両の数が多いときには、二次候補のうちのいずれか1つを推奨ルートに決定している。二次候補のルート状態量変化性は上述したしきい値よりも小さいので、二次候補は比較的安定している。その結果、第1順位候補を走行する車両の数を増大させることなく、安定したルートに沿った車両走行を確保することができる。 Therefore, in the embodiment according to the present invention, when the number of other vehicles traveling on the first rank candidate is small, the first rank candidate is determined as the recommended route. As a result, it is possible to secure the vehicle running along the most stable route. On the other hand, when the number of other vehicles traveling on the first-ranked candidate is large, one of the secondary candidates is determined as the recommended route. Since the root state quantity changeability of the secondary candidate is smaller than the above-mentioned threshold value, the secondary candidate is relatively stable. As a result, it is possible to secure vehicle traveling along a stable route without increasing the number of vehicles traveling in the first rank candidate.

しかも本発明による実施例では、ルート状態量変化性又は状態量変化性に基づいて、推奨ルートが決定されるので、より適切な推奨ルートをより簡単に決定することができる。 Moreover, in the embodiment according to the present invention, the recommended route is determined based on the root state quantity changeability or the state quantity changeability, so that a more appropriate recommended route can be determined more easily.

次いで、推奨ルート決定部26はこのようにして決定された推奨ルートの情報を、出発地の位置情報及び目的地の位置情報が送信された車両Vに送信する。この車両Vが推奨ルートの情報を受信すると、車両Vの目標ルート設定部43は推奨ルートを目標ルートに設定する。 Next, the recommended route determination unit 26 transmits the information of the recommended route thus determined to the vehicle V to which the position information of the departure place and the position information of the destination are transmitted. When the vehicle V receives the information on the recommended route, the target route setting unit 43 of the vehicle V sets the recommended route as the target route.

なお、単位走行距離当たりのオーバーライドの回数をオーバーライド率(例えば、回/km)と称すると、図10に示されるように、ルート状態量変化性が小さくなるにつれてオーバーライド率は低くなる。本発明による実施例では、オーバーライド率があらかじめ定められたしきい率のときに、ルート状態量変化性が上述のしきい値となる。したがって、本発明による実施例では、オーバーライド率がしきい率よりも低い一次候補が二次候補に決定されるということになる。その結果、自動運転の観点から見て安定したルートが二次候補に決定される。 When the number of overrides per unit mileage is referred to as an override rate (for example, times / km), as shown in FIG. 10, the override rate decreases as the route state quantity changeability decreases. In the embodiment according to the present invention, when the override rate is a predetermined threshold rate, the root state quantity changeability becomes the above-mentioned threshold value. Therefore, in the embodiment according to the present invention, the primary candidate whose override rate is lower than the threshold rate is determined as the secondary candidate. As a result, a stable route is determined as a secondary candidate from the viewpoint of autonomous driving.

図11は本発明による実施例の推奨ルート決定制御を実行するためのルーチンを示している。このルーチンは推奨ルート決定システム10においてあらかじめ定められた設定時間ごとの割り込みによって実行される。図11を参照すると、ステップ100では、車両Vの制御システム30から出発地の位置情報及び目的地の位置情報を受信したか否かが判別される。当該位置情報を受信していないときには処理サイクルを終了する。当該位置情報を受信したときには次いでステップ101に進み、一次候補が決定される。続くステップ102では、一次候補のルート状態量変化性がそれぞれ算出される。続くステップ103では、第1順位候補が決定される。続くステップ104では、第1順位候補上を走行する他車両の数NOVが算出される。続くステップ105では、他車両数NOVがあらかじめ定められたしきい値NOVXよりも大きいか否かが判別される。NOV≦NOVXのときには次いでステップ106に進み、第1順位候補が推奨ルートに決定される。次いでステップ109に進む。これに対し、NOV>NOVXのときには次いでステップ107に進み、二次候補が決定される。続くステップ108では、二次候補のうちのいずれか1つが推奨ルートに決定される。次いでステップ109に進む。ステップ109では、推奨ルートが車両Vの制御システム30に送信される。 FIG. 11 shows a routine for executing the recommended route determination control of the embodiment according to the present invention. This routine is executed by interrupts at predetermined time intervals in the recommended route determination system 10. With reference to FIG. 11, in step 100, it is determined whether or not the position information of the departure place and the position information of the destination have been received from the control system 30 of the vehicle V. When the location information is not received, the processing cycle ends. When the position information is received, the process proceeds to step 101, and the primary candidate is determined. In the following step 102, the root state quantity changeability of the primary candidate is calculated. In the following step 103, the first ranking candidate is determined. In the following step 104, the number NOV of other vehicles traveling on the first rank candidate is calculated. In the following step 105, it is determined whether or not the number of other vehicles NOV is larger than the predetermined threshold value NOVX. When NOV ≦ NOVX, the process proceeds to step 106, and the first ranking candidate is determined as the recommended route. Then, the process proceeds to step 109. On the other hand, when NOV> NOVX, the process proceeds to step 107, and the secondary candidate is determined. In the following step 108, any one of the secondary candidates is determined as the recommended route. Then, the process proceeds to step 109. In step 109, the recommended route is transmitted to the vehicle V control system 30.

図12は本発明による実施例の目標ルート設定制御を実行するためのルーチンを示している。このルーチンは車両Vの制御システム30においてあらかじめ定められた設定時間ごとの割り込みによって実行される。図12を参照すると、ステップ200では、ドライバによる出発地及び目的地の入力が行われたか否かが判別される。当該入力が行われていないときには処理サイクルを終了する。これに対し、当該入力が行われたときには次いでステップ201に進み、入力された出発地の位置情報及び目的地の位置情報が推奨ルート決定システム10に送信される。続くステップ202では、推奨ルート決定システム10から推奨ルートの情報を受信したか否かが判別される。推奨ルートの情報を受信していないときにはステップ202に戻る。推奨ルートの情報を受信したときには次いでステップ203に進み、推奨ルートが目標ルートに設定される。 FIG. 12 shows a routine for executing the target route setting control of the embodiment according to the present invention. This routine is executed by interrupts at predetermined time intervals in the control system 30 of the vehicle V. With reference to FIG. 12, in step 200, it is determined whether or not the departure point and the destination have been input by the driver. When the input is not made, the processing cycle is terminated. On the other hand, when the input is made, the process proceeds to step 201, and the input location information of the departure place and the position information of the destination are transmitted to the recommended route determination system 10. In the following step 202, it is determined whether or not the recommended route information has been received from the recommended route determination system 10. If the recommended route information has not been received, the process returns to step 202. When the information on the recommended route is received, the process proceeds to step 203, and the recommended route is set as the target route.

別の実施例(図示しない)では、推奨ルート決定システム10の少なくとも一部が車両Vに搭載される。一例では、獲得部22、一次候補決定部23、算出部24、判断部25、及び、推奨ルート決定部26が車両Vに設けられる。この場合、一次候補決定部23は車両Vの道路地図記憶装置11の道路地図情報を用いて一次候補を決定する。 In another embodiment (not shown), at least a portion of the recommended route determination system 10 is mounted on the vehicle V. In one example, the acquisition unit 22, the primary candidate determination unit 23, the calculation unit 24, the determination unit 25, and the recommended route determination unit 26 are provided in the vehicle V. In this case, the primary candidate determination unit 23 determines the primary candidate using the road map information of the road map storage device 11 of the vehicle V.

10 推奨ルート決定システム
11 道路地図記憶装置
12 環境地図記憶装置
20 電子制御ユニット
22 獲得部
23 一次候補決定部
24 算出部
25 判断部
26 推奨ルート決定部
10 Recommended route determination system 11 Road map storage device 12 Environmental map storage device 20 Electronic control unit 22 Acquisition unit 23 Primary candidate determination unit 24 Calculation unit 25 Judgment unit 26 Recommended route determination unit

Claims (2)

複数の移動体の推奨ルートをそれぞれ決定し、前記複数の移動体にそれぞれ対応する推奨ルートを送信する、移動体の推奨ルート決定システムであって、
道路地図情報を記憶するように構成されている道路地図記憶装置と、
環境地図情報を記憶するように構成されている環境地図記憶装置であって、前記環境地図情報は、空間内の複数の位置をそれぞれ表す位置情報と、前記複数の位置のそれぞれの状態量変化性であって、それぞれ対応する前記位置情報と関連付けられた前記状態量変化性と、を有しており、前記状態量変化性は、対応する位置の状態量の時間に対する変化が小さいときには当該変化が大きいときに比べて小さい、環境地図記憶装置と、
前記移動体の出発地の位置情報及び目的地の位置情報を獲得するように構成されている獲得部と、
前記道路地図情報、並びに、前記移動体の出発地の位置情報及び目的地の位置情報を用いて、前記移動体の推奨ルートの一次候補を複数決定するように構成されている一次候補決定部と、
前記環境地図情報を用いて、前記一次候補のルート状態量変化性をそれぞれ算出するように構成されている算出部と、
前記一次候補のうち前記ルート状態量変化性が最小の一次候補と少なくとも部分的に重なっている推奨ルートが送信された他移動体の数をカウントすることにより当該一次候補上を移動する他移動体の数を求めるとともに、前記他移動体の数があらかじめ定められた設定数よりも少ないか否かを判断するように構成されている判断部と、
前記他移動体の数が前記設定数よりも少ないと判断されたときには、前記ルート状態量変化性が最小の一次候補を前記移動体の推奨ルートに決定し、前記他移動体の数が前記設定数よりも多いと判断されたときには、前記ルート状態量変化性があらかじめ定められたしきい値よりも小さい前記一次候補のうちのいずれか1つを前記移動体の推奨ルートに決定する、ように構成されている推奨ルート決定部と、
を備えた、移動体の推奨ルート決定システム。
It is a recommended route determination system for mobiles that determines recommended routes for each of a plurality of mobiles and transmits recommended routes corresponding to the plurality of mobiles .
A road map storage device that is configured to store road map information,
It is an environmental map storage device configured to store environmental map information, and the environmental map information includes position information representing a plurality of positions in space and state quantity changeability of each of the plurality of positions. It has the state quantity changeability associated with the corresponding position information, and the state quantity changeability changes when the change of the state quantity of the corresponding position with respect to time is small. Environmental map storage device, which is smaller than when it is large,
An acquisition unit configured to acquire the position information of the departure point and the position information of the destination of the moving body, and
With the primary candidate determination unit configured to determine a plurality of primary candidates for the recommended route of the moving body by using the road map information, the position information of the departure point of the moving body, and the position information of the destination. ,
A calculation unit configured to calculate the route state quantity changeability of the primary candidate using the environment map information, and a calculation unit.
Among the primary candidates, other mobiles that move on the primary candidate by counting the number of other mobiles to which the recommended route whose route state quantity changeability is at least partially overlapped with the primary candidate is transmitted. And a judgment unit configured to determine whether or not the number of other moving objects is less than a predetermined number.
When it is determined that the number of the other mobiles is smaller than the set number, the primary candidate having the smallest root state quantity changeability is determined as the recommended route of the mobile, and the number of the other mobiles is the setting. When it is determined that the number is larger than the number, any one of the primary candidates whose route state quantity variability is smaller than the predetermined threshold value is determined as the recommended route of the moving body. The recommended route determination unit that is configured and
Recommended route determination system for mobiles.
或る位置の前記状態量は当該或る位置に物体が存在する確率又は当該或る位置に存在する物体の色もしくは輝度値により表される、請求項1に記載の移動体の推奨ルート決定システム。 The recommended route determination system for a moving body according to claim 1, wherein the state quantity at a certain position is represented by the probability that an object exists at the certain position or the color or brightness value of the object existing at the certain position. ..
JP2016179560A 2016-09-14 2016-09-14 Recommended route determination system for mobiles Active JP6798206B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2016179560A JP6798206B2 (en) 2016-09-14 2016-09-14 Recommended route determination system for mobiles

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2016179560A JP6798206B2 (en) 2016-09-14 2016-09-14 Recommended route determination system for mobiles

Publications (2)

Publication Number Publication Date
JP2018044848A JP2018044848A (en) 2018-03-22
JP6798206B2 true JP6798206B2 (en) 2020-12-09

Family

ID=61693635

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016179560A Active JP6798206B2 (en) 2016-09-14 2016-09-14 Recommended route determination system for mobiles

Country Status (1)

Country Link
JP (1) JP6798206B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7250571B2 (en) * 2019-03-11 2023-04-03 本田技研工業株式会社 Inverted pendulum type robot

Also Published As

Publication number Publication date
JP2018044848A (en) 2018-03-22

Similar Documents

Publication Publication Date Title
US10331139B2 (en) Navigation device for autonomously driving vehicle
JP2020053094A (en) Method and device for determining lane identifier on road
JP6411956B2 (en) Vehicle control apparatus and vehicle control method
US11055540B2 (en) Method for determining anchor boxes for training neural network object detection models for autonomous driving
JP7059888B2 (en) Assistance control system
US10310511B2 (en) Automatic driving control system of mobile object
US10759415B2 (en) Effective rolling radius
CN110874642A (en) Learning device, learning method, and storage medium
US20210035450A1 (en) Passenger walking points in pick-up/drop-off zones
CN113313933B (en) Lane-based routing system for an autonomous vehicle
CN109795500B (en) Vehicle control device, vehicle control method, and storage medium
JP2019159611A (en) Vehicle control device, vehicle control method, and program
JP6705270B2 (en) Automatic operation control system for mobile
KR20210002323A (en) A vehicle-platoons implementation under autonomous driving system designed for single vehicle
WO2022165498A1 (en) Methods and system for generating a lane-level map for an area of interest for navigation of an autonomous vehicle
WO2022154995A1 (en) Methods and system for constructing data representation for use in assisting autonomous vehicles navigate intersections
JP6728970B2 (en) Automatic operation control system for mobile
JP6728959B2 (en) Automatic operation control system for mobile
JP6798206B2 (en) Recommended route determination system for mobiles
JP6668915B2 (en) Automatic operation control system for moving objects
US20230060940A1 (en) Determining a content of a message used to coordinate interactions among vehicles
JP2022103546A (en) Vehicle control device, vehicle control method, and program
JP6705271B2 (en) Automatic operation control system for mobile
US20240166239A1 (en) Trajectory planning for navigating small objects on road
WO2023188262A1 (en) Map generating device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190418

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20200319

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200331

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200518

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: 20201020

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20201102

R151 Written notification of patent or utility model registration

Ref document number: 6798206

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151