JPWO2017199333A1 - 情報出力装置、端末装置、制御方法、プログラム及び記憶媒体 - Google Patents

情報出力装置、端末装置、制御方法、プログラム及び記憶媒体 Download PDF

Info

Publication number
JPWO2017199333A1
JPWO2017199333A1 JP2018517966A JP2018517966A JPWO2017199333A1 JP WO2017199333 A1 JPWO2017199333 A1 JP WO2017199333A1 JP 2018517966 A JP2018517966 A JP 2018517966A JP 2018517966 A JP2018517966 A JP 2018517966A JP WO2017199333 A1 JPWO2017199333 A1 JP WO2017199333A1
Authority
JP
Japan
Prior art keywords
information
unit
feature
point group
output
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.)
Withdrawn
Application number
JP2018517966A
Other languages
English (en)
Inventor
岩井 智昭
智昭 岩井
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Pioneer Corp
Original Assignee
Pioneer Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Pioneer Corp filed Critical Pioneer Corp
Publication of JPWO2017199333A1 publication Critical patent/JPWO2017199333A1/ja
Withdrawn legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/86Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/89Lidar systems specially adapted for specific applications for mapping or imaging
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/93Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/931Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/003Transmission of data between radar, sonar or lidar systems and remote stations
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/50Context or environment of the image
    • G06V20/56Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/58Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/9316Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles combined with communication equipment with other vehicles or with base stations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/9322Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles using additional data, e.g. driver condition, road state or weather data
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/9323Alternative operation using light waves

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Electromagnetism (AREA)
  • Automation & Control Theory (AREA)
  • Multimedia (AREA)
  • Theoretical Computer Science (AREA)
  • Traffic Control Systems (AREA)
  • Navigation (AREA)

Abstract

サーバ装置4は、3次元点群DB43を記憶し、ライダ2の特性に関するライダ特性情報IL及び予測自車位置Pprを含む点群情報要求信号Srを車載機1から受信した場合に、ライダ2によるスキャン対象空間を特定する。そして、サーバ装置4は、特定したスキャン対象空間内の点群に相当する地図点群情報Daを3次元点群DB43から抽出し、車載機1へ送信する。

Description

