JPH01267708A - サーボモータ制御方法 - Google Patents

サーボモータ制御方法

Info

Publication number
JPH01267708A
JPH01267708A JP63095776A JP9577688A JPH01267708A JP H01267708 A JPH01267708 A JP H01267708A JP 63095776 A JP63095776 A JP 63095776A JP 9577688 A JP9577688 A JP 9577688A JP H01267708 A JPH01267708 A JP H01267708A
Authority
JP
Japan
Prior art keywords
dmr
pulse
rotation
per
absolute position
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
Application number
JP63095776A
Other languages
English (en)
Other versions
JP2702499B2 (ja
Inventor
Shunsuke Matsubara
俊介 松原
Kaname Matsumoto
要 松本
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 JP63095776A priority Critical patent/JP2702499B2/ja
Priority to DE68924699T priority patent/DE68924699T2/de
Priority to US07/449,920 priority patent/US5231340A/en
Priority to PCT/JP1989/000355 priority patent/WO1989010590A1/ja
Priority to KR1019890702350A priority patent/KR920009888B1/ko
Priority to EP89904230A priority patent/EP0374255B1/en
Publication of JPH01267708A publication Critical patent/JPH01267708A/ja
Application granted granted Critical
Publication of JP2702499B2 publication Critical patent/JP2702499B2/ja
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00Control of position or direction
    • G05D3/10Control of position or direction without using feedback
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-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 programme 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 programme 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
    • G05B19/21Numerical 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 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 using an incremental digital measuring device
    • G05B19/23Numerical 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 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 using an incremental digital measuring device for point-to-point control
    • G05B19/231Numerical 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 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 using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-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 programme 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 programme 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
    • G05B19/21Numerical 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 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 using an incremental digital measuring device
    • G05B19/23Numerical 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 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 using an incremental digital measuring device for point-to-point control
    • G05B19/231Numerical 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 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 using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude
    • G05B19/237Numerical 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 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 using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude with a combination of feedback covered by G05B19/232 - G05B19/235
    • 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
    • H02P5/00Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors

Landscapes

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

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 〈産業上の利用分野〉 本発明はサーボモータ制純方法に係り、特に絶対位置検
出パルスコーダを用いたサーボモータ制御方法に関する
〈従来技術〉 サーボモータを)レクル制御する)レタルサーボモータ
制御においては、数値制御部で所定時間ΔT毎の各軸移
動量ΔRnを計算してデジタルサーボ回路に入力し、デ
ジタルサーボ回路はΔT毎に次式 %式% (ただし、ΔP、は△T毎の実際の移動量、E、は位置
誤差)の演算を行い、該位置誤差の大きさに応じてパル
スコーダを行ってサーボモータを回転制御する。
第3図はかかる従来のデジタルサーボ回路のブロック図
であり、1は所定時間Δτ毎の移動指令ΔR,と実際の
移動量ΔPnの差を演算する演算部、2ば次式 %式%) により演算部】の出力(ΔR,−ΔP、、)を積算して
位置誤差E1を出力するエラーカウンタ部、3はポジシ
ョンゲインKp設定部、4ば速度制御部、5(よ電流制
御部、6はサーボアンプ及びサーボモータ等のハードウ
ェア部、7ばサーボモータ1回転当りにN個のパルスを
発生するバルスコーダ、8はパルスコーダ7からΔTの
間に発生するパルスを計数する積分器、9は積分器8の
出力Mに検出マルチプライヤ比DMRを乗算してΔTの
間に移動した移動量ΔP1、を移動指令ΔR,の設定単
位と同一にして出力するDMR乗算部である。
尚、検出マルチプライヤ比DMRは、サーボモータ1回
転当りの機械可動部の移動量りと、移動指令の1パルス
当りの移動量(設定単位)Rと、サーボモータ1回転当
りにパルスコーダ7から出力されるパルス数N(パルス
/rev)とから次式%式%) により求まる値である。従って、移動指令の設定単位R
を0.1μm/パルス、モータ1回転当りの8i械可動
部の移動量りを8−、モータ1回転当りにバルスコーダ
から発生するパルス数Nを20000パルス/ rev
とすれば、上式よりDMR=4とな勢、演算部1に入力
される実際の移動量ΔP、、の単位は(0,1μm/パ
ルス)となって移動指令の設定単位と同一になる。
〈発明が解決しようとしている課題〉 ところで、従来方法ではDMRO値として特別なua、
シか用いろことができなかった。このため、予めNの異
なる複数のパルスコーダを用意しておき、(l)式によ
り求まるDMRが特別な整数となりうるようにパルスコ
ーダを選択してサーボ系を構成するようにしている。し
かし、かかる方法で(ま予め多数のバルスコーゲを用意
しておかなけilばならず、しがもり、Rの関係では用
意しであるどのバルスコーダを用いてもD M Rf>
(整数とならない場合があり不都合であった。
尚、DMRとして整数以外の値を用いるとDMR乗算部
における乗算結果に小数点ふ下の数値が発生し、該小数
点以下の値が誤差としてΔT毎に累積してサーボモータ
制御の精変を低下させ、従ってDMRとしては整数以外
の数値を用いろことができない。
以上から本発明の目的は、DMRが小数点を含む任意の
数値でもよ<、シかも種々のバルスコーダを用意してお
く必要がないサーボモータ制御方法を提供することであ
る。
〈課題を解決するための手段〉 第1図は本発明にかかるサーボモータ制御回路のブロッ
ク図である。
11は移動指令積算部、12は位置誤差演算部、17は
サーボアンプやサーボモータのハードウェア部、18は
絶対位置検出パルスコーダ、19はDMR乗算部、20
はD M R演算部である。
く作用〉 サーボモータ1回転当りN個のインクリメンタルパルス
を発生するパルスコーダと、該インクリメンタルパルス
を回転方向に応じて可逆計数するカウンタとを有する絶
対位置検出パルスコーダ18を設けると共に、予めDM
R演算部2oにおいてモータ1回転当りの機械可動部の
移動量りと移動指令の設定単位Rと前記パルス数Nとか
らマルチプライヤ比DMRを演算しておく。
そして、移動指令積算部11で移動指令を積算すると共
に、DMR乗算部19で絶対位置検出パルスコーダ1g
から出力される絶対位置をDMR倍し、演算部12で移
動指令の積算値P、とDMR乗算結果PAの差を位置誤
差E、として演算し、該位置誤差を用いてモータの回転
制御を行う。
〈実施例〉 第1図は本発明にかかるサーボモータ制御装置のブロッ
ク図、第2図は絶対位置検出パルスフーダの説明図であ
る。
11は所定時間ΔT毎の移llI権令ΔR,を積算して
移動指令の積算値P。を出力する移動指令積算部、12
は移動指令の積算値P。と機械可動部の実際の絶対位置
PAの差である位置誤差を演算する位置誤差演算部、1
3は位置誤差を記憶するエラー保持部、14はポジショ
ンゲインKP設定部、15は速度制御部、16は電流制
御部、17はサーボアンプ及びサーボモータ等のハード
ウェア部、18は絶対位置検出パルスコーグであり、第
2図に示すようにモータ17aが所定角度回転する毎に
1個のインクリメンタルパルスを発生するパルスコーグ
18aと、該パルスコーグから発生するパルスを回転方
向に応じて計数して絶対位置PA′を記憶・出力すると
共に、電源が切断されても該絶対位置を記憶し続けるカ
ウンタ18bとで構成されている。尚、第2図において
21は機械可動部であろ◇又、パルスコーグ18aはモ
ータ1回転当りにN個のインクリメンタルパルスを発生
する。
19は絶対位置検出パルスコーグ18から出力される絶
対位置(パルス数)P6′をDMR倍して移動指令の設
定単位と同一にして出力するDMR乗算部である。20
はDMR演算部であり、モータ1回転当りの機械可動部
の移動量りと、移動指令の1パルス当りの移動量(設定
単位)Rと、モータ1回転当りにパルスコーグ18aか
ら出力されろパルス数N(パルス/rev)とから次式
%式%)( により検出マルチプライヤ比DMRを演算する。
たとえば、 移動指令の設定単位Rを0.1μm/パルス、モータ1
回転当りの81械可動部の移動量りを8胴、モータ1回
転当りにパルスコーグから発生するパルス数をNパルス
/revとすれば、上式よりDMR= 80000/N となり、機械可動部が10ma/rev移動するものと
すれば DMR= 100000/N となる。
以下、第1図の全体的動作を説明する。
予めDMR演算部20において<11式を用いて、モー
タ1回転当りの機械可動部の移動量りと移動指令の設定
単位Rとパルスコーグ18aの1回転当りのパルス数N
とからマルチプライヤ比DMRを演算しておく。
かかる状態において、ΔT毎の移動指令ΔRnが発生す
れば移動指令積算部11で積算し、位置誤差演算部12
で移動指令の積算値P。とDMR乗算乗算部上9出力さ
れる絶対位置(設定単位で表現した絶対位置)PAO差
を位置誤差E、として演算してエラー保持部13に保持
させ、該位置誤差E。
にポジションゲインKpを乗算して指令速度V。0を発
生し、以後速度制御、電流制御を行ってサーボモータ1
7aを回転させる。
モータが回転すれば絶対位置検出パルスコーグ18のパ
ルスコーグ18a(第2図参照)から1回転当たりN個
のインクリメ・ン・タルパルスが発生してカウンタ18
bに積算され、該カウンタの計数値PA′が絶対位置P
A′ として出力される。
DMR乗算乗算部上9式 %式%(2) の演算を行って設定単位で表現しtコ絶対位置PAを出
力する。
以後、所定時間△T毎に上記処理が繰り返されてサーボ
モータは指令速度で回転することになる。
〈発明の効果〉 以上本発明は、従来のようにΔT毎のインクリメンタル
移動量にDMR倍するものではなく、その都度アブソリ
ュート値にDMR倍するものである為、検出マルチプラ
イヤ比D −M Rが小数点以下を含んでいても従来の
ように誤差は累積することがなく、従って1種類のパル
スコーグを用意しておくだけで十分である。
【図面の簡単な説明】
第1図は本発明にかかるサーボモータ制御回路のブロッ
ク図、 第2図は絶対位置検出パルスコーグの説明図、第3図は
従来方法を説明するためのブロックである。 コト・移動指令積算部、 12・・位置誤差演算部、 17・・サーボモータ等のハーニ:ウェア部、18・・
絶対位置検出パルスコーグ、 18a・・パルスコーグ、 18b・・カウンタ、 19・・DMR乗算部、 20・・DMR演算部 特許出願人        ファナック株式会社代理人
          弁理士  齋藝千幹第2図 PA’

Claims (2)

    【特許請求の範囲】
  1. (1)モータ1回転当りN個のインクリメンタルパルス
    を発生するパルスコーダと、インクリメンタルパルスを
    回転方向に応じて可逆計数するカウンタとを有する絶対
    位置検出パルスコーダを用いてモータの回転制御を行う
    サーボモータ制御方法において、 モータ1回転当りの機械可動部の移動量Lと移動指令の
    1パルス当りの移動量Rと前記インクリメンタルパルス
    数Nとからマルチプライヤ比DMRを演算し、 移動指令を積算すると共に、絶対位置検出パルスコーダ
    から出力される絶対位置をDMR倍し、移動指令の積算
    値と前記DMRの乗算結果との差を位置誤差として演算
    し、 該位置誤差を用いてサーボモータの回転制御を行うこと
    を特徴とするサーボモータ制御方法。
  2. (2)DMR=L/(R・N)により前記DMRを演算
    することを特徴とする特許請求の範囲第1項記載のサー
    ボモータ制御方法。
JP63095776A 1988-04-20 1988-04-20 サーボモータ制御方法 Expired - Lifetime JP2702499B2 (ja)

Priority Applications (6)

Application Number Priority Date Filing Date Title
JP63095776A JP2702499B2 (ja) 1988-04-20 1988-04-20 サーボモータ制御方法
DE68924699T DE68924699T2 (de) 1988-04-20 1989-04-04 Verfahren zur steuerung eines servomotors.
US07/449,920 US5231340A (en) 1988-04-20 1989-04-04 Servomotor control method
PCT/JP1989/000355 WO1989010590A1 (en) 1988-04-20 1989-04-04 Method of controlling servo motor
KR1019890702350A KR920009888B1 (ko) 1988-04-20 1989-04-04 서보모타 제어방법
EP89904230A EP0374255B1 (en) 1988-04-20 1989-04-04 Method of controlling servo motor

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP63095776A JP2702499B2 (ja) 1988-04-20 1988-04-20 サーボモータ制御方法

Publications (2)

Publication Number Publication Date
JPH01267708A true JPH01267708A (ja) 1989-10-25
JP2702499B2 JP2702499B2 (ja) 1998-01-21

Family

ID=14146885

Family Applications (1)

Application Number Title Priority Date Filing Date
JP63095776A Expired - Lifetime JP2702499B2 (ja) 1988-04-20 1988-04-20 サーボモータ制御方法

Country Status (6)

Country Link
US (1) US5231340A (ja)
EP (1) EP0374255B1 (ja)
JP (1) JP2702499B2 (ja)
KR (1) KR920009888B1 (ja)
DE (1) DE68924699T2 (ja)
WO (1) WO1989010590A1 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0293713A (ja) * 1988-09-29 1990-04-04 Toyoda Mach Works Ltd 位置決め装置
JPH0434607A (ja) * 1990-05-31 1992-02-05 Fanuc Ltd 数値制御装置

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5077507A (en) * 1989-06-29 1991-12-31 Mitsubishi Denki K.K. Servo control apparatus
KR101891276B1 (ko) * 2016-05-10 2018-10-01 알에스오토메이션주식회사 속도 제어 장치
CN116639531B (zh) * 2023-04-20 2023-10-03 新创碳谷集团有限公司 一种基于编码器的转盘转动控制方法及控制系统

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5433985A (en) * 1977-08-17 1979-03-13 Yaskawa Electric Mfg Co Ltd Resolver detecting system
JPS5569004A (en) * 1978-11-18 1980-05-24 Toshiba Corp Measuring unit of amount of movement
JPS59122393A (ja) * 1982-12-27 1984-07-14 Fanuc Ltd 同期モ−タの制御方式

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2087034A5 (ja) * 1970-04-20 1971-12-31 Bendix Corp
DE2052757C3 (de) * 1970-10-28 1974-10-17 Siemens Ag, 1000 Berlin Und 8000 Muenchen Einrichtung zum numerischen Steuern der Bewegung einer Werkzeugmaschine
JPS5294995A (en) * 1976-02-06 1977-08-10 Toshiba Corp Numerical control system
US4211967A (en) * 1977-04-27 1980-07-08 Matsushita Electric Industrial Co., Ltd. Motor speed adjusting apparatus
US4484287A (en) * 1980-09-30 1984-11-20 Fujitsu Fanuc Limited System for restoring numerically controlled machine tool to former condition
JPS59188518A (ja) * 1983-04-11 1984-10-25 Fanuc Ltd サ−ボ制御系の絶対位置検出方式

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5433985A (en) * 1977-08-17 1979-03-13 Yaskawa Electric Mfg Co Ltd Resolver detecting system
JPS5569004A (en) * 1978-11-18 1980-05-24 Toshiba Corp Measuring unit of amount of movement
JPS59122393A (ja) * 1982-12-27 1984-07-14 Fanuc Ltd 同期モ−タの制御方式

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0293713A (ja) * 1988-09-29 1990-04-04 Toyoda Mach Works Ltd 位置決め装置
JPH0434607A (ja) * 1990-05-31 1992-02-05 Fanuc Ltd 数値制御装置

Also Published As

Publication number Publication date
EP0374255A4 (en) 1993-03-03
EP0374255B1 (en) 1995-11-02
KR920009888B1 (ko) 1992-11-05
DE68924699T2 (de) 1996-04-04
EP0374255A1 (en) 1990-06-27
WO1989010590A1 (en) 1989-11-02
DE68924699D1 (de) 1995-12-07
US5231340A (en) 1993-07-27
KR900700950A (ko) 1990-08-17
JP2702499B2 (ja) 1998-01-21

Similar Documents

Publication Publication Date Title
US6107771A (en) Move command correction method and servo control system with correction of move command
JP3129622B2 (ja) フルクローズド・ループ方式における象限突起補正方法
EP1717657B1 (en) Numerical controller with override means and time-delay table for operation
JP2006302171A (ja) 数値制御装置
JP2720584B2 (ja) サーボシステムの同調位相制御装置
US20070185609A1 (en) Numerical control method
JPH01267708A (ja) サーボモータ制御方法
JP2558252B2 (ja) 原点復帰方法
JPH05301196A (ja) ロボット制御系パラメータ調整装置
US4577271A (en) Sampled data servo control system
US4578763A (en) Sampled data servo control system with deadband compensation
US5510996A (en) Method for determining auxiliary position-control parameters
JP3628119B2 (ja) サーボモータの制御方法
US7580770B2 (en) Numerical controller
US4020331A (en) Feed rate control system for numerical control machine tool
JP4282632B2 (ja) テーブル形式データで運転を行う数値制御装置
KR930001582B1 (ko) 원점 복귀방법
US6677721B2 (en) Method of control and control structure for the movement control, pre-control and fine interpolation of objects in a speed controller clock which is faster than the position controller clock
JPS60219988A (ja) ブラシレスモ−タ制御装置
JPH03111913A (ja) クローズド・ループ方式によるサーボモータの制御方式
JPH02121006A (ja) ディジタルサーボ制御用関数発生装置
JPH0418986B2 (ja)
SU798726A1 (ru) Цифрова след ща система управлени пЕРЕМЕщЕНиЕМ Об'ЕКТА
KR100195078B1 (ko) 브이알 모터의 속도제어방법 및 장치
JPS62120513A (ja) 手動パルスのてい倍制御方式