JP7195073B2 - グラフ生成装置 - Google Patents

グラフ生成装置 Download PDF

Info

Publication number
JP7195073B2
JP7195073B2 JP2018130522A JP2018130522A JP7195073B2 JP 7195073 B2 JP7195073 B2 JP 7195073B2 JP 2018130522 A JP2018130522 A JP 2018130522A JP 2018130522 A JP2018130522 A JP 2018130522A JP 7195073 B2 JP7195073 B2 JP 7195073B2
Authority
JP
Japan
Prior art keywords
graph
vertex
edge
obstacle
cell
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2018130522A
Other languages
English (en)
Other versions
JP2020009225A (ja
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.)
Furuno Electric Co Ltd
Original Assignee
Furuno Electric Co Ltd
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 Furuno Electric Co Ltd filed Critical Furuno Electric Co Ltd
Priority to JP2018130522A priority Critical patent/JP7195073B2/ja
Priority to EP19185148.4A priority patent/EP3594623A1/en
Priority to US16/507,550 priority patent/US11193787B2/en
Priority to CN201910619263.3A priority patent/CN110702126A/zh
Publication of JP2020009225A publication Critical patent/JP2020009225A/ja
Application granted granted Critical
Publication of JP7195073B2 publication Critical patent/JP7195073B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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/34Route searching; Route guidance
    • G01C21/3446Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags, using precalculated routes
    • 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/38Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3863Structures of map data
    • G01C21/387Organisation of map data, e.g. version management or database structures
    • G01C21/3881Tile-based structures
    • 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/34Route searching; Route guidance
    • G01C21/3407Route searching; Route guidance specially adapted for specific applications
    • G01C21/343Calculating itineraries, i.e. routes leading from a starting point to a series of categorical destinations using a global route restraint, round trips, touristic trips
    • 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/34Route searching; Route guidance
    • G01C21/3453Special cost functions, i.e. other than distance or default speed limit of road segments
    • 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/34Route searching; Route guidance
    • G01C21/36Input/output arrangements for on-board computers
    • G01C21/3667Display of a road map
    • G01C21/3676Overview of the route on the road map
    • 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/38Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3863Structures of map data
    • G01C21/3867Geometry of map features, e.g. shape points, polygons or for simplified maps
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T11/002D [Two Dimensional] image generation
    • G06T11/20Drawing from basic elements, e.g. lines or circles
    • G06T11/203Drawing of straight lines or curves

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Databases & Information Systems (AREA)
  • Geometry (AREA)
  • Theoretical Computer Science (AREA)
  • Processing Or Creating Images (AREA)
  • Instructional Devices (AREA)
  • Navigation (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Design And Manufacture Of Integrated Circuits (AREA)

Description

本発明は、グラフ生成装置に関する。
従来から、地図データ等を利用して、経路を探索する方法が知られている。特許文献1は、この種の経路探索方法を開示する。
特許文献1は、環境を長方形領域に4分割し、分割した長方形領域内に障害物が存在する領域に対しては更にその長方形領域を4分割する処理を再帰的に行い、環境を4分木構造で表現することによって走行可能な経路を探索する方法を開示する。
特開平7-129238号公報
しかし、上記特許文献1の構成は、長方形領域を4分割する処理が少ない場合、障害物間等の狭い空間の経路を求めることができない。そして、当該空間の経路を求めるために、長方形領域を4分割する処理回数を増加させた場合、4分木構造のデータ量が爆発的に増加するので、計算負担が増大する。従って、上記特許文献1の構成は、軽い計算負担で適切な経路を求めることができない場合があるという点で改善の余地があった。
本発明は以上の事情に鑑みてされたものであり、その目的は、経路探索のためのグラフを適切に生成することにある。
課題を解決するための手段及び効果
本発明の解決しようとする課題は以上の如くであり、次にこの課題を解決するための手段とその効果を説明する。
本発明の第1の観点によれば、以下の構成のグラフ生成装置が提供される。即ち、このグラフ生成装置は、障害物データ取得部と、第1グラフ生成部と、第2グラフ生成部と、グラフ合成部と、第2グラフ調整部と、を備える。前記障害物データ取得部は、障害物の情報を含む障害物データを取得する。前記第1グラフ生成部は、前記障害物を含む領域を四分木分割法によりセルに再帰的に分割し、前記障害物を含まない前記セルである非包含セルに第1頂点を設定し、互いに隣接する前記非包含セルの前記第1頂点同士を第1辺で接続することで第1グラフを生成する。前記第2グラフ生成部は、ボロノイ分割法又はポテンシャル法により複数の障害物の間の領域を分割する境界の頂点として第2頂点を設定し、前記第2頂点を第2辺で接続することで第2グラフを生成する。前記グラフ合成部は、前記第1グラフ及び前記第2グラフを合成して合成グラフを生成する。前記第2グラフ調整部は、前記第2グラフ生成部が生成する第2グラフを、前記グラフ合成部で前記第1グラフと合成される前に調整する。前記グラフ合成部は、前記第2グラフにおいて前記第2辺が繋ぐ2つの前記第2頂点のうち一方である注目第2頂点が、前記障害物を一部だけに含む前記セルである一部包含セルに位置し、かつ、当該第2辺が前記一部包含セルだけでなく前記非包含セルも通る場合に、当該第2辺を変更して、前記注目第2頂点と、当該注目第2頂点を起点としたときに前記第2辺が最初に通る前記非包含セルの前記第1頂点と、を接続させる。
これにより、四分木分割法の利点と、他の方法の利点と、の両方を活かして、経路探索のためのグラフを生成することができる。2つのグラフが違和感なく自然に連続している合成グラフを生成することができる。第2グラフと第1グラフとを自然に繋いで合成することができる。
前記のグラフ生成装置においては、前記第1グラフ生成部は、所定の上限回数まで分割を反復した場合に、分割を打ち切ることが好ましい。
これにより、四分木分割法による空間の分割回数を所定回数以内に抑えることができるので、経路計算時における計算負担の軽減を実現できる。
前記のグラフ生成装置においては、前記第2グラフ生成部は、ボロノイ分割法により、前記領域のうち前記障害物に含まれない任意の点が、前記障害物を囲む領域である囲み領域の何れに属するかを求め、得られた前記囲み領域の境界に沿って複数の第2頂点を設定し、当該境界で繋がれる前記第2頂点同士を第2辺で接続することで第2グラフを生成することが好ましい。
これにより、遠回りになるグラフが生成されにくい四分木分割法の利点と、障害物同士の間隔が狭い箇所でも負担の少ない処理でグラフを生成できるボロノイ分割法の利点と、の両方を活かして、グラフを生成することができる。
前記のグラフ生成装置においては、前記第2グラフ調整部は、前記第2辺が1つ又は複数の前記非包含セルだけを通る場合に当該第2辺を削除することが好ましい。
これにより、第1グラフと第2グラフが実質的に重複している部分について、四分木分割法で生成した第1グラフを優先する形で2つのグラフを合成することができる。
前記のグラフ生成装置においては、前記第2グラフ調整部は、前記障害物を一部だけに含む前記セルを一部包含セルと呼ぶときに、前記第2辺が1つ又は複数の前記一部包含セルだけを通る場合に、当該第2辺については削除しないことが好ましい。
これにより、第1グラフにおいて第1辺を配置できなかった一部包含セルを通る第2辺を活かして、合成グラフを生成することができる。
本発明の第2の観点によれば、以下のグラフ生成方法が提供される。即ち、障害物の情報を含む障害物データを取得する。前記障害物を含む領域を四分木分割法によりセルに再帰的に分割し、前記障害物を含まない前記セルである非包含セルに第1頂点を設定し、互いに隣接する前記非包含セルの前記第1頂点同士を第1辺で接続することで第1グラフを生成する。ボロノイ分割法又はポテンシャル法により複数の障害物の間の領域を分割する境界の頂点として第2頂点を設定し、前記第2頂点を第2辺で接続することで第2グラフを生成する。前記第1グラフ及び前記第2グラフを合成して合成グラフを生成する。生成された第2グラフを、前記第1グラフと合成される前に調整する。前記合成グラフを生成するときに、前記第2グラフにおいて前記第2辺が繋ぐ2つの前記第2頂点のうち一方である注目第2頂点が、前記障害物を一部だけに含む前記セルである一部包含セルに位置し、かつ、当該第2辺が前記一部包含セルだけでなく前記非包含セルも通る場合に、当該第2辺を変更して、前記注目第2頂点と、当該注目第2頂点を起点としたときに前記第2辺が最初に通る前記非包含セルの前記第1頂点と、を接続させる。
これにより、四分木分割法の利点と、他の方法の利点と、の両方を活かして、経路グラフを生成することができる。2つのグラフが違和感なく自然に連続している合成グラフを生成することができる。第2グラフと第1グラフとを自然に繋いで合成することができる。
本発明の一実施形態に係るグラフ生成装置の電気的構成を示すブロック図。 グラフを生成する領域に存在する障害物を示す図。 四分木グラフが生成された様子を示す図。 ボロノイグラフが生成された様子を示す図。 ボロノイグラフの調整処理を説明する図。 四分木グラフとボロノイグラフの合成処理を説明する図。 四分木グラフとボロノイグラフの合成処理の結果として生成されたグラフを示す図。
次に、図面を参照して本発明の実施の形態を説明する。図1は、本発明の一実施形態に係るグラフ生成装置1の電気的構成を示すブロック図である。
図1に示すグラフ生成装置1は、障害物を避ける1つ又は複数通りの経路を表現するグラフを生成することができる。本明細書でいうグラフとは、頂点の集合と、2つの頂点を接続する辺の集合と、の組み合わせを意味する。
グラフ生成装置1は、地図データ取得部(障害物データ取得部)11と、四分木グラフ生成部(第1グラフ生成部)21と、ボロノイグラフ生成部(第2グラフ生成部)31と、ボロノイグラフ調整部(第2グラフ調整部)41と、グラフ合成部51と、経路探索部61と、を備える。
具体的には、グラフ生成装置1は公知のコンピュータとして構成されており、CPU、ROM、RAM、HDD等を備える。HDDには、本発明のグラフ生成方法を実現するためのプログラムが記憶されている。上記のハードウェアとソフトウェアの協働により、グラフ生成装置1を、地図データ取得部11、四分木グラフ生成部21、ボロノイグラフ生成部31、ボロノイグラフ調整部41、グラフ合成部51、及び経路探索部61として動作させることができる。
地図データ取得部11は、グラフの生成に利用する地図データ(障害物データ)を取得する。地図データ取得部11は、地図データを、例えば、外部の記憶装置(例えば、地図データベースサーバ)から通信により取得することができる。
地図データは、障害物の位置及び形状に関する情報を含んでいる。この地図データは、図2に示すように移動体が通行不能な障害物101,102が領域100内にある場合に、例えば、障害物101,102の輪郭を表現した折れ線の各頂点の位置を記述したベクトルデータとすることができる。図1の地図データ取得部11は、取得した地図データを、四分木グラフ生成部21及びボロノイグラフ生成部31に出力する。
四分木グラフ生成部21は、公知の四分木分割法(階層的近似セル分割法)を利用して、グラフを地図データに基づいて生成する。
詳細に説明すると、四分木グラフ生成部21は、地図データにおいて経路を生成したい領域100を縦横に分割することによって、それぞれのサイズが均等である4つのセルを生成する。生成したセル内の一部にのみ障害物101,102が含まれる場合、四分木グラフ生成部21は、当該セルの領域を再度縦横に分割して、それぞれのサイズが均等である4つのセルを再度生成する。四分木グラフ生成部21は、上記の分割処理を、所定の分割回数(分割深さ)に到達するまで再帰的に繰り返す。この結果、図3に示すように領域100が鎖線で示すように縦横に分割され、複数の矩形のセルが生成される。セルには、障害物101,102が全部含まれる場合と、一部にのみ含まれる場合と、全く含まれない場合と、がある。以下の説明では、障害物101,102が一部にのみ含まれるセルを「一部包含セル」と呼び、障害物101,102が全く含まれないセルを「非包含セル」と呼ぶことがある。
セルの分割が完了すると、四分木グラフ生成部21は、非包含セルの中心に頂点(第1頂点)を設定して、互いに隣接する非包含セルの頂点同士を直線状の辺(第1辺)で結ぶ処理を行う。このようにして、四分木グラフ生成部21は、経路計算に用いることができるグラフを生成する。以下、四分木分割法によるグラフを単に「四分木グラフ」と呼ぶことがある。四分木グラフは、第1グラフに相当する。四分木グラフの例が図3に示されている。このグラフは、第1頂点及び第1辺を含んで構成される。図3において、第1頂点は太線の丸印で示され、第1辺は太線で示されている。
四分木グラフ生成部21が行う分割回数(分割の深さ)には、上限が設定されている。従って、障害物101と障害物102との間が狭い場合、その間の部分においては、十分に細かく分割されて非包含セルが生成される前に分割が打ち切られ、結果として第1辺が生成されない場合がある。
図3には、分割の上限回数が3である場合が示されている。図3では、障害物101と障害物102との間に非包含セルがないため、図3の上下のグラフを繋ぐ第1辺が図3の中央に存在せず、グラフが上下に分離した状態となっている。
分割は図3の状態で打ち切られるが、仮に図3の状態からセルをもう1回分割すれば、上側と下側とを繋ぐように非包含セルが並んで生成され、障害物101と障害物102との間の狭いスペースに第1辺を生成することができる。ただし、この場合、グラフの頂点の数は大幅に増大する。
図1の四分木グラフ生成部21は、生成したグラフをボロノイグラフ調整部41及びグラフ合成部51に出力する。
ボロノイグラフ生成部31は、公知のボロノイ分割法を利用して、グラフを地図データに基づいて生成する。
詳細に説明すると、一般的なボロノイ分割法は、ある領域内において複数の点(母点)が与えられ、その領域内の任意の点が最も近い母点に属するとしたときに、どの母点に属するかが分かれる境界を求めて平面を分割するものである。本実施形態では、障害物101,102は点でなく広がりを持った領域である。従って、ボロノイグラフ生成部31は、障害物101,102の輪郭を例えば多角形として表し、領域100内で障害物101,102に含まれない任意の点が、障害物101,102をそれぞれ囲む領域(囲み領域)の何れに属するかを求めて、得られた囲み領域の境界を求める。
この境界は、例えば、一方の障害物101の折れ線と、他方の障害物102において対応する折れ線と、に挟まれた領域を2等分する直線を求めることで、図4のように折れ線の形で取得することができる。
ボロノイグラフ生成部31は、境界の折れ線の頂点と同じ位置に第2頂点を配置し、折れ線(境界)で繋がれる関係にある第2頂点同士を、第2辺によって接続する。このようにして、ボロノイグラフ生成部31は、経路計算に用いることができるグラフ(第2グラフ)を生成する。以下、ボロノイ分割法によるグラフを単に「ボロノイグラフ」と呼ぶことがある。ボロノイグラフは、第2グラフに相当する。ボロノイグラフの例が図4に示されている。このグラフは、第2頂点及び第2辺を含んで構成される。図4において、第2頂点は二重丸印で示され、第2辺は二重線で示されている。
ボロノイグラフ生成部31は、ボロノイ分割法を利用するので、スペースが狭い場所のグラフを容易に生成することができる。図4のボロノイグラフの例では、障害物101,102の間が狭く、図3の四分木グラフでは分割の打切りによりグラフが途切れている部分においても、障害物101,102の間を通るグラフを生成できていることがわかる。
ただし、ボロノイ分割法では、第2頂点及び第2辺は、障害物の間が広く離れているときも当該障害物の間を等しく分割するように配置される。従って、例えば図4の破線で囲った部分で示すように、第2頂点及び第2辺と障害物101,102との距離が必要以上に大きくなり、経路が遠回りとなってしまう場合がある。
図1のボロノイグラフ生成部31は、生成したグラフをボロノイグラフ調整部41に出力する。
ボロノイグラフ調整部41は、四分木グラフ生成部21が生成したグラフを利用して、ボロノイグラフ生成部31が生成したボロノイグラフを調整する処理を行う。
ボロノイグラフ調整部41が行う処理には、ボロノイグラフの第2辺の削除処理が含まれる。この辺削除処理は、複数の第2辺のうち1つに着目したときに、当該第2辺が1つ又は複数の非包含セルだけを通る場合に、当該第2辺を削除する処理を行うものである。なお、非包含セルは、障害物101,102が全く含まれないセルであり、図5では非包含セルに太線丸印(四分木グラフの第1頂点)が配置されている。この処理は、ボロノイグラフを構成する第2辺のそれぞれについて行われる。
例えば、図5において符号S2Aで示す第2辺は2つのセルを通るが、当該2つのセルは何れも非包含セルであるので、この第2辺S2Aは削除の対象となる。この処理で削除される第2辺には、図5においてバツ印が付けられている。ボロノイグラフ調整部41は、第2辺が削除されることにより他の何れの第2頂点とも繋がらなくなった第2頂点も削除する。図5においては、削除される第2頂点についてもバツ印が付けられている。
この結果、四分木グラフとボロノイグラフとが実質的に重複している部分について、後述の合成グラフにおいては、四分木グラフが現れることになる。このように四分木グラフを優先させることで、経路が遠回りになる傾向があるボロノイグラフの不利な点を回避することができる。
例えば図5の符号S2Bで示すように、第2辺が1つ又は複数の一部包含セルだけを通る場合がある。この第2辺S2Bは、上述の条件を満たさないので、ボロノイグラフ調整部41によって削除されない。ボロノイグラフ調整部41が出力するグラフには、第2辺S2Bがそのまま残される。これにより、障害物101,102の間の狭いスペースでもグラフを生成できるボロノイ分割法の利点を良好に活かすことができる。
これにより、図1のボロノイグラフ調整部41は、四分木グラフ生成部21が生成した四分木グラフと実質的に重複しないように第2辺及び第2頂点を削除したボロノイグラフを生成することができる。ボロノイグラフ調整部41は、調整後のボロノイグラフをグラフ合成部51に出力する。
グラフ合成部51は、四分木グラフ生成部21が出力した四分木グラフと、ボロノイグラフ調整部41が出力したボロノイグラフと、を組み合わせて、1つの合成グラフを生成する処理を行う。
具体的には、グラフ合成部51は、ボロノイグラフの第2辺の繋ぎ替え処理を行う。この繋ぎ替え処理は、ある第2辺が互いに接続する2つの第2頂点のうち1つに注目したときに、その注目した頂点(注目第2頂点)が一部包含セルに位置し、かつ、当該第2辺が当該一部包含セルだけでなく非包含セルも通る場合に、当該第2辺を、着目第2頂点と、非包含セルの第1頂点と、を接続するように変更するものである。この処理は、図6に示される全ての第2辺について行われる。
例えば、図6において符号S2Cで示す第2辺を考える。第2辺S2Cが互いに接続する2つの第2頂点のうち、上側の第2頂点を注目第2頂点とすると、この注目第2頂点は一部包含セルに位置している。また、この第2辺S2Cは、一部包含セルだけでなく、その下側にある非包含セルも通っている。従って、グラフ合成部51は、第2辺S2Cを、上側の注目第2頂点と、非包含セル(厳密に言えば、注目第2頂点を起点として、第2辺S2Cが最初に通る非包含セル)の第1頂点と、を接続するように繋ぎ替える。図5において、第2辺の接続の変更が、黒塗りの矢印で示されている。グラフ合成部51は、この繋ぎ替えにより他の何れの頂点とも繋がらなくなった第2頂点を削除する。図6においては、削除される第2頂点についてバツ印が付けられている。
ボロノイグラフ生成部31が生成したボロノイグラフは、図5で説明したとおり、ボロノイグラフ調整部41によって予め調整されている。この事前調整処理と、図6で説明した繋ぎ替え処理とにより、グラフ合成部51は、図7に示すように、四分木グラフとボロノイグラフとを違和感なく自然に接続したグラフを生成することができる。
四分木グラフを構成するそれぞれの第1辺、及び、ボロノイグラフを構成するそれぞれの第2辺には、重みに関する情報を含めることができる(重み付きグラフ)。重みの例としては、頂点と頂点の間の移動距離、所要時間等を挙げることができるが、これらに限定されない。この場合、グラフ合成部51により四分木グラフとボロノイグラフを繋ぎ合わせたグラフも重み付きグラフとなる。グラフ合成部51は、生成したグラフを経路探索部61に出力する。
経路探索部61は、公知のグラフ探索アルゴリズムに基づいて、グラフ合成部51が生成したグラフから経路を探索する。経路探索部61は、例えば、得られたグラフに対して出発地と目的地を与えることにより、重み付きグラフにおける最短経路問題アルゴリズムを利用して、出発地から目的地までの最短経路を得ることができる。得られた経路は、例えば、グラフ生成装置1が備える表示装置、又は、グラフ生成装置1に電気的に接続される外部の表示装置に表示することができる。
以上に説明したように、本実施形態のグラフ生成装置1は、地図データ取得部11と、四分木グラフ生成部21と、ボロノイグラフ生成部31と、グラフ合成部51と、を備える。地図データ取得部11は、障害物101,102の情報を含む障害物データを取得する。四分木グラフ生成部21は、障害物101,102を含む領域100を四分木分割法によりセルに再帰的に分割し、障害物101,102を含まないセルである非包含セルに第1頂点を設定し、互いに隣接する非包含セルの前記第1頂点同士を第1辺で接続することで四分木グラフを生成する。ボロノイグラフ生成部31は、四分木分割法とは異なる方法(ボロノイ分割法)により第2頂点を設定し、前記第2頂点同士を第2辺で接続することでボロノイグラフを生成する。グラフ合成部51は、四分木グラフ及びボロノイグラフを合成して合成グラフを生成する。
これにより、四分木分割法の利点と、他の方法の利点と、の両方を活かして、経路グラフを生成することができる。
以上に本発明の好適な実施の形態を説明したが、上記の構成は例えば以下のように変更することができる。
グラフ生成装置1は、ボロノイグラフ生成部31に代えて、公知のポテンシャル法の考え方を利用してグラフを生成するポテンシャルグラフ生成部を備えてもよい。ポテンシャルグラフ生成部(第2グラフ生成部)は、例えば、障害物101,102に近い程ポテンシャルが高くなるようなポテンシャル場を生成し、ポテンシャルが極小値となる点を第2頂点として設定し、第2頂点同士を第2辺で適宜に繋いでグラフとすることが考えられる。
四分木分割法における分割回数の上限は、例えば地図データにおける障害物101,102の配置、移動体の物理的な大きさ等を考慮して、適宜に設定することができる。
ボロノイ分割法は、障害物101,102の間を等しく分割する境界でなく、例えば1:2というように偏りを有する境界で分割するように変更することもできる。このような境界は、公知の重み付け処理を伴う計算により得ることができる。
ボロノイ分割法により取得される境界は、折れ線に限定されず、例えば滑らかな曲線であっても良い。この場合、ボロノイグラフ生成部31は、曲線に沿って第2頂点を複数設定し、当該曲線で繋がれる関係の第2頂点同士を第2辺で接続することで、ボロノイグラフを生成することができる。
経路探索部61は、グラフ生成装置1とは異なるコンピュータ(経路探索コンピュータ)に備えられても良い。この場合、グラフ生成装置1は、グラフ合成部51で生成したグラフを、適宜の記憶装置(例えば、データベースサーバ又はリムーバブル型メモリ)に保存する。経路探索コンピュータは、当該記憶装置からグラフを取得し、経路探索を行う。
グラフ生成装置1は、例えば、船舶等の移動体の通行経路を求めるためのグラフを生成するために用いることができる。
1 グラフ生成装置
11 地図データ取得部(障害物データ取得部)
21 四分木グラフ生成部(第1グラフ生成部)
31 ボロノイグラフ生成部(第2グラフ生成部)
41 ボロノイグラフ調整部(第2グラフ調整部)
51 グラフ合成部
100 領域
101 障害物
102 障害物

Claims (6)

  1. 障害物の情報を含む障害物データを取得する障害物データ取得部と、
    前記障害物を含む領域を四分木分割法によりセルに再帰的に分割し、前記障害物を含まない前記セルである非包含セルに第1頂点を設定し、互いに隣接する前記非包含セルの前記第1頂点同士を第1辺で接続することで第1グラフを生成する第1グラフ生成部と、
    ボロノイ分割法又はポテンシャル法により複数の障害物の間の領域を分割する境界の頂点として第2頂点を設定し、前記第2頂点を第2辺で接続することで第2グラフを生成する第2グラフ生成部と、
    前記第1グラフ及び前記第2グラフを合成して合成グラフを生成するグラフ合成部と、
    前記第2グラフ生成部が生成する第2グラフを、前記グラフ合成部で前記第1グラフと合成される前に調整する第2グラフ調整部と、
    を備え、
    前記グラフ合成部は、
    前記第2グラフにおいて前記第2辺が繋ぐ2つの前記第2頂点のうち一方である注目第2頂点が、前記障害物を一部だけに含む前記セルである一部包含セルに位置し、かつ、当該第2辺が前記一部包含セルだけでなく前記非包含セルも通る場合に、
    当該第2辺を変更して、前記注目第2頂点と、当該注目第2頂点を起点としたときに前記第2辺が最初に通る前記非包含セルの前記第1頂点と、を接続させることを特徴とするグラフ生成装置。
  2. 請求項1に記載のグラフ生成装置であって、
    前記第1グラフ生成部は、所定の上限回数まで分割を反復した場合に、分割を打ち切ることを特徴とするグラフ生成装置。
  3. 請求項1又は2に記載のグラフ生成装置であって、
    前記第2グラフ生成部は、ボロノイ分割法により、前記領域のうち前記障害物に含まれない任意の点が、前記障害物を囲む領域である囲み領域の何れに属するかを求め、得られた前記囲み領域の境界に沿って複数の第2頂点を設定し、当該境界で繋がれる前記第2頂点同士を第2辺で接続することで第2グラフを生成することを特徴とするグラフ生成装置。
  4. 請求項1から3までの何れか一項に記載のグラフ生成装置であって、
    前記第2グラフ調整部は、前記第2辺が1つ又は複数の前記非包含セルだけを通る場合に当該第2辺を削除することを特徴とするグラフ生成装置。
  5. 請求項1から4までの何れか一項に記載のグラフ生成装置であって、
    前記第2グラフ調整部は、前記障害物を一部だけに含む前記セルを一部包含セルと呼ぶときに、前記第2辺が1つ又は複数の前記一部包含セルだけを通る場合に、当該第2辺については削除しないことを特徴とするグラフ生成装置。
  6. 障害物の情報を含む障害物データを取得し、
    前記障害物を含む領域を四分木分割法によりセルに再帰的に分割し、前記障害物を含まない前記セルである非包含セルに第1頂点を設定し、互いに隣接する前記非包含セルの前記第1頂点同士を第1辺で接続することで第1グラフを生成し、
    ボロノイ分割法又はポテンシャル法により複数の障害物の間の領域を分割する境界の頂点として第2頂点を設定し、前記第2頂点を第2辺で接続することで第2グラフを生成し、
    前記第1グラフ及び前記第2グラフを合成して合成グラフを生成し、
    生成された第2グラフを、前記第1グラフと合成される前に調整し、
    前記合成グラフを生成するときに、
    前記第2グラフにおいて前記第2辺が繋ぐ2つの前記第2頂点のうち一方である注目第2頂点が、前記障害物を一部だけに含む前記セルである一部包含セルに位置し、かつ、当該第2辺が前記一部包含セルだけでなく前記非包含セルも通る場合に、
    当該第2辺を変更して、前記注目第2頂点と、当該注目第2頂点を起点としたときに前記第2辺が最初に通る前記非包含セルの前記第1頂点と、を接続させることを特徴とするグラフ生成方法。
JP2018130522A 2018-07-10 2018-07-10 グラフ生成装置 Active JP7195073B2 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2018130522A JP7195073B2 (ja) 2018-07-10 2018-07-10 グラフ生成装置
EP19185148.4A EP3594623A1 (en) 2018-07-10 2019-07-09 Graph generating device
US16/507,550 US11193787B2 (en) 2018-07-10 2019-07-10 Graph generating device
CN201910619263.3A CN110702126A (zh) 2018-07-10 2019-07-10 图生成装置及图生成方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018130522A JP7195073B2 (ja) 2018-07-10 2018-07-10 グラフ生成装置

Publications (2)

Publication Number Publication Date
JP2020009225A JP2020009225A (ja) 2020-01-16
JP7195073B2 true JP7195073B2 (ja) 2022-12-23

Family

ID=67220699

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018130522A Active JP7195073B2 (ja) 2018-07-10 2018-07-10 グラフ生成装置

Country Status (4)

Country Link
US (1) US11193787B2 (ja)
EP (1) EP3594623A1 (ja)
JP (1) JP7195073B2 (ja)
CN (1) CN110702126A (ja)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3611694A1 (en) * 2018-08-15 2020-02-19 Koninklijke Philips N.V. System for analysis of microscopic data using graphs
KR102106748B1 (ko) * 2020-02-04 2020-05-04 (주)코마린 해양 내비게이션 제공 시스템 및 방법 및 이에 있어서 해양 내비게이션 장치
CN113536837B (zh) * 2020-04-15 2023-08-04 杭州萤石软件有限公司 室内场景的区域划分方法及装置
CN112525198B (zh) * 2020-11-23 2021-12-03 广州极飞科技股份有限公司 作业路线规划方法及相关装置
CN113029160B (zh) * 2021-05-30 2021-09-14 浙江华睿科技股份有限公司 导航方法、导航终端及计算机可读存储介质
CN115437368B (zh) * 2022-06-02 2023-08-29 珠海云洲智能科技股份有限公司 一种救援路径确定方法、装置、救援设备及可读存储介质

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001318938A (ja) 2000-05-09 2001-11-16 Internatl Business Mach Corp <Ibm> 空間データマイニング方法、空間データマイニング装置、および記憶媒体
JP2016212627A (ja) 2015-05-08 2016-12-15 富士通株式会社 経路探索プログラム、情報処理装置、及び経路探索方法
JP2016218880A (ja) 2015-05-25 2016-12-22 株式会社国際電気通信基礎技術研究所 経路算出装置、経路算出プログラムおよび経路算出方法

Family Cites Families (32)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07129238A (ja) 1993-11-01 1995-05-19 Fujitsu Ltd 障害物回避経路生成方式
JPH08147020A (ja) * 1994-11-18 1996-06-07 Toyota Central Res & Dev Lab Inc ロボットの自動経路生成装置
US20050149251A1 (en) * 2000-07-18 2005-07-07 University Of Minnesota Real time high accuracy geospatial database for onboard intelligent vehicle applications
KR20030001483A (ko) * 2001-03-12 2003-01-06 코닌클리케 필립스 일렉트로닉스 엔.브이. 옥트리를 이용한 복수의 영상으로부터의 3차원 표현의 발생
JP4447865B2 (ja) * 2003-08-01 2010-04-07 ソニー株式会社 地図表示システム、地図データ加工装置、地図表示装置及び地図表示方法
DE102004032118B4 (de) * 2004-07-01 2006-09-21 Daimlerchrysler Ag Objekterkennungsverfahren für Fahrzeuge
US7248952B2 (en) * 2005-02-17 2007-07-24 Northrop Grumman Corporation Mixed integer linear programming trajectory generation for autonomous nap-of-the-earth flight in a threat environment
US20090088916A1 (en) * 2007-09-28 2009-04-02 Honeywell International Inc. Method and system for automatic path planning and obstacle/collision avoidance of autonomous vehicles
CN106454373B (zh) * 2010-04-13 2019-10-01 Ge视频压缩有限责任公司 解码器、重建数组的方法、编码器及编码方法
RS63059B1 (sr) * 2010-04-13 2022-04-29 Ge Video Compression Llc Kodiranje videa primenom podele sa više stabala na slikama
US8744770B2 (en) * 2010-08-27 2014-06-03 University Of Maryland, College Park Path oracles for spatial networks
DE102012105332A1 (de) * 2012-06-19 2013-12-19 Continental Teves Ag & Co. Ohg Verfahren zur Darstellung einer Fahrzeugumgebung
JP2014026516A (ja) * 2012-07-27 2014-02-06 Nissan Motor Co Ltd 目標経路生成装置及び目標経路生成方法
CN103900600A (zh) * 2012-12-25 2014-07-02 中国电信股份有限公司 室内跨楼层地图路径导航方法及***
DE102013200387A1 (de) * 2013-01-14 2014-07-17 Robert Bosch Gmbh Erstellung einer Hinderniskarte
CN105333883B (zh) * 2014-08-07 2018-08-14 深圳点石创新科技有限公司 一种用于抬头显示器的导航路径轨迹显示方法和装置
CN104168581B (zh) * 2014-09-05 2017-08-11 合肥工业大学 维诺图构造的水面移动基站路径规划方法
US9524647B2 (en) * 2015-01-19 2016-12-20 The Aerospace Corporation Autonomous Nap-Of-the-Earth (ANOE) flight path planning for manned and unmanned rotorcraft
US10452788B2 (en) * 2015-08-31 2019-10-22 Autodesk, Inc. Modeling a three-dimensional object having multiple materials
US9796390B2 (en) * 2016-02-29 2017-10-24 Faraday&Future Inc. Vehicle sensing grid having dynamic sensing cell size
FR3052275A1 (fr) * 2016-06-03 2017-12-08 Commissariat Energie Atomique Procede et systeme de determination de cellules traversees par un axe de mesure ou de visualisation
US10325169B2 (en) * 2016-10-09 2019-06-18 Airspace Systems, Inc. Spatio-temporal awareness engine for priority tree based region selection across multiple input cameras and multimodal sensor empowered awareness engine for target recovery and object path prediction
CN106528773B (zh) * 2016-11-07 2020-06-26 山东联友通信科技发展有限公司 一种基于Spark平台支持空间数据管理的图计算***及方法
CN106682787A (zh) * 2017-01-09 2017-05-17 北京航空航天大学 一种基于wavefront算法的快速生成广义维诺图的方法
US20200158517A1 (en) * 2017-01-19 2020-05-21 Mindmaze Holding Sa System, methods, device and apparatuses for preforming simultaneous localization and mapping
CN107228673B (zh) * 2017-05-19 2020-02-18 北京旋极伏羲大数据技术有限公司 航路规划方法及装置
US20190086513A1 (en) * 2017-09-21 2019-03-21 GM Global Technology Operations LLC Method and apparatus for frame rate boosting in lidar array
US20190122073A1 (en) * 2017-10-23 2019-04-25 The Charles Stark Draper Laboratory, Inc. System and method for quantifying uncertainty in reasoning about 2d and 3d spatial features with a computer machine learning architecture
KR20240011241A (ko) * 2017-12-08 2024-01-25 파나소닉 인텔렉츄얼 프로퍼티 코포레이션 오브 아메리카 이미지 인코딩 장치, 이미지 디코딩 장치, 이미지 인코딩 방법 및 이미지 디코딩 방법
US10681388B2 (en) * 2018-01-30 2020-06-09 Google Llc Compression of occupancy or indicator grids
US10788325B1 (en) * 2018-04-17 2020-09-29 Rockwell Collins, Inc. Systems and methods for hybrid graph and grid three-dimensional routing
JP7084806B2 (ja) * 2018-07-10 2022-06-15 古野電気株式会社 航法装置及びルート作成方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001318938A (ja) 2000-05-09 2001-11-16 Internatl Business Mach Corp <Ibm> 空間データマイニング方法、空間データマイニング装置、および記憶媒体
JP2016212627A (ja) 2015-05-08 2016-12-15 富士通株式会社 経路探索プログラム、情報処理装置、及び経路探索方法
JP2016218880A (ja) 2015-05-25 2016-12-22 株式会社国際電気通信基礎技術研究所 経路算出装置、経路算出プログラムおよび経路算出方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
SHAHED SHOJAEIPOURL 他,Motion Planning for Mobile Robot Navigation using Combine Quad-Tree Decomposition and Voronoi Diagrams,2010 The 2nd International Conference on Computer and Automation Engineering (ICCAE),米国,IEEE,2010年02月28日,90-93,https://ieeexplore.ieee.org/document/5451994

Also Published As

Publication number Publication date
US11193787B2 (en) 2021-12-07
EP3594623A1 (en) 2020-01-15
US20200018615A1 (en) 2020-01-16
CN110702126A (zh) 2020-01-17
JP2020009225A (ja) 2020-01-16

Similar Documents

Publication Publication Date Title
JP7195073B2 (ja) グラフ生成装置
US9626790B1 (en) View-dependent textures for interactive geographic information system
US20170278293A1 (en) Processing a Texture Atlas Using Manifold Neighbors
US10288437B2 (en) Routing with data version stitching
JPH08271274A (ja) 移動経路生成装置
JP2000227966A (ja) 3dコンピュ―タ・グラフィックス処理装置及び方法
JP2016134009A (ja) 3次元地図表示システム
JP4928993B2 (ja) 農地区画データ作成システム
JPH11339061A (ja) 階層化ポリゴンデータを用いた3次元ポリゴン表示装置
JP2006284704A (ja) 立体地図簡略化装置及び立体地図簡略化方法
Surazhsky et al. Blending polygonal shapes with different topologies
JP4111834B2 (ja) 画像生成方法および装置
CN117685995A (zh) 道路处理方法、装置、计算机设备和计算机可读存储介质
JP2000340476A (ja) 形状シミュレーション方法、装置および記録媒体
EP2876607B1 (en) Shape data generation method and device
JP2011197816A (ja) 画像生成方法
JP7475711B2 (ja) 自律走行車両の走行計画のためのロードネットワークマップ生成方法、サーバーおよびコンピュータプログラム
JPH0973559A (ja) モーフィング編集装置
WO2019049457A1 (ja) 画像生成装置および画像生成方法
KR102469228B1 (ko) 가상 시점 영상 생성 장치 및 방법
JP5664859B2 (ja) 画像変換装置、画像生成システム、画像変換方法及び画像生成方法
CN114612733A (zh) 一种基于环路虚拟路径图的分段重定向映射方法、终端及可读存储介质
JP6110807B2 (ja) 画像処理装置
JP6060772B2 (ja) 処理プログラム、処理装置、及び処理方法
JP2006059061A (ja) 3次元データ処理方法、装置及びプログラム

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210426

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220603

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220726

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20221004

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20221129

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20221209

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20221213

R150 Certificate of patent or registration of utility model

Ref document number: 7195073

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150