本発明は、情報を出力する技術に関する。
従来から、外界センサを用いて現在位置を高精度に推定する技術が知られている。例えば、特許文献1には、移動体周辺のランドマークを観測する外界センサの観測結果と、環境全域におけるランドマークに関する情報を収めた大域地図とのマッチングを行うことで、自己位置を推定する技術が開示されている。
特開2008−165275号公報
自動運転における自己位置推定の場合、特許文献1に記載のような大域地図のデータ容量は膨大となるため、サーバ装置が大域地図を管理し、移動体側の端末が適宜サーバ装置から自己位置周辺のランドマークの情報を取得することになる。この場合、移動体側の端末は、周辺に存在するランドマークの情報を全てサーバ装置から取得することになると、通信量が多くなってしまい、自己位置推定に必要な情報を選定する処理負荷等も増加するという問題がある。
本発明は、例えば、上記のような課題を解決するためになされたものであり、出力させるデータ量を好適に低減させることが可能な情報出力装置を提供することを主な目的とする。
請求項に記載の発明は、情報出力装置であって、移動体に配置された外界検出装置の特性に関する特性情報を取得する取得部と、前記特性情報に基づいて、記憶部に記憶された地物を示す地物情報から前記地物情報の一部を抽出して出力する出力部と、を備える。
また、請求項に記載の発明は、外界検出装置が配置された移動体と共に移動する端末装置であって、前記外界検出装置の特性に関する特性情報を記憶する記憶部と、前記特性情報を請求項1〜4のいずれか一項に記載の情報出力装置に送信する送信部と、前記情報出力装置から地物情報を受信する受信部と、前記地物情報と、前記外界検出装置の検出情報とに基づき現在位置を推定する推定部と、を備える。
また、請求項に記載の発明は、情報出力装置が実行する制御方法であって、移動体に配置された外界検出装置の特性に関する特性情報を取得する取得工程と、前記特性情報に基づいて、記憶部に記憶された地物を示す地物情報から前記地物情報の一部を抽出して出力する出力工程と、を有する。
また、請求項に記載の発明は、コンピュータが実行するプログラムであって、移動体に配置された外界検出装置の特性に関する特性情報を取得する取得部と、前記特性情報に基づいて、記憶部に記憶された地物を示す地物情報から前記地物情報の一部を抽出して出力する出力部として前記コンピュータを機能させる。
高度化地図システムの概略構成である。 (A)車載機の概略構成を示す。(B)ライダ特性情報のデータ構造を示す。 サーバ装置の概略構成を示す。 車載機の機能的な構成を示すブロック図である。 (A)ライダが出力するレーザが車載機周辺にある建物等の地物に照射される様子を示した図である。(B)レーザの照射位置となる点群を抽出した図である。 (A)3次元点群DBに登録されている自車位置周辺の点群を可視化した図である。(B)地図点群情報に対応する点群を抽出した図である。 実施例に係る自車位置推定処理の手順を示すフローチャートである。
本発明の好適な実施形態によれば、情報出力装置であって、移動体に配置された外界検出装置の特性に関する特性情報を取得する取得部と、前記特性情報に基づいて、記憶部に記憶された地物を示す地物情報から前記地物情報の一部を抽出して出力する出力部と、を備える。ここで、「地物情報の一部を抽出」とは、記憶部に記憶された地物情報から特性情報に基づいてその一部を抽出することを指す。よって、所定個数の地物の各々に対する地物情報が記憶部に記憶されている場合に、全体が該当する地物に対する地物情報をそのまま抽出する態様や、一部が該当する地物に対する地物情報の該当部分を切り出して抽出する態様も含まれる。この実施形態によれば、情報出力装置は、外界検出装置の特性に関する特性情報に基づいて、出力すべき地物情報を好適に限定することができる。
上記情報出力装置の一態様では、前記出力部は、前記特性情報に基づき前記外界検出装置の検出範囲を特定し、当該検出範囲内に存在する地物の地物情報を抽出して出力する。この態様により、情報出力装置は、好適に外界検出装置の検出範囲内の地物情報を出力し、外界検出装置の検出情報とのマッチング等に活用させることができる。
上記情報出力装置の他の一態様では、前記特性情報には、前記外界検出装置の設置位置の高さに関する情報、又は、水平方向又は/及び垂直方向において前記外界検出装置が検出を行う範囲に関する情報が含まれる。この態様により、情報出力装置は、好適に外界検出装置の検出範囲を特定し、抽出すべき地物情報を決定することができる。
上記情報出力装置の他の一態様では、前記取得部は、前記外界検出装置の検出情報を受信する端末装置から前記特性情報及び前記移動体の位置情報を受信し、前記出力部は、前記特性情報及び前記位置情報に基づき抽出した前記地物情報を前記端末装置へ送信する。この態様により、情報出力装置は、外界検出装置の検出情報と当該検出情報に対応する地物情報とを好適に端末装置に取得させることができる。
本発明の他の好適な実施形態によれば、外界検出装置が配置された移動体と共に移動する端末装置であって、前記外界検出装置の特性に関する特性情報を記憶する記憶部と、前記特性情報を上記いずれか記載の情報出力装置に送信する送信部と、前記情報出力装置から地物情報を受信する受信部と、前記地物情報と、前記外界検出装置の検出情報とに基づき現在位置を推定する推定部と、を備える。この態様によれば、端末装置は、地物情報を記憶する情報出力装置から現在位置の推定に必要な最小限の地物情報を受信し、現在位置の推定を効率的に行うことができる。
上記端末装置の一態様では、前記検出情報及び前記地物情報は、点群情報であり、前記推定部は、前記検出情報が示す点群と、当該点群に対応する前記地物情報が示す点群との位置の誤差に基づき、前記現在位置を推定する。この態様により、端末装置は、情報出力装置が予め記憶した地物の点群情報を基準として、外界検出装置が出力する点群情報から正確に自己位置を推定することが可能となる。
上記端末装置の他の一態様では、端末装置は、測定部の出力に基づく現在位置の予測値を取得する位置予測部をさらに備え、前記推定部は、前記地物情報と前記検出情報とに基づき前記予測値を補正することで、前記現在位置の推定値を算出する。この態様により、端末装置は、測定部が測定した現在位置よりも高精度な現在位置を取得することができる。
本発明の他の好適な実施形態によれば、情報出力装置が実行する制御方法であって、移動体に配置された外界検出装置の特性に関する特性情報を取得する取得工程と、前記特性情報に基づいて、記憶部に記憶された地物を示す地物情報から前記地物情報の一部を抽出して出力する出力工程と、を有する。情報出力装置は、この制御方法を実行することで、外界検出装置の特性に関する特性情報に基づいて、出力すべき地物情報を好適に限定することができる。
本発明の他の好適な実施形態によれば、コンピュータが実行するプログラムであって、移動体に配置された外界検出装置の特性に関する特性情報を取得する取得部と、前記特性情報に基づいて、記憶部に記憶された地物を示す地物情報から前記地物情報の一部を抽出して出力する出力部として前記コンピュータを機能させる。コンピュータは、このプログラムを実行することで、外界検出装置の特性に関する特性情報に基づいて、出力すべき地物情報を好適に限定することができる。好適には、上記プログラムは、記憶媒体に記憶される。
以下、図面を参照して本発明の好適な実施例について説明する。実施例において、点群とは、3次元位置が特定される点の集合体を指し、3次元点群とは、3次元に(即ち空間的に)分布する点群を指すものとする。
[高度化地図システムの概要]
図1は、本実施例に係る高度化地図システムの概略構成である。高度化地図システムは、車両と共に移動する車載機1と、車載機1により制御されるライダ(Lidar:Light Detection and Ranging、または、Laser Illuminated Detection And Ranging)2と、道路周辺の地物(天然物及び人工物の両方を含む。)の表面を離散的に構成する3次元点群のデータベースである3次元点群DB43を記憶するサーバ装置4とを備える。そして、高度化地図システムは、ライダ2により計測された点群と、3次元点群DB43に登録された点群とのマッチングを行うことにより、高精度な自車位置推定を行う。
車載機1は、ライダ2と電気的に接続され、地物を検知するためのライダ2の光の出射制御を行う。本実施例では、車載機1は、ライダ2の特性に関する情報(「ライダ特性情報IL」とも呼ぶ。)を予め記憶する。そして、車載機1は、後述するGPS受信機等の測定部の出力により予測した自車位置(「予測自車位置Ppr」とも呼ぶ。)とライダ特性情報ILとを含む要求信号(「点群情報要求信号Sr」とも呼ぶ。)をサーバ装置4へ送信する。これにより、車載機1は、ライダ特性情報IL及び予測自車位置Pprに基づき3次元点群DB43から抽出された点群情報(「地図点群情報Da」とも呼ぶ。)を、サーバ装置4から受信する。そして、車載機1は、ライダ2から出力された点群情報(「計測点群情報Db」とも呼ぶ。)と、サーバ装置4から受信した地図点群情報Daとに基づき、予測自車位置Pprの誤差を算出し、当該誤差により予測自車位置Pprを補正した自車位置の推定値を算出する。車載機1は、本発明における「端末装置」の一例である。
ライダ2は、水平方向および垂直方向の所定の角度範囲に対してパルスレーザを出射することで、外界に存在する物体までの距離を離散的に測定し、当該物体の位置を示す3次元の点群情報を計測点群情報Dbとして生成する。この場合、ライダ2は、照射方向を変えながらレーザ光を出射する出射部と、照射したレーザ光の反射光(散乱光)を受光する受光部と、受光部が出力する受光信号に基づく点群情報を出力する出力部とを有する。点群情報は、受光部が受光したレーザ光に対応する照射方向と、上述の受光信号に基づき特定される当該レーザ光の応答遅延時間とに基づき生成される。なお、ライダ2は、垂直方向へは走査することなく水平方向の所定角度範囲のみに対してパルスレーザを出射して2次元の点群情報を生成するものであってもよい。そして、ライダ2は、生成した計測点群情報Dbを車載機1へ供給する。計測点群情報Dbは、車載機1を基準とした相対的な座標系(単に「相対座標系」とも呼ぶ。)により表される。ライダ2は、本発明における「外界検出装置」の一例である。
サーバ装置4は、3次元点群DB43を含む地図データを記憶する。サーバ装置4は、車載機1から点群情報要求信号Srを受信した場合に、点群情報要求信号Srに含まれるライダ特性情報IL及び予測自車位置Pprに基づき、ライダ2が計測する空間(「スキャン対象空間」とも呼ぶ。)を認識し、当該スキャン対象空間内の位置を指し示す点群の情報である地図点群情報Daを3次元点群DB43から抽出して車載機1へ送信する。サーバ装置4は、本発明における「情報出力装置」の一例である。また、スキャン対象空間は、本発明における「検出範囲」の一例であり、3次元空間に限らず2次元空間の場合も含む。
図2(A)は、車載機1の機能的構成を示すブロック図である。車載機1は、主に、通信部11と、記憶部12と、センサ部13と、入力部14と、制御部15と、出力部16とを有する。これらの各要素は、バスラインを介して相互に接続されている。
通信部11は、制御部15の制御に基づき、サーバ装置4とデータ通信を行う。
記憶部12は、制御部15が実行するプログラムや、制御部15が所定の処理を実行するのに必要な情報を記憶する。また、本実施例では、記憶部12は、ライダ特性情報ILを予め記憶しておく。ライダ特性情報ILは、本発明における「特性情報」の一例である。
図2(B)は、ライダ特性情報ILのデータ構造の一例である。図2(B)に示すように、ライダ特性情報ILは、設置高さ情報と、スキャン範囲情報とを含む。ここで、設置高さ情報は、ライダ2が配置される車両に対するライダ2の相対的な設置高さを示す情報であり、例えば、車両が水平面上に存在する場合の当該水平面に対する高さを示す。スキャン範囲情報は、車両に対するライダ2の相対的な計測可能範囲を示す情報であり、例えば、所定の方向(例えば車両の進行方向)を基準とした場合のライダ2によるスキャンの水平角度範囲及び垂直角度範囲と、ライダ2の計測可能距離(即ちスキャン距離)と、ライダ2のレーザが照射されるスキャン面の層数を示す照射層数又はライダ2のレーザ送受信センサの個数(センサ数)と、隣り合う照射面間での角度を示す層間角度とを含む。なお、ライダ2が水平なスキャン面を垂直方向に移動させることで3次元スキャンを行う場合、スキャン範囲情報は、上述の垂直角度範囲に代えて、スキャン面の層数(即ち走査線の数)の情報を含んでもよい。記憶部12は、例えば実験等に基づき予め計測されたこれらの設置高さ情報及びスキャン範囲情報等を、ライダ特性情報ILとして予め記憶しておく。
再び図2(A)に戻り車載機1の構成について説明する。センサ部13は、車両の状態を検出するセンサであり、GPS受信機32と、IMU(Inertial Measurement Unit)33などを含む。本実施例では、制御部15は、センサ部13の出力に基づき、予測自車位置Pprを算出する。センサ部13は、本発明における「測定部」の一例である。
入力部14は、ユーザが操作するためのボタン、タッチパネル、リモートコントローラ、音声入力装置等であり、出力部16は、例えば、制御部15の制御に基づき出力を行うディスプレイやスピーカ等である。
制御部15は、プログラムを実行するCPUなどを含み、車載機1の全体を制御する。本実施例では、制御部15は、例えば所定の時間間隔ごとに、センサ部13の出力に基づき算出した予測自車位置Pprと記憶部12に記憶されたライダ特性情報ILとを含む点群情報要求信号Srを、通信部11によりサーバ装置4へ送信する。そして、通信部11が点群情報要求信号Srの応答として地図点群情報Daを受信した場合に、制御部15は、地図点群情報Daが示す点群と、ライダ2が出力する計測点群情報Dbが示す点群とのマッチングを行うことで、予測自車位置Pprの誤差(ずれ)を示す情報(「誤差情報dP」とも呼ぶ。)を生成する。そして、制御部15は、誤差情報dPが示す誤差分だけ修正した予測自車位置Pprを、自車位置の推定値として算出する。制御部15は、本発明における「位置予測部」、「送信部」、「受信部」及び「推定部」の一例である。
図3は、サーバ装置4の機能的構成を示すブロック図である。サーバ装置4は、主に、通信部41と、記憶部42と、制御部45とを有する。これらの各要素は、バスラインを介して相互に接続されている。通信部41は、制御部45の制御に基づき、車載機1とデータ通信を行う。
記憶部42は、制御部45が実行するプログラムや、制御部45が所定の処理を実行するのに必要な情報を記憶する。本実施例では、記憶部42は、3次元点群DB43を含む地図データを記憶する。3次元点群DB43は、地図データに登録された各道路の周辺に存在する地物の表面を形成する3次元の点群情報のデータベースである。3次元点群DB43に登録される各点群は、例えば緯度・経度及び高さ(例えば標高)の3次元座標により表される。3次元点群DB43に登録される各点群の座標系を「絶対座標系」とも呼ぶ。なお、3次元点群DB43に登録される点群情報は、水平方向及び垂直方向にスキャンしたライダが出力した点群情報から生成されたものであってもよい。また、3次元点群DB43に登録される点群情報は、当該ライダが出力した点群情報、地図データに含まれる地物の位置情報及び形状情報等に基づき生成された各地物を示す3次元の点群情報であってもよい。3次元点群DB43に登録されている各点群情報は、本発明における「地物情報」の一例である。
制御部45は、プログラムを実行するCPUなどを含み、サーバ装置4の全体を制御する。本実施例では、制御部45は、通信部41が車載機1から点群情報要求信号Srを受信した場合に、点群情報要求信号Srに含まれる予測自車位置Ppr及びライダ特性情報ILに基づき、ライダ2によるスキャン対象空間を特定する。そして、制御部45は、特定したスキャン対象空間内となる点群を示す地図点群情報Daを、3次元点群DB43から抽出し、抽出した地図点群情報Daを通信部41により車載機1へ送信する。制御部45は、本発明における「取得部」、「出力部」、及び本発明におけるプログラムを実行するコンピュータの一例である。
[自車位置推定処理]
次に、自車位置推定処理について詳しく説明する。
(1)機能構成
図4は、車載機1の機能的な構成を示すブロック図である。図4に示すように、車載機1の制御部15は、機能的には、予測自車位置取得部51と、ライダ特性情報抽出部52と、地図点群情報取得部53と、計測点群情報取得部54と、マッチング部55と、自車位置推定部56と、を有する。
予測自車位置取得部51は、GPS受信機32及びIMU33の出力に基づき、現在の緯度及び経度を含む2次元又は3次元位置と、車両の進行方向とを予測する。そして、予測自車位置取得部51は、予測した位置情報を予測自車位置Pprとして点群情報要求信号Srに含め、通信部11によりサーバ装置4へ送信する。ライダ特性情報抽出部52は、記憶部12に記憶されたライダ特性情報ILを抽出し、抽出したライダ特性情報ILを点群情報要求信号Srに含め、通信部11によりサーバ装置4へ送信する。
地図点群情報取得部53は、点群情報要求信号Srの応答としてサーバ装置4が送信した地図点群情報Daを、通信部11により受信する。そして、地図点群情報取得部53は、受信した地図点群情報Daをマッチング部55へ供給する。計測点群情報取得部54は、ライダ2が出力する計測点群情報Dbを取得し、マッチング部55へ供給する。この場合、地図点群情報取得部53は、マッチング部55によるマッチングに必要な最小限の地図点群情報Daのみを受信するため、通信容量及び必要な記憶容量を好適に削減することができると共に、計測点群情報Dbとのマッチング処理の処理負荷を好適に低減させることができる。
マッチング部55は、計測点群情報取得部54から取得した計測点群情報Dbが示す点群と、地図点群情報取得部53から取得した地図点群情報Daが示す点群とのマッチング(位置合わせ)を行うことで誤差情報dPを生成する。例えば、マッチング部55は、まず、車載機1の位置及び進行方向を基準とした相対座標系により表された計測点群情報Dbを、予測自車位置取得部51から取得した予測自車位置Pprに基づき、絶対座標系に変換する。そして、マッチング部55は、絶対座標系に変換した計測点群情報Dbが示す点群と、絶対座標系により表された地図点群情報Daが示す点群とを、ICP(Iterative Closest Point)などの公知のマッチング手法を用いて対応付けを行う。そして、マッチング部55は、絶対座標系に変換した計測点群情報Dbの点群を、対応する地図点群情報Daの点群に位置合わせするために必要な変位を示すベクトル量及び回転角度を算出し、算出した情報を誤差情報dPとして自車位置推定部56へ供給する。マッチング部55の具体例については、図5及び図6を参照して説明する。
自車位置推定部56は、マッチング部55から誤差情報dP及び予測自車位置Pprを取得し、予測自車位置Pprに誤差情報dPが示す位置及び姿勢のずれを反映させた自車位置の推定値を算出する。自車位置推定部56が算出した自車位置の推定値は、例えば自動運転や経路案内などの各種制御に用いられる。
(2)マッチングの具体例
図5(A)は、ライダ2が出力するレーザが車載機1を搭載する車両周辺にある建物等の地物60〜62に照射される様子を示した図であり、図5(B)は、図5(A)におけるレーザの照射位置となる点群を抽出した図である。ここでは、一例として、ライダ2が水平方向のみをスキャンする場合について示している。
この場合、計測点群情報取得部54は、ライダ2と同一の高さに存在する地物60〜62の表面位置の点群に相当する計測点群情報Dbをライダ2から取得し、マッチング部55は、計測点群情報取得部54が取得した計測点群情報Dbを、予測自車位置Pprを用いて絶対座標系の3次元座標に変換する。
図6(A)は、3次元点群DB43に登録されている車両の周辺の点群を可視化した図である。
図6(A)に示すように、3次元点群DB43には、地物60〜62の3次元の表面の点群情報及び道路の縁の点群情報が登録されている。そして、サーバ装置4は、点群情報要求信号Srを受信した場合に、点群情報要求信号Srに含まれる予測自車位置Pprと、設置高さ情報及びスキャン範囲情報を含むライダ特性情報ILとに基づき、ライダ2のスキャン対象空間を特定し、当該空間内の点群を示す地図点群情報Daを、3次元点群DB43から抽出する。
図6(B)は、図6(A)に示す点群から車載機1に送信する地図点群情報Daに対応する点群を抽出した図である。この場合、サーバ装置4は、ライダ特性情報IL及び予測自車位置Pprに基づき、ライダ2によるスキャン対象空間を特定し、特定したスキャン対象空間内の点群を抽出する。
ここで、図6(B)の例では、サーバ装置4は、ライダ特性情報ILの設置高さ情報に基づき、ライダ2の照射面の高さを認識し、認識した高さと所定距離以内の高さとなる点群を抽出している。好適には、サーバ装置4は、スキャン範囲情報に垂直スキャン範囲の情報が含まれる場合には、当該範囲に応じて3次元点群DB43から抽出する点群の高さ範囲を決定するとよい。この場合、サーバ装置4は、スキャン範囲情報に含まれる垂直スキャン範囲と、3次元点群DB43から抽出する点群の高さ範囲とを同一にしてもよく、走行する車両の姿勢変動によるライダ2の照射面変動に対応するため、スキャン範囲情報に含まれる垂直スキャン範囲よりも3次元点群DB43から抽出する点群の高さ範囲はある程度広くしてもよい。また、図6(B)の例では、サーバ装置4は、ライダ特性情報ILのスキャン範囲情報と予測自車位置Pprとに基づき、水平面上におけるライダ2の水平面上でのスキャン範囲を認識し、当該スキャン範囲内に存在する地物60〜62の点群等を抽出している。
また、サーバ装置4は、ライダ特性情報ILのスキャン範囲情報に含まれる照射層数(又はライダ2のレーザ送受信センサの個数)を示す情報に基づき、当該照射層数に応じた点群を抽出してもよい。また、サーバ装置4は、照射層数を示す情報に加え、スキャン範囲情報に含まれる各照射層間の角度を示す情報に基づき、3次元点群DB43から抽出する点群の高さ範囲を決定してもよい。
なお、サーバ装置4は、3次元点群DB43に登録される各点群の高さの尺度が標高である場合、車両が存在する路面の標高を設置高さ情報に加味してライダ2の照射面の標高を算出する。この場合、例えば、サーバ装置4は、点群情報要求信号Srに含まれる予測自車位置PprがGPS受信機32の出力等に基づく車両の標高の情報を含んでいる場合には、当該標高の情報に基づき車両が存在する路面の標高を認識する。他の例では、サーバ装置4は、車両が存在する道路に対応する道路データに標高の情報が含まれている場合には、当該標高の情報に基づき車両が存在する路面の標高を認識する。
その後、マッチング部55は、絶対座標系に変換された図5(B)に示す点群(即ち計測点群情報Dbが示す点群)と、図6(B)に示す点群(即ち地図点群情報Daが示す点群)との位置合わせを行う。そして、マッチング部55は、絶対座標系に変換された図5(B)に示す点群の図6(B)に示す点群に対するずれを示すベクトル量及び回転角度に相当する誤差情報dPを生成する。
図5及び図6の例によれば、車載機1は、マッチング部55によるマッチングに必要な最小限の地図点群情報Daのみをサーバ装置4から受信するため、通信容量及び必要な記憶容量を好適に削減することができると共に、マッチング処理の処理負荷を好適に低減させることができる。
(3)処理フロー
図7は、本実施例における自車位置推定処理の手順を示すフローチャートである。車載機1は、図7に示すフローチャートを繰り返し実行する。
まず、車載機1は、GPS受信機32及びIMU33の出力等に基づき、現在の緯度、経度、車両の進行方向等を示した予測自車位置Pprを取得する(ステップS101)。なお、予測自車位置Pprは、GPS受信機32等が測定した現在の標高を含む情報であってもよい。そして、車載機1は、ステップS101で取得した予測自車位置Pprと記憶部12に記憶されたライダ特性情報ILとを含む点群情報要求信号Srをサーバ装置4へ送信する(ステップS102)。
この場合、サーバ装置4は、車載機1が送信した点群情報要求信号Srを受信する(ステップS201)。そして、サーバ装置4は、点群情報要求信号Srに含まれる予測自車位置Pprとライダ特性情報ILとに基づき、絶対座標系においてライダ2がスキャンする対象となるスキャン対象空間を認識し、当該スキャン対象空間内の点群を示す地図点群情報Daを3次元点群DB43から抽出する(ステップS202)。そして、サーバ装置4は、3次元点群DB43から抽出した地図点群情報Daを車載機1へ送信する(ステップS203)。
車載機1は、サーバ装置4から地図点群情報Daを受信する(ステップS103)。そして、車載機1は、ライダ2から取得した計測点群情報Dbと、受信した地図点群情報Daとを用いたマッチングを行う(ステップS104)。そして、車載機1は、マッチング結果に基づき誤差情報dPを算出する(ステップS105)。そして、車載機1は、算出した誤差情報dPに基づきステップS101で算出した予測自車位置Pprを補正することで、自車位置の推定値を算出する(ステップS106)。
以上説明したように、本実施例に係るサーバ装置4は、3次元点群DB43を記憶し、ライダ2の特性に関するライダ特性情報IL及び予測自車位置Pprを含む点群情報要求信号Srを車載機1から受信した場合に、ライダ2によるスキャン対象空間を特定する。そして、サーバ装置4は、特定したスキャン対象空間内の点群に相当する地図点群情報Daを3次元点群DB43から抽出し、車載機1へ送信する。この場合、車載機1は、マッチングに必要な最小限の地図点群情報Daのみを受信するため、通信容量及び必要な記憶容量を好適に削減することができると共に、計測点群情報Dbとのマッチング処理の処理負荷を好適に低減させることができる。
[変形例]
サーバ装置4は、複数のサーバから構成されてもよい。例えば、サーバ装置4は、3次元点群DB43を記憶するサーバと、図7のステップS201〜S203の処理を実行するサーバとが別体に構成されてもよい。サーバ装置4が複数のサーバから構成される場合、各サーバは、予め割り当てられた処理を実行するのに必要な情報を他のサーバから受信し、必要な処理を実行する。
1 車載機
2 ライダ
4 サーバ装置
11、41 通信部
12、42 記憶部
13 センサ部
14 入力部
15、45 制御部
16 出力部
43 3次元点群DB

