JP7349909B2

JP7349909B2 - 位置同定装置、移動体位置同定システム、及び位置同定方法

Info

Publication number: JP7349909B2
Application number: JP2019238697A
Authority: JP
Inventors: 俊則生川
Original assignee: IHI Aerospace Co Ltd
Current assignee: IHI Aerospace Co Ltd
Priority date: 2019-12-27
Filing date: 2019-12-27
Publication date: 2023-09-25
Anticipated expiration: 2039-12-27
Also published as: JP2021107980A

Description

本発明は、移動体の位置を同定する技術に関する。

車両等の移動体の位置を把握する場合に、ＧＰＳ等のＧＮＳＳ（Global Navigation Satellite System）が利用される。この場合、移動体は、複数の衛星から電波を受信し、当該電波に含まれる衛星の軌道情報や時間情報、および当該電波の受信時刻に基づいて、自己位置を求める。

一方、ＧＮＳＳを利用せずに、移動体の位置を把握する場合には、例えば、予め作成した３次元地図データを用いたマッチングが行われる。この場合、移動体に搭載した３次元環境計測センサ（例えばＬＲＦ：Laser Range Finder）が外界を観測し、観測結果に基づいて３次元局所地図を作成し、この局所地図と、上述の３次元地図データとをマッチングさせる。この時、局所地図に含まれるランドマーク（例えば建物、道路、木など）と、３次元地図データにおける対応するランドマークとの位置合わせを行うことにより、マッチングがなされる。このようなマッチングにより、移動体の位置を求めることができる。マッチングにより移動体の位置を求める技術は、例えば特許文献１に記載されている。

特許第５８１７６１１号公報

月、火星等において、移動体（例えばローバー）を移動させて探査する場合、ＧＮＳＳを利用できないので、上述したようなマッチングにより移動体の位置を求めることが考えられる。

しかし、月面においては、地球の表面に存在するような建物、道路、木などがないので、観測により得られた局所地図と、予め得た月面の大域地図データとのマッチングにおいて特徴的な建物、道路、又は木を位置合わせに用いることができない。そのため、移動体の位置を求めることが困難となる場合がある。

そこで、本発明の目的は、ＧＮＳＳを使用できず、移動体の移動領域にランドマークが少ない場合でも、移動体の位置を正確に求めることができる技術を提供することにある。

上述の目的を達成するため、本発明による位置同定装置は、
観測時点に移動体から外界を観測した観測画像と、前記観測時点の前記移動体の推定位置を、前記移動体から受信する通信部と、
ＣＧ生成視点から見た環境を表すＣＧ画像を地図データから生成するＣＧ生成部と、
前記観測画像と共に前記ＣＧ画像を表示する表示部と、を備え、
前記通信部が前記観測画像と前記推定位置を受信すると、前記ＣＧ生成部は、前記推定位置を前記ＣＧ生成視点として前記ＣＧ画像を生成し、
前記ＣＧ生成視点を含むＣＧ生成基準を変更する操作が可能な操作部を備え、
前記ＣＧ生成基準が変更された場合、前記ＣＧ生成部は、変更後の前記ＣＧ生成基準で前記ＣＧ画像を生成し、前記表示部は、当該ＣＧ画像を前記観測画像と共に表示し、
前記ＣＧ生成基準の変更操作を完了させる旨の入力が可能な入力部と、
当該入力がなされた場合、最新の前記ＣＧ生成視点に基づいて前記移動体の位置を同定する位置同定部と、を備える。

本発明による移動体位置同定システムは、上述の位置同定装置と前記移動体とを含むシステムであって、
前記移動体は、
前記観測時点で前記観測画像を取得する観測部と、
前記移動体の運動状態を計測する計測部と、
前記移動体の既知の初期位置と、計測された前記運動状態に基づいて、前記観測時点における前記移動体の前記推定位置を求める位置推定部と、
前記観測画像と前記推定位置を、前記位置同定装置へ送信する通信部と、を備える。

本発明による位置同定方法は、
移動体から外界を観測時点で観測した観測画像を取得し、
前記観測時点における移動体の推定位置を求め、
前記推定位置をＣＧ生成視点としたＣＧ画像を、予め作成した地図データから生成し、
前記ＣＧ画像を前記観測画像と共に表示し、
前記ＣＧ生成視点を含むＣＧ生成基準を変更する操作が操作部になされた場合、変更後の前記ＣＧ生成基準でＣＧ画像を生成し、当該ＣＧ画像を前記観測画像と共に表示し、
前記ＣＧ生成基準の変更操作を完了させる旨の入力が入力部になされた場合、最新の前記ＣＧ生成視点に基づいて前記移動体の位置を同定する。

