JP2012035399A - Correction matrix derivation device, error correction device, and machine tool - Google Patents

Correction matrix derivation device, error correction device, and machine tool Download PDF

Info

Publication number
JP2012035399A
JP2012035399A JP2010180601A JP2010180601A JP2012035399A JP 2012035399 A JP2012035399 A JP 2012035399A JP 2010180601 A JP2010180601 A JP 2010180601A JP 2010180601 A JP2010180601 A JP 2010180601A JP 2012035399 A JP2012035399 A JP 2012035399A
Authority
JP
Japan
Prior art keywords
correction
calculation
correction matrix
coordinates
reference point
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
Application number
JP2010180601A
Other languages
Japanese (ja)
Inventor
Masaru Hamano
勝 浜野
Kenichi Matsubara
憲一 松原
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.)
Shin Nippon Koki KK
Original Assignee
Shin Nippon Koki KK
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 Shin Nippon Koki KK filed Critical Shin Nippon Koki KK
Priority to JP2010180601A priority Critical patent/JP2012035399A/en
Publication of JP2012035399A publication Critical patent/JP2012035399A/en
Pending legal-status Critical Current

Links

Images

Abstract

PROBLEM TO BE SOLVED: To correct an error of a processing position of a workpiece, and to correct each error small as a whole even if errors of different magnitudes occur in a plurality of places on the workpiece.SOLUTION: In the correction matrix derivation device 20, an operation part 26 performs first weighting factor reconfiguration re-configuring the weighting factor G of a first maximum alienation reference point selected on the basis of the coordinates after a first correction conversion by a temporary correction matrix by a given increment g1; and performs the second correction matrix calculation operation of a correction matrix which is the correction matrix for correction conversion of the reference coordinates of respective reference points 100a, and calculates the correction matrix in which a value obtained by adding a value obtained by multiplying the weighting factor G of the respective reference points 100a to a squared value of the distance between the coordinates after the correction conversion of the reference coordinates of the respective reference points 100a by the correction matrix and the corresponding measured coordinates for all the reference points 100a, becomes the minimum by the method of a least square.

Description

本発明は、補正マトリクス導出装置、誤差補正装置及び工作機械に関するものである。   The present invention relates to a correction matrix deriving device, an error correcting device, and a machine tool.

従来、工作機械において、様々な要因によりワークの加工位置にずれが生じるため、その加工位置のずれを補正することが行われている。例えば、下記特許文献1には、このようなワークの加工位置のずれを補正するための工作機械の基準位置補正装置が開示されている。   2. Description of the Related Art Conventionally, in a machine tool, since a deviation occurs in the machining position of a workpiece due to various factors, correction of the deviation of the machining position has been performed. For example, Patent Document 1 below discloses a machine tool reference position correction apparatus for correcting such a shift in the machining position of a workpiece.

特許文献1に示された工作機械の基準位置補正装置は、工作機械の構成部材の熱変形に起因して発生するワークの加工誤差を補正するものである。この基準位置補正装置は、工作機械のワーク支持用のテーブルに固定され、第1基準穴と第2基準穴が設けられた治具と、ワーク加工用の工具が取り付けられて回転させられる工作機械の主軸に工具の代わりに取り付けられたタッチセンサとを有しており、そのタッチセンサを用いて前記治具の両基準穴の位置を検出するようになっている。具体的には、タッチセンサを水平軸方向に移動させて各基準穴の水平軸方向の中心位置を検出するとともにタッチセンサを垂直軸方向に移動させて各基準穴の垂直軸方向の中心位置を検出し、それら検出した両中心位置から各基準穴の中心位置間の距離を求める。そして、工作機械の構成部材が常温の時の前記両基準穴の中心位置間の距離を予め計測しておき、その常温時の両基準穴の中心位置間の距離に対する今回計測した両基準穴の中心位置間の距離の変化量を算出する。そして、この基準位置補正装置では、第1基準穴の中心位置を基準位置として、前記算出した距離の変化量の分、主軸とテーブルとの相対位置を補正するようになっている。   The machine tool reference position correction apparatus disclosed in Patent Document 1 corrects a workpiece machining error caused by thermal deformation of a component of a machine tool. This reference position correction apparatus is fixed to a work support table of a machine tool, and is a machine tool that is rotated by being attached with a jig provided with a first reference hole and a second reference hole, and a work processing tool. And a touch sensor attached to the main shaft instead of the tool, and the position of both reference holes of the jig is detected using the touch sensor. Specifically, the touch sensor is moved in the horizontal axis direction to detect the center position of each reference hole in the horizontal axis direction, and the touch sensor is moved in the vertical axis direction to determine the center position of each reference hole in the vertical axis direction. The distance between the center positions of the respective reference holes is obtained from the detected center positions. Then, the distance between the center positions of the two reference holes when the component of the machine tool is at room temperature is measured in advance, and the distance between the center positions of the two reference holes at the room temperature is measured. The amount of change in the distance between the center positions is calculated. In this reference position correcting apparatus, the relative position between the spindle and the table is corrected by the calculated amount of change in the distance with the center position of the first reference hole as the reference position.

特開2009−251621号公報JP 2009-251621 A

しかしながら、上記特許文献1の基準位置補正装置は、あくまで、装置側の熱変形に起因する主軸とテーブルとの相対位置の誤差を補正するものであり、ワークに各種要因による変形が生じたり、テーブルへのワークの設置位置にずれが生じたりした場合における加工位置の誤差を補正することはできず、さらに、ワーク上の複数の位置においてそれぞれ異なる加工位置の誤差が生じている場合には、それらの誤差が全体的に小さくなるような補正を行うことはできない。   However, the reference position correction apparatus of the above-mentioned Patent Document 1 only corrects an error in the relative position between the spindle and the table caused by thermal deformation on the apparatus side, and deformation due to various factors occurs in the workpiece, If there is a deviation in the work position on the workpiece, the error in the machining position cannot be corrected, and if there are different machining position errors at multiple positions on the workpiece, It is not possible to perform a correction that reduces the error of the overall.

本発明は、上記の課題を解決するためになされたものであり、その目的は、ワークの変形や設置位置のずれに起因するワークの加工位置の誤差を補正できるようにするとともに、ワーク上の複数の位置においてそれぞれ異なる大きさの誤差が生じている場合でもそれらの各誤差を全体的に小さくする補正を行えるようにすることである。   The present invention has been made in order to solve the above-described problems, and the purpose of the present invention is to make it possible to correct an error in the machining position of the workpiece caused by deformation of the workpiece or displacement of the installation position, and on the workpiece. Even when errors of different sizes occur at a plurality of positions, it is possible to perform correction to reduce each error as a whole.

本願発明者は、上記目的を達成するために、基準座標軸上における座標が既知であるワーク上の複数の基準点について実際の座標(計測座標)を計測し、各基準点の基準座標軸上における既知の座標である基準座標を補正変換した場合にその補正変換後の各基準点の座標と対応する計測座標との間の距離の二乗の値を全ての基準点の分足し合わせた値が極小となるように各基準点の基準座標を補正変換可能な補正マトリクスを最小二乗法によって算出し、その補正マトリクスによりワークの加工指令を補正変換することを思いついた。   In order to achieve the above object, the inventor of the present application measures actual coordinates (measurement coordinates) of a plurality of reference points on a workpiece whose coordinates on the reference coordinate axis are known, and each reference point is known on the reference coordinate axis. When the reference coordinate that is the coordinate of the correction is corrected and converted, the value of the square of the distance between the coordinate of each reference point after the correction conversion and the corresponding measurement coordinate is the sum of all the reference points is the minimum value. Thus, the inventors have come up with the idea of calculating a correction matrix capable of correcting and converting the reference coordinates of each reference point by the least square method, and correcting and converting a workpiece machining command using the correction matrix.

この誤差補正の技術によれば、ワークの基準点の基準座標と計測座標との距離(誤差)に基づいてワークの加工指令を補正することになるので、ワークの変形や設置位置のずれに起因するワークの加工位置の誤差を補正できるようになる。また、この誤差補正では、前記補正マトリクスにより、前記補正変換後の各基準点の基準座標と対応する計測座標との間の距離の二乗和が極小となるようにワークの加工指令を補正変換することが可能であるので、ワーク上の複数の位置においてそれぞれ異なる大きさの誤差が生じている場合でもそれらの各誤差を全体的に小さくすることができる。   According to this error correction technique, the machining command for the workpiece is corrected based on the distance (error) between the reference coordinate of the workpiece reference point and the measurement coordinate, resulting in deformation of the workpiece or displacement of the installation position. The error of the machining position of the workpiece to be corrected can be corrected. In this error correction, the workpiece processing command is corrected and converted by the correction matrix so that the sum of squares of the distance between the reference coordinate of each reference point after the correction conversion and the corresponding measurement coordinate is minimized. Therefore, even when errors having different sizes occur at a plurality of positions on the workpiece, the errors can be reduced as a whole.

ところで、機械加工の分野では、計測したワーク上の各基準点の全てにおいてその誤差が許容値以下になることを保証する必要がある場合が多いが、上記の誤差補正の技術では、ワーク上の複数の基準点の中に計測座標が基準座標から著しく変位している少数の基準点が含まれている場合には、その基準点の誤差を許容値以下になるような補正ができない虞がある。   By the way, in the field of machining, it is often necessary to ensure that the error is less than or equal to an allowable value at each of the reference points on the measured workpiece. If a small number of reference points whose measurement coordinates are significantly displaced from the reference coordinates are included in the plurality of reference points, there is a possibility that correction cannot be performed so that the error of the reference points is less than the allowable value. .

具体的には、上記の誤差補正の技術では、前記複数の基準点の中に計測座標が基準座標から著しく変位している少数の基準点が含まれていても、その基準点以外の基準点の誤差が補正マトリクスの算出に影響を与える要素として大きな比重を占める。このため、算出される補正マトリクスによって全基準点の基準座標の補正を行うと、前記著しく変位した基準点以外の基準点の誤差については許容値以下に補正されるものの、前記著しく変位した基準点の誤差については十分な補正ではなく、補正後も許容値よりも大きい誤差が残ってしまう場合がある。   Specifically, in the error correction technique described above, even if a small number of reference points whose measurement coordinates are significantly displaced from the reference coordinates are included in the plurality of reference points, reference points other than the reference points are included. As a factor affecting the calculation of the correction matrix, the error of occupies a large specific gravity. For this reason, when the reference coordinates of all the reference points are corrected using the calculated correction matrix, errors of reference points other than the significantly displaced reference points are corrected to an allowable value or less, but the significantly displaced reference points. In some cases, the error is not sufficiently corrected, and an error larger than the allowable value may remain after the correction.

そこで、本願発明者は、このような著しく変位した基準点の誤差を最小化しつつ、全ての基準点の誤差を全体的に小さくする補正を行うために、以下のような構成の補正マトリックス導出装置、誤差補正装置及び工作機械を発明した。   Therefore, the inventor of the present application performs a correction matrix derivation device having the following configuration in order to perform correction to minimize the errors of all the reference points while minimizing the errors of the reference points that are significantly displaced. Invented an error correction device and a machine tool.

すなわち、本発明による補正マトリクス導出装置は、ワークとそのワークを加工するための工具とのうち少なくとも一方を基準座標軸上の移動ベクトルで表される加工指令に従って移動させることにより前記工具によるワークの加工を実行する駆動装置を備えた工作機械でのワークの実際の加工時に生じる加工位置の誤差を補正するように前記加工指令を変換するための補正マトリクスを導出する補正マトリクス導出装置であって、前記基準座標軸上における座標がそれぞれ与えられたワーク上の複数の基準点についてそれらの実際の座標をそれぞれ計測する計測装置と、前記複数の基準点に与えられた座標である基準座標と前記計測装置によって計測された前記複数の基準点の実際の座標である計測座標とに基づいて前記補正マトリクスを算出するための演算を行う演算部とを備え、前記演算部は、前記各基準点の前記基準座標を補正変換するための仮補正マトリクスであって、前記各基準点の前記基準座標を当該仮補正マトリクスによって補正変換した後の座標と対応する前記計測座標との間の距離の二乗の値を全ての基準点の分足し合わせた値が極小となるような仮補正マトリクスを最小二乗法によって算出する第1補正マトリクス算出演算と、その第1補正マトリクス算出演算によって算出された前記仮補正マトリクスにより前記各基準点の前記基準座標を補正変換する第1補正変換と、前記各基準点について等しい重み係数をそれぞれ設定する第1重み係数設定と、前記各基準点のうち前記基準座標を前記第1補正変換した後の座標と対応する前記計測座標との間の距離が最も大きい基準点である第1最大離間基準点を選出する第1選出と、その選出した前記第1最大離間基準点の前記重み係数を所定の増加分だけ増加した値に再設定する第1重み係数再設定と、その第1重み係数再設定の後、前記各基準点の前記基準座標を補正変換するための補正マトリクスであって、前記各基準点の前記基準座標を当該補正マトリクスによって補正変換した後の座標と対応する前記計測座標との間の距離の二乗の値にその各基準点について設定されている前記重み係数を掛けた値を全ての基準点の分足し合わせた値が極小となるような補正マトリクスを最小二乗法によって算出する第2補正マトリクス算出演算とを行う。   That is, the correction matrix deriving device according to the present invention processes a workpiece by the tool by moving at least one of the workpiece and a tool for machining the workpiece according to a machining command represented by a movement vector on a reference coordinate axis. A correction matrix deriving device for deriving a correction matrix for converting the machining command so as to correct an error of a machining position that occurs during actual machining of a workpiece in a machine tool having a drive device that executes A measuring device that measures the actual coordinates of a plurality of reference points on the workpiece, each of which is given coordinates on a reference coordinate axis, and a reference coordinate that is a coordinate given to the plurality of reference points and the measuring device The correction matrix is calculated based on measured coordinates that are actual coordinates of the plurality of reference points. A calculation unit that performs a calculation for calculating the reference coordinates, and the calculation unit is a temporary correction matrix for correcting and converting the reference coordinates of the reference points, and the reference coordinates of the reference points are converted to the temporary coordinates. A temporary correction matrix is calculated by the method of least squares so that a value obtained by adding the squares of the distances between the coordinates after correction conversion by the correction matrix and the corresponding measurement coordinates becomes the minimum value. A first correction matrix calculation operation, a first correction conversion for correcting and converting the reference coordinates of each reference point by the temporary correction matrix calculated by the first correction matrix calculation operation, and an equal weight for each reference point A first weighting coefficient setting for setting each coefficient, and a distance between the coordinates after the first correction conversion of the reference coordinates among the reference points and the corresponding measurement coordinates A first selection for selecting a first maximum separation reference point that is the largest reference point, and a first weight for resetting the weight coefficient of the selected first maximum separation reference point to a value increased by a predetermined increment. A correction matrix for correcting and converting the reference coordinates of each reference point after resetting the coefficient and resetting the first weighting coefficient, wherein the reference coordinates of each reference point are corrected and converted by the correction matrix. A value obtained by multiplying the value of the square of the distance between the coordinate after the measurement and the corresponding measurement coordinate by the weighting factor set for each reference point and adding all the reference points is a minimum. A second correction matrix calculation operation for calculating such a correction matrix by the least square method is performed.

この補正マトリクス導出装置では、演算部が、第1最大離間基準点の重み係数を所定の増加分だけ増加した値に再設定した後、各基準点の基準座標の補正変換後の座標と対応する計測座標との間の距離の二乗の値にその各基準点について設定されている重み係数を掛けた値を全ての基準点の分足し合わせた値が極小となるように各基準点の基準座標を補正変換可能な補正マトリクスを最小二乗法によって算出するため、単に各基準点の基準座標と計測座標との間の距離の二乗和が極小となるように各基準点の基準座標を補正変換可能な補正マトリクスを求める場合に比べて、各基準点のうち第1最大離間基準点の基準座標からの実際の座標の誤差を大きく加味した補正マトリクスを算出することができる。従って、この算出した補正マトリクスによってワークの加工指令を補正変換すれば、計測座標が基準座標から最大に変位した基準点、すなわち、計測座標が基準座標から著しく変位した基準点の誤差を最小化しつつ、全ての基準点の誤差を全体的に小さくする補正を行うことができる。   In this correction matrix deriving device, the arithmetic unit resets the weight coefficient of the first maximum separation reference point to a value increased by a predetermined increment, and then corresponds to the coordinates after correction conversion of the reference coordinates of each reference point. The reference coordinates of each reference point so that the value obtained by multiplying the square value of the distance to the measurement coordinate by the weighting factor set for each reference point is the sum of all the reference points. Since the correction matrix that can be corrected and converted is calculated by the least square method, the reference coordinates of each reference point can be corrected and converted so that the sum of squares of the distance between the reference coordinates of each reference point and the measurement coordinates is minimized. As compared with the case of obtaining a correct correction matrix, a correction matrix can be calculated in which an error in the actual coordinates from the reference coordinates of the first maximum separation reference point among the reference points is greatly added. Accordingly, if the workpiece machining command is corrected and converted by the calculated correction matrix, the error of the reference point where the measurement coordinate is displaced from the reference coordinate to the maximum, that is, the reference point where the measurement coordinate is significantly displaced from the reference coordinate is minimized. Thus, it is possible to perform correction to reduce the error of all the reference points as a whole.

