JP2020201180A - 情報処理装置、制御方法、プログラム及び記憶媒体 - Google Patents
情報処理装置、制御方法、プログラム及び記憶媒体 Download PDFInfo
- Publication number
- JP2020201180A JP2020201180A JP2019109518A JP2019109518A JP2020201180A JP 2020201180 A JP2020201180 A JP 2020201180A JP 2019109518 A JP2019109518 A JP 2019109518A JP 2019109518 A JP2019109518 A JP 2019109518A JP 2020201180 A JP2020201180 A JP 2020201180A
- Authority
- JP
- Japan
- Prior art keywords
- information
- angle
- map
- unit
- information processing
- 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
Abstract
【課題】車両などの移動体の位置を好適に算出可能な情報処理装置を提供する。【解決手段】情報処理装置1は、移動体の周辺の地物を含む角度対応画像Iaを取得し、角度対応画像Ia中の地物に関連する少なくとも3つの基準部を抽出する。そして、情報処理装置1は、少なくとも3つの基準部から基準部の組み合わせを少なくとも2つ選択し、組み合わせの各々に対し、組み合わせに対する車両位置を基準とした角度に関する情報を取得する。そして、情報処理装置1は、地図DB4に基づき、上述の組み合わせに対応する2つの基準部の地図上における位置情報と、上述の組み合わせに対応する基線の長さに関する情報と、を夫々取得する。そして、情報処理装置1は、上述の角度に関する情報と、上述の長さに関する情報と、上述の位置情報と、から、地図上における車両の位置である自車位置Pを算出する。【選択図】図8
Description
本発明は、位置を測定する技術に関する。
従来から、車両の進行先に設置される地物をライダ、レーダ又はカメラを用いて検出し、その検出結果に基づいて自車位置を推定する技術が知られている。例えば、特許文献1には、計測センサによる道路周辺の地物の計測結果と、予め地図上に登録された地物の位置情報とを照合させることで自己位置を推定する技術が開示されている。
自動運転等においては、高精度な自車位置推定が必要となり、かつ、種々の状況下においても位置推定が可能であることが好ましい。一方、GNSS(Global Navigation Satellite System)による位置推定や道路周辺の地物の距離計測に基づく位置推定のみでは、全ての状況下において高精度な位置推定を行うことができない。よって、このような既存の位置推定方法に加えて、他の位置推定方法が存在することが好ましい。
本発明は、上記のような課題を解決するためになされたものであり、車両などの移動体の位置を好適に算出可能な情報処理装置を提供することを主な目的とする。
請求項に記載の発明は、情報処理装置であって、移動体の周辺の地物を含む画像を取得する第1取得部と、前記画像中の前記地物に関連する少なくとも3つの基準部を抽出する抽出部と、前記少なくとも3つの基準部から基準部の組み合わせを少なくとも2つ選択し、前記組み合わせの各々に対し、前記組み合わせに対する前記移動体の位置を基準とした角度に関する情報を取得する第2取得部と、地図情報に基づき、前記組み合わせに対応する2つの基準部の地図上における位置情報と、前記組み合わせに対応する2つの基準部間の長さに関する情報と、を夫々取得する第3取得部と、前記角度に関する情報と、前記長さに関する情報と、前記位置情報と、から、地図上における移動体の位置を算出する算出部と、を有する。
また、請求項に記載の発明は、情報処理装置であって、移動体の周辺の地物に対して電磁波を走査することで得られる走査情報を取得する第1取得部と、前記走査情報に基づき、前記地物に関連する少なくとも3つの基準部から基準部の組み合わせを少なくとも2つ選択し、前記組み合わせの各々に対し、前記組み合わせに対する前記移動体の位置を基準とした角度に関する情報を取得する第2取得部と、地図情報に基づき、前記組み合わせに対応する2つの基準部の地図上における位置情報と、前記組み合わせに対応する2つの基準部間の長さに関する情報と、を夫々取得する第3取得部と、前記角度に関する情報と、前記長さに関する情報と、前記位置情報と、から、地図上における移動体の位置を算出する算出部と、を有する。
また、請求項に記載の発明は、情報処理装置が実行する制御方法であって、移動体の周辺の地物を含む画像を取得する第1取得工程と、前記画像中の前記地物に関連する少なくとも3つの基準部を抽出する抽出工程と、前記少なくとも3つの基準部から基準部の組み合わせを少なくとも2つ選択し、前記組み合わせの各々に対し、前記組み合わせに対する前記移動体の位置を基準とした角度に関する情報を取得する第2取得工程と、地図情報に基づき、前記組み合わせに対応する2つの基準部の地図上における位置情報と、前記組み合わせに対応する2つの基準部間の長さに関する情報と、を夫々取得する第3取得工程と、前記角度に関する情報と、前記長さに関する情報と、前記位置情報と、から、地図上における移動体の位置を算出する算出工程と、を有する。
また、請求項に記載の発明は、コンピュータが実行するプログラムであって、移動体の周辺の地物を含む画像を取得する第1取得部と、前記画像中の前記地物に関連する少なくとも3つの基準部を抽出する抽出部と、前記少なくとも3つの基準部から基準部の組み合わせを少なくとも2つ選択し、前記組み合わせの各々に対し、前記組み合わせに対する前記移動体の位置を基準とした角度に関する情報を取得する第2取得部と、地図情報に基づき、前記組み合わせに対応する2つの基準部の地図上における位置情報と、前記組み合わせに対応する2つの基準部間の長さに関する情報と、を夫々取得する第3取得部と、前記角度に関する情報と、前記長さに関する情報と、前記位置情報と、から、地図上における移動体の位置を算出する算出部として前記コンピュータを機能させる。
本発明の好適な実施形態によれば、情報処理装置は、移動体の周辺の地物を含む画像を取得する第1取得部と、前記画像中の前記地物に関連する少なくとも3つの基準部を抽出する抽出部と、前記少なくとも3つの基準部から基準部の組み合わせを少なくとも2つ選択し、前記組み合わせの各々に対し、前記組み合わせに対する前記移動体の位置を基準とした角度に関する情報を取得する第2取得部と、地図情報に基づき、前記組み合わせに対応する2つの基準部の地図上における位置情報と、前記組み合わせに対応する2つの基準部間の長さに関する情報と、を夫々取得する第3取得部と、前記角度に関する情報と、前記長さに関する情報と、前記位置情報と、から、地図上における移動体の位置を算出する算出部と、を有する。情報処理装置は、この態様により、地図上における移動体の位置を、幾何学的計算により好適に算出することができる。
上記情報処理装置の一態様では、前記画像は、極座標球面上に投影された画像中の隣り合う画素に対して当該極座標球面の中心からそれぞれ引いた仮想線同士がなす第1角度が対応している画像であり、前記第2取得部は、前記画像中における基準部の組み合わせ毎に、当該組み合わせに対応する2つの基準部間の画素数を求め、当該画素数に前記第1角度を乗じることで、前記角度に関する情報を取得する、この態様により、情報処理装置は、地図上における移動体の位置の算出に必要な、移動体の位置を基準とした基準部の角度に関する情報を、好適に取得することができる。
上記情報処理装置の他の一態様では、前記地図情報は、前記基準部の各々の地図上における位置情報を含み、前記第3取得部は、前記基準部間の長さに関する情報を、当該基準部の地図上における位置情報に基づき生成する。この態様により、情報処理装置は、基準部間の長さに関する情報を好適に取得することができる。
上記情報処理装置の他の一態様では、前記抽出部は、前記地物に関連する3つの基準部を抽出し、前記第2取得部は、当該3つの基準部から、前記基準部の組み合わせを2つ選択し、前記算出部は、選択された2つの前記組み合わせに対応する、前記角度に関する情報及び前記長さに関する情報に基づき、前記位置を算出する。この態様により、情報処理装置は、地図上における移動体の位置を、幾何学的計算により一意に算出することができる。
上記情報処理装置の他の一態様では、前記抽出部は、略鉛直方向に延在する地物又は地物の略鉛直部分を、前記基準部として抽出する。情報処理装置は、このような基準部に関する位置、距離、角度に関する情報に基づき、水平面上における移動体の位置を高精度に算出することができる。
上記情報処理装置の他の一態様では、前記第2取得部は、前記少なくとも3つの基準部とは異なる基準部を含む基準部の組み合わせに対する前記移動体の位置を基準とした角度である第2角度に関する情報をさらに取得し、前記算出部は、前記地図情報と前記算出部が算出した前記移動体の位置とに基づき算出した第2角度と、前記第2取得部が取得した第2角度とに基づき、前記算出部が算出した前記移動体の位置の検証を行う。この態様により、情報処理装置は、算出した移動体の位置の検証を好適に実行することができる。
本発明に係る他の好適な実施形態では、情報処理装置は、移動体の周辺の地物に対して電磁波を走査することで得られる走査情報を取得する第1取得部と、前記走査情報に基づき、前記地物に関連する少なくとも3つの基準部から基準部の組み合わせを少なくとも2つ選択し、前記組み合わせの各々に対し、前記組み合わせに対する前記移動体の位置を基準とした角度に関する情報を取得する第2取得部と、地図情報に基づき、前記組み合わせに対応する2つの基準部の地図上における位置情報と、前記組み合わせに対応する2つの基準部間の長さに関する情報と、を夫々取得する第3取得部と、前記角度に関する情報と、前記長さに関する情報と、前記位置情報と、から、地図上における移動体の位置を算出する算出部と、を有する。情報処理装置は、この態様によっても、地図上における移動体の位置を、幾何学的計算により好適に算出することができる。
本発明に係る他の好適な実施形態では、情報処理装置が実行する制御方法であって、移動体の周辺の地物を含む画像を取得する第1取得工程と、前記画像中の前記地物に関連する少なくとも3つの基準部を抽出する抽出工程と、前記少なくとも3つの基準部から基準部の組み合わせを少なくとも2つ選択し、前記組み合わせの各々に対し、前記組み合わせに対する前記移動体の位置を基準とした角度に関する情報を取得する第2取得工程と、地図情報に基づき、前記組み合わせに対応する2つの基準部の地図上における位置情報と、前記組み合わせに対応する2つの基準部間の長さに関する情報と、を夫々取得する第3取得工程と、前記角度に関する情報と、前記長さに関する情報と、前記位置情報と、から、地図上における移動体の位置を算出する算出工程と、を有する。情報処理装置は、この制御方法を実行することで、地図上における移動体の位置を、幾何学的計算により好適に算出することができる。
本発明に係る他の好適な実施形態では、コンピュータが実行するプログラムであって、移動体の周辺の地物を含む画像を取得する第1取得部と、前記画像中の前記地物に関連する少なくとも3つの基準部を抽出する抽出部と、前記少なくとも3つの基準部から基準部の組み合わせを少なくとも2つ選択し、前記組み合わせの各々に対し、前記組み合わせに対する前記移動体の位置を基準とした角度に関する情報を取得する第2取得部と、地図情報に基づき、前記組み合わせに対応する2つの基準部の地図上における位置情報と、前記組み合わせに対応する2つの基準部間の長さに関する情報と、を夫々取得する第3取得部と、前記角度に関する情報と、前記長さに関する情報と、前記位置情報と、から、地図上における移動体の位置を算出する算出部として前記コンピュータを機能させる。コンピュータは、このプログラムを実行することで、地図上における移動体の位置を、幾何学的計算により好適に算出することができる。好適には、上記プログラムは、記憶媒体に記憶される。
以下、図面を参照して本発明の好適な実施例について説明する。以後において、「地図」とは、従来の経路案内用の車載機が参照するデータに加えて、ADAS(Advanced Driver Assistance System)や自動運転に用いられるデータも含むものとする。
[情報処理装置の構成]
図1は、本実施例における情報処理装置1の概略構成図を示す。情報処理装置1は、車両内で使用される据置型又は携帯型の装置、あるいは車両と一体となっている装置である。情報処理装置1は、主に、通信部11と、記憶部12と、入力部13と、制御部14と、車両に設けられたセンサ部7と電気的に接続するインターフェース15と、表示部16と、音出力部17とを有する。情報処理装置1内の各要素は、バスライン19を介して相互に接続されている。
図1は、本実施例における情報処理装置1の概略構成図を示す。情報処理装置1は、車両内で使用される据置型又は携帯型の装置、あるいは車両と一体となっている装置である。情報処理装置1は、主に、通信部11と、記憶部12と、入力部13と、制御部14と、車両に設けられたセンサ部7と電気的に接続するインターフェース15と、表示部16と、音出力部17とを有する。情報処理装置1内の各要素は、バスライン19を介して相互に接続されている。
通信部11は、制御部14の制御に基づきデータ通信を行う。例えば、通信部11は、センサ部7の出力に基づき検出された物体等に関する情報を、データの収集及び配信を行うサーバ装置へ送信したり、現在位置周辺のエリアに対応する地図データなどを、上述のサーバ装置から受信したりする。また、通信部11は、車両を制御するための制御信号を車両に送信する処理、車両の状態に関する信号を車両から受信する処理、及び車車間通信による他車両とのデータの送受信処理などを行ってもよい。
記憶部12は、制御部14が実行するプログラムや、制御部14が所定の処理を実行する為に必要な情報を記憶する。記憶部12は、情報処理装置1に接続又は内蔵されたハードディスクなどの外部記憶装置であってもよく、フラッシュメモリなどの記憶媒体であってもよい。なお、記憶部12は、情報処理装置1とデータ通信を行うサーバ装置であってもよい。この場合、記憶部12は、複数のサーバ装置から構成されてもよい。
記憶部12は、地図DB4と、センサデータキャッシュ6とを記憶する。
地図DB4は、例えば、道路情報、施設情報、及び地物情報などを含むデータベースである。道路情報には、経路探索用の車線ネットワークデータ、道路形状データ、交通法規データなどが含まれる。地物情報は、道路標識等の看板や停止線等の道路標示、センターライン等の道路区画線や道路沿いの構造物等の情報を含む。地図DB4は、通信部11により図示しないサーバ装置から受信する更新データに基づき適宜更新が行われてもよい。地図DB4のデータ構造については後述する。センサデータキャッシュ6は、センサ部7の出力データ(所謂生データ)を一時的に保持するキャッシュメモリである。
入力部13は、ユーザが操作するためのボタン、タッチパネル、リモートコントローラ、音声入力装置等であり、例えば、目的地などの経路探索の条件を指定する入力、自動運転のオン及びオフを指定する入力などを受け付け、生成した入力信号を制御部14へ供給する。
インターフェース15は、センサ部7の出力データを制御部14やセンサデータキャッシュに供給するためのインターフェース動作を行う。センサ部7は、カメラ71などの車両の周辺環境を認識するための1又は複数の外界センサと、GPS受信機72、ジャイロセンサ73、加速度センサ74、速度センサ75などの内界センサを含む。カメラ71は、車両から撮影した画像を生成する。
好適には、カメラ71は、撮影位置から2つの対象物までの角度差を、画素数から算出可能な画像(「角度対応画像Ia」とも呼ぶ。)を出力するカメラ(例えば360°円周カメラ)を含むとよい。この場合、角度対応画像Iaを出力するカメラは、例えば、1又は複数の魚眼レンズを含んでもよい。
角度対応画像Iaは、極座標球面上に投影された画像中の隣り合う画素に対し、極座標球面の中心からそれぞれ引いた仮想線同士がなす角度が対応している画像であり、1つの画素が所定角度分の方位差に対応している。上述の所定角度は、本発明における「第1角度」の一例である。従って、情報処理装置1は、角度対応画像Iaを参照することで、角度対応画像Ia中の2つの対象物に対し、車両を基準とした場合のこれらの対象物の方位の差(角度差)を、角度対応画像Iaにおける対象物間の画素数に1画素に対応する角度を乗じることで、好適に算出することができる。角度対応画像Iaは、車両の現在位置の算出に好適に用いられる。なお、角度対応画像Iaを出力するカメラ71を備える代わりに、制御部14は、画素と角度が対応しない通常のカメラが出力する画像に基づき、角度対応画像Ia又はこれに相当するデータを生成してもよい。
なお、センサ部7は、図1に示した外界センサ及び内界センサ以外の任意の外界センサ及び内界センサを有してもよい。例えば、センサ部7は、外界センサとして、ライダ(測域センサ)、超音波センサ、赤外線センサ、その他電磁波を走査することで情報を取得するセンサを有してもよい。
表示部16は、制御部14の制御に基づき、情報を表示する。例えば、表示部16は、目的地までの経路を示した地図を表示したり、運転を補助する情報などを表示したりする。音出力部17は、制御部14の制御に基づき、音を出力する。音出力部17は、例えば、運転を支援する案内音声、警告音、又は音楽等を出力する。
制御部14は、所定のプログラムを実行するCPUなどを含み、情報処理装置1の全体を制御する。本実施例では、制御部14は、地図DB4を参照し、カメラ71が出力する画像を解析することで、円周角の定理又は正弦定理に基づき、現在位置を算出する。以後では、本実施例に基づき算出する車両の位置を、「自車位置P」とも呼ぶ。制御部14は、第1取得部、抽出部、第2取得部、第3取得部、算出部及びプログラムを実行するコンピュータ等として機能する。
[データ構造]
図2は、地図DB4のデータ構造の一例である。図2に示す地図DB4は、主に、道路情報と、施設情報と、地物情報とを有する。地物情報は、地物毎に固有の識別情報である地物IDと、地物の種別を示す種別情報と、地物の位置を示す位置情報と、基準部情報とを含む。
図2は、地図DB4のデータ構造の一例である。図2に示す地図DB4は、主に、道路情報と、施設情報と、地物情報とを有する。地物情報は、地物毎に固有の識別情報である地物IDと、地物の種別を示す種別情報と、地物の位置を示す位置情報と、基準部情報とを含む。
基準部情報は、自車位置Pの算出において基準とする基準部に関する情報である。基準部は、略鉛直方向に延在する地物又は地物の略鉛直部分などが該当する。例えば、基準部は、電柱や信号機などの柱状物の中心線、又は、建物の鉛直方向に延びるエッジ部分などである。
基準部情報は、基準部毎に設けられ、例えば、基準部IDと、基準部位置情報とを含む。基準部IDは、基準部毎に割り当てられる固有の識別情報である。基準部位置情報は、基準部の位置を示す情報である。なお、基準部情報は、基準部ID及び基準部位置情報以外の基準部に関する任意の情報を有してもよい。例えば、基準部情報は、対象の基準部の計測に必要な情報をさらに有してもよい。例えば、基準部情報は、対象の基準部が建物のエッジ部分に該当する場合には、当該エッジに沿った線を基準部として検出すべき旨を指示する情報をさらに含んでもよい。他の例では、基準部情報は、対象の基準部が電柱等の柱状物の中心線である場合には、当該柱状物の中心線を基準部として検出すべき旨を指示する情報をさらに含んでもよい。
なお、図2に示す地図DB4のデータ構造は一例であり、本発明が適用可能な地図DB4のデータ構造は、図2に示す構造に限定されない。例えば、基準部情報は、地物情報の一部として管理される代わりに、地物情報とは独立した情報として管理されてもよい。
図3は、道路20と道路21からなるT字路付近の地図を示す。図3では、基準部情報として地図DB4に登録される基準部の位置を黒点により明示している。図3に示すように、地図に表示された建物22〜26のエッジ部分が基準部として定められている。また、道路20沿いに存在する電柱又は信号機などの柱状物27、28の中心部分が基準部として定められている。そして、この場合、地図DB4には、各黒点に対応する基準部に関する基準部情報が含まれる。
なお、図3の例では、建物22〜26のエッジ部分のうち、道路から明らかに計測することができないエッジ部分については、基準部として地図DB4に登録されない。例えば、建物22の6個のエッジ部分のうち、道路20又は道路21のいずれにも面していない4つのエッジ部分については、基準部として地図DB4に登録されていない。同様に、建物23の4つのエッジ部分のうち、道路20又は道路21のいずれからも計測することが困難な1つのエッジ部分については、基準部として地図DB4に登録されていない。このように、基準部情報は、建物等の全てのエッジ部分毎に生成される必要はない。
このように、基準部情報は、基準部の位置情報に関する情報を含み、構造物全体を表す点群情報等を含む必要がないため、地図DB4に基準部情報を付加することによる地図DB4のデータ量増加分が小さい。また、上述したように、基準部情報は、道路から計測可能な建物のエッジ部分や電柱等に対してのみ設けられてもよい。よって、この場合、地図DB4に基準部情報を付加することによる地図DB4のデータ量の増加をさらに抑制することが可能である。
[自車位置の測定]
次に、本実施例に基づく自車位置Pの測定方法について説明する。概略的には、情報処理装置1は、角度対応画像Iaに含まれる少なくとも3つの基準部に関する距離と角度に基づき、円周角の定理又は正弦定理を用いることで、自車位置Pを算出する。
次に、本実施例に基づく自車位置Pの測定方法について説明する。概略的には、情報処理装置1は、角度対応画像Iaに含まれる少なくとも3つの基準部に関する距離と角度に基づき、円周角の定理又は正弦定理を用いることで、自車位置Pを算出する。
(1)正弦定理に基づく自車位置の算出
まず、正弦定理を用いた自車位置Pの算出方法について説明する。以下に説明する正弦定理に基づく自車位置Pの算出方法は、3つの基準部に関する距離と角度に基づく自車位置Pの算出方法である。
まず、正弦定理を用いた自車位置Pの算出方法について説明する。以下に説明する正弦定理に基づく自車位置Pの算出方法は、3つの基準部に関する距離と角度に基づく自車位置Pの算出方法である。
図4は、3つの基準部と自車位置Pとの水平面上での位置関係を示す図である。図4では、3つの基準部(第1基準部〜第3基準部)が直線上に存在し、第1基準部は位置「A」、第2基準部は位置「B」、第3基準部は位置「C」に存在するものとする。
この場合、情報処理装置1は、まず、地図DB4の基準部情報等を参照することで、位置A〜位置Cの絶対位置を認識する。上述の絶対位置は、地図上の位置であり、例えば、緯度及び経度の組合せにより示される位置である。
そして、情報処理装置1は、認識した位置A〜位置Cの絶対位置に基づき、位置Aと位置Bとを結ぶ線A−Bの長さに相当する距離「L1」と、位置Bと位置Cとを結ぶ線B−Cの長さに相当する距離「L2」とをそれぞれ算出する。以後では、線A−B及び線B−Cなどの、基準部間を結ぶ水平面上の線を「基線」とも呼ぶ。
また、情報処理装置1は、第1基線A−Bの両端に対する水平面上の角度「θ1」と、第2基線B−Cの両端に対する水平面上での角度「θ2」とをそれぞれ計測する。ここで、角度θ1と角度θ2は、それぞれ、自車位置Pを基準とした場合の各基線の両端となる2つの基準部の方位の差(角度差)に相当する。例えば、情報処理装置1は、自車位置Pにおいてカメラ71が取得した角度対応画像Iaに基づき、角度θ1と角度θ2とをそれぞれ算出する。例えば、情報処理装置1は、角度対応画像Ia中において各基準部を特定し、特定した基準部のうち、各基線の両端となる基準部間の画素数を数える。そして、情報処理装置1は、第1基線A−Bと第2基線B−Cについてそれぞれ数えた画素数に対し、角度対応画像Iaの1画素分に対応する角度を乗じることで、角度θ1と角度θ2とをそれぞれ算出する。
そして、情報処理装置1は、位置A〜位置Cの絶対位置と、距離L1、距離L2、角度θ1及び角度θ2とに基づき、正弦定理を用いて、自車位置Pの絶対位置(即ち地図上の位置)を算出する。
ここで、上述の自車位置Pの絶対位置の算出方法について、図4及び後述する図5を参照して具体的に説明する。以後において、三角形A−B−Pにおける頂点Aのなす角を「θx」とし、辺A−Pの長さを「Lx」とする。
まず、三角形A−C−Pに着目して正弦定理を用いると、以下の式(1)が成立し、三角形A−B−Pに着目して正弦定理を用いると、以下の式(2)が成立する。
そして、式(4)について、三角関数の加法定理を用いて角度θxについて整理すると、角度θxに関する以下の式(5)が導かれる。
従って、式(5)を用いることで、距離L1、距離L2、角度θ1、角度θ2に基づき、角度θxを好適に算出することができる。そして、情報処理装置1は、角度θxを用いることで、自車位置Pの絶対位置を好適に算出することができる。例えば、三角形A−B−Pに着目した場合、位置A及び位置Bと、角度θ1及び角度θxとが既知であることから、自車位置Pの座標は、三角測量の原理により好適に求めることができる。
図5は、三角形A−B−Pの拡大図である。図5では、頂点Pから辺A−Bに向けて垂線を引き、当該垂線と辺A−Bとの交点を「V」とし、線分A−Vの長さを「x」、垂線P−Vの長さを「y」としている。ここでは、一例として、頂点AからみたPの座標(x、y)を求める例について説明する。
線分A−Vの長さに相当する座標xは、以下の式(6)により表される。
ここで、車両が道路上に存在する場合の自車位置Pの算出方法の具体例について、補足説明する。
まず、情報処理装置1は、GPSなどのGNSSなどから得られる情報に基づき、暫定的な現在位置(「暫定自車位置Pg」とも呼ぶ。)を決定する。また、情報処理装置1は、地図DB4の道路情報等を参照し、暫定自車位置Pgが道路上に存在しない場合には、暫定自車位置Pgから最も近い道路上に暫定自車位置Pgが存在するように暫定自車位置Pgを修正する。次に、情報処理装置1は、位置A〜Cに対応する第1基準部〜第3基準部を地図DB4上及び角度対応画像Ia内において特定する。例えば、情報処理装置1は、暫定自車位置Pg及び第1基準部〜第3基準部の位置情報等に基づき、自車位置Pに対する第1基準部〜第3基準部のおよその相対位置を特定する。そして、情報処理装置1は、特定した位置に対応する角度対応画像Iaの位置に存在する、鉛直方向に延びたエッジ部分又は鉛直方向に延びた物体領域の中心線を、角度対応画像Ia中の各基準部として認識する。そして、情報処理装置1は、角度対応画像Iaにおいて認識した各基準部の位置に基づき、角度θ1及び角度θ2を算出すると共に、地図DB4の基準部位置情報等を参照することで、距離L1及び距離L2を決定する。そして、情報処理装置1は、位置A〜Cの絶対座標、角度θ1、角度θ2、距離L1、及び距離L2に基づき、式(5)に示す角度θxを算出し、角度θx及び位置A〜Cの絶対座標等に基づき、図5と同様の幾何学的計算により、自車位置Pの絶対座標を算出する。
なお、情報処理装置1は、上述した方法により自車位置Pを算出する代わりに、後述の「(2)円周角の定理に基づく自車位置の算出」のセクションで説明する方法に基づき、自車位置Pを算出してもよい。
(2)円周角の定理に基づく自車位置の算出
次に、円周角の定理に基づき、少なくとも4つの基準部に関する距離と角度から自車位置Pを算出する方法について説明する。
次に、円周角の定理に基づき、少なくとも4つの基準部に関する距離と角度から自車位置Pを算出する方法について説明する。
(2−1)汎用例
図6は、円周角の定理に基づき、4つの基準部に関する距離と角度から自車位置Pを算出する方法の概要を示す図である。ここでは、4つの基準部(第1基準部〜第4基準部)が自車位置Pの周辺位置である位置A〜位置Dにそれぞれ存在している。なお、図6では、各位置がX−Y座標により表されている。
図6は、円周角の定理に基づき、4つの基準部に関する距離と角度から自車位置Pを算出する方法の概要を示す図である。ここでは、4つの基準部(第1基準部〜第4基準部)が自車位置Pの周辺位置である位置A〜位置Dにそれぞれ存在している。なお、図6では、各位置がX−Y座標により表されている。
この場合、情報処理装置1は、まず、地図DB4の基準部情報等を参照することで、位置A〜位置Dの絶対位置を認識する。そして、情報処理装置1は、認識した位置A〜位置Dの絶対位置に基づき、位置Aと位置Bを結ぶ第1基線A−Bの長さに相当する距離L1と、位置Cと位置Dを結ぶ第2基線C−Dの長さに相当する距離L2とをそれぞれ算出する。また、情報処理装置1は、第1基線A−Bの両端に対する水平面上の角度θ1と、第2基線C−Dの両端に対する水平面上の角度θ2とをそれぞれ計測する。なお、距離L1、L2及び角度θ1、θ2の算出方法については、「(1)正弦定理に基づく自車位置Pの算出」のセクションで述べた方法と同一である。
そして、情報処理装置1は、位置A〜位置Dの絶対位置と、距離L1、距離L2、角度θ1及び角度θ2とに基づき、円周角の定理を用いて、自車位置Pの絶対位置(即ち地図上の位置)を算出する。
ここで、まず、三角形A−B−Pの外接円「CL1」の半径「R1」とその中心「O1」(座標(x1、y1))、及び三角形C−D−Pの外接円「CL2」の半径「R2」とその中心「O2」(座標(x2、y2))を、図6に示される計算式に従って求める。
例えば、三角形A−B−P及びその外接円CL1に着目した場合、円周角と中心角の定理に基づき、三角形A−B−O1の頂点O1の角度は「θ1×2」となり、他の頂点A、Bの角度は共に「π/2−θ1」となる。よって、半径R1は、この場合、図6の直角三角形L1−B−O1に着目することで、
R1=(L1/2)/cos(π/2−θ1)
と表される。
R1=(L1/2)/cos(π/2−θ1)
と表される。
また、頂点Aの座標を「(0、A)」、頂点Bの座標を「(B、0)」とした場合、中心O1のX座標x1は、辺B−O1とX座標とがなす角「θe」を用い、
x1=B+(R1*cos(θe))
と表される。同様に、中心O1のY座標y1は、
y1=R1*sin(θe)
と表される。なお、角度θeは、辺A−BとX座標とがなす角が「ATAN(A/B)」となることから、
θe=π−ATAN(A/B)−(π/2−θ1)
と表される。なお、ここでは、座標x1及び角度θxの算出にあたり、一例として「B<A」を仮定しているが、「B≧A」の場合も同様の幾何学的計算により座標x1及び角度θxを定めることができる。また、三角形C−D−Pの外接円CL2の半径R2とその中心O2の座標(x2、y2)についても、上述した半径R1とその中心O1の座標(x1、y1)の導出方法と同様の幾何学的計算により算出することができる。
x1=B+(R1*cos(θe))
と表される。同様に、中心O1のY座標y1は、
y1=R1*sin(θe)
と表される。なお、角度θeは、辺A−BとX座標とがなす角が「ATAN(A/B)」となることから、
θe=π−ATAN(A/B)−(π/2−θ1)
と表される。なお、ここでは、座標x1及び角度θxの算出にあたり、一例として「B<A」を仮定しているが、「B≧A」の場合も同様の幾何学的計算により座標x1及び角度θxを定めることができる。また、三角形C−D−Pの外接円CL2の半径R2とその中心O2の座標(x2、y2)についても、上述した半径R1とその中心O1の座標(x1、y1)の導出方法と同様の幾何学的計算により算出することができる。
また、半径R1及び中心O1の座標(x1、y1)を用いることで、外接円CL1を以下の式により表すことができる。
(X−x1)2+(Y−y1)2=R12
(X−x1)2+(Y−y1)2=R12
同様に、半径R2、座標(x2、y2)を用いることで、外接円CL2を以下の式により表すことができる。
(X−x2)2+(Y−y2)2=R22
(X−x2)2+(Y−y2)2=R22
そして、これらの外接円CL1、CL2に関する2次方程式を解くことで、これらの外接円の交点である自車位置Pを算出することができる。
なお、上述の2次方程式の解により求まる外接円CL1、CL2の交点は、2つ(図6ではPとP‘)存在する場合があるため、求まる2つの交点のうち自車位置Pに該当する交点を判定する必要がある。この場合、第1の判定方法では、情報処理装置1は、1又は2の基準部を追加することで、基線A−B及び基線C−D以外の基線(第3基線)を追加し、自車位置Pを基準とした第3基線の両端がなす角度「θ3」及び距離「L3」を算出する。そして、情報処理装置1は、角度θ3及び距離L3と、角度θ1及び距離L1(又は角度θ2及び距離L2)とを用いて、第3基線と自車位置Pがなす三角形の外接円と外接円CL1(又は外接円CL2)との交点を算出する。そして、情報処理装置1は、算出した当該交点と外接円CL1、CL2の交点とで共通する交点を、自車位置Pであると判定する。第2の判定方法では、情報処理装置1は、外接円CL1、CL2の2つの交点のうち、GNSSなどを用いた他の位置推定により特定される現在位置と近い方の交点を、自車位置Pであると判定する。
なお、情報処理装置1は、交点P、P‘のいずれかが、位置B又は位置Dの近くになるように、基線を決定してもよい。例えば、情報処理装置1は、3つの基準部を用いることで、一端が連結した基線を決定する。この場合、自車位置Pでない交点P’は、いずれかの基準部の位置と一致するため、情報処理装置1は好適に自車位置Pを判定することができる。この具体例については、図7を参照して後述する。他の例では、情報処理装置1は、進行方向に対して片側(例えば進行方向車線の路肩沿い)に存在する柱状物や建物などの地物を対象として第1基準部〜第4基準部をそれぞれ選択する。このようにすることで、外接円CL1、CL2の2つの交点間の距離が長くなるため、情報処理装置1は、例えば、上述の第2の判定方法等を用いることで、好適に自車位置Pを特定することができる。
(2−2)基線を連結させた例
図7は、3つの基準部に基づき基線を決定することにより、連結した基線を明示した自車位置P周辺の平面図を示す。なお、図7では、三角形A−B−Pに対する外接円CL1及び三角形B−C−Pに対する外接円CL2に加えて、暫定自車位置Pgに対する誤差円「CLE」が示されている。
図7は、3つの基準部に基づき基線を決定することにより、連結した基線を明示した自車位置P周辺の平面図を示す。なお、図7では、三角形A−B−Pに対する外接円CL1及び三角形B−C−Pに対する外接円CL2に加えて、暫定自車位置Pgに対する誤差円「CLE」が示されている。
図7の例では、情報処理装置1は、まず、第1基準部〜第3基準部に対応する位置A〜Cに対し、長さL1の第1基線A−Bと長さL2の第2基線B−Cを定めると共に、第1基線A−Bの両端に対する角度θ1と第2基線B−Cの両端に対する角度θ2を測定する。例えば、情報処理装置1は、駐車場のような広い空間内に車両が存在する場合に、当該空間内に存在する電柱などの柱状物を、それぞれ第1基準部〜第3基準部として定める。
ここで、駐車場において3つの基準部に基づき自車位置Pを算出する具体例について、引き続き図7を参照して説明する。
まず、情報処理装置1は、GPSなどのGNSSなどにより、暫定自車位置Pgを決定する。次に、情報処理装置1は、位置A〜Cに対応する第1基準部〜第3基準部を、地図DB4上及び角度対応画像Ia内において特定する。この場合、情報処理装置1は、暫定自車位置Pgの最大誤差より位置A〜Cが互いに離れるように(最大誤差よりも位置A〜Cの間隔が長くなるように)、第1基準部〜第3基準部を選定することが好ましい。そして、情報処理装置1は、角度対応画像Iaに基づき、角度θ1及び角度θ2を算出すると共に、地図DB4の基準部位置情報等を参照することで、距離L1及び距離L2を決定する。
そして、情報処理装置1は、「(2−1)汎用例」のセクションで説明した方法と同様に、三角形A−B−Pの外接円CL1の半径R1とその中心O1の座標(x1、y1)、及び、三角形B−C−Pの外接円CL2の半径R2とその中心O2の座標(x2、y2)を求める。そして、情報処理装置1は、外接円CL1及び外接円CL2に関する以下の2次方程式
(X−x1)2+(Y−y1)2=R12
(X−x2)2+(Y−y2)2=R22
を解くことで、自車位置Pを算出する。この場合、上述の2次方程式の解は原則的には2つ存在するが、2つの解の1つは位置Bと一致する。よって、情報処理装置1は、上述の2次方程式の解により、自車位置Pを好適に決定することができる。
(X−x1)2+(Y−y1)2=R12
(X−x2)2+(Y−y2)2=R22
を解くことで、自車位置Pを算出する。この場合、上述の2次方程式の解は原則的には2つ存在するが、2つの解の1つは位置Bと一致する。よって、情報処理装置1は、上述の2次方程式の解により、自車位置Pを好適に決定することができる。
(3)処理フロー
図8は、本実施例において情報処理装置1が実行する自車位置Pの算出方法の手順を示すフローチャートである。
図8は、本実施例において情報処理装置1が実行する自車位置Pの算出方法の手順を示すフローチャートである。
まず、情報処理装置1は、GPS受信機72等の出力に基づき暫定自車位置Pgを取得する(ステップS11)。そして、情報処理装置1は、地図DB4を参照し、暫定自車位置Pg周辺の少なくとも3つの基準部を選定する(ステップS12)。例えば、情報処理装置1は、図5又は図7を用いて説明した自車位置Pの算出方法の場合には、3つの基準部を選定し、図6を用いて説明した自車位置Pの算出方法の場合には、少なくとも4つの基準部を選定する。
そして、情報処理装置1は、選定した基準部の組み合わせにより構成される2つの基線の長さ(図4〜図7では距離L1及び距離L2)を算出する(ステップS13)。例えば、情報処理装置1は、基線の両端位置となる基準部の絶対位置を示す基準部位置情報を地図DB4から参照することで、上述の基線の長さをそれぞれ算出する。
なお、地図DB4には、基線を構成する基準部の組み合わせ及び当該基線の長さに関する情報が含まれてもよい。この場合、情報処理装置1は、当該情報を参照することで、各基線を構成する基準部の組み合わせと各基線の長さとを決定することができる。
次に、情報処理装置1は、カメラ71が出力する角度対応画像Iaに基づき、各基線を構成する各基準部を検出し、各基線の両端がなす角度(図4〜図7では角度θ1と角度θ2)を算出する(ステップS14)。この場合、例えば、情報処理装置1は、角度対応画像Ia中においてステップS12で選定した各基準部を検出し、検出した各基準部のうち、基線の両端となる基準部間の画素数に基づき、上述の角度を算出する。なお、情報処理装置1は、角度と画素とが対応していない画像をカメラ71が出力する場合には、当該画像から角度対応画像Ia又はこれと同等の情報を生成することで、上述の角度を算出してもよい。
そして、情報処理装置1は、ステップS13で算出した各基線の長さ及びステップS14で算出した各基線の両端がなす角度等に基づき、自車位置Pを算出する(ステップS15)。この場合、情報処理装置1は、例えば、2つの基線が連結するように3つの基準部を選定した場合には、正弦定理に基づく自車位置Pの算出方法(図4及び図5参照)又は円周角の定理に基づく自車位置Pの算出方法(図7参照)のいずれかを用いて自車位置Pを算出する。一方、情報処理装置1は、4つ以上の基準部を選定する場合には、円周角の定理に基づく自車位置Pの算出方法(図6参照)を用いて自車位置Pを算出する。
次に、本実施例による効果について補足説明する。
現在考えられている高精度位置推定方法として、道路周辺の地物等の特徴点までの距離及び方向等を推定し、地図データに記録された特徴点の情報と比較することで、車両の現在位置及び姿勢を算出する方法が存在する。この場合、特徴点を検出する外界センサとしては、例えば、カメラ、ライダ、レーダなどを用いる。
上述の位置推定方法の第1の問題点は、検出すべき特徴点を正確に測ることができる車両の位置が限られていることである。そのため、車両が移動して複数の特徴点を確認できるまでは、正確な位置推定ができない場合がある。上述の位置推定方法の第2の問題点は、特徴点を検出する外界センサの種類によって取得するデータが異なり、互換性の確保が難しいことである。上述の位置推定方法の第3の問題点は、道路周辺の地物等の特徴点が変化しやすいことである。特徴点として採用される広告看板や標識などは、変更されることが多い。また、路面ペイントは(特に雪国等において)劣化しやすく、描き直したペイントが前回のペイントと同一でない場合もある。上述の位置推定方法の第4の問題点は、特徴点の情報として地図データに記憶するデータ量が膨大になりやすいことである。例えば、ライダ等において用いられる占有格子地図(Occupancy Grid Map:OGM)、NDT(Normal Distributions Transform)データ等は、データ量が大きい。上述の位置推定方法の第5の問題点は、地図データに記憶する特徴点の情報を生成するのに車両を用いて実測する必要があり、手間がかかることである。
これに対し、本実施例に係る自車位置Pの算出方法は、第1の問題点に関し、道路よりも遠い位置に存在する基準部を用いることができるため、自車位置Pの算出可能な範囲が広いという利点がある。また、ビルや家などの建物は、2階建て以上になることが多いため、路肩に駐車中の車両が存在する場合であっても、建物のエッジ部分等を基準部として好適に計測することが可能である。同様に、電柱を基準部として用いる場合であっても、電柱は支える電線の下を車両が通過できるように12m程度(3階建て)の高さがあるため、路肩に駐車中の車両等の存在によらずに好適に計測を行うことができる。また、基準部として鉛直なエッジ部分等を計測するため、計測が比較的容易であり、かつ、計測を行う車両の姿勢によらずに計測を行うことが可能である。
また、第2の問題に関し、本実施例に係る自車位置Pの算出方法では、カメラを用いる実施例について説明したが、必要な基準部の車両に対する方向を検出可能な外界センサであればライダ等の他の外界センサを用いてもよく、使用する外界センサの種別に依存しないという利点がある。第3の問題に関し、本実施例に係る自車位置Pの算出方法では、電柱や信号機などの柱状物や建物の鉛直なエッジ部分を使用するため、看板や標識、建築物の壁の模様などが変わっても位置推定精度に影響がないという利点がある。なお、建物の柱の構造は、設計及び建設時に行政による許認可があり、建設後に無断で形を変形することができない。また、建物の耐用年数は30年から50年以上あるため、建て替え等が頻繁に生じない。
第4の問題に関し、本実施例に係る自車位置Pの算出方法では、基準部毎に位置情報が地図データに格納されていればよいため、必要なデータ量は、NDTデータ等と比較して遥かに小さい。第5の問題点に関し、本実施例に係る自車位置Pの算出方法では、電柱や信号機などの柱状物や建物の鉛直なエッジ部分を基準部とし、地図DB4にそれらの位置情報を格納させる。この位置情報は、例えば航空写真計測により求めることも可能であり、車両を用いて実測することなく基準部の位置情報を生成することが可能である。
以上説明したように、本実施例に係る情報処理装置1は、車両周辺の地物を含む角度対応画像Iaを取得し、角度対応画像Ia中の地物に関連する少なくとも3つの基準部を抽出する。そして、情報処理装置1は、少なくとも3つの基準部から基準部の組み合わせを少なくとも2つ選択し、組み合わせの各々に対し、組み合わせに対する車両位置を基準とした角度に関する情報を取得する。そして、情報処理装置1は、地図DB4に基づき、上述の組み合わせに対応する2つの基準部の地図上における位置情報と、上述の組み合わせに対応する基線の長さに関する情報と、を夫々取得する。そして、情報処理装置1は、上述の角度に関する情報と、上述の長さに関する情報と、上述の位置情報と、から、地図上における車両の位置である自車位置Pを算出する。これにより、情報処理装置1は、自車位置Pを好適に算出することができる。
[変形例]
次に、上述の実施例に好適な変形例について説明する。以下の変形例は、任意に組み合わせて上述の実施例に適用してもよい。
次に、上述の実施例に好適な変形例について説明する。以下の変形例は、任意に組み合わせて上述の実施例に適用してもよい。
(変形例1)
情報処理装置1は、カメラ71から取得した角度対応画像Iaを用いて第1基線及び第2基線に関する角度θ1及び角度θ2(図4〜図7参照)を算出する代わりに、他の外界センサが出力するデータを用いて上述の角度θ1及び角度θ2を算出してもよい。例えば、情報処理装置1は、ライダの出力に基づき、上述の角度θ1及び角度θ2を算出してもよい。
情報処理装置1は、カメラ71から取得した角度対応画像Iaを用いて第1基線及び第2基線に関する角度θ1及び角度θ2(図4〜図7参照)を算出する代わりに、他の外界センサが出力するデータを用いて上述の角度θ1及び角度θ2を算出してもよい。例えば、情報処理装置1は、ライダの出力に基づき、上述の角度θ1及び角度θ2を算出してもよい。
この場合、例えば、ライダは、照射方向を変えながらレーザ光を照射する照射部と、照射したレーザ光が物体で反射した反射光(散乱光)を受光する受光部と、受光部が出力する受光信号に基づく走査情報(スキャンデータ)を出力する出力部とを有する。走査情報は、受光部が受光したレーザ光に対応する照射方向と、その照射方向での物体までの距離との組み合わせを示す点群データである。従って、情報処理装置1は、ライダが生成した点群データから、第1基線及び第2基線の両端を構成する基準部に相当する点群データを抽出し、抽出した点群データが示す上述の照射方向に基づき、上述の角度θ1及び角度θ2を算出する。この場合、例えば、情報処理装置1は、第1基線の一端を構成する基準部に相当する点群データが示す照射方向の平均値と、第1基線の他端を構成する基準部に相当する点群データが示す照射方向の平均値との差を、角度θ1として算出する。同様に、情報処理装置1は、第2基線の一端を構成する基準部に相当する点群データが示す照射方向の平均値と、第2基線の他端を構成する基準部に相当する点群データが示す照射方向の平均値との差を、角度θ2として算出する。
この態様によっても、情報処理装置1は、本実施例における自車位置Pの算出に必要な、基線の両端がなす角度を好適に算出することができる。
(変形例2)
情報処理装置1が実行する自車位置Pの算出処理を、車両に存在する端末装置と通信を行うサーバ装置が実行してもよい。
情報処理装置1が実行する自車位置Pの算出処理を、車両に存在する端末装置と通信を行うサーバ装置が実行してもよい。
図9は、変形例2における自車位置算出システムの構成例を示す。図9に示すように、変形例2に係る自車位置算出システムは、サーバ装置に相当する情報処理装置1Aと、車両と共に移動する端末装置1Bとを有する。情報処理装置1Aと端末装置1Bとは、通信網5を介してデータ通信を行う。また、端末装置1Bは、例えば、図1に示す情報処理装置1と同等の構成を有し、カメラ71から角度対応画像Iaを取得する。
この場合、情報処理装置1Aは、図2に示す地図DB4のデータ構造と同等のデータ構造を有する地図データを記憶しており、端末装置1Bから供給される情報に基づき、図8のフローチャートの処理を実行する。この場合、情報処理装置1Aは、ステップS11において、端末装置1BからGPS等に基づく暫定自車位置Pgの情報を受信し、ステップS12において、地図データを参照して少なくとも3つの基準部を選定する。また、情報処理装置1Aは、ステップS13において、地図データを参照することで、各基線の長さ(距離L1及び距離L2)を算出する。また、情報処理装置1Aは、ステップS14において、端末装置1Bから供給される角度対応画像Iaに基づき、各基準部を検出し、各基線の両端がなす角度(角度θ1及び角度θ2)を算出する。そして、情報処理装置1Aは、ステップS15において、上述の基線の長さ及び角度等に基づき、自車位置Pを算出する。そして、情報処理装置1Aは、算出した自車位置Pの情報を端末装置1Bへ送信する。
このように、情報処理装置1Aは、端末装置1Bから受信する情報に基づき、端末装置1Bが存在する車両に対する自車位置Pを算出することができる。
(変形例3)
情報処理装置1は、第1基線と第2基線に用いた基準部とは異なる基準部に基づき設定した第3基線の両端がなす角度θ3に基づき、参照した基準部情報が示す基準部と、実際に計測した基準部との同一性を判定してもよい。
情報処理装置1は、第1基線と第2基線に用いた基準部とは異なる基準部に基づき設定した第3基線の両端がなす角度θ3に基づき、参照した基準部情報が示す基準部と、実際に計測した基準部との同一性を判定してもよい。
具体的には、情報処理装置1は、自車位置Pの算出後、第1基線と第2基線に用いた基準部とは異なる基準部を一端とする第3基線を設定し、自車位置Pを基準とした第3基線の両端がなす角度θ3を計測する。そして、情報処理装置1は、地図DB4に記録された第3基線の両端をなす基準部の位置情報と、算出した自車位置Pとに基づき、算出した自車位置Pを基準とした第3基線の両端がなす角度θ3を理論的に(即ち地図上において)算出する。そして、情報処理装置1は、計測した角度θ3と、理論的に算出した角度θ3とが所定差以内である場合、参照した基準部情報が示す基準部と、実際に計測した基準部とが正しく対応していると判定する。この場合、情報処理装置1は、算出した自車位置Pが正確であるとみなし、当該自車位置Pを用いて地図表示の制御や車両の制御などを行う。一方、情報処理装置1は、計測した角度θ3と、理論的に算出した角度θ3とが所定差より大きい場合、参照した基準部情報が示す基準部と、実際に計測した基準部とが正しく対応していないと判定する。この場合、情報処理装置1は、算出した自車位置Pは正確でないと判定し、当該自車位置Pの算出に用いた基準部とは異なる基準部を基準として再び自車位置Pの算出を行う。角度θ3は、本発明における「第2角度」の一例である。
この態様により、情報処理装置1は、参照した基準部情報が示す基準部と、実際に計測した基準部との同一性を的確に判定し、算出した自車位置Pの正確性の検証を好適に行うことができる。
1、1A 情報処理装置
1B 端末装置
4 地図DB
6 センサデータキャッシュ
11 通信部
12 記憶部
13 入力部
14 制御部
15 インターフェース
16 表示部
17 音出力部
1B 端末装置
4 地図DB
6 センサデータキャッシュ
11 通信部
12 記憶部
13 入力部
14 制御部
15 インターフェース
16 表示部
17 音出力部
Claims (10)
- 移動体の周辺の地物を含む画像を取得する第1取得部と、
前記画像中の前記地物に関連する少なくとも3つの基準部を抽出する抽出部と、
前記少なくとも3つの基準部から基準部の組み合わせを少なくとも2つ選択し、前記組み合わせの各々に対し、前記組み合わせに対する前記移動体の位置を基準とした角度に関する情報を取得する第2取得部と、
地図情報に基づき、前記組み合わせに対応する2つの基準部の地図上における位置情報と、前記組み合わせに対応する2つの基準部間の長さに関する情報と、を夫々取得する第3取得部と、
前記角度に関する情報と、前記長さに関する情報と、前記位置情報と、から、地図上における移動体の位置を算出する算出部と、
を有する情報処理装置。 - 前記画像は、極座標球面上に投影された画像中の隣り合う画素に対して当該極座標球面の中心からそれぞれ引いた仮想線同士がなす第1角度が対応している画像であり、
前記第2取得部は、前記画像中における基準部の組み合わせ毎に、当該組み合わせに対応する2つの基準部間の画素数を求め、当該画素数に前記第1角度を乗じることで、前記角度に関する情報を取得する、請求項1に記載の情報処理装置。 - 前記地図情報は、前記基準部の各々の地図上における位置情報を含み、
前記第3取得部は、前記基準部間の長さに関する情報を、当該基準部の地図上における位置情報に基づき生成する、請求項1または2に記載の情報処理装置。 - 前記抽出部は、前記地物に関連する3つの基準部を抽出し、
前記第2取得部は、当該3つの基準部から、前記基準部の組み合わせを2つ選択し、
前記算出部は、選択された2つの前記組み合わせに対応する、前記角度に関する情報及び前記長さに関する情報に基づき、前記位置を算出する、請求項1〜3のいずれか一項に記載の情報処理装置。 - 前記抽出部は、略鉛直方向に延在する地物又は地物の略鉛直部分を、前記基準部として抽出する、請求項1〜4のいずれか一項に記載の情報処理装置。
- 前記第2取得部は、前記少なくとも3つの基準部とは異なる基準部を含む基準部の組み合わせに対する前記移動体の位置を基準とした角度である第2角度に関する情報をさらに取得し、
前記算出部は、前記地図情報と前記算出部が算出した前記移動体の位置とに基づき算出した第2角度と、前記第2取得部が取得した第2角度とに基づき、前記算出部が算出した前記移動体の位置の検証を行う、請求項1〜5のいずれか一項に記載の情報処理装置。 - 移動体の周辺の地物に対して電磁波を走査することで得られる走査情報を取得する第1取得部と、
前記走査情報に基づき、前記地物に関連する少なくとも3つの基準部から基準部の組み合わせを少なくとも2つ選択し、前記組み合わせの各々に対し、前記組み合わせに対する前記移動体の位置を基準とした角度に関する情報を取得する第2取得部と、
地図情報に基づき、前記組み合わせに対応する2つの基準部の地図上における位置情報と、前記組み合わせに対応する2つの基準部間の長さに関する情報と、を夫々取得する第3取得部と、
前記角度に関する情報と、前記長さに関する情報と、前記位置情報と、から、地図上における移動体の位置を算出する算出部と、
を有する情報処理装置。 - 情報処理装置が実行する制御方法であって、
移動体の周辺の地物を含む画像を取得する第1取得工程と、
前記画像中の前記地物に関連する少なくとも3つの基準部を抽出する抽出工程と、
前記少なくとも3つの基準部から基準部の組み合わせを少なくとも2つ選択し、前記組み合わせの各々に対し、前記組み合わせに対する前記移動体の位置を基準とした角度に関する情報を取得する第2取得工程と、
地図情報に基づき、前記組み合わせに対応する2つの基準部の地図上における位置情報と、前記組み合わせに対応する2つの基準部間の長さに関する情報と、を夫々取得する第3取得工程と、
前記角度に関する情報と、前記長さに関する情報と、前記位置情報と、から、地図上における移動体の位置を算出する算出工程と、
を有する制御方法。 - コンピュータが実行するプログラムであって、
移動体の周辺の地物を含む画像を取得する第1取得部と、
前記画像中の前記地物に関連する少なくとも3つの基準部を抽出する抽出部と、
前記少なくとも3つの基準部から基準部の組み合わせを少なくとも2つ選択し、前記組み合わせの各々に対し、前記組み合わせに対する前記移動体の位置を基準とした角度に関する情報を取得する第2取得部と、
地図情報に基づき、前記組み合わせに対応する2つの基準部の地図上における位置情報と、前記組み合わせに対応する2つの基準部間の長さに関する情報と、を夫々取得する第3取得部と、
前記角度に関する情報と、前記長さに関する情報と、前記位置情報と、から、地図上における移動体の位置を算出する算出部
として前記コンピュータを機能させる、プログラム。 - 請求項9に記載のプログラムを記憶した記憶媒体。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019109518A JP2020201180A (ja) | 2019-06-12 | 2019-06-12 | 情報処理装置、制御方法、プログラム及び記憶媒体 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019109518A JP2020201180A (ja) | 2019-06-12 | 2019-06-12 | 情報処理装置、制御方法、プログラム及び記憶媒体 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2020201180A true JP2020201180A (ja) | 2020-12-17 |
Family
ID=73743363
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019109518A Pending JP2020201180A (ja) | 2019-06-12 | 2019-06-12 | 情報処理装置、制御方法、プログラム及び記憶媒体 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2020201180A (ja) |
-
2019
- 2019-06-12 JP JP2019109518A patent/JP2020201180A/ja active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108362295B (zh) | 车辆路径引导设备和方法 | |
Brenner | Extraction of features from mobile laser scanning data for future driver assistance systems | |
RU2668459C1 (ru) | Устройство оценки положения и способ оценки положения | |
US10240934B2 (en) | Method and system for determining a position relative to a digital map | |
EP3343172B1 (en) | Creation and use of enhanced maps | |
CN108627175A (zh) | 用于识别车辆位置的系统和方法 | |
WO2015096717A1 (zh) | 一种定位方法及装置 | |
US8571265B2 (en) | Measurement apparatus, measurement method, and feature identification apparatus | |
US11519738B2 (en) | Position calculating apparatus | |
JP2020500290A (ja) | 位置特定基準データを生成及び使用する方法及びシステム | |
WO2018181974A1 (ja) | 判定装置、判定方法、及び、プログラム | |
CN105512646A (zh) | 一种数据处理方法、装置及终端 | |
JP2011511281A (ja) | センサにより検出されたオブジェクトとマップマッチングする方法 | |
US20210003415A1 (en) | Submap geographic projections | |
JP5501101B2 (ja) | 位置標定装置、位置標定方法および位置標定プログラム | |
KR102475039B1 (ko) | 지도 정보 갱신 장치, 방법 및 시스템 | |
JP2018116014A (ja) | 自車位置推定装置、制御方法、プログラム及び記憶媒体 | |
JP2019513996A (ja) | 地上標識による周辺内の少なくとも部分自動運転走行車両の姿勢の決定方法 | |
JP5557472B2 (ja) | 道路レーンデータ生成装置、道路レーンデータ生成方法および道路レーンデータ生成プログラム | |
EP4012341A1 (en) | Camera calibration for localization | |
CN113316706A (zh) | 路标位置估计设备和方法以及存储被编程为执行该方法的计算机程序的计算机可读记录介质 | |
WO2017199369A1 (ja) | 地物認識装置、地物認識方法およびプログラム | |
US11482098B2 (en) | Localization in complex traffic scenarios with the aid of markings | |
JP4953015B2 (ja) | 自車位置認識装置と自車位置認識プログラム、及びこれを用いたナビゲーション装置 | |
KR102475042B1 (ko) | 정밀 지도 구축 장치 및 방법 |