JP2022090541A - 成形品取出機の制御装置 - Google Patents
成形品取出機の制御装置 Download PDFInfo
- Publication number
- JP2022090541A JP2022090541A JP2020202992A JP2020202992A JP2022090541A JP 2022090541 A JP2022090541 A JP 2022090541A JP 2020202992 A JP2020202992 A JP 2020202992A JP 2020202992 A JP2020202992 A JP 2020202992A JP 2022090541 A JP2022090541 A JP 2022090541A
- Authority
- JP
- Japan
- Prior art keywords
- torque
- unit
- molded product
- take
- control device
- 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.)
- Pending
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C37/00—Component parts, details, accessories or auxiliary operations, not covered by group B29C33/00 or B29C35/00
- B29C37/0003—Discharging moulded articles from the mould
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G43/00—Control devices, e.g. for safety, warning or fault-correcting
- B65G43/08—Control devices operated by article or material being fed, conveyed or discharged
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C45/00—Injection moulding, i.e. forcing the required volume of moulding material through a nozzle into a closed mould; Apparatus therefor
- B29C45/17—Component parts, details or accessories; Auxiliary operations
- B29C45/40—Removing or ejecting moulded articles
- B29C45/42—Removing or ejecting moulded articles using means movable from outside the mould between mould parts, e.g. robots
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C37/00—Component parts, details, accessories or auxiliary operations, not covered by group B29C33/00 or B29C35/00
- B29C37/0003—Discharging moulded articles from the mould
- B29C37/0007—Discharging moulded articles from the mould using means operable from outside the mould for moving between mould parts, e.g. robots
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C45/00—Injection moulding, i.e. forcing the required volume of moulding material through a nozzle into a closed mould; Apparatus therefor
- B29C45/17—Component parts, details or accessories; Auxiliary operations
- B29C45/76—Measuring, controlling or regulating
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C45/00—Injection moulding, i.e. forcing the required volume of moulding material through a nozzle into a closed mould; Apparatus therefor
- B29C45/17—Component parts, details or accessories; Auxiliary operations
- B29C45/84—Safety devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G47/00—Article or material-handling devices associated with conveyors; Methods employing such devices
- B65G47/74—Feeding, transfer, or discharging devices of particular kinds or types
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/406—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by monitoring or safety
- G05B19/4062—Monitoring servoloop, e.g. overload of servomotor, loss of feedback or reference
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C37/00—Component parts, details, accessories or auxiliary operations, not covered by group B29C33/00 or B29C35/00
- B29C2037/90—Measuring, controlling or regulating
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C37/00—Component parts, details, accessories or auxiliary operations, not covered by group B29C33/00 or B29C35/00
- B29C2037/90—Measuring, controlling or regulating
- B29C2037/903—Measuring, controlling or regulating by means of a computer
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C37/00—Component parts, details, accessories or auxiliary operations, not covered by group B29C33/00 or B29C35/00
- B29C2037/94—Safety devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C45/00—Injection moulding, i.e. forcing the required volume of moulding material through a nozzle into a closed mould; Apparatus therefor
- B29C45/17—Component parts, details or accessories; Auxiliary operations
- B29C45/76—Measuring, controlling or regulating
- B29C45/7626—Measuring, controlling or regulating the ejection or removal of moulded articles
- B29C2045/7633—Take out or gripping means
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C2945/00—Indexing scheme relating to injection moulding, i.e. forcing the required volume of moulding material through a nozzle into a closed mould
- B29C2945/76—Measuring, controlling or regulating
- B29C2945/76003—Measured parameter
- B29C2945/7602—Torque
- B29C2945/76023—Torque derivative, change thereof
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C2945/00—Indexing scheme relating to injection moulding, i.e. forcing the required volume of moulding material through a nozzle into a closed mould
- B29C2945/76—Measuring, controlling or regulating
- B29C2945/76177—Location of measurement
- B29C2945/76314—Auxiliary devices
- B29C2945/76317—Auxiliary devices robots, grippers
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C2945/00—Indexing scheme relating to injection moulding, i.e. forcing the required volume of moulding material through a nozzle into a closed mould
- B29C2945/76—Measuring, controlling or regulating
- B29C2945/76344—Phase or stage of measurement
- B29C2945/76421—Removing or handling ejected articles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C2945/00—Indexing scheme relating to injection moulding, i.e. forcing the required volume of moulding material through a nozzle into a closed mould
- B29C2945/76—Measuring, controlling or regulating
- B29C2945/76494—Controlled parameter
- B29C2945/76568—Position
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C2945/00—Indexing scheme relating to injection moulding, i.e. forcing the required volume of moulding material through a nozzle into a closed mould
- B29C2945/76—Measuring, controlling or regulating
- B29C2945/76655—Location of control
- B29C2945/76792—Auxiliary devices
- B29C2945/76795—Auxiliary devices robots, grippers
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C2945/00—Indexing scheme relating to injection moulding, i.e. forcing the required volume of moulding material through a nozzle into a closed mould
- B29C2945/76—Measuring, controlling or regulating
- B29C2945/76822—Phase or stage of control
- B29C2945/76899—Removing or handling ejected articles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
- B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
- B29C2945/00—Indexing scheme relating to injection moulding, i.e. forcing the required volume of moulding material through a nozzle into a closed mould
- B29C2945/76—Measuring, controlling or regulating
- B29C2945/76929—Controlling method
- B29C2945/76939—Using stored or historical data sets
- B29C2945/76943—Using stored or historical data sets compare with thresholds
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G2203/00—Indexing code relating to control or detection of the articles or the load carriers during conveying
- B65G2203/02—Control or detection
- B65G2203/0266—Control or detection relating to the load carrier(s)
- B65G2203/0283—Position of the load carrier
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G2203/00—Indexing code relating to control or detection of the articles or the load carriers during conveying
- B65G2203/02—Control or detection
- B65G2203/0266—Control or detection relating to the load carrier(s)
- B65G2203/0291—Speed of the load carrier
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/45—Nc applications
- G05B2219/45137—Punch, stamp, also with use die, mould
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Manufacturing & Machinery (AREA)
- Robotics (AREA)
- Human Computer Interaction (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
- Moulds For Moulding Plastics Or The Like (AREA)
Abstract
【課題】サーボ系制御部を手動操作する際に衝突が発生したときに適切な動作を行う成形品取出機の制御装置を提供する。【解決手段】衝突検知部19が動作停止指令を出力すると、偏差クリア部21がサーボ系制御部のオン状態を維持した状態で、サーボ系制御部中の偏差を0にするクリア動作を行う。偏差が0となることにより位置決め完了が確定して、再度運転が可能となる。動作停止後に、退避操作をするときには、操作指令通りにサーボモータ9を動作させて、衝突状態からスムーズに退避することができる。【選択図】図1
Description
本発明は、手動操作時に衝突が発生したときに適切な退避動作を行うことができる成形品取出機の制御装置に関するものである。
特許第3526555号公報(特許文献1)には、チャック部に過度な外力が作用した場合であっても、チャック部が取り付けられる部材の変形を防止して、成形品の傷付を防止することができる成形品取出機の発明が開示されている。この発明では、チャック部が所定の位置へ移動した際に電動モータを直流拘束してチャック部を所定の位置に停止保持させ、停止保持されたチャック部に外力が作用したことを衝突検知用センサで検出して電動モータによる直流拘束力を減少制御してチャック部を外力により移動可能にする。
しかしながら衝突検知専用センサや衝突退避専用センサを取出機の取出ヘッドを含むフレーム全体に取り付けることは現実的に難しく、大きなコストアップにもつながる。また作業環境や作業状況によって、どの箇所に衝突するかを予測することは難しい。そのため実際には、作業者が、成形品取出機の手動動作中に操作を誤って金型や周辺機器に衝突させ、その後の退避操作が原因で、取出ヘッドやガイド部であるトラックローラー及び固定プレートを損傷させることがある。
本発明の目的は、成形品取出機を手動操作する際に衝突が発生したときに破損を防止する適切な動作を行うことができる成形品取出機の制御装置を提供することにある。
本発明は、成形品取出機における取出ヘッドを有するフレームを駆動するサーボモータの駆動部の位置及び速度をエンコーダにより検出して、検出値と位置指令及び速度指令の値との偏差を求め、この偏差により駆動部の位置及び速度のフィードバック制御を行ってサーボモータを制御するサーボ系制御部と、サーボ系制御部を手動操作する際の手動指令を発生する手動指令発生部を備えた成形品取出機の制御装置を改良の対象とする。本発明の制御装置は、衝突が発生したときに適切な動作を行えるようにするために、トルク検知部と、衝突検知部と偏差クリア部を備えている。トルク検知部は、手動指令発生部から出力される手動指令によりサーボ系制御部に動作指令を与えてサーボモータを手動操作する際にフレームに加わるトルクを検知する。そして衝突検知部は、トルク検知部の検出値が予め定めた値より大きくなったときに取出ヘッドが周辺物に衝突したものとして動作停止指令を出力する。その上で、偏差クリア部は、動作停止指令が出力されると、サーボ系制御部のオン状態を維持した状態で、サーボ系制御部中の偏差を0にするクリア動作を行う。
現状では、手動操作中に上下フレームの取出ヘッドを金型等に衝突させることでモータトルク値が例えば、300%に達したときに、過負荷エラーが発生して、サーボモータを停止させる。このときは、サーボ系制御部はサーボオフの状態となるため、衝突した状態から退避するためには再びサーボ系制御部をサーボオンにする必要がある。サーボ系制御部でサーボオフの状態になると、位置偏差が0になると共に取出ヘッドが金型等と接触した状態で若干下降し、取出ヘッドを損傷させるおそれがある。また退避動作をする際に、サーボオンとしたときに手動操作を誤ると、再度、取出ヘッドを金型に衝突させたり、負荷がかかることで上下フレームや取出ヘッドを変形させる可能性がある。また場合によっては、再びサーボオフとなり衝突した状態から脱却できない可能性がある。
本発明によれば、動作停止指令が出力されると、偏差クリア部がサーボ系制御部のオン状態を維持した状態で、サーボ系制御部中の偏差を0にするクリア動作を行うため、偏差が0となることにより位置決め完了が確定して、再度運転が可能となる。その結果、動作停止後に、退避操作をするときには、操作指令通りにサーボモータを動作させて、上下フレーム及び取出ヘッドを動かすことができて、衝突状態からスムーズに退避することができる。
衝突検知部は、前述の予め定めた値を自動運転時の制限値よりも低い値とするのが好ましい。これにより作業者による手動操作の相違によって、衝突時に必要以上の負荷が周辺物に加わるのを防止することができる。
また衝突検知部は、トルク検知部の検出値が予め定めた値より大きくなったことを所定時間検知し続けたときに、取出ヘッドが周辺物に衝突したものとして動作停止指令を出力するのが好ましい。このようにするとノイズによって予め定めた値よりも検出値が大きくなってしまった際にそのノイズを検出しなくなるので、「衝突した」という検出を正確に行うことができる。
さらに衝突検知部は、動作停止指令を出力すると同時にアラーム信号を出力し、衝突検知後の退避時に前記サーボ系制御部に再度手動指令発生部から移動指令が入力されてトルク検知部の検出値が前述の予め定めた値よりも低くなった後、所定時間が経過するまでアラーム信号を出力し続けるのが好ましい。もしトルク検知部の検出値が前述の予め定めた値よりも低くなったと同時にアラームを消してしまうと、作業者が同時に手動操作を止めた場合、衝突状態から完全に退避できていない可能性がある。そのため、アラーム信号の出力を所定時間経過するまで出力することで、作業者は手動操作を続け、衝突状態から完全に退避することができる。
また偏差クリア部は、再度前記手動指令発生部から移動指令が入力されると再度クリア動作を行うのが好ましい。このようにすると、退避動作行う前に確実に偏差データをクリアすることができる。また、わずかな偏差が残った状態で移動指令が入力されることがなくなるので、わずかな偏差を急激にゼロにしようとするフィードバック制御が働いて、オーバーシュートもしくはアンダーシュートを伴う動作により、再度衝突する危険が発生することを防止できる。
トルク検知部は、取出ヘッドに作用する少なくとも1つのトルクの作用方向を検知できるように構成されており、手動操作をするために使用される入力部の表示部には、トルクの作用方向とトルクの大きさに比例するトルク表示が示されているのが好ましい。これらのトルク表示は、数値表示、バーグラフ表示、メータ表示など任意の表示をすることができる。このようにすると、操作者は、退避動作を行う場合にどの方向のトルクを小さくする方向に退避すればよいのかをデータに基づいて正しく決定することができる。
表示部にはトルク表示に隣接して、退避方向を示唆する示唆表示が示されているのが好ましい。この示唆は、文字表示でも、マーク表示でも、またランプ表示等のいずれでもよい。このような表示をすれば、熟練者で無くても、衝突後に容易に退避動作を行うことができる。
なおトルク検知部は、サーボモータが3軸(XVZ)方向の駆動に用いられる場合には、トルク検知部は横行方向のトルク、引抜方向のトルク及び上下方向トルクを検知できるように構成されているのが好ましい。またサーボモータが駆動する軸数が、5軸、6軸等の多軸の場合には、多軸のすべてのトルクを検出できるようにトルク検知部を構成するのが好ましい。さらに取出ヘッドが姿勢制御装置に装着される場合には、姿勢制御装置から取出ヘッドに加わるトルクも、トルク検知部で検知できるようにするのが好ましい。
表示部には3つのトルク表示に隣接して、退避方向を示唆する3つの示唆表示がそれぞれ示されてもよい。このような表示をすれば、操作者は、衝突後の退避動作を行う場合にどの方向のトルクを小さくする方向に退避すればよいのかをデータに基づいて正しく決定することができる。
以下図面参照して本発明の実施の形態の一例を詳細に説明する。図1は、本発明の一実施の形態を適用した成形品取出機1の概略構成を示すブロック図である。図2は本実施の形態の特に衝突検知前後のタイムチャートを示している。図3は入力部23の表示の一例を示す図である。成形品取出機1は、成形機の型内に進入して成形機の型から成形品を取り出すための取出ヘッド3を先端に有する上下フレーム5を三軸直交型の搬送機構7により搬送する成形品取出機である。搬送機構7の駆動源としてエンコーダ10付きの複数のサーボモータ9が用いられている。複数のサーボモータ9の制御をする制御装置11内には、エンコーダ10が検出する位置情報及び速度情報と位置指令及び速度指令との偏差を求めて、この偏差により駆動部としてのサーボモータ9の駆動軸の位置及び速度のフィードバック制御を行うためのサーボ系制御部13が複数のサーボモータ9に対して設けられている。サーボ系制御部13は、いわゆるサーボアンプとしての機能を果たす。
本実施の形態では、制御装置11は、サーボ系制御部13を手動操作する際の手動指令を発生する手動指令発生部14と、ティーチングの際に適切な動作を行うために必要な動作を行ってティーチングデータを取得して記憶するティーチングデータ取得部15と、トルク検知部17と、衝突検知部19と偏差クリア部21を備えている。トルク検知部17は、図2に示すように、入力部23からの手動操作により手動指令発生部14がサーボ系制御部13に移動指令[図2(A)参照]を与えてサーボモータ9を手動操作する際に上下フレーム5または取出ヘッド3に加わるトルク[図2(B)参照]を検知する。本実施の形態では、トルク検知部17は、取出ヘッド3に作用する横行方向のトルク、引抜方向のトルク及び上下方向トルクを検知できるように構成されている。トルクの検知は、モータ電流を測定して検知してもよいし、トルクセンサを用いて検知してもよい。そして本実施の形態では、図3に示すように、手動操作をするために使用されるコントローラからなる入力部23の表示部24の表示画面に、横行方向のトルク、引抜方向のトルク及び上下方向のトルクの大きさに比例する3つのトルク表示(図3では、「40%」、「150%」、「30%」の表示)をするようにしている。また表示部24の表示画面には3つのトルク表示に隣接して、退避方向を示唆する3つの示唆表示(図3では、「○」印と「●」印)がそれぞれ示されている。なおこの示唆表示は、文字表示でも、マーク表示でも、またランプ表示等のいずれでもよい。このような表示をすれば、操作者は、衝突後の退避動作を行う場合にどの方向のトルクを小さくする方向に退避すればよいのかをデータに基づいて正しく決定することができる。また熟練者で無くても、衝突後に容易に退避動作を行うことができる。
衝突検知部19は、トルク検知部17の検出値が予め定めた値より大きくなったときに取出ヘッド3が周辺物に衝突したものとして動作停止指令を出力する。本実施の形態では、図2(B)に示すように、衝突検知部19は、予め定めた値を自動運転時の制限値(例えば定格トルクの300%)よりも低い値(制限値×α%:例えばα=50%)にしている。このように予め定め値を定めることにより、ティーチング等の作業や衝突後の退避動作をするときの手動操作によって、衝突時や退避動作時に必要以上の負荷が周辺物に加わるのを防止している。また本実施の形態では、衝突検知部19が、トルク検知部17の検出値が予め定めた値より大きくなったことを所定時間T1[図2(B)の「β秒」参照]検知し続けたときに、取出ヘッド3が周辺物に衝突したものとして動作停止指令[図2(E)参照]を出力する。このトルクが予め定めた値を超えたときに直ちに衝突であると判断すると、タッピング操作をするときなどに、衝突であると誤った判断をすることがあるため、β秒(具体的に0.2~0.3秒)の期間が経過した後も、トルクが制限値×α%を超え続けていた場合に、衝突が発生したと判断することとした。
さらに衝突検知部19は、動作停止指令を出力すると同時にアラーム信号[図2(C)のエラーフラグ参照]を出力する。その後、退避操作をするために、入力部23を操作してサーボ系制御部13に手動指令発生部14から再度手動操作による移動指令が入力された(図2(A)の「逆方向へ移動」のタイミングになった)後、トルク検知部17の検出値が前述の予め定めた値よりも小さくなった後(フラグ1が0になった)後、所定時間[図2(B)のγ秒参照]が経過するまで(時間T2)は、アラーム信号[図2(C)のエラーフラグ]を出力し続ける。なお「逆方向への移動」をする移動指令が入力されても衝突状態から徐々にトルクが0になっていくため、直ちに制限値×α%が0になることはない。そしてアラーム信号が出力されている間は、アラーム25は音、画像等により作業者に警告を発生する。なおγ秒の待ち時間T2を設定するのは、作業者の退避操作が誤っている場合に、作業者に退避操作のやり直しをするチャンスを与えるためである。すなわち衝突によって引抜方向のトルクが高い状態にあるときには、引抜方向のトルクが0になる方向に上下フレーム5を移動させる必要がある。しかし作業者が上下方向に上下フレーム5を移動させる手動操作をすると、取出ヘッド3を強い力で被衝突物に押しつけた状態で上限方向に移動させて、取出ヘッド3を壊してしまうことがある。そこで作業者に正しい判断をするのに必要な時間を提供するために、γ秒の待ち時間T2を設定している。
偏差クリア部21は、衝突検知部19から動作停止指令が出力されると、サーボモータのサーボ系制御部13のオン状態を維持した状態で、サーボ系制御部13内で演算した偏差を0にする偏差クリア動作を行う。本実施の形態では、偏差クリア部21は、図2(D)に示すように、再度手動操作による移動指令[図2(A)参照]が入力されると、再度クリア動作を行う[図2(D)参照]。
本実施の形態の制御装置によれば、衝突検知部19から動作停止指令が出力されると、偏差クリア部21がサーボ系制御部のオン状態を維持した状態で、サーボ系制御部中の偏差を0にするクリア動作を行うため、偏差が0となることにより位置決め完了が確定して、再度手動指令に対応した運転が可能となる。偏差が0になっていないと、退避動作のための手動指令に先立って偏差分の動作をすることになる。この動作が、取出ヘッド3を損傷させる虞れがあるが、本実施の形態では、このような問題は発生しない。本実施の形態ででは、動作停止後に、脱却操作をするときには、入力部23からの操作指令通りにサーボモータ9を動作させて、上下フレーム5(取出ヘッド3)を動かすことができて、衝突状態からスムーズに退避することができる。
図4は、衝突検知時の実際の動作フローである。ステップST1では、トルク値が所定の値(制限値×α%)より大きいか否かが判定される。Noの場合にはステップST2で手動操作が実行され、ステップST3でサーボモータ9を駆動して軸を移動させる。そしてステップST4では、トルク値が所定の値(制限値×α%)より大きいか否かが再度判定され、Yesの場合には、ステップST5へと進んでタイマの時間T1が0であるかを判定し、YesであればステップST6でタイマの計数を開始してステップST7へと進む。またステップST5でNoの場合にもステップST7へと進んで、タイマは計数を継続する。次にステップST8で、タイマ時間T1がβであるか否かの判定がなされ、βであればステップST9へと進み、NoであればステップST1に戻る。ステップST4でNoであれば、ステップST41へと進み。タイマ時間T1が0であるか否かの判定が行われ、NoであればステップST42でタイマをオフにしてステップST43でタイマ時間T1を0にしてステップST2に戻る。ステップST41でYesの場合にもステップST2に戻る。ステップST8でタイマ時間T1がβになったことが判定されると、ステップST9でエラーフラグがONとなりステップST10で停止処理が実行される。その後ステップST11で偏差がクリアされ、ステップST12でアラームとしてエラーポップアップ(エラー表示)が出され、ステップST13でアラームとしてブザーが発報される。その後ステップST14でタイマのオフ動作が行われてステップST15でタイマ時間T1が0になる。上記の動作により、衝突が検知された後サーボ系制御部がオン状態を維持した上で偏差がリセットされる。
図5は衝突退避時の動作フローである。この例では開始時にトルク値が制限値×α%より大きい場合に衝突退避を行う。ステップST21でトルク値が制限値×α%より小さいか否かの判定がなされる。小さくない場合(大きい場合)にはステップST22へと進んで手動操作が実行され、ステップST23で偏差をクリアして動作停止指令をオフにして、ステップST24でサーボモータを駆動して軸を移動させる。その後、ステップST25で、トルク値が制限値×α%より小さいか否かの判定がなされる。トルク値が制限値×α%より小さい場合には、ステップST26へと進んでタイマ時間T2が0か否かの判定がなされる。タイマ時間T2が0の場合には、ステップST27でタイマの計数が開始される。タイマ時間T2が0でない場合にはステップST28でタイマの計数が継続される。ステップST25でトルク値が制限値×α%より小さくない場合には、ステップST251へと進んでタイマ時間T2が0か否かの判定がなされる。0であればステップST21に戻り、0でなければステップST252へと進んでタイマがオフとされ、ステップST253でタイマ時間T2を0(初期化)にしてステップST21へ戻る。ステップST28でのタイマ時間の計数で、タイマ時間がγになったか否かがステップST29で判定される。NOであればステップ21へ戻り、Yesであれば衝突退避動作のためにステップST30へと進んでエラーフラグをオフにし、ステップST31でブザーをオフにし、ステップST32でタイマ時間T2の計数をオフにして、ステップST33でタイマ時間T2を0にする(初期化する)。これにより衝突状態からの退避がなされる。
[変形例]
トルク検知部は、取出ヘッドに種々の方向から作用するトルクの作用方向を検知できるように構成されているのが好ましい。例えばサーボモータが駆動する軸数が、5軸、6軸等の多軸の場合には、多軸のすべてのトルクを検出できるようにトルク検知部を構成すればよい。また取出ヘッドが姿勢制御装置に装着される場合には、姿勢制御装置から取出ヘッドに加わるトルクも、トルク検知部で検知できるようにすればよい。さらに手動操作をするために使用される入力部の表示部には、トルク検知部が検知するすべてのトルクの大きさに比例するトルク表示を示すのが好ましい。これらのトルク表示は、数値表示、バーグラフ表示、メータ表示な任意の表示をすることができる。また入力部の表示部のトルク表示に隣接して、退避方向を示唆する示唆表示がそれぞれ示されているのが好ましい。この示唆は、文字表示でも、マーク表示でも、またランプ表示等のいずれでもよい。
トルク検知部は、取出ヘッドに種々の方向から作用するトルクの作用方向を検知できるように構成されているのが好ましい。例えばサーボモータが駆動する軸数が、5軸、6軸等の多軸の場合には、多軸のすべてのトルクを検出できるようにトルク検知部を構成すればよい。また取出ヘッドが姿勢制御装置に装着される場合には、姿勢制御装置から取出ヘッドに加わるトルクも、トルク検知部で検知できるようにすればよい。さらに手動操作をするために使用される入力部の表示部には、トルク検知部が検知するすべてのトルクの大きさに比例するトルク表示を示すのが好ましい。これらのトルク表示は、数値表示、バーグラフ表示、メータ表示な任意の表示をすることができる。また入力部の表示部のトルク表示に隣接して、退避方向を示唆する示唆表示がそれぞれ示されているのが好ましい。この示唆は、文字表示でも、マーク表示でも、またランプ表示等のいずれでもよい。
本発明によれば、動作停止指令が出力されると、偏差クリア部がサーボ系制御部のオン状態を維持した状態で、サーボ系制御部中の偏差を0にするクリア動作を行うため、偏差が0となることにより位置決め完了が確定して、再度運転が可能となる。その結果、動作停止後に、退避操作をするときには、操作指令通りにサーボモータを動作させて、上下フレーム及び取出ヘッドを動かすことができて、衝突状態からスムーズに退避することができる。
1 成形品取出機
3 取出ヘッド
5 上下フレーム
7 搬送機構
9 サーボモータ
10 エンコーダ
11 制御装置
13 サーボ系制御部
14 手動指令発生部
15 ティーチングデータ取得部
17 トルク検知部
19 衝突検知部
21 偏差クリア部
23 入力部
24 表示部
25 アラーム
3 取出ヘッド
5 上下フレーム
7 搬送機構
9 サーボモータ
10 エンコーダ
11 制御装置
13 サーボ系制御部
14 手動指令発生部
15 ティーチングデータ取得部
17 トルク検知部
19 衝突検知部
21 偏差クリア部
23 入力部
24 表示部
25 アラーム
Claims (9)
- 成形品取出機における取出ヘッドを有するフレームを駆動するサーボモータの駆動部の位置及び速度をエンコーダにより検出して、検出値と位置指令及び速度指令の値との偏差を求め、この偏差により前記駆動部の位置及び速度のフィードバック制御を行って前記サーボモータを制御するサーボ系制御部と、前記サーボ系制御部を手動操作する際の手動指令を発生する手動指令発生部を備えた成形品取出機の制御装置において、
前記手動指令発生部から出力される前記手動指令により前記サーボ系制御部に動作指令を与えて前記サーボモータを手動操作する際に前記フレームに加わるトルクを検知するトルク検知部と、
前記トルク検知部の検出値が予め定めた値より大きくなったときに前記取出ヘッドが周辺物に衝突したものとして動作停止指令を出力する衝突検知部と、
前記動作停止指令が出力されると、前記サーボ系制御部のオン状態を維持した状態で、前記サーボ系制御部中の前記偏差を0にするクリア動作を行う偏差クリア部をさらに備えたことを特徴とする成形品取出機の制御装置。 - 前記衝突検知部は、前記予め定めた値を自動運転時の制限値よりも低い値とする請求項1に記載の成形品取出機の制御装置。
- 前記衝突検知部は、前記トルク検知部の前記検出値が前記予め定めた値より大きくなったことを所定時間、検知し続けたときに前記取出ヘッドが周辺物に衝突したものとして動作停止指令を出力する請求項1または2に記載の成形品取出機の制御装置。
- 前記衝突検知部は、前記動作停止指令を出力すると同時にアラーム信号を出力し、衝突検知後の退避時に前記サーボ系制御部に再度前記手動指令発生部から移動指令が入力されて前記トルク検知部の前記検出値が前記予め定めた値より小さくなった後、所定時間が経過するまで前記アラーム信号を出力し続ける請求項3に記載の成形品取出機の制御装置。
- 前記偏差クリア部は、再度前記手動指令発生部から前記移動指令が入力されると再度前記クリア動作を行う請求項4に記載の成形品取出機の制御装置。
- 前記トルク検知部は、前記取出ヘッドに作用するトルクの作用方向を検知できるように構成されており、
前記手動操作をするために使用される入力部の表示部には、前記トルクの作用方向と前記トルクの大きさに比例するトルク表示が示されている請求項1乃至5のいずれか1項に記載の成形品取出機の制御装置。 - 前記表示部には前記トルク表示に隣接して、退避方向を示唆する示唆表示が示されている請求項6に記載の成形品取出機の制御装置。
- 前記トルク検知部は、前記取出ヘッドに作用する横行方向のトルク、引抜方向のトルク及び上下方向のトルクを検知できるように構成されており、
前記手動操作をするために使用される入力部の表示部には、前記横行方向のトルク、前記引抜方向のトルク及び前記上下方向のトルクの大きさに比例する3つのトルク表示が示されている請求項6に記載の成形品取出機の制御装置。 - 前記表示部には前記3つのトルク表示に隣接して、退避方向を示唆する3つの示唆表示がそれぞれ示されている請求項8に記載の成形品取出機の制御装置。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020202992A JP2022090541A (ja) | 2020-12-07 | 2020-12-07 | 成形品取出機の制御装置 |
US17/542,866 US20220176596A1 (en) | 2020-12-07 | 2021-12-06 | Control system for apparatus for taking out molded product |
CN202111479367.2A CN114590553A (zh) | 2020-12-07 | 2021-12-06 | 成形品取出机的控制装置 |
EP21212561.1A EP4008517A1 (en) | 2020-12-07 | 2021-12-06 | Control system for apparatus for taking out molded product |
KR1020210173489A KR20220080721A (ko) | 2020-12-07 | 2021-12-07 | 성형품 취출기의 제어 장치 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020202992A JP2022090541A (ja) | 2020-12-07 | 2020-12-07 | 成形品取出機の制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2022090541A true JP2022090541A (ja) | 2022-06-17 |
Family
ID=79185632
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2020202992A Pending JP2022090541A (ja) | 2020-12-07 | 2020-12-07 | 成形品取出機の制御装置 |
Country Status (5)
Country | Link |
---|---|
US (1) | US20220176596A1 (ja) |
EP (1) | EP4008517A1 (ja) |
JP (1) | JP2022090541A (ja) |
KR (1) | KR20220080721A (ja) |
CN (1) | CN114590553A (ja) |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS526555B2 (ja) | 1972-10-30 | 1977-02-23 | ||
US4065212A (en) | 1975-06-30 | 1977-12-27 | International Business Machines Corporation | Inspection tool |
JP2665984B2 (ja) * | 1989-12-26 | 1997-10-22 | ファナック株式会社 | 外乱推定オブザーバによる衝突検出方法 |
JP2608161B2 (ja) * | 1990-03-29 | 1997-05-07 | ファナック株式会社 | 産業用ロボットの停止制御方法 |
JP3079047B2 (ja) * | 1996-10-22 | 2000-08-21 | ファナック株式会社 | 電動式射出成形機の可動部材衝突検知装置 |
JP2000277039A (ja) * | 1999-03-26 | 2000-10-06 | Toshiba Corp | 画像表示装置およびその製造方法 |
JP5168352B2 (ja) * | 2008-04-17 | 2013-03-21 | 三菱電機株式会社 | 加工機における衝突検出装置及び衝突検出方法 |
DE112010005362T5 (de) * | 2010-03-08 | 2012-12-27 | Mitsubishi Electric Corporation | Numerische-Steuerung-Vorrichtung und Steuerverfahren einer Numerische-Steuerung-Vorrichtung |
CN106239516B (zh) * | 2015-06-03 | 2021-09-24 | 精工爱普生株式会社 | 机器人控制装置、机器人以及机器人系统 |
HUE063306T2 (hu) * | 2017-07-21 | 2024-01-28 | Husky Injection Molding Systems Ltd | Védõberendezés programozása formázógéphez |
JP6731893B2 (ja) * | 2017-07-31 | 2020-07-29 | ヤンマーパワーテクノロジー株式会社 | 作業車両 |
US20210354358A1 (en) * | 2018-09-21 | 2021-11-18 | Canon U.S.A., Inc. | Injection molding system |
EP3689555A1 (de) * | 2019-02-04 | 2020-08-05 | Siemens Aktiengesellschaft | Kraftbegrenztes verfahren mindestens eines elements einer produktionsmaschine im manuellen betrieb |
-
2020
- 2020-12-07 JP JP2020202992A patent/JP2022090541A/ja active Pending
-
2021
- 2021-12-06 CN CN202111479367.2A patent/CN114590553A/zh active Pending
- 2021-12-06 EP EP21212561.1A patent/EP4008517A1/en active Pending
- 2021-12-06 US US17/542,866 patent/US20220176596A1/en active Pending
- 2021-12-07 KR KR1020210173489A patent/KR20220080721A/ko unknown
Also Published As
Publication number | Publication date |
---|---|
KR20220080721A (ko) | 2022-06-14 |
US20220176596A1 (en) | 2022-06-09 |
CN114590553A (zh) | 2022-06-07 |
EP4008517A1 (en) | 2022-06-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2608161B2 (ja) | 産業用ロボットの停止制御方法 | |
JP4897632B2 (ja) | 衝突検出機能を有する工作機械の制御装置 | |
EP0566741A1 (en) | Abnormal load detecting method | |
US20190294144A1 (en) | Abnormality detection device | |
EP0203199B1 (en) | Injection molding machine which uses a servo motor and which is provided with a protecting function | |
JP4199283B2 (ja) | 射出成形機 | |
CN107932500A (zh) | 具有限制机器人的速度、加速度的功能的机器人控制装置 | |
CN113412388A (zh) | 需要有意功能激活的安全系统和包括需要有意功能激活的安全系统的材料试验系统 | |
EP1840687A1 (en) | Electric motor control unit | |
JP2676627B2 (ja) | 2つの切断工具の衝突防止装置 | |
JP2022090541A (ja) | 成形品取出機の制御装置 | |
US10065235B2 (en) | System using an air gap for workpiece protection in a fastener machine | |
US10401826B2 (en) | Numerical controller facilitating measure to be taken after detection of interference | |
JP2005052941A (ja) | ワーク載置装置 | |
US5929346A (en) | Apparatus for detecting abnormalities in a work holder | |
JP3327205B2 (ja) | ロボットの制御方法および装置 | |
US20220118614A1 (en) | Force-limited movement of at least one element of a production machine in manual operation | |
JP2005321979A (ja) | 数値制御装置 | |
US20200159190A1 (en) | Numerical controller | |
CN113043328A (zh) | 平衡器的异常检测系统和平衡器的异常检测方法 | |
JP3842596B2 (ja) | 金型保護制御を行う型閉装置が設けられた射出成形機および型閉装置の制御方法 | |
JP7368156B2 (ja) | ロボット制御システム | |
WO1995009063A1 (fr) | Procede pour regler automatiquement l'ecartement d'un ajutage superieur pour machine d'etincelage | |
US10739753B2 (en) | Numerical controller having reduced waiting time for interference avoidance | |
JPH07104810A (ja) | 数値制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20230816 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20231025 |