本発明によると、移動体から外界を観測時点で観測した観測画像を取得し、観測時点における移動体の推定位置をＣＧ生成視点としたＣＧ画像を予め作成した地図データから生成し、ＣＧ画像を観測画像と共に表示する。人は、表示された観測画像とＣＧ画像を見て、操作部を操作することにより、両画像が一致するようにＣＧ生成基準のＣＧ生成視点を変更することができる。これにより、変更後のＣＧ生成視点によるＣＧ画像が生成されて表示される。人は、表示された当該ＣＧ画像と観測画像とが一致したと判断したら、入力部を操作することにより、ＣＧ生成基準の変更操作を完了させる旨の入力を行える。この入力がなされた場合、最新のＣＧ生成視点に基づいて、移動体の位置が同定される。

したがって、ＧＮＳＳが使用できないこと等により、推定位置の精度が低くても、推定位置と地図データから生成したＣＧ画像と観測画像とのマッチングに基づいて、より正確な移動体の位置を同定することができる。

また、ＣＧ画像と観測画像とのマッチングは人を介して行われるので、移動体の移動領域にランドマークが少ない場合でも、移動体の位置を正確に同定することができる。

本発明の実施形態による移動体位置同定システムの構成を示す。移動体を示す側面図である。（Ａ）は、観測画像の一例を示し、（Ｂ）は、ＣＧ画像の一例を示す。重ねて表示された観測画像とＣＧ画像を示す。本発明の実施形態による位置同定方法を示すフローチャートである。

本発明の実施形態を図面に基づいて説明する。なお、各図において共通する部分には同一の符号を付し、重複した説明を省略する。

図１は、本発明の実施形態による移動体位置同定システム１００の構成を示す。移動体位置同定システム１００は、移動体１０と位置同定装置２０を備える。

（移動体の構成）
図２は、移動体１０を示す概略側面図である。移動体１０は、惑星（地球若しくは他の惑星）又は衛星（例えば月）の表面４上を移動する。例えば、移動体１０は、車輪１を有し、当該車輪１が惑星又は衛星の表面４に接触しながら回転駆動されることにより当該表面を走行する車両であってよい。代わりに、移動体１０は、クローラにより上記表面４を走行する走行装置であってもよい。移動体１０は、観測部３と計測部５と位置推定部７と通信部９を備える。

観測部３は、移動体１０の本体２に設けられ、移動体１０から外界を観測時点で観測した観測画像を取得する。観測画像は、各物体（例えば地形箇所）の位置および存在範囲を３次元的に表す画像であってよい。観測部３は、例えばレーザレーダであってよい。レーザレーダ３は、観測範囲に対してレーザ光（例えばパルスレーザ光）を走査して、物体表面の反射点からの反射レーザ光に基づいて、惑星又は月の表面４における障害物や移動体１０が走行可能な面などの環境を表す観測画像を生成して取得する。レーザレーダ３は、例えばＬｉｄａｒ（Light Detection and Ranging）またはＬＲＦ（Laser Range Finder）と呼ばれる機器であってよい。観測部３は、レーザレーダに限定されず、観測範囲を撮像することにより観測画像を取得するステレオカメラであってもよい。

計測部５は、移動体１０の運動状態を検出する。計測部５は、移動体１０の運動状態を検出してよい。本実施形態では、運動状態は、移動体１０において検出された情報であって、移動体１０の移動方向（向き）と移動距離を求めるのに用いられる情報であってよい。例えば、運動状態は、移動体１０が移動する速さ（以下で単に速度という）と角速度を含む。ここで、角速度は、移動体１０に固定され互いに直交する３つの軸（例えばロール軸、ピッチ軸、及びヨー軸）の各々について、当該軸回りの移動体１０の本体２の回転速度を意味してよい。

計測部５は、例えば、速度検出部５ａと角速度検出部５ｂを含む。速度検出部５ａは、移動体１０の速度を検出する。速度検出部５ａは、一例では、上述した車輪１の回転速度を計測し、この回転速度と、既知である当該車輪１の外径とに基づいて移動体１０の速度を検出する。角速度検出部５ｂは、移動体１０の角速度（すなわち、移動体１０に固定された上記各軸回りの回転速度）を検出する。角速度検出部５ｂは、ジャイロセンサを用いて構成されたものであってよい。

位置推定部７は、移動体１０の既知の初期位置と、計測部５により計測された運動状態に基づいて、観測部３が観測画像を取得した観測時点における移動体１０の推定位置を求める。すなわち、位置推定部７は、上記初期位置に移動体１０が位置していた時以降から当該観測時点までの間の各時点において計測部５により計測された運動状態と、上記初期位置とに基づいて、ＧＮＳＳを利用せずにデッドレコニング（dead reckoning）により当該観測時点における移動体１０の推定位置を求める。

例えば、位置推定部７は、移動体１０の既知の初期姿勢（すなわち、上記各軸回りの回転角）と角速度検出部５ｂが検出した角速度の時間積分値とから移動体１０の進行方向を求める。また、位置推定部７は、上記観測時点以前の各時点で求めた当該進行方向と当該各時点で速度検出部５ａが検出した速度とに基づいて、上記観測時点における移動体１０の推定位置を求める。この推定位置は、移動体１０が移動する領域（例えば惑星又は衛星の表面４）に固定された移動領域座標系で表わされたものであってよい。

