JPH02232702A - Controller - Google Patents

Abstract

PURPOSE:To suppress oscillation of a control object to keep the safety by providing a gain changing means which changes a proportional constant in real time based on a controlled variable. CONSTITUTION:An operation controller drives a motor 9 to move a mobile part to a prescribed position. The operation of the motor 9 is controlled by a linear controller in accordance with PID control. A clerk in charge inputs an integral gain, a proportional gain, a differential gain, or the like to a parameter reader 4. A CPU 1 calculates the difference between the position of the mobile part inputted from an encoder reader 8 and the target position inputted from a target generator 5 and determines a speed gain kd. Deviation data, position data, and the speed gain kd are inputted to the linear controller 6 from the CPU 1, and manipulated variable data outputted from a kd multiplying circuit 12, a ki multiplying circuit 14, and a kp multiplying circuit 15 is added by an adding circuit 16, and the motor 9 is driven by the current generated by an amplifier 7.

Description

【発明の詳細な説明】 （＝１）産業上の利用分野 この発明は、産業用ロボットや高速機械等に用いられ、
目標値カーブに制御対象を追従させる制御装置に関する
。[Detailed description of the invention] (=1) Industrial application field This invention is used for industrial robots, high-speed machines, etc.
The present invention relates to a control device that causes a controlled object to follow a target value curve.

（ｂｌ従来の技術 産業用ロボソトや高速機械など可動部を有する機器の動
作を制御する制御装置においては、その可動部（制御対
象）を与えられた目標値に対して高精度に追従させるた
め種々の制御方式が提案されている。現在最も一般的に
行われている制御方式は１）　Ｉ　Ｄ制ｊ３ｌｊ方式で
ありこの制御方式では目標値と制御対象の現在値の差（
偏差）に比例する操作量、偏差の積分値に比例する操作
量およびセンザの微分に比例する操作量を所定の割合で
加算して実際に制御対象に印加される操作量を決定する
制御方式である。上記３個の制御要素を加算する割合は
比例ゲイン，速度ゲイン，積分ゲインによりその割合が
決定されるが、これらのゲインは従来はオペレータの手
で経験に基づいて設定されていた．すなわち、制御対象
の負荷イナーシャが大場合と小さい場合とでは最適なゲ
インの比率がことなるのである。しかしこの方式では一
旦入力されると、ゲインは一定であった． （Ｃｌ発明が解決しようとする課題 しかし、ロボットではハンドリングする物体の重ｌによ
ってイナーシャが大きく変動し、また、可動部の経年変
化などによって動作機能が劣化することがあり、このよ
うな場合これに合わせてゲインを修正するのは面倒であ
り、最適値を求めることが困難であった。(bl Conventional technology) In control devices that control the operation of equipment with moving parts, such as industrial robot robots and high-speed machines, various methods are used to make the moving parts (controlled objects) follow a given target value with high precision. The following control methods have been proposed.The most commonly used control method at present is the 1) ID control method, and in this control method, the difference between the target value and the current value of the controlled object (
A control method that determines the manipulated variable that is actually applied to the controlled object by adding the manipulated variable that is proportional to the deviation), the manipulated variable that is proportional to the integral value of the deviation, and the manipulated variable that is proportional to the derivative of the sensor at a predetermined ratio. be. The ratio of adding the three control elements mentioned above is determined by the proportional gain, speed gain, and integral gain, but conventionally, these gains were set manually by the operator based on experience. That is, the optimal gain ratio is different depending on whether the load inertia of the controlled object is large or small. However, with this method, once input, the gain was constant. (Cl Problem to be solved by the invention) However, in robots, the inertia varies greatly depending on the weight of the object being handled, and the operating function may deteriorate due to changes in movable parts over time. It is troublesome to modify the gain accordingly, and it is difficult to find the optimum value.