上記補正マトリクス導出装置において、前記演算部は、前記第2補正マトリクス算出演算によって算出した前記補正マトリクスにより前記各基準点の前記基準座標を補正変換する第2補正変換と、前記各基準点のうち前記基準座標を前記第2補正変換した後の座標と対応する前記計測座標との間の距離が最も大きい基準点である第2最大離間基準点を選出する第2選出と、前記第2補正変換後の前記各基準点の座標と対応する前記計測座標との間の距離である補正後離間距離の算出と、その各基準点についての補正後離間距離の平均値である補正後離間距離平均値の算出と、今回の前記第2補正マトリクス算出演算に伴って算出した前記第2最大離間基準点についての前記補正後離間距離がその1つ前の回の補正マトリクス算出演算に伴って算出した最大離間基準点についての補正後離間距離よりも大きいという第1条件が満たされているかの判断と、今回の前記第2補正マトリクス算出演算に伴って算出した前記補正後離間距離平均値がその1つ前の回の補正マトリクス算出演算に伴って算出した補正後離間距離平均値よりも大きいという第2条件が満たされているかの判断とを行い、前記第1条件と前記第2条件の両方が満たされたと判断した場合には、前記1つ前の回の補正マトリクス算出演算で算出した補正マトリクスを最終の算出結果とし、前記第1条件と前記第2条件のうち少なくとも一方が満たされていないと判断した場合には、前記第2最大離間基準点の前記重み係数を所定の増加分だけ増加した値に再設定する第2重み係数再設定と、その第2重み係数再設定の後、前記各基準点の前記基準座標を補正変換するための補正マトリクスであって、前記各基準点の前記基準座標を当該補正マトリクスによって補正変換した後の座標と対応する前記計測座標との間の距離の二乗の値にその各基準点について設定されている前記重み係数を掛けた値を全ての基準点の分足し合わせた値が極小となるような補正マトリクスを最小二乗法によって算出する次回の第2補正マトリクス算出演算を行ってもよい。   In the correction matrix deriving device, the calculation unit includes: a second correction conversion that corrects and converts the reference coordinates of the reference points by the correction matrix calculated by the second correction matrix calculation calculation; A second selection for selecting a second maximum separation reference point that is a reference point having the longest distance between the coordinate after the second correction conversion of the reference coordinate and the corresponding measurement coordinate; and the second correction conversion Calculation of a post-correction separation distance that is a distance between the coordinates of each subsequent reference point and the corresponding measurement coordinate, and an average value of the post-correction separation distance that is an average value of the post-correction separation distance for each reference point And the post-correction separation distance for the second maximum separation reference point calculated with the second correction matrix calculation calculation this time is accompanied with the correction matrix calculation calculation of the previous time. The determination as to whether the first condition that the calculated maximum separation reference point is larger than the corrected separation distance is satisfied, and the average value of the corrected separation distance calculated with the second correction matrix calculation calculation this time is A determination is made as to whether a second condition that is greater than the corrected post-correction distance average value calculated with the previous correction matrix calculation operation is satisfied, and the first condition and the second condition When it is determined that both are satisfied, the correction matrix calculated in the previous correction matrix calculation operation is set as the final calculation result, and at least one of the first condition and the second condition is satisfied. If it is determined that the second weighting factor is not set, the second weighting factor resetting is performed to reset the weighting factor of the second maximum separation reference point to a value increased by a predetermined increment. A correction matrix for correcting and converting the reference coordinates of each reference point, between the coordinates after correction conversion of the reference coordinates of each reference point by the correction matrix and the corresponding measurement coordinates The next time the correction matrix is calculated by the method of least squares so that the value obtained by multiplying the value of the square of the distance by the weighting factor set for each reference point is the sum of all the reference points is minimized. A second correction matrix calculation calculation may be performed.

この構成では、演算部が、今回の第2補正マトリクス算出演算に伴って算出した第2最大離間基準点についての補正後離間距離が前回の補正マトリクス算出演算に伴って算出した最大離間基準点についての補正後離間距離よりも大きくなり、かつ、今回の第2補正マトリクス算出演算に伴って算出した補正後離間距離平均値が前回の補正マトリクス算出演算に伴って算出した補正後離間距離平均値よりも大きくなるまで、第2最大離間基準点の選出と、その選出した第2最大離間基準点の補正後離間距離の二乗の値に所定の増加分だけ増加させた重み係数を掛けて行う第2補正マトリクス算出演算とを行うことになるため、計測座標が基準座標から著しく変位した基準点の誤差を良好に小さくしつつ、全ての基準点の誤差を全体的に良好に小さくする補正を行うことが可能な補正マトリクスを算出することができる。   In this configuration, with respect to the maximum separation reference point calculated by the calculation unit with the previous correction matrix calculation calculation, the corrected separation distance for the second maximum separation reference point calculated with the current second correction matrix calculation calculation is calculated. The corrected post-correction distance average value calculated with the current second correction matrix calculation calculation is greater than the post-correction separation distance average value calculated with the previous correction matrix calculation calculation. The second maximum separation reference point is selected by multiplying the square value of the corrected separation distance of the selected second maximum separation reference point by a weighting factor increased by a predetermined increment until Since the correction matrix calculation calculation is performed, the error of the reference point where the measurement coordinate is significantly displaced from the reference coordinate is reduced well, and the error of all the reference points is reduced well overall. It is possible to calculate the correction matrix that can perform Kusuru correction.

上記補正マトリクス導出装置において、前記演算部は、前記第2補正マトリクス算出演算によって算出した前記補正マトリクスにより前記各基準点の前記基準座標を補正変換する第2補正変換と、前記各基準点のうち前記基準座標を前記第2補正変換した後の座標と対応する前記計測座標との間の距離が最も大きい基準点である第2最大離間基準点を選出する第2選出と、前記第2補正変換後の前記各基準点の座標と対応する前記計測座標との間の距離である補正後離間距離の算出と、その各基準点についての補正後離間距離の平均値である補正後離間距離平均値の算出と、今回の前記第2補正マトリクス算出演算に伴って算出した前記第2最大離間基準点についての前記補正後離間距離がその1つ前の回の補正マトリクス算出演算に伴って算出した最大離間基準点についての補正後離間距離よりも大きいという第1条件、及び、今回の前記第2補正マトリクス算出演算に伴って算出した前記補正後離間距離平均値がその1つ前の回の補正マトリクス算出演算に伴って算出した補正後離間距離平均値よりも大きいという第2条件が満たされているかの判断と、今回の前記第2補正マトリクス算出演算に伴って算出した前記第2最大離間基準点についての前記補正後離間距離がその1つ前の回の補正マトリクス算出演算に伴って算出した最大離間基準点についての補正後離間距離よりも小さいという第3条件、及び、今回の前記第2補正マトリクス算出演算に伴って算出した前記第2最大離間基準点についての前記補正後離間距離から今回の前記第2補正マトリクス算出演算に伴って算出した前記補正後離間距離平均値を減じた値がその1つ前の回の補正マトリクス算出演算に伴って算出した最大離間基準点についての補正後離間距離から当該1つ前の回の補正マトリクス算出演算に伴って算出した補正後離間距離平均値を減じた値よりも大きいという第4条件が満たされているかの判断とを行い、前記第1条件と前記第2条件の両方が満たされたか、又は、前記第3条件と前記第4条件の両方が満たされたと判断した場合には、前記1つ前の回の補正マトリクス算出演算で算出した補正マトリクスを最終の算出結果とし、それ以外の場合には、前記第2最大離間基準点の前記重み係数を所定の増加分だけ増加した値に再設定する第2重み係数再設定と、その第2重み係数再設定の後、前記各基準点の前記基準座標を補正変換するための補正マトリクスであって、前記各基準点の前記基準座標を当該補正マトリクスによって補正変換した後の座標と対応する前記計測座標との間の距離の二乗の値にその各基準点について設定されている前記重み係数を掛けた値を全ての基準点の分足し合わせた値が極小となるような補正マトリクスを最小二乗法によって算出する次回の第2補正マトリクス算出演算を行ってもよい。   In the correction matrix deriving device, the calculation unit includes: a second correction conversion that corrects and converts the reference coordinates of the reference points by the correction matrix calculated by the second correction matrix calculation calculation; A second selection for selecting a second maximum separation reference point that is a reference point having the longest distance between the coordinate after the second correction conversion of the reference coordinate and the corresponding measurement coordinate; and the second correction conversion Calculation of a post-correction separation distance that is a distance between the coordinates of each subsequent reference point and the corresponding measurement coordinate, and an average value of the post-correction separation distance that is an average value of the post-correction separation distance for each reference point And the post-correction separation distance for the second maximum separation reference point calculated with the second correction matrix calculation calculation this time is accompanied with the correction matrix calculation calculation of the previous time. The first condition that the calculated maximum separation reference point is larger than the post-correction separation distance, and the post-correction separation average value calculated in accordance with the second calculation calculation of the second correction matrix is the previous one. And whether the second condition of greater than the post-correction separation distance average value calculated with the correction matrix calculation calculation is satisfied, and the second maximum calculated with the current second correction matrix calculation calculation A third condition that the post-correction separation distance for the separation reference point is smaller than the post-correction separation distance for the maximum separation reference point calculated with the previous correction matrix calculation calculation; From the post-correction separation distance for the second maximum separation reference point calculated along with the second correction matrix calculation calculation, along with the current second correction matrix calculation calculation A value obtained by subtracting the average value of the post-correction separation distances from the post-correction separation distance for the maximum separation reference point calculated by the correction matrix calculation operation of the previous one is used. It is determined whether the fourth condition of being larger than the value obtained by subtracting the corrected post-correction distance average value calculated with the calculation operation is satisfied, and whether both the first condition and the second condition are satisfied Or, when it is determined that both the third condition and the fourth condition are satisfied, the correction matrix calculated in the previous correction matrix calculation calculation is used as the final calculation result, In this case, after resetting the weighting coefficient of the second maximum separation reference point to a value increased by a predetermined increment, and after resetting the second weighting coefficient, each reference point Correction conversion of the reference coordinates A correction matrix for correcting the reference coordinates of each reference point with a value of the square of the distance between the coordinates after the correction conversion of the reference coordinates by the correction matrix and the corresponding measurement coordinates. The next second correction matrix calculation calculation may be performed in which a correction matrix is calculated by the least square method so that a value obtained by adding the weighted coefficient multiplied by all the reference points is minimized.

この構成では、前回の補正マトリクス算出演算に伴って算出された最大離間基準点についての補正後離間距離に比べて今回の第2補正マトリクス算出演算に伴って算出された第2最大離間基準点についての補正後離間距離が減少している場合でも、最大離間基準点についての補正後離間距離に対する補正後離間距離平均値の差が前回の補正マトリクス算出演算の場合に比べて今回の第2補正マトリクス算出演算の場合の方が増加すれば、それ以降の回の第2補正マトリクス算出演算は行われず、前回の補正マトリクス算出演算で算出した補正マトリクスが最終の算出結果となる。すなわち、この構成では、計測座標が基準座標から著しく変位した基準点(最大離間基準点)の基準座標に対する誤差を小さくしつつ、そのような最大離間基準点の誤差が全基準点の誤差の平均値に近づくような補正を行うことが可能な補正マトリクスを算出することができる。   In this configuration, the second maximum separation reference point calculated with the current second correction matrix calculation calculation is compared with the post-correction separation distance with respect to the maximum separation reference point calculated with the previous correction matrix calculation calculation. Even if the post-correction separation distance is decreased, the difference between the post-correction separation average value and the post-correction separation distance for the maximum separation reference point is the second correction matrix this time as compared with the previous correction matrix calculation calculation. If the calculation calculation increases, the subsequent second correction matrix calculation calculation is not performed, and the correction matrix calculated in the previous correction matrix calculation calculation becomes the final calculation result. In other words, in this configuration, the error of the reference point (maximum separation reference point) whose measurement coordinate is significantly displaced from the reference coordinate is reduced, while the error of the maximum separation reference point is the average of the errors of all the reference points. It is possible to calculate a correction matrix that can be corrected so as to approach the value.

上記補正マトリクス導出装置において、前記演算部は、前記第1補正マトリクス算出演算に先立って温度によるワークの膨張収縮率を表すスケーリング倍率の導出を行い、前記第1補正マトリクス算出演算では、前記スケーリング倍率を含む前記仮補正マトリクスで前記各基準点の前記基準座標を補正変換した場合について前記仮補正マトリクスの算出を行い、前記第2補正マトリクス算出演算では、前記スケーリング倍率を含む前記補正マトリクスで前記各基準点の前記基準座標を補正変換した場合について前記補正マトリクスの算出を行うことが好ましい。   In the correction matrix deriving device, the calculation unit derives a scaling factor that represents an expansion / contraction rate of the workpiece due to temperature prior to the first correction matrix calculation operation, and in the first correction matrix calculation operation, the scaling factor is calculated. The temporary correction matrix is calculated when the reference coordinates of the reference points are corrected and converted using the temporary correction matrix including the second correction matrix calculation operation, and the second correction matrix calculation operation includes calculating the temporary correction matrix. It is preferable to calculate the correction matrix when the reference coordinates of the reference point are corrected and converted.

この構成では、温度によるワークの膨張収縮率を表すスケーリング倍率の要素を加えた最小二乗法による演算で前記仮補正マトリクス及び前記補正マトリクスが算出されるため、ワークの温度による膨張収縮に起因する誤差を加味した補正マトリクスを得ることができる。このため、その補正マトリクスによってワークの加工指令を補正変換すれば、ワークの温度による膨張収縮に起因する誤差を補正することができる。   In this configuration, since the provisional correction matrix and the correction matrix are calculated by a calculation based on the least square method with an element of the scaling factor representing the expansion / contraction rate of the work due to temperature, an error caused by expansion / contraction due to the temperature of the work Can be obtained. For this reason, if the workpiece machining command is corrected and converted using the correction matrix, errors caused by expansion and contraction due to the workpiece temperature can be corrected.

本発明による誤差補正装置は、ワークとそのワークを加工するための工具とのうち少なくとも一方を基準座標軸上の移動ベクトルで表される加工指令に従って移動させることにより前記工具によるワークの加工を実行する駆動装置を備えた工作機械に設けられ、ワークの実際の加工時に生じる加工位置の誤差を補正するための誤差補正装置であって、上記補正マトリクス導出装置と、その補正マトリクス導出装置によって導出された前記補正マトリクスを用いて前記加工指令を補正変換する加工指令補正変換部とを備えている。   The error correction apparatus according to the present invention performs machining of a workpiece by the tool by moving at least one of the workpiece and a tool for machining the workpiece according to a machining command represented by a movement vector on a reference coordinate axis. An error correction device that is provided in a machine tool having a driving device and corrects a machining position error that occurs during actual machining of a workpiece, and is derived by the correction matrix deriving device and the correction matrix deriving device. A machining command correction conversion unit that corrects and converts the machining command using the correction matrix.

この誤差補正装置では、加工指令補正変換部が上記補正マトリクス導出装置によって導出された補正マトリクスを用いてワークの加工指令を補正変換するため、ワークの各基準点の中で基準座標から最大に変位した基準点に対応する部位の加工誤差を最小化しつつ、ワークの全ての基準点に対応する部位の加工誤差を全体的に小さくする補正を行うことができる。   In this error correction device, since the machining command correction conversion unit corrects and converts the workpiece machining command using the correction matrix derived by the correction matrix deriving device, the workpiece command is displaced to the maximum from the reference coordinates among the reference points of the workpiece. It is possible to perform correction to reduce the machining errors of the parts corresponding to all the reference points of the workpiece as a whole while minimizing the machining errors of the parts corresponding to the reference points.

本発明による工作機械は、ワークを加工するための工作機械であって、ワークとそのワークを加工するための工具とのうち少なくとも一方を基準座標軸上の移動ベクトルで表される加工指令に従って移動させることにより前記工具によるワークの加工を実行する駆動装置と、上記誤差補正装置と、その誤差補正装置によって補正変換された加工指令に従って前記駆動装置にワークと前記工具のうち少なくとも一方の移動を実行させてワークを加工させる制御装置とを備えている。   A machine tool according to the present invention is a machine tool for machining a workpiece, and moves at least one of the workpiece and a tool for machining the workpiece according to a machining command represented by a movement vector on a reference coordinate axis. Thus, according to the drive device for processing the workpiece with the tool, the error correction device, and the machining command corrected and converted by the error correction device, the drive device executes at least one of the workpiece and the tool. And a control device for processing the workpiece.

この工作機械では、制御装置が、上記誤差補正装置によって補正変換された加工指令に従って駆動装置にワークと工具のうち少なくとも一方の移動を実行させてワークを加工させるため、ワークの各基準点の中で基準座標から最大に変位した基準点に対応する部位の加工誤差を最小化しつつ、ワークの全ての基準点に対応する部位の加工誤差を全体的に小さくすることができる。   In this machine tool, the control device causes the drive device to move at least one of the workpiece and the tool in accordance with the machining command corrected and converted by the error correction device, so that the workpiece is machined. Thus, it is possible to minimize the machining error of the part corresponding to all the reference points of the workpiece while minimizing the machining error of the part corresponding to the reference point displaced to the maximum from the reference coordinates.

以上説明したように、本発明によれば、ワークの各基準点のうち計測座標が基準座標から著しく変位した基準点の誤差を最小化しつつ、全ての基準点の誤差を全体的に小さくする補正を行うことができる。   As described above, according to the present invention, the correction that minimizes the errors of all the reference points while minimizing the errors of the reference points in which the measurement coordinates are significantly displaced from the reference coordinates among the reference points of the workpiece. It can be performed.

