JP2009094160A - Component mounting apparatus, control method, and program - Google Patents
Component mounting apparatus, control method, and program Download PDFInfo
- Publication number
- JP2009094160A JP2009094160A JP2007261221A JP2007261221A JP2009094160A JP 2009094160 A JP2009094160 A JP 2009094160A JP 2007261221 A JP2007261221 A JP 2007261221A JP 2007261221 A JP2007261221 A JP 2007261221A JP 2009094160 A JP2009094160 A JP 2009094160A
- Authority
- JP
- Japan
- Prior art keywords
- coordinate value
- limit
- unit
- movable unit
- support stage
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Supply And Installment Of Electrical Components (AREA)
Abstract
【課題】部品実装装置における多様な条件下でのソフトリミット制御を、多数のリミット値をあらかじめ用意することなく好適に実行できる制御方法を提供する。
【解決手段】部品実装装置に備えられる可動ユニットと他のユニットとの干渉を防止する制御方法であって、前記可動ユニットの現在位置を表す現在座標値を取得する位置取得ステップと(S11)、前記可動ユニットを移動させようとするときに、前記他のユニットと干渉しない限界点を表すリミット座標値を、前記現在座標値に応じて算出するリミット算出ステップ(S12)と、前記現在座標値が前記リミット座標値に達していれば前記可動ユニットの移動を規制する移動規制ステップ(S13、S14)とを含む。
【選択図】図7Provided is a control method capable of suitably executing soft limit control under various conditions in a component mounting apparatus without preparing a large number of limit values in advance.
A position acquisition step for acquiring a current coordinate value representing a current position of the movable unit, which is a control method for preventing interference between a movable unit provided in a component mounting apparatus and another unit (S11), A limit calculation step (S12) for calculating a limit coordinate value representing a limit point that does not interfere with the other unit when the movable unit is moved, according to the current coordinate value; and the current coordinate value is A movement restriction step (S13, S14) for restricting movement of the movable unit if the limit coordinate value is reached.
[Selection] Figure 7
Description
本発明は、部品実装装置の制御方法に関し、特に前記部品実装装置に備えられる可動ユニットと他のユニットとの干渉を防止する技術に関する。 The present invention relates to a method for controlling a component mounting apparatus, and more particularly to a technique for preventing interference between a movable unit provided in the component mounting apparatus and another unit.
従来、部品実装装置をはじめとする各種の製造機械では、製造装置が備える可動ユニットの移動範囲を所定の範囲内に規制することにより、可動ユニットが他のユニットや作業者と不都合な干渉を起こす事故を防止している(例えば、特許文献1および特許文献2を参照)。 2. Description of the Related Art Conventionally, in various manufacturing machines including component mounting apparatuses, the movable unit causes inconvenient interference with other units and workers by restricting the movable range of the movable unit included in the manufacturing apparatus within a predetermined range. Accidents are prevented (see, for example, Patent Document 1 and Patent Document 2).
特許文献1には、テープフィーダおよびトレイフィーダから供給される電子部品を移載ヘッドによりピックアップして基板に実装する電子部品実装装置において、機械的なストッパおよびリミットセンサを用いて移載ヘッドの移動範囲を規制する場合に、ストッパの位置を部品の供給形態に応じて移動させ、また、複数のリミットセンサの1つを部品の供給形態に応じて選択的に使用することにより、移載ヘッドの移動範囲を容易かつ迅速に変更可能とする技術が開示されている。 In Patent Document 1, in an electronic component mounting apparatus that picks up an electronic component supplied from a tape feeder and a tray feeder by a transfer head and mounts the electronic component on a substrate, the movement of the transfer head using a mechanical stopper and a limit sensor is disclosed. When the range is regulated, the position of the stopper is moved according to the part supply form, and one of a plurality of limit sensors is selectively used according to the part supply form. A technique is disclosed in which the moving range can be changed easily and quickly.
特許文献2には、XY平面内で平行移動および回転移動自在なステージにて基板を搬送する基板搬送装置において、コントローラにて、ステージの目標位置の座標値とリミット値とを比較し、目標位置の座標値がリミット値を超えると判断される場合に、ステージ駆動機構の制御を中止する技術が開示されている。
In
この基板搬送装置には、コントローラに加えて、ステージの大きさおよびXY平面内での向きに応じた複数のリミット値を記憶している記憶装置と、実際のステージの大きさおよび向きを検出するセンサとが設けられる。コントローラは、センサによる検出結果に応じたリミット値を記憶装置からレジスタに読み出し、レジスタに設定されたリミット値とステージの目標位置の座標値とを比較する。これにより、ステージの大きさおよび向きによらず、干渉を確実に防止することができる。 In addition to the controller, the substrate transport apparatus detects a storage device that stores a plurality of limit values corresponding to the stage size and the orientation in the XY plane, and the actual stage size and orientation. And a sensor. The controller reads the limit value corresponding to the detection result by the sensor from the storage device to the register, and compares the limit value set in the register with the coordinate value of the target position of the stage. Thereby, interference can be reliably prevented regardless of the size and direction of the stage.
なお、特許文献1に示されるような、機械的なストッパやリミットセンサを用いて行う干渉防止制御をハードリミット制御と呼び、特許文献2に示されるような、コントローラのソフトウェア機能として実現される干渉防止制御をソフトリミット制御と呼ぶ。
ところで、実際の部品実装装置においてソフトリミット制御を行う場合、従来の技術で考慮されている可動ユニットとしてのステージの大きさや向き以外にも、リミット値に影響を与える多数の条件が存在する。 By the way, when performing soft limit control in an actual component mounting apparatus, there are a number of conditions that affect the limit value in addition to the size and orientation of the stage as a movable unit considered in the prior art.
例えば、可動ユニットの断面形状または可動ユニットと干渉する可能性がある他のユニットの断面形状が高さ方向に異なる場合、用いるべきリミット値は高さに応じて異なる。また、ワークの受け渡しなどのために、可動ユニットが他のユニットの特定部分に進入することが許される場合、用いるべきリミット値を特定部分と他の部分とで区別する必要がある。 For example, when the cross-sectional shape of the movable unit or the cross-sectional shape of another unit that may interfere with the movable unit is different in the height direction, the limit value to be used differs depending on the height. In addition, when the movable unit is allowed to enter a specific part of another unit for transferring a workpiece or the like, it is necessary to distinguish a limit value to be used between the specific part and the other part.
しかしながら、多数の条件が存在する部品実装装置において、従来の技術を用いてソフトリミット制御を行うには、条件に適応する多数のリミット値をあらかじめ用意しておく必要がある。これは煩雑であるのみならず、条件の数によっては実際的でない。 However, in order to perform soft limit control using a conventional technique in a component mounting apparatus in which a large number of conditions exist, it is necessary to prepare a large number of limit values adapted to the conditions in advance. This is not only complicated, but impractical depending on the number of conditions.
また、リミット値を用意するときに位置が定まらない可動の障害物との干渉回避には、従来の技術によるソフトリミット制御は適用できない。 Further, the soft limit control according to the conventional technique cannot be applied to avoid interference with a movable obstacle whose position is not determined when preparing a limit value.
本発明は、かかる問題点に鑑みてなされたものであり、部品実装装置における多数の条件に適応するソフトリミット制御を、多数のリミット値をあらかじめ用意することなく好適に実行できる制御方法、およびそのような制御方法に従って動作する部品実装装置を提供することを目的とする。 The present invention has been made in view of such problems, and a control method that can suitably execute soft limit control adapted to a large number of conditions in a component mounting apparatus without preparing a large number of limit values in advance, and An object of the present invention is to provide a component mounting apparatus that operates according to such a control method.
上記目的を達成するために、本発明の制御方法は、部品実装装置に備えられる可動ユニットと他のユニットとの干渉を防止する制御方法であって、前記可動ユニットの現在位置を表す現在座標値を取得する位置取得ステップと、前記可動ユニットを移動させようとするときに、前記現在座標値に応じて、前記可動ユニットが前記他のユニットと干渉せずに動ける限界点を表すリミット座標値を算出するリミット算出ステップと、前記現在座標値が前記リミット座標値に達しているか判断する干渉判断ステップと、前記干渉判断ステップで少なくとも肯定判断された場合に前記可動ユニットの移動を規制する移動規制ステップとを含む。 In order to achieve the above object, a control method of the present invention is a control method for preventing interference between a movable unit provided in a component mounting apparatus and another unit, and a current coordinate value representing a current position of the movable unit. A position acquisition step of acquiring a limit coordinate value representing a limit point at which the movable unit can move without interfering with the other unit according to the current coordinate value when trying to move the movable unit. A limit calculating step for calculating, an interference determining step for determining whether the current coordinate value has reached the limit coordinate value, and a movement restricting step for restricting movement of the movable unit when at least an affirmative determination is made in the interference determining step. Including.
また、前記可動ユニットは複数の座標軸の方向に移動することができ、前記複数の座標軸の1つを動作座標軸とする場合に、前記リミット算出ステップで、前記リミット座標値の前記動作座標軸の値を、前記現在座標値の他の座標軸の値を用いて算出し、前記干渉判断ステップで、前記現在座標値の前記動作座標軸の値が前記リミット座標値の前記動作座標軸の値に達するか判断してもよい。 Further, the movable unit can move in the direction of a plurality of coordinate axes, and when one of the plurality of coordinate axes is set as an operation coordinate axis, the value of the operation coordinate axis of the limit coordinate value is calculated in the limit calculation step. Calculating using the value of the other coordinate axes of the current coordinate value, and determining whether the value of the motion coordinate axis of the current coordinate value reaches the value of the motion coordinate axis of the limit coordinate value in the interference determination step. Also good.
また、前記他のユニットが可動である場合に、前記他のユニットが可動である場合に、前記位置取得ステップで、さらに前記他のユニットの現在位置を表す相手座標値を取得し、前記リミット算出ステップで、前記リミット座標値を、前記現在座標値および前記相手座標値に応じて算出してもよい。 Further, when the other unit is movable, when the other unit is movable, the position acquisition step further acquires a partner coordinate value representing the current position of the other unit, and calculates the limit. In the step, the limit coordinate value may be calculated according to the current coordinate value and the counterpart coordinate value.
また、前記制御方法は、さらに、前記可動ユニットの移動先を表す移動先座標値を取得する移動先取得ステップと、前記移動先座標値に応じて、別のリミット座標値を算出する移動先リミット算出ステップと、前記移動先座標値が前記別のリミット座標値に達するか判断する移動先干渉判断ステップとを含み、前記移動規制ステップにて、さらに前記干渉判断ステップおよび前記移動先干渉判断ステップの少なくとも一方で肯定判断された場合に前記可動ユニットの移動を規制してもよい。 The control method further includes a destination acquisition step for acquiring a destination coordinate value representing a destination of the movable unit, and a destination limit for calculating another limit coordinate value according to the destination coordinate value. A calculation step; and a movement destination interference determination step for determining whether the movement destination coordinate value reaches the other limit coordinate value. In the movement restriction step, the interference determination step and the movement destination interference determination step If at least one of the determinations is affirmative, the movement of the movable unit may be restricted.
なお、本発明は、このような制御方法として実現することができるだけでなく、部品実装装置としても実現できる。さらに、このような制御方法を実行するためのプログラム、およびそのプログラムを格納する記憶媒体としても実現することができる。 The present invention can be realized not only as such a control method but also as a component mounting apparatus. Furthermore, the present invention can also be realized as a program for executing such a control method and a storage medium for storing the program.
本発明の制御方法によれば、可動ユニットを移動させようとする都度、前記可動ユニットの現在位置を表す現在座標値に応じて前記リミット座標値を算出し、前記現在座標値が前記リミット座標値に達する場合に、干渉が生じると判断して前記可動ユニットの移動を規制するので、前記現在位置に応じてリミット座標値を切り替える条件が多岐にわたる場合でも、一々の条件に対応して多数のリミット座標値をあらかじめ用意することなく、好適にソフトリミット制御を行うことが可能になる。 According to the control method of the present invention, each time the movable unit is moved, the limit coordinate value is calculated according to the current coordinate value indicating the current position of the movable unit, and the current coordinate value is calculated as the limit coordinate value. Since the movement of the movable unit is restricted by determining that interference occurs, even if there are a wide variety of conditions for switching the limit coordinate values according to the current position, a large number of limits Soft limit control can be suitably performed without preparing coordinate values in advance.
以下、本発明の実施の形態における部品実装装置および制御方法について、図面を参照しながら説明する。 Hereinafter, a component mounting apparatus and a control method according to embodiments of the present invention will be described with reference to the drawings.
図1は、本実施の形態のパネル実装機100の構成を示す斜視図である。
ここで、パネル実装機100は本発明の部品実装装置の一例である。また、本発明において実装とは、ワークである表示パネル200に、異方性導電シート(以下「ACF」)を介して部品300を仮圧着および本圧着して装着することをいう。このACFは、粘着性を有する合成樹脂シートから成っており、表示パネル200の電極の上面、あるいは部品300の下面に予め貼着される。
FIG. 1 is a perspective view showing a configuration of a
Here, the
パネル実装機100は、ACF貼付装置110、仮圧着装置120、本圧着装置130、および搬送装置140から構成される。
The
ACF貼付装置110、仮圧着装置120、および本圧着装置130には、表示パネル200を真空吸着により支持し、X軸Y軸(水平)方向、Z軸(上下)方向、およびθ軸(水平面内での回転)方向に移動自在な支持ステージ111、支持ステージ121、支持ステージ131がそれぞれ設けられている。
The
仮圧着装置120には、部品300を真空吸着により保持し、X軸Y軸方向、Z軸方向、およびθ軸方向に移動自在な移載ヘッド122が設けられている。
The temporary
ACF貼付装置110は、表示パネル200を支持ステージ111にて支持し、支持ステージ111を移動させることによって表示パネル200のACF貼付箇所を所定の作業位置へ位置付けた後、表示パネル200にACFを貼り付ける。
The
仮圧着装置120は、表示パネル200を支持ステージ121にて支持するとともに、部品300を移載ヘッド122にて保持し、支持ステージ121および移載ヘッド122の少なくとも一方を移動させることによって表示パネル200と部品300との位置合わせを行った後、表示パネル200に対して部品300を仮圧着する。
The temporary
本圧着装置130は、表示パネル200を支持ステージ131にて支持し、支持ステージ131を移動させることによって表示パネル200を所定の作業位置へ位置付けた後、表示パネル200に対して部品300を本圧着する。
The
搬送装置140は、ACF貼付装置110、仮圧着装置120、および本圧着装置130の間で、表示パネル200を搬送する。ここで、搬送装置140は、それぞれの装置用に複数台備えてもよい。
The
次に、仮圧着装置120による仮圧着動作について詳しく説明する。この仮圧着動作が、本実施の形態におけるソフトリミット制御の対象の一例である。
Next, the temporary pressure bonding operation by the temporary
図2は、仮圧着装置120の要部を表す斜視図である。図2には、仮圧着装置120とともに、搬送装置140および制御装置150が示される。
FIG. 2 is a perspective view illustrating a main part of the temporary
仮圧着装置120は、支持ステージ121、移載ヘッド122、吸着ノズル123、仮圧着ステージ124、および撮像装置125を有している。
The temporary
支持ステージ121は、制御装置150からの指令信号に応じて動作する駆動機構によって、表示パネル200を真空吸着により支持し、X軸およびY軸方向に平行移動しZ軸方向に上下動するとともにθ軸方向に回転する。
The
支持ステージ121は、ステージ部121aと駆動部121bとを有し、駆動部121bはステージ部121aに表示パネル200を吸着支持して回転移動するための吸着力および回転力を伝える。
The
移載ヘッド122は、制御装置150からの指令信号に応じて動作する駆動機構によって、図示しない部品供給装置から供給される部品300を吸着ノズル123にて真空吸着により保持し、移載ヘッド122が回転軸まわりにθ軸方向に水平面内で回転し、吸着ノズル123がZ軸方向に上下動するとともにθ軸方向に回転する。
The
なお、ここでは、移載ヘッド122がθ軸方向に水平面内で回転するとしたが、X軸方向およびY軸方向に平行移動してもよく、また、回転移動と平行移動とを組み合わせて行えるとしてもよい。
Here, it is assumed that the
移載ヘッド122は、部品300を保持した吸着ノズル123が仮圧着ステージ124上に来るまで回転した後、Z軸方向に下降することにより、部品300を表示パネル200に仮圧着する。
The
仮圧着ステージ124は、石英などの透明材料にて成り、移載ヘッド122が部品300を表示パネル200に仮圧着するための反力を与える。
The
撮像装置125は、仮圧着ステージ124越しに、支持ステージ121にて支持された状態での表示パネル200の位置認識マーク、および移載ヘッド122にて保持された状態での部品300の位置認識マークを撮像することにより、表示パネル200および部品300の位置合わせに必要な情報を制御装置150へ供給する。
The
搬送装置140は、制御装置150からの指令信号に応じて動作する駆動機構によってX軸方向に移動し、ACF貼付装置110から表示パネル200を搬送して支持ステージ121へ受け渡し、また支持ステージから表示パネル200を受け取って本圧着装置130へ搬送する。
The
搬送装置140は、表示パネル200を支持するアーム140aを有している。
制御装置150は、支持ステージ121、移載ヘッド122、吸着ノズル123、撮像装置125、および搬送装置140へ指令信号を送ることにより、上述したそれぞれの動作を制御する。
The
The
前述の仮圧着動作では、少なくとも仮圧着装置120の支持ステージ121、移載ヘッド122、および吸着ノズル123、ならびに搬送装置140が可動ユニットであり、ソフトリミット制御の対象となり得る。
In the above-described temporary press-bonding operation, at least the
そこで本実施の形態では、好ましい例として、こられの可動ユニットのうち、支持ステージ121を対象としたソフトリミット制御、および搬送装置140を対象としたソフトリミット制御について説明する。
Therefore, in the present embodiment, as a preferable example, soft limit control for the
図3は、この例のソフトリミット制御に関係するパネル実装機100の機能的な構成の一例を示す機能ブロック図である。
FIG. 3 is a functional block diagram showing an example of a functional configuration of the
制御装置150は、ACF貼付装置110、仮圧着装置120、本圧着装置130、および搬送装置140を制御する装置であり、具体的には、プロセッサ、メモリ、入出力装置、および通信装置などからなるコンピュータシステムである。
The
全体制御部154およびソフトリミット制御部160は、制御装置150において、プロセッサがメモリに記憶されているコンピュータプログラムを実行することにより実現されるソフトウェア機能である。
The
NC(数値制御)プログラム記憶部151、パラメータ記憶部153、および動作状態記憶部155は、メモリに割り当てられるデータ領域である。
An NC (numerical control)
操作部152は、オペレータとのインタフェースを実現する液晶表示器およびタッチパネルなどの入出力装置である。
The
NCプログラム記憶部151は、NCプログラムを記憶する。周知のように、NCプログラムは、パネル実装機100の動作内容を定める情報である。NCプログラムは、例えば操作部152を介してオペレータから教示されるか、または上位のプロセスコンピュータから通信で与えられる。NCプログラムの内容は、本発明の特徴部分ではないため、詳細な説明を省略する。
The NC
パラメータ記憶部153は、パラメータ情報を記憶する。パラメータ情報は、例えば操作部152を介してオペレータから入力される。
The
パラメータ情報は、パネル実装機100の要部の寸法、可動ユニットの停止余裕距離であるリミットマージンなど、ソフトリミット制御においてリミット座標値を算出するために用いられる種々の数値である。パラメータ情報の具体例については後述する。
The parameter information is various numerical values used for calculating limit coordinate values in the soft limit control, such as the dimensions of the main part of the
全体制御部154は、NCプログラム記憶部151に記憶されているNCプログラムに従って、ACF貼付装置110、仮圧着装置120、および本圧着装置130に含まれる支持ステージ、および搬送装置140などの可動ユニットへ、動作の開始および停止などを指令する指令信号を送信することにより、それぞれの可動ユニットを移動させる。
The
全体制御部154は、また、指令信号に応じて動作するそれぞれの可動ユニットに設けられているセンサから、動作状態を特定する信号(例えば、可動ユニットの現在位置を特定するために例えば1μm移動するごとに1回出力されるパルス信号)を継続的に受信し、受信した信号によって特定される動作状態を表すように動作状態記憶部155の動作状態情報(例えば、現在位置の座標値)を更新する。動作状態情報の具体例については後述する。
The
ソフトリミット制御部160は、ソフトリミット制御の対象となる可動ユニット(例えば支持ステージ121)の現在位置の座標値である現在座標値、ならびに可動ユニットと干渉する可能性がある他のユニット(例えば搬送装置140)の現在位置の座標値である相手座標値に応じて、可動ユニットが他のユニットと干渉せずに動ける限界点を表すリミット座標値を算出する。そして、現在座標値がリミット座標値に達している場合、全体制御部154を制御することにより可動ユニットの移動を規制する。ソフトリミット制御部160の詳細な動作については後述する。
The soft
次に、パラメータ情報、および動作状態情報の具体例を説明する。
図4は、パラメータ記憶部153に記憶されるパラメータ情報の一例を示す図である。
Next, specific examples of parameter information and operation state information will be described.
FIG. 4 is a diagram illustrating an example of parameter information stored in the
パラメータ記憶部153には、一例として、支持ステージ121、搬送装置140、仮圧着ステージ124、および仮圧着装置120の作業領域の寸法を表すパラメータ情報が記憶される。図4では、具体的な数値の代わりにそれぞれの数値を表す記号を示している。
As an example, the
図5は、動作状態記憶部155に記憶される動作状態情報の一例を示す図である。
動作状態記憶部155には、一例として、支持ステージ121の現在位置、および搬送装置140の現在位置を示す動作状態情報が記憶される。図5では、具体的な座標値の代わりにそれぞれの座標値を表す記号を示している。
FIG. 5 is a diagram illustrating an example of operation state information stored in the operation
As an example, the operation
図6(A)および図6(B)はそれぞれ、支持ステージ121、搬送装置140、および仮圧着ステージ124の寸法および位置を、図4のパラメータ情報および図5の動作状態情報に対応して示す平面図および側面図である。
6A and 6B respectively show the dimensions and positions of the
説明の便宜上、最外側の実線枠で仮圧着装置120の作業領域を示し、作業領域の一隅を座標系の原点Omとする。支持ステージ121の位置を表す基準点をOsとし、搬送装置140の位置を表す基準点をOtとする。また、図内の実線で各ユニットの外形を示す。
For convenience of explanation, the work area of the temporary
これらの実線で示される作業領域の境界および他のユニットの外形が、支持ステージ121の外形が到達できる最大領域となる。
The boundary of the work area indicated by these solid lines and the outer shape of another unit are the maximum area that the outer shape of the
リミット座標値は、この最大領域のリミットマージンMの手前(点線で示されている)から、さらに可動ユニット自身の寸法に応じた距離を後退した地点として算出される。 The limit coordinate value is calculated as a point where a distance corresponding to the dimension of the movable unit itself is further retracted from a position before the limit margin M of the maximum area (indicated by a dotted line).
リミットマージンMとは、ソフトリミット制御によって移動を規制される可動ユニットが実際に干渉を生じることなく安全に停止するための余裕距離であり、一例として各ユニットを駆動するモータのトルクが大きいほど小さな値が定められるといったように、装置の特性に依存して定められるパラメータである。 The limit margin M is an allowance distance for a movable unit whose movement is restricted by soft limit control to stop safely without actually causing interference. For example, the limit margin M is smaller as the torque of the motor driving each unit is larger. It is a parameter that is determined depending on the characteristics of the device such that the value is determined.
図6(A)および図6(B)において、支持ステージ121、搬送装置140、および仮圧着ステージ124の寸法を、対応箇所に図4の記号を付して示している。また、支持ステージ121および搬送装置140の現在位置を、それぞれの基準点に図5の記号を付して示している。
6A and 6B, the dimensions of the
次に、ソフトリミット制御部160が行う処理の一例として、図6(A)および図6(B)に太い破線矢印で示されるように、支持ステージ121を搬送装置140の下方へ向かって移動させる場合に行われるソフトリミット制御処理について説明する。
Next, as an example of processing performed by the soft
この例では、支持ステージ121は斜めに、X軸、Y軸、およびZ軸のそれぞれのマイナス方向に移動する。
In this example, the
図7は、このような移動に際して行われるソフトリミット制御処理を一般的に表すフローチャートである。以下の説明において、図7のフローチャートに記載の可動ユニットおよび他のユニットが、それぞれ支持ステージ121および搬送装置140に対応する。
FIG. 7 is a flowchart generally showing a soft limit control process performed during such movement. In the following description, the movable unit and other units described in the flowchart of FIG. 7 correspond to the
このソフトリミット制御処理は、全体制御部154が支持ステージ121に対して前述した移動を指令しようとするときに、全体制御部154から起動され実行される。
This soft limit control process is activated and executed by the
ソフトリミット制御部160は、まず、支持ステージ121が現在位置において既に、作業領域の境界または搬送装置140と干渉するかを判断する。
The soft
そのために、位置取得部161は、支持ステージ121および搬送装置140の現在位置を表す現在座標値を動作状態記憶部155から取得する(S11)。
For this purpose, the
リミット算出部162は、支持ステージ121が、現在位置から作業領域の境界または搬送装置140と干渉せずに動ける限界点を表すリミット座標値を算出する。X軸、Y軸、およびZ軸のそれぞれのリミット座標値が、支持ステージ121の現在座標値の他の座標軸の値、および搬送装置140の現在座標値を用いて算出される(S12)。
The
図8(A)および図8(B)は、このリミット座標値の算出に用いられる要部の位置および限界点を説明する平面図および側面図である。 FIG. 8A and FIG. 8B are a plan view and a side view for explaining the positions and limit points of the main parts used for calculating the limit coordinate values.
以下の説明では、簡明のため、支持ステージ121の長辺を支持ステージ121のθ軸まわりの基準方向とし、その基準方向がX軸に平行であるとする。
In the following description, for the sake of simplicity, it is assumed that the long side of the
点線は、前述したように、支持ステージ121の外形が到達できる最大領域からリミットマージンMの手前の地点を表す。斜線を付した点線はそこからさらに、支持ステージ121の干渉寸法(すなわち、支持ステージ121の基準点Osからステージ部121aの外形までの座標軸方向の距離)後退した限界点を表す。
As described above, the dotted line represents the point before the limit margin M from the maximum region where the outer shape of the
また、支持ステージ121のX軸方向の干渉寸法をs_L(ステージ部121aの長辺の長さの半分)とし、Y軸方向の干渉寸法をs_S(ステージ部121aの短辺の長さの半分)とする。
Further, the interference dimension in the X-axis direction of the
また、搬送装置140の干渉寸法(すなわち、搬送装置140の基準点Otからアーム140aの外形までの座標軸方向の距離)については、X軸方向の内側の干渉寸法をt_W1(アーム140aのX軸方向の内側長さの半分)とし、X軸方向の外側の干渉寸法をt_W2(アーム140aのX軸方向の外側長さの半分)とし、また、Y軸方向の凹部の干渉寸法をt_D1(アーム140aのY軸方向の凹部奥行き)とし、Y軸方向の凸部の干渉寸法をt_D2(アーム140aのY軸方向の凸部奥行き)とする。
For the interference dimension of the transport device 140 (that is, the distance in the coordinate axis direction from the reference point Ot of the
支持ステージ121の基準点Osは、ステージ部121aが作業領域の端および他のユニットと干渉することなく、斜線を付した点線の内側を動くことができる。この範囲は、支持ステージ121の高さ(Z軸の座標値)に応じて異なる。
The reference point Os of the
まず、支持ステージ121のX軸のマイナス方向に向かう限界点を表すリミット座標値limXを、(式1)に従って算出する。
First, a limit coordinate value limX representing a limit point of the
(式1)において条件1−1は、支持ステージ121が搬送装置140と干渉しないZ軸の高さにあるか、言い換えれば支持ステージ121が搬送装置140のアーム140aの下へ潜り込めるかを判断する。
In (Expression 1), Condition 1-1 determines whether the
条件1−1が真の場合、支持ステージ121の外形は、X軸の座標値が0で表される作業領域の境界からリミットマージンMの手前の地点まで移動できる。したがって、limXを、作業領域の境界からリミットマージンMおよび支持ステージ121のX軸方向の干渉寸法s_Lの余裕を持たせた(M+s_L)とする。
When the condition 1-1 is true, the outer shape of the
条件1−1が偽の場合、条件1−2により、支持ステージ121が搬送装置140の通路(X軸方向の移動領域)外のY軸の位置にあるかを判断する。
When the condition 1-1 is false, it is determined according to the condition 1-2 whether the
条件1−2が真の場合、支持ステージ121の外形は、作業領域の境界からリミットマージンMの手前の地点まで移動できる。したがって、limXを、作業領域の境界からリミットマージンMおよび支持ステージ121の干渉寸法s_Lの余裕を持たせた(M+s_L)とする。
When the condition 1-2 is true, the outer shape of the
条件1−2が偽の場合、支持ステージ121は、搬送装置140と干渉する高さにありかつ搬送装置140の通路内に進入していると判断される。この場合、支持ステージ121と搬送装置140との位置関係によって、さらに条件が分かれる。
When the condition 1-2 is false, it is determined that the
条件1−3は、支持ステージ121が搬送装置140の右側(X軸のプラス方向)に来るX軸の位置にあるかを判断する。
Condition 1-3 determines whether or not the
条件1−3が真の場合、支持ステージ121は、X軸のマイナス方向へ動くことで搬送装置140のアーム140aの右外側と干渉する可能性がある。したがって、limXを、X軸の座標値がt_x+t_W2で表される搬送装置140のアーム140aの右外側からリミットマージンMおよび支持ステージ121の干渉寸法s_Lの余裕を持たせた(t_x+t_W2+M+s_L)とする。
When the condition 1-3 is true, the
条件1−4は、支持ステージ121が搬送装置140のアーム140a内に進入しているX軸の位置にあるかを判断する。
Condition 1-4 determines whether or not the
条件1−4が真の場合、支持ステージ121は、X軸のマイナス方向へ動くことで搬送装置140のアーム140aの左内側と干渉する可能性がある。したがって、limXを、X軸の座標値がt_x−t_W1で表される搬送装置140のアーム140aの左内側からリミットマージンMおよび支持ステージ121の干渉寸法s_Lの余裕を持たせた(t_x−t_W1+M+s_L)とする。
When the condition 1-4 is true, the
条件1−4が偽の場合、支持ステージ121は、搬送装置140のアーム140aの左側(X軸のマイナス方向)に来るX軸の位置にあると判断される。
When the condition 1-4 is false, it is determined that the
条件1−4が偽の場合、支持ステージ121の外形は、作業領域の境界からリミットマージンMの手前の地点まで移動できる。したがって、limXを、作業領域の境界からリミットマージンMおよび支持ステージ121の干渉寸法s_Lの余裕を持たせた(M+s_L)とする。
When the condition 1-4 is false, the outer shape of the
次に、支持ステージ121のY軸のマイナス方向に向かう限界点を表すリミット座標値limYを、(式2)に従って算出する。
Next, a limit coordinate value limY representing the limit point of the
(式2)において条件2−1は、支持ステージ121が搬送装置140と干渉しないZ軸の高さにあるか、言い換えれば支持ステージ121が搬送装置140のアーム140aの下へ潜り込めるかを判断する。
In (Expression 2), the condition 2-1 determines whether the
条件2−1が真の場合、支持ステージ121の外形は、Y軸の座標値が0で表される作業領域の境界からリミットマージンMの手前の地点まで移動できる。したがって、limYを、作業領域の境界からリミットマージンMおよび支持ステージ121のY軸方向の干渉寸法s_Sの余裕を持たせた(M+s_S)とする。
When the condition 2-1 is true, the outer shape of the
条件2−1が偽の場合、条件2−2により、支持ステージ121が搬送装置140のアーム140aの外形と干渉するX軸の位置にあるかを判断する。
When the condition 2-1 is false, it is determined according to the condition 2-2 whether the
条件2−2が真の場合、条件2−3により、支持ステージ121が搬送装置140のアーム140a内に進入できるX軸の位置にあるかを判断する。
When the condition 2-2 is true, it is determined according to the condition 2-3 whether the
条件2−3が真の場合、支持ステージ121は、搬送装置140のアーム140aのY軸方向の凹部と干渉する可能性がある。したがって、limYを、Y軸の座標値がt_D1で表されるアーム140aのY軸方向の凹部からリミットマージンMおよび支持ステージ121の干渉寸法s_Sの余裕を持たせた(t_D1+M+s_S)とする。
When the condition 2-3 is true, the
条件2−3が偽の場合、支持ステージ121は、搬送装置140のアーム140aのY軸方向の凸部と干渉する可能性がある。したがって、limYを、Y軸の座標値がt_D2で表されるアーム140aのY軸方向の凸部からリミットマージンMおよび支持ステージ121の干渉寸法s_Sの余裕を持たせた(t_D2+M+s_S)とする。
When the condition 2-3 is false, the
条件2−2が偽の場合、および条件2−1が偽の場合、支持ステージ121の外形は、作業領域の境界からリミットマージンMの手前の地点まで移動できる。したがって、limYを、作業領域の境界からリミットマージンMおよび支持ステージ121の干渉寸法s_Sの余裕を持たせた(M+s_S)とする。
When the condition 2-2 is false and the condition 2-1 is false, the outer shape of the
なお、上記の説明では簡略のため、X軸およびY軸のリミット座標値を算出するにあたって、支持ステージ121の大きさがステージ部121aと駆動部121bとで異なる(駆動部121bがステージ部121aよりも細い)ことを無視し、駆動部121bよりも大きいステージ部121aの寸法を干渉寸法として一律に用いた。
For the sake of simplification in the above description, in calculating the limit coordinate values of the X axis and the Y axis, the size of the
しかしながら、ステージ部121aおよび駆動部121bの何れが干渉するかでさらに場合を分けてリミット座標値を算出してももちろん構わない。
However, it goes without saying that the limit coordinate value may be calculated in different cases depending on which of the
例えば、駆動部121bが干渉する場合のリミット座標値は、(式1)および(式2)におけるステージ部121aのX軸方向およびY軸方向の干渉寸法であるs_Lおよびs_Sを、それぞれ駆動部121bのX軸方向およびY軸方向の干渉寸法であるs_Wおよびs_Dで置き換えることにより算出できる。
For example, the limit coordinate values when the
また、支持ステージ121のZ軸のマイナス方向に向かう限界点を表すリミット座標値も同様にして算出する。
Further, the limit coordinate value representing the limit point of the
すなわち、支持ステージ121が、下降することでステージ部121aの駆動部121bから張り出している部分が搬送装置140または仮圧着ステージ124と干渉するX軸およびY軸の位置にあるか否かで場合を分けて、支持ステージ121が下降可能な限界点を表すリミット座標値を算出する。
That is, depending on whether or not the portion of the
なお、このように算出されるZ軸方向のリミット座標値を用いた干渉判断は、X軸方向およびY軸方向の干渉判断と同様に行うことができるため、以下では簡略のため説明を省略する。 The interference determination using the limit coordinate value in the Z-axis direction calculated in this way can be performed in the same manner as the interference determination in the X-axis direction and the Y-axis direction. .
このように、本実施の形態のソフトリミット制御では、複数の条件の一々に対応する複数のリミット座標値をあらかじめ用意しておきその中の1つを選択的に用いる従来の技術とは異なり、統一された数式と少数のパラメータとを用いてリミット座標値を都度計算で求める。 Thus, in the soft limit control of the present embodiment, unlike the conventional technique in which a plurality of limit coordinate values corresponding to each of a plurality of conditions are prepared in advance and one of them is selectively used, A limit coordinate value is obtained by calculation each time using a unified mathematical formula and a small number of parameters.
算出されたリミット座標値を用いて、以下の処理を続行する。
干渉判断部163は、支持ステージ121のX軸の現在座標値s_xがlimXに達するかを、s_x<limXの比較を行うことにより判断する。また、支持ステージ121のY軸の現在座標値s_yがlimYに達するかを、s_y<limYの比較を行うことにより判断する(S13)。
The following processing is continued using the calculated limit coordinate value.
The
X軸およびY軸の少なくとも一方で達すると判断された場合(S13でYES)、支持ステージ121は、作業領域の境界または搬送装置140との干渉のために移動を開始する余裕がないことを意味している。
When it is determined that at least one of the X axis and the Y axis is reached (YES in S13), the
その場合、移動規制部164は、全体制御部154を制御することにより支持ステージ121の移動を規制する。具体的に、全体制御部154は、操作部152に移動できないことを示すエラーメッセージを表示し(S14)、支持ステージ121に対して移動を指令することなく処理を終了する。
In that case, the
現在位置において支持ステージ121は他のユニットと干渉しないと判断された場合(S13でNO)、ソフトリミット制御部160は、支持ステージ121が移動先において、作業領域の境界または搬送装置140と干渉するかを判断する。
When it is determined that the
そのために、位置取得部161は、支持ステージ121の移動先を表す移動先座標値(s_x’,s_y’,s_z’)を全体制御部154から取得する(S21)。
For this purpose, the
リミット算出部162は、前述した(式1)および(式2)に、支持ステージ121の移動先座標値(s_x’,s_y’,s_z’)を代入することによって、支持ステージ121の移動先でのリミット座標値limX’およびlimY’を算出する(S22)。
The
このようにして、算出されたリミット座標値limX’およびlimY’を用いて、以下の処理を続行する。 In this way, the following processing is continued using the calculated limit coordinate values limX ′ and limY ′.
干渉判断部163は、支持ステージ121のX軸の移動先座標値s_x’がlimX’に達するかを、s_x’<limX’の比較を行うことにより判断する。また、Y軸の移動先座標値s_y’がlimY’に達するかを、s_y’<limY’の比較を行うことにより判断する(S23)。
The
X軸およびY軸の少なくとも一方で達すると判断された場合(S23でYES)、支持ステージ121は、移動先まで移動すれば、作業領域の境界または搬送装置140と干渉することを意味している。
If it is determined that at least one of the X axis and the Y axis is reached (YES in S23), it means that the
その場合、移動規制部164は、全体制御部154を制御することにより支持ステージ121の移動を規制する。具体的に、全体制御部154は、操作部152に移動できないことを示すエラーメッセージを表示し(S24)、支持ステージ121に対して移動を指令することなく処理を終了する。
In that case, the
移動先において支持ステージ121は他のユニットと干渉しないと判断された場合(S23でNO)、全体制御部154は、支持ステージ121に対して移動を指令する(S31)。
When it is determined that the
この指令を受けて支持ステージ121は移動を開始する。支持ステージ121が移動するに従って、全体制御部154は、動作状態記憶部155に保持されている支持ステージ121の現在位置を表す現在座標値を更新する。
In response to this command, the
位置取得部161は、支持ステージ121の移動中、周期的に(例えば10ミリ秒の周期で)これらの更新された値を取得する(S32)。以下、支持ステージ121の移動中に取得される現在座標値を、(s_x”,s_y”,s_z”)と表記して、移動開始前の現在座標値と区別する。
The
リミット算出部162は、前述した(式1)および(式2)に、支持ステージ121の移動中の現在座標値(s_x”,s_y”,s_z”)を代入することによって、支持ステージ121の移動中のリミット座標値limX”およびlimY”を算出する(S33)。
The
このようにして、算出されたリミット座標値limX”およびlimY”を用いて、以下の処理を続行する。 In this way, the following processing is continued using the calculated limit coordinate values limX ″ and limY ″.
干渉判断部163は、支持ステージ121のX軸の現在座標値s_x”がlimX”に達するかを、s_x”<limX”の比較を行うことにより判断する。また、Y軸の現在座標値s_y”がlimY”に達するかを、s_y”<limY”の比較を行うことにより判断する(S34)。
The
X軸およびY軸の少なくとも一方で達すると判断された場合(S34でYES)、支持ステージ121は、移動中に、作業領域の境界または搬送装置140との干渉を防止する安全余裕がなくなったことを意味している。
If it is determined that at least one of the X axis and the Y axis is reached (YES in S34), the
その場合、移動規制部164は、全体制御部154を制御することによって支持ステージ121に対し緊急停止を指令する(S35)。全体制御部154は、操作部152に移動できないことを示すエラーメッセージを表示し(S36)、処理を終了する。
In that case, the
支持ステージ121に干渉が生じると判断されない限り(S34でNO)、支持ステージ121が移動先に到着するまで、ステップS32に戻って処理を続ける(S37)。
Unless it is determined that interference occurs in the support stage 121 (NO in S34), the process returns to step S32 and continues until the
全体制御部154は、支持ステージ121が移動先に接近すると、支持ステージ121に対し移動先にて停止するよう指令する(S38)。
When the
以上のソフトリミット制御処理によれば、支持ステージ121および搬送装置140の現在位置を表す現在座標値、移動先を表す移動先座標値、および移動中の位置を表す座標値を(式1)および(式2)に統一的に代入することによって、適切なリミット座標値を都度算出して干渉判断に用いることができる。
According to the soft limit control process described above, the current coordinate value indicating the current position of the
そのため、多数の条件に適応した柔軟なソフトリミット制御を、多数の条件の一々に対応する多数のリミット座標値をあらかじめ用意するといった煩雑な作業を必要とせずに、簡便に行うことができる。 Therefore, flexible soft limit control adapted to a large number of conditions can be easily performed without requiring a complicated operation of preparing a large number of limit coordinate values corresponding to a large number of conditions in advance.
ここまで、支持ステージ121をX軸、Y軸、およびZ軸のマイナス方向に移動させる場合のソフトリミット制御処理について、図7のフローチャートを参照して説明した。同様のソフトリミット制御処理は、移動方向が異なる場合や、他の可動ユニットにも適用できることはもちろんである。
Up to this point, the soft limit control process when the
例えば、支持ステージ121をY軸のプラス方向、つまり仮圧着ステージ124の方向に移動させる場合のソフトリミット制御処理では、リミット算出部162は、支持ステージ121の現在位置、移動先、および移動中の位置におけるリミット座標値limY、limY’、およびlimY”を、それぞれ(式3)に従って算出する(図7のS12、S22、およびS33)。
For example, in the soft limit control process when the
(式3)において条件3−1は、支持ステージ121が、Z軸方向に0からb_H1までの高さにある仮圧着ステージ124の下部と干渉するZ軸の高さにあるかを判断する。
In (Expression 3), the condition 3-1 determines whether the
条件3−1が真の場合、支持ステージ121の外形は、仮圧着ステージ124の下部からリミットマージンMの手前の地点まで移動できる。したがって、limYを、Y軸の座標値が(m_D−b_D1)で表される仮圧着ステージ124の下部からリミットマージンMおよび支持ステージ121のY軸方向の干渉寸法s_Sの余裕を持たせた(m_D−b_D1−M−s_S)とする。
When the condition 3-1 is true, the outer shape of the
条件3−1が偽の場合、条件3−2により、支持ステージ121が、Z軸方向にb_H1からb_H2までの高さにある仮圧着ステージ124の上部と干渉するZ軸の高さにあるかを判断する。
If the condition 3-1 is false, is the condition stage 3-2 that the
条件3−2が真の場合、支持ステージ121の外形は、仮圧着ステージ124の上部からリミットマージンMの手前の地点まで移動できる。したがって、limYを、Y軸の座標値が(m_D−b_D2)で表される仮圧着ステージ124の上部からリミットマージンMおよび支持ステージ121の干渉寸法s_Sの余裕を持たせた(m_D−b_D2−M−s_S)とする。
When the condition 3-2 is true, the outer shape of the
条件3−2が偽の場合、支持ステージ121の外形は、Y軸の座標値がm_Dで表される作業領域の境界からリミットマージンMの手前の地点まで移動できる。したがって、limYを、作業領域の境界からリミットマージンMおよび支持ステージ121の干渉寸法s_Sの余裕を持たせた(m_D−M−s_S)とする。
When the condition 3-2 is false, the outer shape of the
干渉判断部163は、支持ステージ121のY軸の現在座標値s_y、移動先座標値s_y’、および移動中の座標値s_y”がそれぞれ上記算出されたlimY、limY’、およびlimY”に達するかを、s_y>limY、s_y’>limY’、およびs_y”>limY”の比較を行うことにより判断する(図7のS13、S23、およびS34)。ここで、支持ステージ121の移動方向がY軸のプラス方向かマイナス方向かに応じて、干渉判断のための不等号の向きが逆になることに注意する。
The
他のステップの処理は、前述の説明と同様にして行われる。
このように、支持ステージ121を移動させようとする場合のソフトリミット制御処理は、移動方向に応じた算出式を用いてリミット座標値を求め、移動方向に応じた比較判断を行うことで、図7のフローチャートで示される共通の手順に従って行うことができる。
The processing of other steps is performed in the same manner as described above.
As described above, the soft limit control process in the case of moving the
なお、ここまでは、支持ステージ121の長辺がX軸と平行である場合について説明したが、支持ステージ121がθ軸方向に回転することによって長辺がX軸に斜めになっている場合は干渉寸法が変わってくる。
Up to this point, the case where the long side of the
そこで、支持ステージ121の長辺がX軸に斜めになっている場合には、移動方向に向かう先端頂点のX軸およびY軸の現在座標値を求め、支持ステージ121の基準点OsのX軸およびY軸の現在座標値と、求めた先端頂点のX軸およびY軸の現在座標値との差を干渉寸法として用いる。
Therefore, when the long side of the
支持ステージ121の長辺がX軸に斜めになっている場合の先端頂点のX軸およびY軸の現在座標値は、支持ステージ121の長辺がX軸と平行である場合のθ軸の座標値を0として、その場合の先端頂点のX軸およびY軸の座標値に、θ軸の現在座標値に応じた回転変換を施すことによって求めることができる。
When the long side of the
次に、支持ステージ121をθ軸方向に回転移動させる場合のソフトリミット制御処理について説明する。
Next, a soft limit control process when the
この場合、ソフトリミット制御部160は、干渉が生じるかをθ軸の座標値の比較によって直接判断する代わりに、X軸のプラス方向およびマイナス方向、ならびにY軸のプラス方向およびマイナス方向の4つの方向のうち何れか1つの方向にでも干渉が生じるかで判断する。
In this case, the soft
具体的には、リミット算出部162は、θ軸のリミット座標値を算出するのではなく、前記のX軸およびY軸それぞれのプラス方向およびマイナス方向の4方向について4つのリミット座標値を算出する。このリミット座標値の算出には、前述のθ軸の現在座標値に応じた干渉寸法が用いられる。
Specifically, the
干渉判断部163は、前記の4方向についてそれぞれ、支持ステージ121の現在座標値がリミット座標値に達するかを比較判断する。
The
そして、いずれか1つの方向にでも、支持ステージ121の現在座標値がリミット座標値に達すると判断された場合、支持ステージ121は、回転移動を開始する余裕がないことを意味しているので、移動規制部164は、全体制御部154を制御することにより支持ステージ121の回転を規制する。
And if it is determined that the current coordinate value of the
現在位置において支持ステージ121に干渉が生じないと判断された場合、干渉判断部163は、支持ステージ121の回転後の目標方向を全体制御部154から取得し、支持ステージ121が目標方向へ回転した場合について、前記の4方向に向かってそれぞれ干渉が生じるかの判断を行う。
When it is determined that no interference occurs in the
いずれか1つの方向にでも干渉が生じると判断された場合、移動規制部164は、全体制御部154を制御することにより支持ステージ121の回転を規制する。
When it is determined that interference occurs in any one direction, the
移動先において支持ステージ121に干渉が生じない場合、全体制御部154は、支持ステージ121に対して回転を指令する。この指令を受けて支持ステージ121が回転するに従って、全体制御部154は、動作状態記憶部155の支持ステージ121の現在の向きであるθ座標値を更新する。
When there is no interference with the
この回転中に更新されるθ座標値を用いて、支持ステージ121の回転中に、周期的にリミット座標値の算出と干渉判断とを行ってももちろん構わない。
Of course, it is possible to periodically calculate the limit coordinate value and determine the interference during the rotation of the
次に、支持ステージ121以外の可動ユニットに対するソフトリミット制御処理の例として、搬送装置140に対するソフトリミット制御処理について説明する。
Next, as an example of the soft limit control process for the movable unit other than the
搬送装置140に対するソフトリミット制御処理を行う場合、搬送装置140は隣接する工程を処理する装置へも進入することから、隣接する装置内において干渉が生じるかを判断する必要がある。
When the soft limit control process is performed on the
一例として、仮圧着装置120内にある搬送装置140が、ACF貼付装置110または本圧着装置130へ進入しようとする場合、搬送装置140と支持ステージ121とは干渉しないと判断されたとしても、ACF貼付装置110の支持ステージ111、または本圧着装置130の支持ステージ131とは干渉する可能性がある。
As an example, when the conveying
そこで、全体制御部154は、仮圧着装置120の支持ステージ121だけでなく、ACF貼付装置110の支持ステージ111、および本圧着装置130の支持ステージ131からも、現在位置を特定する信号を受信し(図3を参照)、受信した信号によって特定される支持ステージ111、支持ステージ121、および支持ステージ131のそれぞれの現在位置を表す座標値を動作状態記憶部155に記録しておく。
Therefore, the
ソフトリミット制御部160は、動作状態記憶部155に記録された座標値を参照することにより、仮圧着装置120の支持ステージ121だけでなく、ACF貼付装置110の支持ステージ111、および本圧着装置130の支持ステージ131も考慮に入れてリミット座標値を算出する。そして、搬送装置140の現在座標値が、算出されたリミット座標値に達する場合には、他装置内で干渉が生じると判断して、搬送装置140の移動を規制する。
The soft
また、一斉に動く複数のアームを備え、それぞれのアームにパネルを支持して搬送可能な搬送装置もある。 In addition, there is a transport device that includes a plurality of arms that move at the same time and that can support and transport a panel on each arm.
そのような搬送装置では、一例として、仮圧着装置120内のアームを動かすだけで、ACF貼付装置110または本圧着装置130内のアームが連動して予期しない干渉が生じる可能性がある。
In such a transport apparatus, as an example, simply moving the arm in the temporary crimping
この場合には、1つのアームを移動しようとするときに、連動する全てのアームについて他のユニットとの干渉が生じるか判断し、干渉が生じると判断されるアームが1つでもある場合に、本来のアームの移動を規制すれば、干渉の発生を適正に防止することができる。 In this case, when trying to move one arm, it is determined whether all the interlocking arms cause interference with other units, and if there is one arm that is determined to cause interference, If the original movement of the arm is restricted, the occurrence of interference can be prevented appropriately.
以上、本発明のソフトリミット制御方法について、パネル実装機を一例とした実施の形態に基づいて説明したが、本発明は、この実施の形態に限定されるものではない。本発明の趣旨を逸脱しない限り、当業者が思いつく各種変形を本実施の形態に施したものも本発明の範囲内に含まれる。 As mentioned above, although the soft limit control method of this invention was demonstrated based on embodiment which made the panel mounting machine an example, this invention is not limited to this embodiment. Unless it deviates from the meaning of the present invention, those in which various modifications conceived by those skilled in the art have been made in the present embodiment are also included in the scope of the present invention.
例えば、上記の説明では、支持ステージ121のステージ部121aの寸法s_Lおよびs_Sを干渉寸法として用いたが、支持ステージ121がワークを載置している場合には、便宜的にワークの長辺の長さの半分およびワークの短辺の長さの半分を干渉寸法として用いてもよい。
For example, in the above description, the dimensions s_L and s_S of the
そうすれば、リミット座標値を算出するための計算式を全く変更することなく、パラメータの値の変更のみで、支持ステージ121が載置しているワークの大きさに基づく干渉判断に切り替えることができる。
Then, without changing the calculation formula for calculating the limit coordinate value, it is possible to switch to interference determination based on the size of the workpiece placed on the
本発明は、部品実装装置などの製造機械、とりわけ他のユニットとの干渉を防止する必要がある可動ユニットを備えた製造機械、およびその制御方法して利用できる。 INDUSTRIAL APPLICABILITY The present invention can be used as a manufacturing machine such as a component mounting apparatus, particularly a manufacturing machine including a movable unit that needs to prevent interference with other units, and a control method thereof.
100 パネル実装機
110 ACF貼付装置
111 支持ステージ
120 仮圧着装置
121 支持ステージ
121a ステージ部
121b 駆動部
122 移載ヘッド
123 吸着ノズル
124 仮圧着ステージ
125 撮像装置
130 本圧着装置
131 支持ステージ
140 搬送装置
140a アーム
150 制御装置
151 NCプログラム記憶部
152 操作部
153 パラメータ記憶部
154 全体制御部
155 動作状態記憶部
160 ソフトリミット制御部
161 位置取得部
162 リミット算出部
163 干渉判断部
164 移動規制部
200 表示パネル
300 部品
DESCRIPTION OF
Claims (6)
前記可動ユニットの現在位置を表す現在座標値を取得する位置取得ステップと、
前記可動ユニットを移動させようとするときに、前記現在座標値に応じて、前記可動ユニットが前記他のユニットと干渉せずに動ける限界点を表すリミット座標値を算出するリミット算出ステップと、
前記現在座標値が前記リミット座標値に達しているか判断する干渉判断ステップと、
前記干渉判断ステップで少なくとも肯定判断された場合に前記可動ユニットの移動を規制する移動規制ステップと
を含むことを特徴とする制御方法。 A control method for preventing interference between a movable unit and other units provided in a component mounting apparatus,
A position acquisition step of acquiring a current coordinate value representing a current position of the movable unit;
A limit calculating step for calculating a limit coordinate value representing a limit point at which the movable unit can move without interfering with the other unit, according to the current coordinate value, when the movable unit is to be moved;
An interference determination step for determining whether the current coordinate value has reached the limit coordinate value;
A movement restriction step for restricting movement of the movable unit when at least an affirmative decision is made in the interference determination step.
前記リミット算出ステップで、前記リミット座標値の前記動作座標軸の値を、前記現在座標値の他の座標軸の値を用いて算出し、
前記干渉判断ステップで、前記現在座標値の前記動作座標軸の値が前記リミット座標値の前記動作座標軸の値に達するか判断する
ことを特徴とする請求項1に記載の制御方法。 The movable unit can move in the direction of a plurality of coordinate axes, and when one of the plurality of coordinate axes is an operation coordinate axis,
In the limit calculating step, the value of the operation coordinate axis of the limit coordinate value is calculated using the value of the other coordinate axis of the current coordinate value,
The control method according to claim 1, wherein in the interference determination step, it is determined whether the value of the motion coordinate axis of the current coordinate value reaches the value of the motion coordinate axis of the limit coordinate value.
前記位置取得ステップで、さらに前記他のユニットの現在位置を表す相手座標値を取得し、
前記リミット算出ステップで、前記リミット座標値を、前記現在座標値と前記相手座標値とに応じて算出する
ことを特徴とする請求項1または請求項2に記載の制御方法。 When the other unit is movable,
In the position acquisition step, further obtain a partner coordinate value representing the current position of the other unit,
The control method according to claim 1, wherein, in the limit calculation step, the limit coordinate value is calculated according to the current coordinate value and the counterpart coordinate value.
前記可動ユニットの移動先を表す移動先座標値を取得する移動先取得ステップと、
前記移動先座標値に応じて、別のリミット座標値を算出する移動先リミット算出ステップと、
前記移動先座標値が前記別のリミット座標値に達するか判断する移動先干渉判断ステップとを含み、
前記移動規制ステップにて、さらに前記干渉判断ステップおよび前記移動先干渉判断ステップの少なくとも一方で肯定判断された場合に前記可動ユニットの移動を規制する
ことを特徴とする請求項1から請求項3のいずれかに記載の制御方法。 The control method further includes:
A destination acquisition step of acquiring a destination coordinate value representing a destination of the movable unit;
A destination limit calculation step of calculating another limit coordinate value according to the destination coordinate value;
A destination interference determination step for determining whether the destination coordinate value reaches the another limit coordinate value;
4. The movement of the movable unit is restricted in the movement restriction step when an affirmative determination is further made in at least one of the interference determination step and the destination interference determination step. 5. The control method in any one.
前記可動ユニットの現在位置を表す現在座標値を取得する現在位置取得ステップと、
前記可動ユニットを移動させようとするときに、前記現在座標値に応じて、前記可動ユニットが前記他のユニットと干渉せずに動ける限界点を表すリミット座標値を算出するリミット算出ステップと、
前記現在座標値が前記リミット座標値に達しているか判断する干渉判断ステップと、
前記干渉判断ステップで少なくとも肯定判断された場合に前記可動ユニットの移動を規制する移動規制ステップと
をコンピュータに実行させることを特徴とするプログラム。 A computer program for performing control to prevent interference between a movable unit and other units provided in a component mounting apparatus,
A current position acquisition step of acquiring a current coordinate value representing a current position of the movable unit;
A limit calculating step for calculating a limit coordinate value representing a limit point at which the movable unit can move without interfering with the other unit, according to the current coordinate value, when the movable unit is to be moved;
An interference determination step for determining whether the current coordinate value has reached the limit coordinate value;
A program for causing a computer to execute a movement restriction step for restricting movement of the movable unit when at least an affirmative determination is made in the interference determination step.
前記可動ユニットと干渉する可能性がある他のユニットと、
前記可動ユニットの動作を制御する制御手段と
を備え、
前記制御手段は、
前記可動ユニットの現在位置を表す現在座標値を取得する位置取得部と、
前記可動ユニットを移動させようとするときに、前記現在座標値に応じて、前記可動ユニットが前記他のユニットと干渉せずに動ける限界点を表すリミット座標値を算出するリミット算出部と、
前記現在座標値が前記リミット座標値に達しているか判断する判断する干渉判断部と、
前記干渉判断部で少なくとも肯定判断された場合に前記可動ユニットの移動を規制する移動規制部とを有する
ことを特徴とする部品実装装置。 A movable unit;
Other units that may interfere with the movable unit;
Control means for controlling the operation of the movable unit,
The control means includes
A position acquisition unit for acquiring a current coordinate value representing a current position of the movable unit;
When trying to move the movable unit, a limit calculation unit that calculates a limit coordinate value representing a limit point at which the movable unit can move without interfering with the other unit according to the current coordinate value;
An interference determination unit for determining whether the current coordinate value has reached the limit coordinate value;
A component mounting apparatus, comprising: a movement restricting unit that restricts movement of the movable unit when at least an affirmative decision is made by the interference determining unit.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2007261221A JP4843590B2 (en) | 2007-10-04 | 2007-10-04 | Component mounting apparatus, control method, and program |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2007261221A JP4843590B2 (en) | 2007-10-04 | 2007-10-04 | Component mounting apparatus, control method, and program |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2009094160A true JP2009094160A (en) | 2009-04-30 |
| JP4843590B2 JP4843590B2 (en) | 2011-12-21 |
Family
ID=40665885
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2007261221A Active JP4843590B2 (en) | 2007-10-04 | 2007-10-04 | Component mounting apparatus, control method, and program |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4843590B2 (en) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2019069438A1 (en) * | 2017-10-06 | 2019-04-11 | 株式会社Fuji | SUBSTRATE WORKING SYSTEM |
| CN116917089A (en) * | 2021-02-18 | 2023-10-20 | 发那科株式会社 | Robot control device, robot control system and computer program |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2002094294A (en) * | 2000-09-18 | 2002-03-29 | Shibaura Mechatronics Corp | Substrate transfer device |
| JP2006066547A (en) * | 2004-08-25 | 2006-03-09 | Matsushita Electric Ind Co Ltd | Work rotational area determination device, work movement route determination device, and work movement route determination method |
-
2007
- 2007-10-04 JP JP2007261221A patent/JP4843590B2/en active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2002094294A (en) * | 2000-09-18 | 2002-03-29 | Shibaura Mechatronics Corp | Substrate transfer device |
| JP2006066547A (en) * | 2004-08-25 | 2006-03-09 | Matsushita Electric Ind Co Ltd | Work rotational area determination device, work movement route determination device, and work movement route determination method |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2019069438A1 (en) * | 2017-10-06 | 2019-04-11 | 株式会社Fuji | SUBSTRATE WORKING SYSTEM |
| JPWO2019069438A1 (en) * | 2017-10-06 | 2019-12-26 | 株式会社Fuji | Substrate work system |
| US11382246B2 (en) | 2017-10-06 | 2022-07-05 | Fuji Corporation | Substrate work system under adjustable rail spacing distance |
| CN116917089A (en) * | 2021-02-18 | 2023-10-20 | 发那科株式会社 | Robot control device, robot control system and computer program |
Also Published As
| Publication number | Publication date |
|---|---|
| JP4843590B2 (en) | 2011-12-21 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP3258764B1 (en) | Mounting device and control method for mounting device | |
| JP3624145B2 (en) | Electronic component mounting device | |
| US10293499B2 (en) | Movable robot | |
| EP3328181B1 (en) | Component mounting machine and component mounting system | |
| CN110520255B (en) | Robot device and method for manufacturing electronic apparatus | |
| US11833687B2 (en) | Robot apparatus, control method for the robot apparatus, assembly method using the robot apparatus, and recording medium | |
| JP6374189B2 (en) | Die bonder and bonding method | |
| JP4843590B2 (en) | Component mounting apparatus, control method, and program | |
| CN115039215B (en) | Substrate holding hand and substrate transfer robot | |
| JP4866832B2 (en) | Component mounting apparatus, control method, and program | |
| KR102671756B1 (en) | Robot control device | |
| JP4903731B2 (en) | Component mounting apparatus and control method | |
| JP5043693B2 (en) | Component mounting apparatus and control method | |
| JP2015195261A (en) | Die bonder and semiconductor manufacturing method | |
| US12269694B2 (en) | Controller | |
| CN109848968B (en) | Movement control method, device, equipment and system of grabbing device | |
| JP5430526B2 (en) | Control method of tandem press line | |
| JP2017027989A (en) | Component thickness measurement method and component mounting device | |
| JP4852513B2 (en) | Component mounting system | |
| JP3578118B2 (en) | Bonding apparatus and bonding method | |
| JP4932923B2 (en) | Parts transfer device | |
| JP4918015B2 (en) | Component mounting method | |
| CN111590323B (en) | Cutting and splinter integrated device and cutting and splinter control method | |
| JP4389868B2 (en) | Chip mounting apparatus and chip mounting method | |
| CN223211380U (en) | FPC picking device, robotic arm and production line |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20100108 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20110706 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110712 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110908 |
|
| 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: 20111004 |
|
| 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: 20111007 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 4843590 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: 20141014 Year of fee payment: 3 |