上述した移動体１０の既知の初期位置と既知の初期姿勢は、位置同定装置２０の初期位置姿勢取得部２７により、次のように求められてよい。初期位置姿勢取得部２７は、初期時点（移動体１０が上記初期位置にあり上記初期姿勢をとっている時点）において観測部３が観測した観測画像と、後述の記憶部１３に記憶されている地図データとのマッチングにより移動体１０の初期位置と初期姿勢を求める。例えば、初期位置姿勢取得部２７は、地図データに含まれるランドマーク（例えば、特徴的な地形箇所）と、観測画像における対応するランドマークとの位置合わせを行うことによりマッチングを行って、移動体１０の初期位置と初期姿勢を求めることができる。初期位置と初期姿勢を求めるための上記観測画像は、移動体１０の通信部９から位置同定装置２０の通信部１１へ送信されて初期位置姿勢取得部２７に入力されてよい。また、初期位置姿勢取得部２７が求めた上記初期位置と上記初期姿勢は、位置同定装置２０の通信部１１から移動体１０の通信部９へ送信されて位置推定部７に入力される。また、この初期姿勢は、観測方向推定部８にも入力される。

初期時点において移動体１０の周囲にランドマークが無く、上記マッチングを行えない場合には、ランドマークを観測部３が撮像できる位置まで、移動体１０を移動させてもよい。その結果、上述のマッチングにより移動体１０の初期位置と初期姿勢を求めることができる。ランドマークを観測部３が撮像できる位置までの移動体１０の移動は、例えば次のようになされてよい。観測部３が観測した観測画像が、後述のように表示部１７に表示され、人は、この観測画像を見て、適宜の操作装置を操作する。この操作による指令（例えば移動方向、移動距離など）が移動体１０へ送信され、移動体１０は、この指令に従って移動する。これにより、ランドマークを観測部３が撮像できる位置まで移動体１０を移動させることができる。次いで、ランドマークを含む観測画像が観測部３により取得され位置同定装置２０へ送信される。

上記ランドマークは、特徴的な地形箇所であってもよいし、人工的なマーカーであってもよい。移動体１０の移動領域が月面である場合、マーカーは、月面着陸船や月面ローバー等が予め設置したものであってよい。

なお、初期位置姿勢取得部２７は、位置同定装置２０ではなく移動体１０に設けられており、上記地図データを記憶していてもよい。この場合、初期位置姿勢取得部２７は、求めた上記初期位置を位置推定部７に入力し、求めた上記初期姿勢を位置推定部７と観測方向推定部８に入力する。

また、計測部５は、移動体１０の本体２の姿勢変化状態を検出する。姿勢変化状態は、移動体１０において検出された情報であって、本体２の姿勢（すなわち、向き）を求めるのに用いられる情報である。本実施形態では、姿勢変化状態は、角速度検出部５ｂにより検出される上述した各軸回りの角速度であってよい。

観測方向推定部８は、観測部３の観測方向を推定観測方向として求める。ここで、観測方向は、観測時点に観測部３が外界を観測した方向である。観測方向は、観測部３から見た上記観測範囲（観測部３の視野）の中心の方向であってよい。

観測方向推定部８は、移動体１０（本体２）の既知の初期姿勢と、移動体１０の姿勢が上記初期姿勢となっている上記初期時点から当該観測時点までの間の各時点において計測部５により計測された姿勢変化状態に基づいて、観測時点における移動体１０の推定姿勢を求め、当該推定姿勢に基づいて、推定観測方向を求める。推定姿勢は、上述した各軸回りの本体２の回転角であってよい。当該各回転角は、対応する上記軸回りに基準角から回転した角度であってよく、基準角に一致する時は０度または３６０度であり、０度から３６０度までの値をとり、３６０度になったら０度に戻る。観測方向推定部８は、上記のように求めた推定姿勢と、本体２に対する観測部３の向き（観測方向）とに基づいて、上述の移動領域座標系で表わされる観測部３の推定観測方向を求める。本体２に対する観測部３の向きは、固定されている場合には、既知であり、変化する場合には、観測時点に適宜のセンサにより計測されて観測方向推定部８に入力される。

通信部９は、上記観測時点に観測部３が取得した観測画像と、位置推定部７が求めた当該観測時点における上記推定位置と、観測方向推定部８が求めた当該観測時点における上記推定観測方向を、位置同定装置２０へ無線通信により送信する。

（位置同定装置の構成）
位置同定装置２０は、移動体１０から離れた遠隔位置に設けられる。例えば、移動体１０は月面に位置し、位置同定装置２０は地球上に位置する。位置同定装置２０は、通信部１１と記憶部１３とＣＧ生成部１５と表示部１７と操作部１９と入力部２１と位置同定部２３と姿勢同定部２４と更新部２５とを備える。

