Patents

Search tools Text Classification Chemistry Measure Numbers Full documents Title Abstract Claims All Any Exact Not Add AND condition These CPCs and their children These exact CPCs Add AND condition
Exact Exact Batch Similar Substructure Substructure (SMARTS) Full documents Claims only Add AND condition
Add AND condition
Application Numbers Publication Numbers Either Add AND condition

ディジタル型繰り返し制御方式

Abstract

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

Classifications

G05B21/02 Systems involving sampling of the variable controlled electric

Landscapes

Show more

JPH043208A

Japan

Other languages
English
Inventor
Mitsuhiko Araki
荒木 光彦
Keiji Sakamoto
坂本 啓二
Heisuke Iwashita
平輔 岩下
Current Assignee
Fanuc Corp

Worldwide applications
1990 JP 1991 DE US EP WO

Application JP2103058A events
Pending

Description

【発明の詳細な説明】 産業上の利用分野 本発明は、ロボットや工作機械等において、あるパター
ンが目標入力として周期的に繰り返し人力され、制御対
象に同一動作を繰り返させるディジタル制御系に関する
従来の技術 ロボットや工作機械等の制御対象に、あるパターンで周
期的に繰り返される目標入力を入力して、制御対象に同
一動作を周期的に繰り返させるときの制御方式として、
内部モデル原理によるディジタル型繰り返し制御方式か
公知である。
この内部モデル原理によるディジタル型繰り返し制御方
式は、周期Tであるパターンの周期入力信号y (t)
があり、サンプリング周期をτとし、T/τ=L  (
L・正の整数)とすると、信号y (t)のZ変換Yr
(Z)は次の第1−式で表される。
Yr(Z)= r o+ r 、  Z−’+−+ r 、−、Z ’
−’+ (ro + r、z−’+−=+ rL−i 
 z”’ )z−’・・・ (1) なお、ro +  rI + ”’rLlは周期信号y
 (t)のパターンの係数、Z−1,・・・ZL−1は
1時間遅れ。
・・・(L−1)1時間遅れを表す。
ro + r Hz−’+−・−+ rt−I ZL−
’ =Yv。(Z)とおくと、 Yr(Z)= Y、。(Z)(1+Z−’+Z−2L+・・・ )=Y
、。(Z)/ (1−Z−’) =ZL −Y、0 (Z)/ (ZL−1)−(2)と
なる。したがって、周期信号Y (t)の発生モデルは
1/ (ZL−1)と考えることができ、このモデルを
補償器内に組み込めば定常偏差のない制御系が実現でき
る。繰り返し制御系の設計法としては、例えば第4図の
ブロック図のように制御系を構成しフィードバックゲイ
ンhとに1〜kLを適当に選び、閉ループ系を構成し、
拡大系として状態フィードバックによる安定化を行なえ
ばよい。
発明が解決しようとする課題 上述した従来例の内部モデル原理によるディジタル型繰
り返し制御方式は、制御対象の状態変数x (i)を含
んでおり、この状態変数x (i)が既知でなければ、
制御系を構成することができない。一般に、状態変数x
 (i)は測定不可能であるから、第4図のブロック図
では実現できない。
そのため制御系を構成する上で大きな困難があり、自由
な設計が難しいという問題がある。また、従来方式では
時間遅れ系の数が入力周期幅をサンプリングタイムτで
割った値しに固定しなければならず入力周期の変動にフ
レキシブルに対応できないという問題がある。
そこで本発明の目的は、制御対象の状態変数が分からな
くても制御系を構成でき、追従遅れの少ないディジタル
型繰り返し制御方式を提供すると共に、入力の周期が変
動してもパラメータの変更だけで、制御系の構造を変え
ることなしに内部モデル原理を満足するディジタル型繰
り返し制御系を提供することにある。
課題を解決するための手段 本発明は、目標指令値と制御対象の出力の差分である偏
差を利用して周期的な目標指令値に少ない偏差で制御対
象を追従させるディジタル制御系において、周期的な目
標指令値の入力周期Tを上記偏差のサンプリング時間τ
で除して得られる整数り以上のn個の時間遅れ系を、あ
るゲインを介して上記偏差に縦続に接続し、各サンプリ
ング時における上記偏差に0を含む係数をかけて全ての
時間遅れ入力に加算すると共に、各サンプリング時にお
ける上記縦続に接続されたn個の時間遅れ系の最後の出
力に当該サンプリング時の偏差を加算した値を制御対象
の入力として与え、各サンプリング時における当該制御
対象への入力に0を含む係数をかけて全ての時間遅れ入
力に加算することによって、追従遅れの少ない制御系を
構成した。
作   用 n個の各時間遅れ系には1つ前の時間遅れ系の出力と、
当該サンプリング時の偏差にゲインを乗じた値および制
御対象の入力にゲインを乗じた値を加算した値が記憶さ
れる。n個の時間遅れ系には目標指令値の1周期分のデ
ータが記憶されており、各サンプリング時には、当該サ
ンプリング時の上記偏差に最後の時間遅れ系の出力が加
算されて制御対象に入力される。
実施例 第3図に示すように、入力をu(k)、出力をy(k)
、制御対象の状態変数をx (k)とした制御対象1を
考える。すなわち、制御対象1は、x (k+1)−A
x (k)+Bu (k)y (k)=Cx (k) 
      ・・・(3)が成立するとする。
