JP5460371B2 - Numerical controller - Google Patents

Numerical controller Download PDF

Info

Publication number
JP5460371B2
JP5460371B2 JP2010033692A JP2010033692A JP5460371B2 JP 5460371 B2 JP5460371 B2 JP 5460371B2 JP 2010033692 A JP2010033692 A JP 2010033692A JP 2010033692 A JP2010033692 A JP 2010033692A JP 5460371 B2 JP5460371 B2 JP 5460371B2
Authority
JP
Japan
Prior art keywords
error correction
correction amount
position command
response
command
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2010033692A
Other languages
Japanese (ja)
Other versions
JP2011170609A (en
Inventor
弘太朗 長岡
智典 佐藤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Priority to JP2010033692A priority Critical patent/JP5460371B2/en
Publication of JP2011170609A publication Critical patent/JP2011170609A/en
Application granted granted Critical
Publication of JP5460371B2 publication Critical patent/JP5460371B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Numerical Control (AREA)

Description

本発明は、工作機械等の被制御装置を数値制御する数値制御装置に関し、特に被制御装置が備えるテーブルや主軸ヘッド等の機械位置を移動させるための位置指令に対して機械誤差の補正を行う数値制御装置に関する。   The present invention relates to a numerical control device that numerically controls a controlled device such as a machine tool, and in particular, corrects a mechanical error with respect to a position command for moving a machine position of a table, a spindle head, or the like included in the controlled device. The present invention relates to a numerical control device.

工作機械に存在する機械的な誤差(真直度誤差や直角度誤差等)を補正するために、あらかじめ測定した機械誤差の量にもとづいて補正量を決定し、その補正量を指令値に加算することにより機械的な誤差の補正を行っていた(例えば特許文献1参照)。この補正はピッチエラー補正あるいはピッチ誤差補正と呼ばれている。   In order to correct mechanical errors (straightness error, squareness error, etc.) existing in the machine tool, the correction amount is determined based on the amount of machine error measured in advance, and the correction amount is added to the command value. Thus, the mechanical error is corrected (see, for example, Patent Document 1). This correction is called pitch error correction or pitch error correction.

特開2009−104317号公報JP 2009-104317 A 特開2000−172341号公報JP 2000-172341 A

位置決め時の機械誤差を補正する場合には補正量を指令値に加算する上記した従来の技術で補正を行うことが可能である。しかしながら、軌跡制御を行う場合、すなわち時々刻々の位置が変化するような指令を与え、その指令された位置の軌跡に実際の機械位置の軌跡が追従するように制御を行う場合、サーボ系の応答遅れの影響により、補正量を加算する位置と実際に補正量が加算される位置がずれてしまい、本来補正したいタイミングと異なったタイミングで補正量が加算され、補正した結果の軌跡が指令された軌跡と一致しなくなるという問題があった。この現象は、指令速度が大きい場合や、サーボ系の応答遅れが大きい場合に特に顕著となる。   When correcting the mechanical error at the time of positioning, the correction can be performed by the above-described conventional technique in which the correction amount is added to the command value. However, when trajectory control is performed, that is, when a command that changes the position from moment to moment is given and control is performed so that the trajectory of the actual machine position follows the trajectory of the commanded position, the response of the servo system Due to the effect of the delay, the position where the correction amount is added deviates from the position where the correction amount is actually added, and the correction amount is added at a timing different from the timing at which correction is originally desired, and the locus of the corrected result is commanded. There was a problem that it did not match the trajectory. This phenomenon is particularly noticeable when the command speed is large or when the response delay of the servo system is large.

また、機械誤差が周期的である場合、すなわち機械誤差が一定間隔で正の値と負の値をくりかえすような場合は、位置指令に加算する補正量も周期的な量となるが、サーボ系の応答遅れが大きい場合、実際に作用する補正量の位相が元々の補正量の位相とずれてしまい、この位相差が180度(degree)付近になった場合には、補正を行うことによりかえって機械誤差を増大させてしまうという問題があった。   If the machine error is periodic, that is, if the machine error repeats a positive value and a negative value at regular intervals, the correction amount added to the position command is also a periodic amount. When the response delay is large, the phase of the correction amount that actually acts shifts from the phase of the original correction amount. When this phase difference is around 180 degrees (degree), the correction is performed. There was a problem of increasing the mechanical error.

本発明は、上記に鑑みてなされたものであって、機械誤差補正後の軌跡と指令された軌跡とのずれを低減した数値制御を実行する数値制御装置を得ることを目的とする。   The present invention has been made in view of the above, and an object of the present invention is to obtain a numerical control device that executes numerical control in which a deviation between a trajectory after mechanical error correction and a commanded trajectory is reduced.

上述した課題を解決し、目的を達成するために、本発明は、同一の対象物を互いに直交する方向に移動せしめる複数の軸であって機械に存在する複数の軸を制御する軸制御系を軸ごとに有し、それぞれの軸制御系において、位置検出器による機械位置の検出値である検出器位置と、外部から入力される位置指令と、前記検出器位置と前記機械位置との誤差を補正する外部から入力される、前記複数の軸のうちの自軸制御系が制御する軸と異なる軸にかかる指令位置に応じた誤差補正量と、を用いて、前記位置指令に前記機械位置が追従するようにモータ駆動することにより前記対象物の軌跡制御を行う数値制御装置であって、それぞれの軸制御系は、前記位置指令から前記検出器位置までの応答よりも前記誤差補正量から前記検出器位置までの応答が速くなるように前記位置指令および前記誤差補正量に対して演算を実行する演算処理実行部と、前記演算処理実行部による演算後の位置指令および誤差補正量を合算して補正後位置指令を出力する加算器と、前記検出器位置が前記補正後位置指令に追従するように前記モータを動作させるサーボ制御部と、を備えることを特徴とする。 In order to solve the above-described problems and achieve the object, the present invention provides an axis control system that controls a plurality of axes that move a same object in directions orthogonal to each other and exist in a machine. has for each axis, in each of the axis control system, the detector position is a detected value of the machine position by the position detector, a position command inputted from the outside, the error between the machine position and the detector position An error correction amount corresponding to a command position applied to an axis different from the axis controlled by the own axis control system of the plurality of axes input from the outside to be corrected, and the machine position is included in the position command. a numerical controller for performing trajectory control of the object by driving the motor so as to follow, each of the axis control system, from the error correction than the response from the position command to said detector location Up to the detector position. A calculation processing execution unit that performs calculation on the position command and the error correction amount so that the response of the position is corrected, and the position command and error correction amount after calculation by the calculation processing execution unit are added together to obtain a corrected position. An adder that outputs a command, and a servo control unit that operates the motor so that the detector position follows the corrected position command.

本発明によれば、機械誤差補正後の軌跡と指令された軌跡とのずれを低減した数値制御を実行する数値制御装置を得ることができるという効果を奏する。   According to the present invention, there is an effect that it is possible to obtain a numerical control device that executes numerical control in which a deviation between a trajectory after mechanical error correction and a commanded trajectory is reduced.

図1は、本発明の実施の形態1の数値制御装置の構成を示すブロック図である。FIG. 1 is a block diagram showing the configuration of the numerical control apparatus according to Embodiment 1 of the present invention. 図2は、軸数が2軸の場合の数値制御装置の構成を示すブロック図である。FIG. 2 is a block diagram showing the configuration of the numerical controller when the number of axes is two. 図3は、機械誤差について説明する図である。FIG. 3 is a diagram for explaining the mechanical error. 図4は、サーボ系の応答遅れがある場合の従来の数値制御装置による制御を説明する図である。FIG. 4 is a diagram for explaining the control by the conventional numerical control apparatus when there is a response delay of the servo system. 図5は、本発明の実施の形態1の数値制御装置による制御を説明する図である。FIG. 5 is a diagram for explaining control by the numerical controller according to Embodiment 1 of the present invention. 図6は、本発明の実施の形態2の数値制御装置の構成を示すブロック図である。FIG. 6 is a block diagram showing the configuration of the numerical control apparatus according to the second embodiment of the present invention. 図7は、本発明の実施の形態3の数値制御装置の構成を示すブロック図である。FIG. 7 is a block diagram showing the configuration of the numerical control apparatus according to the third embodiment of the present invention. 図8は、本発明の実施の形態4の数値制御装置の構成を示すブロック図である。FIG. 8 is a block diagram showing the configuration of the numerical control apparatus according to the fourth embodiment of the present invention.

以下に、本発明にかかる数値制御装置の実施の形態を図面に基づいて詳細に説明する。なお、この実施の形態によりこの発明が限定されるものではない。   Embodiments of a numerical controller according to the present invention will be described below in detail with reference to the drawings. Note that the present invention is not limited to the embodiments.

実施の形態1.
図1は本発明の実施の形態1の数値制御装置の構成を示すブロック図である。図示するように、数値制御装置30は、モータ5およびモータ5により駆動される負荷6を備える機械10に接続されている。モータ5には機械位置を検出する位置検出器7が取り付けられている。なお、位置検出器7が検出した機械位置を検出器位置ということとする。
Embodiment 1 FIG.
FIG. 1 is a block diagram showing the configuration of the numerical control apparatus according to Embodiment 1 of the present invention. As illustrated, the numerical control device 30 is connected to a machine 10 including a motor 5 and a load 6 driven by the motor 5. A position detector 7 for detecting the machine position is attached to the motor 5. The machine position detected by the position detector 7 is referred to as a detector position.

数値制御装置30には、位置指令が入力される。また、数値制御装置30は、機械10が備える位置検出器7が検出した検出器位置が入力される。数値制御装置30は、検出器位置が位置指令により指令された位置に追従するように、モータ5を駆動するモータ駆動トルクを生成する。   A position command is input to the numerical controller 30. The numerical control device 30 receives the detector position detected by the position detector 7 included in the machine 10. The numerical control device 30 generates a motor driving torque for driving the motor 5 so that the detector position follows the position commanded by the position command.

数値制御装置30は軸制御系9を有している。軸制御系9は、前記した位置指令と誤差補正量とが入力され、位置検出器7によって検出された検出器位置が入力された位置指令に追従するようにモータ駆動トルクを生成し、生成したモータ駆動トルクをモータ5に与える。誤差補正量は、検出器位置と実際の機械の位置(機械位置)の間の誤差(機械誤差)を補正するためのものである。誤差補正量に関する詳細な説明は後述する。   The numerical control device 30 has an axis control system 9. The axis control system 9 receives the position command and the error correction amount, and generates a motor drive torque so that the detector position detected by the position detector 7 follows the input position command. Motor drive torque is applied to the motor 5. The error correction amount is for correcting an error (machine error) between the detector position and the actual machine position (machine position). Detailed description regarding the error correction amount will be described later.

軸制御系9は、モデル位置指令演算部1と、モデル誤差補正量演算部2と、加算器3と、サーボ制御部4と、を備えている。モデル位置指令演算部1は、入力された位置指令に基づいてモデル位置指令を算出する。また、モデル誤差補正量演算部2は、入力された誤差補正量に基づいてモデル誤差補正量を算出する。モデル位置指令演算部1およびモデル誤差補正量演算部2の応答特性については後述する。   The axis control system 9 includes a model position command calculation unit 1, a model error correction amount calculation unit 2, an adder 3, and a servo control unit 4. The model position command calculation unit 1 calculates a model position command based on the input position command. Further, the model error correction amount calculation unit 2 calculates a model error correction amount based on the input error correction amount. Response characteristics of the model position command calculation unit 1 and the model error correction amount calculation unit 2 will be described later.

加算器3は、モデル位置指令演算部1が算出したモデル位置指令とモデル誤差補正量演算部2が算出したモデル誤差補正量とを加算し、加算結果(補正後モデル位置指令)をサーボ制御部4へ出力する。サーボ制御部4は、入力された補正後モデル位置指令と検出器位置とが一致するようにモータ駆動トルクを生成する。   The adder 3 adds the model position command calculated by the model position command calculation unit 1 and the model error correction amount calculated by the model error correction amount calculation unit 2, and adds the addition result (corrected model position command) to the servo control unit. Output to 4. The servo control unit 4 generates a motor driving torque so that the input corrected model position command and the detector position coincide.

機械10に複数の軸が存在する場合、複数の軸の夫々に対応して数値制御装置30にも複数の軸制御系を設置することができる。図2は軸数が2軸の場合の数値制御装置30の構成を示すブロック図である。機械10は第1軸モータ15と第1軸モータ15の負荷としての第1軸負荷16と第1軸位置検出器17とからなる1軸目と、第2軸モータ25と第2軸モータ25の負荷としての第2軸負荷26と第2軸位置検出器27とからなる2軸目と、を備えている。それぞれの負荷16、26は、ボールねじとボールねじによって駆動されるテーブルから構成される。第1軸と第2軸の移動方向は直交するように配置されており、第1軸によって機械位置のX座標を、第2軸によって機械位置のY座標を制御するものとする。一方、数値制御装置30は第1軸制御系19と第2軸制御系29を持つ。これらの軸制御系19、29の構成は、それぞれ図1における軸制御系9と同一の構成となっている。軸制御系19は、第1軸位置指令と第1軸誤差補正量とが入力され、第1軸位置検出器17から第1軸検出器位置が入力され、第1軸モータ15に供給する第1軸モータ駆動トルクを生成する。また、軸制御系29は、第2軸位置指令と第2軸誤差補正量とが入力され、第2軸位置検出器27から第2軸検出器位置が入力され、第2軸モータ25に供給する第2軸モータ駆動トルクを生成する。   When there are a plurality of axes in the machine 10, a plurality of axis control systems can be installed in the numerical controller 30 corresponding to each of the plurality of axes. FIG. 2 is a block diagram showing the configuration of the numerical controller 30 when the number of axes is two. The machine 10 includes a first axis composed of a first axis motor 15, a first axis load 16 as a load of the first axis motor 15, and a first axis position detector 17, a second axis motor 25, and a second axis motor 25. And a second axis consisting of a second axis load 26 and a second axis position detector 27. Each of the loads 16 and 26 includes a ball screw and a table driven by the ball screw. The moving directions of the first axis and the second axis are arranged to be orthogonal to each other, and the X coordinate of the machine position is controlled by the first axis, and the Y coordinate of the machine position is controlled by the second axis. On the other hand, the numerical control device 30 has a first axis control system 19 and a second axis control system 29. The configuration of these axis control systems 19 and 29 is the same as that of the axis control system 9 in FIG. The axis control system 19 receives the first axis position command and the first axis error correction amount, receives the first axis detector position from the first axis position detector 17, and supplies it to the first axis motor 15. A single-axis motor driving torque is generated. Further, the axis control system 29 receives the second axis position command and the second axis error correction amount, receives the second axis detector position from the second axis position detector 27, and supplies it to the second axis motor 25. The second shaft motor driving torque is generated.

このようにして機械の位置を制御することができるが、通常、位置検出器7は機械10の中の実際に制御したい位置(機械位置)とは離れた位置に取り付けられている。例えば、図2の1軸目の場合、位置検出器17は、負荷16を構成するテーブルではなく、第1軸モータ15に取り付けられている。このように機械位置と位置検出器17が取り付けられている位置との間に差異があると、数値制御装置30によって検出器位置が位置指令に追従するように制御したとしても機械位置と位置指令との間には誤差(機械誤差)が生じてしまう。機械位置と位置指令との間の差異としては、機械の真直度誤差や直角度誤差、ボールねじのピッチ誤差などがある。機械位置を直接計測してその位置を検出器位置として用いることができれば理想的であるが、機械位置を直接計測するためには特別な計測機器を設置しなければならず、工作機械ではそのような計測機器を取り付けると加工を行うことができなくなるといった問題や、機械の特性が閉ループ制御系の中に入るため、機械共振があると制御系が発振してしまうといった問題があり、現実的ではない。   Although the position of the machine can be controlled in this way, the position detector 7 is usually attached at a position apart from the position (machine position) to be actually controlled in the machine 10. For example, in the case of the first axis in FIG. 2, the position detector 17 is attached to the first axis motor 15 instead of the table constituting the load 16. Thus, if there is a difference between the machine position and the position where the position detector 17 is attached, even if the numerical controller 30 controls the detector position to follow the position command, the machine position and the position command An error (mechanical error) occurs between the two. Differences between the machine position and the position command include machine straightness error, squareness error, ball screw pitch error, and the like. Ideally, it would be ideal if the machine position could be measured directly and used as the detector position, but in order to measure the machine position directly, special measuring equipment would have to be installed. If the measuring instrument is attached, there is a problem that processing cannot be performed, and the mechanical characteristics enter the closed loop control system, so there is a problem that the control system will oscillate if there is mechanical resonance. Absent.

そのため、あらかじめ検出器位置と機械位置の間の関係を計測機器を利用して測定した値に基づいて誤差補正パラメータを設定しておき、機械位置と検出器位置の間の誤差補正するための誤差補正量を位置指令に加算することが行われる。誤差補正パラメータは一般に位置によって変化するため、位置についての関数やテーブルとして与えられる。誤差補正量は、位置指令と誤差補正パラメータによって決定される。このように誤差補正量を加算することにより、検出器位置は位置指令と異なった値となるが、機械位置は位置指令に追従するようになり、機械位置を高い精度で制御することが可能となる。   Therefore, an error correction parameter is set in advance based on a value obtained by measuring the relationship between the detector position and the machine position using a measuring device, and an error for correcting the error between the machine position and the detector position is set. The correction amount is added to the position command. Since the error correction parameter generally changes depending on the position, the error correction parameter is given as a function or a table regarding the position. The error correction amount is determined by the position command and the error correction parameter. By adding the error correction amount in this way, the detector position becomes a value different from the position command, but the machine position follows the position command, and the machine position can be controlled with high accuracy. Become.

検出器位置と機械位置の間の誤差補正パラメータについては、あらかじめ所定の複数の位置に位置決めした場合の機械位置をレーザ測長器や接触式変位計といった機械位置を直接測定できる計測機器を用いて測定し、その結果から各位置における検出器位置と機械位置の差を各位置における誤差補正パラメータとして設定しておく。誤差補正パラメータを位置に関するテーブルとして設定した場合、誤差補正量は現在位置に対応する誤差補正パラメータを当該テーブルから参照して決定される。   For the error correction parameter between the detector position and the machine position, use a measuring instrument that can directly measure the machine position, such as a laser length meter or contact displacement meter, when the machine position is determined in advance at a plurality of predetermined positions. Based on the measurement results, the difference between the detector position and the machine position at each position is set as an error correction parameter at each position. When the error correction parameter is set as a table relating to the position, the error correction amount is determined by referring to the error correction parameter corresponding to the current position from the table.

ところが、軌跡制御を行う間の移動経路内で誤差補正量が時々刻々変化するような場合で、移動速度が速い場合やサーボ系の応答遅れが大きい場合、検出器位置が誤差補正量に追従しなくなる。その結果、実際の機械位置の軌跡が指令された軌跡とずれてしまい、意図したとおりの補正が行えなくなるという問題がある。そこで、本発明の実施の形態1では、実際の機械位置の軌跡を指令された軌跡に近づけるために、位置指令にモデル位置指令演算部1を挿入し、誤差補正量にモデル誤差補正量演算部2を挿入し、かつモデル誤差補正量演算部2の応答特性がモデル位置指令演算部1の応答特性よりも高くなるように設定して、誤差補正量から検出器位置までの応答が位置指令から検出器位置までの応答よりも速くなるようにした。   However, if the error correction amount changes from moment to moment in the movement path during trajectory control, and the movement speed is fast or the response delay of the servo system is large, the detector position follows the error correction amount. Disappear. As a result, there is a problem that the actual locus of the machine position deviates from the commanded locus, and correction as intended cannot be performed. Therefore, in the first embodiment of the present invention, in order to bring the actual machine position trajectory closer to the commanded trajectory, the model position command calculating unit 1 is inserted into the position command, and the model error correction amount calculating unit is added to the error correction amount. 2 and the response characteristic of the model error correction amount calculation unit 2 is set to be higher than the response characteristic of the model position command calculation unit 1, and the response from the error correction amount to the detector position is determined from the position command. The response to the detector position is faster.

応答性の高さや応答の速さは、ゲイン応答の高さに置き換えて考えることができる。すなわち、同一周波数における周波数応答のゲインが高い方が、応答性が高く、応答が速い。したがって、誤差補正量から検出器位置までの周波数応答のゲインが、位置指令から検出器位置までの周波数応答のゲインよりも高くなるように、モデル誤差補正量演算部2の周波数応答のゲインがモデル位置指令演算部1の周波数応答のゲインよりも高くなるように設定する。あるいは、応答性の高さや応答の速さの指標として、ステップ応答の応答遅れ時間を用いることもできる。これは、ステップ応答の応答遅れ時間はステップ応答の値が目標値の所定倍(例えば0.5倍)に到達するまでの時間として定義され、この時間が短いほうが、応答が速い。   The height of response and the speed of response can be considered by replacing with the height of gain response. That is, the higher the frequency response gain at the same frequency, the higher the response and the faster the response. Accordingly, the gain of the frequency response of the model error correction amount calculation unit 2 is set so that the gain of the frequency response from the error correction amount to the detector position is higher than the gain of the frequency response from the position command to the detector position. It is set to be higher than the frequency response gain of the position command calculation unit 1. Alternatively, the response delay time of the step response can be used as an index of the high responsiveness or the response speed. This is because the response delay time of the step response is defined as the time until the value of the step response reaches a predetermined multiple (for example, 0.5 times) of the target value, and the shorter this time, the faster the response.

本実施の形態1では、位置指令や誤差補正量に含まれる高周波数領域の成分を除去して機械振動などが励起されにくくするために、モデル位置指令演算部1およびモデル誤差補正量演算部2を、低域通過特性をもつフィルタとする。一般的なフィルタの入出力特性は伝達関数で表すことができる。ここでは、モデル位置指令演算部1の伝達関数をGr(s)、モデル誤差補正量演算部2の伝達関数をGe(s)とおく(sは、ラプラス演算子)。周波数応答のゲインは、伝達関数の絶対値を計算することにより求められる。よって、モデル誤差補正量演算部2の周波数応答のゲイン|Ge(jω)|が、モデル位置指令演算部1の周波数応答のゲイン|Gr(jω)|よりも高くなるようにモデル位置指令演算部1およびモデル誤差補正量演算部2を設定すればよい。ただし、jは虚数単位、ωは周波数を表す。   In the first embodiment, the model position command calculation unit 1 and the model error correction amount calculation unit 2 are used in order to remove the components in the high frequency region included in the position command and the error correction amount to make it difficult to excite mechanical vibration and the like. Is a filter having a low-pass characteristic. The input / output characteristics of a general filter can be expressed by a transfer function. Here, the transfer function of the model position command calculation unit 1 is set to Gr (s), and the transfer function of the model error correction amount calculation unit 2 is set to Ge (s) (s is a Laplace operator). The gain of the frequency response is obtained by calculating the absolute value of the transfer function. Therefore, the model position command calculation unit so that the frequency response gain | Ge (jω) | of the model error correction amount calculation unit 2 is higher than the frequency response gain | Gr (jω) | of the model position command calculation unit 1. 1 and the model error correction amount calculation unit 2 may be set. However, j represents an imaginary unit, and ω represents a frequency.

低域通過特性を持つフィルタの場合、応答帯域を高く設定することにより、入力に対する出力の応答を速くすることができる。応答帯域は、周波数応答のゲインが所定の値(例えば0.707)以上である最大の周波数ωとして定義することができる。モデル位置指令演算部1は、位置指令に対して所望の応答特性を持つように設計される。例えば、2次の重根をもつフィルタとして、Gr(s)を次式のように設定する。
Gr(s)=Kr2/(s2+2Kr・s+Kr2) (1)
ここで、Krはモデル位置応答のゲインであり、モデル位置指令演算部1の応答帯域に相当する。Krを大きく設定すると、それに伴ってモデル位置指令演算部1の伝達関数Gr(s)の応答帯域が高くなり、モデル位置指令は位置指令に早く追従するようになり、結果として検出器位置が位置指令に早く追従するようになる。
In the case of a filter having a low-pass characteristic, the response of the output to the input can be accelerated by setting the response band high. The response band can be defined as the maximum frequency ω at which the gain of the frequency response is a predetermined value (for example, 0.707) or more. The model position command calculation unit 1 is designed to have a desired response characteristic with respect to the position command. For example, Gr (s) is set as the following equation as a filter having a secondary double root.
Gr (s) = Kr 2 / (s 2 + 2Kr · s + Kr 2 ) (1)
Here, Kr is a gain of the model position response and corresponds to the response band of the model position command calculation unit 1. When Kr is set to a large value, the response band of the transfer function Gr (s) of the model position command calculation unit 1 increases accordingly, and the model position command follows the position command quickly. As a result, the detector position becomes the position. Follow the command quickly.

また、モデル誤差補正量演算部も、同様に次式のような伝達関数Ge(s)をもつように設定する。
Ge(s)=Ke2/(s2+2Ke・s+Ke2) (2)
ここで、Keはモデル誤差補正量応答のゲインであり、モデル誤差補正量演算部2の応答帯域に相当する。Keを大きく設定すると、それに伴ってモデル誤差補正量演算部2の伝達関数Ge(s)の応答帯域が高くなり、モデル誤差補正量は誤差補正量に早く追従するようになり、結果として検出器位置が誤差補正量に早く追従するようになる。
Similarly, the model error correction amount calculation unit is set to have a transfer function Ge (s) as shown in the following equation.
Ge (s) = Ke 2 / (s 2 + 2Ke · s + Ke 2 ) (2)
Here, Ke is a gain of the model error correction amount response, and corresponds to the response band of the model error correction amount calculation unit 2. When Ke is set large, the response band of the transfer function Ge (s) of the model error correction amount calculation unit 2 increases accordingly, and the model error correction amount quickly follows the error correction amount, and as a result, the detector The position quickly follows the error correction amount.

そこで、KeをKrよりも大きく設定することにより、モデル誤差補正量演算部2の応答帯域がモデル位置指令演算部1の応答帯域よりも高くなるようにし、位置指令から検出器位置までの応答よりも誤差補正量から検出器位置までの応答の方が速くなるようにすることができる。   Therefore, by setting Ke larger than Kr, the response band of the model error correction amount calculation unit 2 is made higher than the response band of the model position command calculation unit 1, and from the response from the position command to the detector position. Also, the response from the error correction amount to the detector position can be made faster.

サーボ制御部4の構成は、例えば特許文献2に開示されているように、位置ループの内部に速度ループ・電流ループをもつカスケード構造のフィードバック制御系に、位置および速度のフィードフォワードを行う制御系とするとよい。   The configuration of the servo control unit 4 is, for example, as disclosed in Patent Document 2, a control system that feeds forward position and speed to a feedback control system having a cascade structure having a speed loop and a current loop inside the position loop. It is good to do.

次に、図3〜図5を参照して、本発明の実施の形態1による効果を説明する。図3は、機械誤差について説明する図である。図3(a)において、太い実線は指令経路を表す。この指令経路はX方向に位置指令が移動する経路であるが、機械誤差により、実際の機械位置はY方向にも変位し、図3(a)中の破線に示すようになる場合を考える。このような場合、検出器位置での軌跡を図の細い実線のように制御することができれば、実際の機械位置を指令経路と一致させることができる。そこで、時々刻々の図の細い実線上の位置と図の太い実線上の位置の差、すなわち検出器位置と機械位置の差が誤差補正量として数値制御装置30に入力される。図3(b)は位置指令の時間変化を、図3(c)は誤差補正量の時間変化を示す。X軸の位置指令は一定速度で増加するのに対し、Y軸の位置指令は一定値を保つ。また、X軸の誤差補正量は常に0であるのに対し、Y軸の誤差補正量はX軸が移動することによる機械誤差量の変化に対応して時間と共に変化する。   Next, effects of the first embodiment of the present invention will be described with reference to FIGS. FIG. 3 is a diagram for explaining the mechanical error. In FIG. 3A, a thick solid line represents a command path. This command path is a path along which the position command moves in the X direction. However, a case is considered in which the actual machine position is also displaced in the Y direction due to a machine error, as indicated by a broken line in FIG. In such a case, if the trajectory at the detector position can be controlled as shown by the thin solid line in the figure, the actual machine position can be matched with the command path. Therefore, the difference between the position on the thin solid line in the drawing and the position on the thick solid line in the drawing, that is, the difference between the detector position and the machine position is input to the numerical controller 30 as an error correction amount. FIG. 3B shows the time change of the position command, and FIG. 3C shows the time change of the error correction amount. While the X-axis position command increases at a constant speed, the Y-axis position command maintains a constant value. Further, while the X-axis error correction amount is always 0, the Y-axis error correction amount changes with time corresponding to the change in the mechanical error amount caused by the movement of the X-axis.

図4は、サーボ系の応答遅れがある場合の従来の数値制御装置による制御を説明する図である。従来の数値制御装置によれば、サーボ系の応答遅れが大きい場合、補正後のサーボ応答の経路すなわち検出器位置の軌跡は図4(a)の破線のようになる。つまり、図4(b)に示すように、位置指令は一定速度の移動のため、位置指令に対するサーボ応答は位置指令に追従するが、図4(c)に示すように、誤差補正量は時々刻々変化するために誤差補正量に対するサーボ応答は与えられた誤差補正量に対して遅れて変化する。その結果、実際の機械位置の軌跡は指令経路からずれてしまう。   FIG. 4 is a diagram for explaining the control by the conventional numerical control apparatus when there is a response delay of the servo system. According to the conventional numerical control apparatus, when the response delay of the servo system is large, the corrected servo response path, that is, the locus of the detector position is as shown by a broken line in FIG. That is, as shown in FIG. 4B, since the position command moves at a constant speed, the servo response to the position command follows the position command. However, as shown in FIG. Since it changes every moment, the servo response to the error correction amount changes with a delay with respect to the given error correction amount. As a result, the actual locus of the machine position deviates from the command path.

図5は、本発明の実施の形態1の数値制御装置30による制御を説明する図である。数値制御装置30によれば、誤差補正量から検出器位置までの応答が位置指令から検出器位置までの応答よりも速くなるように制御することにより、補正後のサーボ応答経路を図5(a)の破線のように、補正後の指令経路に近づけることができ、その結果実際の機械位置の軌跡が指令経路に精度よく追従させることができる。すなわち、機械誤差補正後の軌跡と指令された軌跡とのずれを低減することができる。その際の位置指令に対するサーボ応答の時間変化は図5(b)のようになり、誤差補正量のサーボ応答の時間変化は図5(c)のようになる。   FIG. 5 is a diagram for explaining control by the numerical control device 30 according to the first embodiment of the present invention. According to the numerical control device 30, by controlling so that the response from the error correction amount to the detector position is faster than the response from the position command to the detector position, the corrected servo response path is shown in FIG. ) As indicated by a broken line, the actual path of the machine position can follow the command path with high accuracy. That is, it is possible to reduce the deviation between the trajectory after the mechanical error correction and the commanded trajectory. The time change of the servo response to the position command at that time is as shown in FIG. 5B, and the time change of the servo response of the error correction amount is as shown in FIG.