通信部１１は、移動体１０の通信部９から送信された上記観測画像と上記推定位置と上記推定観測方向を受信する。

記憶部１３は、移動体１０が移動する領域の地図データを記憶する。地図データは、予め作成されて記憶部１３に記憶される。地図データは、ＣＧ生成部１５がＣＧ画像を生成するのに利用される。地図データは、上述の移動領域座標系で表わされていてよい。

移動体１０の移動領域が月面である場合、月を回る観測衛星に搭載された観測機器（例えばレーザ高度計）により月面を観測したデータ（月面の地形と標高）に基づいて、月面の３次元の地図が上記地図データとして予め作成されてよい。或いは、移動体１０を搭載した月面着陸船が月面に着陸する前に、月面の上方から、月面着陸船に搭載した観測機器（例えばレーザ高度計）により月面を観測したデータ（月面の地形と標高）に基づいて、月面の３次元の地図を上記地図データとして予め作成してよい。なお、例えば、上記観測機器により観測したデータが、観測衛星又は月面着陸船から、位置同定装置２０の通信部１１へ送信され、当該データに基づいて、位置同定装置２０に設けられた地図生成部１４が、月面の上記３次元の地図を上記地図データとして作成して記憶部１３に記憶してもよい。

ＣＧ生成部１５は、ＣＧ生成視点から仮想観測方向に見た環境を表すＣＧ（computer graphics）画像を、記憶部１３の地図データから生成する。ＣＧ生成視点と仮想観測方向は、それぞれ、記憶部１３の地図データ（移動領域座標系）において表わされる視点と方向である。通信部１１が上述した観測画像と推定位置と推定観測方向を受信すると、ＣＧ生成部１５は、当該推定位置と推定観測方向をそれぞれＣＧ生成視点と仮想観測方向としてＣＧ画像を、記憶部の地図データから生成する。すなわち、ＣＧ生成部１５は、記憶部１３の地図データにおいて、推定位置から推定観測方向に見た環境を表すＣＧ画像を生成する。

表示部１７は、ＣＧ生成部１５が生成したＣＧ画像を、通信部１１が受信した上記観測画像と共に表示する。ＣＧ画像と観測画像は、同じ視野範囲の画像であってよい。一例では、表示部１７は、ＣＧ画像と観測画像とを、互いに（例えば部分的ではなく全体的に）重ねて表示する。なお、表示部１７は、ＣＧ画像と観測画像とを、重ねずに、画面の別々の領域にそれぞれ表示してもよい。

表示部１７の画面においてＣＧ画像と観測画像が互いに重ねて表示される場合に、両画像のうち、画面の手前側の画像（例えばＣＧ画像）を通して奥側の画像（例えば観測画像）が見えるように、手前側の画像は透明部分を有する。手前側の画像において、透明部分以外の非透明部分は、例えば、障害物や各物体の輪郭又は外形を表す線又は多数の点を含んでよい。非透明部分は、このような線又は多数の点に加えて、惑星又は月の表面に間隔をおいて描かれた複数の等高線を含んでもよい。

図３（Ａ）は、通信部９から送信された観測画像の一例を示す。図３（Ｂ）は、この観測画像と共に通信部９から送信された推定位置と推定観測方向をそれぞれＣＧ生成視点と仮想観測方向としてＣＧ生成部１５により生成されるＣＧ画像の一例を示す。図４は、表示部１７により重ねて表示された図３（Ａ）の観測画像と図３（Ｂ）のＣＧ画像を示す。

操作部１９は、上述したＣＧ生成視点と仮想観測方向からなるＣＧ生成基準を変更する操作を人が行えるように構成されている。したがって、人は、表示部１７に表示されたＣＧ画像と観測画像を見ながら、操作部１９を操作することにより、ＣＧ生成視点を現在のＣＧ生成視点（例えば上記推定位置）から変更することができ、仮想観測方向を現在の仮想観測方向（例えば上記推定観測方向）から変更することができる。このように、人は、操作部１９を操作することにより、ＣＧ生成視点と仮想観測方向の一方又は両方を変更することができる。操作部１９になされた操作により特定された変更後のＣＧ生成基準が操作部１９からＣＧ生成部１５へ入力される。

人は、操作部１９を操作することにより、ＣＧ生成視点を、現在のＣＧ生成視点（未だＣＧ生成視点を変更していない場合には上述の推定位置）から所望の方向に所望の距離だけ変更することができる。所望の方向は、例えば、表示部１７の画面の奥行方向、手前方向、左方向、右方向、上方向、及び下方向のいずれかであってもよく、或いは、これらの方向の２つ以上であってよい。後者の場合、操作部１９の操作により、方向毎に、ＣＧ生成視点の変更距離を指定できる。なお、これらの方向について、奥行方向と手前方向は、表示部１７の画面に直交する方向であって互いに逆向きである。また、左方向と右方向は、表示部１７の画面に平行であって、互いに逆向きである。上方向と下方向は、奥行方向、手前方向、左方向、及び右方向に直交する方向であって互いに逆向きである。