本発明の一実施形態による工作機械の概略的な斜視図である。1 is a schematic perspective view of a machine tool according to an embodiment of the present invention. 本発明の一実施形態による工作機械の機能ブロック図である。It is a functional block diagram of the machine tool by one Embodiment of this invention. 本発明の一実施形態の工作機械によるワークの加工プロセスを示すフローチャートである。It is a flowchart which shows the process process of the workpiece | work by the machine tool of one Embodiment of this invention. 本発明の一実施形態の工作機械におけるキャリブレーションの方法を説明するための図である。It is a figure for demonstrating the method of the calibration in the machine tool of one Embodiment of this invention. 本発明の一実施形態の工作機械におけるスケーリング倍率導出時の基準バーの測定方法を説明するための図である。It is a figure for demonstrating the measuring method of the reference | standard bar | burr at the time of deriving the scaling magnification in the machine tool of one Embodiment of this invention. ワーク上に配置された基準球の状態を示す斜視図である。It is a perspective view which shows the state of the reference | standard sphere arrange | positioned on a workpiece | work. 本発明の一実施形態の工作機械における基準点の計測座標の計測方法を説明するための図である。It is a figure for demonstrating the measuring method of the measurement coordinate of the reference point in the machine tool of one Embodiment of this invention. 本発明の一実施形態の補正マトリクス導出装置による補正マトリクスの算出プロセスを示すフローチャートのうち第1最大離間基準点の選出までのプロセスを示す図である。It is a figure which shows the process until selection of the 1st largest separation | separation reference point among the flowcharts which show the calculation process of the correction matrix by the correction matrix derivation device of one embodiment of the present invention. 本発明の一実施形態の補正マトリクス導出装置による補正マトリクスの算出プロセスを示すフローチャートのうち第2補正マトリクス算出演算以降のプロセスを示す図である。It is a figure which shows the process after the 2nd correction matrix calculation calculation among the flowcharts which show the calculation process of the correction matrix by the correction matrix derivation device of one embodiment of the present invention.

以下、本発明の実施形態を図面を参照して説明する。   Hereinafter, embodiments of the present invention will be described with reference to the drawings.

まず、図1及び図2を参照して、本発明の一実施形態による工作機械の構成について説明する。   First, with reference to FIG.1 and FIG.2, the structure of the machine tool by one Embodiment of this invention is demonstrated.

本実施形態による工作機械は、加工対象物であるワークWを加工するためのものであって、基準座標軸上の移動ベクトルで表される加工指令に従ってワークWと工具5を移動させることにより、その工具5によるワークWの加工を行うものである。   The machine tool according to the present embodiment is for machining a workpiece W that is a workpiece, and by moving the workpiece W and the tool 5 in accordance with a machining command represented by a movement vector on a reference coordinate axis, The workpiece W is processed by the tool 5.

具体的には、本実施形態の工作機械は、駆動装置2と、工具5と、誤差補正装置6(図2参照)と、制御装置7(図2参照)とを備えている。   Specifically, the machine tool of this embodiment includes a drive device 2, a tool 5, an error correction device 6 (see FIG. 2), and a control device 7 (see FIG. 2).

駆動装置2は、ワークWとそのワークWを加工するための工具5を加工指令に従って移動させることにより工具5によるワークWの加工を実行する装置である。この駆動装置2は、ワーク駆動装置3と、工具駆動装置4とを備えている。   The drive device 2 is a device that executes machining of the workpiece W by the tool 5 by moving the workpiece W and the tool 5 for machining the workpiece W according to the machining command. The drive device 2 includes a workpiece drive device 3 and a tool drive device 4.

ワーク駆動装置3は、加工指令に従ってワークWを水平方向であるX軸方向に移動させるものである。このワーク駆動装置3は、設置面上に固定されたベッド3a上において前記X軸方向にテーブル3bを移動させることにより、そのテーブル3b上に載置されたワークWをX軸方向に移動させる。このワーク駆動装置3は、テーブル3bをX軸方向に移動させるための駆動源として図略のサーボモータを備えている。   The workpiece driving device 3 moves the workpiece W in the X-axis direction, which is the horizontal direction, according to the machining command. The work drive device 3 moves the work W placed on the table 3b in the X-axis direction by moving the table 3b in the X-axis direction on the bed 3a fixed on the installation surface. This work drive device 3 includes a servo motor (not shown) as a drive source for moving the table 3b in the X-axis direction.

工具駆動装置4は、加工指令に従って、水平方向で前記X軸方向に直交するY軸方向と、X軸及びY軸の両方に直交するZ軸方向(鉛直方向)とに工具5を移動させるものである。   The tool driving device 4 moves the tool 5 in the horizontal direction in the Y-axis direction orthogonal to the X-axis direction and the Z-axis direction (vertical direction) orthogonal to both the X-axis and the Y-axis in accordance with the machining command. It is.

具体的には、工具駆動装置4は、一対のコラム8と、クロスレール10と、水平移動装置12と、垂直移動装置14と、主軸装置16とを備えている。   Specifically, the tool driving device 4 includes a pair of columns 8, a cross rail 10, a horizontal movement device 12, a vertical movement device 14, and a main shaft device 16.

一対のコラム8は、ベッド3aの幅方向(Y軸方向)においてそのベッド3aの両側に分かれて立設されている。   The pair of columns 8 are separately provided on both sides of the bed 3a in the width direction (Y-axis direction) of the bed 3a.

クロスレール10は、ベッド3aの上方においてY軸方向に延びるように配置されており、一対のコラム8によって上下方向に移動可能に支持されている。そして、このクロスレール10は、図略の駆動機構によりコラム8に沿って上下方向に移動させられるようになっている。   The cross rail 10 is disposed so as to extend in the Y-axis direction above the bed 3a, and is supported by a pair of columns 8 so as to be movable in the vertical direction. The cross rail 10 is moved up and down along the column 8 by a drive mechanism (not shown).

水平移動装置12は、クロスレール10によってY軸方向(クロスレール10の長手方向)に移動可能に支持されている。水平移動装置12は、図略のサーボモータを備えており、そのサーボモータの駆動力によってクロスレール10に沿ってY軸方向に移動するようになっている。   The horizontal movement device 12 is supported by the cross rail 10 so as to be movable in the Y-axis direction (longitudinal direction of the cross rail 10). The horizontal movement device 12 includes a servo motor (not shown), and moves in the Y-axis direction along the cross rail 10 by the driving force of the servo motor.

垂直移動装置14は、水平移動装置12に搭載されている。この垂直移動装置14は、図略のサーボモータを備えており、そのサーボモータの駆動力によって水平移動装置12に対してZ軸方向に移動するようになっている。   The vertical movement device 14 is mounted on the horizontal movement device 12. The vertical movement device 14 includes a servo motor (not shown), and is moved in the Z-axis direction with respect to the horizontal movement device 12 by the driving force of the servo motor.

主軸装置16は、垂直移動装置14によって支持されている。この主軸装置16は、工具5を保持し、その工具5をZ軸方向に延びる軸心回りに回転させる。この主軸装置16によって回転させられた工具5によりワークWが切削加工される。   The spindle device 16 is supported by the vertical movement device 14. The spindle device 16 holds the tool 5 and rotates the tool 5 about an axis extending in the Z-axis direction. The workpiece W is cut by the tool 5 rotated by the spindle device 16.

そして、Y軸方向への水平移動装置12の移動とZ軸方向への垂直移動装置14の移動とにより、工具5がY軸方向及びZ軸方向に移動させられ、この工具5のY軸方向及びZ軸方向への移動とワーク駆動装置3によるワークWのX軸方向への移動との組み合わせにより工具5をワークWに対して相対的に加工パスに従って移動させ、ワークWを所定の形状に加工するようになっている。   Then, the tool 5 is moved in the Y-axis direction and the Z-axis direction by the movement of the horizontal movement device 12 in the Y-axis direction and the movement of the vertical movement device 14 in the Z-axis direction. The tool 5 is moved relative to the workpiece W in accordance with the machining path by a combination of the movement in the Z-axis direction and the movement of the workpiece W in the X-axis direction by the workpiece driving device 3 so that the workpiece W is shaped into a predetermined shape. It is designed to be processed.

誤差補正装置6は、ワークWの実際の加工時に生じる加工位置の誤差を補正するためのものである。具体的には、誤差補正装置6は、図2に示すように、補正マトリクス導出装置20と、加工指令補正変換部22とを有する。   The error correction device 6 is for correcting an error in the machining position that occurs during actual machining of the workpiece W. Specifically, the error correction device 6 includes a correction matrix derivation device 20 and a machining command correction conversion unit 22 as shown in FIG.

補正マトリクス導出装置20は、ワークWの実際の加工時に生じる加工位置の誤差を補正するように加工指令を補正変換するための補正マトリクスを導出するものである。ワークWの実際の加工時に生じる加工位置の誤差は、加工指令で指示されるワークW上の加工位置と実際に工具5によって切削加工されるワークW上の位置との間で生じる誤差のことであり、温度によるワークWの膨張収縮、ワークWの捩れ、ワークWの重力変形、その他、ワークWの設置位置のずれ等に起因して生じるものである。   The correction matrix deriving device 20 derives a correction matrix for correcting and converting a machining command so as to correct a machining position error that occurs during actual machining of the workpiece W. The error of the machining position that occurs during actual machining of the workpiece W is an error that occurs between the machining position on the workpiece W that is instructed by the machining command and the position on the workpiece W that is actually cut by the tool 5. Yes, it is caused by expansion / contraction of the workpiece W due to temperature, twisting of the workpiece W, gravity deformation of the workpiece W, misalignment of the installation position of the workpiece W, and the like.

補正マトリクス導出装置20は、計測装置24と、演算部26と、記憶部28とを有する。   The correction matrix deriving device 20 includes a measurement device 24, a calculation unit 26, and a storage unit 28.

計測装置24は、計測対象物の座標を計測するものである。この計測装置24は、基準座標軸上における座標がそれぞれ与えられたワークW上の複数の基準点100aについてそれらの実際の座標をそれぞれ計測する。具体的には、ワークWには、図6に示すように、複数の基準球100が設けられている。この複数の基準球100は、平板状のワークWの上面から突出するように設けられており、互いに離間して設置されている。そして、この各基準球100の中心点がそれぞれ基準点100aとなっている。計測装置24は、図2に示すように、測定プローブ34と、座標取得部36と、座標算出部38と、座標記憶部40とを有する。   The measuring device 24 measures the coordinates of the measurement object. The measuring device 24 measures the actual coordinates of a plurality of reference points 100a on the workpiece W to which the coordinates on the reference coordinate axis are respectively given. Specifically, the workpiece W is provided with a plurality of reference balls 100 as shown in FIG. The plurality of reference spheres 100 are provided so as to protrude from the upper surface of the flat workpiece W, and are disposed apart from each other. The center point of each reference sphere 100 is a reference point 100a. As shown in FIG. 2, the measurement device 24 includes a measurement probe 34, a coordinate acquisition unit 36, a coordinate calculation unit 38, and a coordinate storage unit 40.

測定プローブ34(図4参照)は、直線的に延びる軸部34aと、その軸部34aの先端(下端)に設けられた球状のセンサ部34bとを有するタッチセンサである。この測定プローブ34は、工具5の代わりに主軸装置16に取り付けられる。この際、測定プローブ34は、Z軸方向に延びる姿勢で主軸装置16に保持され、その軸心が主軸装置16に保持される工具5の軸心(回転軸)の位置と一致するように主軸装置16に保持される。測定プローブ34は、その先端のセンサ部34bが対象物に接触することによって、座標取得部36へ信号を送るように構成されている。   The measurement probe 34 (see FIG. 4) is a touch sensor having a linearly extending shaft portion 34a and a spherical sensor portion 34b provided at the tip (lower end) of the shaft portion 34a. The measurement probe 34 is attached to the spindle device 16 instead of the tool 5. At this time, the measurement probe 34 is held by the spindle device 16 in a posture extending in the Z-axis direction, and the spindle is aligned with the position of the axis (rotary axis) of the tool 5 held by the spindle device 16. It is held in the device 16. The measurement probe 34 is configured to send a signal to the coordinate acquisition unit 36 when the sensor unit 34b at the tip thereof contacts the object.

座標取得部36は、ワーク駆動装置3からX軸方向の移動座標のデータを、工具駆動装置4の水平移動装置12からY軸方向の移動座標のデータを、工具駆動装置4の垂直移動装置14からZ軸方向の移動座標のデータをそれぞれ得ており、測定プローブ34のセンサ部34bが対象物に接触して測定プローブ34から信号が送られてくるのに応じてそのときのセンサ部34bが接触した部位の座標を前記各移動座標のデータから求める。   The coordinate acquisition unit 36 receives movement coordinate data in the X-axis direction from the workpiece driving device 3, movement coordinate data in the Y-axis direction from the horizontal movement device 12 in the tool driving device 4, and vertical movement device 14 in the tool driving device 4. The movement coordinate data in the Z-axis direction is respectively obtained from the sensor probe 34b of the measurement probe 34. When the sensor unit 34b of the measurement probe 34 contacts the object and a signal is sent from the measurement probe 34, the sensor unit 34b at that time The coordinate of the contacted part is obtained from the data of each moving coordinate.

座標算出部38は、測定プローブ34のセンサ部34bがワークW上の各基準球100の外面にXYZ軸の各方向から接触して座標取得部36がその接触部位の座標を取得した場合に、その座標取得部36の取得した前記接触部位の座標から各基準球100の中心に位置する基準点100aの座標を算出する。当該計測装置24の測定プローブ34、座標取得部36及び座標算出部38によるワークW上の各基準点100aの座標の詳細な導出プロセスについては、後述する。   The coordinate calculation unit 38, when the sensor unit 34b of the measurement probe 34 contacts the outer surface of each reference sphere 100 on the workpiece W from each direction of the XYZ axes, and the coordinate acquisition unit 36 acquires the coordinates of the contact portion, The coordinates of the reference point 100 a located at the center of each reference sphere 100 are calculated from the coordinates of the contact part acquired by the coordinate acquisition unit 36. A detailed process of deriving the coordinates of each reference point 100a on the workpiece W by the measurement probe 34, the coordinate acquisition unit 36, and the coordinate calculation unit 38 of the measurement device 24 will be described later.

座標記憶部40は、座標算出部38によって算出された各基準点100aの座標を記憶する。なお、座標取得部36、座標算出部38及び座標記憶部40は、工作機械に設けられた演算装置に組み込まれている。   The coordinate storage unit 40 stores the coordinates of each reference point 100a calculated by the coordinate calculation unit 38. In addition, the coordinate acquisition part 36, the coordinate calculation part 38, and the coordinate memory | storage part 40 are integrated in the arithmetic unit provided in the machine tool.

演算部26は、ワークW上の複数の基準点100aに与えられた基準座標と計測装置24によって計測された複数の基準点100aの実際の座標である計測座標とに基づいて補正マトリクスを算出するための演算や、その他各種演算、判断等を行う。補正マトリクスは、オイラー角と平行移動ベクトルとによって表され、ワークW上の複数の基準点100aの基準座標を計測座標に近づけるためにその複数の基準点100aの基準座標をどのように回転させて平行移動させるかを表す。この演算部26が補正マトリクスの算出のために行う各種演算や判断等の詳細な内容については、後述する。   The computing unit 26 calculates a correction matrix based on the reference coordinates given to the plurality of reference points 100a on the workpiece W and the measurement coordinates that are actual coordinates of the plurality of reference points 100a measured by the measuring device 24. And other various calculations and judgments. The correction matrix is represented by an Euler angle and a translation vector, and how the reference coordinates of the plurality of reference points 100a are rotated in order to bring the reference coordinates of the reference points 100a on the workpiece W closer to the measurement coordinates. Indicates whether to translate. Detailed contents such as various calculations and determinations performed by the calculation unit 26 for calculating the correction matrix will be described later.

記憶部28は、ワークWの加工指令(NCプログラム)、キャリブレーションによって算出された補正値、スケーリング倍率、ワークW上の各基準点100aの基準座標、計測装置24によって計測されたワークW上の各基準点100aの計測座標、第1補正マトリクス算出演算によって算出される仮補正マトリクスのデータ、第2補正マトリクス算出演算によって算出される補正マトリクスのデータ、補正マトリクスによって補正変換された後の加工指令、その他、各種データを保存する。   The storage unit 28 includes a machining command (NC program) for the workpiece W, a correction value calculated by calibration, a scaling factor, reference coordinates of each reference point 100a on the workpiece W, and on the workpiece W measured by the measuring device 24. Measurement coordinates of each reference point 100a, provisional correction matrix data calculated by the first correction matrix calculation calculation, correction matrix data calculated by the second correction matrix calculation calculation, and processing command after correction conversion by the correction matrix Save other data.

加工指令補正変換部22は、補正マトリクス導出装置20の演算部26によって導出され、記憶部28に保存された補正マトリクスを用いて加工指令を補正変換するものである。   The machining command correction conversion unit 22 corrects and converts the machining command using the correction matrix derived by the calculation unit 26 of the correction matrix deriving device 20 and stored in the storage unit 28.

制御装置7は、ワーク駆動装置3の駆動及び工具駆動装置4の駆動を制御するものである。この制御装置7は、加工指令補正変換部22によって補正変換された加工指令に従ってワーク駆動装置3にワークWの移動を実行させるとともに工具駆動装置4の水平移動装置12及び垂直移動装置14に工具5の移動を実行させてワークWを加工させる。   The control device 7 controls the driving of the work driving device 3 and the driving of the tool driving device 4. The control device 7 causes the workpiece driving device 3 to move the workpiece W in accordance with the machining command corrected and converted by the machining command correction conversion unit 22 and causes the horizontal movement device 12 and the vertical movement device 14 of the tool driving device 4 to move the tool 5. To move the workpiece W.

次に、本実施形態の工作機械によるワークWの加工プロセスについて説明する。   Next, a machining process of the workpiece W by the machine tool of this embodiment will be described.