以上述べたように、本発明の実施の形態1によれば、位置指令に対する応答よりも誤差補正量に対する応答を速く設定することにより、誤差補正量に実際の軌跡が素早く追従するようになってサーボ応答遅れにより生じる機械誤差補正後の軌跡と指令された軌跡とのずれを低減することができる。したがって、サーボ系の応答遅れや送り速度に関係なく機械誤差を意図したとおりに補正することができるようになる。機械誤差を意図したとおりに補正することができるので、機械位置で加工される製品の歩留まりを向上させることができる。   As described above, according to the first embodiment of the present invention, the actual trajectory quickly follows the error correction amount by setting the response to the error correction amount faster than the response to the position command. It is possible to reduce the deviation between the trajectory after the mechanical error correction caused by the servo response delay and the commanded trajectory. Therefore, the mechanical error can be corrected as intended regardless of the response delay of the servo system and the feed speed. Since the machine error can be corrected as intended, the yield of products processed at the machine position can be improved.

また、モデル位置指令演算部1とモデル誤差補正量演算部2を、低域通過特性をもつフィルタとし、モデル誤差補正量演算部2のフィルタの応答帯域をモデル位置指令演算部1のフィルタの応答帯域よりも高くするようにしたので、機械誤差補正後の軌跡と指令された軌跡とのずれを低減することができるとともに、位置指令や誤差補正量に含まれる高周波数領域の成分を除去して機械振動などが励起されにくくすることができる。   Also, the model position command calculation unit 1 and the model error correction amount calculation unit 2 are filters having low-pass characteristics, and the response band of the filter of the model error correction amount calculation unit 2 is set to the response of the filter of the model position command calculation unit 1. Since it is made higher than the band, it is possible to reduce the deviation between the trajectory after the mechanical error correction and the commanded trajectory, and to remove the high frequency region component included in the position command and error correction amount. Mechanical vibration and the like can be made difficult to be excited.

