JP3677800B2

JP3677800B2 - Travel control method and travel control apparatus for moving body

Info

Publication number: JP3677800B2
Application number: JP02194195A
Authority: JP
Inventors: 成歳林
Original assignee: Toyota Industries Corp
Current assignee: Toyota Industries Corp
Priority date: 1995-02-09
Filing date: 1995-02-09
Publication date: 2005-08-03
Anticipated expiration: 2020-08-03
Also published as: JPH08221133A

Description

【０００１】
【産業上の利用分野】
本発明は、例えば自動倉庫に備えられたスタッカクレーンなどの移動体を走行制御させる移動体の走行制御方法及び走行制御装置に関するものである。
【０００２】
【従来の技術】
例えば特公平４−２７１２７号公報には、自動倉庫において、スタッカクレーンの走行時の速度パターンをその移動距離に応じて決定し、その速度パターンに合致するようにスタッカクレーンを走行させる走行制御方法が開示されている。この走行制御方法では、図９に示す速度パターンＭが予め設定されている。ここで、加速過程の走行距離Ｓa 、減速開始点Ｐ1 からクリープ速度Ｖc に減速するまでの走行距離Ｓb 、クリープ速度Ｖc での走行距離Ｓc 、ブレーキ開始点Ｐ2 から停止までの走行距離Ｓd は、それぞれ図９の斜線部の面積で表される。これらの総和をＳA （＝Ｓa ＋Ｓb ＋Ｓc ＋Ｓd ）（図９の斜線部の総面積）とする。すなわち、距離ＳA は、設定された最高速度Ｖmax まで加速することができる最小の走行距離である。また、加速度α１、減速度β１、β２、クリープ速度Ｖc 、クリープ速度Ｖc での保持時間ｔc は予め設定された定数であることから、加速することができる最高速度ＶM は、その走行距離Ｓx に応じて決まり、関数式Ｓx ＝ｆ（ＶM ）が成立する。
【０００３】
スタッカクレーンは目標位置が決まると、現在位置と目標位置との差から求まる走行距離Ｓx と距離ＳA との大小を比較する。そして、Ｓx ≧ＳA の場合にはＭの速度パターンを設定し、Ｓx ＜ＳA の場合にはＮの速度パターンを設定する。すなわち、走行距離Ｓx が速度Ｖmax まで加速することができる距離である場合には、設定最高速度Ｖmax まで走行し、走行距離Ｓx が速度Ｖmax まで加速することができない距離である場合には、目標位置にて停止できるように加速過程途中の速度ＶM から減速過程に移行するようになっていた。Ｎの速度パターンにおける最高速度ＶM は、Ｓx ＝ｆ（ＶM ）より求められる。
【０００４】
【発明が解決しようとする課題】
ところで、走行距離Ｓx が比較的短く、Ｓx ≦ＳA の場合には、Ｎの速度パターンに沿うように、加速度α１で加速されたスタッカクレーンは最高速度ＶM に達すると加速過程から直ぐさま減速過程に移行される。このとき、スタッカクレーンには、加速（加速度α１）から減速（減速度β１）への急激な加速度変化に伴い衝撃が加えられる。その衝撃により走行輪がスリップした場合には、スタッカクレーンの停止位置精度が劣化するという問題があった。また、その衝撃によりスタッカクレーンが揺れ、その揺れがスタッカクレーンの停止後まで続く場合には、その揺れの静止を待ってフォークを作動させねばならず、その分だけサイクルタイムが長くなるという問題があった。
【０００５】
本発明は上記問題点を解決するためになされたものであって、その目的は移動体の走行距離に拘わらず、加速から減速への移行を緩やかな加速度変化とすることにより、その加速度変化時に移動体に加わる衝撃を小さくすることができる移動体の走行制御方法及び走行制御装置を提供することにある。
【０００６】
【課題を解決するための手段】
上記問題点を解決するため請求項１に記載の発明では、移動体の現在位置と目標位置との差に基づいて、予め設定された加速度にて加減速させる速度パターンを、走行距離に拘わらず加速完了後の速度で少なくとも所定時間維持されるように作成し、該速度パターンに合致するように該移動体を走行させる移動体の走行制御方法であって、前記速度パターンを作成する際、前記移動体の現在位置と目標位置との差で決まる走行距離より、予め設定された設定最高速度で前記所定時間以上保持し得るか否かを判断し、その走行距離により設定最高速度で所定時間以上保持し得ると判断された場合には設定最高速度を設定し、その走行距離により設定最高速度で所定時間以上保持できないと判断された場合には、所定時間保持し得るその走行距離に見合った最高速度を設定するようにした。
【０００７】
請求項２に記載の発明では、移動体の現在位置と目標位置との差に基づいて、予め設定された加速度にて加減速させる速度パターンを、加速完了後の速度で少なくとも所定時間維持されるように作成する速度パターン作成手段と、前記速度パターン作成手段により作成された速度パターンに合致するように前記移動体の走行駆動源を駆動制御する制御手段とを備えた移動体の走行制御装置であって、前記速度パターン作成手段は、前記移動体の現在位置と目標位置との差で決まる走行距離より、予め設定された設定最高速度で前記所定時間以上保持し得るか否かを判断する距離判断手段と、前記距離判断手段により、その走行距離により設定最高速度で所定時間以上保持し得ると判断された場合には設定最高速度を設定し、その走行距離により設定最高速度で所定時間以上保持できないと判断された場合には、所定時間保持し得るその走行距離に見合った最高速度を設定する最高速度設定手段とを備えた。
【０００９】
請求項３に記載の発明では、前記移動体が加速又は減速される速度変化過程には複数段の加速度が設定されており、前記速度パターン作成手段は、前記最高速度決定手段により決定された前記最高速度に対して所定比の速度となるように、前記速度変化過程における加速度変化時期を設定する加速度変化時期設定手段を備えた。
【００１０】
請求項４に記載の発明では、前記速度パターン作成手段により作成される速度パターンに、目標位置に到達する手前で保持されるクリープ速度を設定した。
【００１１】
【作用】
従って、請求項１に記載の発明によれば、移動体を予め設定された加速度にて加減速させたとき、その走行距離に拘わらず加速完了後の速度で少なくとも所定時間維持されるように、移動体の現在位置と目標位置との差に基づいて速度パターンが作成され、移動体は該速度パターンに合致するように走行する。そのとき、移動体は加速完了後に一定速度に保持されてから減速を開始する。従って、加速から減速へ大きな加速度変化を伴わず緩やかに移行される。そのため、移動体に加速度変化による大きな衝撃が加わらない。また、前記速度パターンを作成する際、移動体の現在位置と目標位置との差で決まる走行距離が、予め設定された設定最高速度で所定時間以上保持し得る距離であるか否かを距離判断手段により判断する。そして、その走行距離により設定最高速度で所定時間以上保持し得ると判断された場合には前記最高速度として設定最高速度を設定し、その走行距離により設定最高速度で所定時間以上保持できないと判断された場合には、その走行距離に見合った所定時間保持し得る最高速度を設定する。従って、設定最高速度で移動体を走行させると、加速完了後の速度で所定時間保持できなくなる走行距離の場合も、加速完了後の速度で所定時間保持されてから減速が開始される。
【００１２】
請求項２に記載の発明によれば、移動体を予め設定された加速度にて加減速させたとき、加速完了後の速度で少なくとも所定時間維持されるように、移動体の現在位置と目標位置との差に基づいて速度パターンが速度パターン作成手段により作成され、移動体はその走行駆動源が制御手段により駆動制御されることにより、該速度パターンに合致するように走行する。
【００１４】
また、移動体の現在位置と目標位置との差で決まる走行距離が、予め設定された設定最高速度で所定時間以上保持し得る距離であるか否かを距離判断手段により判断する。そして、距離判断手段により、その走行距離により設定最高速度で所定時間以上保持し得ると判断された場合には前記最高速度として設定最高速度を設定し、その走行距離により設定最高速度で所定時間以上保持できないと判断された場合には、その走行距離に見合った所定時間保持し得る最高速度を設定する。この最高速度の設定は最高速度設定手段により行われる。従って、設定最高速度で移動体を走行させると、加速完了後の速度で所定時間保持できなくなる走行距離の場合も、加速完了後の速度で所定時間保持されてから減速が開始される。
【００１５】
請求項３に記載の発明によれば、移動体が加速又は減速される速度変化過程には複数段に加速度が設定されており、この速度変化過程における加速度変化時期が、最高速度決定手段により決定された最高速度に対して所定比の速度となるように加速度変化時期設定手段により設定される。従って、加速過程や減速過程において、常に最高速度に対して所定比の速度に達したときに加速度が変化される。
【００１６】
請求項４に記載の発明によれば、移動体は、目標位置に到達する手前で保持されたクリープ速度から常に制動される。
【００１７】
【実施例】
以下、本発明を自動倉庫におけるスタッカクレーンに具体化した一実施例を図１〜図７に基づいて説明する。
【００１８】
図７に示すように、移動体としてのスタッカクレーン１は台車１ａの底部に設けられた複数の走行ローラ２を介してレール４上に走行可能に載置されている。走行ローラ２は駆動ローラと被動ローラとからなり、駆動ローラは台車１ａ上に設けられたモータ５の駆動軸と作動連結されている。モータ５が正逆転駆動されることにより、スタッカクレーン１は両側に立設された棚６（片側のみ図示）間をレール４に沿って走行するようになっている。棚６には多数の収納部（図示せず）がマトリクス状に配置されている。台車１ａの底部には、計測輪３がレール４の上面に押圧された状態で転動可能に設けられている。
【００１９】
台車１ａ上に立設されたマスト１ｂの頂部に設けられた滑車７には、ウィンチ８ａから延びるワイヤ９が掛装され、そのワイヤ９の先端部にキャリッジ１０が吊下状態に支持されている。ウィンチ８ａを駆動するモータ８が正逆転駆動されることにより、キャリッジ１０がマスト１ｂに沿って昇降するようになっている。キャリッジ１０には水平方向（図７の紙面直交方向）に出退可能なフォーク１１が装備され、棚６を構成する所定の収納部に対してキャリッジ１０を対向配置した状態でフォーク１１を出退させることにより、その収納部との間で荷の出し入れが行われるようになっている。
【００２０】
棚６の最下段には走行レーン方向（図７の左右方向）に沿う各収納部毎にドグ６ａが設けられており、台車１ａにはドグ６ａを検知可能なセンサ１２が配設されている。センサ１２が目標停止位置に対応するドグ６ａを検知すると、スタッカクレーン１は制動されるようになっている。
【００２１】
スタッカクレーン１は図２に示す制御装置ＣＴを備えている。制御装置ＣＴにはマイクロコンピュータＭＣが内蔵されている。図２に示すように、マイクロコンピュータＭＣは、中央処理装置（以下、ＣＰＵという）１３と、読出し専用メモリ（ＲＯＭ）よりなるプログラムメモリ１４と、読出し書替え用メモリ（ＲＡＭ）よりなる作業用メモリ１５とを備えている。ＣＰＵ１３はタイマ１６及びカウンタ１７に接続されており、プログラムメモリ１４に記憶されたプログラムデータに基づいて動作する。
【００２２】
ＣＰＵ１３は入出力インタフェース１８に接続されている。入出力インタフェース１８に接続されたモータ駆動回路１９，２０にはインバータ２１，２２を介して各モータ５，８がそれぞれ接続されている。各モータ５，８は誘導モータであり、インバータ２１，２２の出力周波数に基づき速度制御される。入出力インタフェース１８に接続された励消磁回路２３には、モータ５の駆動軸に配備された電磁ブレーキ２４が接続され、ＣＰＵ１３からの励磁信号に基づき作動されてモータ５の駆動軸を機械的に制動する。
【００２３】
また、入出力インタフェース１８にはセンサ１２及びエンコーダ２５が接続されている。エンコーダ２５は計測輪３に接続されており、計測輪３の回転量に比例したパルス数を有するパルス信号を出力する。ＣＰＵ１３はエンコーダ２５から入力したパルス信号のパルス数をカウンタ１７に計数させる。カウンタ１７には、スタッカクレーン１がホームポジションに配置された位置を基準（例えば計数値「０」）とする計数値（パルス値）が計数され、カウンタ１７のパルス値からスタッカクレーン１の位置が認知されるようになっている。また、ＣＰＵ１３は単位時間当たりにエンコーダ２５から入力される信号のパルス数によりスタッカクレーン１の走行速度を演算する。ＣＰＵ１３はセンサ１２から目標停止位置のドグ６ａを検知した検知信号を入力すると、励消磁回路２３に励磁信号を出力し、電磁ブレーキ２４を作動させるようになっている。
【００２４】
作業用メモリ１５には走行レーン方向における各停止位置のパルス値が記憶されており、カウンタ１７から読込んだ現在位置（パルス値）と、作業用メモリ１５から読出した目標位置（パルス値）との差から走行距離Ｌが算出される。
【００２５】
作業用メモリ１５にはスタッカクレーン１を走行させるための図３に示す速度パターンが予め記憶されている。図３に示すように、速度パターンは、加速過程、定速過程および減速過程からなる。加速過程では３段階の加速度α1 ，α2 ，α3 が設定され、減速過程では３段階の減速度β1 ，β2 ，β3 が設定されている。また、定速過程での速度Ｖｍが最高速度となる。
【００２６】
図３において、加速度α1 ，α2 ，α3 が変化する変曲点速度Ｖ1 ，Ｖ2 、減速度β1 ，β2 ，β3 が変化する変曲点速度Ｖ3 ，Ｖ4 は、それぞれ最高速度Ｖｍに対する比率（所定％）で設定されている。すなわち、
Ｖ1 ＝ａ1 ・Ｖｍ … (1)
Ｖ2 ＝ａ2 ・Ｖｍ … (2)
Ｖ3 ＝ａ3 ・Ｖｍ … (3)
Ｖ4 ＝ａ4 ・Ｖｍ … (4)
ここで、ａ1 ，ａ2 ，ａ3 ，ａ4 は、０＜ａk ＜１；（ｋ＝１〜４）を満たす定数である。
【００２７】
図３の速度パターンから、時刻ｔ1 ，ｔ2 ，…，ｔ7 にて区分された各速度領域における走行距離Ｌ1 ，Ｌ2 ，…，Ｌ7 は、図３の各速度領域の面積で表され、それぞれ以下のように示される。
【００２８】
Ｌ1 ＝Ｖ1 ²／２・α1 … (5)
Ｌ2 ＝（Ｖ2 −Ｖ1 ）・（Ｖ2 ＋Ｖ1 ）／２・α2 … (6)
Ｌ3 ＝（Ｖｍ−Ｖ2 ）・（Ｖｍ＋Ｖ2 ）／２・α3 … (7)
Ｌ4 ＝Ｖｍ（ｔ4 −ｔ3 ） … (8)
Ｌ5 ＝（Ｖｍ−Ｖ3 ）・（Ｖｍ＋Ｖ3 ）／２・β1 … (9)
Ｌ6 ＝（Ｖ3 −Ｖ4 ）・（Ｖ3 ＋Ｖ4 ）／２・β2 … (10)
Ｌ7 ＝Ｖ4 ²／２・β3 … (11)
ここで、ΔＴ＝（ｔ4 −ｔ3 ）は最高速度Ｖｍでの保持時間であり、一定時間が設定されている。全走行距離Ｌは、 (5)〜 (11) 式から次のようになる。
【００２９】