また、人は、操作部１９を操作することにより、仮想観測方向を、現在の仮想観測方向（例えば、未だＣＧ生成視点を変更していない場合には、上述の推定観測方向）から所望の方向に所望の角度だけ変更することができる。

操作部１９が操作されることにより、ＣＧ生成基準が変更された場合、ＣＧ生成部１５は、変更後のＣＧ生成基準に従ってＣＧ画像を新たに生成する。例えば、ＣＧ生成基準のＣＧ生成視点と仮想観測方向の両方が変更されている場合には、変更後のＣＧ生成視点から変更後の仮想観測方向に見た環境を表すＣＧ画像を、地図データに基づいて新たに生成する。表示部１７は、新たに生成されたＣＧ画像を観測画像と共に表示する。この時のＣＧ画像と観測画像の表示方法は、上述と同じであってよい。

図４の例では、ＣＧ画像は観測画像に対して右方向に１０ｍずれている。この場合、ＣＧ生成視点を左方向に１０ｍだけ変更する操作が操作部１９になされることにより、ＣＧ生成部１５は、新たなＣＧ画像を生成し、表示部１７により表示される当該ＣＧ画像と観測画像とが一致するようになる。例えば、当該ＣＧ画像と観測画像とが表示部１７により重ねて表示された場合には、両画像において互いに対応する物体（例えば地形箇所）同士が全体的に重なる状態になる。

入力部２１は、ＣＧ生成基準の変更操作を完了させる旨の入力（以下で単に完了入力ともいう）を人が行えるように構成されている。すなわち、人は、表示部１７に表示されたＣＧ画像と観測画像を見て、両画像が一致していると判断したら、入力部２１を操作することにより、完了入力を位置同定装置２０に行う。なお、「両画像が一致している」とは、例えば、両画像において、同じ物体が同じ位置に同じ大きさで且つ同じ向きに映っている場合を意味してよい。

位置同定部２３は、完了入力がなされた場合、最新のＣＧ生成視点に基づいて、観測画像を取得した観測時点における移動体１０の位置を同定する。例えば、位置同定部２３は、記憶部１３における地図データにおける最新のＣＧ生成視点の位置を、移動体１０の位置として同定（決定）する。

姿勢同定部２４は、完了入力がなされた場合、最新の仮想観測方向に基づいて、観測画像を取得した観測時点における移動体１０の姿勢を同定する。例えば、姿勢同定部２４は、記憶部１３における地図データ（上記移動領域座標系）における最新の仮想観測方向と、移動体１０の本体２に対する観測部３の向き（観測方向）とに基づいて、上記移動領域座標系における移動体１０（本体２）の姿勢を同定（決定）する。本体２に対する観測部３の向きは、固定されている場合には、既知であり、変化する場合には、上述のように移動体１０において適宜のセンサにより計測されて通信部９，１１を介して姿勢同定部２４へ入力される。

このように位置同定部２３と姿勢同定部２４によりそれぞれ同定された位置及び姿勢は、上述の推定位置と推定姿勢よりも正確な同定位置及び同定姿勢として、通信部１１から移動体１０へ無線通信で送信される。

更新部２５は、完了入力がなされたら、観測画像のデータを、最新のＣＧ生成視点から最新の仮想観測方向に見た環境を表すデータとして地図データに組み込む。これにより、更新部２５は、記憶部１３内の地図データを更新する。観測画像のデータは、各物体の位置及び存在範囲を表すデータである。例えば、観測画像が、レーザレーダにより取得したものである場合には、観測画像のデータは、各物体表面における各点の３次元座標値を含む。この場合、更新部２５は、当該各３次元座標を物体表面の点として記憶部１３内の地図データに組み込む。

更新部２５は、観測画像のデータを地図データに組み込む時に、座標変換を行ってよい。観測画像のデータは、観測部３に固定された観測座標系で表わされたデータであり、地図データは、上述の移動領域座標系で表わされたデータである。更新部２５は、最新のＣＧ生成視点と最新の仮想観測方向に基づいて、観測座標系で表わされた観測画像のデータ（例えば上記各３次元座標値）を、移動領域座標系のデータに変換して地図データに組み込む。より詳しくは、観測座標系の原点（観測部３の位置）を移動座標系における最新のＣＧ生成視点に一致させ、観測座標系において原点を通る既知の観測軸（観測方向）を、移動領域座標系おいて最新のＣＧ生成視点から最新の仮想観測方向に延びる軸に一致させるように、観測座標系を併進および回転させることにより、更新部２５は、観測座標系で表わされたデータ（例えば上記各３次元座標値）を、移動領域座標系におけるデータに変換する。

なお、一例では、人は、表示部１７に表示された観測画像又はＣＧ画像を見て、適宜の操作装置を操作することにより、移動体１０の移動に関する指令（例えば移動方向、移動距離など）を入力することができる。この指令は、通信部１１介して移動体１０へ送信される。移動体１０では、この指令を通信部９により受信する。移動体１０は、このように受信した指令に従って移動するように構成されてよい。