実施の形態2.
図6は、本発明の実施の形態2の数値制御装置の構成を示すブロック図である。ここでは、実施の形態1と等しい構成要素には同じ符号を付し、該構成要素に関する詳細な説明は省略する。
Embodiment 2. FIG.
FIG. 6 is a block diagram showing the configuration of the numerical control apparatus according to the second embodiment of the present invention. Here, the same reference numerals are given to the same constituent elements as those in the first embodiment, and detailed description thereof will be omitted.

図6に示すように、実施の形態2の数値制御装置40は、モデル位置指令演算部1、モデル誤差補正量演算部42、加算器3、サーボ制御部4を有する軸駆動系41を備えている。加算器3は、モデル位置指令演算部1が算出したモデル位置指令とモデル誤差補正量演算部42が算出したモデル誤差補正量とを加算し、補正後モデル位置指令を算出する。   As shown in FIG. 6, the numerical controller 40 of the second embodiment includes a shaft drive system 41 having a model position command calculation unit 1, a model error correction amount calculation unit 42, an adder 3, and a servo control unit 4. Yes. The adder 3 adds the model position command calculated by the model position command calculation unit 1 and the model error correction amount calculated by the model error correction amount calculation unit 42 to calculate a corrected model position command.

ここで、モデル誤差補正量演算部42は、むだ時間要素として機能する。モデル誤差補正量演算部42のむだ時間には、モデル位置指令の応答遅れ時間と同じ時間が設定される。応答遅れ時間とは、定常状態における遅れ時間である。定常状態における遅れ時間は、サーボ系に一定速度の入力が与えられたときの指令に対する応答の定常的な遅れ時間をラプラス変換の最終値定理を用いて求めることにより得られる。   Here, the model error correction amount calculation unit 42 functions as a dead time element. The dead time of the model error correction amount calculation unit 42 is set to the same time as the response delay time of the model position command. The response delay time is a delay time in a steady state. The delay time in the steady state is obtained by obtaining the steady delay time of the response to the command when a constant speed input is given to the servo system using the final value theorem of Laplace transform.