よって、走行距離Ｌは最高速度Ｖｍの関数となり、Ｌ＝Ｆ（Ｖｍ）とおける。
【００３０】
スタッカクレーン１には予め最高速度Ｖmax が設定されている。最高速度Ｖmax で所定時間ΔＴ保持できる最小の走行距離Ｌ0 は、Ｌ0 ＝Ｌ（Ｖmax ）である。これを基準距離Ｌ0 とおく。本実施例では、加速完了後の速度で少なくとも所定時間ΔＴ以上保持されるように、その走行距離Ｌx に応じて最高速度Ｖｍが決定される。すなわち、走行距離Ｌx と基準距離Ｌ0 とを比較し、Ｌx ≧Ｌ0 である場合には最高速度Ｖmax を、Ｌx ＜Ｌ0 である場合には、Ｌx ＝Ｆ（ＶM ）を満たす速度ＶM を、それぞれ最高速度Ｖｍとして設定するようになっている。
【００３１】
プログラムメモリ１４には、図４に示すように走行距離Ｌx と最高速度ＶM との関係を示すマップデータMD1 が記憶されている。マップデータMD1 は、関数式Ｌx ＝Ｆ（ＶM ）を用いて作成されたものであり、走行距離Ｌx がＬx ＜Ｌ0 を満たす条件下における走行距離Ｌx と最高速度Ｖｍとの対応関係が、速度Ｖｍ「０．１ｍ／sec.」刻みで設定されている。
【００３２】
また、減速開始点ＰD （図３に示す）は、目標位置までの距離ＳD （以下、減速開始距離という）で示されている。減速開始距離ＳD は、時刻ｔ4 〜ｔ7 までの走行距離であり、(9) 〜 (11) 式から次のようになる。
【００３３】

