JP2009080616A - Numerical control device - Google Patents

Numerical control device Download PDF

Info

Publication number
JP2009080616A
JP2009080616A JP2007248902A JP2007248902A JP2009080616A JP 2009080616 A JP2009080616 A JP 2009080616A JP 2007248902 A JP2007248902 A JP 2007248902A JP 2007248902 A JP2007248902 A JP 2007248902A JP 2009080616 A JP2009080616 A JP 2009080616A
Authority
JP
Japan
Prior art keywords
machine
error
machine position
command
measurement
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2007248902A
Other languages
Japanese (ja)
Other versions
JP4618616B2 (en
Inventor
Kotaro Nagaoka
弘太朗 長岡
Naoki Nakamura
直樹 中村
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.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric 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 Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Priority to JP2007248902A priority Critical patent/JP4618616B2/en
Publication of JP2009080616A publication Critical patent/JP2009080616A/en
Application granted granted Critical
Publication of JP4618616B2 publication Critical patent/JP4618616B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To provide a numerical control device for correctly measuring a machine position during a test operation by using a measuring unit for measuring a machine position, obtaining a machine error from the measurement result, and correctly obtaining a parameter for correcting the machine error. <P>SOLUTION: This numerical control device for controlling the relative position of a main axis with respect to a table of a machine by driving a motor so that a detected position to be output from a detector 4 detecting the position of a motor 3 may follow a commanded position is provided with: a measuring unit 5 for machine position measurement for measuring the displacement of the relative position of a main axis to the table of a machine in a prescribed direction; a machine position calculating part 6 for calculating the machine position based on the detected position output from the detector 4 and the detected position output from the measuring unit 5 for machine position measurement and a signal for machine position measurement at the same time; a machine error difference measurement part 7 for calculating a machine error based on the commanded position, the detected position output from the detector 4 and the machine position calculated by the machine position calculation part 6; and a parameter changing part 8 for changing the parameter for error correction based on the machine error. <P>COPYRIGHT: (C)2009,JPO&INPIT

Description

この発明は、工作機械を数値制御(NC)する数値制御装置に関し、特に機械端にダブルボールバーなどの位置検出器を取り付けて機械位置を正確に求める数値制御装置に関するものである。   The present invention relates to a numerical control apparatus for numerically controlling (NC) a machine tool, and more particularly to a numerical control apparatus for accurately obtaining a machine position by attaching a position detector such as a double ball bar to a machine end.

数値制御の工作機械は、各軸を指令された位置に制御することで加工を行うが、位置を制御するために位置検出器を用いて計測する点と、制御したい点、すなわち実際に加工を行う点とは異なっている。以下では、位置検出器を用いて計測する点の位置を「検出位置」と呼び、実際に加工を行う点の位置を「機械位置」と呼ぶ。   Numerically controlled machine tools perform machining by controlling each axis to the commanded position, but the points to be measured using a position detector to control the position and the points to be controlled, that is, the actual machining is performed. It is different from what you do. Hereinafter, the position of a point measured using a position detector is referred to as a “detection position”, and the position of a point where machining is actually performed is referred to as a “machine position”.

例えば、ボールねじ駆動の機械でセミクローズド制御を行う場合、計測する点はモータの回転角であるが、制御したい点は、ボールねじの先にとりつけられた移動体である。   For example, when semi-closed control is performed with a ball screw drive machine, the measurement point is the rotation angle of the motor, but the point to be controlled is a moving body attached to the tip of the ball screw.

また、リニアスケールを用いてフルクローズド制御を行う場合でも、実際に加工を行う点にリニアスケールを配置できないため、検出位置(リニアスケールを取り付けた位置)と機械位置(実際に加工を行う点)とは離れている。   Even when full-closed control is performed using a linear scale, the linear scale cannot be placed at the actual processing point, so the detection position (the position where the linear scale is attached) and the machine position (the actual processing point) Is far from.

このため、数値制御装置で検出位置が指令した位置に追従するように制御しても、一般には機械位置は指令位置に完全に追従せず、最終的な加工形状は指令値どおりとならない。別の例では、回転軸を有する5軸加工機やパラレルメカニズム機構を有する機械では、回転軸の位置などの機構パラメータに設計誤差があると、各軸を指令された位置(指令した形状から、機構パラメータの設計値を用いて算出した位置)に制御しても、最終的な加工形状は指令形状どおりとはならない。   For this reason, even if the numerical control device controls the detected position so as to follow the commanded position, generally, the machine position does not completely follow the commanded position, and the final machining shape does not match the commanded value. In another example, in a 5-axis processing machine having a rotation axis or a machine having a parallel mechanism mechanism, if there is a design error in a mechanism parameter such as the position of the rotation axis, each axis is instructed from the commanded position (from the commanded shape, Even if it is controlled to the position calculated using the design value of the mechanism parameter, the final machining shape does not match the command shape.

そこで、あらかじめ試験動作を行ったときの機械の誤差(検出位置と機械位置の間の差)を測定しておき、数値制御装置において誤差の分だけの補正を行ったり、誤差に応じて機構パラメータを修正したりする方法がとられている。機械の誤差を測定するためには、数値制御装置で用いている位置検出器のほかに、機械位置を測定するための計測器を用いることになる。この機械位置を測定するための計測器は、機械にとりつけたままでは加工などの工作機械本来の動作を行うことが困難であるため、通常は機械にとりつけられておらず、機械の調整時に一時的に取り付けるものである(例えば、特許文献1参照)。   Therefore, the machine error (difference between the detection position and the machine position) when the test operation is performed in advance is measured, and the numerical control device corrects only the error, or the mechanism parameter according to the error. There are ways to fix this. In order to measure the error of the machine, in addition to the position detector used in the numerical control device, a measuring instrument for measuring the machine position is used. This measuring instrument for measuring the machine position is not normally attached to the machine because it is difficult to perform the original operation of the machine tool such as machining if it is attached to the machine. (For example, refer patent document 1).

特開2004−1203号公報Japanese Patent Laid-Open No. 2004-1203

従来は、機械位置の測定を、指令位置や検出位置とは無関係に独立して行うため、機械位置と検出位置の間の時々刻々の関係を正確に把握することは不可能であった。したがって、幾何学的な誤差は測定できても、動的な誤差(例えば、移動中の機械位置と検出位置の間の誤差)を測定することはできなかった。特に、いわゆるダブルボールバーのような2点間の距離を測定する装置を用いて機械位置を測定する場合、ダブルボールバーは1次元の変位を計測するものであるため、機械位置の3次元空間内における位置を正確に求めることができない。従来は指令形状と指令速度が既知であり、機械も指令した形状および速度で移動していると仮定して、測定した2点間の距離すなわち1次元の変位から3次元空間内の機械位置を求めているが、実際の移動は加速、減速を伴うため、従来の方法では機械位置を正しく求めることができないという問題点があった。さらに、従来は機械位置の測定動作は試験動作のための位置制御と独立して行うため、測定のたびに測定結果を確認して、測定が正しく行われていなければ、測定をやり直すという作業が必要であるという問題点があった。   Conventionally, since the measurement of the machine position is performed independently of the command position and the detection position, it is impossible to accurately grasp the moment-to-time relationship between the machine position and the detection position. Therefore, although a geometric error can be measured, a dynamic error (for example, an error between a moving machine position and a detection position) cannot be measured. In particular, when the machine position is measured using a device that measures the distance between two points such as a so-called double ball bar, the double ball bar measures a one-dimensional displacement. It is not possible to accurately determine the position within. Conventionally, the command shape and the command speed are known, and the machine position in the three-dimensional space is determined from the measured distance between two points, that is, the one-dimensional displacement, assuming that the machine is also moving at the commanded shape and speed. However, since the actual movement is accompanied by acceleration and deceleration, there is a problem that the conventional method cannot correctly determine the machine position. Furthermore, since the measurement operation of the machine position is conventionally performed independently of the position control for the test operation, the measurement result is confirmed at each measurement, and if the measurement is not performed correctly, it is necessary to repeat the measurement. There was a problem that it was necessary.

この発明は、上述のような課題を解決するためになされたもので、その目的は、機械位置を求めるために計測器を取り付け、試験動作時の機械位置を指令位置や検出位置と同じ時間軸上で測定し、測定結果から機械の誤差を求め、求めた機械の誤差を補正するためのパラメータを正確に求めることができる数値制御装置を得るものである。   The present invention has been made in order to solve the above-described problems. The object of the present invention is to attach a measuring instrument to obtain the machine position and set the machine position during the test operation to the same time axis as the command position and the detection position. A numerical control apparatus is obtained that can measure the above, obtain a machine error from the measurement result, and accurately obtain a parameter for correcting the obtained machine error.

この発明に係る数値制御装置は、モータの位置を検出して検出器から出力される検出位置が指令位置に追従するように、前記モータを駆動して機械のテーブルに対する主軸の相対位置を制御する数値制御装置において、前記機械のテーブルに対する主軸の相対位置の所定の方向の変位を計測する機械位置測定用計測器と、前記検出器から出力される検出位置及び前記機械位置測定用計測器から出力され前記検出位置と同時刻の機械位置測定用信号に基づいて機械位置を計算する機械位置計算部と、前記指令位置、前記検出器から出力される検出位置及び前記機械位置計算部により計算された機械位置に基づいて機械誤差を計算する機械誤差計算部と、前記機械誤差に基づいて誤差補正のためのパラメータを変更するパラメータ変更部とを設けたものである。   The numerical controller according to the present invention controls the relative position of the spindle to the machine table by driving the motor so that the detected position output from the detector follows the command position by detecting the position of the motor. In the numerical controller, a mechanical position measuring instrument that measures a displacement in a predetermined direction of a relative position of the spindle relative to the table of the machine, a detection position output from the detector, and an output from the mechanical position measuring instrument Calculated by a machine position calculation unit that calculates a machine position based on a machine position measurement signal at the same time as the detection position, the command position, the detection position output from the detector, and the machine position calculation unit. A machine error calculation unit that calculates a machine error based on the machine position and a parameter change unit that changes a parameter for error correction based on the machine error are provided. It is intended.

この発明に係る数値制御装置は、指令位置、検出位置と同時刻の機械位置を正確に求めることができるという効果を奏する。また、同時刻の指令位置、検出位置、機械位置をもとに機械誤差を求めて機械誤差を補正するためのパラメータを変更するため、機械誤差補正のパラメータを正確に設定することができるという効果を奏する。   The numerical control device according to the present invention has an effect that the machine position at the same time as the command position and the detection position can be accurately obtained. In addition, since the machine error is determined based on the command position, detection position, and machine position at the same time and the parameter for correcting the machine error is changed, the machine error correction parameter can be set accurately. Play.

実施の形態1.
この発明の実施の形態1に係る数値制御装置について図1及び図2を参照しながら説明する。図1は、この発明の実施の形態1に係る数値制御装置の構成を示すブロック図である。なお、以降では、各図中、同一符号は同一又は相当部分を示す。
Embodiment 1 FIG.
A numerical control apparatus according to Embodiment 1 of the present invention will be described with reference to FIGS. FIG. 1 is a block diagram showing a configuration of a numerical control apparatus according to Embodiment 1 of the present invention. In the following, in each figure, the same reference numerals indicate the same or corresponding parts.

図1において、この発明の実施の形態1に係る数値制御装置は、指令位置を生成する指令生成部1と、モータ3を駆動する機械駆動部2と、モータ3の位置を検出する検出器4と、機械のテーブルに対する主軸の相対位置の所定の方向の変位を計測する機械位置測定用計測器5と、機械位置を計算する機械位置計算部6と、検出位置及び機械位置の機械誤差を計算する機械誤差計算部7と、機械誤差を元に誤差補正のためのパラメータを変更するパラメータ変更部8とが設けられている。   In FIG. 1, a numerical controller according to Embodiment 1 of the present invention includes a command generation unit 1 that generates a command position, a mechanical drive unit 2 that drives a motor 3, and a detector 4 that detects the position of the motor 3. A mechanical position measuring instrument 5 that measures the displacement of the spindle relative to the machine table in a predetermined direction; a machine position calculator 6 that calculates the machine position; and a machine error in the detected position and the machine position. There are provided a machine error calculation unit 7 for performing the above and a parameter changing unit 8 for changing a parameter for error correction based on the machine error.

また、図2は、この発明の実施の形態1に係る数値制御装置の機械位置測定用計測器のセットアップの様子を示す斜視図である。   FIG. 2 is a perspective view showing the setup of the measuring instrument for measuring the machine position of the numerical controller according to Embodiment 1 of the present invention.

図2において、機械位置測定用計測器5として用いるダブルボールバーは、2つの球52、53が直動軸51でつながれた構造となっており、2つの球52、53の間の距離を出力することができる長さセンサである。2つの球のうち片方の球52は、機械のテーブル90に磁石54により固定され、もう一方の球53は、機械の主軸91に磁石55により固定される。機械は、テーブル90に対して主軸91が直交3軸(X軸、Y軸、Z軸)の各方向に移動するものとする。試験動作の経路(破線)80は、テーブル90側の球52を中心とする円軌道とし、ダブルボールバーの2つの球52、53の中心が円軌道の面内に常にあるように主軸91が移動するものとする。   In FIG. 2, the double ball bar used as the machine position measuring instrument 5 has a structure in which two balls 52 and 53 are connected by a linear motion shaft 51, and outputs a distance between the two balls 52 and 53. It is a length sensor that can. One of the two spheres 52 is fixed to the machine table 90 by a magnet 54, and the other sphere 53 is fixed to a main spindle 91 of the machine by a magnet 55. In the machine, it is assumed that the main shaft 91 moves with respect to the table 90 in each of three orthogonal directions (X axis, Y axis, Z axis). The path (broken line) 80 of the test operation is a circular orbit centered on the sphere 52 on the table 90 side, and the spindle 91 is positioned so that the centers of the two spheres 52 and 53 of the double ball bar are always in the plane of the circular orbit. Shall move.

つぎに、この実施の形態1に係る数値制御装置の動作について図面を参照しながら説明する。   Next, the operation of the numerical control apparatus according to the first embodiment will be described with reference to the drawings.

指令生成部1は、機械を駆動させるための時々刻々の機械のテーブルに対する主軸の相対位置の指令位置を生成して出力する。この指令生成部1は、試験動作の経路80をもとに一定周期毎の機械各駆動軸の指令位置を生成する。また、指令生成部1は、指令位置を生成する際に、パラメータ変更部8の機械誤差を補正するためのパラメータを参照して機械誤差がなくなるように、指令位置の補正を行う。指令生成部1で生成された指令位置は、機械駆動部2に入力される。   The command generation unit 1 generates and outputs a command position of the relative position of the spindle with respect to the table of the machine every moment for driving the machine. The command generation unit 1 generates a command position for each drive shaft of the machine at a constant cycle based on the test operation path 80. Further, when generating the command position, the command generation unit 1 refers to the parameter for correcting the mechanical error of the parameter change unit 8 and corrects the command position so that the mechanical error is eliminated. The command position generated by the command generator 1 is input to the machine drive unit 2.

機械駆動部2は、モータ3を駆動する。この機械駆動部2は、モータ3に取り付けられた検出器4から出力される検出位置が指令位置に追従するようにモータ3を制御する。モータ3の位置は、検出器4で検出されて、検出位置として機械駆動部2に入力される。なお、パラメータ変更部8の機械誤差を補正するためのパラメータを参照して機械誤差がなくなるように、指令生成部1に代えて、機械駆動部2で指令位置の補正を行っても良い。   The mechanical drive unit 2 drives the motor 3. The mechanical drive unit 2 controls the motor 3 so that the detection position output from the detector 4 attached to the motor 3 follows the command position. The position of the motor 3 is detected by the detector 4 and input to the mechanical drive unit 2 as a detection position. Note that the command drive unit 2 may correct the command position instead of the command generation unit 1 so that the machine error is eliminated by referring to the parameter for correcting the machine error of the parameter changing unit 8.

機械位置測定用計測器5は、機械位置を測定するために別途機械に設置されるセンサであり、機械位置の次元数よりも少ない次元の変位を出力するセンサを用いる。本実施の形態1では、長さセンサの一種であるダブルボールバーを用いる。このダブルボールバー5は、通常の機械稼動時には取り付けられておらず、機械の調整を行うときのみ一時的に取り付けるものである。ダブルボールバー5は、試験動作中の2つの球52、53間の距離を計測し、長さ信号(1次元の変位信号)を出力する。この出力された長さ信号は、機械位置計算部6に入力される。本実施の形態1では、機械位置測定用計測器5としてダブルボールバーを用いるので、機械位置測定用信号はダブルボールバーの長さ信号となる。   The machine position measuring instrument 5 is a sensor that is separately installed in the machine to measure the machine position, and uses a sensor that outputs a displacement having a dimension smaller than the number of dimensions of the machine position. In the first embodiment, a double ball bar which is a kind of length sensor is used. The double ball bar 5 is not attached during normal machine operation, but is temporarily attached only when the machine is adjusted. The double ball bar 5 measures the distance between the two balls 52 and 53 during the test operation and outputs a length signal (one-dimensional displacement signal). The output length signal is input to the machine position calculation unit 6. In the first embodiment, since a double ball bar is used as the machine position measuring instrument 5, the machine position measuring signal is a length signal of the double ball bar.

機械駆動部2から出力された検出位置は、機械位置測定用計測器5が出力する機械位置計測用信号と同じ時刻のものが機械位置計算部6に入力される。すなわち、検出位置と、ダブルボールバー5で測定した長さ信号が機械位置計算部6に入力されるが、これらの検出位置及び長さ信号は、同一時刻における値が入力される。   The detection position output from the machine drive unit 2 is input to the machine position calculation unit 6 at the same time as the machine position measurement signal output from the machine position measurement measuring instrument 5. That is, the detection position and the length signal measured by the double ball bar 5 are input to the machine position calculation unit 6, and these detection position and length signals are input at the same time.

機械位置計算部6は、入力された検出位置及び機械位置計測用信号(長さ信号)をもとに機械位置を計算して、機械誤差計算部7に出力する。機械位置は、試験動作の経路80である指令円弧の中心位置と検出位置を結ぶ直線上にあり、指令円弧の中心からの距離がダブルボールバー5で測定した長さ信号の値である点を機械位置としてその座標を求める。   The machine position calculation unit 6 calculates the machine position based on the input detection position and the machine position measurement signal (length signal), and outputs the machine position to the machine error calculation unit 7. The machine position is on a straight line connecting the center position of the command arc that is the path 80 of the test operation and the detection position, and the distance from the center of the command arc is the value of the length signal measured by the double ball bar 5. The coordinates are obtained as the machine position.

このことを数式で表現すると以下のようになる。試験動作の経路80である指令円弧がXY平面内の円弧であるとし、ダブルボールバー5で計測した、時刻tにおける長さをl(t)、指令円弧の中心を原点としたときの時刻tにおける検出位置を(x(t),y(t),z(t))とすると、同じ時刻tにおける機械位置(x(t),y(t),z(t))は、次の式(1)のように求められる。 This can be expressed as follows: Suppose that the command arc that is the path 80 of the test operation is an arc in the XY plane, the length at time t measured by the double ball bar 5 is l (t), and the time t when the center of the command arc is the origin. (X d (t), y d (t), z d (t)) is the machine position (x m (t), y m (t), z m (t) at the same time t. ) Is obtained by the following equation (1).

Figure 2009080616
Figure 2009080616

機械誤差計算部7は、機械位置計算部6で求めた機械位置と、指令位置及び検出位置から、機械誤差を計算する。例えば、指令位置の変化方向が反転する前後での検出位置と機械位置の差を求める。つまり、機械誤差計算部7は、モータ3の駆動方向反転時の運動誤差を計算する。機械要素にバックラッシやロストモーションがあると、指令位置の方向が変化する前後で、検出位置と機械位置の差の値がほぼ逆符号の値となる。   The machine error calculation unit 7 calculates a machine error from the machine position obtained by the machine position calculation unit 6, the command position, and the detection position. For example, the difference between the detected position and the machine position before and after the change direction of the command position is reversed is obtained. That is, the mechanical error calculation unit 7 calculates a motion error when the driving direction of the motor 3 is reversed. If there is backlash or lost motion in the machine element, the difference between the detected position and the machine position is almost opposite in value before and after the direction of the command position is changed.

パラメータ変更部8は、機械誤差計算部7で求めた機械誤差に応じて、機械誤差補正機能のパラメータを変更する。例えば、パラメータは、前述のバックラッシを補正するための機能として機械の方向反転時に指令位置を補正する機能があるので、検出位置と機械位置の差が補正量となるようなパラメータの設定を行う。つまり、パラメータ変更部8は、前述の運動誤差に基づいて駆動方向反転時に指令位置を補正するためのパラメータを変更する。   The parameter changing unit 8 changes the parameters of the machine error correction function according to the machine error obtained by the machine error calculating unit 7. For example, since the parameter has a function of correcting the command position when reversing the machine direction as a function for correcting the backlash, the parameter is set so that the difference between the detected position and the machine position becomes the correction amount. That is, the parameter changing unit 8 changes a parameter for correcting the command position when the driving direction is reversed based on the motion error described above.

なお、従来は、ダブルボールバー単体で測定を行っており、ダブルボールバーの長さ信号から機械位置を計算する際には、機械が円弧経路上を等速で移動しているものとして計算を行っていたが、実際には開始時と終了時に加速と減速が生じるため、従来の手法で求めた機械位置は、実際の機械位置とは大きく異なることになる。   In the past, measurement was performed with a single double ball bar, and when calculating the machine position from the length signal of the double ball bar, the calculation was made assuming that the machine was moving at a constant speed on the circular arc path. However, since acceleration and deceleration occur in practice at the start and end, the machine position obtained by the conventional method is greatly different from the actual machine position.

これに対し、本実施の形態1では、同時刻の長さ信号と検出位置から機械位置を求めるため、機械位置測定用計測器から出力される機械位置の次元数よりも少ない次元の変位信号から、正しい機械位置を求めることができる。すなわち、ダブルボールバーの出力する1次元の長さ信号から、3次元の機械位置を正しく求めることができる。   On the other hand, in the first embodiment, since the machine position is obtained from the length signal at the same time and the detection position, the displacement signal having a dimension smaller than the number of dimensions of the machine position output from the machine position measuring instrument is used. The correct machine position can be determined. That is, the three-dimensional machine position can be correctly obtained from the one-dimensional length signal output from the double ball bar.

さらに、従来の方法では、指令位置の変化と機械位置の変化との時間関係が不明であるため、指令方向反転時の機械位置の挙動を正確に求めることができず、機械誤差補正のパラメータを正確に求めることができない。   Furthermore, in the conventional method, since the time relationship between the change in the command position and the change in the machine position is unknown, the behavior of the machine position when the command direction is reversed cannot be obtained accurately, and the parameter for machine error correction is It cannot be determined accurately.

これに対し、本実施の形態1では、同時刻における指令位置と機械位置がわかるため指令方向反転時の機械位置の挙動を正確に求めることができ、機械誤差を補正するためのパラメータを正確に求めることが可能となる。   On the other hand, in the first embodiment, since the command position and the machine position at the same time can be known, the behavior of the machine position when the command direction is reversed can be accurately obtained, and the parameters for correcting the machine error can be accurately determined. It can be obtained.

以上のように、本実施の形態1によれば、指令位置及び検出位置と同時刻の機械位置測定用計測器5の長さ信号から機械位置を求めるので、移動中に加速、減速があっても正確な機械位置を求めることができるという効果がある。また、本実施の形態1によれば、指令位置及び検出位置と同時刻の機械位置をもとに機械誤差を求めて機械誤差補正機能のパラメータを変更するため、機械誤差補正のパラメータを正確に設定することができるという効果がある。特に、本実施の形態1では、駆動方向反転時の運動誤差がタイミングも含めて正確に把握できるので、バックラッシやロストモーションなどの駆動方向反転時に発生する機械誤差を補正するためのパラメータを正確に設定することができるという効果がある。   As described above, according to the first embodiment, since the machine position is obtained from the length signal of the machine position measuring instrument 5 at the same time as the command position and the detection position, there is acceleration and deceleration during movement. There is an effect that an accurate machine position can be obtained. Further, according to the first embodiment, since the machine error is obtained based on the machine position at the same time as the command position and the detection position and the parameter of the machine error correction function is changed, the machine error correction parameter is accurately set. There is an effect that it can be set. In particular, in the first embodiment, since the motion error at the time of driving direction reversal can be accurately grasped including the timing, parameters for correcting mechanical errors generated at the time of reversing the driving direction such as backlash and lost motion can be accurately determined. There is an effect that it can be set.

実施の形態2.
この発明の実施の形態2に係る数値制御装置について図3から図5までを参照しながら説明する。図3は、この発明の実施の形態2に係る数値制御装置の構成を示すブロック図である。
Embodiment 2. FIG.
A numerical controller according to Embodiment 2 of the present invention will be described with reference to FIGS. FIG. 3 is a block diagram showing a configuration of a numerical control apparatus according to Embodiment 2 of the present invention.

図3において、上記の実施の形態1と相違する点は、機械位置表示部9をさらに設け、この機械位置表示部9により、指令生成部1が出力する指令位置と、機械駆動部2が出力する検出位置と、機械位置計算部6が出力する機械位置とを表示するようにしたことである。   In FIG. 3, the difference from the first embodiment is that a machine position display unit 9 is further provided. The machine position display unit 9 outputs a command position output from the command generation unit 1 and a machine drive unit 2 outputs the command position. And the machine position output by the machine position calculation unit 6 are displayed.

また、図4は、この発明の実施の形態2に係る数値制御装置の機械位置測定用計測器のセットアップの様子を示す斜視図である。   FIG. 4 is a perspective view showing the setup of the measuring instrument for measuring the machine position of the numerical controller according to Embodiment 2 of the present invention.

図4において、上記の実施の形態1と相違する点は、試験動作の経路80の半径がダブルボールバーの2つの球52、53間の長さよりも短いことである。このようなセットアップは、機械の可動範囲が狭く、上記の実施の形態1のような経路では機械を動作させることができない場合に、円弧指令時の機械位置を測定したい場合に有効である。   In FIG. 4, the difference from the first embodiment is that the radius of the path 80 for the test operation is shorter than the length between the two spheres 52 and 53 of the double ball bar. Such a setup is effective when it is desired to measure the machine position at the time of the circular arc command when the movable range of the machine is narrow and the machine cannot be operated along the path as in the first embodiment.

つぎに、この実施の形態2に係る数値制御装置の動作について図面を参照しながら説明する。図5は、この発明の実施の形態2に係る数値制御装置の機械位置表示部の表示例を示す図である。   Next, the operation of the numerical control apparatus according to the second embodiment will be described with reference to the drawings. FIG. 5 is a diagram showing a display example of the machine position display unit of the numerical controller according to Embodiment 2 of the present invention.

上記の実施の形態1と相違する点は、機械位置計算部6における機械位置の計算の動作と、機械位置表示部9における表示動作である。   The difference from the first embodiment described above is the calculation operation of the machine position in the machine position calculation unit 6 and the display operation in the machine position display unit 9.

機械位置計算部6は、入力された検出位置及び長さ信号から、機械位置を求める。機械位置は、指令円弧の中心位置と検出位置とを結ぶ直線上にあり、テーブル90側の球52の中心からの距離がダブルボールバー5で測定した長さ信号の値となる点を機械位置としてその座標を求める。   The machine position calculation unit 6 obtains a machine position from the input detection position and length signal. The machine position is on a straight line connecting the center position of the command arc and the detection position, and the point where the distance from the center of the sphere 52 on the table 90 side becomes the value of the length signal measured by the double ball bar 5 is the machine position. As its coordinates.

このことを数式で表現すると以下のようになる。指令円弧がXY平面内の円弧であるとし、ダブルボールバー5で計測した時刻tにおける長さをl(t)、テーブル90側の球52の中心を原点としたときの時刻tにおける検出位置を(x(t),y(t),z(t))とすると、同じ時刻tにおける機械位置(x(t),y(t),z(t))は、次の式(2)のように求められる。 This can be expressed as follows: Suppose that the command arc is an arc in the XY plane, the length at time t measured by the double ball bar 5 is l (t), and the detection position at time t when the center of the sphere 52 on the table 90 side is the origin is the position. (X d (t), y d (t), z d (t)), the machine position (x m (t), y m (t), z m (t)) at the same time t is It is calculated | required like Formula (2).

Figure 2009080616
Figure 2009080616

また、機械位置表示部9は、指令位置、検出位置、機械位置を、数値制御装置の画面表示器上に表示する。これらの位置を同じ座標軸上に表示することにより、指令位置、検出位置、機械位置の相対的な関係を視覚的に把握することができ、機械誤差補正機能のパラメータを変更することで軌跡がどのように変化するかを素早く確認することができる。図5は、画面表示内容の一例である。   The machine position display unit 9 displays the command position, the detection position, and the machine position on the screen display of the numerical controller. By displaying these positions on the same coordinate axis, it is possible to visually grasp the relative relationship between the command position, detection position, and machine position. You can quickly check how it changes. FIG. 5 is an example of the screen display content.

以上のように、本実施の形態2によれば、機械の可動範囲が狭く、上記の実施の形態1のような経路では機械を動作させることができない場合でも、正確な機械位置を求めることができるという効果がある。また、本実施の形態2によれば、測定した指令位置、検出位置、機械位置を画面上に同一座標系上で表示するため、指令位置、検出位置、機械位置の相対的な関係を視覚的に把握でき、機械誤差補正機能のパラメータを変更することで軌跡がどのように変化するかを素早く確認することができるという効果がある。   As described above, according to the second embodiment, an accurate machine position can be obtained even when the movable range of the machine is narrow and the machine cannot be operated along the route as in the first embodiment. There is an effect that can be done. Further, according to the second embodiment, the measured command position, detection position, and machine position are displayed on the same coordinate system on the screen, so that the relative relationship between the command position, detection position, and machine position is visually determined. Thus, there is an effect that it is possible to quickly confirm how the locus changes by changing the parameter of the mechanical error correction function.

実施の形態3.
この発明の実施の形態3に係る数値制御装置について図6及び図7を参照しながら説明する。図6は、この発明の実施の形態3に係る数値制御装置の構成を示すブロック図である。
Embodiment 3 FIG.
A numerical control apparatus according to Embodiment 3 of the present invention will be described with reference to FIGS. FIG. 6 is a block diagram showing a configuration of a numerical control apparatus according to Embodiment 3 of the present invention.

図6において、上記の実施の形態2と相違する点は、測定異常検出部10と指令変更部11をさらに設けたことである。また、測定異常検出部10は、機械位置測定用計測器5から出力される機械位置測定用信号が、機械位置測定用計測器5の測定可能範囲を逸脱すると判断した場合には、異常信号を指令変更部11に出力し、指令変更部11は、異常信号を受けた場合には、測定を中止して機械位置測定用信号が測定可能範囲を逸脱しないように動作指令を変更し、変更した動作指令を指令生成部1に出力するようにし、動作指令が変更された場合には変更後の動作指令に基づいて再度測定をおこなうようにしたことである。   In FIG. 6, the difference from the second embodiment is that a measurement abnormality detection unit 10 and a command change unit 11 are further provided. In addition, when the measurement abnormality detection unit 10 determines that the machine position measurement signal output from the machine position measurement instrument 5 deviates from the measurable range of the machine position measurement instrument 5, the measurement abnormality detection unit 10 outputs the abnormality signal. When the command change unit 11 receives an abnormal signal, the command change unit 11 changes the operation command so that the machine position measurement signal does not deviate from the measurable range. That is, the operation command is output to the command generation unit 1, and when the operation command is changed, the measurement is performed again based on the changed operation command.

また、図7は、この発明の実施の形態3に係る数値制御装置の機械位置測定用計測器のセットアップの様子を示す斜視図である。   FIG. 7 is a perspective view showing the setup of the measuring instrument for measuring the machine position of the numerical controller according to Embodiment 3 of the present invention.

図7において、上記の実施の形態1と相違する点は、機械の主軸91は直交3軸各方向の並進移動軸のほかに、回転中心軸82のまわりに回転する回転軸を有する構造になっていることである。このとき、回転中心軸82上の一点をピボット点83とする。機械駆動部2は、ピボット点83の並進移動軸と、ピボット点83まわりの回転軸を駆動する。また、試験動作の経路80は、ダブルボールバー5のテーブル90側の球52を中心とし、回転中心軸82に垂直な平面上の円弧を、主軸91が常にテーブル90側の球52の方向に向くような経路とする。すなわち、ピボット点83の位置としては、試験動作の経路80に、ピボット点83と主軸91側の球53との間のずれ量を加算した経路(試験動作時のピボット点の経路81)である。   In FIG. 7, the difference from the first embodiment is that the main shaft 91 of the machine has a rotation axis that rotates around the rotation center axis 82 in addition to the translational movement axes in the three orthogonal directions. It is that. At this time, one point on the rotation center axis 82 is set as a pivot point 83. The mechanical drive unit 2 drives the translational movement axis of the pivot point 83 and the rotation axis around the pivot point 83. Further, the path 80 of the test operation is centered on the sphere 52 on the table 90 side of the double ball bar 5, and has a circular arc on a plane perpendicular to the rotation center axis 82. The route should be suitable. That is, the position of the pivot point 83 is a path obtained by adding a deviation amount between the pivot point 83 and the sphere 53 on the spindle 91 side to the test operation path 80 (pivot point path 81 during the test operation). .

このような回転軸を有する機械において主軸91の先端の位置を指令する場合、並進移動軸の移動量は、主軸91の先端の移動量からピボット点83の移動量に換算して並進移動軸を駆動する必要がある。そのため、指令生成部1において、回転軸がある特定の角度(例えば、0度)のときの主軸91の先端とピボット点83(回転中心軸上の点)の間の相対位置を、回転中心位置パラメータとして記憶しておき、この回転中心位置パラメータとそのときの回転軸角度指令位置をもとに主軸91の先端の移動量をピボット点83の移動量に換算することが行われる。   When the position of the tip end of the main shaft 91 is commanded in a machine having such a rotating shaft, the amount of movement of the translation shaft is converted from the amount of movement of the tip of the main shaft 91 to the amount of movement of the pivot point 83, and the translation shaft is moved. Need to drive. Therefore, in the command generation unit 1, the relative position between the tip of the main shaft 91 and the pivot point 83 (a point on the rotation center axis) when the rotation axis is at a certain angle (for example, 0 degree) is determined as the rotation center position. It is stored as a parameter, and the amount of movement of the tip of the main shaft 91 is converted into the amount of movement of the pivot point 83 based on this rotation center position parameter and the rotation axis angle command position at that time.

つぎに、この実施の形態3に係る数値制御装置の動作について図面を参照しながら説明する。   Next, the operation of the numerical control apparatus according to the third embodiment will be described with reference to the drawings.

上記の実施の形態1と相違する点は、機械位置計算部6における機械位置の計算の動作と、機械誤差計算部7における機械誤差の計算の動作と、パラメータ変更部8におけるパラメータの変更の動作と、測定異常検出部10及び指令変更部11の動作である。   The difference from the first embodiment is that the machine position calculation unit 6 performs a machine position calculation operation, the machine error calculation unit 7 performs a machine error calculation operation, and the parameter change unit 8 performs a parameter change operation. And the operation of the measurement abnormality detection unit 10 and the command change unit 11.

機械位置計算部6は、入力された検出位置及び長さ信号から、機械位置を求める。機械位置は、指令円弧の中心位置と検出位置とを結ぶ直線上にあり、テーブル90側の球52の中心からの距離がダブルボールバー5で測定した長さ信号の値となる点を機械位置としてその座標を求める。   The machine position calculation unit 6 obtains a machine position from the input detection position and length signal. The machine position is on a straight line connecting the center position of the command arc and the detection position, and the point where the distance from the center of the sphere 52 on the table 90 side becomes the value of the length signal measured by the double ball bar 5 is the machine position. As its coordinates.

このことを数式で表現すると以下のようになる。指令円弧がXZ平面内の円弧であるとし、ダブルボールバー5で計測した時刻tにおける長さをl(t)、回転軸の検出位置をθ(t)とすると、同じ時刻tにおける機械位置(x(t),y(t),z(t))は、次の式(3)のように求められる。 This can be expressed as follows: If the command arc is an arc in the XZ plane, the length at time t measured with the double ball bar 5 is l (t), and the detected position of the rotation axis is θ d (t), the machine position at the same time t (X m (t), y m (t), z m (t)) is obtained as in the following equation (3).

Figure 2009080616
Figure 2009080616

ただし、θ=0のとき、主軸91はZ軸の負方向を向いているものとする。また、ここでは、送り速度が十分遅く、回転軸の検出位置と直交3軸の検出位置との同期が十分取れており、指令円弧の中心位置からみた検出位置の方向と、主軸91の向きが一致しているものとして数式を導出している。 However, when θ d = 0, it is assumed that the main shaft 91 faces the negative direction of the Z axis. Also, here, the feed rate is sufficiently slow, and the detection position of the rotation axis and the detection position of the three orthogonal axes are sufficiently synchronized, and the direction of the detection position viewed from the center position of the command arc and the direction of the main shaft 91 are The mathematical formula is derived as a match.

機械誤差計算部7は、機械位置と検出位置から、回転中心位置(ピボット点83と主軸91側の球53のずれ量)のパラメータと実測値の間の誤差を算出し、パラメータ変更部8では、回転中心位置を記憶するパラメータに、機械誤差計算部7で求めた誤差を補正した値を設定する。   The machine error calculation unit 7 calculates an error between the parameter of the rotation center position (the displacement amount of the sphere 53 on the pivot point 83 side and the spindle 91 side) and the actual measurement value from the machine position and the detection position. A value obtained by correcting the error obtained by the mechanical error calculation unit 7 is set in the parameter for storing the rotation center position.

また、測定異常検出部10は、ダブルボールバー5が出力する長さ信号が、測定可能範囲を逸脱しないかどうかを監視し、逸脱する場合には異常信号を出力する。指令変更部11は、測定異常検出部10により異常信号が出力された場合、測定を中止し、機械の各駆動軸を試験動作の経路80の開始位置に戻した上で、動作経路を変更して再度測定を行う。長さ信号が測定可能範囲の上限値を上回った場合は、動作経路の半径を小さくする。小さくする量は、測定開始から測定中止までの長さ信号の最小値と、測定可能範囲の下限値との差を超えない値とする。また、長さ信号が測定可能範囲の下限値を下回った場合は、動作経路の半径を大きくする。大きくする量は、測定可能範囲の上限値と、測定開始から測定中止までの長さ信号の最大値との差を超えない値とする。   The measurement abnormality detection unit 10 monitors whether the length signal output from the double ball bar 5 does not deviate from the measurable range, and outputs an abnormality signal when deviating. When the abnormality signal is output from the measurement abnormality detection unit 10, the command change unit 11 stops the measurement, returns the drive axes of the machine to the start position of the test operation path 80, and then changes the operation path. And measure again. When the length signal exceeds the upper limit of the measurable range, the radius of the operation path is reduced. The amount to be reduced is a value that does not exceed the difference between the minimum value of the length signal from the start of measurement to the stop of measurement and the lower limit value of the measurable range. When the length signal falls below the lower limit value of the measurable range, the radius of the operation path is increased. The amount to be increased is a value that does not exceed the difference between the upper limit of the measurable range and the maximum value of the length signal from the start of measurement to the stop of measurement.

以上のように、本実施の形態3によれば、回転軸の移動も含むような複雑な動作経路においても、正確な機械位置を求めることができるという効果がある。また、本実施の形態3によれば、指令位置及び検出位置と同時刻の機械位置をもとに回転軸の回転中心位置を求めて回転中心位置のパラメータを設定するため、回転軸の回転中心位置のパラメータを正確に設定することができるという効果がある。さらに、本実施の形態3によれば、ダブルボールバー5の出力する長さ信号が測定可能範囲を逸脱する場合は測定を中止し、動作経路の条件を変更して測定を再度実施することにより、機械位置測定用計測器5を故障させることなく確実に測定を行うことができるという効果がある。   As described above, according to the third embodiment, there is an effect that an accurate machine position can be obtained even in a complicated operation path including movement of the rotating shaft. Further, according to the third embodiment, since the rotation center position of the rotation axis is obtained based on the machine position at the same time as the command position and the detection position, and the rotation center position parameter is set, There is an effect that the position parameter can be set accurately. Furthermore, according to the third embodiment, when the length signal output from the double ball bar 5 deviates from the measurable range, the measurement is stopped, the operation path condition is changed, and the measurement is performed again. There is an effect that the measurement can be surely performed without causing the machine position measuring instrument 5 to fail.

なお、本実施の形態3においては、主軸側が回転する例について説明したが、テーブル側が回転しても良い。   In the third embodiment, the example in which the main shaft side rotates has been described, but the table side may rotate.

実施の形態4.
この発明の実施の形態4に係る数値制御装置について図8及び図9を参照しながら説明する。図8は、この発明の実施の形態4に係る数値制御装置の構成を示すブロック図である。
Embodiment 4 FIG.
A numerical control apparatus according to Embodiment 4 of the present invention will be described with reference to FIGS. FIG. 8 is a block diagram showing a configuration of a numerical control apparatus according to Embodiment 4 of the present invention.

図8において、上記の実施の形態1と相違する点は、機械位置測定用計測器5Aとして、ダブルボールバーの代わりに2次元座標測定器(グリッドエンコーダ)を用いることである。なお、この2次元座標測定器(グリッドエンコーダ)は、上記の実施の形態2や、実施の形態3にも適用できる。   In FIG. 8, the difference from the first embodiment is that a two-dimensional coordinate measuring device (grid encoder) is used instead of the double ball bar as the mechanical position measuring measuring device 5A. This two-dimensional coordinate measuring device (grid encoder) can also be applied to the second embodiment and the third embodiment.

また、図9は、この発明の実施の形態4に係る数値制御装置の機械位置測定用計測器のセットアップの様子を示す斜視図である。 FIG. 9 is a perspective view showing the state of setup of the measuring instrument for measuring the machine position of the numerical controller according to Embodiment 4 of the present invention.

図9において、機械位置測定用計測器5Aとして用いるグリッドエンコーダは、微細な格子(グリッド)をもつプレート57の上に走査ヘッド56を置き、プレート57の面に平行な平面内における走査ヘッド56の2次元変位信号を出力するものである。機械のテーブル90の上にグリッドエンコーダ5Aのプレート57を設置し、主軸91にグリッドエンコーダ5Aの走査ヘッド56を取り付ける。試験動作の経路80は、走査ヘッド56をプレート57の面に平行に直線で移動するものとする。   In FIG. 9, the grid encoder used as the machine position measuring instrument 5 </ b> A has a scanning head 56 placed on a plate 57 having a fine grid (grid), and the scanning head 56 in a plane parallel to the surface of the plate 57. A two-dimensional displacement signal is output. The plate 57 of the grid encoder 5A is installed on the machine table 90, and the scanning head 56 of the grid encoder 5A is attached to the spindle 91. It is assumed that the test operation path 80 moves the scanning head 56 in a straight line parallel to the surface of the plate 57.

つぎに、この実施の形態4に係る数値制御装置の動作について図面を参照しながら説明する。   Next, the operation of the numerical control apparatus according to the fourth embodiment will be described with reference to the drawings.

上記の実施の形態1と相違する点は、機械位置測定用計測器5Aの出力が長さ信号ではなく2次元平面内の2次元変位信号であることと、機械位置計算部6、機械誤差計算部7、パラメータ変更部8の各動作である。   The difference from the first embodiment described above is that the output of the machine position measuring instrument 5A is not a length signal but a two-dimensional displacement signal in a two-dimensional plane, a machine position calculation unit 6, and a machine error calculation. The operations of the unit 7 and the parameter changing unit 8 are as follows.

以下では、グリッドエンコーダ5Aのプレート57の面はXY平面に平行に取り付けられているものとし、試験動作の経路80はX軸方向に一定速度で移動するものとする。   In the following description, it is assumed that the surface of the plate 57 of the grid encoder 5A is attached in parallel to the XY plane, and the test operation path 80 moves at a constant speed in the X-axis direction.

機械位置測定用計測器5Aは、時刻tにおけるX方向の変位x(t)と、Y軸方向の変位y(t)を出力する。 Machine position measuring instrument 5A outputs the X-direction displacement x g (t) at time t, Y-axis direction displacement y g a (t).

機械位置計算部6は、試験動作中の機械位置を計算する。試験動作の開始位置を原点としたときの時刻tにおける検出位置を(x(t),y(t),z(t))とすると、同じ時刻tにおける機械位置(x(t),y(t),z(t))は、次の式(4)のように求められる。 The machine position calculation unit 6 calculates the machine position during the test operation. If the detection position at time t when the start position of the test operation is the origin is (x d (t), y d (t), z d (t)), the machine position (x m (t ), Y m (t), z m (t)) are obtained by the following equation (4).

Figure 2009080616
Figure 2009080616

ここで、式(4)中のxm0、ym0は、試験動作の開始位置における検出位置である。 Here, x m0 and y m0 in the equation (4) are detection positions at the start position of the test operation.

機械誤差計算部7は、試験動作中の検出位置と機械位置の差を求める。試験動作の区間をn点に分割し、分割したk番目の点のx座標をxとするとき、検出位置がxとなるときの機械位置と検出位置の差Δx、Δyを求める。ΔxはX軸のピッチエラーであり、ΔyはY軸の真直度誤差である。つまり、機械誤差計算部7は、機械の主軸91の移動中の予め指定した点における検出位置及び機械位置のピッチエラー及び真直度誤差を計算する。 The machine error calculation unit 7 obtains a difference between the detection position and the machine position during the test operation. The section of the test operation is divided into n points, when the x-coordinate of the divided k-th point and x k, the difference [Delta] x k of the machine position and the detected position when the detection position is x k, determining a [Delta] y k . Δx k is an X-axis pitch error, and Δy k is a Y-axis straightness error. That is, the machine error calculation unit 7 calculates the pitch error and the straightness error of the detection position and the machine position at points specified in advance during the movement of the main spindle 91 of the machine.

パラメータ変更部8は、機械誤差計算部7で求めたピッチエラー及び真直度誤差をもとに、ピッチエラー補正及び真直度誤差補正のためのパラメータを変更する。つまり、パラメータ変更部8は、ピッチエラー及び真直度誤差に基づいて指定した点の指令位置を補正するためのパラメータを変更する。   The parameter changing unit 8 changes parameters for pitch error correction and straightness error correction based on the pitch error and straightness error obtained by the mechanical error calculation unit 7. That is, the parameter changing unit 8 changes the parameter for correcting the command position of the point specified based on the pitch error and the straightness error.

以上のように、本実施の形態4によれば、検出位置と同時刻の機械位置がわかるので、移動中の機械誤差を正確に求めることができるという効果がある。また、本実施の形態4によれば、1回の移動指令中に指定した点のピッチエラーと真直度誤差を同時に求めることができるので、ピッチエラー及び真直度誤差の補正パラメータを正確かつ迅速に設定することができるという効果がある。   As described above, according to the fourth embodiment, since the machine position at the same time as the detected position is known, there is an effect that the machine error during movement can be accurately obtained. Further, according to the fourth embodiment, since the pitch error and the straightness error at the point specified in one movement command can be obtained simultaneously, the correction parameters for the pitch error and the straightness error can be set accurately and quickly. There is an effect that it can be set.

なお、本実施の形態4では、機械位置測定用計測器5Aの測定方向と、機械の駆動軸の方向が一致している例を挙げたが、これらが異なっていてもよい。その場合は、機械位置計算部6において、機械の駆動軸方向に動かしたときの機械位置測定用計測器5Aの測定値をもとに座標変換を行い、機械の駆動軸方向の機械位置を求めるとよい。   In the fourth embodiment, the example in which the measurement direction of the machine position measuring instrument 5A and the direction of the machine drive shaft coincide with each other has been described, but these may be different. In that case, the machine position calculation unit 6 performs coordinate conversion based on the measurement value of the machine position measurement measuring instrument 5A when moved in the machine drive axis direction to obtain the machine position in the machine drive axis direction. Good.

また、以上の各実施の形態では、並進移動軸については、テーブル90が固定されており主軸91が移動する例を用いたが、逆に、主軸91が固定され、テーブル90が動くものであっても良いし、ある軸(例えば、X軸とZ軸)は主軸91が動き、他の軸(例えば、Y軸)はテーブル90が動くといったものであっても良い。いずれの場合も、主軸91の位置を、テーブル90に対する主軸91の相対位置と置き換えて考えればよい。   Further, in each of the above embodiments, the example in which the table 90 is fixed and the main shaft 91 moves is used for the translational movement axis. Conversely, the main shaft 91 is fixed and the table 90 moves. Alternatively, a certain axis (for example, the X axis and the Z axis) may be such that the main axis 91 moves, and another axis (for example, the Y axis) may move the table 90. In either case, the position of the main shaft 91 may be replaced with the relative position of the main shaft 91 with respect to the table 90.

この発明の実施の形態1に係る数値制御装置の構成を示すブロック図である。It is a block diagram which shows the structure of the numerical control apparatus which concerns on Embodiment 1 of this invention. この発明の実施の形態1に係る数値制御装置の機械位置測定用計測器のセットアップの様子を示す斜視図である。It is a perspective view which shows the mode of a setup of the measuring device for machine position measurement of the numerical control apparatus which concerns on Embodiment 1 of this invention. この発明の実施の形態2に係る数値制御装置の構成を示すブロック図である。It is a block diagram which shows the structure of the numerical control apparatus which concerns on Embodiment 2 of this invention. この発明の実施の形態2に係る数値制御装置の機械位置測定用計測器のセットアップの様子を示す斜視図である。It is a perspective view which shows the mode of a setup of the measuring device for machine position measurement of the numerical control apparatus which concerns on Embodiment 2 of this invention. この発明の実施の形態2に係る数値制御装置の機械位置表示部の表示例を示す図である。It is a figure which shows the example of a display of the machine position display part of the numerical control apparatus which concerns on Embodiment 2 of this invention. この発明の実施の形態3に係る数値制御装置の構成を示すブロック図である。It is a block diagram which shows the structure of the numerical control apparatus which concerns on Embodiment 3 of this invention. この発明の実施の形態3に係る数値制御装置の機械位置測定用計測器のセットアップの様子を示す斜視図である。It is a perspective view which shows the mode of a setup of the measuring device for machine position measurement of the numerical control apparatus which concerns on Embodiment 3 of this invention. この発明の実施の形態4に係る数値制御装置の構成を示すブロック図である。It is a block diagram which shows the structure of the numerical control apparatus which concerns on Embodiment 4 of this invention. この発明の実施の形態4に係る数値制御装置の機械位置測定用計測器のセットアップの様子を示す斜視図である。It is a perspective view which shows the mode of a setup of the measuring device for machine position measurement of the numerical control apparatus which concerns on Embodiment 4 of this invention.

符号の説明Explanation of symbols

1 指令生成部、2 機械駆動部、3 モータ、4 検出器、5 機械位置測定用計測器(ダブルボールバー)、5A 機械位置測定用計測器(グリッドエンコーダ)、6 機械位置計算部、7 機械誤差計算部、8 パラメータ変更部、9 機械位置表示部、10 測定異常検出部、11 指令変更部。   DESCRIPTION OF SYMBOLS 1 Command generation part, 2 Machine drive part, 3 Motor, 4 Detector, 5 Machine position measuring instrument (double ball bar), 5A Machine position measuring instrument (grid encoder), 6 Machine position calculation part, 7 Machine Error calculation unit, 8 parameter change unit, 9 machine position display unit, 10 measurement abnormality detection unit, 11 command change unit.

Claims (8)

モータの位置を検出して検出器から出力される検出位置が指令位置に追従するように、前記モータを駆動して機械のテーブルに対する主軸の相対位置を制御する数値制御装置において、
前記機械のテーブルに対する主軸の相対位置の所定の方向の変位を計測する機械位置測定用計測器と、
前記検出器から出力される検出位置及び前記機械位置測定用計測器から出力され前記検出位置と同時刻の機械位置測定用信号に基づいて機械位置を計算する機械位置計算部と、
前記指令位置、前記検出器から出力される検出位置及び前記機械位置計算部により計算された機械位置に基づいて機械誤差を計算する機械誤差計算部と、
前記機械誤差に基づいて誤差補正のためのパラメータを変更するパラメータ変更部と
を備えたことを特徴とする数値制御装置。
In a numerical control device that drives the motor to control the relative position of the spindle to the table of the machine so that the detection position output from the detector follows the command position by detecting the position of the motor.
A machine position measuring instrument for measuring a displacement in a predetermined direction of the relative position of the spindle relative to the table of the machine;
A machine position calculation unit that calculates a machine position based on a detection position output from the detector and a machine position measurement signal output from the machine position measurement measuring instrument at the same time as the detection position;
A machine error calculator that calculates a machine error based on the command position, a detection position output from the detector, and a machine position calculated by the machine position calculator;
A numerical control device comprising: a parameter changing unit that changes a parameter for error correction based on the mechanical error.
前記機械位置測定用計測器は、長さセンサであり、前記機械位置測定用信号は、機械のテーブル上の一点と主軸上の一点の間の距離を示す長さ信号であり、
前記機械位置計算部は、前記検出器から出力される検出位置及び前記長さセンサから出力され前記検出位置と同時刻の長さ信号に基づいて機械位置を計算する
ことを特徴とする請求項1記載の数値制御装置。
The machine position measuring instrument is a length sensor, and the machine position measuring signal is a length signal indicating a distance between one point on the machine table and one point on the spindle,
The machine position calculation unit calculates a machine position based on a detection position output from the detector and a length signal output from the length sensor and at the same time as the detection position. The numerical controller described.
前記機械誤差計算部は、モータの駆動方向反転時の運動誤差を計算し、
前記パラメータ変更部は、前記運動誤差に基づいて駆動方向反転時の指令位置を補正するためのパラメータを変更する
ことを特徴とする請求項1又は2記載の数値制御装置。
The mechanical error calculation unit calculates a motion error when the motor driving direction is reversed,
The numerical control device according to claim 1, wherein the parameter changing unit changes a parameter for correcting a command position when the driving direction is reversed based on the motion error.
前記機械誤差計算部は、前記機械の主軸またはテーブルの回転軸の回転中心位置の誤差を計算し、
前記パラメータ変更部は、前記回転中心位置の誤差に基づいて回転中心位置のパラメータを変更する
ことを特徴とする請求項1又は2記載の数値制御装置。
The machine error calculation unit calculates the error of the rotation center position of the spindle of the machine or the rotation axis of the table,
The numerical controller according to claim 1, wherein the parameter changing unit changes a parameter of the rotation center position based on an error of the rotation center position.
前記機械位置測定用計測器は、2次元座標測定器であり、前記機械位置測定用信号は、機械のテーブル上の一点から主軸上の一点の間の2次元平面内の変位を示す2次元変位信号であり、
前記機械位置計算部は、前記検出器から出力される検出位置及び前記2次元座標測定器から出力され前記検出位置と同時刻の2次元変位信号に基づいて機械位置を計算する
ことを特徴とする請求項1記載の数値制御装置。
The machine position measuring instrument is a two-dimensional coordinate measuring instrument, and the machine position measuring signal is a two-dimensional displacement indicating a displacement in a two-dimensional plane between a point on the machine table and a point on the spindle. Signal,
The machine position calculation unit calculates a machine position based on a detection position output from the detector and a two-dimensional displacement signal output from the two-dimensional coordinate measuring device and at the same time as the detection position. The numerical controller according to claim 1.
前記機械誤差計算部は、前記機械の主軸の移動中の予め指定した点における前記検出位置及び機械位置に基づいて当該点のピッチエラー及び真直度誤差を計算し、
前記パラメータ変更部は、前記ピッチエラー及び真直度誤差に基づいて指定した点の指令位置を補正するためのパラメータを変更する
ことを特徴とする請求項1又は5記載の数値制御装置。
The machine error calculation unit calculates a pitch error and a straightness error of the point based on the detection position and the machine position at a point specified in advance during the movement of the spindle of the machine,
The numerical controller according to claim 1, wherein the parameter changing unit changes a parameter for correcting a command position of a point specified based on the pitch error and the straightness error.
前記機械位置測定用計測器から出力される機械位置測定用信号が測定可能範囲を逸脱する場合には異常と判断する測定異常検出部と、
前記測定異常検出部により異常と判断された場合には測定を中止し、前記機械位置測定用信号が測定可能範囲を逸脱しないように動作指令を変更する指令変更部とをさらに備え、
動作指令が変更された場合には変更後の動作指令に基づいて再度測定を行う
ことを特徴とする請求項1から請求項6までのいずれかに記載の数値制御装置。
A measurement abnormality detection unit that determines an abnormality when the machine position measurement signal output from the machine position measurement instrument deviates from the measurable range;
A command changing unit that stops measurement when the measurement abnormality detecting unit determines that an abnormality has occurred, and changes an operation command so that the machine position measurement signal does not deviate from the measurable range;
The numerical control device according to any one of claims 1 to 6, wherein when the operation command is changed, measurement is performed again based on the changed operation command.
前記指令位置、前記検出器から出力される検出位置及び前記機械位置計算部により計算された機械位置を同一座標系上に表示する機械位置表示部
をさらに備えたことを特徴とする請求項1から請求項7までのいずれかに記載の数値制御装置。
The machine position display unit for displaying the command position, the detection position output from the detector, and the machine position calculated by the machine position calculation unit on the same coordinate system. The numerical control device according to claim 7.
JP2007248902A 2007-09-26 2007-09-26 Numerical controller Active JP4618616B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2007248902A JP4618616B2 (en) 2007-09-26 2007-09-26 Numerical controller

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2007248902A JP4618616B2 (en) 2007-09-26 2007-09-26 Numerical controller

Publications (2)

Publication Number Publication Date
JP2009080616A true JP2009080616A (en) 2009-04-16
JP4618616B2 JP4618616B2 (en) 2011-01-26

Family

ID=40655327

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2007248902A Active JP4618616B2 (en) 2007-09-26 2007-09-26 Numerical controller

Country Status (1)

Country Link
JP (1) JP4618616B2 (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102019564A (en) * 2009-09-10 2011-04-20 发那科株式会社 3d-trajectory display device for machine tool
CN102354158A (en) * 2011-10-24 2012-02-15 天津职业技术师范大学 Separation device for online measurement of dynamic error based on Bayesian network and method thereof
JP2018069375A (en) * 2016-10-28 2018-05-10 Dmg森精機株式会社 Machine position measuring apparatus and machine position measuring system
WO2018147232A1 (en) 2017-02-10 2018-08-16 国立大学法人神戸大学 Motion evaluation method, evaluation device, parameter adjustment method using said evaluation method, workpiece machining method, and machine tool
KR20190009514A (en) * 2017-07-19 2019-01-29 경일대학교산학협력단 Ball bar with geometric error measuring function

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1998032571A1 (en) * 1997-01-29 1998-07-30 Kabushiki Kaisha Yaskawa Denki Device and method for calibrating robot
JP2002023852A (en) * 2000-07-04 2002-01-25 Toshiba Mach Co Ltd Correcting device for feeding mechanism of numerically controlled machine tool and the same machine
JP2002091522A (en) * 2000-07-13 2002-03-29 Okuma Corp Error correcting method for work machine
JP2004094962A (en) * 2003-10-02 2004-03-25 Mitsubishi Electric Corp Numerical controller
JP2006326786A (en) * 2005-05-27 2006-12-07 Nippei Toyama Corp Device for measuring rotary motion accuracy of machine

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1998032571A1 (en) * 1997-01-29 1998-07-30 Kabushiki Kaisha Yaskawa Denki Device and method for calibrating robot
JP2002023852A (en) * 2000-07-04 2002-01-25 Toshiba Mach Co Ltd Correcting device for feeding mechanism of numerically controlled machine tool and the same machine
JP2002091522A (en) * 2000-07-13 2002-03-29 Okuma Corp Error correcting method for work machine
JP2004094962A (en) * 2003-10-02 2004-03-25 Mitsubishi Electric Corp Numerical controller
JP2006326786A (en) * 2005-05-27 2006-12-07 Nippei Toyama Corp Device for measuring rotary motion accuracy of machine

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102019564A (en) * 2009-09-10 2011-04-20 发那科株式会社 3d-trajectory display device for machine tool
CN102354158A (en) * 2011-10-24 2012-02-15 天津职业技术师范大学 Separation device for online measurement of dynamic error based on Bayesian network and method thereof
JP2018069375A (en) * 2016-10-28 2018-05-10 Dmg森精機株式会社 Machine position measuring apparatus and machine position measuring system
WO2018147232A1 (en) 2017-02-10 2018-08-16 国立大学法人神戸大学 Motion evaluation method, evaluation device, parameter adjustment method using said evaluation method, workpiece machining method, and machine tool
KR20190009514A (en) * 2017-07-19 2019-01-29 경일대학교산학협력단 Ball bar with geometric error measuring function
KR102009249B1 (en) * 2017-07-19 2019-08-09 경일대학교 산학협력단 Ball bar with geometric error measuring function

Also Published As

Publication number Publication date
JP4618616B2 (en) 2011-01-26

Similar Documents

Publication Publication Date Title
TWI491847B (en) Machine movement track measuring device, numerical control 〈nc〉tool machine and method for measuring machine movement track
JP6295070B2 (en) Geometric error identification method for multi-axis machine tools and multi-axis machine tools
KR101158772B1 (en) Numerically controlled machine tool and numerically control device
EP2647477A1 (en) Device for error correction for CNC machines
US9103648B2 (en) Profile measuring method and profile measuring instrument
JP2008089578A (en) Surface shape measuring device
JP5355037B2 (en) Accuracy measuring method, error control method for numerically controlled machine tool, and numerically controlled machine tool having error correcting function
JP2007044802A (en) Swivel axis center measuring method in multi-axis machine tool
JP4618616B2 (en) Numerical controller
JP5388823B2 (en) Trajectory measuring device
EP2149775B1 (en) Profile measuring instrument and profile measuring method
US11409258B2 (en) Information processing device and information processing method
JP5963792B2 (en) Error map creation method and apparatus, and numerically controlled machine tool having error map creation function
JP6803043B2 (en) How to measure geometric error of machine tools
JP2012079358A (en) Error map creation method, device, and numerical control machine tool with an error map creation function
JP2016154039A (en) Method and device for creating error map, and numerically controlled machine tool having error map creation function
EP4134762A1 (en) Machining method
US20230339060A1 (en) Processing machine, processing system, and method for manufacturing processed object
JP5210911B2 (en) Shape measuring device
JP2012104153A (en) Method and device for creating error map, and numerically controlled machine tool having error map creating function
KR102593770B1 (en) Position-independent geometric errors measuring equipment of five axis machine tool and measuring method using the same
JP5740201B2 (en) Geometric error identification device
JP4669639B2 (en) Mobile device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20090129

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20100913

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: 20100921

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20101019

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20131105

Year of fee payment: 3

R150 Certificate of patent or registration of utility model

Ref document number: 4618616

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250