JPS6130514B2 - - Google Patents

Info

Publication number
JPS6130514B2
JPS6130514B2 JP55146647A JP14664780A JPS6130514B2 JP S6130514 B2 JPS6130514 B2 JP S6130514B2 JP 55146647 A JP55146647 A JP 55146647A JP 14664780 A JP14664780 A JP 14664780A JP S6130514 B2 JPS6130514 B2 JP S6130514B2
Authority
JP
Japan
Prior art keywords
voltage
command
motor
compensation
control device
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
Application number
JP55146647A
Other languages
English (en)
Other versions
JPS5771282A (en
Inventor
Keiji Sakamoto
Yukio Toyosawa
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.)
Fanuc Corp
Original Assignee
Fanuc 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 Fanuc Corp filed Critical Fanuc Corp
Priority to JP55146647A priority Critical patent/JPS5771282A/ja
Publication of JPS5771282A publication Critical patent/JPS5771282A/ja
Publication of JPS6130514B2 publication Critical patent/JPS6130514B2/ja
Granted legal-status Critical Current

Links

Classifications

    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P7/00Arrangements for regulating or controlling the speed or torque of electric DC motors
    • H02P7/06Arrangements for regulating or controlling the speed or torque of electric DC motors for regulating or controlling an individual DC dynamo-electric motor by varying field or armature current
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Program-control systems
    • G05B19/02Program-control systems electric
    • G05B19/18Numerical 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 program data in numerical form
    • G05B19/19Numerical 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 program data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/41Servomotor, servo controller till figures
    • G05B2219/41156Injection of vibration anti-stick, against static friction, dither, stiction

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Direct Current Motors (AREA)
  • Feedback Control In General (AREA)
  • Control Of Position Or Direction (AREA)
  • Control Of Electric Motors In General (AREA)

Description