これらの問題に対して、従来よりセルフチューニングと
呼ばれるゲイン設定方式や学習機能を付加した制御系な
どが提案されている．セルフチューニングとは、センサ
や操作量から制御対象の状態を推定し、各ゲインをリア
ルタイムで変更していく方式であるが、この方式はゲイ
ンの推定演算に時間がかかる欠点があり高速で動作する
モータやロボットなどには用いることが困難であった。To address these problems, gain setting methods called self-tuning and control systems with learning functions have been proposed. Self-tuning is a method of estimating the state of the controlled object from sensors and manipulated variables and changing each gain in real time, but this method has the disadvantage that gain estimation calculations take time and operate at high speed. It was difficult to use it for motors, robots, etc.

また学習方式は、一回の試行毎にゲインを変えていく方
法であり、十分な試行回数があれば精度の良いゲイン設
定を行うことができるが、試行回数が少ない場合や、動
作毎に負荷イナーシャが変わる場合には十分な精度を出
すことができない欠点があった。In addition, the learning method is a method in which the gain is changed for each trial, and if there is a sufficient number of trials, it is possible to set the gain with high accuracy, but if the number of trials is small, or if the load is There was a drawback that sufficient accuracy could not be achieved when the inertia changed.

この発明は、上記のような課題に鑑みてなされたもので
、複数の制御要素のゲインのうち微分ゲインのみをリア
ルタイムで変更することにより、集束性や追従精度を向
上することのできる制御装置を提供することを目的とす
る。This invention was made in view of the above-mentioned problems, and provides a control device that can improve focusing performance and tracking accuracy by changing only the differential gain among the gains of a plurality of control elements in real time. The purpose is to provide.

さらにこの発明の目的は、微分ゲインを変更して集束性
や追従性度を向上した場合でも制御対象の振動を抑制し
、安定性を保つことができる制御装置を提供することを
目的とする。A further object of the present invention is to provide a control device that can suppress vibrations of a controlled object and maintain stability even when the focusing ability and followability are improved by changing the differential gain.

（ｄ）課題を解決するための手段 この出願に係る第一の発明は、 制？１１量に関する値の微分値に比例定数を乗じた■を
含む操作量で、制御対象を制御する制御装置において、 制ＩＩｌｌに基づき前記比例定数をリアルタイムで変更
するゲイン変更手段を設けたことを特徴とする。(d) Means for solving the problem The first invention related to this application is a system? 11. In a control device that controls a controlled object with a manipulated variable including a differential value of a value related to a quantity multiplied by a proportionality constant, the control device is characterized by being provided with a gain changing means for changing the proportionality constant in real time based on the control IIll. shall be.

この出願に係る第二の発明は、 制？１１１に関する値の微分値に比例定数を乗じた量を
含む操作量で、制御対象を制御する制御装置において、 制１１１ｍに基づきリアルタイムで定数を求める定数算
出手段と、 定数算出手段によって求められた定数がそれまで使用さ
れていた比例定数よりも大きいとき、この定数を新たな
比例定数として設定する定数更新手段と、 動作開始から一定時間後は前記定数更新手段の動作を禁
止するマスク手段と、 を設けたことを特徴とする． （ｅ）作用 この出願に係る第１の発明は、センサの微分値に比例し
た操作量を含む操作量を制御対象に印加し、動作制御を
行うＰＩＤ制御装置等制御装置であり複数の制御要素の
うちセンサの微分値に比例する制御要素の比例定数（微
分ゲイン）のみを制御量に基づいてリアルタイムで変更
する．すなわち、制御量が飽和しているときには微分ゲ
インを大きくし、制ＩＩ量が飽和していないときには微
分ゲインを小さくする。これにより、イナーシャが大き
い場合の目標位置からの行き過ぎや振動を防止すること
ができ、イナーシャが小さい場合には収束を早めること
ができる。The second invention related to this application is a system? In a control device that controls a controlled object with a manipulated variable that includes a differential value of a value related to 111 multiplied by a proportionality constant, a constant calculation means for calculating a constant in real time based on control 111m, and a constant calculated by the constant calculation means constant updating means for setting this constant as a new proportionality constant when the proportionality constant is larger than the proportionality constant used previously; and masking means for prohibiting the operation of the constant updating means after a certain period of time from the start of operation. It is characterized by the fact that (e) Effect The first invention according to this application is a control device such as a PID control device that controls the operation by applying a manipulated variable including a manipulated variable proportional to the differential value of a sensor to a controlled object, and includes a plurality of control elements. Of these, only the proportional constant (differential gain) of the control element that is proportional to the differential value of the sensor is changed in real time based on the controlled variable. That is, when the control amount is saturated, the differential gain is increased, and when the control II amount is not saturated, the differential gain is decreased. Thereby, it is possible to prevent overshooting and vibration from the target position when the inertia is large, and it is possible to accelerate convergence when the inertia is small.

