サーボプレス設備とその制御方法
【課題】搬送中のワークを落とすおそれが少なく、金型と搬送装置の機械的干渉を防ぐことができ、搬送装置がプレス機械との追従状態からはずれた位置で停止した場合でも、ワークを損傷することなく復帰動作が容易にできるサーボプレス設備とその制御方法を提供する。
【解決手段】サーボモータでスライドを駆動しその位置をリアルタイムに制御可能なプレス装置１０と、プレス装置にワークを搬入・搬出する搬送装置２０と、搬送装置の動作軌跡上での位置を検出し、プレス装置を搬送装置と機械的に干渉しないように制御する制御装置４０とを備える。制御装置４０は、取り付けられた金型１０４及びスライドが搬送装置と機械的に干渉しないスライドの位置範囲を計算するスライド位置計算手段４１を有し、このスライド位置計算手段により、機械的に干渉しないスライドの目標範囲を計算し、スライドの実際の位置が、目標範囲内に入るようにプレス装置を制御する。
【解決手段】サーボモータでスライドを駆動しその位置をリアルタイムに制御可能なプレス装置１０と、プレス装置にワークを搬入・搬出する搬送装置２０と、搬送装置の動作軌跡上での位置を検出し、プレス装置を搬送装置と機械的に干渉しないように制御する制御装置４０とを備える。制御装置４０は、取り付けられた金型１０４及びスライドが搬送装置と機械的に干渉しないスライドの位置範囲を計算するスライド位置計算手段４１を有し、このスライド位置計算手段により、機械的に干渉しないスライドの目標範囲を計算し、スライドの実際の位置が、目標範囲内に入るようにプレス装置を制御する。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、サーボモータでスライドを駆動するプレス装置とこのプレス装置にワークを搬入及び／又は搬出する搬送装置とを備えたサーボプレス設備とその制御方法に関する。
【背景技術】
【０００２】
プレス成型による生産を能率よく行うためにプレス装置にワークを搬入・搬出する搬送装置を付設する場合、ワークを成形加工する金型と搬送装置が衝突（干渉）しないように、プレス機械と搬送装置の互いの動きを制御する必要がある。
【０００３】
従来の制御手段では、主として機械プレス（クランクプレス、ナックルプレス、クランクレスプレス、リンクプレス、等）を対象としており、プレス自体の動作をマスターとしている。すなわち、例えば、クランクプレスの場合、スライドを駆動するクランク軸（主駆動軸）の回転に同期して、搬送装置が動作するという構成が取られている。なお、かかる制御手段の一例が特許文献１、２に開示されている。
【０００４】
一方、近年、サーボモータでスライドを駆動する種々のサーボプレス装置が、開発されている（例えば、特許文献３〜５）。
【０００５】
特許文献１の「プレス機械とロボットの同期装置」は、プレスが動作するエリアへの搬送装置の進入の許可・不許可を、スライドを駆動するクランク軸の角度に基づいて決めるものである。
【０００６】
特許文献２の「プレス用自動搬送制御方法および装置」は、スライドを駆動するクランク軸の回転角度に応じて時々刻々の搬送装置の目標位置が計算され、それに追従するように搬送装置が制御されるものである。
【０００７】
特許文献３の「サーボプレスの製造方法及びサーボプレス」は、クランクレス方式のサーボプレス装置を開示している。
特許文献４の「サーボモータ駆動式リンクプレス」は、リンクプレス方式のサーボプレス装置を開示している。
特許文献５の「プレス機械」は、スクリュー方式のサーボプレス装置を開示している。
【０００８】
【特許文献１】特許第３６４０３１６号明細書、「プレス機械とロボットの同期装置」
【特許文献２】特許第３３４００９５号明細書、「プレス用自動搬送制御方法および装置」
【特許文献３】特開２００６−２６３８０６号公報、「サーボプレスの製造方法及びサーボプレス」
【特許文献４】特開２００３−３２０４８９号公報、「サーボモータ駆動式リンクプレス」
【特許文献５】特開平１１−１９７８９７号公報、「プレス機械」
【発明の開示】
【発明が解決しようとする課題】
【０００９】
上述した特許文献３〜５のように、サーボモータでスライドを駆動するサーボプレス装置として、リンクプレスに限られず、他の形式（クランクプレス、ナックルプレス、クランクレスプレス、スクリュープレス、等）のサーボプレス装置の開発も進められている。
【００１０】
しかし、これらのサーボプレス装置にワークを搬入・搬出する搬送装置を付設する場合、特許文献１、２のように主駆動軸（例えばクランク軸）の回転をマスターとして、それに同期させて、搬送装置（搬入装置と搬出装置）を動作させると、以下の問題点があった。
【００１１】
（１）サーボプレス装置は、主駆動軸（例えばクランク軸）の回転速度を自在に変化させることができる特徴がある。従って、工程の中途で一時的に逆転することさえもできる。
しかし、搬送のスループットを向上させようとするときに、従来技術では、プレス機械の動作が決まっているため、搬送装置の動作を速くする必要がある。そのため、搬送装置の駆動機構が大型化したり、搬送中のワークの速度・加減速度が大きくなるため、大きな空気抵抗や慣性力が搬送装置及びワークに加わり、搬送中のワーク保持が不安定になりワークを落とす可能性が大きくなる。
（２）また、金型と搬送装置との間のクリアランスを小さくし、スライドの動作と搬送装置の動作との間の待ち時間及び無駄時間を減らすことも行われるが、搬送装置に異常が発生して意図した動きをしなくなった場合に、プレス機械は継続して動作しようとするので、金型と搬送装置が機械的に干渉して破損する可能性が高くなる。
（３）また、何らかの異常が発生して搬送装置がプレス機械との追従状態から外れた位置で停止した場合、再び搬送装置がプレス機械に追従して運転再開できるようにするため、プレス機械の位置を基準として、追従可能な位置まで搬送装置を動かす必要がある（この動作を「復帰動作」と呼ぶ）。
復帰動作を行うときには正常運転中と異なる軌跡、異なる速度、異なる加速度で搬送装置が動くので、搬送装置がワークを把持している場合、ワークを取り落としたり、ワークに異常な力を加えてワークを損傷する可能性がある。
（４）特に特許文献２の場合、クランク軸の回転には微小なふらつきが生じていることが多く、搬送装置がそれに忠実に追従しようとして搬送装置の動作が滑らかでなくなるため、搬送中のワークを落としてしまう可能性が高くなる。
【００１２】
本発明は上述した種々の問題点を解決するために創案されたものである。すなわち、本発明の目的は、サーボプレス装置にワークを搬入・搬出する搬送装置を付設する場合において、（１）搬送装置の動作を速くした場合でも、或いはクランク軸の回転に微小なふらつきが生じても、搬送中のワーク保持を安定にできワークを落とすおそれが少なく、（２）搬送装置に異常が発生して意図した動きをしなくなった場合でも、金型と搬送装置の機械的干渉を防ぐことができ、（３）何らかの異常が発生して搬送装置がプレス機械との追従状態からはずれた位置で停止した場合でも、ワークを取り落としたりワークに異常な力を加えてワークを損傷することなく、再び搬送装置がプレス機械に追従して運転再開できるようにする復帰動作が容易にできるサーボプレス設備とその制御方法を提供することにある。
【課題を解決するための手段】
【００１３】
本発明によれば、サーボモータでスライドを駆動しその位置をリアルタイムに制御可能なプレス装置と、該プレス装置にワークを搬入及び／又は搬出する搬送装置と、該搬送装置の動作軌跡上での位置を間欠的又は連続的に検出し、該プレス装置を搬送装置と機械的に干渉しないように制御する制御装置とを備える、ことを特徴とするサーボプレス設備が提供される。
【００１４】
本発明の好ましい実施形態によれば、前記制御装置は、搬送装置の検出された位置に対して、取り付けられた金型及び付属物を含むスライドが搬送装置と機械的に干渉しないスライドの位置又は位置範囲を計算するスライド位置計算手段を有し、
該スライド位置計算手段により、検出された搬送装置の位置に対しスライドの前記干渉しない位置又は位置範囲を計算し、これを目標位置又は目標範囲として、スライドの実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置を制御する。
【００１５】
また本発明によれば、サーボモータでスライドを駆動しその位置をリアルタイムに制御可能なプレス装置と、該プレス装置にワークを搬入及び／又は搬出する搬送装置とを備えたサーボプレス設備の制御方法であって、
搬送装置の動作軌跡上での位置を間欠的又は連続的に検出しプレス装置を搬送装置と機械的に干渉しないように制御する、ことを特徴とするサーボプレス設備の制御方法が提供される。
【００１６】
本発明の好ましい実施形態によれば、搬送装置の動作軌跡上での位置を間欠的又は連続的に検出する搬送位置検出ステップと、
搬送装置の検出された位置に対して、取り付けられた金型及び付属物を含むスライドが搬送装置と機械的に干渉しないスライドの位置又は位置範囲を計算するスライド位置計算ステップと、
計算されたスライドの前記干渉しない位置又は位置範囲を目標位置又は目標範囲として、スライドの実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置を制御するサーボプレス制御ステップとを有する。
【発明の効果】
【００１７】
上記本発明の装置及び方法によれば、搬送装置の動作軌跡は、速度や加速度が大きくなく搬送に適した軌跡とすることができるので、ワーク把持を安定化でき、搬送装置の駆動機構や駆動モータをむやみに大きくする必要性を回避できる。
【００１８】
また、搬送装置に異常が発生した場合、搬送装置との干渉を避けるようにスライドが動作するので、機械的干渉による搬送装置及びプレス機械の破損可能性を低減することができる。
【００１９】
また、異常停止からの復帰動作を行うとき、搬送装置の位置を基準としてプレス機械を動かして追従可能な位置へ移動させるので、復帰動作中にワークを把持している搬送装置は動く必要が無く、ワークを取り落としたり、ワークを損傷する可能性を低減できる。
【００２０】
さらに、搬送装置は制御装置の内部で生成する搬送装置固有の滑らかな動作軌跡で動作できるので、搬送装置がふらついたりすることがなく、搬送が安定して行える。
【発明を実施するための最良の形態】
【００２１】
以下、本発明の好ましい実施形態を図面を参照して説明する。なお、各図において共通する部分には同一の符号を付し、重複した説明を省略する。
【００２２】
図１は、本発明によるサーボプレス設備の第１実施形態図であり、搬送装置として多軸ロボットを使用する例を示す。この図において、本発明のサーボプレス設備は、プレス装置１０、搬送装置２０及び制御装置４０を備える。
【００２３】
プレス装置１０は、サーボモータ（メインモータ１０１）でスライド１０３を駆動し、その位置をリアルタイムに制御可能なサーボプレス装置である。
搬送装置２０は、プレス装置１０にワーク１を搬入及び搬出する装置である。
制御装置４０は、搬送装置２０を制御し、搬送装置２０の動作軌跡上での位置を間欠的又は連続的に検出し、プレス装置１０を制御する制御装置である。
制御装置４０は、搬送装置２０の検出された位置に対して、取り付けられた金型（上金型１０４）及び付属物を含むスライド１０３が搬送装置２０と機械的に干渉しないスライド１０３の位置又は位置範囲を計算するスライド位置計算手段４１を有する。
このスライド位置計算手段４１により、検出された搬送装置２０の位置に対しスライド１０３の干渉しない位置又は位置範囲を計算し、これを目標位置又は目標範囲として、スライド１０３の実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置１０を制御する。
【００２４】
図２は、本発明によるサーボプレス設備の制御方法を示すフロー図である。本発明の制御方法は、サーボモータ（メインモータ１０１）でスライド１０３を駆動しその位置をリアルタイムに制御可能なプレス装置１０と、プレス装置１０にワーク１を搬入及び搬出する搬送装置２０とを備えたサーボプレス設備の制御方法である。
本発明の制御方法では、搬送装置２０の動作軌跡上での位置を間欠的又は連続的に検出し、プレス装置１０を搬送装置２０と機械的に干渉しないように制御する。
【００２５】
すなわちこの図において、本発明の制御方法は、搬送位置検出ステップＳ１、スライド位置計算ステップＳ２、及びサーボプレス制御ステップＳ３の各ステップを有する。
搬送位置検出ステップＳ１では、搬送装置２０の動作軌跡上での位置を間欠的又は連続的に検出する。
スライド位置計算ステップＳ２では、搬送装置２０の検出された位置に対して、取り付けられた金型（上金型１０４）及び付属物を含むスライド１０３が搬送装置２０と機械的に干渉しないスライド１０３の位置又は位置範囲を計算する。なお、付属物とは、ダイクランパや配管などスライドに取り付けられていてスライドと一緒に動くもののことである。
サーボプレス制御ステップＳ３では、計算されたスライド１０３の干渉しない位置又は位置範囲を目標位置又は目標範囲として、スライドの実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置１０を制御する。
【００２６】
図１においてサーボプレス装置１０は、メインモータ１０１、スライド駆動機構１０２、スライド１０３、ボルスタ１０６、フレーム１０７及びエンコーダ１２１からなる。
【００２７】
メインモータ１０１の回転がスライド駆動機構１０２で直線動に変換されスライド１０３を上下動させる。スライド１０３には上金型１０４が取り付けられており、スライド１０３と共に上下動する。上金型１０４に対向して下金型１０５がボルスタ１０６に取り付けられている。上金型１０４に加わる荷重はスライド１０３とスライド駆動機構１０２を経由してフレーム１０７の上部で支持され、下金型１０５に加わる荷重はボルスタ１０６を経由してフレーム１０７の下部で支持される。
【００２８】
プレス成型の対象となるワーク１は上金型１０４と下金型１０５の間に挿入され、スライド１０３が下降して上金型１０４とワーク１と下金型１０５が接触すると、上金型１０４及び下金型１０５からワーク１に対してプレス成型力が発生する。
スライド駆動機構１０２としては、クランク方式、クランクレス方式、ナックル方式、リンク方式、スクリュー方式などがあり、例えば、特許文献３〜５に開示されている。
メインモータ１０１としては、誘導モータ、同期モータ、直流モータ等が使用可能である。また本発明では、制御性の優れたサーボモータを使用する。スライド１０３の位置を検出するために、メインモータ１０１の回転角を検出するエンコーダ１２１が設けられている。
【００２９】
図１において、制御装置４０は、メインモータ制御器１２２、メインモータアンプ１２３、スライド位置指令生成器１４１、及びロボットコントローラ２２１を備える。
【００３０】
メインモータ制御器１２２は、エンコーダ１２１が検出したメインモータ１０１の回転角をスライド駆動機構１０２の寸法及び構造に基づいて変換して得られるスライド１０３の現在位置と、スライド位置指令生成器１４１から与えられるスライド位置指令値とに基づいて、メインモータ１０１に対するトルク指令値を生成する。
【００３１】
メインモータアンプ１２３は、メインモータ１０１がトルク指令値に従ってトルクを発生するように、メインモータ１０１へ供給される電流、電圧、又は電力を変化させる。
【００３２】
以上の構成により、スライド位置指令生成器１４１からスライド位置指令値が時々刻々与えられると、それに追従してスライド１０３の位置が時々刻々変化するクローズドループ制御が行われる。
【００３３】
エンコーダ１２１としては、光学式エンコーダやレゾルバが使用可能である。メインモータアンプ１２３には、直流モータを使用する場合にはサイリスタレオナードやＩＧＢＴを使用したチョッパ方式、交流モータを使用する場合にはパワーＭＯＳＦＥＴやＩＧＢＴを使用したＰＷＭ方式のインバータ、等が使用できる。メインモータ制御器１２２の制御手段としては、ＰＩ、ＰＩＤ、ＩＰＤなどのフィードバック制御やフィードフォワード制御の組み合わせ等が使用できる。
【００３４】
図１において、搬送装置２０は、ワーク把持ツール２０１、多軸ロボット２０２、及びアーム先端部２０３からなる。
ワーク１を把持するためのワーク把持ツール２０１は、多軸ロボット２０２のアーム先端部２０３に取り付けられている。多軸ロボット２０２の各動作軸はモータ（図示せず）により駆動されており、ロボットコントローラ２２１から指令が与えられると、各動作軸のモータが適切に回転して、アーム先端部２０３の位置・姿勢を任意に動かすことができる。
【００３５】
ワーク把持ツール２０１はアーム先端部２０３に取り付けられているので、アーム先端部２０３の位置・姿勢を適切に動かすことにより、ワーク把持ツール２０１の位置・姿勢も任意に動かすことができ、ワーク把持ツール２０１でワーク１を把持して、プレス装置１０に搬入・搬出することができる。
ワーク把持ツール２０１としては、ワーク１を真空吸着する吸盤を取り付けたクロスバーや、ワーク１をはさみこむフィンガーなどが使用される。
【００３６】
ロボットコントローラ２２１からの指令に従ってロボットのアーム先端部２０３を任意の位置及び姿勢に動かす仕組みは、産業用ロボットで広く実用されている方式を使用可能である。
例えば、モータをＩＧＢＴやパワートランジスタを使用したＰＷＭ方式のアンプでモータを速度及びトルク可変に駆動し、モータの回転角を光学式エンコーダやパルスジェネレータで測定し、位置偏差を打ち消すようにフィードバック制御を行うクローズドループ方式を用いる。
【００３７】
この例において、搬送装置２０の動作軌跡上での位置の間欠的又は連続的検出は、ロボットコントローラ２２１による。
上述したスライド位置計算手段４１は、スライド位置指令生成器１４１に内蔵されており、このスライド位置計算手段４１により、検出された搬送装置２０の位置に対しスライド１０３の干渉しない位置又は位置範囲を計算する。
さらにロボットコントローラ２２１からスライド位置指令生成器１４１へ、多軸ロボット２０２が動作軌跡上のどの目標点（詳細は以下で説明）に到達したかを示す目標点到達信号２４１を送るようになっている。
【００３８】
図３は、搬送装置２０の動作軌跡の模式図である。動作軌跡に従った搬送装置２０の動作は以下のように実現される。
図３に示すように、動作軌跡は分割して目標点の列としてロボットコントローラ２２１に記憶されており、ロボットコントローラ２２１は、目標点１→目標点２→目標点３→…と順々にたどっていくように多軸ロボット２０２のモータを制御する。
【００３９】
すなわち、まず、多軸ロボット２０２を目標点１へ移動させるように制御し、多軸ロボット２０２が目標点１へ到達すると、今度は多軸ロボット２０２を目標点２へ移動させるように制御し、多軸ロボット２０２が目標点２へ到達すると、今度は多軸ロボット２０２を目標点３へ移動させるように制御し、というように順々に制御を行う。多軸ロボット２０２が目標点Ｎに到達したら、目標点１へ移動させるように制御して、以上の過程を繰り返すことにより、同一の動作軌跡上を繰り返し移動させることができる。
多軸ロボット２０２の動きと、アーム先端部２０３の位置及び姿勢と、ワーク把持ツール２０１の位置及び姿勢は、一定の関係を保っているので、以上のように多軸ロボット２０２が動作軌跡上を目標点１→目標点２→目標点３→と順々に移動させることにより、ワーク把持ツール２０１もある軌跡（動作軌跡から一意に決まる）上を移動する。
【００４０】
目標点のデータを生成する手段としては、それぞれの目標点ごとに、アーム先端部２０３の位置を人間が操作して教示し、そのときの多軸ロボット２０２の各動作軸のモータ回転角を光学式エンコーダやパルスジェネレータで測定して記憶しておくティーチングプレイバック方式や、それぞれの目標点ごとに、アーム先端部２０３の所望の位置に対応する各動作軸のモータ回転角を、多軸ロボット２０２のアーム長さや機構の寸法に基づきオフラインで計算により求める方式がある。
【００４１】
図４は、搬送装置の動作軌跡とスライドの目標位置軌跡との関係図である。
搬送装置２０の動作を基準として、プレス装置１０を以下のように追従動作させる。
【００４２】
スライド位置指令生成器１４１は、搬送装置の動作軌跡に対応するスライド１０３の目標位置軌跡を記憶している。具体的には、図４に示すように、多軸ロボット２０２の目標点１，２，３，…，Ｎに対応して、スライド１０３の目標位置１，２，３，…Ｎを記憶している。
ロボットコントローラ２２１からスライド位置指令生成器１４１へ、多軸ロボット２０２が目標点１に到達したことを示す目標点到達信号２４１が送られてくると、スライド位置指令生成器１４１は目標位置１をメインモータ制御器１２２へ出力する。
次に、多軸ロボット２０２が目標点２に到達したことを示す目標点到達信号２４１が送られてくると、目標位置２をメインモータ制御器１２２へ出力する。さらに、多軸ロボット２０２が目標点３に到達したことを示す目標点到達信号２４１が送られてくると、目標位置３をメインモータ制御器１２２へ出力する。
【００４３】
以下これを繰り返し、ロボットコントローラ２２１からスライド位置指令生成器１４１へ、多軸ロボット２０２が目標点Ｘに到達したことを示す目標点到達信号２４１が送られてくると、スライド位置指令生成器１４１は目標位置Ｘをメインモータ制御器１２２へ出力する。
【００４４】
メインモータ制御器１２２は、スライド１０３がスライド位置指令生成器１４１から与えられるスライド位置指令値に従って動くようにメインモータ１０１に対するトルク指令値を生成し、それに従ってメインモータアンプ１２３はメインモータ１０１へ供給される電流・電圧・電力を変化させるので、以上の手段により、搬送装置２０が動作軌跡に従って移動し、多軸ロボット２０２が目標点１，２，３，…，Ｎを通過するのに追従して、スライド１０３の位置が目標位置１，２，３，…，Ｎと変化していくような制御が行われる。
【００４５】
もし何らかの異常が発生して、プレス装置１０が搬送装置２０に追従する位置からずれた状態でプレス装置１０、搬送装置２０が停止した場合の復帰処理は以下のように行う。
スライド位置指令生成器１４１に多軸ロボット２０２が到達した最新の目標点（目標点Ｙと記述する）を記憶する機能を設けておき、スライド位置指令生成器１４１は目標点Ｙに対応する目標位置Ｙをメインモータ制御器１２２へ出力する。搬送装置２０（多軸ロボット２０２）を停止させたまま、プレス装置１０のスライド１０３を目標位置Ｙへ動かす。スライド１０３が目標位置Ｙへ移動したら、搬送装置２０を再起動させることにより、再びプレス装置１０が搬送装置２０に追従動作する。
【００４６】
以上で説明した手段の場合、搬送装置２０の動作に対しプレス装置１０の動作が若干遅れる可能性があるが、多軸ロボット２０２が目標点Ｘに到達したときに、プレス装置１０は目標位置Ｘと目標位置Ｘ＋１の間の適当な点（もしくは目標位置Ｘ＋１）を目標位置とすることにより遅れを補正することが可能である。
同様に、復帰動作においても、目標位置Ｙのかわりに目標位置Ｙと目標位置Ｙ＋１の間の適当な点（もしくは目標位置Ｙ＋１）を目標位置とすることが可能である。
【００４７】
また、以上で説明した手段では、プレス装置１０の動作が常に搬送装置２０の動作に追従しているが、プレス装置１０と搬送装置２０の動作サイクルの一部分、特に、スライド１０３が下降して上金型１０４と下金型１０５がワーク１を成型加工している時間帯では、搬送装置２０はプレス装置１０から離れており、機械的に干渉する可能性がない。このような時間帯には、プレス装置１０が搬送装置２０に追従する必要はなく、プレス装置１０のスライド１０３が搬送装置２０と無関係に適当な速度（例えば、ワーク１の成型加工に適した速度）で動作するように、スライド位置指令生成器１４１がスライド位置指令を生成してよい。
【００４８】
プレス装置１０に対し、ワーク搬入用とワーク搬出用にそれぞれ独立した搬送装置２０が設置されるときは、以下のようにすればよい。
ワーク搬入用搬送装置がワークをプレスに搬入している時間帯にはプレス装置１０は搬入用搬送装置の動作に追従し、搬入用搬送装置の動作軌跡上の目標点に対応してスライド目標位置を決める。ワーク搬出用搬送装置がワークをプレスから搬出している時間帯にはプレス装置１０は搬出用搬送装置の動作に追従し、搬出用搬送装置の動作軌跡上の目標点に対応してスライド目標位置を決める。
【００４９】
搬送装置２０の動作軌跡、及びスライド１０３の目標位置移動軌跡は、多軸ロボット２０２やワーク把持ツール２０１の性能（例えばモータの回転数、駆動トルク、発熱の制限や機構の強度）、及びプレス装置１０の性能の範囲内で、プレス機械と搬送装置が機械的に干渉しないように決定する。干渉チェック機能を有する３次元ＣＡＤを使ってオフラインで決定する手段や、実際に搬送装置とプレス機械を動作させてみてオンラインで決定していく手段などがある。
【００５０】
上述した実施形態では、搬送装置がロボットで構成されている例を示したが、図３に示すように目標点の列を順次たどっていく手段で制御される搬送装置であれば、ロボットに限らず任意の搬送装置に上述した実施形態を適用可能である。
【００５１】
図５は、本発明によるサーボプレス設備の第２実施形態図であり、搬送装置として、搬送マスター信号に同期して搬送装置の各モーション軸が動作する例を示す。
この図に示すように、本発明のサーボプレス設備は、プレス装置１０、搬送装置３０、及び制御装置４０を備える。
【００５２】
プレス装置１０は、サーボモータ（メインモータ１０１）でスライド１０３を駆動し、その位置をリアルタイムに制御可能なプレス機械である。
搬送装置３０は、プレス装置１０にワーク１を搬入及び搬出する装置である。
制御装置４０は、搬送装置３０を制御し、搬送装置３０の動作軌跡上での位置を間欠的又は連続的に検出しプレス装置１０を制御する制御装置である。
制御装置４０は、搬送装置３０の検出された位置に対して、取り付けられた金型（上金型１０４）及び付属物を含むスライド１０３が搬送装置３０と機械的に干渉しないスライド１０３の位置又は位置範囲を計算するスライド位置計算手段４１を有する。
このスライド位置計算手段４１により、検出された搬送装置３０の位置に対しスライド１０３の干渉しない位置又は位置範囲を計算し、これを目標位置又は目標範囲として、スライド１０３の実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置１０を制御する。
【００５３】
プレス装置１０の構成は、制御装置４０にスライド位置許容範囲計算器１３１（説明は後述する）が追加された以外は第１実施形態と同じであるので説明を略す。各構成要素に付した番号も第１実施形態と同じである。
上述したスライド位置計算手段４１は、スライド位置許容範囲計算器１３１に内蔵されている。
【００５４】
図５において、搬送装置３０は、ワーク把持ツール３０１、キャリッジ３０２、フィード機構３０３、フィードモータ３０４、リフト機構３０５、リフトモータ３０６、フィードエンコーダ３２１、及びリフトエンコーダ３２４からなる。
【００５５】
ワーク１を把持するためのワーク把持ツール３０１は、キャリッジ３０２から支持されている。キャリッジ３０２をフィード方向（図中の左右方向）に動かすためのフィード機構３０３がフィードモータ３０４により駆動され、キャリッジ３０２をリフト方向（図中の上下方向）に動かすためのリフト機構３０５がリフトモータ３０６により駆動される。
【００５６】
フィード機構やリフト機構としては、モータの回転をボールスクリューで直線動に変える手段や、モータの回転をギアで減速し、ピニオンラック方式により直線動に変える手段などがある。
【００５７】
図５において、制御装置４０は、上述したメインモータ制御器１２２、メインモータアンプ１２３、及びスライド位置指令生成器１４１の他に、スライド位置許容範囲計算１３１、フィードモータ制御器３２２、フィードモータアンプ３２３、リフトモータ制御器３２５、リフトモータアンプ３２６、搬送マスター信号発生器３４１、搬送装置位置指令生成器３４３、及び、搬送装置位置計算器３５１を備える。
【００５８】
搬送装置３０が希望する動作状態（正転、逆転、サイクルタイム変化など）に応じて動作軌跡に従って移動できるようにするため、搬送マスター信号発生器３４１が設けられており、希望する動作状態に応じて、時間変化する搬送マスター信号３４２を発生し、搬送装置位置指令生成器３４３へ出力する。
【００５９】
搬送装置位置指令生成器３４３は、動作軌跡を示す情報、すなわち、搬送マスター信号３４２と搬送装置位置指令値（本例では、フィードとリフトの位置指令値）との関係、すなわちモーションカーブを記憶しており、入力された搬送マスター信号３４２の値に対応するフィードとリフトの位置指令値を、それぞれフィードモータ制御器３２２とリフトモータ制御器３２５へ出力する。
【００６０】
図６は、搬送マスター信号と搬送装置の関係図である。この図において、（Ａ）は経過時間と搬送マスター信号の関係、（Ｂ）は搬送マスター信号とフィード位置指令値及びフィード位置との関係、（Ｃ）は搬送マスター信号とリフト位置指令値及びリフト位置との関係を示す。
【００６１】
例えば、搬送装置３０を一定のサイクルタイムで動作軌跡に沿って正転させたい場合、図６に示すように、搬送マスター信号発生器３４１は搬送装置３０のサイクルタイムＴを周期とし、周期内では一定レートで増加する搬送マスター信号３４２を発生する。
搬送装置位置指令生成器３４３は、フィードのモーションカーブに基づき、搬送マスター信号３４２に対応するフィード位置指令値を計算し、フィードモータ制御器３２２へ出力する。また、リフトのモーションカーブに基づき、搬送マスター信号３４２に対応するリフト位置指令値を計算し、リフトモータ制御器３２５へ出力する。
【００６２】
搬送装置位置指令生成器３４３にモーションカーブを保持させる手段としては、適当な間隔でサンプルした値をテーブルで記憶しその間を多項式やスプラインで補間する手段、カーブの全体もしくは適当に分割した区間ごとに関数で表現する手段などがある。
【００６３】
図７は、搬送装置の作動状態と搬送マスター信号の関係を示す図である。この図において、（Ａ）（Ｂ）（Ｃ）（Ｄ）はそれぞれ搬送装置の異なる作動状態における搬送マスター信号の時間に対する変化パターンを示す。
搬送装置３０を異なる動作状態で動かしたいときは、搬送マスター信号発生器３４１が発生する搬送マスター信号３４２の時間に対する変化パターンを変える。
例えば、搬送装置のサイクルタイムを変化させたい場合には、図７（Ａ）に示すように毎周期ごとに１周期の時間を変化させたり、図７（Ｂ）に示すように搬送マスター信号３４２の変化レートを連続的に変化させることにより実現できる。搬送装置３０を一時的に停止させたい場合には、図７（Ｃ）に示すように、搬送マスター信号３４２の変化レートをゼロにすれば、フィード方向位置指令値・リフト方向位置指令値は変化しなくなり、搬送装置３０は停止する。
搬送装置３０を動作軌跡に沿って逆転したい場合には、図７（Ｄ）に示すように、搬送マスター信号３４２を減少させればよい。
【００６４】
以上で説明したように生成されたフィード位置指令値・リフト位置指令値に対し、搬送装置３０の実際のフィード位置・リフト位置が一致するように、以下のように制御が行われる。
【００６５】
キャリッジ３０２のフィード（図中の左右方向）の位置を検出するために、フィードモータ３０４の回転角を検出するフィードエンコーダ３２１が設けられている。フィードモータ制御器３２２は、フィードエンコーダ３２１が検出したフィードモータ３０４の回転角をフィード機構３０３の寸法・構造に基づいて変換して得られるキャリッジ３０２のフィード位置と、搬送装置位置指令生成器３４３から与えられるフィード位置指令値とに基づいて、フィードモータ３０４に対するトルク指令値を生成する。フィードモータアンプ３２３は、フィードモータ３０４がトルク指令値に従ってトルクを発生するように、フィードモータ３０４へ供給される電流・電圧・電力を変化させる。リフト（図中の上下方向）に対しても、同様の構成と作用を有するリフトエンコーダ３２４、リフトモータ制御器３２５、リフトモータアンプ３２６が設けられている。
【００６６】
以上の構成により、搬送装置位置指令生成器３４３から搬送装置位置指令値（この例では、フィードとリフトの位置指令値）が時々刻々与えられると、それに追従してキャリッジ３０２の位置（本例では、フィードとリフトの位置）が時々刻々変化するクローズドループ制御が行われる。ワーク把持ツール３０１はキャリッジ３０２と一定の位置関係を保つように保持されているので、把持ツール３０１の位置も搬送装置位置指令生成器３４３から与えられる搬送装置位置指令値に追従し、搬送装置位置指令生成器３４３に記憶された搬送マスター信号３４２と搬送装置位置指令値との関係に従って、動作軌跡上を動く。
【００６７】
上述したスライド位置計算手段４１は、スライド位置許容範囲計算器１３１に内蔵されている。
フィードエンコーダ３２１とリフトエンコーダ３２４で測定されたフィードとリフトの位置は搬送装置位置計算器３５１に入力される。搬送装置位置計算器３５１は、搬送装置の機構的寸法（キャリッジ３０２の駆動機構やワーク把持ツール３０１の機構的寸法や相互の位置関係）に基づいて、時々刻々の搬送装置位置を計算し、搬送装置位置信号３５２としてスライド位置許容範囲計算器１３１へ出力する。
搬送装置位置としては、搬送装置上の適当なポイント、例えばキャリッジ位置やワーク把持ツール位置を使用することができる。搬送装置上の複数のポイントを複合して、例えばキャリッジ位置とワーク把持ツール位置をペアにして搬送装置位置としてもよい。
【００６８】
スライド位置許容範囲計算器１３１は、内蔵するスライド位置計算手段４１により、検出された搬送装置３０の位置に対しスライド１０３の位置又は位置範囲を計算し、これを目標位置又は目標範囲として、スライド１０３の実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置１０を制御する。
すなわちスライド位置許容範囲計算器１３１は、搬送装置位置信号３５２で示される搬送装置位置に対し、スライド１０３及びそれに固定されている上金型１０４（もしスライド１０３といっしょに動く他の付属物があればそれも含め）が機械的に干渉しないスライド１０３の位置の範囲を計算し、スライド位置許容範囲信号１３２としてスライド位置指令生成器１４１へ出力する。
【００６９】
スライド位置指令生成器１４１は、スライド位置許容範囲１３２の範囲内でスライド１０３の位置指令値を生成しメインモータ制御器１２２へ出力する。
【００７０】
以上説明したように生成されたスライド位置指令値に対し、プレス装置１０のスライド１０３の実際の位置が一致するように、第１実施形態と同様に、エンコーダ１２１、メインモータ制御器１２２、メインモータアンプ１２３、及びメインモータ１０１によるクローズドループ制御が行われる。
【００７１】
プレス装置１０、搬送装置３０のいずれにおいても、エンコーダ１２１，３２１，３２４としては、光学式エンコーダやレゾルバが使用可能である。モータアンプ１２３，３２３，３２６には、直流モータを使用する場合にはサイリスタレオナードやＩＧＢＴを使用したチョッパ方式、交流モータを使用する場合にはパワートランジスタやパワーＭＯＳＦＥＴやＩＧＢＴを使用したＰＷＭ方式のインバータ、等が使用できる。モータ制御器１２２，３２２，３２５の制御方法としては、ＰＩ、ＰＩＤ、ＩＰＤなどのフィードバック制御やフィードフォワード制御の組み合わせ等が使用できる。
ワーク把持ツール３０１としては、ワーク１を真空吸着する吸盤を取り付けたクロスバーや、ワーク１をはさみこむフィンガーなどが使用できる。
【００７２】
図８は、フィード位置・リフト位置とスライド位置許容範囲の関係図である。この図において、Ａ１はフィード位置がＦ１、リフト位置がＬ１のときに、搬送装置とプレス機械（プレス装置１０）が干渉しないスライド位置許容範囲を示す。同様にＡ２，Ａ３はそれぞれフィード位置がＦ２，Ｆ３、リフト位置がＬ２，Ｌ３のときに、搬送装置３０とプレス装置１０が干渉しないスライド位置許容範囲を示す。
【００７３】
搬送装置３０の動作を基準としてプレス装置１０が追従動作するように、以下のようにスライド位置指令値を生成する。
搬送装置３０が動作するにつれ、搬送装置位置計算器３５１から搬送装置位置信号３５２がスライド位置許容範囲計算器１３１へ入力される。例えば、搬送装置位置信号３５２としてキャリッジ３０２のフィード位置・リフト位置を用いるものとすると、スライド位置許容範囲計算器１３１は、図８に示すように、時々刻々のキャリッジ３０２のフィード位置・リフト位置に対して、搬送装置３０とプレス装置１０が機械的に干渉しないようなスライド１０３の位置を計算しスライド位置許容範囲信号１３２として出力する。
【００７４】
スライド位置許容範囲の計算手段としては、例えば、あらかじめプレス装置１０（金型及び付属物を含む）と搬送装置の寸法形状を３Ｄ−ＣＡＤに入力して計算したり、搬送装置３０とプレス装置１０を手動でゆっくり動作させて現物あわせで測定することにより、さまざまな搬送装置位置に対し機械的干渉が生じないスライド１０３の高さ範囲をあらかじめ求めてテーブルに格納しておき、テーブルを参照して（必要があれば補間を行って）スライド位置許容範囲を求める手段や、プレス装置１０（金型及び付属物を含む）・搬送装置の寸法形状のデータがスライド位置許容範囲計算器１３１に格納されており、スライド位置許容範囲をリアルタイムに計算する手段がある。
【００７５】
さらに異なる手段として、ワーク把持ツール３０１やキャリッジ３０２に光学式距離計や短距離用レーザやスポット光方式のレーザ距離計を取り付けて、スライド１０３や上金型１０４までの距離を時々刻々測定することにより、搬送装置３０とプレス装置１０が機械的に干渉しない余裕距離を計算してスライド位置許容範囲に換算する手段もある。
【００７６】
図９は、スライド位置許容範囲とスライド位置指令値の関係図である。この図において、Ｈはスライド位置許容範囲の上限の時間変化、Ｌはスライド位置許容範囲の下限の時間、Ａは変化時刻ｔにおけるスライド位置許容範囲、Ｂ１〜Ｂ５はスライド位置指令値の変化を示している。
【００７７】
スライド位置指令生成器１４１は、スライド位置許容範囲信号１３２が示すスライド位置許容範囲Ａ内で、適切なスライド位置指令値Ｂ（Ｂ１〜Ｂ５）を生成する。
例えば、ワーク１をプレス成型するためにスライド１０３が下降中であるが上金型１０４がワーク１にまだ接触していない間は、できるだけ高速で下降することが望ましいので、図９（Ａ）に示すように、もしスライド１０３の位置がスライド位置許容範囲内であればメインモータ１０１の性能が許す限りできるだけ高速にスライド１０３を下降させるようなスライド位置指令値Ｂ１とし、もしスライド１０３の位置がスライド位置許容範囲の下限に引っかかるのであれば、スライド位置許容範囲の下限をスライド位置指令値Ｂ２とすればよい。スライド１０３の位置がスライド位置許容範囲の上限に引っかかる場合は、異常と考えられ、搬送装置３０をすぐに停止する異常処理を行えばよい。
【００７８】
上金型１０４がワーク１と接触しプレス成型加工を行っている間は、もしスライド１０３の位置がスライド位置許容範囲信号１３２の示すスライド位置許容範囲内であれば、図９（Ｂ）に示すように、プレス成型加工に適した速度でスライド１０３が動くようなスライド位置指令値Ｂ３とすればよい。
また図９（Ａ）又は図９（Ｃ）と同様、もしスライド１０３の位置がスライド位置許容範囲の下限もしくは上限に引っかかるのであれば、スライド位置許容範囲の下限もしくは上限をスライド位置指令値とすればよいが、プレス成型加工中には搬送装置３０はプレス装置１０と干渉しない位置にいることが普通であり、普通はスライド１０３の位置がスライド位置許容範囲の下限もしくは上限に引っかかることはない。
【００７９】
プレス成型加工が終了した後は、できるだけ高速でスライド１０３を上昇させることが望ましいので、図９（Ｃ）に示すように、もしスライド１０３の位置がスライド位置許容範囲信号１３２の示すスライド位置許容範囲内であればメインモータ１０１の性能が許す限りできるだけ高速にスライド１０３を上昇させるようなスライド位置指令値Ｂ４とし、もしスライド１０３の位置がスライド位置許容範囲の上限に引っかかるのであれば、スライド位置許容範囲の上限をスライド位置指令値Ｂ５とすればよい。スライド１０３の位置がスライド位置許容範囲の下限に引っかかる場合は、異常と考えられ、搬送装置３０をすぐに停止する異常処理を行えばよい。
【００８０】
もし何らかの異常が発生して、プレス装置１０が搬送装置３０に追従する位置からずれた状態でプレス装置１０、搬送装置３０が停止した場合の復帰処理は以下のように行う。停止位置におけるフィードエンコーダ３２１，リフトエンコーダ３２４の測定値に基づいて、搬送装置位置計算器３５１は搬送装置位置を計算して搬送装置位置信号３５２として出力するので、それに対応したスライド位置許容範囲をスライド位置許容範囲計算器１３１で計算し、スライド１０３の位置が計算されたスライド位置許容範囲内に入るまでプレス装置１０のみ動かす。スライド１０３がスライド位置許容範囲内に入ったら、搬送装置３０を再起動させることにより、再びプレス装置１０が搬送装置３０に追従動作する。
【００８１】
プレス装置１０に対し、ワーク搬入用とワーク搬出用に独立した搬送装置が設置されるときは、以下のようにすればよい。搬入用ワーク搬送装置と搬出用ワーク搬送装置のそれぞれに対し、図５に示す３０１〜３０６、３２１〜３２６、３４１〜３４３、３５１、３５２に相当する要素を独立に設ける。
搬入用搬送装置がワークをプレスに搬入している時間帯は、スライド位置許容範囲計算器１３１への入力として、搬入用搬送装置からの搬送装置位置信号を用い、搬出用搬送装置がワークをプレスから搬出している時間帯は、スライド位置許容範囲計算器１３１への入力として、搬出用搬送装置からの搬送装置位置信号を用いる。
【００８２】
搬送装置３０の動作軌跡は、ワーク把持ツール３０１を含む搬送装置３０の性能（例えばモータの回転数・駆動トルク・発熱の制限や機構の強度）の範囲内で、ワークを取り落としたりすることがなく、かつプレス機械もメインモータの性能の範囲内で動くことが可能であり機械的な干渉が生じないように決定する。干渉チェック機能を有する３次元ＣＡＤを使ってオフラインで決定する手段や、実際に搬送装置とプレス機械を動作させてみてオンラインで決定していく手段などがある。
【００８３】
この第２実施形態では、搬送装置がフィードとリフトの２動作軸を有する場合の例を示したが、図６に示すように搬送マスター信号に基づいてモーションカーブに追従するように制御される搬送装置であれば、任意の構成、構造、動作軸数の搬送装置にこの第２実施形態を適用可能である。例えば、フィードとリフトとクランプを有する３次元トランスファー機構や、ドッピン式と称されるようなリンク式のローダー、各種の産業用ロボットの機構、などが使用可能である。搬入側と搬出側で機構が異なっていてもよい。
【００８４】
（第１実施形態、第２実施形態に共通）
第１、第２実施形態ではプレス機械と搬送装置が１台ずつの場合を示したが、以下のようにすることにより、複数のプレス機械と搬送装置で生産ラインを構成する場合にも本発明を適用可能である。
【００８５】
第１実施形態の場合、各プレス機械ごとにスライド位置指令生成器、各搬送装置ごとにロボットコントローラを設け、各プレス機械は、ワーク搬入が行われている間はワークを搬入している搬送装置の動作軌跡に追従するようにスライド目標位置を生成し、ワーク搬出が行われている間はワークを搬出している搬送装置の動作軌跡に追従するようにスライド目標位置を生成するようにすればよい。
【００８６】
第２実施形態の場合、各プレス機械ごとにスライド位置許容範囲計算器・スライド位置指令生成器、各搬送装置ごとに搬送マスター信号発生器・搬送装置位置指令生成器・搬送装置位置計算器を設け、各プレス機械は、ワーク搬入が行われている間はワークを搬入している搬送装置からの搬送装置位置信号に基づいてスライド位置許容範囲を決定し、ワーク搬出が行われている間はワークを搬出している搬送装置からの搬送装置位置信号に基づいてスライド位置許容範囲を決定するようにすればよい。
いずれの場合にも、各搬送装置、各プレス機械は、一台ずつ異なる動作軌跡・スライド移動軌跡で動かすことが可能である。
【００８７】
上述した実施形態では、モータの回転を機構的にスライドの直線動に変換するサーボプレスを示したが、リニアモータを使用してスライドを駆動するサーボプレスにも適用可能である。
【００８８】
上述した実施形態では、スライドやフィード・リフトの位置検出手段として、モータの回転角をエンコーダで検出し、スライドやフィード・リフト駆動機構の寸法に基づいてスライドやフィード・リフトの位置に変換する例を示したが、スライドやフィード・リフトの位置を光学式リニアスケールや磁歪式リニアエンコーダで直接検出する手段も可能である。
【００８９】
上述した実施形態では、エンコーダをモータ軸に取り付ける例を示したが、モータで駆動される機構の側にロータリーエンコーダないしリニアエンコーダを設けて位置を検出する手段も可能である。
【００９０】
上述した本発明の装置及び方法によれば、搬送装置２０，３０の動作軌跡は、速度や加速度が大きくなく搬送に適した軌跡とすることができるので、ワーク把持を安定化でき、搬送装置２０，３０の駆動機構や駆動モータをむやみに大きくする必要性を回避できる。
【００９１】
また、搬送装置２０，３０に異常が発生した場合、搬送装置２０，３０との干渉を避けるようにスライド１０３が動作するので、機械的干渉による搬送装置及びプレス機械の破損可能性を低減することができる。
【００９２】
また、異常停止からの復帰動作を行うとき、搬送装置２０，３０の位置を基準としてプレス機械１０を動かして追従可能な位置へ移動させるので、復帰動作中にワークを把持している搬送装置は動く必要が無く、ワークを取り落としたりワークを損傷する可能性を低減できる。
【００９３】
さらに、搬送装置２０，３０は制御装置の内部で生成する搬送装置固有の滑らかな動作軌跡で動作できるので、搬送装置がふらついたりすることがなく、搬送が安定して行える。
【００９４】
なお、本発明は上述した実施の形態に限定されず、本発明の要旨を逸脱しない範囲で種々の変更を加え得ることは勿論である。
【図面の簡単な説明】
【００９５】
【図１】本発明によるサーボプレス設備の第１実施形態図である。
【図２】本発明によるサーボプレス設備の制御方法を示すフロー図である。
【図３】搬送装置２０の動作軌跡の模式図である。
【図４】搬送装置の動作軌跡とスライドの目標位置軌跡との関係図である。
【図５】本発明によるサーボプレス設備の第２実施形態図である。
【図６】搬送マスター信号と搬送装置の関係図である。
【図７】搬送装置の作動状態と搬送マスター信号の関係を示す図である。
【図８】フィード位置・リフト位置とスライド位置許容範囲の関係図である。
【図９】スライド位置許容範囲とスライド位置指令値の関係図である。
【符号の説明】
【００９６】
１ ワーク、
１０ プレス装置（サーボプレス装置）、
２０，３０ 搬送装置、
４０ 制御装置、
４１ スライド位置計算手段
【技術分野】
【０００１】
本発明は、サーボモータでスライドを駆動するプレス装置とこのプレス装置にワークを搬入及び／又は搬出する搬送装置とを備えたサーボプレス設備とその制御方法に関する。
【背景技術】
【０００２】
プレス成型による生産を能率よく行うためにプレス装置にワークを搬入・搬出する搬送装置を付設する場合、ワークを成形加工する金型と搬送装置が衝突（干渉）しないように、プレス機械と搬送装置の互いの動きを制御する必要がある。
【０００３】
従来の制御手段では、主として機械プレス（クランクプレス、ナックルプレス、クランクレスプレス、リンクプレス、等）を対象としており、プレス自体の動作をマスターとしている。すなわち、例えば、クランクプレスの場合、スライドを駆動するクランク軸（主駆動軸）の回転に同期して、搬送装置が動作するという構成が取られている。なお、かかる制御手段の一例が特許文献１、２に開示されている。
【０００４】
一方、近年、サーボモータでスライドを駆動する種々のサーボプレス装置が、開発されている（例えば、特許文献３〜５）。
【０００５】
特許文献１の「プレス機械とロボットの同期装置」は、プレスが動作するエリアへの搬送装置の進入の許可・不許可を、スライドを駆動するクランク軸の角度に基づいて決めるものである。
【０００６】
特許文献２の「プレス用自動搬送制御方法および装置」は、スライドを駆動するクランク軸の回転角度に応じて時々刻々の搬送装置の目標位置が計算され、それに追従するように搬送装置が制御されるものである。
【０００７】
特許文献３の「サーボプレスの製造方法及びサーボプレス」は、クランクレス方式のサーボプレス装置を開示している。
特許文献４の「サーボモータ駆動式リンクプレス」は、リンクプレス方式のサーボプレス装置を開示している。
特許文献５の「プレス機械」は、スクリュー方式のサーボプレス装置を開示している。
【０００８】
【特許文献１】特許第３６４０３１６号明細書、「プレス機械とロボットの同期装置」
【特許文献２】特許第３３４００９５号明細書、「プレス用自動搬送制御方法および装置」
【特許文献３】特開２００６−２６３８０６号公報、「サーボプレスの製造方法及びサーボプレス」
【特許文献４】特開２００３−３２０４８９号公報、「サーボモータ駆動式リンクプレス」
【特許文献５】特開平１１−１９７８９７号公報、「プレス機械」
【発明の開示】
【発明が解決しようとする課題】
【０００９】
上述した特許文献３〜５のように、サーボモータでスライドを駆動するサーボプレス装置として、リンクプレスに限られず、他の形式（クランクプレス、ナックルプレス、クランクレスプレス、スクリュープレス、等）のサーボプレス装置の開発も進められている。
【００１０】
しかし、これらのサーボプレス装置にワークを搬入・搬出する搬送装置を付設する場合、特許文献１、２のように主駆動軸（例えばクランク軸）の回転をマスターとして、それに同期させて、搬送装置（搬入装置と搬出装置）を動作させると、以下の問題点があった。
【００１１】
（１）サーボプレス装置は、主駆動軸（例えばクランク軸）の回転速度を自在に変化させることができる特徴がある。従って、工程の中途で一時的に逆転することさえもできる。
しかし、搬送のスループットを向上させようとするときに、従来技術では、プレス機械の動作が決まっているため、搬送装置の動作を速くする必要がある。そのため、搬送装置の駆動機構が大型化したり、搬送中のワークの速度・加減速度が大きくなるため、大きな空気抵抗や慣性力が搬送装置及びワークに加わり、搬送中のワーク保持が不安定になりワークを落とす可能性が大きくなる。
（２）また、金型と搬送装置との間のクリアランスを小さくし、スライドの動作と搬送装置の動作との間の待ち時間及び無駄時間を減らすことも行われるが、搬送装置に異常が発生して意図した動きをしなくなった場合に、プレス機械は継続して動作しようとするので、金型と搬送装置が機械的に干渉して破損する可能性が高くなる。
（３）また、何らかの異常が発生して搬送装置がプレス機械との追従状態から外れた位置で停止した場合、再び搬送装置がプレス機械に追従して運転再開できるようにするため、プレス機械の位置を基準として、追従可能な位置まで搬送装置を動かす必要がある（この動作を「復帰動作」と呼ぶ）。
復帰動作を行うときには正常運転中と異なる軌跡、異なる速度、異なる加速度で搬送装置が動くので、搬送装置がワークを把持している場合、ワークを取り落としたり、ワークに異常な力を加えてワークを損傷する可能性がある。
（４）特に特許文献２の場合、クランク軸の回転には微小なふらつきが生じていることが多く、搬送装置がそれに忠実に追従しようとして搬送装置の動作が滑らかでなくなるため、搬送中のワークを落としてしまう可能性が高くなる。
【００１２】
本発明は上述した種々の問題点を解決するために創案されたものである。すなわち、本発明の目的は、サーボプレス装置にワークを搬入・搬出する搬送装置を付設する場合において、（１）搬送装置の動作を速くした場合でも、或いはクランク軸の回転に微小なふらつきが生じても、搬送中のワーク保持を安定にできワークを落とすおそれが少なく、（２）搬送装置に異常が発生して意図した動きをしなくなった場合でも、金型と搬送装置の機械的干渉を防ぐことができ、（３）何らかの異常が発生して搬送装置がプレス機械との追従状態からはずれた位置で停止した場合でも、ワークを取り落としたりワークに異常な力を加えてワークを損傷することなく、再び搬送装置がプレス機械に追従して運転再開できるようにする復帰動作が容易にできるサーボプレス設備とその制御方法を提供することにある。
【課題を解決するための手段】
【００１３】
本発明によれば、サーボモータでスライドを駆動しその位置をリアルタイムに制御可能なプレス装置と、該プレス装置にワークを搬入及び／又は搬出する搬送装置と、該搬送装置の動作軌跡上での位置を間欠的又は連続的に検出し、該プレス装置を搬送装置と機械的に干渉しないように制御する制御装置とを備える、ことを特徴とするサーボプレス設備が提供される。
【００１４】
本発明の好ましい実施形態によれば、前記制御装置は、搬送装置の検出された位置に対して、取り付けられた金型及び付属物を含むスライドが搬送装置と機械的に干渉しないスライドの位置又は位置範囲を計算するスライド位置計算手段を有し、
該スライド位置計算手段により、検出された搬送装置の位置に対しスライドの前記干渉しない位置又は位置範囲を計算し、これを目標位置又は目標範囲として、スライドの実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置を制御する。
【００１５】
また本発明によれば、サーボモータでスライドを駆動しその位置をリアルタイムに制御可能なプレス装置と、該プレス装置にワークを搬入及び／又は搬出する搬送装置とを備えたサーボプレス設備の制御方法であって、
搬送装置の動作軌跡上での位置を間欠的又は連続的に検出しプレス装置を搬送装置と機械的に干渉しないように制御する、ことを特徴とするサーボプレス設備の制御方法が提供される。
【００１６】
本発明の好ましい実施形態によれば、搬送装置の動作軌跡上での位置を間欠的又は連続的に検出する搬送位置検出ステップと、
搬送装置の検出された位置に対して、取り付けられた金型及び付属物を含むスライドが搬送装置と機械的に干渉しないスライドの位置又は位置範囲を計算するスライド位置計算ステップと、
計算されたスライドの前記干渉しない位置又は位置範囲を目標位置又は目標範囲として、スライドの実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置を制御するサーボプレス制御ステップとを有する。
【発明の効果】
【００１７】
上記本発明の装置及び方法によれば、搬送装置の動作軌跡は、速度や加速度が大きくなく搬送に適した軌跡とすることができるので、ワーク把持を安定化でき、搬送装置の駆動機構や駆動モータをむやみに大きくする必要性を回避できる。
【００１８】
また、搬送装置に異常が発生した場合、搬送装置との干渉を避けるようにスライドが動作するので、機械的干渉による搬送装置及びプレス機械の破損可能性を低減することができる。
【００１９】
また、異常停止からの復帰動作を行うとき、搬送装置の位置を基準としてプレス機械を動かして追従可能な位置へ移動させるので、復帰動作中にワークを把持している搬送装置は動く必要が無く、ワークを取り落としたり、ワークを損傷する可能性を低減できる。
【００２０】
さらに、搬送装置は制御装置の内部で生成する搬送装置固有の滑らかな動作軌跡で動作できるので、搬送装置がふらついたりすることがなく、搬送が安定して行える。
【発明を実施するための最良の形態】
【００２１】
以下、本発明の好ましい実施形態を図面を参照して説明する。なお、各図において共通する部分には同一の符号を付し、重複した説明を省略する。
【００２２】
図１は、本発明によるサーボプレス設備の第１実施形態図であり、搬送装置として多軸ロボットを使用する例を示す。この図において、本発明のサーボプレス設備は、プレス装置１０、搬送装置２０及び制御装置４０を備える。
【００２３】
プレス装置１０は、サーボモータ（メインモータ１０１）でスライド１０３を駆動し、その位置をリアルタイムに制御可能なサーボプレス装置である。
搬送装置２０は、プレス装置１０にワーク１を搬入及び搬出する装置である。
制御装置４０は、搬送装置２０を制御し、搬送装置２０の動作軌跡上での位置を間欠的又は連続的に検出し、プレス装置１０を制御する制御装置である。
制御装置４０は、搬送装置２０の検出された位置に対して、取り付けられた金型（上金型１０４）及び付属物を含むスライド１０３が搬送装置２０と機械的に干渉しないスライド１０３の位置又は位置範囲を計算するスライド位置計算手段４１を有する。
このスライド位置計算手段４１により、検出された搬送装置２０の位置に対しスライド１０３の干渉しない位置又は位置範囲を計算し、これを目標位置又は目標範囲として、スライド１０３の実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置１０を制御する。
【００２４】
図２は、本発明によるサーボプレス設備の制御方法を示すフロー図である。本発明の制御方法は、サーボモータ（メインモータ１０１）でスライド１０３を駆動しその位置をリアルタイムに制御可能なプレス装置１０と、プレス装置１０にワーク１を搬入及び搬出する搬送装置２０とを備えたサーボプレス設備の制御方法である。
本発明の制御方法では、搬送装置２０の動作軌跡上での位置を間欠的又は連続的に検出し、プレス装置１０を搬送装置２０と機械的に干渉しないように制御する。
【００２５】
すなわちこの図において、本発明の制御方法は、搬送位置検出ステップＳ１、スライド位置計算ステップＳ２、及びサーボプレス制御ステップＳ３の各ステップを有する。
搬送位置検出ステップＳ１では、搬送装置２０の動作軌跡上での位置を間欠的又は連続的に検出する。
スライド位置計算ステップＳ２では、搬送装置２０の検出された位置に対して、取り付けられた金型（上金型１０４）及び付属物を含むスライド１０３が搬送装置２０と機械的に干渉しないスライド１０３の位置又は位置範囲を計算する。なお、付属物とは、ダイクランパや配管などスライドに取り付けられていてスライドと一緒に動くもののことである。
サーボプレス制御ステップＳ３では、計算されたスライド１０３の干渉しない位置又は位置範囲を目標位置又は目標範囲として、スライドの実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置１０を制御する。
【００２６】
図１においてサーボプレス装置１０は、メインモータ１０１、スライド駆動機構１０２、スライド１０３、ボルスタ１０６、フレーム１０７及びエンコーダ１２１からなる。
【００２７】
メインモータ１０１の回転がスライド駆動機構１０２で直線動に変換されスライド１０３を上下動させる。スライド１０３には上金型１０４が取り付けられており、スライド１０３と共に上下動する。上金型１０４に対向して下金型１０５がボルスタ１０６に取り付けられている。上金型１０４に加わる荷重はスライド１０３とスライド駆動機構１０２を経由してフレーム１０７の上部で支持され、下金型１０５に加わる荷重はボルスタ１０６を経由してフレーム１０７の下部で支持される。
【００２８】
プレス成型の対象となるワーク１は上金型１０４と下金型１０５の間に挿入され、スライド１０３が下降して上金型１０４とワーク１と下金型１０５が接触すると、上金型１０４及び下金型１０５からワーク１に対してプレス成型力が発生する。
スライド駆動機構１０２としては、クランク方式、クランクレス方式、ナックル方式、リンク方式、スクリュー方式などがあり、例えば、特許文献３〜５に開示されている。
メインモータ１０１としては、誘導モータ、同期モータ、直流モータ等が使用可能である。また本発明では、制御性の優れたサーボモータを使用する。スライド１０３の位置を検出するために、メインモータ１０１の回転角を検出するエンコーダ１２１が設けられている。
【００２９】
図１において、制御装置４０は、メインモータ制御器１２２、メインモータアンプ１２３、スライド位置指令生成器１４１、及びロボットコントローラ２２１を備える。
【００３０】
メインモータ制御器１２２は、エンコーダ１２１が検出したメインモータ１０１の回転角をスライド駆動機構１０２の寸法及び構造に基づいて変換して得られるスライド１０３の現在位置と、スライド位置指令生成器１４１から与えられるスライド位置指令値とに基づいて、メインモータ１０１に対するトルク指令値を生成する。
【００３１】
メインモータアンプ１２３は、メインモータ１０１がトルク指令値に従ってトルクを発生するように、メインモータ１０１へ供給される電流、電圧、又は電力を変化させる。
【００３２】
以上の構成により、スライド位置指令生成器１４１からスライド位置指令値が時々刻々与えられると、それに追従してスライド１０３の位置が時々刻々変化するクローズドループ制御が行われる。
【００３３】
エンコーダ１２１としては、光学式エンコーダやレゾルバが使用可能である。メインモータアンプ１２３には、直流モータを使用する場合にはサイリスタレオナードやＩＧＢＴを使用したチョッパ方式、交流モータを使用する場合にはパワーＭＯＳＦＥＴやＩＧＢＴを使用したＰＷＭ方式のインバータ、等が使用できる。メインモータ制御器１２２の制御手段としては、ＰＩ、ＰＩＤ、ＩＰＤなどのフィードバック制御やフィードフォワード制御の組み合わせ等が使用できる。
【００３４】
図１において、搬送装置２０は、ワーク把持ツール２０１、多軸ロボット２０２、及びアーム先端部２０３からなる。
ワーク１を把持するためのワーク把持ツール２０１は、多軸ロボット２０２のアーム先端部２０３に取り付けられている。多軸ロボット２０２の各動作軸はモータ（図示せず）により駆動されており、ロボットコントローラ２２１から指令が与えられると、各動作軸のモータが適切に回転して、アーム先端部２０３の位置・姿勢を任意に動かすことができる。
【００３５】
ワーク把持ツール２０１はアーム先端部２０３に取り付けられているので、アーム先端部２０３の位置・姿勢を適切に動かすことにより、ワーク把持ツール２０１の位置・姿勢も任意に動かすことができ、ワーク把持ツール２０１でワーク１を把持して、プレス装置１０に搬入・搬出することができる。
ワーク把持ツール２０１としては、ワーク１を真空吸着する吸盤を取り付けたクロスバーや、ワーク１をはさみこむフィンガーなどが使用される。
【００３６】
ロボットコントローラ２２１からの指令に従ってロボットのアーム先端部２０３を任意の位置及び姿勢に動かす仕組みは、産業用ロボットで広く実用されている方式を使用可能である。
例えば、モータをＩＧＢＴやパワートランジスタを使用したＰＷＭ方式のアンプでモータを速度及びトルク可変に駆動し、モータの回転角を光学式エンコーダやパルスジェネレータで測定し、位置偏差を打ち消すようにフィードバック制御を行うクローズドループ方式を用いる。
【００３７】
この例において、搬送装置２０の動作軌跡上での位置の間欠的又は連続的検出は、ロボットコントローラ２２１による。
上述したスライド位置計算手段４１は、スライド位置指令生成器１４１に内蔵されており、このスライド位置計算手段４１により、検出された搬送装置２０の位置に対しスライド１０３の干渉しない位置又は位置範囲を計算する。
さらにロボットコントローラ２２１からスライド位置指令生成器１４１へ、多軸ロボット２０２が動作軌跡上のどの目標点（詳細は以下で説明）に到達したかを示す目標点到達信号２４１を送るようになっている。
【００３８】
図３は、搬送装置２０の動作軌跡の模式図である。動作軌跡に従った搬送装置２０の動作は以下のように実現される。
図３に示すように、動作軌跡は分割して目標点の列としてロボットコントローラ２２１に記憶されており、ロボットコントローラ２２１は、目標点１→目標点２→目標点３→…と順々にたどっていくように多軸ロボット２０２のモータを制御する。
【００３９】
すなわち、まず、多軸ロボット２０２を目標点１へ移動させるように制御し、多軸ロボット２０２が目標点１へ到達すると、今度は多軸ロボット２０２を目標点２へ移動させるように制御し、多軸ロボット２０２が目標点２へ到達すると、今度は多軸ロボット２０２を目標点３へ移動させるように制御し、というように順々に制御を行う。多軸ロボット２０２が目標点Ｎに到達したら、目標点１へ移動させるように制御して、以上の過程を繰り返すことにより、同一の動作軌跡上を繰り返し移動させることができる。
多軸ロボット２０２の動きと、アーム先端部２０３の位置及び姿勢と、ワーク把持ツール２０１の位置及び姿勢は、一定の関係を保っているので、以上のように多軸ロボット２０２が動作軌跡上を目標点１→目標点２→目標点３→と順々に移動させることにより、ワーク把持ツール２０１もある軌跡（動作軌跡から一意に決まる）上を移動する。
【００４０】
目標点のデータを生成する手段としては、それぞれの目標点ごとに、アーム先端部２０３の位置を人間が操作して教示し、そのときの多軸ロボット２０２の各動作軸のモータ回転角を光学式エンコーダやパルスジェネレータで測定して記憶しておくティーチングプレイバック方式や、それぞれの目標点ごとに、アーム先端部２０３の所望の位置に対応する各動作軸のモータ回転角を、多軸ロボット２０２のアーム長さや機構の寸法に基づきオフラインで計算により求める方式がある。
【００４１】
図４は、搬送装置の動作軌跡とスライドの目標位置軌跡との関係図である。
搬送装置２０の動作を基準として、プレス装置１０を以下のように追従動作させる。
【００４２】
スライド位置指令生成器１４１は、搬送装置の動作軌跡に対応するスライド１０３の目標位置軌跡を記憶している。具体的には、図４に示すように、多軸ロボット２０２の目標点１，２，３，…，Ｎに対応して、スライド１０３の目標位置１，２，３，…Ｎを記憶している。
ロボットコントローラ２２１からスライド位置指令生成器１４１へ、多軸ロボット２０２が目標点１に到達したことを示す目標点到達信号２４１が送られてくると、スライド位置指令生成器１４１は目標位置１をメインモータ制御器１２２へ出力する。
次に、多軸ロボット２０２が目標点２に到達したことを示す目標点到達信号２４１が送られてくると、目標位置２をメインモータ制御器１２２へ出力する。さらに、多軸ロボット２０２が目標点３に到達したことを示す目標点到達信号２４１が送られてくると、目標位置３をメインモータ制御器１２２へ出力する。
【００４３】
以下これを繰り返し、ロボットコントローラ２２１からスライド位置指令生成器１４１へ、多軸ロボット２０２が目標点Ｘに到達したことを示す目標点到達信号２４１が送られてくると、スライド位置指令生成器１４１は目標位置Ｘをメインモータ制御器１２２へ出力する。
【００４４】
メインモータ制御器１２２は、スライド１０３がスライド位置指令生成器１４１から与えられるスライド位置指令値に従って動くようにメインモータ１０１に対するトルク指令値を生成し、それに従ってメインモータアンプ１２３はメインモータ１０１へ供給される電流・電圧・電力を変化させるので、以上の手段により、搬送装置２０が動作軌跡に従って移動し、多軸ロボット２０２が目標点１，２，３，…，Ｎを通過するのに追従して、スライド１０３の位置が目標位置１，２，３，…，Ｎと変化していくような制御が行われる。
【００４５】
もし何らかの異常が発生して、プレス装置１０が搬送装置２０に追従する位置からずれた状態でプレス装置１０、搬送装置２０が停止した場合の復帰処理は以下のように行う。
スライド位置指令生成器１４１に多軸ロボット２０２が到達した最新の目標点（目標点Ｙと記述する）を記憶する機能を設けておき、スライド位置指令生成器１４１は目標点Ｙに対応する目標位置Ｙをメインモータ制御器１２２へ出力する。搬送装置２０（多軸ロボット２０２）を停止させたまま、プレス装置１０のスライド１０３を目標位置Ｙへ動かす。スライド１０３が目標位置Ｙへ移動したら、搬送装置２０を再起動させることにより、再びプレス装置１０が搬送装置２０に追従動作する。
【００４６】
以上で説明した手段の場合、搬送装置２０の動作に対しプレス装置１０の動作が若干遅れる可能性があるが、多軸ロボット２０２が目標点Ｘに到達したときに、プレス装置１０は目標位置Ｘと目標位置Ｘ＋１の間の適当な点（もしくは目標位置Ｘ＋１）を目標位置とすることにより遅れを補正することが可能である。
同様に、復帰動作においても、目標位置Ｙのかわりに目標位置Ｙと目標位置Ｙ＋１の間の適当な点（もしくは目標位置Ｙ＋１）を目標位置とすることが可能である。
【００４７】
また、以上で説明した手段では、プレス装置１０の動作が常に搬送装置２０の動作に追従しているが、プレス装置１０と搬送装置２０の動作サイクルの一部分、特に、スライド１０３が下降して上金型１０４と下金型１０５がワーク１を成型加工している時間帯では、搬送装置２０はプレス装置１０から離れており、機械的に干渉する可能性がない。このような時間帯には、プレス装置１０が搬送装置２０に追従する必要はなく、プレス装置１０のスライド１０３が搬送装置２０と無関係に適当な速度（例えば、ワーク１の成型加工に適した速度）で動作するように、スライド位置指令生成器１４１がスライド位置指令を生成してよい。
【００４８】
プレス装置１０に対し、ワーク搬入用とワーク搬出用にそれぞれ独立した搬送装置２０が設置されるときは、以下のようにすればよい。
ワーク搬入用搬送装置がワークをプレスに搬入している時間帯にはプレス装置１０は搬入用搬送装置の動作に追従し、搬入用搬送装置の動作軌跡上の目標点に対応してスライド目標位置を決める。ワーク搬出用搬送装置がワークをプレスから搬出している時間帯にはプレス装置１０は搬出用搬送装置の動作に追従し、搬出用搬送装置の動作軌跡上の目標点に対応してスライド目標位置を決める。
【００４９】
搬送装置２０の動作軌跡、及びスライド１０３の目標位置移動軌跡は、多軸ロボット２０２やワーク把持ツール２０１の性能（例えばモータの回転数、駆動トルク、発熱の制限や機構の強度）、及びプレス装置１０の性能の範囲内で、プレス機械と搬送装置が機械的に干渉しないように決定する。干渉チェック機能を有する３次元ＣＡＤを使ってオフラインで決定する手段や、実際に搬送装置とプレス機械を動作させてみてオンラインで決定していく手段などがある。
【００５０】
上述した実施形態では、搬送装置がロボットで構成されている例を示したが、図３に示すように目標点の列を順次たどっていく手段で制御される搬送装置であれば、ロボットに限らず任意の搬送装置に上述した実施形態を適用可能である。
【００５１】
図５は、本発明によるサーボプレス設備の第２実施形態図であり、搬送装置として、搬送マスター信号に同期して搬送装置の各モーション軸が動作する例を示す。
この図に示すように、本発明のサーボプレス設備は、プレス装置１０、搬送装置３０、及び制御装置４０を備える。
【００５２】
プレス装置１０は、サーボモータ（メインモータ１０１）でスライド１０３を駆動し、その位置をリアルタイムに制御可能なプレス機械である。
搬送装置３０は、プレス装置１０にワーク１を搬入及び搬出する装置である。
制御装置４０は、搬送装置３０を制御し、搬送装置３０の動作軌跡上での位置を間欠的又は連続的に検出しプレス装置１０を制御する制御装置である。
制御装置４０は、搬送装置３０の検出された位置に対して、取り付けられた金型（上金型１０４）及び付属物を含むスライド１０３が搬送装置３０と機械的に干渉しないスライド１０３の位置又は位置範囲を計算するスライド位置計算手段４１を有する。
このスライド位置計算手段４１により、検出された搬送装置３０の位置に対しスライド１０３の干渉しない位置又は位置範囲を計算し、これを目標位置又は目標範囲として、スライド１０３の実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置１０を制御する。
【００５３】
プレス装置１０の構成は、制御装置４０にスライド位置許容範囲計算器１３１（説明は後述する）が追加された以外は第１実施形態と同じであるので説明を略す。各構成要素に付した番号も第１実施形態と同じである。
上述したスライド位置計算手段４１は、スライド位置許容範囲計算器１３１に内蔵されている。
【００５４】
図５において、搬送装置３０は、ワーク把持ツール３０１、キャリッジ３０２、フィード機構３０３、フィードモータ３０４、リフト機構３０５、リフトモータ３０６、フィードエンコーダ３２１、及びリフトエンコーダ３２４からなる。
【００５５】
ワーク１を把持するためのワーク把持ツール３０１は、キャリッジ３０２から支持されている。キャリッジ３０２をフィード方向（図中の左右方向）に動かすためのフィード機構３０３がフィードモータ３０４により駆動され、キャリッジ３０２をリフト方向（図中の上下方向）に動かすためのリフト機構３０５がリフトモータ３０６により駆動される。
【００５６】
フィード機構やリフト機構としては、モータの回転をボールスクリューで直線動に変える手段や、モータの回転をギアで減速し、ピニオンラック方式により直線動に変える手段などがある。
【００５７】
図５において、制御装置４０は、上述したメインモータ制御器１２２、メインモータアンプ１２３、及びスライド位置指令生成器１４１の他に、スライド位置許容範囲計算１３１、フィードモータ制御器３２２、フィードモータアンプ３２３、リフトモータ制御器３２５、リフトモータアンプ３２６、搬送マスター信号発生器３４１、搬送装置位置指令生成器３４３、及び、搬送装置位置計算器３５１を備える。
【００５８】
搬送装置３０が希望する動作状態（正転、逆転、サイクルタイム変化など）に応じて動作軌跡に従って移動できるようにするため、搬送マスター信号発生器３４１が設けられており、希望する動作状態に応じて、時間変化する搬送マスター信号３４２を発生し、搬送装置位置指令生成器３４３へ出力する。
【００５９】
搬送装置位置指令生成器３４３は、動作軌跡を示す情報、すなわち、搬送マスター信号３４２と搬送装置位置指令値（本例では、フィードとリフトの位置指令値）との関係、すなわちモーションカーブを記憶しており、入力された搬送マスター信号３４２の値に対応するフィードとリフトの位置指令値を、それぞれフィードモータ制御器３２２とリフトモータ制御器３２５へ出力する。
【００６０】
図６は、搬送マスター信号と搬送装置の関係図である。この図において、（Ａ）は経過時間と搬送マスター信号の関係、（Ｂ）は搬送マスター信号とフィード位置指令値及びフィード位置との関係、（Ｃ）は搬送マスター信号とリフト位置指令値及びリフト位置との関係を示す。
【００６１】
例えば、搬送装置３０を一定のサイクルタイムで動作軌跡に沿って正転させたい場合、図６に示すように、搬送マスター信号発生器３４１は搬送装置３０のサイクルタイムＴを周期とし、周期内では一定レートで増加する搬送マスター信号３４２を発生する。
搬送装置位置指令生成器３４３は、フィードのモーションカーブに基づき、搬送マスター信号３４２に対応するフィード位置指令値を計算し、フィードモータ制御器３２２へ出力する。また、リフトのモーションカーブに基づき、搬送マスター信号３４２に対応するリフト位置指令値を計算し、リフトモータ制御器３２５へ出力する。
【００６２】
搬送装置位置指令生成器３４３にモーションカーブを保持させる手段としては、適当な間隔でサンプルした値をテーブルで記憶しその間を多項式やスプラインで補間する手段、カーブの全体もしくは適当に分割した区間ごとに関数で表現する手段などがある。
【００６３】
図７は、搬送装置の作動状態と搬送マスター信号の関係を示す図である。この図において、（Ａ）（Ｂ）（Ｃ）（Ｄ）はそれぞれ搬送装置の異なる作動状態における搬送マスター信号の時間に対する変化パターンを示す。
搬送装置３０を異なる動作状態で動かしたいときは、搬送マスター信号発生器３４１が発生する搬送マスター信号３４２の時間に対する変化パターンを変える。
例えば、搬送装置のサイクルタイムを変化させたい場合には、図７（Ａ）に示すように毎周期ごとに１周期の時間を変化させたり、図７（Ｂ）に示すように搬送マスター信号３４２の変化レートを連続的に変化させることにより実現できる。搬送装置３０を一時的に停止させたい場合には、図７（Ｃ）に示すように、搬送マスター信号３４２の変化レートをゼロにすれば、フィード方向位置指令値・リフト方向位置指令値は変化しなくなり、搬送装置３０は停止する。
搬送装置３０を動作軌跡に沿って逆転したい場合には、図７（Ｄ）に示すように、搬送マスター信号３４２を減少させればよい。
【００６４】
以上で説明したように生成されたフィード位置指令値・リフト位置指令値に対し、搬送装置３０の実際のフィード位置・リフト位置が一致するように、以下のように制御が行われる。
【００６５】
キャリッジ３０２のフィード（図中の左右方向）の位置を検出するために、フィードモータ３０４の回転角を検出するフィードエンコーダ３２１が設けられている。フィードモータ制御器３２２は、フィードエンコーダ３２１が検出したフィードモータ３０４の回転角をフィード機構３０３の寸法・構造に基づいて変換して得られるキャリッジ３０２のフィード位置と、搬送装置位置指令生成器３４３から与えられるフィード位置指令値とに基づいて、フィードモータ３０４に対するトルク指令値を生成する。フィードモータアンプ３２３は、フィードモータ３０４がトルク指令値に従ってトルクを発生するように、フィードモータ３０４へ供給される電流・電圧・電力を変化させる。リフト（図中の上下方向）に対しても、同様の構成と作用を有するリフトエンコーダ３２４、リフトモータ制御器３２５、リフトモータアンプ３２６が設けられている。
【００６６】
以上の構成により、搬送装置位置指令生成器３４３から搬送装置位置指令値（この例では、フィードとリフトの位置指令値）が時々刻々与えられると、それに追従してキャリッジ３０２の位置（本例では、フィードとリフトの位置）が時々刻々変化するクローズドループ制御が行われる。ワーク把持ツール３０１はキャリッジ３０２と一定の位置関係を保つように保持されているので、把持ツール３０１の位置も搬送装置位置指令生成器３４３から与えられる搬送装置位置指令値に追従し、搬送装置位置指令生成器３４３に記憶された搬送マスター信号３４２と搬送装置位置指令値との関係に従って、動作軌跡上を動く。
【００６７】
上述したスライド位置計算手段４１は、スライド位置許容範囲計算器１３１に内蔵されている。
フィードエンコーダ３２１とリフトエンコーダ３２４で測定されたフィードとリフトの位置は搬送装置位置計算器３５１に入力される。搬送装置位置計算器３５１は、搬送装置の機構的寸法（キャリッジ３０２の駆動機構やワーク把持ツール３０１の機構的寸法や相互の位置関係）に基づいて、時々刻々の搬送装置位置を計算し、搬送装置位置信号３５２としてスライド位置許容範囲計算器１３１へ出力する。
搬送装置位置としては、搬送装置上の適当なポイント、例えばキャリッジ位置やワーク把持ツール位置を使用することができる。搬送装置上の複数のポイントを複合して、例えばキャリッジ位置とワーク把持ツール位置をペアにして搬送装置位置としてもよい。
【００６８】
スライド位置許容範囲計算器１３１は、内蔵するスライド位置計算手段４１により、検出された搬送装置３０の位置に対しスライド１０３の位置又は位置範囲を計算し、これを目標位置又は目標範囲として、スライド１０３の実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置１０を制御する。
すなわちスライド位置許容範囲計算器１３１は、搬送装置位置信号３５２で示される搬送装置位置に対し、スライド１０３及びそれに固定されている上金型１０４（もしスライド１０３といっしょに動く他の付属物があればそれも含め）が機械的に干渉しないスライド１０３の位置の範囲を計算し、スライド位置許容範囲信号１３２としてスライド位置指令生成器１４１へ出力する。
【００６９】
スライド位置指令生成器１４１は、スライド位置許容範囲１３２の範囲内でスライド１０３の位置指令値を生成しメインモータ制御器１２２へ出力する。
【００７０】
以上説明したように生成されたスライド位置指令値に対し、プレス装置１０のスライド１０３の実際の位置が一致するように、第１実施形態と同様に、エンコーダ１２１、メインモータ制御器１２２、メインモータアンプ１２３、及びメインモータ１０１によるクローズドループ制御が行われる。
【００７１】
プレス装置１０、搬送装置３０のいずれにおいても、エンコーダ１２１，３２１，３２４としては、光学式エンコーダやレゾルバが使用可能である。モータアンプ１２３，３２３，３２６には、直流モータを使用する場合にはサイリスタレオナードやＩＧＢＴを使用したチョッパ方式、交流モータを使用する場合にはパワートランジスタやパワーＭＯＳＦＥＴやＩＧＢＴを使用したＰＷＭ方式のインバータ、等が使用できる。モータ制御器１２２，３２２，３２５の制御方法としては、ＰＩ、ＰＩＤ、ＩＰＤなどのフィードバック制御やフィードフォワード制御の組み合わせ等が使用できる。
ワーク把持ツール３０１としては、ワーク１を真空吸着する吸盤を取り付けたクロスバーや、ワーク１をはさみこむフィンガーなどが使用できる。
【００７２】
図８は、フィード位置・リフト位置とスライド位置許容範囲の関係図である。この図において、Ａ１はフィード位置がＦ１、リフト位置がＬ１のときに、搬送装置とプレス機械（プレス装置１０）が干渉しないスライド位置許容範囲を示す。同様にＡ２，Ａ３はそれぞれフィード位置がＦ２，Ｆ３、リフト位置がＬ２，Ｌ３のときに、搬送装置３０とプレス装置１０が干渉しないスライド位置許容範囲を示す。
【００７３】
搬送装置３０の動作を基準としてプレス装置１０が追従動作するように、以下のようにスライド位置指令値を生成する。
搬送装置３０が動作するにつれ、搬送装置位置計算器３５１から搬送装置位置信号３５２がスライド位置許容範囲計算器１３１へ入力される。例えば、搬送装置位置信号３５２としてキャリッジ３０２のフィード位置・リフト位置を用いるものとすると、スライド位置許容範囲計算器１３１は、図８に示すように、時々刻々のキャリッジ３０２のフィード位置・リフト位置に対して、搬送装置３０とプレス装置１０が機械的に干渉しないようなスライド１０３の位置を計算しスライド位置許容範囲信号１３２として出力する。
【００７４】
スライド位置許容範囲の計算手段としては、例えば、あらかじめプレス装置１０（金型及び付属物を含む）と搬送装置の寸法形状を３Ｄ−ＣＡＤに入力して計算したり、搬送装置３０とプレス装置１０を手動でゆっくり動作させて現物あわせで測定することにより、さまざまな搬送装置位置に対し機械的干渉が生じないスライド１０３の高さ範囲をあらかじめ求めてテーブルに格納しておき、テーブルを参照して（必要があれば補間を行って）スライド位置許容範囲を求める手段や、プレス装置１０（金型及び付属物を含む）・搬送装置の寸法形状のデータがスライド位置許容範囲計算器１３１に格納されており、スライド位置許容範囲をリアルタイムに計算する手段がある。
【００７５】
さらに異なる手段として、ワーク把持ツール３０１やキャリッジ３０２に光学式距離計や短距離用レーザやスポット光方式のレーザ距離計を取り付けて、スライド１０３や上金型１０４までの距離を時々刻々測定することにより、搬送装置３０とプレス装置１０が機械的に干渉しない余裕距離を計算してスライド位置許容範囲に換算する手段もある。
【００７６】
図９は、スライド位置許容範囲とスライド位置指令値の関係図である。この図において、Ｈはスライド位置許容範囲の上限の時間変化、Ｌはスライド位置許容範囲の下限の時間、Ａは変化時刻ｔにおけるスライド位置許容範囲、Ｂ１〜Ｂ５はスライド位置指令値の変化を示している。
【００７７】
スライド位置指令生成器１４１は、スライド位置許容範囲信号１３２が示すスライド位置許容範囲Ａ内で、適切なスライド位置指令値Ｂ（Ｂ１〜Ｂ５）を生成する。
例えば、ワーク１をプレス成型するためにスライド１０３が下降中であるが上金型１０４がワーク１にまだ接触していない間は、できるだけ高速で下降することが望ましいので、図９（Ａ）に示すように、もしスライド１０３の位置がスライド位置許容範囲内であればメインモータ１０１の性能が許す限りできるだけ高速にスライド１０３を下降させるようなスライド位置指令値Ｂ１とし、もしスライド１０３の位置がスライド位置許容範囲の下限に引っかかるのであれば、スライド位置許容範囲の下限をスライド位置指令値Ｂ２とすればよい。スライド１０３の位置がスライド位置許容範囲の上限に引っかかる場合は、異常と考えられ、搬送装置３０をすぐに停止する異常処理を行えばよい。
【００７８】
上金型１０４がワーク１と接触しプレス成型加工を行っている間は、もしスライド１０３の位置がスライド位置許容範囲信号１３２の示すスライド位置許容範囲内であれば、図９（Ｂ）に示すように、プレス成型加工に適した速度でスライド１０３が動くようなスライド位置指令値Ｂ３とすればよい。
また図９（Ａ）又は図９（Ｃ）と同様、もしスライド１０３の位置がスライド位置許容範囲の下限もしくは上限に引っかかるのであれば、スライド位置許容範囲の下限もしくは上限をスライド位置指令値とすればよいが、プレス成型加工中には搬送装置３０はプレス装置１０と干渉しない位置にいることが普通であり、普通はスライド１０３の位置がスライド位置許容範囲の下限もしくは上限に引っかかることはない。
【００７９】
プレス成型加工が終了した後は、できるだけ高速でスライド１０３を上昇させることが望ましいので、図９（Ｃ）に示すように、もしスライド１０３の位置がスライド位置許容範囲信号１３２の示すスライド位置許容範囲内であればメインモータ１０１の性能が許す限りできるだけ高速にスライド１０３を上昇させるようなスライド位置指令値Ｂ４とし、もしスライド１０３の位置がスライド位置許容範囲の上限に引っかかるのであれば、スライド位置許容範囲の上限をスライド位置指令値Ｂ５とすればよい。スライド１０３の位置がスライド位置許容範囲の下限に引っかかる場合は、異常と考えられ、搬送装置３０をすぐに停止する異常処理を行えばよい。
【００８０】
もし何らかの異常が発生して、プレス装置１０が搬送装置３０に追従する位置からずれた状態でプレス装置１０、搬送装置３０が停止した場合の復帰処理は以下のように行う。停止位置におけるフィードエンコーダ３２１，リフトエンコーダ３２４の測定値に基づいて、搬送装置位置計算器３５１は搬送装置位置を計算して搬送装置位置信号３５２として出力するので、それに対応したスライド位置許容範囲をスライド位置許容範囲計算器１３１で計算し、スライド１０３の位置が計算されたスライド位置許容範囲内に入るまでプレス装置１０のみ動かす。スライド１０３がスライド位置許容範囲内に入ったら、搬送装置３０を再起動させることにより、再びプレス装置１０が搬送装置３０に追従動作する。
【００８１】
プレス装置１０に対し、ワーク搬入用とワーク搬出用に独立した搬送装置が設置されるときは、以下のようにすればよい。搬入用ワーク搬送装置と搬出用ワーク搬送装置のそれぞれに対し、図５に示す３０１〜３０６、３２１〜３２６、３４１〜３４３、３５１、３５２に相当する要素を独立に設ける。
搬入用搬送装置がワークをプレスに搬入している時間帯は、スライド位置許容範囲計算器１３１への入力として、搬入用搬送装置からの搬送装置位置信号を用い、搬出用搬送装置がワークをプレスから搬出している時間帯は、スライド位置許容範囲計算器１３１への入力として、搬出用搬送装置からの搬送装置位置信号を用いる。
【００８２】
搬送装置３０の動作軌跡は、ワーク把持ツール３０１を含む搬送装置３０の性能（例えばモータの回転数・駆動トルク・発熱の制限や機構の強度）の範囲内で、ワークを取り落としたりすることがなく、かつプレス機械もメインモータの性能の範囲内で動くことが可能であり機械的な干渉が生じないように決定する。干渉チェック機能を有する３次元ＣＡＤを使ってオフラインで決定する手段や、実際に搬送装置とプレス機械を動作させてみてオンラインで決定していく手段などがある。
【００８３】
この第２実施形態では、搬送装置がフィードとリフトの２動作軸を有する場合の例を示したが、図６に示すように搬送マスター信号に基づいてモーションカーブに追従するように制御される搬送装置であれば、任意の構成、構造、動作軸数の搬送装置にこの第２実施形態を適用可能である。例えば、フィードとリフトとクランプを有する３次元トランスファー機構や、ドッピン式と称されるようなリンク式のローダー、各種の産業用ロボットの機構、などが使用可能である。搬入側と搬出側で機構が異なっていてもよい。
【００８４】
（第１実施形態、第２実施形態に共通）
第１、第２実施形態ではプレス機械と搬送装置が１台ずつの場合を示したが、以下のようにすることにより、複数のプレス機械と搬送装置で生産ラインを構成する場合にも本発明を適用可能である。
【００８５】
第１実施形態の場合、各プレス機械ごとにスライド位置指令生成器、各搬送装置ごとにロボットコントローラを設け、各プレス機械は、ワーク搬入が行われている間はワークを搬入している搬送装置の動作軌跡に追従するようにスライド目標位置を生成し、ワーク搬出が行われている間はワークを搬出している搬送装置の動作軌跡に追従するようにスライド目標位置を生成するようにすればよい。
【００８６】
第２実施形態の場合、各プレス機械ごとにスライド位置許容範囲計算器・スライド位置指令生成器、各搬送装置ごとに搬送マスター信号発生器・搬送装置位置指令生成器・搬送装置位置計算器を設け、各プレス機械は、ワーク搬入が行われている間はワークを搬入している搬送装置からの搬送装置位置信号に基づいてスライド位置許容範囲を決定し、ワーク搬出が行われている間はワークを搬出している搬送装置からの搬送装置位置信号に基づいてスライド位置許容範囲を決定するようにすればよい。
いずれの場合にも、各搬送装置、各プレス機械は、一台ずつ異なる動作軌跡・スライド移動軌跡で動かすことが可能である。
【００８７】
上述した実施形態では、モータの回転を機構的にスライドの直線動に変換するサーボプレスを示したが、リニアモータを使用してスライドを駆動するサーボプレスにも適用可能である。
【００８８】
上述した実施形態では、スライドやフィード・リフトの位置検出手段として、モータの回転角をエンコーダで検出し、スライドやフィード・リフト駆動機構の寸法に基づいてスライドやフィード・リフトの位置に変換する例を示したが、スライドやフィード・リフトの位置を光学式リニアスケールや磁歪式リニアエンコーダで直接検出する手段も可能である。
【００８９】
上述した実施形態では、エンコーダをモータ軸に取り付ける例を示したが、モータで駆動される機構の側にロータリーエンコーダないしリニアエンコーダを設けて位置を検出する手段も可能である。
【００９０】
上述した本発明の装置及び方法によれば、搬送装置２０，３０の動作軌跡は、速度や加速度が大きくなく搬送に適した軌跡とすることができるので、ワーク把持を安定化でき、搬送装置２０，３０の駆動機構や駆動モータをむやみに大きくする必要性を回避できる。
【００９１】
また、搬送装置２０，３０に異常が発生した場合、搬送装置２０，３０との干渉を避けるようにスライド１０３が動作するので、機械的干渉による搬送装置及びプレス機械の破損可能性を低減することができる。
【００９２】
また、異常停止からの復帰動作を行うとき、搬送装置２０，３０の位置を基準としてプレス機械１０を動かして追従可能な位置へ移動させるので、復帰動作中にワークを把持している搬送装置は動く必要が無く、ワークを取り落としたりワークを損傷する可能性を低減できる。
【００９３】
さらに、搬送装置２０，３０は制御装置の内部で生成する搬送装置固有の滑らかな動作軌跡で動作できるので、搬送装置がふらついたりすることがなく、搬送が安定して行える。
【００９４】
なお、本発明は上述した実施の形態に限定されず、本発明の要旨を逸脱しない範囲で種々の変更を加え得ることは勿論である。
【図面の簡単な説明】
【００９５】
【図１】本発明によるサーボプレス設備の第１実施形態図である。
【図２】本発明によるサーボプレス設備の制御方法を示すフロー図である。
【図３】搬送装置２０の動作軌跡の模式図である。
【図４】搬送装置の動作軌跡とスライドの目標位置軌跡との関係図である。
【図５】本発明によるサーボプレス設備の第２実施形態図である。
【図６】搬送マスター信号と搬送装置の関係図である。
【図７】搬送装置の作動状態と搬送マスター信号の関係を示す図である。
【図８】フィード位置・リフト位置とスライド位置許容範囲の関係図である。
【図９】スライド位置許容範囲とスライド位置指令値の関係図である。
【符号の説明】
【００９６】
１ ワーク、
１０ プレス装置（サーボプレス装置）、
２０，３０ 搬送装置、
４０ 制御装置、
４１ スライド位置計算手段
【特許請求の範囲】
【請求項１】
サーボモータでスライドを駆動しその位置をリアルタイムに制御可能なプレス装置と、該プレス装置にワークを搬入及び／又は搬出する搬送装置と、該搬送装置の動作軌跡上での位置を間欠的又は連続的に検出し、該プレス装置を搬送装置と機械的に干渉しないように制御する制御装置とを備える、ことを特徴とするサーボプレス設備。
【請求項２】
前記制御装置は、搬送装置の検出された位置に対して、取り付けられた金型及び付属物を含むスライドが搬送装置と機械的に干渉しないスライドの位置又は位置範囲を計算するスライド位置計算手段を有し、
該スライド位置計算手段により、検出された搬送装置の位置に対しスライドの前記干渉しない位置又は位置範囲を計算し、これを目標位置又は目標範囲として、スライドの実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置を制御する、ことを特徴とする請求項１に記載のサーボプレス設備。
【請求項３】
サーボモータでスライドを駆動しその位置をリアルタイムに制御可能なプレス装置と、該プレス装置にワークを搬入及び／又は搬出する搬送装置とを備えたサーボプレス設備の制御方法であって、
搬送装置の動作軌跡上での位置を間欠的又は連続的に検出しプレス装置を搬送装置と機械的に干渉しないように制御する、ことを特徴とするサーボプレス設備の制御方法。
【請求項４】
搬送装置の動作軌跡上での位置を間欠的又は連続的に検出する搬送位置検出ステップと、
搬送装置の検出された位置に対して、取り付けられた金型及び付属物を含むスライドが搬送装置と機械的に干渉しないスライドの位置又は位置範囲を計算するスライド位置計算ステップと、
計算されたスライドの前記干渉しない位置又は位置範囲を目標位置又は目標範囲として、スライドの実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置を制御するサーボプレス制御ステップとを有する、ことを特徴とする請求項３に記載のサーボプレス設備の制御方法。
【請求項１】
サーボモータでスライドを駆動しその位置をリアルタイムに制御可能なプレス装置と、該プレス装置にワークを搬入及び／又は搬出する搬送装置と、該搬送装置の動作軌跡上での位置を間欠的又は連続的に検出し、該プレス装置を搬送装置と機械的に干渉しないように制御する制御装置とを備える、ことを特徴とするサーボプレス設備。
【請求項２】
前記制御装置は、搬送装置の検出された位置に対して、取り付けられた金型及び付属物を含むスライドが搬送装置と機械的に干渉しないスライドの位置又は位置範囲を計算するスライド位置計算手段を有し、
該スライド位置計算手段により、検出された搬送装置の位置に対しスライドの前記干渉しない位置又は位置範囲を計算し、これを目標位置又は目標範囲として、スライドの実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置を制御する、ことを特徴とする請求項１に記載のサーボプレス設備。
【請求項３】
サーボモータでスライドを駆動しその位置をリアルタイムに制御可能なプレス装置と、該プレス装置にワークを搬入及び／又は搬出する搬送装置とを備えたサーボプレス設備の制御方法であって、
搬送装置の動作軌跡上での位置を間欠的又は連続的に検出しプレス装置を搬送装置と機械的に干渉しないように制御する、ことを特徴とするサーボプレス設備の制御方法。
【請求項４】
搬送装置の動作軌跡上での位置を間欠的又は連続的に検出する搬送位置検出ステップと、
搬送装置の検出された位置に対して、取り付けられた金型及び付属物を含むスライドが搬送装置と機械的に干渉しないスライドの位置又は位置範囲を計算するスライド位置計算ステップと、
計算されたスライドの前記干渉しない位置又は位置範囲を目標位置又は目標範囲として、スライドの実際の位置が、目標位置に一致する、もしくは目標範囲内に入るようにプレス装置を制御するサーボプレス制御ステップとを有する、ことを特徴とする請求項３に記載のサーボプレス設備の制御方法。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【公開番号】特開２００８−１７３６４２（Ｐ２００８−１７３６４２Ａ）
【公開日】平成２０年７月３１日（２００８．７．３１）
【国際特許分類】
【出願番号】特願２００７−６５７１（Ｐ２００７−６５７１）
【出願日】平成１９年１月１６日（２００７．１．１６）
【出願人】（０００００００９９）株式会社ＩＨＩ (5,014)
【Ｆターム（参考）】
【公開日】平成２０年７月３１日（２００８．７．３１）
【国際特許分類】
【出願日】平成１９年１月１６日（２００７．１．１６）
【出願人】（０００００００９９）株式会社ＩＨＩ (5,014)
【Ｆターム（参考）】
[ Back to top ]