実施の形態1と同様にモデル位置指令演算部1としてゲインKrの2次の重根をもつフィルタを用いた場合、応答遅れ時間はゲインKrの逆数1/Krとなる。したがって、モデル誤差補正量演算部42はモデル位置指令の応答遅れ時間1/Krと等しいむだ時間を持つようにするとよい。ただし、数値制御装置40に離散時間系の制御を実行させる場合、モデル位置指令の応答遅れ時間1/Krと全く等しい時間をモデル誤差補正量演算部42のむだ時間に設定することは一般に不可能であるため、そのような場合、サンプル周期の整数倍のうちモデル位置指令の応答遅れ時間1/Krに最も近い時間を設定するようにするとよい。   When a filter having a second-order multiple root of the gain Kr is used as the model position command calculation unit 1 as in the first embodiment, the response delay time is the reciprocal 1 / Kr of the gain Kr. Therefore, it is preferable that the model error correction amount calculation unit 42 has a dead time equal to the response delay time 1 / Kr of the model position command. However, when the numerical control device 40 executes the discrete time control, it is generally impossible to set the time exactly equal to the response delay time 1 / Kr of the model position command as the dead time of the model error correction amount calculation unit 42. Therefore, in such a case, it is preferable to set the time closest to the response delay time 1 / Kr of the model position command among integer multiples of the sample period.

