JPH02232702A - Controller - Google Patents
ControllerInfo
- Publication number
- JPH02232702A JPH02232702A JP5455289A JP5455289A JPH02232702A JP H02232702 A JPH02232702 A JP H02232702A JP 5455289 A JP5455289 A JP 5455289A JP 5455289 A JP5455289 A JP 5455289A JP H02232702 A JPH02232702 A JP H02232702A
- Authority
- JP
- Japan
- Prior art keywords
- gain
- constant
- control device
- proportional
- 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
- 230000010355 oscillation Effects 0.000 abstract 1
- 238000000034 method Methods 0.000 description 12
- 229920006395 saturated elastomer Polymers 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 3
- 238000006073 displacement reaction Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 235000008708 Morus alba Nutrition 0.000 description 1
- 240000000249 Morus alba Species 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000000873 masking effect Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000004043 responsiveness Effects 0.000 description 1
Landscapes
- Feedback Control In General (AREA)
Abstract
Description
【発明の詳細な説明】
(=1)産業上の利用分野
この発明は、産業用ロボットや高速機械等に用いられ、
目標値カーブに制御対象を追従させる制御装置に関する
。[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従来の技術
産業用ロボソトや高速機械など可動部を有する機器の動
作を制御する制御装置においては、その可動部(制御対
象)を与えられた目標値に対して高精度に追従させるた
め種々の制御方式が提案されている。現在最も一般的に
行われている制御方式は1) I D制j3lj方式で
ありこの制御方式では目標値と制御対象の現在値の差(
偏差)に比例する操作量、偏差の積分値に比例する操作
量およびセンザの微分に比例する操作量を所定の割合で
加算して実際に制御対象に印加される操作量を決定する
制御方式である。上記3個の制御要素を加算する割合は
比例ゲイン,速度ゲイン,積分ゲインによりその割合が
決定されるが、これらのゲインは従来はオペレータの手
で経験に基づいて設定されていた.すなわち、制御対象
の負荷イナーシャが大場合と小さい場合とでは最適なゲ
インの比率がことなるのである。しかしこの方式では一
旦入力されると、ゲインは一定であった.
(Cl発明が解決しようとする課題
しかし、ロボットではハンドリングする物体の重lによ
ってイナーシャが大きく変動し、また、可動部の経年変
化などによって動作機能が劣化することがあり、このよ
うな場合これに合わせてゲインを修正するのは面倒であ
り、最適値を求めることが困難であった。(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)課題を解決するための手段
この出願に係る第一の発明は、
制?11量に関する値の微分値に比例定数を乗じた■を
含む操作量で、制御対象を制御する制御装置において、
制IIllに基づき前記比例定数をリアルタイムで変更
するゲイン変更手段を設けたことを特徴とする。(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.
この出願に係る第二の発明は、
制?111に関する値の微分値に比例定数を乗じた量を
含む操作量で、制御対象を制御する制御装置において、
制111mに基づきリアルタイムで定数を求める定数算
出手段と、
定数算出手段によって求められた定数がそれまで使用さ
れていた比例定数よりも大きいとき、この定数を新たな
比例定数として設定する定数更新手段と、
動作開始から一定時間後は前記定数更新手段の動作を禁
止するマスク手段と、
を設けたことを特徴とする.
(e)作用
この出願に係る第1の発明は、センサの微分値に比例し
た操作量を含む操作量を制御対象に印加し、動作制御を
行うPID制御装置等制御装置であり複数の制御要素の
うちセンサの微分値に比例する制御要素の比例定数(微
分ゲイン)のみを制御量に基づいてリアルタイムで変更
する.すなわち、制御量が飽和しているときには微分ゲ
インを大きくし、制II量が飽和していないときには微
分ゲインを小さくする。これにより、イナーシャが大き
い場合の目標位置からの行き過ぎや振動を防止すること
ができ、イナーシャが小さい場合には収束を早めること
ができる。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.
さらに、この出願の第2の発明では、動作開始ののち微
分ゲインを大きな値にのみ更新するようにした。これに
より、負荷イナーシャ変化による微小な振動を未然に防
止した。さらに、一定時間後からは微分ゲインの更新を
禁止した。これ番こより、制御対象に最適な微分ゲイン
が求められたのちの制御を簡略化でき、不必要な振動を
防止することができる。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)実施例
第1図はこの発明の実施例である動作制御装置の概略ブ
ロソク図である。この動作制御装置はモータ9 (制御
対象)を駆動して可動部を所定位置に移動させるもので
ある。モーク9の動作制御は主として線形制IJ器6に
よってPID制御で行われる。この線形制御器6はバス
2に接続され、このバスを介してC P U 1に接続
されている。バス2にはCPUI.線形制御器6のほか
、メモリ3パラメータ読込器4,目標値生成器5,エン
コーダ読取器8が接続されている。パラメータ読込器4
はキース.インチなどを有しており、係員が積分ゲイン
,比例ゲイン,微分ゲイン等を人力する。目標値生成器
5にはインターフェイスが接続されており、このインタ
ーフェイスを介して動作目標データが入力される。目標
値生成器5はこの動作目標データを制御対象の目標値に
変換して出力する.
エンコーダa 取n8にはロータリーエンコーダlOが
接続されている.ロータリーエンコーダ10はモータ9
の回転に同期してパルス信号を発生ずる装置である。こ
のロータリーエンコーダ10が出力するパルス数によっ
てモーク9の回転数(可動部の移動距1甜)を計測する
ことができる。CPUNはエンコーダ読取器8から人力
された可動部の位置および目標値住成器5から入力され
た1」標位置との差(偏差)を算出して線形制御器6に
出力する。また、CPUIは制IIと偏差とに基づいて
速度ゲインKdを決定し、線形制御器6に出力する。こ
こで、目標値は1述のよ・)に位置データとして生成さ
れるため、偏差を微分して求められる微分ゲインは速度
ゲインKdとなる.第2図に線形制御器6のブロソク図
を示す。徐形制御器にはCPUIより偏差データ,制御
量データおよび速度ゲインKdが入力される。偏差デー
タは積分回路l3およびKp乗算回路15に入力される
。積分回路13は偏差を一定時間にわたって積分する回
路であり、このデータはKi乗算回路14に入力される
。ここでKpは比例ゲインK1は積分ゲインである.K
p乗算回路15は入力された偏差にKpを乗じて偏差に
比例した操作遣データを出力する。Kt乗算回路14は
入力された偏差にKLを乗じて偏差の積分値に比例した
1桑作逍データを出力する。比例操作量は目標値追従の
ための主要な操作量となり、積分操作量は定常偏差(オ
フセット)をキャンセルするために用いろれる。(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).
一方、CPUIから入力される位置データは微分回路1
1に入力され、制御対象の変位速度データが求められる
。この変位速度データはKd乗算回路I2に入力される
。Kd乗算回路12はCPLllから入力されたKdゲ
インをこのデータに乗算して速度に比例した操作層デー
タを出力する。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.
乗算回路12,14.15から出力された操作遣データ
は加算器16で加算され、アンプ7に出力される。アン
ブ7では入力された操作量データに基づきモータ9を駆
勤ずるための電流を生成する。この電流はモータ9に入
力され、モータ9は入力された電流によって駆動される
。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.
第3図は前記CPU lの動作を示すフローチャートで
ある。新たな目標値が目標値設定235に入力され、こ
の目標値に向けて、制御装置が動作を開始すると動作が
スター トシ、繰り返し実行され先ずnlではルリ御諺
,目標値,操作量を読み込み、n2で操作■入力対する
制御量出力が飽和じでいるか否かを判断ずる.飽和して
いる場合には目標値への急速な追従は不可能であるため
徐々に目標値へ収束するようにKdを一定値Δだけ増加
させる(n4)。また、飽和していない場合には目標値
へ追従しやすいようにKdを一定値Δだけ小さくする(
n3)。n3およびn4によって更新されたKdをn5
,n6においてKdの最大限度値(MAX Kd),最
小限度値(旧N Kd)と比較する。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.
更新されたKdがMAX Kdよりも大きくなったとき
にはKdをそノMAX Ktl4.:再設定し(n7)
、Kdが旧N Kdよりも小さくなったときにはKdを
1%Kdに再設定する(n8)。n3,n.4で設定さ
れたK d 7′l<MAX Kdと旧NKdの間の値
であればそのままりターンする。制御対象の動作が継続
している間この動作が繰り返し行われる。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.
以上の実施例では、常時!!続してKdの更新を行うよ
うにしたが、一連の動作中には負荷イナーシャが変動し
ない場合(例えば、産業用ロボットが物体をハンドリン
グしてある時点ま′cR送する場合等)にはある程度速
度ゲインの更新を継続すれば適当な値を発見することが
でき、それ以降更新を継続してもより良い値を得ること
が難しいことが考えられる。さらに、動作中に負荷イナ
ーシャが変動したり制御対象の動作状態が変動したとき
、速度ゲインKdが小さくなるように更新した場合には
その後の収束が遅くなったり微小な振動の原因となる場
合がある。そこで、動作開始から一定時刻P.P.(バ
イロソトポイント)以降は微分ゲインの変更を禁止する
とともに、微分ゲインの変更は大きくなる変更のみ許可
するようにして、このような問題を解決することが考え
られる.第4図にこのような実施例のフローチャートを
示す。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.
同図において、先ずnlOで動作開始からの時間経過が
パイロフトポイントを過ぎているかどうかを判断する。In the figure, first, it is determined at nlO whether the time elapsed from the start of the operation has passed the pyroft point.
パイロットポイントを過ぎている場合にはそのままリタ
ーンする。パイロットポイントを過ぎていない場合には
第3図に示した動作を実行し(nil)Kdを算出する
。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.
このKdをKM(更新されたKdの最大値)と比較し(
nl2)、KdO方が大きければKMをKdの値に書き
直して(nl2)リターンする。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.
線形制御器6はKdO値で動作する。また、KMがKd
以上であれば、KdをKMに書き直して(nl3) リ
ターンする.
以上のような制御を行うことにより、制御対象を第5図
(A), (B)に示すように制御することができる
。この図は仮想等価モデルを用いたシミュレーションを
行った結果を示すグラフである.同図において目標値は
ステップ上に変更されており、実線で示す曲線が速度ゲ
インKtをリアルタイムに更新した場合の動作状態(本
願発明)を示し、破線で示す曲線がKdを固定したまま
の制御における動作状態(従来例)を示す.同図(A)
はイナーシャが小さい場合の動作状態を示している.従
来の制御系では、動作が急速に立ち上がるが、目標値を
過ぎて振動を起こしている。これに対してこの発明の制
御系でば速度ゲイン(Kd)が大きくなるため急激な動
作が抑制され振動することなく目標値に収束している.
このグラフにおいてはこの発明の制御系による動作制御
はやや過制動であるが、Kdの増減率(第3図のフロー
チャートにおけるΔ)を適当に選ぶことにより (この
シュミレーシッンよりも小さく選ぶことにより)、臨界
制動に近づけることができる.
また同図(B)はイナーシャが大きい場合を示している
.この場合にはアンプ7やモータ9の出力の限界により
操作量に対し制御遺が飽和しているためKdは小さな値
に抑えられる.これにより制御対象の行き過ぎは小さく
抑えられ従来の制御系のような振動は生じない。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.
第1図はこの発明の実施例である動作制御装置の概略ブ
ロノク図、第2図は同動作制御装置の線形制御器のブロ
ソク図、第3図は同動作制御装置の動作を示すフローチ
ャートである。
第4図は同動作制御装置の他の実施例の動作を示すフロ
ーチャートである。第5図(A),(Bる
)は同動作制御装置によ勢動作制御の状態を示す図であ
る。
6一締形制御器、9−モータ、
10−ロータリーエンコーダ、
11一微分回路、1 2 − K d乗算回路。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)
を含む操作量で、制御対象を制御する制御装置において
、 制御量に基づき前記比例定数をリアルタイムで変更する
ゲイン変更手段を設けたことを特徴とする制御装置。(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.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP5455289A JPH02232702A (en) | 1989-03-07 | 1989-03-07 | Controller |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP5455289A JPH02232702A (en) | 1989-03-07 | 1989-03-07 | Controller |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH02232702A true JPH02232702A (en) | 1990-09-14 |
Family
ID=12973852
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP5455289A Pending JPH02232702A (en) | 1989-03-07 | 1989-03-07 | Controller |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH02232702A (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11327604A (en) * | 1998-05-12 | 1999-11-26 | Mitsubishi Heavy Ind Ltd | Process controller of closed loop system including pid adjusting device |
KR20030020781A (en) * | 2001-09-04 | 2003-03-10 | 주식회사 져스텍 | Unified PID Position Controller for Linear Motor and Gain Design Method Using The Same |
JP2011117836A (en) * | 2009-12-03 | 2011-06-16 | Yokogawa Denshikiki Co Ltd | Control device and gyrocompass |
JP2014078640A (en) * | 2012-10-11 | 2014-05-01 | Canon Inc | Exposure apparatus and device manufacturing method |
-
1989
- 1989-03-07 JP JP5455289A patent/JPH02232702A/en active Pending
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11327604A (en) * | 1998-05-12 | 1999-11-26 | Mitsubishi Heavy Ind Ltd | Process controller of closed loop system including pid adjusting device |
KR20030020781A (en) * | 2001-09-04 | 2003-03-10 | 주식회사 져스텍 | Unified PID Position Controller for Linear Motor and Gain Design Method Using The Same |
JP2011117836A (en) * | 2009-12-03 | 2011-06-16 | Yokogawa Denshikiki Co Ltd | Control device and gyrocompass |
JP2014078640A (en) * | 2012-10-11 | 2014-05-01 | Canon Inc | Exposure apparatus and device manufacturing method |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108189036B (en) | Torque control method and device, robot and storage medium | |
EP0417312B1 (en) | Feedforward control unit for servomotor | |
JP3516232B2 (en) | Method and apparatus for implementing feedback control that optimally and automatically rejects disturbances | |
CN102904521B (en) | Electric motor controller comprising function for simultaneously estimating inertia, friction, and spring | |
CN106020124B (en) | Servo motor control device and collision detection method | |
US5986422A (en) | Control mode changing over method for servo control system | |
KR0137340B1 (en) | Position control system and position control method thereof | |
JP4453526B2 (en) | Servo control device | |
JPH06245561A (en) | Abnormal load detection control method for servo motor | |
JP6646025B2 (en) | Control device and machine learning device | |
EP0474888A1 (en) | Method of regulating gain of motor control | |
JPH02232702A (en) | Controller | |
KR100842978B1 (en) | Servo control method | |
JP2733881B2 (en) | Adaptive sliding mode control method based on PI control loop | |
JPH06131050A (en) | Method for detecting collision of movable part driven by servo motor | |
JPH10105247A (en) | Overshoot preventing method for servomotor | |
JPH03240109A (en) | Robot control method | |
JP2000020104A (en) | Method and device for speed control gain adjustment | |
JPH06187045A (en) | Positioning device | |
JP3197898B2 (en) | Servo motor control method | |
JPH10161706A (en) | Simply adaptive controller | |
KR100194144B1 (en) | Position control method and controller of servomotor by feedforward | |
JPH04233608A (en) | Control method for servo motor | |
JP4019350B2 (en) | CONTROLLER WITH INTEGRATION UNIT AND ITS INTEGRATION METHOD | |
JPH05143106A (en) | Stage control device |