Claims (10)

  1. 移動体に配置された外界検出装置の特性に関する特性情報を取得する取得部と、
    前記特性情報に基づいて、記憶部に記憶された地物を示す地物情報から前記地物情報の一部を抽出して出力する出力部と、
    を備える情報出力装置。
  2. 前記出力部は、前記特性情報に基づき前記外界検出装置の検出範囲を特定し、当該検出範囲内に存在する地物の地物情報を抽出して出力する請求項1に記載の情報出力装置。
  3. 前記特性情報には、前記外界検出装置の設置位置の高さに関する情報、又は、水平方向又は/及び垂直方向において前記外界検出装置が検出を行う範囲に関する情報が含まれる請求項1または2に記載の情報出力装置。
  4. 前記取得部は、前記外界検出装置の検出情報を受信する端末装置から前記特性情報及び前記移動体の位置情報を受信し、
    前記出力部は、前記特性情報及び前記位置情報に基づき抽出した前記地物情報を前記端末装置へ送信する請求項1〜3のいずれか一項に記載の情報出力装置。
  5. 外界検出装置が配置された移動体と共に移動する端末装置であって、
    前記外界検出装置の特性に関する特性情報を記憶する記憶部と、
    前記特性情報を請求項1〜4のいずれか一項に記載の情報出力装置に送信する送信部と、
    前記情報出力装置から地物情報を受信する受信部と、
    前記地物情報と、前記外界検出装置の検出情報とに基づき現在位置を推定する推定部と、を備える端末装置。
  6. 前記検出情報及び前記地物情報は、点群情報であり、
    前記推定部は、前記検出情報が示す点群と、当該点群に対応する前記地物情報が示す点群との位置の誤差に基づき、前記現在位置を推定する請求項5に記載の端末装置。
  7. 測定部の出力に基づく現在位置の予測値を取得する位置予測部をさらに備え、
    前記推定部は、前記地物情報と前記検出情報とに基づき前記予測値を補正することで、前記現在位置の推定値を算出する請求項5または6に記載の端末装置。
  8. 情報出力装置が実行する制御方法であって、
    移動体に配置された外界検出装置の特性に関する特性情報を取得する取得工程と、
    前記特性情報に基づいて、記憶部に記憶された地物を示す地物情報から前記地物情報の一部を抽出して出力する出力工程と、
    を有する制御方法。
  9. コンピュータが実行するプログラムであって、
    移動体に配置された外界検出装置の特性に関する特性情報を取得する取得部と、
    前記特性情報に基づいて、記憶部に記憶された地物を示す地物情報から前記地物情報の一部を抽出して出力する出力部
    として前記コンピュータを機能させるプログラム。
  10. 請求項9に記載のプログラムを記憶した記憶媒体。