本実施形態による工作機械では、ワークWの加工を行うに当たって、図3に示すように、まず、キャリブレーションを行う(ステップS1)。このキャリブレーションは、図4に示すような基準治具102を用いて行われる。具体的には、基準治具102は、工作機械のテーブル3b上に設置される基部102aと、その基部102aから延びる脚部102bと、その脚部102bの先端に設けられた球体102cとを有する。そして、このキャリブレーションは、主軸装置16に測定プローブ34を取り付け、その測定プローブ34で前記球体102cの外面の複数箇所の座標を検出することによって行う。詳細には、ワーク駆動装置3と工具駆動装置4の駆動によって、測定プローブ34のセンサ部34bを図4中の矢印で示すように前記球体102cの外面の複数箇所に対して接触させる。これにより、球体102cのうちセンサ部34bが接触した各箇所の座標が座標取得部36によって取得される。そして、演算部26が、座標取得部36によって取得された座標とセンサ部34bが球体102cに接触すべき本来の座標とのずれを算出するとともに、そのずれを補正するための補正値を算出し、その算出した補正値の分だけワークWの加工指令(NCプログラム)を補正する。このキャリブレーションによる補正後の加工指令は、記憶部28に保存される。   In the machine tool according to the present embodiment, when processing the workpiece W, calibration is first performed as shown in FIG. 3 (step S1). This calibration is performed using a reference jig 102 as shown in FIG. Specifically, the reference jig 102 has a base portion 102a installed on the table 3b of the machine tool, a leg portion 102b extending from the base portion 102a, and a sphere 102c provided at the tip of the leg portion 102b. . This calibration is performed by attaching the measurement probe 34 to the spindle device 16 and detecting the coordinates of a plurality of locations on the outer surface of the sphere 102 c with the measurement probe 34. Specifically, by driving the work driving device 3 and the tool driving device 4, the sensor portion 34b of the measurement probe 34 is brought into contact with a plurality of locations on the outer surface of the sphere 102c as indicated by arrows in FIG. Thereby, the coordinate acquisition part 36 acquires the coordinate of each location which the sensor part 34b contacted among the spherical bodies 102c. Then, the calculation unit 26 calculates a deviation between the coordinates acquired by the coordinate acquisition unit 36 and the original coordinates that the sensor unit 34b should contact with the sphere 102c, and calculates a correction value for correcting the deviation. Then, the machining command (NC program) of the workpiece W is corrected by the calculated correction value. The processing command after correction by this calibration is stored in the storage unit 28.

次に、基準バー104の計測及びその計測結果に基づくスケーリング倍率mの算出が行われる(ステップS2)。基準バー104としては、図5に示すような形状で捩れや歪み等の変形がなく、ワークWと同じ材質からなり、常温での長さが既知のものを用いる。この基準バー104の常温での長さのデータは、記憶部28に保存されている。そして、この基準バー104の測定では、まず、基準バー104をテーブル3b上にY軸方向に延びるようにセットする。その後、工具駆動装置4によって測定プローブ34が移動させられ、計測装置24により基準バー104の両端の座標がそれぞれ計測される。そして、演算部26が、計測装置24によって計測された基準バー104の両端の座標から基準バー104の実際の長さを算出し、その算出した実際の長さを記憶部28に保存された基準バー104の常温での長さによって除することにより基準バー104の常温での長さに対する前記実際の長さの倍率を算出する。この倍率がスケーリング倍率mとなる。この算出されたスケーリング倍率mのデータは、記憶部28に保存される。   Next, measurement of the reference bar 104 and calculation of the scaling factor m based on the measurement result are performed (step S2). As the reference bar 104, a bar having the shape shown in FIG. 5, which is not deformed such as twisting or distortion, is made of the same material as the workpiece W, and has a known length at room temperature. Data on the length of the reference bar 104 at normal temperature is stored in the storage unit 28. In the measurement of the reference bar 104, first, the reference bar 104 is set on the table 3b so as to extend in the Y-axis direction. Thereafter, the measurement probe 34 is moved by the tool driving device 4, and the coordinates of both ends of the reference bar 104 are respectively measured by the measuring device 24. Then, the calculation unit 26 calculates the actual length of the reference bar 104 from the coordinates of both ends of the reference bar 104 measured by the measuring device 24, and the calculated actual length is stored in the storage unit 28. By dividing by the length of the bar 104 at room temperature, the magnification of the actual length with respect to the length of the reference bar 104 at room temperature is calculated. This magnification is the scaling magnification m. The data of the calculated scaling factor m is stored in the storage unit 28.

次に、ワークWがテーブル3b上にセットされ、ワークW上の各基準点100aの実際の座標の計測が行われる(ステップS3)。基準点100aの実際の座標の計測時には、ワーク駆動装置3により測定プローブ34が図7に示す矢印i方向から基準球100に対して相対的に接近させられてセンサ部34bが基準球100に接触し、その接触した部位の座標が座標取得部36によって取得される。次に、ワーク駆動装置3及び工具駆動装置4により、前記矢印i方向と反対の矢印ii方向から基準球100に対して測定プローブ34が接近させられてセンサ部34bが基準球100に接触し、その接触した部位の座標が座標取得部36によって取得される。そして、これらX軸方向において取得された2つの部位の座標の間の中心の座標が、座標算出部38によって算出される。この算出された座標は、座標記憶部40に記憶される。   Next, the workpiece W is set on the table 3b, and the actual coordinates of each reference point 100a on the workpiece W are measured (step S3). When measuring the actual coordinates of the reference point 100a, the work probe 3 brings the measurement probe 34 closer to the reference sphere 100 from the direction of the arrow i shown in FIG. The coordinates of the contacted part are acquired by the coordinate acquisition unit 36. Next, the work probe 3 and the tool driver 4 bring the measurement probe 34 closer to the reference sphere 100 from the direction of the arrow ii opposite to the direction of the arrow i, and the sensor unit 34b contacts the reference sphere 100. The coordinates of the contacted part are acquired by the coordinate acquisition unit 36. The coordinate calculation unit 38 calculates the center coordinates between the coordinates of the two parts acquired in the X-axis direction. The calculated coordinates are stored in the coordinate storage unit 40.

その後、ワーク駆動装置3及び工具駆動装置4により、座標算出部38によって算出された前記i方向における基準球100に対するセンサ部34bの接触部位と前記ii方向における基準球100に対するセンサ部34bの接触部位との中点の座標を通るとともにY軸方向に延びる直線上において、基準球100の一方側に測定プローブ34のセンサ部34bが配置され、そのセンサ部34bが図7中の矢印iii方向から基準球100に接触させられてその接触した部位の座標が座標取得部36によって取得される。次に、工具駆動装置4により、前記矢印iii方向と反対の矢印iv方向から基準球100に対して測定プローブ34が接触させられてその接触した部位の座標が座標取得部36によって取得される。そして、これらY軸方向において取得された2つの部位の座標の間の中心の座標が、座標算出部38によって算出される。このようにして、Y軸方向における基準球100の中心の座標が求められる。この算出された基準球100のY軸方向の中心の座標は、座標記憶部40に記憶される。   Thereafter, the contact part of the sensor unit 34b with respect to the reference sphere 100 in the i direction and the contact part of the sensor unit 34b with respect to the reference sphere 100 in the ii direction calculated by the coordinate calculation unit 38 by the work driving device 3 and the tool driving device 4. The sensor part 34b of the measurement probe 34 is disposed on one side of the reference sphere 100 on a straight line passing through the coordinates of the middle point and extending in the Y-axis direction, and the sensor part 34b is referenced from the direction of arrow iii in FIG. The coordinate acquisition unit 36 acquires the coordinates of the contacted part of the sphere 100. Next, the tool driving device 4 brings the measurement probe 34 into contact with the reference sphere 100 from the direction of the arrow iv opposite to the direction of the arrow iii, and the coordinates of the contacted part are acquired by the coordinate acquisition unit 36. Then, the coordinate calculation unit 38 calculates the coordinates of the center between the coordinates of the two parts acquired in the Y-axis direction. In this way, the coordinates of the center of the reference sphere 100 in the Y-axis direction are obtained. The calculated coordinates of the center of the reference sphere 100 in the Y-axis direction are stored in the coordinate storage unit 40.

次に、ワーク駆動装置3及び工具駆動装置4により、座標算出部38によって算出された基準球100のY軸方向の中心の座標を通るとともにX軸方向に延びる直線上において、基準球100の一方側に測定プローブ34のセンサ部34bが配置され、そのセンサ部34bが矢印v方向から基準球100に接触させられてその接触した部位の座標が座標取得部36によって取得される。その後、工具駆動装置4により、前記矢印v方向と反対の矢印vi方向から基準球100に対して測定プローブ34が接近させられてセンサ部34bが基準球100に接触し、その接触した部位の座標が座標取得部36によって取得される。そして、これらX軸方向において取得された2つの部位の座標の間の中心の座標が、座標算出部38によって算出される。このようにして、基準球100のX軸方向の中心の座標が求められる。この算出された基準球100のX軸方向の中心の座標は、座標記憶部40に記憶される。   Next, one of the reference spheres 100 on a straight line that passes through the coordinates of the center in the Y-axis direction of the reference sphere 100 calculated by the coordinate calculation unit 38 and extends in the X-axis direction by the work driving device 3 and the tool driving device 4. The sensor part 34b of the measurement probe 34 is arranged on the side, the sensor part 34b is brought into contact with the reference sphere 100 from the direction of the arrow v, and the coordinates of the contacted part are acquired by the coordinate acquisition part 36. Thereafter, the tool driving device 4 causes the measurement probe 34 to approach the reference sphere 100 from the direction of the arrow vi opposite to the direction of the arrow v so that the sensor unit 34b contacts the reference sphere 100, and the coordinates of the contacted part. Is acquired by the coordinate acquisition unit 36. The coordinate calculation unit 38 calculates the center coordinates between the coordinates of the two parts acquired in the X-axis direction. In this way, the coordinates of the center of the reference sphere 100 in the X-axis direction are obtained. The calculated coordinates of the center of the reference sphere 100 in the X-axis direction are stored in the coordinate storage unit 40.

次に、ワーク駆動装置3及び工具駆動装置4により、上記のようにして求められた基準球100のX軸方向及びY軸方向の中心の座標を通るとともにZ軸方向に延びる直線上において、測定プローブ34のセンサ部34bが基準球100の上側に配置され、そのZ軸方向においてセンサ部34bが基準球100に上側から接触させられ、その接触した部位の座標が座標取得部36によって取得される。そして、その座標取得部36によって取得されたZ軸方向におけるセンサ部34bの接触部位の座標と記憶部28に保存された基準球100の半径のデータとから、座標算出部38が、基準球100のZ軸方向の中心の座標を算出する。この算出された基準球100のZ軸方向の中心の座標は、座標記憶部40に記憶される。   Next, the workpiece driving device 3 and the tool driving device 4 are measured on a straight line that passes through the coordinates of the center in the X-axis direction and the Y-axis direction of the reference sphere 100 obtained as described above and extends in the Z-axis direction. The sensor unit 34b of the probe 34 is arranged on the upper side of the reference sphere 100, the sensor unit 34b is brought into contact with the reference sphere 100 from the upper side in the Z-axis direction, and the coordinates of the contacted part are acquired by the coordinate acquisition unit 36. . Then, from the coordinates of the contact part of the sensor unit 34b in the Z-axis direction acquired by the coordinate acquisition unit 36 and the radius data of the reference sphere 100 stored in the storage unit 28, the coordinate calculation unit 38 generates a reference sphere 100. The coordinates of the center in the Z-axis direction are calculated. The calculated coordinates of the center of the reference sphere 100 in the Z-axis direction are stored in the coordinate storage unit 40.

以上のようにして、X,Y,Z軸方向における基準球100の中心点(基準点100a)の実際の座標(計測座標)が求められる。なお、座標算出部38によって求められた基準球100の中心点の計測座標は、座標記憶部40に加えて記憶部28にも記憶される。そして、このような基準点の実際の座標の計測は、全ての基準点100a(基準球100)についてそれぞれ行われ、計測された全ての基準点100aの計測座標のデータが記憶部28に保存される。   As described above, the actual coordinates (measurement coordinates) of the center point (reference point 100a) of the reference sphere 100 in the X, Y, and Z axis directions are obtained. Note that the measurement coordinates of the center point of the reference sphere 100 obtained by the coordinate calculation unit 38 are stored in the storage unit 28 in addition to the coordinate storage unit 40. Then, the actual coordinates of the reference points are measured for all the reference points 100a (reference spheres 100), and the measured coordinate data of all the reference points 100a are stored in the storage unit 28. The

次に、補正マトリクス導出装置20の演算部26による補正マトリクスの算出が行われる(ステップS4)。   Next, the correction matrix is calculated by the calculation unit 26 of the correction matrix deriving device 20 (step S4).

この補正マトリクスの算出は、図8及び図9に示すフローチャートに基づいて行われる。具体的には、まず、演算部26が初期値計算を行う(図8のステップS11)。   The calculation of the correction matrix is performed based on the flowcharts shown in FIGS. Specifically, first, the calculation unit 26 performs initial value calculation (step S11 in FIG. 8).

この初期値計算では、演算部26は、補正マトリクスを算出可能な最小の個数の基準点100aの組合せを選択する。本実施形態では、基準点100aが全部でn個あり、このn個の基準点100aの中から補正マトリクスを算出可能な最小の個数の基準点100aとして例えば3個の基準点100aが選択される。そして、演算部26は、その選択した基準点100a(以下、選択基準点という)の基準座標を対応する計測座標に近づくように変換するためのマトリクスを構成する初期値t0[j]を求める。この初期値t0[j]には、前記選択基準点の基準座標を対応する計測座標に近づくように変換するためのオイラー角及び平行移動ベクトルと、前記ステップS2において求められたスケーリング倍率mとが含まれる。具体的には、初期値t0[j]には、前記平行移動ベクトルとしての(t0[0],t0[1],t0[2])と、前記オイラー角としての(t0[3],t0[4],t0[5])と、前記スケーリング倍率mとしてのt0[6]とが含まれる。   In this initial value calculation, the calculation unit 26 selects a combination of the minimum number of reference points 100a for which a correction matrix can be calculated. In the present embodiment, there are a total of n reference points 100a, and, for example, three reference points 100a are selected from the n reference points 100a as the minimum number of reference points 100a for which a correction matrix can be calculated. . Then, the calculation unit 26 obtains an initial value t0 [j] that forms a matrix for converting the reference coordinates of the selected reference point 100a (hereinafter referred to as a selection reference point) so as to approach the corresponding measurement coordinates. The initial value t0 [j] includes an Euler angle and a translation vector for converting the reference coordinates of the selected reference point so as to approach the corresponding measurement coordinates, and the scaling factor m obtained in step S2. included. Specifically, the initial value t0 [j] includes (t0 [0], t0 [1], t0 [2]) as the translation vector and (t0 [3], t0 as the Euler angles). [4], t0 [5]) and t0 [6] as the scaling magnification m.

そして、初期値t0[j]に含まれるオイラー角及び平行移動ベクトルは、例えば、選択基準点の基準座標によって平面が構成される場合には、その基準座標によって構成される平面が選択基準点の計測座標によって構成される平面に重なるように前記基準座標を変換するために必要なオイラー角及び平行移動ベクトルであって、各選択基準点の基準座標を変換した後の座標のうち少なくとも1つの座標がその選択基準点の計測座標に一致するようなオイラー角及び平行移動ベクトルである。   The Euler angle and the translation vector included in the initial value t0 [j] are, for example, when a plane is constituted by the reference coordinates of the selection reference point, the plane constituted by the reference coordinates is that of the selection reference point. Euler angles and translation vectors necessary for converting the reference coordinates so as to overlap a plane constituted by measurement coordinates, and at least one of the coordinates after conversion of the reference coordinates of each selected reference point Is an Euler angle and a translation vector that coincide with the measurement coordinates of the selected reference point.

次に、演算部26は、各基準点100aの基準座標を補正変換するための仮補正マトリクスを算出する第1補正マトリクス算出演算を行う(ステップS13)。この際、演算部26は、各基準点100aの基準座標を当該補正マトリクスによって補正変換した後の座標と対応する計測座標との間の距離の二乗の値を全ての基準点100aの分足し合わせた値が極小となるような仮補正マトリクスを最小二乗法によって算出する。   Next, the calculation unit 26 performs a first correction matrix calculation calculation for calculating a temporary correction matrix for correcting and converting the reference coordinates of each reference point 100a (step S13). At this time, the calculation unit 26 adds the square value of the distance between the coordinate after the reference coordinate of each reference point 100a is corrected and converted by the correction matrix and the corresponding measurement coordinate to all the reference points 100a. A temporary correction matrix that minimizes the calculated value is calculated by the method of least squares.

具体的には、まず、基準点100aの計測座標をPi=(Xi,Yi,Zi)、基準点100aの基準座標をpi=(xi,yi,zi)、計測座標Piと基準座標piとの間の距離をLi、計測座標Piと基準座標piとの間の距離Liの二乗の値をFiとする。ここで、i=0,1,2,・・・,n−1である。   Specifically, first, the measurement coordinates of the reference point 100a are Pi = (Xi, Yi, Zi), the reference coordinates of the reference point 100a are pi = (xi, yi, zi), and the measurement coordinates Pi and the reference coordinates pi Let Li be the distance between them, and let Fi be the square value of the distance Li between the measurement coordinates Pi and the reference coordinates pi. Here, i = 0, 1, 2,..., N−1.