上述した位置同定装置２０は、コンピュータを用いて構成されてよい。この場合、地図生成部１４、ＣＧ生成部１５、位置同定部２３、姿勢同定部２４、及び更新部２５は、コンピュータに設けたＣＰＵ（central processing unit）がコンピュータプログラムを実行することにより実現されてよい。また、操作部１９と入力部２１は、例えばキーボード、マウス、タッチパネルなどにより構成されてよい。

（位置同定方法）
図５は、本発明の実施形態による位置同定方法を示すフローチャートである。この方法は、上述の移動体位置同定システム１００により実行されてよい。

ステップＳ１では、観測部３が、観測時点において外界を観測した観測画像を取得する。このステップＳ１は、所定の時間間隔をおいて行われてもよいし、移動体１０が所定の距離を移動する度に行われてもよいし、外部から観測指令を移動体１０が受ける度に行われてもよいし、他のタイミングで行われてもよい。ステップＳ１が行われる度に、このステップＳ１に対して後述のステップＳ２～Ｓ１１が行われてよい。

ステップＳ２では、ステップＳ１の観測時点における移動体１０の推定位置と推定観測方向を、それぞれ、上述のように位置推定部７と観測方向推定部８により求める。

ステップＳ３では、移動体１０の通信部９が、ステップＳ１で取得された観測画像とステップＳ２で求められた推定位置と推定観測方向を、無線通信により位置同定装置２０へ送信する。また、ステップＳ３では、送信された当該観測画像と推定位置と推定観測方向が、位置同定装置２０の通信部１１により受信される。

ステップＳ４では、位置同定装置２０において、ＣＧ生成部１５が、ステップＳ３で受信した推定位置をＣＧ生成視点とし、ステップＳ３で受信した推定観測方向を仮想観測方向としたＣＧ画像を、記憶部１３の地図データから生成する。

ステップＳ５では、表示部１７は、ステップＳ４で生成されたＣＧ画像を、ステップＳ３で受信された観測画像と共に表示する。

ステップＳ６では、人は、ステップＳ５で表示されたＣＧ画像と観測画像を見て、ＣＧ画像と観測画像とが一致しているかどうかを判断する。この判断の結果が否定である場合には、ステップＳ７へ進み、この判断の結果が肯定である場合には、ステップＳ８へ進む。

ステップＳ７では、人は操作部１９を操作することにより、ＣＧ画像が観測画像に一致するようにＣＧ生成基準を変更する。このステップＳ７の後、上述のステップＳ４～Ｓ６が再び行われる。すなわち、再度のステップＳ４では、ステップＳ７で変更されたＣＧ生成基準に従って、ＣＧ生成部１５はＣＧ画像を生成する。次いで、このＣＧ画像と、ステップＳ３で受信された観測画像とが、表示部１７に表示される。次に、当該ＣＧ画像と観測画像について上述のステップＳ６が再び行われる。

一方、ステップＳ８では、人は、入力部２１を操作することにより、ＣＧ生成基準の変更操作を完了させる旨の入力を行う。この入力がなされると、ステップＳ９～Ｓ１１が行われる。

ステップＳ９では、位置同定部２３が、上述のように最新のＣＧ生成視点に基づいて移動体１０の位置を同定し、姿勢同定部２４が、上述のように最新の仮想観測方向に基づいて移動体１０の姿勢を同定する。ここで、最新のＣＧ生成視点は、ステップＳ７が１回も行われていない場合には、ステップＳ３で受信された推定位置であり、ステップＳ７が１回以上行われている場合には、直前に行われたステップＳ７で変更されたＣＧ生成基準のＣＧ生成視点である。同様に、最新の仮想観測方向は、ステップＳ７が１回も行われていない場合には、ステップＳ３で受信された推定観測方向であり、ステップＳ７が１回以上行われている場合には、直前に行われたステップＳ７で変更されたＣＧ生成基準の仮想観測方向である。

ステップＳ１０では、ステップＳ９で同定された移動体１０の位置と姿勢が、位置同定装置２０の通信部１１から移動体１０へそれぞれ同定位置及び同定姿勢として送信される。これらの同定位置及び同定姿勢は、移動体１０の通信部９に受信され、移動体１０の位置推定部７と観測方向推定部８において新たな初期位置及び初期姿勢として利用される。

すなわち、位置推定部７は、この同定位置を、前回のステップＳ１の観測時点における初期位置として新たに設定する。その後、位置推定部７は、当該初期位置と、前回のステップＳ１の観測時点以降において計測部５が各時点で計測した移動体１０の運動状態とに基づいて、再度のステップＳ１での観測時点における移動体１０の推定位置を再度のステップＳ２で求める。