このように、本発明の実施の形態2では、モデル誤差補正量演算部42は、モデル位置指令の応答遅れ時間と等しいむだ時間を持つむだ時間要素として機能するように構成した。これにより、モデル誤差補正量演算部42のゲイン特性は1となり、モデル位置指令演算部1の応答特性よりも速い特性となるが、モデル誤差補正量演算部42の定常状態における応答遅れ時間はモデル位置指令演算部1と等しくなる。したがって、本発明の実施の形態2によれば、モデル位置指令演算部1の応答遅れが大きい場合に誤差補正量を加算するタイミングが早くなりすぎるといった状態に至ることを防ぐことができるので、機械誤差補正後の軌跡と指令された軌跡とのずれを低減することができる。   As described above, in the second embodiment of the present invention, the model error correction amount calculation unit 42 is configured to function as a dead time element having a dead time equal to the response delay time of the model position command. Thereby, the gain characteristic of the model error correction amount calculation unit 42 becomes 1, which is faster than the response characteristic of the model position command calculation unit 1, but the response delay time in the steady state of the model error correction amount calculation unit 42 is the model. It becomes equal to the position command calculation unit 1. Therefore, according to the second embodiment of the present invention, when the response delay of the model position command calculation unit 1 is large, it is possible to prevent a situation in which the timing for adding the error correction amount becomes too early. The deviation between the locus after error correction and the commanded locus can be reduced.