この関数式ＳD ＝Ｇ（Ｖｍ）を用いて、最高速度Ｖｍと減速開始距離ＳD との関係が、図５に示すマップデータMD2 としてプログラムメモリ１４に記憶されている。これも速度Ｖｍ「０．１ｍ／sec.」刻みに設定されている。ＣＰＵ１３は定速過程で目標位置までの残りの走行距離ＬR を演算し、その残り距離ＬR が減速開始距離ＳD に一致した（正確にはＬR ≦ＳD を満たす）時に、減速指令信号を出力して減速を開始させるようになっている。
【００３４】
次に、図１のフローチャートに従ってスタッカクレーン１の走行制御について説明する。ＣＰＵ１３は、ステップＳ１でクレーン制御盤（図示せず）から走行指令信号を入力すると、ステップＳ２で走行指令信号より目標位置データＰgを取得し、ステップＳ３で現在位置Ｐ0と目標位置Ｐgとの差をとって走行距離Ｌx（＝｜Ｐ0−Ｐg｜）を算出する。ステップＳ４では、走行距離Ｌxが最高速度Ｖmaxを出せる基準距離Ｌ0以上であるか否かを判断する。すなわち、Ｌx≧Ｌ0を満たすか否かを判断する。
【００３５】
例えば、指令された目標位置Ａ１までの走行距離ＬA が基準距離Ｌ0 より短い場合（ＬA ＜Ｌ0 ）、ＣＰＵ１３はステップＳ５に進み、図４のマップデータMD1 からその走行距離ＬA に応じた最高速度ＶA を引出して設定する。そして、ステップＳ７で最高速度ＶA から (1)，(2) 式を用いて加速時の変曲点速度ＶA1，ＶA2を算出し、ステップＳ８で最高速度ＶA から (3)，(4) 式を用いて減速時の変曲点速度ＶA3，ＶA4を算出する。算出した値ＶA1，ＶA2，ＶA3，ＶA4は各変曲点速度として設定される。
【００３６】
こうして最高速度ＶA 及び各変曲点速度ＶA1，ＶA2，ＶA3，ＶA4が決まると、ＣＰＵ１３は、ステップＳ９で、走行開始指令信号を出力するとともに、スタッカクレーン１の速度軌跡が設定値ＶA1，ＶA2，ＶA3，ＶA4通りの各変曲点速度にて加速度変化するようにインバータ２１を介してモータ５を速度制御する。
【００３７】
すなわち、ＣＰＵ１３はモータ駆動回路１９に対してまず加速度α１、速度ＶA1の指令を出力し、スタッカクレーン１がその停止位置から加速度α１で加速される。走行速度Ｖが速度ＶA1に達すると加速度α２、速度ＶA2を出力指令し、さらに走行速度Ｖが速度ＶA2に達すると加速度α３、速度ＶA を出力指令する。走行速度Ｖが速度ＶA に達すると、スタッカクレーン１はその速度ＶA に保持される。こうして定速過程に入ると、ＣＰＵ１３は図５のマップデータMD2 を用いてそのときの速度ＶA から減速開始距離ＳA を求める。定速過程では、ＣＰＵ１３はその時々の目標位置Ａ１までの残り距離ＬRAを逐次演算し、その残り距離ＬRAが減速開始距離ＳA に一致（正確にはＬRA≦ＳA ）すると（点ＰA ）、モータ駆動回路１９に対して加速度β１、速度ＶA3の指令を出力し、スタッカクレーン１の減速が開始される。走行速度Ｖが速度ＶA3に達すると加速度β２、速度ＶA4を出力指令し、さらに走行速度Ｖが速度ＶA4に達すると加速度β３、速度０を出力指令する。そして、センサ１２から入力される目標位置Ａ１のドグ６ａを検知した検知信号に基づき電磁ブレーキ２４を作動させてスタッカクレーン１を目標位置Ａ１にて停止させる。こうしてスタッカクレーン１は図６に示す速度パターンＡに沿って走行制御される。
【００３８】
走行距離Ｌx ＜Ｌ0 のとき、スタッカクレーン１が常に定速過程の最高速度ＶM にて所定時間ΔＴだけ保持されるように変曲点速度Ｖ１〜Ｖ４が設定される。よって走行距離ＬB （≠ＬA かつ＜Ｌ0 ）の場合にも、図４のマップデータMD1 から求まる速度ＶB まで、その速度ＶB から求めた変曲点速度ＶB1，ＶB2にて加速度変化するように加速される。そして、その速度ＶB で所定時間ΔＴ保持された後、残り距離ＬRBがその速度ＶB からマップデータMD2 にて求まる減速開始距離ＳB に一致すると（点ＰB ）、その速度ＶB での変曲点速度ＶB3，ＶB4にて減速度変化するように減速される。スタッカクレーン１は、最高速度ＶB にて所定時間ΔＴだけ保持されるように図６に示す速度パターンＢに沿って速度制御される。このように走行距離Ｌx ＜Ｌ0 のときには、加速度α３にて最高速度ＶM に到達後、一定速度すなわち加速度「０」の状態で所定時間ΔＴだけ保持された後に減速度β１での減速が開始される。つまり、Ｌx ＜Ｌ0 では、最高速度ＶM での保持時間ΔＴが等しく、加速過程及び減速過程での速度パターン形状が相似となる。
【００３９】
また、指令された走行距離ＬがＬx ≧Ｌ0 を満たす場合には、ステップＳ４における判断によりＣＰＵ１３はステップＳ６に進み、最高速度「Ｖmax 」を設定する。そして、この最高速度Ｖmax から (1)〜(4) 式を用いて変曲点速度Ｖ1 ，Ｖ2 ，Ｖ3 ，Ｖ4 を算出するとともにその算出値を設定する（Ｓ７，Ｓ８）。スタッカクレーン１は最高速度が「Ｖmax 」となるように各変曲点速度Ｖ1 ，Ｖ2 ，Ｖ3 ，Ｖ4 及び減速開始点ＰC にて加速度制御される（Ｓ９）。例えばＬx ＝Ｌ0 のときには、図６の速度パターンＣを描くように速度制御され、最高速度Ｖmax で所定時間ΔＴだけ保持される。また、Ｌ＞Ｌ0 のときには、図６の速度パターンＣにおいて、最高速度Ｖmax での保持時間ＴがＴ＞ΔＴとなる。
【００４０】
以上詳述したように本実施例によれば、スタッカクレーン１は所定加速度で加速されて最高速度Ｖｍに到達後、一定速度すなわち加速度「０」の状態で少なくとも所定時間ΔＴ保持されてから所定減速度で減速が開始される。そのため、加速から減速へ移行するときの加速度変化が緩やかとなり、その加速度変化時にスタッカクレーン１に加わる衝撃を小さくすることができる。よって、加速度変化時の衝撃に起因する走行ローラ３のスリップを回避して、スタッカクレーン１を目標位置に位置精度良く停止させることができる。また、加速度変化時の衝撃が小さいので、その衝撃によるスタッカクレーン１の揺れは小さく、停止後直ちにもしくは停止後にフォーク１１が作動されるまでにスタッカクレーン１を静止状態とすることができる。そのため、従来のようにスタッカクレーンの静止を待ってフォークを作動させる必要がないので、スタッカクレーン１のサイクルタイムを短くすることができる。
【００４１】
また、予め設定した最高速度Ｖmax でスタッカクレーン１を所定時間ΔＴ保持できない場合には、所定時間ΔＴ保持できるようにその走行距離Ｌに応じた最高速度Ｖｍが設定されるので、スタッカクレーン１を走行距離Ｌに応じたできるだけ高速度で走行させることにより、短い移動時間を実現することができる。
【００４２】
さらに、加速過程や減速過程における加速度の変化は、最高速度に対して所定比の速度に達したときに段階的に行われ、速度パターンが速度変化過程において走行距離に拘わらずほぼ相似をなすので、スタッカクレーン１をスムーズに加速変化させ、安定走行を実現させることができる。また、走行距離Ｌに応じた最高速度ＶM を、作業用メモリ１５に記憶したマップデータMD1 から引出すようにしたので、所望する最高速度ＶM を直ちに求めることができる。そして、演算処理が不要な分だけ、ＣＰＵ１３の処理負担を軽減させることができる。
【００４３】
なお、本発明は上記実施例に限定されるものではなく、発明の趣旨を逸脱しない範囲で例えば次のように構成することもできる。
（１）図８に示す速度パターンのように、目標位置に到達する手前で保持されるクリープ速度Ｖc を設定してもよい。スタッカクレーン１は常にクリープ速度Ｖc から制動されるので、目標位置に位置精度良く停止させることができる。
【００４４】
（２）関数式ＶM ＝Ｆ^-1（Ｌ）を作業用メモリ１５などの記憶媒体に記憶させておき、この式を用いて走行速度Ｌに応じた最高速度ＶM を算出してもよい。
（３）加速過程及び減速過程における速度パターンの形状は特に限定されない。各過程において加速度や減速度が一定であってもよい。
【００４５】
（４）移動体はスタッカクレーンに限定されない。急激な加速度変化を回避する必要があるその他の移動体に本発明を適用することができる。例えばキャリッジ１０の昇降制御に本発明を適用してもよい。この構成によれば、キャリッジ１０の滑らかな速度変化が実現され、載置された荷に衝撃を与えずに済む。
【００４６】
（５）減速開始距離ＳD を、スタッカクレーン１の始動前に最高速度Ｖｍから予め算出しておいてもよい。
（６）減速開始時期を最高速度Ｖｍに達した後、タイマ１６が所定時間（≧ΔＴ）を計時した時に設定してもよい。
【００４７】
前記実施例から把握される発明を、その効果とともに以下に記載する。
（イ）前記最高速度設定手段は所定時間保持し得る最高速度が走行距離毎に設定されたマップを記憶する記憶手段を備え、該記憶手段に記憶したマップを用いてその走行距離に見合った最高速度を求めるようにした。直ちに所望する最高速度を求めることができる。また、演算処理を不要とすることもできる。
【００４８】
（ロ）前記移動体は自動倉庫に装備されたスタッカクレーンである。スリップや大きな揺れの防止によりスタッカクレーンを目標位置に精度良く停止させることができ、サイクルタイムも短縮できる。
【００４９】
【発明の効果】
以上詳述したように請求項１及び請求項２に記載の発明によれば、移動体はその走行距離に拘わらず、少なくとも加速完了後の速度で所定時間保持されてから減速されるので、加速から減速への移行が緩やかな加速度変化となり、移動体に加速度変化時に加わる衝撃を小さくすることができる。
【００５０】
また、設定最高速度で移動体を走行させると、加速完了後の速度で所定時間保持できなくなる走行距離の場合には、その最高速度が加速完了後の速度で所定時間保持し得るように設定されるので、移動体を高速度で走行させ、その移動時間を比較的短くすることができる。
【００５１】
また、請求項３に記載の発明によれば、加速過程や減速過程において、最高速度に対して所定比の速度に達したときに段階的に加速度が変化するように速度パターンが設定され、速度パターンが加速過程や減速過程でその走行距離に拘わらずほぼ相似をなすので、移動体の安定走行を実現することができる。
【００５２】
また、請求項４に記載の発明によれば、移動体は、常にクリープ速度から制動されて停止するので、目標位置に精度良く停止させることができる。
【図面の簡単な説明】
【図１】スタッカクレーンを走行制御するためのフローチャート。
【図２】走行制御装置の電気的構成を示すブロック図。
【図３】設定速度パターン図。
【図４】走行距離と最高速度との対応関係を示すマップデータ図。
【図５】最高速度と減速開始位置との対応関係を示すマップデータ図。
【図６】スタッカクレーンの速度パターン図。
【図７】スタッカクレーンの側面図。
【図８】別例の速度パターン図。
【図９】従来技術における移動体の速度パターン図。
【符号の説明】
１…移動体としてのスタッカクレーン、５…走行駆動源としてのモータ、８…走行駆動源としてのモータ、１３…速度パターン作成手段、距離判断手段、最高速度設定手段及び加速度変化時期設定手段としてのＣＰＵ、２１，２２…制御手段を構成するインバータ、ＣＴ…制御手段を構成する制御装置、Ｖｍ…最高速度、Ｖmax …設定最高速度、ΔＴ…所定時間、Ｌx …走行距離、α１〜α３，β１〜β３…加速度、Ｖ１〜Ｖ４…加速度変化時期としての変曲点速度、Ｖc …クリープ速度。[0001]
[Industrial application fields]
The present invention relates to a traveling control method and a traveling control device for a moving body that controls traveling of the moving body such as a stacker crane provided in an automatic warehouse, for example.
[0002]
[Prior art]
For example, Japanese Patent Publication No. 4-27127 discloses a traveling control method for determining a speed pattern during travel of a stacker crane in accordance with the movement distance in an automatic warehouse and causing the stacker crane to travel so as to match the speed pattern. It is disclosed. In this travel control method, a speed pattern M shown in FIG. 9 is preset. Here, the travel distance Sa in the acceleration process, the travel distance Sb from the deceleration start point P1 to the deceleration to the creep speed Vc, the travel distance Sc at the creep speed Vc, and the travel distance Sd from the brake start point P2 to the stop are respectively shown. It is represented by the area of the hatched portion in FIG. The sum of these is SA (= Sa + Sb + Sc + Sd) (total area of the shaded portion in FIG. 9). That is, the distance SA is the minimum travel distance that can be accelerated to the set maximum speed Vmax. Further, since the acceleration time α1, deceleration β1, β2, creep speed Vc, and retention time tc at the creep speed Vc are preset constants, the maximum speed VM that can be accelerated depends on the travel distance Sx. Therefore, the functional expression Sx = f (VM) is established.
[0003]
When the target position is determined, the stacker crane compares the travel distance Sx and the distance SA obtained from the difference between the current position and the target position. When Sx ≧ SA, an M speed pattern is set, and when Sx <SA, an N speed pattern is set. That is, when the travel distance Sx is a distance that can be accelerated to the speed Vmax, the vehicle travels to the set maximum speed Vmax, and when the travel distance Sx is a distance that cannot be accelerated to the speed Vmax, The speed VM during the acceleration process is shifted to the deceleration process so that the vehicle can be stopped at. The maximum speed VM in the N speed pattern is obtained from Sx = f (VM).
[0004]
[Problems to be solved by the invention]
By the way, when the travel distance Sx is relatively short and Sx ≦ SA, the stacker crane accelerated at the acceleration α1 along the speed pattern of N changes from the acceleration process to the deceleration process immediately after reaching the maximum speed VM. To be migrated. At this time, an impact is applied to the stacker crane with a sudden change in acceleration from acceleration (acceleration α1) to deceleration (deceleration β1). When the traveling wheel slips due to the impact, there is a problem that the stop position accuracy of the stacker crane deteriorates. Also, if the stacker crane shakes due to the impact, and the shake continues until after the stacker crane stops, the fork must be operated after the shaking stops, and the cycle time becomes longer accordingly. there were.
[0005]
The present invention has been made to solve the above-mentioned problems, and its purpose is to make the transition from acceleration to deceleration a gradual acceleration change regardless of the travel distance of the moving object, so that when the acceleration changes, It is an object of the present invention to provide a traveling control method and traveling control device for a moving body that can reduce an impact applied to the moving body.
[0006]
[Means for Solving the Problems]
  In order to solve the above problem, in the first aspect of the present invention, the speed pattern for accelerating / decelerating at a preset acceleration based on the difference between the current position of the moving body and the target position is used regardless of the travel distance. Create so that the speed after completion of acceleration is maintained for at least a predetermined time, and run the moving body to match the speed patternA travel control method for a mobile object, wherein when the speed pattern is created, a predetermined maximum speed is maintained for a predetermined time or more from a travel distance determined by a difference between a current position of the mobile object and a target position. If it is determined that the maximum travel speed can be maintained at a set maximum speed for a predetermined time or more, the maximum set speed is set and the maximum travel speed cannot be maintained for a predetermined time or more by the travel distance. If it is judged, the maximum speed corresponding to the mileage that can be held for a predetermined time is set.I did it.
