JPS61150009A - Position correcting method - Google Patents
Position correcting methodInfo
- Publication number
- JPS61150009A JPS61150009A JP27168984A JP27168984A JPS61150009A JP S61150009 A JPS61150009 A JP S61150009A JP 27168984 A JP27168984 A JP 27168984A JP 27168984 A JP27168984 A JP 27168984A JP S61150009 A JPS61150009 A JP S61150009A
- Authority
- JP
- Japan
- Prior art keywords
- load
- weight
- correction value
- work table
- drive source
- 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
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23H—WORKING OF METAL BY THE ACTION OF A HIGH CONCENTRATION OF ELECTRIC CURRENT ON A WORKPIECE USING AN ELECTRODE WHICH TAKES THE PLACE OF A TOOL; SUCH WORKING COMBINED WITH OTHER FORMS OF WORKING OF METAL
- B23H7/00—Processes or apparatus applicable to both electrical discharge machining and electrochemical machining
- B23H7/02—Wire-cutting
- B23H7/06—Control of the travel curve of the relative movement between electrode and workpiece
- B23H7/065—Electric circuits specially adapted therefor
-
- 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/401—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 control arrangements for measuring, e.g. calibration and initialisation, measuring workpiece for machining purposes
- G05B19/4015—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 control arrangements for measuring, e.g. calibration and initialisation, measuring workpiece for machining purposes going to a reference at the beginning of machine cycle, e.g. for calibration
-
- 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/41—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 interpolation, e.g. the computation of intermediate points between programmed end points to define the path to be followed and the rate of travel along that path
-
- 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/37—Measurements
- G05B2219/37612—Transfer function, kinematic identification, parameter estimation, response
-
- 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/41—Servomotor, servo controller till figures
- G05B2219/41123—Correction inertia of servo
-
- 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/45221—Edm, electrical discharge machining, electroerosion, ecm, chemical
-
- 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/49—Nc machine tool, till multiple
- G05B2219/49164—Corner, making corner
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Human Computer Interaction (AREA)
- Theoretical Computer Science (AREA)
- Computing Systems (AREA)
- Mechanical Engineering (AREA)
- Chemical & Material Sciences (AREA)
- Chemical Kinetics & Catalysis (AREA)
- Electrochemistry (AREA)
- Control Of Position Or Direction (AREA)
- Manipulator (AREA)
- Control Of Conveyors (AREA)
Abstract
Description
【発明の詳細な説明】
[発明の技術分野]
この発明は、産業機械、工作機械、ロボット等の機械一
般の位置補正方法に関する。DETAILED DESCRIPTION OF THE INVENTION [Technical Field of the Invention] The present invention relates to a position correction method for general machines such as industrial machines, machine tools, and robots.
[発明の技術的背景及びその問題点]
一般工作機械、産業機械、ロボット等の機械の駆動方法
は、閉ループ、セミ閉ループ、あるいは開ループ制御方
法による。そして、移動物体の位置決め精度を向上させ
るために移動物体の移動制御装置にバックラッシュ補正
や送りねじピッチ誤差補正機能を付加している。このよ
うな位置制御方法では移動物体の位置決め精度を向上さ
せることはできるが、移動物体、例えばテーブル上にワ
ークが載せられる場合、そのワークの重量が変更された
ような時には、駆動軸に対する駆動源の負荷は上昇する
にも拘らず、その負荷の変動に対して一律の補正を与え
るものであり、負荷に応じた補正を行なうといった方法
はとられていない。そのために、負荷の変動によって位
置決め精度が変化するといった問題があった。[Technical Background of the Invention and Problems Therewith] Machines such as general machine tools, industrial machines, and robots are driven by closed-loop, semi-closed-loop, or open-loop control methods. In order to improve the positioning accuracy of a moving object, backlash correction and feed screw pitch error correction functions are added to the movement control device for the moving object. Although this position control method can improve the positioning accuracy of a moving object, when a moving object, such as a workpiece, is placed on a table, when the weight of the workpiece changes, the drive source for the drive shaft Despite the fact that the load increases, a uniform correction is applied to changes in the load, and no method is used to make corrections according to the load. Therefore, there is a problem in that positioning accuracy changes due to changes in load.
[発明の目的]
この発明は、このような従来の問題に鑑みてなされたも
のであって、移動物体の重量が変動し、駆動装置の駆動
負荷が変化するような場合であっても停止位置の補正を
的確に行なうことにより正確な位置決めを行なえる位置
補正方法を提供することを目的とする。[Object of the Invention] The present invention has been made in view of such conventional problems.Even when the weight of a moving object fluctuates and the driving load of the driving device changes, the stopping position can be maintained. It is an object of the present invention to provide a position correction method that enables accurate positioning by accurately correcting the position.
[発明のRS]
この発明は、一般工作機械、産業機械、ロボット等にお
ける移動対象物の重量と該移動対象物を移動させる時の
駆動源の負荷とを測定するとともに移動対象物の重量と
駆動源の負荷に応じた位置決め精度を測定して補正値を
予め求め、それを記憶装置に記憶させ、現在の移動対象
物の重量と駆動源の負荷とに相応した補正値を記憶装置
より選定し、この選定した補正値に基いて移動対象物の
移動停止時における位置補正を行なうことを特徴とする
位置補正方法であって、例えばワークテーブルのように
移動対象物の1fflがワークの重ωによって変動する
ような場合にもその変動した重量に相応した補正値を記
憶装置より選定し、移動対象物の移動停止時における位
置補正を行ない、正確な位置において停止させることが
できるようにするものである。[RS of the invention] This invention measures the weight of a moving object in a general machine tool, industrial machine, robot, etc. and the load on a drive source when moving the moving object, and also measures the weight of the moving object and the drive source. A correction value is obtained in advance by measuring the positioning accuracy according to the load of the drive source, and it is stored in the storage device, and a correction value corresponding to the current weight of the moving object and the load of the drive source is selected from the storage device. , is a position correction method characterized by correcting the position of a moving object when it stops moving based on the selected correction value. Even if the weight fluctuates, a correction value corresponding to the fluctuating weight is selected from the storage device, and the position of the moving object is corrected when the object stops moving, so that it can be stopped at an accurate position. be.
[発明の実施例]
図面はボールねじ1により移動対象物としてのワークテ
ーブル3を一軸方向において制御する工作機械における
実施例を示すものである。ボールねじ1は駆動源として
のモータ5によって回転され、そのボールねじ1の回転
によりワークテーブル3が一軸方向に移動する。[Embodiment of the Invention] The drawing shows an embodiment of a machine tool in which a work table 3 as a moving object is controlled in one axis direction by a ball screw 1. The ball screw 1 is rotated by a motor 5 as a driving source, and the rotation of the ball screw 1 causes the work table 3 to move in a uniaxial direction.
モータ5の回転制御は、制御l装置7によって行なわれ
る。この制御装置7は閉ループ、セミ閉ループ、開ルー
プ制御いずれの方式をとるものであってもよく、限定さ
れることはない。The rotation of the motor 5 is controlled by a control device 7. This control device 7 may be of any closed-loop, semi-closed-loop, or open-loop control type, and is not limited to any one of them.
制御装置7に対して補正値記憶装置9、負荷入力装置1
1、比較装置13が接続されている。A correction value storage device 9 and a load input device 1 for the control device 7
1. A comparison device 13 is connected.
補正値記憶装置9は、ワークテーブル3上に載置するワ
ークの重さ、および駆動軸としてのボールねじ1の負荷
に対応する停止位置補正値を記憶しているものである。The correction value storage device 9 stores stop position correction values corresponding to the weight of the workpiece placed on the work table 3 and the load on the ball screw 1 as a drive shaft.
そしてこの補正値記憶装置9には、ワークテーブル3上
に載置するワークの重さを段階的に変えて停止位置を測
定し、その誤差を精密測定機で測定し、記憶させるので
ある。The correction value storage device 9 measures the stop position by changing the weight of the workpiece placed on the worktable 3 in stages, and measures the error using a precision measuring device, and stores the resultant value.
負荷入力装置11はキーボードのような主導入力装置で
あってもよく、またワークテーブル3のmlを自動的に
検出する自動計測装置であってもよい。この負荷入力装
置11はワークテーブル3上に載置されるワークの重さ
を入力するものである。The load input device 11 may be an active input device such as a keyboard, or may be an automatic measuring device that automatically detects the ml of the work table 3. This load input device 11 is used to input the weight of a workpiece placed on the worktable 3.
比較装R13は前記負荷入力装置11がらのワークテー
ブル3のi!、ボールねじ1の負荷を、補正値記憶装置
9からワークの重量やボールねじ1の負荷に同等か近似
しているところの補正値を選びだして制御装置7に与え
る。The comparison device R13 is connected to the i! of the work table 3 of the load input device 11. For the load on the ball screw 1, a correction value that is equal to or similar to the weight of the workpiece or the load on the ball screw 1 is selected from the correction value storage device 9 and is applied to the control device 7.
制御装置7は比較装置13からの補正値を演算し、停止
指令に対して補正漬方を上乗せあるいは差っ引くことに
より目的の位置においてワークテーブル3が正確に停止
されるようモータ5を制御する。The control device 7 calculates the correction value from the comparison device 13 and controls the motor 5 so that the work table 3 is accurately stopped at the target position by adding or subtracting the correction value from the stop command. .
尚、モータ5の負荷も自動的に継続し負荷入力装置11
に入力するようにすることもできる。Note that the load on the motor 5 is automatically continued and the load input device 11
It is also possible to input .
上記のように構成した位置補正装置による位置補正方法
を次に説明する。ワークテーブル3上にある重さのワー
クが載置された時、そのワークの重さを負荷入力装置1
1に入力し、あるいは負荷入力装置11によって自動的
に検出し、比較装置13に与える。比較装置13におい
ては補正値記憶装置9に記憶されているワークの重さ、
モータ5の負荷より同等か近似しているところの補正値
を選定し、その補正値を制御装置7に与える。制御装置
7では与えられた補正値をもとにモータ5の停止タイミ
ングを補正し、正確な位置においてワークテーブル3が
停止できるようモータ5を制御する。A position correction method using the position correction device configured as described above will be described next. When a work of a certain weight is placed on the work table 3, the weight of the work is input to the load input device 1.
1 or automatically detected by the load input device 11 and provided to the comparison device 13. In the comparison device 13, the weight of the workpiece stored in the correction value storage device 9,
A correction value that is equal to or similar to the load of the motor 5 is selected, and the correction value is given to the control device 7. The control device 7 corrects the stop timing of the motor 5 based on the given correction value, and controls the motor 5 so that the work table 3 can be stopped at an accurate position.
尚、上記実施例は一軸制御方式を持つ工作機械の実施例
について説明したが、この発明は上記の場合に限定され
るものではない。XY二軸制御の場合において各軸に対
し上記実施例と同様の位置補正方式を採用し・、XY両
軸に対して位置補正を行なうことができる。またロボッ
トその他の産業機械においても移動する各部分の停止位
置を制御する場合、その移動対象物の重量と駆動源の負
荷とを測定して移動対象物の重量と駆動源の負荷に応じ
た位置決め精度を測定して補正値を記憶し、移動対象物
の実際の電量と駆動源の負荷とに対応した補正値を選び
だしてその補正値に基いて移動対象物の停止位置を補正
し、正確な位置決めを行なうことができる。Incidentally, although the above embodiment describes an embodiment of a machine tool having a single-axis control system, the present invention is not limited to the above case. In the case of XY two-axis control, a position correction method similar to that of the above embodiment is adopted for each axis, and position correction can be performed for both the XY axes. In addition, when controlling the stopping position of each moving part of a robot or other industrial machine, the weight of the moving object and the load of the driving source are measured and positioning is determined according to the weight of the moving object and the load of the driving source. Measure the accuracy and store the correction value, select a correction value that corresponds to the actual amount of electricity of the moving object and the load of the drive source, and correct the stopping position of the moving object based on the correction value to ensure accuracy. positioning can be performed.
[発明の効果1
この発明は、移動対象物の重量と移動対象物を移動させ
る時の駆動源の負荷とを測定すると共に移動対象物の重
量と駆動源の負荷に応じた位置決め精度を測定して補正
値を予め求めて記憶させ、移動対象物の実際の重Qと駆
動源の負荷とに相応した補正値を記憶装置より選定し、
その選定した補正値に基いて移動対象物の移動停止位置
を補正するものである。従って、移動対象物の重量が変
動するような場合でも、その実際の移動対象物の重量に
応じて移動停止位置を補正することができ、正確な位置
決めが実現できる。[Effects of the Invention 1] This invention measures the weight of a moving object and the load on a driving source when moving the moving object, and also measures the positioning accuracy according to the weight of the moving object and the load on the driving source. determine and store a correction value in advance, and select a correction value from the storage device that corresponds to the actual weight Q of the object to be moved and the load of the driving source;
The movement stop position of the moving object is corrected based on the selected correction value. Therefore, even if the weight of the object to be moved varies, the movement stop position can be corrected according to the actual weight of the object to be moved, and accurate positioning can be achieved.
図面はこの発明の一実施例を使用した位置補正装置のブ
ロック図である。
1・・・ボールねじ 3・・・ワークテーブル5・
・・モータ 7・・・制御装置9・・・補正値
記憶装置The drawing is a block diagram of a position correction device using an embodiment of the present invention. 1... Ball screw 3... Work table 5.
...Motor 7...Control device 9...Correction value storage device
Claims (1)
源の負荷とを測定すると共に移動対象物の重量と駆動源
の負荷に応じた位置決め精度を測定して補正値を予め求
め、それを記憶装置に記憶させ、現在の移動対象物の重
量と駆動源の負荷とに相応した補正値を記憶装置より選
定し、この選定した補正値に基いて移動対象物の移動停
止時における位置補正を行なうことを特徴とする位置補
正方法。Measure the weight of the object to be moved and the load on the drive source when moving the object, measure the positioning accuracy according to the weight of the object to be moved and the load on the drive source, and obtain a correction value in advance. is stored in the storage device, a correction value corresponding to the current weight of the moving object and the load of the drive source is selected from the storage device, and the position of the moving object is corrected when the movement of the object stops based on the selected correction value. A position correction method characterized by performing the following.
Priority Applications (7)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP27168984A JPS61150009A (en) | 1984-12-25 | 1984-12-25 | Position correcting method |
US06/811,368 US4703143A (en) | 1984-12-25 | 1985-12-20 | Wire EDM method for preventing wire lagging during machining of an angular corner and workpiece position control |
GB8531712A GB2169536B (en) | 1984-12-25 | 1985-12-23 | A method of and apparatus for controlling a wire cut electrical discharge machine |
DE3546130A DE3546130C2 (en) | 1984-12-25 | 1985-12-24 | Process for controlling machining in an electrical discharge machine with a wire electrode |
FR858519259A FR2575096B1 (en) | 1984-12-25 | 1985-12-26 | METHOD AND APPARATUS FOR CONTROLLING A WIRE ELECTROEROSION MACHINING OR CUTTING MACHINE |
IT8523393A IT1214495B (en) | 1984-12-25 | 1985-12-27 | PROCESS OF CONTROL OF THE PROCESSING TO THE MACHINE TOOL FOR ELECTRIC DISCHARGE MACHINE WITH CUTTING WIRE. |
GB8802512A GB2201263B (en) | 1984-12-25 | 1988-02-04 | A method of and apparatus for controlling movement of a moveable member in a machine tool |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP27168984A JPS61150009A (en) | 1984-12-25 | 1984-12-25 | Position correcting method |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS61150009A true JPS61150009A (en) | 1986-07-08 |
Family
ID=17503474
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP27168984A Pending JPS61150009A (en) | 1984-12-25 | 1984-12-25 | Position correcting method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS61150009A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1989002624A1 (en) * | 1987-09-19 | 1989-03-23 | Fanuc Ltd | Method of controlling robot depending upon load conditions |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS52112963A (en) * | 1976-03-19 | 1977-09-21 | Hitachi Ltd | External force compensation control system |
JPS5650403A (en) * | 1979-09-29 | 1981-05-07 | Shin Meiwa Ind Co Ltd | Position control unit |
JPS56152004A (en) * | 1980-04-03 | 1981-11-25 | Heidenhain Gmbh Dr Johannes | Method of automatically compensating deviation voltage in numerical control machine |
JPS58143985A (en) * | 1982-02-20 | 1983-08-26 | 日本電信電話株式会社 | Control system of multiple freedom-degree kinetic mechanism |
JPS58223583A (en) * | 1982-06-21 | 1983-12-26 | 三菱電機株式会社 | Control apparatus of industrial robot |
JPS594730A (en) * | 1982-06-29 | 1984-01-11 | Hitachi Constr Mach Co Ltd | Running control oil-pressure circuit for construction vehicle |
-
1984
- 1984-12-25 JP JP27168984A patent/JPS61150009A/en active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS52112963A (en) * | 1976-03-19 | 1977-09-21 | Hitachi Ltd | External force compensation control system |
JPS5650403A (en) * | 1979-09-29 | 1981-05-07 | Shin Meiwa Ind Co Ltd | Position control unit |
JPS56152004A (en) * | 1980-04-03 | 1981-11-25 | Heidenhain Gmbh Dr Johannes | Method of automatically compensating deviation voltage in numerical control machine |
JPS58143985A (en) * | 1982-02-20 | 1983-08-26 | 日本電信電話株式会社 | Control system of multiple freedom-degree kinetic mechanism |
JPS58223583A (en) * | 1982-06-21 | 1983-12-26 | 三菱電機株式会社 | Control apparatus of industrial robot |
JPS594730A (en) * | 1982-06-29 | 1984-01-11 | Hitachi Constr Mach Co Ltd | Running control oil-pressure circuit for construction vehicle |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1989002624A1 (en) * | 1987-09-19 | 1989-03-23 | Fanuc Ltd | Method of controlling robot depending upon load conditions |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4361071B2 (en) | Servo control device | |
US6775586B2 (en) | Numerical controller | |
US5020001A (en) | Robot controller | |
US20050137739A1 (en) | Method of controlling numerically controlled machine tool and numerically controlled machine tool | |
EP0557530A1 (en) | Numerical control device | |
CN102621930A (en) | Numerical controller having workpiece mounting error compensation unit for three-axis machine tool | |
JP2002224936A (en) | Tool presetter and method for calculation of tool offset data | |
JPH0715715Y2 (en) | Machine tool position correction device | |
JPH03271813A (en) | Nc device | |
JPWO2004087359A1 (en) | Threading control method and apparatus | |
JPS61150009A (en) | Position correcting method | |
JP2002187040A (en) | Loader control device | |
JPH0424198B2 (en) | ||
EP0540761A1 (en) | Method of controlling backlash acceleration | |
JP2771458B2 (en) | Industrial robot deflection correction method | |
JP2684782B2 (en) | Data correction device | |
JP2021084139A (en) | Control device of electric motor and control method of electric motor | |
WO1994004310A1 (en) | Clamp method for preventing deformation of workpiece | |
JPH02160457A (en) | Correcting device for straightness of machine tool | |
WO2021230203A1 (en) | Tool measuring system, and control method | |
JP2001005529A (en) | Servo motor control method and its control system, and controller | |
JPH01274947A (en) | Drive unit for nc table | |
JPH08118204A (en) | Positioning error correction method on machine tool and device thereof | |
JP2824649B2 (en) | Spindle controller | |
KR100200208B1 (en) | Backlash modification method of machine |