演算部26は、前記Fiを全ての基準点100aの分足し合わせた値F=Σ(Fi)を最小とする解t[j]を次の非線形連立方程式(1)を満たす解として求める。この解t[j]が仮補正マトリクスを構成する要素となる。   The calculation unit 26 obtains a solution t [j] that minimizes the value F = Σ (Fi) obtained by adding Fi to all the reference points 100a as a solution that satisfies the following nonlinear simultaneous equation (1). This solution t [j] is an element constituting the temporary correction matrix.

∂F/∂t[j]=0・・・(1)   ∂F / ∂t [j] = 0 (1)

上記非線形連立方程式(1)は、解析的には解けないため、演算部26は、この方程式(1)を漸近法を使用して解く。この際、最初に用いる解t[j]として、前記初期値計算で求めた初期値t0[j]を用いる。演算部26は、各基準点の基準座標pi=(xi,yi,zi)を初期値t0[j]で構成されるマトリクスによってそれぞれ補正変換する。この補正変換後の座標(x,y,z)は、以下の式(2)〜(4)で求められる。   Since the nonlinear simultaneous equation (1) cannot be solved analytically, the calculation unit 26 solves the equation (1) using an asymptotic method. At this time, the initial value t0 [j] obtained by the initial value calculation is used as the solution t [j] to be used first. The calculation unit 26 corrects and converts the reference coordinates pi = (xi, yi, zi) of each reference point using a matrix composed of initial values t0 [j]. The coordinates (x, y, z) after this correction conversion are obtained by the following equations (2) to (4).

x=m×[{cos(a)・cos(c)−sin(a)・cos(b)・sin(c)}×xi−{cos(a)・sin(c)+sin(a)・cos(b)・cos(c)}×yi+{sin(a)・sin(b)}×zi+u]・・・(2)
y=m×[{sin(a)・cos(c)+cos(a)・cos(b)・sin(c)}×xi+{−sin(a)・sin(c)+cos(a)・cos(b)・cos(c)}×yi+{−cos(a)・sin(b)}×zi+v]・・・(3)
z=m×{sin(b)・sin(c)×xi+sin(b)・cos(c)・yi+cos(b)×zi+w}・・・(4)
x = m * [{cos (a) * cos (c) -sin (a) * cos (b) * sin (c)} * xi- {cos (a) * sin (c) + sin (a) * cos (B) · cos (c)} × yi + {sin (a) · sin (b)} × zi + u] (2)
y = m × [{sin (a) · cos (c) + cos (a) · cos (b) · sin (c)} × xi + {− sin (a) · sin (c) + cos (a) · cos ( b) · cos (c)} × yi + {− cos (a) · sin (b)} × zi + v] (3)
z = m * {sin (b) * sin (c) * xi + sin (b) * cos (c) * yi + cos (b) * zi + w} (4)

ここで、u=t0[0],v=t0[1],w=t0[2],a=t0[3],b=t0[4],c=t0[5],m=t0[6]である。   Here, u = t0 [0], v = t0 [1], w = t0 [2], a = t0 [3], b = t0 [4], c = t0 [5], m = t0 [6 ].

そして、演算部26は、以下の式(5)により、各基準点100aについて補正変換後の座標(x,y,z)と対応する計測座標Pi=(Xi,Yi,Zi)との間の距離の二乗の値Eをそれぞれ算出する。   And the calculating part 26 is between the measurement coordinate Pi = (Xi, Yi, Zi) corresponding to the coordinate (x, y, z) after correction | amendment conversion about each reference point 100a by the following formula | equation (5). A distance squared value E is calculated.

E=(x−Xi)+(y−Yi)+(z−Zi)・・・(5) E = (x−Xi) 2 + (y−Yi) 2 + (z−Zi) 2 (5)

さらに、演算部26は、以下の式(6)に示すように、上記式(5)で求めた距離の二乗の値Eを全ての基準点100a(i=0〜n−1までの基準点100a)の分足し合わせた値Fを算出する。   Further, as shown in the following equation (6), the calculation unit 26 calculates the square value E of the distance obtained by the above equation (5) to all the reference points 100a (i = 0 to n−1). A value F obtained by adding 100a) is calculated.

F=ΣE・・・(6)   F = ΣE (6)

そして、演算部26は、以下の式(7)で表されるdF[j]を求める。   And the calculating part 26 calculates | requires dF [j] represented by the following formula | equation (7).

dF[j]=Σ(∂E/∂t[j])=Σ(dE[j])・・・(7)   dF [j] = Σ (∂E / ∂t [j]) = Σ (dE [j]) (7)

なお、j=0,1,2,3,4,5であり、ここでは、t[j]として前記初期値t0[1]〜t0[5]が用いられる。すなわち、演算部26は、前記Eを前記初期値t0[1]〜t0[5]でそれぞれ偏微分した値を全て足し合わせた値dF[j]を求める。   Note that j = 0, 1, 2, 3, 4, and 5, and here, the initial values t0 [1] to t0 [5] are used as t [j]. That is, the calculation unit 26 obtains a value dF [j] obtained by adding all values obtained by partial differentiation of E with respect to the initial values t0 [1] to t0 [5].

そして、dE[j]は、以下の式(8)で表される。   DE [j] is expressed by the following equation (8).

dE[j]=2×{(x−Xi)・dX[j]+(y−Yi)・dY[j]+(z−Zi)・dZ[j]}・・・(8)   dE [j] = 2 × {(x−Xi) · dX [j] + (y−Yi) · dY [j] + (z−Zi) · dZ [j]} (8)

なお、dX[j]、dY[j]、dZ[j]は、各基準点100aの補正変換後の座標(x,y,z)の各座標値をそれぞれt[j](ここでは、前記初期値t0[1]〜t0[5])で偏微分した値である。すなわち、dX[j]=∂x/∂t[j]であり、dY[j]=∂y/∂t[j]であり、dZ[j]=∂z/∂t[j]である。   Note that dX [j], dY [j], and dZ [j] are the coordinate values of the coordinates (x, y, z) after correction conversion of each reference point 100a, respectively, t [j] It is a value obtained by partial differentiation with an initial value t0 [1] to t0 [5]). That is, dX [j] = ∂x / ∂t [j], dY [j] = ∂y / ∂t [j], and dZ [j] = ∂z / ∂t [j].

そして、演算部26は、以下の式(9)で表されるaa[j][k]を求める。   And the calculating part 26 calculates | requires aa [j] [k] represented by the following formula | equation (9).

aa[j][k]=Σ(∂(∂E/∂t[j])/∂t[k])=Σ(dEE[j][k])・・・(9)   aa [j] [k] = Σ (∂ (∂E / ∂t [j]) / ∂t [k]) = Σ (dEE [j] [k]) (9)

なお、k=0,1,2,3,4,5であり、ここでは、t[k]として前記初期値t0[1]〜t0[5]が用いられる。すなわち、演算部26は、上記式(9)により、前記dF[j]を前記初期値t0[1]〜t0[5]でそれぞれ偏微分した値を全て足し合わせた値aa[j][k]を求める。   Note that k = 0, 1, 2, 3, 4, and 5, and here, the initial values t0 [1] to t0 [5] are used as t [k]. That is, the calculation unit 26 adds the values aa [j] [k] obtained by adding all the partial differential values of the dF [j] with the initial values t0 [1] to t0 [5] according to the above equation (9). ].

ここで、dEE[j][k]は、以下の式(10)で表される。   Here, dEE [j] [k] is expressed by the following formula (10).

dEE[j][k]=2×G×{dX[k]・dX[j]+(x−Xi)・dXX[j][k]+dY[k]×dY[j]+(y−Yi)・dYY[j][k]+dZ[k]・dZ[j]+(z−Zi)・dZZ[j][k]}・・・(10)   dEE [j] [k] = 2 × G × {dX [k] · dX [j] + (x−Xi) · dXX [j] [k] + dY [k] × dY [j] + (y−Yi DYY [j] [k] + dZ [k] dZ [j] + (z−Zi) dZZ [j] [k]} (10)

なお、dXX[j][k]は、dX[j]をt[k]で偏微分した値であり、dYY[j][k]は、dY[j]をt[k]で偏微分した値であり、dZZ[j][k]は、dZ[j]をt[k]で偏微分した値である。なお、ここでは、t[k]として前記初期値t0[1]〜t0[5]が用いられる。   DXX [j] [k] is a value obtained by partial differentiation of dX [j] by t [k], and dYY [j] [k] is obtained by partial differentiation of dY [j] by t [k]. DZZ [j] [k] is a value obtained by partial differentiation of dZ [j] with respect to t [k]. Here, the initial values t0 [1] to t0 [5] are used as t [k].

そして、演算部26は、∂F/∂t[j]=0を漸近展開した以下の線形連立方程式(11)を解いて、漸近解t[j]、すなわち、t[0]〜t[5]を求める。   Then, the calculation unit 26 solves the following linear simultaneous equations (11) asymptotically expanded ∂F / ∂t [j] = 0 to obtain an asymptotic solution t [j], that is, t [0] to t [5]. ].

aa[j][0]×t[0]+aa[j][1]×t[1]+・・・+aa[j][5]×t[5]=s[j]+dF[j]・・・(11)   aa [j] [0] × t [0] + aa [j] [1] × t [1] +... + aa [j] [5] × t [5] = s [j] + dF [j] · (11)

なお、s[j]は、偏微分によって生じる定数部分の合計である。   Note that s [j] is the total of constant parts generated by partial differentiation.

この線形連立方程式(11)を解く際には、前記式(7)で求めたdF[j]及び前記式(9)で求めたaa[j][k]を用いる。   When solving the linear simultaneous equations (11), dF [j] obtained by the equation (7) and aa [j] [k] obtained by the equation (9) are used.

演算部26は、このような前記式(2)〜(11)に係る漸近解t[j]を求めるための演算を、得られた漸近解t[j]が収束するか、又は、演算回数が予め設定された特定の設定回数に達するまで行う。演算部26は、演算を繰り返し行う場合には、1つの回の前記式(2)〜(11)に係る演算によって得られた漸近解t[j]を次回の演算で初期値として用いて同様の演算を繰り返し行う。   The calculation unit 26 performs the calculation for obtaining the asymptotic solution t [j] according to the equations (2) to (11), or the obtained asymptotic solution t [j] converges or the number of calculations Is performed until a predetermined number of preset times is reached. When the calculation unit 26 repeatedly performs the calculation, the asymptotic solution t [j] obtained by one calculation related to the equations (2) to (11) is used as an initial value in the next calculation. Repeat the above operation.

そして、演算部26は、前記漸近解t[j]が収束したか否かについての判断を行う(ステップS15)。この際、演算部26は、dF[0]+dF[1]+・・・+dF[5]の値が設定値を下回ることを前記漸近解t[j]の収束条件とする。具体的には、演算部26は、dF[0]+dF[1]+・・・+dF[5]の値が設定値を下回った場合には、前記漸近解t[j]が収束したと判断し、dF[0]+dF[1]+・・・+dF[5]の値が設定値以上である場合には、前記漸近解t[j]が収束していないと判断する。   Then, the calculation unit 26 determines whether or not the asymptotic solution t [j] has converged (step S15). At this time, the calculation unit 26 sets the convergence condition of the asymptotic solution t [j] that the value of dF [0] + dF [1] +... + DF [5] is lower than the set value. Specifically, the arithmetic unit 26 determines that the asymptotic solution t [j] has converged when the value of dF [0] + dF [1] +... + DF [5] falls below the set value. If the value of dF [0] + dF [1] +... + DF [5] is greater than or equal to the set value, it is determined that the asymptotic solution t [j] has not converged.

そして、演算部26は、前記漸近解t[j]が収束していないと判断した場合には、初期値計算において選択すべき選択基準点の組み合わせが他にないか否かを判断する(ステップS17)。ここで、演算部26は、初期値計算において選択すべき選択基準点の組み合わせが他にはないと判断した場合には、エラー表示を図略のディスプレイに出力する。一方、演算部26は、初期値計算において選択すべき選択基準点の組合せが他にもあると判断した場合には、新たな選択基準点を選択して前記ステップS11以降の処理を再度行う。   If the calculation unit 26 determines that the asymptotic solution t [j] has not converged, the calculation unit 26 determines whether there are any other combinations of selection reference points to be selected in the initial value calculation (step). S17). Here, when the calculation unit 26 determines that there are no other combinations of selection reference points to be selected in the initial value calculation, it outputs an error display to a display (not shown). On the other hand, when the calculation unit 26 determines that there are other combinations of selection reference points to be selected in the initial value calculation, the calculation unit 26 selects a new selection reference point and performs the processing from step S11 again.

また、前記ステップS15の判断において、演算部26は、前記漸近解t[j]が収束したと判断した場合には、その収束した漸近解t[j]によって構成されるマトリクスを仮補正マトリクスとして記憶部28に保存させる(ステップS19)。   Further, in the determination of step S15, when the calculation unit 26 determines that the asymptotic solution t [j] has converged, a matrix constituted by the converged asymptotic solution t [j] is used as a temporary correction matrix. The data is stored in the storage unit 28 (step S19).

そして、演算部26は、その仮補正マトリクスを用いて各基準点100aの基準座標の補正変換(第1補正変換)を行う(ステップS21)。   And the calculating part 26 performs correction | amendment conversion (1st correction | amendment conversion) of the reference | standard coordinate of each reference | standard point 100a using the temporary correction matrix (step S21).

その後、演算部26は、前記ステップS21で仮補正マトリクスにより補正変換した後の各基準点100aの座標と対応する計測座標との間の距離である補正後離間距離の算出と、その各基準点100aの補正後離間距離の平均値である補正後離間距離平均値の算出とを行う(ステップS22)。   Thereafter, the calculation unit 26 calculates a post-correction separation distance that is a distance between the coordinates of each reference point 100a after the correction conversion using the temporary correction matrix in step S21 and the corresponding measurement coordinates, and each of the reference points. Calculation of the average distance after correction, which is the average value of the distance after correction 100a, is performed (step S22).

次に、演算部26は、重み係数付与計算の回数N1,N2の初期設定と、重み係数Gの初期設定(第1重み係数設定)とを行う(ステップS23)。ここで、重み係数Gは、後述する第2補正マトリクス算出演算において各基準点100aの補正変換した後の座標と対応する計測座標との間の距離の二乗の値をどの程度の重みをもって反映させるかを表す値であり、全ての基準点100aに対して個別に重み係数Gがそれぞれ用意される。そして、ここでは、演算部26は、各基準点100aについての重み係数Gを等しい値(1.0)に初期設定する。なお、この重み係数Gの初期設定値は、1よりも大きい任意の値に設定変更することも可能である。また、後述の第2補正マトリクス算出演算を繰り返し行う場合には、その演算毎に対応して選出される最大離間基準点の重み係数Gが再設定されるが、前記重み係数付与計算の回数N1,N2は、その重み係数Gの設定回数に相当する。ここでは、演算部26は、重み係数付与計算回数N1,N2を共に1に初期設定する。なお、N1は、重み係数Gの全ての設定回数に相当し、N2は、後述の第2補正マトリクス算出演算において漸近解t[j]が収束しない場合に重み係数Gを再設定する際の重み係数Gの設定回数に相当する。   Next, the computing unit 26 performs initial setting of the number of weighting coefficient assignment calculations N1 and N2, and initial setting of the weighting coefficient G (first weighting coefficient setting) (step S23). Here, the weighting factor G reflects the value of the square of the distance between the coordinate after the correction conversion of each reference point 100a and the corresponding measurement coordinate in the second correction matrix calculation calculation described later with what weight. A weighting factor G is individually prepared for each of the reference points 100a. Here, the calculation unit 26 initially sets the weighting coefficient G for each reference point 100a to an equal value (1.0). Note that the initial setting value of the weighting factor G can be changed to an arbitrary value larger than 1. Further, when the second correction matrix calculation calculation described later is repeatedly performed, the weight coefficient G of the maximum separation reference point selected corresponding to each calculation is reset, but the number N1 of weight coefficient addition calculations is set. , N2 corresponds to the number of times the weighting coefficient G is set. Here, the calculation unit 26 initially sets the weighting coefficient addition calculation times N1 and N2 to 1. N1 corresponds to the total number of times the weighting factor G is set, and N2 is a weight for resetting the weighting factor G when the asymptotic solution t [j] does not converge in the second correction matrix calculation calculation described later. This corresponds to the number of times the coefficient G is set.

次に、演算部26は、各基準点100aのうち前記ステップS21で基準座標を仮補正マトリクスにより補正変換した後の座標と対応する計測座標との間の距離が最も大きい基準点である第1最大離間基準点の選出(第1選出)を行う(ステップS25)。   Next, the computing unit 26 is the first reference point having the largest distance between the coordinates after the reference coordinates are corrected and converted by the temporary correction matrix in step S21 and the corresponding measurement coordinates among the reference points 100a. The maximum separation reference point is selected (first selection) (step S25).

次に、演算部26は、選出した第1最大離間基準点の重み係数Gを予め設定された所定の増加分g1だけ増加した値に再設定(第1重み係数再設定)する(ステップS26)。なお、重み係数Gの増加分g1は、予め任意の値に設定可能であり、記憶部28に保存されている。   Next, the computing unit 26 resets the weight coefficient G of the selected first maximum separation reference point to a value increased by a predetermined increase g1 set in advance (first weight coefficient reset) (step S26). . The increment g1 of the weighting factor G can be set to an arbitrary value in advance and is stored in the storage unit 28.