[0007]
  According to the second aspect of the present invention, the speed pattern for accelerating / decelerating at a preset acceleration based on the difference between the current position of the moving body and the target position is maintained at a speed after completion of acceleration for at least a predetermined time. And a control means for driving and controlling the traveling drive source of the moving body so as to match the speed pattern created by the speed pattern creating means.A travel control device for a mobile body, wherein the speed pattern creating means can hold a predetermined maximum speed or more for a predetermined time or more based on a travel distance determined by a difference between a current position of the mobile body and a target position. If the distance determining means determines whether or not the distance determining means can hold the set maximum speed for a predetermined time or more according to the travel distance, the set maximum speed is set and set according to the travel distance. When it is determined that the maximum speed cannot be maintained for a predetermined time or more, a maximum speed setting means for setting a maximum speed corresponding to the travel distance that can be maintained for a predetermined time is provided..
[0009]
  Claim3In the invention described in (1), a plurality of stages of acceleration are set in the speed change process in which the moving body is accelerated or decelerated, and the speed pattern creating means sets the maximum speed determined by the maximum speed determining means. An acceleration change timing setting means is provided for setting an acceleration change timing in the speed change process so that the speed is a predetermined ratio.
[0010]
  Claim4In the invention described in (1), the creep speed held before reaching the target position is set in the speed pattern created by the speed pattern creating means.