この制御対象10入力端に目標指令値の周期Tをサンプ
リング時間τで除した値より大きい正の整数の値のn(
≧T/τ)個の遅れ要素Z−1を接続して得られる拡大
系に対しては、 y (k)・Cx(k) y (k+l) =Cx (k+l) =CAl (k
) +CBu (k)y (k+2) =Cx (k+
2) A x (k) +CABu (k) +Ch (k+I)
丁(k+n) CI (k+n) =CA x  (k)+CA・ Eu (k) + C″ Bu (k+I) +−−−+CBu (k+n−])
これを一連の式にまとめて記述すると、と記述すること
ができる。
なお、 第3式、 第4式 %式% Bは行列を意味する。
第5式より、 となる。
ここで、 u (k+n I) となるような行列H (h。
・・・・・・h。
が存在する と仮定すると、 第4式のフィードバック制御則は、 I (k) −に、。
u (k) −k。
u(k+I)− ・・・・・・・・・・・・・・・・・・・・・・・・−
に1u(k+n k、。
v (k) −に、。
u (k+I)・・・・・ u(k+n m、  u(k)+m、−1  u(k+I)+ −−
−−−−+rr+、  u(k+n−11−h、  y
(k)−==−−−=−h+  y(k+n1)−ho
 y(k+n)となって制御則からx (k)を取り除
くことができフィードバック制御則は第2図として現さ
れる。
第2図より、 w 、  (k+n)=m 、 u(k)−b、 y(
k)     −(7−1)v n−1(k+n)・m
 n−1u(k+I)−り、、−+ r(t!I)+W
、  (k+n)   −(7−2)故に第8式より、 u 、(k+n):=w、(k+n)−ho y (k
+n)u(k)=w1 (k)−ho (k)   −
−(9)第7−n式にに+nの代わりにに+1を代入し
、第7−n−1式にに+nの代わりにに+2を代入し、
以下順次に+nの代わりにに+3.に+4゜・・・・・
・、そして第7−2式のに+nの代わりにに+n−1を
代入すると、 v 1(k+])□m + u(k)−hlF(k)+
v2(k÷I) ・(10i)w  2 (k+2)=
m  2 u(k)−h2  y(k)4w3  (k
+2)  −(10−2)v 2(k+n)=m 2u
(k+n−2)−h2y(k+n−2)4w  3 (
k+n)    −(7−n−1)v  、  (k十
n)=m  、  u(k+n−1)−1z  y(k
+n−1)4w2(k+n)   −・・・l7−n)
以上より w  )  (k+n)= m、  u(k)+m、、−,u(k+I)+  −・
−−−−+m、  u(k+n−1)h、、v (k)
−−・−・・−h+  Y (k+n−])=u (k
+n)÷ha  y(k十n)           
  +・+  (8)w n−1(k+n−1)・m 
、、−1υ(k)−h、−+  y(k)4wゎ  (
k+n−])     ]=iIO−n−]上記第7−
1.第10−1式〜第1O−n−1式および第9式より
制御則は第1図の構成となる。
上記第1図に示す構成の直列補償器を用い、入力−y 
(k)の代わりにyr (k)−y (k)(目標値−
出力)を入力し、該直列補償器の出力u (k)を制御
対象に入力するようにすることによって、目標に対して
追従遅れの少ない制御系を構成することができる。しか
も、第1図に示す直列補償器は、制御対象の状態変数を
含まないので、設計自由度の大きい制御系が構成できる
発明の効果 本発明は、あるパターンで周期的に繰り返し入力され、
制御対象に同一動作を周期的におこなわせるディジタル
型繰り返し制御方式において、制御対象の状態変数が不
明でも、制御対象の出力を用いて、少ない偏差で制御対
象を追従させることができる。また、制御対象の状態変
数を含まない直列補償器を構成するので、追従遅れの少
ない制御系の設計が容易となる。
【図面の簡単な説明】
第1図は本発明の一実施例における直列補償器の構成図
、第2図は本実施例の直列補償器を得る過程における制
御則のブロック図、第3図は制御対象にn個の遅れ要素
を接続したブロック図、第4図は従来の直列補償器を組
み込んだ制御系の一例を示すブロック図である。 1・・・制御対象、Z−1・・・遅れ要素、ho −h
n +  ml 〜m、 ・・・ゲイン。

Claims (1)
Hide Dependent

    【特許請求の範囲】
  1. 目標指令値と制御対象の出力の差分である偏差を利用し
    て周期的な目標指令値に少ない偏差で制御対象を追従さ
    せるディジタル制御系において、周期的な目標指令値の
    入力周期Tを上記偏差のサンプリング時間τで除して得
    られる整数L以上のn個の時間遅れ系を、あるゲインを
    介して上記偏差に縦続に接続し、各サンプリング時にお
    ける上記偏差に0を含む係数をかけて全ての時間遅れ入
    力に加算すると共に、各サンプリング時における上記縦
    続に接続されたn個の時間遅れ系の最後の出力に当該サ
    ンプリング時の偏差を加算した値を制御対象の入力とし
    て与え、各サンプリング時における当該制御対象への入
    力に0を含む係数をかけて全ての時間遅れ入力に加算す
    ることを特徴とするディジタル型繰り返し制御方式。