JP3618038B2 - 数値制御装置の位置誤差量検出方法及び装置 - Google Patents
数値制御装置の位置誤差量検出方法及び装置 Download PDFInfo
- Publication number
- JP3618038B2 JP3618038B2 JP19390597A JP19390597A JP3618038B2 JP 3618038 B2 JP3618038 B2 JP 3618038B2 JP 19390597 A JP19390597 A JP 19390597A JP 19390597 A JP19390597 A JP 19390597A JP 3618038 B2 JP3618038 B2 JP 3618038B2
- Authority
- JP
- Japan
- Prior art keywords
- position error
- error amount
- command value
- detector
- correction data
- 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.)
- Expired - Fee Related
Links
Landscapes
- Numerical Control (AREA)
Description
【発明の属する技術分野】
本発明は、モータを制御する数値制御装置において、数値制御装置を構成する位置検出器が固有に持つ位置検出値誤差に起因して発生する位置誤差量を簡単に検出可能な方法及び装置に関する。
【0002】
【従来の技術】
まず、モータを制御する数値制御装置において、数値制御装置を構成する位置検出器が固有に持つ誤差に起因する位置誤差を補償する装置の従来例について図4を用いて説明する。
【0003】
パートプログラム記憶部1は、NC加工プログラム等のデータを記憶する。関数発生部2は前記記憶部1から読み出したNC加工プログラム等の外部入力データに基づいて工具等の移動すべき位置の算出、すなわち関数発生を行ない、発生された位置指令値PSを位置誤差量算出部3、速度フィードフォワード制御部4、及び後述する位置誤差量記憶部10と補正データ演算部12に転送する。速度フィードフォワード制御部4は関数発生部2から転送された位置指令値PSに基づいて速度指令データSDを生成し、位置制御部5を経ることなく速度指令データSDを速度誤差量算出部6へ転送する。このような速度フィードフォワード制御の機能によりサーボモータ8が等速運動をしているような定常状態では位置誤差量DIFFの値を零とすることができる。また、位置誤差算出部3はサーボモータ8に結合されたモータ位置検出器9から得られる位置検出値MSと、前記位置指令値PSとの偏差、すなわち位置誤差量DIFFを算出し、この位置誤差量DIFFを位置制御部5へ転送する。前記位置検出器9は、サーボモータ8に結合されたモータ位置検出器以外に、フルクローズドの検出器であってもよい。位置制御部5は位置誤差量DIFFに位置制御ループゲインを乗算することによりサーボモータ8の速度指令SPを算出し、この速度指令SPを速度誤差量算出部6に転送する。速度・トルク制御部7は前記の位置制御ループのマイナーループであって、それぞれ、公知の方法によって速度制御ループ、電流制御ループを構成し、それらの指令に基づいて、サーボモータ8は所定の位置へ速やかに駆動される。
【0004】
図2は、前記位置検出器9が持つ固有の位置検出値誤差の一例を示す。すなわち、位置検出器9は機械構成部品の精度誤差、及び電気信号の誤差により固有の位置検出値誤差を有し、モータ回転駆動時において、その位置検出値誤差の周波数が位置制御ループで追従できる周波数帯内であった場合には、機械は位置検出器9が持つ固有の位置検出値誤差に対して正確に追従してしまう。そのため加工工具等の軌跡は位置検出値誤差を含む軌跡で移動するため、加工対象物はNC加工プログラムに対して正確な形状とならない。
【0005】
従来、このような位置検出器9が固有に持つ位置検出値誤差に起因して発生する加工対象物の形状不良を補正するために、レーザー測長器等の位置測定器を用いて制御ループの外部から位置誤差を測定して、各位置毎の位置誤差量を位置誤差量記憶部10に記憶させていた。そして、記憶部10に記憶された位置誤差量に基づいて、任意の位置指令値に対する位置誤差補正データを演算部12により生成する。その位置誤差補正データを関数発生、すなわち移動位置算出に従い、任意の位置指令値に対する位置誤差補正データとして加算器11にて位置指令値PSに加算することにより位置誤差を補償していた。
【0006】
【発明が解決しようとする課題】
しかしながら、従来の位置誤差を補償する装置においては、レーザー測長器等の位置測定器を用いて制御ループの外部から位置誤差を測定するため、測定器の設置、及び調整を必要とした。本発明の目的は、簡単な制御ブロックにより位置検出器が固有に持つ位置誤差量を極めて簡単に検出可能な方法及び装置を提供することにある。
【0007】
【課題を解決するための手段】
本発明は、数値制御装置を構成する位置検出器が固有に持つ位置検出値誤差の周波数が、位置制御ループの追従不能な高周波数帯になるような領域の速度をサーボモータに与えるための位置指令値を与え、そのときに発生する位置誤差量を、前記位置指令値に対して記憶することを特徴とする。前記位置誤差量は位置誤差量記憶部に記憶され、このため、位置制御部に供給される信号がモード切換スイッチによって前記位置誤差量記憶部へ供給される。すなわち、本発明によれば、位置誤差補正データ記録モードにおいては前記モード切換スイッチをクローズとして通常位置制御部へ供給される信号をそのまま位置誤差量記憶部へ並列的に配給し、容易に位置誤差量を検出可能としたものである。また、本発明によれば、定められた区間毎に繰り返し位置誤差量を平均化することによって周期的な位置誤差量を算出することができ、このためにモード切換スイッチの出力は周期的位置誤差量演算部を介して位置誤差量記憶部へ供給される。
【0008】
【発明の実施の形態】
図1は、本発明に係る数値制御装置の第1実施形態の構成を示しており、図4と同一の構成要素には同一符号を付し説明を簡略化する。
【0009】
本実施形態において特徴的なことは、位置誤差量記憶部14と位置誤差量算出部3との間がモード切換スイッチ13によって接続されていることであり、モード切換スイッチ13がクローズの場合には前記算出部3の位置誤差量がそのまま記憶部14へ供給されることとなる。モード切換スイッチ13によって、位置誤差補正データ記録モードと、通常モードとを区別する。モード切換スイッチ13がクローズの場合は、位置誤差補正データ記録モードとなり、関数発生部2が発生する位置指令値PSと、位置指令値PSに同期して発生した位置誤差算出部3より算出される位置誤差量DIFFは、位置誤差量記憶部14に格納される。一方、モード切換スイッチ13がオープンの場合は通常モードとなる。位置誤差量記憶部14に記憶された位置誤差量に基づいて、任意の位置指令値に対する位置誤差補正データを補正データ演算部12により生成する。その位置誤差補正データを関数発生に従い、位置指令値PSに加算することにより位置検出器が固有に持つ位置検出値誤差に起因する位置誤差を補償する。
【0010】
次に、本発明の位置誤差量検出動作原理について説明する。図3は一般的なNC工作機械の位置制御ループの周波数特性を示すグラフである。一般的にNC工作機械の位置制御ループの周波数応答は0〜30Hz程度であり、それ以上の高速な指令に対しては機械は追従しない。仮に位置検出器9が固有に持つ位置検出値誤差がモータ1回転あたり10回の周期を持つ成分であった場合を例にして説明する。関数発生部2がNCプログラムに従い、モータ8に1000rpmの速い速度指令を与えた場合、位置検出器9が固有に持つ位置検出値誤差の周波数は
【数1】
1000(rpm)/60(sec)×10(回)=166.7(Hz)
となる。
位置制御ループの周波数応答は前述した様に30Hz程度であり、これに対して位置検出器9が固有に持つ位置検出値誤差の周波数が充分高い周波数となっているため、機械はこの誤差に追従することができない。よって位置検出器9が固有に持つ位置検出値誤差は、位置指令値に対する位置誤差量DIFFとしてそのまま現われる。この位置誤差量の発生周期は数1で導きだされる166.7Hzとなる。
仮に関数発生部2がNCプログラムに従い、モータに100rpmの遅い速度指令を与えた場合には、位置検出器9が固有に持つ位置検出値誤差の周波数は
【数2】
100(rpm)/60(sec)×10(回)=16.7(Hz)
となる。
位置制御ループは位置検出器9が固有に持つ位置検出値誤差の周波数である16.7Hzに対して十分に追従できるため、位置検出値誤差は位置誤差量DIFFとして現われない。
【0011】
モード切換スイッチ13をクローズして位置誤差補正データ記録モードとし、位置検出器9が固有に持つ位置検出値誤差の周波数が、位置制御ループが追従不能な高周波数帯になるようにモータ8を回転させ、この時に発生する位置誤差量DIFFを記憶する。位置誤差量の記録が完了したら、モード切換スイッチ13をオープンにして、通常モードとする。通常モードにおいては、記憶部14に記憶された位置誤差量に基づいて、任意の位置指令値に対する位置誤差補正データを演算部12により生成し、その位置誤差補正データを関数発生に従い、位置指令値PSに加算して位置誤差補償を行なうことができる。
以上の様に、制御ループの外部から位置誤差を測定するための測定機器の設置、及び調整をすることなく、簡単に量を検出することが可能となる。
【図面の簡単な説明】
【図1】本発明の第1実施形態に係る数値制御装置の構成を示す図である。
【図2】数値制御装置において位置検出器が固有に持つ位置検出値誤差の例を示す図である。
【図3】一般的なNC工作機械の位置制御ループの周波数特性を示すグラフである。
【図4】従来の数値制御装置の構成を示す図である。
【符号の説明】
1 パートプログラム記憶部、2 関数発生部、3 位置誤差量算出部、4 速度フィードフォワード制御部、5 位置制御部、6 速度誤差量算出部、7 速度・電流制御部、8 モータ、9 モータ位置検出器、10,14 位置誤差量記憶部、11 位置誤差補正データ加算部、12 補正データ演算部、13 モード切換スイッチ。
Claims (2)
- 数値制御プログラムに基づいて関数発生部より発生する位置指令値と位置検出器により検出される位置検出値との差分である位置誤差量に基づいて、任意の位置指令値に対する位置誤差補正を行う数値制御装置において、
サーボモータに与える位置指令値に基づき算出された速度指令を、位置検出器が固有にもつ位置検出値誤差の周波数が位置制御ループの追従不能な高周波数帯となる領域に設定し、この速度指令でサーボモータが駆動されたときの位置誤差量を前記位置指令値に対して記憶することを特徴とする数値制御装置の位置誤差量検出方法。 - 数値制御プログラムに基づいて関数発生部より発生する位置指令値と位置検出器により検出される位置検出値との差分である位置誤差量に基づいて、任意の位置指令値に対する位置誤差補正を行う数値制御装置において、
位置指令値と位置検出器との差分である位置誤差量に対して位置ループゲインを乗算することにより速度指令を発生する位置制御部と、
位置誤差量を記憶する位置誤差量記憶部と、
前記位置誤差量に基づいて任意の位置指令値に対する位置誤差補正データを生成する位置誤差補正データ演算部と、
前記位置誤差補正データを位置指令値に加算する位置誤差補正データ加算器と、
位置検出器が固有にもつ位置検出値誤差の周波数が位置制御ループの追従不能な高周波数帯となる速度をサーボモータに位置指令値として与えたときに前記位置制御部に供給される位置誤差量を前記位置誤差量記憶部へ供給するモード切換スイッチと、を含む数値制御装置の位置誤差量検出装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP19390597A JP3618038B2 (ja) | 1997-07-18 | 1997-07-18 | 数値制御装置の位置誤差量検出方法及び装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP19390597A JP3618038B2 (ja) | 1997-07-18 | 1997-07-18 | 数値制御装置の位置誤差量検出方法及び装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH1139013A JPH1139013A (ja) | 1999-02-12 |
JP3618038B2 true JP3618038B2 (ja) | 2005-02-09 |
Family
ID=16315698
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP19390597A Expired - Fee Related JP3618038B2 (ja) | 1997-07-18 | 1997-07-18 | 数値制御装置の位置誤差量検出方法及び装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3618038B2 (ja) |
-
1997
- 1997-07-18 JP JP19390597A patent/JP3618038B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JPH1139013A (ja) | 1999-02-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6515442B1 (en) | Position controller | |
JP3215067B2 (ja) | 移動方向反転時の位置補正方法 | |
JP3129622B2 (ja) | フルクローズド・ループ方式における象限突起補正方法 | |
JPH0569275A (ja) | 数値制御装置 | |
EP0012620A2 (en) | Closed loop type numerical-controlled machine tool | |
KR100301751B1 (ko) | 서보조정방법및그장치 | |
US5059881A (en) | Numerical control apparatus having a backlash compensation function and method thereof | |
JP3169838B2 (ja) | サーボモータの制御方法 | |
KR20150119065A (ko) | 서보 제어 장치 | |
US6118245A (en) | Control device and control process for motors | |
JP3926739B2 (ja) | ねじ切り加工制御方法及びその装置 | |
JP2950149B2 (ja) | オートチューニングコントローラ | |
JP3618038B2 (ja) | 数値制御装置の位置誤差量検出方法及び装置 | |
JPH05138497A (ja) | 工具の摩耗補正方式 | |
KR970002259B1 (ko) | 서보모터의 제어방법 | |
JP4636271B2 (ja) | サーボ制御装置とその調整方法 | |
JPH07129211A (ja) | 変動負荷自動補正方式 | |
JP3927264B2 (ja) | トルク一定同期駆動制御装置 | |
JPH0146939B2 (ja) | ||
JP3648858B2 (ja) | 主軸同期制御方法及びその装置 | |
JP2003047269A (ja) | サーボ制御装置 | |
JP3579237B2 (ja) | 溶接機におけるデータサンプリング方法 | |
JP3435828B2 (ja) | 位相制御されるサーボ系の進角自動決定方法 | |
JP2918030B2 (ja) | ディジタル制御方式 | |
JPH05169351A (ja) | 工作機械の熱変位補正方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20040622 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20040823 |
|
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: 20041102 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20041108 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101119 Year of fee payment: 6 |
|
LAPS | Cancellation because of no payment of annual fees |