[0011]
[Action]
  Therefore, according to the first aspect of the present invention, when the moving body is accelerated / decelerated at a preset acceleration, the speed after completion of acceleration is maintained for at least a predetermined time regardless of the travel distance. A speed pattern is created based on the difference between the current position of the moving body and the target position, and the moving body travels so as to match the speed pattern. At that time, the moving body starts to decelerate after being held at a constant speed after completion of acceleration. Therefore, a gradual transition is made from acceleration to deceleration without a large acceleration change. Therefore, a large impact due to a change in acceleration is not applied to the moving body.Further, when creating the speed pattern, it is determined whether or not the travel distance determined by the difference between the current position of the moving body and the target position is a distance that can be maintained for a predetermined time or more at a preset maximum speed. Judge by means. When it is determined that the maximum travel speed can be maintained for a predetermined time or more according to the travel distance, the maximum set speed is set as the maximum speed, and it is determined that the maximum travel speed cannot be maintained for a predetermined time or more according to the travel distance. In the case of a failure, a maximum speed that can be maintained for a predetermined time corresponding to the travel distance is set. Accordingly, when the moving body is driven at the set maximum speed, deceleration is started after being held at the speed after completion of acceleration for a predetermined time, even in the case of a travel distance that cannot be maintained for a predetermined time at the speed after completion of acceleration.