【発明の詳細な説明】 本発明はDCモータの回転方向反転時に生じる
応答の遅れを改善した閉ループ方式採用のサーボ
モータ制御装置に関するものである。
一般に、位置フイードバツクループをもつサー
ボモータ制御装置は、例えば第1図に示すよう
に、DCモータ10の回転位置または機械可動部
(図示せず)の位置を制御するための位置フイー
ドバツクループの他に、DCモータ10の回転速
度を制御するための速度フイードバツクループ
と、DCモータ10のモータ電流を制御するため
の電流フイードバツクループとが設けられてい
る。そして、電流フイードバツクループでは、抵
抗11で検出したモータ電流Idと位相補償回路
12からの電流指令値Isとの偏差が零になるよ
うに制御され、速度フイードバツクループでは、
速度発電機などの速度検出器13で検出したモー
タ速度vdとDA変換器器14からの速度指令値v
sとの偏差が零になるように制御されて、最終的
には、レゾルバやリニアスケール等の位置検出器
15で検出されたモータ位置ldと指令パルス発
生回路16から与えられる位置指令値lsとの差
が零になるように位置フイードバツクループによ
りモータ位置が制御される。なお、図中、17は
増幅器、18a〜18cは加算器である。
第2図は第1図の加算器18b、位相補償回路
12及び加算器18c部分の従来における構成を
表わす電気回路図であり、演算増幅器Q1と抵抗
R1〜R5で加算器18bを構成し、演算増幅器
Q1、抵抗R6〜R9及びコンデンサC1で位相補償回
路12を構成し、演算増幅器Q3と抵抗R10〜R13
で加算器18cを構成していた。
ところで、第2図に示したような構成を有する
従来のサーボモータ制御装置において、DCモー
タの回転方向反転時におけるモータ電流Iとモー
タ速度vとの関係を、縦軸にモニタ電流I及びモ
ータ速度vをとり、横軸に方向反転指令入力時を
原点として時間tをとつて図示すると、例えば第
3図の曲線30i,31vに示するものとなる。
ここで、I0は機械の摩擦トルクをモータ電流に換
算した値であり、図示例ではt<0即ち方向反転
前は回転が停止している場合を示す。
同図から判るようにt=0で反対方向の指令パ
ルスが入力されると曲線30iで示すモータ電流
Iは徐々に増加していくが、曲線31vで示すモ
ータ速度vはモータ電流Iが+I0を越える時点ま
で零であり、モータ電流Iが+I0を越えてはじめ
てDCモータは逆回転し始める。即ち、反対方向
の指令パルスが入力されてからDCモータが逆回
転を開始するまでT1の時間遅れが生じる。
このような時間遅れは、当然数値制御加工誤差
となつて現れ、具体的には例えば第4図に示すよ
うに、真円の指令パルス列の分配が行なわれて同
図の曲線40に示す真円に沿つて切削が行なわれ
るべきところが、回転方向反転時に応答遅れがあ
るために円弧切削の象限切換え部分において、実
際の切削物の形状は曲線41に示すようにふくら
みをもつという不具合を生じる。
本発明はこのような従来の欠点を改善したもの
であり、その目的は、DCモータの方向反転時に
摩擦トルクによつて引き起こされるDCモータの
応答遅れを補償して制御精度を高めることにあ
る。本発明に依ればこの目的は、方向反転信号入
力時における電流指令値を決定している電圧が摩
擦トルクに比例した電圧であることを利用し、そ
の電圧とほぼ絶対値が等しい逆極性の補償電圧を
発生させて、この補償電圧により方向反転信号入
力直後に前記指令電流値を形成している電圧を速
かに摩擦トルクに対応する電圧にプリセツトする
ことにより達成される。以下実施例について詳細
に説明する。
第5図は本発明実施例装置構成を表わす要部伝
気回路図であり、第2図と同一符号は同一部分を
示し、50は補償電圧発生回路、51は応答補償
回路、FN1は第1図における加算器18bの出力
が加えられる入力端子、IN2はピーク値セツト信
号S1が加えられる入力端子、IN3は摩擦トルク補
償信号S2が加えられる入力端子、OUTは電流指
令値Isを第1図における加算器18cに加える
出力端子、Q4〜Q6は図示の極性を有する演算増
幅器、SW1,SW2はスイツチング素子、R14〜R22
は抵抗、C2はコンデンサである。
本実施例装置が第2図に示した従来装置と異な
るところは、補償電圧発生回路50及び応答補償
回路51を設けたところにある。
補償電圧発生回路50は、数値制御装置におけ
る指令パルス発生回路からDCモータの回転方向
反転信号が出力されたとき、その時点における電
流指令値を決定している電圧即ち位相補償回路1
2の出力電圧(以下指令電圧と称す)を検出し、
その指令電圧にほぼ絶対値が等しく極性が反対の
補償電圧Vcを発生するものであり、抵抗R14とコ
ンデンサC2からなる積分回路と、その動作を制
御するスイツチング素子SW1と、演算増幅器
Q5,Q6と抵抗R15〜R17からなる極性反転回路と
で構成されている。
また応答補償回路51は、DCモータの回転方
向反転指令入力直後に、速やかに指令電圧をほぼ
補償電圧に等しくするように動作するものであ
り、指令電圧と補償電圧Vcとの差分を増幅する
演算増幅器Q6とその出力を位相補償回路12の
入力側にフイードバツクするよう動作するスイツ
チング素子SW2等とから構成されている。
第6図は第5図示装置を動作させた場合におけ
る各部の信号波形を表わす線図であり、以下同図
を参照して第5図示装置の動作を詳細する。
指令パルス発生回路から例えば第6図Aに示す
ような方向反転信号が出力されると、図示しない
制御回路で例えば第6図Bに示すようにその立上
りが方向反転信号の立上りにほぼ一致した時間幅
T2のピーク値セツト信号S1が発生される。
このピーク値セツト信号S1は補償電圧発生回路
50のスイツチング素子SW1に加えられ、このス
イツチング素子SW1を時間T2だけオン状態にす
る。その結果、コンデンサC2はそのときの指令
電圧によつて充電され、演算増幅器Q5の出力に
は指令電圧にほぼ絶対値が等しい逆極性の補償電
圧Vcがほぼτ=C2×R14の時定数で現れる。そこ
で、ピーク値セツト信号S1の時間幅T2を2τ〜
3τ程度に設定しておくと、補償電圧発生回路5
0からは例えば第6図のCに示すように指令電圧
とほぼ絶対値が等しい逆極性の補償電圧が得ら
れ、この補償電圧はスイツチング素子SW1のオフ
後も保持される。
次に、図示しない制御回路によつて例えば第6
図Dに示すようにほぼピーク値セツト信号S1の立
下り時に立上るような時間幅T3の摩擦トルク補
償信号S2が発生され、これが応答補償回路51の
スイツチング素子SW2に加えられてこれを導通さ
せる。その結果、指令電圧と補償電圧Vcとの差
を増幅している演算増幅器Q6の出力によつて指
令電圧は補償電圧Vcにほぼ等しくなるようにフ
イードバツク制御され、指令電圧は例えば第6図
Eに示すように速やかに下降(ただし、反対の方
向反転が行なわれた場合には速やかに上昇する)
するものとなる。ここで、指令電圧の補償速度は
抵抗R22の値を調整することにより自由に変更し
得るものである。
本実施例装置におけるDCモータ回転方向反転
時のモータ電流Iとモータ速度の変化は例えば第
3図の曲線32i,33vに示すものとなり、モ
ータ電流曲線32iは補償動作の働きで従来より
早く反対側摩擦トルクI0を越えるから、モータ速
度曲線33vもそれだけ早く立上り、モータの反
転遅れ時間T4は大幅に改善される。なお、反転
遅れ時間T4は抵抗R22の値を調整することにより
自由に変更することができる。
以上の説明から判るように、本発明は、指令パ
ルス発生回路からDCモータの回転方向反転指令
が入力されたときに、そのときの電流指令値を決
定している指令電圧とほぼ絶対値が等しく且つ極
性の反対な補償電圧を補償電圧発生回路で発生さ
せ、この補償電圧を用いて、指令電圧を方向反転
信号入力直後に速やかに反転側摩擦トルクに対応
する電圧にほぼ等しくなるようにしたものであ
り、摩擦トルクに対応する電圧が速やかに補償さ
れるから、摩擦トルクによるサーボ系の遅れを大
幅に改善することができる。従つて、本発明を数
値制御装置のサーボモータ制御装置に適用すれば
加工精度の向上等が図れて非常に有効である。
【図面の簡単な説明】
第1図は位置フイードバツクループを有するサ
ーボモータ制御装置の一般的な構成を表わすブロ
ツク図、第2図は従来のサーボモータ制御装置の
構成を表わす要部電気回路図、第3図は第2図及
び第5図示装置を動作させた場合におけるモータ
電流I及びモータ速度vの変化を表わす線図、第
4図は方向反転時の応答遅れが加工に与えられる
影響を説明するための線図、第5図は本発明実施
例装置の要部電気回路図、第6図は第5図示装置
を動作させた場合における各部の信号波形を表わ
す線図である。 10はDCモータ、12は位相補償回路、13
は速度検出器、15は位置検出器、16は指令パ
ルス発生回路、17は増幅器、18a〜18cは
加算器、50は補償電圧発生回路、51は応答補
償回路である。