また、モデル位置指令演算部1を、低域通過特性をもつフィルタとしたことにより、位置指令に含まれる高周波数領域の成分を除去して機械振動などが励起されにくくすることができる。   Further, by using the model position command calculation unit 1 as a filter having a low-pass characteristic, it is possible to remove components in a high frequency region included in the position command and make it difficult to excite mechanical vibrations.

実施の形態3.
誤差補正量が時間に対して周期的な関数であれば、サーボ応答遅れによる位相遅れはあらかじめ求めることができる。そこで、実施の形態3では、実施の形態1からモデル誤差補正量演算部を省き、モデル位置指令演算部では、サーボ系において誤差補正量の位相が遅れる分だけ位置指令の位相を遅らせることにより、誤差補正量に対するサーボ応答のタイミングと位置指令に対するサーボ応答のタイミングを合わせるようにした。図7は、本発明の実施の形態3の数値制御装置の構成を示すブロック図である。なお、実施の形態3に関し、実施の形態1と等しい構成要素には同じ符号を付し、該構成要素に関する詳細な説明は省略する。
Embodiment 3 FIG.
If the error correction amount is a periodic function with respect to time, the phase delay due to the servo response delay can be obtained in advance. Therefore, in the third embodiment, the model error correction amount calculation unit is omitted from the first embodiment, and in the model position command calculation unit, the phase of the position command is delayed by an amount that the phase of the error correction amount is delayed in the servo system. The timing of the servo response to the error correction amount is matched with the timing of the servo response to the position command. FIG. 7 is a block diagram showing the configuration of the numerical control apparatus according to the third embodiment of the present invention. In addition, regarding Embodiment 3, the same code | symbol is attached | subjected to the component same as Embodiment 1, and the detailed description regarding this component is abbreviate | omitted.

図7に示すように、実施の形態3の数値制御装置50は、モデル位置指令演算部52、加算器3、サーボ制御部4を有する軸駆動系51を備えている。加算器3は、モデル位置指令演算部52が算出したモデル位置指令と数値制御装置50に入力された誤差補正量とを加算し、サーボ制御部4に供給する補正後モデル位置指令を算出する。   As shown in FIG. 7, the numerical control device 50 according to the third embodiment includes a shaft drive system 51 having a model position command calculation unit 52, an adder 3, and a servo control unit 4. The adder 3 adds the model position command calculated by the model position command calculation unit 52 and the error correction amount input to the numerical controller 50 to calculate a corrected model position command to be supplied to the servo control unit 4.

モデル位置指令演算部52は、位相遅れフィルタとしての特性を備えている。誤差補正量から検出器位置までの伝達関数をGed(s)とし、誤差補正量が周波数ωeで変化するとすると、モデル位置指令演算部52の周波数ωeにおける位相遅れが、周波数ωeにおける誤差補正量から検出器位置までの伝達関数の位相遅れ量∠Ged(j・ωe)と等しくなるように、モデル位置指令演算部52の位相遅れフィルタGr(s)が設計される。位相遅れフィルタとしては、例えば次式に示す1次の低域通過フィルタが設定される。
Gr(s)=1/(Tr・s+1) (3)
Trは低域通過フィルタの時定数であり、モデル位置指令演算部の周波数ωeにおける位相遅れ∠Gr(j・ωe)が、周波数ωeにおける誤差補正量から検出器位置までの伝達関数の位相遅れ量∠Ged(j・ωe)と等しくなるように設定される。
The model position command calculation unit 52 has characteristics as a phase delay filter. When the transfer function from the error correction amount to the detector position is Ged (s) and the error correction amount changes at the frequency ωe, the phase delay at the frequency ωe of the model position command calculation unit 52 is determined from the error correction amount at the frequency ωe. The phase delay filter Gr (s) of the model position command calculation unit 52 is designed so as to be equal to the phase delay amount ∠Ged (j · ωe) of the transfer function up to the detector position. As the phase delay filter, for example, a first-order low-pass filter represented by the following equation is set.
Gr (s) = 1 / (Tr · s + 1) (3)
Tr is the time constant of the low-pass filter, and the phase delay ∠Gr (j · ωe) at the frequency ωe of the model position command calculation unit is the phase delay amount of the transfer function from the error correction amount to the detector position at the frequency ωe. It is set to be equal to ∠Ged (j · ωe).

このように、実施の形態3では、誤差補正量が所定周波数で変化する場合において、誤差補正量は操作せず、モデル位置指令演算部52は、誤差補正量から検出器位置までの前記所定周波数における位相遅れ量と等しい位相遅れ量を持つ位相遅れフィルタ特性を備えるように構成したので、実施の形態1に比して簡易な構成で機械誤差補正後の軌跡と指令された軌跡とのずれを低減することができる。   As described above, in the third embodiment, when the error correction amount changes at a predetermined frequency, the error correction amount is not operated, and the model position command calculation unit 52 performs the predetermined frequency from the error correction amount to the detector position. Since the phase lag filter characteristic having the phase lag amount equal to the phase lag amount in FIG. 3 is provided, the deviation between the trajectory after the mechanical error correction and the commanded trajectory can be reduced with a simpler configuration compared to the first embodiment. Can be reduced.