[0012]
According to the second aspect of the present invention, when the moving body is accelerated or decelerated at a preset acceleration, the current position and the target position of the moving body are maintained at a speed after completion of acceleration for at least a predetermined time. A speed pattern is created by the speed pattern creating means based on the difference between the moving object and the moving body travels so as to match the speed pattern when the travel drive source is driven and controlled by the control means.
[0014]
  AlsoThe distance determining means determines whether or not the travel distance determined by the difference between the current position of the moving body and the target position is a distance that can be maintained for a predetermined time or more at a preset maximum speed. Then, when the distance judging means judges that the set maximum speed can be maintained for a predetermined time or more according to the travel distance, the set maximum speed is set as the maximum speed, and the set maximum speed is set for the predetermined time or more by the travel distance. If it is determined that the vehicle cannot be held, a maximum speed that can be held for a predetermined time corresponding to the travel distance is set. The maximum speed is set by the maximum speed setting means. Accordingly, when the moving body is driven at the set maximum speed, deceleration is started after being held at the speed after completion of acceleration for a predetermined time, even in the case of a travel distance that cannot be maintained for a predetermined time at the speed after completion of acceleration.
[0015]
  Claim3In the speed change process in which the moving body is accelerated or decelerated, acceleration is set in a plurality of stages, and the acceleration change timing in the speed change process is determined by the maximum speed determination means. It is set by the acceleration change timing setting means so that the speed becomes a predetermined ratio with respect to the speed. Therefore, in the acceleration process and the deceleration process, the acceleration is always changed when the speed reaches a predetermined ratio with respect to the maximum speed.
[0016]
  Claim4According to the invention described in (1), the moving body is always braked from the creep speed held before reaching the target position.
[0017]
【Example】
Hereinafter, an embodiment in which the present invention is embodied in a stacker crane in an automatic warehouse will be described with reference to FIGS.
[0018]
As shown in FIG. 7, the stacker crane 1 as a moving body is mounted on a rail 4 so as to be able to travel via a plurality of travel rollers 2 provided at the bottom of the carriage 1a. The traveling roller 2 includes a driving roller and a driven roller, and the driving roller is operatively connected to a driving shaft of a motor 5 provided on the carriage 1a. When the motor 5 is driven forward and backward, the stacker crane 1 travels along the rail 4 between shelves 6 (only one side is shown) erected on both sides. A large number of storage units (not shown) are arranged on the shelf 6 in a matrix. At the bottom of the carriage 1a, the measuring wheel 3 is provided so as to be able to roll while being pressed against the upper surface of the rail 4.
[0019]
A pulley 9 provided on the top of a mast 1b erected on the carriage 1a is provided with a wire 9 extending from a winch 8a, and a carriage 10 is supported in a suspended state at the tip of the wire 9. . When the motor 8 that drives the winch 8a is driven forward and backward, the carriage 10 is moved up and down along the mast 1b. The carriage 10 is equipped with a fork 11 that can be withdrawn / retracted in the horizontal direction (in the direction perpendicular to the plane of FIG. 7). By doing so, the loading and unloading of goods is performed between the storage parts.
[0020]
A dog 6a is provided for each storage unit along the traveling lane direction (left-right direction in FIG. 7) at the bottom of the shelf 6, and a sensor 12 capable of detecting the dog 6a is provided on the carriage 1a. . When the sensor 12 detects the dog 6a corresponding to the target stop position, the stacker crane 1 is braked.
[0021]
The stacker crane 1 includes a control device CT shown in FIG. The control device CT has a built-in microcomputer MC. As shown in FIG. 2, the microcomputer MC includes a central processing unit (hereinafter referred to as a CPU) 13, a program memory 14 composed of a read-only memory (ROM), and a working memory 15 composed of a read / rewrite memory (RAM). And. The CPU 13 is connected to the timer 16 and the counter 17 and operates based on the program data stored in the program memory 14.
[0022]
The CPU 13 is connected to the input / output interface 18. The

motor drive circuits

19 and 20 connected to the input / output interface 18 are connected to the

motors

5 and 8 via

inverters

21 and 22, respectively. Each of the

motors

5 and 8 is an induction motor and is speed-controlled based on the output frequency of the

inverters

21 and 22. An electromagnetic brake 24 provided on the drive shaft of the motor 5 is connected to the excitation / demagnetization circuit 23 connected to the input / output interface 18 and is operated based on an excitation signal from the CPU 13 to mechanically drive the drive shaft of the motor 5. Braking.
[0023]
The sensor 12 and the encoder 25 are connected to the input / output interface 18. The encoder 25 is connected to the measuring wheel 3 and outputs a pulse signal having a pulse number proportional to the rotation amount of the measuring wheel 3. The CPU 13 causes the counter 17 to count the number of pulses of the pulse signal input from the encoder 25. The counter 17 counts a count value (pulse value) based on the position at which the stacker crane 1 is placed at the home position (for example, a count value “0”), and the position of the stacker crane 1 is determined from the pulse value of the counter 17. It has come to be recognized. Further, the CPU 13 calculates the traveling speed of the stacker crane 1 based on the number of pulses of a signal input from the encoder 25 per unit time. When the CPU 13 inputs a detection signal for detecting the dog 6a at the target stop position from the sensor 12, the CPU 13 outputs an excitation signal to the excitation / demagnetization circuit 23 to operate the electromagnetic brake 24.
[0024]
The work memory 15 stores a pulse value at each stop position in the traveling lane direction, and the current position (pulse value) read from the counter 17 and the target position (pulse value) read from the work memory 15. The travel distance L is calculated from the difference.
[0025]
In the work memory 15, a speed pattern shown in FIG. 3 for traveling the stacker crane 1 is stored in advance. As shown in FIG. 3, the speed pattern includes an acceleration process, a constant speed process, and a deceleration process. In the acceleration process, three stages of acceleration α1, α2, and α3 are set, and in the deceleration process, three stages of deceleration β1, β2, and β3 are set. Further, the speed Vm in the constant speed process becomes the maximum speed.
[0026]
In FIG. 3, the inflection point velocities V1, V2 at which the accelerations α1, α2, α3 change and the inflection point velocities V3, V4 at which the decelerations β1, β2, β3 change are ratios (predetermined%) to the maximum velocity Vm, respectively. Is set in That is,
V1 = a1 · Vm (1)
V2 = a2 · Vm (2)
V3 = a3 ・ Vm (3)
V4 = a4 ・ Vm (4)
Here, a1, a2, a3 and a4 are constants satisfying 0 <ak <1; (k = 1 to 4).
[0027]
From the speed pattern of FIG. 3, the travel distances L1, L2,..., L7 in each speed region divided at times t1, t2,..., T7 are represented by the areas of the speed regions of FIG. As shown.
[0028]
L1 = V1²/ 2 ・ α1 (5)
L2 = (V2-V1). (V2 + V1) /2..alpha.2 (6)
L3 = (Vm-V2). (Vm + V2) /2..alpha.3 (7)
L4 = Vm (t4 -t3) (8)
L5 = (Vm-V3). (Vm + V3) /2..beta.1 (9)
L6 = (V3-V4). (V3 + V4) /2.beta.2 (10)
L7 = V4²/ 2 ・ β3 (11)
Here, ΔT = (t4−t3) is the holding time at the maximum speed Vm, and a fixed time is set. The total travel distance L is as follows from the equations (5) to (11).
[0029]

