JPH0546565B2 - - Google Patents
Info
- Publication number
- JPH0546565B2 JPH0546565B2 JP60221285A JP22128585A JPH0546565B2 JP H0546565 B2 JPH0546565 B2 JP H0546565B2 JP 60221285 A JP60221285 A JP 60221285A JP 22128585 A JP22128585 A JP 22128585A JP H0546565 B2 JPH0546565 B2 JP H0546565B2
- Authority
- JP
- Japan
- Prior art keywords
- traveling
- command
- section
- unit
- node
- 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
- 238000012937 correction Methods 0.000 description 10
- 230000008859 change Effects 0.000 description 4
- 238000000034 method Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000001419 dependent effect Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 239000004615 ingredient Substances 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Description
【発明の詳細な説明】
[産業上の利用分野]
この発明は、無人車等の移動ロボツトに係り、
特に、走行部に車輪、クローラ、歩足等を使用し
た各種ロボツトを、指令部からの同一のコマンド
によつて制御できるようにした移動ロボツトに関
する。
特に、走行部に車輪、クローラ、歩足等を使用し
た各種ロボツトを、指令部からの同一のコマンド
によつて制御できるようにした移動ロボツトに関
する。
[従来の技術]
現在自立走行ロボツトの研究が盛んに行なわれ
ている。この種の移動ロボツトは、走行部に車
輪、クローラ、歩足等を持つており、指令部から
の命令によつて、走行するようになつている。
ている。この種の移動ロボツトは、走行部に車
輪、クローラ、歩足等を持つており、指令部から
の命令によつて、走行するようになつている。
第5図は、走行部に車輪を有する従来の移動ロ
ボツト1の構成を示すブロツク図である。図にお
いて、2は指令部、3は車輪駆動部、4a,4b
は左右の車輪5a,5bを駆動するモータであ
り、車輪駆動部3とモータ4a,4bと車輪5
a,5bが走行部6を構成している。
ボツト1の構成を示すブロツク図である。図にお
いて、2は指令部、3は車輪駆動部、4a,4b
は左右の車輪5a,5bを駆動するモータであ
り、車輪駆動部3とモータ4a,4bと車輪5
a,5bが走行部6を構成している。
このような構成において、目的地が与えられる
と、指令部2は、目的地までの走行経路を探索
し、その結果から走行指令(以下、コマンドとい
う)を作成して車輪駆動部3へ供給する。車輪駆
動部3はこのコマンドを解釈し、車輪5a,5b
を駆動する。
と、指令部2は、目的地までの走行経路を探索
し、その結果から走行指令(以下、コマンドとい
う)を作成して車輪駆動部3へ供給する。車輪駆
動部3はこのコマンドを解釈し、車輪5a,5b
を駆動する。
第6図は、従来のコマンドの一例(GOコマン
ド)を示すものである。例えば、指定部2から車
輪駆動部3へGO(60、100、10、30)なるコマン
ドが与えられると(同図a)、車輪駆動部3はこ
のコマンドを解釈して、図示するように移動ロボ
ツト1を走行させる。すなわち、移動ロボツト1
は、x軸上を直進し、x=60cmの地点でカーブを
切り始め、x=100cm、y=10cmの地点を、x軸
と30゜の角をなす方向に通過し、以後再び直進す
る。従つて新たな直進方向を新座標軸x1とする
と、新座標軸x1と旧座標軸xとがなす角は30゜と
なる。
ド)を示すものである。例えば、指定部2から車
輪駆動部3へGO(60、100、10、30)なるコマン
ドが与えられると(同図a)、車輪駆動部3はこ
のコマンドを解釈して、図示するように移動ロボ
ツト1を走行させる。すなわち、移動ロボツト1
は、x軸上を直進し、x=60cmの地点でカーブを
切り始め、x=100cm、y=10cmの地点を、x軸
と30゜の角をなす方向に通過し、以後再び直進す
る。従つて新たな直進方向を新座標軸x1とする
と、新座標軸x1と旧座標軸xとがなす角は30゜と
なる。
また、GO(100、50、80、135)なるコマンド
が与えられると(同図b)、移動ロボツト1はx
軸上を直進し、x=100cmの地点まで進んで急カ
ーブを切り始め、x=50cm、y=80cmの地点をx
軸と135゜の角をなして通過する。
が与えられると(同図b)、移動ロボツト1はx
軸上を直進し、x=100cmの地点まで進んで急カ
ーブを切り始め、x=50cm、y=80cmの地点をx
軸と135゜の角をなして通過する。
このように、車輪駆動部3は、指令部2からの
指令を解釈して、車輪5a,5bを駆動する。こ
の場合、車輪駆動部3は局所座標のみを考えて車
輪5a,5bを制御すればよい。また、指令部2
は、世界座標を管理し、移動ロボツト1が目的地
て到達できるように、経路探索、コマンド作成を
行う。
指令を解釈して、車輪5a,5bを駆動する。こ
の場合、車輪駆動部3は局所座標のみを考えて車
輪5a,5bを制御すればよい。また、指令部2
は、世界座標を管理し、移動ロボツト1が目的地
て到達できるように、経路探索、コマンド作成を
行う。
[発明が解決しようとする問題点]
ところで、上述した従来の移動ロボツトにあつ
ては、次のような欠点があつた。
ては、次のような欠点があつた。
(1) 指令部は走行部のカーブの開始地点や、終了
地点などの細かな点まで指示しなければならな
い。ところで、このような地点は、走行部が車
輪、クローラ、歩足のいずれの走行装置を採用
しているかによつて異なるため、コマンドが走
行部の方式によつて異なるものとならざるをえ
ず、指令部のプログラムが走行部な強く依存し
てしまう。
地点などの細かな点まで指示しなければならな
い。ところで、このような地点は、走行部が車
輪、クローラ、歩足のいずれの走行装置を採用
しているかによつて異なるため、コマンドが走
行部の方式によつて異なるものとならざるをえ
ず、指令部のプログラムが走行部な強く依存し
てしまう。
(2) また、走行部が歩足の場合は、複雑な重心制
御も指令部が行わなければならないため、指令
部の走行部への依存性は更に強まり、指令部の
負担も増加する。
御も指令部が行わなければならないため、指令
部の走行部への依存性は更に強まり、指令部の
負担も増加する。
(3) 従来のコマンドは進行方向がx軸方向(可
変)に限定されている。従つて、横行、斜行等
の全方向への移動を記述することができない。
変)に限定されている。従つて、横行、斜行等
の全方向への移動を記述することができない。
この発明は、このような背景の下になされたも
ので、走行部の種類に依存せず、かつ全方向への
移動が可能な移動ロボツトを提供することを目的
とする。
ので、走行部の種類に依存せず、かつ全方向への
移動が可能な移動ロボツトを提供することを目的
とする。
[問題点を解決するための手段]
上記問題点を解決するためにこの発明は、指令
部と、該指令部と別途に設けられ、所定の走行手
段を備える走行部とを有し、前記指令部が決定し
た走行経路に従つて前記走行部が前記走行手段に
よつて走行する移動ロボツトにおいて、 前記指令部は、現ノードから次ノードまでの距
離情報、走行方向情報および前記次ノードの位置
方向を示す角度情報を、現在位置から到達点に至
る間の各ノード毎に対応させて順次与える折れ線
軌跡の形で、前記走行手段の走行特性に依存しな
い、全方向を含む前記走行経路として前記走行部
に供給し、 前記走行部は、前記折れ線軌跡から、前記走行
手段の走行特性に応じて、前記各ノード間毎の速
度パターンおよび回転パターンを順次生成し、該
速度パターン、回転パターンおよび前記走行手段
からの現在の走行状況を示すフイードバツク情報
に従つて前記走行手段を駆動することを特徴とす
る。
部と、該指令部と別途に設けられ、所定の走行手
段を備える走行部とを有し、前記指令部が決定し
た走行経路に従つて前記走行部が前記走行手段に
よつて走行する移動ロボツトにおいて、 前記指令部は、現ノードから次ノードまでの距
離情報、走行方向情報および前記次ノードの位置
方向を示す角度情報を、現在位置から到達点に至
る間の各ノード毎に対応させて順次与える折れ線
軌跡の形で、前記走行手段の走行特性に依存しな
い、全方向を含む前記走行経路として前記走行部
に供給し、 前記走行部は、前記折れ線軌跡から、前記走行
手段の走行特性に応じて、前記各ノード間毎の速
度パターンおよび回転パターンを順次生成し、該
速度パターン、回転パターンおよび前記走行手段
からの現在の走行状況を示すフイードバツク情報
に従つて前記走行手段を駆動することを特徴とす
る。
[作用]
上記構成によれば、指令部から走行部に供給さ
れた折れ線軌跡を、走行部がその種類に最適の走
行パターンに変換して走行制御するので、走行部
の種類、すなわち、走行部が車輪か、クローラか
あるいは歩足か等にかかわらず、指令部から走行
部へのコマンドは同一の折れ線軌跡の形で与える
ことができる。この結果、指令部は、走行装置の
種類によつてコマンドやプログラムを変更しなく
て済み、指令部のソフトウエア資源の汎用性が増
す。
れた折れ線軌跡を、走行部がその種類に最適の走
行パターンに変換して走行制御するので、走行部
の種類、すなわち、走行部が車輪か、クローラか
あるいは歩足か等にかかわらず、指令部から走行
部へのコマンドは同一の折れ線軌跡の形で与える
ことができる。この結果、指令部は、走行装置の
種類によつてコマンドやプログラムを変更しなく
て済み、指令部のソフトウエア資源の汎用性が増
す。
また、上記折れ線軌跡を用いれば、全方向移動
可能な走行装置の制御を行うことができるので、
前・後進ばかりでなく、横行、斜行などの走行も
同一のコマンドで制御でき、従来移動ロボツトが
使えなかつた狭い場所などにも、移動ロボツトを
適用することが可能となる。
可能な走行装置の制御を行うことができるので、
前・後進ばかりでなく、横行、斜行などの走行も
同一のコマンドで制御でき、従来移動ロボツトが
使えなかつた狭い場所などにも、移動ロボツトを
適用することが可能となる。
[実施例]
以下、図面を参照して、本発明の実施例を説明
する。
する。
第1図において、11は、指令部10から無線
または有線で送られてきたコマンドを受信するコ
マンド受信部である。コマンド受信部11は、直
列信号の形で送られてきたコマンドを並列データ
の形に変換して、コマンド解釈部12に供給す
る。
または有線で送られてきたコマンドを受信するコ
マンド受信部である。コマンド受信部11は、直
列信号の形で送られてきたコマンドを並列データ
の形に変換して、コマンド解釈部12に供給す
る。
ここで、上記コマンドは
GO(x、y、v、θ、ptr、N)……(1)
の形のものである。ただし、
xはx軸方向の走行距離(正:前進、負:後退)
yはy軸方向の走行距離(正:左進、負:右進)
vはx,y方向の合成速度
θは回転角度(正:反転時計回り)
ptrは情景ポインタ
Nはコマンド実行後に到達するノード番号
である。すなわち、コマンドは、実行後に到達す
るノードNまでの走行距離をx,y各成分毎に与
えるとともに、走行速度v、次のノードに到達す
るまでの回転角度θを情景ポインタptrやノード
番号Nとともに与える。そして、一連のコマンド
によつて与えられる軌跡は、複数のノードを連結
する折れ線軌跡の形を取ることとなる。ここで、
ノードとは、停止点、分岐点、作業地点などの走
行状態変換点のことである。また情景ポインタ
ptrとは、左右の壁までの距離や壁の変化点(エ
ツジ)等の情報群を指定するものであり、これら
の情報が後述する超音波センサ等から得られた情
報と比較対比され、移動ロボツトの実際の位置を
修正するのに利用される。
るノードNまでの走行距離をx,y各成分毎に与
えるとともに、走行速度v、次のノードに到達す
るまでの回転角度θを情景ポインタptrやノード
番号Nとともに与える。そして、一連のコマンド
によつて与えられる軌跡は、複数のノードを連結
する折れ線軌跡の形を取ることとなる。ここで、
ノードとは、停止点、分岐点、作業地点などの走
行状態変換点のことである。また情景ポインタ
ptrとは、左右の壁までの距離や壁の変化点(エ
ツジ)等の情報群を指定するものであり、これら
の情報が後述する超音波センサ等から得られた情
報と比較対比され、移動ロボツトの実際の位置を
修正するのに利用される。
コマンド解釈部12は、上述のように折れ線軌
跡の形で与えられたコマンドを解釈して、移動ロ
ボツトの走行パターンを作成するものである。す
なわち、コマンド解釈部12は、一連のコマンド
によつて与えられた、x,y各成分毎の走行距
離、走行速度v、回転角度θを実現するのに最適
な速度パターンや回転パターン(第4図参照)を
走行パターンとして決定し、x軸成分の速度パタ
ーン信号vx、y軸成分の速度パターン信号vy、
回転パターン信号θを出力し、これらのパターン
信号をサーボ指令作成部13に供給する。ここ
で、上記走行パターンは走行装置(本実施例の場
合は車輪)に最も適したパターンとなるように、
走行装置の種類によつて変化する。
跡の形で与えられたコマンドを解釈して、移動ロ
ボツトの走行パターンを作成するものである。す
なわち、コマンド解釈部12は、一連のコマンド
によつて与えられた、x,y各成分毎の走行距
離、走行速度v、回転角度θを実現するのに最適
な速度パターンや回転パターン(第4図参照)を
走行パターンとして決定し、x軸成分の速度パタ
ーン信号vx、y軸成分の速度パターン信号vy、
回転パターン信号θを出力し、これらのパターン
信号をサーボ指令作成部13に供給する。ここ
で、上記走行パターンは走行装置(本実施例の場
合は車輪)に最も適したパターンとなるように、
走行装置の種類によつて変化する。
サーボ指令作成部13は、コマンド解釈部12
から供給されたパターン信号vx,vy,θを所定
のサンプリング周期毎に読み込み、これらを後述
するフイードバツク信号vxf,vyf,θfと突き合わ
せて偏差信号Δvx,Δvy,ΔΕθを演算し、これら
の信号をアナログ信号に変換した後サーボ制御部
14へ供給する。これによつて、サーボ制御部1
4は上記偏差信号が零になるように、モータ4
a,4bを駆動制御する。
から供給されたパターン信号vx,vy,θを所定
のサンプリング周期毎に読み込み、これらを後述
するフイードバツク信号vxf,vyf,θfと突き合わ
せて偏差信号Δvx,Δvy,ΔΕθを演算し、これら
の信号をアナログ信号に変換した後サーボ制御部
14へ供給する。これによつて、サーボ制御部1
4は上記偏差信号が零になるように、モータ4
a,4bを駆動制御する。
モータ4a,4bの回転量は、モータ4a,4
bの回転軸に連結されたエンコーダ15a,15
bによつて電気パルスに変換され、軌道修正部1
6に供給される。
bの回転軸に連結されたエンコーダ15a,15
bによつて電気パルスに変換され、軌道修正部1
6に供給される。
軌道修正部16は、エンコーダ15a,15b
から送られてきたパルス信号をカウントして走行
距離を求めるとともに、このパルス信号からの速
度のフイードバツク信号vxf,vyfを求める。た
だし、本実施例は走行装置として車輪を使用して
いるので、x軸方向のフイードバツク信号vxfの
みが得られる。
から送られてきたパルス信号をカウントして走行
距離を求めるとともに、このパルス信号からの速
度のフイードバツク信号vxf,vyfを求める。た
だし、本実施例は走行装置として車輪を使用して
いるので、x軸方向のフイードバツク信号vxfの
みが得られる。
軌道修正部16は、また、左右のパルス信号の
差から回転角を求め、これに修正を施して回転角
のフイードバツク信号θfを作成する。この修正
は、環境認識部17から送られてきたデータと、
地図部18に記憶され、情景ポインタptrをキー
として読み出された地図データとを比較して行う
ものである。
差から回転角を求め、これに修正を施して回転角
のフイードバツク信号θfを作成する。この修正
は、環境認識部17から送られてきたデータと、
地図部18に記憶され、情景ポインタptrをキー
として読み出された地図データとを比較して行う
ものである。
以下、上記修正につき説明する。
まず、上記地図部18は、走行経路の左右両側
の壁までの距離を、ノードからの距離と対応づけ
て記憶するメモリを有し、壁の変化点(エツジ)
毎に、ノードからの距離と、左右両側の壁までの
距離とが記憶されている。そして、1つのノード
から次のノードに至るまでの一連のデータが1つ
の情景ポインタptrと対応づけられており、コマ
ンドによつて指定された情景ポインタptrに対応
する地図データが読み出されるようになつてい
る。
の壁までの距離を、ノードからの距離と対応づけ
て記憶するメモリを有し、壁の変化点(エツジ)
毎に、ノードからの距離と、左右両側の壁までの
距離とが記憶されている。そして、1つのノード
から次のノードに至るまでの一連のデータが1つ
の情景ポインタptrと対応づけられており、コマ
ンドによつて指定された情景ポインタptrに対応
する地図データが読み出されるようになつてい
る。
一方、移動ロボツトから左右両側の壁までの実
際の距離は、超音波測距部19によつて測定され
る。すなわち、超音波側距部19は、超音波送信
器20aを駆動して壁に向けて超音波を発射し、
その反射波を受信器20bによつて受信して、こ
の間の経過時間によつて壁までの距離を測定す
る。この測定結果は環境認識部17に供給され、
環境認識部17は、壁までの距離が変化する点、
すなわち、エツジを検出する。
際の距離は、超音波測距部19によつて測定され
る。すなわち、超音波側距部19は、超音波送信
器20aを駆動して壁に向けて超音波を発射し、
その反射波を受信器20bによつて受信して、こ
の間の経過時間によつて壁までの距離を測定す
る。この測定結果は環境認識部17に供給され、
環境認識部17は、壁までの距離が変化する点、
すなわち、エツジを検出する。
軌道修正部16は、情景ポインタptrによつて
指定された地図データを地図部18から読み出す
とともに、環境認識部17から供給される左右両
側の壁までの実際を距離、およびノードからエツ
ジまで距離を、地図データと比較して次の2種類
の修正を行う。
指定された地図データを地図部18から読み出す
とともに、環境認識部17から供給される左右両
側の壁までの実際を距離、およびノードからエツ
ジまで距離を、地図データと比較して次の2種類
の修正を行う。
(1) 左右両側の壁までの距離がほぼ等しくなるよ
うに、すなわち、移動ロボツトが経路のほぼ中
央を通るように回転角を修正して、回転角のフ
イードバツク信号θf作成する。
うに、すなわち、移動ロボツトが経路のほぼ中
央を通るように回転角を修正して、回転角のフ
イードバツク信号θf作成する。
(2) エンコーダ15a,15bからのパルス信号
をカウントして得たノードからエツジまでの実
際の走行距離が、地図データから得たものと違
う場合は、この差分だけ加減して修正する。言
い替えると、上記パルス信号のカウント値に差
分を足したり引いたりして、ソフト的に修正す
る。
をカウントして得たノードからエツジまでの実
際の走行距離が、地図データから得たものと違
う場合は、この差分だけ加減して修正する。言
い替えると、上記パルス信号のカウント値に差
分を足したり引いたりして、ソフト的に修正す
る。
要約すると、上記修正は、移動ロボツトの両
側の壁までの距離によつて、左右方向の位置を
回転角によつて修正するものと、壁のエツジ
(変化点)を検出して、エンコーダのカウント
値をソフト的に修正するものとに大別される。
側の壁までの距離によつて、左右方向の位置を
回転角によつて修正するものと、壁のエツジ
(変化点)を検出して、エンコーダのカウント
値をソフト的に修正するものとに大別される。
以上が本実施例の構成であり、上述した構成要
素4a,4b,5a,5bおよび11〜20が走
行部21を構成し、指令部10と走行部21とが
移動ロボツト22(第2図)を構成している。ま
た、本実施例は、走行装置として車輪を用いてい
るので、一方向、例えば、x軸方向にのみ走行可
能であり、y軸方向の速度成分は持たない。
素4a,4b,5a,5bおよび11〜20が走
行部21を構成し、指令部10と走行部21とが
移動ロボツト22(第2図)を構成している。ま
た、本実施例は、走行装置として車輪を用いてい
るので、一方向、例えば、x軸方向にのみ走行可
能であり、y軸方向の速度成分は持たない。
次に、第2図〜第4図を参照して本実施例の動
作を説明する。なお、以下の説明では、第2図の
ノードN0からノードN7に行く場合を例にとり、
移動ロボツト22は、ノードN0で、次のノード
N1の方向を向いているものとする。また、説明
の便宜上、各ノード間の距離は10mとする。
作を説明する。なお、以下の説明では、第2図の
ノードN0からノードN7に行く場合を例にとり、
移動ロボツト22は、ノードN0で、次のノード
N1の方向を向いているものとする。また、説明
の便宜上、各ノード間の距離は10mとする。
まず、ノードN7に行くべき命令を受けると、
指令部10は、ノードN0からN7に至る最短経路
を探索し、N0→N1→N4→N5→N7の経路を決定
する。なお、この探索方法としては、縦型探索、
横型探索などの公知の方法を用いることができ
る。こうして、経路が決定されると、指令部10
は走行部に転送するコマンドとして、以下の一連
のコマンドを作成する。
指令部10は、ノードN0からN7に至る最短経路
を探索し、N0→N1→N4→N5→N7の経路を決定
する。なお、この探索方法としては、縦型探索、
横型探索などの公知の方法を用いることができ
る。こうして、経路が決定されると、指令部10
は走行部に転送するコマンドとして、以下の一連
のコマンドを作成する。
(1)GO(10000、0、2000、0、P0、N1)
(2)GO(10000、0、2000、−15708、P1、N4)
(3)GO(10000、0、2000、+15708、P2、N5)
(4)GO(10000、0、2000、−15708、P3、N7)
(5)WAIT(0、1、0)
ここで、括弧内の最初の成分10000は、ノード
間の距離が10m(=10000mm)であることを示し、
2番目の成分0は、y軸方向の距離成分がゼロで
あることを示している。また、3番目の成分2000
は、時速2Km(=2000mm)で走行すべきことを示
している。更に、4番目の成分である−15708は、
π/2=3.1416/2=1.5708に対応し、回転角が
−90゜、すなわち、時計方向に90゜回転すべきこと
を示している。最後に、5番目、6番目の成分が
情景ポインタptrと次に到達すべきノードNを示
すことは、既に述べた通りである。なお、
WAITコマンドについては後述する。
間の距離が10m(=10000mm)であることを示し、
2番目の成分0は、y軸方向の距離成分がゼロで
あることを示している。また、3番目の成分2000
は、時速2Km(=2000mm)で走行すべきことを示
している。更に、4番目の成分である−15708は、
π/2=3.1416/2=1.5708に対応し、回転角が
−90゜、すなわち、時計方向に90゜回転すべきこと
を示している。最後に、5番目、6番目の成分が
情景ポインタptrと次に到達すべきノードNを示
すことは、既に述べた通りである。なお、
WAITコマンドについては後述する。
このような、コマンドがコマンド受信部11に
受信されると、コマンド解釈部12は、まず、上
記(1)、(2)のコマンドから第3図に示すような走行
経路をイメージし、第4図に示すような速度パタ
ーンvxと回転パターンθとを作成する。
受信されると、コマンド解釈部12は、まず、上
記(1)、(2)のコマンドから第3図に示すような走行
経路をイメージし、第4図に示すような速度パタ
ーンvxと回転パターンθとを作成する。
この場合、速度パターンvxは、ノードN0から
地点S0まで徐々に加速し、速度が2000m/hに
なつた地点S0から一定の速度で走行し、コーナ
ー部のやや手前の地点S1から徐々に減速する。
地点S0まで徐々に加速し、速度が2000m/hに
なつた地点S0から一定の速度で走行し、コーナ
ー部のやや手前の地点S1から徐々に減速する。
一方、回転パターンθは、この地点S2で右方
向にカーブを切り始めて、移動ロボツト22を右
方にコーナリングさせるとともに、ノードN1に
対応する地点S3でカーブを逆方向に戻し始め、
地点S4で、移動ロボツト22が90゜のコーナリン
グを完了して、直線走行に戻るようにする。
向にカーブを切り始めて、移動ロボツト22を右
方にコーナリングさせるとともに、ノードN1に
対応する地点S3でカーブを逆方向に戻し始め、
地点S4で、移動ロボツト22が90゜のコーナリン
グを完了して、直線走行に戻るようにする。
速度パターンvxは、上記地点S4で再び加速を
開始して、地点S5で速度が2000m/hに戻るよ
うにする。
開始して、地点S5で速度が2000m/hに戻るよ
うにする。
そして、この速度パターンvxと回転パターン
θとがサーボ指令作成部13に送られ、軌道修正
部16からのフイードバツク信号vxf,θfと突き
合わされ、偏差信号Δvx,Δθが作成されてサー
ボ制御部14に供給され、上記走行パターンに沿
つた走行が行なわれる。
θとがサーボ指令作成部13に送られ、軌道修正
部16からのフイードバツク信号vxf,θfと突き
合わされ、偏差信号Δvx,Δθが作成されてサー
ボ制御部14に供給され、上記走行パターンに沿
つた走行が行なわれる。
この場合、情景ポインタP0,P1によつて地図
部18から地図情報が読み出され、上述した修
正、すなわち、移動ロボツト22が経路の中央に
くるような修正と、エンコーダ15a,15bか
らのパルスカウントの修正が行なわれる。
部18から地図情報が読み出され、上述した修
正、すなわち、移動ロボツト22が経路の中央に
くるような修正と、エンコーダ15a,15bか
らのパルスカウントの修正が行なわれる。
以下、同様に(2)、(3)のコマンドにより、ノード
N4〜N5の方向に走行制御され、(3)、(4)のコマン
ドよつて、ノードN5〜N7まで走行制御される。
そして、(5)のWAITコマンドによつて、ノード
N7の手前で減速され、ノードN7に到達した時点
でブレーキがかかつて、移動ロボツト22が停止
する。
N4〜N5の方向に走行制御され、(3)、(4)のコマン
ドよつて、ノードN5〜N7まで走行制御される。
そして、(5)のWAITコマンドによつて、ノード
N7の手前で減速され、ノードN7に到達した時点
でブレーキがかかつて、移動ロボツト22が停止
する。
以上は、前進(x軸方向の走行)のみによつて
目的地まで行つたが、交差点が狭いためにカーブ
が切れないような場合は、横行(y軸方向の走
行)を併用する方法が考えられる。この場合、走
行装置には、例えば、特開昭59−184062号公報に
記載されたような全方向移動可能な機構を用い、
次のようなコマンドで制御すればよい。
目的地まで行つたが、交差点が狭いためにカーブ
が切れないような場合は、横行(y軸方向の走
行)を併用する方法が考えられる。この場合、走
行装置には、例えば、特開昭59−184062号公報に
記載されたような全方向移動可能な機構を用い、
次のようなコマンドで制御すればよい。
(1)GO(10000、0、2000、0、P0、N1)
(2)GO(0、−10000、20000、0、P1、N4)
(3)GO(10000、0、2000、0、P2、N5)
(4)GO(0、−10000、2000、0、P3、N7)
(5)WAIT(0、1、0)
このような一連のコマンドによれば、第2図の
ノードN0からN1まで前進した後、ノードN1か
らN4まで横行し、ノードN4からN5までは再び
前進し、ノードN5からN7まで横行して目的ノー
ドN7に到達する。
ノードN0からN1まで前進した後、ノードN1か
らN4まで横行し、ノードN4からN5までは再び
前進し、ノードN5からN7まで横行して目的ノー
ドN7に到達する。
第2図の場合は、通路が直行しているので、横
行のみで対処できるが、斜めに交差している通路
がある場合は、x,y両成分にゼロでない値を与
えることによつて、斜行させればよい。
行のみで対処できるが、斜めに交差している通路
がある場合は、x,y両成分にゼロでない値を与
えることによつて、斜行させればよい。
このように、本発明によれば、指令部10から
与えられた折れ線軌跡によつて、走行部21が自
らの走行装置(車輪、クローラ、歩足等)に最適
な、滑らかな走行軌跡を作成して移動するので、
指令部10は走行装置に依存せず、走行装置が変
わつても指令部10のプログラム等を変えなくて
も済む。また、全方向の走行装置に容易に適用す
ることができる。
与えられた折れ線軌跡によつて、走行部21が自
らの走行装置(車輪、クローラ、歩足等)に最適
な、滑らかな走行軌跡を作成して移動するので、
指令部10は走行装置に依存せず、走行装置が変
わつても指令部10のプログラム等を変えなくて
も済む。また、全方向の走行装置に容易に適用す
ることができる。
次に、GOコマンド以外のコマンドについて簡
単に説明する。
単に説明する。
コマンドWAITは、WAIT(0、1、0)のよ
うな形で与えられ、動作の一時停止を指示する。
ここで、括弧の中の成分は、緩減速停止/急停
止、停止後ブレーキをかける/かけない、サーボ
オフ/オンと各指定を0/1で指示するものであ
る。
うな形で与えられ、動作の一時停止を指示する。
ここで、括弧の中の成分は、緩減速停止/急停
止、停止後ブレーキをかける/かけない、サーボ
オフ/オンと各指定を0/1で指示するものであ
る。
コマンドRESTARTは、RESTART( )の
形で与えられ、括弧の中の指定はない。これは、
WAITコマンドと反対に、一時停止状態の解除
を指令するものである。
形で与えられ、括弧の中の指定はない。これは、
WAITコマンドと反対に、一時停止状態の解除
を指令するものである。
コマンドSTOPは、非常停止を指令するもの
で、STOP( )の形で与えられる。このコマン
ドが発せられると、それ以前に出されたすべての
コマンドがキヤンセルされる。
で、STOP( )の形で与えられる。このコマン
ドが発せられると、それ以前に出されたすべての
コマンドがキヤンセルされる。
このほか、円弧状走行を指示するコマンド
ARC、位置決めのコマンドFIXなどのコマンド
がある。
ARC、位置決めのコマンドFIXなどのコマンド
がある。
なお、上記実施例において、指令部10と走行
部21は別々のプロセツサで構成してもよいし、
共通のプロセツサを時分割的に使用してもよい。
また、複数のプロセツサを結合して、データをや
り取りしながら処理するようにしてもよい。
部21は別々のプロセツサで構成してもよいし、
共通のプロセツサを時分割的に使用してもよい。
また、複数のプロセツサを結合して、データをや
り取りしながら処理するようにしてもよい。
また、走行部21のプログラムは、各種走行装
置専用のものであつてもよいし、装置装置の種類
を判別することによつて、その種類に対応するプ
ログラムを起動するようにしてもよい。
置専用のものであつてもよいし、装置装置の種類
を判別することによつて、その種類に対応するプ
ログラムを起動するようにしてもよい。
更に、環境認識部は超音波行センサに限定され
ず、その他の認識装置を使用してもかまわない。
ず、その他の認識装置を使用してもかまわない。
[発明の効果]
以上説明したように、この発明は、指令部から
走行部に、2次元折れ線軌跡の形で走行軌跡を供
給し、走行部がこの軌跡に基づいて実際の走行軌
跡を作成するようにしたので、次のような効果を
奏することができる。
走行部に、2次元折れ線軌跡の形で走行軌跡を供
給し、走行部がこの軌跡に基づいて実際の走行軌
跡を作成するようにしたので、次のような効果を
奏することができる。
(1) 車輪、クローラ、歩足等、走行装置の種類が
変わてても、指令部から走行部へのコマンドは
不変で、走行部の制御プログラムを変更するだ
けでよい。従つて、指令部のソフトウエア資源
の汎用性が増す。
変わてても、指令部から走行部へのコマンドは
不変で、走行部の制御プログラムを変更するだ
けでよい。従つて、指令部のソフトウエア資源
の汎用性が増す。
(2) コマンドが簡単な折れ線軌跡の形で記述でき
るので、走行経路のシミユレーシヨンが容易に
なる。また、走行装置の特性や種類を考慮する
必要がないので、コマンドの作成が容易にな
る。
るので、走行経路のシミユレーシヨンが容易に
なる。また、走行装置の特性や種類を考慮する
必要がないので、コマンドの作成が容易にな
る。
(3) 上記コマンドは、全方向移動可能な走行装置
にもそのまま適用できる。この結果、横行、斜
行などを用いることができ、狭い通路や作業場
所など、従来は不可能であつた場所にも移動ロ
ボツトを適用することができる。
にもそのまま適用できる。この結果、横行、斜
行などを用いることができ、狭い通路や作業場
所など、従来は不可能であつた場所にも移動ロ
ボツトを適用することができる。
第1図はこの発明の一実施例による移動ロボツ
トの電気的構成を示すブロツク図、第2図は同移
動ロボツトの走行経路の一例を示す平面図、第3
図はノードN0からノードN1を経てノードN4に
至る実際の走行軌跡を示す平面図、第4図は第3
図の場合の速度パターンと回転パターンとを示す
波形図、第5図は従来の移動ロボツトの電気的構
成を示すブロツク図、第6図は同移動ロボツトの
コマンド例を説明するための平面図である。 10……指令部、21……走行部。
トの電気的構成を示すブロツク図、第2図は同移
動ロボツトの走行経路の一例を示す平面図、第3
図はノードN0からノードN1を経てノードN4に
至る実際の走行軌跡を示す平面図、第4図は第3
図の場合の速度パターンと回転パターンとを示す
波形図、第5図は従来の移動ロボツトの電気的構
成を示すブロツク図、第6図は同移動ロボツトの
コマンド例を説明するための平面図である。 10……指令部、21……走行部。
Claims (1)
- 【特許請求の範囲】 1 指令部と、該指令部と別途に設けられ、所定
の走行手段を備える走行部とを有し、前記指令部
が決定した走行経路に従つて前記走行部が前記走
行手段によつて走行する移動ロボツトにおいて、 前記指令部は、現ノードから次ノードまでの距
離情報、走行方向情報および前記次ノードの位置
方向を示す角度情報を、現在位置から到達点に至
る間の各ノード毎に対応させて順次与える折れ線
軌跡の形で、前記走行手段の走行特性に依存しな
い、全方向を含む前記走行経路として前記走行部
に供給し、 前記走行部は、前記折れ線軌跡から、前記走行
手段の走行特性に応じて、前記各ノード間毎の速
度パターンおよび回転パターンを順次生成し、該
速度パターン、回転パターンおよび前記走行手段
からの現在の走行状況を示すフイードバツク情報
に従つて前記走行手段を駆動することを特徴とす
る移動ロボツト。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP60221285A JPS6280708A (ja) | 1985-10-04 | 1985-10-04 | 移動ロボツト |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP60221285A JPS6280708A (ja) | 1985-10-04 | 1985-10-04 | 移動ロボツト |
Publications (2)
Publication Number | Publication Date |
---|---|
JPS6280708A JPS6280708A (ja) | 1987-04-14 |
JPH0546565B2 true JPH0546565B2 (ja) | 1993-07-14 |
Family
ID=16764385
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP60221285A Granted JPS6280708A (ja) | 1985-10-04 | 1985-10-04 | 移動ロボツト |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS6280708A (ja) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5927306A (ja) * | 1982-08-09 | 1984-02-13 | Hitachi Ltd | ロボツトの制御方法 |
JPS6170616A (ja) * | 1984-09-12 | 1986-04-11 | Caterpillar Mitsubishi Ltd | 自動走行体のコ−ス移行誘導システム |
JPS6180410A (ja) * | 1984-09-28 | 1986-04-24 | Yutaka Kanayama | 移動ロボツトの走行指令方式 |
JPH0546565A (ja) * | 1991-08-07 | 1993-02-26 | Sumitomo Electric Ind Ltd | データ処理装置 |
-
1985
- 1985-10-04 JP JP60221285A patent/JPS6280708A/ja active Granted
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5927306A (ja) * | 1982-08-09 | 1984-02-13 | Hitachi Ltd | ロボツトの制御方法 |
JPS6170616A (ja) * | 1984-09-12 | 1986-04-11 | Caterpillar Mitsubishi Ltd | 自動走行体のコ−ス移行誘導システム |
JPS6180410A (ja) * | 1984-09-28 | 1986-04-24 | Yutaka Kanayama | 移動ロボツトの走行指令方式 |
JPH0546565A (ja) * | 1991-08-07 | 1993-02-26 | Sumitomo Electric Ind Ltd | データ処理装置 |
Also Published As
Publication number | Publication date |
---|---|
JPS6280708A (ja) | 1987-04-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JPS63150711A (ja) | 無人車の制御方法 | |
JP3056211B2 (ja) | 位置のフィ―ドバックと連続曲率を用いて、有向直線と有向円弧の系列からなる経路を追跡する自律ロボット移動車とその制御方法 | |
JP6599543B2 (ja) | 自動搬送車 | |
JPH0529924B2 (ja) | ||
JP2717800B2 (ja) | 自走車の操向制御装置 | |
JPS6319011A (ja) | 地点追従方式による無人移動機械の誘導方法 | |
JP2006227673A (ja) | 自律走行装置 | |
JP3266747B2 (ja) | 車両の誘導走行制御装置 | |
JPS62154008A (ja) | 自走ロボツトの走行制御方法 | |
Khatib et al. | Indoor navigation with uncertainty using sensor-based motions | |
CN112130558B (zh) | 一种基于差速轮组agv的导航***及控制方法 | |
Lundgren | Path tracking and obstacle avoidance for a miniature robot | |
JPH0827652B2 (ja) | 地点追従方式による無人移動機械の誘導方法 | |
WO2016072186A1 (ja) | 位置検出装置、制御方法及び自動走行車 | |
JPH0546565B2 (ja) | ||
JPS59111508A (ja) | 点追従方式による車両の自動誘導方法 | |
JP2564832B2 (ja) | 自立型無人車 | |
JPS633315A (ja) | 自立走行する車両の走行制御方法 | |
JPH02311909A (ja) | 移動ロボット | |
JP2671297B2 (ja) | 自立型無人車の経路修正方法 | |
JPH10105234A (ja) | 無人搬送車 | |
JP2000132229A (ja) | 移動体の走行制御方法 | |
JP2712523B2 (ja) | 自律走行車両 | |
JPH01280807A (ja) | 移動体の誘導方法 | |
JP2825239B2 (ja) | 移動体の自動誘導制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
EXPY | Cancellation because of completion of term |