JPH03228106A - サーボモータの制御方法 - Google Patents
サーボモータの制御方法Info
- Publication number
- JPH03228106A JPH03228106A JP2008347A JP834790A JPH03228106A JP H03228106 A JPH03228106 A JP H03228106A JP 2008347 A JP2008347 A JP 2008347A JP 834790 A JP834790 A JP 834790A JP H03228106 A JPH03228106 A JP H03228106A
- Authority
- JP
- Japan
- Prior art keywords
- value
- control loop
- integrator
- speed
- backlash
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 230000001133 acceleration Effects 0.000 claims abstract description 75
- 238000012937 correction Methods 0.000 claims abstract description 34
- 238000012545 processing Methods 0.000 claims abstract description 10
- 238000000034 method Methods 0.000 claims description 25
- 238000010586 diagram Methods 0.000 description 18
- 230000002441 reversible effect Effects 0.000 description 7
- 238000007796 conventional method Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000005070 sampling Methods 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 238000012546 transfer Methods 0.000 description 2
- 230000007423 decrease Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/404—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41078—Backlash acceleration compensation when inversing, reversing direction
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41084—Compensation speed axis with changing, reversing direction, quadrant circle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41085—Compensation pulses on inversion of direction of rotation, movement
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position Or Direction (AREA)
- Numerical Control (AREA)
- Automatic Control Of Machine Tools (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
産業上の利用分野
本発明は、工作機械のテーブル等の送り軸を駆動するサ
ーボモータの制御方式に関し、特に、送り軸の移動方向
が反転するときのバックラッシュ加速補正に関するもの
である。
ーボモータの制御方式に関し、特に、送り軸の移動方向
が反転するときのバックラッシュ加速補正に関するもの
である。
従来の技術
工作機械において、テーブル等を駆動するサーボモータ
の駆動方向を反転させるとき、通常、送りねじのバック
ラッシュや摩擦の影響のため、機械は即座に反転するこ
とができない。そのため、工作機械で円弧切削等を行っ
ているとき、象限が変わると切削円弧面に突起が生しる
。例えば、X。
の駆動方向を反転させるとき、通常、送りねじのバック
ラッシュや摩擦の影響のため、機械は即座に反転するこ
とができない。そのため、工作機械で円弧切削等を行っ
ているとき、象限が変わると切削円弧面に突起が生しる
。例えば、X。
Y2軸平面上でワークに対し円弧切削を行い、X軸をプ
ラス方向、Y軸をマイナス方向に移動させているとき象
限が変わり、Y軸はそのままマイナス方向に駆動し、X
軸をマイナス方向に駆動するように切換えた場合、Y軸
に対しては今までと同一速度で切削か行われるが、X軸
は位置偏差が「0」になることからトルク指令値が小さ
くなり、摩擦によりサーボモータは即座に反転できない
こと、及び、テーブルを送る送りねじのバックラッシュ
によりテーブルの移動も即座に反転できないことから、
X軸方向のワークの移動は移動指令に対し追従できなく
遅れることとなる。その結果、切削円弧面に突起が生じ
る。
ラス方向、Y軸をマイナス方向に移動させているとき象
限が変わり、Y軸はそのままマイナス方向に駆動し、X
軸をマイナス方向に駆動するように切換えた場合、Y軸
に対しては今までと同一速度で切削か行われるが、X軸
は位置偏差が「0」になることからトルク指令値が小さ
くなり、摩擦によりサーボモータは即座に反転できない
こと、及び、テーブルを送る送りねじのバックラッシュ
によりテーブルの移動も即座に反転できないことから、
X軸方向のワークの移動は移動指令に対し追従できなく
遅れることとなる。その結果、切削円弧面に突起が生じ
る。
従来、この突起をなくすため、あるいは減らすため、移
動方向の反転時に位置偏差に位置のバックラッシュ補正
を行うと共に、速度指令に適当な値(加速量)を加えて
サーボモータの反転方向に加速を行い象限突起を減らす
、いわゆるバックラッシュ加速を行っている。
動方向の反転時に位置偏差に位置のバックラッシュ補正
を行うと共に、速度指令に適当な値(加速量)を加えて
サーボモータの反転方向に加速を行い象限突起を減らす
、いわゆるバックラッシュ加速を行っている。
第8図は、従来行われているこのバックラッシュ補正の
ブロック図で、CNC(コンピュータ内臓の数値制御装
置)はデジタルサーボ回路側に位置指令、及び位置指令
の符号か反転するときに機械系のバックラッシュを補正
するためにバックラッシュ補正データ(位置のデータ)
を与える。デジタルサーボ回路のプロセッサ(c p
u)はこのバックラッシュ補正データを受信すると、バ
ックラッシュ補正手段13によりエラーカウンタ10に
このバックラッシュ補正データを加算する。この補正デ
ータはポジションゲインKpを通じて速度ループ12に
作用するが、サーボ系の遅れのために機械はすぐには動
かず、象限突起が生じる。
ブロック図で、CNC(コンピュータ内臓の数値制御装
置)はデジタルサーボ回路側に位置指令、及び位置指令
の符号か反転するときに機械系のバックラッシュを補正
するためにバックラッシュ補正データ(位置のデータ)
を与える。デジタルサーボ回路のプロセッサ(c p
u)はこのバックラッシュ補正データを受信すると、バ
ックラッシュ補正手段13によりエラーカウンタ10に
このバックラッシュ補正データを加算する。この補正デ
ータはポジションゲインKpを通じて速度ループ12に
作用するが、サーボ系の遅れのために機械はすぐには動
かず、象限突起が生じる。
そこで、位置のバックラッシュ補正と共に速度指令VC
MDにも適当な値(加速量)を加えて、サーボモータの
反転方向に加速を行うが、CNCがバックラッシュ補正
データを送出するのと同時にサーボソフト内部(デジタ
ルサーボ回路内)でバックラッシュ加速を行うと、サー
ボモータが完全に方向反転をしていないために、逆に円
弧切削面を内側にくい込んで切削してしまう不具合が生
じる。すなわち、エラーカウンタ10で示される位置偏
差にポジションゲインKPを乗じて得られる速度指令が
完全に逆転しないうちに、バックラッシュ加速が行われ
て切削面が内側にくい込んで切削されることとなる。
MDにも適当な値(加速量)を加えて、サーボモータの
反転方向に加速を行うが、CNCがバックラッシュ補正
データを送出するのと同時にサーボソフト内部(デジタ
ルサーボ回路内)でバックラッシュ加速を行うと、サー
ボモータが完全に方向反転をしていないために、逆に円
弧切削面を内側にくい込んで切削してしまう不具合が生
じる。すなわち、エラーカウンタ10で示される位置偏
差にポジションゲインKPを乗じて得られる速度指令が
完全に逆転しないうちに、バックラッシュ加速が行われ
て切削面が内側にくい込んで切削されることとなる。
また、バックラッシュ加速量が大きすぎると、バックラ
ッシュや摩擦トルクを補正する以上に内側へ切り込むこ
とにもなる。
ッシュや摩擦トルクを補正する以上に内側へ切り込むこ
とにもなる。
そこで、サーボコントローラはエラーカウンタの値を監
視し、エラーカウンタの値の符号が反転したとき、モー
タの回転方向が反転したタイミングとみなし、バックラ
ッシュ加速を行うようにしている。さらには、速度指令
VCMDは位置偏差e(1)にポジションゲインを乗じ
た値であるので、チエツクボードを通して速度指令VC
MDをアナログ信号として観測し、速度指令VCMDの
波形が理想的な位置偏差e(1)に対応する速度指令(
KP −e (1) )に近くなるようにバックラッ
シュ加速量、加速時間を調整している。
視し、エラーカウンタの値の符号が反転したとき、モー
タの回転方向が反転したタイミングとみなし、バックラ
ッシュ加速を行うようにしている。さらには、速度指令
VCMDは位置偏差e(1)にポジションゲインを乗じ
た値であるので、チエツクボードを通して速度指令VC
MDをアナログ信号として観測し、速度指令VCMDの
波形が理想的な位置偏差e(1)に対応する速度指令(
KP −e (1) )に近くなるようにバックラッ
シュ加速量、加速時間を調整している。
そして、バックラッシュ加速後、位置のフィードバック
パルスを積算し、その積算値がある値以上になるとバッ
クラッシュ加速を停止させる等の制御を行っている。
パルスを積算し、その積算値がある値以上になるとバッ
クラッシュ加速を停止させる等の制御を行っている。
発明が解決しようとする課題
上述した従来のバックラッシュ加速補正においては、バ
ックラッシュ加速量、加速時間等のパラメータの決定が
試行錯誤的に行われており、しかもこれらのパラメータ
の決定は厳密に決定しなければならない。
ックラッシュ加速量、加速時間等のパラメータの決定が
試行錯誤的に行われており、しかもこれらのパラメータ
の決定は厳密に決定しなければならない。
さらに、サーホモータの負荷や切削速度によってバック
ラッシュ加速量、加速時間等のパラメータの最適値も異
なり、ある条件で最適値に調整しても、切削条件か変わ
ると、最適値ではなくなり、象限突起や切り込みを生し
てしまうという欠点がある。
ラッシュ加速量、加速時間等のパラメータの最適値も異
なり、ある条件で最適値に調整しても、切削条件か変わ
ると、最適値ではなくなり、象限突起や切り込みを生し
てしまうという欠点がある。
特に、位置偏差が±1パルスでの方向反転の様な状況で
は、送り軸の動きかバックラッシュ内で行われるために
、摩擦や負荷か少なくバックラッシュ加速量で極めて過
剰な応答になってしまう。
は、送り軸の動きかバックラッシュ内で行われるために
、摩擦や負荷か少なくバックラッシュ加速量で極めて過
剰な応答になってしまう。
そこで、本発明の目的は、切削条件等の変動かあっても
最適なバックラッシュ補正を自動的に行うことができる
サーホモータの制御方式を提供することにある。
最適なバックラッシュ補正を自動的に行うことができる
サーホモータの制御方式を提供することにある。
課題を解決するための手段
本発明は、方向反転直前の速度制御ループ積分器の逆符
号の値を目標値とし、方向反転以降の設定時間内の各速
度制御ループ処理においては、上記目標値から各速度制
御ループ処理における積分器の値を減じた値に、定数を
乗したものを、各速度制御ループ処理におけるバックラ
ッシュ加速量として、バックラッシュ加速補正を行う。
号の値を目標値とし、方向反転以降の設定時間内の各速
度制御ループ処理においては、上記目標値から各速度制
御ループ処理における積分器の値を減じた値に、定数を
乗したものを、各速度制御ループ処理におけるバックラ
ッシュ加速量として、バックラッシュ加速補正を行う。
特に上記定数は、方向反転時の切削速度に比例する値と
する。又、切削速度を方向反転時の位置偏差の平方根に
よって推定し、この平方根に比例する値を上記定数とす
る。さらに、バックラッシュ加速補正を行う−F記所定
時間は、上記定数によって決まる速度制御ループ積分器
の反転時定数に応じて決定する。
する。又、切削速度を方向反転時の位置偏差の平方根に
よって推定し、この平方根に比例する値を上記定数とす
る。さらに、バックラッシュ加速補正を行う−F記所定
時間は、上記定数によって決まる速度制御ループ積分器
の反転時定数に応じて決定する。
作 用
送り軸の移動方向の反転直前及び直後は速度指令、及び
モータの実速度、即ち、速度フィードバック値も「0」
に近い値である。そして、サーホモータから出力される
トルクも摩擦トルクに対応する程度のものである。その
結果、速度制御ループから出力されるトルク指令は、速
度指令及び速度フィードバック値か10」に近いもので
あるから、比例項の出力は無視でき、はとんど積分器の
出力であり、この積分器の出力が摩擦トルクに対応して
いる。そして、移動方向が反転すれば摩擦力も反転する
ものであるから、積分器の出力の符号を反転させて出力
させれば、バックラッシュは過不足なく急速に補正され
ることとなる。
モータの実速度、即ち、速度フィードバック値も「0」
に近い値である。そして、サーホモータから出力される
トルクも摩擦トルクに対応する程度のものである。その
結果、速度制御ループから出力されるトルク指令は、速
度指令及び速度フィードバック値か10」に近いもので
あるから、比例項の出力は無視でき、はとんど積分器の
出力であり、この積分器の出力が摩擦トルクに対応して
いる。そして、移動方向が反転すれば摩擦力も反転する
ものであるから、積分器の出力の符号を反転させて出力
させれば、バックラッシュは過不足なく急速に補正され
ることとなる。
そこで本発明は、方向反転直前の速度制御ループの積分
器の値の符号を逆転した値を目標値とし、切削条件が変
動しても影響がでない程度の時間内に該積分器の出力値
が上記目標値に達するように定数を定め、方向反転開始
以降、設定所定時間内、上記目標値から各速度制御ルー
プの積分器の値を減じた値に上記設定定数を乗じて、各
速度制御ループ処理時のバックラッシュ加速量としてバ
ックラッシュ加速補正を行う。
器の値の符号を逆転した値を目標値とし、切削条件が変
動しても影響がでない程度の時間内に該積分器の出力値
が上記目標値に達するように定数を定め、方向反転開始
以降、設定所定時間内、上記目標値から各速度制御ルー
プの積分器の値を減じた値に上記設定定数を乗じて、各
速度制御ループ処理時のバックラッシュ加速量としてバ
ックラッシュ加速補正を行う。
さらに、方向か反転する時間は切削速度に反比例するこ
とが望ましい。即ち、積分器の反転時定数を切削速度に
反比例比例させる事が望ましいことから、方向反転時の
切削速度がわかっていれば、この切削速度に比例して上
記定数を決定する。又、方向反転時の切削速度がわかっ
ていない場合には、指令反転時の位置偏差の平方根が切
削速度に比例することを利用して上記定数を切削速度に
比例した値とする。こうして上記定数を切削速度に比例
させると、上記定数と反転時定数は反比例関係にあるこ
とから、バックラッシュ加速補正を行う上記所定時間(
反転時定数の2〜3倍)も予ずから決まり、上記定数に
応じて、バックラッシュ加速補正時間も決定する。
とが望ましい。即ち、積分器の反転時定数を切削速度に
反比例比例させる事が望ましいことから、方向反転時の
切削速度がわかっていれば、この切削速度に比例して上
記定数を決定する。又、方向反転時の切削速度がわかっ
ていない場合には、指令反転時の位置偏差の平方根が切
削速度に比例することを利用して上記定数を切削速度に
比例した値とする。こうして上記定数を切削速度に比例
させると、上記定数と反転時定数は反比例関係にあるこ
とから、バックラッシュ加速補正を行う上記所定時間(
反転時定数の2〜3倍)も予ずから決まり、上記定数に
応じて、バックラッシュ加速補正時間も決定する。
以上のようにして、速度制御ループの積分器は設定所定
時間内に目標値に収束することとなり、どのような切削
条件においても、バックラッシュ加速量の不足及びかけ
すぎは生ぜず、最適なバックラッシュ加速補正制御がで
きる。
時間内に目標値に収束することとなり、どのような切削
条件においても、バックラッシュ加速量の不足及びかけ
すぎは生ぜず、最適なバックラッシュ加速補正制御がで
きる。
実施例
第2図は速度制御ループ、電流制御ループを含む位置制
御ループ系のブロック図で、ブロック1のKPは位置制
御ループのポジションゲイン、ブロック2.ブロック3
は速度制御ループの積分項。
御ループ系のブロック図で、ブロック1のKPは位置制
御ループのポジションゲイン、ブロック2.ブロック3
は速度制御ループの積分項。
比例項で、klは積分ゲイン、k2は比例ゲイン、ブロ
ック4は電流制御ループ及びPWMインバータ等の電力
増幅器、ブロック5.6はサーボモータの伝達関数で、
Klはトルク定数、Jmはイナーシャ、ブロック7はサ
ーボモータの速度を積分して位置を求める伝達関数であ
る。
ック4は電流制御ループ及びPWMインバータ等の電力
増幅器、ブロック5.6はサーボモータの伝達関数で、
Klはトルク定数、Jmはイナーシャ、ブロック7はサ
ーボモータの速度を積分して位置を求める伝達関数であ
る。
数値制御装置から出力された位置指令からサーボモータ
に取付けられたパルスコーダ等からの位置フィードバッ
ク値を減じて位置偏差を求め、該位置偏差にポジション
ゲインKPを乗じて速度指令VCMDを求め、該速度指
令VCMDとパルスコーダ等で検出されるサーボモータ
の実速度の速度フィードバック値より、速度制御ループ
の積分比例制御を行ってトルク指令TCMDを求め、電
流制御ループ処理を行って、電力増幅器によってサーボ
モータを駆動するものである。
に取付けられたパルスコーダ等からの位置フィードバッ
ク値を減じて位置偏差を求め、該位置偏差にポジション
ゲインKPを乗じて速度指令VCMDを求め、該速度指
令VCMDとパルスコーダ等で検出されるサーボモータ
の実速度の速度フィードバック値より、速度制御ループ
の積分比例制御を行ってトルク指令TCMDを求め、電
流制御ループ処理を行って、電力増幅器によってサーボ
モータを駆動するものである。
上記位置制御ループ系の構成1作用はすてに公知のもの
であり、CNC装置(コンピュータ内臓数値制御装置)
から構成される装置指令を受けて、上記電流制御ループ
処理までをプロセッサで処理するソフトウェアサーボ(
デジタルサーボ)もすでに公知であり、本発明もソフト
ウェアサーボによって行うものである。
であり、CNC装置(コンピュータ内臓数値制御装置)
から構成される装置指令を受けて、上記電流制御ループ
処理までをプロセッサで処理するソフトウェアサーボ(
デジタルサーボ)もすでに公知であり、本発明もソフト
ウェアサーボによって行うものである。
ところで、サーボモータで駆動される送り軸の移動方向
が反転する直前及び直後を考えると、ある方向の速度指
令VCMDが10」に近づき「0」になって、次に速度
指令VCMDは反転するものであるから、反転直前、直
後は速度指令VCMD、及びモータの実速度である速度
フィードバック値は「0」に近い値である。その結果、
速度制御ループの出力は比例項の影響は少なく無視てき
る小さな値であり、積分器の出力が速度制御ループの出
力、即ち、トルク指令となっている。
が反転する直前及び直後を考えると、ある方向の速度指
令VCMDが10」に近づき「0」になって、次に速度
指令VCMDは反転するものであるから、反転直前、直
後は速度指令VCMD、及びモータの実速度である速度
フィードバック値は「0」に近い値である。その結果、
速度制御ループの出力は比例項の影響は少なく無視てき
る小さな値であり、積分器の出力が速度制御ループの出
力、即ち、トルク指令となっている。
又、一方、速度が「0」に近づき「0」になるものであ
るから反転直前のモータの出力トルクは摩擦力程度のも
のである。その結果、反転直前の速度制御ループの積分
器の出力が摩擦トルクとほぼ等しいことを意味する。そ
して、移動方向が反転すれば摩擦力の方向も反転するか
ら、方向反転後速かに摩擦力に対応する程度のトルクを
サーボモータに出力させれば、バックラッシュの補正の
ためには過不足ないこととなる。即ち、第3図に示すよ
うに移動方向反転時(速度指令VCMDの符号反転時)
においては、速度指令VCMD及び速度フィードバック
値は「0」に近く、トルク指令TCMDは摩擦トルクA
程度のものであり、例えば、方向反転直前のトルク指令
TCMDが負方向の摩擦トルクAに対応する程度のもの
であれば、方向反転後、正方向のこの摩擦トルクA分を
トルク指令TCMDとすれば、バックラッシュは速かに
補正されることとなる。即ち、第3図においてトルク指
令TCMDが−Aから+Aに反転する時間Tを短縮する
ほどよいことになる。しかし、バックラッシュ加速量が
大きすぎて、反転後にトルク指令TCMDが摩擦トルク
Aをオーバシュートしすぎては、加工面に切り込みが生
じることとなる。
るから反転直前のモータの出力トルクは摩擦力程度のも
のである。その結果、反転直前の速度制御ループの積分
器の出力が摩擦トルクとほぼ等しいことを意味する。そ
して、移動方向が反転すれば摩擦力の方向も反転するか
ら、方向反転後速かに摩擦力に対応する程度のトルクを
サーボモータに出力させれば、バックラッシュの補正の
ためには過不足ないこととなる。即ち、第3図に示すよ
うに移動方向反転時(速度指令VCMDの符号反転時)
においては、速度指令VCMD及び速度フィードバック
値は「0」に近く、トルク指令TCMDは摩擦トルクA
程度のものであり、例えば、方向反転直前のトルク指令
TCMDが負方向の摩擦トルクAに対応する程度のもの
であれば、方向反転後、正方向のこの摩擦トルクA分を
トルク指令TCMDとすれば、バックラッシュは速かに
補正されることとなる。即ち、第3図においてトルク指
令TCMDが−Aから+Aに反転する時間Tを短縮する
ほどよいことになる。しかし、バックラッシュ加速量が
大きすぎて、反転後にトルク指令TCMDが摩擦トルク
Aをオーバシュートしすぎては、加工面に切り込みが生
じることとなる。
そこで、方向反転時に、方向反転直前の速度制御ループ
の積分器の出力(摩擦トルク相当)への符号を反転させ
た値を目標値としてセットし、第4図に示すように、上
記目標値にトルク指令TCMD (反転後の積分器の出
力)が収束するようにバックラッシュ加速を行う。
の積分器の出力(摩擦トルク相当)への符号を反転させ
た値を目標値としてセットし、第4図に示すように、上
記目標値にトルク指令TCMD (反転後の積分器の出
力)が収束するようにバックラッシュ加速を行う。
この場合、方向反転直前の積分器出力の逆符号の値を、
方向反転後の積分器(トルク指令)の目標値としてセッ
トし、設定時間中、各速度制御ループ処理毎、目標値か
ら現在の積分器の出力を減した値に、定数k(0<k<
1)を乗じてノ<・ツクラッシュ加速量を計算し、この
加速量を速度指令に加算して加速を行うと、第4図に示
すような応答が得られる。
方向反転後の積分器(トルク指令)の目標値としてセッ
トし、設定時間中、各速度制御ループ処理毎、目標値か
ら現在の積分器の出力を減した値に、定数k(0<k<
1)を乗じてノ<・ツクラッシュ加速量を計算し、この
加速量を速度指令に加算して加速を行うと、第4図に示
すような応答が得られる。
第4図において、方向反転時をn=oとし、n回目の積
分器のを出力をS (n)とすると次の第(1)式が成
立する。
分器のを出力をS (n)とすると次の第(1)式が成
立する。
S (n+1) =S (n) 十k (A−3(n)
)(1−k) S (n) +kA ・・・ (1) 一方、第4図において、方向反転時の時刻を「0」とし
、時刻tにおける積分器の出力をS(t)9反転時定数
をτとすると、次の第(2)式が成立する。
)(1−k) S (n) +kA ・・・ (1) 一方、第4図において、方向反転時の時刻を「0」とし
、時刻tにおける積分器の出力をS(t)9反転時定数
をτとすると、次の第(2)式が成立する。
5(t)−A(1−2e”’) −(2)サンプ
リング系で考え、サンプリングタイムをΔtとすれば、
第(1)式より S(t+Δt) =A (12e (1゛6+l/−)
=A(l Ll e−1/′、 e−6+/+ )=
A A e−AI/+ +A e−61/ l A
2 eA +/ + 、 e−1/ j=A (1−
e ”” ) 十e ”°” ・A (1−2e ”)
=e−”” ・S (t) +A (1−e−””
)・・・(3) 上記第(1)式、第(3)式を比較し、S(を十Δt)
−8(n+1.) 、S (t) =S (n)とす
ると、次の第(4)式、第(5)式が成立する。
リング系で考え、サンプリングタイムをΔtとすれば、
第(1)式より S(t+Δt) =A (12e (1゛6+l/−)
=A(l Ll e−1/′、 e−6+/+ )=
A A e−AI/+ +A e−61/ l A
2 eA +/ + 、 e−1/ j=A (1−
e ”” ) 十e ”°” ・A (1−2e ”)
=e−”” ・S (t) +A (1−e−””
)・・・(3) 上記第(1)式、第(3)式を比較し、S(を十Δt)
−8(n+1.) 、S (t) =S (n)とす
ると、次の第(4)式、第(5)式が成立する。
(l−k) −e””’“ ・・・(4)k−
(1・e ’ h““) ・・・(5)上記第
(4)式、第(5)式より次の第(6)式が成立する。
(1・e ’ h““) ・・・(5)上記第
(4)式、第(5)式より次の第(6)式が成立する。
τ−Δt/1n 1 ・・・(6)1−に
ただし、Inは自然対数記号である。
速度制御ループのサンプリングタイムを10.。5程度
とすると、上記定数には大きくて0.1程度であり、第
(6)式より反転時定数の逆数1/τと定数にの関係を
図に表すと第5図のようになり、反転時定数の逆数1/
τと定数には比例関係にある。
とすると、上記定数には大きくて0.1程度であり、第
(6)式より反転時定数の逆数1/τと定数にの関係を
図に表すと第5図のようになり、反転時定数の逆数1/
τと定数には比例関係にある。
一方、切削速度が速ければ速いほど方向が反転する時間
(積分器が−Aから+Aに反転する時間)は短い事が望
ましい。即ち、反転時定数τは切削速度に反比例させる
必要がある。
(積分器が−Aから+Aに反転する時間)は短い事が望
ましい。即ち、反転時定数τは切削速度に反比例させる
必要がある。
前述したように、反転時定数τの逆数1/τと上記定数
には第5図に示すように比例関係にあるので切削速度に
比例して定数kを変えれば方向が変転する時間は切削速
度に反比例して切削速度が犬になるほど反転時間は短く
なることになる。
には第5図に示すように比例関係にあるので切削速度に
比例して定数kを変えれば方向が変転する時間は切削速
度に反比例して切削速度が犬になるほど反転時間は短く
なることになる。
その結果、方向反転時の切削速度に比例して上記定数k
を決めればよく、又、定数kが決まれば、反転時定数τ
も第5図に示す関係から自ずから決まり、反転時定数で
の2〜3倍をバ・ソクラ・ソシュ加速時間Tとすればよ
い。
を決めればよく、又、定数kが決まれば、反転時定数τ
も第5図に示す関係から自ずから決まり、反転時定数で
の2〜3倍をバ・ソクラ・ソシュ加速時間Tとすればよ
い。
また、直接切削速度が判らないときには、次のようにし
て、位置偏差量から切削速度を推定する。
て、位置偏差量から切削速度を推定する。
例えばX−Y2軸で半径Rの円弧を第6図に示す様に切
削しているとする X軸の移動指令方向が反転し、Y軸の移動方向は反転し
ないとき、即ち、第6図における点Aの位置指令のとき
時間1=0となるように時間軸をとるとX軸の位置指令
m、(t)は次の第(7)式となる。
削しているとする X軸の移動指令方向が反転し、Y軸の移動方向は反転し
ないとき、即ち、第6図における点Aの位置指令のとき
時間1=0となるように時間軸をとるとX軸の位置指令
m、(t)は次の第(7)式となる。
m、 (t)=Rcosωt −(7)なお
、ωは角速度で指令速度をFとするとωF /’ Rと
なる。
、ωは角速度で指令速度をFとするとωF /’ Rと
なる。
一方、速度制御ループを理想化して位置制御ルプを単純
化すると第7図のブロック線図となる。
化すると第7図のブロック線図となる。
なお、Kpはポジションゲインである。
X軸の機械位置をP (t)、X軸の位置偏差をe (
t)すると、X軸の位置偏差e (t)は次の第(8)
式となる。
t)すると、X軸の位置偏差e (t)は次の第(8)
式となる。
e (t) −m (t)−P (t)
−(8)上記第(8)式をラプラス変換すると次の第(
9)式となる。
−(8)上記第(8)式をラプラス変換すると次の第(
9)式となる。
E (S) −M (s) −P (s) ・・
・(9)上記第(9)式と第7図のブロック線図よりP
(S) −(Kp /S) ・E (S)(
Kp /S) (M (S)−P (S))・・(
10) 上記第(10) 式より、 一方、X軸の位置指令m、(t)のラプラス変換M (
S)は次のようになる。
・(9)上記第(9)式と第7図のブロック線図よりP
(S) −(Kp /S) ・E (S)(
Kp /S) (M (S)−P (S))・・(
10) 上記第(10) 式より、 一方、X軸の位置指令m、(t)のラプラス変換M (
S)は次のようになる。
M (S)
L [m、(t)]
=L[Rcosωtコ
L [(R/2) ・ (e+−“+e(R/2)・
Xン・・・e−・ j”°)] +e−’−普e “) ・・・(12) 上記第(11)式。
Xン・・・e−・ j”°)] +e−’−普e “) ・・・(12) 上記第(11)式。
第(12)式より
一方、上記第(13)式を部分分数展開を行うとしてと
すると、第(13)式と第(14)式よりa (S2+
ω2) 十b (S+Kp ) (S−jω)+C(
S十Kp )(S十jω) (a+b+c)S2+ ((Kp jω)b+ (K
p+jωKp(c−b)+aω2 上記第(16)式より a+b+c=Q (Kp−jω)b十(K9 +jω)c=KpjoJK
p (c−b) +aω’ =QSKp・・・(15
) +jω) c) S Kp s ・・・(16) ・・・(17) ・・・(18) ・・・(19) 上記第(17) (19) 式を解き、 l b。
すると、第(13)式と第(14)式よりa (S2+
ω2) 十b (S+Kp ) (S−jω)+C(
S十Kp )(S十jω) (a+b+c)S2+ ((Kp jω)b+ (K
p+jωKp(c−b)+aω2 上記第(16)式より a+b+c=Q (Kp−jω)b十(K9 +jω)c=KpjoJK
p (c−b) +aω’ =QSKp・・・(15
) +jω) c) S Kp s ・・・(16) ・・・(17) ・・・(18) ・・・(19) 上記第(17) (19) 式を解き、 l b。
Cを求めると
Kp 2/(Kp 2+ω2)
・・・(20)
Kp
(Kp+jω)/2
(Kp 2+ω2)
・・・(21)
c=Kp
(Kp
jω)/2
(Kp 2+ω2)
・・・(22)
上記第(20)
〜 (21)
式と第
(14)式より
上記第(23)式を逆ラプラス変換すると、p (+)
[P (S) ]
に”+
Kp
(Kp 2+ω2)
i(Kp+jω)
1′’+ (Kp
Jω)
]R
(Kp
CO8ωt+ωS inωt)
・・・(24)
定常状態では第(24)式右辺第1項は「0」となる。
よって、
(1)
m(t)
(1)
(Kp
CO8ωt+ωSinωt)]R
・・・(25)
1=0で
(ω/Kp
)
は高々10
2程度であるので第
(26)
式より第
(27)
式のように近似できる。
第
(27)
式より、
指令の方向反転時の位置側
差量e
(0)
の平方根は切削速度に比例している
ことがわかる。
よって、
この位置偏差e
(0)
の
平方根より切削速度を推定し、
この切削速度より
定数kを決めればよい。
第1図は、ソフトウェアサーボのプロセッサが速度制御
ループ処理周期毎行う処理のフローチャートである。
ループ処理周期毎行う処理のフローチャートである。
まず、エラーカウンタの値、即ち位置偏差の符号が反転
したか否かによってバックラッシュ加速開始か否か判断
しくステップS1)、バックラッシュ加速開始であれば
、当該時点における切削速度より定数に1及びバックラ
ッシュ補正時間Tを算出する。
したか否かによってバックラッシュ加速開始か否か判断
しくステップS1)、バックラッシュ加速開始であれば
、当該時点における切削速度より定数に1及びバックラ
ッシュ補正時間Tを算出する。
前述したように切削速度が直接判るものであれば、この
切削速度により、又、直接切削速度が判らないものであ
れば、方向反転時の位置偏差e(0)の平方根より切削
速度を推定し、これにより定数kを求める。(ステップ
S2)。
切削速度により、又、直接切削速度が判らないものであ
れば、方向反転時の位置偏差e(0)の平方根より切削
速度を推定し、これにより定数kを求める。(ステップ
S2)。
次に速度制御ループ積分器の値(積分器として作用する
アキュムレータの値)を読出し、この値の符号を反転さ
せて目標値Aとしてレジスタにセットする(ステップS
3)。次に、ステップS2で求められたバックラッシュ
加速時間Tを加速カウンタBLCNTにセットしくステ
ップS4)、各速度制御ループ処理におけるバックラッ
シュ加速量を記憶する加速量レジスタBLCMPに、目
標値Aの2倍(目標値と現在の積分器の値の差)にステ
ップS2で求められた定数にの値を乗じた値を格納する
(ステップS5)。次に、位置制御ループで算出された
速度指令VCMDに加速量レジスタBLCMPに格納さ
れた値(2A x k)を加算し、バックラッシュ加速
補正が行われた速度指令きする。そして、この速度指令
により従来と同様の速度制御ループ処理を行ってトルク
指令TCMDを求め、当該周期の速度制御ループ処理を
終了する(ステップS6)。
アキュムレータの値)を読出し、この値の符号を反転さ
せて目標値Aとしてレジスタにセットする(ステップS
3)。次に、ステップS2で求められたバックラッシュ
加速時間Tを加速カウンタBLCNTにセットしくステ
ップS4)、各速度制御ループ処理におけるバックラッ
シュ加速量を記憶する加速量レジスタBLCMPに、目
標値Aの2倍(目標値と現在の積分器の値の差)にステ
ップS2で求められた定数にの値を乗じた値を格納する
(ステップS5)。次に、位置制御ループで算出された
速度指令VCMDに加速量レジスタBLCMPに格納さ
れた値(2A x k)を加算し、バックラッシュ加速
補正が行われた速度指令きする。そして、この速度指令
により従来と同様の速度制御ループ処理を行ってトルク
指令TCMDを求め、当該周期の速度制御ループ処理を
終了する(ステップS6)。
次の周期ではバックラッシュ加速開始点ではないので、
ステップS1からステップs7へ移行し、加速カウンタ
BLCNTの値が正か否か判断しくステップS7)、正
ならば、目標値Aから速度制御ループのその時点の積分
器の値を減じた値に定数kを乗じて、当該周期のバック
ラッシュ加速量を求め加速量をレジスタBLCMPに格
納シ、加速カウンタBLCNTから「1」を減算する(
1周期分を減算する)(ステップS8.S9)。
ステップS1からステップs7へ移行し、加速カウンタ
BLCNTの値が正か否か判断しくステップS7)、正
ならば、目標値Aから速度制御ループのその時点の積分
器の値を減じた値に定数kを乗じて、当該周期のバック
ラッシュ加速量を求め加速量をレジスタBLCMPに格
納シ、加速カウンタBLCNTから「1」を減算する(
1周期分を減算する)(ステップS8.S9)。
そして、加速量レジスタBLCMPに格納された加速量
を速度指令VCMDに加算しで、この値で速度制御ルー
プ処理を行う(ステップS6)。以下、加速カウンタB
LCNTが0以下になるまでステップSL、37〜S9
.86の処理を各速度制御ループ処理周期毎行う。
を速度指令VCMDに加算しで、この値で速度制御ルー
プ処理を行う(ステップS6)。以下、加速カウンタB
LCNTが0以下になるまでステップSL、37〜S9
.86の処理を各速度制御ループ処理周期毎行う。
設定されたバックラッシュ加速時間Tが経過して、加速
カウンタBLCNTがO以下になると(ステップS7)
、加速量レジスタBLCMPに「0」を格納し、バック
ラッシュ加速補正を行わず、位置制御ループ処理で求め
られた速度指令VCMDにより、通常の速度制御ループ
処理を行うこととなる(ステップ86)。
カウンタBLCNTがO以下になると(ステップS7)
、加速量レジスタBLCMPに「0」を格納し、バック
ラッシュ加速補正を行わず、位置制御ループ処理で求め
られた速度指令VCMDにより、通常の速度制御ループ
処理を行うこととなる(ステップ86)。
なお、第1図に示す実施例では定数に、バックラッシュ
加速補正時間Tを方向反転時の切削速度より算出するよ
うにしたが、切削速度が判っている場合では、予め定数
に、バックラッシュ加速補正時間Tを求めておきパラメ
ータで設定するようにすればよい。この場合には、第1
図のフローチャートにおいてステップS2の処理が必要
なくなる。
加速補正時間Tを方向反転時の切削速度より算出するよ
うにしたが、切削速度が判っている場合では、予め定数
に、バックラッシュ加速補正時間Tを求めておきパラメ
ータで設定するようにすればよい。この場合には、第1
図のフローチャートにおいてステップS2の処理が必要
なくなる。
第9〜12図は、本発明の効果をみるために実験して得
られた速度指令VCMDとトルク指令TCMDの波形を
示す図である。
られた速度指令VCMDとトルク指令TCMDの波形を
示す図である。
第9図はある速度、負荷において、バックラッシュ加速
補正を何ら行わないときの波形を示す図で、第9図中、
破線で示す直線は理想の速度指令VCMDの波形である
。速度指令VCMDの符号が反転した後、速度指令VC
MDは理想の線よりも急激に増大している。即ち、方向
反転により出力トルクは減少し、摩擦のために移動せず
位置偏差か増大し、速度指令が増大している。それにつ
れてトルク指令TCMDも増大し、静摩擦に打ち勝つ程
度のトルク指令TCMDとなると、速度指令VCMDの
増大はなくなっている。これは位置偏差が減少したこと
を意味する。第9図中Qで示すこの点が象限突起を生じ
させる原因である。
補正を何ら行わないときの波形を示す図で、第9図中、
破線で示す直線は理想の速度指令VCMDの波形である
。速度指令VCMDの符号が反転した後、速度指令VC
MDは理想の線よりも急激に増大している。即ち、方向
反転により出力トルクは減少し、摩擦のために移動せず
位置偏差か増大し、速度指令が増大している。それにつ
れてトルク指令TCMDも増大し、静摩擦に打ち勝つ程
度のトルク指令TCMDとなると、速度指令VCMDの
増大はなくなっている。これは位置偏差が減少したこと
を意味する。第9図中Qで示すこの点が象限突起を生じ
させる原因である。
一方、第10図(a)は、第9図と同一の条件で、従来
の方式によってバックラッシュ加速量。
の方式によってバックラッシュ加速量。
加速時間をベストの状態に調整したときの各波形を示す
ものであり、第10図(b)は、同様の条件で本発明を
適用したときの各波形を示すもので、この第10図(a
)、 (b)に示すように本発明の方式の方が速度指
令VCMDが理想的に直線的に変化し、突起が生じない
ことがわかる。又、トルク指令TCMDの変動も少なく
、トルク指令が速やかに反転していることがわかる。
ものであり、第10図(b)は、同様の条件で本発明を
適用したときの各波形を示すもので、この第10図(a
)、 (b)に示すように本発明の方式の方が速度指
令VCMDが理想的に直線的に変化し、突起が生じない
ことがわかる。又、トルク指令TCMDの変動も少なく
、トルク指令が速やかに反転していることがわかる。
第11図(a)は、第10図(a)の切削条件において
、速度を半分にしバックラッシュ加速量。
、速度を半分にしバックラッシュ加速量。
加速時間は同一としたときの従来方式による各波形を示
すもので、これに対し同じ切削条件で本発明を適用した
ときの各波形を第11図(b)に示す。この第11図(
a)、 (b)に示すように速度が半分になり切削条
件が変更されても、本発明の方式の方が、速度指令VC
MDは直線的に変化し、象限突起が生じないことがわか
る。又、トルク指令TCMDの反転も、本発明の方が速
やかに行われトルク変動もない。
すもので、これに対し同じ切削条件で本発明を適用した
ときの各波形を第11図(b)に示す。この第11図(
a)、 (b)に示すように速度が半分になり切削条
件が変更されても、本発明の方式の方が、速度指令VC
MDは直線的に変化し、象限突起が生じないことがわか
る。又、トルク指令TCMDの反転も、本発明の方が速
やかに行われトルク変動もない。
第12図(a)、 (b)は第11図(a)。
(b)と同じ条件で負荷をなくしたときの各波形を示す
図で、従来の方式の第12図(a)の波形は速度指令V
CMDが直線的ではなく、象限と突起及び切り込みが生
じ、又、トルク指令T CMDも大きく変動しているが
、本発明の方式の第12図(b)では、速度指令VCM
Dは直線的に変化し、トルク指令TCMDも変動がなく
速やかに切換わっている。
図で、従来の方式の第12図(a)の波形は速度指令V
CMDが直線的ではなく、象限と突起及び切り込みが生
じ、又、トルク指令T CMDも大きく変動しているが
、本発明の方式の第12図(b)では、速度指令VCM
Dは直線的に変化し、トルク指令TCMDも変動がなく
速やかに切換わっている。
発明の効果
本発明は、速度制御ループの積分器の出力を用いてバッ
クラッシュ加速量を自動的に補正するようにしたので、
切削条件が変動しても常に最適なバックラッシュ加速量
が得られ、象限突起、内側への切り込みをほとんどなく
した最適なバックラッシュ補正を行うことができる。
クラッシュ加速量を自動的に補正するようにしたので、
切削条件が変動しても常に最適なバックラッシュ加速量
が得られ、象限突起、内側への切り込みをほとんどなく
した最適なバックラッシュ補正を行うことができる。
第1図は本発明の一実施例のフローチャート、第2図は
本発明を適用する位置制御ループ系のブロック図、第3
図は方向反転時のトルク指令の説明図、第4図は本発明
による方向反転時の積分器出力(トルク指令)の説明図
、第5図は定数にと反転時点数の逆数1/τの関係を表
す説明図、第6図はX−Y2軸円弧切削の説明図、第7
図は速度制御ループを理想化して位置制御ループを簡略
化したブロック線図、第8図はバックラッシュ補正の説
明図、第9図はバックラッシュ補正を行わないときの方
向反転時の速度指令、トルク指令の波形を示す図、第1
0図(a)、 (b)、第11図(a)、 (b)
、第12図(a)、 (b)は従来方式のバックラッ
シュ加速補正と、本発明の方式のバックラッシュ加速補
正により切削条件を変えて得られた速度指令、トルク指
令の波形を示す図である。 KP・・位置ループゲイン、kl・・・速度制御ループ
の積分ゲイン、K2・・・速度制御ループの比例ゲイン
、4・・・電流制御ループ及び電力増幅器、K1・・・
トルク定数、Jm・・・イナーシャ、VCMD・・・速
度指令、T CMD・・・トルク指令。 第 5 呪 U] Ji Jj ・υ4 ・υ5 い t ・υご 力 に 第 図 第 因 第10 因(bl
本発明を適用する位置制御ループ系のブロック図、第3
図は方向反転時のトルク指令の説明図、第4図は本発明
による方向反転時の積分器出力(トルク指令)の説明図
、第5図は定数にと反転時点数の逆数1/τの関係を表
す説明図、第6図はX−Y2軸円弧切削の説明図、第7
図は速度制御ループを理想化して位置制御ループを簡略
化したブロック線図、第8図はバックラッシュ補正の説
明図、第9図はバックラッシュ補正を行わないときの方
向反転時の速度指令、トルク指令の波形を示す図、第1
0図(a)、 (b)、第11図(a)、 (b)
、第12図(a)、 (b)は従来方式のバックラッ
シュ加速補正と、本発明の方式のバックラッシュ加速補
正により切削条件を変えて得られた速度指令、トルク指
令の波形を示す図である。 KP・・位置ループゲイン、kl・・・速度制御ループ
の積分ゲイン、K2・・・速度制御ループの比例ゲイン
、4・・・電流制御ループ及び電力増幅器、K1・・・
トルク定数、Jm・・・イナーシャ、VCMD・・・速
度指令、T CMD・・・トルク指令。 第 5 呪 U] Ji Jj ・υ4 ・υ5 い t ・υご 力 に 第 図 第 因 第10 因(bl
Claims (4)
- (1)サーボモータを用いて駆動される工作機械の送り
軸の方向反転時のバックラッシュ加速補正において、方
向反転直前の速度制御ループ積分器の逆符号の値を目標
値とし、方向反転以降の所定時間内の各速度制御ループ
処理においては、上記目標値から各速度制御ループ処理
における積分器の値を減じた値に、定数を乗じたものを
、各速度制御ループ処理におけるバックラッシュ加速量
としたことを特徴とするサーボモータの制御方式。 - (2)サーボモータを用いて駆動される工作機械の送り
軸の方向反転時のバックラッシュ加速補正において、方
向反転直前の速度制御ループ積分器の逆符号の値を目標
値とし、方向反転以降の所定時間内の各速度制御ループ
処理においては、上記目標値から各速度制御ループにお
ける積分器の値を減じた値に、方向反転時の切削速度に
比例する値を乗じ、得られた値を各速度制御ループ処理
におけるバックラッシュ加速量としたことを特徴とする
サーボモータの制御方式。 - (3)サーボモータを用いて駆動される工作機械の送り
軸の方向反転時のバックラッシュ加速補正において、方
向反転直前の速度制御ループ積分器の逆符号の値を目標
値とし、方向反転以降の所定時間内の各速度制御ループ
処理においては、上記目標値から各速度制御ループにお
ける積分器の値を減じた値に、位置指令が方向反転した
瞬間の位置偏差量の平方根に比例する値を乗じ、得られ
た値を各速度制御ループ処理におけるバックラッシュ加
速量としたことを特徴とするサーボモータの制御方式。 - (4)バックラッシュ加速補正を行う上記所定時間は、
上記目標値から各速度制御ループ処理における積分器の
値を減じた値に乗じる値に応じて決定する事を特徴とす
る請求項1、請求項2又は請求項3記載のサーボモータ
の制御方式。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008347A JP2709969B2 (ja) | 1989-12-12 | 1990-01-19 | サーボモータの制御方法 |
US07/741,447 US5204602A (en) | 1989-12-12 | 1990-12-10 | Servomotor control method |
PCT/JP1990/001608 WO1991009358A1 (en) | 1989-12-12 | 1990-12-10 | Servo motor control method |
EP91900368A EP0460224B1 (en) | 1989-12-12 | 1990-12-10 | Servo motor control method |
DE69025321T DE69025321T2 (de) | 1989-12-12 | 1990-12-10 | Verfahren zur steuerung eines servomotors |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP32055289 | 1989-12-12 | ||
JP1-320552 | 1989-12-12 | ||
JP2008347A JP2709969B2 (ja) | 1989-12-12 | 1990-01-19 | サーボモータの制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH03228106A true JPH03228106A (ja) | 1991-10-09 |
JP2709969B2 JP2709969B2 (ja) | 1998-02-04 |
Family
ID=26342843
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2008347A Expired - Fee Related JP2709969B2 (ja) | 1989-12-12 | 1990-01-19 | サーボモータの制御方法 |
Country Status (5)
Country | Link |
---|---|
US (1) | US5204602A (ja) |
EP (1) | EP0460224B1 (ja) |
JP (1) | JP2709969B2 (ja) |
DE (1) | DE69025321T2 (ja) |
WO (1) | WO1991009358A1 (ja) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0527845A (ja) * | 1991-07-22 | 1993-02-05 | Okuma Mach Works Ltd | 制御パラメータ変更機能を有する数値制御装置 |
JPH0540521A (ja) * | 1991-08-07 | 1993-02-19 | Mitsubishi Electric Corp | サーボモータの制御装置 |
WO1994025910A1 (en) * | 1993-04-28 | 1994-11-10 | Shunsuke Matsubara | Method for controlling servomotor |
WO1995005703A1 (fr) * | 1993-08-19 | 1995-02-23 | Fanuc Ltd | Appareil et procede pour commander un servomoteur |
WO2022124150A1 (ja) * | 2020-12-08 | 2022-06-16 | スター精密株式会社 | 工作機械 |
Families Citing this family (32)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3083870B2 (ja) * | 1991-05-10 | 2000-09-04 | ファナック株式会社 | 数値制御装置 |
JP2826391B2 (ja) * | 1991-05-24 | 1998-11-18 | ファナック株式会社 | バックラッシ加速制御方法 |
JP2875646B2 (ja) * | 1991-07-04 | 1999-03-31 | ファナック株式会社 | バックラッシ加速補正装置 |
JP2697399B2 (ja) * | 1991-09-13 | 1998-01-14 | 三菱電機株式会社 | 位置決め装置及びそのプログラム表示方法 |
JP3176705B2 (ja) * | 1992-04-30 | 2001-06-18 | 本田技研工業株式会社 | アクチュエータの駆動方法 |
US5327059A (en) * | 1992-09-24 | 1994-07-05 | Archive Corporation | Tape drive capstan motor servo system with static friction compensation |
JP2833730B2 (ja) * | 1993-03-10 | 1998-12-09 | 三菱電機株式会社 | 位置制御装置 |
ATE171551T1 (de) * | 1994-04-08 | 1998-10-15 | Siemens Ag | Einrichtung zur kompensation von nichtlinearitäten an maschinenachsen |
JPH0866893A (ja) * | 1994-08-24 | 1996-03-12 | Fanuc Ltd | 衝突検出方法 |
CH690661A5 (de) * | 1994-11-03 | 2000-11-30 | Bosch Gmbh Robert | Verfahren zur Kompensation der Anfahrreibung eines Antriebs. |
JPH08231075A (ja) | 1994-11-22 | 1996-09-10 | Xerox Corp | 高精度速度制御装置及び方法 |
DE4441620A1 (de) * | 1994-11-23 | 1996-05-30 | Bosch Gmbh Robert | Verfahren zur Steuerung eines Servoantriebs |
US5710498A (en) * | 1994-12-06 | 1998-01-20 | Trinova Corporation | Method and apparatus for friction compensation |
JP3481004B2 (ja) * | 1995-02-02 | 2003-12-22 | ファナック株式会社 | 外乱オブザーバを使用したバックラッシュ補正方法 |
JPH0969013A (ja) * | 1995-08-31 | 1997-03-11 | Fanuc Ltd | サーボモータを用いたサーボ系の制御モード切り換え方法 |
JP3169838B2 (ja) * | 1996-08-21 | 2001-05-28 | 東芝機械株式会社 | サーボモータの制御方法 |
JP3215067B2 (ja) * | 1997-03-21 | 2001-10-02 | ファナック株式会社 | 移動方向反転時の位置補正方法 |
WO1999044108A1 (en) * | 1998-02-27 | 1999-09-02 | Mitsubishi Denki Kabushiki Kaisha | Synchronization controller |
DE19983362T1 (de) * | 1999-05-14 | 2001-08-16 | Mitsubishi Electric Corp | Servosteuervorrichtung |
DE69934251T2 (de) | 1999-10-20 | 2007-07-05 | Makino Milling Machine Co. Ltd. | Nc-werkzeugmaschine und verfahren zur steuerung der nc-werkzeugmaschine |
JP3923047B2 (ja) * | 2003-03-04 | 2007-05-30 | ファナック株式会社 | 同期制御装置 |
WO2004103649A1 (ja) * | 2003-05-20 | 2004-12-02 | Fujitsu Limited | バックラッシュ補償制御方法、バックラッシュ補償制御装置およびバックラッシュ補償制御プログラム |
KR100923822B1 (ko) * | 2005-05-31 | 2009-10-27 | 미쓰비시덴키 가부시키가이샤 | 전동기 제어 장치 |
SE530380C2 (sv) * | 2006-10-03 | 2008-05-20 | Abb Ab | Automatisk uppskattning av glapp |
JP5096019B2 (ja) * | 2007-02-26 | 2012-12-12 | オークマ株式会社 | サーボモータ制御装置 |
JP5845433B2 (ja) * | 2010-03-08 | 2016-01-20 | パナソニックIpマネジメント株式会社 | モータ駆動装置 |
JP5269158B2 (ja) * | 2011-09-01 | 2013-08-21 | 株式会社神戸製鋼所 | 制御方法及び制御装置 |
JP6290619B2 (ja) * | 2013-12-19 | 2018-03-07 | オークマ株式会社 | モータの制御装置 |
JP6209176B2 (ja) | 2014-04-14 | 2017-10-04 | オークマ株式会社 | 位置制御装置 |
JP6392726B2 (ja) * | 2015-10-30 | 2018-09-19 | ファナック株式会社 | バックラッシを補正するモータ制御装置 |
GB201603283D0 (en) * | 2016-02-25 | 2016-04-13 | Johnson Electric Sa | Method of reducing noise from a HVAC system |
CN112936101B (zh) * | 2021-01-29 | 2022-11-01 | 天津中屹铭科技有限公司 | 一种应用于自动化打磨切割设备的柔性控制方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS58144582A (ja) * | 1982-02-23 | 1983-08-27 | Fanuc Ltd | サ−ボモ−タ制御装置 |
JPH0215311A (ja) * | 1988-07-04 | 1990-01-19 | Mitsubishi Electric Corp | 位置制御装置のバックラッシュ補正装置 |
JPH0253117A (ja) * | 1988-08-17 | 1990-02-22 | Mitsubishi Electric Corp | サーボ制御装置 |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4042869A (en) * | 1971-03-29 | 1977-08-16 | Industrial Nucleonics Corporation | Backlash compensation |
JPS5294995A (en) * | 1976-02-06 | 1977-08-10 | Toshiba Corp | Numerical control system |
SE427509B (sv) * | 1981-09-18 | 1983-04-11 | Facit Ab | Anordning for korrigering av glapp i en drivanordning bestaende av en driven skruv och ett mutterorgan |
JPS63148315A (ja) * | 1986-12-12 | 1988-06-21 | Fanuc Ltd | サ−ボモ−タ制御装置 |
JPS63148314A (ja) * | 1986-12-12 | 1988-06-21 | Fanuc Ltd | セミクロ−ズドル−プサ−ボ制御系の制御装置 |
US4857816A (en) * | 1987-02-05 | 1989-08-15 | Joseph Rogozinski | Precise positioning apparatus |
JPS63273115A (ja) * | 1987-04-30 | 1988-11-10 | Fanuc Ltd | サ−ボ制御回路 |
JPS63308613A (ja) * | 1987-06-10 | 1988-12-16 | Fanuc Ltd | サ−ボモ−タの制御方式 |
JPH0719180B2 (ja) * | 1988-03-08 | 1995-03-06 | オ−クマ株式会社 | 送り軸の位置制御方式 |
JP2703575B2 (ja) * | 1988-09-30 | 1998-01-26 | ファナック株式会社 | サーボ制御装置 |
JPH0371206A (ja) * | 1989-08-10 | 1991-03-27 | Mitsubishi Electric Corp | Nc工作機械の機械誤差補正装置 |
-
1990
- 1990-01-19 JP JP2008347A patent/JP2709969B2/ja not_active Expired - Fee Related
- 1990-12-10 DE DE69025321T patent/DE69025321T2/de not_active Expired - Fee Related
- 1990-12-10 EP EP91900368A patent/EP0460224B1/en not_active Expired - Lifetime
- 1990-12-10 WO PCT/JP1990/001608 patent/WO1991009358A1/ja active IP Right Grant
- 1990-12-10 US US07/741,447 patent/US5204602A/en not_active Expired - Lifetime
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS58144582A (ja) * | 1982-02-23 | 1983-08-27 | Fanuc Ltd | サ−ボモ−タ制御装置 |
JPH0215311A (ja) * | 1988-07-04 | 1990-01-19 | Mitsubishi Electric Corp | 位置制御装置のバックラッシュ補正装置 |
JPH0253117A (ja) * | 1988-08-17 | 1990-02-22 | Mitsubishi Electric Corp | サーボ制御装置 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0527845A (ja) * | 1991-07-22 | 1993-02-05 | Okuma Mach Works Ltd | 制御パラメータ変更機能を有する数値制御装置 |
JPH0540521A (ja) * | 1991-08-07 | 1993-02-19 | Mitsubishi Electric Corp | サーボモータの制御装置 |
WO1994025910A1 (en) * | 1993-04-28 | 1994-11-10 | Shunsuke Matsubara | Method for controlling servomotor |
US5517100A (en) * | 1993-04-28 | 1996-05-14 | Fanuc Ltd. | Method of controlling a servo motor |
WO1995005703A1 (fr) * | 1993-08-19 | 1995-02-23 | Fanuc Ltd | Appareil et procede pour commander un servomoteur |
US5598077A (en) * | 1993-08-19 | 1997-01-28 | Fanuc Ltd. | Control apparatus and a control method for a servomotor |
WO2022124150A1 (ja) * | 2020-12-08 | 2022-06-16 | スター精密株式会社 | 工作機械 |
Also Published As
Publication number | Publication date |
---|---|
WO1991009358A1 (en) | 1991-06-27 |
EP0460224B1 (en) | 1996-02-07 |
JP2709969B2 (ja) | 1998-02-04 |
EP0460224A1 (en) | 1991-12-11 |
DE69025321D1 (de) | 1996-03-21 |
US5204602A (en) | 1993-04-20 |
EP0460224A4 (en) | 1992-12-09 |
DE69025321T2 (de) | 1996-06-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JPH03228106A (ja) | サーボモータの制御方法 | |
US4727303A (en) | Positional control method and system utilizing same | |
EP0423357B1 (en) | Device for controlling servo motor | |
US5691616A (en) | Fully-closed-loop servomotor control system | |
JP2875646B2 (ja) | バックラッシ加速補正装置 | |
JPH02290187A (ja) | 同期制御方法及びその装置 | |
JPS63274385A (ja) | サ−ボモ−タの速度制御装置 | |
JP3285681B2 (ja) | サーボモータの制御方法 | |
JP2703575B2 (ja) | サーボ制御装置 | |
JP2826391B2 (ja) | バックラッシ加速制御方法 | |
JPS6130514B2 (ja) | ||
JP3253022B2 (ja) | サーボモータのバックラッシュ補正制御方法 | |
KR940002206B1 (ko) | 컨벌루션(Convolution)을 이용한 로보트의 궤적발생방법 | |
JPH04352012A (ja) | ロボットの位置制御方法 | |
JPH048451A (ja) | サーボモータの制御方式 | |
JPH10105247A (ja) | サーボモータのオーバーシュート防止方法 | |
JP2546881B2 (ja) | 静止最大摩擦トルク測定方法 | |
JPH04362702A (ja) | 繰り返し制御における速度制御方法 | |
JPH0719180B2 (ja) | 送り軸の位置制御方式 | |
JP2734236B2 (ja) | サーボモータの制御装置 | |
JP2724054B2 (ja) | 位置決め制御装置 | |
JP2021051433A (ja) | サーボモータの制御装置 | |
JPS61255409A (ja) | 2軸位置決め制御装置 | |
JPS60134905A (ja) | 揺動機構の制御方式 | |
JPH0817587B2 (ja) | 電動機の制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20081024 Year of fee payment: 11 |
|
LAPS | Cancellation because of no payment of annual fees |