JP2023112670A - 制御システム、制御方法、及びコンピュータプログラム - Google Patents
制御システム、制御方法、及びコンピュータプログラム Download PDFInfo
- Publication number
- JP2023112670A JP2023112670A JP2023002447A JP2023002447A JP2023112670A JP 2023112670 A JP2023112670 A JP 2023112670A JP 2023002447 A JP2023002447 A JP 2023002447A JP 2023002447 A JP2023002447 A JP 2023002447A JP 2023112670 A JP2023112670 A JP 2023112670A
- Authority
- JP
- Japan
- Prior art keywords
- information
- space
- control system
- autonomous mobile
- mobile body
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims description 12
- 238000004590 computer program Methods 0.000 title claims description 9
- 238000001514 detection method Methods 0.000 description 61
- 238000006243 chemical reaction Methods 0.000 description 56
- 238000010586 diagram Methods 0.000 description 45
- 230000006870 function Effects 0.000 description 45
- 238000012545 processing Methods 0.000 description 23
- 238000007726 management method Methods 0.000 description 21
- 230000037230 mobility Effects 0.000 description 17
- 238000000605 extraction Methods 0.000 description 14
- 230000008859 change Effects 0.000 description 10
- 238000012790 confirmation Methods 0.000 description 8
- 238000003384 imaging method Methods 0.000 description 7
- 238000005259 measurement Methods 0.000 description 7
- 238000004891 communication Methods 0.000 description 5
- 239000000284 extract Substances 0.000 description 5
- 230000010365 information processing Effects 0.000 description 4
- 238000013507 mapping Methods 0.000 description 4
- 230000033228 biological regulation Effects 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 3
- 230000001276 controlling effect Effects 0.000 description 3
- 238000003825 pressing Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 230000007423 decrease Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000012876 topography Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000013523 data management Methods 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000003702 image correction Methods 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000010801 machine learning Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005192 partition Methods 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000002123 temporal effect Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 238000012384 transportation and delivery Methods 0.000 description 1
Images
Landscapes
- Instructional Devices (AREA)
- Navigation (AREA)
- Information Retrieval, Db Structures And Fs Structures Therefor (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
【課題】自己位置を安定的に検出可能な制御システムを提供する。【解決手段】制御システムにおいて、例えば緯度/経度/高さ等の所定の座標系によって定義される3次元の空間に固有識別子を付与し、前記空間に存在する物体の状態と時間に関する空間情報を前記固有識別子と関連付けてフォーマット化して保存するフォーマット化手段を有し、前記フォーマット化手段は、前記空間情報として、キーフレーム情報を登録可能であることを特徴とする。【選択図】 図15
Description
本発明は、3次元の空間に関する制御システム、制御方法、及びコンピュータプログラム等に関するものである。
近年、自律走行モビリティや空間認識システムなどの技術革新に伴い、異なる組織や社会の構成員の間でデータやシステムをつなぐ全体像(以下、デジタルアーキテクチャ)の開発が促進されている。
デジタルアーキテクチャを活用することで、自律走行モビリティや空間認識システムはより多くの情報を取得することができるようになるとともに、自己以外の外部デバイス及びシステムと連携してより大きな課題を解決することができる。これを実現するためには、現実世界の空間とデジタル情報を結び付ける技術が必要である。
特許文献1では、ユーザの提供する時空間管理データに従って単一のプロセッサが時空間領域を時間及び空間で分割して、複数の時空間分割領域を生成している。又、時空間分割領域の時間及び空間の近傍性を考慮して、複数の時空間分割領域の各々を一意に識別するための、一次元の整数値で表現される識別子を割り当てている。
そして、その識別子が近い時空間分割領域のデータが記憶装置上で近くに配置されるように、時系列データの配置を決定する時空間データ管理システムが開示されている。
しかしながら、上記特許文献1においては、生成された領域に関するデータを識別子で把握できるのはそれを生成したプロセッサ内でのみである。よって、異なるシステムのユーザがその空間分割領域の情報を活用することができない。また、システムユーザーが時空間分割領域の情報を使用するためには、自己位置を正確に検出する手段が必要であった。
そこで、本発明は、自己位置を安定的に検出可能な制御システムを提供することを目的の1つとする。
本発明に係る制御システムは、
所定の座標系によって定義される3次元の空間に固有識別子を付与し、前記空間に存在する物体の状態と時間に関する空間情報を前記固有識別子と関連付けてフォーマット化して保存するフォーマット化手段を有し、
前記フォーマット化手段は、前記空間情報として、キーフレーム情報を登録する。
所定の座標系によって定義される3次元の空間に固有識別子を付与し、前記空間に存在する物体の状態と時間に関する空間情報を前記固有識別子と関連付けてフォーマット化して保存するフォーマット化手段を有し、
前記フォーマット化手段は、前記空間情報として、キーフレーム情報を登録する。
本発明によれば、自己位置を安定的に検出可能な制御システムを提供することが出来る。
以下、図面を参照して本発明の実施形態を説明する。ただし、本発明は以下の実施形態に限定されるものではない。尚、各図において、同一の部材または要素については同一の参照番号を付し、重複する説明は省略または簡略化する。
尚、実施形態においては自律移動体の制御に適用した例について説明するが、移動体はユーザが移動体の移動に関して少なくとも一部を操作可能なものであっても良い。即ち、例えばユーザに対して移動経路等に関する各種表示等を行い、その表示を参照してユーザが移動体の運転操作の一部を行う構成であっても良い。
<実施形態1>
図1は本発明の実施形態1にかかる自律移動体制御システムの全体構成例を示す図である。図1に示すように、本実施形態の自律移動体制御システム(制御システムと略すこともある。)は、システム制御装置10、ユーザインターフェース11、自律移動体12、経路決定装置13、変換情報保持装置14、センサノード15等を備える。尚、ここで、ユーザインターフェース11はユーザ端末装置を意味する。
図1は本発明の実施形態1にかかる自律移動体制御システムの全体構成例を示す図である。図1に示すように、本実施形態の自律移動体制御システム(制御システムと略すこともある。)は、システム制御装置10、ユーザインターフェース11、自律移動体12、経路決定装置13、変換情報保持装置14、センサノード15等を備える。尚、ここで、ユーザインターフェース11はユーザ端末装置を意味する。
尚、本実施形態では、図1に示される各装置はインターネット16を介して、後述される夫々のネットワーク接続部によって接続されている。しかし、例えば、LAN(Local Area Network)等の他のネットワークシステムを用いてもかまわない。
又、システム制御装置10、ユーザインターフェース11、経路決定装置13、変換情報保持装置14等の一部は同一装置として構成しても構わない。
又、システム制御装置10、ユーザインターフェース11、経路決定装置13、変換情報保持装置14等の一部は同一装置として構成しても構わない。
システム制御装置10、ユーザインターフェース11、自律移動体12、経路決定装置13、変換情報保持装置14、センサノード15は夫々、コンピュータとしてのCPUや、記憶媒体としてのROM、RAM、HDD等からなる情報処理装置を含んでいる。各装置の機能及び内部構成の詳細については後に説明する。
次に、自律移動体制御システムによって提供されるサービスアプリケーションソフトウェア(以下、アプリと略す。)について説明する。尚、説明にあたっては、先ず、ユーザが位置情報を入力する際にユーザインターフェース11に表示される画面イメージを図2(A)、(B)を用いて説明する。
続いて、ユーザが自律移動体12の現在位置を閲覧する際のユーザインターフェース11に表示される画面イメージを図3(A)、図3(B)を用いて説明する。また、自律移動体制御システムにおいて、どのようにアプリに対してユーザの操作がなされるのかを例を用いて説明する。
尚、本説明において、便宜上、地図表示は二次元の平面で説明するが、本実施の形態において、ユーザは「高さ」も含めた3次元的な位置指定が可能であり、「高さ」情報を入力することもできる。即ち、本実施形態ではアプリは3次元地図を表示することができる。
図2(A)はユーザが位置情報を入力する際の入力画面の例を示す図、図2(B)は使用する自律移動体を選択するための選択画面の例を示す図である。ユーザがユーザインターフェース11の表示画面を操作して、インターネット16にアクセスし、自律移動体制御システムの例えば経路設定アプリを選択すると、システム制御装置10のWEBページが表示される。
WEBページに先ず表示されるのは、自律移動体12を移動させる際に、出発地、経由地、到着地を設定するための出発地、経由地、到着地の入力画面40である。入力画面40には使用する自律移動体(例えば、自動運転可能なモビリティ)の一覧を表示させるための一覧表示ボタン48がある。ユーザが一覧表示ボタン48を押下すると、図2(B)で示すようにモビリティの一覧表示画面47が表示される。
ユーザは先ず、一覧表示画面47において使用する自律移動体(例えば、自動運転可能なモビリティ)を選択する。一覧表示画面47においては例えばM1~M3のモビリティが選択可能に表示されているが、数はこれに限定されない。
ユーザがM1~M3のいずれかのモビリティをタッチ操作やクリック操作等によって選択すると、自動的に図2(A)の入力画面40に戻る。又、一覧表示ボタン48には、選択されたモビリティ名が表示される。その後ユーザは出発地として設定する場所を「出発地」の入力フィールド41に入力する。
又、ユーザは経由地として設定する場所を「経由地1」の入力フィールド42に入力する。尚、経由地は追加可能となっており、経由地の追加ボタン44を1回押下すると、「経由地2」の入力フィールド46が1つ追加表示され、追加する経由地を入力することができる。
経由地の追加ボタン44を押下する度に、「経由地3」、「経由地4」のように、入力フィールド46が押下に応じて追加表示され、追加する経由地を複数地点入力することができる。又、ユーザは到着地として設定する場所を「到着地」の入力フィールド43に入力する。尚、図には示していないが、入力フィールド41~43、46等をクリックすると、文字を入力するためのキーボード等が一時的に表示される。
そして、ユーザは決定ボタン45を押下することにより、自律移動体12の移動経路を設定することができる。図2の例では、出発地として”AAA”、経由地1として”BBB”、到着地として”CCC”と設定している。入力フィールドに入力する文言は、例えば住所等であってもよいし、緯度情報および経度情報(以下、緯度/経度情報とも記載する)や店名や電話番号などの、特定の位置を示すための位置情報を入力できるようにしてもよい。
図3(A)は自律移動体の現在位置を確認するための画面の例を示す図、図3(B)は自律移動体の現在位置を確認する際の地図表示画面の例を示す図である。
図3(A)の50は確認画面であり、図2(A)のような画面で自律移動体12の移動経路を設定した後に、不図示の操作ボタンの操作をユーザがすることによって表示される。
図3(A)の50は確認画面であり、図2(A)のような画面で自律移動体12の移動経路を設定した後に、不図示の操作ボタンの操作をユーザがすることによって表示される。
確認画面50では、自律移動体12の現在位置が例えば現在地56のように、ユーザインターフェース11のWEBページに表示される。従ってユーザは容易に現在位置を把握できる。
又、ユーザは更新ボタン57を押下することにより、画面表示情報を更新して最新状態を表示することができる。又、ユーザは経由地/到着地変更ボタン54を押下することにより、出発地、経由地、または到着地を変更することができる。即ち、ユーザは「出発地」の入力フィールド51、「経由地1」の入力フィールド52、「到着地」の入力フィールド53に夫々再設定したい場所を入力することで変更することができる。
図3(B)には、図3(A)の地図表示ボタン55を押下した場合に、確認画面50から切り替わる地図表示画面60の例が示されている。地図表示画面60では、現在地62の位置を地図上で表示することによって、自律移動体12の現在地をよりわかりやすく確認する。又、ユーザが戻るボタン61を押下した場合には、図3(A)の確認画面50に表示画面を戻すことができる。
以上のように、ユーザはユーザインターフェース11の操作により、自律移動体12を所定の場所から所定の場所まで移動するための移動経路を容易に設定できる。尚、このような経路設定アプリは、例えばタクシーの配車サービスや、ドローンの宅配サービスなどにも適用することができる。
次に図1における10~15の構成例と機能例に関して図4を用いて詳細に説明する。図4は、図1の10~15の内部構成例を示した機能ブロック図である。尚、図4に示される機能ブロックの一部は、各装置に含まれる不図示のコンピュータに、不図示の記憶媒体としてのメモリに記憶されたコンピュータプログラムを実行させることによって実現されている。しかし、それらの一部又は全部をハードウェアで実現するようにしても構わない。ハードウェアとしては、専用回路(ASIC)やプロセッサ(リコンフィギュラブルプロセッサ、DSP)などを用いることができる。
又、図4に示される夫々の機能ブロックは、同じ筐体に内蔵されていなくても良く、互いに信号路を介して接続された別々の装置により構成しても良い。
図4において、ユーザインターフェース11は操作部11-1、制御部11-2、表示部11-3、情報記憶部(メモリ/HDD)11-4、ネットワーク接続部11-5を備える。ユーザインターフェース11は、例えば、スマートフォン、タブレット端末、またはスマートウォッチ等の情報処理装置である。
操作部11-1は、タッチパネルやキーボタンなどで構成されており、データの入力のために用いられる。表示部11-3は例えば液晶画面などであり、経路情報やその他のデータを表示するために用いられる。
図2、図3において示したユーザインターフェース11の表示画面は表示部11-3に表示される。ユーザは表示部11-3に表示されたメニューを用いて、移動経路の選択、情報の入力、情報の確認等を行うことができる。つまり操作部11-1及び表示部11-3はユーザが実際に操作をするための操作用のインターフェースを提供している。尚、操作部11-1と表示部11-3を別々に設ける代わりに、タッチパネルによって操作部と表示部を兼用しても良い。
制御部11-2は、コンピュータとしてのCPUを内蔵し、ユーザインターフェース11における各種アプリの管理や、情報入力、情報確認などのモード管理を行い、通信処理を制御する。又、システム制御装置内の各部における処理を制御する。
情報記憶部(メモリ/HDD)11-4は、例えばCPUが実行するためのコンピュータプログラム等の、必要な情報を保有しておくための記録媒体である。ネットワーク接続部11-5は、インターネットやLAN、無線LANなどを介して行われる通信を制御する。
このように、本実施形態のユーザインターフェース11は、システム制御装置10のブラウザ画面に出発地、経由地、および到着地を入力画面40を表示する。また、ユーザによる出発地点、経由地点、到着地点といった位置情報の入力受付が可能である。ユーザインターフェース11は、ブラウザ画面に確認画面50及び地図表示画面60を表示することで、自律移動体12の現在位置を表示することができる。
図4における、経路決定装置13は、地図情報管理部13-1、制御部13-2、位置/経路情報管理部13-3、情報記憶部(メモリ/HDD)13-4、ネットワーク接続部13-5を備える。地図情報管理部13-1は、広域の地図情報を保有しており、指定された所定の位置情報に基づいて地図上のルートを示す経路情報を探索するとともに、探索結果の経路情報を位置/経路情報管理部13-3に送信する。
本実施形態では、地図情報は地形や緯度/経度/高度といった情報を含む3次元空間の地図情報である。また地図情報は、車道、歩道、進行方向、および交通規制といった道路交通法に関わる規制情報なども含む。
又、例えば地図情報は、時間帯によって一方通行となる場合や、時間帯によって歩行者専用道路となるものなど、時間によって変化する交通規制情報も、それぞれの時間情報とともに含む。制御部13-2は、コンピュータとしてのCPUを内蔵し、経路決定装置13内の各部における処理を制御する。
位置/経路情報管理部13-3は、ネットワーク接続部13-5を介して取得した自律移動体の位置情報を管理するとともに、地図情報管理部13-1に位置情報送信し、地図情報管理部13-1から取得した探索結果としての経路情報を管理する。制御部13-2は、外部システムの要求に従って、位置/経路情報管理部13-3で管理されている経路情報を所定のデータ形式に変換するとともに、外部システムに送信する。
以上のように、本実施形態においては、経路決定装置13は、指定された位置情報に基づいて道路交通法等に則した経路を探索し、経路情報を所定のデータ形式で出力できるように構成されている。
図4における、変換情報保持装置14は、位置/経路情報管理部14-1、固有識別子管理部14-2、制御部14-3、フォーマットデータベース14-4、情報記憶部(メモリ/HDD)14-5、ネットワーク接続部14-6を備える。
又、変換情報保持装置14は、緯度/経度/高さによって定義される3次元の空間に固有識別子を付与し、その空間に存在する物体の状態と時間に関する空間情報を上記固有識別子と関連付けてフォーマット化して保存するフォーマット化手段として機能できる。
位置/経路情報管理部14-1は、ネットワーク接続部14-6を通して取得した所定の位置情報を管理するとともに、制御部14-3の要求に従って位置情報を制御部14-3に送信する。制御部14-3は、コンピュータとしてのCPUを内蔵し、変換情報保持装置14内の各部における処理を制御する。
制御部14-3は、位置/経路情報管理部14-1から取得した位置情報と、フォーマットデータベース14-4で管理されているフォーマットの情報に基づいて、位置情報をフォーマットで規定された固有識別子に変換する。そして、固有識別子管理部14-2に送信する。
フォーマットについては後に詳しく説明するが、所定の位置を起点とした空間に識別子(以下、固有識別子)を割り振り、固有識別子によって空間を管理するものである。本実施形態においては、所定の位置情報を基に、対応する固有識別子や空間内の情報を取得することができる。
固有識別子管理部14-2は、制御部14-3にて変換した固有識別子を管理するとともにネットワーク接続部14-6を通じて送信する。フォーマットデータベース14-4は、フォーマットの情報を管理するとともに、制御部14-3の要求に従って、フォーマットの情報を制御部14-3に送信する。
又、ネットワーク接続部14-6を通じて取得した空間内の情報をフォーマットを用いて管理する。変換情報保持装置14は、外部の機器、装置、ネットワークにより取得された空間に関する情報を、固有識別子と紐づけて管理する。又、外部の機器、装置、ネットワークに対して固有識別子及びそれに紐づく空間に関する情報を提供する。
以上のように、変換情報保持装置14は、所定の位置情報を基に、固有識別子と空間内の情報を取得し、その情報を自身に接続された外部の機器、装置、ネットワークが共有できる状態に管理、提供する。又、変換情報保持装置14は、システム制御装置10に指定された位置情報を、固有識別子に変換し、システム制御装置10に提供する。
図4において、システム制御装置10は固有識別子管理部10-1、制御部10-2、位置/経路情報管理部10-3、情報記憶部(メモリ/HDD)10-4、ネットワーク接続部10-5を備える。位置/経路情報管理部10-3は、地形情報と緯度/経度情報の対応付けをした簡易的な地図情報を保持するとともに、ネットワーク接続部10-5を通して取得した所定の位置情報及び経路情報を管理する。
また位置/経路情報管理部10-3は、経路情報を所定の間隔で区切るとともに、区切った場所の緯度/経度といった位置情報を生成することもできる。固有識別子管理部10-1は、位置情報及び経路情報を固有識別子に変換した情報を管理する。
制御部10-2は、コンピュータとしてのCPUを有し、システム制御装置10の位置情報、経路情報、固有識別子の通信機能の制御を司り、システム制御装置10の各構成要素における処理を制御する。
又、制御部10-2は、ユーザインターフェース11にWEBページを提供するとともに、WEBページから取得した所定の位置情報を、経路決定装置13に送信する。又、経路決定装置13から所定の経路情報を取得し、経路情報の各位置情報を変換情報保持装置14に送信する。そして、変換情報保持装置14から取得した固有識別子に変換された経路情報を自律移動体12に送信する。
以上のように、システム制御装置10はユーザの指定する所定の位置情報の取得、位置情報及び経路情報の送受信、位置情報の生成、固有識別子を用いた経路情報の送受信を行えるように構成されている。
又、システム制御装置10は、ユーザインターフェース11に入力された位置情報に基づいて、自律移動体12が自律移動を行うのに必要な経路情報を収集するとともに、自律移動体12に固有識別子を用いた経路情報を提供する。尚、本実施形態では、システム制御装置10と経路決定装置13、変換情報保持装置14は例えばサーバーとして機能している。
図4において、自律移動体12は検出部12-1、制御部12-2、方向制御部12-3、情報記憶部(メモリ/HDD)12-4、ネットワーク接続部12-5、駆動部12-6を備える。検出部12-1は、例えば複数の撮像素子を有し、複数の撮像素子から得られた複数の撮像信号の位相差に基づき測距を行う機能を有する。
又、周辺の地形・建物の壁などの障害物といった検出情報(以下、検出情報)を取得し、検出情報と地図情報に基づき自己位置を推定する自己位置推定機能を有する。
又、検出部12-1は、GPS(Global Positioning System)などの自己位置検出機能と、例えば地磁気センサなどの方向検出機能を有する。更に、取得した検出情報と自己位置推定情報と方向検出情報を基に、制御部12-2はサイバー空間の3次元マップを生成することができる。
ここで、サイバー空間の3次元マップとは、現実世界の地物位置と等価な空間情報を、デジタルデータとして表現可能なものである。このサイバー空間の3次元マップ内には、現実世界に存在する自律移動体12や、その周辺の地物情報が、デジタルデータとして空間的に等価な情報として保持されている。従って、このデジタルデータを用いることで、効率的な移動が可能である。
以下図5を例として、本実施形態で用いるサイバー空間の3次元マップについて説明する。図5(A)は、現実世界における自律移動体12とその周辺の地物情報として存在する柱99の空間的位置関係を示した図、図5(B)は自律移動体12と柱99を、位置P0を原点とする任意のXYZ座標系空間にマッピングした状態を示した図である。
図5(A)、(B)において、自律移動体12の位置は、自律移動体12に搭載された不図示のGPS等によって取得された緯度経度の位置情報から、自律移動体12内の位置α0として特定される。又、自律移動体12の方位は不図示の電子コンパス等によって取得された方位αYと自律移動体12に移動方向12Yの差分によって特定される。
又、柱99の位置は、予め測定された位置情報から頂点99-1の位置として特定される。また自律移動体12の測距機能によって、自律移動体12のα0から頂点99-1までの距離を取得することが可能である。図5(A)においては移動方向12YをXYZ座標系の軸としてα0を原点とした場合に、頂点99-1の座標(Wx,Wy,Wz)として示される。
サイバー空間の3次元マップでは、この様に取得された情報がデジタルデータとして管理され、図5(B)のような空間情報としてシステム制御装置10、経路決定装置13等で再構成することが可能である。図5(B)においては、自律移動体12と柱99を、P0を原点とする任意のXYZ座標系空間にマッピングした状態を示している。
P0を現実世界の所定の緯度経度に設定し、現実世界の方位北をY軸方向に取ることで、この任意のXYZ座標系空間で自律移動体12を、P1と柱99をP2として表現することができる。
具体的には、α0の緯度経度とP0の緯度経度から、この空間におけるα0の位置P1を算出できる。又、同様に柱99をP2として算出できる。この例では、自律移動体12と柱99の2つをサイバー空間の3次元マップで表現しているが、勿論もっと多数あっても同様に扱うことが可能である。以上のように、3次元空間に現実世界の自己位置や物体をマッピングしたものが3次元マップである。
図4に戻り、自律移動体12は、機械学習を行った物体検出の学習結果データを、例えば情報記憶部(メモリ/HDD)12-4に記憶しており、機械学習を用いて撮影画像から物体検出することができる。尚、検出情報に関しては、ネットワーク接続部12-5を経由して、外部のシステムから取得して、3次元マップに反映することもできる。
尚、制御部12-2は、コンピュータとしてのCPUを有し、自律移動体12の移動、方向転換、自律走行機能の制御を司り、自律移動体12の各構成要素における処理を制御する。
方向制御部12-3は、駆動部12-6の駆動方向を変更することで、自律移動体12の移動方向の変更を行う。駆動部12-6は、モータなどの駆動装置からなり、自律移動体12の推進力を発生させる。自律移動体12は3次元マップ内に自己位置及び検出情報、物体検出情報を反映し、周辺の地形・建物・障害物・物体から一定の間隔を保った経路を生成し、自律走行を行うことができる。
尚、経路決定装置13は例えば道路交通法に関わる規制情報を考慮した経路生成を行う。一方、自律移動体12は経路決定装置13による経路において、周辺障害物の位置をより正確に検出し、自分のサイズに基づき、それらに接触せずに移動するための経路生成を行う。
又、自律移動体12の情報記憶部(メモリ/HDD)12-4には自律移動体自身のモビリティ形式を格納することも出来る。このモビリティ形式とは移動体の種別等であり、例えば自動車、自転車、ドローンなどの種別を意味する。このモビリティ形式に基づいて、後述するフォーマット経路情報の生成を行うことが出来る。
ここで本実施形態における自律移動体12の本体構成例について図6を用いて説明する。図6は実施形態1に係る自律移動体12のメカ的な構成例を示す斜視図である。尚、本実施形態においては、自律移動体12は、車輪を有する走行体の例を説明するがこの限りではなく、ドローンなどの飛行体であっても良い。
図6において、自律移動体12には検出部12-1、制御部12-2、方向制御部12-3、情報記憶部(メモリ/HDD)12-4、ネットワーク接続部12-5、駆動部12-6が搭載されており、各構成要素は互いに電気的に接続されている。駆動部12-6、方向制御部12-3は自律移動体12に少なくとも2つ以上配備されている。
方向制御部12-3は軸の回転駆動により駆動部12-6の方向を変更することで、自律移動体12の移動方向を変更し、駆動部12-6は、軸の回転により自律移動体12の前進、後退を行う。尚、図6を用いて説明した構成は1例であって、これに限定するものではなく、例えば移動方向の変更をオムニホイール等を用いて行っても良い。
尚、自律移動体12は例えばSLAM(Simultaneous Localization and Mapping)技術を用いた移動体である。又、検出部12-1等により検出した検出情報や、インターネット16を介して取得した外部システムの検出情報を基に、指定された所定の経路を自律移動できるように構成されている。
自律移動体12は細かく指定された地点をトレースするようなトレース移動も可能であるし、大まかに設定された地点を通過しながらその間の空間においては自身で経路情報を生成し、移動することも可能である。以上のように、本実施形態の自律移動体12は、システム制御装置10により提供された固有識別子を用いた経路情報に基づき自律移動を行うことができる。
図4に戻り、センサノード15は、例えばロードサイドカメラユニットのような映像監視システムなどの外部システムであり、検出部15-1、制御部15-2、情報記憶部(メモリ/HDD)15-3、ネットワーク接続部15-4を備える。検出部15-1は、例えばカメラ等で構成される撮影部であり、自身が検出可能なエリアの検出情報を取得するとともに、物体検出機能、測距機能を有する。
制御部15-2は、コンピュータとしてのCPUを内蔵し、センサノード15の検出、データ保管、データ送信機能の制御を司り、センサノード15内の各部における処理を制御する。又、検出部15-1で取得した検出情報を情報記憶部(メモリ/HDD)15-3に保管するとともに、ネットワーク接続部15-4を通じて変換情報保持装置14に送信する。
以上のように、センサノード15は、検出部15-1で検出した画像情報、検出した物体の特徴点情報、位置情報などの検出情報を情報記憶部15-3に保存及び通信できるように構成されている。又、センサノード15は、自身が検出可能なエリアの検出情報を、変換情報保持装置14に提供する。
次に、図4における各制御部の具体的なハードウェア構成に関して説明する。図7は、制御部10-2、制御部11-2、制御部12-2、制御部13-2、制御部14-3、制御部15-2の具体的なハードウェア構成例を示すブロック図である。尚、図7に示すハードウェア構成に限定されない。又、図7に示す各ブロックを全て備えている必要はない。
図7において、21は情報処理装置の演算・制御を司るコンピュータとしてのCPUである。RAM22は、CPU21の主メモリとして、及び実行プログラムの領域や該プログラムの実行エリアならびにデータエリアとして機能する記録媒体である。ROM23はCPU21の動作処理手順(プログラム)を記録している記録媒体である。
ROM23は情報処理装置の機器制御を行うシステムプログラムである基本ソフト(OS)を記録したプログラムROMと、システムを稼働するために必要な情報等が記録されているデータROMとを備える。尚、ROM23の代わりに、後述のHDD29を用いても良い。
ネットワークI/F24はネットワークインターフェース(NETIF)であり、インターネット16を介して情報処理装置間のデータ転送を行うための制御や接続状況の診断を行う。25はビデオRAM(VRAM)であり、LCD26の画面に表示させるための画像を展開し、その表示の制御を行う。LCD26はディスプレイ等の表示装置(以下、LCDと記す)である。
コントローラ27は外部入力装置28からの入力信号を制御するためのコントローラ(以下、KBCと記す)である。外部入力装置28は利用者が行う操作を受け付けるための外部入力装置(以下、KBと記す)であり、例えばキーボードやマウス等のポインティングデバイスが用いられる。
HDD29はハードディスクドライブ(以下、HDDと記す)であり、アプリケーションプログラムや各種データ保存用に用いられる。本実施形態におけるアプリケーションプログラムとは、本実施形態における各種処理機能を実行するソフトウェアプログラム等である。
CDD30は外部入出力装置(以下、CDDと記す)である。例えばCDROMドライブ、DVDドライブ、Blu-Ray(登録商標)ディスクドライブ等の、取り外し可能なデータ記録媒体としてのリムーバブル・メディア31とデータを入出力するためのものである。
CDD30は、上述したアプリケーションプログラムをリムーバブル・メディアから読み出す場合等に用いられる。31はCDD30によって読み出しされる、例えば、CDROMディスク、DVD、Blu―Rayディスク等のリムーバブル・メディアである。
尚、リムーバブル・メディアは、光磁気記録媒体(例えば、MO)、半導体記録媒体(例えば、メモリカード)等であっても良い。尚、HDD29に格納するアプリケーションプログラムやデータをリムーバブル・メディア31に格納して利用することも可能である。20は上述した各ユニット間を接続するための伝送バス(アドレスバス、データバス、入出力バス、及び制御バス)である。
次に、図2、図3で説明したアプリを実現するための自律移動体制御システムにおける制御動作の詳細について図8~図10を用いて説明する。図8は実施形態1に係る自律移動体制御システムが実行する処理を説明するシーケンス図であり、図9は、図8の続きのシーケンス図であり、図10は、図9の続きのシーケンス図である。
図8~図10は、ユーザがユーザインターフェース11に位置情報を入力してから自律移動体12の現在位置情報を受け取るまでの、各装置が実行する処理を示している。尚、10~15の制御部内のコンピュータがメモリに記憶されたコンピュータプログラムを実行することによって図8~図10のシーケンスの各ステップの動作が行われる。
先ず、ステップS201において、ユーザが、ユーザインターフェース11を用いて、システム制御装置10が提供するWEBページにアクセスする。ステップS202において、システム制御装置10はWEBページの表示画面に図2で説明したような位置入力画面を表示させる。ステップS203において、図2で説明したように、ユーザは自律移動体(モビリティ)を選択し、出発地点、経由地、および到着地点を示す位置情報(以下、位置情報)を入力する。
位置情報は、例えば建物名や駅名や住所など、特定の場所を指定するワード(以下、位置ワード)でもよいし、WEBページに表示された地図の特定の位置をポイント(以下、ポイント)として指定する手法でもよい。
ステップS204において、システム制御装置10は選択された自律移動体12の移動体の種別情報と、入力された位置情報などの入力情報とを保存する。この時、システム制御装置10は位置情報が位置ワードの場合は、位置ワードを保存する。また、位置情報がポイントの場合は、システム制御装置10は、位置/経路情報管理部10-3に保存してある簡易的な地図情報を基に、ポイントに該当する緯度および経度を探索し、緯度および経度を保存する。
次に、ステップS205において、システム制御装置10はユーザによって指定された自律移動体12のモビリティ形式(移動体の種別)から、移動できる経路の種別(以下、経路種別)を指定する。そして、ステップS206において、位置情報とともに経路決定装置13に送信する。
前述のように、モビリティ形式とは、例えば、法的に区別された移動体の種別等であり、例えば自動車、自転車、ドローンなどの種別等である。又、経路種別は、例えば、一般道、高速道路、自動車専用道路、所定の歩道、一般道の路側帯および自転車専用レーンである。例えばモビリティ形式が自動車である場合、経路種別は一般道や高速道路、自動車専用道路等が指定される。また、モビリティ形式が自転車である場合、所定の歩道、一般道の路側帯、自転車専用レーンなどが指定される。
ステップS207において、経路決定装置13は、受信した位置情報を、所有する地図情報に出発地点、経由地、および到着地点として入力する。位置情報が位置ワードの場合は、位置ワードにより地図情報で探索(事前探索)し、該当する緯度/経度情報を入力する。位置情報が緯度/経度情報の場合はそのまま地図情報に入力して使用する。更に経路決定装置13は経路を事前に探索してもよい。
続いて、ステップS208で、経路決定装置13は出発地点から経由地点を経由して到着地点までの経路を探索する。この時、探索する経路は経路種別に則った経路を検索する。なお、ステップS208において経路を事前探索していた場合は、経路種別に基づいて事前に探索した経路を適宜変更する。
そして、ステップS209で、経路決定装置13は探索の結果として、出発地点から経由地点を経由して到着地点までの経路(以下、経路情報)をGPX形式(GPS eXchange Format)で出力し、システム制御装置10に送信する。
GPX形式のファイルは、ウェイポイント(順序関係を持たない地点情報)、ルート(時間情報を付加した順序関係を持つ地点情報)、トラック(複数の地点情報の集合体:軌跡)の3種類で主に構成されている。
更に、各地点情報の属性値として緯度/経度、子要素として標高やジオイド高、GPS受信状況・精度などが記載される。GPXファイルに必要な最小要素は、単一ポイントの緯度/経度情報で、それ以外の情報の記述は任意である。経路情報として出力するのはルートであり、順序関係を持つ緯度/経度からなる地点情報の集合体である。尚、経路情報は上記を満足できれば他の形式であっても良い。
ここで、変換情報保持装置14のフォーマットデータベース14-4で管理しているフォーマットの構成例に関して図11(A)、図11(B)、図12を参照して詳しく説明する。
図11(A)は地球の緯度/経度情報を示す図であり、図11(B)は図11(A)の所定の空間100を示す斜視図である。又、図11(B)において所定の空間100の中心を中心101とする。図12は空間100内の空間情報を模式的に示した図である。
図11(A)、図11(B)において、フォーマットは、地球の3次元空間を、緯度/経度/高さを起点とした範囲によって決定される所定の単位体積ごとの空間に分割し、夫々の空間に固有識別子を付加して管理可能とするものである。例えばここでは所定の3次元の空間として空間100を表示する。
空間100は、中心101が北緯20度、東経140度、高さ(高度、標高)Hにより規定され、緯度方向の幅をD、経度方向の幅をW、高さ方向の幅をTと規定された分割空間である。又、地球の空間を緯度/経度/高さを起点とした範囲によって決定される空間に分割した1つの空間である。
図11(A)においては便宜上、空間100のみを表示しているが、フォーマットの規定においては前述のとおり空間100と同じように規定された空間が緯度/経度/高さ方向に並んで配置されているものとする。そして配置された各分割空間は夫々緯度/経度によって水平位置を定義されているとともに、高さ方向にも重なりを持ち、高さによって高さ方向の位置を定義されているものとする。
尚、図11(B)において緯度/経度/高さの起点として、分割空間の中心101を設定しているが、これに限定するものではなく、例えば空間の角部や、底面の中心を起点としても良い。又、形状も略直方体であればよく、地球のような球体表面上に敷き詰める場合を考えた時は、直方体の底面よりも天面のほうをわずかに広く設定したほうが、より隙間なく配置できる。
図12において空間100を例にすると、フォーマットデータベース14-4には空間100の範囲に存在又は進入可能な物体の種別と時間制限に関する情報(空間情報)が夫々固有識別子と関連付けて(紐づけて)フォーマット化されて保存されている。又、フォーマット化された空間情報は、過去から未来といった時系列に保管されている。尚、本実施形態においては、関連付けると紐づけるとは同じ意味で用いる。
即ち、変換情報保持装置14は、緯度/経度/高さによって定義される3次元の空間に存在又は進入可能な物体の種別と時間制限に関する空間情報を固有識別子と関連付けてフォーマット化しフォーマットデータベース14-4に保存している。
空間情報は、変換情報保持装置14に通信可能に接続された外部システム(例えばセンサノード15)などの情報供給手段により供給された情報に基づき所定の更新間隔で更新される。そして、変換情報保持装置14に通信可能に接続された他の外部システムに情報共有される。尚、時間に関する情報を必要としない用途においては、時間に関する情報を含まない空間情報を使用することも可能である。又、固有識別子の代わりに、固有でない識別子を用いても良い。
また、外部システムを有する事業者/個人の情報、外部システムが取得した検出情報へのアクセス方法の情報、検出情報のメタデータ/通信形式などの検出情報の仕様情報も空間情報として、固有識別子と関連付けて管理することができる。
以上のように、実施形態1では、緯度/経度/高さによって定義される3次元の空間に存在又は進入可能な物体の種別と時間制限に関する情報(以下、空間情報)を固有識別子と関連付けてフォーマット化してデータベースに保存している。そしてフォーマット化された空間情報によって時空間を管理可能としている。
なお、本実施形態においては空間(ボクセル)の位置を規定する座標系として緯度/経度/高さを用いて説明していく。しかし、座標系はこれに限定されたものではなく、例えば任意の座標軸を有するXYZ座標系や、水平方向の座標としてMGRS(Military Grid Reference System)を用いるなど、様々な座標系を用いることができる。その他、画像の画素位置を座標として利用するピクセル座標系や、所定の領域をタイルという単位で分割し、X/Y方向に並べて表現するタイル座標系を用いることもできる。
又、実施形態1の変換情報保持装置14は、空間情報の更新間隔に関する情報も固有識別子と関連付けてフォーマット化し保存するフォーマット化ステップを実行している。尚、固有識別子と関連付けてフォーマット化する更新間隔に関する情報は更新頻度であっても良く、更新間隔に関する情報は更新頻度を含む。
図8に戻り、自律移動体制御システムが実行する処理の続きを説明する。ステップS210において、システム制御装置10は、受信した経路情報内の各地点情報間の間隔を確認する。そして、地点情報の間隔とフォーマットで規定する分割空間の起点位置同士の間隔とを整合したものを位置点群データとして作成する。
この時、地点情報の間隔が分割空間の起点位置同士の間隔より小さい場合、システム制御装置10は分割空間の起点位置間隔に合わせて経路情報内の地点情報を間引いたものを位置点群データとする。又、地点情報の間隔が分割空間の起点位置同士の間隔より大きい場合、システム制御装置10は経路情報から逸脱しない範囲で地点情報を補間して位置点群データとする。
次に、図9のステップS211に示すように、システム制御装置10は、位置点群データの各地点情報の緯度/経度情報を、変換情報保持装置14に、経路の順番に送信する。又、ステップS212において、変換情報保持装置14は受信した緯度/経度情報に該当する固有識別子をフォーマットデータベース14-4から探索し、ステップS213において、システム制御装置10に送信する。
ステップS214において、システム制御装置10は受信した固有識別子を元の位置点群データと同じ順に並べ、固有識別子を用いた経路情報(以下、フォーマット経路情報)として保管する。このように、ステップS214においては、経路生成手段としてのシステム制御装置10は、変換情報保持装置14のデータベースから空間情報を取得し、取得した空間情報と、移動体の種別情報に基づき移動体の移動経路に関する経路情報を生成している。
ここで、経路情報から位置点群データを生成し、固有識別子を用いた経路情報に変換する過程を、図13(A)、図13(B)、図13(C)を参照して詳細に説明する。図13(A)は経路情報を地図情報で表示したイメージ図、図13(B)は位置点群データを用いた経路情報を地図情報で表示したイメージ図、図13(C)は固有識別子を用いた経路情報を地図情報で表示したイメージ図である。
図13(A)において、120は経路情報、121は自律移動体12が通過できない移動不可領域、122は自律移動体12が移動可能な移動可能領域である。ユーザが指定した出発地点、経由地点、到着地点の位置情報をもとに、経路決定装置13により生成された経路情報120は、出発地点、経由地点、到着地点を通過し、かつ地図情報上で移動可能領域122上を通る経路として生成されている。
図13(B)において、123は経路情報上の複数の位置情報である。経路情報120を取得したシステム制御装置10は、経路情報120上に、所定の間隔で配置した位置情報123を生成する。
位置情報123は夫々緯度/経度/高さで表すことができ、これら位置情報123を実施形態1では位置点群データと呼ぶ。そして、システム制御装置10はこれら位置情報123(各点の緯度/経度/高さ)を1つずつ変換情報保持装置14に送信し、固有識別子に変換する。
図13(C)において、124は位置情報123を1つずつ固有識別子に変換し、固有識別子が規定する空間範囲を四角い枠で表現した位置空間情報である。位置情報を固有識別子に変換することで、位置空間情報124が得られる。これにより、経路情報120が表現していた経路を、連続した位置空間情報124に変換して表現する。
尚、各位置空間情報124には、空間の範囲に存在又は進入可能な物体の種別と時間制限に関する情報が紐づけられている。この連続した位置空間情報124を実施形態1ではフォーマット経路情報と呼ぶ。
図9に戻り、自律移動体制御システムが実行する処理の続きを説明する。ステップS214の次に、ステップS215において、システム制御装置10はフォーマット経路情報の各固有識別子に紐づけられた空間情報を変換情報保持装置14からダウンロードする。
そしてステップS216で、システム制御装置10は、空間情報を、自律移動体12のサイバー空間の3次元マップに反映できる形式に変換して、所定空間内の複数物体(障害物)の位置を示す情報(以下、コストマップ)を作成する。コストマップは、フォーマット経路情報のすべての経路の空間に関して初めに作成しても良いし、一定領域で区切った形で作成し、順次更新していく方法で作成しても良い。
次に、ステップS217において、システム制御装置10は、フォーマット経路情報とコストマップを、自律移動体12に割り当てられた固有識別番号(固有識別子)に紐づけて保管する。
自律移動体12は所定時間間隔で、自己の固有識別番号をネットワークを介して監視(以下、ポーリング)しており、ステップS218において、紐づけられたコストマップをダウンロードする。自律移動体12はステップS219において、フォーマット経路情報の各固有識別子の緯度/経度情報を、自己が作成したサイバー空間の3次元マップに対して経路情報として反映させる。
次に、ステップS220において、自律移動体12はコストマップをルート上の障害物情報としてサイバー空間の3次元マップに反映する。コストマップが一定間隔で区切った形で作成されている場合は、コストマップが作成された領域を移動した後に、次の領域のコストマップをダウンロードし、コストマップを更新する。
ステップS221において、自律移動体12は、経路情報に沿ってコストマップで入力された物体(障害物)を回避しながら移動する。即ち、コストマップに基づき移動制御を行う。
この時、ステップS222において、自律移動体12は物体検出を行いながら移動し、コストマップとの差異があれば物体検出情報を用いてコストマップを更新しつつ移動する。又、ステップS223において、自律移動体12はコストマップとの差異情報を、対応する固有識別子とともにシステム制御装置10に送信する。
固有識別子と、コストマップとの差異情報を取得したシステム制御装置10は、図10のステップS224において、変換情報保持装置14に空間情報を送信し、ステップS225で、変換情報保持装置14は該当する固有識別子の空間情報を更新する。
ここで更新する空間情報の内容は、コストマップとの差異情報をそのまま反映するわけではなく、システム制御装置10にて抽象化されてから変換情報保持装置14に送信される。抽象化の詳細な内容に関しては後述する。
フォーマット経路情報に基づき移動している自律移動体12は、ステップS226において、各固有識別子に紐づけられた分割空間を通過するごとにシステム制御装置10に対して現在自身が通過している空間に紐づけられた固有識別子を送信する。
もしくはポーリング時に、自身の固有識別番号に紐づけても良い。システム制御装置10は、自律移動体12から受け取る、空間の固有識別子情報を基に、フォーマット経路情報上の自律移動体12の現在位置を把握する。
ステップS226を繰り返すことで、システム制御装置10はフォーマット経路情報の中で、自律移動体12が現在どこにいるのかを把握することができる。尚、自律移動体12が通過した空間の固有識別子に関して、システム制御装置10は保持することをやめてもよく、それによりフォーマット経路情報の保持データ容量を削減することもできる。
ステップS227において、システム制御装置10は把握した自律移動体12の現在位置情報を基に、図2及び図3で説明した確認画面50及び地図表示画面60を作成し、WEBページの表示画面に表示する。自律移動体12により、現在位置を示す固有識別子がシステム制御装置10に送信されるたびに、システム制御装置10は確認画面50及び地図表示画面60を更新する。
一方、図8のステップS228において、センサノード15は検出範囲の検出情報を保存するとともに、ステップS229において検出情報を抽象化して、ステップS230において空間情報として変換情報保持装置14に送信する。抽象化とは、例えば物体が存在しているか否か、物体の存在状態に変化があったか否かといった情報であり、物体に関する詳細情報ではない。
物体に関する詳細情報はセンサノード内のメモリに保管される。そして、ステップS231において、変換情報保持装置14は、抽象化された検出情報である空間情報を、空間情報に対応する位置の固有識別子に紐づけて保管する。これにより、フォーマットデータベース内の1つの固有識別子に空間情報が格納されることになる。
又、センサノード15とは異なる外部システムが空間情報を活用する場合、外部システムは変換情報保持装置14内の空間情報を基に、変換情報保持装置14を経由してセンサノード15内の検出情報を取得して活用する。この時、変換情報保持装置14は外部システムとセンサノード15の通信規格をつなぐ機能も有する。
上記のような空間情報の格納をセンサノード15に限らず複数デバイス間で行うことで、変換情報保持装置14は比較的軽量なデータ量にて複数のデバイスのデータをつなぐ機能を有する。尚、図9のステップS215、S216においてシステム制御装置10がコストマップを作成の際に詳細な物体情報を必要とする場合は、空間情報の詳細な検出情報を保管している外部システムから詳細情報をダウンロードして使用すれば良い。
ここで、自律移動体12のフォーマット経路情報の経路上において、センサノード15が空間情報を更新したとする。この時、図10のステップS232でセンサノード15は検出情報を取得し、ステップS233で抽象化された空間情報を生成して、ステップS234で変換情報保持装置14に送信する。変換情報保持装置14は、ステップS235で空間情報をフォーマットデータベース14-4に格納する。
システム制御装置10は、管理するフォーマット経路情報における空間情報の変化を所定の時間間隔で確認しており、変化があればステップS236で空間情報をダウンロードする。そして、ステップS237で自律移動体12に割り当てられた固有識別番号に紐づけられたコストマップを更新する。
自律移動体12はステップS238において、ポーリングにてコストマップの更新を認識し、自己が作成したサイバー空間の3次元マップに反映する。
以上のように、複数デバイスで共有された空間情報を活用することで、自律移動体12は自己が認識できないルート上の変化を事前に認識でき、その変化に対応することができる。
上記一連のシステムを遂行し、ステップS239で自律移動体12が到着地点に到着した場合には、ステップS240で固有識別子を送信する。
上記一連のシステムを遂行し、ステップS239で自律移動体12が到着地点に到着した場合には、ステップS240で固有識別子を送信する。
これにより固有識別子を認識したシステム制御装置10は、ステップS241で、到着表示をユーザインターフェース11に表示し、アプリを終了する。
実施形態1によれば、以上のようにしてデジタルアーキテクチャのフォーマット及びそれを用いた自律移動体制御システムを提供することができる。
実施形態1によれば、以上のようにしてデジタルアーキテクチャのフォーマット及びそれを用いた自律移動体制御システムを提供することができる。
図11(A)、(B)、図12で説明したように、フォーマットデータベース14-4には空間100の範囲に存在又は進入可能な物体の種別と時間制限に関する情報(空間情報)が過去から未来といった時系列に保管されている。又、空間情報は、変換情報保持装置14に通信可能に接続された外部センサなどから入力された情報に基づき更新され、変換情報保持装置14に接続可能な他の外部システムに情報共有されている。
これらの空間情報の1つとして、空間内の物体の種別情報がある。ここでの空間内の物体の種別情報は例えば道路における車道、歩道、自転車専用道路等、地図情報より取得可能な情報である。また他には車道におけるモビリティの進行方向や交通規制等の情報も同様に種別情報と定義することが出来る。更に後述するように空間自体に種別情報を定義することも出来る。
以上、図4を用いて、変換情報保持装置14と自律移動体12の制御を行うシステム制御装置10等の連携動作の説明を行った。しかし、変換情報保持装置14はシステム制御装置10以外にも、道路の情報を管理するシステム制御装置や、道路以外の区画の情報を管理するシステム制御装置と接続することができる。
即ち、前述のように、システム制御装置10は図13(B)の位置情報123を総称した位置点群データを変換情報保持装置14に送信できる。それと同様に、道路の情報を管理するシステム制御装置や、道路以外の区画の情報を管理するシステム制御装置もそれに相当するデータを変換情報保持装置14に送信できる。
それに相当するデータとは、道路の情報を管理するシステム制御装置や、道路以外である区画の情報を管理するシステム制御装置が管理する位置点群データの情報である。尚、位置点群データの各々の点を位置点と以降呼ぶこととする。
送信した後は、フォーマットデータベース14-4の固有識別子に紐づけて格納し、適宜その情報を更新することで、現在の現実世界の情報を正確に変換情報保持装置14に反映し、自律移動体12の移動に支障がないようにする。
尚、実施形態1では、空間情報の更新間隔は、その空間に存在する物体の種類に応じて異なる。即ち、その空間に存在する物体の種類が移動体の場合には、その空間に存在する物体の種類が移動体でない場合よりも短くなるようにする。又、空間に存在する物体の種類が道路の場合には、空間に存在する物体の種類が区画の場合よりも短くなるようにする。
又、空間に複数の物体が存在する場合には、夫々の物体に関する空間情報の更新間隔は、夫々の物体の種類(例えば移動体、道路、区画等)に応じて夫々異なるようにする。そして、空間に存在する複数の物体の夫々の状態と時間に関する空間情報を固有識別子と関連付けてフォーマット化して保存するように構成している。従って、空間情報の更新のための負荷を低減することができる。
なお、本実施形態における説明では位置点群データから後述するフォーマット経路情報を作成する際にフォーマット経路情報を構成する固有識別子によって特定される空間(=ボクセル)が隙間なく数珠繋ぎとなるように、位置点群データの間引き/補間を行っている。
しかしこれに限定されるものではなく、少なくとも位置点群データを構成する地点情報の間隔は、分割空間の起点(=基準点)位置同士の間隔以上あり、分割空間同士が被らないようにして移動経路を設定できる。
位置点群データ同士の間隔が詰まっているほど、より詳細に移動経路を指定することが可能となるが、その反面、移動経路全体のデータ量は増大する。また、位置点群データ同士の間隔が大きければ、移動経路の詳細な指定はできないが移動経路全体のデータ量は抑えることができる。
つまり、自律移動体12への移動経路の指示粒度や、扱えるデータ量などの条件に合わせて、位置点群データ同士の間隔を適切に調整することができる。また、部分的に位置点群データ同士の間隔を変更し、より最適な経路設定とすることも可能である。
<実施形態2>
実施形態2では、実施形態1の構成に加えて、自律移動体が自己位置検出機能によって正確な自己位置が検出できない場合に、フォーマットデータベースに格納された情報を基に自己位置を検出し移動するように構成されている。
実施形態2では、実施形態1の構成に加えて、自律移動体が自己位置検出機能によって正確な自己位置が検出できない場合に、フォーマットデータベースに格納された情報を基に自己位置を検出し移動するように構成されている。
図10のステップS226で、システム制御装置10が、自律移動体12から受け取る固有識別子情報を基に、フォーマット経路情報上の自律移動体12の現在位置を把握する動作について述べた。ここで自律移動体12が、各固有識別子が紐づく分割空間を通過したかどうかの判定は、検出部12-1内のGPSなどの自己位置検出機能によって行われる。
そのためGPS電波が受信しにくい地点、例えば地下やトンネル内を移動する際にはその精度が低下する場合がある。またGPSなどの自己位置検出機能を有していない自律移動体は、システム制御装置に対して、フォーマット経路情報の中で現在どこにいるのかを伝えることができず、実施形態1における自律移動体制御システムを活用できない場合があった。
そこで、本実施形態では、フォーマット化手段としての変換情報保持装置14は、その空間を特徴づける情報(以降、キーフレーム情報と記す)を、その情報が該当する位置の固有識別子に関連付けて(紐づけて)登録(保存または記録)する。キーフレーム情報は、詳細は後述するが、例えば、関連付けられた空間の周辺に同一の物体が存在しない物体を示す情報である。
キーフレーム情報を用いることで、自律移動体12は自身の位置を推定できる。実施形態1の図4で説明したように、自律移動体12は、機械学習などを用いて撮影画像から物体検出できる。従って、この物体検出機能によってキーフレーム情報に含まれる物体を検出することで、その検出地点をキーフレーム情報が紐づけられた固有識別子に該当する位置であると、推定(特定)することが可能である。
このように撮像画像等を用いることによりキーフレーム情報に含まれる物体を検出し、そのキーフレーム情報が紐づけられた固有識別子に該当する位置を特定する動作を、本実施形態では「キーフレーム情報を照合する」と記載する。
自律移動体12は、「キーフレーム情報を照合する」ことで、たとえ、GPS電波が受信しにくい地点であったり、自律移動体が自己位置検出機能を有していなくても、自己位置を特定することができる。自己位置は、自律移動体12が特定した、キーフレーム情報が紐づけられた固有識別子に該当する位置である。従って、自律移動体12は、その位置情報を自律移動体を制御するシステム制御装置に対して伝えることが可能となる。
本実施形態では、キーフレーム情報は空間情報の1つである。例えば、実施形態1で説明したように、フォーマットデータベース14-4には空間100の範囲に存在する物体の状態と時間に関する情報(空間情報)が過去から未来といった時系列に保管されている。
又、空間情報は、変換情報保持装置14に通信可能に接続された外部システムなどにより入力された情報により更新され、変換情報保持装置14に可能に接続された他の外部システムに情報共有される。これらの空間情報の1つとして、変換情報保持装置14は、空間内の物体のキーフレーム情報を記録する。
次に、フォーマットデータベース14-4へのキーフレーム情報の格納手順について、図14のブロック図と図15のシーケンス図を用いて説明する。図14は、実施形態2に係るキーフレーム情報の格納処理に関わる機能ブロック図であり、地図情報抽出システム901、センサノード15、自律移動体612、変換情報保持装置14の内部構成を機能ブロックとして示している。
図14において自律移動体612は、検出部612-1、制御部612-2、方向制御部612-3、情報記憶部(メモリ/HDD)612-4、ネットワーク接続部612-5、駆動部612-6から構成されている。612-1~612-6は図4で説明した自律移動体12の構成である12-1~12-6と同様な構成なので詳細な説明を省略する。尚、自律移動体612は、図5で説明した自律移動体12と同様に物体検出機能や測距機能を有している。
又、図14において、地図情報抽出システム901は、地図情報管理部901-1、制御部901-2、情報抽出部901-3、情報記憶部(メモリ/HDD)901-4、ネットワーク接続部901-5を備える。
地図情報管理部901-1は、地球上の3次元空間の地図情報を保有している。情報抽出部901-3は、地図情報管理部901-1が保有する地図情報の中から位置情報や地名や施設名など設定された条件に基づき情報を抽出する機能を有する。
制御部901-2は、地図情報抽出システム901における地図情報抽出の制御を司り、情報抽出部901-3が抽出する際の条件を設定する。そして、例えばキーフレーム情報としての要件を満たすような条件で抽出した情報を情報記憶部(メモリ/HDD)901-4で保管するとともにネットワーク接続部901-5を通じて変換情報保持装置14に送信する機能の制御を行う。図14における変換情報保持装置14とセンサノード15は図4で説明した構成と同様なため説明を省略する。
図14のような構成により、実施形態2においては、地図情報抽出システム901は地図情報の中からキーフレーム情報としての要件を満たす物体の情報を抽出し、変換情報保持装置14に提供(出力)する。
図15は、実施形態2に係るキーフレーム情報の格納処理を説明するシーケンス図であり、キーフレーム情報の格納に関わる、地図情報抽出システム901、センサノード15、自律移動体612、変換情報保持装置14が実行する処理を示している。尚、14,15、612,901の制御部内のコンピュータがメモリに記憶されたコンピュータプログラムを実行することによって図15のシーケンスの各ステップの動作が行われる。
先ず、変換情報保持装置14に通信可能に接続された外部システムの例として地図情報抽出システム901が地図情報からキーフレーム情報を抽出し、フォーマットデータベース14-4へ格納する方法について図15を用いて説明する。
ステップS401において、地図情報抽出システム901は、キーフレーム情報の要件を満たす物体の情報を、所有する地図情報の所定の範囲より抽出する。ここで抽出されるキーフレーム情報の要件を満たす物体の情報は、周辺に同一のものが存在しない物体を示す情報である。キーフレーム情報は、詳細については後述するが、例えば「XX交差点」や「YY郵便局」などの固有名詞が記載された案内標識(道路標識)等の標識、および看板などである。
その後、ステップS402において、地図情報抽出システム901は、抽出したキーフレーム情報を、その物体の位置情報と関連付けて(紐づけて)情報記憶部(メモリ/HDD)901-4に記憶(保存)する。
更に、ステップS403において、地図情報抽出システム901は、紐づけたキーフレーム情報と位置情報を変換情報保持装置14に送信する。
変換情報保持装置14は、ステップS404において、送信された位置情報に対応する固有識別子を判別し、その固有識別子に対応するキーフレーム情報をフォーマットデータベース14-4に保管する。このようにして、地図情報より固有識別子に対応するキーフレーム情報をフォーマットデータベース14-4に登録(格納)することが出来る。ここでステップS404は、空間情報として、キーフレーム情報を固有識別子と関連付けてフォーマット化して登録するフォーマット化ステップとして機能している。
次にキーフレーム情報を格納する別の手段として、センサノード15が取得した情報に基づきキーフレーム情報を格納する方法について記載する。図14においてセンサノード15は、例えばロードサイドカメラユニットのような映像監視システムなどの外部システムであり、情報記憶部(メモリ/HDD)15-3にはセンサノード自身の設置されている位置情報が保管されている。
先ず、センサノード15は、ステップS411において、検出部15-1の物体検出機能及び測距機能により、自身が検出可能なエリアに存在する物体の画像情報、特徴点情報、および位置情報などの情報を検出する。そしてステップS412において、センサノード15は、検出情報を情報記憶部(メモリ/HDD)15-3に保存する。
センサノード15の制御部15-2は、ステップS413において、この物体の画像情報、特徴点情報の中から、キーフレーム情報として、キーフレーム情報の要件を満たす物体の情報を抽出する。そして、センサノード15の制御部15-2は、ステップS414において、キーフレーム情報と、キーフレーム情報の要件を満たす物体の位置情報とを紐づけて情報記憶部(メモリ/HDD)15-3に記録する。
ここで抽出されるキーフレーム情報の要件を満たす物体とは、例えば、地図情報から情報を抽出する場合と同じく、周辺に同一のものが存在しない物体である。その他のキーフレーム情報の要件を満たす物体については後述する。
センサノード15は、ステップS415において、互いに関連付けられた(紐づけられた)キーフレーム情報と位置情報とを変換情報保持装置14に送信する。変換情報保持装置14は、ステップS416において、ステップS415で送信されてきた位置情報に対応する固有識別子を判別し、その固有識別子に対応するキーフレーム情報をフォーマットデータベース14-4に記録する。このようにして、センサノード15が検出した情報より、固有識別子に対応するキーフレーム情報をフォーマットデータベース14-4に格納することが出来る。
次にキーフレーム情報を格納する別の手段として、自律移動体が取得した情報に基づきキーフレーム情報を格納する方法について説明する。先ず、ステップS421において、自律移動体612は、その物体検出機能及び測距機能により、自身が検出可能なエリアに存在する物体の画像情報、特徴点情報、および位置情報などの情報を検出する。
そしてステップS422において、自律移動体612は、ステップS421で検出した情報を情報記憶部(メモリ/HDD)612-4に保存する。更にステップS423において、自律移動体612の制御部612-2は、この物体の画像情報、特徴点情報の中から、キーフレーム情報として、キーフレーム情報の要件を満たす物体の情報を抽出する。そして、ステップS424において、キーフレーム情報と、キーフレーム情の要件を満たす物体の位置情報とを関連付けて(紐づけて)制御部612-2に保管する。
ここで抽出されるキーフレーム情報の要件を満たす物体は、例えば地図情報から情報を抽出する場合と同じく、周辺に同一のものが存在しない物体である。他にも、キーフレーム情報の要件を満たす物体として、自律移動体612が撮影した「その地点の風景の画像データ」などもある。
ステップS425において、自律移動体612は、互いに関連付けられた(紐づけられた)キーフレーム情報と位置情報とを変換情報保持装置14に送信する。変換情報保持装置14は、ステップS426において、送信されてきた位置情報に対応する固有識別子を判別し、その固有識別子に対応するキーフレーム情報をフォーマットデータベース14-4に保管する。このようにして、自律移動体612が検出した情報より固有識別子に対応するキーフレーム情報をフォーマットデータベース14-4に格納することが出来る。
このようにして、フォーマットデータベース14-4内の所定の固有識別子に関連付けて(紐づけて)キーフレーム情報が格納される。ここで、本実施形態では、このキーフレーム情報は適切なタイミングで更新される。
例えば、地図情報から格納されたキーフレーム情報は地図情報が更新された時に更新されることが望ましい。又、例えば、ステップS424でセンサノード15によって格納されたキーフレーム情報は、センサノード15が検出可能な範囲の情報が変化し、その変化がキーフレーム情報に影響を与える変化である、と判断された場合に更新されることが望ましい。即ち、キーフレーム情報は、例えば、キーフレーム情報として格納されていた物体が移動した場合などは更新されることが望ましい。
又、自律移動体612によって格納されたキーフレーム情報は、同一地点に新しく別のキーフレーム情報が紐づけられて置き換わった場合などには、更新することが望ましい。但し、1つの分割空間に紐づけられるキーフレーム情報は複数であってもよい。この場合は、キーフレーム情報に新たにキーフレーム情報の要件を満たす物体を示す情報が追加される。
次にGPS電波の受信強度が低いルートにおいて、キーフレーム情報を用いて自律移動体612が移動する際の過程を図16、図17を用いて説明する。GPS電波の受信強度が低いルートにおいては、自律移動体612が本来有するGPSを用いた自己位置検出機能の精度は低下し、例えば±5m程度の誤差が発生するものとする。又、GPS電波の受信強度が低いルートにおいても地磁気センサを用いた方向検出機能に支障はなく、自律移動体612は地磁気の方向は正しく検知されるものとする。
図16は実施形態2に係る自律移動体612のフォーマット経路情報900のイメージ図である。図16のフォーマット経路情報900は、その経路上でキーフレーム情報が格納された分割空間902-1、902-2を通過するように設定されている。
分割空間902-1に格納されたキーフレーム情報は「XX交差点」と記された案内標識を示す情報であり、分割空間902-2に格納されたキーフレーム情報は「YY郵便局」の看板を示す情報であるとする。又、自律移動体612及びは自律移動体612を制御するシステム制御装置10は、出発地においては、自律移動体612の位置を把握しているものとする。
図17は図16のフォーマット経路情報900を用いて移動する自律移動体612と自律移動体612を制御するシステム制御装置10の動作を説明するシーケンス図である。尚、10,12の各制御部内のコンピュータがメモリに記憶されたコンピュータプログラムを実行することによって図17のシーケンスの各ステップの動作が行われる。
先ず、ステップS431において、システム制御装置10は図16で示した出発地の自律移動体612に対して図16の紙面右方向に移動開始するように指示を出す。
指示を受けた自律移動体612は、ステップS432において、地磁気センサを用いた方向検出機能から得られる情報を基に、図16の紙面右方向に移動開始する。
その後ステップS433において、自律移動体612は分割空間902-1付近±5m程度の位置に到達したとき、自律移動体612が有する撮像手段によって、「XX交差点」と記された案内標識を検出する。そして、検出された案内標識をもとに分割空間902-1に格納されたキーフレーム情報を照合する。
更にステップS434において、自律移動体612は有する測距機能によって、検出した「XX交差点」と記された案内標識までの距離を算出する。続けてステップS435において、自律移動体612は距離の算出結果に基づき分割空間902-1から自身の相対的な位置情報を算出する。そしてステップS436において、この位置情報を基にフォーマット経路情報900上の自己の位置を、自己が作成したサイバー空間の三次元マップに反映する。
更に自律移動体612は、ステップS437において、この位置情報をシステム制御装置10にも送信する。システム制御装置10はステップS438において、自律移動体612から受け取った位置情報を基に、フォーマット経路情報900上の自律移動体612の現在位置を把握する。尚、ステップS433~ステップS438の処理は自律移動体612が分割空間902-1に到達するまで連続的に行わる。
自律移動体612が分割空間902-1に到達すると、ステップS439において、自律移動体612は、ステップS436で作成したサイバー空間の三次元マップと方向検出機能を基に左折(図16の紙面上方向へ移動)する。
次にステップS440において、自律移動体612は分割空間902-2付近±5m程度の位置に到達したとき、自律移動体612が有する撮像手段によって、「YY郵便局」の看板を検出する。そして、自律移動体612は、検出された看板をもとに分割空間902-1に格納されたキーフレーム情報を照合する。
更にステップS441において、自律移動体612は、測距機能によって、検出した「YY郵便局」の看板までの距離を算出する。続けて自律移動体612は、ステップS442において、距離の算出結果から分割空間902-2から自身の相対的な位置情報を算出する。そして、ステップS443において、自己が作成したサイバー空間の三次元マップに反映し、ステップS444においてシステム制御装置10にも送信する。
システム制御装置10は、ステップS445において、自律移動体612から受け取った、分割空間902-2から自律移動体612までの相対的な位置情報を基に、フォーマット経路情報900上の自律移動体612の現在位置を把握する。
ステップS440~ステップS445の処理も、自律移動体612がキーフレーム情報の地点に到着するまで連続的に行われる。
ステップS440~ステップS445の処理も、自律移動体612がキーフレーム情報の地点に到着するまで連続的に行われる。
自律移動体612がキーフレーム情報の地点に到着したとき、自律移動体612及びシステム制御装置10は、自律移動体612がフォーマット経路情報900上の分割空間902-2に到達、即ち到着地まで到達したことを把握することができる。そして、システム制御装置10は自律移動体612に対して移動終了の指示を出す。そしてステップS447において、自律移動体612は移動を終了する。
次に、どのような情報がキーフレーム情報として利用可能なのか、について説明する。今まで、キーフレーム情報の例として「周辺に同一のものが存在しない物体を示す情報」と説明した。周辺に同一のものが存在しない物体、とは例えば、固有名詞を含む物体などである。例に挙げた「XX交差点」や「YY郵便局」などの固有名詞が書かれた案内標識や看板などは、当該地域においては、その地点のみに存在すると考えられる。
従って、固有名詞を検出できれば、GPSなどの自己位置検出機能を有していない自律移動体であっても、その地点においては正確に自己位置を特定することが可能となる。
なお、例えば、渋谷駅前の忠犬ハチ公像などの像(彫像や塑像も含む)および東京タワーなどの特徴的な建造物等の物体もキーフレーム情報の要件を満たす物体である。また、単に「ポスト」や「信号機」などの同様の形状をした物体が3次元空間に点在するような物体であってもキーフレーム情報の要件を満たす物体となりうる。例えば、「ポスト」は、日本では、あるポストを中心とした半径400m以内に別のポストがない地点に設置される。そのため、自律移動体が有するGPSを用いた自己位置検出機能の精度が、±100m程度の誤差があったとしても、別のポストと混同することはない。
又、そもそも自己位置検出機能を有していない自律移動体であっても、前後で検出した別のキーフレーム情報と複合的に判断することで、別のポストとの混同を避けることができる場合がある。
例えば、移動速度4km/hの、ある自律移動体が、その地点(A地点とする)を完全に特定可能なキーフレーム情報を照合した3分後に「ポスト」というキーフレーム情報を検出したとする。この移動体が3分で移動できる距離は200mであり、A地点から200mの範囲にあるポストが1つしかなければ、その地点を完全に特定できたことになる。
「完全にはその地点の特定ができない物体の存在情報」は使用する側の自己位置検出機能や、使い方に依存する。そのため自律移動体は、そのキーフレーム情報が自身で使用可能な情報かどうか判断する必要がある。そのため「完全にはその地点の特定ができない物体の存在情報」と「完全にその地点の特定ができる物体の存在情報」は同じキーフレーム情報であっても分類されていることが望ましい。
例えば、「完全にその地点の特定ができる物体の存在情報」はクラスAのキーフレーム情報、「±10kmの範囲には同一のものが存在しない物体の存在情報」はクラスBのキーフレーム情報といったクラス情報を付随させる。又、「±200mの範囲には同一のものが存在しない物体の存在情報」はクラスCのキーフレーム情報、といったクラス情報を付随させる。それによって、使用可能な情報かどうか判断する際の負担を軽減することが可能となる。
更に、キーフレーム情報の要件を満たす物体の情報の例として挙げられる別の例は、自律移動体612等によって撮影された「その地点の風景の画像データ」である。即ち、キーフレーム情報は、空間に対応した地点で撮影された画像データを含む。
この画像データを自律移動体の撮像手段等で目の前の実際の風景と比較し、特徴点の一致割合が一定以上かどうか解析行うことができれば、そのキーフレーム情報を照合、つまりその地点を特定することが可能となる。
但し、同じ地点の画像データであっても、撮影方向や、撮影時間、撮影機材等の条件が大きく異なる場合、特徴点の一致割合は低下し、照合することは難しくなる。そこで、その画像を撮影した際の撮影条件に関するパラメータデータを「その地点の風景の画像データ」に紐づけてフォーマットデータベース14-4に格納することが望ましい。即ち、パラメータデータは、対象となる空間で画像データを撮影した際の撮影条件を含む。
そしてパラメータデータは、その画像を撮影した地点の位置情報を含む。どの地点から撮影した画像データか分かれば、例えば自律移動体側がその方向に回り込むなどの動作を加えたり、カメラを回転することで、特徴点の一致割合を向させ、照合の難易度を下げることができるからである。
又、その画像データを撮影した際の照明の状態に関する情報も、パラメータデータとなりうる。即ち、撮影条件はその撮影をした際の明るさに関する情報を含む。撮影した際の照明の状態に関する条件は、画像全体の画質や色味、画像内の物体のエッジや影などに大きな影響を与えるためである。
ここで、照明の状態とは、例えば、撮影日時、撮影時の日の光はどのくらいの強さでどちらの方向から射していたか、近くに街頭などの光源はあったか、街灯があった場合それはどちらの方向からか、色(色温度)や照度はどの位か、の少なくとも1つを含む。
これらの条件をパラメータデータとして格納することで、例えば自律移動体で撮影した画像を、パラメータデータの条件に近づけるよう画像補正などの処理を行うことができ、照合度を上げることができるからである。
又、撮影した撮影機材に関する情報もパラメータデータとして含めることが望ましい。例えば撮影した自律移動体612の撮影機材のIDや光学特性に関するデータやホワイトバランスなどの設定情報を事前に準備できれば、自律移動体で撮影した画像に対して補正処理を行うことができる。それにより、照合度を上げることができるからである。またこれらのパラメータデータを有効に利用するため、撮影機材名、光学的な特性、撮影時の画質やゲインやホワイトバランスの設定情報に関するデータテーブルを事前に準備しておくことが望ましい。
尚、上記のようなパラメータデータを正確な形で収集することが困難な場合には、パラメータデータを推定値で格納しても良い。推定値とは例えば、明るさに関する推定値である。別の地点のキーフレーム情報のパラメータデータとして収集された明るさのデータの中から、例えば撮影時間や地形等の条件が近いものを格納することで、簡易的なパラメータデータとして使用しても良い。
更に、キーフレーム情報の要件を満たす物体の情報の他の例は、その地点の、或いはその地点から見た風景の3Dデータである。自律移動体が、例えばLiDAR(Light Detection And Ranging)等の、対象物の形状を判別可能な機能を有していれば、キーフレーム情報として格納された3Dデータを照合することが可能となる。即ち、キーフレーム情報は、対象となる空間に対応した地点での3Dデータを含む。
例えば、格納されたキーフレーム情報である3Dデータと、自身がLiDARによって測距した結果を比較し、その特徴点の一致割合が一定以上かどうか解析すれば、そのキーフレーム情報を照合でき、その地点を特定することが可能となる。キーフレーム情報として格納する3Dデータは、その地点すべてのデータでなく、解析が行いやすい特徴的な物体の形状のみであっても良い。
尚、LiDARはその測距性能が対象物の表面状態に左右されるという特徴がある。そのため、パラメータデータとして、キーフレーム情報である3Dデータ内の特徴的な形状を有する物体の表面情報を3Dデータに紐づけて格納することで、照合度を上げることができる。
即ち、フォーマット化手段は、空間情報として、キーフレーム情報を照合するためのパラメータデータを、キーフレーム情報と紐づけて登録可能とすることで照合度を向上できる。又、パラメータデータは3Dデータの物体の表面情報を含む。尚、ここでのパラメータデータも正確な形で収集することが困難な場合、パラメータデータは、物体の形状や地形等の条件から推測される推定値であっても良い。
キーフレーム情報の照合の難易度は、パラメータデータに依存する部分が大きいが、パラメータデータが推定値であった場合、そのキーフレーム情報の照合する難易度を事前に正確に見積もることは難しくなる。
自律移動体が自身の検出能力や解析能力では照合できないキーフレーム情報を照合可能と誤解して、実際その地点に到達した後に現在位置を見失ってしまうという事態は避けなければいけない。そのため、そのキーフレーム情報を自身で照合可能か、という照合難易度は、ルート設定の段階では高めに見積もることが望ましい。
画像データは一般的に明るい条件よりも暗い条件で撮影された場合、認識しずらい画像となる場合が多い。そのため、画像データをキーフレーム情報として使用し、パラメータデータを推定として格納する場合、そのパラメータデータに複数の候補がある場合、より明るい条件のパラメータデータを推定値として採用することが望ましい。
またパラメータデータは正確な値が新たに収集できた場合には、推定値から、この新たに収集した値に更新することが望ましい。
又、3Dデータをキーフレーム情報として使用し、パラメータデータを推定して格納する場合に、その推定が困難なときは、LiDAR等での測距が困難とされる、低反射率の物体の値、例えば黒紙の反射率である10%、などとする。それにより、自律移動体側での照合難易度を高めに見積もることができる。
以上の実施形態によれば、例えば緯度/経度/高さ等の所定の座標系によって定義される3次元空間の空間情報を用いた自律移動体制御システムの安全性を効率的に高めることができる。
尚、上述の実施形態においては自律移動体に制御システムを適用した例について説明した。しかし、本実施形態の移動体は、AGV(Automatic Guided Vehicle)やAMR(Autonomous Mobile Robot)などの自律移動体に限らない。例えば自動車、列車、船舶、飛行機、ロボット、ドローンなどの移動をする移動装置であればどのようなものであってもよい。また、本実施形態の制御システムは一部がそれらの移動体に搭載されていても良いし、搭載されていなくても良い。又、移動体をリモートでコントロールする場合にも本実施形態を適用することができる。
以上、本発明をその好適な実施形態に基づいて詳述してきたが、本発明は上記実施形態に限定されるものではなく、本発明の趣旨に基づき種々の変形が可能であり、それらを本発明の範囲から除外するものではない。尚、本実施形態は、以下の組み合わせを含む。
(構成1)所定の座標系によって定義される3次元の空間に固有識別子を付与し、前記空間に存在する物体の状態と時間に関する空間情報を前記固有識別子と関連付けてフォーマット化して保存するフォーマット化手段を有し、前記フォーマット化手段は、前記空間情報として、キーフレーム情報を登録可能であることを特徴とする制御システム。
(構成2)前記キーフレーム情報は、前記空間に対応した地点の周辺に同一のものが存在しない物体の存在情報を含むことを特徴とする構成1の制御システム。
(構成3)前記キーフレーム情報は、前記空間に対応した地点で撮影された画像データを含むことを特徴とする構成1又は2に記載の制御システム。
(構成4)前記キーフレーム情報は、前記空間に対応した地点での3Dデータを含むことを特徴とする構成1~3のいずれか1つに記載の制御システム。
(構成5)前記フォーマット化手段は、前記空間情報として、前記キーフレーム情報を照合するためのパラメータデータを、前記キーフレーム情報と紐づけて登録可能であることを特徴とする構成1~4のいずれか1つに記載の制御システム。
(構成6)前記キーフレーム情報は、前記空間に対応した地点で撮影された画像データを含み、
前記パラメータデータは、前記画像データを撮影した際の撮影条件を含むことを特徴とする構成5に記載の制御システム。
前記パラメータデータは、前記画像データを撮影した際の撮影条件を含むことを特徴とする構成5に記載の制御システム。
(構成7)前記撮影条件は、前記撮影をした地点の位置情報を含むことを特徴とする構成6に記載の制御システム。
(構成8)前記撮影条件は前記撮影をした際の明るさに関する情報を含むことを特徴とする構成6又は7に記載の制御システム。
(構成9)撮影条件は前記撮影をした撮影機材に関する情報を含むことを特徴とする構成6~8のいずれか1つに記載の制御システム。
(構成10)前記キーフレーム情報は、前記空間に対応した地点の3Dデータを含み、
前記パラメータデータは、前記3Dデータの物体の表面情報を含むことを特徴とする構成5に記載の制御システム。
前記パラメータデータは、前記3Dデータの物体の表面情報を含むことを特徴とする構成5に記載の制御システム。
(構成11)前記パラメータデータは、推定値を含むことを特徴とする5に記載の制御システム。
(構成12)前記フォーマット化手段から取得した前記空間情報と、移動体の種別情報に基づき前記移動体の移動経路に関する経路情報を生成する経路生成手段を有することを特徴とする構成1~11のいずれか1つに記載の制御システム。
(構成13)前記フォーマット化手段は、前記空間情報の更新間隔に関する情報を前記固有識別子と関連付けてフォーマット化することを有することを特徴とする構成1~12のいずれか1つに記載の制御システム。
(構成14)前記更新間隔に関する情報は、前記空間に存在する物体の種類に応じて異なることを特徴とする構成13に記載の制御システム。
(構成15)前記更新間隔に関する情報は、前記空間に存在する物体の種類が移動体の場合には、前記空間に存在する物体の種類が移動体でない場合よりも短いことを特徴とする構成14に記載の制御システム。
(方法)所定の座標系によって定義される3次元の空間に固有識別子を付与し、前記空間に存在する物体の状態と時間に関する空間情報を前記固有識別子と関連付けてフォーマット化して保存するフォーマット化ステップを有し、前記フォーマット化ステップは、前記空間情報として、キーフレーム情報を登録可能であることを特徴とする制御方法。
(プログラム)構成1~15のいずれか1つに記載の制御システムの各手段をコンピュータによって制御するためのコンピュータプログラム。
尚、本発明は、前述した実施形態の機能を実現するソフトウェアのプログラムコード(制御プログラム)を記録した記憶媒体を、システムあるいは装置に供給することによって実現してもよい。そして、そのシステムあるいは装置のコンピュータ(又はCPUやMPU)が記憶媒体に格納されたコンピュータ読取可能なプログラムコードを読み出し実行することによっても達成される。その場合、記憶媒体から読み出されたプログラムコード自体が前述した実施形態の機能を実現することになり、そのプログラムコードを記憶した記憶媒体は本発明を構成することになる。
10:システム制御装置
11:ユーザインターフェース
12:自律移動体
13:経路決定装置
14:変換情報保持装置
15:センサノード
16:インターネット
11:ユーザインターフェース
12:自律移動体
13:経路決定装置
14:変換情報保持装置
15:センサノード
16:インターネット
Claims (17)
- 所定の座標系によって定義される3次元の空間に固有識別子を付与し、前記空間に存在する物体の状態と時間に関する空間情報を前記固有識別子と関連付けてフォーマット化して保存するフォーマット化手段を有し、
前記フォーマット化手段は、前記空間情報として、キーフレーム情報を登録することを特徴とする制御システム。 - 前記キーフレーム情報は、前記空間に対応した地点の周辺に同一のものが存在しない物体の存在情報を含むことを特徴とする請求項1に記載の制御システム。
- 前記キーフレーム情報は、前記空間に対応した地点で撮影された画像データを含むことを特徴とする請求項1に記載の制御システム。
- 前記キーフレーム情報は、前記空間に対応した地点での3Dデータを含むことを特徴とする請求項1に記載の制御システム。
- 前記フォーマット化手段は、前記空間情報として、前記キーフレーム情報を照合するためのパラメータデータを、前記キーフレーム情報と紐づけて登録可能であることを特徴とする請求項1に記載の制御システム。
- 前記キーフレーム情報は、前記空間に対応した地点で撮影された画像データを含み、
前記パラメータデータは、前記画像データを撮影した際の撮影条件を含むことを特徴とする請求項5に記載の制御システム。 - 前記撮影条件は、前記撮影をした地点の位置情報を含むことを特徴とする請求項6に記載の制御システム。
- 前記撮影条件は前記撮影をした際の明るさに関する情報を含むことを特徴とする請求項6に記載の制御システム。
- 前記撮影条件は前記撮影をした撮影機材に関する情報を含むことを特徴とする請求項6に記載の制御システム。
- 前記キーフレーム情報は、前記空間に対応した地点の3Dデータを含み、
前記パラメータデータは、前記3Dデータの物体の表面情報を含むことを特徴とする請求項5に記載の制御システム。 - 前記パラメータデータは、推定値を含むことを特徴とする請求項5に記載の制御システム。
- 前記フォーマット化手段から取得した前記空間情報と、移動体の種別情報に基づき前記移動体の移動経路に関する経路情報を生成する経路生成手段を有することを特徴とする請求項1に記載の制御システム。
- 前記フォーマット化手段は、前記空間情報の更新間隔に関する情報を前記固有識別子と関連付けてフォーマット化することを有することを特徴とする請求項1に記載の制御システム。
- 前記更新間隔に関する情報は、前記空間に存在する物体の種類に応じて異なることを特徴とする請求項13に記載の制御システム。
- 前記更新間隔に関する情報は、前記空間に存在する物体の種類が移動体の場合には、前記空間に存在する物体の種類が移動体でない場合よりも短いことを特徴とする請求項14に記載の制御システム。
- 所定の座標系によって定義される3次元の空間に固有識別子を付与し、前記空間に存在する物体の状態と時間に関する空間情報を前記固有識別子と関連付けてフォーマット化して保存するフォーマット化ステップを有し、
前記フォーマット化ステップは、前記空間情報として、キーフレーム情報を登録可能であることを特徴とする制御方法。 - 請求項1~15のいずれか1項に記載の制御システムの各手段をコンピュータによって制御するためのコンピュータプログラム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2023/002676 WO2023149376A1 (ja) | 2022-02-01 | 2023-01-27 | 制御システム、制御方法、及び記憶媒体 |
Applications Claiming Priority (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2022014166 | 2022-02-01 | ||
JP2022014166 | 2022-02-01 | ||
JP2022110828 | 2022-07-08 | ||
JP2022110828 | 2022-07-08 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2023112670A true JP2023112670A (ja) | 2023-08-14 |
Family
ID=87562165
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2023002447A Pending JP2023112670A (ja) | 2022-02-01 | 2023-01-11 | 制御システム、制御方法、及びコンピュータプログラム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2023112670A (ja) |
-
2023
- 2023-01-11 JP JP2023002447A patent/JP2023112670A/ja active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11774250B2 (en) | Using high definition maps for generating synthetic sensor data for autonomous vehicles | |
US20200401823A1 (en) | Lidar-based detection of traffic signs for navigation of autonomous vehicles | |
US11501104B2 (en) | Method, apparatus, and system for providing image labeling for cross view alignment | |
CN111656135A (zh) | 基于高清地图的定位优化 | |
WO2021007117A1 (en) | Generating training data for deep learning models for building high definition maps | |
CN110945498A (zh) | 地图不确定性和观测模型 | |
EP3644013A1 (en) | Method, apparatus, and system for location correction based on feature point correspondence | |
WO2005098362A1 (en) | Navigation system and method | |
US11699246B2 (en) | Systems and methods for validating drive pose refinement | |
EP4202835A1 (en) | Method, apparatus, and system for pole extraction from optical imagery | |
EP4202833A1 (en) | Method, apparatus, and system for pole extraction from a single image | |
KR100620668B1 (ko) | 지피에스 수신기를 갖춘 차량 네비게이션 시스템의 비디오지리정보 시스템 구성 방법 | |
WO2023149376A1 (ja) | 制御システム、制御方法、及び記憶媒体 | |
JP2023112670A (ja) | 制御システム、制御方法、及びコンピュータプログラム | |
CN117029815A (zh) | 基于空间互联网的场景定位方法和相关设备 | |
WO2023149370A1 (ja) | 制御システム、制御方法、及び記憶媒体 | |
WO2023149349A1 (ja) | 制御システム、制御方法、及び記憶媒体 | |
WO2023149264A1 (ja) | 制御システム、制御方法、及び記憶媒体 | |
WO2023149358A1 (ja) | 制御システム、制御方法、及び記憶媒体 | |
WO2023149288A1 (ja) | 情報処理装置、情報処理方法、及び記憶媒体 | |
JP2023112666A (ja) | 制御システム、制御方法、及びコンピュータプログラム | |
WO2023149353A1 (ja) | 制御システム、制御方法、及び記憶媒体 | |
WO2023149308A1 (ja) | 制御システム、制御方法、及び記憶媒体 | |
WO2023149319A1 (ja) | 自律移動体制御システム、制御方法 | |
JP2023112669A (ja) | 制御システム、制御方法、及びコンピュータプログラム |