Nothing Special   »   [go: up one dir, main page]

JP4214533B2 - 移動体システム - Google Patents

移動体システム Download PDF

Info

Publication number
JP4214533B2
JP4214533B2 JP2006218694A JP2006218694A JP4214533B2 JP 4214533 B2 JP4214533 B2 JP 4214533B2 JP 2006218694 A JP2006218694 A JP 2006218694A JP 2006218694 A JP2006218694 A JP 2006218694A JP 4214533 B2 JP4214533 B2 JP 4214533B2
Authority
JP
Japan
Prior art keywords
detected
linear
moving
origin
linear scale
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.)
Active
Application number
JP2006218694A
Other languages
English (en)
Other versions
JP2008045873A (ja
Inventor
秀樹 久保
裕喜 曽根
敦雄 長澤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Murata Machinery Ltd
Original Assignee
Murata Machinery Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Murata Machinery Ltd filed Critical Murata Machinery Ltd
Priority to JP2006218694A priority Critical patent/JP4214533B2/ja
Priority to TW096105103A priority patent/TWI414920B/zh
Priority to KR1020070015954A priority patent/KR101087600B1/ko
Priority to CN2007101408215A priority patent/CN101122470B/zh
Publication of JP2008045873A publication Critical patent/JP2008045873A/ja
Priority to HK08107864.0A priority patent/HK1112757A1/xx
Application granted granted Critical
Publication of JP4214533B2 publication Critical patent/JP4214533B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B7/00Measuring arrangements characterised by the use of electric or magnetic techniques
    • G01B7/003Measuring arrangements characterised by the use of electric or magnetic techniques for measuring position, not involving coordinate determination
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G1/00Storing articles, individually or in orderly arrangement, in warehouses or magazines
    • B65G1/02Storage devices
    • B65G1/04Storage devices mechanical
    • B65G1/0407Storage devices mechanical using stacker cranes
    • B65G1/0421Storage devices mechanical using stacker cranes with control for stacker crane operations

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Transmission And Conversion Of Sensor Element Output (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
  • Platform Screen Doors And Railroad Systems (AREA)
  • Warehouses Or Storage Devices (AREA)

Description

この発明はスタッカークレーンや天井走行車、有軌道台車、ターンテーブルその他の移動体のシステムに関し、特にその絶対位置の検出に関する。
移動体システムでは、移動体の絶対位置の検出が重要である。この点に関し、駆動用モータのエンコーダ値をそのまま絶対位置に換算すると、車輪の滑りによる誤差が生じる。そこで移動経路が固定の場合、移動経路に沿って櫛歯などのマークを設けてカウントすることが考えられるが、櫛歯の分解能分の誤差が生じるし、停止後にバックラッシュが生じると誤差となる。この点に付き、特許文献1は停止位置の付近にリニアセンサの被検出マークを設け、移動体にセンサを設けて、各停止位置を基準とする絶対位置を検出することを提案している。この手法では目標停止位置へ接近すると減速を開始し、マークを検出すると、制御上の残距離をエンコーダなどで求めたものからリニアスケールを用いて求めたものへ切り替える。残距離をリニアスケールを用いたものに切り替えると、制御上はエンコーダの誤差に相当する誤差が突然発生したことになり、これに対して強い制御を施すと振動の原因となる。そこでエンコーダからリニアスケールに切り替えるまでに充分減速して、小さな制御ゲインで停止できるようにする必要がある。検出エリアが広いリニアスケールを設けるとこのような問題は解消するが、検出エリアの広いリニアスケールを設けることは難しい。
特開2005−202464号
この発明の課題は、個々のリニアセンサの検出スケールよりも広い範囲で、移動体の絶対位置を求めることができるようにすることにある。
この発明での追加の課題は、移動体の絶対位置が揺動してもリニアセンサを切り替える必要が無いようにすることにある。
この発明での追加の課題は、被検出マークの番号をリニアセンサの信号から求めることができるようにすることにある。
請求項3の発明での追加の課題は、移動経路の全域に渡って移動体の絶対位置を求めることができるようにすることにある。
請求項4の発明での追加の課題は、停電や故障等からの復旧時に、検出対象の被検出マークの番号の妥当性を簡単に検査できるようにすることにある。
この発明の移動体システムは、移動体の移動方向に平行な被検出マークの列を少なくとも2列設けて、各列に被検出マークを離散的に配置し、前記少なくとも2列の被検出マークに対応して、前記移動方向に直交する方向での位置が異なるリニアセンサを少なくとも2個前記移動体に設けて、前記少なくとも2個のリニアセンサでの被検出マークに対する検出エリアが互いに重なるようにすると共に、前記検出エリアの端部で、移動体の移動方向に従って、検出対象の被検出マークの番号をカウントアップもしくはカウントダウンすると共に、前記少なくとも2個のリニアセンサの間で、用いるリニアセンサを切り替えるための手段と、用いるリニアセンサの信号から、移動体の絶対位置を検出するための手段とを設けたものである。
好ましくは、移動体は原点と反原点との間で移動し、移動体の移動方向を原点から遠ざかる向きを+、原点に近づく向きを−とし、リニアセンサの信号をリニアセンサ内原点を基準として、移動体の原点から遠い側を+、移動体の原点に近い側を−とし、かつ検出対象の被検出マークの番号を、移動体の原点側から反原点側へ向けて増すようにした際に、前記切り替えるための手段では、移動体の移動方向と用いるリニアセンサの信号が共に+で、検出対象の被検出マークの番号をカウントアップし、移動体の移動方向と用いるリニアセンサの信号が共に−で、検出対象の被検出マークの番号をカウントダウンする。なお+や−の意味は相対的なものである。例えば移動体の移動方向や、リニアセンサの信号の正負を逆にし、被検出マークの数え方を逆にすると、同じ制御結果が得られる。
特に好ましくは、移動体の移動経路の全域に渡って前記少なくとも2列の被検出マークを配置する。
より好ましくは、検出対象の被検出マークの番号を移動体のトラブル時も記憶するための記憶手段と、移動体をトラブルから回復させた際に、少なくとも、記憶した検出対象の被検出マークの番号をどのリニアセンサが被検出マークを検出しているかで、記憶した検出対象の被検出マークの番号の妥当性を検査するための検査手段とを、さらに設けて、検査手段の検査結果が妥当な際に、前記記憶した被検出マークの番号を用いて移動体の絶対位置の初期値を求める。
この発明では被検出マークを少なくとも2列配置し、各列毎にリニアセンサを設けて、検出するマークトリにアセンサを切り替えながら、移動体の絶対位置を求める。このため移動方向に沿った絶対位置を連続的に検出でき、しかも長大な被検出マークや長大なリニアセンサを設ける必要がない。絶対位置を連続的に検出できるので、エンコーダや櫛歯センサ、レーザ距離計などの補助的なセンサで絶対位置を補間する必要が無い。
ここで少なくとも2個のリニアセンサの検出エリアが重なり合うようにすると、一方のリニアセンサから他方のリニアセンサへ切り替えた後にバックラッシュ等が生じて、元のリニアセンサの検出エリアへ移動体が戻っても、リニアセンサを切り替える必要がない。さらに2列の被検出マークの間で移動体がねじれると、2個のリニアセンサの検出エリアが重ならない場合、何れのリニアセンサも検出できないエリアが生じる。これに対し少なくとも2個のリニアセンサの検出エリアが重なり合うようにすると、リニアセンサを頻繁に切り替えたりする必要がない。
移動体の移動経路の全域に渡って被検出マークの列を配置すると、移動経路上のどの位置でも絶対位置をリニアセンサで求めることができ、他の補助的なセンサで絶対位置を推定せねばならない位置が生じない。
被検出マークの列を複数設けると、どのマークを検出しているのかを認識する必要がある。そこで被検出マークの付近にそのIDを示すRFIDなどのマークを設けて、被検出マークとは別にID用のマークを読み取っても良い。しかし移動体の移動方向に従って、検出した被検出マークをカウントアップもしくはカウントダウンすると、リニアセンサの信号自体から被検出マークの番号が判明する。
移動体が停電やその他のトラブルで停止することがある。被検出マークをリニアセンサでカウントしてどの被検出マークを用いているかを自律的に判断すると、トラブル等から復旧した際に移動体の位置が不明になる。そこで検出対象の被検出マークの番号を移動体のトラブル時も記憶するための記憶手段を設けると、トラブルが発生する前に用いていた被検出マークの番号が判明する。問題はこの番号が正しいかどうかであるが、被検出マークを複数列に配置し各列毎にリニアセンサを設けると、どの列のリニアセンサが被検出マークを検出しているかから、記憶した被検出マークの番号をマークの列の単位まで確認できる。トラブル等の間に移動体が被検出マーク2個分以上を移動することは考え難いので、マークの列の単位まで妥当性を検査できると、被検出マークの記憶値が正しいものとして移動体を復旧できる。このためトラブルの都度、原点等の絶対位置を確認できる点まで移動体を移動させる必要が無く、停止していたその場から作業を再開できる。
以下に本発明を実施するための最適実施例を示す。
図1〜図12に、実施例の移動体システムを示す。各図において、2は移動体で、ここではスタッカークレーンで、天井走行車や有軌道台車、ターンテーブルあるいはその他の移動体でもよい。なお移動体2は走行経路が定められている。4は台車、6は昇降台、8,9は前後のマストで、10,11は走行モータである。12,13は昇降モータで、図示しないドラムやプーリ、ギアなどを介して、ベルトやワイヤ、ロープなどの吊持材により昇降台6を昇降させる。なお走行モータ10,11や昇降モータ12,13の台数や配置などは任意である。昇降台6にはスライドフォーク14などの移載装置を設け、移載装置と昇降台6の間にターンテーブルなどを搭載してもよい。また台車4には、少なくとも左右一対のリニアセンサ16,17を設け、また昇降台6にはマスト8に沿って少なくとも左右一対のリニアセンサ18,19を設ける。
20は走行レールで、その左右に例えば少なくとも2列に磁気マーク21,22を設け、また図3に示すように、例えばマスト8の左右に磁気マーク31,32を少なくとも2列に配置する。実施例では、リニアセンサ16,17の走行方向位置を同じにし、磁気マーク21,22を等ピッチで互い違いに配置する。リニアセンサ16,17の走行方向位置を異ならせる場合、磁気マーク21から磁気マーク22へのピッチと、磁気マーク22から磁気マーク21へのピッチも異ならせる。磁気マーク31,32はマスト8に2列に配置するが、マスト8側とマスト9側とに各1列配置してもよい。但しこの場合、昇降台6が移動体2の移動方向に傾斜すると、リニアセンサ18,19の出力が検出エリアの重なり部で一致しなくなり、補正が必要となる。実施例では、磁気マーク21,22を2列に配置したが、3列以上に配置してもよく、同様に磁気マーク31,32も3列以上に配置してもよい。さらに磁気マーク21,22等は、リニアセンサ16,17等との電磁結合により検出され、磁気マークに代えて強誘電体などのマークを用いてもよい。磁気マーク21,22等は例えば棒状で、実施例では棒状の磁石を用いるが、磁性体や反磁性体を用いてもよい。走行レール20の一端に走行原点が有り、他端に反原点が有る。
図4にターンテーブル40への応用例を示し、41はターンテーブル40の駆動軸で、42は駆動モータである。ターンテーブル40の周囲の固定部側には、磁気マーク45,46を飛び飛びにかつ同心円上に少なくとも2列に配置し、ターンテーブル40側には磁気マーク45,46を配置した2つの円に対応して、リニアセンサ43,44を配置する。図1〜図4の各場合において、磁気マーク21,22等を固定側に、リニアセンサ16,17等を移動側に設ける。
図5に、リニアセンサ16と磁気マーク21とを例に、リニアスケールの構成を示し、他のリニアセンサ17等や磁気マーク22等の場合も同様である。50は交流電源で、 sinωtに比例する交流電流を出力し、複数個のコイル51が例えば直列に配置されている。各コイルに加わる電圧は信号処理部52に入力され、演算部53でsinθ・sinωtとcosθ・cosωtに変換される。ここでθは、リニアセンサ16に対する磁気マーク21の位相で、演算部54は演算部53の出力を1つのリニアスケール内での座標、即ちリニアスケール座標LSCに変換する。なおリニアスケール内の原点、通常はリニアスケールの中心、の絶対座標をLSC0で表し、リニアスケール座標の上端(検出エリアの反原点側の端部)を+Aで、下端(検出エリアの原点側の端部)を-Aで表す。
図6にリニアセンサ16,17からの信号の処理を例に、絶対位置算出部60の構成を示す。リニアセンサ18,19やリニアセンサ43,44に対しても、同様の絶対位置算出部60を設けて、昇降方向の絶対位置や回動角の絶対値を算出する。入出力61へ、2つのリニアセンサ16,17からのリニアスケール座標LSC1,LSC2が、交互に入力される。磁気マークに接してリニアスケール座標を出力しているリニアセンサを有効なリニアセンサという。リニアスケール切り替え部62は、各リニアスケールの検出エリアの端部で、移動体の移動方向に従って、用いるリニアスケールを切り替える。なお移動方向は駆動モータの回転方向で見た移動方向で、バックラッシュなどによる移動を含まない。リニアスケールデータ記憶部63は、現在のリニアスケール座標LSC並びに現在のリニアスケール番号LSCNo.及び現在の絶対座標を記憶する。ここで現在のリニアスケール番号は添字iで表し、その最下位ビットの0または1は磁気マーク21,22の列を表す。絶対座標は移動体の走行原点からの座標で、移動体が反原点側へ移動すると絶対座標が増す。オフセット記憶部64は、各リニアスケールに対してその原点座標すなわちLSCi0(オフセット)を記憶する。表1に実施例での用語を示す。
表1 用 語
LS リニアスケール: 磁気マークとリニアセンサの組み合わせで実現されるスケール;スケール番号を添字iで示し、リニアスケール内の原点(中心)からのリニアスケール内座標をLSCiで、その上限を+Aで、下限を-Aで示し、リニアスケールを切り替える点をAで示す。リニアスケールの有効範囲を検出エリアという。
LSC リニアスケール内座標
LSCNo. リニアスケールの番号(添字i)で具体的には磁気マークの番号: 移動体の原点の有るリニアスケールで、i=1、反原点側に向かって番号が増加し、番号の偶奇性は2列のどちらの列かを示す。
LSCi0 リニアスケール内原点の絶対座標: オフセットということがある。
a リニアスケールの重なりを示すパラメータで、リニアスケール端部での、隣接するリニアスケールとの重なりの約1/2の距離がa: LSCの上限あるいは下限からマージンaで、リニアスケールを切り替える。
t 移動体の原点を基準とする絶対座標: 絶対座標と絶対位置は同義語で、共に原点基準の座標や位置を示す。
図6の65,66は入出力である。67は、各リニアスケールの原点座標LSCi0に対する絶対座標(オフセット)を取得するためのオフセット取得部である。正当性検査部68は、停電や移動体2のトラブルからの復旧時に、バックアップメモリ70に記憶したリニアスケール番号の妥当性等を検査する。バックアップメモリ70は、リニアスケールデータ記憶部63並びにオフセット記憶部64のデータを電池あるいは無停電電源などにより記憶し、移動体2の電源をオフしても記憶を維持する。移動体2の電源がオフすると、バックアップメモリ70のデータは更新されず、またリニアセンサ16,17等も動作を停止する。エンコーダ71は走行モータの回転数の積算値などを記憶及び出力し、電池や無停電電源などにより動作して、移動体の電源がオフしている際にも動作を続行する。エンコーダバックアップメモリ72は、エンコーダ71のデータをバックアップするメモリで、移動体の電源をオフすると、記憶値が更新されなくなるので、電源をオフする直前のエンコーダの出力を記憶する。
図7に、リニアスケールLSiと次のリニアスケールLSi+1の間の、リニアセンサの切り替えを示す。各磁気マークは長さが例えば数10mm程度で、各リニアセンサはその検出範囲が例えば数100mm〜1000mm程度である。リニアスケールの幅は数100mm〜1000mm程度で、隣り合うリニアスケールの間で検出エリアが例えば数10mm程度重なるようにする。そして重なりの目標値の1/2をマージンとし、リニアスケールLSiからリニアスケールLSi+1へ切り替える際には、リニアスケールLSiの上限値+Aよりもマージンだけ小さい切り替え点Aで、リニアスケールLSi+1へ切り替える。リニアスケールLSi+1からリニアスケールLSiへ切り替える際には、リニアスケールLSi+1の検出エリアの下限-Aよりもマージンaだけリニアスケール座標が大きい点で切り替えを行う。
磁気マーク等が理想的に設置されている場合、2つの切り替え点は一致するが、これらは特に一致させる必要はない。リニアスケールの切り替えは、走行モータや昇降モータなどによる駆動の方向に合わせて行う。例えば図7の左から右へと移動体が駆動されて、切り替え点Aを通過すると、リニアスケールを切り替える。この直後に移動体が停止し、バックラッシュなどにより移動体が図7の左側に逆移動して切り替え点を再度通過したとしても、リニアスケールの切り替えは行わない。磁気マークは例えば2列に配置されているので、移動体にねじれがあると、一方の磁気マークを基準とする切り替え点と、他方の磁気マークを基準とする切り替え点が異なることがある。このため一方の磁気マークの切り替え点を通過していても、他方の磁気マークの切り替え点を通過していないこともある。このような場合も、リニアスケールを再度切り替えることはしない。これらの結果、リニアスケールを頻繁に切り替えることを防止できる。
図8に、2列のリニアスケールを用いた絶対位置の算出を示す。リニアスケールLS1は移動体の走行原点付近に設けられ、その原点座標LSC10は走行原点で、絶対座標は0である。各リニアスケールに対してその原点座標LSCi0がオフセット記憶部64に記憶され、各リニアスケールLSi内の原点を基準とするリニアスケール座標が、リニアスケール座標LSCiとして出力される。そこで現在用いているリニアスケールの番号(添字i)が判明し、これに対するオフセットが判明すると、リニアスケール座標LSCiをオフセットLSCi0に加算することにより、現在の絶対座標が判明する。
図9に、リニアスケールの原点座標LSCi0の取得アルゴリズムを示す。移動体を走行原点側から反原点側へスタートさせる。また走行原点位置は例えば最初のリニアスケールの原点位置(中心位置)とし、最初のリニアスケール(LSNo.=1)の原点位置を検出すると、その位置で絶対座標tを0とする。台車を移動させ、次のリニアスケールを検出すると、切り替え点での絶対座標tAiを記憶し、切り替えた新たなリニアスケールLSi+1でのリニアスケール座標LSCi+1を記憶し、リニアスケール番号iを1加算する。リニアスケール番号iは既に1加算済みなので、新たなリニアスケールLSCi+1でのリニアスケール内原点を検出すると、切り替え点Aからのリニアスケール座標の変化分を、記憶済みの絶対座標tAiに加え、リニアスケール内原点の絶対座標として記憶する。ここでリニアスケールを切り替えた際に求めたリニアスケール座標LSCi+1を、切り替え点AからリニアスケールLSi+1のリニアスケール内原点までの距離に換算し、直ちにリニアスケールLSi+1のリニアスケール内原点の絶対座標を求めてもよい。
以上のループを最後のリニアスケールまで繰り返し、全リニアスケールに対してリニアスケール内原点座標の絶対値を求めて記憶する。なおリニアスケールを設計データなどに基づいて設置し、移動体を移動させる以外の手法で、リニアスケール内原点座標の絶対値を求めてもよい。
図10にリニアスケールの切り替えアルゴリズムを示す。隣接したリニアスケールには検出エリアの重なりがあるので、この部分で左右のリニアスケールが共に有効になる。次に現在使用中のリニアスケールが左もしくは右のいずれであるかを求める。使用中のリニアスケールが例えば左の場合、駆動モータの回転方向が+方向で、リニアスケール座標が+側にあり、かつ検出エリアの端部のマージンaを移動体が越えた場合に、次の右側のリニアスケールを有効にし、リニアスケール番号を1加算する。これとは逆に、モータの駆動方向が−側で、リニアスケール座標が負であり、かつ−側のマージンを越えた場合、リニアスケール番号を1減算して、有効なリニアスケールを右側のリニアスケールに変更する。これ以外の場合は、駆動モータの動作と同期した変化ではないので、リニアスケールの切り替えは行わない。
右側のリニアスケールを現在使用中の場合、モータの駆動方向が+で、リニアスケール座標が+で、かつ+側でリニアスケール座標がマージンaを越えている場合、リニアスケール番号を1加算する。モータの回転方向が−で、リニアスケール座標が負であり、−側でリニアスケール座標がマージンaを越えた場合、リニアスケール番号を1減算する。これ以外の場合は、リニアスケール番号を維持する。以上によって使用するリニアスケールを切り替える。
図11に示すように、1つのリニアスケールの検出エリア内の移動では、現在のリニアスケール番号と、リニアスケール内原点の絶対座標LSCi0を用いる。リニアスケール座標の現在位置LSCiを用いて、絶対座標tを t=LSCi0+LSCi により求める。
図12に、停電や移動体のトラブルなどからの復旧時のリセット処理を示す。バックアップデータから、リニアスケール番号iとバックアップしたリニアスケール座標LSCを取得する。同様にエンコーダ用バックアップデータから、モータのエンコーダ値を取得する。次に電源をオンすると、リニアスケールは動作を開始し、左右のリニアスケールの内、少なくとも一方が有効で、これからリニアスケール番号の最下位ビットが判明する。移動体がトラブル時や停電時にリニアスケール2個分以上移動していなければ、バックアップしたリニアスケール番号の最下位ビットと、現在有効なリニアスケールが左側か右側かのデータとから、移動体が同じリニアスケール上にとどまっているか、トラブル等の間に別のリニアスケールへ移動したかが判明する。なお左右のリニアスケールが共に有効な場合、バックアップデータから求めたリニアスケール番号の最下位ビットに対応するリニアスケールが有効なはずである。次にリニアスケール座標自体をバックアップしている場合、リセット時に新たに測定したリニアスケール座標と比較し、誤差が許容範囲内かどうかをチェックする。さらにバックアップメモリのエンコーダ値と実際のエンコーダ値との誤差が許容範囲内かどうかをチェックする。なおエンコーダは電池や無停電電源などにより動作しているので、移動体の電源が遮断されている間も、駆動軸が回転すればエンコーダ値が更新される。なおリニアスケール座標LSCはバックアップしておかなくても良い。
リニアスケール番号が妥当で、リニアスケール座標が妥当で、エンコーダ値が妥当な場合、移動体の電源が遮断された後の移動量は許容範囲内である。そこでこの場合、現在のリニアスケール座標とリニアスケール番号とを元に絶対座標を復元し、移動体を再作動させる。上記のいずれかのデータに妥当性がない場合、例えば移動体を原点に移動させ、正確な絶対座標を再度取得する。なおバックアップしたデータに信頼性がない場合、移動体を一律に原点に移動させる必要はなく、バックアップしたデータの信頼性に合わせた復旧処理を多種類設けてもよい。
実施例では以下の効果が得られる。
(1) 移動体の移動経路の全域に渡って、絶対位置を求めることができる。
(2) 移動体の移動経路の全域に渡るリニアセンサを設けることは実質上不可能であるが、実施例では2つのリニアセンサを交互に切り替えれば良く、長大なリニアセンサを設ける必要がない。
(3) 移動体の移動や昇降、回動など任意の種類の動作に対して、絶対座標を求めることができる。
(4) リニアスケールの検出エリアの端部に重なりを持たせるので、移動体のバックラッシュや2列の磁気マーク間での移動体の捻れなどにより、リニアスケールを頻繁に切り替える必要がない。
(5) 各リニアスケール内の原点の絶対座標を自動的に取得できる。
(6) どのリニアスケールが使用中であるかを、リニアセンサ自体の信号により求めることができる。
(7) 移動体をリセットする際に、バックアップしたリニアスケール番号等が妥当であれば、移動体を原点まで再移動させずにリセットできる。
実施例では磁気マークを2列に配置したが3列以上に配置してもよく、この場合磁気マークの列の数だけのリニアセンサを移動体に設ける。また実施例ではリニアスケール座標とエンコーダ値の双方をバックアップしたが、例えばその一方のみをバックアップしてもよい。用いる移動体の種類はスタッカークレーンに限らず天井走行車や有軌道台車、ターンテーブル、コンベヤ、循環棚など任意である。検出エリアの重なり部の切り替え点で100%リニアセンサを切り替える代わりに、重なり部では左右のリニアセンサで求めた絶対位置を重み付き平均して絶対位置に換算し、その重みを重なり部内で徐々に変化させても良い。
実施例の移動体システムの要部平面図 実施例の移動体システムの要部側面図 実施例でのマストへの磁気マークの配置を模式的に示す図 実施例でのターンテーブルへの磁気マークの配置を模式的に示す図 実施例でのリニアセンサのブロック図 実施例での座標算出部のブロック図 実施例での、リニアスケールの切替を模式的に示す図 実施例での、リニアスケールの切替とオフセット補正を模式的に示す図 実施例でのリニアスケールのオフセットLSCi0の取得アルゴリズムを示すフローチャート 実施例でのリニアスケールの切り替えアルゴリズムを示すフローチャート 実施例でのリニアスケール内移動アルゴリズムを示すフローチャート 実施例でのリセットアルゴリズムを示すフローチャート
符号の説明
2 移動体
4 台車
6 昇降台
8,9 マスト
10,11 走行モータ
12,13 昇降モータ
14 スライドフォーク
16,17 リニアセンサ
18,19 リニアセンサ
20 走行レール
21,22 磁気マーク
31,32 磁気マーク
40 ターンテーブル
41 駆動軸
42 駆動モータ
43,44 リニアセンサ
45,46 磁気マーク
50 交流電源
51 コイル
52 信号処理部
53,54 演算部
60 絶対位置算出部
61 入出力
62 リニアスケール切り替え部
63 リニアスケールデータ記憶部
64 オフセット記憶部
65,66 入出力
67 オフセット取得部
68 正当性検査部
70 バックアップメモリ
71 エンコーダ
72 エンコーダバックアップメモリ

Claims (4)

  1. 移動体の移動方向に平行な被検出マークの列を少なくとも2列設けて、各列に被検出マークを離散的に配置し、前記少なくとも2列の被検出マークに対応して、前記移動方向に直交する方向での位置が異なるリニアセンサを少なくとも2個前記移動体に設けて、前記少なくとも2個のリニアセンサでの被検出マークに対する検出エリアが互いに重なるようにすると共に、
    前記検出エリアの端部で、移動体の移動方向に従って、検出対象の被検出マークの番号をカウントアップもしくはカウントダウンすると共に、前記少なくとも2個のリニアセンサの間で、用いるリニアセンサを切り替えるための手段と、
    用いるリニアセンサの信号から、移動体の絶対位置を検出するための手段とを設けた移動体システム。
  2. 移動体は原点と反原点との間で移動し、移動体の移動方向を原点から遠ざかる向きを+、原点に近づく向きを−とし、リニアセンサの信号をリニアセンサ内原点を基準として、移動体の原点から遠い側を+、移動体の原点に近い側を−とし、かつ検出対象の被検出マークの番号を、移動体の原点側から反原点側へ向けて増すようにした際に、前記切り替えるための手段では、移動体の移動方向と用いるリニアセンサの信号が共に+で、検出対象の被検出マークの番号をカウントアップし、移動体の移動方向と用いるリニアセンサの信号が共に−で、検出対象の被検出マークの番号をカウントダウンするようにしたことを特徴とする、請求項1の移動体システム。
  3. 移動体の移動経路の全域に渡って前記少なくとも2列の被検出マークを配置したことを特徴とする、請求項1または2の移動体システム。
  4. 検出対象の被検出マークの番号を移動体のトラブル時も記憶するための記憶手段と、
    移動体をトラブルから回復させた際に、少なくとも、記憶した検出対象の被検出マークの番号をどのリニアセンサが被検出マークを検出しているかで、記憶した検出対象の被検出マークの番号の妥当性を検査するための検査手段とを、さらに設けて、
    検査手段の検査結果が妥当な際に、前記記憶した被検出マークの番号を用いて移動体の絶対位置の初期値を求めるようにしたことを特徴とする、請求項1〜3のいずれかの移動体システム。
JP2006218694A 2006-08-10 2006-08-10 移動体システム Active JP4214533B2 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
JP2006218694A JP4214533B2 (ja) 2006-08-10 2006-08-10 移動体システム
TW096105103A TWI414920B (zh) 2006-08-10 2007-02-12 Mobile system
KR1020070015954A KR101087600B1 (ko) 2006-08-10 2007-02-15 이동체 시스템
CN2007101408215A CN101122470B (zh) 2006-08-10 2007-08-10 移动体系统
HK08107864.0A HK1112757A1 (en) 2006-08-10 2008-07-16 Moving body system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2006218694A JP4214533B2 (ja) 2006-08-10 2006-08-10 移動体システム

Publications (2)

Publication Number Publication Date
JP2008045873A JP2008045873A (ja) 2008-02-28
JP4214533B2 true JP4214533B2 (ja) 2009-01-28

Family

ID=39084900

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2006218694A Active JP4214533B2 (ja) 2006-08-10 2006-08-10 移動体システム

Country Status (5)

Country Link
JP (1) JP4214533B2 (ja)
KR (1) KR101087600B1 (ja)
CN (1) CN101122470B (ja)
HK (1) HK1112757A1 (ja)
TW (1) TWI414920B (ja)

Families Citing this family (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5093664B2 (ja) * 2008-02-06 2012-12-12 村田機械株式会社 移動体システム
AU2009333799B2 (en) * 2008-12-29 2014-12-11 Crown Products & Services, Inc. System and method for compacting materials in open top transport conveyance
JP5045705B2 (ja) * 2009-04-16 2012-10-10 村田機械株式会社 搬送車システム
JP4835960B2 (ja) * 2009-04-24 2011-12-14 村田機械株式会社 移動体システム
JP5007753B2 (ja) * 2010-04-12 2012-08-22 村田機械株式会社 位置センサ
CN103630064A (zh) * 2012-08-22 2014-03-12 大银微系统股份有限公司 封闭式位置量测器的可动原点构造
CN102937812B (zh) * 2012-11-14 2015-04-22 中国水产科学研究院渔业机械仪器研究所 一种轨道小车行走控制系统和方法
CN102968121B (zh) * 2012-11-27 2015-04-08 福建省电力有限公司 一种沿轨道行驶定位装置
JP6314372B2 (ja) * 2013-04-22 2018-04-25 村田機械株式会社 位置検出装置、位置検出方法、及び移動体システム
ITTO20130628A1 (it) * 2013-07-24 2015-01-25 Eurofork S R L Magazzino automatizzato
JP2017096756A (ja) * 2015-11-24 2017-06-01 Kyb株式会社 ストローク検出装置
JP6365601B2 (ja) * 2016-07-11 2018-08-01 愛知製鋼株式会社 磁気マーカ検出システム及び磁気マーカ検出方法
CN106287335A (zh) * 2016-08-16 2017-01-04 凌云光技术集团有限责任公司 一种用于图像传感器性能测试的光源装置
JP6771999B2 (ja) * 2016-08-26 2020-10-21 シャープ株式会社 自動走行装置及び自動走行システム
AT519139B1 (de) * 2016-10-10 2018-09-15 Tgw Mechanics Gmbh Regalbediengerät und Regallagersystem mit verbesserter Zugänglichkeit und Gewichtsverteilung
TWI815834B (zh) * 2017-12-22 2023-09-21 瑞士商施內貝格爾控股公司 用來確定絕對位置的線性路線測量儀和用這種路線測量儀進行線性導引
IL282630B (en) * 2018-10-29 2022-08-01 Murata Machinery Ltd Car travel system
KR102300080B1 (ko) * 2019-10-10 2021-09-07 세메스 주식회사 캐리어 이송 장치의 위치 인식 시스템 및 방법

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5040427A (en) * 1988-12-02 1991-08-20 Canon Kabushiki Kaisha Moving apparatus
US5497083A (en) * 1992-12-24 1996-03-05 Kayaba Kogyo Kabushiki Kaisha Rod axial position detector including a first scale having equidistant magnetic parts and a second scale having unequally distant parts and differing field strengths
JP3712908B2 (ja) 2000-03-08 2005-11-02 日本輸送機株式会社 無人搬送車及びその誘導路
CN2483473Y (zh) * 2001-01-15 2002-03-27 池续航 电磁导航自动化停车装置
DE10216422C5 (de) * 2002-04-12 2011-02-10 Conductix-Wampfler Ag Vorrichtung zur induktiven Energieversorgung und Führung eines beweglichen Objektes
TWI282047B (en) * 2003-07-23 2007-06-01 Murata Machinery Ltd Carrying vehicle system and carrying vehicle
CN101048292A (zh) * 2004-08-24 2007-10-03 布鲁克斯自动化公司 输送系统

Also Published As

Publication number Publication date
KR101087600B1 (ko) 2011-11-29
CN101122470A (zh) 2008-02-13
JP2008045873A (ja) 2008-02-28
TWI414920B (zh) 2013-11-11
TW200811628A (en) 2008-03-01
HK1112757A1 (en) 2008-09-12
KR20080014584A (ko) 2008-02-14
CN101122470B (zh) 2011-05-04

Similar Documents

Publication Publication Date Title
JP4214533B2 (ja) 移動体システム
KR101601735B1 (ko) 이동체 시스템과 이동체의 주행 제어 방법
TWI538381B (zh) Discrete configuration linear motor system
JP4074999B2 (ja) 搬送台車システム
EP2836799B1 (en) Displacement sensor for contactlessly measuring a position by means of a plurality of magnetic field sensors arranged in series
JP2007126254A (ja) 搬送装置
JP4189826B2 (ja) 走行台車と走行台車システム
JP4438882B2 (ja) 移動体システム
JP2010162635A (ja) 自走式ロボットの位置および姿勢の補正方法
TWI698069B (zh) 移動體
US8981766B2 (en) Position/displacement measuring system
KR20080050287A (ko) 주행대차와 그 시스템
TWI276600B (en) Carriage system
JP5104909B2 (ja) 搬送車システム
JP2014137710A (ja) 無人搬送車の制御方法
JP2015178759A (ja) 駐車システム
JP6191665B2 (ja) 移動体
JP5783410B2 (ja) 移動体システムと移動体の位置検出方法
CN117190833A (zh) 测位装置及驱动装置
JPH08310787A (ja) クレーン位置決め装置
JP2007200062A (ja) 移動体の制御装置
JP4076339B2 (ja) タイヤ式クレーンの走行制御装置
TW202340678A (zh) 定位標度尺、動子及驅動裝置
JP2024047448A (ja) 制御装置、走行装置、制御方法及び制御プログラム
JP2005330076A (ja) 移動棚と無人フォークリフトの複合システム

Legal Events

Date Code Title Description
A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20080804

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20080925

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20081010

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20081023

R150 Certificate of patent or registration of utility model

Ref document number: 4214533

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20111114

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20121114

Year of fee payment: 4

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20131114

Year of fee payment: 5

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20131114

Year of fee payment: 5

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250