同様に、観測方向推定部８は、上記同定姿勢を、前回のステップＳ１の観測時点における初期姿勢として新たに設定する。その後、観測方向推定部８は、当該初期姿勢と、前回のステップＳ１の観測時点以降において計測部５が各時点で計測した移動体１０の姿勢変化状態とに基づいて、再度のステップＳ１での観測時点における推定観測方向を再度のステップＳ２で求める。

ステップＳ１１は、ステップＳ９、Ｓ１０と並行して行われてよい。ステップＳ１１では、更新部２５は、ステップＳ３で受信された観測画像のデータを上述のように記憶部１３の地図データに組み込む。これにより、記憶部１３における地図データが更新される。

（実施形態による効果）
本実施形態によると、観測時点で移動体１０から観測画像を取得し、観測時点における移動体１０の推定位置と推定観測方向を求め、推定位置をＣＧ生成視点とし推定観測方向を仮想観測方向としたＣＧ画像を予め作成した地図データから生成し、ＣＧ画像を観測画像と共に表示する。人は、表示された観測画像とＣＧ画像を見て、操作部１９を操作することにより、両画像が一致するようにＣＧ生成基準（ＣＧ生成視点と仮想観測方向）を推定位置と推定観測方向から変更することができる。これにより、変更後のＣＧ生成基準によるＣＧ画像が生成されて表示される。人は、表示された当該ＣＧ画像と観測画像とが一致したと判断したら、入力部２１を操作することにより、ＣＧ生成基準の変更操作を完了させる旨の入力を行える。この入力がなされた場合、位置同定部２３は、最新のＣＧ生成視点に基づいて移動体１０の位置を同定し、姿勢同定部２４は、最新の仮想観測方向に基づいて移動体１０の位置を同定する。

したがって、ＧＮＳＳが使用できないこと等により、推定位置と推定観測方向（推定姿勢）の精度が低くても、推定位置と推定観測方向（推定姿勢）と地図データから生成したＣＧ画像と観測画像とのマッチングに基づいて、より正確な移動体１０の位置と姿勢を同定することができる。また、このマッチングは人を介して行われるので、移動体１０の移動領域においてランドマークが少ない場合でも、移動体１０の位置と姿勢を正確に同定することが可能となる。

また、位置同定部２３と姿勢同定部２４がそれぞれ同定した移動体１０の位置と姿勢は、移動体１０へ送信され、移動体１０の位置と姿勢を推定する場合の初期位置と初期姿勢として利用できる。したがって、移動体１０においてデッドレコニングにより推定される移動体１０の位置と姿勢の精度が低下することを防止できる。

また、ＣＧ画像と観測画像とが一致した時のＣＧ生成視点と仮想観測方向に基づいて、観測画像のデータが地図データに組み込まれる。したがって、予め作成した地図データが精密でなくても、地図データがより精密になるように更新される。移動体１０の移動に伴って、上述のステップＳ１～Ｓ１１を繰り返し行うことにより、異なる位置や観測方向で取得した複数の観測画像のデータが地図データに組み込まれる。これにより、広範囲にわたってより精密化されるように地図データを更新できる。

本発明は上述した実施の形態に限定されず、本発明の技術的思想の範囲内で種々変更を加え得ることは勿論である。例えば、以下の変更例１，２の一方又は両方を採用してもよい。この場合、以下で説明しない点は、上述と同じであってよい。

（変更例１）
観測部３が、移動体１０の全方位を観測したパノラマ画像を上記観測画像として取得する場合には、観測方向推定部８と姿勢同定部２４が省略されてもよい。この場合、ＣＧ生成部１５は、ＣＧ生成視点から全方位を見た環境を表すパノラマ画像をＣＧ画像として生成する。また、この場合、ＣＧ生成基準は、ＣＧ生成視点であり、仮想観測方向を含まない。

また、この場合、観測画像を地図データに組み込む時の座標変換について、観測座標系の併進は上述と同じであってよいが、観測座標系の回転は次のように行われてよい。人は、表示部１７に表示されているＣＧ画像と観測画像とを、所定の中心軸回りに互いに回転させる操作を、ステップＳ８の前に適宜の操作装置により行ってよい。これにより、表示されているＣＧ画像と観測画像の所定の中心軸回りの回転位相が互いに一致したら、ステップＳ８を行う。次いで、ステップＳ１１で、更新部２５は、上記所定の中心軸回りの回転操作量に基づいて観測座標系を移動領域座標系に対して回転させることにより、観測画像のデータを観測座標系から移動領域座標系に変換して記憶部１３の地図データに組み込んでよい。

変更例１では、姿勢同定部２４が省略される場合、必要に応じて、移動体１０の姿勢（例えば進行方向）が適宜の方法で求められてもよい。例えば、移動体１０が直進している場合に、位置同定部２３が前回に同定した移動体１０の位置から見た、位置同定部２３が今回に同定した移動体１０の位置の向きが、位置同定装置２０により移動体１０の姿勢として求められてもよい。