実施の形態4.
実施の形態3で述べたように、誤差補正量が時間に対して周期的な関数であれば、サーボ応答遅れによる位相遅れはあらかじめ求めることができる。実施の形態4では、位置指令の位相を操作せず、誤差補正量の位相を進ませることによって、誤差補正量に対するサーボ応答のタイミングと位置指令に対するサーボ応答のタイミングを合わせるようにした。図8は本発明の実施の形態4の数値制御装置の構成を示すブロック図である。実施の形態4に関し、実施の形態1と等しい構成要素には同じ符号を付し、該構成要素に関する詳細な説明は省略する。
Embodiment 4 FIG.
As described in the third embodiment, if the error correction amount is a periodic function with respect to time, the phase delay due to the servo response delay can be obtained in advance. In the fourth embodiment, the timing of the servo response to the error correction amount and the timing of the servo response to the position command are matched by advancing the phase of the error correction amount without manipulating the phase of the position command. FIG. 8 is a block diagram showing the configuration of the numerical control apparatus according to the fourth embodiment of the present invention. In the fourth embodiment, the same reference numerals are given to the same components as those in the first embodiment, and detailed description thereof will be omitted.

図8に示すように、実施の形態4の数値制御装置60は、モデル誤差補正量演算部62、加算器3、サーボ制御部4を有する軸駆動系61を備えている。加算器3は、数値制御装置60に入力された位置指令とモデル誤差補正量演算部62が算出したモデル誤差補正量とを加算し、サーボ制御部4に供給する補正後モデル位置指令を算出する。   As shown in FIG. 8, the numerical control device 60 of the fourth embodiment includes a shaft drive system 61 having a model error correction amount calculation unit 62, an adder 3, and a servo control unit 4. The adder 3 adds the position command input to the numerical controller 60 and the model error correction amount calculated by the model error correction amount calculation unit 62 to calculate a corrected model position command to be supplied to the servo control unit 4. .

モデル誤差補正量演算部62は、位相進みフィルタとしての特性を備えている。誤差補正量から検出器位置までの伝達関数をGed(s)とし、誤差補正量が周波数ωeで変化するとすると、モデル誤差補正量演算部62の周波数ωeにおける位相進み量が、周波数ωeにおける誤差補正量から検出器位置までの伝達関数の位相遅れ量∠Ged(j・ωe)と等しくなるように、モデル誤差補正量演算部62の位相進みフィルタGe(s)が設定される。モデル誤差補正量演算部62の位相進みフィルタとしては、例えば次式に示す1次の零点をもつフィルタが設定される。
Ge(s)=Te・s+1 (4)
Teはフィルタの時定数であり、モデル位置指令演算部の周波数ωeにおける位相進み量(位相遅れ量を符号反転した値)−∠Ge(j・ωe)が、周波数ωeにおける誤差補正量から検出器位置までの伝達関数の位相遅れ量∠Ged(j・ωe)と等しくなるように設定される。
The model error correction amount calculation unit 62 has characteristics as a phase advance filter. Assuming that the transfer function from the error correction amount to the detector position is Ged (s) and the error correction amount changes at the frequency ωe, the phase advance amount at the frequency ωe of the model error correction amount calculation unit 62 becomes the error correction at the frequency ωe. The phase advance filter Ge (s) of the model error correction amount calculation unit 62 is set so as to be equal to the phase delay amount ∠Ged (j · ωe) of the transfer function from the amount to the detector position. As the phase advance filter of the model error correction amount calculation unit 62, for example, a filter having a primary zero point represented by the following equation is set.
Ge (s) = Te · s + 1 (4)
Te is a time constant of the filter, and the phase advance amount (the value obtained by sign-inversion of the phase delay amount) −∠Ge (j · ωe) at the frequency ωe of the model position command calculation unit is detected from the error correction amount at the frequency ωe. It is set to be equal to the phase delay amount ∠Ged (j · ωe) of the transfer function up to the position.

このように、実施の形態4では、誤差補正量が所定周波数で変化する場合において、位置指令は操作せず、モデル誤差補正量演算部62は、誤差補正量から前記検出器位置までの前記所定周波数における位相遅れ量と等しい量だけ位相を進める位相進みフィルタ特性を備えるように構成したので、実施の形態1に比して簡易な構成で機械誤差補正後の軌跡と指令された軌跡とのずれを低減することができる。   As described above, in the fourth embodiment, when the error correction amount changes at a predetermined frequency, the position command is not operated, and the model error correction amount calculation unit 62 performs the predetermined error from the error correction amount to the detector position. Since the phase advance filter characteristic for advancing the phase by an amount equal to the phase lag amount at the frequency is provided, the deviation between the trajectory after the mechanical error correction and the commanded trajectory is simpler than that of the first embodiment. Can be reduced.

以上のように、本発明にかかる数値制御装置は、工作機械等の被制御装置を数値制御する数値制御装置に有用であり、特に、被制御装置が備えるテーブルや主軸ヘッド等の機械位置を移動させるための位置指令に対して機械誤差の補正を行う数値制御装置に適している。   As described above, the numerical control device according to the present invention is useful for a numerical control device that numerically controls a controlled device such as a machine tool. In particular, the position of a machine such as a table or a spindle head included in the controlled device is moved. It is suitable for a numerical control device that corrects a mechanical error with respect to a position command for causing a position command.

1 モデル位置指令演算部
2 モデル誤差補正量演算部
3 加算器
4 サーボ制御部
5 モータ
6 負荷
7 位置検出器
9 軸制御系
10 機械
15 第1軸モータ
16 第1軸負荷
17 第1軸位置検出器
19 第1軸制御系
25 第2軸モータ
26 第2軸負荷
27 第2軸位置検出器
29 第2軸制御系
30 数値制御装置
40 数値制御装置
41 軸駆動系
42 モデル誤差補正量演算部
50 数値制御装置
51 軸駆動系
52 モデル位置指令演算部
60 数値制御装置
61 軸駆動系
62 モデル誤差補正量演算部
DESCRIPTION OF SYMBOLS 1 Model position command calculating part 2 Model error correction amount calculating part 3 Adder 4 Servo control part 5 Motor 6 Load 7 Position detector 9 Axis control system 10 Machine 15 1st axis motor 16 1st axis load 17 1st axis position detection 19 First axis control system 25 Second axis motor 26 Second axis load 27 Second axis position detector 29 Second axis control system 30 Numerical control device 40 Numerical control device 41 Axis drive system 42 Model error correction amount calculation unit 50 Numerical control device 51 Axis drive system 52 Model position command calculation unit 60 Numerical control device 61 Axis drive system 62 Model error correction amount calculation unit

Claims (6)

