JP5762320B2 - Travel control system and travel control method - Google Patents
Travel control system and travel control method Download PDFInfo
- Publication number
- JP5762320B2 JP5762320B2 JP2012012266A JP2012012266A JP5762320B2 JP 5762320 B2 JP5762320 B2 JP 5762320B2 JP 2012012266 A JP2012012266 A JP 2012012266A JP 2012012266 A JP2012012266 A JP 2012012266A JP 5762320 B2 JP5762320 B2 JP 5762320B2
- Authority
- JP
- Japan
- Prior art keywords
- information
- vehicle
- texture
- unit
- travel
- 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
Links
Images
Description
本発明は、複数台の車両が取得した各車両の位置情報及び周辺の画像データに基づき、操作者がサーバを介して各車両を遠隔操作により制御する走行制御システム及び走行制御方法に関する。 The present invention relates to a travel control system and a travel control method in which an operator remotely controls each vehicle via a server based on positional information of each vehicle acquired by a plurality of vehicles and surrounding image data.
従来から、人間が立ち入れない地域において、無線により制御可能な車両を遠隔操作により操作し、周囲環境の情報収集や対象物の回収などの作業が行われている。
このとき、遠隔操作より操作者が車両を走行させる場合、操作側の表示装置には、操作者が遠隔操作し易いように、操作対象の車両の周囲環境を、当該車両自身が撮像した画像を表示させることが行われている。
ここで、撮像された画像をデータ圧縮して少ないデータ量で送信することにより、周囲環境の画像の表示遅延を低減させ、リアルタイムに遠隔操作を行う装置が開示されている(例えば、特許文献1参照)。
2. Description of the Related Art Conventionally, in an area where humans cannot enter, operations such as collecting information on the surrounding environment and collecting objects are performed by remotely operating a vehicle that can be controlled wirelessly.
At this time, when the operator runs the vehicle by remote operation, the display device on the operation side displays an image captured by the vehicle itself of the surrounding environment of the operation target vehicle so that the operator can easily perform the remote operation. It is done to display.
Here, an apparatus that performs remote operation in real time by reducing the display delay of an image of the surrounding environment by compressing the captured image and transmitting it with a small amount of data is disclosed (for example, Patent Document 1). reference).
しかしながら、図15に示すように、同一の作業範囲にある複数の車両、例えば車両1000_A、1000_B及び1000_Cの各々を、それぞれ異なる操作者A、B及びCが各自のサーバにより操作する場合がある。この場合、それぞれの車両においては、各車両の走行情報取得部が車両の位置情報及び車両周辺の画像を取得し、上記サーバに対して送信する。また、各車両の自律制御部は、取得した位置情報を元に自律走行に用い、かつサーバが作成した車両走行マップを、対応する操作者のサーバに送信する。一方、サーバは、供給される位置情報及び車両周辺の画像を元に、各車両の走行している環境をサーバの表示画面に表示する画像を生成し、この画像をサーバの表示装置に表示する。そして、操作者A,B及びCは、それぞれのサーバに表示される画像により担当の車両の走行制御を行う。
このように、複数の車両を用いて、同一作業範囲において情報収集等の処理を行う際、それぞれの車両が異なる位置の位置情報のデータを関連性無く作成されるため、それぞれの車両の操作に用いている位置情報のデータがサーバ毎に異なることになる。
However, as shown in FIG. 15, different operators A, B, and C may operate each of a plurality of vehicles in the same work range, for example, the vehicles 1000_A, 1000_B, and 1000_C, by their servers. In this case, in each vehicle, the travel information acquisition unit of each vehicle acquires the position information of the vehicle and the image around the vehicle, and transmits the acquired information to the server. Moreover, the autonomous control part of each vehicle is used for autonomous traveling based on the acquired position information, and transmits the vehicle traveling map created by the server to the corresponding operator's server. On the other hand, the server generates an image for displaying the environment in which each vehicle is traveling on the display screen of the server based on the supplied position information and images around the vehicle, and displays this image on the display device of the server. . Then, the operators A, B, and C perform traveling control of the vehicle in charge using images displayed on the respective servers.
In this way, when performing processing such as information collection in the same work range using a plurality of vehicles, the position information data of different positions is created for each vehicle, so that the operation of each vehicle can be performed. The position information data used is different for each server.
このため、各操作者は、ぞれぞれ走行制御を担当している車両からの環境情報のみで、車両を操作することになり、複数の車両を有機的に活動させるための十分な周囲の環境の情報を、それぞれの操作者間で共有することができない。
また、複数の車両が位置情報及び画像のデータを各操作者のサーバに送信するため、複数台の各々が同一の地点の同様な位置情報を、重複して異なるサーバに対して送信することになり、サーバの設置されている情報統合センタと車両各々の間の通信資源を有効に使用できないという問題もある。
For this reason, each operator operates the vehicle only with environmental information from the vehicle in charge of traveling control, and there is sufficient surroundings for organically operating a plurality of vehicles. Environment information cannot be shared between operators.
In addition, since a plurality of vehicles transmit position information and image data to each operator's server, each of the plurality of vehicles transmits the same position information at the same point to different servers. Therefore, there is a problem that communication resources between the information integration center where the server is installed and each vehicle cannot be used effectively.
本発明は、このような事情に鑑みてなされたもので、走行制御システム下にある複数台の車両における位置情報及び周辺の画像のデータを、車両間において連携を取って収集することで、各車両とセンタ間のデータの送受信の総量を低下させ、通信資源を有効に使用でき、かつ複数の車両が有機的に作業を行うことが可能な走行制御システム及び走行制御方法を提供することを目的とする。 The present invention has been made in view of such circumstances, and by collecting the position information and surrounding image data in a plurality of vehicles under the traveling control system in cooperation between the vehicles, An object of the present invention is to provide a travel control system and a travel control method capable of reducing the total amount of data transmitted and received between the vehicle and the center, effectively using communication resources, and capable of performing a plurality of vehicles in an organic manner. And
本発明の走行制御システムは、複数の車両の走行制御を行う走行制御システムであり、前記車両の各々に設けられ、当該車両の走行位置に応じた周囲の走行環境を示す第1車両情報を取得する走行情報取得部と、前記複数の車両に対して共通に用いる第2車両情報を記憶するマップデータ記憶部と、前記第2車両情報における前記車両各々の走行方向の領域の車両情報である第3車両情報を、前記複数の車両の各々へ送信する要求エリア選択部と、前記車両の各々に設けられ、前記第1車両情報と前記第3車両情報とを比較し、前記第1車両情報と前記第3車両情報との差分である差分車両情報を抽出する走行情報差分抽出部と、前記差分車両情報を前記第2車両情報に追加し、当該第2車両情報を更新する情報更新部とを備えることを特徴とする。 The travel control system of the present invention is a travel control system that performs travel control of a plurality of vehicles, and is provided in each of the vehicles, and acquires first vehicle information indicating a surrounding travel environment according to the travel position of the vehicle. is the second and the map data storage unit for storing the car both information, the vehicle information of the vehicle each traveling direction of a region of the said second vehicle information used in common with the traveling information acquisition unit, to the plurality of vehicles A request area selection unit that transmits third vehicle information to each of the plurality of vehicles, and provided in each of the vehicles, the first vehicle information and the third vehicle information are compared, and the first vehicle information And a travel information difference extraction unit that extracts difference vehicle information that is a difference between the third vehicle information, an information update unit that adds the difference vehicle information to the second vehicle information, and updates the second vehicle information. Characterized by comprising To.
本発明の走行制御システムは、前記第1車両情報、第2車両情報及び第3車両情報の各々が、車両の走行するマップにおける各座標の立体物の位置及び高さを示す3次元情報と、当該3次元情報に対応付けられた前記立体物の画像のデータの情報を示すテクスチャ情報とを有し、前記走行情報取得部が、前記立体物の位置及び高さを測定して前記3次元情報を生成し、前記立体物の画像を撮像して前記テクスチャ情報を生成することを特徴とする。 In the travel control system of the present invention, each of the first vehicle information, the second vehicle information, and the third vehicle information includes three-dimensional information indicating the position and height of a three-dimensional object at each coordinate in a map traveled by the vehicle, Texture information indicating data information of the image of the three-dimensional object associated with the three-dimensional information, and the travel information acquisition unit measures the position and height of the three-dimensional object to determine the three-dimensional information. The texture information is generated by capturing an image of the three-dimensional object.
本発明の走行制御システムは、前記要求エリア選択部が、前記車両各々の進行方向にある3次元情報と、当該3次元情報の中から前記テクスチャ情報が無い3次元情報を示す要求テクスチャ情報とを前記マップデータ記憶部から抽出し、前記第3車両情報として前記車両に対して送信することを特徴とする。 In the travel control system of the present invention, the requested area selecting unit includes three-dimensional information in the traveling direction of each vehicle and requested texture information indicating three-dimensional information without the texture information from the three-dimensional information. Extracted from the map data storage unit and transmitted to the vehicle as the third vehicle information.
本発明の走行制御システムは、前記走行情報差分抽出部が、前記走行情報取得部が取得した前記第1車両情報における3次元情報及びテクスチャ情報と、前記第3車両情報における3次元情報及びテクスチャ情報とを比較し、前記第3車両情報に含まれていない前記第1車両情報における3次元情報及びテクスチャ情報を前記差分車両情報として抽出することを特徴とする。 In the travel control system of the present invention, the travel information difference extraction unit includes the three-dimensional information and texture information in the first vehicle information acquired by the travel information acquisition unit, and the three-dimensional information and texture information in the third vehicle information. And the three-dimensional information and texture information in the first vehicle information not included in the third vehicle information are extracted as the difference vehicle information.
本発明の走行制御システムは、前記走行情報取得部が、前記車両が走行不能となる高さ閾値を超える前記座標を、前記立体物の3次元情報として抽出することを特徴とする。 In the travel control system of the present invention, the travel information acquisition unit extracts the coordinates that exceed a height threshold at which the vehicle cannot travel as 3D information of the three-dimensional object.
本発明の走行制御システムは、前記要求エリア選択部、前記情報更新部及び前記マップデータ記憶部が、前記複数の車両を統合して制御する情報統合装置に設けられていることを特徴とする。 The travel control system of the present invention is characterized in that the request area selection unit, the information update unit, and the map data storage unit are provided in an information integration device that controls the plurality of vehicles in an integrated manner.
本発明の走行制御システムは、前記要求エリア選択部、前記情報更新部及び前記マップデータ記憶部が、前記車両に設けられており、前記複数の車両を統合して制御する情報統合装置が、他の情報更新部及び他の前記マップデータ記憶部とを有し、前記情報更新部が前記差分車両情報を前記情報統合装置に送信し、前記他の情報更新部が、前記他のマップデータ記憶部に記憶されている前記第2車両情報を前記差分車両情報により更新することを特徴とする。 In the travel control system of the present invention, the request area selection unit, the information update unit, and the map data storage unit are provided in the vehicle, and an information integration device that controls the plurality of vehicles in an integrated manner The information update unit and the other map data storage unit, the information update unit transmits the difference vehicle information to the information integration device, and the other information update unit includes the other map data storage unit. The second vehicle information stored in is updated with the difference vehicle information.
本発明の走行制御方法は、複数の車両の走行制御を行う走行制御システムを動作させる方法であり、前記車両の各々に設けられた走行情報取得部が、当該車両の走行位置に応じた周囲の走行環境を示す第1車両情報を取得する走行情報取得過程と、要求エリア選択部が、マップデータ記憶部に記憶されている前記複数の車両の共通に用いる第2車両情報における前記車両各々の走行方向の領域の車両情報である第3車両情報を、前記複数の車両の各々へ送信する要求エリア選択過程と、前記車両の各々に設けられ、前記第1車両情報と前記第3車両情報とを比較し、前記第1車両情報と前記第3車両情報との差分である差分車両情報を抽出する走行情報差分抽出過程と、前記差分車両情報を前記マップデータ記憶部の前記第2車両情報に追加し、当該第2車両情報を更新する情報更新過程とを備えることを特徴とする。 The travel control method of the present invention is a method of operating a travel control system that performs travel control of a plurality of vehicles, and a travel information acquisition unit provided in each of the vehicles has a peripheral position corresponding to the travel position of the vehicle. A travel information acquisition process for acquiring first vehicle information indicating a travel environment, and a travel of each of the vehicles in the second vehicle information used by the request area selection unit that is stored in the map data storage unit. A request area selection process for transmitting third vehicle information, which is vehicle information in a direction area, to each of the plurality of vehicles; and the first vehicle information and the third vehicle information provided in each of the vehicles. additional comparison, a travel information difference extraction process for extracting difference vehicle information which is a difference between the first vehicle information and the third vehicle information, the difference vehicle information to said second vehicle information of the map data storage unit , Characterized in that it comprises an information updating step of updating the second vehicle information.
この発明によれば、走行制御システム下にある各車両において、周辺の走行環境の情報である車両情報を共有化することにより、車両間での連携の取れた情報収集を行うことを可能とし、かつ同一の走行環境情報を複数の車両が重複して情報統合装置に対して送信することが無くなり、各車両間あるいは各車両と情報統合を行う情報統合装置との間のデータの送受信の総量を低下させ、通信資源を有効に使用できる。
また、この発明によれば、走行環境情報を走行制御システム下にある各車両が共通に用いるため、複数の車両それぞれに対して他の車両とを関連させた処理を行わせることができ、複数の車両間において有機的な作業を行わせることが可能となる。
According to this invention, in each vehicle under the traveling control system, by sharing vehicle information that is information on the surrounding traveling environment, it is possible to collect information that is coordinated between the vehicles, In addition, a plurality of vehicles do not transmit the same driving environment information to the information integration device, and the total amount of data transmitted / received between the vehicles or between the information integration devices that integrate information with each vehicle is reduced. The communication resources can be used effectively by reducing the communication resources.
In addition, according to the present invention, since each vehicle under the traveling control system uses the traveling environment information in common, it is possible to cause each of the plurality of vehicles to perform a process associated with another vehicle. It is possible to perform organic work between the vehicles.
<第1の実施形態>
以下、図面を参照して、本発明の第1の実施形態について説明する。図1は、この発明の第1の実施形態による走行制御システムの構成例を示す概略ブロック図である。この図1において、本実施形態の走行制御システムは、複数の移動体(車両、陸上無人機等)、例えば車両200_A、200_B、200_C、…と、これらの車両の各々の走行制御を遠隔操作により行う情報統合装置100とで構成されている。ここで、車両200_A、200_B、200_C、…の各々と、情報統合装置100との間は、例えば無線通信により制御に必要なデータの送受信が行われている。
<First Embodiment>
Hereinafter, a first embodiment of the present invention will be described with reference to the drawings. FIG. 1 is a schematic block diagram showing a configuration example of a travel control system according to the first embodiment of the present invention. In FIG. 1, the travel control system of the present embodiment includes a plurality of mobile bodies (vehicles, land drones, etc.), for example, vehicles 200_A, 200_B, 200_C,. It is comprised with the
車両200_A、200_B、200_C、…の各々は、同様な構成であり、走行情報取得部201、走行情報合成部202、走行情報差分抽出部203、走行制御部204、位置情報取得部205、データ送受信部206、記憶部207、自律制御部208、切出部209及び抽出部210を備えている。
以下、本実施形態においては、3次元情報は、予め定められた座標系における3次元位置座標(x,y,z)により表されるものとして説明を続ける。また、以下の説明において、車両として車両200_Aを例として説明を行うが、他の車両200_B、車両200_C…においても同様の処理が行われる。
Each of the vehicles 200_A, 200_B, 200_C,... Has a similar configuration, and a travel
Hereinafter, in the present embodiment, the description will be continued assuming that the three-dimensional information is represented by the three-dimensional position coordinates (x, y, z) in a predetermined coordinate system. In the following description, the vehicle 200_A is described as an example of the vehicle, but the same processing is performed in the other vehicles 200_B, vehicles 200_C.
ここで、座標成分zは、被写体の高さ成分である。また、後述する位置情報取得部205が測位した車両の2次元座標(x,y)(すなわち、地平面を示すxy座標)に対して、走行情報取得部201が測定した被写体の3次元位置座標(x,y,z)における2次元座標(x,y)とは対応している。すなわち、位置情報取得部205の取得した2次元座標(x,y)の位置座標に対し、走行情報取得部201の取得する3次元位置座標(x,y,z)における2次元座標(x,y)の位置座標が一致するように、位置情報取得部205と走行情報取得部201との相対的な距離及び姿勢が予めキャリブレーションされているものとする。また、同様に、撮像部2011が撮像した被写体の画像データを含む画像フレームにおける2次元座標と、物体検知部2012が測定した被写体の3次元位置座標における2次元座標とにおける位置が同一の座標となるように、撮像部2011と物体検知部2012との相対的な距離及び姿勢は、予めキャリブレーションされているものとする。
Here, the coordinate component z is a height component of the subject. Also, the three-dimensional position coordinates of the subject measured by the travel
走行情報取得部201は、自身を搭載する車両が走行する周辺に存在する被写体(例えば、構造物、人物、道路、白線及び縁石)の画像(以下、モデル画像とする)と、この被写体の3次元空間における位置を示す3次元位置情報(x、y、z)との2次元座標(x,y)が対応するデータの組を取得する。
この走行情報取得部201は、撮像部2011と物体検知部2012とを備えている。
撮像部2011は、例えばディジタルカメラなどであり、車両の周囲に存在する被写体を撮像し、撮像した被写体のモデル画像を取得する。ここで、撮像部2011は、上記モデル画像として、動画または静止画のいずれの形式により被写体を撮像してもよい。また、走行情報取得部201は、得られたモデル画像を切出部209へ出力する。
The travel
The travel
The
物体検知部2012は、移動体の周囲環境の3次元座標を測定するレーザレーダ装置である。物体検知部2012は、移動体の周囲環境にレーザ光を照射する。そして、物体検知部2012は、照射したレーザ光が周囲環境にある被写体で反射されて自身に戻るまでの時間と、レーザ光の照射方向(物体検知部2012の姿勢)とに基づいて、車両200_Aの周囲環境の3次元位置情報(3次元座標)を、周囲環境をスキャンしながら繰り返し測定する。
すなわち、物体検知部2012は、被写体の距離及び各距離を測定した際のレーザ光の照射方向(照射角度)と、位置情報取得部205から供給される位置情報(2次元座標(x,y)における位置)とに基づいて、車両の周囲に存在する被写体の3次元座標(x,y,z)を求める。
なお、レーザレーダ装置の一例については、例えば、特開2011−99742号公報を参照することができる。
The
That is, the
In addition, about an example of a laser radar apparatus, Unexamined-Japanese-Patent No. 2011-99742 can be referred, for example.
次に、図2は、データ送受信部206を備える車両200_A(移動体)及びその周囲環境を示す俯瞰図である。この図2では、データ送受信部206及び走行情報取得部201が車両200_Aに搭載されており、車両200_Aが道路400上の走行において、この走行情報取得部201が、車両200_Aの周囲環境に在る被写体500、被写体510、被写体520及び道路400等を撮像している。また、走行情報取得部201は、車両200_Aの周囲環境に在る被写体500、被写体510、被写体520、道路400等の3次元位置座標(x,y,z)を測定しながら、車両200_Aと共に道路400上を移動している。
Next, FIG. 2 is a bird's-eye view showing the vehicle 200_A (moving body) including the data transmission /
また、図2において、測定点300−1〜300−19は、周囲環境において物体検知部2012からのレーザ光が反射された位置(以下、「測定点」という)をそれぞれ示す。この測定点のうち、測定点300−1〜300−9,300−19は、ぞれぞれの座標成分z(高さ成分)が、予め定められた高さ閾値未満である測定点である。一方、測定点300−10〜300−18は、測定点の座標成分zが、高さ閾値以上である測定点である。この高さ閾値は、車両200_Aが走行不能な高さとして予め実験等により測定して設定されている。
In FIG. 2, measurement points 300-1 to 300-19 indicate positions (hereinafter referred to as “measurement points”) where the laser light from the
つまり、被写体520が立体的であるため(高さ閾値以上の高さを有するため)、測定点300−10及び300−11は、座標成分zが周囲の測定点300−1から300−9などよりも高い測定点として、物体検知部2012により検出される。また、被写体510の各測定点300−12、300−13及び被写体500の各測定点300−11、300−12についても同様である。各測定点の3次元位置座標(x,y,z)を示す情報は、物体検知部2012により、抽出部210に出力される。
That is, since the subject 520 is three-dimensional (because it has a height equal to or higher than the height threshold), the measurement points 300-10 and 300-11 have the coordinate component z of the surrounding measurement points 300-1 to 300-9, etc. Is detected by the
なお、この図2においては、被写体530と車両200_Aとの距離が離れて過ぎているために、被写体530にはレーザ光が照射されない、あるいはレーザ光が照射されたとしても高さ閾値未満となる。このため、物体検知部2012は、被写体530の3次元位置座標を測定していない状態が示されている。車両200_Aが道路400上をさらに移動して、被写体530と車両200_Aとがより接近することにより、被写体530にはレーザ光が高さ閾値以上の場所に照射される。これにより、物体検知部2012は、被写体530の3次元位置座標(x,y,z)を測定することができるようになる。撮像部2011についても同様に、車両200_Aが道路400上をさらに移動して、被写体530と車両200_Aとがより接近することにより、撮像部2011が被写体530を撮像することができるようになる。
In FIG. 2, since the distance between the subject 530 and the vehicle 200_A is too far away, the subject 530 is not irradiated with laser light, or even if the laser light is irradiated, it is less than the height threshold. . For this reason, the state in which the
図1に戻り、位置情報取得部205は、車両の存在する位置(2次元座標(x,y)における座標値)及び車両の走行方向を示す向きを周期的に測定し、この車両の位置及び向きを示す位置情報を、走行情報取得部201に対して出力する。ここで、位置情報取得部205は、例えば、GPS(Global Positioning System)により、車両の2次元座標及び向きを測定してもよい。このとき、位置情報取得部205は、GPSより得られる時刻毎の車両の存在する座標成分の時間的な変化に基づいて、車両の向き(移動方向)を測定してもよい。
また、位置情報取得部205は、位置及び向きを示す位置情報を、データ送受信部206を介して、情報統合装置100に対して送信する。
Returning to FIG. 1, the position
The position
また、位置情報取得部205は、上述したGPSに換え、IMU(Inertial Measurement Unit:慣性計測装置)として、速度センサ、3軸加速度センサ及び3軸ジャイロ(回転角センサ)を備える構成としても良い。位置情報取得部205は、これら速度センサ、3軸加速度センサ及び3軸ジャイロによるセンシング結果のうち少なくとも一つに基づいて、車両200_Aの3次元位置座標における2次元座標及び向きを測定してもよい。ここで、位置情報取得部205、例えば、加速度センサにより検出した加速度を積分することにより車両200_Aの移動速度を検出し、検出した移動速度をさらに積分することにより、車両200_Aの3次元位置座標における2次元座標を測定してもよい。
Further, the position
抽出部210には、各測定点の3次元位置座標を示す情報が、物体検知部2012から入力される。また、抽出部210には、車両200_Aの位置情報(2次元座標及び向き(車両200_Aの走行方向)を示す情報)が、位置情報取得部205から入力される。
ここで、抽出部210は、各測定点の3次元位置座標を示す情報と、車両200_Aの位置情報とに基づいて、3次元位置座標により表される測定点の位置を示すマップ、すなわち、平面において格子状に並べられたマップ(以下、「高さグリッドマップ」という)を生成する。
Information indicating the three-dimensional position coordinates of each measurement point is input from the
Here, the
また、抽出部210は、上述した高さグリッドマップを構成する測定点のうち、座標成分z(高さ成分)が高さ閾値以上である測定点を抽出し、各測定点の3次元座標を示す情報に基づいて高さグリッドマップを生成する。抽出部210は、座標成分zが高さ閾値以上である測定点が抽出されて生成された高さグリッドマップを示す情報を、切出部209に出力する。ここで、高さグリッドマップを示す情報は、例えば、3次元位置座標の配列(2次元座標(x,y)とこの各2次元座標(x,y)における高さとのテーブルなど)により表されてもよい。
In addition, the
次に、図3は、高さグリッドマップの例を示す図である。この図3において、横線及び縦線の交点がグリッドである。抽出部210は、抽出された複数の測定点(高さ閾値を越える高さの測定点)を仮想的に結び、この測定点を結んだ範囲を、モデル画像に対応付ける範囲(以下、「モデル範囲」という)として暫定的に定める。ここで、モデル範囲は、高さグリッドマップの地平面(2次元座標、すなわちxy平面)において、直線に定められてもよいし、曲線(扇形)に定められてもよい。
Next, FIG. 3 is a diagram illustrating an example of a height grid map. In FIG. 3, the intersection of a horizontal line and a vertical line is a grid. The
この図3においては、測定点300−10及び300−11を直線で結んだ範囲に、モデル範囲620aが暫定的に定められている。また、測定点300−12及び300−13を直線で結んだ範囲に、モデル範囲610aが暫定的に定められている。また、測定点300−14及び300−18を曲線で結んだ範囲に、モデル範囲600aが暫定的に定められている。
In FIG. 3, a
切出部209は、撮像部2011が所定周期で供給するモデル画像を含む画像を取得する。また、切出部209は、座標成分zが高さ閾値以上である測定点が抽出された高さグリッドマップの情報を、抽出部210から取得する。
切出部209は、撮像部2011から供給された画像(以下、「撮像画像」という)における2次元座標(x,y)と、座標成分zが高さ閾値以上である測定点の3次元位置座標(x,y,z)との対応に基づいて、暫定的に定めたモデル範囲を撮像画像に定める。ここで、切出部209は、暫定的に定めたモデル範囲を示す枠が周囲環境に実際に在ると仮定した場合に、その枠が撮像画像に撮像されることになる範囲を撮像画像に定める。
The
The
また、切出部209は、モデル画像を含むようにモデル範囲を大まかに補正する。また、切出部209は、撮像画像に定められたモデル範囲、及びその周辺の所定範囲について、モデル画像の輪郭(エッジ)の強度を判定することにより、そのモデル画像を含むようにモデル範囲をさらに補正する。ここで、モデル範囲は、そのモデル範囲の各頂点の3次元位置座標(x,y,z)により表されてもよい。また、切出部209は、補正したモデル範囲に含まれるモデル画像を、撮像画像から切り出す。
Further, the
次に、図4は、モデル画像の切り出し処理を説明するための図である。図4(A)には、撮像部2011から供給される撮像画像が示されている。この図4(A)では、モデル画像700、モデル画像710、モデル画像720、及び道路400の画像が、撮像画像に含まれている。ここで、モデル画像700は、被写体500の画像である。また、モデル画像710は、被写体510の画像である。また、モデル画像720は、被写体520の画像である。
Next, FIG. 4 is a diagram for explaining a model image cut-out process. FIG. 4A shows a captured image supplied from the
図4(B)には、モデル画像と、暫定的に定めたモデル範囲を示す枠画像とを含む撮像画像が示されている。また、図4(B)では、モデル範囲600aを示す枠画像と、モデル範囲610aを示す枠画像と、モデル範囲620aを示す枠画像とが、図4(A)に示す撮像画像に対して更に含まれている。
FIG. 4B shows a captured image including a model image and a frame image indicating a provisionally determined model range. In FIG. 4B, a frame image showing the
図4(C)には、モデル画像と、そのモデル画像の輪郭に基づいて補正したモデル範囲を示す枠画像と、を含む撮像画像が示されている。図4(C)では、補正したモデル範囲600aを示す枠画像と、補正したモデル範囲610aを示す枠画像と、補正したモデル範囲620aを示す枠画像とが、図4(A)に示す撮像画像に対して更に含まれている。
FIG. 4C shows a captured image including a model image and a frame image indicating a model range corrected based on the contour of the model image. In FIG. 4C, a frame image showing the corrected
図1に戻り、切出部209は、上述した図4(C)に対し、モデル画像700の輪郭に基づいて補正されたモデル範囲600aに含まれるモデル画像700を切り出す。また、切出部209は、モデル画像710の輪郭に基づいて補正されたモデル範囲610aに含まれるモデル画像710を切り出す。また、切出部209は、モデル画像720の輪郭に基づいて補正されたモデル範囲620aに含まれるモデル画像720を切り出す。
Returning to FIG. 1, the
切出部209は、補正されたモデル範囲を示す情報(以下、テクスチャ範囲情報という)と、切り出されたモデル画像(以下、テクスチャ)と、高さグリッドマップを示す情報(以下、3次元情報)とを、走行情報差分抽出部203に出力する。ここで、切出部209は、テクスチャ範囲情報と、切り出されたテクスチャとの組をテクスチャ情報とし、このテクスチャ情報の各々に対し、テクスチャ情報を識別するテクスチャ識別情報を付加する。この3次元情報及びテクスチャ情報とは、車両の周辺の走行環境を示す情報として、以下、車両毎の車両情報とする。また、上述した3次元情報には、テクスチャ範囲情報における範囲の枠の底辺を示す座標(以下、テクスチャ範囲底辺情報)が付加されている。切出部209は、テクスチャ範囲情報からこのテクスチャ範囲底辺情報を抽出する。
The
次に、図5は、補正されたモデル範囲が定められた高さグリッドマップの例が示されている。この図5においては、モデル範囲600aは、高さグリッドマップの地平面(xy平面)において、x軸に平行な直線となるように、切出部209により補正されている。また、モデル範囲610aは、高さグリッドマップの地平面(xy平面)において、モデル範囲600aと平行になるように、切出部209により補正されている。同様に、モデル範囲620aは、高さグリッドマップの地平面(xy平面)において、モデル範囲600aと平行になるように、切出部209により補正されている。
Next, FIG. 5 shows an example of a height grid map in which the corrected model range is defined. In FIG. 5, the
また、切出部209は、テクスチャ範囲情報の枠における底辺を構成する頂点の座標を示す情報(すなわち、3次元位置座標における2次元座標)を、テクスチャ範囲情報からテクスチャ範囲底辺情報として抽出する。
例えば、切出部209は、高さグリッドマップにおいて、モデル範囲600aを構成する測定点300−16及び200−18の3次元位置情報(x、y、z)から、この範囲の底辺を示すxy平面における2次元座標(x、y)、すなわち枠における底辺の両端の頂点の2次元座標を抽出する。
Further, the
For example, in the height grid map, the
図1に戻り、走行情報合成部202は、高さグリッドマップにおける3次元座標により設定される送信領域情報と、車両情報におけるテクスチャ情報を要求する要求テクスチャ情報とを含む情報要求情報が、データ送受信部206を介して供給される。この情報要求情報は、情報統合装置100から送信される(詳細は後述)。
また、走行情報合成部202は、供給された送信領域情報に含まれる3次元情報と、すでに記憶部207に記憶されて車両が現在使用している高さグリッドマップの3次元情報とを、それぞれの3次元位置情報における2次元座標の座標値に対応して合成する。ここで、送信領域情報とは、詳細は後述するが、車両200_Aが記憶部207に有しておらず、かつ車両200_Aの進行方向にある領域の3次元情報の集合体を示している。
Returning to FIG. 1, the travel
Further, the travel
次に、図6は、記憶部207に記憶されている地図領域と、情報不完全領域との2次元座標における合成を説明する図である。この図6において、地図領域1001及び1002は、例えば、3次元情報とテクスチャ情報との双方が存在する車両情報が完全に満たされている領域である。一方、情報不完全領域1003は、情報統合装置100から送信される情報要求情報に付加された領域であり、テクスチャ情報が未取得な領域、すなわち車両情報が不完全な領域を示す情報である。この情報不完全領域は、後述するように、情報統合装置100がマップデータ記憶部105から検索した情報である。
Next, FIG. 6 is a diagram for explaining the combination of the map area stored in the
図1に戻り、走行制御部204は、情報統合装置100から送信される操作情報を、データ送受信部206を介して受信し、この操作情報に記載された制御の指示、例えば、車両200_Aのハンドル、アクセル、ブレーキ、クラッチ、ギヤシフト機器、エンジン始動装置などの操作機器の操作状態や、車速及び加速度などの指示に応じて、車両200_Aを制御する。
Returning to FIG. 1, the
走行情報差分抽出部203は、走行情報取得部201が取得した3次元情報と、情報要求情報に付加された送信領域情報に含まれる3次元情報とを比較し、走行情報取得部201が取得した3次元情報から、送信領域情報に含まれる3次元情報に含まれていない3次元情報を抽出する。
すなわち、走行情報差分抽出部203は、走行情報取得部201が3次元情報を取得した領域から、車両情報要求情報に対応し、情報統合装置100に送信する3次元情報を抽出する。走行情報差分抽出部203は、情報統合装置100に対し、抽出した3次元情報をデータ送受信部206を介して送信する。
The travel information
That is, the travel information
また、走行情報差分抽出部203は、走行情報取得部201が取得したテクスチャ情報に対応するテクスチャ範囲底辺情報と、情報要求情報に付加された要求テクスチャ情報に含まれるテクスチャ範囲底辺情報とを比較する。
そして、走行情報差分抽出部203は、要求テクスチャ情報に含まれるテクスチャ範囲底辺情報と一致するテクスチャ範囲底辺情報を、走行情報取得部201が取得したテクスチャ情報に対応するテクスチャ範囲底辺情報から抽出する。
すなわち、走行情報差分抽出部203は、走行情報取得部201が取得したテクスチャ情報から、情報要求情報に対応し、情報統合装置100に送信するテクスチャ情報を抽出する。走行情報差分抽出部203は、情報統合装置100に対し、抽出したテクスチャ情報をデータ送受信部206を介して送信する。
Further, the travel information
Then, the travel information
That is, the travel information
自律制御部208は、情報統合装置100からの操作情報が受信されない場合、記憶部207に記憶されている領域の3次元情報に基づき、車両200_Aのハンドル、アクセル、ブレーキ、クラッチ、ギヤシフト機器などを操作する自律操作情報を走行制御部204へ出力する。
すなわち、自律制御部208は、走行が不能な高さの立体物を記憶部207に記憶されている領域の3次元情報から検出し、この3次元情報と、位置情報取得部205の出力する自身の3次元位置情報とにより、記憶部207に記憶されている領域内において、走行制御部204に対して自律操作情報を供給し、走行不能な高さを避けて走行させることで、情報統合装置100から操作情報が受信されるまで車両200_Aを自律走行させる。
When the operation information from the
That is, the
次に、図1における情報統合装置100は、要求エリア選択部101、3D情報更新部102、テクスチャデータ更新部103、表示画像作成部104、マップデータ記憶部105、画像表示部106及びデータ送受信部107を備えている。
要求エリア選択部101は、車両200_Aから受信した車両位置情報の変化から推定した車両200_Aの進行方向にある3次元情報を、マップデータ記憶部105に記憶されている3Dマップマスタテーブルから抽出する。
そして、要求エリア選択部101は、3Dマップマスターテーブルから抽出した3次元情報と、マップデータ記憶部105に記憶されているエリアマトリクステーブルにおける3次元情報とを比較する。
Next, the
The request
The requested
ここで、要求エリア選択部101は、車両200_Aが保持していない3次元情報を、3Dマップマスタテーブルから抽出した3次元情報から抽出する。例えば、要求エリア選択部101は、車両200_Aの進行方向にある複数のグリッドの3次元情報を3Dマップマスターテーブルから抽出する。そして、要求エリア選択部101は、この3Dマップマスターテーブルから抽出した3次元情報に対し、自身の車両識別情報に対応して記憶されているない3次元情報を選択し、この選択した3次元情報を送信領域情報として車両200_Aに対して送信する。ここで、要求エリア選択部101は、定期的に車両200_Aから送信される、車両200_Aの位置情報に含まれる走行方向から、車両200_Aの進行方向を推定する。
Here, the request
また、要求エリア選択部101は、マップデータ記憶部105に記憶されているテクスチャマスタテーブルから、テクスチャ識別情報が対応して記憶されていないテクスチャ範囲底辺情報を抽出する。要求エリア選択部101は、抽出したテクスチャ範囲底辺情報から、上述した送信領域に含まれるテクスチャ範囲底辺情報を選択し、この選択したテクスチャ範囲底辺情報を要求テクスチャ情報とする。
In addition, the request
また、要求エリア選択部101は、定期的に送信領域情報及び要求テクスチャ情報の抽出を行い、抽出した送信領域情報及び要求テクスチャ情報を情報要求情報に付加し、データ送受信部107を介して車両200_Aに対して送信する。ここで、要求エリア選択部101は、車両200_Aに対して送信した送信領域情報をDマップエリア情報として、データマップ記憶部105のエリアマトリクステーブルに書き込んで記憶させる。
Further, the request
次に、図7は、3Dマップマスタテーブルの構成例を示す図である。この図7に示す3Dマップマスタテーブルは、例えば、緯度及び経度(グリッドマップにおけるグリッドに位置情報、すなわち、3次元位置座標(x,y,z)における2次元座標(x,y))と、グリッドにおける高さ情報(3次元位置座標(x,y,z)におけるz座標)との対応を示すテーブルである。 Next, FIG. 7 is a diagram illustrating a configuration example of a 3D map master table. The 3D map master table shown in FIG. 7 includes, for example, latitude and longitude (position information on the grid in the grid map, that is, two-dimensional coordinates (x, y) in three-dimensional position coordinates (x, y, z)), It is a table which shows a response | compatibility with the height information (z coordinate in three-dimensional position coordinate (x, y, z)) in a grid.
次に、図8は、図1のマップデータ記憶部105に記憶されているテクスチャマスタテーブルの構成例を示す図である。この図8に示すテクスチャマスタテーブルは、例えば、テクスチャ識別情報と、3次元位置座標におけるxy平面の2次元座標で示される立体物の底面の辺の両端の座標、(すなわち、上述したテクスチャ範囲底辺情報)と、テクスチャインデックスとの対応を示すテーブルである。ここで、3Dマップマスタテーブルに存在する立体物の底辺の全てに対し、この底辺のテクスチャ範囲底辺情報と、テクスチャ識別情報と、ステクスチャインデックスとの欄は生成される。また、テクスチャインデックスは、マップデータ記憶部105に設けられたテクスチャ記憶領域における、各テクスチャとしてのモデル画像のデータが記憶されているアドレスを示している。
Next, FIG. 8 is a diagram illustrating a configuration example of a texture master table stored in the map
ここで、テクスチャ範囲底辺情報は、車両200_Aの抽出部210により生成される。すでに述べたように、抽出部210は、テクスチャ情報におけるテクスチャ範囲情報から、テクスチャ範囲底辺情報を抽出する。そして、走行情報差分抽出部203は、自身の記憶部207に記憶しているテクスチャ範囲底辺情報と、情報統合装置100から送信される立体物底辺情報との差分を抽出し、抽出したテクスチャ範囲底辺情報が付加された3次元情報を情報統合装置100に対して出力する。また、テクスチャ識別情報の欄の「NOD」は、テクスチャの画像のデータが存在していないことを示している。したがって、3Dマップマスタにおける3次元位置情報で示す立体物は存在するものの、この立体物に対するテクスチャ情報がないことを示している。
Here, the texture range bottom information is generated by the
次に、図9は、図1のマップデータ記憶部105に記憶されているテクスチャマトリクステーブルの構成例を示す図である。この図9に示すテクスチャマトリクステーブルは、例えば、テクスチャ識別情報と、このテクスチャ識別情報のテクスチャの大きさ、すなわち3Dマップで用いる次元位置座標(x,y,z)を用い、4点のこの3次元位置座標(x,y,z)で示される範囲の情報(すなわち、テクスチャ範囲情報)との対応を示すテーブルである。
Next, FIG. 9 is a diagram illustrating a configuration example of a texture matrix table stored in the map
次に、図10は、図1のマップデータ記憶部105に記憶されているエリアマトリクステーブルの構成例を示す図である。この図10に示すエリアマトリクステーブルは、例えば、車両毎に付加されている車両識別情報と、この車両識別情報の示す車両の記憶部207に記憶されている3Dマップの領域を示す情報(以下、3Dマップエリア情報)との対応を示すテーブルである。ここで、3Dマップエリア情報は、3Dマップの3次元位置座標におけるxy平面の2次元座標における範囲を示す情報である。
Next, FIG. 10 is a diagram showing a configuration example of an area matrix table stored in the map
図1に戻り、3D情報更新部102は、車両200_Aから供給される、車両情報要求情報に付加された送信領域に対し、この送信領域外にある新たな3次元情報を、マップデータ記憶部105における3Dマップマスタテーブルに対して追加書き込みをし、3Dマップマスタテーブルの更新処理を行う。
また、要求エリア選択部101は、送信領域外にある新たな3次元情報を、マップデータ記憶部105の3Dマップマスタテーブルに対して書き込み、3Dマップマスタテーブルの更新を行う。
Returning to FIG. 1, the 3D
Further, the request
テクスチャデータ更新部103は、テクスチャ情報と、このテクスチャ情報を識別するテクスチャ識別情報と、このテクスチャ識別情報に対応するテクスチャ範囲底辺情報とが車両200_Aから供給される。ここで、テクスチャデータ更新部103は、マップデータ記憶部105にあるテクスチャマスタテーブルから、同一のテクスチャ範囲底辺情報を検索する。
そして、テクスチャデータ更新部103は、検索されたテクスチャ範囲底辺情報に対応するテクスチャ識別情報の欄に対し、このテクスチャ情報のテクスチャ識別情報を書き込む。また、テクスチャデータ更新部103は、マップデータ記憶部105のテクスチャ記憶領域に対し、上述したテクスチャ識別情報の示すテクスチャ情報におけるテクスチャのデータを書き込んで記憶させ、記憶させたアドレスをテクスチャインデックスの欄に書き込む。
The texture
Then, the texture
また、テクスチャデータ更新部103は、車両200_Aが情報要求情報に対応して送信したテクスチャ情報と、このテクスチャ情報を識別するテクスチャ識別情報とにより、マップデータ記憶部105のテクスチャマトリクステーブルの更新処理を行う。すなわち、テクスチャデータ更新部103は、テクスチャマトリクステーブルに対し、車両200_Aが情報要求情報に対応して送信したテクスチャ情報におけるテクスチャ範囲情報と、このテクスチャ情報を識別するテクスチャ識別情報とを対応させて書き込み記憶させる。
Further, the texture
画像記憶部108には、高さグリッドマップの地平面の2次元座標(x,y)に対応付けられた俯瞰画像(例えば、空撮画像、航空写真、衛星画像)が予め書き込まれて記憶されている。
In the
表示画像作成部104は、高さグリッドマップを示す3次元情報を、マップデータ記憶部105の3Dマップマスタテーブルから読み込む。ここで、表示画像作成部104は、高さグリッドマップを示す情報に基づいて、その高さグリッドマップの地平面の2次元座標(x,y)に対応付けられた俯瞰画像を、画像記憶部108から読み込む。
The display
また、表示画像作成部104は、高さグリッドマップを示す3次元情報に基づいて、座標成分z(高さ成分)が同じ高さである測定点を結ぶことで、高さグリッドマップに等高線を定める。また、表示画像作成部104は、等高線が定められた高さグリッドマップに俯瞰画像を貼り付け、その高さグリッドマップの俯瞰図を、高さマップの俯瞰図として生成する。以下、等高線が定められかつ俯瞰画像が貼り付けられた高さグリッドマップを、「高さマップ」という。
In addition, the display
また、表示画像作成部104は、マップデータ記憶部105のテクスチャマトリクステーブルから、3Dマップ座標情報とこの3Dマップ座標情報に対応するテクスチャ識別情報とを読み込む。そして、表示画像作成部104は、読み込んだテクスチャ識別情報に対応するテクスチャの記憶先を示すテクスチャインデックスを、マップデータ記憶部105のテクスチャマスタテーブルから読み出す。表示画像作成部104は、読み出したテクスチャインデックスの示すアドレスに記憶されているテクスチャのデータを読み出す。
表示画像作成部104は、テクスチャを貼り付けるテクスチャ貼付範囲を、3Dマップ座標情報に基づいて、高さマップの俯瞰図に定める。また、表示画像作成部104は、テクスチャ識別情報により対応付けられたモテクスチャを、同一のテクスチャ識別情報により高さマップの俯瞰図に設定したテクスチャ貼付範囲に貼り付ける。また、表示画像作成部104は、高さマップの俯瞰図の予め定められた座標に、車両200_Aの俯瞰画像を貼り付ける。
Further, the display
The display
図11は、高さマップの俯瞰図の例を示す図である。この図11では、モデル範囲600aに予め対応付けられているモデル画像700は、高さマップの俯瞰図におけるモデル範囲600a(図5を参照)に貼り付けられている。また、モデル範囲610aに予め対応付けられているモデル画像710は、高さマップの俯瞰図におけるモデル範囲610a(図5を参照)に貼り付けられている。また、モデル範囲620aに予め対応付けられているモデル画像720は、高さマップの俯瞰図におけるモデル範囲620a(図5を参照)に貼り付けられている。また、移動体900の俯瞰画像は、高さマップの俯瞰図の予め定められた座標に貼り付けられている。また、等高線800−1〜800−5を示す画像は、高さマップに定められた等高線と重なるように、高さマップの俯瞰図に貼り付けられている。
FIG. 11 is a diagram illustrating an example of an overhead view of the height map. In FIG. 11, the
図1に戻り、画像表示部106は、上述した図11に示すように、テクスチャの画像と、等高線を示す画像と、車両200_Aの俯瞰画像とが貼り付けられた高さマップの俯瞰図を表示する。
また、画像表示部106は、遠隔操作に必要な各種情報(例えば、車両200_Aの3次元座標)を更に表示してもよい。ここで、画像表示部106は、例えば、液晶表示装置などである。
Returning to FIG. 1, the
The
次に、図1及び図12を用いて、本発明の第1の実施形態による走行制御システムにおける車両情報の取得処理を説明する。図12は、本発明の第1の実施形態による走行制御システムにおける走行情報の取得処理の動作例を示すフローチャートである。本実施形態においては、以下に示す走行制御の処理が、予め設定された周期において繰り返して行われる。以下では、車両と情報統合装置100とのデータの授受の例として、車両200_A、200_B、200_C、…における車両200_Aと、情報統合装置100との間の処理を説明するが、他の200_B、200_C、…の各々と、情報統合装置100との間においても、同様に以下に説明する処理が行われる。
Next, vehicle information acquisition processing in the travel control system according to the first embodiment of the present invention will be described with reference to FIGS. FIG. 12 is a flowchart showing an operation example of travel information acquisition processing in the travel control system according to the first embodiment of the present invention. In the present embodiment, the following travel control process is repeatedly performed in a preset cycle. Hereinafter, as an example of data exchange between the vehicle and the
ステップS1:
要求エリア選択部101は、定期的に車両200_Aから送信される、車両200_Aの位置情報に含まれる走行方向から、車両200_Aの進行方向を推定する。
そして、要求エリア選択部101は、車両200_Aの進行方向にある3次元情報を、マップデータ記憶部105に記憶されている3Dマップマスタテーブルから抽出する。
ここで、例えば、予め各車両に搭載されている走行情報取得部201が取得可能なテクスチャ情報及び3次元情報の取得可能領域として、車両の進行方向に対する角度が設定しておいても良い。この場合、要求エリア選択部101は、マップデータ記憶部105に記憶されている3Dマップマスタテーブルから、車両200_Aの現在位置及び進行方向と、上記取得可能領域とに基づき、この範囲に含まれる3次元情報を送信領域情報として抽出する。
また、要求エリア選択部101は、車両200_Aに対する送信領域情報に含まれる3次元情報を、マップデータ記憶部105におけるエリアマトリクステーブルの車両200_Aに対応する領域に書き込んで記憶させ、エリアマトリクステーブルの更新を行う。
Step S1:
The request
Then, the request
Here, for example, an angle with respect to the traveling direction of the vehicle may be set as a texture information and three-dimensional information acquirable area that can be acquired in advance by the travel
Further, the requested
ステップS2:
次に、要求エリア選択部101は、マップデータ記憶部105に記憶されているテクスチャマスタテーブルから、テクスチャ識別情報が対応して記憶されていないテクスチャ範囲底辺情報を抽出する。
そして、要求エリア選択部101は、抽出したテクスチャ範囲底辺情報から、上述した送信領域に含まれるテクスチャ範囲底辺情報を抽出し、この抽出したテクスチャ範囲底辺情報を要求テクスチャ情報とする。
Step S2:
Next, the request
Then, the requested
ステップS3:
次に、要求エリア選択部101は、抽出した送信領域情報及び要求テクスチャ情報を、車両200_Aに対し、情報要求情報としてデータ送受信部107を介して送信する。
Step S3:
Next, the request
ステップS4:
データ送受信部206は、情報統合装置100から情報要求情報を受信し、この受信した情報要求信号を、走行情報合成部202と走行情報差分抽出部203とに対して供給する。
Step S4:
The data transmission /
ステップS5:
次に、走行情報合成部202は、データ送受信部206から供給される3次元情報を、すでに記憶部207に記憶されている3次元情報と合成する。
そして、走行情報合成部202は、新たに走行情報取得部201が取得する3次元情報、テクスチャ範囲底辺情報及びテクスチャ情報を記憶部207に対して順次書き込んで一端蓄積する。
Step S5:
Next, the travel
Then, the travel
ステップS6:
次に、走行情報差分抽出部203は、記憶部207に記憶されている3次元情報と、新たに走行情報取得部201が取得した3次元情報とを比較する。
そして、走行情報差分抽出部203は、記憶部207に記憶されている3次元情報に含まれていない3次元情報を、新たに走行情報取得部201が取得した3次元情報から抽出し、差分の3次元情報とする。
Step S6:
Next, the travel information
Then, the travel information
ステップS7:
次に、走行情報差分抽出部203は、要求テクスチャ情報におけるテクスチャ範囲底辺情報と、記憶部207に蓄積されているテクスチャ範囲底辺情報とを比較する。
そして、走行情報差分抽出部203は、要求テクスチャ情報に含まれていないテクスチャ範囲底辺情報を、記憶部207に記憶されているテクスチャ範囲底辺情報から抽出し、差分のテクスチャ範囲底辺情報とする。
また、走行情報差分抽出部203は、この差分のテクスチャ範囲底辺情報に対応するテクスチャ情報を、記憶部207から差分のテクスチャ情報として読み出す。
Step S7:
Next, the travel information
Then, the travel information
Further, the travel information
ステップS8:
次に、走行情報差分抽出部203は、抽出した差分の3次元情報と、差分のテクスチャ情報及びこのテクスチャ情報各々に対応するテクスチャ範囲底辺情報の組とを、情報統合装置100に対し、データ送受信部206を介して送信する。
Step S8:
Next, the travel information
ステップS9:
データ送受信部107は、抽出した差分の3次元情報と、差分のテクスチャ情報及びこのテクスチャ情報各々に対応するテクスチャ範囲底辺情報の組とを、車両200_Aから受信する。
そして、データ送受信部107は、この受信した抽出した差分の3次元情報と、差分のテクスチャ情報及びこのテクスチャ情報各々に対応するテクスチャ範囲底辺情報の組とを、要求エリア選択部101、3D情報更新部102及びテクスチャデータ更新部103に対して供給する。
Step S9:
The data transmitting / receiving
Then, the data transmitting / receiving
ステップS10:
次に、3D情報更新部102は、車両200_Aから供給された差分3次元情報を、マップデータ記憶部105の3Dマップマスタテーブルに対して追加の書き込みを行い、この3Dマップマスタテーブルの更新処理を行う。
Step S10:
Next, the 3D
ステップS11:
次に、テクスチャデータ更新部103は、差分の3次元情報に含まれるテクスチャ範囲底辺情報を、マップデータ記憶部105のテクスチャマスタテーブルに追加で書き込む。
そして、テクスチャデータ更新部103は、差分のテクスチャ情報におけるテクスチャの画像のデータを、マップデータ記憶部105のテクスチャ記憶領域に書き込み、このテクスチャのテクスチャ識別情報と、テクスチャの画像のデータを書き込んだテクスチャ記憶領域のアドレスとを内部に記憶する。
Step S11:
Next, the texture
Then, the texture
また、テクスチャデータ更新部103は、差分のテクスチャ情報及びこのテクスチャ情報各々に対応するテクスチャ範囲底辺情報の組において、この組のテクスチャ範囲底辺情報と一致するテクスチャ範囲底辺情報を、マップデータ記憶部105のテクスチャマスタテーブルから検索する。
そして、テクスチャデータ更新部103は、検索されたテクスチャ範囲底辺情報に対応させて、マップデータ記憶部105のテクスチャマスタテーブルに対して、テクスチャ識別情報及びテクスチャの画像のデータを書き込んだアドレスを書き込んで、このテクスチャマスタテーブルの更新を行う。
また、テクスチャデータ更新部103は、マップデータ記憶部105のテクスチャマスタテーブルに書き込んだテクスチャ情報におけるテクスチャ識別情報とテクスチャ範囲情報とを、マップデータ記憶部105のテクスチャマトリクステーブルに追加で書き込んで記憶させる更新処理を行う。
In addition, the texture
Then, the texture
The texture
ステップS12:
次に、要求エリア選択部101は、車両200_Aからの差分の3次元情報を、マップデータ記憶部105のエリアマトリクステーブルに対し、車両200_Aに対応する領域に書き込んで、このエリアマトリクステーブルの更新処理を行う。
Step S12:
Next, the requested
ステップS13:
次に、表示画像作成部104は、図11に示す俯瞰画像を、マップデータ記憶部105におけるテクスチャマトリクス及びテクスチャマスタテーブルとを用いて作成する。
Step S13:
Next, the display
ステップS14:
次に、画像表示部106は、上述した図11に示すように、テクスチャの画像と、等高線を示す画像と、車両200_Aの俯瞰画像とが貼り付けられた高さマップの俯瞰図を表示する。
Step S14:
Next, as shown in FIG. 11 described above, the
上述したように、本実施形態は、複数の車両が個々に取得した3次元情報及びテクスチャ情報を、情報統合装置100において共通にマップデータ記憶部105において集積し、複数の車両が共通に用いる構成としている。
このため、本実施形態によれば、いずれかの車両が取得し、情報統合装置100に対して送信した3次元情報及びテクスチャ情報を、他の車両が重複して情報統合装置100に対して送信する必要がなくなる。
したがって、本実施形態によれば、情報統合装置100と各車両との間で重複した3次元情報及びテクスチャ情報の送受信が削減されるので、情報統合装置100及び各車両間における通信データの量を低減することができる。
As described above, in the present embodiment, the three-dimensional information and texture information individually acquired by a plurality of vehicles are integrated in the map
For this reason, according to the present embodiment, the three-dimensional information and texture information acquired by one of the vehicles and transmitted to the
Therefore, according to this embodiment, since the transmission / reception of the overlapping 3D information and texture information between the
<第2の実施形態>
以下、図面を参照して、本発明の第2の実施形態について説明する。図13は、この発明の第2の実施形態による走行制御システムの構成例を示す概略ブロック図である。
この図13に示す第2の実施形態は、第1の実施形態の走行制御システムと同様に、複数の移動体(車両、陸上無人機等)、例えば車両200_A、200_B、200_C、…と、これらの車両の各々の走行制御を遠隔操作により行う情報統合装置100とで構成されている。図13においては、第1の実施形態と同様な構成については同一の符号を付し、その説明を省略し、以下、第1の実施形態と異なる構成及び動作について説明する。
<Second Embodiment>
The second embodiment of the present invention will be described below with reference to the drawings. FIG. 13 is a schematic block diagram showing a configuration example of a travel control system according to the second embodiment of the present invention.
The second embodiment shown in FIG. 13 is similar to the traveling control system of the first embodiment, such as a plurality of moving bodies (vehicles, land drones, etc.), such as vehicles 200_A, 200_B, 200_C,. And an
本実施形態が、第1の実施形態と異なる点は、複数の車両の中の一台、例えば、車両200_Aに対し、車両情報(テクスチャ情報及び3次元情報)を集約する機能を持たせることにある。そして、車両200_Aが集約した車両情報を情報統合装置100に送信することで、本実施形態においては、各車両と情報統合装置100との間の送受信のデータ量を、第1の実施形態に比較してさらに低減させている。
また、車両200_Aのマップデータ記憶部105_Aと、情報統合装置100のマップデータ記憶部105との各々は、同一のデータが記憶される3Dマップマスタテーブル、テクスチャマスタテーブル及びテクスチャマトリクステーブルを有している。ここで、マップデータ記憶部105_Aには、車両_200Aが各車両の有している3次元情報を管理するため、エリアマトリクステーブルが記憶されている。一方、マップデータ記憶部105には、第1の実施形態と異なり、各車両の有している3次元情報を管理することがないため、エリアマトリクステーブルが備えられていない。
The present embodiment is different from the first embodiment in that one of a plurality of vehicles, for example, the vehicle 200_A, has a function of collecting vehicle information (texture information and three-dimensional information). is there. Then, by transmitting the vehicle information aggregated by the vehicle 200_A to the
Each of the map data storage unit 105_A of the vehicle 200_A and the map
このため、本実施形態において、情報統合装置100は、車両情報の取得の制御を行わないため、要求エリア選択部が必要なくなる。
一方、車両情報の取得の制御を行うため、車両200_Aは、第1の実施形態の構成に加えて、要求エリア選択部101_A、3D情報更新部102_A、テクスチャデータ更新部103_A及びマップデータ記憶部105_Aが新たに設けられている。これら要求エリア選択部101_A、3D情報更新部102_A、テクスチャデータ更新部103_A及びマップデータ記憶部105_Aの各々は、それぞれ第1の実施形態における要求エリア選択部101、3D情報更新部102、テクスチャデータ更新部103及びマップデータ記憶部105と同様な構成であり、同様の処理を行う。また、車両200_B、200_C、…の各々は、第1の実施形態における車両200_Aと同様の構成をしている。
For this reason, in this embodiment, since the
On the other hand, in order to control acquisition of vehicle information, the vehicle 200_A includes a request area selection unit 101_A, a 3D information update unit 102_A, a texture data update unit 103_A, and a map data storage unit 105_A in addition to the configuration of the first embodiment. Is newly provided. Each of these request area selection unit 101_A, 3D information update unit 102_A, texture data update unit 103_A, and map data storage unit 105_A is respectively requested
要求エリア選択部101_Aは、マップデータ記憶部105_Aにおける3Dマップマスタテーブル、テクスチャマスタテーブル及びエリアマトリクステーブルの各々を用い、自身を含む各車両に対して出力する3次元情報及び要求テクスチャ情報を生成し、それぞれに情報要求情報に付加して出力する。ここで、車両200_Aは、自身に対してこの情報要求信号を供給する際、データ送受信部206を介さず、3次元情報及び要求テクスチャ情報を直接に各部に出力する。一方、車両200_Aは、他の車両に対してこの情報要求信号を供給する際、データ送受信部206を介し、3次元情報及び要求テクスチャ情報を各車両に対して送信する。
また、この情報要求情報を受信した後の、各車両における3次元情報及びテクスチャ情報の取得処理と、取得した3次元情報及びテクスチャ情報から、車両200_Aに対して送信する差分3次元情報及び差分のテクスチャ情報の抽出処理とは、第1の実施形態と同様である。
The requested area selection unit 101_A uses each of the 3D map master table, the texture master table, and the area matrix table in the map data storage unit 105_A to generate 3D information and requested texture information to be output to each vehicle including itself. , Each is added to the information request information and output. Here, when supplying the information request signal to the vehicle 200_A, the vehicle 200_A directly outputs the three-dimensional information and the requested texture information to each unit without using the data transmission /
Further, after receiving this information request information, the three-dimensional information and texture information acquisition process in each vehicle, and the difference three-dimensional information and difference information to be transmitted to the vehicle 200_A from the acquired three-dimensional information and texture information. The texture information extraction process is the same as in the first embodiment.
3D情報更新部102_Aは、上記情報要求情報に対応し、自身を含む各車両から供給される差分の3次元情報を、マップデータ記憶部105_Aの3Dマップマスタテーブルに対し、追加の書き込みを行い、この3Dマップマスタテーブルを更新する。
テクスチャデータ更新部103_Aは、マップデータ記憶部105_Aのテクスチャマスタテーブル及びテクスチャマトリクステーブルに対し、差分のテクスチャ情報に基づいた追加のデータの書き込みを行い、このテクスチャマスタテーブル及びテクスチャマトリクステーブルを更新する。
要求エリア選択部101_Aは、自身を含む各車両に送信した3次元情報及び各車両から供給される差分の3次元情報とを、マップデータ記憶部105_Aのエリアマトリクステーブルに対して追加の書き込みを行い、エリアマトリクステーブルの更新処理を行う。
The 3D information update unit 102_A additionally writes the three-dimensional information of the difference supplied from each vehicle including itself to the 3D map master table of the map data storage unit 105_A corresponding to the information request information. This 3D map master table is updated.
The texture data update unit 103_A writes additional data based on the difference texture information to the texture master table and the texture matrix table of the map data storage unit 105_A, and updates the texture master table and the texture matrix table.
The requested area selection unit 101_A additionally writes the three-dimensional information transmitted to each vehicle including itself and the difference three-dimensional information supplied from each vehicle to the area matrix table of the map data storage unit 105_A. The area matrix table is updated.
次に、図13及び図14を用いて、本発明の第2の実施形態による走行制御システムにおける車両情報の取得処理を説明する。図14は、本発明の第2の実施形態による走行制御システムにおける走行情報の取得処理の動作例を示すフローチャートである。本実施形態においては、以下に示す走行制御の処理が、予め設定された周期において繰り返して行われる。以下では、各車両の車両情報の取得を行い集積する車両を200_Aとし、この車両200_Aが車両200_Bから車両情報の取得を行う処理を例として説明する。また、車両200_Aは、車両200_B、200_C、…における車両200_B以外の車両200_C、…の各々と、情報統合装置100との間においても、同様に以下に説明する処理が行われる。
Next, vehicle information acquisition processing in the travel control system according to the second embodiment of the present invention will be described with reference to FIGS. 13 and 14. FIG. 14 is a flowchart showing an operation example of travel information acquisition processing in the travel control system according to the second embodiment of the present invention. In the present embodiment, the following travel control process is repeatedly performed in a preset cycle. In the following, an example of processing in which vehicle information of each vehicle is acquired and accumulated is 200_A, and the vehicle 200_A acquires vehicle information from the vehicle 200_B will be described as an example. In addition, the vehicle 200_A similarly performs the process described below between each of the vehicles 200_B, 200_C,..., Other than the vehicle 200_B, and the
ステップS21:
車両200_Aにおいて、要求エリア選択部101_Aは、定期的に車両200_Bから送信される、車両200_Bの位置情報に含まれる走行方向から、車両200_Bの進行方向を推定する。
そして、要求エリア選択部101_Aは、車両200_Bの進行方向にある3次元情報を、マップデータ記憶部105_Aに記憶されている3Dマップマスタテーブルから抽出する。
ここで、例えば、予め各車両に搭載されている走行情報取得部201が取得可能なテクスチャ情報及び3次元情報の取得可能領域として、第1の実施形態と同様に、車両の進行方向に対する角度が設定しておいても良い。この場合、要求エリア選択部101_Aは、マップデータ記憶部105_Aに記憶されている3Dマップマスタテーブルから、車両200_Bの現在位置及び進行方向と、上記取得可能領域とに基づき、この範囲に含まれる3次元情報を送信領域情報として抽出する。
また、要求エリア選択部101_Aは、車両200_Bに対する送信領域情報に含まれる3次元情報を、マップデータ記憶部105_Aにおけるエリアマトリクステーブルの車両200_Bに対応する領域に書き込んで記憶させ、エリアマトリクステーブルの更新を行う。
Step S21:
In the vehicle 200_A, the request area selection unit 101_A estimates the traveling direction of the vehicle 200_B from the traveling direction included in the position information of the vehicle 200_B that is periodically transmitted from the vehicle 200_B.
Then, the request area selection unit 101_A extracts the three-dimensional information in the traveling direction of the vehicle 200_B from the 3D map master table stored in the map data storage unit 105_A.
Here, for example, the texture information and the three-dimensional information that can be acquired by the travel
Further, the requested area selection unit 101_A writes and stores the three-dimensional information included in the transmission region information for the vehicle 200_B in the region corresponding to the vehicle 200_B in the area matrix table in the map data storage unit 105_A, and updates the area matrix table. I do.
ステップS22:
次に、車両200_Aにおいて、要求エリア選択部101_Aは、マップデータ記憶部105_Aに記憶されているテクスチャマスタテーブルから、テクスチャ識別情報が対応して記憶されていないテクスチャ範囲底辺情報を抽出する。
そして、要求エリア選択部101_Aは、抽出したテクスチャ範囲底辺情報から、上述した送信領域に含まれるテクスチャ範囲底辺情報を抽出し、この抽出したテクスチャ範囲底辺情報を要求テクスチャ情報とする。
Step S22:
Next, in the vehicle 200_A, the request area selection unit 101_A extracts texture range bottom information in which the texture identification information is not stored correspondingly from the texture master table stored in the map data storage unit 105_A.
Then, the requested area selection unit 101_A extracts the texture range bottom information included in the transmission area described above from the extracted texture range bottom information, and uses the extracted texture range bottom information as requested texture information.
ステップS23:
次に、車両200_Aにおいて、要求エリア選択部101_Aは、抽出した送信領域情報及び要求テクスチャ情報を、車両200_Bに対し、情報要求情報としてデータ送受信部107を介して送信する。
Step S23:
Next, in the vehicle 200_A, the request area selection unit 101_A transmits the extracted transmission area information and request texture information to the vehicle 200_B via the data transmission /
ステップS24:
そして、車両200_Bにおいて、データ送受信部206は、車両200_Aから情報要求信号を受信し、この受信した情報要求信号を、走行情報合成部202と走行情報差分抽出部203とに対して供給する。
Step S24:
In the vehicle 200_B, the data transmission /
ステップS25:
次に、車両200_Bにおいて、走行情報合成部202は、データ送受信部206から供給される3次元情報を、すでに記憶部207に記憶されている3次元情報と合成する。
そして、走行情報合成部202は、新たに走行情報取得部201が取得する3次元情報、テクスチャ範囲底辺情報及びテクスチャ情報を記憶部207に対して順次書き込んで一端蓄積する。
Step S25:
Next, in the vehicle 200_B, the traveling
Then, the travel
ステップS26:
次に、車両200_Bにおいて、走行情報差分抽出部203は、記憶部207に記憶されている3次元情報と、新たに走行情報取得部201が取得した3次元情報とを比較する。
そして、走行情報差分抽出部203は、記憶部207に記憶されている3次元情報に含まれていない3次元情報を、新たに走行情報取得部201が取得した3次元情報から抽出し、差分の3次元情報とする。
Step S26:
Next, in the vehicle 200_B, the travel information
Then, the travel information
ステップS27:
次に、車両200_Bにおいて、走行情報差分抽出部203は、要求テクスチャ情報におけるテクスチャ範囲底辺情報と、記憶部207に蓄積されているテクスチャ範囲底辺情報とを比較する。
そして、走行情報差分抽出部203は、要求テクスチャ情報に含まれていないテクスチャ範囲底辺情報を、記憶部207に記憶されているテクスチャ範囲底辺情報から抽出し、差分のテクスチャ範囲底辺情報とする。
また、走行情報差分抽出部203は、この差分のテクスチャ範囲底辺情報に対応するテクスチャ情報を、記憶部207から差分のテクスチャ情報として読み出す。
Step S27:
Next, in the
Then, the travel information
Further, the travel information
ステップS28:
次に、車両200_Bにおいて、走行情報差分抽出部203は、抽出した差分の3次元情報と、差分のテクスチャ情報及びこのテクスチャ情報各々に対応するテクスチャ範囲底辺情報の組とを、車両200_Aに対し、データ送受信部206を介して送信する。
Step S28:
Next, in the vehicle 200_B, the travel information
ステップS29:
次に、車両200_Aにおいて、データ送受信部107は、抽出した差分の3次元情報と、差分のテクスチャ情報及びこのテクスチャ情報各々に対応するテクスチャ範囲底辺情報の組とを、車両200_Bから受信する。
そして、データ送受信部107は、この受信した抽出した差分の3次元情報と、差分のテクスチャ情報及びこのテクスチャ情報各々に対応するテクスチャ範囲底辺情報の組とを、要求エリア選択部101_A、3D情報更新部102_A及びテクスチャデータ更新部103_Aに対して供給する。
Step S29:
Next, in the vehicle 200_A, the data transmitting / receiving
Then, the data transmitting / receiving
ステップS30:
次に、車両200_Aにおいて、3D情報更新部102_Aは、車両200_Bから供給された差分3次元情報を、マップデータ記憶部105_Aの3Dマップマスタテーブルに対して追加の書き込みを行い、この3Dマップマスタテーブルの更新処理を行う。
Step S30:
Next, in the vehicle 200_A, the 3D information update unit 102_A additionally writes the difference 3D information supplied from the vehicle 200_B to the 3D map master table of the map data storage unit 105_A, and this 3D map master table Update processing is performed.
ステップS31:
次に、車両200_Aにおいて、テクスチャデータ更新部103_Aは、差分の3次元情報に含まれるテクスチャ範囲底辺情報を、マップデータ記憶部105_Aのテクスチャマスタテーブルに追加で書き込む。
そして、テクスチャデータ更新部103_Aは、差分のテクスチャ情報におけるテクスチャの画像のデータを、マップデータ記憶部105_Aのテクスチャ記憶領域に書き込み、このテクスチャのテクスチャ識別情報と、テクスチャの画像のデータを書き込んだテクスチャ領域のアドレスとを内部に記憶する。
Step S31:
Next, in the vehicle 200_A, the texture data update unit 103_A additionally writes the texture range base information included in the difference three-dimensional information to the texture master table of the map data storage unit 105_A.
Then, the texture data update unit 103_A writes the texture image data in the difference texture information to the texture storage area of the map data storage unit 105_A, and the texture identification information of the texture and the texture image data written therein The address of the area is stored internally.
また、車両200_Aにおいて、テクスチャデータ更新部103_Aは、差分のテクスチャ情報及びこのテクスチャ情報各々に対応するテクスチャ範囲底辺情報の組において、この組のテクスチャ範囲底辺情報と一致するテクスチャ範囲底辺情報を、マップデータ記憶部105_Aのテクスチャマスタテーブルから検索する。
そして、テクスチャデータ更新部103_Aは、検索されたテクスチャ範囲底辺情報に対応させて、マップデータ記憶部105_Aのテクスチャマスタテーブルに対して、テクスチャ識別情報及びテクスチャの画像のデータを書き込んだアドレスを書き込んで、このテクスチャマスタテーブルの更新を行う。
また、テクスチャデータ更新部103_Aは、マップデータ記憶部105_Aのテクスチャマスタテーブルに書き込んだテクスチャ情報におけるテクスチャ識別情報とテクスチャ範囲情報とを、マップデータ記憶部105_Aのテクスチャマトリクステーブルに追加で書き込んで記憶させる更新処理を行う。
Further, in the vehicle 200_A, the texture data update unit 103_A maps the texture range bottom information that matches the texture range bottom information of this set in the set of the difference texture information and the texture range bottom information corresponding to each of the texture information. Search from the texture master table of the data storage unit 105_A.
Then, the texture data update unit 103_A writes the address at which the texture identification information and the texture image data are written in the texture master table of the map data storage unit 105_A in association with the searched texture range bottom information. The texture master table is updated.
The texture data updating unit 103_A additionally writes and stores texture identification information and texture range information in the texture information written in the texture master table of the map data storage unit 105_A in the texture matrix table of the map data storage unit 105_A. Perform update processing.
ステップS32:
次に、車両200_Aにおいて、要求エリア選択部101_Aは、車両200_Bからの差分の3次元情報を、マップデータ記憶部105_Aのエリアマトリクステーブルに対し、車両200_B対応する領域に書き込んで、このエリアマトリクステーブルの更新処理を行う。
Step S32:
Next, in the vehicle 200_A, the requested area selection unit 101_A writes the three-dimensional information of the difference from the vehicle 200_B in the area corresponding to the vehicle 200_B in the area matrix table of the map data storage unit 105_A. Update processing is performed.
ステップS33:
次に、車両200_Aにおいて、走行情報差分抽出部203は、抽出した差分の3次元情報と、差分のテクスチャ情報及びこのテクスチャ情報各々に対応するテクスチャ範囲底辺情報の組とを、情報統合装置100に対し、データ送受信部206を介して送信する。
Step S33:
Next, in the vehicle 200_A, the travel information
ステップS34:
次に、情報統合装置100において、データ送受信部107は、抽出した差分の3次元情報と、差分のテクスチャ情報及びこのテクスチャ情報各々に対応するテクスチャ範囲底辺情報の組とを、車両200_Aから受信する。
そして、データ送受信部107は、この受信した抽出した差分の3次元情報と、差分のテクスチャ情報及びこのテクスチャ情報各々に対応するテクスチャ範囲底辺情報の組とを、3D情報更新部102及びテクスチャデータ更新部103_Aに対して供給する。
Step S34:
Next, in the
Then, the data transmitting / receiving
ステップS35:
次に、情報統合装置100において、3D情報更新部102は、車両200_Aから供給された差分3次元情報を、マップデータ記憶部105の3Dマップマスタテーブルに対して追加の書き込みを行い、この3Dマップマスタテーブルの更新処理を行う。
Step S35:
Next, in the
ステップS36:
次に、情報統合装置100において、テクスチャデータ更新部103は、差分の3次元情報に含まれるテクスチャ範囲底辺情報を、マップデータ記憶部105のテクスチャマスタテーブルに追加で書き込む。
そして、テクスチャデータ更新部103は、差分のテクスチャ情報におけるテクスチャの画像のデータを、マップデータ記憶部105のテクスチャ記憶領域に書き込み、このテクスチャのテクスチャ識別情報と、テクスチャの画像のデータを書き込んだテクスチャ領域のアドレスとを内部に記憶する。
Step S36:
Next, in the
Then, the texture
また、車両200_Aにおいて、テクスチャデータ更新部103_Aは、差分のテクスチャ情報及びこのテクスチャ情報各々に対応するテクスチャ範囲底辺情報の組において、この組のテクスチャ範囲底辺情報と一致するテクスチャ範囲底辺情報を、マップデータ記憶部105_Aのテクスチャマスタテーブルから検索する。
そして、テクスチャデータ更新部103_Aは、検索されたテクスチャ範囲底辺情報に対応させて、マップデータ記憶部105_Aのテクスチャマスタテーブルに対して、テクスチャ識別情報及びテクスチャの画像のデータを書き込んだアドレスを書き込んで、このテクスチャマスタテーブルの更新を行う。
また、テクスチャデータ更新部103_Aは、マップデータ記憶部105_Aのテクスチャマスタテーブルに書き込んだテクスチャ情報におけるテクスチャ識別情報とテクスチャ範囲情報とを、マップデータ記憶部105_Aのテクスチャマトリクステーブルに追加で書き込んで記憶させる更新処理を行う。
Further, in the vehicle 200_A, the texture data update unit 103_A maps the texture range bottom information that matches the texture range bottom information of this set in the set of the difference texture information and the texture range bottom information corresponding to each of the texture information. Search from the texture master table of the data storage unit 105_A.
Then, the texture data update unit 103_A writes the address at which the texture identification information and the texture image data are written in the texture master table of the map data storage unit 105_A in association with the searched texture range bottom information. The texture master table is updated.
The texture data updating unit 103_A additionally writes and stores texture identification information and texture range information in the texture information written in the texture master table of the map data storage unit 105_A in the texture matrix table of the map data storage unit 105_A. Perform update processing.
ステップS37:
次に、情報統合装置100において、表示画像作成部104は、図11に示す俯瞰画像を、マップデータ記憶部105におけるテクスチャマトリクス及びテクスチャマスタテーブルとを用いて作成する。
Step S37:
Next, in the
ステップS38:
次に、情報処統合置100において、画像表示部106は、上述した図11に示すように、テクスチャの画像と、等高線を示す画像と、車両200_Bの俯瞰画像とが貼り付けられた高さマップの俯瞰図を表示する(車両200_Aを含む他の車両の同様)。
Step S38:
Next, in the information processing integrated
上述したように、本実施形態は、複数の車両が個々に取得した3次元情報及びテクスチャ情報を、一旦、複数の車両における車両200_Aにおいて共通にマップデータ記憶部105_Aにおいて集積し、集積してデータが更新される毎に、更新された車両データ(差分の3次元情報及び差分のテクスチャ情報)のみを、情報統合装置100に対して送信し、複数の車両の走行制御に用いる構成としている。
このため、本実施形態によれば、いずれかの車両が各車両の車両情報を取得して集積し、情報統合装置100に対して送信するため、各車両が3次元情報及びテクスチャ情報を、重複して情報統合装置100に対して送信することがなくなる。
As described above, in the present embodiment, the three-dimensional information and texture information acquired individually by a plurality of vehicles are temporarily accumulated in the map data storage unit 105_A in the vehicle 200_A in the plurality of vehicles, and the accumulated data is collected. Each time is updated, only the updated vehicle data (difference three-dimensional information and difference texture information) is transmitted to the
For this reason, according to this embodiment, since any vehicle acquires and accumulate | stores the vehicle information of each vehicle, and transmits with respect to the
したがって、本実施形態によれば、情報統合装置100と各車両との間で重複した3次元情報及びテクスチャ情報の送受信が削減されるので、情報統合装置100及び各車両間における通信データの量を低減することができる。
すなわち、本実施形態によれば、車両200_Aが集約した車両情報を情報統合装置100に送信することで、各車両と情報統合装置100との間の送受信のデータ量を、第1の実施形態に比較してさらに低減させている。
Therefore, according to this embodiment, since the transmission / reception of the overlapping 3D information and texture information between the
That is, according to the present embodiment, by transmitting the vehicle information aggregated by the vehicle 200_A to the
また、本実施形態によれば、周囲の環境により、各車両と情報統合装置100との間の通信が行えなくなった場合でも、車両間における3次元情報の共通化が行えるため、自律走行を行う際、第1の実施形態に比較し、より各車両における自律走行可能な範囲を広げることができる。
ここで、本実施形態の走行制御システムにおいて、複数車両の1台ではなく、複数あるいは全てに対して、車両200_Aにおける各車両の車両情報を取得する車両情報集積機能を持たせ、通信状況や故障などにより、逐次、車両情報集積機能を起動させる車両を変更するようにしても良い。
In addition, according to the present embodiment, even when communication between each vehicle and the
Here, in the travel control system of the present embodiment, a vehicle information integration function for acquiring vehicle information of each vehicle in the vehicle 200_A is provided for a plurality or all of the vehicles, rather than one of the plurality of vehicles, so that the communication status or failure For example, the vehicle that activates the vehicle information accumulation function may be changed sequentially.
また、図1における各車両の各部の機能と、情報統合装置100の各部の機能、または図13における各車両の各部の機能と、情報統合装置100の各部の機能との各々を実現するためのプログラムをコンピュータ読み取り可能な記録媒体に記録して、この記録媒体に記録されたプログラムをコンピュータシステムに読み込ませ、実行することにより各車両の走行制御を行ってもよい。なお、ここでいう「コンピュータシステム」とは、OSや周辺機器等のハードウェアを含むものとする。
1 for realizing the functions of the respective parts of each vehicle in FIG. 1 and the functions of the respective parts of the
また、「コンピュータシステム」は、WWWシステムを利用している場合であれば、ホームページ提供環境(あるいは表示環境)も含むものとする。
また、「コンピュータ読み取り可能な記録媒体」とは、フレキシブルディスク、光磁気ディスク、ROM、CD−ROM等の可搬媒体、コンピュータシステムに内蔵されるハードディスク等の記憶装置のことをいう。さらに「コンピュータ読み取り可能な記録媒体」とは、インターネット等のネットワークや電話回線等の通信回線を介してプログラムを送信する場合の通信線のように、短時間の間、動的にプログラムを保持するもの、その場合のサーバやクライアントとなるコンピュータシステム内部の揮発性メモリのように、一定時間プログラムを保持しているものも含むものとする。また上記プログラムは、前述した機能の一部を実現するためのものであっても良く、さらに前述した機能をコンピュータシステムにすでに記録されているプログラムとの組み合わせで実現できるものであっても良い。
Further, the “computer system” includes a homepage providing environment (or display environment) if a WWW system is used.
The “computer-readable recording medium” refers to a storage device such as a flexible medium, a magneto-optical disk, a portable medium such as a ROM and a CD-ROM, and a hard disk incorporated in a computer system. Furthermore, the “computer-readable recording medium” dynamically holds a program for a short time like a communication line when transmitting a program via a network such as the Internet or a communication line such as a telephone line. In this case, a volatile memory in a computer system serving as a server or a client in that case, and a program that holds a program for a certain period of time are also included. The program may be a program for realizing a part of the functions described above, and may be a program capable of realizing the functions described above in combination with a program already recorded in a computer system.
以上、この発明の実施形態を図面を参照して詳述してきたが、具体的な構成はこの実施形態に限られるものではなく、この発明の要旨を逸脱しない範囲の設計等も含まれる。 The embodiment of the present invention has been described in detail with reference to the drawings. However, the specific configuration is not limited to this embodiment, and includes design and the like within a scope not departing from the gist of the present invention.
100…情報統合装置
101,101_A…要求エリア選択部
102,102_A…3D情報更新部
103,103_A…テクスチャデータ更新部
104…表示画像作成部
105,105_A…マップデータ記憶部
106…画像表示部
107,206…データ送受信部
108…画像記憶部
200_A,200_B,200_C…車両
201…走行情報取得部
202…走行情報合成部
203…走行情報差分抽出部
204…走行制御部
205…位置情報取得部
207…記憶部
208…自律制御部
209…切出部
210…抽出部
2011…撮像部
2012…物体検知部
DESCRIPTION OF
Claims (8)
前記車両の各々に設けられ、当該車両の走行位置に応じた周囲の走行環境を示す第1車両情報を取得する走行情報取得部と、
前記複数の車両に対して共通に用いる第2車両情報を記憶するマップデータ記憶部と、
前記第2車両情報における前記車両各々の走行方向の領域の車両情報である第3車両情報を、前記複数の車両の各々へ送信する要求エリア選択部と、
前記車両の各々に設けられ、前記第1車両情報と前記第3車両情報とを比較し、前記第1車両情報と前記第3車両情報との差分である差分車両情報を抽出する走行情報差分抽出部と、
前記差分車両情報を前記第2車両情報に追加し、当該第2車両情報を更新する情報更新部と
を備えることを特徴とする走行制御システム。 A traveling control system that performs traveling control of a plurality of vehicles.
A travel information acquisition unit that is provided in each of the vehicles and acquires first vehicle information indicating a surrounding travel environment according to the travel position of the vehicle;
A map data storage unit for storing the second car both information used in common for the plurality of vehicles,
A request area selection unit that transmits third vehicle information that is vehicle information of a region in the traveling direction of each of the vehicles in the second vehicle information to each of the plurality of vehicles;
A travel information difference extraction that is provided in each of the vehicles, compares the first vehicle information with the third vehicle information, and extracts differential vehicle information that is a difference between the first vehicle information and the third vehicle information. And
An information update unit that adds the difference vehicle information to the second vehicle information and updates the second vehicle information.
前記走行情報取得部が、前記立体物の位置及び高さを測定して前記3次元情報を生成し、前記立体物の画像を撮像して前記テクスチャ情報を生成することを特徴とする請求項1に記載の走行制御システム。 Each of the first vehicle information, the second vehicle information, and the third vehicle information is associated with three-dimensional information indicating the position and height of a three-dimensional object at each coordinate in a map traveled by the vehicle, and the three-dimensional information. And texture information indicating data information of the image of the three-dimensional object,
The travel information acquisition unit measures the position and height of the three-dimensional object to generate the three-dimensional information, captures an image of the three-dimensional object, and generates the texture information. The travel control system according to.
前記車両各々の進行方向にある3次元情報と、当該3次元情報の中から前記テクスチャ情報が無い3次元情報を示す要求テクスチャ情報とを前記マップデータ記憶部から抽出し、前記第3車両情報として前記車両に対して送信することを特徴とする請求項2に記載の走行制御システム。 The request area selection unit
The three-dimensional information in the traveling direction of each vehicle and the requested texture information indicating the three-dimensional information without the texture information from the three-dimensional information are extracted from the map data storage unit, and are used as the third vehicle information. The traveling control system according to claim 2, wherein the traveling control system transmits to the vehicle.
前記走行情報取得部が取得した前記第1車両情報における3次元情報及びテクスチャ情報と、前記第3車両情報における3次元情報及びテクスチャ情報とを比較し、前記第3車両情報に含まれていない前記第1車両情報における3次元情報及びテクスチャ情報を前記差分車両情報として抽出する
ことを特徴とする請求項2または請求項3に記載の走行制御システム。 The travel information difference extraction unit is
The three-dimensional information and texture information in the first vehicle information acquired by the travel information acquisition unit is compared with the three-dimensional information and texture information in the third vehicle information, and is not included in the third vehicle information. The three-dimensional information and texture information in 1st vehicle information are extracted as said difference vehicle information. The travel control system of Claim 2 or Claim 3 characterized by the above-mentioned.
前記車両が走行不能となる高さ閾値を超える前記座標を、前記立体物の3次元情報として抽出する
ことを特徴とする請求項2から請求項4のいずれか一項に記載の走行制御システム。 The travel information acquisition unit
The travel control system according to any one of claims 2 to 4, wherein the coordinates that exceed a height threshold at which the vehicle cannot travel are extracted as three-dimensional information of the three-dimensional object.
ことを特徴とする請求項1から請求項5のいずれか一項に記載の走行制御システム。 The said request | requirement area selection part, the said information update part, and the said map data memory | storage part are provided in the information integration apparatus which integrates and controls these several vehicles. Any one of Claims 1-5 characterized by the above-mentioned. The travel control system according to claim 1.
前記複数の車両を統合して制御する情報統合装置が、他の情報更新部及び他の前記マップデータ記憶部とを有し、
前記情報更新部が前記差分車両情報を前記情報統合装置に送信し、
前記他の情報更新部が、
前記他のマップデータ記憶部に記憶されている前記第2車両情報を前記差分車両情報により更新する
ことを特徴とする請求項1から請求項6のいずれか一項に記載の走行制御システム。 The request area selection unit, the information update unit, and the map data storage unit are provided in the vehicle,
The information integration device that integrates and controls the plurality of vehicles has another information update unit and another map data storage unit,
The information update unit transmits the difference vehicle information to the information integration device,
The other information update unit
The travel control system according to any one of claims 1 to 6 , wherein the second vehicle information stored in the other map data storage unit is updated with the difference vehicle information.
前記車両の各々に設けられた走行情報取得部が、当該車両の走行位置に応じた周囲の走行環境を示す第1車両情報を取得する走行情報取得過程と、
要求エリア選択部が、マップデータ記憶部に記憶されている前記複数の車両の共通に用いる第2車両情報における前記車両各々の走行方向の領域の車両情報である第3車両情報を、前記複数の車両の各々へ送信する要求エリア選択過程と、
前記車両の各々に設けられ、前記第1車両情報と前記第3車両情報とを比較し、前記第1車両情報と前記第3車両情報との差分である差分車両情報を抽出する走行情報差分抽出過程と、
前記差分車両情報を前記マップデータ記憶部の前記第2車両情報に追加し、当該第2車両情報を更新する情報更新過程と
を備えることを特徴とする走行制御方法。 A method of operating a traveling control system that performs traveling control of a plurality of vehicles,
A travel information acquisition process in which a travel information acquisition unit provided in each of the vehicles acquires first vehicle information indicating a surrounding travel environment according to the travel position of the vehicle;
The request area selection unit is configured to obtain third vehicle information that is vehicle information of a region in the traveling direction of each of the vehicles in second vehicle information that is commonly used for the plurality of vehicles stored in the map data storage unit. A request area selection process to be transmitted to each of the vehicles;
A travel information difference extraction that is provided in each of the vehicles, compares the first vehicle information with the third vehicle information, and extracts differential vehicle information that is a difference between the first vehicle information and the third vehicle information. Process ,
An information update process of adding the difference vehicle information to the second vehicle information in the map data storage unit and updating the second vehicle information.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2012012266A JP5762320B2 (en) | 2012-01-24 | 2012-01-24 | Travel control system and travel control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2012012266A JP5762320B2 (en) | 2012-01-24 | 2012-01-24 | Travel control system and travel control method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2013153280A JP2013153280A (en) | 2013-08-08 |
JP5762320B2 true JP5762320B2 (en) | 2015-08-12 |
Family
ID=49049316
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2012012266A Active JP5762320B2 (en) | 2012-01-24 | 2012-01-24 | Travel control system and travel control method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5762320B2 (en) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6665605B2 (en) * | 2016-03-15 | 2020-03-13 | 株式会社デンソー | Display control device and display control method |
JP7050683B2 (en) * | 2016-08-26 | 2022-04-08 | パナソニック インテレクチュアル プロパティ コーポレーション オブ アメリカ | 3D information processing method and 3D information processing equipment |
JP7395280B2 (en) | 2019-08-08 | 2023-12-11 | 三菱重工業株式会社 | Position calculation system, position calculation method, and automated guided vehicle |
US20210246636A1 (en) * | 2020-02-07 | 2021-08-12 | Caterpillar Inc. | System and Method of Autonomously Clearing a Windrow |
JP6949417B1 (en) * | 2020-05-18 | 2021-10-13 | 防衛装備庁長官 | Vehicle maneuvering system and vehicle maneuvering method |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4456667B2 (en) * | 2001-04-20 | 2010-04-28 | アルパイン株式会社 | Navigation device |
JP2004030132A (en) * | 2002-06-25 | 2004-01-29 | Mitsubishi Heavy Ind Ltd | Device and method for vehicle control, remote control device, vehicle control system and computer program |
US8139108B2 (en) * | 2007-01-31 | 2012-03-20 | Caterpillar Inc. | Simulation system implementing real-time machine data |
JP5473304B2 (en) * | 2008-12-02 | 2014-04-16 | 三菱電機株式会社 | Remote location image display device, remote control device, vehicle control device, remote control system, remote control method, remote control program, vehicle control program, remote location image display method, remote location image display program |
JP2011027594A (en) * | 2009-07-27 | 2011-02-10 | Toyota Infotechnology Center Co Ltd | Map data verification system |
-
2012
- 2012-01-24 JP JP2012012266A patent/JP5762320B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2013153280A (en) | 2013-08-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102338639B (en) | Information processing device and information processing method | |
JP7082545B2 (en) | Information processing methods, information processing equipment and programs | |
JP3798469B2 (en) | Navigation device | |
CN106461402B (en) | For determining the method and system of the position relative to numerical map | |
US10291898B2 (en) | Method and apparatus for updating navigation map | |
JP5762320B2 (en) | Travel control system and travel control method | |
JP2016057108A (en) | Arithmetic device, arithmetic system, arithmetic method and program | |
JP2022518911A (en) | Generate structured map data from vehicle sensors and camera arrays | |
JP6950832B2 (en) | Position coordinate estimation device, position coordinate estimation method and program | |
CN106959103A (en) | Measure subsystem and measuring system | |
JP2007080060A (en) | Object specification device | |
CN111936821A (en) | System and method for positioning | |
JP2010134499A (en) | Remote place image display device, remote control apparatus, vehicle control apparatus, remote control system, remote control method, remote control program, vehicle control program, remote place image display method, and remote place image display program | |
CN107547864A (en) | Surrounding's ken monitoring system and method for vehicle | |
JP2017090239A (en) | Information processing device, control method, program, and storage media | |
JP4348468B2 (en) | Image generation method | |
US20230138487A1 (en) | An Environment Model Using Cross-Sensor Feature Point Referencing | |
JP2019533875A (en) | Method and system for generating a composite top view image of a road | |
JP6773473B2 (en) | Survey information management device and survey information management method | |
JP2017120238A (en) | Navigation information providing system and navigation information providing device | |
CN110597275A (en) | Method and system for generating map by using unmanned aerial vehicle | |
CN112254653B (en) | Program control method for 3D information acquisition | |
JP7337617B2 (en) | Estimation device, estimation method and program | |
CN111044040A (en) | All-terrain multi-sensor data acquisition platform for unmanned equipment | |
JP2011149957A (en) | Image display device, image display method, and program |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20140715 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20150227 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20150401 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20150415 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20150416 |
|
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: 20150512 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20150609 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 5762320 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |