JPS58140813A - 位置制御方式 - Google Patents
位置制御方式Info
- Publication number
- JPS58140813A JPS58140813A JP2242682A JP2242682A JPS58140813A JP S58140813 A JPS58140813 A JP S58140813A JP 2242682 A JP2242682 A JP 2242682A JP 2242682 A JP2242682 A JP 2242682A JP S58140813 A JPS58140813 A JP S58140813A
- Authority
- JP
- Japan
- Prior art keywords
- pulse
- error
- servo
- simulator
- position control
- 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.)
- Pending
Links
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/19—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 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/21—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 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/23—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 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
-
- 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/41186—Lag
-
- 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/42—Servomotor, servo controller kind till VSS
- G05B2219/42155—Model
-
- 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/42—Servomotor, servo controller kind till VSS
- G05B2219/42162—Model reference adaptive control MRAC, correction fictive-real error, position
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
本発明は位置制御方式にiシ、特に追従gA差を補正す
ることができる位置制御方式に関する。
ることができる位置制御方式に関する。
通常、数値制御ンステムにおける位置制御においては、
指令値と実際の移動量とのta蚤を増幅し、鋏誤差が零
となるようにサーボモータを駆動し、可wJsを指令位
置に位置決めする。第1図はか\る位置制御を説明する
説明図である。図中、11はNo装置でパルス分配器を
内蔵し、移動指令に基いてパルス分配演算を行ない指令
パルスCPを発生する。12は周知のサーボ回路で、指
令パルスCPと後述するフィードバックパルスFPの差
(WA差という)を演算して出力する可逆カウンタ岬よ
りな゛る誤差演算記憶部12mと、咳誤艷に応じたアナ
ログ電圧を発生すゐDA変換器12bと、増幅器12C
岬を有しており、前記誤差が零となるようにサーボモー
タを駆動する。1sは直流モータなどのサーボモータ、
14はポールスクリ為、15は可動部としてのテーブル
、16はテーブルが所定量移動する毎に1個のフィード
バックパルスFPを発生するパルス分配器などの位置検
出器である。このw11図において、NO装置11から
分配パルスOPが発生すれば該分配パルスはサーボ回路
12内の誤差演薯記憶9128に累積される。
指令値と実際の移動量とのta蚤を増幅し、鋏誤差が零
となるようにサーボモータを駆動し、可wJsを指令位
置に位置決めする。第1図はか\る位置制御を説明する
説明図である。図中、11はNo装置でパルス分配器を
内蔵し、移動指令に基いてパルス分配演算を行ない指令
パルスCPを発生する。12は周知のサーボ回路で、指
令パルスCPと後述するフィードバックパルスFPの差
(WA差という)を演算して出力する可逆カウンタ岬よ
りな゛る誤差演算記憶部12mと、咳誤艷に応じたアナ
ログ電圧を発生すゐDA変換器12bと、増幅器12C
岬を有しており、前記誤差が零となるようにサーボモー
タを駆動する。1sは直流モータなどのサーボモータ、
14はポールスクリ為、15は可動部としてのテーブル
、16はテーブルが所定量移動する毎に1個のフィード
バックパルスFPを発生するパルス分配器などの位置検
出器である。このw11図において、NO装置11から
分配パルスOPが発生すれば該分配パルスはサーボ回路
12内の誤差演薯記憶9128に累積される。
誤差演算記憶部12aの内容(誤差)FiDA変換器1
2bによりDA変換後、増幅器12cにより増幅されて
サーボモータ15に入力さね、該サーボモーpvtvs
転する。これKよシボールスクリ&14が一転し、テー
ブル15は指令され良方向に移動す為、テーブル15が
所定量移動すれば位置検出器16から1側のフィードバ
ックパルスFPが発生し、このフィードバックパルスは
誤差演算記憶部1taに入力されその内容を減少する。
2bによりDA変換後、増幅器12cにより増幅されて
サーボモータ15に入力さね、該サーボモーpvtvs
転する。これKよシボールスクリ&14が一転し、テー
ブル15は指令され良方向に移動す為、テーブル15が
所定量移動すれば位置検出器16から1側のフィードバ
ックパルスFPが発生し、このフィードバックパルスは
誤差演算記憶部1taに入力されその内容を減少する。
以後、上記O動作を繰返えし、定常時には誤差演算記憶
部12aK記憶されている誤差Erは一定の定常偏差値
に轡しくな抄、サーボモータ13.可動部15は指令さ
れ大速度で移動することになる。tll、定常偏差値は
位置制御1llll路のゲインをに、指令パルス連駿を
rとすればF/にとなる。そして指令され参勤距離に相
当すゐ数の分配パルス(指令パルス)CPが発生すれば
、4はや該分配パルスは出力されなくなり、以後誤差演
算配憶部121に記憶され九誤差に相当する量だけテー
ブル15が移動すればWIA差Erが零となりテーブル
15は正しく目標位置に位置決めされる。
部12aK記憶されている誤差Erは一定の定常偏差値
に轡しくな抄、サーボモータ13.可動部15は指令さ
れ大速度で移動することになる。tll、定常偏差値は
位置制御1llll路のゲインをに、指令パルス連駿を
rとすればF/にとなる。そして指令され参勤距離に相
当すゐ数の分配パルス(指令パルス)CPが発生すれば
、4はや該分配パルスは出力されなくなり、以後誤差演
算配憶部121に記憶され九誤差に相当する量だけテー
ブル15が移動すればWIA差Erが零となりテーブル
15は正しく目標位置に位置決めされる。
以上のように、従来の位置側tlnKよればテーブル、
工具郷の可動部を正しく目標位置に位置決めすることが
できる。
工具郷の可動部を正しく目標位置に位置決めすることが
できる。
しかしながら、か\る従来の位置制御においては指令と
可動部の移動との間に一定の遅れが生じる。即ち、指令
パルス(第1図では分配パルスCP)が発生してもテー
ブルは直ちに移動せず一定の遅れ時間後に移動を開始し
、又指令パルスの発生を停止して本テーブルは直ちに停
止せず一定の遅れ時間後に停止する。
可動部の移動との間に一定の遅れが生じる。即ち、指令
パルス(第1図では分配パルスCP)が発生してもテー
ブルは直ちに移動せず一定の遅れ時間後に移動を開始し
、又指令パルスの発生を停止して本テーブルは直ちに停
止せず一定の遅れ時間後に停止する。
このため、同時2軸、同時3軸制御などによ〉テーブル
或いは工具を移動させる場合、各制御軸のサーボ回路特
性が相違すると、たとえば各サーボ回路のゲインが異な
ると定常偏差値が異なることになシ、可動部は指令通路
上を移動しなくなる。
或いは工具を移動させる場合、各制御軸のサーボ回路特
性が相違すると、たとえば各サーボ回路のゲインが異な
ると定常偏差値が異なることになシ、可動部は指令通路
上を移動しなくなる。
又、2つのモータを同期して運転するガントリタイプの
工作機械制御或いは大型製図機の移動制御においては、
各モータのサーボ特性が異なると完全な同期がとれない
事態を生じ、機械の破損、精度の良い工作ができなくな
る。
工作機械制御或いは大型製図機の移動制御においては、
各モータのサーボ特性が異なると完全な同期がとれない
事態を生じ、機械の破損、精度の良い工作ができなくな
る。
以上から、本発明は定常偏差値の差にもとず〈誤動作を
防止できる、換盲すれは追従誤差を補正することがでI
ゐ位置制御方式を提供することを■釣とする。
防止できる、換盲すれは追従誤差を補正することがでI
ゐ位置制御方式を提供することを■釣とする。
以下、本発明の実施例を図面に従って詳細に説明すゐ。
第21eは本発−の黄施例を示すプElyり図であ伽
*来例と同一部分には同一符号を付している。
*来例と同一部分には同一符号を付している。
11中s 1yはシミル−タである0通常、サーボ篭−
タ(直111モータとする)15は一次遅れ時働を示し
、分配パルスCPが発生しても直ちに該分配パルスOP
K追従して回転で鼻ず、所定の遅れをもって回転する。
タ(直111モータとする)15は一次遅れ時働を示し
、分配パルスCPが発生しても直ちに該分配パルスOP
K追従して回転で鼻ず、所定の遅れをもって回転する。
シミル−タ17はか\るt−ポ系の伝達特性を模擬しフ
ィードバックパルxFFと#′!埋同−の時間間隔で模
擬パルスSPを11!1!すゐ。
ィードバックパルxFFと#′!埋同−の時間間隔で模
擬パルスSPを11!1!すゐ。
第1図はか\ゐシミエレータ17のブロック図−e&j
、17ad分配パルスCPをカウントアツプし、模擬パ
ルス8Pを減算する可逆カウンタ。
、17ad分配パルスCPをカウントアツプし、模擬パ
ルス8Pを減算する可逆カウンタ。
17bIIiアキニームレータ、17cFi一定周波数
のパルスPsを発生する発振器、17dは発番器17c
よりパルスPsが発生する毎に可逆カウンタ17mの計
数値をアキュームレータ17bの累積値に加算する加算
回路である。冑、アキュームレータ17bのビット数を
nとすれば、累積値が2a以上になるとオm /(70
−ハルスカ発生り、、とのオーバフローパルスが模擬パ
ルスSPとなって出力される。命。
のパルスPsを発生する発振器、17dは発番器17c
よりパルスPsが発生する毎に可逆カウンタ17mの計
数値をアキュームレータ17bの累積値に加算する加算
回路である。冑、アキュームレータ17bのビット数を
nとすれば、累積値が2a以上になるとオm /(70
−ハルスカ発生り、、とのオーバフローパルスが模擬パ
ルスSPとなって出力される。命。
可逆カウンタ17mの内容をC1発振!117cから発
生、するパルスのパルス速度をfo、分配パルスcPの
パルス速度をFl 、模擬パルスSPのパルス速度Fo
とすれば次式が成立する。
生、するパルスのパルス速度をfo、分配パルスcPの
パルス速度をFl 、模擬パルスSPのパルス速度Fo
とすれば次式が成立する。
a
−−−= Fi −Fo (
11t )・。”−” 、e = ke 211 (2)(1)、
(2)式より、e、Foはそれぞゎ1 e = −、(1−exp (−k t ))
(31Fo = Fl (1−exp (−k
l )) f41となシ、シミエレータ
17はサーボ系の一次遅れ特性を模擬する。
11t )・。”−” 、e = ke 211 (2)(1)、
(2)式より、e、Foはそれぞゎ1 e = −、(1−exp (−k t ))
(31Fo = Fl (1−exp (−k
l )) f41となシ、シミエレータ
17はサーボ系の一次遅れ特性を模擬する。
第2図に戻って、18け分配パルスCPの数と横綱パル
ス8PO数の差に等しいパルス数を有するパルス列を発
生する第1の合成回路、19は分配パルスCPと#11
の合成回路1B(D出力パルスを合成する第20合成回
路である。
ス8PO数の差に等しいパルス数を有するパルス列を発
生する第1の合成回路、19は分配パルスCPと#11
の合成回路1B(D出力パルスを合成する第20合成回
路である。
京て、第21!IDq施例においてサーボ回路12OW
A差演算記憶部121に印加される指令パルスは、CP
+ (OF−8P ) となシ、(CP−8P)によシサーボ系の特性に基づく
遍れが補償される。Iaち、分配パルスOFがlI鉋す
れけ直ちに可動部(テーブル)F!移動し、分配パルス
OFの発生が停止すれは直ちに可動部の移動社停止する
。
A差演算記憶部121に印加される指令パルスは、CP
+ (OF−8P ) となシ、(CP−8P)によシサーボ系の特性に基づく
遍れが補償される。Iaち、分配パルスOFがlI鉋す
れけ直ちに可動部(テーブル)F!移動し、分配パルス
OFの発生が停止すれは直ちに可動部の移動社停止する
。
111E4図Hす−ボモータ13のシャツ)Kバルスコ
ーダ郷の位置検出器14を装着し次場合の例で、fIi
f#llと同一部分には同一符号を付している。
ーダ郷の位置検出器14を装着し次場合の例で、fIi
f#llと同一部分には同一符号を付している。
第BmFi2つo毫−fi 15,1B’を同期させる
ための本発明の応用例であゐ、M、第2 rItJs第
4図と同一部分に#i同一符号を付している。又12,
15゜14はそれぞれ餉4図に示ず1−水回路12、サ
ーボモータ11、位置検出器14に相幽する。
ための本発明の応用例であゐ、M、第2 rItJs第
4図と同一部分に#i同一符号を付している。又12,
15゜14はそれぞれ餉4図に示ず1−水回路12、サ
ーボモータ11、位置検出器14に相幽する。
第5図においてモータ13′は分配パルスOPに対し所
定の追従誤差を持って回転している。しかし、モータ1
5は系に7ミ為レータ17、第1、第2合成回路が組込
まれているためフィードバックパルスFPに遅れること
なく回転する。換言すれはモータ1s’、15は同期し
て回転することになる。
定の追従誤差を持って回転している。しかし、モータ1
5は系に7ミ為レータ17、第1、第2合成回路が組込
まれているためフィードバックパルスFPに遅れること
なく回転する。換言すれはモータ1s’、15は同期し
て回転することになる。
以上1本発明によりば定常偏差か存在していても追従誤
差をなくすことができ、2台のモータの同期運転を確実
に行なうことが可能であり、更には同時n軸制御におけ
る加工釉度を向上することができる。
差をなくすことができ、2台のモータの同期運転を確実
に行なうことが可能であり、更には同時n軸制御におけ
る加工釉度を向上することができる。
第1図は従来の位置制御を説明する説明図、第2図は本
発明に係る位置制御を説明する説明図、第5図はシミエ
レータのブロック図、第4図は本発明の別の実施例ブロ
ック図、wIJ5図は本発明の詳細な説明するためのブ
ロック図である。 11・・・NO装置%12・・・サーボ回路、15・・
サーボモータ、14・・・位置検出器、17・・・シj
zレータ。 特許出願人 富士通ファナック株式会社代層人 弁廖士
辻 實 外2名
発明に係る位置制御を説明する説明図、第5図はシミエ
レータのブロック図、第4図は本発明の別の実施例ブロ
ック図、wIJ5図は本発明の詳細な説明するためのブ
ロック図である。 11・・・NO装置%12・・・サーボ回路、15・・
サーボモータ、14・・・位置検出器、17・・・シj
zレータ。 特許出願人 富士通ファナック株式会社代層人 弁廖士
辻 實 外2名
Claims (1)
- 指令値と実際の移動量との誤差を増嘱し、骸誤差が零と
なるようにサーボモータを駆動して可動部を指令位置に
位置決めする位置制御回路を備なえた位置制御方式にお
いて、前記位置制御回路の伝達lf#性を模擬するシミ
ユレータを設けると共に、腋7ミiレータに指令値を入
力し、シミエレータ出力と指令値との誤差を発生し、該
誤差を前記籟令値に加え合せて位置側4回路に入力する
ことを4I像とする位置制御方式。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2242682A JPS58140813A (ja) | 1982-02-15 | 1982-02-15 | 位置制御方式 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2242682A JPS58140813A (ja) | 1982-02-15 | 1982-02-15 | 位置制御方式 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS58140813A true JPS58140813A (ja) | 1983-08-20 |
Family
ID=12082357
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2242682A Pending JPS58140813A (ja) | 1982-02-15 | 1982-02-15 | 位置制御方式 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS58140813A (ja) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61201304A (ja) * | 1985-03-04 | 1986-09-06 | Matsushita Electric Ind Co Ltd | ロボツトの位置制御法 |
JPS62256005A (ja) * | 1986-04-30 | 1987-11-07 | Mitsubishi Heavy Ind Ltd | Nc装置 |
JPH0199485A (ja) * | 1987-10-09 | 1989-04-18 | Toshiba Corp | サーボ電動機の制御装置 |
JPH0816215A (ja) * | 1994-06-27 | 1996-01-19 | Mazda Motor Corp | 機器の制御装置および制御方法 |
-
1982
- 1982-02-15 JP JP2242682A patent/JPS58140813A/ja active Pending
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61201304A (ja) * | 1985-03-04 | 1986-09-06 | Matsushita Electric Ind Co Ltd | ロボツトの位置制御法 |
JPS62256005A (ja) * | 1986-04-30 | 1987-11-07 | Mitsubishi Heavy Ind Ltd | Nc装置 |
JPH0199485A (ja) * | 1987-10-09 | 1989-04-18 | Toshiba Corp | サーボ電動機の制御装置 |
JPH0816215A (ja) * | 1994-06-27 | 1996-01-19 | Mazda Motor Corp | 機器の制御装置および制御方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP0012620A2 (en) | Closed loop type numerical-controlled machine tool | |
US4706003A (en) | Acceleration and deceleration control system | |
KR970002258B1 (ko) | 서보모터의 제어방법 | |
Ishizaki et al. | Cross Coupling Controller for Accurate Motion Synchronization of Dual Servo Systems. | |
JPH0147804B2 (ja) | ||
JP2861277B2 (ja) | 位置決め制御装置および位置決め制御方法 | |
JPS6140602A (ja) | 工作機駆動装置のための制御最適化方法 | |
JPS58140813A (ja) | 位置制御方式 | |
JPS6314363B2 (ja) | ||
JPS6346843B2 (ja) | ||
JPH02178811A (ja) | サーボ制御装置 | |
Tan et al. | Advanced nonlinear control strategy for motion control systems | |
JPH05216540A (ja) | サーボモータの制御方式 | |
JP2636264B2 (ja) | ヘッド位置決め装置のサーボゲイン自動調整方式 | |
JPS6232804B2 (ja) | ||
JPH03107384A (ja) | モータ駆動制御装置 | |
JPS62217304A (ja) | 自動制御装置 | |
US20240061400A1 (en) | Servo control device | |
JPH04333105A (ja) | ロボットの軌跡制御方法 | |
JPS5998216A (ja) | サ−ボ装置 | |
JP2001100819A (ja) | 位置駆動制御システムおよび同期・同調位置駆動制御方法 | |
JP3435828B2 (ja) | 位相制御されるサーボ系の進角自動決定方法 | |
JPS58214905A (ja) | サ−ボ系のフイ−ドフオワ−ド信号発生方法 | |
JPS59194212A (ja) | 数値制御装置 | |
SU1249483A1 (ru) | Двухкоординатна система дл программного управлени |