次に、演算部26は、各基準点100aの基準座標を補正変換するための補正マトリクスを算出する第2補正マトリクス算出演算を行う(図9のステップS27)。この際、演算部26は、各基準点100aの基準座標を当該補正マトリクスによって補正変換した後の座標と対応する計測座標との間の距離の二乗の値にその各基準点100aについてそれぞれ設定されている重み係数Gを掛けた値を全ての基準点100aの分足し合わせた値が極小となるような補正マトリクスを最小二乗法によって算出する。   Next, the calculation unit 26 performs a second correction matrix calculation calculation for calculating a correction matrix for correcting and converting the reference coordinates of each reference point 100a (step S27 in FIG. 9). At this time, the calculation unit 26 sets each reference point 100a to a square value of the distance between the coordinate after the reference coordinate of each reference point 100a is corrected and converted by the correction matrix and the corresponding measurement coordinate. A correction matrix is calculated by the method of least squares so that a value obtained by multiplying the weighted coefficient G by the sum of all the reference points 100a is minimized.

具体的には、演算部26は、第2補正マトリクス算出演算において基本的に前記第1補正マトリクス算出演算と同様の演算を行う。ただし、この1回目の第2補正マトリクス算出演算では、非線形連立方程式∂F/∂t[j]=0を漸近法を使用して解く際に最初に用いる解として、前記初期値t0[j]の代わりに前記仮補正マトリクスを構成する前記漸近解t[j]を用いる。   Specifically, the calculation unit 26 performs basically the same calculation as the first correction matrix calculation calculation in the second correction matrix calculation calculation. However, in the first calculation of the second correction matrix, the initial value t0 [j] is used as the first solution when the nonlinear simultaneous equation ∂F / ∂t [j] = 0 is solved using the asymptotic method. Is used instead of the asymptotic solution t [j] constituting the provisional correction matrix.

そして、演算部26は、この第2補正マトリクス算出演算では、上記式(5)の代わりに次式(13)を用いて各基準点100aについてのEの値を算出する。   Then, in this second correction matrix calculation calculation, the calculation unit 26 calculates the value of E for each reference point 100a using the following equation (13) instead of the above equation (5).

E=G×{(x−Xi)+(y−Yi)+(z−Zi)}・・・(13) E = G × {(x−Xi) 2 + (y−Yi) 2 + (z−Zi) 2 } (13)

ここで、第1最大離間基準点については、前記ステップS26において重み係数Gが増加されているので、他の基準点に比べて第1最大離間基準点についてのEの値が大きくなる。演算部26は、この第2補正マトリクス算出演算において上記以外は第1補正マトリクス算出演算と同様にして補正マトリクスを構成する漸近解t[j]を求める。従って、当該第2補正マトリクス算出演算では、第1最大離間基準点の補正後離間距離の二乗の値が他の基準点の補正後離間距離の二乗の値に比べて大きく反映された補正マトリクスが求められる。   Here, for the first maximum separation reference point, since the weighting coefficient G is increased in step S26, the value of E for the first maximum separation reference point is larger than the other reference points. The calculation unit 26 obtains an asymptotic solution t [j] constituting the correction matrix in the second correction matrix calculation calculation in the same manner as the first correction matrix calculation calculation except for the above. Accordingly, in the second correction matrix calculation calculation, a correction matrix in which the square value of the post-correction separation distance of the first maximum separation reference point is largely reflected as compared to the square value of the post-correction separation distance of the other reference points. Desired.

次に、演算部26は、前記第2補正マトリクス算出演算で求めた漸近解t[j]が収束したか否かを判断する(ステップS29)。この際、演算部26は、前記ステップS15と同様にして収束判断を行う。   Next, the calculation unit 26 determines whether or not the asymptotic solution t [j] obtained by the second correction matrix calculation calculation has converged (step S29). At this time, the calculation unit 26 performs convergence determination in the same manner as in step S15.

そして、演算部26は、第2補正マトリクス算出演算で求めた漸近解t[j]が収束していないと判断した場合には、その後、重み係数付与計算回数N2が予め設定された最大値を超えるか否かを判断する(ステップS31)。なお、この重み係数付与計算回数N2の最大値は、予め任意の回数に設定可能であり、記憶部28に保存される。   Then, when the calculation unit 26 determines that the asymptotic solution t [j] obtained in the second correction matrix calculation calculation has not converged, the weighting coefficient addition calculation number N2 is set to a preset maximum value. It is determined whether or not it exceeds (step S31). Note that the maximum value of the weighting coefficient addition calculation number N2 can be set to an arbitrary number in advance and is stored in the storage unit 28.

そして、演算部26は、重み係数付与計算回数N2が予め設定された最大値を超えたと判断した場合には、その時点で記憶部28に保存されていた補正マトリクスのデータを最終の算出結果とする(ステップS33)。一方、演算部26は、重み係数付与計算回数N2が予め設定された最大値を超えていないと判断した場合には、その後、重み係数付与計算回数N1,N2のインクリメントと前記第1最大離間基準点の重み係数Gの再設定(ステップS35)を行った後、次回の第2補正マトリクス算出演算(ステップS27)とその第2補正マトリクス算出演算で算出される漸近解t[j]の収束判断(ステップS29)を再度行う。   When the calculation unit 26 determines that the weighting coefficient addition calculation count N2 exceeds the preset maximum value, the calculation matrix data stored in the storage unit 28 at that time is used as the final calculation result. (Step S33). On the other hand, when the calculation unit 26 determines that the weighting coefficient application calculation number N2 does not exceed the preset maximum value, the calculation unit 26 thereafter increments the weighting coefficient application calculation number N1 and N2 and the first maximum separation criterion. After resetting the point weighting factor G (step S35), the convergence judgment of the asymptotic solution t [j] calculated by the next second correction matrix calculation calculation (step S27) and the second correction matrix calculation calculation is performed. (Step S29) is performed again.

なお、前記ステップS35における重み係数付与計算回数N1,N2のインクリメントでは、演算部26は、重み係数付与計算回数N1及びN2をそれぞれ1だけ増加させる。また、前記ステップS35では、演算部26は、第1最大離間基準点の重み係数Gを増加分g1だけ増加させる。そして、次回の第2補正マトリクス算出演算では、演算部26は、第1最大離間基準点について前記ステップS35で再設定した重み係数Gを付与して漸近解t[j](補正マトリクス)の算出を行う。   In addition, in the increment of the weight coefficient addition calculation times N1 and N2 in step S35, the calculation unit 26 increases the weight coefficient addition calculation times N1 and N2 by 1, respectively. In step S35, the calculation unit 26 increases the weighting coefficient G of the first maximum separation reference point by the increment g1. In the next second correction matrix calculation calculation, the calculation unit 26 calculates the asymptotic solution t [j] (correction matrix) by applying the weighting coefficient G reset in step S35 for the first maximum separation reference point. I do.

そして、演算部26は、第2補正マトリクス算出演算で求めた漸近解t[j]が収束したと前記ステップS29において判断した場合には、その漸近解t[j]で構成される補正マトリクスを用いて各基準点100aの基準座標の補正変換(第2補正変換)を行う(ステップS37)。   If the calculation unit 26 determines in step S29 that the asymptotic solution t [j] obtained by the second correction matrix calculation calculation has converged, the calculation unit 26 determines a correction matrix composed of the asymptotic solution t [j]. Then, correction conversion (second correction conversion) of the reference coordinates of each reference point 100a is performed (step S37).

その後、演算部26は、前記ステップS37で補正マトリクスにより補正変換した後の各基準点100aの座標と対応する計測座標との間の距離である補正後離間距離の算出と、その各基準点100aの補正後離間距離の平均値である補正後離間距離平均値の算出とを行う(ステップS38)。   Thereafter, the calculation unit 26 calculates a post-correction separation distance that is a distance between the coordinates of each reference point 100a after the correction conversion by the correction matrix in step S37 and the corresponding measurement coordinate, and each reference point 100a. The corrected post-correction distance average value, which is the average value of the post-correction separation distances, is calculated (step S38).

次に、演算部26は、各基準点100aのうち前記ステップS37で基準座標を補正マトリクスにより補正変換した後の座標と対応する計測座標との間の距離(補正後離間距離)が最も大きい基準点である第2最大離間基準点の選出(第2選出)を行う(ステップS39)。   Next, the calculation unit 26 has the largest distance (post-correction separation distance) between the coordinates after the reference coordinates are corrected and converted by the correction matrix in step S37 among the reference points 100a and the corresponding measurement coordinates. The second maximum separation reference point that is a point is selected (second selection) (step S39).

その後、演算部26は、重み係数付与計算回数N1が予め設定された最大値を超えるか否かを判断する(ステップS40)。なお、この重み係数付与計算回数N1の最大値は、予め任意の回数に設定可能であり、記憶部28に保存される。   Thereafter, the calculation unit 26 determines whether or not the weighting coefficient addition calculation count N1 exceeds a preset maximum value (step S40). It should be noted that the maximum value of the weighting coefficient addition calculation number N1 can be set to an arbitrary number in advance and is stored in the storage unit 28.

そして、演算部26は、重み係数付与計算の回数N1が予め設定された最大値を超えたと判断した場合には、次に、今回の第2補正変換後に前記ステップS39で選出した第2最大離間基準点についての補正後離間距離が前回の補正変換後に選出した最大離間基準点についての補正後離間距離よりも小さいという条件が満たされたか否かを判断する(ステップS41)。なお、1回目の第2補正マトリクス算出演算後における当該ステップS41の判断では、前回の補正変換後に選出した最大離間基準点についての補正後離間距離として、前記第1最大離間基準点の基準座標を仮補正マトリクスで補正変換した座標と対応する計測座標との間の補正後離間距離を用いる。   If the calculation unit 26 determines that the number N1 of weighting coefficient addition calculations exceeds a preset maximum value, the calculation unit 26 next selects the second maximum separation selected in step S39 after the current second correction conversion. It is determined whether or not a condition that the corrected separation distance for the reference point is smaller than the corrected separation distance for the maximum separation reference point selected after the previous correction conversion is satisfied (step S41). In the determination of step S41 after the first calculation of the second correction matrix, the reference coordinates of the first maximum separation reference point are used as the separation distance after correction for the maximum separation reference point selected after the previous correction conversion. A post-correction separation distance between the coordinate corrected and converted by the temporary correction matrix and the corresponding measurement coordinate is used.

そして、演算部26は、前記条件が満たされたと判断した場合には、前記ステップS27で算出した漸近解t[j]によって構成されるマトリクスを補正マトリクスとして記憶部28に保存させる(ステップS42)。この際、先に記憶部28に保存されていた補正マトリクス(仮補正マトリクス)のデータがある場合には、そのマトリクスのデータは、新しく保存する補正マトリクスのデータに更新される。その後、演算部26は、記憶部28に保存された補正マトリクスのデータを最終の算出結果とする(ステップS33)。   If the calculation unit 26 determines that the condition is satisfied, the calculation unit 26 stores the matrix formed by the asymptotic solution t [j] calculated in step S27 in the storage unit 28 as a correction matrix (step S42). . At this time, if there is correction matrix (temporary correction matrix) data previously stored in the storage unit 28, the matrix data is updated to the newly stored correction matrix data. Thereafter, the calculation unit 26 sets the correction matrix data stored in the storage unit 28 as the final calculation result (step S33).

一方、演算部26は、前記ステップS41において前記条件が満たされていないと判断した場合には、前記ステップS33の処理を行う。すなわち、その時点で記憶部28に保存されていた補正マトリクスのデータを最終の算出結果とする。   On the other hand, when the calculation unit 26 determines in step S41 that the condition is not satisfied, the calculation unit 26 performs the process of step S33. That is, the correction matrix data stored in the storage unit 28 at that time is used as the final calculation result.

また、演算部26は、前記ステップS40において重み係数付与計算回数N1が予め設定された最大値を超えないと判断した場合には、次に、以下の第1条件と第2条件の両方が満たされているか、又は、以下の第3条件と第4条件の両方が満たされているかについて判断する(ステップS45)。   In addition, when the calculation unit 26 determines in step S40 that the weighting coefficient addition calculation count N1 does not exceed the preset maximum value, next, both the following first condition and second condition are satisfied. It is determined whether or not both of the following third condition and fourth condition are satisfied (step S45).

第1条件は、今回の第2補正マトリクス算出演算に伴って算出した第2最大離間基準点についての補正後離間距離がその1つ前の回の補正マトリクス算出演算に伴って算出した最大離間基準点についての補正後離間距離よりも大きいという条件である。また、第2条件は、今回の第2補正マトリクス算出演算に伴って算出した補正後離間距離平均値(前記ステップS43で算出した補正後離間距離平均値)がその1つ前の回の補正マトリクス算出演算に伴って算出した補正後離間距離平均値よりも大きいという条件である。また、第3条件は、今回の第2補正マトリクス算出演算に伴って算出した第2最大離間基準点についての補正後離間距離がその1つ前の回の補正マトリクス算出演算に伴って算出した最大離間基準点についての補正後離間距離よりも小さいという条件である。また、第4条件は、今回の第2補正マトリクス算出演算に伴って算出した最大離間基準点についての補正後離間距離から今回の第2補正マトリクス算出演算に伴って算出した補正後離間距離平均値を減じた値がその1つ前の回の補正マトリクス算出演算に伴って算出した最大離間基準点についての補正後離間距離から当該1つ前の回の補正マトリクス算出演算に伴って算出した補正後離間距離平均値を減じた値よりも大きいという条件である。   The first condition is that the maximum separation reference that the post-correction separation distance for the second maximum separation reference point calculated with the current second correction matrix calculation calculation is calculated with the previous correction matrix calculation calculation is calculated. This is a condition that the distance is larger than the corrected separation distance for the point. Further, the second condition is that the corrected post-correction distance average value (the corrected post-correction distance average value calculated in step S43) calculated in association with the current second correction matrix calculation calculation is the correction matrix one time before that. This is a condition that it is larger than the corrected post-correction distance average value calculated with the calculation operation. The third condition is that the post-correction separation distance for the second maximum separation reference point calculated with the second correction matrix calculation calculation this time is the maximum calculated with the correction matrix calculation calculation of the previous one. The condition is that the distance is smaller than the corrected separation distance for the separation reference point. Further, the fourth condition is that the corrected post-correction distance average value calculated along with the current second correction matrix calculation operation from the post-correction separation distance for the maximum separation reference point calculated along with the current second correction matrix calculation operation. After correction, the value obtained by subtracting is calculated from the post-correction separation distance for the maximum separation reference point calculated with the previous correction matrix calculation calculation, with the previous correction matrix calculation calculation. This is a condition that it is larger than the value obtained by subtracting the average distance.

なお、1回目の第2補正マトリクス算出演算に伴う当該ステップS45の判断では、1つ前の回の補正変換後に選出した最大離間基準点として、前記ステップS25で選出した第1最大離間基準点を用い、1つ前の回の補正マトリクス算出演算に伴って算出した補正後離間距離及び補正後離間距離平均値として、第1補正マトリクス算出演算に伴って前記ステップS22で算出した補正後離間距離及び補正後離間距離平均値を用いる。   In the determination in step S45 associated with the first calculation of the second correction matrix, the first maximum separation reference point selected in step S25 is used as the maximum separation reference point selected after the previous correction conversion. As the post-correction separation distance and the post-correction separation distance average value calculated with the previous correction matrix calculation calculation, the post-correction separation distance calculated in step S22 with the first correction matrix calculation calculation and The average distance after correction is used.

このステップS45の判断において、演算部26は、前記第1条件と前記第2条件の両方が満たされたか、又は、前記第3条件と前記第4条件の両方が満たされたと判断した場合には、前記ステップS33の処理を行い、それ以外の場合には、前記ステップS42の処理と同様に前記ステップS27で算出した漸近解t[j]によって構成されるマトリクスを補正マトリクスとして記憶部28に保存させる(ステップS47)とともに、重み係数付与計算回数N1のインクリメント及び第2最大離間基準点の重み係数Gの再設定(第2重み係数再設定)を行った(ステップS49)後、次回の第2補正マトリクス算出演算を行う。すなわち、この場合には、演算部26は、ステップS27,S29,S37,S38,S39,S40,S45,S49からなるサイクルを繰り返し行う。   In the determination of step S45, when the calculation unit 26 determines that both the first condition and the second condition are satisfied, or that both the third condition and the fourth condition are satisfied, Then, the process of step S33 is performed. In other cases, the matrix constituted by the asymptotic solution t [j] calculated in step S27 is stored in the storage unit 28 as a correction matrix in the same manner as the process of step S42. (Step S47) and incrementing the weighting coefficient application calculation number N1 and resetting the weighting coefficient G of the second maximum separation reference point (seconding weighting coefficient resetting) (Step S49), Correction matrix calculation calculation is performed. That is, in this case, the calculation unit 26 repeatedly performs a cycle including steps S27, S29, S37, S38, S39, S40, S45, and S49.

なお、前記ステップS49における重み係数付与計算回数N1のインクリメントでは、演算部26は、重み係数付与計算回数N1を1だけ増加させる。また、前記ステップS49では、演算部26は、前記ステップS39で選出した第2最大離間基準点の重み係数Gのみを増加分g1だけ増加させ、他の基準点100aの重み係数Gは増加させない。   Note that in the increment of the weighting coefficient addition calculation number N1 in step S49, the calculation unit 26 increases the weighting coefficient addition calculation number N1 by one. In step S49, the calculation unit 26 increases only the weight coefficient G of the second maximum separation reference point selected in step S39 by the increment g1, and does not increase the weight coefficient G of the other reference points 100a.

