JPH01304501A - Servo loop control method for industrial robot - Google Patents
Servo loop control method for industrial robotInfo
- Publication number
- JPH01304501A JPH01304501A JP13449988A JP13449988A JPH01304501A JP H01304501 A JPH01304501 A JP H01304501A JP 13449988 A JP13449988 A JP 13449988A JP 13449988 A JP13449988 A JP 13449988A JP H01304501 A JPH01304501 A JP H01304501A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- speed
- industrial robot
- servo loop
- 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
- 238000000034 method Methods 0.000 title claims abstract description 8
- 238000004458 analytical method Methods 0.000 claims description 3
- 230000010354 integration Effects 0.000 abstract 1
- 238000013016 damping Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 239000003638 chemical reducing agent Substances 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
Landscapes
- Feedback Control In General (AREA)
Abstract
Description
【発明の詳細な説明】
〔産業上の利用分野〕
本発明は産業用ロボットのサーボループ制御方法に関し
、特にオブザーバによる状態変数推定値のフィードバッ
クゲインをロボットの姿勢を考慮してオンライン的に変
化させる制御方法に関する。[Detailed Description of the Invention] [Industrial Application Field] The present invention relates to a servo loop control method for an industrial robot, and in particular a method for changing the feedback gain of a state variable estimate by an observer online in consideration of the robot's posture. Regarding control method.
一般に産業用ロボットは片持ち構造を成しており、しか
も各アーム等の各可動機体部と各駆動源である各サーボ
モータとの間には低剛性な減速機等が存在している。従
って全体として低剛性であって共振周波数の低い、しか
も減衰性の非常に悪い制御対象系である。この低剛性で
低減衰性のロボットをサーボループによって駆動制御す
る場合、制御すべき状態変数を推定するオブザーバを使
用し、該状態変数の推定値をフィードバックさせる場合
に固定化されたフィードバックゲインを使用して減衰性
の良いフィードバック制御を行なおうとしていた。Generally, industrial robots have a cantilevered structure, and a low-rigidity reduction gear or the like is present between each movable body part such as each arm and each servo motor that is each drive source. Therefore, it is a controlled system that has low rigidity as a whole, a low resonance frequency, and very poor damping properties. When driving and controlling this low-rigidity, low-damping robot using a servo loop, an observer is used to estimate the state variable to be controlled, and a fixed feedback gain is used when feeding back the estimated value of the state variable. They were trying to perform feedback control with good damping performance.
然しなから、上述の如〈産業用ロボットは片持ち構造を
成しており、作動に起因して変化する姿勢並びに作動速
度と共にその動特性は大きく変化する。そのためオブザ
ーバによる状態変数推定値のフィードハックゲインを固
定化することは制御対象系を素早く減衰させるためには
好ましいことではない。However, as mentioned above, industrial robots have a cantilevered structure, and their dynamic characteristics vary greatly with the posture and operating speed that change due to operation. Therefore, fixing the feed-hack gain of the state variable estimate by the observer is not preferable in order to quickly dampen the controlled system.
依って本発明は産業用ロボットの作動姿勢に応じたその
動特性の変動を反映させる該産業用ロボットのサーボル
ープ制御方法の提供を目的とする。Therefore, an object of the present invention is to provide a servo loop control method for an industrial robot that reflects changes in the dynamic characteristics of the industrial robot depending on its operating posture.
上記目的に鑑みて本発明は、産業用ロボットに所望の作
動をさせる場合において、前記産業用ロボットの運動解
析モデルに基づくオブザーバによって状態変数を推定し
、該各状態変数をフィードバックする際、該フィードバ
ックを含む産業用ロボットのサーボループ制御系におけ
る伝達関数が所定の理想伝達関数となるための条件から
各フィードバックゲインをオンライン的に変化させる産
業用ロボットのサーボループ制御方法を提供する。In view of the above object, the present invention estimates state variables using an observer based on a kinematic analysis model of the industrial robot when causing an industrial robot to perform a desired operation, and when feeding back each state variable, the feedback Provided is a servo loop control method for an industrial robot in which each feedback gain is changed online based on conditions for a transfer function in a servo loop control system of an industrial robot including a predetermined ideal transfer function.
オブザーバによる状態変数推定値のフィードバックゲイ
ンに関し、全体制御系であるサーボループ内での前記フ
ィードバックを含む産業用ロボットの伝達関数が、例え
ばステップ人力に対し理想的な減衰特性を示す理想伝達
関数となるための条件から各フィードバックゲインをオ
ンライン的に算出して各推定値のフィードバックを行な
う。従って産業用ロボットの作動姿勢並びに作動速度に
応じた動特性の変動を反映した制御が行なえる。Regarding the feedback gain of the state variable estimated value by the observer, the transfer function of the industrial robot that includes the feedback in the servo loop that is the overall control system is an ideal transfer function that exhibits ideal damping characteristics for, for example, human step force. Each feedback gain is calculated online from the conditions for the calculation, and each estimated value is fed back. Therefore, control can be performed that reflects changes in dynamic characteristics depending on the operating posture and operating speed of the industrial robot.
以下本発明を添付図面に示す実施例に基づいて更に詳細
に説明する。第2図は産業用ロボ・ノドの可動機体部、
例えばアーム12と駆動源であるサーボモータのロータ
10とを並列配置された1次元ばね14とダッシュポッ
ト16とで接続した運動解析モデルである。この1次元
ばね14とダッシュポット16とは主としてアーム12
とサーボモータのロータ10との間に介在する減速機1
8をモデル化したものであり、このモデルは減速機その
ものの動特性を概ね正確に表わすものであることが簡単
な実験により分かっている。この解析モデルによって次
の運動方程式が成立する。The present invention will be described in more detail below based on embodiments shown in the accompanying drawings. Figure 2 shows the movable body of the industrial robot Nodo.
For example, this is a motion analysis model in which an arm 12 and a rotor 10 of a servo motor serving as a drive source are connected by a one-dimensional spring 14 and a dashpot 16 arranged in parallel. This one-dimensional spring 14 and dashpot 16 are mainly connected to the arm 12.
and the rotor 10 of the servo motor.
8, and it has been found through simple experiments that this model generally accurately represents the dynamic characteristics of the reducer itself. This analytical model establishes the following equation of motion.
ここで、
Tニモータの出力トルク、
θM:ロータ10の回転角度、
JM二フロータ10慣性モーメント、
θR:モータ軸換算のロボットアーム回転角度、JR:
モータ軸換算のロボットアームの慣性モーメント、
KC:減速機部分の涙り捩りばね係数、BK:減速機部
分の減衰係数、
である。この解析モデルにおいて、出力トルクTを入力
とし、モータにおけるロータの回転角速度jMを出力と
する伝達関数Gは次式となる。Here, T motor output torque, θM: rotation angle of rotor 10, JM two floater 10 moment of inertia, θR: robot arm rotation angle converted to motor axis, JR:
The moment of inertia of the robot arm in terms of the motor shaft, KC: tear torsional spring coefficient of the reducer section, BK: damping coefficient of the reducer section. In this analytical model, a transfer function G whose input is the output torque T and whose output is the rotational angular velocity jM of the rotor in the motor is expressed by the following equation.
−Jω’−BK・(1/JM+1/JR)・ω”+KC
・(1/JM+1/JR)・Jω−参〇 ノλ
ゲインIGIは次式で表わされる。-Jω'-BK・(1/JM+1/JR)・ω”+KC
・(1/JM+1/JR)・Jω−三〇ノλ Gain IGI is expressed by the following formula.
…二
このゲインICIは2つの極値IGIIと1G21を有
し、夫々ω=ω1又はω=ω2の所でボード線図におい
て極値となるとすれば次式が成り立つ。...2 This gain ICI has two extreme values IGII and 1G21, and assuming that they become extreme values in the Bode diagram at ω=ω1 or ω=ω2, respectively, the following equation holds true.
KC干JR・ω1! ・・・ホ
ここで、A= 1/JM+ 17JR
B=1/JM
C= 1/ (JM−JR)
である。ロボットの場合変化の小さなω、の変動幅を予
め実験的に定めておき、それを所望の精度で等分割し、
その分割幅で1回前のω1の推定値からはじめてω、を
移動し、最小ゲインになる位置を現時点でのω、として
決定し、その値ω1を上記の式ホへ代入してKCを算出
し、またこのω−ω1の条件を式ニヘ代入してゲインl
G11を算出して弐へからBKを算出する。なおJMと
JRは現時点でのロボット姿勢から算出できる。KC Han JR・ω1! ...Here, A=1/JM+17JR B=1/JM C=1/(JM-JR). In the case of robots, the fluctuation range of ω, which has a small change, is determined experimentally in advance, and it is divided into equal parts with the desired accuracy.
Using that division width, move ω starting from the previous estimated value of ω1, determine the position where the minimum gain is achieved as the current ω, and substitute that value ω1 into the above formula E to calculate KC. Then, by substituting this ω-ω1 condition into equation N, the gain l
Calculate G11 and then calculate BK. Note that JM and JR can be calculated from the current robot posture.
第1図は制御対象22である産業用ロボットのサーボル
ープ制御を示している。外部のコントローラ(図示せず
)において指令回転速度が発信され、積分ゲインに4と
比例ゲインに5とを有した速度トルク変換器20を通し
て指令トルクTに変換する。ロボット内の所定のサーボ
モータは指令トルクTに応じた電流制御によって駆動さ
れ、回転速度xi(−/7M)が出力される。この出力
回転速度xlはパルスエンコーダ等によって実測され、
その実測回転速度x1をフィードバックして、指令回転
速度との差を速度トルク変換器20へ入力させる。FIG. 1 shows servo loop control of an industrial robot, which is a controlled object 22. A command rotational speed is transmitted from an external controller (not shown) and converted into a command torque T through a speed-torque converter 20 having an integral gain of 4 and a proportional gain of 5. A predetermined servo motor within the robot is driven by current control according to the command torque T, and outputs a rotational speed xi (-/7M). This output rotational speed xl is actually measured by a pulse encoder etc.
The measured rotational speed x1 is fed back and the difference between it and the commanded rotational speed is input to the speed-torque converter 20.
このサーボループ制御11において、系の安定性向上の
ためオブザーバ24を設けている。このオブザーバ24
の状態変数の推定には前述の運動状態方程式イと口を使
用しており、x2C=OM−JR)及びx3 (=θM
−θR)の推定値x2とx3を夫々ゲインに2 、に3
を有する増幅器26゜28を通して指令トルクTヘフィ
ードバックさせている。入力を指令トルクT、出力をモ
ータ回転速度θM(=X1)とする二点鎖vA30で示
す部分子 S S”+(BK/JM+BK/
JR−に2)・S+ (KC/JM+KC/JR,に3
)この伝達関数を、ステップ入力に応じて第3図に示す
応答をする北森の理想伝達関数と比較する。In this servo loop control 11, an observer 24 is provided to improve the stability of the system. This observer 24
The state variables of
-θR) estimated values x2 and x3 are set to gains 2 and 3, respectively.
The command torque T is fed back through an amplifier 26. Partial molecule S S”+(BK/JM+BK/
JR-2)・S+ (KC/JM+KC/JR, 3)
) This transfer function is compared with Kitamori's ideal transfer function, which responds as shown in FIG. 3 in response to a step input.
北森の理想伝達関数とは2次の場合次式で表示される。Kitamori's ideal transfer function is expressed by the following equation in the quadratic case.
0.5・δ2・S2+δ・S+1
ここでδは、応答目標値の63%に達するまでの時間を
示す時定数である。この両伝達関数の特性方程式の係数
比較から次式を得る。0.5・δ2・S2+δ・S+1 Here, δ is a time constant indicating the time until 63% of the response target value is reached. The following equation is obtained by comparing the coefficients of the characteristic equations of both transfer functions.
8に/JM+BK/JR−K 2 = 1 / 0.5
6・・・トKC/JM+KC/JR−K 3 = 1
/ 0.5δ2・・・チこの各式ト、チに、前述の式ホ
、へを代入することによりフィードバックゲインに2と
に3を算出することができる。時定数δは第1図に示す
速度ループの時定数の1/4〜I15とする。To 8/JM+BK/JR-K 2 = 1 / 0.5
6... KC/JM+KC/JR-K 3 = 1
/0.5δ2...C By substituting the above-mentioned equations E and E into each of these equations G and J, it is possible to calculate a feedback gain of 2 and 3. The time constant δ is set to 1/4 to I15 of the time constant of the speed loop shown in FIG.
以上の説明から明らかな様に本発明によれば、刻々変化
するロボットの作動姿勢並びに作動速度からオンライン
的にJM、JR1及びω1を算定することができ、゛こ
の現時点の各値から推定値/\ /へ
x2とx3の各フィードバックゲインに2とに3をオン
ライン的に変化させ、最適なサーボループ制御を行なう
ことができる。即ち減衰性の高い安定な制御が可能とな
る。As is clear from the above description, according to the present invention, JM, JR1, and ω1 can be calculated online from the ever-changing operating posture and operating speed of the robot. By changing the feedback gains of x2 and x3 by 2 and 3 online, optimal servo loop control can be performed. In other words, stable control with high damping performance is possible.
第1図は制御対象のサーボループ制御図、第2図は制御
対象(ロボット)のオブザーバに使用する解析モデル図
、
第3図は理想伝達関数の説明用応答図。
IO・・・サーボモータのロータ、
12・・・アーム、 18・・・減速機。Fig. 1 is a servo loop control diagram of the controlled object, Fig. 2 is an analytical model diagram used for an observer of the controlled object (robot), and Fig. 3 is an explanatory response diagram of the ideal transfer function. IO...Rotor of servo motor, 12...Arm, 18...Reduction gear.
Claims (1)
、前記産業用ロボットの運動解析モデルに基づくオブザ
ーバによって状態変数を推定し、該各状態変数をフィー
ドバックする際、該フィードバックを含む産業用ロボッ
トのサーボループ制御系における伝達関数が所定の理想
伝達関数となるための条件から各フィードバックゲイン
をオンライン的に変化させることを特徴とする産業用ロ
ボットのサーボループ制御方法。1. When causing an industrial robot to perform a desired operation, state variables are estimated by an observer based on the motion analysis model of the industrial robot, and when each state variable is fed back, the servo of the industrial robot including the feedback is A servo loop control method for an industrial robot, characterized in that each feedback gain is changed online based on conditions for a transfer function in a loop control system to be a predetermined ideal transfer function.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP13449988A JPH01304501A (en) | 1988-06-02 | 1988-06-02 | Servo loop control method for industrial robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP13449988A JPH01304501A (en) | 1988-06-02 | 1988-06-02 | Servo loop control method for industrial robot |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH01304501A true JPH01304501A (en) | 1989-12-08 |
Family
ID=15129751
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP13449988A Pending JPH01304501A (en) | 1988-06-02 | 1988-06-02 | Servo loop control method for industrial robot |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH01304501A (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH04109304A (en) * | 1990-08-30 | 1992-04-10 | Fanuc Ltd | Adaptive pi control system |
WO1995011478A1 (en) * | 1993-10-18 | 1995-04-27 | Siemens Aktiengesellschaft | Control device |
-
1988
- 1988-06-02 JP JP13449988A patent/JPH01304501A/en active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH04109304A (en) * | 1990-08-30 | 1992-04-10 | Fanuc Ltd | Adaptive pi control system |
WO1995011478A1 (en) * | 1993-10-18 | 1995-04-27 | Siemens Aktiengesellschaft | Control device |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR100276873B1 (en) | Servo control method and servo control system for supply drive system | |
Altintas et al. | Sliding mode controller design for high speed feed drives | |
JPH05216504A (en) | Adaptive sliding mode control system for control object including spring system | |
WO1991005296A1 (en) | Sliding mode control method | |
US5920169A (en) | Servomotor control method | |
JPS63314606A (en) | Controller for articulated robot | |
JP2016194761A (en) | Servo motor control device and collision detecting method | |
JP3239789B2 (en) | Control device and control method | |
JPS615302A (en) | Controller of manipulator | |
JPH0720941A (en) | Flexible servo control method capable of specifying softness on work coordinates | |
JPH10329063A (en) | Robot control device | |
JP2004234205A (en) | Numerical controller | |
JP2000148210A (en) | Gain calculating device | |
JPH0962363A (en) | Motor positioning control method | |
JPS61201304A (en) | Method for controlling position of robot | |
JPH01304501A (en) | Servo loop control method for industrial robot | |
JP4576530B2 (en) | Servo gain calculation method, servo gain calculation program, and servo gain calculation device | |
Zeng et al. | Nonlinear friction compensation of a flexible robotic joint with harmonic drive | |
WO1991003780A1 (en) | Method of controlling robot | |
JPH07185817A (en) | Weaving control method of multi-axes robot | |
JP2580502B2 (en) | Force / torque control method for motor with reduction gear | |
JPH08278821A (en) | Damping method for servo control system | |
JPH04112690A (en) | Control method for servo motor | |
JPH08323670A (en) | Manipulator controller | |
JPS61217802A (en) | Robot controller |