同一の対象物を互いに直交する方向に移動せしめる複数の軸であって機械に存在する複数の軸を制御する軸制御系を軸ごとに有し、それぞれの軸制御系において、位置検出器による機械位置の検出値である検出器位置と、外部から入力される位置指令と、前記検出器位置と前記機械位置との誤差を補正する外部から入力される、前記複数の軸のうちの自軸制御系が制御する軸と異なる軸にかかる指令位置に応じた誤差補正量と、を用いて、前記位置指令に前記機械位置が追従するようにモータを駆動することにより前記対象物の軌跡制御を行う数値制御装置であって、
それぞれの軸制御系は、
前記位置指令から前記検出器位置までの応答よりも前記誤差補正量から前記検出器位置までの応答が速くなるように前記位置指令および前記誤差補正量に対して演算を実行する演算処理実行部と、
前記演算処理実行部による演算後の位置指令および誤差補正量を合算して補正後位置指令を出力する加算器と、
前記検出器位置が前記補正後位置指令に追従するように前記モータを動作させるサーボ制御部と、
を備えることを特徴とする数値制御装置。
A plurality of axes that move the same object in directions orthogonal to each other and each having an axis control system that controls a plurality of axes existing in the machine . In each axis control system, a machine that uses a position detector Self-axis control of the plurality of axes input from the outside for correcting an error between the detector position that is a position detection value, a position command input from the outside, and the detector position and the machine position Using the error correction amount corresponding to the command position applied to an axis different from the axis controlled by the system , the trajectory control of the object is performed by driving the motor so that the machine position follows the position command. A numerical controller,
Each axis control system
An arithmetic processing execution unit that performs an operation on the position command and the error correction amount so that a response from the error correction amount to the detector position is faster than a response from the position command to the detector position; ,
An adder for adding the position command and the error correction amount after calculation by the calculation processing execution unit and outputting the corrected position command;
A servo control unit that operates the motor so that the detector position follows the corrected position command;
A numerical control device comprising:
前記演算処理実行部による演算は、前記外部から入力された位置指令および誤差補正量に対して夫々低域通過特性を持つフィルタを作用させることであって、
前記誤差補正量に作用させるフィルタの応答帯域は前記位置指令に作用させるフィルタの応答帯域よりも高いことを特徴とする請求項1に記載の数値制御装置。
The calculation by the calculation processing execution unit is to apply a filter having a low-pass characteristic to the position command and the error correction amount input from the outside,
The numerical control device according to claim 1, wherein a response band of a filter that acts on the error correction amount is higher than a response band of a filter that acts on the position command.
前記演算処理実行部による演算は、前記外部から入力された位置指令に対して応答遅れ時間を有する所定のフィルタを作用させ、かつ前記外部から入力された誤差補正量に対して前記所定のフィルタの応答遅れ時間に等しい時間をむだ時間とする処理を実行することである、
ことを特徴とする請求項1に記載の数値制御装置。
The calculation by the calculation processing execution unit causes a predetermined filter having a response delay time to act on the position command input from the outside, and applies an error correction amount input from the outside to the error correction amount of the predetermined filter. It is to execute a process in which a time equal to the response delay time is a dead time.
The numerical controller according to claim 1.
前記所定のフィルタは、低域通過特性を持つフィルタである、ことを特徴とする請求項3に記載の数値制御装置。   The numerical control apparatus according to claim 3, wherein the predetermined filter is a filter having a low-pass characteristic. 前記外部から入力される誤差補正量は時間に対して所定周波数の周期的に変化し、
前記演算処理実行部による演算は、前記外部から入力された誤差補正量から前記検出器位置までの前記所定周波数における位相遅れ量と等しい位相遅れ量を有する位相遅れフィルタを前記外部から入力された位置指令に対して作用させることである、
ことを特徴とする請求項1に記載の数値制御装置。
The error correction amount input from the outside periodically changes with a predetermined frequency with respect to time,
The calculation performed by the calculation processing execution unit is a position where a phase lag filter having a phase lag amount equal to the phase lag amount at the predetermined frequency from the error correction amount input from the outside to the detector position is input from the outside. To act on the command,
The numerical controller according to claim 1.
前記外部から入力される誤差補正量は時間に対して所定周波数の周期的に変化し、
前記演算処理実行部による演算は、前記外部から入力された誤差補正量から前記検出器位置までの前記所定周波数における位相遅れ量と等しい量だけ位相を進める位相進みフィルタを前記外部から入力された誤差補正量に対して作用させることである、
ことを特徴とする請求項1に記載の数値制御装置。
The error correction amount input from the outside periodically changes with a predetermined frequency with respect to time,
The calculation by the calculation processing execution unit is an error input from the outside by a phase advance filter that advances the phase by an amount equal to the phase delay amount at the predetermined frequency from the error correction amount input from the outside to the detector position. To act on the correction amount,
The numerical controller according to claim 1.
JP2010033692A 2010-02-18 2010-02-18 Numerical controller Active JP5460371B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2010033692A JP5460371B2 (en) 2010-02-18 2010-02-18 Numerical controller

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2010033692A JP5460371B2 (en) 2010-02-18 2010-02-18 Numerical controller

Publications (2)

Publication Number Publication Date
JP2011170609A JP2011170609A (en) 2011-09-01
JP5460371B2 true JP5460371B2 (en) 2014-04-02

Family

ID=44684672

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2010033692A Active JP5460371B2 (en) 2010-02-18 2010-02-18 Numerical controller

Country Status (1)

Country Link
JP (1) JP5460371B2 (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104508580B (en) * 2012-07-17 2016-08-24 三菱电机株式会社 Numerical control device and digital control system
EP3512092B1 (en) 2016-09-08 2020-09-30 Panasonic Intellectual Property Management Co., Ltd. Motor control device, motor position control method, and industrial machine
JP7134031B2 (en) * 2018-09-05 2022-09-09 オークマ株式会社 Numerical control method and numerical control device

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04278603A (en) * 1991-03-06 1992-10-05 Mitsubishi Heavy Ind Ltd Feed driving device
JP2000091911A (en) * 1998-09-16 2000-03-31 Toshiba Corp Delay phase locked loop circuit for spread spectrum communication device

Also Published As

Publication number Publication date
JP2011170609A (en) 2011-09-01

Similar Documents

Publication Publication Date Title
JP5885883B2 (en) Servo control device
JP5411978B2 (en) Servo control device with a function to correct the amount of expansion and contraction of the ball screw
US10108177B2 (en) Control parameter adjustment device
JP4335123B2 (en) Control device
US9772619B2 (en) Motor control device
JP6592143B2 (en) Electric motor control device
JP5762625B2 (en) Trajectory control device
US11175647B2 (en) Motor controller
JP2007219812A (en) Controller for servo motor
JPH0569275A (en) Numerical control device
EP2996003B1 (en) Device and method for moving an object
KR20150139519A (en) Motor drive device
JP6412071B2 (en) Motor control device, motor control method, and motor control program
JP2011145884A (en) Locus control device
WO2015083275A1 (en) Trajectory measurement device, numerical control device, and trajectory measurement method
JP5460371B2 (en) Numerical controller
JP5836206B2 (en) Servo control device
JP5319167B2 (en) Control device
EP3076260B1 (en) Device and method for assisting in design improvement work for mechanical device
JP4636271B2 (en) Servo control device and adjustment method thereof
JP6391489B2 (en) Motor control device
JP6048174B2 (en) Numerical control device and lost motion compensation method
JP2005269758A (en) Motor controller
JP3902745B2 (en) Industrial device control method and industrial device
JP4843942B2 (en) Thrust ripple correction method and thrust ripple correction device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20111007

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20121226

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20130129

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130325

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20130716

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130906

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20131217

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20140114

R150 Certificate of patent or registration of utility model

Ref document number: 5460371

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250