JPS61114304A - デイジタル制御装置 - Google Patents
デイジタル制御装置Info
- Publication number
- JPS61114304A JPS61114304A JP23545684A JP23545684A JPS61114304A JP S61114304 A JPS61114304 A JP S61114304A JP 23545684 A JP23545684 A JP 23545684A JP 23545684 A JP23545684 A JP 23545684A JP S61114304 A JPS61114304 A JP S61114304A
- Authority
- JP
- Japan
- Prior art keywords
- controlled
- motor
- digital
- digital signal
- target value
- 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—Program-control systems
- G05B19/02—Program-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 program 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 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
- 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 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 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 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 using an incremental digital measuring device for point-to-point control
- G05B19/231—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 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 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
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)
- Feedback Control In General (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
〔産業上の利用分野〕
本発明は、例えばロボットの制御のような機械系の制御
に係り、特にそのサーボ*aにおいて高速に演算ができ
るようなディジタルサーボ制御装置に関するものである
。
に係り、特にそのサーボ*aにおいて高速に演算ができ
るようなディジタルサーボ制御装置に関するものである
。
例えばロボットのvIrIJの場合のように目標値を与
えてこれに追従させるサーボ制御装置は、第4図に示す
如く、開数発生器20を有し、モータ24の目標位置X
cと目標速度Vcをこれに入力すると、これに対応した
目標値XRとモータ24の動き初めのみ加速度αRを出
力する。αRはモータの立ち上がり(応答速度)を速め
るために必要なものである。
えてこれに追従させるサーボ制御装置は、第4図に示す
如く、開数発生器20を有し、モータ24の目標位置X
cと目標速度Vcをこれに入力すると、これに対応した
目標値XRとモータ24の動き初めのみ加速度αRを出
力する。αRはモータの立ち上がり(応答速度)を速め
るために必要なものである。
この加速度αRはD/A変換回路21でアナログ値に変
換され、加算器22を経由してパワーアンプ23に増幅
されたのちモータ24を駆動させる。モータ24の現在
位置はエンコーダ25により検出されて、このエンコー
ダ25の出力パルスがカウンタ26でカウントされ、こ
れが前記目標値XRと比較器27にて比較され、その差
のディジタル値がD/A変換回路28でアナログ化され
る。
換され、加算器22を経由してパワーアンプ23に増幅
されたのちモータ24を駆動させる。モータ24の現在
位置はエンコーダ25により検出されて、このエンコー
ダ25の出力パルスがカウンタ26でカウントされ、こ
れが前記目標値XRと比較器27にて比較され、その差
のディジタル値がD/A変換回路28でアナログ化され
る。
このD/A変換回路28のアナログ値は目標値と現在値
の偏差を示すものであるが、これが状態観測器(オブザ
ーバ)30といわれるシミュレータと積分器29に伝達
されて状態観測器30から推定出力される推定速度偏差
値Z1及び推定位置偏差値z2が出力され、また積分器
29から位置偏差の積分値z3が出力される。これらの
各値21、z2及びz3はそれぞれ係数回路33.32
.31によりフィードバック係数に+−に3が乗ぜられ
、加算1s34.35を経由して加算器22に送出され
、パワーアンプ23の入力となり、モータ24をこれに
応じて制御するものとなる。
の偏差を示すものであるが、これが状態観測器(オブザ
ーバ)30といわれるシミュレータと積分器29に伝達
されて状態観測器30から推定出力される推定速度偏差
値Z1及び推定位置偏差値z2が出力され、また積分器
29から位置偏差の積分値z3が出力される。これらの
各値21、z2及びz3はそれぞれ係数回路33.32
.31によりフィードバック係数に+−に3が乗ぜられ
、加算1s34.35を経由して加算器22に送出され
、パワーアンプ23の入力となり、モータ24をこれに
応じて制御するものとなる。
すなわち、従来のサーボ制御装置は制御をよく行うため
にシステムの状態変数を全てフィードバックすることが
望ましいが必らずしも全て測定できるわけではない、そ
こで観測器といわれるシミュレータを用いて系の状態変
数を推定する。このように推定された状態変数は最適レ
ギュレータの理論を用いて適当なフィードバック係数が
乗算されてフィードバックされる。
にシステムの状態変数を全てフィードバックすることが
望ましいが必らずしも全て測定できるわけではない、そ
こで観測器といわれるシミュレータを用いて系の状態変
数を推定する。このように推定された状態変数は最適レ
ギュレータの理論を用いて適当なフィードバック係数が
乗算されてフィードバックされる。
なお関数発生器20はホストプロセッサからの目標値指
令に対してサーボ制御装置がそれに追従できるように滑
らかな目標値関数を発生させるものである。
令に対してサーボ制御装置がそれに追従できるように滑
らかな目標値関数を発生させるものである。
このような、第4図で示す回路では、前記推定速度偏差
値”Zs 、推定位置偏差値Zz、位置偏差の積分値2
3等はアナログ値であり、観測器30や積分器29、ま
た各係数回路31〜33等はオペアンプで構成されてお
り、このような回路構成のために従来はアナログ技術が
用いられてきた。
値”Zs 、推定位置偏差値Zz、位置偏差の積分値2
3等はアナログ値であり、観測器30や積分器29、ま
た各係数回路31〜33等はオペアンプで構成されてお
り、このような回路構成のために従来はアナログ技術が
用いられてきた。
しかしながらアナログ制御回路では、コントローラのパ
ラメータを抵抗、コンデンサなどで設定するので、いっ
たん固定されてしまうと特性が運動や時間の経過につれ
て変化するような制御対象、例えばロボットのようなも
のの制御には、その特性の変化に応じてコントローラの
パラメータを変化させる必要があるため、良好な制御が
行えないという欠点があった。また乗算や加算をオペア
ンプで行うため、必然的にドリフトやオフセットの問題
があり補償するのは容易でない。
ラメータを抵抗、コンデンサなどで設定するので、いっ
たん固定されてしまうと特性が運動や時間の経過につれ
て変化するような制御対象、例えばロボットのようなも
のの制御には、その特性の変化に応じてコントローラの
パラメータを変化させる必要があるため、良好な制御が
行えないという欠点があった。また乗算や加算をオペア
ンプで行うため、必然的にドリフトやオフセットの問題
があり補償するのは容易でない。
そこでフレキシブルな制御が行えるソフトウェア制W(
ディジタル制vIJ)が近年行われているが、マイクロ
コンピュータを用いたソフトウェア制御では演算速度が
遅(、したがってサンプリング周期が長くなり、特にロ
ボットのような高速動作が要求される場合には十分な制
御性能を上げることができなかった。
ディジタル制vIJ)が近年行われているが、マイクロ
コンピュータを用いたソフトウェア制御では演算速度が
遅(、したがってサンプリング周期が長くなり、特にロ
ボットのような高速動作が要求される場合には十分な制
御性能を上げることができなかった。
ディジタル制御では、サンプリング時間、つまり制御量
を制御対象へ入力する間隔をできるだけ短かくすること
が、外乱に強い、良い制御を行うために必須のことであ
るにもかかわらず、従来のディジタル制御ではこれに応
じられないという問題があった。
を制御対象へ入力する間隔をできるだけ短かくすること
が、外乱に強い、良い制御を行うために必須のことであ
るにもかかわらず、従来のディジタル制御ではこれに応
じられないという問題があった。
本発明は前記の問題点を解決した、高速のディジタル制
御装置を提供するため、目標値を出力する目標値出力手
段と、この目標値に達するように制御される被制御体と
、該被制御体の状態を出力する被制御体の状態出力手段
と、前記目標値と被制御体の状態を比較してその差に応
じて被制御体を制御するディジタルサーボ制御装置にお
いて、オブザーバ機能と積分機能を有するディジタル・
シグナル・プロセッサを備え、サーボ系の部分をホスト
プロセッサより切り離してサーボ演算をこのディジタル
・シグナル・プロセッサにより行うようにしたことを特
徴とする。
御装置を提供するため、目標値を出力する目標値出力手
段と、この目標値に達するように制御される被制御体と
、該被制御体の状態を出力する被制御体の状態出力手段
と、前記目標値と被制御体の状態を比較してその差に応
じて被制御体を制御するディジタルサーボ制御装置にお
いて、オブザーバ機能と積分機能を有するディジタル・
シグナル・プロセッサを備え、サーボ系の部分をホスト
プロセッサより切り離してサーボ演算をこのディジタル
・シグナル・プロセッサにより行うようにしたことを特
徴とする。
本発明では高速に乗算、加算などのディジタル演算が実
行できるディジタル・シグナル・プロセッサを専用に用
いてサーボ制御の各演算を行うように構成したので、サ
ンプリング時間を早(することが可能となり、外乱に強
い、精度のよい、高速なサーボ制御を行うことができる
。
行できるディジタル・シグナル・プロセッサを専用に用
いてサーボ制御の各演算を行うように構成したので、サ
ンプリング時間を早(することが可能となり、外乱に強
い、精度のよい、高速なサーボ制御を行うことができる
。
本発明の一実施例を第1図〜第3図にもとづき説明する
。
。
第1図は本発明の一実施例構成図、第2図はそのブロッ
ク図、第3図は本発明の詳細な説明するフローチャート
である。
ク図、第3図は本発明の詳細な説明するフローチャート
である。
図中、1はホストプロセッサであって目標位置Xcや目
標速度Vc等を出力するもの、10はディジタル・シグ
ナル・プロセッサ(以下DSPという)、1工はD/A
コンバータであってDSPloより出力されるディジタ
ル値をアナログ値に変換するもの、12はパワーアンプ
であって第4図のパワーアンプ23に対応するもの、1
3はモータ、14はエンコーダであってそれぞれ第4図
のモータ24、エンコーダ25に対応するものである。
標速度Vc等を出力するもの、10はディジタル・シグ
ナル・プロセッサ(以下DSPという)、1工はD/A
コンバータであってDSPloより出力されるディジタ
ル値をアナログ値に変換するもの、12はパワーアンプ
であって第4図のパワーアンプ23に対応するもの、1
3はモータ、14はエンコーダであってそれぞれ第4図
のモータ24、エンコーダ25に対応するものである。
ディジタル・シグナル・プロセッサは本来ディジタルフ
ィルタや音声合成などのために開発された乗算、加算を
高速に実行する専用のマイクロプロセッサである。この
ディジタル・シグナル・プロセッサ10は、オブザーバ
10−1、積分回路10−2、関数発生器10−3、演
算回路10−4等を具備しており、後述するような処理
を行う。
ィルタや音声合成などのために開発された乗算、加算を
高速に実行する専用のマイクロプロセッサである。この
ディジタル・シグナル・プロセッサ10は、オブザーバ
10−1、積分回路10−2、関数発生器10−3、演
算回路10−4等を具備しており、後述するような処理
を行う。
DSPlOは、本発明の特徴的なものであり、ホストプ
ロセッサ1から目標位置Xcとその時の移動速度Vcが
DSPIOに与えられると、DSPIOはサンプリング
時間毎に現在位置をエンコーダ14から読みながら各サ
ンプリング時点で最適な1llllilu (第11!
!Jの例ではD/Aコンバータ11への出力電圧)を算
出する。このときDSPloは次のような演算を行うこ
とになる。この場合、D/Aコンバータ11、パワーア
ンプ12、モータ13、エンコーダ14からなる制御対
象が次の(11式で示す状態方程式(制御対象の特性を
示すもの)で表わされていると、状態観測器としての機
能によるオブザーバの推定式は次の(2)式で表わすこ
とができる。
ロセッサ1から目標位置Xcとその時の移動速度Vcが
DSPIOに与えられると、DSPIOはサンプリング
時間毎に現在位置をエンコーダ14から読みながら各サ
ンプリング時点で最適な1llllilu (第11!
!Jの例ではD/Aコンバータ11への出力電圧)を算
出する。このときDSPloは次のような演算を行うこ
とになる。この場合、D/Aコンバータ11、パワーア
ンプ12、モータ13、エンコーダ14からなる制御対
象が次の(11式で示す状態方程式(制御対象の特性を
示すもの)で表わされていると、状態観測器としての機
能によるオブザーバの推定式は次の(2)式で表わすこ
とができる。
Z (k+1) =A−Z (k) +b−u −・
−=−=(1)7 (k+1)”C’ ・Z (k+1
>Z−(21) ここでU;制御入力 y;出力値であり、この場合は位置偏差で22である。
−=−=(1)7 (k+1)”C’ ・Z (k+1
>Z−(21) ここでU;制御入力 y;出力値であり、この場合は位置偏差で22である。
またA、b、Cは制御対象の特性から決るものであって
、 Aは行列;b、cはベクトルである。
、 Aは行列;b、cはベクトルである。
そしてC′は転置ベクトルであり、またkはサンプリン
グ時点を表わす。
グ時点を表わす。
そして前記(1)式で示す状態方程式に対し、オブザー
バの推定式は次のように構成される。
バの推定式は次のように構成される。
Z (k+1) −A−Z (k) +b −u+f・
(yテムのyに対応するオブザーバの出力値である。
(yテムのyに対応するオブザーバの出力値である。
モしてrは、
められることになる。
本発明の動作を第3図のフローチャートにしたがって説
明する。
明する。
(1)、DSPloはホストプロセッサ1から出力され
た目標位置Xc及びその時の移動速度Vcを受取ったと
き、エンコーダ14の出力を読み取り現在位置を知る。
た目標位置Xc及びその時の移動速度Vcを受取ったと
き、エンコーダ14の出力を読み取り現在位置を知る。
そして演算回路10−4にて次の(3)式により位置偏
差を算出する。
差を算出する。
位置偏差−目標位置−現在位置 −・−−−一−−
・(3)セ) この位置偏差が零であれば目標位置に一
致した状態であるので、ホストプロセッサ1から次の目
標位置および移動速度を受取る。
・(3)セ) この位置偏差が零であれば目標位置に一
致した状態であるので、ホストプロセッサ1から次の目
標位置および移動速度を受取る。
(3)シかし前記位置偏差が零でなければオブザーバ1
0−1により速度偏差を計算する。
0−1により速度偏差を計算する。
(4) 続いて位置偏!!z2の積分量Z3を積分回
路10−2にて計算する。これは定常偏差の解消に必要
である。
路10−2にて計算する。これは定常偏差の解消に必要
である。
Z 3 ”” f Z 2 d t
−−−−−−−−−−(4)(5) こうして全ての
状態変数である位置偏差22、速度偏差Z1、位置偏差
の積分量Z3を求めたのち、次の(5)式により演算回
路10−4は最適レギュレータ理論により求めたフィー
ドバック係数を各状態変数に乗じて加算し最適の制御量
を求め、この最適制御量を送出し、これをD/Aコンバ
ータ11にてアナログ値に変換してパワーアンプ12で
増幅し、モータ13を制御することになる。
−−−−−−−−−−(4)(5) こうして全ての
状態変数である位置偏差22、速度偏差Z1、位置偏差
の積分量Z3を求めたのち、次の(5)式により演算回
路10−4は最適レギュレータ理論により求めたフィー
ドバック係数を各状態変数に乗じて加算し最適の制御量
を求め、この最適制御量を送出し、これをD/Aコンバ
ータ11にてアナログ値に変換してパワーアンプ12で
増幅し、モータ13を制御することになる。
u=−(kt ・Z+ +kz ・Z2 +に3
1 Z3)・−−一一一−−−−−・−(5) このようにして演算を高速に実行するため、高速で柔軟
なモータのディジタル制御装置を提供することができる
。
1 Z3)・−−一一一−−−−−・−(5) このようにして演算を高速に実行するため、高速で柔軟
なモータのディジタル制御装置を提供することができる
。
なお前記説明ではサーボ制御対象としてモータの例につ
いて説明したが、本発明は勿論モータのみに限定される
ものではない。
いて説明したが、本発明は勿論モータのみに限定される
ものではない。
本発明によればサーボ系部分をホストプロセッサから切
り離して、専用のDSPを使用して高速でサーボ制御の
演算を実行するためサンプリング時間を短かくすること
ができ、外乱に強い頑儂なディジタルサーボ制御装置を
構築できる。さらにフィードバック係数の乗算などをソ
フトで実行するため、ロボットなどのように移動中に特
性が変化するような制御対象にも柔軟に対応することが
できる。
り離して、専用のDSPを使用して高速でサーボ制御の
演算を実行するためサンプリング時間を短かくすること
ができ、外乱に強い頑儂なディジタルサーボ制御装置を
構築できる。さらにフィードバック係数の乗算などをソ
フトで実行するため、ロボットなどのように移動中に特
性が変化するような制御対象にも柔軟に対応することが
できる。
第1図は本発明の一実施例構成図、第2図はそのブロッ
ク図、第3図は本発明の詳細な説明するフローチャート
、第4図は従来のサーボ制御装置である。 図中、1はホストプロセッサ、10はディジタル・シグ
ナル・プロセッサ、11はD/Aコンバータ、12はパ
ワーアンプ、13はモータ、14はエンコーダを示す。
ク図、第3図は本発明の詳細な説明するフローチャート
、第4図は従来のサーボ制御装置である。 図中、1はホストプロセッサ、10はディジタル・シグ
ナル・プロセッサ、11はD/Aコンバータ、12はパ
ワーアンプ、13はモータ、14はエンコーダを示す。
Claims (1)
- 目標値を出力する目標値出力手段と、この目標値に達す
るように制御される被制御体と、該被制御体の状態を出
力する被制御体の状態出力手段と、前記目標値と被制御
体の状態を比較してその差に応じて被制御体を制御する
ディジタルサーボ制御装置において、オブザーバ機能と
積分機能を有するディジタル・シグナル・プロセッサを
備え、サーボ系の部分をホストプロセッサより切り離し
てサーボ演算をこのディジタル・シグナル・プロセッサ
により行うようにしたことを特徴とするディジタル制御
装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP23545684A JPS61114304A (ja) | 1984-11-08 | 1984-11-08 | デイジタル制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP23545684A JPS61114304A (ja) | 1984-11-08 | 1984-11-08 | デイジタル制御装置 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JPS61114304A true JPS61114304A (ja) | 1986-06-02 |
Family
ID=16986368
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP23545684A Pending JPS61114304A (ja) | 1984-11-08 | 1984-11-08 | デイジタル制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPS61114304A (ja) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH02200004A (ja) * | 1989-01-30 | 1990-08-08 | Mazda Motor Corp | マイクロコンピュータの入力信号処理装置 |
| EP0649217A1 (en) * | 1993-10-12 | 1995-04-19 | SMITH & NEPHEW DYONICS INC | Brushless motor |
| US5563481A (en) * | 1992-04-13 | 1996-10-08 | Smith & Nephew Endoscopy, Inc. | Brushless motor |
| US5672945A (en) * | 1992-04-13 | 1997-09-30 | Smith & Nephew Endoscopy, Inc. | Motor controlled surgical system and method having self clearing motor control |
-
1984
- 1984-11-08 JP JP23545684A patent/JPS61114304A/ja active Pending
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH02200004A (ja) * | 1989-01-30 | 1990-08-08 | Mazda Motor Corp | マイクロコンピュータの入力信号処理装置 |
| US5563481A (en) * | 1992-04-13 | 1996-10-08 | Smith & Nephew Endoscopy, Inc. | Brushless motor |
| US5672945A (en) * | 1992-04-13 | 1997-09-30 | Smith & Nephew Endoscopy, Inc. | Motor controlled surgical system and method having self clearing motor control |
| EP0649217A1 (en) * | 1993-10-12 | 1995-04-19 | SMITH & NEPHEW DYONICS INC | Brushless motor |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Lorenz et al. | High-resolution velocity estimation for all-digital, AC servo drives | |
| Torfs et al. | Comparison of two feedforward design methods aiming at accurate trajectory tracking of the end point of a flexible robot arm | |
| KR900007107B1 (ko) | 속도 제어 방식 | |
| Su et al. | Hybrid adaptive/robust motion control of rigid-link electrically-driven robot manipulators | |
| US5532565A (en) | Controller | |
| JPS61114304A (ja) | デイジタル制御装置 | |
| Ciliz et al. | Modeling and compensation of frictional uncertainties in motion control: A neural network based approach | |
| JPH0424701A (ja) | オブザーバ制御方式 | |
| JP2691591B2 (ja) | 力制御ロボットの制御方式 | |
| JPH0695294B2 (ja) | 産業用ロボットの軌跡補間方法 | |
| JPH09191678A (ja) | サーボモータの速度制御方法 | |
| JP3971959B2 (ja) | 位置制御装置及び制御器設計方法 | |
| JP2906255B2 (ja) | サーボ制御装置 | |
| JPH0454888A (ja) | モータ制御装置、外乱負荷トルク推定装置 | |
| JPH104692A (ja) | 電動機の位置制御装置 | |
| EP0605909B1 (en) | Controller | |
| Tarn et al. | Nonlinear feedback method of robot control: A preliminary experimental study | |
| JP3234308B2 (ja) | 複合制御系の制御装置および複合制御系の制御方法 | |
| JPH0550005B2 (ja) | ||
| JPH117303A (ja) | サーボ系の駆動制御装置 | |
| JPH06266425A (ja) | ロボットの制御装置 | |
| JPS5913044B2 (ja) | 高頻度位置決め制御装置 | |
| JP3355614B2 (ja) | マスタ・スレーブロボットの制御装置 | |
| JP3269198B2 (ja) | 位置制御装置 | |
| Moallem et al. | Experimental results for nonlinear decoupling control of flexible multi-link manipulators |