JP7036269B1 - 経路作成装置、経路管理システム、経路作成プログラムおよび経路作成方法 - Google Patents
経路作成装置、経路管理システム、経路作成プログラムおよび経路作成方法 Download PDFInfo
- Publication number
- JP7036269B1 JP7036269B1 JP2021132984A JP2021132984A JP7036269B1 JP 7036269 B1 JP7036269 B1 JP 7036269B1 JP 2021132984 A JP2021132984 A JP 2021132984A JP 2021132984 A JP2021132984 A JP 2021132984A JP 7036269 B1 JP7036269 B1 JP 7036269B1
- Authority
- JP
- Japan
- Prior art keywords
- route
- landmark
- transit
- point
- points
- 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
Links
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
図1は実施の形態1における経路管理システムの概要図である。
図2は実施の形態1における経路管理システムで作成される最短経路と圧縮経路とを示す図である。
図3は実施の形態1における経路管理システムのブロック図である。
図4は実施の形態1における経路作成装置の動作の概要を説明するためのフローチャートである。
図5は実施の形態1における経路作成装置の動作の概要を説明するためのフローチャートである。
図6は実施の形態1における経路作成装置の動作の概要を説明するためのフローチャートである。
図7は実施の形態1における経路作成装置のハードウェア構成図である。図8は実施の形態1における経路作成装置の別の例のハードウェア構成図である。
Claims (14)
- 自律的に移動するロボットが2つの地点の間の経路を移動するために必要なコストを示す経路コスト値を演算する経路コスト演算部と、
複数のランドマーク地点の位置が示された第1地図情報に基づいて、前記ロボットの出発地点から出発し前記複数のランドマーク地点のうち3つ以上の経由ランドマーク地点を経由して目的地点へと至る複数の経路の和集合である全体経路の情報を作成する全体経路作成部と、
前記全体経路作成部が作成した前記全体経路に含まれる複数の経路のうち、前記経路コスト演算部に演算された経路コスト値が最も小さい経路を最短経路に決定する最短経路作成部と、
前記最短経路作成部が決定した前記最短経路に含まれる前記3つ以上の経由ランドマーク地点のうちの第1経由ランドマーク地点と、前記3つ以上の経由ランドマーク地点のうちの前記第1経由ランドマーク地点より後に通過する地点であって前記第1経由ランドマーク地点に隣接しない第2経由ランドマーク地点と、を選択し、前記第1経由ランドマーク地点から出発し前記第1地図情報に示された前記複数のランドマーク地点のうち少なくとも1つのランドマーク地点を経由して前記第2経由ランドマーク地点へと至る1つ以上の部分経路を作成する部分経路作成部と、
前記部分経路作成部が作成した前記1つ以上の部分経路のうち、前記経路コスト演算部に演算された経路コスト値が規定の閾値以下である部分経路の個数が1つである場合に、前記最短経路に含まれる前記3つ以上の経由ランドマーク地点のうちの前記第1経由ランドマーク地点から前記第2経由ランドマーク地点までの間に存在する1つ以上の第3経由ランドマーク地点を前記最短経路から削除した圧縮経路を作成する圧縮経路作成部と、
を備えた経路作成装置。 - 前記圧縮経路作成部は、前記規定の閾値として前記部分経路作成部が作成した前記1つ以上の部分経路の経路コスト値のうち最も小さい経路コスト値と同じ値を用いる請求項1に記載の経路作成装置。
- 前記圧縮経路作成部は、前記規定の閾値として前記部分経路作成部が作成した前記1つ以上の部分経路の経路コスト値のうち最も小さい経路コスト値に調整値を加えた値を用いる請求項1に記載の経路作成装置。
- 前記経路コスト演算部は、2つの地点の間のユークリッド距離の値を経路コスト値として演算する請求項1から請求項3のいずれか一項に記載の経路作成装置。
- 前記経路コスト演算部は、2つの地点の間のユークリッド距離を示す値と2つの地点の間の移動困難度を示す値との合計値を経路コスト値として演算する請求項1から請求項3のいずれか一項に記載の経路作成装置。
- 前記経路コスト演算部は、前記移動困難度を示す値として、2つの地点の間の混雑度合いを示す値と2つの地点の間の床面の状態を示す値との合計値を用いる請求項5に記載の経路作成装置。
- 前記全体経路作成部は、前記第1地図情報に示される前記複数のランドマーク地点のうち前記出発地点からの経路コスト値が最も小さいランドマーク地点を前記3つ以上の経由ランドマーク地点のうちの前記出発地点の次に通る経由ランドマーク地点として設定する請求項1から請求項6のいずれか一項に記載の経路作成装置。
- 前記全体経路作成部は、前記第1地図情報に示される前記複数のランドマーク地点のうち前記目的地点への経路コスト値が最も小さいランドマーク地点を前記3つ以上の経由ランドマーク地点のうち前記目的地点の直前に通る経由ランドマーク地点に設定する請求項1から請求項7のいずれか一項に記載の経路作成装置。
- 前記第1地図情報として、建築物のBIM(Building Information Modeling)に基づいて変換された地図情報であって前記複数のランドマーク地点のIDと位置座標とが対応付けられた地図情報を記憶する記憶部、
を更に備えた請求項1から請求項8のいずれか一項に記載の経路作成装置。 - 前記記憶部は、前記第1地図情報に示される前記複数のランドマーク地点のうち2つのランドマーク地点の各々のIDと当該2つのランドマーク地点の組み合わせに設定された経路コスト値とが対応付けられた経路コスト値の情報を記憶し、
前記経路コスト演算部は、前記記憶部に記憶された前記経路コスト値の情報に基づいて、任意の経路の経路コスト値を演算する請求項9に記載の経路作成装置。 - 前記経路コスト演算部は、前記複数のランドマーク地点のうち2つのランドマーク地点の間の経路に対応する経路コスト値を演算したときに、当該演算した経路コスト値が前記記憶部に記憶される経路コスト値の情報に含まれない場合、当該演算した経路コスト値の情報を前記記憶部に記憶させる請求項10に記載の経路作成装置。
- ロボットの移動を制御する移動制御装置と、
前記ロボットの出発地点と目標地点との情報を受信した場合に、前記出発地点から前記目的地点へと至る移動経路の情報を前記移動制御装置に送信する管理サーバと、
を備えた経路管理システムであって、
前記管理サーバは、
複数のランドマーク地点の位置が示された第1地図情報を記憶する第1記憶装置と、
請求項1から請求項8のいずれか一項に記載の経路作成装置と、
前記経路作成装置が作成した前記圧縮経路の情報を前記移動経路の情報として前記移動制御装置に送信する通信装置と、
を有し、
前記移動制御装置は、
前記経路作成装置が作成した前記圧縮経路の情報を受信する通信部と、
前記第1地図情報に含まれる前記複数のランドマーク地点の位置が示された第2地図情報を記憶する第2記憶部と、
前記ロボットが2つの地点の間の経路を移動するために必要なコストを示す経路コスト値を演算する復元経路コスト演算部と、
前記通信部が前記圧縮経路の情報を受信した場合に、前記圧縮経路に含まれる前記第1経由ランドマーク地点から出発し前記第2記憶部が記憶する前記第2地図情報に含まれる前記複数のランドマーク地点のうち少なくとも1つのランドマーク地点を経由して前記圧縮経路に含まれる前記第2経由ランドマーク地点へと至る1以上の復元部分経路を作成する復元部分経路作成部と、
前記復元部分経路作成部が作成した前記1以上の復元部分経路のうち前記復元経路コスト演算部が演算した経路コスト値が最も小さい復元部分経路と前記圧縮経路が含まれる復元経路の情報を作成する復元経路作成部と、
前記復元経路作成部が作成した復元経路の情報に基づいて前記ロボットを移動させる移動制御部と、
を有する経路管理システム。 - コンピュータに、
自律的に移動するロボットが2つの地点の間の経路を移動するために必要なコストを示す経路コスト値を演算する経路コスト演算ステップと、
複数のランドマーク地点の位置が示された第1地図情報に基づいて、前記ロボットの出発地点から出発し前記複数のランドマーク地点のうち3つ以上の経由ランドマーク地点を経由して目的地点へと至る複数の経路の和集合である全体経路の情報を作成する全体経路作成ステップと、
前記全体経路作成ステップで作成された前記全体経路に含まれる複数の経路のうち、前記経路コスト演算ステップで演算された経路コスト値が最も小さい経路を最短経路に決定する最短経路作成ステップと、
前記最短経路作成ステップで決定された前記最短経路に含まれる前記3つ以上の経由ランドマーク地点のうちの第1経由ランドマーク地点と、前記3つ以上の経由ランドマーク地点のうちの前記第1経由ランドマーク地点より後に通過する地点であって前記第1経由ランドマーク地点に隣接しない第2経由ランドマーク地点と、を選択し、前記第1経由ランドマーク地点から出発し前記第1地図情報に示された前記複数のランドマーク地点のうち少なくとも1つのランドマーク地点を経由して前記第2経由ランドマーク地点へと至る1つ以上の部分経路を作成する部分経路作成ステップと、
前記部分経路作成ステップで作成された前記1つ以上の部分経路のうち、前記経路コスト演算ステップで演算された経路コスト値が規定の閾値よりも小さい部分経路の個数が1つである場合に、前記最短経路に含まれる前記3つ以上の経由ランドマーク地点のうちの前記第1経由ランドマーク地点から前記第2経由ランドマーク地点までの間に存在する1つ以上の第3経由ランドマーク地点を前記最短経路から削除した圧縮経路を作成する圧縮経路作成ステップと、
を実行させる経路作成プログラム。 - 自律的に移動するロボットが2つの地点の間の経路を移動するために必要なコストを示す経路コスト値を演算する経路コスト演算工程と、
複数のランドマーク地点の位置が示された第1地図情報に基づいて、前記ロボットの出発地点から出発し前記複数のランドマーク地点のうち3つ以上の経由ランドマーク地点を経由して目的地点へと至る複数の経路の和集合である全体経路の情報を作成する全体経路作成工程と、
前記全体経路作成工程で作成された前記全体経路に含まれる複数の経路のうち、前記経路コスト演算工程で演算された経路コスト値が最も小さい経路を最短経路に決定する最短経路作成工程と、
前記最短経路作成工程で決定された前記最短経路に含まれる前記3つ以上の経由ランドマーク地点のうちの第1経由ランドマーク地点と、前記3つ以上の経由ランドマーク地点のうちの前記第1経由ランドマーク地点より後に通過する地点であって前記第1経由ランドマーク地点に隣接しない第2経由ランドマーク地点と、を選択し、前記第1経由ランドマーク地点から出発し前記第1地図情報に示された前記複数のランドマーク地点のうち少なくとも1つのランドマーク地点を経由して前記第2経由ランドマーク地点へと至る1つ以上の部分経路を作成する部分経路作成工程と、
前記部分経路作成工程で作成された前記1つ以上の部分経路のうち、前記経路コスト演算工程で演算された経路コスト値が規定の閾値よりも小さい部分経路の個数が1つである場合に、前記最短経路に含まれる前記3つ以上の経由ランドマーク地点のうちの前記第1経由ランドマーク地点から前記第2経由ランドマーク地点までの間に存在する1つ以上の第3経由ランドマーク地点を前記最短経路から削除した圧縮経路を作成する圧縮経路作成工程と、
を備えた経路作成方法。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2021132984A JP7036269B1 (ja) | 2021-08-17 | 2021-08-17 | 経路作成装置、経路管理システム、経路作成プログラムおよび経路作成方法 |
| CN202111282463.8A CN115903767B (zh) | 2021-08-17 | 2021-11-01 | 路径创建装置、路径管理系统、存储介质以及路径创建方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2021132984A JP7036269B1 (ja) | 2021-08-17 | 2021-08-17 | 経路作成装置、経路管理システム、経路作成プログラムおよび経路作成方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP7036269B1 true JP7036269B1 (ja) | 2022-03-15 |
| JP2023027706A JP2023027706A (ja) | 2023-03-02 |
Family
ID=81213516
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2021132984A Active JP7036269B1 (ja) | 2021-08-17 | 2021-08-17 | 経路作成装置、経路管理システム、経路作成プログラムおよび経路作成方法 |
Country Status (2)
| Country | Link |
|---|---|
| JP (1) | JP7036269B1 (ja) |
| CN (1) | CN115903767B (ja) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20240125744A (ko) * | 2023-02-09 | 2024-08-20 | 주식회사 심시스글로벌 | 빌딩 정보 모델링 데이터를 이용하여 로봇 맵을 관리하는 방법, 장치 및 시스템 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2002310693A (ja) | 2001-04-09 | 2002-10-23 | Nissan Motor Co Ltd | 経路探索装置およびプログラム |
| JP2009136996A (ja) | 2007-12-10 | 2009-06-25 | Honda Motor Co Ltd | 目標経路生成システム |
| JP2019164410A (ja) | 2018-03-19 | 2019-09-26 | 株式会社日立システムズ | 移動型ロボット異常状態回復支援システム |
| US20190316924A1 (en) | 2018-04-16 | 2019-10-17 | Morgan Brown Consultancy Ltd. | Vehicle routing |
Family Cites Families (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP0807803B1 (en) * | 1996-05-16 | 2005-02-23 | Matsushita Electric Industrial Co., Ltd. | Road map information readout apparatus, recording medium and transmitting method |
| JP3676713B2 (ja) * | 2001-09-12 | 2005-07-27 | 三菱電機株式会社 | 経路探索装置 |
| JP5547112B2 (ja) * | 2011-02-16 | 2014-07-09 | 株式会社日立製作所 | 経路探索システム |
| JP5803392B2 (ja) * | 2011-08-01 | 2015-11-04 | 株式会社豊田中央研究所 | 自律移動装置 |
| JP6601947B2 (ja) * | 2014-08-25 | 2019-11-06 | 国立大学法人 鹿児島大学 | ナビゲーションシステム、ナビゲーション方法及びプログラム |
| JP2017204048A (ja) * | 2016-05-10 | 2017-11-16 | 村田機械株式会社 | 走行車システム |
| JP6829604B2 (ja) * | 2017-01-05 | 2021-02-10 | 綜合警備保障株式会社 | 最小コスト演算装置、最小コスト演算方法および最小コスト演算プログラム |
| CN109163722B (zh) * | 2018-06-29 | 2020-06-30 | 北京建筑大学 | 一种仿人机器人路径规划方法及装置 |
| CN110975291B (zh) * | 2019-11-20 | 2023-11-10 | 中国人民解放军国防科技大学 | 一种路径提取方法及系统 |
| CN110967028B (zh) * | 2019-11-26 | 2022-04-12 | 深圳优地科技有限公司 | 导航地图构建方法、装置、机器人及存储介质 |
| CN112904842B (zh) * | 2021-01-13 | 2022-07-15 | 中南大学 | 一种基于代价势场的移动机器人路径规划与优化方法 |
-
2021
- 2021-08-17 JP JP2021132984A patent/JP7036269B1/ja active Active
- 2021-11-01 CN CN202111282463.8A patent/CN115903767B/zh active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2002310693A (ja) | 2001-04-09 | 2002-10-23 | Nissan Motor Co Ltd | 経路探索装置およびプログラム |
| JP2009136996A (ja) | 2007-12-10 | 2009-06-25 | Honda Motor Co Ltd | 目標経路生成システム |
| JP2019164410A (ja) | 2018-03-19 | 2019-09-26 | 株式会社日立システムズ | 移動型ロボット異常状態回復支援システム |
| US20190316924A1 (en) | 2018-04-16 | 2019-10-17 | Morgan Brown Consultancy Ltd. | Vehicle routing |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20240125744A (ko) * | 2023-02-09 | 2024-08-20 | 주식회사 심시스글로벌 | 빌딩 정보 모델링 데이터를 이용하여 로봇 맵을 관리하는 방법, 장치 및 시스템 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2023027706A (ja) | 2023-03-02 |
| CN115903767A (zh) | 2023-04-04 |
| CN115903767B (zh) | 2025-07-15 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN112859859B (zh) | 一种基于三维障碍物体素对象映射的动态栅格地图更新方法 | |
| US11785430B2 (en) | System and method for real-time indoor navigation | |
| US11797023B2 (en) | Controller, control method, and program | |
| DK2343615T3 (en) | Independent movement device | |
| JP6462692B2 (ja) | 自律移動装置 | |
| US10552981B2 (en) | Depth camera 3D pose estimation using 3D CAD models | |
| KR101864949B1 (ko) | 이동 로봇을 통한 격자 지도 작성 방법 | |
| WO2019113611A2 (en) | Method and system for fingerprinting survey | |
| US20110085707A1 (en) | Method and apparatus for automated determination of features on an electronic map | |
| JPWO2020105189A1 (ja) | 経路計画装置、経路計画方法、及びプログラム | |
| JP7036269B1 (ja) | 経路作成装置、経路管理システム、経路作成プログラムおよび経路作成方法 | |
| Bräunl | Localization and navigation | |
| CN113091743B (zh) | 机器人的室内定位方法及装置 | |
| CN111460067B (zh) | 导航路线自动更新的方法、装置和电子设备 | |
| CN113778073A (zh) | 应用于室内场景的机器人行驶方法、装置以及系统 | |
| US20250216856A1 (en) | A Method And System For Navigating a Robot in a Designated Environment | |
| JP2021196489A (ja) | 地図補正システム、及び地図補正プログラム | |
| CN117990082A (zh) | 包含激光slam与二维码融合的定位方法、机器人及存储介质 | |
| CN115388876B (zh) | 智能可移动设备导航方法、装置、设备和存储介质 | |
| US20250304292A1 (en) | Mobile body control device, mobile body control method, and program | |
| CN114485670B (zh) | 一种移动单元的路径规划方法、装置、电子设备及介质 | |
| CN117419733A (zh) | 用于识别周围环境的有错地图的方法 | |
| JP2024165836A (ja) | 制御装置、移動体、経路計画装置、プログラム、及び、学習済みモデルを生成するための方法 | |
| CN115930967A (zh) | 一种路径规划方法、装置以及计算机存储介质 | |
| CN115047858A (zh) | 路径规划方法、装置、移动机器人和存储介质 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20210817 |
|
| A871 | Explanation of circumstances concerning accelerated examination |
Free format text: JAPANESE INTERMEDIATE CODE: A871 Effective date: 20211117 |
|
| 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: 20220201 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20220214 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7036269 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |