JPH05324076A - Method and device for controlling speed of bilateral servo - Google Patents
Method and device for controlling speed of bilateral servoInfo
- Publication number
- JPH05324076A JPH05324076A JP15270392A JP15270392A JPH05324076A JP H05324076 A JPH05324076 A JP H05324076A JP 15270392 A JP15270392 A JP 15270392A JP 15270392 A JP15270392 A JP 15270392A JP H05324076 A JPH05324076 A JP H05324076A
- Authority
- JP
- Japan
- Prior art keywords
- speed
- actuator
- servo
- master
- bilateral
- 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.)
- Granted
Links
Abstract
Description
【０００１】[0001]
【産業上の利用分野】本発明は、大型建設機械のよう
に、操作指令装置（以下、マスタという。）に比べてス
レーブの寸法が巨大で、マスタの動きをほぼそのまま拡
大するような制御系において利用するのに適した速度制
御系のバイラテラル・マスタスレーブサーボ制御方法及
び装置に関するものである。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a control system such as a large construction machine in which the size of a slave is larger than that of an operation command device (hereinafter referred to as a master) and the motion of the master is expanded almost as it is. The present invention relates to a bilateral master-slave servo control method and device for a speed control system suitable for use in.
【０００２】[0002]
【従来の技術】今、建設現場では、建設機械の操作の難
しさに起因する熟練オペレータの不足及びオペレータの
高齢化が深刻な問題となっている。これらを解決するた
め、操作性の良いマニュアルオペレーションを得ること
や建設機械の自動化を目的とした、さまざまな研究が行
われている。すなわち、建設機械にコンピュータ制御を
導入して知能化を図ろうとするものである。その中に
は、複雑な環境下でのマスタースレーブ制御において、
その有効性が確かめられているバイラテラル制御方式を
建設機械に導入した武田らの建設作業用バイラテラルマ
ニピュレータの開発がある（武田、吉灘、大坪、建設作
業用バイラテラルマニプレータの開発、第１回ＳＣＲ、
pp.391-396,1990 参照）。武田らは、バイラテラルサー
ボ制御系を同構造のマスタ（操作指令装置）による位置
制御系で構成し、その有効性を確認した。しかし、動作
範囲が非常に大きく、かつ細かい作業にも対応しなけれ
ばならない大型建設機械にとって、操作量に対する拡大
率を変化させることが困難な位置制御系は不向きである
といえる。2. Description of the Related Art At the construction site, the shortage of skilled operators and the aging of operators due to the difficulty of operating construction machines are now serious problems. In order to solve these problems, various studies have been conducted with the aim of obtaining a manual operation with good operability and automating construction machinery. That is, the computer control is introduced into the construction machine to make it intelligent. Among them, in master-slave control in a complicated environment,
Takeda et al. Have developed a bilateral manipulator for construction work that has introduced a bilateral control method, whose effectiveness has been confirmed, into construction machinery (Takeda, Yoshinada, Otsubo, Development of bilateral manipulator for construction work, No. 1). Times SCR,
pp.391-396, 1990). Takeda et al. Constructed a bilateral servo control system with a position control system using a master (operation command device) of the same structure, and confirmed its effectiveness. However, it can be said that the position control system, in which it is difficult to change the expansion rate with respect to the operation amount, is unsuitable for a large construction machine, which has a very large operation range and must cope with fine work.
【０００３】従来から行われてきたバイラテラル・マス
タスレーブ制御系では、マスタとスレーブの寸法がそれ
ほど大きく異なるものではなかったため、もっぱら位置
制御系が使用され、速度制御系についての研究開発はほ
とんど行われていない。異構造マスマスタスレーブ等に
おいても同様である。しかし、上述のように、建設機械
の場合、マスタに比べてスレーブの寸法が巨大であるた
め、マスタの動きをほぼそのまま拡大する位置制御系
は、安全性、安定性、精度の点で不十分である。In the conventional bilateral master-slave control system, the dimensions of the master and slave are not so different from each other. Therefore, the position control system is mainly used, and most of the research and development on the speed control system are performed. I haven't been. The same applies to mass master slaves with different structures. However, as mentioned above, in the case of construction machinery, the size of the slave is larger than that of the master, so a position control system that expands the movement of the master almost as is is insufficient in terms of safety, stability, and accuracy. Is.
【０００４】そこで、本発明者らは、大型建設機械の中
で特に操作が難しいといわれている油圧ショベルについ
て、その操作性向上を目的とした１本レバーによる操作
指令法を提案し（井上、津田、木村、中野、奥田、建設
機械の操作性向上に関する研究第１報、第９回日本ロボ
ット学会学術講演会予稿集、pp.955-956,1991-11）、操
作量に対する拡大率を変化させることで、大きな動作か
ら小さな動作まで対応できる異構造マスタによる速度制
御系の有効性を確認している。加えて、バイラテラル機
能を導入すれば、土砂の状態を常に把握し、岩石等の硬
い環境との急な接触も感知することができるため、作業
効率の向上とオペレータの精神的負担の軽減に、大きく
貢献すると考えられる。Therefore, the present inventors proposed an operation command method using a single lever for the purpose of improving the operability of hydraulic excavators, which are said to be particularly difficult to operate in large construction machines (Inoue, Tsuda, Kimura, Nakano, Okuda, Study on improvement of operability of construction machinery 1st report, 9th Annual Conference of Robotics Society of Japan, Proceedings, pp.955-956, 1991-11) By doing so, we have confirmed the effectiveness of the speed control system with a different structure master that can handle large to small movements. In addition, by introducing the bilateral function, it is possible to constantly grasp the state of the soil and to detect sudden contact with a hard environment such as rocks, thus improving work efficiency and reducing the mental burden on the operator. , Is believed to make a major contribution.
【０００５】[0005]
【発明が解決しようとする課題】本発明の技術的課題
は、大型建設機械のように、マスタに比べてスレーブの
寸法が巨大で、マスタの動きをほぼそのまま拡大するよ
うな制御系における操作性のさらなる向上を期待し、マ
スタによる速度制御系にバイラテラル機能を付加したバ
イラテラルサーボ制御系を提供することにある。The technical problem of the present invention is to improve the operability of a control system, such as a large construction machine, in which the size of the slave is larger than that of the master and the motion of the master is expanded almost as it is. With the expectation of further improvement of the above, it is to provide a bilateral servo control system in which a bilateral function is added to the speed control system by the master.
【０００６】[0006]
【課題を解決するための手段】上記課題を解決するため
の本発明の速度制御バイラテラルサーボ制御方法は、ア
クチュエータ操作のための速度入力を、バイラテラル制
御系を構成するサーボモータをもつマスタによって行
い、駆動用アクチュエータの駆動速度をサーボ駆動器で
制御し、アクチュエータにおいて発生する力をセンサ
で、アクチュエータの駆動位置を位置検出器で検出し
て、操作指令装置を中立位置に戻すようなフィードバッ
ク制御を行い、上記制御において、アクチュエータのサ
ーボ系は、 ｕvout＝−ＫP （ｖc −ｖd ） ・・・（１） ｖd ＝Ｋvdθ ・・・（２） 但し、 ｕvout ：サーボ駆動器への出力 Ｋp ：比較ゲイン ｖC ：駆動用アクチュエータ速度 ｖd ：入力速度 Ｋvd ：入力速度ゲイン θ ：マスタの変位角 に従って速度制御し、マスタのサーボモータへの出力
は、According to a speed control bilateral servo control method of the present invention for solving the above problems, a speed input for operating an actuator is supplied by a master having a servo motor constituting a bilateral control system. Feedback control that controls the driving speed of the driving actuator with the servo driver, detects the driving force of the actuator with the sensor and the driving position of the actuator with the position detector, and returns the operation command device to the neutral position. In the above control, the servo system of the actuator is u vout = −K P (v c −v d ) ... (1) v d = K vd θ ... (2) where u vout : servo Output to driver K p : Comparison gain v C : Driving actuator speed v d : Input speed K vd : Input speed gain θ: According to the displacement angle of the master The speed is controlled and the output to the master servo motor is
【０００７】[0007]
【数５】 とすることを特徴とするものである。[Equation 5] It is characterized by
【０００８】また、上記方法を実施するための本発明の
速度制御バイラテラルサーボ制御装置は、バイラテラル
制御系を構成するサーボモータを有し、アクチュエータ
操作のための速度入力を行うマスタと、発生する力を検
出するセンサ及び駆動位置を検出する位置検出器を備え
た駆動用アクチュエータと、上記駆動用アクチュエータ
の駆動速度を制御するサーボ駆動器と、上記アクチュエ
ータのサーボ系を上記（１）式及び（２）式に従って速
度制御し、マスタのサーボモータへの出力を上記（３）
式及び（４）式によって与える駆動制御装置とを備えた
ことを特徴とするものである。Further, the speed control bilateral servo control device of the present invention for carrying out the above method has a servo motor forming a bilateral control system, and a master for inputting speed for actuator operation, For driving the actuator, a servo actuator for controlling the driving speed of the driving actuator, and a servo system for the actuator are represented by the formula (1) and The speed is controlled according to equation (2), and the output to the master servo motor is set to the above (3).
And a drive control device given by equation (4).
【０００９】[0009]
【実施例】図１は、本発明にかかる速度制御バイラテラ
ルサーボ制御系の構成を示している。この実施例は、油
圧バイラテラル・マスタスレーブ制御を中心に、従っ
て、アクチュエータとして油圧シリンダを用い、アクチ
ュエータに付設するセンサとして上記油圧シリンダで発
生する力を検出する圧力センサを用い、さらにサーボ駆
動器としてサーボバルブを用いた場合について説明する
が、油圧系以外の他のアクチュエータを用いる場合も全
く同様である。DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS FIG. 1 shows the structure of a speed control bilateral servo control system according to the present invention. This embodiment is centered on hydraulic bilateral master-slave control, and therefore uses a hydraulic cylinder as an actuator, uses a pressure sensor for detecting the force generated by the hydraulic cylinder as a sensor attached to the actuator, and further uses a servo driver. The case where a servo valve is used will be described as above, but the same is true when an actuator other than the hydraulic system is used.
【００１０】この速度制御バイラテラルサーボ制御系に
おいては、スレーブにおけるシリンダ操作のための速度
入力を行うマスタ１を備えている。上記マスタ１として
は、グリップ部１ａの水平方向回転、垂直方向回転、グ
リップ部回転の３自由度からなる操作指令装置（井上、
津田、木村、中野、奥田、建設機械の操作性向上に関す
る研究第１報、第９回日本ロボット学会学術講演会予稿
集、pp.955-956,1991-11、及び特願平３−３３７７５６
号参照）が適している。このマスタ１は、上記３自由度
についての操作位置を検出して出力する位置検出器（ロ
ータリエンコーダ）２を備えると共に、バイラテラル制
御系を構成するＤＣサーボモータ３を備え、平歯車によ
り減速駆動されるもので、このマスタ自体、スレーブと
異構造のものでも同構造のものでも差し支えない。In this speed control bilateral servo control system, there is provided a master 1 for inputting speed for cylinder operation in a slave. The master 1 is an operation command device (Inoue, which has three degrees of freedom: horizontal rotation, vertical rotation, and grip rotation of the grip 1a.
Tsuda, Kimura, Nakano, Okuda, Study on improvement of operability of construction machinery 1st report, 9th Annual Conference of Robotics Society of Japan, Proceedings, pp.955-956, 1991-11, and Japanese Patent Application No. 3-337756
No.) is suitable. The master 1 includes a position detector (rotary encoder) 2 that detects and outputs an operation position in the three degrees of freedom, a DC servo motor 3 that constitutes a bilateral control system, and decelerates and drives a spur gear. The master itself and the slave may have a different structure or the same structure.
【００１１】一方、油圧ショベル等の建設機械等の駆動
のために用いられる片ロッドの駆動用油圧シリンダ４
は、一対の圧力室において発生する力を検出するための
圧力センサ５を備えると共に、シリンダの駆動位置を検
出する位置検出器６を備えている。上記圧力センサ５
は、油圧シリンダ４に直接的に設置する必要はなく、そ
れを駆動するサーボバルブ７の出力ポートに取り付ける
こともでき、また、圧力センサに限ることなく、他の力
検出センサを用いてもよいし、手首センサによる検出力
の各自由度への分配力で換算しても同様である。さら
に、上記位置検出器６としては、ラック・ピニオンとロ
ータリエンコーダを組合わせたものなどを用いることが
できる。上記油圧シリンダ４を駆動するサーボバルブ７
としては、圧力制御を十分行えるだけの周波数応答をも
つものを使用し、このサーボバルブ７には、図示しない
定圧油圧供給源によって、一定圧力（減圧弁によって調
節可能）が供給される。なお、図中８はサーボアンプを
示している。On the other hand, a single rod driving hydraulic cylinder 4 used for driving a construction machine such as a hydraulic excavator.
Includes a pressure sensor 5 for detecting the force generated in the pair of pressure chambers, and a position detector 6 for detecting the driving position of the cylinder. The pressure sensor 5
Need not be installed directly on the hydraulic cylinder 4, but can be attached to the output port of the servo valve 7 that drives it, and it is not limited to a pressure sensor, and another force detection sensor may be used. The same applies when the detection force of the wrist sensor is converted into the distribution force to each degree of freedom. Further, as the position detector 6, a combination of a rack and pinion and a rotary encoder can be used. Servo valve 7 for driving the hydraulic cylinder 4
As the servo valve 7, a constant pressure (adjustable by a pressure reducing valve) is supplied to the servo valve 7 by a constant pressure hydraulic pressure supply source (not shown). In the figure, 8 indicates a servo amplifier.
【００１２】上記速度制御バイラテラルサーボ制御系に
おいては、図示を省略しているが、全体的な駆動を制御
するためのコンピュータ等により構成される駆動制御装
置を備えている。この駆動制御装置においては、後述す
る図２の実施例に比して、圧力センサ５からの推定シリ
ンダ出力をそのままマスタ１に伝達するような制御を行
うが、ここでは、その制御系を「力逆送型バイラテラル
サーボ制御系」と呼ぶことにする。Although not shown, the speed control bilateral servo control system is provided with a drive control device composed of a computer or the like for controlling the overall drive. Compared to the embodiment of FIG. 2 described later, this drive control device performs control so that the estimated cylinder output from the pressure sensor 5 is transmitted to the master 1 as it is. It will be referred to as a "reverse feed type bilateral servo control system".
【００１３】この力逆送型バイラテラルサーボ制御系
は、これまで提案されてきたような位置制御系のバイラ
テラルサーボ制御ではなく、速度制御系のバイラテラル
サーボ制御を行い、マスタ１を常に中立位置に戻すよう
なフィードバック制御が行われ、具体的には、上記油圧
シリンダ４のサーボ系を基本的な速度制御の前記（１）
及び（２）式に従って制御し、また、マスタ１のサーボ
モータ３への出力を前記（３）式によって与えるもので
ある。上記（３）式の右辺第一項は、マスタ１を常に中
立位置に戻すための位置フィードバックであるが、この
項は中立位置に戻る範囲でなるべく小さくするのが望ま
しい。また、同第二項は、速度減衰させ、オーバーシュ
ートを防ぐために用いる速度フィードバックで、第三項
が力フィードバックである。This force reverse feed type bilateral servo control system performs bilateral servo control of the speed control system instead of the bilateral servo control of the position control system which has been proposed so far, and always keeps the master 1 neutral. Feedback control for returning to the position is performed. Specifically, the servo system of the hydraulic cylinder 4 is basically the speed control (1).
And equation (2), and the output of the master 1 to the servomotor 3 is given by the equation (3). The first term on the right side of the equation (3) is position feedback for always returning the master 1 to the neutral position, but it is desirable to make this term as small as possible within the range of returning to the neutral position. The second term is velocity feedback used for damping the velocity and preventing overshoot, and the third term is force feedback.
【００１４】図２は、力の情報として、圧力センサから
の推定シリンダ出力と入力速度の積をマスタに伝達する
制御系を示すもので、この制御系をここでは「速度制御
優先力逆送型バイラテラルサーボ制御系」と呼ぶことに
する。この速度制御優先力逆送型バイラテラルサーボ制
御系は、油圧シリンダ側のサーボ系については、前記
「力逆送型バイラテラルサーボ制御系」と同様、（１）
及び（２）式に従うが、モータへの出力は（４）式に従
うような制御系である。（４）式の右辺第一項、第二項
は、（３）式と同様であるが、第三項の力フィードバッ
クの項は、シリンダ出力の関数であるだけでなく、マス
タの変位角、すなわち入力速度の関数にもなっている。
なお、図２の実施例は、上述した点を除いて図１の実施
例と相違するところがないので、同一部分に同一の符号
を付してその説明を省略する。FIG. 2 shows a control system for transmitting the product of the estimated cylinder output from the pressure sensor and the input speed to the master as the force information. This control system is herein referred to as "speed control priority force reverse transfer type". It will be called "bilateral servo control system". This speed control priority force reverse feed type bilateral servo control system is similar to the "force reverse feed type bilateral servo control system" in the servo system on the hydraulic cylinder side (1).
And the equation (2), but the output to the motor is a control system according to the equation (4). The first term and the second term on the right side of the equation (4) are the same as the equation (3), but the term of the force feedback of the third term is not only a function of the cylinder output but also the displacement angle of the master, That is, it is also a function of the input speed.
The embodiment of FIG. 2 is the same as the embodiment of FIG. 1 except for the points described above, and therefore the same parts are designated by the same reference numerals and the description thereof is omitted.
【００１５】次に、本発明の制御系における動作の確認
実験の結果について説明する。実験においては、内径40
mm、ストローク250mm の２つに片ロッド油圧シリンダを
対向させ、１つを本発明によってサーボ制御される駆動
用とし、もう１つを建設現場の土砂をモデル化した負荷
をつくり出すための負荷用として使用した。各シリンダ
を制御するため、圧力制御を十分行えるだけの周波数応
答をもつ、定格流量10 l/min（弁圧力降下70 kgf/cm2）
のサーボバルブを使用した。定圧油圧供給源による各バ
ルブへの供給圧力は、最大シリンダ出力が1000 kgfとな
るように82 kgf/cm2に選んだ。シリンダ操作のための速
度入力は、３自由度のマスタの内の１自由度（水平方向
回転）のみを使って行い、バイラテラル制御による力フ
ィードバック量は、オペレータの疲労も考慮に入れて最
大1.5kg にした。また、負荷用油圧シリンダと駆動用油
圧シリンダとの間には荷重変換器を設け、この荷重変換
器の出力を実際に環境に与えている力と判断した。Next, the result of an experiment for confirming the operation of the control system of the present invention will be described. In the experiment, inner diameter 40
mm, stroke 250 mm, with two single-rod hydraulic cylinders facing each other, one for drive controlled by the present invention, and one for load to create load modeling sand and sand on construction site used. Since each cylinder is controlled, the rated flow rate is 10 l / min (valve pressure drop 70 kgf / cm 2 ) with a frequency response sufficient for pressure control.
The servo valve of was used. The supply pressure to each valve by the constant pressure hydraulic pressure supply source was selected to be 82 kgf / cm 2 so that the maximum cylinder output would be 1000 kgf. Velocity input for cylinder operation is performed using only one degree of freedom (horizontal direction rotation) of the three degrees of freedom master, and the force feedback amount by bilateral control is a maximum of 1.5 considering operator fatigue. was set to kg. In addition, a load converter was provided between the load hydraulic cylinder and the drive hydraulic cylinder, and it was determined that the output of this load converter was the force actually applied to the environment.
【００１６】本実験装置の負荷用シリンダによって与え
ることのできる建設現場の土砂をモデル化した負荷Ｆ
loadは、（５）式のようにばね成分と減衰成分で表され
る。 Ｆload＝ｋe ｘ1 ＋Ｃe ｖ1 ・・・（５） 但し、 Ｃe ：減衰定数 Ｆload：負荷 ｋe ：ばね定数 ｖ1 ：負荷用シリンダ速度 ｘ1 ：負荷用シリンダ位置A load F modeling the earth and sand at the construction site, which can be given by the load cylinder of this experimental apparatus.
The load is represented by a spring component and a damping component as shown in equation (5). F load = k e x 1 + C e v 1 (5) where C e : damping constant F load : load k e : spring constant v 1 : load cylinder speed x 1 : load cylinder position
【００１７】掘削可能時の土砂のばね成分と減衰成分の
割合は、ばね成分に比べ、減衰成分がかなり大きくなる
状態に相当する。また、掘削不可能（停止）時には、減
衰成分が０とみなせるので、土砂は硬いばねとおける。
そこで、本実験では簡単のため、掘削可能時にはダンパ
のみ、掘削不可能時には硬いバネのみで建設現場の土砂
をモデル化することにした。故に、バイラテラルサーボ
制御及びシリンダ出力制限付速度制御の実験で負荷用シ
リンダによって与えられる負荷は、（６）式と（７）式
に従うことになる。（６）式は掘削可能時の、（７）式
は掘削不可能時の負荷出力を表す。 Ｆload＝Ｃe ｖ1 ・・・（６） Ｆload＝ｋe ｘ1 ・・・（７） 掘削可能時の負荷の大きさは、減衰定数Ｃe を変えるこ
とで調整した。The ratio of the spring component and the damping component of the earth and sand when excavation is possible corresponds to a state in which the damping component is considerably larger than the spring component. Further, when excavation is impossible (stop), the damping component can be regarded as 0, so the earth and sand can be regarded as a hard spring.
Therefore, for the sake of simplicity in this experiment, we decided to model the earth and sand on the construction site using only the damper when excavation is possible and only the hard spring when excavation is not possible. Therefore, in the experiment of bilateral servo control and speed control with cylinder output limitation, the load given by the load cylinder follows the equations (6) and (7). Equation (6) represents the load output when excavation is possible, and Equation (7) represents the load output when excavation is not possible. F load = C e v 1 (6) F load = k e x 1 (7) The magnitude of the load when excavation was possible was adjusted by changing the damping constant C e .
【００１８】確認実験１：硬い環境との接触時 硬い環境との接触時における力フィードバックの応答
を、上記油圧バイラテラルサーボ基礎実験装置で確認
し、前記「力逆送型バイラテラルサーボ制御系」及び
「速度制御優先力逆送型バイラテラルサーボ制御系」の
２つのサーボ制御系の比較を行った。実験は、負荷用シ
リンダを完全に固定し、マスタを用いて駆動用シリンダ
を負荷用シリンダに速度を変えて押しつけることによっ
て行い、その時々で、どのような力がマスタに出力され
るか確認した。Confirmation Experiment 1: Contact with hard environment The response of force feedback when contacting with a hard environment was confirmed with the above hydraulic bilateral servo basic experiment device, and the above-mentioned "force reverse feed type bilateral servo control system" was confirmed. And, two servo control systems of "speed control priority force reverse feed type bilateral servo control system" were compared. The experiment was performed by completely fixing the load cylinder and pressing the drive cylinder against the load cylinder at different speeds using the master, and confirmed what force was output to the master at each time. ..
【００１９】硬い環境との接触時における、「力逆送型
バイラテラルサーボ制御系」と「速度制御優先力逆送型
バイラテラルサーボ制御系」との動作の比較を、図３及
び図４に示す。「力逆送型バイラテラルサーボ制御系」
は、入力速度によらず、負荷がそのまま力フィードバッ
ク量としてモータに出力されるので、硬い環境と接触し
た時、負荷に見合った力がマスタに出力される（図３
Ａ）。しかし、負荷を感知し、マスタを中立位置に戻し
ても、力フィードバック量は変わらない（図３Ｂ）。反
対方向にマスタを動かし、硬い環境から完全に離れて負
荷がなくなったとき、はじめて力フィードバック量が０
となる（図３Ｃ，Ｄ）。3 and 4 compare the operation of the "force reverse feed bilateral servo control system" and the "speed control priority force reverse feed bilateral servo control system" when in contact with a hard environment. Show. "Reverse force type bilateral servo control system"
Since the load is directly output to the motor as a force feedback amount regardless of the input speed, the force commensurate with the load is output to the master when in contact with a hard environment (Fig. 3).
A). However, even if the load is sensed and the master is returned to the neutral position, the amount of force feedback does not change (FIG. 3B). When the master is moved in the opposite direction and the load is completely removed from the hard environment, the force feedback amount becomes 0 for the first time.
(FIGS. 3C and 3D).
【００２０】一方、「速度制御優先力逆送型バイラテラ
ルサーボ制御系」では、力フィードバック量が入力速度
に比例するので、硬い環境と接触し、大きな負荷がかか
っても、中立位置を見失うことがない。入力速度が０の
とき、力フィードバック量も０となるので、負荷のかか
った状態での中立位置停止も可能である（図４Ａ，
Ｂ）。On the other hand, in the "speed control priority force reverse feed type bilateral servo control system", since the force feedback amount is proportional to the input speed, the neutral position may be lost even if it comes into contact with a hard environment and receives a large load. There is no. When the input speed is 0, the force feedback amount is also 0, so it is possible to stop at the neutral position under load (Fig. 4A,
B).
【００２１】確認実験２：外力が加わった時 次に、シリンダに外力が加わった時の力フィードバック
の応答を、２つのバイラテラルサーボ制御系について比
較する。実験は、制御用シリンダを固定し、そこに負荷
用シリンダをゆっくり近付けることにより行い、駆動用
シリンダに接触した後、マスタにどのような力が出力さ
れるか確認した。Confirmation Experiment 2: When External Force is Applied Next, the response of force feedback when an external force is applied to the cylinder is compared for two bilateral servo control systems. The experiment was performed by fixing the control cylinder and slowly bringing the load cylinder close to it, and confirmed what force was output to the master after contacting the drive cylinder.
【００２２】実験の結果を図５に示す。図５Ａの「力逆
送型バイラテラルサーボ制御系」では、負荷がそのまま
力フィードバック量としてマスタ制御用モータに出力さ
れるので、負荷用シリンダと接触したとき、マスタが勝
手に動作し、反対方向に動かされてしまう。このマスタ
の反対方向への動きに伴い駆動用シリンダも反対方向に
動く。したがって、シリンダにある負荷をかけたままの
状態を維持するためには、マスタを支えている必要があ
る。一方、図５Ｂの「速度制御優先力逆送型バイラテラ
ルサーボ制御系」では、マスタの入力速度が０のとき、
すなわちマスタが中立位置のとき、力フィードバック量
も０となるので、駆動用シリンダに外力が加わることに
よってマスタが中立位置に戻されたあとも、引き続き駆
動用シリンダに外力がかかった状態をそのまま保持でき
る。このため、力逆型バイラテラルサーボ制御系のよう
に、マスタが反対方向に振れることにより駆動用シリン
ダが逆戻りするというようなことはない。The results of the experiment are shown in FIG. In the "force reverse feed bilateral servo control system" of FIG. 5A, the load is output as it is to the master control motor as the force feedback amount. Therefore, when the load cylinder is contacted, the master operates arbitrarily and the opposite direction is applied. Will be moved to. As the master moves in the opposite direction, the drive cylinder also moves in the opposite direction. Therefore, it is necessary to support the master in order to maintain the state in which a load is applied to the cylinder. On the other hand, in the “speed control priority force reverse feed type bilateral servo control system” of FIG. 5B, when the master input speed is 0,
That is, when the master is in the neutral position, the force feedback amount is also 0. Therefore, even after the master is returned to the neutral position by applying the external force to the drive cylinder, the state in which the external force is continuously applied to the drive cylinder is maintained as it is. it can. Therefore, unlike the force reversal type bilateral servo control system, the drive cylinder does not return due to the master swinging in the opposite direction.
【００２３】確認実験３：改造油圧ショベルへの導入 改造油圧ショベルに「速度制御優先力逆送型バイラテラ
ルサーボ制御系」を導入し、以下に示す４種類の対象物
をバケット先端と鉄製のストッパの間に挟み、これらを
バケットで押しつけたときに発生する力を測定した。４
種類の対象物とは、 1. 空気の抜けたタイヤ 2. 空気の入ったタイヤ 3. 木片 4. ストッパ自身 である。Confirmation Experiment 3: Introduction to Modified Hydraulic Excavator Introduced "speed control priority force reverse feed type bilateral servo control system" to the modified hydraulic excavator, and the following four types of objects are bucket tip and iron stopper It was sandwiched between these, and the force generated when these were pressed with a bucket was measured. Four
Types of objects are: 1. deflated tires 2. pneumatic tires 3. wood chips 4. stoppers themselves.
【００２４】図６はその実験結果である。図中の破線が
ｙ軸方向、実線がｘ軸方向の発生力を表している。図の
縦軸は油圧ショベルが発生している力、横軸は時間であ
る。また、図中の影のついた部分は油圧ショベルが対象
物に接触している場合を示している。図６の結果から、
ほぼ力を加えた方向にのみ力が発生し、接触と同時に発
生力の立ち上がりが見られることから、この力成分をマ
スタにフィードバックすることでオペレータは油圧ショ
ベル先端の接触を知ることができる。そして、最も発生
力が顕著に表れる空気なしのタイヤとストッパであれ
ば、十分それらを力フィードバックのみで区別できるこ
とを確認した。FIG. 6 shows the experimental results. The broken line in the figure represents the generated force in the y-axis direction, and the solid line represents the generated force in the x-axis direction. The vertical axis of the figure is the force generated by the hydraulic excavator, and the horizontal axis is the time. Also, the shaded portion in the figure shows the case where the hydraulic excavator is in contact with the object. From the result of FIG.
Since the force is generated only in the direction in which the force is applied, and the rise of the generated force is seen at the same time as the contact, the operator can know the contact of the tip of the hydraulic excavator by feeding back this force component to the master. Then, it was confirmed that the tires without air and the stoppers in which the generated force most remarkably appears can be sufficiently distinguished from each other only by the force feedback.
【００２５】速度制御系でバイラテラルサーボ制御系を
構成する場合、操作時に入力速度の向きや大きさを常に
把握しておくこと、すなわち中立位置の確認は誤操作を
なくし、作業を安全に行うために非常に重要となる。し
たがって、負荷の大きさ、向きによらず、常に中立位置
に戻るようにマスタが制御される速度制御優先力逆送型
バイラテラルサーボ制御系は、速度制御系において有効
である。また、力逆送型バイラテラルサーボ制御系は、
負荷の大きさに比例した力を常にマスタに出力するの
で、負荷の大きさを正確に伝えることができる。一方、
速度優先力逆送型バイラテラルサーボ制御系は、力フィ
ードバック量が入力速度に依存しているので、負荷の大
きさを正確に伝えることはできないが、大型建設機械に
おいて、こうした不正確さは、以下に述べるような理由
で操作性の向上に格別の障害となるものではない。When a bilateral servo control system is composed of a speed control system, the direction and magnitude of the input speed should always be known at the time of operation, that is, confirmation of the neutral position eliminates erroneous operation and ensures safe work. Will be very important to Therefore, the speed control priority force reverse feed type bilateral servo control system in which the master is controlled so as to always return to the neutral position regardless of the magnitude and direction of the load is effective in the speed control system. In addition, the force reverse type bilateral servo control system
Since the force proportional to the magnitude of the load is always output to the master, the magnitude of the load can be accurately transmitted. on the other hand,
In the speed-priority force reverse-feed bilateral servo control system, the amount of force feedback depends on the input speed, so it is not possible to accurately transmit the magnitude of the load. For the reasons described below, there is no particular obstacle to improving operability.
【００２６】さらに、岩石などをバケットに入れて運ぶ
ようなとき、力逆送型バイラテラルサーボ制御系では、
重力方向に常に負荷を感じながら作業することになる。
もし、マスタの手を緩めると、負荷によりマスタが動か
され、バケットが下がってしまうことになる。建設機械
は、このように長時間、大出力で作業を行う場合が多
く、オペレータがなるべく疲れないようにする必要があ
る。しかるに、上記速度優先力逆送型バイラテラルサー
ボ制御系は、速度指令を行っているときのみが力フィー
ドバックされるので、オペレータの疲労も少なくなる。Further, when a rock or the like is put in a bucket and carried, in the force reverse type bilateral servo control system,
You will always work while feeling the load in the direction of gravity.
If the master's hand is loosened, the load will cause the master to move and the bucket will drop. Construction machines often perform work at high output for such a long time, and it is necessary to prevent the operator from getting tired as much as possible. However, in the speed-priority force reverse-feeding bilateral servo control system, force feedback is performed only when the speed command is being issued, so operator fatigue is reduced.
【００２７】力逆送型バイラテラルサーボ制御系で、シ
リンダ出力をそのままマスタに出力させ、かつ停止時に
はマスタを中立位置に停止させるようにするためには、
厳密な重力補償が必要となる。これに対し、速度制御優
先力逆送型バイラテラルサーボ制御系では、入力速度が
０のとき、どのような負荷でもマスタの出力が０となる
ので、厳密な重力補償は必要でない。従って、このよう
な特性を考慮し、両制御系はそれぞれに適した用途にお
いて用いることが必要である。In the force reverse feed type bilateral servo control system, in order to output the cylinder output to the master as it is and stop the master at the neutral position at the time of stop,
Strict gravity compensation is required. On the other hand, in the speed control priority force reverse feed type bilateral servo control system, when the input speed is 0, the output of the master becomes 0 regardless of any load, and therefore, strict gravity compensation is not necessary. Therefore, in consideration of such characteristics, it is necessary that both control systems be used in their respective suitable applications.
【００２８】[0028]
【発明の効果】以上に詳述した本発明の速度制御バイラ
テラルサーボ制御方法及びその装置によれば、マスタに
よる速度制御系にバイラテラル機能を付加した油圧バイ
ラテラルサーボ制御系を提供し、それによって、大型建
設機械のように、マスタに比べてスレーブの寸法が巨大
で、マスタの動きをほぼそのまま拡大するような制御系
における操作性のさらなる向上を期待することができ
る。According to the speed control bilateral servo control method and apparatus of the present invention described in detail above, a hydraulic bilateral servo control system in which a bilateral function is added to a speed control system by a master is provided. Thus, as in a large construction machine, the slave has a larger size than the master, and it is possible to expect further improvement in operability in the control system that expands the movement of the master almost as it is.
【図１】本発明にかかる速度制御バイラテラルサーボ制
御系についてのブロック構成図である。FIG. 1 is a block diagram of a speed control bilateral servo control system according to the present invention.
【図２】他の実施例のブロック構成図である。FIG. 2 is a block diagram of another embodiment.
【図３】Ａ〜Ｄはいずれも「力逆送型バイラテラルサー
ボ制御系」についての動作説明図である。FIGS. 3A to 3D are operation explanatory views of a “force reverse type bilateral servo control system”.
【図４】Ａ，Ｂは「速度制御優先力逆送型バイラテラル
サーボ制御系」についての動作説明図である。4A and 4B are operation explanatory diagrams of a "speed control priority force reverse feed type bilateral servo control system".
【図５】シリンダに外力が加わった時の力フィードバッ
クの応答についての説明図である。FIG. 5 is an explanatory diagram of a force feedback response when an external force is applied to the cylinder.
【図６】Ａ〜Ｄはいずれも本発明についての実験の結果
を示すグラフである。6A to 6D are graphs showing the results of experiments on the present invention.
１ マスタ（操作指令装置）、 ２ 位置検出器、 ３ ＤＣサーボモータ、 ４ 駆動用油圧シリンダ、 ５ 圧力センサ、 ６ 位置検出器、 ７ サーボバルブ。 1 master (operation command device), 2 position detector, 3 DC servo motor, 4 drive hydraulic cylinder, 5 pressure sensor, 6 position detector, 7 servo valve.
フロントページの続き (72)発明者 奥 田 澄 雄 東京都町田市山崎町1356番地 シーアイハ イツＤ−705Front Page Continuation (72) Inventor Sumio Okuda 1356 Yamazaki-cho, Machida-shi, Tokyo CIA Heights D-705
Claims (4)
バイラテラル制御系を構成するサーボモータをもつ操作
指令装置によって行い、 駆動用アクチュエータの駆動速度をサーボ駆動器で制御
し、アクチュエータにおいて発生する力をセンサで、ア
クチュエータの駆動位置を位置検出器で検出して、操作
指令装置を中立位置に戻すようなフィードバック制御を
行い、 上記制御において、アクチュエータのサーボ系は、 ｕvout＝−ＫP （ｖc −ｖd ） ｖd ＝Ｋvdθ 但し、 ｕvout ：サーボ駆動器への出力 Ｋp ：比較ゲイン ｖC ：駆動用アクチュエータ速度 ｖd ：入力速度 Ｋvd ：入力速度ゲイン θ ：操作指令装置の変位角 に従って速度制御し、 操作指令装置のサーボモータへの出力は、 【数１】 とする、 ことを特徴とする速度制御バイラテラルサーボ制御方
法。1. A velocity input for operating an actuator,
It is performed by an operation command device that has a servo motor that constitutes a bilateral control system, the drive speed of the drive actuator is controlled by the servo driver, and the force generated in the actuator is detected by the sensor and the drive position of the actuator is detected by the position detector. Then, feedback control is performed to return the operation command device to the neutral position. In the above control, the actuator servo system is u vout = −K P (v c −v d ) v d = K vd θ vout: output K p to the servo driver: comparison gain v C: drive actuator velocity v d: input speed K vd: input speed gain theta: controlled rate according to the displacement angle of the operation command unit, the operation command unit servo motor The output to is A speed control bilateral servo control method characterized by the following.
置であって、 バイラテラル制御系を構成するサーボモータを有し、ア
クチュエータ操作のための速度入力を行う操作指令装置
と、 発生する力を検出するセンサ及び駆動位置を検出する位
置検出器を備えた駆動用アクチュエータと、 上記駆動用アクチュエータの駆動速度を制御するサーボ
駆動器と、 上記アクチュエータのサーボ系を、 ｕvout＝−ＫP （ｖc −ｖd ） ｖd ＝Ｋvdθ に従って速度制御し、操作指令装置のサーボモータへの
出力を、 【数２】 によって与える駆動制御装置とを備えた、 ことを特徴とする速度制御バイラテラルサーボ制御装
置。2. An apparatus for carrying out the method according to claim 1, comprising a servomotor constituting a bilateral control system, and an operation command device for inputting a speed for operating an actuator. A driving actuator equipped with a sensor for detecting the force to be detected and a position detector for detecting the driving position, a servo driver for controlling the driving speed of the driving actuator, and a servo system of the actuator, u vout = −K P (v c −v d ) v d = K vd θ The speed is controlled according to θ, and the output to the servo motor of the operation command device is expressed by And a drive control device provided by the speed control bilateral servo control device.
バイラテラル制御系を構成するサーボモータをもつ操作
指令装置によって行い、 駆動用アクチュエータの駆動速度をサーボ駆動器で制御
し、アクチュエータにおいて発生する力をセンサで、ア
クチュエータの駆動位置を位置検出器で検出して、操作
指令装置を中立位置に戻すようなフィードバック制御を
行い、 上記制御において、アクチュエータのサーボ系は、 ｕvout＝−ＫP （ｖc −ｖd ） ｖd ＝Ｋvdθ に従って速度制御し、 操作指令装置のサーボモータへの出力は、 【数３】 とする、 ことを特徴とする速度制御バイラテラルサーボ制御方
法。3. A velocity input for operating an actuator,
It is performed by an operation command device that has a servo motor that constitutes a bilateral control system, the drive speed of the drive actuator is controlled by the servo driver, and the force generated in the actuator is detected by the sensor and the drive position of the actuator is detected by the position detector. Then, feedback control is performed to return the operation command device to the neutral position, and in the above control, the servo system of the actuator controls the speed according to u vout = −K P (v c −v d ) v d = K vd θ. Then, the output to the servo motor of the operation command device is as follows. A speed control bilateral servo control method characterized by the following.
置であって、 バイラテラル制御系を構成するサーボモータを有し、ア
クチュエータ操作のための速度入力を行う操作指令装置
と、 発生する力を検出するセンサ及び駆動位置を検出する位
置検出器を備えた駆動用アクチュエータと、 上記駆動用アクチュエータの駆動速度を制御するサーボ
駆動器と、 上記アクチュエータのサーボ系を、 ｕvout＝−ＫP （ｖc −ｖd ） ｖd ＝Ｋvdθ に従って速度制御し、操作指令装置のサーボモータへの
出力を、 【数４】 によって与える駆動制御装置とを備えた、 ことを特徴とする速度制御バイラテラルサーボ制御装
置。4. An apparatus for performing the method according to claim 3, wherein the apparatus includes a servo motor that constitutes a bilateral control system, and an operation command apparatus that inputs a speed for operating an actuator. A driving actuator equipped with a sensor for detecting the force to be detected and a position detector for detecting the driving position, a servo driver for controlling the driving speed of the driving actuator, and a servo system of the actuator, u vout = −K P (v c −v d ) v d = K vd θ The speed is controlled according to θ, and the output to the servo motor of the operation command device is expressed by And a drive control device provided by the speed control bilateral servo control device.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP15270392A JP3290698B2 (en) | 1992-05-20 | 1992-05-20 | Speed control bilateral servo control method and device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP15270392A JP3290698B2 (en) | 1992-05-20 | 1992-05-20 | Speed control bilateral servo control method and device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH05324076A true JPH05324076A (en) | 1993-12-07 |
| JP3290698B2 JP3290698B2 (en) | 2002-06-10 |
Family
ID=15546305
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP15270392A Expired - Fee Related JP3290698B2 (en) | 1992-05-20 | 1992-05-20 | Speed control bilateral servo control method and device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3290698B2 (en) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103309363A (en) * | 2013-06-24 | 2013-09-18 | 中国科学院长春光学精密机械与物理研究所 | Two-way control method for eliminating imaging rotation of scanning imaging system |
| WO2015037029A1 (en) * | 2013-09-10 | 2015-03-19 | 富士電機株式会社 | Remote handling apparatus for load object and auxiliary apparatus therefor |
| CN109940625A (en) * | 2016-11-22 | 2019-06-28 | 北京航空航天大学 | A kind of robot hydraulic-driven cradle head closed loop control method |
| JP2020520312A (en) * | 2017-05-17 | 2020-07-09 | ティペット，ジョナサン | Control system for joint and operating method thereof |
-
1992
- 1992-05-20 JP JP15270392A patent/JP3290698B2/en not_active Expired - Fee Related
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103309363A (en) * | 2013-06-24 | 2013-09-18 | 中国科学院长春光学精密机械与物理研究所 | Two-way control method for eliminating imaging rotation of scanning imaging system |
| WO2015037029A1 (en) * | 2013-09-10 | 2015-03-19 | 富士電機株式会社 | Remote handling apparatus for load object and auxiliary apparatus therefor |
| US9260278B2 (en) | 2013-09-10 | 2016-02-16 | Fuji Electric Co., Ltd. | Remote handling apparatus for load object and auxiliary apparatus thereof |
| CN109940625A (en) * | 2016-11-22 | 2019-06-28 | 北京航空航天大学 | A kind of robot hydraulic-driven cradle head closed loop control method |
| JP2020520312A (en) * | 2017-05-17 | 2020-07-09 | ティペット，ジョナサン | Control system for joint and operating method thereof |
Also Published As
| Publication number | Publication date |
|---|---|
| JP3290698B2 (en) | 2002-06-10 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Koivumäki et al. | Stability-guaranteed force-sensorless contact force/motion control of heavy-duty hydraulic manipulators | |
| Ha et al. | Impedance control of a hydraulically actuated robotic excavator | |
| Tafazoli et al. | Impedance control of a teleoperated excavator | |
| Ostoja-Starzewski et al. | A master-slave manipulator for excavation and construction tasks | |
| JP2002167794A (en) | Front control device for hydraulic backhoe | |
| JPH05324076A (en) | Method and device for controlling speed of bilateral servo | |
| Mobasser et al. | Transparent rate mode bilateral teleoperation control | |
| Lawrence et al. | Computer-assisted control of excavator-based machines | |
| Bodur et al. | Dynamic cognitive force control for an automatic land excavation robot | |
| Yamada et al. | Development of a telerobotics system for construction robot using virtual reality | |
| JPS62297080A (en) | Master/slave manipulator | |
| Banthia | Haptic-enabled teleoperation of single-rod hydraulic manipulators | |
| JP3253170B2 (en) | Manipulator control method | |
| Herbin et al. | Bilateral teleoperation system for a mini crane | |
| KR100335363B1 (en) | Excavator control equipment | |
| JP4461994B2 (en) | Master / slave manipulator controller | |
| JP3248821B2 (en) | Actuator operating method and device | |
| JPH0447087B2 (en) | ||
| Haas et al. | Practical evaluation of a control concept for a remote controlled 1.8 T excavator using a 3D input device | |
| Chen et al. | Dynamic modeling and trajectory tracking control of a novel muck-removal hydraulic manipulator | |
| JPH05216583A (en) | Input device for 6-freedom-degree information | |
| JPH02279285A (en) | Method and device for controlling master/slave manipulator | |
| JPS5810197B2 (en) | Enkatsu Souji Yuusouchi | |
| JPH05494B2 (en) | ||
| KR0155281B1 (en) | Interpolation method of multi-robot |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| LAPS | Cancellation because of no payment of annual fees |