さらに、この出願の第２の発明では、動作開始ののち微
分ゲインを大きな値にのみ更新するようにした。これに
より、負荷イナーシャ変化による微小な振動を未然に防
止した。さらに、一定時間後からは微分ゲインの更新を
禁止した。これ番こより、制御対象に最適な微分ゲイン
が求められたのちの制御を簡略化でき、不必要な振動を
防止することができる。Furthermore, in the second invention of this application, the differential gain is updated only to a large value after the start of operation. This prevents minute vibrations caused by changes in load inertia. Furthermore, updating of the differential gain was prohibited after a certain period of time. This makes it possible to simplify the control after the optimal differential gain for the controlled object is determined, and to prevent unnecessary vibrations.

（ｆ）実施例 第１図はこの発明の実施例である動作制御装置の概略ブ
ロソク図である。この動作制御装置はモータ９　（制御
対象）を駆動して可動部を所定位置に移動させるもので
ある。モーク９の動作制御は主として線形制ＩＪ器６に
よってＰＩＤ制御で行われる。この線形制御器６はバス
２に接続され、このバスを介してＣ　Ｐ　Ｕ　１に接続
されている。バス２にはＣＰＵＩ．線形制御器６のほか
、メモリ３パラメータ読込器４，目標値生成器５，エン
コーダ読取器８が接続されている。パラメータ読込器４
はキース．インチなどを有しており、係員が積分ゲイン
，比例ゲイン，微分ゲイン等を人力する。目標値生成器
５にはインターフェイスが接続されており、このインタ
ーフェイスを介して動作目標データが入力される。目標
値生成器５はこの動作目標データを制御対象の目標値に
変換して出力する． エンコーダａ　取ｎ８にはロータリーエンコーダｌＯが
接続されている．ロータリーエンコーダ１０はモータ９
の回転に同期してパルス信号を発生ずる装置である。こ
のロータリーエンコーダ１０が出力するパルス数によっ
てモーク９の回転数（可動部の移動距１甜）を計測する
ことができる。ＣＰＵＮはエンコーダ読取器８から人力
された可動部の位置および目標値住成器５から入力され
た１」標位置との差（偏差）を算出して線形制御器６に
出力する。また、ＣＰＵＩは制ＩＩと偏差とに基づいて
速度ゲインＫｄを決定し、線形制御器６に出力する。こ
こで、目標値は１述のよ・）に位置データとして生成さ
れるため、偏差を微分して求められる微分ゲインは速度
ゲインＫｄとなる．第２図に線形制御器６のブロソク図
を示す。徐形制御器にはＣＰＵＩより偏差データ，制御
量データおよび速度ゲインＫｄが入力される。偏差デー
タは積分回路ｌ３およびＫｐ乗算回路１５に入力される
。積分回路１３は偏差を一定時間にわたって積分する回
路であり、このデータはＫｉ乗算回路１４に入力される
。ここでＫｐは比例ゲインＫ１は積分ゲインである．Ｋ
ｐ乗算回路１５は入力された偏差にＫｐを乗じて偏差に
比例した操作遣データを出力する。Ｋｔ乗算回路１４は
入力された偏差にＫＬを乗じて偏差の積分値に比例した
１桑作逍データを出力する。比例操作量は目標値追従の
ための主要な操作量となり、積分操作量は定常偏差（オ
フセット）をキャンセルするために用いろれる。(f) Embodiment FIG. 1 is a schematic block diagram of an operation control device which is an embodiment of the present invention. This motion control device drives a motor 9 (controlled object) to move a movable part to a predetermined position. The operation of the mork 9 is mainly controlled by the linear control IJ device 6 using PID control. This linear controller 6 is connected to the bus 2 and via this bus to the CPU 1. Bus 2 has CPUI. In addition to the linear controller 6, a memory 3, a parameter reader 4, a target value generator 5, and an encoder reader 8 are connected. Parameter reader 4
is Keith. It has inches, etc., and the staff manually calculates the integral gain, proportional gain, differential gain, etc. An interface is connected to the target value generator 5, and operational target data is inputted via this interface. The target value generator 5 converts this operation target data into a target value for the controlled object and outputs it. A rotary encoder lO is connected to encoder a n8. Rotary encoder 10 is motor 9
This is a device that generates a pulse signal in synchronization with the rotation of the The number of rotations of the moke 9 (one distance traveled by the movable part) can be measured by the number of pulses output by the rotary encoder 10. The CPU calculates the difference (deviation) between the position of the movable part manually inputted from the encoder reader 8 and the 1" target position inputted from the target value generator 5, and outputs it to the linear controller 6. Further, the CPU determines a speed gain Kd based on the control II and the deviation, and outputs it to the linear controller 6. Here, since the target value is generated as position data as described in 1), the differential gain obtained by differentiating the deviation becomes the speed gain Kd. FIG. 2 shows a block diagram of the linear controller 6. Deviation data, control amount data, and speed gain Kd are input to the gradual shape controller from the CPUI. The deviation data is input to the integration circuit l3 and the Kp multiplication circuit 15. The integration circuit 13 is a circuit that integrates the deviation over a certain period of time, and this data is input to the Ki multiplication circuit 14. Here, Kp is a proportional gain and K1 is an integral gain. K
The p multiplication circuit 15 multiplies the input deviation by Kp and outputs operation data proportional to the deviation. The Kt multiplication circuit 14 multiplies the input deviation by KL and outputs 1 mulberry cropping data proportional to the integral value of the deviation. The proportional manipulated variable is the main manipulated variable for target value tracking, and the integral manipulated variable is used to cancel steady-state deviation (offset).

一方、ＣＰＵＩから入力される位置データは微分回路１
１に入力され、制御対象の変位速度データが求められる
。この変位速度データはＫｄ乗算回路Ｉ２に入力される
。Ｋｄ乗算回路１２はＣＰＬｌｌから入力されたＫｄゲ
インをこのデータに乗算して速度に比例した操作層デー
タを出力する。On the other hand, the position data input from the CPUI is input to the differential circuit 1.
1, and the displacement velocity data of the controlled object is obtained. This displacement speed data is input to the Kd multiplication circuit I2. The Kd multiplication circuit 12 multiplies this data by the Kd gain input from the CPLll and outputs operation layer data proportional to the speed.

このデータは操作対象の応答性を高めたり、急激な挙動
を抑制したりするために用いられる。This data is used to increase the responsiveness of the operating target and to suppress sudden behavior.

乗算回路１２，１４．１５から出力された操作遣データ
は加算器１６で加算され、アンプ７に出力される。アン
ブ７では入力された操作量データに基づきモータ９を駆
勤ずるための電流を生成する。この電流はモータ９に入
力され、モータ９は入力された電流によって駆動される
。The operation data output from the multiplication circuits 12, 14, and 15 are added by an adder 16 and output to an amplifier 7. The amplifier 7 generates a current for driving the motor 9 based on the input operation amount data. This current is input to the motor 9, and the motor 9 is driven by the input current.

第３図は前記ＣＰＵ　ｌの動作を示すフローチャートで
ある。新たな目標値が目標値設定２３５に入力され、こ
の目標値に向けて、制御装置が動作を開始すると動作が
スター　トシ、繰り返し実行され先ずｎｌではルリ御諺
，目標値，操作量を読み込み、ｎ２で操作■入力対する
制御量出力が飽和じでいるか否かを判断ずる．飽和して
いる場合には目標値への急速な追従は不可能であるため
徐々に目標値へ収束するようにＫｄを一定値Δだけ増加
させる（ｎ４）。また、飽和していない場合には目標値
へ追従しやすいようにＫｄを一定値Δだけ小さくする（
ｎ３）。ｎ３およびｎ４によって更新されたＫｄをｎ５
，ｎ６においてＫｄの最大限度値（ＭＡＸ　Ｋｄ），最
小限度値（旧Ｎ　Ｋｄ）と比較する。FIG. 3 is a flowchart showing the operation of the CPU I. When a new target value is input to the target value setting 235 and the control device starts operating toward this target value, the operation starts and is repeatedly executed. Use n2 to determine whether the control amount output in response to the operation input remains saturated. If it is saturated, rapid tracking to the target value is impossible, so Kd is increased by a constant value Δ so as to gradually converge to the target value (n4). Also, if it is not saturated, reduce Kd by a constant value Δ to make it easier to follow the target value (
n3). Kd updated by n3 and n4 as n5
, n6, the maximum limit value (MAX Kd) and the minimum limit value (old N Kd) of Kd are compared.

更新されたＫｄがＭＡＸ　Ｋｄよりも大きくなったとき
にはＫｄをそノＭＡＸ　Ｋｔｌ４．：再設定し（ｎ７）
、Ｋｄが旧Ｎ　Ｋｄよりも小さくなったときにはＫｄを
１％Ｋｄに再設定する（ｎ８）。ｎ３，ｎ．４で設定さ
れたＫ　ｄ　７′ｌ＜ＭＡＸ　Ｋｄと旧ＮＫｄの間の値
であればそのままりターンする。制御対象の動作が継続
している間この動作が繰り返し行われる。When the updated Kd becomes larger than MAX Kd, the Kd is changed to MAX Ktl4. : Reset (n7)
, when Kd becomes smaller than the old N Kd, Kd is reset to 1% Kd (n8). n3, n. If Kd7'l<MAX set in step 4 is a value between Kd and the old NKd, the turn continues. This operation is repeated while the operation of the controlled object continues.

以上の動作により、操作量が目標値追従に最適でない場
合でも制御対象の動作に対応して速度ゲインが変更され
るため大きな行き過ぎや振動を生じさせずに目標値に収
束させることができる。With the above operation, even if the manipulated variable is not optimal for following the target value, the speed gain is changed in accordance with the operation of the controlled object, so it is possible to converge to the target value without causing large overshoot or vibration.

以上の実施例では、常時！！続してＫｄの更新を行うよ
うにしたが、一連の動作中には負荷イナーシャが変動し
ない場合（例えば、産業用ロボットが物体をハンドリン
グしてある時点ま′ｃＲ送する場合等）にはある程度速
度ゲインの更新を継続すれば適当な値を発見することが
でき、それ以降更新を継続してもより良い値を得ること
が難しいことが考えられる。さらに、動作中に負荷イナ
ーシャが変動したり制御対象の動作状態が変動したとき
、速度ゲインＫｄが小さくなるように更新した場合には
その後の収束が遅くなったり微小な振動の原因となる場
合がある。そこで、動作開始から一定時刻Ｐ．Ｐ．（バ
イロソトポイント）以降は微分ゲインの変更を禁止する
とともに、微分ゲインの変更は大きくなる変更のみ許可
するようにして、このような問題を解決することが考え
られる．第４図にこのような実施例のフローチャートを
示す。In the above example, always! ! Kd is then updated, but if the load inertia does not change during a series of operations (for example, when an industrial robot handles an object and sends it at a certain point) If the speed gain is continued to be updated, an appropriate value can be found, and even if the update is continued thereafter, it may be difficult to obtain a better value. Furthermore, if the speed gain Kd is updated to become smaller when the load inertia fluctuates or the operating state of the controlled object changes during operation, subsequent convergence may be delayed or minute vibrations may occur. be. Therefore, at a certain time P from the start of operation. P. A possible solution to this problem would be to prohibit changes in the differential gain after the (birosoto point) and only allow changes that increase the differential gain. FIG. 4 shows a flowchart of such an embodiment.

