JP2006300646A - 作動装置 - Google Patents
作動装置 Download PDFInfo
- Publication number
- JP2006300646A JP2006300646A JP2005121057A JP2005121057A JP2006300646A JP 2006300646 A JP2006300646 A JP 2006300646A JP 2005121057 A JP2005121057 A JP 2005121057A JP 2005121057 A JP2005121057 A JP 2005121057A JP 2006300646 A JP2006300646 A JP 2006300646A
- Authority
- JP
- Japan
- Prior art keywords
- origin
- encoder
- output value
- incremental encoder
- unit
- 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.)
- Withdrawn
Links
Images
Landscapes
- Transmission And Conversion Of Sensor Element Output (AREA)
Abstract
【課題】 作動部材の位置を検出するインクリメンタルエンコーダの原点位置を速やかに検出し得、安価な作動装置を得る。
【解決手段】 電子部品保持装置移動装置を構成するX軸方向移動装置のX軸スライダの位置をインクリメンタルエンコーダにより検出し、X軸スライダ移動用モータのロータの回転位置をアブソリュートエンコーダにより検出し、電源投入時にインクリメンタルエンコーダの原点位置を取得する。そのため、インクリメンタルエンコーダの原点に対して予め定められた側に探索開始位置をアブソリュートエンコーダの出力値で設定し、アブソリュートエンコーダの出力値に基づいてX軸スライダを探索開始位置へ高速で移動させ、その後、低速で移動させつつ原点位置を探す。原点位置検出信号が得られれば、インクリメンタルエンコーダの出力値を0にセットする。
【選択図】 図6
【解決手段】 電子部品保持装置移動装置を構成するX軸方向移動装置のX軸スライダの位置をインクリメンタルエンコーダにより検出し、X軸スライダ移動用モータのロータの回転位置をアブソリュートエンコーダにより検出し、電源投入時にインクリメンタルエンコーダの原点位置を取得する。そのため、インクリメンタルエンコーダの原点に対して予め定められた側に探索開始位置をアブソリュートエンコーダの出力値で設定し、アブソリュートエンコーダの出力値に基づいてX軸スライダを探索開始位置へ高速で移動させ、その後、低速で移動させつつ原点位置を探す。原点位置検出信号が得られれば、インクリメンタルエンコーダの出力値を0にセットする。
【選択図】 図6
Description
本発明は、作動部材が駆動源により運動伝達装置を介して作動させられる作動装置に関するものであり、特に、駆動源の位置がアブソリュートエンコーダにより検出され、作動部材の位置がインクリメンタルエンコーダにより検出される作動装置に関するものである。
この種の作動装置は、例えば、下記の特許文献1に記載されている。特許文献1に記載の作動装置は主軸装置であり、主軸と、主軸を回転駆動するサーボモータと、複数の歯車を含み、サーボモータの回転を減速して主軸に伝達する減速機とを備え、主軸の回転位置がインクリメンタルエンコーダにより検出され、サーボモータのロータの回転位置がアブソリュートエンコーダにより検出される。この主軸装置の作動時には、インクリメンタルエンコーダの出力値に基づいて主軸の回転位置が求められ、フィードバック制御が行われる。そのため、電源投入時にアブソリュートエンコーダの出力値とインクリメンタルエンコーダの出力値とに基づいて、それらエンコーダの原点相互のずれが求められ、作動時には、取得された原点間のずれと、インクリメンタルエンコーダの出力値とに基づいて、演算により主軸の絶対的な回転位置(インクリメンタルエンコーダの原点をアブソリュートエンコーダの原点に一致させた場合の、インクリメンタルエンコーダの原点に対する位置)が得られるようにされている。
特開平5−88751号公報
しかしながら、特許文献1に記載の主軸装置においては、アブソリュートエンコーダの原点とインクリメンタルエンコーダの原点とのずれを、それらの出力値に基づいて演算により求めているため、誤差が生ずる場合がある。両エンコーダの原点の相対位置や運動伝達装置としての減速機の熱変形等に起因する機械的誤差によっては、大きな演算誤差が生じることすらある。
一方、原点センサを設け、インクリメンタルエンコーダの原点を検出することが行われており、この場合には上記演算誤差発生の恐れはないが、原点検出に時間が掛かるという別の問題がある。原点センサで原点を検出するためには、作動部材を低速で移動させることが必要であるからであり、作動部材が原点から遠く離れた位置にある状態から原点検出が行われる場合には、特に長い時間が必要となる。
本発明は、上記の事情を背景として為されたものであり、作動部材を運動伝達装置を介して作動させる駆動源の位置がアブソリュートエンコーダにより検出され、作動部材の位置がインクリメンタルエンコーダにより検出される作動装置において、インクリメンタルエンコーダの原点位置を速やかに検出し得、しかも安価な作動装置を得ることを課題とする。
一方、原点センサを設け、インクリメンタルエンコーダの原点を検出することが行われており、この場合には上記演算誤差発生の恐れはないが、原点検出に時間が掛かるという別の問題がある。原点センサで原点を検出するためには、作動部材を低速で移動させることが必要であるからであり、作動部材が原点から遠く離れた位置にある状態から原点検出が行われる場合には、特に長い時間が必要となる。
本発明は、上記の事情を背景として為されたものであり、作動部材を運動伝達装置を介して作動させる駆動源の位置がアブソリュートエンコーダにより検出され、作動部材の位置がインクリメンタルエンコーダにより検出される作動装置において、インクリメンタルエンコーダの原点位置を速やかに検出し得、しかも安価な作動装置を得ることを課題とする。
本発明は、上記の課題を解決するために、駆動源と、その駆動源により運動伝達装置を介して作動させられる作動部材と、駆動源の位置を検出するアブソリュートエンコーダと、作動部材の位置を検出するインクリメンタルエンコーダと、それらアブソリュートエンコーダおよびインクリメンタルエンコーダの出力に基づいて駆動源を制御することにより作動部材の位置を制御する制御装置とを含む作動装置において、制御装置を、(a)作動部材を、アブソリュートエンコーダの出力に基づいて、インクリメンタルエンコーダの原点位置近傍であって、かつ、その原点に対して予め定められた側であることが保証される探索開始位置まで作動させるように、駆動源を高速で作動させる高速作動部と、(b)その高速作動部による作動後に、上記高速より低い速度で駆動源を作動させる低速作動部と、(c)その低速作動部による作動中にインクリメンタルエンコーダの原点を探索し、原点位置を取得する原点探索部とを含むものとしたことを要旨とするものである。
作動部材には、例えば、一直線に沿って移動する直線移動部材、回転軸線まわりに回転する回転部材、旋回軸線まわりに旋回する旋回部材等がある。回転部材の位置検出には、インクリメンタルエンコーダとしてロータリエンコーダが適している。
駆動源として、例えば、電動回転モータのような回転駆動源や、流体圧シリンダのような直線的駆動源を使用することができる。直線的駆動源の位置検出には、アブソリュートエンコーダとしてリニアスケールエンコーダを用いてもよく、ロータリエンコーダを用いてもよい。
運動伝達装置として、例えば、互いに螺合した雄ねじ部材および雌ねじ部材を含むねじ装置、プーリ等の回転体およびベルト等の巻掛回転伝達部材を含む巻掛伝達装置、互いに噛み合わされた複数の歯車を含む歯車装置等を使用することができる。
作動部材には、例えば、一直線に沿って移動する直線移動部材、回転軸線まわりに回転する回転部材、旋回軸線まわりに旋回する旋回部材等がある。回転部材の位置検出には、インクリメンタルエンコーダとしてロータリエンコーダが適している。
駆動源として、例えば、電動回転モータのような回転駆動源や、流体圧シリンダのような直線的駆動源を使用することができる。直線的駆動源の位置検出には、アブソリュートエンコーダとしてリニアスケールエンコーダを用いてもよく、ロータリエンコーダを用いてもよい。
運動伝達装置として、例えば、互いに螺合した雄ねじ部材および雌ねじ部材を含むねじ装置、プーリ等の回転体およびベルト等の巻掛回転伝達部材を含む巻掛伝達装置、互いに噛み合わされた複数の歯車を含む歯車装置等を使用することができる。
インクリメンタルエンコーダの原点の探索は、例えば、インクリメンタルエンコーダ自身が有する原点検出機構、あるいはインクリメンタルエンコーダとは別に設けられた原点位置センサによって、原点が検出されるか否かにより行われ、作動部材が駆動源により作動させられ、インクリメンタルエンコーダの原点に対応する位置へ到達すれば、原点位置検出信号が得られ、インクリメンタルエンコーダの原点位置が取得される。いずれにしても、インクリメンタルエンコーダの原点位置は作動部材の作動領域内にあり、作動部材を作動させることにより、インクリメンタルエンコーダの現実の原点位置が得られ、運動伝達装置に熱膨張や経年変化等が生じてもインクリメンタルエンコーダの原点位置が正確に得られ、その出力値に基づいて作動部材の位置を精度良く検出することができる。
しかも、探索開始位置が設定され、作動部材は原点探索開始時の位置から探索開始位置までは高速で作動させられ、探索開始位置到達後、インクリメンタルエンコーダの原点位置近傍では低速で作動させられるため、作動部材が原点探索開始時の位置から原点位置まで低速で作動させられる場合に比較して、迅速に、かつ原点位置を逃すことなく確実に取得することができる。また、探索開始位置は、インクリメンタルエンコーダの原点に対して予め定められた側であることが保証される位置に設定されるため、作動部材の探索開始位置からの作動方向が予め定められ、駆動源の低速作動制御が容易に行われる。
なお、インクリメンタルエンコーダを、それ自身が原点位置を検出する機能を有するものとすれば、インクリメンタルエンコーダとは別に原点位置センサを設ける場合に比較して、容易にかつ安価に原点位置を取得することができる。また、別の原点位置センサにおけるようにノイズ等により原点位置の検出精度が低くなることがなく、原点位置が精度良く検出される。
しかも、探索開始位置が設定され、作動部材は原点探索開始時の位置から探索開始位置までは高速で作動させられ、探索開始位置到達後、インクリメンタルエンコーダの原点位置近傍では低速で作動させられるため、作動部材が原点探索開始時の位置から原点位置まで低速で作動させられる場合に比較して、迅速に、かつ原点位置を逃すことなく確実に取得することができる。また、探索開始位置は、インクリメンタルエンコーダの原点に対して予め定められた側であることが保証される位置に設定されるため、作動部材の探索開始位置からの作動方向が予め定められ、駆動源の低速作動制御が容易に行われる。
なお、インクリメンタルエンコーダを、それ自身が原点位置を検出する機能を有するものとすれば、インクリメンタルエンコーダとは別に原点位置センサを設ける場合に比較して、容易にかつ安価に原点位置を取得することができる。また、別の原点位置センサにおけるようにノイズ等により原点位置の検出精度が低くなることがなく、原点位置が精度良く検出される。
以下に、本願において特許請求が可能と認識されている発明(以下、「請求可能発明」という場合がある。請求可能発明は、少なくとも、請求の範囲に記載された発明である「本発明」ないし「本願発明」を含むが、本願発明の下位概念発明や、本願発明の上位概念あるいは別概念の発明を含むこともある。)の態様をいくつか例示し、それらについて説明する。各態様は請求項と同様に、項に区分し、各項に番号を付し、必要に応じて他の項の番号を引用する形式で記載する。これは、あくまでも請求可能発明の理解を容易にするためであり、請求可能発明を構成する構成要素の組み合わせを、以下の各項に記載されたものに限定する趣旨ではない。つまり、請求可能発明は、各項に付随する記載,実施例の記載等を参酌して解釈されるべきであり、その解釈に従う限りにおいて、各項の態様にさらに他の構成要素を付加した態様も、また、各項の態様から構成要素を削除した態様も、請求可能発明の一態様となり得るのである。
なお、以下の各項において、(1)項が請求項1に相当し、(2)項が請求項2に、(3)項が請求項3に、(4)項が請求項4に、(6)項と(8)項とを合わせたものが請求項5にそれぞれ相当する。
(1)駆動源と、その駆動源により運動伝達装置を介して作動させられる作動部材と、前記駆動源の位置を検出するアブソリュートエンコーダと、前記作動部材の位置を検出するインクリメンタルエンコーダと、それらアブソリュートエンコーダおよびインクリメンタルエンコーダの出力に基づいて前記駆動源を制御することにより前記作動部材の位置を制御する制御装置とを含む作動装置であって、
前記制御装置が、
前記作動部材を、前記アブソリュートエンコーダの出力に基づいて、前記インクリメンタルエンコーダの原点位置近傍であって、かつ、その原点に対して予め定められた側であることが保証される探索開始位置まで作動させるように、前記駆動源を高速で作動させる高速作動部と、
その高速作動部による作動後に、前記高速より低い速度で前記駆動源を作動させる低速作動部と、
その低速作動部による作動中に前記インクリメンタルエンコーダの原点を探索し、原点位置を取得する原点探索部と
を含む作動装置。
探索開始位置は、予めアブソリュートエンコーダの一定出力値に設定しておくことも可能であるが、下記 (2)項,(3)項に記載のように設定すれば、原点探索のために作動部材を低速で移動させるべき距離を小さくでき、原点検出に要する時間を短縮し得る。
(2)前記高速作動部が、
(a)当該作動装置について予め実際に検出されて前記制御装置に記憶されている、前記インクリメンタルエンコーダの原点位置と前記アブソリュートエンコーダの原点位置との相互ずれ量と、(b)当該作動装置と同種の作動装置に共通の値として予め設定されて前記制御装置に記憶されている前記探索開始位置と前記インクリメンタルエンコーダの原点との間の前記作動部材の作動量である共通設定作動量とに基づいて、前記探索開始位置に対応する前記アブソリュートエンコーダの出力値である初期目標出力値を設定する初期目標出力値設定部と、
前記アブソリュートエンコーダの実際の出力値が、前記初期目標出力値設定部により設定された前記初期目標出力値と等しくなるまで、前記作動部材を高速で作動させるように前記駆動源を制御する高速作動制御部と
を含む(1)項に記載の作動装置。
相互ずれ量および共通設定作動量は、例えば、作動部材の作動を制御するプログラムの一部として設定されて、プログラムと共に制御装置のプログラム記憶部に記憶されるようにしてもよく、あるいは少なくとも一方がプログラム記憶部とは別の記憶部に記憶され、プログラム実行時に読み出されて使用されるようにしてもよい。
インクリメンタルエンコーダの原点とアブソリュートエンコーダの原点とが完全に合致するように作動装置を組み立てるには極めて長い時間を要し、実際は殆ど不可能である。そのため、両エンコーダの原点にある程度のずれを許容して作動装置の組立てが行われるのが普通である。ただし、両エンコーダの原点のずれが許容範囲内にあることは必要であり、組立終了時にはずれ量が検出され、許容範囲内にあることが確認されるのが普通である。この場合には、検出されたずれ量を制御装置に記憶させておけばよい。しかし、実際のずれ量は、作動装置の構成要素、特に運動伝達装置の熱膨張,経年変化等に起因して変化する。
したがって、共通設定作動量は、実際のずれ量の上記変化にもかかわらず、探索開始位置へ高速作動させられた作動部材が、必ずインクリメンタルエンコーダの原点位置の予め定められた側に位置することが保証される大きさに設定される。それによって、インクリメンタルエンコーダの原点を探索するための作動部材の作動は、常に予め定められた方向への低速作動により行うことが可能となる。
(3)前記高速作動部が、
前記アブソリュートエンコーダの現在の出力値を、少なくともそのアブソリュートエンコーダと前記インクリメンタルエンコーダとの分解能および前記運動伝達装置の伝達比を使用して、前記インクリメンタルエンコーダの出力値に換算する換算部と、
少なくとも、当該作動装置と同種の作動装置に共通の値として予め設定されて前記制御装置に記憶されている前記探索開始位置と前記インクリメンタルエンコーダの原点との間の前記作動部材の作動量である共通設定作動量に基づいて、前記探索開始位置に対応する前記インクリメンタルエンコーダの出力値である初期目標出力値を設定する初期目標出力値設定部と、
前記作動部材の移動に伴って、前記換算部により換算された出力値から変化する前記インクリメンタルエンコーダの実際の出力値が、前記初期目標出力値設定部により設定された初期目標出力値と等しくなるまで、前記作動部材を高速で作動させるように前記駆動源を制御する高速作動制御部と
を含み、かつ、前記換算部と前記初期目標出力設定部とのいずれか一方が、前記換算または前記初期目標出力値の設定に、当該作動装置について予め実際に検出されて前記制御装置に記憶されている、前記インクリメンタルエンコーダの原点位置と前記アブソリュートエンコーダの原点位置との相互ずれ量をも加味するものである(1)項に記載の作動装置。
アブソリュートエンコーダの出力値とインクリメンタルエンコーダの出力値とは、両エンコーダの分解能(アブソリュートエンコーダとインクリメンタルエンコーダとが発生するパルス信号の1周期に対応する作動部材の作動量)および駆動源の運動を作動部材に伝達する運動伝達装置の伝達比とを使用して相互に換算することができる。
また、高速作動制御部をインクリメンタルエンコーダの出力値に基づいて駆動源を制御するものとする場合には、アブソリュートエンコーダの出力値により示されている作動部材の現在位置をインクリメンタルエンコーダの現在位置に換算して、駆動源の高速作動制御に使用する必要がある。
しかし、両エンコーダの原点位置間には相互ずれ量が存在するため、換算部によるアブソリュートエンコーダの現在の出力値のインクリメンタルエンコーダの出力値への換算と、初期目標出力値設定部による初期目標出力値の設定とのいずれか一方において、両エンコーダの原点位置の相互ずれ量が加味されるようにすることが望ましい。
(4)前記作動部材の作動目標位置を取得する作動目標位置取得部と、
前記原点探索部により探索された原点位置と前記インクリメンタルエンコーダの出力とに基づいて、前記作動部材の現在位置を取得する現在位置取得部と、
その現在位置取得部により取得される現在位置が、前記作動目標位置取得部により取得された作動目標位置に等しくなるように前記駆動源を制御し、前記作動部材を前記作動目標位置へ移動させる位置制御部と
を含み、かつ、前記高速作動部,低速作動部および原点探索部が前記制御装置の少なくとも電源投入時に作動させられ、前記作動目標位置取得部,現在位置取得部および位置制御部が前記電源投入時より後の時期である通常時に作動させられる(1)項ないし(3)項のいずれかに記載の作動装置。
インクリメンタルエンコーダは、電源が落とされれば、電源投入中の出力を記憶せず、次の電源投入時の出力は作動部材の位置を表さない。そのため、電源投入時にインクリメンタルエンコーダの原点位置が探索され、インクリメンタルエンコーダにより作動部材の位置が検出され得るようにされる。
作動部材が、それに予定された作動を行う際には、既にインクリメンタルエンコーダの原点位置が取得されており、作動部材の現在位置と作動目標位置とに基づいて駆動源が制御されることにより、作動部材が精度良く作動目標位置に位置させられる。
インクリメンタルエンコーダは、原点探索部により探索された原点位置から現在位置までの距離を出力するものでもよく、作動部材が単位量作動する毎に+1あるいは−1を出力するものでもよい。前者の場合には、現在位置取得部は単にインクリメンタルエンコーダの出力を読み取る読取部とすることができ、後者の場合には、原点位置において0にセットされ、+1あるいは−1を加算するカウンタとすることができる。
インクリメンタルエンコーダの原点のアブソリュートエンコーダの原点に対する位置が一定で変化しないのであれば、電源投入毎に必ずインクリメンタルエンコーダの原点位置を探索することは不可欠ではなく、アブソリュートエンコーダの原点位置に基づいて演算によりインクリメンタルエンコーダの原点位置を取得することができる。それに対し、例えば運動伝達装置の熱膨張によりインクリメンタルエンコーダの原点とアブソリュートエンコーダの原点との相対位置が変化する場合には、電源投入毎に原点探索が行われ、常にインクリメンタルエンコーダの正確な原点位置が得られるようにすることが必要である。また、アブソリュートエンコーダとインクリメンタルエンコーダとの分解能が異なるために、演算結果に1パルスの誤差が生じる可能性がある場合にも、電源投入毎に原点探索が行われるようにすることが望ましい。
なお、インクリメンタルエンコーダの原点位置の探索は、電源投入時に限らず、それ以外の時、例えば、予め設定された条件の成立時にも行われるようにすることができる。予め設定された条件は、例えば、電源投入から設定時間が経過したこと、その作動装置を含む作業機械の作業量が設定量に達したこと等である。作動装置が回路基板への電子部品の装着を行うための装置であれば、設定枚数の回路基板への電子部品の装着が行われたことが後者の一例である。
(5)前記駆動源が、回転部材を備え、その回転部材の回転に基づいて駆動を行う回転駆動源であり、前記アブソリュートエンコーダが前記回転部材の回転位置を検出するロータリエンコーダを含む(1)項ないし(4)のいずれかに記載の作動装置。
アブソリュート型のロータリエンコーダはリニアスケールエンコーダに比較して安価であり、回転駆動源のアブソリュートエンコーダに適している。また、アブソリュート型のロータリエンコーダを備えた回転駆動源が多く市販されており、それら市販の回転駆動源を利用すれば、本項の作動装置を安価に構成することができる。
(6)前記作動部材が一直線に沿って移動する直線移動部材を含む(1)項ないし(5)項のいずれかに記載の作動装置。
(7)前記運動伝達装置が、互いに螺合した雄ねじ部材と雌ねじ部材とを含み、それら両ねじ部材の一方が前記回転駆動源によって回転させられることにより、両ねじ部材が相対的に直線移動させられる送りねじ装置を含む(5)項または(6)項に記載の作動装置。
運動伝達装置が互いに螺合される2つのねじ部材を含む場合、例えば、熱膨張により、インクリメンタルエンコーダの原点位置とアブソリュートエンコーダの原点位置との関係が変わることがあるが、インクリメンタルエンコーダの原点位置が取得されるため、熱膨張の影響を受けることなく、作動部材の位置を制御することができる。
(8)前記インクリメンタルエンコーダが、前記一直線に平行に配設されたリニアスケールエンコーダを含む(6)項または(7)項に記載の作動装置。
インクリメンタル型のリニアスケールエンコーダはアブソリュート型に比較して安価であり、本発明によれば、高価なアブソリュート型のリニアスケールエンコーダを用いることなく、直線移動部材の位置を検出することができる。
(9)駆動源と、その駆動源により運動伝達装置を介して作動させられる作動部材と、前記駆動源の位置を検出するアブソリュートエンコーダと、前記作動部材の位置を検出するインクリメンタルエンコーダと、それらアブソリュートエンコーダおよびインクリメンタルエンコーダの出力に基づいて前記駆動源を制御することにより前記作動部材の位置を制御する制御装置とを含む作動装置の制御プログラムであって、
前記作動部材を、前記アブソリュートエンコーダの出力に基づいて、前記インクリメンタルエンコーダの原点位置近傍であって、かつ、その原点に対して予め定められた側であることが保証される探索開始位置まで作動させるように、前記駆動源を高速で作動させる高速作動ステップと、
その高速作動ステップの実行後に、前記高速より低い速度で前記駆動源を作動させる低速作動ステップと、
その低速作動ステップの実行中に前記インクリメンタルエンコーダの原点を探索し、原点位置を取得する原点探索ステップと
を含む作動装置の制御プログラム。
(2)項ないし(8)項の各々に記載の特徴は、本制御プログラムの発明にも適用可能である。
前記制御装置が、
前記作動部材を、前記アブソリュートエンコーダの出力に基づいて、前記インクリメンタルエンコーダの原点位置近傍であって、かつ、その原点に対して予め定められた側であることが保証される探索開始位置まで作動させるように、前記駆動源を高速で作動させる高速作動部と、
その高速作動部による作動後に、前記高速より低い速度で前記駆動源を作動させる低速作動部と、
その低速作動部による作動中に前記インクリメンタルエンコーダの原点を探索し、原点位置を取得する原点探索部と
を含む作動装置。
探索開始位置は、予めアブソリュートエンコーダの一定出力値に設定しておくことも可能であるが、下記 (2)項,(3)項に記載のように設定すれば、原点探索のために作動部材を低速で移動させるべき距離を小さくでき、原点検出に要する時間を短縮し得る。
(2)前記高速作動部が、
(a)当該作動装置について予め実際に検出されて前記制御装置に記憶されている、前記インクリメンタルエンコーダの原点位置と前記アブソリュートエンコーダの原点位置との相互ずれ量と、(b)当該作動装置と同種の作動装置に共通の値として予め設定されて前記制御装置に記憶されている前記探索開始位置と前記インクリメンタルエンコーダの原点との間の前記作動部材の作動量である共通設定作動量とに基づいて、前記探索開始位置に対応する前記アブソリュートエンコーダの出力値である初期目標出力値を設定する初期目標出力値設定部と、
前記アブソリュートエンコーダの実際の出力値が、前記初期目標出力値設定部により設定された前記初期目標出力値と等しくなるまで、前記作動部材を高速で作動させるように前記駆動源を制御する高速作動制御部と
を含む(1)項に記載の作動装置。
相互ずれ量および共通設定作動量は、例えば、作動部材の作動を制御するプログラムの一部として設定されて、プログラムと共に制御装置のプログラム記憶部に記憶されるようにしてもよく、あるいは少なくとも一方がプログラム記憶部とは別の記憶部に記憶され、プログラム実行時に読み出されて使用されるようにしてもよい。
インクリメンタルエンコーダの原点とアブソリュートエンコーダの原点とが完全に合致するように作動装置を組み立てるには極めて長い時間を要し、実際は殆ど不可能である。そのため、両エンコーダの原点にある程度のずれを許容して作動装置の組立てが行われるのが普通である。ただし、両エンコーダの原点のずれが許容範囲内にあることは必要であり、組立終了時にはずれ量が検出され、許容範囲内にあることが確認されるのが普通である。この場合には、検出されたずれ量を制御装置に記憶させておけばよい。しかし、実際のずれ量は、作動装置の構成要素、特に運動伝達装置の熱膨張,経年変化等に起因して変化する。
したがって、共通設定作動量は、実際のずれ量の上記変化にもかかわらず、探索開始位置へ高速作動させられた作動部材が、必ずインクリメンタルエンコーダの原点位置の予め定められた側に位置することが保証される大きさに設定される。それによって、インクリメンタルエンコーダの原点を探索するための作動部材の作動は、常に予め定められた方向への低速作動により行うことが可能となる。
(3)前記高速作動部が、
前記アブソリュートエンコーダの現在の出力値を、少なくともそのアブソリュートエンコーダと前記インクリメンタルエンコーダとの分解能および前記運動伝達装置の伝達比を使用して、前記インクリメンタルエンコーダの出力値に換算する換算部と、
少なくとも、当該作動装置と同種の作動装置に共通の値として予め設定されて前記制御装置に記憶されている前記探索開始位置と前記インクリメンタルエンコーダの原点との間の前記作動部材の作動量である共通設定作動量に基づいて、前記探索開始位置に対応する前記インクリメンタルエンコーダの出力値である初期目標出力値を設定する初期目標出力値設定部と、
前記作動部材の移動に伴って、前記換算部により換算された出力値から変化する前記インクリメンタルエンコーダの実際の出力値が、前記初期目標出力値設定部により設定された初期目標出力値と等しくなるまで、前記作動部材を高速で作動させるように前記駆動源を制御する高速作動制御部と
を含み、かつ、前記換算部と前記初期目標出力設定部とのいずれか一方が、前記換算または前記初期目標出力値の設定に、当該作動装置について予め実際に検出されて前記制御装置に記憶されている、前記インクリメンタルエンコーダの原点位置と前記アブソリュートエンコーダの原点位置との相互ずれ量をも加味するものである(1)項に記載の作動装置。
アブソリュートエンコーダの出力値とインクリメンタルエンコーダの出力値とは、両エンコーダの分解能(アブソリュートエンコーダとインクリメンタルエンコーダとが発生するパルス信号の1周期に対応する作動部材の作動量)および駆動源の運動を作動部材に伝達する運動伝達装置の伝達比とを使用して相互に換算することができる。
また、高速作動制御部をインクリメンタルエンコーダの出力値に基づいて駆動源を制御するものとする場合には、アブソリュートエンコーダの出力値により示されている作動部材の現在位置をインクリメンタルエンコーダの現在位置に換算して、駆動源の高速作動制御に使用する必要がある。
しかし、両エンコーダの原点位置間には相互ずれ量が存在するため、換算部によるアブソリュートエンコーダの現在の出力値のインクリメンタルエンコーダの出力値への換算と、初期目標出力値設定部による初期目標出力値の設定とのいずれか一方において、両エンコーダの原点位置の相互ずれ量が加味されるようにすることが望ましい。
(4)前記作動部材の作動目標位置を取得する作動目標位置取得部と、
前記原点探索部により探索された原点位置と前記インクリメンタルエンコーダの出力とに基づいて、前記作動部材の現在位置を取得する現在位置取得部と、
その現在位置取得部により取得される現在位置が、前記作動目標位置取得部により取得された作動目標位置に等しくなるように前記駆動源を制御し、前記作動部材を前記作動目標位置へ移動させる位置制御部と
を含み、かつ、前記高速作動部,低速作動部および原点探索部が前記制御装置の少なくとも電源投入時に作動させられ、前記作動目標位置取得部,現在位置取得部および位置制御部が前記電源投入時より後の時期である通常時に作動させられる(1)項ないし(3)項のいずれかに記載の作動装置。
インクリメンタルエンコーダは、電源が落とされれば、電源投入中の出力を記憶せず、次の電源投入時の出力は作動部材の位置を表さない。そのため、電源投入時にインクリメンタルエンコーダの原点位置が探索され、インクリメンタルエンコーダにより作動部材の位置が検出され得るようにされる。
作動部材が、それに予定された作動を行う際には、既にインクリメンタルエンコーダの原点位置が取得されており、作動部材の現在位置と作動目標位置とに基づいて駆動源が制御されることにより、作動部材が精度良く作動目標位置に位置させられる。
インクリメンタルエンコーダは、原点探索部により探索された原点位置から現在位置までの距離を出力するものでもよく、作動部材が単位量作動する毎に+1あるいは−1を出力するものでもよい。前者の場合には、現在位置取得部は単にインクリメンタルエンコーダの出力を読み取る読取部とすることができ、後者の場合には、原点位置において0にセットされ、+1あるいは−1を加算するカウンタとすることができる。
インクリメンタルエンコーダの原点のアブソリュートエンコーダの原点に対する位置が一定で変化しないのであれば、電源投入毎に必ずインクリメンタルエンコーダの原点位置を探索することは不可欠ではなく、アブソリュートエンコーダの原点位置に基づいて演算によりインクリメンタルエンコーダの原点位置を取得することができる。それに対し、例えば運動伝達装置の熱膨張によりインクリメンタルエンコーダの原点とアブソリュートエンコーダの原点との相対位置が変化する場合には、電源投入毎に原点探索が行われ、常にインクリメンタルエンコーダの正確な原点位置が得られるようにすることが必要である。また、アブソリュートエンコーダとインクリメンタルエンコーダとの分解能が異なるために、演算結果に1パルスの誤差が生じる可能性がある場合にも、電源投入毎に原点探索が行われるようにすることが望ましい。
なお、インクリメンタルエンコーダの原点位置の探索は、電源投入時に限らず、それ以外の時、例えば、予め設定された条件の成立時にも行われるようにすることができる。予め設定された条件は、例えば、電源投入から設定時間が経過したこと、その作動装置を含む作業機械の作業量が設定量に達したこと等である。作動装置が回路基板への電子部品の装着を行うための装置であれば、設定枚数の回路基板への電子部品の装着が行われたことが後者の一例である。
(5)前記駆動源が、回転部材を備え、その回転部材の回転に基づいて駆動を行う回転駆動源であり、前記アブソリュートエンコーダが前記回転部材の回転位置を検出するロータリエンコーダを含む(1)項ないし(4)のいずれかに記載の作動装置。
アブソリュート型のロータリエンコーダはリニアスケールエンコーダに比較して安価であり、回転駆動源のアブソリュートエンコーダに適している。また、アブソリュート型のロータリエンコーダを備えた回転駆動源が多く市販されており、それら市販の回転駆動源を利用すれば、本項の作動装置を安価に構成することができる。
(6)前記作動部材が一直線に沿って移動する直線移動部材を含む(1)項ないし(5)項のいずれかに記載の作動装置。
(7)前記運動伝達装置が、互いに螺合した雄ねじ部材と雌ねじ部材とを含み、それら両ねじ部材の一方が前記回転駆動源によって回転させられることにより、両ねじ部材が相対的に直線移動させられる送りねじ装置を含む(5)項または(6)項に記載の作動装置。
運動伝達装置が互いに螺合される2つのねじ部材を含む場合、例えば、熱膨張により、インクリメンタルエンコーダの原点位置とアブソリュートエンコーダの原点位置との関係が変わることがあるが、インクリメンタルエンコーダの原点位置が取得されるため、熱膨張の影響を受けることなく、作動部材の位置を制御することができる。
(8)前記インクリメンタルエンコーダが、前記一直線に平行に配設されたリニアスケールエンコーダを含む(6)項または(7)項に記載の作動装置。
インクリメンタル型のリニアスケールエンコーダはアブソリュート型に比較して安価であり、本発明によれば、高価なアブソリュート型のリニアスケールエンコーダを用いることなく、直線移動部材の位置を検出することができる。
(9)駆動源と、その駆動源により運動伝達装置を介して作動させられる作動部材と、前記駆動源の位置を検出するアブソリュートエンコーダと、前記作動部材の位置を検出するインクリメンタルエンコーダと、それらアブソリュートエンコーダおよびインクリメンタルエンコーダの出力に基づいて前記駆動源を制御することにより前記作動部材の位置を制御する制御装置とを含む作動装置の制御プログラムであって、
前記作動部材を、前記アブソリュートエンコーダの出力に基づいて、前記インクリメンタルエンコーダの原点位置近傍であって、かつ、その原点に対して予め定められた側であることが保証される探索開始位置まで作動させるように、前記駆動源を高速で作動させる高速作動ステップと、
その高速作動ステップの実行後に、前記高速より低い速度で前記駆動源を作動させる低速作動ステップと、
その低速作動ステップの実行中に前記インクリメンタルエンコーダの原点を探索し、原点位置を取得する原点探索ステップと
を含む作動装置の制御プログラム。
(2)項ないし(8)項の各々に記載の特徴は、本制御プログラムの発明にも適用可能である。
以下、請求可能発明の実施例を、図を参照しつつ詳しく説明する。なお、請求可能発明は、下記実施例の他、上記〔発明の態様〕の項に記載された態様を始めとして、当業者の知識に基づいて種々の変更を施した態様で実施することができる。
本実施例の電子部品装着システムは、図1に示すように、電子部品保持装置10,電子部品供給装置12,基板保持装置14,電子部品保持装置移動装置16,基板搬送装置18および制御装置20(図3参照)を含む。
基板搬送装置18は、システム本体の一部を成すベッド24上に設けられ、例えば、ベルトコンベヤを備え、回路基板26を水平な姿勢で一方向に搬送して基板保持装置14に搬入し、基板保持装置14から搬出する。基板搬送方向をX軸方向とし、基板保持装置14により保持された回路基板26に平行な面である水平面内においてX軸方向と直交する方向をY軸方向とする。基板保持装置14は位置を固定して設けられ、図示は省略するが、例えば、回路基板26を下方から支持する基板支持装置と、回路基板26をクランプするクランプ装置とを含み、基板搬送装置18により搬入された回路基板26を水平に保持する。電子部品供給装置12は、本実施例では、ベッド24上の、基板搬送装置18に対してY軸方向の一方の側に位置を固定して設けられている。
電子部品保持装置移動装置16は、本実施例では、X軸方向移動装置30およびY軸方向移動装置32を含み、電子部品保持装置10と、電子部品供給装置12および基板保持装置14とを部品保持具の軸線と直交する方向に相対移動させる相対移動装置を構成している。X軸方向移動装置30は、本実施例では、作動部材の一種である直線移動部材としてのX軸スライダ34とX軸スライダ移動装置36とを含む。X軸スライダ移動装置36は、本実施例では、回転駆動源の一種である2つのX軸スライダ移動用モータ38と、それらX軸スライダ移動用モータ38の各回転をそれぞれX軸スライダ34の直線運動に変換する運動伝達装置の一種である運動変換装置としての送りねじ装置40とを含む。送りねじ装置40は、ベッド24上にX軸方向に平行な姿勢で回転可能にかつ軸方向に移動不能に設けられた雄ねじ部材たる送りねじの1種であるボールねじ42と、X軸スライダ34に固定され、ボールねじ42と螺合された雌ねじ部材としてのナット44とを含み、ボールねじ42がX軸スライダ移動用モータ38によって回転させられることにより、X軸スライダ34が案内装置を構成する案内部材としての1対のガイドレール46(図2参照)により案内されてX軸方向に平行な一直線に沿って移動させられる。
2つのX軸スライダ移動用モータ38はそれぞれ、本実施例ではサーボモータにより構成されている。サーボモータは回転角度の正確な制御が可能な回転電動モータであり、図示は省略するが、回転部材としてのロータを備え、ロータと一体的に回転する出力軸からボールねじ42に回転が伝達される。2つのX軸スライダ移動用モータ38のうちの一方、例えば、図1においては上側に図示されていて、電子部品供給装置12側とは反対側に設けられたX軸スライダ移動用モータ38は、ロータの回転位置を検出するエンコーダ48を備えている。このエンコーダ48は、本実施例では、アブソリュート型のロータエンコーダとされている。以後、アブソリュートエンコーダ48と称する。
また、X軸スライダ34の位置は、エンコーダ50(図3参照)により検出される。このエンコーダ50は、本実施例では、インクリメンタル型のリニアスケールエンコーダとされており、インクリメンタルエンコーダ50と称する。インクリメンタルエンコーダ50は、図示は省略するが、メインスケールおよびインデックススケールを含む。メインスケールは、ベッド24の、前記アブソリュートエンコーダ48が設けられたX軸スライダ移動用モータ38およびそれにより回転させられるボールねじ42の近傍部分に、X軸スライダ34の移動領域全体にわたってX軸方向に平行に固定して設けられ、2つのスリット列がそれぞれ、X軸方向に平行にかつ上下に並んで設けられるとともに、それらスリット列の下に原点位置検出用スリットが設けられている。2つのスリット列はそれぞれ、X軸方向に等ピッチで並んで形成された多数のスリットを備えるとともに、X軸方向において、スリットの幅の1/2分(隣接する2個のスリット間のピッチを360度とすれば90度分)、位相をずらして設けられている。また、原点位置検出用スリットは、メインスケールの、X軸スライダ34の移動領域の一方の端に対応する位置に1個、設けられている。
インデックススケールはX軸スライダ34に設けられ、スリット,発光素子および受光素子が、メインスケールの3段のスリットの各々について設けられており、X軸スライダ34と共に移動する。発光素子および受光素子は、インデックススケールのスリットおよびメインスケールを挟む状態で設けられ、インデックススケールは、受光素子の受光量の変化に基づいてパルス信号を生成するとともに、パルス信号数をカウントして出力する。また、インデックススケールにより、2列のスリット列の位相ずれに基づいてX軸スライダ34の移動方向が検出され、原点位置検出スリットを光が通過することにより原点位置検出信号が出力され、インクリメンタルエンコーダ50の原点位置が検出される。なお、3段のスリットは、上下方向に限らず、例えば、水平方向に並ぶ状態で設けてもよい。
Y軸方向移動装置32は、図1に示すように、作動部材の一種である直線移動部材としてのY軸スライダ60およびY軸スライダ移動装置62を含み、X軸スライダ34上に設けられている。Y軸スライダ移動装置62は、X軸スライダ移動装置36と同様に、回転駆動源の一種であるY軸スライダ移動用モータ64と送りねじ装置66とを含む。送りねじ装置66は、図2に示すように、X軸スライダ34にY軸方向に平行な姿勢で回転可能にかつ軸方向に移動不能に設けられた雄ねじ部材としてのボールねじ68と、Y軸スライダ60に固定され、ボールねじ68と螺合された雌ねじ部材としてのナット70とを含み、ボールねじ68がY軸スライダ移動用モータ64によって回転させられることにより、Y軸スライダ60が1対のガイドレール72に案内されてY軸方向に平行な一直線に沿って移動させられる。
Y軸スライダ移動用モータ64は、X軸スライダ移動用モータ38と同様にサーボモータにより構成され、そのロータの回転位置がアブソリュート型のロータリエンコーダ74により検出される。また、Y軸スライダ60の位置は、前記X軸用のインクリメンタルエンコーダ50と同様のインクリメンタル型のリニアスケールエンコーダ76(図3参照)により検出される。このY軸用のインクリメンタルエンコーダ76は、X軸スライダ34に、Y軸スライダ60の移動領域全体にわたってY軸方向に平行に設けられたメインスケールと、Y軸スライダ60に設けられたインデックススケールとを含み、Y軸スライダ60の位置,移動方向およびインクリメンタルエンコーダ76の原点位置が検出される。
前記電子部品保持装置10はY軸スライダ60上に設けられ、電子部品保持装置移動装置16により水平面内の任意の位置へ移動させられる。電子部品保持装置10は、本実施例では、図2に示すように、保持装置本体80,部品保持ヘッド82,部品保持ヘッド昇降装置84および部品保持ヘッド回転装置85(図3参照)を備えている。部品保持ヘッド82は、保持装置本体80により前記X軸方向およびY軸方向と直交し、基板保持装置14に保持された回路基板26に直角な方向である鉛直なZ軸方向に移動可能にかつ自身の鉛直な軸線まわりに回転可能に支持され、部品保持具の一種である吸着ノズル86を保持し、部品保持ヘッド昇降装置84によりZ軸方向に移動させられ、部品保持ヘッド回転装置85により回転させられる。
部品保持ヘッド昇降装置84は、本実施例では、Z軸スライダ90およびZ軸スライダ移動装置92を含む。Z軸スライダ移動装置92は、回転駆動源の一種であるZ軸スライダ移動用モータ94と送りねじ装置96とを備えている。送りねじ装置96は、保持装置本体80に鉛直軸線まわりに回転可能かつ軸方向移動不能に設けられた雌ねじ部材としてのナット98と、Z軸スライダ90と一体的に設けられ、ナット98と螺合された雄ねじ部材としてのボールねじ100とを含み、ナット98がZ軸スライダ移動用モータ94によって回転させられることによりZ軸スライダ90が昇降させられ、Z軸スライダ90に設けられた部品保持ヘッド82が昇降させられる。
Z軸スライダ90が作動部材の一種である直線移動部材であり、Z軸スライダ移動用モータ94は、本実施例においてはサーボモータにより構成され、そのロータの回転位置が、アブソリュート型のロータリエンコーダ104に検出される。また、Z軸スライダ90のZ軸方向の位置が、インクリメンタル型のリニアスケールエンコーダ106(図3参照)により検出される。このZ軸用のインクリメンタルエンコーダ106は、保持装置本体80にZ軸方向に平行に固定されたメインスケールと、Z軸スライダ90に設けられたインデックススケールとを含み、Z軸スライダ90の位置,昇降方向およびインクリメンタルエンコーダ106の原点位置が検出される。
なお、X軸スライダ34には、吸着ノズル86に保持された電子部品を撮像する部品撮像システム110(図1参照)が設けられ、Y軸スライダ60には、回路基板26に設けられた基準マークを撮像するマーク撮像システム112(図2参照)が設けられている。電子部品は、回路基板26に装着されて電子回路を構成する部品である。
前記制御装置20は、図3に示すように、制御コンピュータ120および入出力部122を含む制御部と、複数の駆動回路123,124とを含む。これら複数の駆動回路123,124のうち、X軸スライダ移動用モータ38,Y軸スライダ移動用モータ64およびZ軸スライダ移動用モータ94の各駆動回路124はそれぞれ、市販のサーボ制御装置134(図4参照)を主体として構成されている。制御コンピュータ120は、CPU126,ROM128,RAM130およびそれらを接続するバスを含み、入出力部122には、インクリメンタルエンコーダ50,76,106,画像処理コンピュータ132,X軸スライダ移動用モータ38等が接続されている。なお、アブソリュートエンコーダ48,74,104は、後述する図7および図8に示す実施例において入出力部122に接続されるため、ここでは二点鎖線で示す。サーボ制御装置134は、図4にX軸スライダ移動用モータ38の制御を代表して示すように、通常時には、制御コンピュータ120から、X軸スライダ34の移動目標位置に対応するインクリメンタルエンコーダ50の出力値である作動目標出力値としての移動目標出力値が供給されるとともに、制御コンピュータ120により、X軸スライダ移動用モータ38をアブソリュートエンコーダ48の出力値に基づいて制御する状態と、インクリメンタルエンコーダ50の出力値に基づいて制御する状態とに切り換えられる。また、サーボ制御装置134から制御コンピュータ120に、制御コンピュータ120から供給された移動目標出力値に対応する位置に到達したことを表す情報(信号)が供給される。さらに、ROM128には、図示を省略するメインルーチン,電子部品装着ルーチン,図5にフローチャートで示すスライダ移動制御ルーチン等、種々のプログラムおよびデータ等が記憶されている。
本電子部品装着システムにおいては、電子部品保持装置10が電子部品保持装置移動装置16により移動させられるとともに、部品保持ヘッド昇降装置84により昇降させられ、電子部品供給装置12から電子部品を受け取り、回路基板26に装着するのであるが、電源投入時にX軸,Y軸,Z軸用のインクリメンタルエンコーダ50,76,106についてそれぞれ原点位置が取得され、その原点位置に基づいてスライダ34,60,90が移動目標位置へ移動させられる。これらエンコーダ50,76,106の各原点位置の取得およびスライダ34,60,90の各移動目標位置への移動の制御はそれぞれ、X軸,Y軸,Z軸について同様に行われるため、X軸用のインクリメンタルエンコーダ50の原点位置の取得およびX軸スライダ34の移動目標位置への移動制御を代表的に説明する。
原点位置は、図5に示すスライダ移動制御ルーチンの実行により取得される。本電子部品装着システムの電源が投入されれば、スライダ移動制御ルーチンのステップ1(以後、S1と略記する。他のステップについても同じ。)が実行され、インクリメンタルエンコーダ50の原点位置が既に取得されたか否かが判定される。この判定は、RAM130に設けられた原点位置取得フラグが1にセットされているか否かにより行われる。原点位置取得フラグは、例えば、電源投入時にメインルーチンの初期設定において0にリセットされる。電源投入時には原点位置が取得されておらず、原点位置取得フラグは0にリセットされており、S1の判定結果はNOになってS2が実行される。
S2においては、インクリメンタルエンコーダ50の原点位置の探索を開始する探索開始位置が設定される。探索開始位置は、アブソリュートエンコーダ48の原点位置とインクリメンタルエンコーダ50の原点位置との相互ずれ量(相互ずれ距離)と、探索開始位置とインクリメンタルエンコーダ50の原点との間のX軸スライダ34の移動距離である共通設定移動距離とに基づいて設定される。X軸スライダ移動装置36の組立は、アブソリュートエンコーダ48の原点とインクリメンタルエンコーダ50の原点とにある程度のずれを許容して行われ、組立終了時にずれ量が検出され、許容範囲内にあることが確認される。本実施例では、インクリメンタルエンコーダ50の原点がアブソリュートエンコーダ48の原点に対して、図6(a)に示すように、X軸スライダ34がアブソリュートエンコーダ48の原点に対応する位置から、インクリメンタルエンコーダ50の原点に対応する位置へ移動させられるとき、アブソリュートエンコーダ48の検出値が増大する側にずれるように組立が行われ、検出された相互ずれ量は、制御コンピュータ120の記憶部たる不揮発性メモリ、例えば、ROM128に記憶される。アブソリュートエンコーダ48の原点における出力値は0であり、相互ずれ量は、アブソリュートエンコーダ48の出力値により記憶される。なお、説明は省略するが、Y軸,Z軸の各スライダ移動装置62,92も同様に組立が行われ、インクリメンタルエンコーダ76,106についてもそれぞれ、それらの各原点位置とアブソリュートエンコーダ74,104の各原点位置との相互ずれ量が検出され、記憶される。
上記相互ずれ量が、個々の電子部品装着システムに固有の値であるのに対し、共通設定移動距離は、同型式の電子部品装着システムに共通の大きさに設定される。ただし、X軸,Y軸,Z軸の各スライダ移動装置36,62,92間では互いに同じ大きさに設定されても、異なる大きさに設定されてもよく、本実施例においては、移動距離の大きさや温度変化の大きさの違いを考慮して互いに異なる大きさに設定されている。いずれにしても、共通設定移動距離は、送りねじ装置40等の熱膨張や経年変化等に起因する相互ずれ量の変化にもかかわらず、探索開始位置へ移動させられたX軸スライダ34が、図6(a)に示すように、アブソリュートエンコーダ48の原点に対応する位置から、インクリメンタルエンコーダ50の原点に対応する位置より離れた位置に位置する距離に設定され、上記相互ずれ量と同様に制御コンピュータ120の不揮発性メモリに予め記憶されている。共通設定移動距離は、アブソリュートエンコーダ48のパルス信号数で記憶される。S2においては、制御コンピュータ120に記憶されている相互ずれ量および共通設定移動距離が読み出され、アブソリュートエンコーダ48の原点での出力値である0に、相互ずれ量および共通設定移動距離を加えた値が算出され、探索開始位置に対応するアブソリュートエンコーダ48の出力値である初期目標出力値が設定される。
次いでS3が実行され、X軸スライダ34が探索開始位置へ移動させられる。電源投入時におけるX軸スライダ34の位置は一定ではないが、インクリメンタルエンコーダ50の原点位置はX軸スライダ34の移動領域の一端に設けられ、探索開始位置も原点位置近傍に設けられているため、電源投入時にX軸スライダ34は、探索開始位置に対して、アブソリュートエンコーダ48の原点とは反対側へ大きく離れた位置にあるのが普通である。したがって、通常は、S3が実行されれば、X軸スライダ移動用モータ38が起動されてX軸スライダ34が高速で探索開始位置へ移動させられ、停止させられる。X軸スライダ34は、滑らかに加速後、一定速度で移動させられた後、滑らかに減速させられる。この速度制御および位置制御は、駆動回路124の主体をなす市販のサーボ制御装置134により行われ、サーボ制御装置134は2つのX軸スライダ移動用モータ38を同じ制御指令により同時に共通して制御する。探索開始位置への到達後およびインクリメンタルエンコーダ50の原点位置の取得後の通常時におけるX軸スライダ34の移動時も同様である。そのため、S3では、X軸スライダ34の探索開始位置への高速移動指令とともに、S2において算出された初期目標出力値が上記サーボ制御装置134へ出力される。また、サーボ制御装置134は、制御コンピュータ120により、アブソリュートエンコーダ48からの出力に基づいてX軸スライダ移動用モータ38を制御する状態に切り換えられる。サーボ制御装置134は、これら制御コンピュータ120からの出力値およびアブソリュートエンコーダ48の出力値に基づいてX軸スライダ移動用モータ38を制御し、図6(b)に示すように、アブソリュートエンコーダ48の実際の出力値が初期目標出力値と等しくなるまで、X軸スライダ34を高速で移動させる。なお、移動開始時におけるX軸スライダ34の位置が探索開始位置に近い場合には、例えば、加速および減速のみが行われる等、適宜のパターンで速度制御が行われる。
X軸スライダ34が探索開始位置へ到達し、停止させられれば、その到達,停止を表す信号がサーボ制御装置134から制御コンピュータ120へ供給され、それによりS4が実行され、X軸スライダ34が探索開始位置への移動時と同じ方向へ、その移動時より低速で移動させられる。
ただし、稀に、電源投入時にX軸スライダ34が探索開始位置よりもアブソリュートエンコーダ48の原点に対応する位置側に位置することがあり、その場合には、インクリメンタルエンコーダ50の原点探索時のX軸スライダ34の移動方向が、電源投入時の位置から探索開始位置までの移動方向とは逆になる。
ただし、稀に、電源投入時にX軸スライダ34が探索開始位置よりもアブソリュートエンコーダ48の原点に対応する位置側に位置することがあり、その場合には、インクリメンタルエンコーダ50の原点探索時のX軸スライダ34の移動方向が、電源投入時の位置から探索開始位置までの移動方向とは逆になる。
S4では、原点探索時におけるX軸スライダ34の移動方向および移動速度が制御コンピュータ120からサーボ制御装置134に指令され、それに従ってX軸スライダ移動用モータ38が制御される。探索開始位置は、アブソリュートエンコーダ48の原点に対応する位置から、インクリメンタルエンコーダ50の原点に対応する位置より離れた位置に設定され、インクリメンタルエンコーダ50の原点に対して、予め定められた側であることが保証される位置に設定されているため、X軸スライダ34の探索開始位置からの移動方向が予め定められており、それに従って移動方向が指令される。上記原点探索時におけるX軸スライダ34の移動速度は、インクリメンタルエンコーダ50の原点位置を見落とすことなく、確実に検出することができる速さに設定される。インクリメンタルエンコーダ50は、スライダ34が原点位置に至れば、原点位置検出信号が出力されるように構成されており、原点位置検出信号が出力される状態が確実に捉えられる速度にX軸スライダ34の移動速度が設定される。そして、S5において原点位置検出信号が出力されているか否かにより、インクリメンタルエンコーダ50の原点位置が検出されたか否かが判定される。原点位置検出信号が出力されていなければ、S5の判定結果はNOになってS4が実行され、X軸スライダ34が低速で移動させられ続ける。インクリメンタルエンコーダ50の原点位置が検出されるまで、S4およびS5が繰り返し実行され、図6(c)に示すようにX軸スライダ34が原点位置へ到達し、原点位置検出信号が出力されれば、S5の判定結果がYESになってS6が実行され、インクリメンタルエンコーダ50の出力値がRAM130に記憶される。次いでS7が実行され、X軸スライダ34が停止させられた後、S8が実行され、インクリメンタルエンコーダ50の原点位置における出力値が0にセットされる。具体的には、インクリメンタルエンコーダ50の出力値が読み込まれ、その出力値から、S6において記憶された原点位置検出時の出力値を引いた値に、インクリメンタルエンコーダ50の出力値がセットされ、検出された原点位置を0としてX軸スライダ34の位置を表すパルス信号数が出力されるようにされるのである。また、原点位置取得フラグがセットされるとともに、サーボ制御装置134が、制御コンピュータ120により、インクリメンタルエンコーダ50の出力値に基づいてX軸スライダ移動用モータ38を制御する状態に切り換えられる。
電源投入後、電子部品の回路基板26への装着が行われる通常時には、上記のように取得されたインクリメンタルエンコーダ50の原点位置,X軸スライダ34の作動目標位置としての移動目標位置および現在位置に基づいてX軸スライダ移動用モータ38がフィードバック制御され、X軸スライダ34が移動目標位置へ移動させられる。この際には、既にインクリメンタルエンコーダ50の原点位置における出力値が0にセットされており、インクリメンタルエンコーダ50の出力値はX軸スライダ34の、インクリメンタルエンコーダ50の原点位置に対する位置(現在位置)を表す。
まず、S9においてX軸スライダ34の移動が指令されているか否かが判定され、移動が指令されているのであれば、S9の判定結果はYESになってS10が実行され、X軸スライダ34の移動目標位置が、電子部品装着プログラムから読み出される。X軸スライダ34の移動目標位置は、原点位置を0とするインクリメンタルエンコーダ50の出力値により設定されている。次いでS11が実行され、X軸スライダ34が移動目標位置へ高速で移動させられる。このX軸スライダ34の移動目標位置への移動も、探索開始位置への移動と同様に市販のサーボ制御装置134により制御される。ただし、この際には、サーボ制御装置134に現在位置が既に記憶されているため、S11では、X軸スライダ34の移動指令が、S10において取得された移動目標位置と共にサーボ制御装置134へ出力される。サーボ制御装置134においては、インクリメンタルエンコーダ50により検出され、時々刻々供給されるX軸スライダ34の現在位置と、上記移動目標位置とに基づいて速度制御および位置制御が行われ、X軸スライダ34が移動目標位置へ移動させられる。X軸スライダ34が移動目標位置へ到達すれば、スライダ移動制御ルーチンの実行が終了する。次にS1が実行されるとき、その判定結果はYESになってS9ないしS11が実行される。
まず、S9においてX軸スライダ34の移動が指令されているか否かが判定され、移動が指令されているのであれば、S9の判定結果はYESになってS10が実行され、X軸スライダ34の移動目標位置が、電子部品装着プログラムから読み出される。X軸スライダ34の移動目標位置は、原点位置を0とするインクリメンタルエンコーダ50の出力値により設定されている。次いでS11が実行され、X軸スライダ34が移動目標位置へ高速で移動させられる。このX軸スライダ34の移動目標位置への移動も、探索開始位置への移動と同様に市販のサーボ制御装置134により制御される。ただし、この際には、サーボ制御装置134に現在位置が既に記憶されているため、S11では、X軸スライダ34の移動指令が、S10において取得された移動目標位置と共にサーボ制御装置134へ出力される。サーボ制御装置134においては、インクリメンタルエンコーダ50により検出され、時々刻々供給されるX軸スライダ34の現在位置と、上記移動目標位置とに基づいて速度制御および位置制御が行われ、X軸スライダ34が移動目標位置へ移動させられる。X軸スライダ34が移動目標位置へ到達すれば、スライダ移動制御ルーチンの実行が終了する。次にS1が実行されるとき、その判定結果はYESになってS9ないしS11が実行される。
以上の説明から明らかなように、本実施例においては、制御コンピュータ120のS2を実行する部分が初期目標出力値設定部を構成し、S3を実行する部分がサーボ制御装置134と共同して高速移動制御部を構成し、それらが高速移動部を構成している。また、制御コンピュータ120のS4を実行する部分が低速移動部を構成し、S5を実行する部分が原点探索部を構成し、S10を実行する部分が移動目標位置取得部を構成し、原点位置における出力値が0にセットされた後のインクリメンタルエンコーダ50自体、あるいはそのインクリメンタルエンコーダ50とそれの出力値を時々刻々サーボ制御装置134に供給する部分とが共同して現在位置取得部を構成し、S11を実行する部分がサーボ制御装置134と共同して位置制御部を構成し、制御装置20がX軸,Y軸,Z軸の各スライダ移動装置36,62,92の各々と共に、請求可能発明の実施例である作動装置を構成している。
X軸スライダ34を探索開始位置へ移動させる際、インクリメンタルエンコーダ50の出力に基づいて移動を制御してもよい。この移動も、本実施例では、駆動回路124の主体を成す市販のサーボ制御装置140により制御され、図7にX軸スライダ移動用モータ38の制御を代表して示すように、サーボ制御装置140には、インクリメンタルエンコーダ50の出力値は供給されるが、アブソリュートエンコーダ48の出力値は供給されず、制御コンピュータ120から、X軸スライダ34の移動目標位置がインクリメンタルエンコーダ50の出力値で供給される。本実施例では、電子部品装着システムの構成要素のうち、前記実施例の電子部品装着システムの構成要素と同様の作用を成す要素については同じ符号を付して説明に使用する。本電子部品装着システムにおいては、制御コンピュータ120の入出力部122にアブソリュートエンコーダ48,74,104が接続されている。また、制御装置20の構成を概念的に示すブロック図においてモータ38,64,94と駆動回路124との関係は、駆動回路124によるモータ38,64,94の制御を表す一方向の矢印により表される。
この場合、制御コンピュータ120のROM128には、図8に示すスライダ移動制御ルーチンが記憶され、実行される。このルーチンのS21は、前記スライダ移動制御ルーチンのS1と同様に実行される。S21の実行後、S22が実行され、アブソリュートエンコーダ48の現在の出力値が読み込まれ、電源投入時におけるX軸スライダ34の位置が取得される。次いでS23が実行され、S22において読み込まれたアブソリュートエンコーダ48の電源投入時の出力値が、エンコーダ48,50の分解能と、送りねじ装置40の運動伝達比(減速比)とに基づいて、インクリメンタルエンコーダ50の出力値(現在位置)に換算され、インクリメンタルエンコーダ50の実際の出力値が、その換算された出力値にセットされる。次いでS24が実行され、インクリメンタルエンコーダ50の原点位置の探索開始位置が、アブソリュートエンコーダ48の原点とインクリメンタルエンコーダ50の原点との間の相互ずれ量と、前記実施例におけると同様な共通設定移動距離とに基づいて設定される。ただし、本実施例においては、相互ずれ量も共通設定移動距離もインクリメンタルエンコーダ50の分解能に応じた値で設定されており、したがって、探索開始位置に相当するインクリメンタルエンコーダ50の出力値である初期目標出力値もインクリメンタルエンコーダ50の分解能に応じた値で設定される。
そして、S25では、S24において算出された初期目標出力値と高速移動指令とがサーボ制御装置140に出力され、X軸スライダ移動用モータ38が高速で作動させられ、X軸スライダ34が探索開始位置へ移動させられる。サーボ制御装置140は、インクリメンタルエンコーダ50の出力値に基づいてX軸スライダ移動用モータ38を制御し、インクリメンタルエンコーダ50から供給される現在位置を示す出力値が、制御コンピュータ120から供給された探索開始位置に相当する値となるまで、X軸スライダ34を移動させる。X軸スライダ34の探索開始位置への移動後、移動完了を表す信号がサーボ制御装置140から制御コンピュータ120へ供給され、S26〜S29が前記S4〜S7と同様に実行される。そして、インクリメンタルエンコーダ50の原点が検出されたならば、S30が実行され、制御コンピュータ120はインクリメンタルエンコーダ50の出力値を0に再設定し、以後、インクリメンタルエンコーダ50は、自身の原点を0とする値を出力する状態となる。インクリメンタルエンコーダ50の出力値の0設定は、前記S8と同様に行われる。そのため、X軸スライダ50の移動が指令され、サーボ制御装置140に移動指令および移動目標位置が供給されれば、サーボ制御装置140は、インクリメンタルエンコーダ50から供給される現在位置が、制御コンピュータ120から供給された移動目標位置に一致するようにX軸スライダ移動用モータ38を高速で作動させる(S31〜S33)。
本実施例においては、制御コンピュータ120のS23を実行する部分が換算部を構成し、S24を実行する部分が初期目標出力値設定部を構成し、S25を実行する部分がサーボ制御装置140と共同して高速移動制御部を構成し、これらが高速移動部を構成している。
本実施例においては、制御コンピュータ120のS23を実行する部分が換算部を構成し、S24を実行する部分が初期目標出力値設定部を構成し、S25を実行する部分がサーボ制御装置140と共同して高速移動制御部を構成し、これらが高速移動部を構成している。
なお、作動部材の作動は、市販のサーボ制御装置に限らず、本発明に係る作動装置の作動部材用に専用に作られたサーボ制御装置により制御されてもよく、あるいはサーボ制御装置と制御コンピュータとが一体的に構成され、作動部材の作動が制御コンピュータにより制御されるようにしてもよい。後者の場合、例えば、制御コンピュータによって実行される原点探索プログラムおよび直線移動部材移動プログラムに基づいて直線移動部材の移動が制御される。この原点探索プログラムは、直線移動部材を探索開始位置まで移動させるために、その電源投入時における位置から探索開始位置までの移動距離に応じて速度制御パターンを設定し、アブソリュートエンコーダの出力あるいはインクリメンタルエンコーダの出力に基づいて移動を制御するものとされることが望ましい。インクリメンタルエンコーダの原点位置の取得後、直線移動部材移動プログラムに従って直線移動部材を移動目標位置へ移動させる場合も同様である。
さらに、作動部材を探索開始位置において停止させることなく、原点位置探索のために設定された速度まで低下させ、続けて移動させて原点位置を探索させてもよい。
また、X軸スライダ移動装置36は、X軸スライダ移動用モータ38を1つ含むものとしてもよい。
さらに、ロータリエンコーダおよびリニアスケールエンコーダは、光学式の他、例えば、マグネスケール,インダクトシン等、磁気的,電磁的に作動部材の位置を検出するものとしてもよい。
また、インクリメンタルエンコーダのインデックススケールは、パルス信号を生成し、移動部材が単位量移動する毎に+1あるいは−1を出力するものとし、パルス信号数のカウントは、例えば、コンピュータのカウンタやサーボ制御装置に設けられたカウンタにより行われるようにしてもよい。
さらに、作動装置毎に探索開始位置が予め算出されて記憶され、インクリメンタルエンコーダの原点位置の探索時に読み出されて使用されるようにしてもよい。
また、インクリメンタルエンコーダのインデックススケールは、パルス信号を生成し、移動部材が単位量移動する毎に+1あるいは−1を出力するものとし、パルス信号数のカウントは、例えば、コンピュータのカウンタやサーボ制御装置に設けられたカウンタにより行われるようにしてもよい。
さらに、作動装置毎に探索開始位置が予め算出されて記憶され、インクリメンタルエンコーダの原点位置の探索時に読み出されて使用されるようにしてもよい。
また、請求可能発明は、電子回路部品装着システムたる電子部品装着システムの移動装置に限らず、スクリーン印刷機,接着剤塗布機,装着検査機等、電子回路生産ラインを構成する各種の対回路基板作業機は勿論、工作機械,被加工物加工装置等において、直線移動部材,回転部材等の作動部材を備えて作動する作動装置に適用することができる。
20:制御装置 34:X軸スライダ 36:X軸スライダ移動装置 38:X軸スライダ移動用モータ 40:送りねじ装置 48:アブソリュートエンコーダ 50:インクリメンタルエンコーダ 60:Y軸スライダ 62:Y軸スライダ移動装置 64:Y軸スライダ移動用モータ 66:送りねじ装置 74:アブソリュートエンコーダ 76:インクリメンタルエンコーダ 90:Z軸スライダ 92:Z軸スライダ移動装置 94:Z軸スライダ移動用モータ 96:送りねじ装置 104:アブソリュートエンコーダ 106:インクリメンタルエンコーダ
Claims (5)
- 駆動源と、その駆動源により運動伝達装置を介して作動させられる作動部材と、前記駆動源の位置を検出するアブソリュートエンコーダと、前記作動部材の位置を検出するインクリメンタルエンコーダと、それらアブソリュートエンコーダおよびインクリメンタルエンコーダの出力に基づいて前記駆動源を制御することにより前記作動部材の位置を制御する制御装置とを含む作動装置であって、
前記制御装置が、
前記作動部材を、前記アブソリュートエンコーダの出力に基づいて、前記インクリメンタルエンコーダの原点位置近傍であって、かつ、その原点に対して予め定められた側であることが保証される探索開始位置まで作動させるように、前記駆動源を高速で作動させる高速作動部と、
その高速作動部による作動後に、前記高速より低い速度で前記駆動源を作動させる低速作動部と、
その低速作動部による作動中に前記インクリメンタルエンコーダの原点を探索し、原点位置を取得する原点探索部と
を含むことを特徴とする作動装置。 - 前記高速作動部が、
(a)当該作動装置について予め実際に検出されて前記制御装置に記憶されている、前記インクリメンタルエンコーダの原点位置と前記アブソリュートエンコーダの原点位置との相互ずれ量と、(b)当該作動装置と同種の作動装置に共通の値として予め設定されて前記制御装置に記憶されている前記探索開始位置と前記インクリメンタルエンコーダの原点との間の前記作動部材の作動量である共通設定作動量とに基づいて、前記探索開始位置に対応する前記アブソリュートエンコーダの出力値である初期目標出力値を設定する初期目標出力値設定部と、
前記アブソリュートエンコーダの実際の出力値が、前記初期目標出力値設定部により設定された前記初期目標出力値と等しくなるまで、前記作動部材を前記高速で作動させるように前記駆動源を制御する高速作動制御部と
を含むことを特徴とする請求項1に記載の作動装置。 - 前記高速作動部が、
前記アブソリュートエンコーダの現在の出力値を、少なくともそのアブソリュートエンコーダと前記インクリメンタルエンコーダとの分解能および前記運動伝達装置の伝達比を使用して、前記インクリメンタルエンコーダの出力値に換算する換算部と、
少なくとも、当該作動装置と同種の作動装置に共通の値として予め設定されて前記制御装置に記憶されている前記探索開始位置と前記インクリメンタルエンコーダの原点との間の前記作動部材の作動量である共通設定作動量に基づいて、前記探索開始位置に対応する前記インクリメンタルエンコーダの出力値である初期目標出力値を設定する初期目標出力値設定部と、
前記作動部材の移動に伴って、前記換算部により換算された出力値から変化する前記インクリメンタルエンコーダの実際の出力値が、前記初期目標出力値設定部により設定された初期目標出力値と等しくなるまで、前記作動部材を高速で作動させるように前記駆動源を制御する高速作動制御部と
を含み、かつ、前記換算部と前記初期目標出力設定部とのいずれか一方が、前記換算または前記初期目標出力値の設定に、当該作動装置について予め実際に検出されて前記制御装置に記憶されている、前記インクリメンタルエンコーダの原点位置と前記アブソリュートエンコーダの原点位置との相互ずれ量をも加味するものである請求項1に記載の作動装置。 - 前記作動部材の作動目標位置を取得する作動目標位置取得部と、
前記原点探索部により探索された原点位置と前記インクリメンタルエンコーダの出力とに基づいて、前記作動部材の現在位置を取得する現在位置取得部と、
その現在位置取得部により取得される現在位置が、前記作動目標位置取得部により取得された作動目標位置に等しくなるように前記駆動源を制御し、前記作動部材を前記作動目標位置へ移動させる位置制御部と
を含み、かつ、前記高速作動部,低速作動部および原点探索部が前記制御装置の少なくとも電源投入時に作動させられ、前記作動目標位置取得部,現在位置取得部および位置制御部が前記電源投入時より後の時期である通常時に作動させられることを特徴とする請求項1ないし3のいずれかに記載の作動装置。 - 前記作動部材が一直線に沿って移動する直線移動部材を含み、前記インクリメンタルエンコーダが、前記一直線に平行に配設されたリニアスケールエンコーダを含むことを特徴とする請求項1ないし4のいずれかに記載の作動装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005121057A JP2006300646A (ja) | 2005-04-19 | 2005-04-19 | 作動装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005121057A JP2006300646A (ja) | 2005-04-19 | 2005-04-19 | 作動装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2006300646A true JP2006300646A (ja) | 2006-11-02 |
Family
ID=37469118
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2005121057A Withdrawn JP2006300646A (ja) | 2005-04-19 | 2005-04-19 | 作動装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2006300646A (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015072265A (ja) * | 2013-09-03 | 2015-04-16 | キヤノン株式会社 | エンコーダ及びエンコーダの原点算出方法 |
-
2005
- 2005-04-19 JP JP2005121057A patent/JP2006300646A/ja not_active Withdrawn
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015072265A (ja) * | 2013-09-03 | 2015-04-16 | キヤノン株式会社 | エンコーダ及びエンコーダの原点算出方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4033705B2 (ja) | プリント配線板位置誤差取得方法,プログラムおよび電子回路部品装着システム | |
KR101291495B1 (ko) | 로봇 및 그 교시 방법 | |
JP7335878B2 (ja) | アライナ及びアライナの補正値算出方法 | |
JP2002217598A (ja) | 電子部品装着装置 | |
WO2007049345A1 (ja) | テーブルの位置決め制御装置 | |
JP6390282B2 (ja) | ナット締付装置 | |
JP2006300646A (ja) | 作動装置 | |
JP2009212251A (ja) | 部品移載装置 | |
JP4789721B2 (ja) | 部品保持具による電子回路部品の保持位置検出装置 | |
KR20190085979A (ko) | 부품 실장 장치 및 그 제어 방법 | |
EP1223485B1 (en) | Positioning-controlling apparatus and positioning-controlling method, and part-mounting equipment and part-mounting method | |
JP2008306046A (ja) | 部品供給装置、表面実装機 | |
WO2013161036A1 (ja) | パラレルリンク式部品実装装置 | |
KR100837372B1 (ko) | 가변 스테이지 시스템 | |
JP5072743B2 (ja) | マイクロマシンおよびマイクロフライスマシン | |
JP2010067704A (ja) | 作動制御方法および対回路基板作業装置 | |
JP6320925B2 (ja) | 部品実装機 | |
KR101439748B1 (ko) | 교시 시스템을 갖는 로봇 및 이의 교시 방법 | |
JP5854773B2 (ja) | 送りねじ駆動装置及びこれを用いる部品実装機 | |
JP5348766B2 (ja) | X−y直交2軸駆動機構 | |
JP7316581B2 (ja) | 部品供給装置および部品供給装置の制御方法 | |
JP2012018008A (ja) | 産業機械および産業機械の制御方法 | |
JP2018020415A (ja) | 工作機械用駆動装置 | |
JP5814756B2 (ja) | ツインドライブ装置のスライダの歪み補正方法およびツインドライブ装置 | |
JP2002261496A (ja) | 位置決め制御装置及び位置決め制御方法、並びに部品実装装置及び部品実装方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A300 | Withdrawal of application because of no request for examination |
Free format text: JAPANESE INTERMEDIATE CODE: A300 Effective date: 20080701 |