そして、演算部26は、次回の第2補正マトリクス算出演算において、前記ステップS27で説明した第2補正マトリクス算出演算を第1最大離間基準点の代わりに前記ステップS39で選出した第2最大離間基準点を用いて再度実行し、その際、前記ステップS39で選出した第2最大離間基準点については前記ステップS49で再設定した重み係数Gを用いて前記Eの値を算出し、その他の基準点100aについては各々の重み係数Gを用いて前記Eの値を算出する。   Then, in the next second correction matrix calculation calculation, the calculation unit 26 selects the second correction matrix calculation calculation described in step S27 instead of the first maximum separation reference point in the second maximum separation reference. The second maximum separation reference point selected in step S39, the value of E is calculated using the weighting factor G reset in step S49, and the other reference points For 100a, the value of E is calculated using each weighting factor G.

また、演算部26は、次回のサイクルの第2補正マトリクス算出演算において、非線形連立方程式∂F/∂t[j]=0を漸近法を使用して解く際に最初に用いる解として、その1つ前のサイクルの第2補正マトリクス算出演算で算出した補正マトリクスを構成する漸近解t[j]を用いる。   In addition, in the second correction matrix calculation calculation in the next cycle, the calculation unit 26 uses the first as a solution used when solving the nonlinear simultaneous equation ∂F / ∂t [j] = 0 using the asymptotic method. The asymptotic solution t [j] constituting the correction matrix calculated by the second correction matrix calculation calculation of the previous cycle is used.

また、演算部26は、次回のサイクルのステップS41の判断では、前回の補正後離間距離として1つ前のサイクルのステップS39で選出した第2最大離間基準点についての補正後離間距離を用いる。   Further, in the determination in step S41 of the next cycle, the calculation unit 26 uses the corrected separation distance for the second maximum separation reference point selected in step S39 of the previous cycle as the previous corrected separation distance.

そして、演算部26が以上のようにして補正マトリクスを算出した後、加工指令補正変換部22がその算出された補正マトリクスを用いて加工指令(NCプログラム)の補正変換を行う(ステップS5)。   Then, after the calculation unit 26 calculates the correction matrix as described above, the machining command correction conversion unit 22 performs correction conversion of the machining command (NC program) using the calculated correction matrix (step S5).

その後、制御装置7が、加工指令補正変換部22によって補正変換された加工指令に従ってワーク駆動装置3にワークWの移動を実行させるとともに工具駆動装置4に工具5の移動を実行させてワークWを加工させる。   Thereafter, the control device 7 causes the workpiece driving device 3 to move the workpiece W according to the machining command corrected and converted by the machining command correction conversion unit 22 and causes the tool driving device 4 to move the tool 5 to move the workpiece W. Let it be processed.

以上説明したように、本実施形態では、演算部26が、最大離間基準点の重み係数Gを所定の増加分g1だけ増加した値に再設定した後、各基準点100aの基準座標の補正変換後の座標と対応する計測座標との間の距離の二乗の値にその各基準点100aについて設定されている重み係数Gを掛けた値を全ての基準点100aの分足し合わせた値が極小となるように各基準点100aの基準座標を補正変換可能な補正マトリクスを最小二乗法によって算出するため、単に各基準点の基準座標と計測座標との間の距離の二乗和が極小となるように各基準点の基準座標を補正変換可能な補正マトリクスを求める場合に比べて、各基準点100aのうち最大離間基準点の基準座標に対する実際の座標の誤差を大きく加味した補正マトリクスを算出することができる。従って、この算出した補正マトリクスによってワークWの加工指令を補正変換することにより、計測座標が基準座標から最大に変位した基準点、すなわち、計測座標が基準座標から著しく変位した基準点の誤差を最小化しつつ、全ての基準点の誤差を全体的に小さくする補正を行うことができる。   As described above, in the present embodiment, the calculation unit 26 resets the weight coefficient G of the maximum separation reference point to a value increased by a predetermined increment g1, and then corrects and converts the reference coordinates of each reference point 100a. A value obtained by multiplying the value of the square of the distance between the later coordinate and the corresponding measurement coordinate by the weighting coefficient G set for each reference point 100a and adding all the reference points 100a is the minimum. Since the correction matrix capable of correcting and converting the reference coordinates of each reference point 100a is calculated by the least square method, the sum of squares of the distances between the reference coordinates of each reference point and the measurement coordinates is simply minimized. Compared with the case where a correction matrix capable of correcting and converting the reference coordinates of each reference point is obtained, a correction matrix is calculated that greatly considers the error of the actual coordinates with respect to the reference coordinates of the maximum separated reference point among the reference points 100a. Rukoto can. Therefore, by correcting and converting the machining command for the workpiece W using the calculated correction matrix, the reference point where the measurement coordinate is displaced to the maximum from the reference coordinate, that is, the error of the reference point where the measurement coordinate is significantly displaced from the reference coordinate is minimized. Thus, it is possible to perform correction to reduce the error of all reference points as a whole.

また、本実施形態では、演算部26が、今回の第2補正マトリクス算出演算に伴って算出した第2最大離間基準点についての補正後離間距離が前回の補正マトリクス算出演算に伴って算出した最大離間基準点についての補正後離間距離よりも大きくなり、かつ、今回の第2補正マトリクス算出演算に伴って算出した補正後離間距離平均値が前回の補正マトリクス算出演算に伴って算出した補正後離間距離平均値よりも大きくなるまで、第2最大離間基準点の選出と、その選出した第2最大離間基準点の補正後離間距離の二乗の値に所定の増加分g1だけ増加させた重み係数Gを掛けて行う第2補正マトリクス算出演算とを行うため、計測座標が基準座標から著しく変位した基準点の誤差を良好に小さくしつつ、全ての基準点の誤差を全体的に良好に小さくする補正を行うことが可能な補正マトリクスを算出することができる。   In the present embodiment, the calculation unit 26 calculates the maximum corrected separation distance for the second maximum separation reference point calculated along with the current second correction matrix calculation calculation as calculated along with the previous correction matrix calculation calculation. The post-correction separation calculated by the previous correction matrix calculation calculation is greater than the post-correction separation distance for the reference separation point, and the corrected post-correction separation average value calculated by the second correction matrix calculation calculation is calculated. The weighting factor G obtained by selecting the second maximum separation reference point and increasing the square value of the corrected separation distance of the selected second maximum separation reference point by a predetermined increment g1 until it becomes larger than the distance average value. In order to perform the second correction matrix calculation calculation performed by multiplying the error, the error of all the reference points is reduced as a whole while the error of the reference point where the measurement coordinates are significantly displaced from the reference coordinates is satisfactorily reduced. It is possible to calculate the correction matrix that can be corrected to reduce the good.

また、本実施形態では、前回の補正マトリクス算出演算に伴って算出された最大離間基準点についての補正後離間距離に比べて今回の第2補正マトリクス算出演算に伴って算出された第2最大離間基準点についての補正後離間距離が減少している場合でも、最大離間基準点についての補正後離間距離に対する補正後離間距離平均値の差が前回の補正マトリクス算出演算の場合に比べて今回の第2補正マトリクス算出演算の場合の方が増加すれば、それ以降の回の第2補正マトリクス算出演算は行われず、前回の補正マトリクス算出演算で算出した補正マトリクスが最終の算出結果となる。すなわち、本実施形態では、計測座標が基準座標から著しく変位した基準点(最大離間基準点)の基準座標に対する誤差を小さくしつつ、そのような最大離間基準点の誤差が全基準点の誤差の平均値に近づくような補正を行うことが可能な補正マトリクスを算出することができる。   Further, in the present embodiment, the second maximum separation calculated with the current second correction matrix calculation calculation compared to the post-correction separation distance for the maximum separation reference point calculated with the previous correction matrix calculation calculation. Even if the post-correction separation distance for the reference point is reduced, the difference between the corrected post-correction distance average value for the maximum separation reference point and the corrected post-correction distance average value is larger than that of the previous correction matrix calculation calculation. If the number of the two correction matrix calculation calculations increases, the second correction matrix calculation calculation for the subsequent rounds is not performed, and the correction matrix calculated in the previous correction matrix calculation calculation becomes the final calculation result. That is, in the present embodiment, the error of the reference point (maximum separation reference point) where the measurement coordinate is significantly displaced from the reference coordinate is reduced, and the error of the maximum separation reference point is the error of all the reference points. It is possible to calculate a correction matrix that can be corrected so as to approach the average value.

また、本実施形態では、温度によるワークWの膨張収縮率を表すスケーリング倍率mの要素を加えた最小二乗法による演算で仮補正マトリクス及び補正マトリクスが算出されるため、ワークWの温度による膨張収縮に起因する誤差を加味した補正マトリクスを得ることができる。このため、その補正マトリクスによってワークWの加工指令を補正変換することにより、ワークWの温度による膨張収縮に起因する誤差を補正することができる。   In the present embodiment, the provisional correction matrix and the correction matrix are calculated by the least square method with an element of the scaling factor m representing the expansion / contraction rate of the workpiece W depending on the temperature. It is possible to obtain a correction matrix that takes into account errors due to the above. For this reason, the error due to the expansion and contraction due to the temperature of the workpiece W can be corrected by correcting and converting the machining command of the workpiece W by the correction matrix.

なお、今回開示された実施形態は、すべての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は、上記した実施形態の説明ではなく特許請求の範囲によって示され、さらに特許請求の範囲と均等の意味及び範囲内でのすべての変更が含まれる。   The embodiment disclosed this time should be considered as illustrative in all points and not restrictive. The scope of the present invention is shown not by the above description of the embodiments but by the scope of claims for patent, and further includes meanings equivalent to the scope of claims for patent and all modifications within the scope.

例えば、本発明による補正マトリクス導出装置及び誤差補正装置は、上記実施形態で示したような工作機械以外の工作機械に適用してもよい。   For example, the correction matrix deriving device and the error correcting device according to the present invention may be applied to a machine tool other than the machine tool as shown in the above embodiment.

また、演算部26、記憶部28及び加工指令補正変換部22は、工作機械に組み込まれていなくてもよい。例えば、これら演算部26、記憶部28及び加工指令補正変換部22は、パーソナルコンピュータ等の外部端末に組み込まれていて、その外部端末で演算処理して補正変換した加工指令のデータを工作機械の制御装置7に出力するようにしてもよい。   Moreover, the calculating part 26, the memory | storage part 28, and the process command correction | amendment conversion part 22 do not need to be integrated in the machine tool. For example, the calculation unit 26, the storage unit 28, and the machining command correction conversion unit 22 are incorporated in an external terminal such as a personal computer, and the machining command data obtained through calculation processing and correction conversion by the external terminal is stored in the machine tool. You may make it output to the control apparatus 7. FIG.

また、前記ステップS45の判断において、第1条件と第2条件の両方を満たすか否かの判断のみを行い、第1条件と第2条件の両方を満たす場合には、ステップS33の処理を行い、それ以外の場合には、ステップS47及びS49を経て次回の第2補正マトリクス算出演算を行うようにしてもよい。   In the determination in step S45, only determination is made as to whether both the first condition and the second condition are satisfied. If both the first condition and the second condition are satisfied, the process in step S33 is performed. In other cases, the next second correction matrix calculation may be performed through steps S47 and S49.

また、スケーリング倍率の導出方法は、上記実施形態で示した方法に限定されない。例えば、工作機械にワークWの温度を検出する検出装置を設置しておくとともに、予め測定した温度とワークWのスケーリング倍率との相関関係を記憶部28に登録しておいて、前記検出装置によって検出されたワークWの温度と前記相関関係とに基づいてその温度のときのワークWのスケーリング倍率を演算部26が求めるようにしてもよい。   Further, the method for deriving the scaling factor is not limited to the method shown in the above embodiment. For example, a detection device that detects the temperature of the workpiece W is installed in the machine tool, and a correlation between the temperature measured in advance and the scaling factor of the workpiece W is registered in the storage unit 28, and the detection device Based on the detected temperature of the workpiece W and the correlation, the calculation unit 26 may obtain the scaling factor of the workpiece W at the temperature.

4 工具駆動装置
5 工具
7 制御装置
20 補正マトリクス導出装置
22 加工指令補正変換部
24 計測装置
26 演算部
W ワーク
4 Tool Driving Device 5 Tool 7 Control Device 20 Correction Matrix Deriving Device 22 Processing Command Correction Conversion Unit 24 Measuring Device 26 Computing Unit W Workpiece

Claims (6)