Claims (1)

    【特許請求の範囲】
  1. 1 DCモータを数値制御装置の指令パルス発生
    回路から与えられる指令値通りに制御する閉ルー
    プ方式採用のサーボモータ制御装置において、前
    記指令パルス発生回路からの方向反転信号入力時
    にそのときの前記DCモータの電流指令値を決定
    している指令電圧とほぼ絶対値が等しく且つ極性
    が反対の補償電圧を発生する補償電圧発生回路
    と、該補償電圧発生回路で発生された前記補償電
    圧を用いて前記指令電圧を方向反転信号入力直後
    に速やかに反転側摩擦トルクに対応する電圧にほ
    ぼ等しく応答補償回路とを具備したことを特徴と
    するサーボモータ制御装置。
JP55146647A 1980-10-20 1980-10-20 Servo motor controller Granted JPS5771282A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP55146647A JPS5771282A (en) 1980-10-20 1980-10-20 Servo motor controller

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP55146647A JPS5771282A (en) 1980-10-20 1980-10-20 Servo motor controller

Publications (2)

Publication Number Publication Date
JPS5771282A JPS5771282A (en) 1982-05-04
JPS6130514B2 true JPS6130514B2 (ja) 1986-07-14

Family

ID=15412454

Family Applications (1)

Application Number Title Priority Date Filing Date
JP55146647A Granted JPS5771282A (en) 1980-10-20 1980-10-20 Servo motor controller