Therefore, the travel distance L is a function of the maximum speed Vm, and L = F (Vm).
[0030]
The maximum speed Vmax is set in the stacker crane 1 in advance. The minimum travel distance L0 that can be held for the predetermined time ΔT at the maximum speed Vmax is L0 = L (Vmax). This is set as a reference distance L0. In this embodiment, the maximum speed Vm is determined according to the travel distance Lx so that the speed after completion of acceleration is maintained for at least the predetermined time ΔT. That is, the travel distance Lx and the reference distance L0 are compared. When Lx ≧ L0, the maximum speed Vmax is obtained. When Lx <L0, the speed VM satisfying Lx = F (VM) is obtained. The speed Vm is set.
[0031]
As shown in FIG. 4, the program memory 14 stores map data MD1 indicating the relationship between the travel distance Lx and the maximum speed VM. The map data MD1 is created using the functional expression Lx = F (VM), and the correspondence relationship between the travel distance Lx and the maximum speed Vm under the condition that the travel distance Lx satisfies Lx <L0 is the speed Vm. It is set in increments of “0.1 m / sec.”.
[0032]
The deceleration start point PD (shown in FIG. 3) is indicated by a distance SD (hereinafter referred to as a deceleration start distance) to the target position. The deceleration start distance SD is a travel distance from time t4 to t7, and is as follows from the equations (9) to (11).
[0033]

Using this functional equation SD = G (Vm), the relationship between the maximum speed Vm and the deceleration start distance SD is stored in the program memory 14 as map data MD2 shown in FIG. This is also set in increments of speed Vm “0.1 m / sec.”. The CPU 13 calculates the remaining travel distance LR up to the target position in the constant speed process, and outputs a deceleration command signal when the remaining distance LR coincides with the deceleration start distance SD (exactly, LR ≦ SD is satisfied). Deceleration is started.
[0034]
  Next, traveling control of the stacker crane 1 will be described according to the flowchart of FIG. When the CPU 13 inputs a travel command signal from a crane control panel (not shown) in step S1, the CPU 13 acquires target position data Pg from the travel command signal in step S2, and in step S3, the current position P0 and the target position P.gThe difference between the travel distance Lx (= | P0−Pg|) Is calculated. In step S4, it is determined whether or not the travel distance Lx is greater than or equal to a reference distance L0 at which the maximum speed Vmax can be obtained. That is, it is determined whether Lx ≧ L0 is satisfied.
[0035]
For example, when the travel distance LA to the commanded target position A1 is shorter than the reference distance L0 (LA <L0), the CPU 13 proceeds to step S5, and the maximum speed VA corresponding to the travel distance LA from the map data MD1 in FIG. Pull out and set. In step S7, the inflection point speeds VA1 and VA2 are calculated from the maximum speed VA using the equations (1) and (2). In step S8, the equations (3) and (4) are calculated from the maximum speed VA. Use to calculate the inflection point speeds VA3 and VA4 during deceleration. The calculated values VA1, VA2, VA3, VA4 are set as the inflection point velocities.
[0036]
When the maximum speed VA and the inflection point speeds VA1, VA2, VA3, VA4 are determined in this way, the CPU 13 outputs a travel start command signal in step S9, and the speed trajectory of the stacker crane 1 is set to the set values VA1, VA2,. The speed of the motor 5 is controlled via the inverter 21 so that the acceleration changes at each inflection point speed of VA3 and VA4.
[0037]
That is, the CPU 13 first outputs a command of acceleration α1 and speed VA1 to the motor drive circuit 19, and the stacker crane 1 is accelerated from the stop position with the acceleration α1. When the traveling speed V reaches the speed VA1, output commands for the acceleration α2 and the speed VA2 are issued, and when the traveling speed V reaches the speed VA2, the output commands for the acceleration α3 and the speed VA are issued. When the traveling speed V reaches the speed VA, the stacker crane 1 is held at the speed VA. When entering the constant speed process, the CPU 13 obtains the deceleration start distance SA from the speed VA at that time using the map data MD2 of FIG. In the constant speed process, the CPU 13 sequentially calculates the remaining distance LRA to the target position A1 at that time, and when the remaining distance LRA coincides with the deceleration start distance SA (exactly LRA ≦ SA) (point PA), the motor is driven. A command of acceleration β1 and speed VA3 is output to the circuit 19, and the stacker crane 1 starts decelerating. When the traveling speed V reaches the speed VA3, an output command is issued for the acceleration β2 and the speed VA4, and when the traveling speed V reaches the speed VA4, an output command is issued for the acceleration β3 and the speed 0. And the electromagnetic brake 24 is operated based on the detection signal which detected the dog 6a of the target position A1 input from the sensor 12, and the stacker crane 1 is stopped at the target position A1. Thus, the stacker crane 1 is travel-controlled along the speed pattern A shown in FIG.
[0038]
When the travel distance Lx <L0, the inflection point speeds V1 to V4 are set so that the stacker crane 1 is always held at the maximum speed VM in the constant speed process for a predetermined time ΔT. Therefore, even in the case of the travel distance LB (≠ LA and <L0), the vehicle is accelerated so as to change the acceleration at the inflection point speeds VB1 and VB2 obtained from the speed VB up to the speed VB obtained from the map data MD1 in FIG. The After the predetermined distance ΔT is held at the speed VB, when the remaining distance LRB coincides with the deceleration start distance SB obtained from the speed VB by the map data MD2 (point PB), the inflection point speed VB3 at the speed VB is reached. , VB4 decelerates to change the deceleration. The stacker crane 1 is speed controlled along a speed pattern B shown in FIG. 6 so that the stacker crane 1 is held for a predetermined time ΔT at the maximum speed VB. Thus, when the travel distance Lx <L0, after reaching the maximum speed VM at the acceleration α3, the vehicle is held at a constant speed, that is, at the acceleration “0” for a predetermined time ΔT, and then the deceleration at the deceleration β1 is started. . That is, when Lx <L0, the holding time ΔT at the maximum speed VM is equal, and the speed pattern shapes in the acceleration process and the deceleration process are similar.
[0039]
If the commanded travel distance L satisfies Lx ≧ L0, the CPU 13 proceeds to step S6 based on the determination in step S4, and sets the maximum speed “Vmax”. Then, the inflection point velocities V1, V2, V3, V4 are calculated from the maximum speed Vmax using the equations (1) to (4) and the calculated values are set (S7, S8). The stacker crane 1 is subjected to acceleration control at the inflection point speeds V1, V2, V3, V4 and the deceleration start point PC so that the maximum speed becomes "Vmax" (S9). For example, when Lx = L0, the speed is controlled so as to draw the speed pattern C in FIG. 6, and the maximum speed Vmax is maintained for a predetermined time ΔT. When L> L0, the holding time T at the maximum speed Vmax is T> ΔT in the speed pattern C of FIG.
[0040]
As described in detail above, according to the present embodiment, the stacker crane 1 is accelerated at a predetermined acceleration and reaches the maximum speed Vm, and then is held at a constant speed, that is, at an acceleration “0” for at least a predetermined time ΔT and then decreased by a predetermined amount. Deceleration starts at speed. Therefore, the change in acceleration when shifting from acceleration to deceleration becomes moderate, and the impact applied to the stacker crane 1 when the acceleration changes can be reduced. Therefore, it is possible to avoid the slip of the traveling roller 3 due to the impact at the time of acceleration change, and to stop the stacker crane 1 at the target position with high positional accuracy. Further, since the impact at the time of acceleration change is small, the stacker crane 1 is not greatly shaken by the impact, and the stacker crane 1 can be kept stationary immediately after the stop or before the fork 11 is operated after the stop. Therefore, it is not necessary to wait for the stacker crane to stop and operate the fork as in the prior art, so the cycle time of the stacker crane 1 can be shortened.
[0041]
Further, when the stacker crane 1 cannot be held for a predetermined time ΔT at the preset maximum speed Vmax, the maximum speed Vm corresponding to the travel distance L is set so that the stacker crane 1 can be held for the predetermined time ΔT. By traveling at as high a speed as possible according to the distance L, a short travel time can be realized.
[0042]
In addition, the acceleration change during the acceleration and deceleration processes is performed in stages when the speed reaches a predetermined ratio with respect to the maximum speed, and the speed pattern is almost similar regardless of the distance traveled during the speed change process. The stacker crane 1 can be smoothly accelerated and changed to realize stable running. Further, since the maximum speed VM corresponding to the travel distance L is drawn from the map data MD1 stored in the work memory 15, the desired maximum speed VM can be obtained immediately. Then, the processing load on the CPU 13 can be reduced by an amount that does not require arithmetic processing.
[0043]
In addition, this invention is not limited to the said Example, For example, it can also comprise as follows in the range which does not deviate from the meaning of invention.
(1) A creep speed Vc held before reaching the target position may be set as in the speed pattern shown in FIG. Since the stacker crane 1 is always braked from the creep speed Vc, it can be stopped at the target position with high positional accuracy.
[0044]
(2) Functional expression VM = F^-1(L) may be stored in a storage medium such as the work memory 15, and the maximum speed VM corresponding to the traveling speed L may be calculated using this equation.
(3) The shape of the speed pattern in the acceleration process and the deceleration process is not particularly limited. In each process, acceleration and deceleration may be constant.
[0045]
(4) The moving body is not limited to a stacker crane. The present invention can be applied to other moving bodies that need to avoid sudden acceleration changes. For example, the present invention may be applied to the raising / lowering control of the carriage 10. According to this configuration, a smooth speed change of the carriage 10 is realized, and it is not necessary to give an impact to the loaded load.
[0046]
(5) The deceleration start distance SD may be calculated in advance from the maximum speed Vm before the stacker crane 1 is started.
(6) The deceleration start timing may be set when the timer 16 measures a predetermined time (≧ ΔT) after reaching the maximum speed Vm.
[0047]
  From the above exampleRuThe invention is described below together with its effects.
  (I)PreviousThe maximum speed setting means includes storage means for storing a map in which the maximum speed that can be held for a predetermined time is set for each travel distance, and uses the map stored in the storage means to determine the maximum speed corresponding to the travel distance. I did it. The desired maximum speed can be determined immediately. In addition, the arithmetic processing can be made unnecessary.