同図において、先ずｎｌＯで動作開始からの時間経過が
パイロフトポイントを過ぎているかどうかを判断する。In the figure, first, it is determined at nlO whether the time elapsed from the start of the operation has passed the pyroft point.

パイロットポイントを過ぎている場合にはそのままリタ
ーンする。パイロットポイントを過ぎていない場合には
第３図に示した動作を実行し（ｎｉｌ）Ｋｄを算出する
。If it is past the pilot point, just return. If the pilot point has not been passed, the operation shown in FIG. 3 is executed (nil) to calculate Kd.

このＫｄをＫＭ（更新されたＫｄの最大値）と比較し（
ｎｌ２）、ＫｄＯ方が大きければＫＭをＫｄの値に書き
直して（ｎｌ２）リターンする。Compare this Kd with KM (maximum value of updated Kd) (
nl2), and if KdO is larger, rewrite KM to the value of Kd (nl2) and return.

線形制御器６はＫｄＯ値で動作する。また、ＫＭがＫｄ
以上であれば、ＫｄをＫＭに書き直して（ｎｌ３）　リ
ターンする． 以上のような制御を行うことにより、制御対象を第５図
（Ａ），　　（Ｂ）に示すように制御することができる
。この図は仮想等価モデルを用いたシミュレーションを
行った結果を示すグラフである．同図において目標値は
ステップ上に変更されており、実線で示す曲線が速度ゲ
インＫｔをリアルタイムに更新した場合の動作状態（本
願発明）を示し、破線で示す曲線がＫｄを固定したまま
の制御における動作状態（従来例）を示す．同図（Ａ）
はイナーシャが小さい場合の動作状態を示している．従
来の制御系では、動作が急速に立ち上がるが、目標値を
過ぎて振動を起こしている。これに対してこの発明の制
御系でば速度ゲイン（Ｋｄ）が大きくなるため急激な動
作が抑制され振動することなく目標値に収束している．
このグラフにおいてはこの発明の制御系による動作制御
はやや過制動であるが、Ｋｄの増減率（第３図のフロー
チャートにおけるΔ）を適当に選ぶことにより　（この
シュミレーシッンよりも小さく選ぶことにより）、臨界
制動に近づけることができる． また同図（Ｂ）はイナーシャが大きい場合を示している
．この場合にはアンプ７やモータ９の出力の限界により
操作量に対し制御遺が飽和しているためＫｄは小さな値
に抑えられる．これにより制御対象の行き過ぎは小さく
抑えられ従来の制御系のような振動は生じない。The linear controller 6 operates on the KdO value. Also, KM is Kd
If it is, rewrite Kd to KM (nl3) and return. By performing the above control, the controlled object can be controlled as shown in FIGS. 5(A) and 5(B). This figure is a graph showing the results of simulation using a virtual equivalent model. In the same figure, the target value is changed in steps, and the curve shown by the solid line shows the operating state (this invention) when the speed gain Kt is updated in real time, and the curve shown by the broken line shows the control with keeping Kd fixed. The operating state (conventional example) is shown below. Same figure (A)
shows the operating state when the inertia is small. In conventional control systems, the operation starts up rapidly, but the target value is exceeded and vibrations occur. On the other hand, in the control system of the present invention, the speed gain (Kd) is large, so sudden movements are suppressed and the control system converges to the target value without vibration.
In this graph, the motion control by the control system of the present invention is a little over-braking, but by appropriately selecting the increase/decrease rate of Kd (Δ in the flowchart in Figure 3) (by selecting it to be smaller than this simulation) ), it is possible to approach critical braking. Also, Figure (B) shows the case where the inertia is large. In this case, the control circuit is saturated with respect to the manipulated variable due to the output limits of the amplifier 7 and motor 9, so Kd can be suppressed to a small value. As a result, overshooting of the controlled object is suppressed to a small extent, and vibrations unlike conventional control systems do not occur.