ワークとそのワークを加工するための工具とのうち少なくとも一方を基準座標軸上の移動ベクトルで表される加工指令に従って移動させることにより前記工具によるワークの加工を実行する駆動装置を備えた工作機械でのワークの実際の加工時に生じる加工位置の誤差を補正するように前記加工指令を変換するための補正マトリクスを導出する補正マトリクス導出装置であって、
前記基準座標軸上における座標がそれぞれ与えられたワーク上の複数の基準点についてそれらの実際の座標をそれぞれ計測する計測装置と、
前記複数の基準点に与えられた座標である基準座標と前記計測装置によって計測された前記複数の基準点の実際の座標である計測座標とに基づいて前記補正マトリクスを算出するための演算を行う演算部とを備え、
前記演算部は、前記各基準点の前記基準座標を補正変換するための仮補正マトリクスであって、前記各基準点の前記基準座標を当該仮補正マトリクスによって補正変換した後の座標と対応する前記計測座標との間の距離の二乗の値を全ての基準点の分足し合わせた値が極小となるような仮補正マトリクスを最小二乗法によって算出する第1補正マトリクス算出演算と、その第1補正マトリクス算出演算によって算出された前記仮補正マトリクスにより前記各基準点の前記基準座標を補正変換する第1補正変換と、前記各基準点について等しい重み係数をそれぞれ設定する第1重み係数設定と、前記各基準点のうち前記基準座標を前記第1補正変換した後の座標と対応する前記計測座標との間の距離が最も大きい基準点である第1最大離間基準点を選出する第1選出と、その選出した前記第1最大離間基準点の前記重み係数を所定の増加分だけ増加した値に再設定する第1重み係数再設定と、その第1重み係数再設定の後、前記各基準点の前記基準座標を補正変換するための補正マトリクスであって、前記各基準点の前記基準座標を当該補正マトリクスによって補正変換した後の座標と対応する前記計測座標との間の距離の二乗の値にその各基準点について設定されている前記重み係数を掛けた値を全ての基準点の分足し合わせた値が極小となるような補正マトリクスを最小二乗法によって算出する第2補正マトリクス算出演算とを行う、補正マトリクス導出装置。
A machine tool including a drive device that performs machining of a workpiece by the tool by moving at least one of the workpiece and a tool for machining the workpiece according to a machining command represented by a movement vector on a reference coordinate axis. A correction matrix deriving device for deriving a correction matrix for converting the machining command so as to correct a machining position error that occurs during actual machining of the workpiece,
A measuring device for measuring the actual coordinates of each of a plurality of reference points on the workpiece given coordinates on the reference coordinate axes,
An operation for calculating the correction matrix is performed based on reference coordinates that are coordinates given to the plurality of reference points and measurement coordinates that are actual coordinates of the plurality of reference points measured by the measurement device. With an arithmetic unit,
The calculation unit is a temporary correction matrix for correcting and converting the reference coordinates of the reference points, and corresponds to the coordinates after the reference coordinates of the reference points are corrected and converted by the temporary correction matrix. A first correction matrix calculation operation for calculating a temporary correction matrix by a least-square method so that a value obtained by adding the squares of the distances to the measurement coordinates to the sum of all the reference points is minimized, and the first correction A first correction conversion for correcting and converting the reference coordinates of the reference points using the temporary correction matrix calculated by a matrix calculation calculation; a first weighting factor setting for setting equal weighting factors for the reference points; The first maximum separation reference that is the reference point having the longest distance between the coordinate after the first correction conversion of the reference coordinate among the reference points and the corresponding measurement coordinate. A first selection of selecting the first weighting factor, a first weighting factor resetting to reset the weighting factor of the selected first maximum separation reference point to a value increased by a predetermined increment, and a resetting of the first weighting factor Thereafter, a correction matrix for correcting and converting the reference coordinates of the reference points, and the measurement coordinates corresponding to the coordinates after the reference coordinates of the reference points are corrected and converted by the correction matrix. A correction matrix is calculated by the method of least squares so that a value obtained by multiplying the value of the square of the distance by the weighting factor set for each reference point and adding all the reference points is minimized. A correction matrix deriving device that performs a second correction matrix calculation calculation.
前記演算部は、前記第2補正マトリクス算出演算によって算出した前記補正マトリクスにより前記各基準点の前記基準座標を補正変換する第2補正変換と、前記各基準点のうち前記基準座標を前記第2補正変換した後の座標と対応する前記計測座標との間の距離が最も大きい基準点である第2最大離間基準点を選出する第2選出と、前記第2補正変換後の前記各基準点の座標と対応する前記計測座標との間の距離である補正後離間距離の算出と、その各基準点についての補正後離間距離の平均値である補正後離間距離平均値の算出と、今回の前記第2補正マトリクス算出演算に伴って算出した前記第2最大離間基準点についての前記補正後離間距離がその1つ前の回の補正マトリクス算出演算に伴って算出した最大離間基準点についての補正後離間距離よりも大きいという第1条件が満たされているかの判断と、今回の前記第2補正マトリクス算出演算に伴って算出した前記補正後離間距離平均値がその1つ前の回の補正マトリクス算出演算に伴って算出した補正後離間距離平均値よりも大きいという第2条件が満たされているかの判断とを行い、前記第1条件と前記第2条件の両方が満たされたと判断した場合には、前記1つ前の回の補正マトリクス算出演算で算出した補正マトリクスを最終の算出結果とし、前記第1条件と前記第2条件のうち少なくとも一方が満たされていないと判断した場合には、前記第2最大離間基準点の前記重み係数を所定の増加分だけ増加した値に再設定する第2重み係数再設定と、その第2重み係数再設定の後、前記各基準点の前記基準座標を補正変換するための補正マトリクスであって、前記各基準点の前記基準座標を当該補正マトリクスによって補正変換した後の座標と対応する前記計測座標との間の距離の二乗の値にその各基準点について設定されている前記重み係数を掛けた値を全ての基準点の分足し合わせた値が極小となるような補正マトリクスを最小二乗法によって算出する次回の第2補正マトリクス算出演算を行う、求項1に記載の補正マトリクス導出装置。   The calculation unit includes: a second correction conversion that corrects and converts the reference coordinates of the reference points by the correction matrix calculated by the second correction matrix calculation calculation; A second selection for selecting a second maximum separation reference point that is the reference point having the largest distance between the coordinate after the correction conversion and the corresponding measurement coordinate; and the reference point of the reference point after the second correction conversion. The calculation of the corrected separation distance that is the distance between the coordinate and the corresponding measurement coordinate, the calculation of the corrected separation distance average value that is the average value of the corrected separation distance for each reference point, and the current Correction for the maximum separation reference point calculated by the correction matrix calculation calculation of the previous time when the post-correction separation distance for the second maximum separation reference point calculated in association with the second correction matrix calculation calculation Determination of whether the first condition that the distance is larger than the separation distance is satisfied, and the correction matrix average calculated after the second correction matrix calculation calculation this time is the previous correction matrix calculation When it is determined whether the second condition that is larger than the corrected post-correction distance average value calculated along with the calculation is satisfied, and it is determined that both the first condition and the second condition are satisfied If the correction matrix calculated in the previous correction matrix calculation operation is the final calculation result, and it is determined that at least one of the first condition and the second condition is not satisfied, A second weighting factor reset for resetting the weighting factor of the second maximum separation reference point to a value increased by a predetermined increment, and after the resetting of the second weighting factor, the reference coordinates of each reference point are correction A correction matrix for converting each reference point to a square value of a distance between the coordinate after correction conversion of the reference coordinate of each reference point by the correction matrix and the corresponding measurement coordinate Performing a second correction matrix calculation operation for the next time to calculate a correction matrix by a least square method so that a value obtained by multiplying the set weighting factor by the sum of all the reference points is minimized. The correction matrix deriving device according to 1. 前記演算部は、前記第2補正マトリクス算出演算によって算出した前記補正マトリクスにより前記各基準点の前記基準座標を補正変換する第2補正変換と、前記各基準点のうち前記基準座標を前記第2補正変換した後の座標と対応する前記計測座標との間の距離が最も大きい基準点である第2最大離間基準点を選出する第2選出と、前記第2補正変換後の前記各基準点の座標と対応する前記計測座標との間の距離である補正後離間距離の算出と、その各基準点についての補正後離間距離の平均値である補正後離間距離平均値の算出と、今回の前記第2補正マトリクス算出演算に伴って算出した前記第2最大離間基準点についての前記補正後離間距離がその1つ前の回の補正マトリクス算出演算に伴って算出した最大離間基準点についての補正後離間距離よりも大きいという第1条件、及び、今回の前記第2補正マトリクス算出演算に伴って算出した前記補正後離間距離平均値がその1つ前の回の補正マトリクス算出演算に伴って算出した補正後離間距離平均値よりも大きいという第2条件が満たされているかの判断と、今回の前記第2補正マトリクス算出演算に伴って算出した前記第2最大離間基準点についての前記補正後離間距離がその1つ前の回の補正マトリクス算出演算に伴って算出した最大離間基準点についての補正後離間距離よりも小さいという第3条件、及び、今回の前記第2補正マトリクス算出演算に伴って算出した前記第2最大離間基準点についての前記補正後離間距離から今回の前記第2補正マトリクス算出演算に伴って算出した前記補正後離間距離平均値を減じた値がその1つ前の回の補正マトリクス算出演算に伴って算出した最大離間基準点についての補正後離間距離から当該1つ前の回の補正マトリクス算出演算に伴って算出した補正後離間距離平均値を減じた値よりも大きいという第4条件が満たされているかの判断とを行い、前記第1条件と前記第2条件の両方が満たされたか、又は、前記第3条件と前記第4条件の両方が満たされたと判断した場合には、前記1つ前の回の補正マトリクス算出演算で算出した補正マトリクスを最終の算出結果とし、それ以外の場合には、前記第2最大離間基準点の前記重み係数を所定の増加分だけ増加した値に再設定する第2重み係数再設定と、その第2重み係数再設定の後、前記各基準点の前記基準座標を補正変換するための補正マトリクスであって、前記各基準点の前記基準座標を当該補正マトリクスによって補正変換した後の座標と対応する前記計測座標との間の距離の二乗の値にその各基準点について設定されている前記重み係数を掛けた値を全ての基準点の分足し合わせた値が極小となるような補正マトリクスを最小二乗法によって算出する次回の第2補正マトリクス算出演算を行う、請求項1に記載の補正マトリクス導出装置。   The calculation unit includes: a second correction conversion that corrects and converts the reference coordinates of the reference points by the correction matrix calculated by the second correction matrix calculation calculation; A second selection for selecting a second maximum separation reference point that is the reference point having the largest distance between the coordinate after the correction conversion and the corresponding measurement coordinate; and the reference point of the reference point after the second correction conversion. The calculation of the corrected separation distance that is the distance between the coordinate and the corresponding measurement coordinate, the calculation of the corrected separation distance average value that is the average value of the corrected separation distance for each reference point, and the current Correction for the maximum separation reference point calculated by the correction matrix calculation calculation of the previous time when the post-correction separation distance for the second maximum separation reference point calculated in association with the second correction matrix calculation calculation The first condition that the distance is larger than the separation distance, and the average value of the post-correction separation distance calculated with the second correction matrix calculation calculation this time is calculated with the correction matrix calculation calculation of the previous time. The determination as to whether the second condition of greater than the corrected post-correction distance average value is satisfied, and the post-correction separation distance for the second maximum separation reference point calculated in accordance with the current second correction matrix calculation calculation Is calculated to be smaller than the post-correction separation distance for the maximum separation reference point calculated with the previous correction matrix calculation operation, and with the current second correction matrix calculation operation The average post-correction distance calculated with the second calculation calculation of the second correction matrix is subtracted from the post-correction distance for the second maximum separation reference point. The post-correction separation distance calculated with the previous correction matrix calculation operation from the post-correction separation distance for the maximum separation reference point calculated with the previous correction matrix calculation operation. A determination is made as to whether a fourth condition that is greater than the value obtained by subtracting the average value is satisfied, and both the first condition and the second condition are satisfied, or the third condition and the fourth condition are satisfied. When it is determined that both of the conditions are satisfied, the correction matrix calculated in the previous correction matrix calculation calculation is used as the final calculation result. In other cases, the second maximum separation reference point is used. A second weighting factor resetting to reset the weighting factor to a value increased by a predetermined increment, and a correction for correcting and converting the reference coordinates of each reference point after the second weighting factor resetting Matrix, before The square value of the distance between the coordinate after the reference coordinate of each reference point is corrected and converted by the correction matrix and the corresponding measurement coordinate is multiplied by the weighting factor set for each reference point. The correction matrix deriving device according to claim 1, wherein a second correction matrix calculation operation is performed for calculating a correction matrix such that a value obtained by adding all of the reference points is minimized by a least square method. 前記演算部は、前記第1補正マトリクス算出演算に先立って温度によるワークの膨張収縮率を表すスケーリング倍率の導出を行い、前記第1補正マトリクス算出演算では、前記スケーリング倍率を含む前記仮補正マトリクスで前記各基準点の前記基準座標を補正変換した場合について前記仮補正マトリクスの算出を行い、前記第2補正マトリクス算出演算では、前記スケーリング倍率を含む前記補正マトリクスで前記各基準点の前記基準座標を補正変換した場合について前記補正マトリクスの算出を行う、請求項1〜3のいずれか1項に記載の補正マトリクス導出装置。   Prior to the first correction matrix calculation calculation, the calculation unit derives a scaling factor that represents the expansion / contraction rate of the workpiece due to temperature. In the first correction matrix calculation calculation, the temporary correction matrix including the scaling factor is used. The temporary correction matrix is calculated when the reference coordinates of each reference point are corrected and converted. In the second correction matrix calculation calculation, the reference coordinates of each reference point are calculated using the correction matrix including the scaling factor. The correction matrix deriving device according to claim 1, wherein the correction matrix is calculated when correction conversion is performed. ワークとそのワークを加工するための工具とのうち少なくとも一方を基準座標軸上の移動ベクトルで表される加工指令に従って移動させることにより前記工具によるワークの加工を実行する駆動装置を備えた工作機械に設けられ、ワークの実際の加工時に生じる加工位置の誤差を補正するための誤差補正装置であって、
請求項1〜4のいずれか1項に記載の補正マトリクス導出装置と、
その補正マトリクス導出装置によって導出された前記補正マトリクスを用いて前記加工指令を補正変換する加工指令補正変換部とを備えた、誤差補正装置。
A machine tool including a driving device that performs machining of a workpiece by the tool by moving at least one of the workpiece and a tool for machining the workpiece according to a machining command represented by a movement vector on a reference coordinate axis An error correction device for correcting an error of a processing position that is provided and is generated during actual processing of a workpiece,
The correction matrix deriving device according to any one of claims 1 to 4,
An error correction apparatus comprising: a processing command correction conversion unit that corrects and converts the processing command using the correction matrix derived by the correction matrix deriving device.
ワークを加工するための工作機械であって、
ワークとそのワークを加工するための工具とのうち少なくとも一方を基準座標軸上の移動ベクトルで表される加工指令に従って移動させることにより前記工具によるワークの加工を実行する駆動装置と、
請求項5に記載の誤差補正装置と、
その誤差補正装置によって補正変換された加工指令に従って前記駆動装置にワークと前記工具のうち少なくとも一方の移動を実行させてワークを加工させる制御装置とを備えた、工作機械。
A machine tool for machining a workpiece,
A drive device that performs machining of the workpiece by the tool by moving at least one of the workpiece and a tool for machining the workpiece according to a machining command represented by a movement vector on a reference coordinate axis;
An error correction device according to claim 5;
A machine tool, comprising: a control device that causes the drive device to move at least one of the workpiece and the tool in accordance with a machining command corrected and converted by the error correction device to machine the workpiece.
JP2010180601A 2010-08-11 2010-08-11 Correction matrix derivation device, error correction device, and machine tool Pending JP2012035399A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2010180601A JP2012035399A (en) 2010-08-11 2010-08-11 Correction matrix derivation device, error correction device, and machine tool

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2010180601A JP2012035399A (en) 2010-08-11 2010-08-11 Correction matrix derivation device, error correction device, and machine tool

Publications (1)

Publication Number Publication Date
JP2012035399A true JP2012035399A (en) 2012-02-23

Family

ID=45847960

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2010180601A Pending JP2012035399A (en) 2010-08-11 2010-08-11 Correction matrix derivation device, error correction device, and machine tool

Country Status (1)

Country Link
JP (1) JP2012035399A (en)

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2013187106A1 (en) * 2012-06-14 2013-12-19 村田機械株式会社 Machine tool and method for correcting thermal deformation thereof
CN103576605A (en) * 2012-07-27 2014-02-12 兄弟工业株式会社 Numerical control device and pitch error calculating method
JP2014128867A (en) * 2012-11-30 2014-07-10 Mitsubishi Heavy Ind Ltd Machine tool
WO2017085768A1 (en) * 2015-11-16 2017-05-26 株式会社牧野フライス製作所 Tool path generating method
CN112051798A (en) * 2020-08-17 2020-12-08 扬州大学 Computable reconfigurable machine tool geometric pose error definition method
CN112835324A (en) * 2019-11-22 2021-05-25 Smc 株式会社 Trajectory control device
CN113008271A (en) * 2019-08-15 2021-06-22 深圳市瑞立视多媒体科技有限公司 Mathematical model construction method for calibrating 3D rotation difference, calibration method and device thereof
CN113804148A (en) * 2021-08-04 2021-12-17 吉林建筑科技学院 Measuring adjustment method based on dynamic reference
CN114918737A (en) * 2022-04-20 2022-08-19 鸿富锦精密电子(成都)有限公司 Coordinate system correction method, industrial equipment and storage medium
JP7337664B2 (en) 2019-11-06 2023-09-04 オークマ株式会社 Correction value measurement method and correction value measurement system for position measurement sensor in machine tool
CN113804148B (en) * 2021-08-04 2024-04-19 吉林建筑科技学院 Dynamic reference-based measurement adjustment method

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05212652A (en) * 1992-02-05 1993-08-24 Toyoda Mach Works Ltd Precision machine mounted with on-machine measuring instrument
JPH1022190A (en) * 1996-06-28 1998-01-23 Nikon Corp Method for correcting alignment error in aligner and aligner using it

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05212652A (en) * 1992-02-05 1993-08-24 Toyoda Mach Works Ltd Precision machine mounted with on-machine measuring instrument
JPH1022190A (en) * 1996-06-28 1998-01-23 Nikon Corp Method for correcting alignment error in aligner and aligner using it

Cited By (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2013187106A1 (en) * 2012-06-14 2013-12-19 村田機械株式会社 Machine tool and method for correcting thermal deformation thereof
JP5846400B2 (en) * 2012-06-14 2016-01-20 村田機械株式会社 Machine tool and its thermal deformation correction method
JPWO2013187106A1 (en) * 2012-06-14 2016-02-04 村田機械株式会社 Machine tool and its thermal deformation correction method
CN103576605A (en) * 2012-07-27 2014-02-12 兄弟工业株式会社 Numerical control device and pitch error calculating method
CN103576605B (en) * 2012-07-27 2016-06-01 兄弟工业株式会社 Numerical Control device and pitch error calculation method
JP2014128867A (en) * 2012-11-30 2014-07-10 Mitsubishi Heavy Ind Ltd Machine tool
WO2017085768A1 (en) * 2015-11-16 2017-05-26 株式会社牧野フライス製作所 Tool path generating method
JPWO2017085768A1 (en) * 2015-11-16 2018-06-07 株式会社牧野フライス製作所 Tool path generation method
CN113008271A (en) * 2019-08-15 2021-06-22 深圳市瑞立视多媒体科技有限公司 Mathematical model construction method for calibrating 3D rotation difference, calibration method and device thereof
JP7337664B2 (en) 2019-11-06 2023-09-04 オークマ株式会社 Correction value measurement method and correction value measurement system for position measurement sensor in machine tool
EP3825071A1 (en) * 2019-11-22 2021-05-26 SMC Corporation Trajectory control device
JP2021082170A (en) * 2019-11-22 2021-05-27 Smc株式会社 Trajectory control device
CN112835324A (en) * 2019-11-22 2021-05-25 Smc 株式会社 Trajectory control device
US11376734B2 (en) 2019-11-22 2022-07-05 Smc Corporation Trajectory control device
JP7120512B2 (en) 2019-11-22 2022-08-17 Smc株式会社 Trajectory control device
CN112835324B (en) * 2019-11-22 2024-03-29 Smc株式会社 Track control device
CN112051798B (en) * 2020-08-17 2021-07-20 扬州大学 Computable reconfigurable machine tool geometric pose error definition method
CN112051798A (en) * 2020-08-17 2020-12-08 扬州大学 Computable reconfigurable machine tool geometric pose error definition method
CN113804148A (en) * 2021-08-04 2021-12-17 吉林建筑科技学院 Measuring adjustment method based on dynamic reference
CN113804148B (en) * 2021-08-04 2024-04-19 吉林建筑科技学院 Dynamic reference-based measurement adjustment method
CN114918737A (en) * 2022-04-20 2022-08-19 鸿富锦精密电子(成都)有限公司 Coordinate system correction method, industrial equipment and storage medium

Similar Documents

Publication Publication Date Title
JP2012035399A (en) Correction matrix derivation device, error correction device, and machine tool
US10401829B2 (en) Machine learning device for machine tool and thermal displacement compensation device
RU2559611C2 (en) Error correction device for cnc machines
US9085082B2 (en) Calibration method and calibration system for robot
JP5418272B2 (en) Thermal displacement correction method and thermal displacement correction apparatus for machine tool
KR101158772B1 (en) Numerically controlled machine tool and numerically control device
JP5383760B2 (en) Robot with workpiece mass measurement function
US10596706B2 (en) Mechanism-parameter-calibration method for robotic arm system
CN101947789B (en) Method and device for operating a manipulator
Rauf et al. Experimental results on kinematic calibration of parallel manipulators using a partial pose measurement device
JP2006318419A (en) Calibration method of parallel mechanism machine
JP6466661B2 (en) Robot teaching point conversion method, apparatus, and robot cell
TW201736069A (en) Mechanism parametric calibration method for robotic arm system
JP6542629B2 (en) Positioning device and method for machining tool
KR20080088165A (en) Robot calibration method
JP2012053033A (en) Industrial machine
JP5962371B2 (en) Robot system and sensor inspection apparatus and method
JP5486416B2 (en) Industrial machinery
US8761936B2 (en) Teaching line correcting apparatus, teaching line correcting method, and program thereof
US6823604B2 (en) Method for adjusting assembly jig
KR20210125459A (en) Calibration device and calibration method
JP5787646B2 (en) Robot system and component manufacturing method
CN109397259B (en) Method for determining an absolute position of a robot device and robot device
JP6011089B2 (en) Robot system and robot control apparatus and method
CN112902898B (en) Three-dimensional measuring device and applicable mechanical arm correction method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20130710

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20140326

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20140401

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20140722