Country Status (1)

Country Link
JP (1) JPS5771282A (ja)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS61150689A (ja) * 1984-12-22 1986-07-09 Yaskawa Electric Mfg Co Ltd 摩擦トルクを補償するサ−ボモ−タ制御方法
DE3590662T1 (ja) * 1984-12-22 1987-02-19
JPS61269687A (ja) * 1985-05-21 1986-11-29 Yaskawa Electric Mfg Co Ltd 摩擦トルクを補償するサ−ボ制御方法
JP2638594B2 (ja) * 1986-11-08 1997-08-06 フアナツク株式会社 デイジタルサーボシステム
JPS63148314A (ja) * 1986-12-12 1988-06-21 Fanuc Ltd セミクロ−ズドル−プサ−ボ制御系の制御装置
JPS63148315A (ja) * 1986-12-12 1988-06-21 Fanuc Ltd サ−ボモ−タ制御装置
JPH07104729B2 (ja) * 1987-04-07 1995-11-13 株式会社安川電機 サーボ系の非線形摩擦補償方法

Also Published As

Publication number Publication date
JPS5771282A (en) 1982-05-04

Similar Documents

Publication Publication Date Title
JP2709969B2 (ja) サーボモータの制御方法
JPS63274385A (ja) サ−ボモ−タの速度制御装置
JPS6353795B2 (ja)
US3206663A (en) Machine tool position control servomechanism with positioning rate control
JPS6130514B2 (ja)
EP0207166A4 (en) METHOD AND DEVICE FOR REGULATING A SERVOMOTOR.
EP0116912B1 (en) Method of controlling motor speed
US4350940A (en) System for servocontrolling a separately excited DC motor
JPS5534716A (en) Positioning control system
JPS61150690A (ja) サ−ボモ−タの制御方法
JPH0118672B2 (ja)
RU2628757C1 (ru) Способ управления электроприводом и устройство для его реализации (варианты)
JPH07322664A (ja) 電動機の制御装置
Grotstollen Comparison of speed controlled dc drives with and without subordinate current loop
KR910001965B1 (ko) 교류 전동기의 전기자 반작용 보상 회로
JPH03178872A (ja) 電動式パワー・ステアリング装置
JP2641430B2 (ja) 産業用ロボツトの制御装置
JPS58144582A (ja) サ−ボモ−タ制御装置
JP2673994B2 (ja) サイリスタレオナード装置の電流制限方法
JPH0690648B2 (ja) ダイレクト教示ロボット
JPH0584207B2 (ja)
JPH0231407B2 (ja) Ichigimekikonoseigyohoshiki
JPS61178157A (ja) 数値制御装置
SU868960A1 (ru) Устройство дл управлени асинхронным электродвигателем
JPS6016969Y2 (ja) 回転体の停止位置制御装置