《幻発明の効果 以上のようにこの発明によれば、いわゆる微分ゲインを
オンラインで更新するようにしたことにより、高速に動
作する産業用ロボット等の装置においてもリアルタイム
でゲイン変更が可能となり、制御対象の目標値への速や
かな集束が可能になる。また、動作開始から一定時間の
後．は比例定数の更新を禁止したことにより制御系の負
担を少なくすることができる。さらに、比例定数の更新
を大きいものにのみ許可したことにより、制御対象の振
動を防止することができる． 以上の動作により、操作量が目標値追従に最適でない場
合でも制御対象の動作に対応して微分ゲインが変更され
るため、制御の大きな行き過ぎや振動を生じさせずに目
標値に収束させることができる。《Effects of the Phantom Invention As described above, according to this invention, by updating the so-called differential gain online, it is possible to change the gain in real time even in devices such as industrial robots that operate at high speed, and the control It becomes possible to quickly focus on the target value of the object. Also, after a certain period of time from the start of operation. By prohibiting the updating of the proportionality constant, the burden on the control system can be reduced. Furthermore, by allowing only large proportional constants to be updated, vibration of the controlled object can be prevented. Through the above operation, even if the manipulated variable is not optimal for target value tracking, the differential gain is changed in accordance with the operation of the controlled object, so it is possible to converge to the target value without causing large overcontrol or vibration. can.

【図面の簡単な説明】[Brief explanation of the drawing]

第１図はこの発明の実施例である動作制御装置の概略ブ
ロノク図、第２図は同動作制御装置の線形制御器のブロ
ソク図、第３図は同動作制御装置の動作を示すフローチ
ャートである。 第４図は同動作制御装置の他の実施例の動作を示すフロ
ーチャートである。第５図（Ａ），（Ｂる ）は同動作制御装置によ勢動作制御の状態を示す図であ
る。 ６一締形制御器、９−モータ、 １０−ロータリーエンコーダ、 １１一微分回路、１　２　−　Ｋ　ｄ乗算回路。FIG. 1 is a schematic block diagram of a motion control device that is an embodiment of the present invention, FIG. 2 is a block diagram of a linear controller of the motion control device, and FIG. 3 is a flowchart showing the operation of the motion control device. . FIG. 4 is a flowchart showing the operation of another embodiment of the same operation control device. FIGS. 5(A) and 5(B) are diagrams showing the state of force motion control by the same motion control device. 6 - clamp controller, 9 - motor, 10 - rotary encoder, 11 - differentiation circuit, 12 - Kd multiplication circuit.

Claims (2)

【特許請求の範囲】[Claims] （１）制御量に関する値の微分値に比例定数を乗じた量
を含む操作量で、制御対象を制御する制御装置において
、 制御量に基づき前記比例定数をリアルタイムで変更する
ゲイン変更手段を設けたことを特徴とする制御装置。(1) In a control device that controls a controlled object with a manipulated variable that includes an amount obtained by multiplying a differential value of a value related to a controlled variable by a proportional constant, a gain changing means is provided to change the proportional constant in real time based on the controlled variable. A control device characterized by: （２）制御量に関する値の微分値に比例定数を乗じた量
を含む操作量で、制御対象を制御する制御装置において
、 制御量に基づきリアルタイムで定数を求める定数算出手
段と、 定数算出手段によって求められた定数がそれまで使用さ
れていた比例定数よりも大きいとき、この定数を新たな
比例定数として設定する定数更新手段と、 動作開始から一定時間後は前記定数更新手段の動作を禁
止するマスク手段と、 を設けたことを特徴とする制御装置。(2) In a control device that controls a controlled object with a manipulated variable that includes an amount obtained by multiplying the differential value of a value related to a controlled variable by a proportionality constant, a constant calculating means for calculating a constant in real time based on the controlled variable, and a constant calculating means Constant updating means for setting the determined constant as a new proportionality constant when the obtained constant is larger than the previously used proportionality constant; and a mask for prohibiting the operation of the constant updating means after a certain period of time from the start of operation. A control device comprising means and.