JPH1185273A - 自律走行ロボット用経路生成装置および経路生成方法およびそのためのプログラムを格納した記憶媒体 - Google Patents
自律走行ロボット用経路生成装置および経路生成方法およびそのためのプログラムを格納した記憶媒体Info
- Publication number
- JPH1185273A JPH1185273A JP9236705A JP23670597A JPH1185273A JP H1185273 A JPH1185273 A JP H1185273A JP 9236705 A JP9236705 A JP 9236705A JP 23670597 A JP23670597 A JP 23670597A JP H1185273 A JPH1185273 A JP H1185273A
- Authority
- JP
- Japan
- Prior art keywords
- block
- robot
- route
- blocks
- information
- 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
- 238000000034 method Methods 0.000 title claims abstract description 7
- 230000009466 transformation Effects 0.000 claims abstract 4
- 238000006243 chemical reaction Methods 0.000 claims description 22
- 238000004590 computer program Methods 0.000 claims 1
- 238000005303 weighing Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 13
- 238000013500 data storage Methods 0.000 description 5
- 238000005452 bending Methods 0.000 description 2
- 230000032258 transport Effects 0.000 description 2
- 241000353097 Molva molva Species 0.000 description 1
- 235000012054 meals Nutrition 0.000 description 1
- 230000000474 nursing effect Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Numerical Control (AREA)
- Feedback Control In General (AREA)
Abstract
(57)【要約】
【課題】 自律走行ロボット用経路生成装置および経路
生成方法およびそのためのプログラムを格納した記憶媒
体に関し,データ作成を容易にする。 【解決手段】 通路の直線部および曲がり角および交差
点および部屋をそれぞれブロックとし,各ブロックの種
類と各ブロック間の接続情報およびブロック座標および
ブロック座標間の変換パラメータを含むブロック情報の
ブロックの種類とブロック間接続情報とに基づいて,ロ
ボットの走行路の交差点および曲がり角のブロックをノ
ードとし他のブロックを直線で表し,ブロックの長さを
重み付けしてノードとノード間を結ぶ直線によりブロッ
ク地図を作成し,ブロック地図に基づいて出発位置と最
終目標位置との間のコストが最小となる走行経路のブロ
ックを求め,最小コストの経路ブロックの各ブロック毎
に定められた座標系とブロック間の座標変換パラメータ
とに基づいてロボットの走行データを作成する。
生成方法およびそのためのプログラムを格納した記憶媒
体に関し,データ作成を容易にする。 【解決手段】 通路の直線部および曲がり角および交差
点および部屋をそれぞれブロックとし,各ブロックの種
類と各ブロック間の接続情報およびブロック座標および
ブロック座標間の変換パラメータを含むブロック情報の
ブロックの種類とブロック間接続情報とに基づいて,ロ
ボットの走行路の交差点および曲がり角のブロックをノ
ードとし他のブロックを直線で表し,ブロックの長さを
重み付けしてノードとノード間を結ぶ直線によりブロッ
ク地図を作成し,ブロック地図に基づいて出発位置と最
終目標位置との間のコストが最小となる走行経路のブロ
ックを求め,最小コストの経路ブロックの各ブロック毎
に定められた座標系とブロック間の座標変換パラメータ
とに基づいてロボットの走行データを作成する。
Description
【0001】
【発明の属する技術分野】本発明は,自律走行ロボット
の走行経路を求め,走行データを生成する自律走行ロボ
ット用経路生成装置そのためのプログラムを格納した記
憶媒体に関するものである。
の走行経路を求め,走行データを生成する自律走行ロボ
ット用経路生成装置そのためのプログラムを格納した記
憶媒体に関するものである。
【0002】病院や介護施設等の医療福祉施設では食事
の搬送や,リネン類等の洗濯物を自動的に搬送する自律
走行ロボットの開発が望まれている。また,オフィスや
学校等では夜間の監視業務等に使用できる自律走行可能
なロボットが必要とされている。このような自律走行ロ
ボットに対して,施設内の環境を表す地図に基づいて自
動的に簡単に経路を求め,ロボットの走行データを簡単
に生成することができる自律走行ロボットの経路生成装
置が必要である。
の搬送や,リネン類等の洗濯物を自動的に搬送する自律
走行ロボットの開発が望まれている。また,オフィスや
学校等では夜間の監視業務等に使用できる自律走行可能
なロボットが必要とされている。このような自律走行ロ
ボットに対して,施設内の環境を表す地図に基づいて自
動的に簡単に経路を求め,ロボットの走行データを簡単
に生成することができる自律走行ロボットの経路生成装
置が必要である。
【0003】
【従来の技術】従来のロボットの走行経路の生成(ロボ
ットの走行データを生成すること)は,施設全体を1つ
の平面として表した環境地図をもとに,その地図上で走
行する経路に沿って,ポイントとなる点をロボットの走
行プログラムに作業者が記録することにより行われてい
た。例えば,各地図上の曲がり角等をポイントとして求
め,地図のXY座標(地図にひとつだけ定めた基準座標
(ワールド座標))と進行方向をロボット内に走行デー
タとして記録した。そして,ロボットのスタート地点か
ら目標地点までの各ポイントに対してこのような走行デ
ータを作成し記録する。
ットの走行データを生成すること)は,施設全体を1つ
の平面として表した環境地図をもとに,その地図上で走
行する経路に沿って,ポイントとなる点をロボットの走
行プログラムに作業者が記録することにより行われてい
た。例えば,各地図上の曲がり角等をポイントとして求
め,地図のXY座標(地図にひとつだけ定めた基準座標
(ワールド座標))と進行方向をロボット内に走行デー
タとして記録した。そして,ロボットのスタート地点か
ら目標地点までの各ポイントに対してこのような走行デ
ータを作成し記録する。
【0004】
【発明が解決しようとする課題】このため,従来のロボ
ットの走行計画では,目的地や経路の変更は,作業者が
予め地図上の位置を確認して座標を求め,それを基にロ
ボットの走行に適した形式のデータを作成して入力する
必要があった。また,生成した経路に壁情報や障害物情
報を付加することができなかった。さらにこのデータは
地図に一つだけ定められた座標系(ワールド座標)に基
づいて作れるために座標をきめることが難しく,走行経
路の変更データを作成することは多大に労力を費やす作
業であった。
ットの走行計画では,目的地や経路の変更は,作業者が
予め地図上の位置を確認して座標を求め,それを基にロ
ボットの走行に適した形式のデータを作成して入力する
必要があった。また,生成した経路に壁情報や障害物情
報を付加することができなかった。さらにこのデータは
地図に一つだけ定められた座標系(ワールド座標)に基
づいて作れるために座標をきめることが難しく,走行経
路の変更データを作成することは多大に労力を費やす作
業であった。
【0005】特に,医療福祉施設では,対象となる部屋
や被介護者のベッドの位置が頻繁に変更されるため,ロ
ボットの走行経路の変更も頻繁に行う必要がある。ま
た,ベット等の部屋に付属する機器の位置の変更は,部
屋単位に把握されるため(同じ形状で同じベッド数の部
屋について全て同時に変更される),機器の位置の変更
があった場合には,地図全体を変更する必要があり,看
護婦や介護者がその変更をもとにロボットのデータを変
更することは不可能であった。そのため,ロボットデー
タの変更には専門技術者を必要としていた。
や被介護者のベッドの位置が頻繁に変更されるため,ロ
ボットの走行経路の変更も頻繁に行う必要がある。ま
た,ベット等の部屋に付属する機器の位置の変更は,部
屋単位に把握されるため(同じ形状で同じベッド数の部
屋について全て同時に変更される),機器の位置の変更
があった場合には,地図全体を変更する必要があり,看
護婦や介護者がその変更をもとにロボットのデータを変
更することは不可能であった。そのため,ロボットデー
タの変更には専門技術者を必要としていた。
【0006】さらに,ロボットが自律的に走行するため
には,壁の位置,ベッドの位置等の詳細な記述を地図上
に示す必要があり,大きなメモリを必要とする。本発明
は,自律装置ロボットの走行経路の生成を簡単に行うこ
とのできる自律走行ロボット用経路生成装置および経路
生成方法およびそのためのプログラムを格納した記憶媒
体を提供することを目的とする。
には,壁の位置,ベッドの位置等の詳細な記述を地図上
に示す必要があり,大きなメモリを必要とする。本発明
は,自律装置ロボットの走行経路の生成を簡単に行うこ
とのできる自律走行ロボット用経路生成装置および経路
生成方法およびそのためのプログラムを格納した記憶媒
体を提供することを目的とする。
【0007】
【課題を解決するための手段】本発明は,自律走行する
ロボットの走行経路を生成する装置において,ロボット
の走行する経路を求める対象の施設の通路の直線部およ
び曲がり角および交差点および部屋をそれぞれブロック
とし,各ブロックの種類と各ブロック間の接続情報およ
びブロック座標およびブロック座標間の変換パラメータ
を含むブロック情報のブロックの種類とブロック間接続
情報とに基づいて,ロボットの走行路の交差点および曲
がり角のブロックをノードとし他のブロックを直線で表
し,ブロックの長さを重み付けしてノードとノード間を
結ぶ直線によりブロック地図を作成するブロック地図生
成部と,該ブロック地図に基づいて出発位置と最終目標
位置との間のコストが最小となる走行経路のブロックを
求めるコスト最小ブロック経路生成部と,該コスト最小
の経路ブロックのブロック情報に含まれる各ブロック毎
に定められた座標系とブロック間の座標変換パラメータ
とに基づいてロボットの走行データを作成する走行経路
生成部とを備える。
ロボットの走行経路を生成する装置において,ロボット
の走行する経路を求める対象の施設の通路の直線部およ
び曲がり角および交差点および部屋をそれぞれブロック
とし,各ブロックの種類と各ブロック間の接続情報およ
びブロック座標およびブロック座標間の変換パラメータ
を含むブロック情報のブロックの種類とブロック間接続
情報とに基づいて,ロボットの走行路の交差点および曲
がり角のブロックをノードとし他のブロックを直線で表
し,ブロックの長さを重み付けしてノードとノード間を
結ぶ直線によりブロック地図を作成するブロック地図生
成部と,該ブロック地図に基づいて出発位置と最終目標
位置との間のコストが最小となる走行経路のブロックを
求めるコスト最小ブロック経路生成部と,該コスト最小
の経路ブロックのブロック情報に含まれる各ブロック毎
に定められた座標系とブロック間の座標変換パラメータ
とに基づいてロボットの走行データを作成する走行経路
生成部とを備える。
【0008】図1は本発明の基本構成を示す。図1にお
いて,1は入力部であって,データを入力するものであ
る。
いて,1は入力部であって,データを入力するものであ
る。
【0009】2はデータ保持部であって,入力されたデ
ータおよび作成されたブロック地図,リスト等を保持す
るものである。5はブロック情報保持部であって,ブロ
ック間の接続情報,ブロックの大きさ,ブロック座標等
のブロック情報を保持するものである。また,ブロック
情報は必要に応じて,障害物の位置,部屋等におけるロ
ボットの走行可能経路を表すパターンを含むものであ
る。
ータおよび作成されたブロック地図,リスト等を保持す
るものである。5はブロック情報保持部であって,ブロ
ック間の接続情報,ブロックの大きさ,ブロック座標等
のブロック情報を保持するものである。また,ブロック
情報は必要に応じて,障害物の位置,部屋等におけるロ
ボットの走行可能経路を表すパターンを含むものであ
る。
【0010】6はロボット初期位置のデータを表す。1
0はブロック地図生成部であって,ブロック情報をもと
にブロック地図を生成するものであり,例えば,通路の
曲がり角,交差点等をノードし,それ以外のコストを距
離とした重みデータをもつエッジとするグラフを作成す
るものである。
0はブロック地図生成部であって,ブロック情報をもと
にブロック地図を生成するものであり,例えば,通路の
曲がり角,交差点等をノードし,それ以外のコストを距
離とした重みデータをもつエッジとするグラフを作成す
るものである。
【0011】12は最小コストノード生成部であって,
ロボットの初期位置から各ノードまでの最小コスト(例
えば最短経路)の経路を求めるものである。13は最小
コストブロック経路生成部であって,最終目標位置のノ
ードもしくは最終目標位置がノードでなければそれに最
も近いノードを求め,その初期位置からそのノードまで
の最小コスト経路のブロックを求めるものである。
ロボットの初期位置から各ノードまでの最小コスト(例
えば最短経路)の経路を求めるものである。13は最小
コストブロック経路生成部であって,最終目標位置のノ
ードもしくは最終目標位置がノードでなければそれに最
も近いノードを求め,その初期位置からそのノードまで
の最小コスト経路のブロックを求めるものである。
【0012】14は走行経路生成部であって,最小コス
ト経路のブロックの座標をもとに座標変換して,経路デ
ータとするものである。15は出力部であって,生成し
た経路データを出力するものである。
ト経路のブロックの座標をもとに座標変換して,経路デ
ータとするものである。15は出力部であって,生成し
た経路データを出力するものである。
【0013】図2は,図1の本発明の基本構成の動作説
明図である。図2 (a)は,環境地図の例を示すものであ
る。B0,B1,B2,B3,B4,B5,B6,B
7,B8,B9,B10はブロックであって,通路であ
る。そのうち,B0,B3,B7,B9,B10はノー
ドになるブロックである。
明図である。図2 (a)は,環境地図の例を示すものであ
る。B0,B1,B2,B3,B4,B5,B6,B
7,B8,B9,B10はブロックであって,通路であ
る。そのうち,B0,B3,B7,B9,B10はノー
ドになるブロックである。
【0014】図2 (b)は,図2 (a)の環境地図を抽象化
したブロック地図である。通路の曲がり角(B0,B
2,B7,B9),交差点(B4)をノードとし,それ
以外の通路をエッジとし,エッジの通路の長さをエッジ
の重みとしたグラフである。
したブロック地図である。通路の曲がり角(B0,B
2,B7,B9),交差点(B4)をノードとし,それ
以外の通路をエッジとし,エッジの通路の長さをエッジ
の重みとしたグラフである。
【0015】図2を参照して,図1の構成の動作を説明
する。Aを出発点とし,ロボットの走行する最終目標位
置(到達目標)をCとする。図2 (a)の地図をもとにし
て,入力データとしてロボットの走行可能な通路をブロ
ック B0,B1,B2,B3,B4,B5,B6,B
7,B8,B9,B10に分割し,各ブロックに座標系
を定める。ブロックの長さ方向をY,幅方向をXとし,
右手座標系もしくは左手座標系等に統一して座標原点,
座標軸,および隣接座標との回転角度等の位置関係を表
すパラメータ(隣接座標との間で走行データを座標変換
するために必要)を定め,ブロック情報とする。また,
ブロックの長さ,幅,隣接ブロック番号,ノードとなる
ブロックであるか等のブロック情報をデータ入力手段に
より入力する。ブロック情報はデータ保持部に保持され
る。また,データ入力手段によりロボッドの初期位置
A,目標位置Cを入力する。各データはデータ保持部2
に保持される。
する。Aを出発点とし,ロボットの走行する最終目標位
置(到達目標)をCとする。図2 (a)の地図をもとにし
て,入力データとしてロボットの走行可能な通路をブロ
ック B0,B1,B2,B3,B4,B5,B6,B
7,B8,B9,B10に分割し,各ブロックに座標系
を定める。ブロックの長さ方向をY,幅方向をXとし,
右手座標系もしくは左手座標系等に統一して座標原点,
座標軸,および隣接座標との回転角度等の位置関係を表
すパラメータ(隣接座標との間で走行データを座標変換
するために必要)を定め,ブロック情報とする。また,
ブロックの長さ,幅,隣接ブロック番号,ノードとなる
ブロックであるか等のブロック情報をデータ入力手段に
より入力する。ブロック情報はデータ保持部に保持され
る。また,データ入力手段によりロボッドの初期位置
A,目標位置Cを入力する。各データはデータ保持部2
に保持される。
【0016】ブロック地図生成部10は入力されたブロ
ックの種類,接続関係,大きさ等のブロック情報をもと
にブロック地図を生成する。ブロック地図は,曲がり
角,交差点のブロックをノードし,それ以外の通路をエ
ッジとして抽象化した地図(グラフ)であり,例えばコ
ストとして通路の長さを重み(コスト)とする。
ックの種類,接続関係,大きさ等のブロック情報をもと
にブロック地図を生成する。ブロック地図は,曲がり
角,交差点のブロックをノードし,それ以外の通路をエ
ッジとして抽象化した地図(グラフ)であり,例えばコ
ストとして通路の長さを重み(コスト)とする。
【0017】最小コストノード生成部12はブロック地
図における各ノードの初期位置からそれぞれのノードま
でのコストが最小(例えば最短経路)を求める。最小コ
ストブロック経路生成部13は,最終目標位置のノード
もしくは最終目標位置がノードでない場合にはそのエッ
ジに最も近いノードを求め,求められているそのノード
までの最小コスト(最短経路)に基づいて,初期位置か
ら目標位置までの最小コスト(最短経路)のブロックを
求める。
図における各ノードの初期位置からそれぞれのノードま
でのコストが最小(例えば最短経路)を求める。最小コ
ストブロック経路生成部13は,最終目標位置のノード
もしくは最終目標位置がノードでない場合にはそのエッ
ジに最も近いノードを求め,求められているそのノード
までの最小コスト(最短経路)に基づいて,初期位置か
ら目標位置までの最小コスト(最短経路)のブロックを
求める。
【0018】走行経路生成部14は各ブロックの座標系
をもとに,隣接ブロックの座標系の原点と自身の座標系
の原点の関係,座標系の回転角度等の座標変換パラメー
タを考慮してそれぞれの座標系にロボットの通過する座
標(例えば,ブロックの入口と出口の座標等)を座標変
換する。走行経路の各ブロックについて座標変換し,ロ
ボットの初期位置から最終目標位置までのロボットの走
行データを求める。走行データは各ブロックに共通に定
めた基準座標(ワールド座標)あるいはブロック毎の座
標データのいずれで表しても良い。
をもとに,隣接ブロックの座標系の原点と自身の座標系
の原点の関係,座標系の回転角度等の座標変換パラメー
タを考慮してそれぞれの座標系にロボットの通過する座
標(例えば,ブロックの入口と出口の座標等)を座標変
換する。走行経路の各ブロックについて座標変換し,ロ
ボットの初期位置から最終目標位置までのロボットの走
行データを求める。走行データは各ブロックに共通に定
めた基準座標(ワールド座標)あるいはブロック毎の座
標データのいずれで表しても良い。
【0019】本発明によれば,ロボットの最小コストの
走行経路を簡単に求めることができ,ロボットの走行対
象の施設の配置等が変更されて,走行経路を変更する場
合にも簡単に変更したデータ作成することができ,変更
された条件での最適走行経路を簡単に求めることができ
る。
走行経路を簡単に求めることができ,ロボットの走行対
象の施設の配置等が変更されて,走行経路を変更する場
合にも簡単に変更したデータ作成することができ,変更
された条件での最適走行経路を簡単に求めることができ
る。
【0020】
【発明の実施の形態】図3は本発明の走行経路生成装置
と自律走行ロボットの実施例を示す図である。本実施の
形態ではコストとして距離を用いることとし,目標位置
までの最短経路を求めることとする。このため,最小コ
ストは最短距離となる。
と自律走行ロボットの実施例を示す図である。本実施の
形態ではコストとして距離を用いることとし,目標位置
までの最短経路を求めることとする。このため,最小コ
ストは最短距離となる。
【0021】図3 (a)は本発明の走行経路生成装置を,
パソコン等のコンピュータにより構成し,コンピュータ
により生成した走行データを自律走行ロボットに入力す
る場合の構成を示す。
パソコン等のコンピュータにより構成し,コンピュータ
により生成した走行データを自律走行ロボットに入力す
る場合の構成を示す。
【0022】図3 (a)において,30は記憶媒体であっ
て,走行経路生成プログラム(ブロック地図生成プログ
ラム,最短距離ノード生成プログラム,最短ブロック経
路生成プログラム(以後最小コストは最短距離であるた
め,以後この表現を用いる)を含む)を格納するもので
あり,磁気記憶媒体,光記憶媒体等である。
て,走行経路生成プログラム(ブロック地図生成プログ
ラム,最短距離ノード生成プログラム,最短ブロック経
路生成プログラム(以後最小コストは最短距離であるた
め,以後この表現を用いる)を含む)を格納するもので
あり,磁気記憶媒体,光記憶媒体等である。
【0023】31は走行経路生成プログラムである。3
2はコンピュータであって,CPU,走行経路生成プロ
グラム,データ記憶部等により自律走行ロボットの走行
経路を生成するものである。
2はコンピュータであって,CPU,走行経路生成プロ
グラム,データ記憶部等により自律走行ロボットの走行
経路を生成するものである。
【0024】33は走行経路生成装置であって,CP
U,走行経路生成プログラム,データ記憶部等により構
成されるものである。34は入力装置であって,データ
を入力するものである。
U,走行経路生成プログラム,データ記憶部等により構
成されるものである。34は入力装置であって,データ
を入力するものである。
【0025】35は出力装置であって,生成された走行
経路データ等を出力するディスプレイ,プリンタ等であ
る。あるいは,生成されたデータ等を記憶する外部記憶
装置等である。
経路データ等を出力するディスプレイ,プリンタ等であ
る。あるいは,生成されたデータ等を記憶する外部記憶
装置等である。
【0026】36は記憶データ入力装置であって,磁気
ディスクドライブ,CDROMドライブ等である。41
は自律走行ロボットである。
ディスクドライブ,CDROMドライブ等である。41
は自律走行ロボットである。
【0027】42はデータ入力部であって,自律走行に
必要なデータを入力するものである。43は走行データ
保持部であって,自律走行に必要なデータを保持するも
のである。
必要なデータを入力するものである。43は走行データ
保持部であって,自律走行に必要なデータを保持するも
のである。
【0028】44は駆動部であって,自律走行データに
基づいてロボットを走行させるものである。図3 (a)の
構成において,記憶データ入力装置36により記憶媒体
30の走行経路生成プログラムをコンピュータ32に入
力し,走行経路経路生成装置36とする。入力装置34
により環境地図のデータ(ブロック情報),ロボット初
期位置,最終目標ブロック番号等を走行経路生成装置3
3に入力する。走行経路生成装置33は入力データに基
づいて最小コストの経路を求め,ロボットの走行データ
を作成し,保持する。走行経路生成装置33で生成され
た走行データは自律走行ロボット41のデータ入力部4
2から入力され,走行データ保持部43に保持される。
駆動部44は保持されている走行経路のデータに基づい
てロボットを駆動する。
基づいてロボットを走行させるものである。図3 (a)の
構成において,記憶データ入力装置36により記憶媒体
30の走行経路生成プログラムをコンピュータ32に入
力し,走行経路経路生成装置36とする。入力装置34
により環境地図のデータ(ブロック情報),ロボット初
期位置,最終目標ブロック番号等を走行経路生成装置3
3に入力する。走行経路生成装置33は入力データに基
づいて最小コストの経路を求め,ロボットの走行データ
を作成し,保持する。走行経路生成装置33で生成され
た走行データは自律走行ロボット41のデータ入力部4
2から入力され,走行データ保持部43に保持される。
駆動部44は保持されている走行経路のデータに基づい
てロボットを駆動する。
【0029】図3 (b)は走行経路生成装置を自律走行ロ
ボットの内部にもつ場合の構成を示す。図3 (b)におい
て,31’は記憶媒体である。
ボットの内部にもつ場合の構成を示す。図3 (b)におい
て,31’は記憶媒体である。
【0030】34は入力装置であって,ブロック情報,
ロボットの初期位置,最終目標ブロック等を入力するも
のである。33は走行経路生成装置であって,自律走行
ロボットの内部に保持されたものである。
ロボットの初期位置,最終目標ブロック等を入力するも
のである。33は走行経路生成装置であって,自律走行
ロボットの内部に保持されたものである。
【0031】35は出力装置であって,生成された走行
経路データ等を出力するディスプレイ,プリンタ等であ
る。あるいは,出力されるデータを記憶する外部記憶装
置等である。
経路データ等を出力するディスプレイ,プリンタ等であ
る。あるいは,出力されるデータを記憶する外部記憶装
置等である。
【0032】42はデータ入力部であって,入力装置3
4,記憶媒体31’等から走行経路の生成に必要なデー
タを入力するものである。43は走行データ保持部であ
る。
4,記憶媒体31’等から走行経路の生成に必要なデー
タを入力するものである。43は走行データ保持部であ
る。
【0033】44は駆動部である。図3 (b)の構成にお
いて,記憶媒体31’に記憶されている走行経路作成プ
ログラムが自律走行ロボット41に入力され,走行経路
生成装置33が構成される。また,ブロック情報,ロボ
ット初期位置,最終目標ブロック等のデータが入力装置
34から入力される。走行経路生成装置33は,ブロッ
ク情報,初期位置,最終目標位置等に基づいてロボット
の走行経路を生成し,走行データ保持部43はそのデー
タを保持する。駆動部44は走行データ保持部43に保
持されている走行データに基づいて,ロボットを駆動す
る。
いて,記憶媒体31’に記憶されている走行経路作成プ
ログラムが自律走行ロボット41に入力され,走行経路
生成装置33が構成される。また,ブロック情報,ロボ
ット初期位置,最終目標ブロック等のデータが入力装置
34から入力される。走行経路生成装置33は,ブロッ
ク情報,初期位置,最終目標位置等に基づいてロボット
の走行経路を生成し,走行データ保持部43はそのデー
タを保持する。駆動部44は走行データ保持部43に保
持されている走行データに基づいて,ロボットを駆動す
る。
【0034】図4は環境地図の例である。図4におい
て,B0,B1,B2,B3,B4,B5,B6,B
7,B8,B9,B10,B11,B12,B13,B
14,B15,B16,B17,B18,B19,B2
0は,ブロックであって,ロボットの走行する通路であ
る。
て,B0,B1,B2,B3,B4,B5,B6,B
7,B8,B9,B10,B11,B12,B13,B
14,B15,B16,B17,B18,B19,B2
0は,ブロックであって,ロボットの走行する通路であ
る。
【0035】B2,B3,B6,B9,B12,B1
7,B19は通路の交差点であって,ノードである。図
3の例ではノードとなるブロックは丁字路のみである
が,ノードになり得るブロックはその他の複数路の交差
路(十字路等),曲がり角等である。
7,B19は通路の交差点であって,ノードである。図
3の例ではノードとなるブロックは丁字路のみである
が,ノードになり得るブロックはその他の複数路の交差
路(十字路等),曲がり角等である。
【0036】図5はブロックタイプの例を示す。図5に
おける括弧付きの番号はデータ構成表にブロック情報と
して記録される項目番号である。図5 (a)はタイプ0の
ブロックであって,突き当たりの通路である。ブロック
は自身の座標をもち,基準ブロックは隣接するブロック
との位置関係を定める基準のブロックである。タイプ0
のブロックはエッジとなるブロックある。
おける括弧付きの番号はデータ構成表にブロック情報と
して記録される項目番号である。図5 (a)はタイプ0の
ブロックであって,突き当たりの通路である。ブロック
は自身の座標をもち,基準ブロックは隣接するブロック
との位置関係を定める基準のブロックである。タイプ0
のブロックはエッジとなるブロックある。
【0037】図5 (b)はタイプ1のブロックであって,
通り抜けできるブロックである。ブロック自身の座標系
をもち,隣接するブロックとの関係を定めるために隣接
するブロックの一方を基準ブロックとする。タイプ1の
ブロックはエッジとなるブロックである。
通り抜けできるブロックである。ブロック自身の座標系
をもち,隣接するブロックとの関係を定めるために隣接
するブロックの一方を基準ブロックとする。タイプ1の
ブロックはエッジとなるブロックである。
【0038】図5 (c)はタイプ2のブロックであって,
曲がり角のブロックである。自身の座標系をもち,隣接
するブロックとの位置関係を定めるために隣接するブロ
ックの1つを基準ブロックとする。タイプ2のブロック
はノードとなるブロックである。
曲がり角のブロックである。自身の座標系をもち,隣接
するブロックとの位置関係を定めるために隣接するブロ
ックの1つを基準ブロックとする。タイプ2のブロック
はノードとなるブロックである。
【0039】図5 (d)はタイプ3のブロックであって,
丁字路である。自身の座標系をもち,隣接ブロックとの
位置関係を定めるために隣接するブロックの1つを基準
ブロックとする。タイプ3のブロックはノードになるブ
ロックである。
丁字路である。自身の座標系をもち,隣接ブロックとの
位置関係を定めるために隣接するブロックの1つを基準
ブロックとする。タイプ3のブロックはノードになるブ
ロックである。
【0040】図5 (e)はタイプ4のブロックであって,
十字路である。自身の座標系をもち,隣接するブロック
との位置関係を定めるために,隣接するブロックの一つ
を基準ブロックとする。タイプ4のブロックはノードに
なるブロックである。
十字路である。自身の座標系をもち,隣接するブロック
との位置関係を定めるために,隣接するブロックの一つ
を基準ブロックとする。タイプ4のブロックはノードに
なるブロックである。
【0041】図5の各タイプにおいて,各ブロックの座
標系は基準ブロックに対して平行移動した関係でセット
されているが,各ブロックの座標原点は任意の位置にと
ることができる。そして,ブロックの構成データ(ブロ
ック情報であって,詳細は後述する)を求める時に基準
ブロックの座標系と自身のブロックに対する相対位置関
係(座標原点の関係,回転角度等)を定義する。相対位
置関係はブロック間の座標変換のパラメータとする。
標系は基準ブロックに対して平行移動した関係でセット
されているが,各ブロックの座標原点は任意の位置にと
ることができる。そして,ブロックの構成データ(ブロ
ック情報であって,詳細は後述する)を求める時に基準
ブロックの座標系と自身のブロックに対する相対位置関
係(座標原点の関係,回転角度等)を定義する。相対位
置関係はブロック間の座標変換のパラメータとする。
【0042】図6は本発明のブロック構成データの例で
あり,ブロック情報である。図4の環境地図のブロック
構成データである。図6のブロック構成データにおい
て,1番目の項目(1) はブロック番号である。0はブロ
ック番号B0,1はブロック番号B1等である。
あり,ブロック情報である。図4の環境地図のブロック
構成データである。図6のブロック構成データにおい
て,1番目の項目(1) はブロック番号である。0はブロ
ック番号B0,1はブロック番号B1等である。
【0043】2番目の項目(2) は図5のタイプ番号であ
る。0はタイプ0,1はタイプ1,2はタイプ2等であ
る。ノードになるタイプは図5で説明したように,タイ
プ2〜タイプ4であり,エッジはタイプ0とタイプ1で
ある。
る。0はタイプ0,1はタイプ1,2はタイプ2等であ
る。ノードになるタイプは図5で説明したように,タイ
プ2〜タイプ4であり,エッジはタイプ0とタイプ1で
ある。
【0044】3番目の項目(3) は基準ブロックである。
例えば,ブロック0の基準ブロックはブロック1である
ことを示す。4番目の項目(4) は隣接ブロックを示し,
タイプ0のブロックは基準ブロック以外にないので−1
で表す(例えば,ブロックB15等)。また,タイプ1
とタイプ2の場合には,基準ブロックと反対側の隣接ブ
ロック番号を示す。例えば,ブロック0の場合に,基準
ブロックは1であるので,その反対側の隣接するブロッ
クの番号2とする。タイプ3,タイプ4のブロックの場
合には対象ブロック(自身のブロック)から基準ブロッ
クをみた時に左側に位置する隣接するブロックの番号で
ある。例えば,ブロックB2の基準ブロックはB0であ
り,ブロックB2からブロックB0を見た時に左側にあ
るブロックB15である。
例えば,ブロック0の基準ブロックはブロック1である
ことを示す。4番目の項目(4) は隣接ブロックを示し,
タイプ0のブロックは基準ブロック以外にないので−1
で表す(例えば,ブロックB15等)。また,タイプ1
とタイプ2の場合には,基準ブロックと反対側の隣接ブ
ロック番号を示す。例えば,ブロック0の場合に,基準
ブロックは1であるので,その反対側の隣接するブロッ
クの番号2とする。タイプ3,タイプ4のブロックの場
合には対象ブロック(自身のブロック)から基準ブロッ
クをみた時に左側に位置する隣接するブロックの番号で
ある。例えば,ブロックB2の基準ブロックはB0であ
り,ブロックB2からブロックB0を見た時に左側にあ
るブロックB15である。
【0045】5番目の項目(5) はタイプ3とタイプ4の
場合において,対象ブロック(自身のブロック)から基
準ブロックをみた時に右側に位置するブロック番号であ
る。例えば,ブロックB2の基準ブロックはB0であ
り,ブロックB2からB0を見た時に左側にあるブロッ
クB16である。タイプ0,タイプ1のブロックに対し
ては存在しないので−1とする。また,タイプ2の場合
にも存在しないが,タイプ2の場合には曲がり角の角度
を(6) に記録する(図6では存在しない)。
場合において,対象ブロック(自身のブロック)から基
準ブロックをみた時に右側に位置するブロック番号であ
る。例えば,ブロックB2の基準ブロックはB0であ
り,ブロックB2からB0を見た時に左側にあるブロッ
クB16である。タイプ0,タイプ1のブロックに対し
ては存在しないので−1とする。また,タイプ2の場合
にも存在しないが,タイプ2の場合には曲がり角の角度
を(6) に記録する(図6では存在しない)。
【0046】6番目の項目(6) はタイプ4のブロックの
場合であり,対象ブロック(自身のブロック)に対して
基準ブロックと反対側に隣接するブロック番号である。
存在しない場合には−1とする(図6の場合には,全ブ
ロックに対して存在しない)。
場合であり,対象ブロック(自身のブロック)に対して
基準ブロックと反対側に隣接するブロック番号である。
存在しない場合には−1とする(図6の場合には,全ブ
ロックに対して存在しない)。
【0047】7番目の項目(7) はブロックの長さYであ
る。例えば,ブロックB0の辺の長い方向をY軸とし
て,その長さ6000を表す。8番目の項目(8) はブロ
ックの幅Xである。例えば,ブロックB0の辺の短い方
向をX軸として,その長さ3600を表す。
る。例えば,ブロックB0の辺の長い方向をY軸とし
て,その長さ6000を表す。8番目の項目(8) はブロ
ックの幅Xである。例えば,ブロックB0の辺の短い方
向をX軸として,その長さ3600を表す。
【0048】9番目の項目(9) は自身の座標系と基準ブ
ロックの座標系に対する回転角度を表す。ブロックB0
の座標系,ブロックB1の座標系を図4に示すように定
めた時に,ブロックB0の場合,基準ブロックはB1で
あり,ブロックB0の座標系を180度回転するとブロ
ックB11の座標系になるので,回転角度を180とす
る。
ロックの座標系に対する回転角度を表す。ブロックB0
の座標系,ブロックB1の座標系を図4に示すように定
めた時に,ブロックB0の場合,基準ブロックはB1で
あり,ブロックB0の座標系を180度回転するとブロ
ックB11の座標系になるので,回転角度を180とす
る。
【0049】10番目の項目(10)は自身のブロックのX
座標の基準ブロックのX座標に対する位置を示す。11
番目の項目(11)は自身のブロックのY座標の基準ブロッ
クのY座標に対する位置を示す。
座標の基準ブロックのX座標に対する位置を示す。11
番目の項目(11)は自身のブロックのY座標の基準ブロッ
クのY座標に対する位置を示す。
【0050】12番目の項目(12)は,タイプ1におい
て,基準ブロックと反対側にあるブロックの座標原点の
自身のブロックのX方向のオフセットである。部屋デー
タ(個室,床部屋等のブロック情報)はそれぞれに接続
する接続ブロック番号と部屋の大きさ,配置のパターン
で表す。
て,基準ブロックと反対側にあるブロックの座標原点の
自身のブロックのX方向のオフセットである。部屋デー
タ(個室,床部屋等のブロック情報)はそれぞれに接続
する接続ブロック番号と部屋の大きさ,配置のパターン
で表す。
【0051】図7は本発明の走行経路生成装置の実施例
構成を示す。図7において,51はデータ保持部1であ
って,ブロック情報,ロボット初期位置,ロボット最終
目標位置,部屋情報等を保持するものである。
構成を示す。図7において,51はデータ保持部1であ
って,ブロック情報,ロボット初期位置,ロボット最終
目標位置,部屋情報等を保持するものである。
【0052】52’はブロック情報1であって,ブロッ
ク番号1の情報である。53はブロック情報2であっ
て,ブロック番号2の情報である。54はロボット初期
位置である。
ク番号1の情報である。53はブロック情報2であっ
て,ブロック番号2の情報である。54はロボット初期
位置である。
【0053】55はロボット最終目標位置である。56
は部屋情報1であって,部屋番号1の情報である。57
は部屋情報2であって,部屋番号2の情報である。
は部屋情報1であって,部屋番号1の情報である。57
は部屋情報2であって,部屋番号2の情報である。
【0054】ブロック情報1において,61はブロック
番号である。62はブロックの大きさ(長さ,幅等)で
ある。
番号である。62はブロックの大きさ(長さ,幅等)で
ある。
【0055】63は座標データであって,原点位置,基
準ブロック,基準ブロックの座標系に対する自身の座標
系の回転角度,オフセット等により構成されるものであ
る。64は基準ブロックおよび接続ブロックであって,
隣接するブロックの番号である。
準ブロック,基準ブロックの座標系に対する自身の座標
系の回転角度,オフセット等により構成されるものであ
る。64は基準ブロックおよび接続ブロックであって,
隣接するブロックの番号である。
【0056】65はタイプであって,ブロックタイプで
ある。66は曲がり角度であって,タイプ2のブロック
の曲がり角度である。部屋情報1において,67は障害
情報であって,ブロックの中のロボットの走行障害物の
座標である。
ある。66は曲がり角度であって,タイプ2のブロック
の曲がり角度である。部屋情報1において,67は障害
情報であって,ブロックの中のロボットの走行障害物の
座標である。
【0057】71は部屋番号である。72は接続ブロッ
クの番号であって,部屋が隣接するブロックの番号であ
る。73は室内走行パターンであって,室内をロボット
が走行できる経路のパターンを表す(図11参照)。
クの番号であって,部屋が隣接するブロックの番号であ
る。73は室内走行パターンであって,室内をロボット
が走行できる経路のパターンを表す(図11参照)。
【0058】データ保持部2において,75はブロック
順序リストであって,求められた走行経路のブロック番
号を通過する順番に表すものである。
順序リストであって,求められた走行経路のブロック番
号を通過する順番に表すものである。
【0059】76は座標変換リストであって,求められ
た走行経路のブロック間の座標の関係を表すものであ
る。ブロック間の座標変換は次の式により行う。
た走行経路のブロック間の座標の関係を表すものであ
る。ブロック間の座標変換は次の式により行う。
【0060】
【数1】 X,Y:次目標ブロックで表した現在のブロック原点位
置(ブロック座標の原点) θ:次目標ブロックで表した現在のブロック姿勢(ブロ
ック座標の基準座標に対する回転角度) 変換式は, OP=AOn ・・・・・・・・・・・・・(2) On:現在のブロック座標での表現 Op:次目標ブロック座標での表現 である。
置(ブロック座標の原点) θ:次目標ブロックで表した現在のブロック姿勢(ブロ
ック座標の基準座標に対する回転角度) 変換式は, OP=AOn ・・・・・・・・・・・・・(2) On:現在のブロック座標での表現 Op:次目標ブロック座標での表現 である。
【0061】77は基準座標系でのブロック間接続点リ
ストであって,求められた走行経路のブロックの通過点
を基準座標(ワールド座標)により表したものである。
各ブロックの通過点をそれぞれのブロックの座標系で表
すために現ブロックの出口の座標データを次目標ブロッ
クの入り口の座標データとして座標変換する必要があ
る。現ブロックが次目標ブロックの基準座標になってい
る場合にはデータ構成表の座標変換パラメータにより変
換する。現ブロックが次目標ブロックの基準ブロックで
ない場合には,データ構成表から自身のブロックとの位
置関係,オフセットがわかるのでそこから座標変換パラ
メータを求め,座標変換する。
ストであって,求められた走行経路のブロックの通過点
を基準座標(ワールド座標)により表したものである。
各ブロックの通過点をそれぞれのブロックの座標系で表
すために現ブロックの出口の座標データを次目標ブロッ
クの入り口の座標データとして座標変換する必要があ
る。現ブロックが次目標ブロックの基準座標になってい
る場合にはデータ構成表の座標変換パラメータにより変
換する。現ブロックが次目標ブロックの基準ブロックで
ない場合には,データ構成表から自身のブロックとの位
置関係,オフセットがわかるのでそこから座標変換パラ
メータを求め,座標変換する。
【0062】78は走行経路点列であって,求められた
走行経路の点列であり,ブロックに障害物がある場合に
は,その障害物を回避する経路である。走行経路点列に
はブロック番号を点列に対応付けて記録する。
走行経路の点列であり,ブロックに障害物がある場合に
は,その障害物を回避する経路である。走行経路点列に
はブロック番号を点列に対応付けて記録する。
【0063】81はブロック地図生成部である。84は
最短ブロック経路生成部である。91は走行経路生成部
である。
最短ブロック経路生成部である。91は走行経路生成部
である。
【0064】93はブロック順序リスト生成部であっ
て,ブロックの初期位置から最終目標位置までの経路の
うちコストが最小の経路を求めるものである。94は座
標変換リスト生成部であって,走行経路の各ブロックの
隣接座標との関係に基づく座標変換を表すリストを生成
するものである。
て,ブロックの初期位置から最終目標位置までの経路の
うちコストが最小の経路を求めるものである。94は座
標変換リスト生成部であって,走行経路の各ブロックの
隣接座標との関係に基づく座標変換を表すリストを生成
するものである。
【0065】95は基準座標系でのブロック間接続点リ
スト生成部であって,基準座標系で,ブロック間の接続
点のリストを生成するものである。96はブロック番号
をもつ走行経路点列生成部であって,走行経路の基準座
標系での点列をブロック番号とともに生成するものであ
る。障害物等があれば,障害物を回避する走行経路を生
成する。
スト生成部であって,基準座標系で,ブロック間の接続
点のリストを生成するものである。96はブロック番号
をもつ走行経路点列生成部であって,走行経路の基準座
標系での点列をブロック番号とともに生成するものであ
る。障害物等があれば,障害物を回避する走行経路を生
成する。
【0066】図8は本発明の実施例の各種リストを示
す。図8 (a)は走行経路ブロックリストであって,図4
の環境地図において,ブロック0をロボットの出発点,
ブロック13を最終目標ブロックとした時,最小コスト
として求まる経路を示す。
す。図8 (a)は走行経路ブロックリストであって,図4
の環境地図において,ブロック0をロボットの出発点,
ブロック13を最終目標ブロックとした時,最小コスト
として求まる経路を示す。
【0067】図8 (b)は,走行経路の各ブロックの走行
経路において隣接するブロックとの関係において決めら
れる座標変換パラメータのリストである。次のブロック
座標に対する座標原点(次目標ブロックで表した現在ブ
ロックの原点)と座標回転角度(次目標ブロックで表し
た現在ブロックの姿勢)をブロック毎に保持するもので
ある。
経路において隣接するブロックとの関係において決めら
れる座標変換パラメータのリストである。次のブロック
座標に対する座標原点(次目標ブロックで表した現在ブ
ロックの原点)と座標回転角度(次目標ブロックで表し
た現在ブロックの姿勢)をブロック毎に保持するもので
ある。
【0068】図8 (c)はブロック座標での接続点(A,
B,C等)の座標,ワールド座標系に変換した接続点の
座標をブロック対応に保持するものである。接続点(ブ
ロックの入口と出口の座標)は,例えば,通路の幅の中
心の座標で表す。
B,C等)の座標,ワールド座標系に変換した接続点の
座標をブロック対応に保持するものである。接続点(ブ
ロックの入口と出口の座標)は,例えば,通路の幅の中
心の座標で表す。
【0069】図8 (d)は走行経路の点列を表すリストで
ある。図8 (d)は走行経路の点列を表し,基準座標系で
表すものである。例えば,ブロックB5に障害物がある
のて,ブロックB5では障害物を迂回して経路(K−L
−M−N)を求める。
ある。図8 (d)は走行経路の点列を表し,基準座標系で
表すものである。例えば,ブロックB5に障害物がある
のて,ブロックB5では障害物を迂回して経路(K−L
−M−N)を求める。
【0070】図9は本発明の実施例のフローチャートで
ある。環境地図をもとに,ブロック番号,座標系等を定
め,図5のブロック構成データを作成し,入力部により
入力する。ブロック構成データはブロック情報としてデ
ータ保持部に保持される。また,ロボット初期位置を入
力する。ロボット初期位置はデータ保持部に保持され
る。また,部屋データを入力する。部屋データはデータ
保持部に部屋情報として保持される。
ある。環境地図をもとに,ブロック番号,座標系等を定
め,図5のブロック構成データを作成し,入力部により
入力する。ブロック構成データはブロック情報としてデ
ータ保持部に保持される。また,ロボット初期位置を入
力する。ロボット初期位置はデータ保持部に保持され
る。また,部屋データを入力する。部屋データはデータ
保持部に部屋情報として保持される。
【0071】S1 ブロック地図生成部81はブロック
構成データを読み込む。ブロック地図作成部は交差点の
ブロックをノードし,それ以外のブロックをエッジとし
て,ブロック地図を作成する。
構成データを読み込む。ブロック地図作成部は交差点の
ブロックをノードし,それ以外のブロックをエッジとし
て,ブロック地図を作成する。
【0072】S2,S3 最短距離ノード生成部83は
ロボットの初期位置を読み込み,ロボットの初期位置を
ノードとして,各ノードまでの距離コストOを設定す
る。 S4 ダイクストラ法により各エッジの長さ(Leng
th)を距離コストとして,各ノードまでの最短距離コ
ストを計算する。
ロボットの初期位置を読み込み,ロボットの初期位置を
ノードとして,各ノードまでの距離コストOを設定す
る。 S4 ダイクストラ法により各エッジの長さ(Leng
th)を距離コストとして,各ノードまでの最短距離コ
ストを計算する。
【0073】S5 ロボットが到達する目標の部屋の部
屋データからその部屋が接続するブロックを求め,最初
の目標ブロックとする。 S6 目標ブロックがノードであるか判定する。ノード
であればS7の処理を行い,ノードでなければS8の処
理をする。
屋データからその部屋が接続するブロックを求め,最初
の目標ブロックとする。 S6 目標ブロックがノードであるか判定する。ノード
であればS7の処理を行い,ノードでなければS8の処
理をする。
【0074】S7 ブロック順序リスト生成部93は,
目標ブロックがノードであれば,隣接するノードで最小
コストとなるブロックを次の目標ブロックに設定する。
例えば,図3において,ロボット初期位置がB0であっ
て,目標ブロックがB9であれば,次の目標ブロックを
B3にする。
目標ブロックがノードであれば,隣接するノードで最小
コストとなるブロックを次の目標ブロックに設定する。
例えば,図3において,ロボット初期位置がB0であっ
て,目標ブロックがB9であれば,次の目標ブロックを
B3にする。
【0075】S8 ブロック順序リスト生成部93は,
エッジが接続しているノードのコストを比較し,最小コ
ストのノードを目標ブロックとして登録する。例えは,
ロボット初期位置がB0であって,目標ブロックがB1
0であれば,次の目標ブロックをB9とする。
エッジが接続しているノードのコストを比較し,最小コ
ストのノードを目標ブロックとして登録する。例えは,
ロボット初期位置がB0であって,目標ブロックがB1
0であれば,次の目標ブロックをB9とする。
【0076】S10 ブロック順序リスト生成部93
は,次目標ブロックが初期位置のブロックか判定し,初
期位置のブロックでなければ,S7以降の処理を,初期
ブロックに到達するまで繰り返す。
は,次目標ブロックが初期位置のブロックか判定し,初
期位置のブロックでなければ,S7以降の処理を,初期
ブロックに到達するまで繰り返す。
【0077】S11 座標変換リスト生成部94は,走
行経路のブロックに対して座標変換リストを生成する。
また,座標変換パラメータにより接続点の座標を座標変
換して,各ブロックでの座標系の接続点の座標を求め
る。
行経路のブロックに対して座標変換リストを生成する。
また,座標変換パラメータにより接続点の座標を座標変
換して,各ブロックでの座標系の接続点の座標を求め
る。
【0078】S12 基準座標系のブロック間座標変換
リスト生成部95は,基準となる座標系への各接続点変
換とブロック番号リストを生成する。 S13 走行経路点列生成部は,ブロック番号を持った
走行経路の点列を生成する。
リスト生成部95は,基準となる座標系への各接続点変
換とブロック番号リストを生成する。 S13 走行経路点列生成部は,ブロック番号を持った
走行経路の点列を生成する。
【0079】図10は以上のようにして求めたロボット
の走行経路の例を示す。ブロックB0を初期位置,最終
目標位置を個室423の入口までの経路のうちコストの
最小な経路を求めたものである。ブロック内に障害物が
ある場合には,障害物を回避して走行する経路の通過点
の座標を与える。
の走行経路の例を示す。ブロックB0を初期位置,最終
目標位置を個室423の入口までの経路のうちコストの
最小な経路を求めたものである。ブロック内に障害物が
ある場合には,障害物を回避して走行する経路の通過点
の座標を与える。
【0080】なお,B2(6000),B3(600
0),B9(167000),B12(25905)等
の括弧内の数字はコストを表す。図11はブロック内に
障害物がある場合と,部屋の内部の走行パターンの例を
示す。
0),B9(167000),B12(25905)等
の括弧内の数字はコストを表す。図11はブロック内に
障害物がある場合と,部屋の内部の走行パターンの例を
示す。
【0081】図11 (a)において,ブロック内の通過点
P,Qの座標をブロック座標Block−Aで表す。図
11 (a)の場合,P((WIDTH−width)/
2,Y 0 ),Q((WIDTH−width)/2,Y
0 +length)で表す。
P,Qの座標をブロック座標Block−Aで表す。図
11 (a)の場合,P((WIDTH−width)/
2,Y 0 ),Q((WIDTH−width)/2,Y
0 +length)で表す。
【0082】ロボットの通行経路はR(ブロックの入
口)−P−Q−S(ブロックの出口)Sで表すことがで
きる。図11 (b), (c)は部屋の中の走行経路のパター
ンの例を示す。
口)−P−Q−S(ブロックの出口)Sで表すことがで
きる。図11 (b), (c)は部屋の中の走行経路のパター
ンの例を示す。
【0083】医療福祉施設等における部屋の構成は,部
屋の大きさ(Rw,Rl),形状,ベッド数等によっ
て,一定に決められている。図11 (b), (c)はベッド
数が4の場合について例示したものである。この場合,
例えば,図11 (b)と図11 (c)の2つのパターンがあ
り,ロボットの走行経路も2つのパターンに決められ
る。
屋の大きさ(Rw,Rl),形状,ベッド数等によっ
て,一定に決められている。図11 (b), (c)はベッド
数が4の場合について例示したものである。この場合,
例えば,図11 (b)と図11 (c)の2つのパターンがあ
り,ロボットの走行経路も2つのパターンに決められ
る。
【0084】従って,部屋の構成に応じてあらかじめパ
ターンを求めておき,パターン1もしくはパターン2を
選択することによりロボットの走行経路を容易に決定す
ることができる。
ターンを求めておき,パターン1もしくはパターン2を
選択することによりロボットの走行経路を容易に決定す
ることができる。
【0085】各部屋の走行経路を部屋の座標系で,図示
のように座標で求めておき,各部屋の座標定の原点(R
x,Ry)をそれぞれの部屋に隣接している廊下のブロ
ックの座標系で表しておくことにより容易に部屋毎の走
行経路を生成できる。
のように座標で求めておき,各部屋の座標定の原点(R
x,Ry)をそれぞれの部屋に隣接している廊下のブロ
ックの座標系で表しておくことにより容易に部屋毎の走
行経路を生成できる。
【0086】上記のように,本発明によれば,ブロック
地図において,交差点,曲がり角をノード,その他をエ
ッジ(辺)とし,エッジ部分に相当するブロックの長さ
を距離とした重み付けグラフを構成することで,最短経
路間作等を効率良く行うことができる。また,施設内の
地図をブロックに分割することで,ロボットは,各ブロ
ック毎に構成情報をもつ。このため,壁,障害物の位置
等はすべてブロック毎の座標系で取り扱えるため,変更
等の取扱が容易になる。また,ベッドの情報等を全て1
つのブロック内で保持できるため,位置変更時はブロッ
ク内記述の変更で対応できる。
地図において,交差点,曲がり角をノード,その他をエ
ッジ(辺)とし,エッジ部分に相当するブロックの長さ
を距離とした重み付けグラフを構成することで,最短経
路間作等を効率良く行うことができる。また,施設内の
地図をブロックに分割することで,ロボットは,各ブロ
ック毎に構成情報をもつ。このため,壁,障害物の位置
等はすべてブロック毎の座標系で取り扱えるため,変更
等の取扱が容易になる。また,ベッドの情報等を全て1
つのブロック内で保持できるため,位置変更時はブロッ
ク内記述の変更で対応できる。
【0087】
【発明の効果】本発明によれば,ロボットの走行路をブ
ロックに分割し,ブロック毎の座標系でデータを作成で
きる。そのため,ロボットの走行路を求めるためのデー
タを容易に作成することができ,最小コストの走行経路
を簡単に求めることができる。また,ロボットの走行対
象の施設の配置等が変更されても,ブロック毎の座標系
で取り扱えるので,変更データを容易に作成することが
できる。そのため,変更された条件での最小コスト経路
を容易に求めることができる。
ロックに分割し,ブロック毎の座標系でデータを作成で
きる。そのため,ロボットの走行路を求めるためのデー
タを容易に作成することができ,最小コストの走行経路
を簡単に求めることができる。また,ロボットの走行対
象の施設の配置等が変更されても,ブロック毎の座標系
で取り扱えるので,変更データを容易に作成することが
できる。そのため,変更された条件での最小コスト経路
を容易に求めることができる。
【0088】また,部屋の走行経路はパターン化されて
いるので,部屋内の物の配置が変更され,そのような変
更が施設の他の部屋においても共通になされたような場
合にも,走行路のパターンを変更するだけで良いので,
施設全体の走行路の変更を容易に行うことができる。
いるので,部屋内の物の配置が変更され,そのような変
更が施設の他の部屋においても共通になされたような場
合にも,走行路のパターンを変更するだけで良いので,
施設全体の走行路の変更を容易に行うことができる。
【図1】本発明の基本構成を示す図である。
【図2】本発明の基本構成の動作説明図である。
【図3】本発明の走行経路生成装置と自律走行ロボット
の実施例を示す図である。
の実施例を示す図である。
【図4】本発明で使用する環境地図の例を示す図であ
る。
る。
【図5】本発明のブロックタイプの例を示す図である。
【図6】ブロック構成データの例を示す図である。
【図7】本発明の走行経路生成装置の実施例構成を示す
図である。
図である。
【図8】本発明の各リストの例を示す図である。
【図9】本発明の実施例のフローチャートを示す図であ
る。
る。
【図10】本発明の経路生成結果の例を示す図である。
【図11】本発明の障害物と部屋の走行パターンの例を
示す図である。
示す図である。
1:入力部 2:データ保持部 5:ブロック情報 5’:ブロック地図 6:ロボット初期位置 7:最終目標情報 10:ブロック地図生成部 12:最小コストノード生成部 13:最小コストブロック経路生成部 14:走行経路生成部 15:出力部
Claims (5)
- 【請求項1】 自律走行するロボットの走行経路を生成
する装置において,ロボットの走行する経路を求める対
象の施設の通路の直線部および曲がり角および交差点お
よび部屋をそれぞれブロックとし,各ブロックの種類と
各ブロック間の接続情報およびブロック座標およびブロ
ック座標間の変換パラメータを含むブロック情報のブロ
ックの種類とブロック間接続情報とに基づいて,ロボッ
トの走行路の交差点および曲がり角のブロックをノード
とし他のブロックを直線で表し,ブロックの長さを重み
付けしてノードとノード間を結ぶ直線によりブロック地
図を作成するブロック地図生成部と,該ブロック地図に
基づいて出発位置と最終目標位置との間のコストが最小
となる走行経路のブロックを求めるコスト最小ブロック
経路生成部と,該コスト最小の経路ブロックのブロック
情報に含まれる各ブロック毎に定められた座標系とブロ
ック間の座標変換パラメータとに基づいてロボットの走
行データを作成する走行経路生成部とを備えることを特
徴とする自律走行ロボット用経路生成装置。 - 【請求項2】 ブロック情報はブロックの障害情報を含
み,該走行路生成部はその障害情報をもとにして障害物
を回避する走行経路を生成することを特徴とする請求項
1に記載の自律走行ロボット用経路生成装置。 - 【請求項3】 部屋のブロック情報は,部屋にある物の
配置がほぼ同じである複数の部屋に共通に定められた部
屋内の走行経路を表す走行パターン情報をもち,走行経
路生成部は,部屋内の走行経路については該走行パター
ンに基づいて部屋内の走行データを生成することを特徴
とする請求項1もしくは2に記載の自律走行ロボット用
経路生成装置。 - 【請求項4】 自律走行するロボットの走行経路を生成
する方法において,ロボットの走行する経路を求める対
象の施設の通路の直線部および曲がり角および交差点お
よび部屋をそれぞれブロックとし,各ブロックの種類と
ブロック間の接続情報とブロック毎に定められた座標系
とブロックの座標変換パラメータをもつブロック情報を
入力し,ブロック情報のブロックの種類およびブロック
間接続情報に基づいてロボットの走行路の交差点および
曲がり角のブロックをノードとし他のブロックを直線で
表し,ブロックの長さを重み付けしてノードとノード間
を結ぶ直線によりブロック地図を作成し,該ブロック地
図に基づいて出発位置と最終目標位置と間のコストが最
小となる走行経路のブロックを求め,該コスト最小の経
路ブロックと各ブロック毎に定められた座標系とブロッ
クの座標変換パラメータをもつブロック情報とに基づい
てロボットの走行データを作成することを特徴とする自
律走行ロボット用経路生成方法。 - 【請求項5】 自律走行するロボットの走行経路を求め
る対象の施設の通路の直線部および曲がり角および交差
点および各部屋をブロックとし,各ブロックの種類およ
び各ブロック間の接続情報と各ブロック毎に定められた
座標系とブロックの座標変換パラメータをもつブロック
情報のブロック間接続情報に基づいてロボットの走行路
の交差点および曲がり角のブロックをノードとし他のブ
ロックを直線で表し,ブロックの長さを重み付けしてノ
ードとノード間を結ぶ直線によりブロック地図を作成
し,該ブロック地図に基づいて出発位置と最終目標位置
との間のコストが最小となる走行経路のブロックを求
め,ブロック情報の該コスト最小の経路ブロックと各ブ
ロック毎に定められた座標系とブロックの座標変換パラ
メータとに基づいてロボットの走行データを作成するコ
ンピュータプログラムを格納した記憶媒体。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP9236705A JPH1185273A (ja) | 1997-09-02 | 1997-09-02 | 自律走行ロボット用経路生成装置および経路生成方法およびそのためのプログラムを格納した記憶媒体 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP9236705A JPH1185273A (ja) | 1997-09-02 | 1997-09-02 | 自律走行ロボット用経路生成装置および経路生成方法およびそのためのプログラムを格納した記憶媒体 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH1185273A true JPH1185273A (ja) | 1999-03-30 |
Family
ID=17004551
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP9236705A Pending JPH1185273A (ja) | 1997-09-02 | 1997-09-02 | 自律走行ロボット用経路生成装置および経路生成方法およびそのためのプログラムを格納した記憶媒体 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH1185273A (ja) |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100715609B1 (ko) * | 2006-01-13 | 2007-05-07 | 학교법인 포항공과대학교 | 가정환경에서의 이동로봇의 위상학적 지도형성 및 자율주행방법 |
KR100822738B1 (ko) * | 2006-12-06 | 2008-04-17 | 고려대학교 산학협력단 | 이동로봇의 경로계획 방법 |
WO2009005188A1 (en) * | 2007-07-03 | 2009-01-08 | Electronics And Telecommunications Research Institute | Path search method |
JP2009515226A (ja) * | 2005-12-09 | 2009-04-09 | 韓國電子通信研究院 | 人工標識と地域座標系を用いた移動ロボットの地図の作成方法及び移動方法 |
KR100955655B1 (ko) * | 2007-10-17 | 2010-05-06 | 한국생산기술연구원 | 로봇의 자율 주행 방법 |
JP2013242738A (ja) * | 2012-05-22 | 2013-12-05 | Sharp Corp | ロボット装置、端末装置、ロボット装置の遠隔操作システム及びプログラム |
JP2014071846A (ja) * | 2012-10-01 | 2014-04-21 | Sharp Corp | レイアウト情報作成装置、レイアウト情報作成方法、および自走式電子機器 |
JP2014085829A (ja) * | 2012-10-23 | 2014-05-12 | Sharp Corp | 機器制御装置、および自走式電子機器 |
CN108628299A (zh) * | 2017-03-23 | 2018-10-09 | 株式会社日立制作所 | 移动体、移动体控制***及移动体控制方法 |
CN109052077A (zh) * | 2018-08-23 | 2018-12-21 | 北京云迹科技有限公司 | 基于物联网的机器人呼梯方法及装置 |
CN109901596A (zh) * | 2019-04-20 | 2019-06-18 | 上海森恒环保科技有限公司 | 一种物联网下危废源头贮存监控预警*** |
CN111443693A (zh) * | 2018-12-27 | 2020-07-24 | 北京奇虎科技有限公司 | 区块超边界处理方法、电子设备及计算机可读存储介质 |
CN115328108A (zh) * | 2021-04-23 | 2022-11-11 | 南京泉峰科技有限公司 | 智能割草设备及其运行控制方法 |
-
1997
- 1997-09-02 JP JP9236705A patent/JPH1185273A/ja active Pending
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009515226A (ja) * | 2005-12-09 | 2009-04-09 | 韓國電子通信研究院 | 人工標識と地域座標系を用いた移動ロボットの地図の作成方法及び移動方法 |
KR100715609B1 (ko) * | 2006-01-13 | 2007-05-07 | 학교법인 포항공과대학교 | 가정환경에서의 이동로봇의 위상학적 지도형성 및 자율주행방법 |
KR100822738B1 (ko) * | 2006-12-06 | 2008-04-17 | 고려대학교 산학협력단 | 이동로봇의 경로계획 방법 |
WO2009005188A1 (en) * | 2007-07-03 | 2009-01-08 | Electronics And Telecommunications Research Institute | Path search method |
KR100915527B1 (ko) * | 2007-07-03 | 2009-09-04 | 한국전자통신연구원 | 경로 탐색 방법 |
US8296064B2 (en) | 2007-07-03 | 2012-10-23 | Electronics And Telecommunications Research Institute | Path search method |
KR100955655B1 (ko) * | 2007-10-17 | 2010-05-06 | 한국생산기술연구원 | 로봇의 자율 주행 방법 |
JP2013242738A (ja) * | 2012-05-22 | 2013-12-05 | Sharp Corp | ロボット装置、端末装置、ロボット装置の遠隔操作システム及びプログラム |
JP2014071846A (ja) * | 2012-10-01 | 2014-04-21 | Sharp Corp | レイアウト情報作成装置、レイアウト情報作成方法、および自走式電子機器 |
JP2014085829A (ja) * | 2012-10-23 | 2014-05-12 | Sharp Corp | 機器制御装置、および自走式電子機器 |
CN108628299A (zh) * | 2017-03-23 | 2018-10-09 | 株式会社日立制作所 | 移动体、移动体控制***及移动体控制方法 |
CN108628299B (zh) * | 2017-03-23 | 2021-11-26 | 株式会社日立制作所 | 移动体、移动体控制***及移动体控制方法 |
CN109052077A (zh) * | 2018-08-23 | 2018-12-21 | 北京云迹科技有限公司 | 基于物联网的机器人呼梯方法及装置 |
CN111443693A (zh) * | 2018-12-27 | 2020-07-24 | 北京奇虎科技有限公司 | 区块超边界处理方法、电子设备及计算机可读存储介质 |
CN109901596A (zh) * | 2019-04-20 | 2019-06-18 | 上海森恒环保科技有限公司 | 一种物联网下危废源头贮存监控预警*** |
CN115328108A (zh) * | 2021-04-23 | 2022-11-11 | 南京泉峰科技有限公司 | 智能割草设备及其运行控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Taylor et al. | Vision-based motion planning and exploration algorithms for mobile robots | |
JPH1185273A (ja) | 自律走行ロボット用経路生成装置および経路生成方法およびそのためのプログラムを格納した記憶媒体 | |
Bender et al. | Lanelets: Efficient map representation for autonomous driving | |
Dudek et al. | Robotic exploration as graph construction | |
Yang et al. | Generation of navigation graphs for indoor space | |
JP3471003B2 (ja) | 交差点表示方法およびその地図表示装置並びに記録媒体 | |
Geraerts | Planning short paths with clearance using explicit corridors | |
Goto et al. | Mobile robot navigation: The CMU system | |
EP2530433A1 (en) | Method of generating a database for a navigation device, method of outputting a three-dimensional map, and navigation device | |
JP2006259963A (ja) | 移動ロボットの経路生成装置 | |
Makaliwe et al. | Automatic planning of nanoparticle assembly tasks | |
Freksa et al. | Spatial problem solving and cognition | |
Cagigas et al. | Hierarchical path search with partial materialization of costs for a smart wheelchair | |
Mohanraj et al. | Mobile robot path planning and obstacle avoidance using hybrid algorithm | |
JP2024507761A (ja) | 動的環境におけるロボットのナビゲーションをヒューリスティックな学習に基づき制御するシステムおよび方法 | |
Overmars | Recent developments in motion planning | |
Mohiuddin et al. | An Efficient Lidar Sensing System For Self-Driving Cars | |
Mikula | Meta-heuristics for routing problems | |
Gregorić et al. | Autonomous hierarchy creation for computationally feasible near-optimal path planning in large environments | |
Johansson | Intelligent motion planning for a multi-robot system | |
Vatistas | Multi-objective mobile robot path planning applied in autonomous robotic inspection of outdoor environment | |
Kallmann | Flexible and efficient navigation meshes for virtual worlds | |
Sarot et al. | Proposal of a spatial database for indoor navigation | |
Coleman et al. | O3: An optimal and opportunistic path planner (with obstacle avoidance) using voronoi polygons | |
Szczerba | New cell decomposition techniques for planning optimal paths |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20040623 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20070403 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20070410 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20080115 |