JP5972941B2 - 数値制御装置付き工作機械 - Google Patents

数値制御装置付き工作機械 Download PDF

Info

Publication number
JP5972941B2
JP5972941B2 JP2014160168A JP2014160168A JP5972941B2 JP 5972941 B2 JP5972941 B2 JP 5972941B2 JP 2014160168 A JP2014160168 A JP 2014160168A JP 2014160168 A JP2014160168 A JP 2014160168A JP 5972941 B2 JP5972941 B2 JP 5972941B2
Authority
JP
Japan
Prior art keywords
center
gravity
machine tool
load
movable part
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2014160168A
Other languages
English (en)
Other versions
JP2016038653A (ja
Inventor
泰広 中濱
泰広 中濱
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
FANUC Corp
Original Assignee
FANUC Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by FANUC Corp filed Critical FANUC Corp
Priority to JP2014160168A priority Critical patent/JP5972941B2/ja
Priority to DE102015112888.8A priority patent/DE102015112888B4/de
Priority to US14/818,669 priority patent/US10474122B2/en
Priority to CN201510477384.0A priority patent/CN105373073B/zh
Publication of JP2016038653A publication Critical patent/JP2016038653A/ja
Application granted granted Critical
Publication of JP5972941B2 publication Critical patent/JP5972941B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical 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/19Numerical 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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical 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/402Numerical 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 control arrangements for positioning, e.g. centring a tool relative to a hole in the workpiece, additional detection means to correct position
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/41Servomotor, servo controller till figures
    • G05B2219/41114Compensation for gravity, counter balance gravity

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Numerical Control (AREA)

Description

本発明は、数値制御装置付き工作機械に関し、特に本体の重心位置を調整する機能を有する数値制御装置付き工作機械に関する。
工作機械は、比較的小型で軽量のものであれば、近距離で移動されることも多い。その移動方法としては、クレーン等で吊り上げたり、台車や、フォークリフトやハンドリフトなどのリフトによって機械を持ち上げて運ぶ方式がある。特に、リフトを使用する方法は、リフト自体が小型であるため、工場建屋内などの比較的近距離での移設作業時に用いられることが多い。
このようにリフトを用いて持ち上げる場合、機械の転倒事故等を防ぐために、リフトが有する2本のフォークの間に機械の重心がくるようにフォークの位置や幅を決める必要がある。この、フォークの位置や幅を決める際に、機械の重心位置を把握しておくことが重要となる。
特許文献1には、産業用ロボットの輸送用補助装置において、フォークリフトを用い、フォークの受け部が、ロボット全体の重心が2本のフォークの間にくるように、ベース部に開口や専用部品を外付けして、ロボット本体を安定した輸送用姿勢をとりつつ、フォークを受け部に挿入して持ち上げる技術が開示されている。
また、小型の工作機械においても、リフトによる移設作業が行われる。この場合、リフトの差込位置が決められていないものが多く、可動部の位置や、テーブル上面などの可動部に設置された積載物の重量が、移設作業ごとに毎回一定でない場合には、重心位置もまた一定ではないため、リフトの位置もこれに応じて決める必要がある。
特許第3883535号公報
小型の工作機械のリフトによる移設作業においては、機械の重心位置に合わせてリフトを位置決めして持ち上げる場合と、リフトの位置を先に決めてしまったあとで、重心位置がフォークの間にくるよう可動部を位置決めする場合がある。
ここで、後者のリフトの位置を先に決めてしまったあとで、可動部を位置決めする場合、重心位置がフォーク間にくる可動部の位置を予想のうえまずは仮定し、位置決めして持ち上げた後、そのバランスを見て可動部の位置の修正を行うという作業を何度か試行することで安定する位置を最終的に決定することとなる。そのため、最初に見立てた重心位置が真の重心位置から著しく異なる場合、試行回数が多くなり工数が増加する。また、上げ下ろしを繰り返すことで機械部品に負担がかかる可能性がある。このため、フォーク間に重心がくるような可動部の位置を最初からなるべく正確に把握し、試行回数を少なくすることが望ましい。
また、フォークによる持上げ作業は機械の電源を切断して行われる場合が多いが、その場合は数値制御装置による位置決めができないため、可動部の位置を修正する際には、人間の手で直接押すなどして強制的に移動させる方法が取られている。ただし、この方法も電源切断時に移動軸にブレーキがかかる構造の機械では行うことができない。
これらのことから、可動部の位置の修正においては、機械の通電中に数値制御装置により正確に位置決めできることが望ましい。
そこで本発明は、数値制御装置付き工作機械において、工作機械の重心位置を簡単な方法で任意の位置に調整することができる工作機械を提供することを目的とする。
本願の請求項1に係る発明では、数値制御装置と、該数値制御装置によって制御され、固定部と、積載物が設置可能な可動部と、を備えた工作機械とを備えた数値制御装置付き工作機械であって、前記数値制御装置は、前記固定部、前記可動部、及び前記積載物のそれぞれの重量及び重心位置が記憶された記憶手段と、該記憶手段に記憶された前記固定部の重心位置及び重量、前記可動部の重心位置及び重量、前記固定部に対する前記可動部の相対位置、及び、前記積載物の重心位置及び重量とから前記工作機械と前記積載物を合わせた全体の重心位置である実重心位置を計算する実重心位置計算手段と、前記工作機械と前記積載物を合わせた全体の重心位置の目標位置である目標重心位置を設定する目標重心位置設定手段と、前記目標重心位置設定手段によって設定された前記目標重心位置に前記工作機械と前記積載物を合わせた全体の重心位置が一致するよう、前記固定部に対する前記可動部の相対位置を補正する可動部位置補正手段とを備えたことを特徴とする数値制御装置付き工作機械が提供される。
請求項1に係る発明によると、工作機械と積載物とを合わせた全体の重心位置の目標重心位置を設定して、全体の重心位置が目標重心位置に一致するように、固定部に対する可動部の相対位置を補正する可動部位置補正手段を備えたことによって、工作機械の重心位置を任意に調整することが可能となるため、フォークリフト等の機器を用いて移設作業を行う際に、リフトの位置を任意に設定しても、その後の可動部位置補正による重心位置の変更によって、安定した姿勢で作業を行うことが可能となる。
本発明により、数値制御装置付き工作機械において、工作機械の重心位置を簡単な方法で任意の位置に調整することができる工作機械を提供することが可能となる。
本発明の実施形態における数値制御装置付き工作機械の概略図である。 本発明の実施形態における工作機械と積載物とを合わせた全体の重心位置の計算手法のブロック図である。 本発明の実施形態における数値制御装置付き工作機械における可動部の移動の様子を示す図である。
以下、本発明の実施形態を図面に基づいて説明する。
図1は、本実施形態が適用される数値制御装置付き工作機械の概略図を示している。1は数値制御装置であり、内部にCPU7及びメモリ8を備え、表面に表示装置9と入力手段10とを備えている。また、数値制御装置1は工作機械11と接続されている。工作機械11は、ベッド2、コラム3、主軸頭4、テーブル5等から構成されている。6はテーブル5の上面に積載されているワークや冶具などの積載物である。ベッド2及びコラム3は、接地面に対して静止しており、本願の固定部に相当する。主軸頭4及びテーブル5は、数値制御装置1からの制御指令を受けて、ベッド2やコラム3の固定部に対して相対移動が可能であり、本願の可動部に相当する。
数値制御装置1内のメモリ8には、工作機械11におけるベッド2やコラム3などの固定部の重心位置と重量、及び、主軸頭4やテーブル5などの可動部の重心位置と重量が予め記憶されている。また、CPU7では、主軸頭4やテーブル5などの可動部の、固定部に対する相対位置や、所定の方法で取得された、テーブル5上に積載された積載物6の重心位置と重量に関する情報から、工作機械11を積載物6とを合わせた全体の重心位置を計算する。具体的な計算方法については後述する。
表示装置9は、CPU7で計算された工作機械11と積載物6とを合わせた全体の重心位置を表示する。重心位置の表示の際には、少なくともいずれか1方向成分に関する情報のみの表示とすることもできる。
ワークの重心位置と重量に関する情報については、入力手段10を用いて、作業者が入力する。また、テーブル5上に乗せる積載物6の重心位置と重量と、テーブル5を加減速する際のパラメータとの関係が、数値制御装置1のメモリ8内に設定されている場合には、積載物6を乗せたテーブル5を移動させることにより、加減速する際のパラメータの値から、積載された積載物6の重量と重心位置を推定して用いることもできる。また、入力手段10は、後述する目標重心位置等を指定する際に使用することも可能である。
図2は、これらの積載物6の重心位置と重量に関する情報を用いて、工作機械11と積載物6とを合わせた全体の重心位置の計算手法のブロック図である。以下ブロック毎に説明する。
まず、工作機械11を構成する部材を、設置面に対して静止している固定部と、固定部に対して相対的に移動可能な可動部とに分ける。本実施形態においては、固定部としてベッド2とコラム3とが含まれており、可動部として主軸頭4とテーブル5とが含まれている。まず、ブロックB1において、可動部の重心位置と重量、及び、固定部の重心位置と重量の値を取得する。また、ブロックB2において、可動部の位置情報を取得する。ブロックB3では、積載物6の重量を取得する。積載物6の重量の取得は、入力手段10により作業者が入力したり、積載物6を乗せたテーブル5を移動させて、加減速する際のパラメータの値を用いて、積載物6の積載重量を推定するといった手法を取ることが可能である。
これらの可動部の位置情報、可動部の重心位置と重量、固定部の重心位置と重量、積載物の重量を用いて、ブロックB4において、CPU7で工作機械11と積載物6とを合わせた全体の重心位置を計算する。そして、計算された全体の重心位置の値を、ブロックB5において、メモリ8に保存する。また、この際に表示装置9において、全体の重心位置の値を表示するようにすることもできる。
一方、ブロックB6においては、入力手段10によって、目標となる重心位置を入力する。入力された目標となる重心位置は、ブロックB7において、メモリ8に保存する。これについても、入力された目標となる重心位置を、表示装置9において表示するようにすることもできる。
ブロックB8においては、メモリ8に保存された現在の重心位置、及び、目標となる重心位置に基づいて、可動部の補正量を計算する。そして、計算された可動部の補正量に基づいて、ブロックB9において可動部位置の位置補正を指令し、可動部の位置が補正される。具体的な重心位置の算出や可動部の補正量の算出の方法については後述する。
次に、重心位置の具体的な計算方法について説明する。
工作機械11と積載物6とを合わせた全体の重心位置は次式により算出される。
ここで、重心位置の計算にあたって考慮する必要のない成分については、式の計算過程より省略することができる。
一例として、図3に示されているように、水平方向及び鉛直方向を基底とし、水平方向を工作機械を設置したときの側面の方向(y方向)と一致させ、鉛直方向がz方向となるようにした基準座標系90を用いることとする。また、例えば位置の基準となる基準位置マーク91を固定部に設け、基準座標系90の座標原点を基準位置マーク91に一致するものとする。
これにより重心位置に関する情報は、基準位置マーク91を原点として数1で表されるベクトル量として扱うことができる。
以降、基準座標系90に対し、リフトをx方向に差し込む場合を例に考える。
このとき、重心位置で問題になるのはy方向成分のみとなるため、[数1式]はそのy方向成分のみ考えればよく、次式により算出される。
ここで、テーブル5の重心位置のy方向成分と積載物6の重心位置のy方向成分がほぼ一致するものとみなせる場合、数3は次式のように近似され、積載物6の重心位置に関する情報を省略できる。
次に、可動部補正位置の具体的な計算方法について説明する。
入力手段(10)によって任意の目標となる重心位置が与えられるとき、数1より次式が成立する。
数5のy方向成分を考えるとき、図1に示す構成の工作機械においては、主軸頭4はZ方向にのみ変位可能であるためγHy=rHyであり、さらにγTy=rLyと見なせる場合、数4から次式が成立する。
数4及び数6より、次式が成立する。
テーブルのy方向成分を数7より算出されたγTyにとることで、機械全体の重心位置を目標位置γyに一致させることができる。
図3に基づいて具体的に説明すると、実線部によりテーブル5と積載物6の位置が示されており、その位置が現在の可動部の位置23として示されている。また、21はそのときの、固定部、可動部を合わせた工作機械全体の重心位置を示しており、22は工作機械全体の重心位置21のy方向成分を示している。
そして、入力手段10等により目標とする重心位置31が指定されると(32は目標とする重心位置31のy方向成分)、目標とする重心位置31に工作機械全体の重心位置が一致するようにするための可動部の位置33を可動部位置補正手段により算出し、可動部の位置をかかる可動部の位置33に一致させるように移動させる。
また、一般に機械可動部には、物理的に、あるいはソフトウェアにより、可動範囲に制限が設けられているため、数7による値がこの範囲を超える場合は、メッセージを出すなどして警告を与えるようにすることもできる。
1 数値制御装置
2 ベッド(固定部)
3 コラム(固定部)
4 主軸頭(可動部)
5 テーブル(可動部)
6 積載物
7 CPU
8 メモリ
9 表示装置
10 入力手段
11 工作機械
21 現在の重心位置
22 現在の重心位置のy方向成分
23 現在の可動部の位置
31 目標とする重心位置
32 目標とする重心位置のy方向成分
33 重心位置が目標とする重心位置に一致するための可動部の位置
90 基準座標系
91 基準位置マーク

Claims (1)

  1. 数値制御装置と、
    該数値制御装置によって制御され、固定部と、積載物が設置可能な可動部と、を備えた工作機械とを備えた数値制御装置付き工作機械であって、
    前記数値制御装置は、
    前記固定部、前記可動部、及び前記積載物のそれぞれの重量及び重心位置が記憶された記憶手段と、
    該記憶手段に記憶された前記固定部の重心位置及び重量、前記可動部の重心位置及び重量、前記固定部に対する前記可動部の相対位置、及び、前記積載物の重心位置及び重量とから前記工作機械と前記積載物を合わせた全体の重心位置である実重心位置を計算する実重心位置計算手段と、
    前記工作機械と前記積載物を合わせた全体の重心位置の目標位置である目標重心位置を設定する目標重心位置設定手段と、
    前記目標重心位置設定手段によって設定された前記目標重心位置に前記工作機械と前記積載物を合わせた全体の重心位置が一致するよう、前記固定部に対する前記可動部の相対位置を補正する可動部位置補正手段
    とを備えたことを特徴とする数値制御装置付き工作機械。
JP2014160168A 2014-08-06 2014-08-06 数値制御装置付き工作機械 Active JP5972941B2 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2014160168A JP5972941B2 (ja) 2014-08-06 2014-08-06 数値制御装置付き工作機械
DE102015112888.8A DE102015112888B4 (de) 2014-08-06 2015-08-05 Werkzeugmaschine mit numerischer Steuervorrichtung
US14/818,669 US10474122B2 (en) 2014-08-06 2015-08-05 Machining tool with numerical control device
CN201510477384.0A CN105373073B (zh) 2014-08-06 2015-08-06 带有数值控制装置的机床

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2014160168A JP5972941B2 (ja) 2014-08-06 2014-08-06 数値制御装置付き工作機械

Publications (2)

Publication Number Publication Date
JP2016038653A JP2016038653A (ja) 2016-03-22
JP5972941B2 true JP5972941B2 (ja) 2016-08-17

Family

ID=55134997

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2014160168A Active JP5972941B2 (ja) 2014-08-06 2014-08-06 数値制御装置付き工作機械

Country Status (4)

Country Link
US (1) US10474122B2 (ja)
JP (1) JP5972941B2 (ja)
CN (1) CN105373073B (ja)
DE (1) DE102015112888B4 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA3049021A1 (en) * 2017-01-11 2018-07-19 Composecure, Llc Metal dual interface card

Family Cites Families (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0756608B2 (ja) * 1986-03-24 1995-06-14 キヤノン株式会社 位置決め制御装置
JPH01193134A (ja) * 1988-01-27 1989-08-03 Komatsu Ltd スライドテーブルを有する構造物のカウンターバランス移動装置
JP2702015B2 (ja) * 1991-10-25 1998-01-21 日立建機株式会社 力制御作業機械の重量・重心位置補正装置
US6561238B2 (en) * 2000-10-13 2003-05-13 Norfield Industries Menu-driven, configurable door processing station
JP2002368495A (ja) * 2001-06-08 2002-12-20 Matsushita Electric Ind Co Ltd 部品実装装置及び部品実装方法
US20050067529A1 (en) * 2001-09-14 2005-03-31 Advanced Telecommunications Research Institute International Program to be executed on a computer to determine arrangement of a plurality of objects and program to be executed on a computer to determine cargo arrangement for transporting cargo to cosmic space
JP3883535B2 (ja) 2003-10-28 2007-02-21 ファナック株式会社 ロボット輸送用補助装置
FR2882694B1 (fr) 2005-03-02 2007-05-11 Manitou Bf Sa Dispositif de stabilisation laterale, pour chariot comportant un pont oscillant
JP5117030B2 (ja) * 2006-10-19 2013-01-09 新日本工機株式会社 工作機械
JP4267027B2 (ja) 2006-12-07 2009-05-27 ファナック株式会社 ロボット制御装置
JP2010023941A (ja) * 2008-07-15 2010-02-04 Mitsubishi Heavy Ind Ltd フォークリフトの姿勢制御装置及び該装置を備えたフォークリフト
JP2010211467A (ja) 2009-03-10 2010-09-24 Fanuc Ltd 可動部重量を推定する機能を有する工作機械を制御する数値制御装置
JP4676544B2 (ja) * 2009-05-29 2011-04-27 ファナック株式会社 工作機械に対してワークの供給及び取り出しを行うロボットを制御するロボット制御装置
JP5330973B2 (ja) 2009-11-30 2013-10-30 三菱重工業株式会社 工作機械のバランス装置及びバランス制御方法
JP5506823B2 (ja) * 2009-12-28 2014-05-28 本田技研工業株式会社 ロボットの制御装置
US8825294B2 (en) * 2011-07-28 2014-09-02 Deere & Company Vehicle center of gravity active suspension control system
US8897919B2 (en) * 2012-06-13 2014-11-25 Fanuc Corporation Robot controller which conducts a force control by using a three-axial force sensor
JP5758976B2 (ja) * 2013-12-20 2015-08-05 ファナック株式会社 数値制御装置付き工作機械

Also Published As

Publication number Publication date
US20160041546A1 (en) 2016-02-11
US10474122B2 (en) 2019-11-12
DE102015112888A1 (de) 2016-02-11
CN105373073B (zh) 2018-01-02
CN105373073A (zh) 2016-03-02
DE102015112888B4 (de) 2020-01-16
JP2016038653A (ja) 2016-03-22

Similar Documents

Publication Publication Date Title
US7904201B2 (en) Robot programming device
JP5480246B2 (ja) 作業装置及び作業方法
JP5523386B2 (ja) 衝突回避装置
US20160332303A1 (en) Robot controller, simple installation-type robot, and method of controlling simple installation-type robot
JP6240133B2 (ja) 溶接を行う打点の位置を測定するスポット溶接システム
JP6166305B2 (ja) 負荷パラメータ設定装置および負荷パラメータ設定方法
JP5532760B2 (ja) 搬送システム,ロボット装置及びワークの製造方法
JP6599927B2 (ja) ワーク供給システム
JP2016052695A5 (ja)
US10280048B2 (en) Automated crane controller taking into account load- and position-dependent measurement errors
KR20130136477A (ko) 로봇 시스템의 퍼리퍼럴 구성요소를 제어하기 위한 방법 및 장치
JP2009110190A (ja) ワーク搬送用ロボットの制御装置
WO2021141039A1 (ja) ワーク搬送システム
KR20090031275A (ko) 슬라브 벤딩에 따른 크레인의 통 위치 제어장치 및 그 제어방법
JP5972941B2 (ja) 数値制御装置付き工作機械
JP5758976B2 (ja) 数値制御装置付き工作機械
JP2017119566A (ja) 自動倉庫
JP6518263B2 (ja) 搬送システムおよびその制御方法
US20170240396A1 (en) Lift-Truck with Automated Height Adjustment of Load Engagement Means
JP2002241079A (ja) クレーンの積み付け制御方法および積み付け制御装置
KR101281436B1 (ko) 전극봉 손상 방지 방법 및 장치
US11305434B2 (en) Robot system
JP5274160B2 (ja) 作業台位置調整システム
KR101633989B1 (ko) 마그네트 크레인의 제어 방법
JP2021009583A (ja) 異物検出装置

Legal Events

Date Code Title Description
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: 20160621

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20160623

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20160713

R150 Certificate of patent or registration of utility model

Ref document number: 5972941

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150