JP2018517966A 2016-05-17 2016-05-17 情報出力装置、端末装置、制御方法、プログラム及び記憶媒体 Withdrawn JPWO2017199333A1 (ja)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2016/064598 WO2017199333A1 (ja) 2016-05-17 2016-05-17 情報出力装置、端末装置、制御方法、プログラム及び記憶媒体

Related Child Applications (1)

Application Number Title Priority Date Filing Date
JP2020199627A Division JP2021044008A (ja) 2020-12-01 2020-12-01 情報出力装置、端末装置、制御方法、プログラム及び記憶媒体

Publications (1)

Publication Number Publication Date
JPWO2017199333A1 true JPWO2017199333A1 (ja) 2019-03-14

Family

ID=60324993

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018517966A Withdrawn JPWO2017199333A1 (ja) 2016-05-17 2016-05-17 情報出力装置、端末装置、制御方法、プログラム及び記憶媒体

Country Status (4)

Country Link
US (1) US20200183009A1 (ja)
EP (1) EP3460779A4 (ja)
JP (1) JPWO2017199333A1 (ja)
WO (1) WO2017199333A1 (ja)

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB2559157A (en) * 2017-01-27 2018-08-01 Ucl Business Plc Apparatus, method and system for alignment of 3D datasets
JP2019109332A (ja) * 2017-12-18 2019-07-04 パイオニア株式会社 地図データ構造
JP2019117434A (ja) * 2017-12-26 2019-07-18 パイオニア株式会社 画像生成装置
JP7333445B2 (ja) * 2017-12-26 2023-08-24 パイオニア株式会社 画像生成装置
KR102242653B1 (ko) * 2018-11-16 2021-04-21 한국과학기술원 지상 로봇의 움직임을 고려한 강인한 레이저 스캐너 매칭 방법 및 그 장치
WO2020154964A1 (en) * 2019-01-30 2020-08-06 Baidu.Com Times Technology (Beijing) Co., Ltd. A point clouds registration system for autonomous vehicles
CN111242799B (zh) * 2019-12-10 2024-01-16 国网电力空间技术有限公司 基于机载LiDAR点云的高压线塔中心坐标提取编号方法及介质
JP7408236B2 (ja) * 2019-12-27 2024-01-05 日産自動車株式会社 位置推定方法及び位置推定装置
WO2023105595A1 (ja) * 2021-12-06 2023-06-15 日本電信電話株式会社 位置姿勢推定方法、位置姿勢推定装置、及びプログラム
DE102022203267A1 (de) 2022-04-01 2023-10-05 Robert Bosch Gesellschaft mit beschränkter Haftung Verfahren zur Lokalisierung eines Fahrzeugs mittels entfernungsbasierter Sensordaten des Fahrzeugs

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009264983A (ja) * 2008-04-25 2009-11-12 Mitsubishi Electric Corp 位置標定装置、位置標定システム、位置標定システムのユーザインタフェース装置、位置標定システムの標定サーバ装置および位置標定方法
JP2011027594A (ja) * 2009-07-27 2011-02-10 Toyota Infotechnology Center Co Ltd 地図データ検証システム
WO2012086029A1 (ja) * 2010-12-22 2012-06-28 株式会社日立製作所 自律移動システム

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008165275A (ja) 2006-12-27 2008-07-17 Yaskawa Electric Corp 自己位置同定装置を備えた移動体
CN101952688A (zh) * 2008-02-04 2011-01-19 电子地图北美公司 用于与传感器检测到的对象进行地图匹配的方法
JP4832596B2 (ja) * 2008-08-29 2011-12-07 三菱電機株式会社 俯瞰画像生成装置、俯瞰画像生成方法および俯瞰画像生成プログラム
US20140379254A1 (en) * 2009-08-25 2014-12-25 Tomtom Global Content B.V. Positioning system and method for use in a vehicle navigation system
US8825371B2 (en) * 2012-12-19 2014-09-02 Toyota Motor Engineering & Manufacturing North America, Inc. Navigation of on-road vehicle based on vertical elements
US9043072B1 (en) * 2013-04-04 2015-05-26 Google Inc. Methods and systems for correcting an estimated heading using a map
JP6325806B2 (ja) * 2013-12-06 2018-05-16 日立オートモティブシステムズ株式会社 車両位置推定システム
EP3467435A4 (en) * 2016-06-01 2020-04-08 Pioneer Corporation CHARACTERISTIC DATA STRUCTURE, STORAGE MEDIUM, INFORMATION PROCESSING DEVICE, AND DETECTION DEVICE

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009264983A (ja) * 2008-04-25 2009-11-12 Mitsubishi Electric Corp 位置標定装置、位置標定システム、位置標定システムのユーザインタフェース装置、位置標定システムの標定サーバ装置および位置標定方法
JP2011027594A (ja) * 2009-07-27 2011-02-10 Toyota Infotechnology Center Co Ltd 地図データ検証システム
WO2012086029A1 (ja) * 2010-12-22 2012-06-28 株式会社日立製作所 自律移動システム

