JPH0786769B2 - 自立無人車システムにおける最適経路探索方法 - Google Patents
自立無人車システムにおける最適経路探索方法Info
- Publication number
- JPH0786769B2 JPH0786769B2 JP61257790A JP25779086A JPH0786769B2 JP H0786769 B2 JPH0786769 B2 JP H0786769B2 JP 61257790 A JP61257790 A JP 61257790A JP 25779086 A JP25779086 A JP 25779086A JP H0786769 B2 JPH0786769 B2 JP H0786769B2
- Authority
- JP
- Japan
- Prior art keywords
- central station
- self
- work
- unmanned vehicle
- point
- 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.)
- Expired - Lifetime
Links
Landscapes
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
【発明の詳細な説明】 「産業上の利用分野」 この発明は、作業要求の発生した作業点に、自立無人
車、例えば、移動車にロボットを搭載したものなどを迅
速に行かせることのできる、自立無人車システムにおけ
る最適経路探索方法に関するものである。
車、例えば、移動車にロボットを搭載したものなどを迅
速に行かせることのできる、自立無人車システムにおけ
る最適経路探索方法に関するものである。
「従来の技術」 現在、自立無人車の開発が盛んに行なわれており、自立
無人車自体の性能はいうにおよばず、自立無人車システ
ム全体としての性能向上が重要な課題となっている。
無人車自体の性能はいうにおよばず、自立無人車システ
ム全体としての性能向上が重要な課題となっている。
この種の自立無人車システムとしては、複数の自立無人
車と、これらの自立無人車を統括制御する1つの中央局
とからなるものが代表的である。
車と、これらの自立無人車を統括制御する1つの中央局
とからなるものが代表的である。
このようなシステムにおいて各自立無人車は、中央局の
指示に従って作業点まで走行して所定の作業を行う。一
方、中央局は自立無人車の移動領域の地図情報を管理す
るとともに、すべての自立無人車の現在位置や作業中か
否かなどの状態を監視し、無線または有線などの通信手
段により自立無人車と交信しながら作業指示を行う。
指示に従って作業点まで走行して所定の作業を行う。一
方、中央局は自立無人車の移動領域の地図情報を管理す
るとともに、すべての自立無人車の現在位置や作業中か
否かなどの状態を監視し、無線または有線などの通信手
段により自立無人車と交信しながら作業指示を行う。
すなわち、いずれかの作業点で作業要求が発生すると、
中央局は作業を行っていない自立無人車の中から、作業
点に行くのに最適な自立無人車を選択して指令を与え
る。ここで、自立無人車の選択方法としては、作業点へ
の直線距離が最も短い自立無人車を選ぶ単純なものや、
各自立無人車が上記作業点に行くための最適経路を中央
局が計算し、その中で今回の作業に最も適した自立無人
車を選択する方法がある。
中央局は作業を行っていない自立無人車の中から、作業
点に行くのに最適な自立無人車を選択して指令を与え
る。ここで、自立無人車の選択方法としては、作業点へ
の直線距離が最も短い自立無人車を選ぶ単純なものや、
各自立無人車が上記作業点に行くための最適経路を中央
局が計算し、その中で今回の作業に最も適した自立無人
車を選択する方法がある。
「発明が解決しようとする問題点」 ところで、上述した従来の選択方法では、中央局が各自
立無人車のそれぞれについて移動経路を求める処理を行
う必要があるから、中央局において処理すべきデータが
膨大なものとなって、中央局の処理能力に大きなものが
要求され、あるいは、中央局がデータを処理して最適な
ロボットを選択するのに要する時間が長くなるという問
題がある。
立無人車のそれぞれについて移動経路を求める処理を行
う必要があるから、中央局において処理すべきデータが
膨大なものとなって、中央局の処理能力に大きなものが
要求され、あるいは、中央局がデータを処理して最適な
ロボットを選択するのに要する時間が長くなるという問
題がある。
また、自立無人車をA地点〜B地点〜C地点…………と
順次移動させながら作業を行なおうとする場合のよう
に、移動経路が長くなると、各自立無人車の経路の計算
にさらに多くの時間が必要になる。
順次移動させながら作業を行なおうとする場合のよう
に、移動経路が長くなると、各自立無人車の経路の計算
にさらに多くの時間が必要になる。
本発明は上記事情に鑑みて提案されたもので、複数の自
立無人車の中から最適なものを最短時間で選択させるこ
とを目的とするものである。
立無人車の中から最適なものを最短時間で選択させるこ
とを目的とするものである。
「問題点を解決するための手段」 上記問題点を解決するためにこの発明は、中央局と、該
中央局によって指定された第1番目から第N番目の各作
業点に移動して所定の作業を行う複数の自立無人車とか
らなる自立無人車システムにおいて、前記各自立無人車
は、前記中央局から指令があったときに、現在位置から
第1番目の作業点への経路探索をそれぞれ行なうととも
にその評価値を前記中央局に送り、前記中央局は、前記
各自立無人車が第1番目の作業点への経路探索および評
価を行っている間に、第1番目の作業点から最終の作業
点までの経路探索を行い、前記中央局は、最も良い評価
値を送ってきた自立無人車に第1番目の作業点への移動
を指令し、また、該自立無人車に、前記中央局において
探索しておいた第1番目の作業点から最終の作業点まで
の経路に沿って移動すべき移動命令を送ることを特徴と
する。
中央局によって指定された第1番目から第N番目の各作
業点に移動して所定の作業を行う複数の自立無人車とか
らなる自立無人車システムにおいて、前記各自立無人車
は、前記中央局から指令があったときに、現在位置から
第1番目の作業点への経路探索をそれぞれ行なうととも
にその評価値を前記中央局に送り、前記中央局は、前記
各自立無人車が第1番目の作業点への経路探索および評
価を行っている間に、第1番目の作業点から最終の作業
点までの経路探索を行い、前記中央局は、最も良い評価
値を送ってきた自立無人車に第1番目の作業点への移動
を指令し、また、該自立無人車に、前記中央局において
探索しておいた第1番目の作業点から最終の作業点まで
の経路に沿って移動すべき移動命令を送ることを特徴と
する。
「作用」 上記構成によれば、各自立無人車毎に異なっている第1
番目の作業点までの経路探索が並列処理の形で行なわれ
るので、短時間で探索が終了する。また、複数の作業点
を経由する全経路について経路探索を行う必要がないか
ら、探査処理を極めて短時間に行うことができる。さら
に、探索処理中は、中央局の処理負荷が従来に比べて著
しく減少するため、中央局は、第1番目の作業点以降の
経路探査を行うことができる。
番目の作業点までの経路探索が並列処理の形で行なわれ
るので、短時間で探索が終了する。また、複数の作業点
を経由する全経路について経路探索を行う必要がないか
ら、探査処理を極めて短時間に行うことができる。さら
に、探索処理中は、中央局の処理負荷が従来に比べて著
しく減少するため、中央局は、第1番目の作業点以降の
経路探査を行うことができる。
「実施例」 以下、図面を参照して、本発明の実施例を説明する。
第1図はこの発明の一実施例の構成を示すブロック図で
ある。
ある。
図において1は中央局、2−k(k=1,2……n)はn
個の自立無人車であり、中央局1と各自立無人車2−k
とは無線または有線の通信回線3−kによって結ばれて
いる。
個の自立無人車であり、中央局1と各自立無人車2−k
とは無線または有線の通信回線3−kによって結ばれて
いる。
中央局1は、CPUとメモリ(ともに図示略)とを有し、
各自立無人車2−kの現在位置や作業中か否かなどの状
態を把握している。また、第3図に示すような各作業点
4−K(=1,2,……N)と結ばれ、作業点からの作業要
求を受け入れ、この情報を各自立無人車2−kに伝送す
る。
各自立無人車2−kの現在位置や作業中か否かなどの状
態を把握している。また、第3図に示すような各作業点
4−K(=1,2,……N)と結ばれ、作業点からの作業要
求を受け入れ、この情報を各自立無人車2−kに伝送す
る。
一方、自立無人車2−kは第2図に示す構成となってい
る。図において、5は自立無人車2−kの走行装置であ
り、走行装置5には、その走行制御を行うCPU6が接続さ
れている。また、CPU6には、メモリ7が接続され、この
メモリ7には各作業点の座標と、作業点の接続関係を示
す地図データが格納されている。
る。図において、5は自立無人車2−kの走行装置であ
り、走行装置5には、その走行制御を行うCPU6が接続さ
れている。また、CPU6には、メモリ7が接続され、この
メモリ7には各作業点の座標と、作業点の接続関係を示
す地図データが格納されている。
CPU6は現在の作業点から目的の作業点に至る経路を探索
し、次のような演算によって評価値Hsを算出する。
し、次のような演算によって評価値Hsを算出する。
Hs=ΣH(Vi,Vj)……(1) H(Vi,Vj) =Wa・A(Vj,G)+Wb・B(Vi,Vj)……(2) ただし、A(Vj,G)=l(Vj,G)/L……(3) B(Vi,Vj)=l(Vi,Vj)/L……(4) ここで、Vi,Vjは地図上の連続する通過点(ノード)で
あり、上記(1)式の和Σは、出発作業点Sから目手作
業点Gに至るすべてのノードについてとられる。また、
l(Vj,G)はノードVjと目的ノード(目的作業点)Gと
の距離、l(Vi,Vj)は連続するノードViとノードVjと
の距離であり、Lはノード間の最大距離である。従っ
て、上記(3)、(4)式の値A(Vj,G)、B(Vi,V
j)は距離Lによって正規化されたもので、0〜1の値
をとり、目的作業点Gに近付くほど、また連続するノー
ドVi,Vj間の距離が短いほど、小さな値となる。
あり、上記(1)式の和Σは、出発作業点Sから目手作
業点Gに至るすべてのノードについてとられる。また、
l(Vj,G)はノードVjと目的ノード(目的作業点)Gと
の距離、l(Vi,Vj)は連続するノードViとノードVjと
の距離であり、Lはノード間の最大距離である。従っ
て、上記(3)、(4)式の値A(Vj,G)、B(Vi,V
j)は距離Lによって正規化されたもので、0〜1の値
をとり、目的作業点Gに近付くほど、また連続するノー
ドVi,Vj間の距離が短いほど、小さな値となる。
従って、(1)式の評価値Hsは小さいほど評価が良くな
るようになっている。なお、Wa、Wbは上記各変数A(V
j,G)およびB(Vi,Vj)の重みづけをする係数であり、
適宜の値に設定される。
るようになっている。なお、Wa、Wbは上記各変数A(V
j,G)およびB(Vi,Vj)の重みづけをする係数であり、
適宜の値に設定される。
このような構成において、ある作業点4Aから4Bを経由し
て4Nに経路に沿って順次作業を行うべく要求が発生する
と、これが中央局1に伝達され、中央局1は待機中の全
自立無人車2−k、またはシステム中の全自立無人車2
−kに最適経路の探索を指示する。
て4Nに経路に沿って順次作業を行うべく要求が発生する
と、これが中央局1に伝達され、中央局1は待機中の全
自立無人車2−k、またはシステム中の全自立無人車2
−kに最適経路の探索を指示する。
探索を指示された自立無人車2−kのCPU6は、公知の縦
型探索法あるいは横型探索法によって出発作業点(すな
わち自分の現在位置)Sから目印作業点G(すなわち第
1番目に作業を行うべき地点4−A)までの経路を探索
し、上記(1)〜(4)式によって評価値Hsを算出す
る。そして、最良の評価値Hsを与える経路を記憶すると
ともに、この最良の評価値Hsを中央局1へ伝達する。
型探索法あるいは横型探索法によって出発作業点(すな
わち自分の現在位置)Sから目印作業点G(すなわち第
1番目に作業を行うべき地点4−A)までの経路を探索
し、上記(1)〜(4)式によって評価値Hsを算出す
る。そして、最良の評価値Hsを与える経路を記憶すると
ともに、この最良の評価値Hsを中央局1へ伝達する。
このような各自立無人車2kの経路探索と並行して、中央
局は、作業点4A以降の経路、すなわち4Aから4B、さらに
は、それ以降の最終作業点4Nに至るまでの経路を探索す
る。
局は、作業点4A以降の経路、すなわち4Aから4B、さらに
は、それ以降の最終作業点4Nに至るまでの経路を探索す
る。
そして、中央局1は各自立無人車2−kから送られてき
た評価値Hsを比較して、この中から最良の評価値Hsを選
択し、最良の評価値Hsを送ってきた自立無人車2−k
(図示例では2−3が該当する)に移動命令を送るとと
もに、この自立無人車2−kに、中央局1において探査
しておいた作業点4A以降の4Nに至る経路に沿って移動す
べく移動命令を送る。なお、4A以降の経路についての作
業命令は、選択された自立無人車2−kが1番目の作業
点4Aにおける作業を終了するまでの期間に出されればよ
い。
た評価値Hsを比較して、この中から最良の評価値Hsを選
択し、最良の評価値Hsを送ってきた自立無人車2−k
(図示例では2−3が該当する)に移動命令を送るとと
もに、この自立無人車2−kに、中央局1において探査
しておいた作業点4A以降の4Nに至る経路に沿って移動す
べく移動命令を送る。なお、4A以降の経路についての作
業命令は、選択された自立無人車2−kが1番目の作業
点4Aにおける作業を終了するまでの期間に出されればよ
い。
なお、上記実施例においては、各自立無人車に地図デー
タを内蔵させたが、必要に応じて中央局からもらうよう
に構成してもよい。
タを内蔵させたが、必要に応じて中央局からもらうよう
に構成してもよい。
「発明の効果」 以上説明したように、この発明によれば、自立無人車を
移動させるべき経路の内、各無人車毎に異なっている第
1番目の作業点までの最適経路探索が各自立無人車にお
いて並列処理の形で行なわれるので、極めて短時間で探
索を終了することができる。
移動させるべき経路の内、各無人車毎に異なっている第
1番目の作業点までの最適経路探索が各自立無人車にお
いて並列処理の形で行なわれるので、極めて短時間で探
索を終了することができる。
また、各自立無人車の探索処理中に、中央局が第1番目
の作業点から最終の作業点までの経路探索を行うので、
経路探索の重複をなくすとともに、並列処理によって中
央局及び各自立無人車の処理能力を十分に利用し、資源
としての中央局及び自立無人車を有効に活用するととも
に、システム全体としての応答性を向上できる。
の作業点から最終の作業点までの経路探索を行うので、
経路探索の重複をなくすとともに、並列処理によって中
央局及び各自立無人車の処理能力を十分に利用し、資源
としての中央局及び自立無人車を有効に活用するととも
に、システム全体としての応答性を向上できる。
第1図はこの発明の一実施例による自立無人車システム
の構成を示すブロック図、第2図は自立無人車2−kの
構成を示すブロック図、第3図は作業点と自立無人車の
位置関係を説明するための平面図である。 1……中央局、2−k……自立無人車、4K……作業点。
の構成を示すブロック図、第2図は自立無人車2−kの
構成を示すブロック図、第3図は作業点と自立無人車の
位置関係を説明するための平面図である。 1……中央局、2−k……自立無人車、4K……作業点。
Claims (1)
- 【請求項1】中央局と、該中央局によって指定された第
1番目から第N番目の各作業点に移動して所定の作業を
行う複数の自立無人車とからなる自立無人車システムに
おいて、 前記各自立無人車は、前記中央局から指令があったとき
に、現在位置から第1番目の作業点への経路探索をそれ
ぞれ行なうとともにその評価値を前記中央局に送り、 前記中央局は、前記各自立無人車が第1番目の作業点へ
の経路探索および評価を行っている間に、第1番目の作
業点から最終の作業点までの経路探索を行い、 前記中央局は、最も良い評価値を送ってきた自立無人車
に第1番目の作業点への移動を指令し、また、該自立無
人車に、前記中央局において探索しておいた第1番目の
作業点から最終の作業点までの経路に沿って移動すべき
移動命令を送る ことを特徴とする自立無人車システムにおける最適経路
探索方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP61257790A JPH0786769B2 (ja) | 1986-10-29 | 1986-10-29 | 自立無人車システムにおける最適経路探索方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP61257790A JPH0786769B2 (ja) | 1986-10-29 | 1986-10-29 | 自立無人車システムにおける最適経路探索方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPS63111506A JPS63111506A (ja) | 1988-05-16 |
| JPH0786769B2 true JPH0786769B2 (ja) | 1995-09-20 |
Family
ID=17311141
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP61257790A Expired - Lifetime JPH0786769B2 (ja) | 1986-10-29 | 1986-10-29 | 自立無人車システムにおける最適経路探索方法 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPH0786769B2 (ja) |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2884816B2 (ja) * | 1991-05-10 | 1999-04-19 | 神鋼電機株式会社 | 移動ロボットシステムにおける制御方法 |
| JP3874819B2 (ja) * | 1995-02-24 | 2007-01-31 | 株式会社デンソー | 輸送経路探索装置 |
| JP3251855B2 (ja) * | 1996-06-25 | 2002-01-28 | 沖電気工業株式会社 | 移動体割当システムおよび移動体割り当て方法 |
| JP3251857B2 (ja) * | 1996-07-03 | 2002-01-28 | 沖電気工業株式会社 | 移動体割当方法 |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH067366A (ja) * | 1992-04-20 | 1994-01-18 | Olympus Optical Co Ltd | 把持鉗子 |
-
1986
- 1986-10-29 JP JP61257790A patent/JPH0786769B2/ja not_active Expired - Lifetime
Also Published As
| Publication number | Publication date |
|---|---|
| JPS63111506A (ja) | 1988-05-16 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP0512866B1 (en) | Control Method for mobile robot system | |
| JP4621073B2 (ja) | ロボット制御装置 | |
| JP2021071891A (ja) | 走行制御装置、走行制御方法、及びコンピュータプログラム | |
| CN118583184A (zh) | 复杂环境下考虑动态障碍物的智能体分层路径规划方法与系统 | |
| JP7276185B2 (ja) | タスク実行システム、無線接続方法、及びプログラム | |
| WO2021020092A1 (ja) | 駐車支援装置、及び駐車支援方法 | |
| CN110210806A (zh) | 一种5g边缘计算的云基无人车架构及其控制评价方法 | |
| JP5732921B2 (ja) | 移動体マップ装置、その処理方法及びプログラム | |
| JPS6232519A (ja) | 移動ロボツトシステムにおける最適経路探索方法 | |
| JPH0683445A (ja) | 自動走行移動体による無人搬送システムにおける走行経路選定方法 | |
| JPH0786770B2 (ja) | 自立無人車システムにおける最適経路探索方法 | |
| JPS63111506A (ja) | 自立無人車システムにおける最適経路探索方法 | |
| JP2021118364A (ja) | 通信制御装置、通信制御方法およびプログラム。 | |
| CN116149314A (zh) | 机器人全覆盖作业方法、装置及机器人 | |
| JPH0731667B2 (ja) | 移動ロボツトの最適経路探索方法 | |
| JP7407329B1 (ja) | 飛行誘導装置および飛行誘導方法 | |
| CN116185078B (zh) | 一种自适应指挥方法、装置、系统及存储介质 | |
| JP2000076581A (ja) | 経路決定方法及び移動体交通制御システム | |
| WO2021029065A1 (ja) | 飛行体の管理サーバ及び管理システム | |
| JPH04340607A (ja) | 最適経路決定装置 | |
| JP2021077089A (ja) | 複数のビークルの移動制御方法、移動制御装置、移動制御システム、プログラム及び記録媒体 | |
| JP2928658B2 (ja) | 移動ロボットの最適経路探索装置 | |
| JPH05101035A (ja) | 移動ロボツトの最適経路探索方法 | |
| JP2881943B2 (ja) | 無人搬送車の配車制御方法 | |
| US12572149B2 (en) | Control system, control method, and storage medium of plurality of autonomous mobile objects |