（変更例２）
移動体１０と位置同定装置２０は、互いに離れて位置するが、いずれも地球上に位置してよい。この場合、移動体１０が、ＧＮＳＳを使用しない装置であってよい。

１車輪
２本体
３観測部
４表面
５計測部
５ａ速度検出部
５ｂ角速度検出部
７位置推定部
８観測方向推定部
９通信部
１０移動体
１１通信部
１３記憶部
１４地図生成部
１５ＣＧ生成部
１７表示部
１９操作部
２０位置同定装置
２１入力部
２３位置同定部
２４姿勢同定部
２５更新部
２７初期位置姿勢取得部
１００移動体位置同定システム

Claims

観測時点に移動体から外界を観測した観測画像と、前記観測時点の前記移動体の推定位置を、前記移動体から受信する通信部と、
ＣＧ生成視点から見た環境を表すＣＧ画像を地図データから生成するＣＧ生成部と、
前記観測画像と共に前記ＣＧ画像を表示する表示部と、を備え、
前記通信部が前記観測画像と前記推定位置を受信すると、前記ＣＧ生成部は、前記推定位置を前記ＣＧ生成視点として前記ＣＧ画像を生成し、
前記ＣＧ生成視点を含むＣＧ生成基準を変更する操作が可能な操作部を備え、
前記ＣＧ生成基準が変更された場合、前記ＣＧ生成部は、変更後の前記ＣＧ生成基準で前記ＣＧ画像を生成し、前記表示部は、当該ＣＧ画像を前記観測画像と共に表示し、
前記ＣＧ生成基準の変更操作を完了させる旨の入力が可能な入力部と、
当該入力がなされた場合、最新の前記ＣＧ生成視点に基づいて前記移動体の位置を同定する位置同定部と、を備える、位置同定装置。
前記通信部は、前記観測画像と前記推定位置と共に、前記観測画像の推定観測方向を受信し、
前記ＣＧ生成部は、前記ＣＧ生成視点から仮想観測方向に見た環境を表すＣＧ画像を前記地図データから生成し、
前記通信部が前記観測画像と前記推定位置と前記推定観測方向を受信すると、前記ＣＧ生成部は、前記推定位置と前記推定観測方向をそれぞれ前記ＣＧ生成視点と前記仮想観測方向として前記ＣＧ画像を生成し、
前記操作部の操作により変更可能な前記ＣＧ生成基準は、前記ＣＧ生成視点と前記仮想観測方向からなり、
前記入力部による前記入力がなされた場合、最新の前記仮想観測方向に基づいて、前記観測時点における前記移動体の姿勢を同定する姿勢同定部を備える、請求項１に記載の位置同定装置。
前記通信部は、前記位置同定部が求めた前記移動体の位置を前記移動体へ送信する、請求項１に記載の位置同定装置。
前記通信部は、前記位置同定部が求めた前記移動体の位置と、前記姿勢同定部が求めた前記移動体の姿勢を、前記移動体へ送信する、請求項２に記載の位置同定装置。
前記地図データを記憶する記憶部と、
前記地図データを更新する更新部と、を備え、
前記入力部による前記入力がなされた場合、前記観測画像のデータを、最新の前記ＣＧ生成基準に基づいて地図データに組み込む、請求項１～４のいずれか一項に記載の位置同定装置。
請求項１に記載の位置同定装置と前記移動体とを含む移動体位置同定システムであって、
前記移動体は、
前記観測時点で前記観測画像を取得する観測部と、
前記移動体の運動状態を計測する計測部と、
前記移動体の既知の初期位置と、計測された前記運動状態に基づいて、前記観測時点における前記移動体の前記推定位置を求める位置推定部と、
前記観測画像と前記推定位置を、前記位置同定装置へ送信する通信部と、を備える、移動体位置同定システム。
前記位置同定装置の前記通信部は、前記位置同定部が同定して前記移動体の位置を、同定位置として前記移動体に送信し、
前記移動体の前記通信部が前記同定位置を受信した場合、前記位置推定部は、当該同定位置を前記観測時点における初期位置として、当該初期位置と、前記観測時点以降において前記計測部が計測した前記移動体の運動状態に基づいて、次の観測時点における前記移動体の推定位置を求める、請求項６に記載の移動体位置同定システム。
移動体から外界を観測時点で観測した観測画像を取得し、
前記観測時点における移動体の推定位置を求め、
前記推定位置をＣＧ生成視点としたＣＧ画像を、予め作成した地図データから生成し、
前記ＣＧ画像を前記観測画像と共に表示し、
前記ＣＧ生成視点を含むＣＧ生成基準を変更する操作が操作部になされた場合、変更後の前記ＣＧ生成基準でＣＧ画像を生成し、当該ＣＧ画像を前記観測画像と共に表示し、
前記ＣＧ生成基準の変更操作を完了させる旨の入力が入力部になされた場合、最新の前記ＣＧ生成視点に基づいて前記移動体の位置を同定する、位置同定方法。