Also Published As

Publication number Publication date
EP3460779A4 (en) 2020-01-01
EP3460779A1 (en) 2019-03-27
WO2017199333A1 (ja) 2017-11-23
US20200183009A1 (en) 2020-06-11

Similar Documents

Publication Publication Date Title
WO2017199333A1 (ja) 情報出力装置、端末装置、制御方法、プログラム及び記憶媒体
KR101625486B1 (ko) 지도 기반 측위 시스템 및 그 방법
JP6442193B2 (ja) 点群位置データ処理装置、点群位置データ処理システム、点群位置データ処理方法およびプログラム
JP6721784B2 (ja) 情報処理装置、サーバ装置、制御方法、プログラム及び記憶媒体
JP2022113746A (ja) 判定装置
US9767372B2 (en) Target detection apparatus and target detection method
US20180154901A1 (en) Method and system for localizing a vehicle
WO2021112074A1 (ja) 情報処理装置、制御方法、プログラム及び記憶媒体
JP6330471B2 (ja) 無線測位装置
JP2017072422A (ja) 情報処理装置、制御方法、プログラム及び記憶媒体
CN109425346B (zh) 用于自动化车辆的导航系统
KR102056147B1 (ko) 자율주행차량을 위한 거리 데이터와 3차원 스캔 데이터의 정합 방법 및 그 장치
JPWO2018212294A1 (ja) 自己位置推定装置、制御方法、プログラム及び記憶媒体
JP2018116014A (ja) 自車位置推定装置、制御方法、プログラム及び記憶媒体
US20210278217A1 (en) Measurement accuracy calculation device, self-position estimation device, control method, program and storage medium
JP6698430B2 (ja) 測定装置、測定方法およびプログラム
JPWO2018212292A1 (ja) 情報処理装置、制御方法、プログラム及び記憶媒体
US20220113139A1 (en) Object recognition device, object recognition method and program
WO2018212301A1 (ja) 自己位置推定装置、制御方法、プログラム及び記憶媒体
JP2023164553A (ja) 位置推定装置、推定装置、制御方法、プログラム及び記憶媒体
JP7032062B2 (ja) 点群データ処理装置、移動ロボット、移動ロボットシステム、および点群データ処理方法
JP2023076673A (ja) 情報処理装置、制御方法、プログラム及び記憶媒体
WO2021112177A1 (ja) 情報処理装置、制御方法、プログラム及び記憶媒体
JP2020046411A (ja) データ構造、記憶装置、端末装置、サーバ装置、制御方法、プログラム及び記憶媒体
CN112345798A (zh) 位置姿势推定装置以及位置姿势推定方法

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20181112

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200204

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20200901

A761 Written withdrawal of application

Free format text: JAPANESE INTERMEDIATE CODE: A761

Effective date: 20201201