[0048]
  (B)PreviousThe moving body is a stacker crane installed in an automated warehouse. The stacker crane can be stopped at the target position with high accuracy by preventing slipping and large shaking, and the cycle time can be shortened.
[0049]
【The invention's effect】
As described above in detail, according to the first and second aspects of the invention, the moving body is decelerated after being held for a predetermined time at least at the speed after completion of acceleration regardless of the travel distance. The transition from deceleration to deceleration results in a gentle acceleration change, and the impact applied to the moving body when the acceleration changes can be reduced.
[0050]
  Also, SettingWhen traveling at a constant maximum speed, the maximum speed is set so that the maximum speed can be maintained at the speed after completion of acceleration in the case of a travel distance that cannot be maintained for a predetermined time at the speed after completion of acceleration. The moving body can be driven at a high speed, and the moving time can be made relatively short.
[0051]
  Also,Claim3According to the invention described in the above, in the acceleration process and the deceleration process, the speed pattern is set so that the acceleration changes stepwise when the speed reaches a predetermined ratio with respect to the maximum speed. In the deceleration process, the vehicle is almost similar regardless of the distance traveled, so that the mobile body can be stably driven.
[0052]
  Claims4According to the invention described in (1), since the moving body is always braked from the creep speed and stopped, it can be accurately stopped at the target position.
[Brief description of the drawings]
FIG. 1 is a flowchart for controlling travel of a stacker crane.
FIG. 2 is a block diagram showing an electrical configuration of a travel control device.
FIG. 3 is a set speed pattern diagram.
FIG. 4 is a map data diagram showing a correspondence relationship between a travel distance and a maximum speed.
FIG. 5 is a map data diagram showing a correspondence relationship between a maximum speed and a deceleration start position.
FIG. 6 is a speed pattern diagram of a stacker crane.
FIG. 7 is a side view of a stacker crane.
FIG. 8 is a velocity pattern diagram of another example.
FIG. 9 is a velocity pattern diagram of a moving object in the prior art.
[Explanation of symbols]
DESCRIPTION OF SYMBOLS 1 ... Stacker crane as a moving body, 5 ... Motor as travel drive source, 8 ... Motor as travel drive source, 13 ... Speed pattern creation means, distance judgment means, maximum speed setting means and acceleration change timing setting means CPU, 21, 22 ... inverter constituting control means, CT ... control device constituting control means, Vm ... maximum speed, Vmax ... set maximum speed, [Delta] T ... predetermined time, Lx ... travel distance, [alpha] 1- [alpha] 3, [beta] 1-. β3: acceleration, V1 to V4: inflection point speed as acceleration change timing, Vc: creep speed.

Claims

Based on the difference between the current position of the moving body and the target position, create a speed pattern that accelerates or decelerates with a preset acceleration so that the speed after acceleration is maintained for at least a predetermined time regardless of the distance traveled. , A travel control method for a mobile object that causes the mobile object to travel so as to match the speed pattern ,
When creating the speed pattern, it is determined from the travel distance determined by the difference between the current position of the moving body and the target position whether or not the predetermined maximum time can be held for the predetermined time or more. If it is determined that the maximum set speed can be maintained for a predetermined time or more depending on the distance, the maximum set speed is set. A traveling control method for a moving body that sets a maximum speed corresponding to the possible travel distance .

Speed pattern creating means for creating a speed pattern for accelerating / decelerating at a preset acceleration based on the difference between the current position and the target position of the moving body so as to be maintained at a speed after completion of acceleration for at least a predetermined time; A traveling control device for a moving body comprising control means for driving and controlling a traveling drive source of the moving body so as to match the speed pattern created by the speed pattern creating means ,
The speed pattern creating means is a distance judging means for judging whether or not the predetermined maximum time can be maintained at a preset maximum speed from a travel distance determined by a difference between the current position of the moving body and a target position. ,
If it is determined by the distance judging means that the set maximum speed can be maintained for a predetermined time or more according to the travel distance, the set maximum speed is set, and it is determined that the set maximum speed cannot be maintained for a predetermined time or more by the travel distance And a maximum speed setting means for setting a maximum speed corresponding to the travel distance that can be held for a predetermined time .

A plurality of stages of acceleration are set in the speed changing process in which the moving body is accelerated or decelerated, and the speed pattern creating means has a predetermined ratio to the maximum speed set by the maximum speed setting means. The travel control device for a moving body according to claim 2 , further comprising acceleration change timing setting means for setting an acceleration change timing in the speed change process .

The travel control device for a moving body according to claim 2 or 3, wherein a creep speed held before reaching the target position is set in the speed pattern set by the speed pattern setting means .