JPH03135609A - 全方向移動車の精密停止方法 - Google Patents
全方向移動車の精密停止方法Info
- Publication number
- JPH03135609A JPH03135609A JP1208748A JP20874889A JPH03135609A JP H03135609 A JPH03135609 A JP H03135609A JP 1208748 A JP1208748 A JP 1208748A JP 20874889 A JP20874889 A JP 20874889A JP H03135609 A JPH03135609 A JP H03135609A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- omnidirectional
- stop position
- error
- stopping position
- 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.)
- Granted
Links
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
(産業上の利用分野)
本発明は、ガイドレスで自動操舵を行う全方向移動車で
あって、あらかじめ定められた走行路からのずれを更正
して精密にステーション等へ停止させるときの精密停止
方法に関する。
あって、あらかじめ定められた走行路からのずれを更正
して精密にステーション等へ停止させるときの精密停止
方法に関する。
(従来の技術)
全方向移動車は、その車体に搭載した中央処理装置に予
定走行経路を記憶させるとともに、その車輪の回転数等
から実走行距離を計測し、車体内部に備えたプログラム
に基づいて、前記予定走行経路に沿って車体を誘導する
ごとく制御を行っている。
定走行経路を記憶させるとともに、その車輪の回転数等
から実走行距離を計測し、車体内部に備えたプログラム
に基づいて、前記予定走行経路に沿って車体を誘導する
ごとく制御を行っている。
例えば、全方向移動車を直進走行させる場合。
走行開始位置から目標停止位置までの距離を車体に搭載
した中央処理装置に記憶させ、車輪の回転数等から演算
した実走行距離が前記距離と一敗したときに全方向移動
車が停止するようにプログラム制御を行っている。
した中央処理装置に記憶させ、車輪の回転数等から演算
した実走行距離が前記距離と一敗したときに全方向移動
車が停止するようにプログラム制御を行っている。
(発明が解決しようとする課題)
このような構成のものでは、車輪の摩耗等による機械的
誤差、あるいは製作誤差によって正確な実走行距離を得
ることができず、ステーション等へ精密に停止させるこ
とができきないという課題があった。
誤差、あるいは製作誤差によって正確な実走行距離を得
ることができず、ステーション等へ精密に停止させるこ
とができきないという課題があった。
(問題を解決するための手段)
本発明は、車体内部に設けた中央処理装置にて予め決定
される走行路を第1の主プログラムに基づいて走行する
全方向移動車であって、該全方向移動車の車輪の回転数
を検知する回転数検知器と。
される走行路を第1の主プログラムに基づいて走行する
全方向移動車であって、該全方向移動車の車輪の回転数
を検知する回転数検知器と。
操舵輪の操舵角を検知する操舵角検知器とを設け。
前記走行路からのずれを更正して前記走行路を走行する
全方向移動車において。
全方向移動車において。
該全方向移動車の車体前後部及び両側部に測距装置をそ
れぞれ配設し。
れぞれ配設し。
該全方向移動車が目標停止位置に到達したとみなされた
際に目標停止位置と現実の停止位置とのずれを演算し、
該ずれを更正するよう新たに開始される第2の補助プロ
グラムを備えた構成を基本とし、全方向移動車をステー
ション等に精密に停止させることを目的とする。
際に目標停止位置と現実の停止位置とのずれを演算し、
該ずれを更正するよう新たに開始される第2の補助プロ
グラムを備えた構成を基本とし、全方向移動車をステー
ション等に精密に停止させることを目的とする。
(実施例及び作用)
以下1本発明の作用及び一実施例を図面に基づき説明す
る。
る。
第1図は、全方向移動車の概略構成を例示し。
1はワークの搬送をする全方向移動車、IAは該全方向
移動車の車体、DPI、DF2.DF3゜DF4はそれ
ぞれ操舵自在な操舵輪であり、操舵用電動機4・・・が
それぞれ配設されている。
移動車の車体、DPI、DF2.DF3゜DF4はそれ
ぞれ操舵自在な操舵輪であり、操舵用電動機4・・・が
それぞれ配設されている。
該操舵輪DPI、DF2.DF3.DF4のうちDPI
及びDF4は駆動輪を兼ねており、走行用電動機5.5
が配設されている。
及びDF4は駆動輪を兼ねており、走行用電動機5.5
が配設されている。
又各車輪には1回転数を検知するための回転数検知器2
及び操舵角を検知する操舵角検知器3がそれぞれ付設さ
れている。
及び操舵角を検知する操舵角検知器3がそれぞれ付設さ
れている。
Xl−X8は車体IAの前後部及び両側部に各2個ずつ
配設された測距装置を示し1本実施例では周知の光学式
測距装置を使用しているが、これに限るものではなく1
例えば橙音波等の測距装置を用いることもできる。又、
後述のように前部と側部、若しくは後部と側部で合計3
個の測距装置が測定することができれば他の5個の測距
装置は不要となるので、全方向移動車の使用環境によっ
て測距装置の取付位置を種々変形することが可能である
。
配設された測距装置を示し1本実施例では周知の光学式
測距装置を使用しているが、これに限るものではなく1
例えば橙音波等の測距装置を用いることもできる。又、
後述のように前部と側部、若しくは後部と側部で合計3
個の測距装置が測定することができれば他の5個の測距
装置は不要となるので、全方向移動車の使用環境によっ
て測距装置の取付位置を種々変形することが可能である
。
6は制御装置であり、内部に中央処理装置(図示せず)
を備えると共に、前記回転数検知器2゜操舵角検知器3
.及び測距装置X1〜X8からのデータを入力信号とし
、このデータに基づいて予め内部メモリ(図示せず)に
記憶されている第1の主プログラム、及び後述する第2
の補助プログラムを実行し、前記走行用電動機5.操舵
用電動機4を制御する。
を備えると共に、前記回転数検知器2゜操舵角検知器3
.及び測距装置X1〜X8からのデータを入力信号とし
、このデータに基づいて予め内部メモリ(図示せず)に
記憶されている第1の主プログラム、及び後述する第2
の補助プログラムを実行し、前記走行用電動機5.操舵
用電動機4を制御する。
次に本発明の作用を第5図のフローチャートにて処理手
順を説明する。
順を説明する。
まず、全方向移動車lが走行指令を受けたかどうかを判
断しく5TEPI)、該走行指令があれば(STEPI
でY)第1の主プログラムを実行して(STEP2)、
予め定められた走行路を走行する(STEP3)。
断しく5TEPI)、該走行指令があれば(STEPI
でY)第1の主プログラムを実行して(STEP2)、
予め定められた走行路を走行する(STEP3)。
次に全方向移動車1が予め定められた目標停止位置M1
に到達したとみなされて第1の主プログラムが終了した
か否かを判断しく5TEP4)。
に到達したとみなされて第1の主プログラムが終了した
か否かを判断しく5TEP4)。
第1の主プログラムが終了していれば(STEP4でY
)、第2の補助プログラムを実行して(STEP5)、
目標停止位置と実際の停止位置とのずれを補正する(S
TEP6)。
)、第2の補助プログラムを実行して(STEP5)、
目標停止位置と実際の停止位置とのずれを補正する(S
TEP6)。
明する。
第2図は測距装置X1〜X8の使用方法を説明するため
の図、第3図は目標停止位置M1が互いに直交する壁面
7,8の一角である場合をマクロ的に例示した平面図、
第4図は第2の補助プログラムの処理手順を示すフロー
チャートであり、第3図において、任意に定めた車体I
Aを代表する座標軸の原点を現実の停止位置Qlとし、
座標系の縦軸をX軸、横軸をY軸、又、停止すべき位置
である目標停止位置をMlとしている。
の図、第3図は目標停止位置M1が互いに直交する壁面
7,8の一角である場合をマクロ的に例示した平面図、
第4図は第2の補助プログラムの処理手順を示すフロー
チャートであり、第3図において、任意に定めた車体I
Aを代表する座標軸の原点を現実の停止位置Qlとし、
座標系の縦軸をX軸、横軸をY軸、又、停止すべき位置
である目標停止位置をMlとしている。
まず、目標停止位置からずれをもった現実の停止位置Q
1の状態で第3図のごとく測距装置X2゜X3.X4の
3箇所を用いて壁面7,8との距離DI、D2.D3を
それぞれ測定しく5TEP51)、この測距データから
現実の停止位置Q1と。
1の状態で第3図のごとく測距装置X2゜X3.X4の
3箇所を用いて壁面7,8との距離DI、D2.D3を
それぞれ測定しく5TEP51)、この測距データから
現実の停止位置Q1と。
予め制御装置に記憶されている停止すべき目標停止位置
Mlとのずれを周知の三角測量方式で演算する(STE
P52)。尚、最終的には距IDI。
Mlとのずれを周知の三角測量方式で演算する(STE
P52)。尚、最終的には距IDI。
)
D、2.D3をそれぞれTI、T2.T3となった「
Hソ、精密停止が完了する。
また、第3図において、上記X−Y座標においては目標
停止位置Mlは現実の停止位置Q1から(x、y)、角
度ずれθとなり、以後、該ずれを(x、y、 θ)と
表すこととする。又、この状態で車体の位置を補正する
旋回中心点をC,Ql・Mlの距離をm、Ql−Mlの
中点をE、QiCの距離をn、Ql・C−Eで作られる
角度をZa、X軸と線分Q1・Mlで作られる角をzb
とする。
停止位置Mlは現実の停止位置Q1から(x、y)、角
度ずれθとなり、以後、該ずれを(x、y、 θ)と
表すこととする。又、この状態で車体の位置を補正する
旋回中心点をC,Ql・Mlの距離をm、Ql−Mlの
中点をE、QiCの距離をn、Ql・C−Eで作られる
角度をZa、X軸と線分Q1・Mlで作られる角をzb
とする。
次に目標停止位置M1と現実の停止位置Q1とを直線で
結んだ距離mを求める。
結んだ距離mを求める。
(STEP53)
m=J171覆7
さらにQl・C−Eで作られる角度laを求る(STE
P54)。
P54)。
la=θ/2
zbを求める(STEP55〜59)。
ここで
m=o のとき
b=。
m=o 以外のとき、かつ
y≧0 のとき b=c o s−’ (x/m)y<
0 のとき b=−c o s−’ (x/m)とな
る。
0 のとき b=−c o s−’ (x/m)とな
る。
次に各車輪の操舵、走行を代表する仮想の操舵輪を車体
の任意の位置に設定する。この仮想操舵輪とは車体代表
点から長さlを持ったアーム9と該アーム9の先端位置
に回動自在に操舵輪10を配置(仮想)している。従っ
て、車体代表点を中心に360度アーム9(仮想)を旋
回させることができると共に、操舵輪10(仮想)自体
も前記アーム9から独立して360度操舵することがで
きるものである。従って、あらゆる位置に車体の旋回中
心を位置させることができる。上記アーム9は、車体を
旋回させる旋回中心点Cと車体代表点Q1とを結ぶ直線
nと常に垂直に位置すると共に 操舵輪10は上記旋回
中心点Cとアーム9の一端9Aとを結ぶ直線nAと常に
直交するように操舵輪10の角度で、以下単に仮想操舵
角αと(、zう)が決まれば、これに基づいて各車輪の
操舵。
の任意の位置に設定する。この仮想操舵輪とは車体代表
点から長さlを持ったアーム9と該アーム9の先端位置
に回動自在に操舵輪10を配置(仮想)している。従っ
て、車体代表点を中心に360度アーム9(仮想)を旋
回させることができると共に、操舵輪10(仮想)自体
も前記アーム9から独立して360度操舵することがで
きるものである。従って、あらゆる位置に車体の旋回中
心を位置させることができる。上記アーム9は、車体を
旋回させる旋回中心点Cと車体代表点Q1とを結ぶ直線
nと常に垂直に位置すると共に 操舵輪10は上記旋回
中心点Cとアーム9の一端9Aとを結ぶ直線nAと常に
直交するように操舵輪10の角度で、以下単に仮想操舵
角αと(、zう)が決まれば、これに基づいて各車輪の
操舵。
走行を決定することができる。
その処理として、仮想進行角βを求める。
ここでβはX軸を基準とし2反時計回りを正とする。
(STEP60)
β=−(b+a)
線分nの距離を求める。
(STEP61〜63)
θ=0 のとき
n=0
θ≠Oのとき
n=m/2sin2θ
次に、仮想操舵角αを求める(STEP64〜68)。
m=o のとき、かつ
θ=0 のとき
α=0
θ〈0 のとき
α=π/2
θ〉0 のとき
α=−π/2
上記条件以外のとき(n≠0)
α−む an−’(1/n)
仮想操舵輪の移動距離γを求める。
(STEP69)
r=lθXf/sinα
ここで、上記演算にて求めた仮想進行角βと仮想操舵角
αを使って各車輪の操舵角の演算を行いこれを各車輪の
操舵用電動機4へ出力しく5TEP70〜71)、各操
舵用電動機4は操舵を行う(STEP72)。
αを使って各車輪の操舵角の演算を行いこれを各車輪の
操舵用電動機4へ出力しく5TEP70〜71)、各操
舵用電動機4は操舵を行う(STEP72)。
ここで、各車輪の操舵角が5TEP70で得られた計算
値と近似かどうかチエツクしく5TEP73)、近似値
であれば(STEP73でy) −定の駆動力を出力し
く5TEP74)、近似でなければ、5TEP51の処
理へ手順を戻す。
値と近似かどうかチエツクしく5TEP73)、近似値
であれば(STEP73でy) −定の駆動力を出力し
く5TEP74)、近似でなければ、5TEP51の処
理へ手順を戻す。
しく5TEP75)、 γ=微少量許容値であれば(
STEP75でY)、操舵角及び駆動力の出力を停止す
る(STEP76)。Tが微少量許容値でない場合には
(STEP75でN)、5TEP51の処理へ手順を戻
す。
STEP75でY)、操舵角及び駆動力の出力を停止す
る(STEP76)。Tが微少量許容値でない場合には
(STEP75でN)、5TEP51の処理へ手順を戻
す。
また、上記実施例においては目標停止位置が直交する壁
の近傍であったが、全方向移動車の走行エリアの例えば
、中央部に目標停止位置が設定されている場合等におい
ては、第6図、第7図に例示するように、精密停止専用
の壁部材Wをその目標停止位置の外沿に設ける事もでき
る。すなわち。
の近傍であったが、全方向移動車の走行エリアの例えば
、中央部に目標停止位置が設定されている場合等におい
ては、第6図、第7図に例示するように、精密停止専用
の壁部材Wをその目標停止位置の外沿に設ける事もでき
る。すなわち。
この壁部材Wは前記全方向移動車の測距装置が測定可能
な大きさであればよく、直角に交差するもの、或は予め
定められた任意の角度で交差しているもの等2種々変形
することができる。
な大きさであればよく、直角に交差するもの、或は予め
定められた任意の角度で交差しているもの等2種々変形
することができる。
(発明の効果)
本発明は、全方向移動車が目標停止位置に到達したとみ
なされた際に目標停止位置と現実の停止位置とのずれを
測距装置を用いて演算し、該ずれを更正するように新た
に開始される第2の補助プログラムを備えた構成として
いるから、車輪の摩耗等による機械的誤差、製作誤差、
あるいは各検知器の分解能力等によって正確な実走行距
離を得ることができない場合であっても、ステーション
等へ精密にかつ迅速に停止させることができる。
なされた際に目標停止位置と現実の停止位置とのずれを
測距装置を用いて演算し、該ずれを更正するように新た
に開始される第2の補助プログラムを備えた構成として
いるから、車輪の摩耗等による機械的誤差、製作誤差、
あるいは各検知器の分解能力等によって正確な実走行距
離を得ることができない場合であっても、ステーション
等へ精密にかつ迅速に停止させることができる。
特に無人倉庫或はクリーンルームといった停止位置に精
度を要する環境では、その効果は著しいものとなる。
度を要する環境では、その効果は著しいものとなる。
第1図は本発明の概略構成を示す平面図、第2図は測距
装置の使用を説明するための平面図、第3図は目標停止
位置が互いに直交する壁面の一角である場合をマクロ的
に例示した平面図、第4図は第2の補助プログラムの処
理手順を示すフローチャート、第5図は本発明の全方向
移動車の走行メインルーチンを説明するためのフローチ
ャート。 第6図及び第7図は他の実施例を示す平面図である。 1−−−−全方向移動車 4− 操舵用電動機IA−
車 体 5− 走行用電動機2− 回転数検知器
6− 制御装置第 2 y 第5 図 第
装置の使用を説明するための平面図、第3図は目標停止
位置が互いに直交する壁面の一角である場合をマクロ的
に例示した平面図、第4図は第2の補助プログラムの処
理手順を示すフローチャート、第5図は本発明の全方向
移動車の走行メインルーチンを説明するためのフローチ
ャート。 第6図及び第7図は他の実施例を示す平面図である。 1−−−−全方向移動車 4− 操舵用電動機IA−
車 体 5− 走行用電動機2− 回転数検知器
6− 制御装置第 2 y 第5 図 第
Claims (3)
- (1)車体内部に設けた中央処理装置にて予め決定され
る走行路を第1の主プログラムに基づいて走行する全方
向移動車であって、該全方向移動車の車輪の回転数を検
知する回転数検知器と、操舵輪の操舵角を検知する操舵
角検知器とを設け、前記走行路からのずれを更正して前
記走行路を走行する全方向移動車において、 該全方向移動車の車体前後部及び両側部に測距装置をそ
れぞれ配設し、 該全方向移動車が目標停止位置に到達したとみなされた
際に目標停止位置と現実の停止位置とのずれを演算し、
該ずれを更正するように新たに開始される第2の補助プ
ログラムを備えたことを特徴とする全方向移動車の精密
停止方法。 - (2)上記請求項(1)において、前記走行路の全方向
移動車の目標停止位置の外沿に基準となる互いに直交す
る2面を有した任意の壁部材を設けたことを特徴とする
全方向移動車の精密停止方法。 - (3)上記請求項(2)において、互いに直交する2面
を有した任意の壁部材が、あらかじめ定められた任意の
角度で交差していることを特徴とする全方向移動車の精
密停止方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP1208748A JP2741411B2 (ja) | 1989-08-12 | 1989-08-12 | 全方向移動車の精密停止方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP1208748A JP2741411B2 (ja) | 1989-08-12 | 1989-08-12 | 全方向移動車の精密停止方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH03135609A true JPH03135609A (ja) | 1991-06-10 |
| JP2741411B2 JP2741411B2 (ja) | 1998-04-15 |
Family
ID=16561429
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP1208748A Expired - Lifetime JP2741411B2 (ja) | 1989-08-12 | 1989-08-12 | 全方向移動車の精密停止方法 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2741411B2 (ja) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009022749A (ja) * | 2007-06-20 | 2009-02-05 | Nobuko Ikoma | 他機能ザル |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS59121408A (ja) * | 1982-12-24 | 1984-07-13 | Honda Motor Co Ltd | 移動ロボツトの制御装置 |
| JPS61235220A (ja) * | 1985-04-10 | 1986-10-20 | Casio Comput Co Ltd | 全方向移動車 |
| JPS6431208A (en) * | 1987-07-28 | 1989-02-01 | Toshiba Corp | Fixed position stop controller for carrier truck |
-
1989
- 1989-08-12 JP JP1208748A patent/JP2741411B2/ja not_active Expired - Lifetime
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS59121408A (ja) * | 1982-12-24 | 1984-07-13 | Honda Motor Co Ltd | 移動ロボツトの制御装置 |
| JPS61235220A (ja) * | 1985-04-10 | 1986-10-20 | Casio Comput Co Ltd | 全方向移動車 |
| JPS6431208A (en) * | 1987-07-28 | 1989-02-01 | Toshiba Corp | Fixed position stop controller for carrier truck |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009022749A (ja) * | 2007-06-20 | 2009-02-05 | Nobuko Ikoma | 他機能ザル |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2741411B2 (ja) | 1998-04-15 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US6256560B1 (en) | Method for correcting position of automated-guided vehicle and apparatus therefor | |
| WO1995004944A1 (en) | Apparatus and method for identifying scanned reflective anonymous targets | |
| JP2001515237A (ja) | 誘導ビームを使用した自律型運動ユニットのドッキング方法 | |
| JPH02105904A (ja) | 移動体の誘導方法及びその装置 | |
| JPH01287415A (ja) | 自走車の位置制御装置 | |
| JP2000194418A (ja) | 無人搬送車の位置補正システム | |
| CN110989596A (zh) | 对桩控制方法、装置、智能机器人及存储介质 | |
| JP4121720B2 (ja) | 2次元マップ作成方法及びその装置 | |
| AU676790B2 (en) | Apparatus for determining position of moving body | |
| JPH03135609A (ja) | 全方向移動車の精密停止方法 | |
| JPH10222225A (ja) | 無人走行体及びその走行方法 | |
| JPH03189805A (ja) | 車両の自動操舵方法及びその自動操舵装置 | |
| JPS6227406B2 (ja) | ||
| JP2000132229A (ja) | 移動体の走行制御方法 | |
| JPH10105234A (ja) | 無人搬送車 | |
| JPS60237504A (ja) | 台車搭載ロボツトの操作用座標設定装置 | |
| CN116974290B (zh) | 一种双舵轮agv舵轮角度校准方法及装置 | |
| JP2840943B2 (ja) | 移動ロボットの誘導装置 | |
| JPH0437736Y2 (ja) | ||
| JP3046718B2 (ja) | 作業車用のビーム光誘導装置 | |
| JP2889257B2 (ja) | 移動体の位置検知装置 | |
| JPH11271042A (ja) | 移動体の位置計測装置 | |
| JPS62254212A (ja) | 自走ロボツト | |
| CN115371683A (zh) | 磁导航定位方法、装置及agv系统 | |
| JPH0322110A (ja) | 移動ロボット |