JP3415611B2

JP3415611B2 - マニピュレータの姿勢角度制御装置

Info

Publication number: JP3415611B2
Application number: JP2001359971A
Authority: JP
Inventors: 裕吉灘; 重明足利; 健治岡村; 和彦大坪; 稔大浦; 郁夫北; 伸二竹内
Original assignee: Komatsu Ltd
Current assignee: Komatsu Ltd
Priority date: 2001-11-26
Filing date: 2001-11-26
Publication date: 2003-06-09
Anticipated expiration: 2018-06-09
Also published as: JP2002234700A

Description

【発明の詳細な説明】

【０００１】

【産業上の利用分野】本発明は、操縦レバーの操作に応
じて作業機の動作させるマニピュレータに関し、特に作
業機の姿勢角度を制御する装置に関する。

【０００２】

【従来の技術および発明が解決しようとする課題】マニ
ピュレータには、作業機と相似形の操縦レバーをマス
タ、作業機をスレーブとするマスタ・スレーブ方式のも
のがある。

【０００３】このマニピュレータにおいて、複数のアー
ムよりなり、多数の自由度を持つ作業機を操作する場合
には、作業機（スレーブ）と相似な形状を有した操縦レ
バー（マスタ）を用意して、作業機の作動範囲と相似な
操作範囲で操縦レバーを操作することが、操作性を向上
させる上で有効である。

【０００４】しかしながら、オペレータに負担がかから
ず無理なく操作できる操縦レバーの操作範囲と、作業機
に要求される作動範囲とは必ずしも相似にはならなく、
あえてレバー操作範囲を非相似化した方が、オペレータ
にかかる負荷が減り操作性が向上し、制御の精度が向上
することがある。

【０００５】そこで、第１アーム３（３´）と第２アー
ム８（８´）からなる平面２自由度の操縦レバー１４お
よび作業機２１を対象とした、従来の「非相似化」の具
体例を図７に示す。

【０００６】すなわち、同図に示すように、１）マスタ１４の第１アーム３´の姿勢角（操作量）
αと第２アーム８´の姿勢角（操作量）γが検出され、
これら検出値α、γが角度／座標変換部２５に加えら
れ、該角度／座標変換部２５においてマスタ１４先端の
座標位置ｘm、ｙmに変換する演算が行なわれる。

【０００７】２）マスタ２１先端の座標位置ｘm、ｙm
はマスタ／スレーブ座標変換部２６に加えられ、該マス
タ／スレーブ座標変換部２６においてスレーブ２１先端
の目標座標位置ｘs、ｙsに変換する演算が行なわれる。

【０００８】３）スレーブ２１先端目標座標位置ｘ
s、ｙsは座標／角度変換部２７に加えられ、該座標／角
度変換部２７においてスレーブ２１の目標姿勢角βd、
δdに変換する演算が行なわれる。

【０００９】４）スレーブ２１の第１アーム３の姿勢
角βと第２アーム８の姿勢角δが検出され、これら検出
された現在のスレーブ姿勢角β、δと目標姿勢角βd、
δdとがそれぞれ比較され、それぞれの偏差が求めら
れ、各偏差に応じた駆動指令値がスレーブ２１の駆動系
へ出力される。

【００１０】この制御装置では、マスタ１４の操作量
α、γを所望の操作範囲内に設定し、この設定操作範囲
の中で、スレーブ２１が所望の動作をするように、各変
換部２５、２６、２７にて変換演算が行なわれる。

【００１１】しかし、上記１）の処理では、順運動学問
題を、また上記３）の処理では、逆運動学問題を解く必
要があるため、複雑な演算が必要とされ、計算機にかか
る負担が大きく演算に多大な時間を要することになる。
このため、いきおい演算能力の高いＣＰＵを使用せざる
を得なくなり、高コストを招来することが必至である。

【００１２】本発明は、こうした実状に鑑みてなされた
ものであり、「非相似化」を複雑な計算を要しないで実
現するようにして、操作性の向上、つまり制御精度の向
上を、低コストで実現することを目的とするものであ
る。

【００１３】

【課題を解決するための手段】そこで、この発明の主た
る発明では、マスタ側に設けられた操縦レバーの操作角
度に応じてスレーブ側に設けられた作業機の姿勢角度を
変化させる制御を行うマスタ・スレーブ方式マニピュレ
ータの姿勢角度制御装置において、前記操縦レバーの所
望の操作範囲の中から異なる複数の操作角度を抽出し
て、前記操縦レバーが前記所望の操作範囲で操作された
場合に前記作業機が所望の動作範囲で動作するように、
前記抽出された複数の操作角度と前記作業機の姿勢角度
との対応づけを行ない、この対応づけられた複数の角度
間を補間する補間手段と、前記補間手段による補間によ
って求められた前記所望操作範囲の操縦レバー操作角度
と前記所望動作範囲の作業機姿勢角度との対応関係を記
憶する記憶手段と、前記操縦レバーの現在の操作角度に
対応する作業機の姿勢角度を、前記記憶手段に記憶され
た対応関係に基づいて求め、該求められた姿勢角度が得
られるように前記作業機の姿勢角度を制御する制御手段
とを具えている。

【００１４】

【作用】上記本発明の構成によれば、図４、図５、図６
に示すように、操縦レバー１４の所望の操作範囲αmin
〜αmaxの中から異なる複数の操作角度α1、α2、α3が
抽出され、操縦レバー１４が所望の操作範囲αmin〜αm
axで操作された場合に作業機２１が所望の動作範囲βmi
n〜βmaxで動作するように、抽出された複数の操作角度
α1、α2、α3と作業機２１の姿勢角度β1、β2、β3と
の対応づけが行なわれ、この対応づけられた複数の角度
間が補間されて対応関係Ｌ1あるいはＬ2が求められる。
そして、この所望操作範囲αmin〜αmaxの操縦レバー操
作角度と所望動作範囲βmin〜βmaxの作業機姿勢角度と
の対応関係Ｌ1あるいはＬ2が記憶手段２４に記憶され
る。

【００１５】そして操縦レバー１４の現在の操作角度α
に対応する作業機の姿勢角度βdが、上記記憶手段２４
に記憶された対応関係Ｌ1あるいはＬ2に基づいて求めら
れ、該求められた姿勢角度βdが得られるように作業機
２１の姿勢角度が制御される。

【００１６】以上のように、本発明によれば予め対応関
係Ｌ1、Ｌ2を求め記憶しておき、それを読み出すだけで
よく、複雑な演算を要しない。

【００１７】

【実施例】以下、図面を参照して本発明に係るマニピュ
レータの姿勢角度制御装置の実施例について説明する。

【００１８】図１は、所定の作業を行う自立移動式のマ
ニピュレータの構成を示す図であり、同図（ａ）は正面
図を、同図（ｂ）は同図（ａ）を上面からみた図を示し
ている。さて、同図１に示すように、このマニピュレー
タは、大きくは、移動台車１と、マスタである操縦レバ
ー１４が配設されている上部旋回体２と、スレーブであ
る作業機２１とから構成されている。

【００１９】すなわち、クローラ式の移動台車１の上に
は、旋回自在に上部旋回体２が搭載されており、この旋
回体２と一体構成の支持部材２ａには、ブーム、つまり
第１アーム３の一端７ｃとこの第１アーム３を回転駆動
する第１アーム駆動シリンダ４の一端４ａとが、それぞ
れ第１アーム３、駆動シリンダ４を回動自在とするよう
に取り付けられている。第１アーム３の先端７ａは、中
間ブラケット５に、第１アーム３を回動自在とするよう
に連結されている。

【００２０】一方、上記第１アーム３と平行となるよう
に第１リンク６が、第１アーム３と同様にして支持部材
２ａ、ブラケット５に装着されている。すなわち、第１
リンク６の一端７ｄは、支持部材２ａに、また第１リン
ク６の他端７ｂは、ブラケット５に、それぞれ第１リン
ク６を回動自在とするように装着されている。

【００２１】以上のように、第１アーム３、第１リンク
６、支持部材２ａ、ブラケット５によって、四節点７ａ
〜７ｄの平行リンク機構である垂直リンク７が構成され
ている。

【００２２】また、上記中間ブラケット５には、第２ア
ーム８の一端１２ａとこの第２アーム８を回転駆動する
第２アーム駆動シリンダ９の一端９ａとが、第２アーム
８および駆動シリンダ９をそれぞれ回動自在とするよう
に取り付けられている。第２アーム８の先端１２ｃは先
端ブラケット１０に、アーム８を回動自在とするように
連結されている。

【００２３】一方、上記第２アーム８と平行となるよう
に第２リンク１１が、第２アーム８と同様にして中間ブ
ラケット５、先端ブラケット１０に装着されている。す
なわち、第２リンク１１の一端１２ｂは、中間ブラケッ
ト５に、また第２リンク１１の他端１２ｄは、先端ブラ
ケット１０に、それぞれ第２リンク１１を回動自在とす
るように装着されている。

【００２４】以上のように、第２アーム８、第２リンク
１１、中間ブラケット５、先端ブラケット１０によって
も、上記垂直リンク７と同様に、四節点１２ａ〜１２ｄ
の平行リンク機構である水平リンク１２が構成されてい
る。

【００２５】そして、水平リンク１２の先端ブラケット
１０には、ハンド１３が回動自在に装着されており、こ
のハンド１３によりワークを把持する等して所定の作業
を行う。

【００２６】また、上記旋回体２には、操縦レバー１
４、操縦室１５、エンジン１６、油圧ポンプ１７等走行
および作業機操縦に必要な機器が搭載されている。な
お、図２では、移動台車１がクローラ式の場合を想定し
ているが、もちろんタイヤ式であってもよい。

【００２７】ここで、作業機２１の操縦は、上記操縦レ
バー１４をマスタとし、作業機２１をスレーブとする、
公知のマスタ・スレーブ方式により行われる。そして、
マスタ・スレーブ方式による作業機２１の姿勢角、つま
り第１アーム３、第２アーム８の回転角度の制御は、こ
れら各回転角度をフィードバックして行うことが一般的
である。

【００２８】そこで、フィードバック量を検出すべく、
中間ブラケット５の外側面５ａの第１アーム３取付部
（回動支点）７ａには、第１アーム３の回転角度βを検
出するポテンショメータ２２が配設されるとともに、同
じく外側面５ａの第２アーム８取付部（回動支点）１２
ａには、第２アーム８の回転角度δを検出するポテンシ
ョメータ２３が配設されている。

【００２９】いま、第１アーム駆動シリンダ４が伸縮動
作されると、図２に示すように、垂直リンク７は平行リ
ンク機構であるために、第１アーム３の姿勢が変化した
としても、中間ブラケット５の姿勢は変化しない。この
ため、第２アーム８は、平行状態を保って上下動される
ことになる。

【００３０】このようにブラケット５の姿勢は変化しな
いで第１アーム３の姿勢のみが変化するので、上記ブラ
ケット５に配設されたポテンショメータ２２によって、
ブラケット５に対する第１アーム３の相対的な回転角度
βを検出することができる。一方、ブラケット５に配設
されたポテンショメータ２３によっても、ブラケット５
に対する第２アーム３の相対的な回転角度δが検出され
る。

【００３１】以上のような構造の作業機２１によれば、
ポテンショメータを垂直リンク７の根元に配設しなくて
も済むので、整備性が向上して、調整を容易に行うこと
ができるとともに、他部品との干渉防止のために専用の
レボフレームを用意しなくてもよく汎用のフレームをそ
のまま使用することができるので、コストを低く抑える
ことができる。

【００３２】そして、これらポテンショメータ２２、２
３で検出された各回転角度β、δと操縦レバー１４の操
作角度に応じた目標姿勢角との偏差に基づいて、後述す
るようにして作業機２１の姿勢角度が制御される。

【００３３】ところで、第１アーム３の重心Ｗ1及び第
２アーム８の重心Ｗ2の軌跡は図２の一点鎖線で示すよ
うになっており、このとき第１アーム駆動シリンダ４に
作用する慣性モーメントＪは、Ｊ＝（Ｗ1／ｇ）・ｒ*2＋（Ｗ2／ｇ）・Ｒ*2 …（１）となる。なお、「*2」とあるのは「２乗」を意味するも
のと定義する（以下同じである。）一方、従来の構造の作業機のブーム（第１アーム）ａの
重心Ｗ1´とアーム（第２アーム）ｃの重心Ｗ2´の軌跡
は、図７の一点鎖線で示すようになっており、このとき
ブームシリンダ（第１アーム駆動シリンダ）ｂに作用す
る慣性モーメントＪ´は、Ｊ´＝（Ｗ1´／ｇ）・ｒ*2＋（Ｗ2´／ｇ）・（ｒ1）*2 …（２）となる。

【００３４】これら（１）、（２）式を比較すると、通
常Ｒ＜ｒ1なので、Ｒ*2＜＜（ｒ1）*2となり、したがっ
てＪ＜＜Ｊ´となり、第１アーム３の回動時に第１アー
ム駆動シリンダ４に作用する慣性モーメントは、従来の
構造の作業機のものよりも極めて小さくなる。したがっ
て、慣性負荷が低減されて、制御の精度が向上する。以
上のように、この実施例によれば、コスト低減が図れる
とともに、姿勢角の制御を精度よく行うことができると
いう効果を奏する。

【００３５】さて、図３は、他の実施例を示す図であ
り、作業機２１´の構成部分のみを示している。なお、
図１と同一符号のものは同一機能のものである。すなわ
ち、図３のものでは、第１アーム３に対応する部分のみ
を四節点の平行リンク７で構成し、第２アーム８に対応
する部分はリンク構成とせずに一般的な構成としてお
り、先端ブラケット１０を回動するための先端ブラケッ
ト駆動シリンダ２０が第２アーム８に連結されている。

【００３６】なお、以上説明した実施例では、ポテンシ
ョメータ２２、２３を中間ブラケット５の片側同一面５
ａ上に取り付けるようにしているが、取り付ける面を異
ならせてもよい。

【００３７】また、以上説明した実施例では、作業機２
１の操縦は、操縦レバー１４をマスタとし、作業機２１
をスレーブとする、公知のマスタ・スレーブ方式により
行われることを想定しているが、マニピュレータ一般、
つまり「空間内において有形の運動および方向の変更が
でき、そのような運動および変更はヘッドから離れた手
段によって随意に制御されるような、把持部またはワー
クヘッドを有するハンドリング器具、装置または機械」
への適用が可能であり、必ずしも「制御ユニットと制御
されるユニットの両者が対応する空間的運動をする」マ
スタ・スレーブ方式のマニピュレータに適用が限定され
るわけではない。

【００３８】つぎに、以上説明した構造の作業機を有し
たマニピュレータの姿勢角の制御について図４〜図６を
参照して説明する。

【００３９】ここで、マスタである操縦レバー１４は、
図４に示すように、作業機２１の第１アーム３、第２ア
ーム８と相似な形状の第１アーム３´、第２アーム８´
を有している。よって、操縦レバー１４の第１アーム３
´が操作量（姿勢角）αだけ回動操作されることによっ
て、作業機２１の第１アーム３が上記操作角度αに応じ
た角度βだけ回動し、その姿勢角が変化される。同様
に、操縦レバー１４の第２アーム８´が操作量（姿勢
角）γだけ回動操作されることによって、作業機２１の
第２アーム８が上記操作角度γに応じた角度δだけ回動
し、その姿勢角が変化される。なお、第１アーム３、第
２アーム８の制御内容は同様であるので、以下第１アー
ム３のみを代表させて説明する。

【００４０】制御の開始前には、以下の処理が前処理と
して行われる。

【００４１】すなわち、まず、操縦レバー１４の第１ア
ーム３´について所望の操作範囲αmin〜αmaxが決定さ
れる。この決定の基準は、オペレータに負担がかからず
無理なく操作できるということである。また、図６
（ａ）、（ｂ）と各別に示すように、作業機２１が行う
作業の種類に応じてその操作範囲を異ならせることがで
きる。

【００４２】つぎに、上記所望の操作範囲αmin〜αmax
の中から異なる複数の操作角度α1、α2、α3が抽出さ
れる（図５参照）。一方、作業機２１の第１アーム３に
ついてその所望の動作範囲βmin〜βmaxが決定される。
この場合も、図６（ａ）、（ｂ）と各別に示すように、
作業機２１が行う作業の種類に応じてその操作範囲を異
ならせることができる。

【００４３】そこで、操縦レバー１４の第１アーム３´
が上記所望の操作範囲αmin〜αmaxで操作された場合に
作業機２１の第１アーム３が所望の動作範囲βmin〜βm
axで動作するように、上記抽出された各操作角度α1、
α2、α3と作業機２１の姿勢角度β1、β2、β3との対
応づけが、図５ないしは図６の破線に示すごとく行なわ
れる。

【００４４】そして、これら対応づけられた複数の角度
間を補間する演算がなされ、図６（ａ）あるいは（ｂ）
に示すように所定の対応関係Ｌ1あるいはＬ2が求められ
る。ここで、補間の仕方としては、作業種類に応じて異
ならせることができる。

【００４５】図６（ａ）は、操縦レバー１４の操作角度
がα1となっている付近での微操作性を重視した補間の
仕方であり、一方図６（ｂ）は操作角度α1、α3付近で
の作業機速度を低下させる補間の仕方であり、作業内容
に応じて異なる特性の対応関係Ｌ1、Ｌ2が求められる。

【００４６】以上にようにして、所望操作範囲αmin〜
αmaxの操縦レバー操作角度と所望動作範囲βmin〜βma
xの作業機姿勢角度との対応関係Ｌ1あるいはＬ2が求め
られると、これら対応関係Ｌ1、Ｌ2が、作業種類、たと
えば作業モード１、作業モード２にそれぞれ対応づけら
れて、テーブル２４に記憶される。

【００４７】以上のようにして前処理が終了される。

【００４８】以下、図４に示す制御ブロック図を参照し
て、上記前処理終了後の姿勢角の制御内容を説明する。

【００４９】まず、オペレータは、現在の作業内容に適
合する作業モードを、図示せぬ選択スイッチを操作して
選択する。いま、作業モードとして、上記対応関係Ｌ1
に対応する作業モード１が選択されたものとする。

【００５０】一方、操縦レバー１４に付設された図示せ
ぬポテンショメータにより第１アーム３´の現在の操作
角度αが検出されており、この現在の操作角度αに対応
する作業機２１の第１アーム３の目標姿勢角度βdが、
上記テーブル２４に記憶された対応関係に基づいて求め
られる。この場合、作業モード１が現在選択されている
ので、この選択されている作業モード１に対応する対応
関係Ｌ1がテーブル２４から読み出され、この対応関係
Ｌ1に基づいて上記目標姿勢角度βdが求められる。

【００５１】ついで、この求められた目標姿勢角度βd
が得られるように、作業機２１の第１アーム３の姿勢角
度が制御される。すなわち、ポテンショメータ２２によ
って、第１アーム３の現在の回転角度βが検出されてお
り、この検出値βがフィードバック量とされ、上記目標
値βdとフィードバック量βとの偏差が求められて、こ
れが、ゲイン乗算部２５に加えられる。ゲイン乗算部２
５で偏差βd−βが所定のゲインＫ倍され、この所定の
ゲインＫ倍された偏差βd−βに応じた駆動指令値が、
図示せぬ駆動制御部に加えられる。この駆動制御部で
は、作業機２１の駆動シリンダ４を、上記偏差βd−β
が零となるように駆動する。

【００５２】以上のように、この実施例によれば予め対
応関係Ｌ1、Ｌ2を求め、これらをテーブル２４に記憶し
ておき、それを読み出すだけでよく、複雑な演算を要し
ないで制御がなされる。したがって、計算機にかかる負
荷が軽減されるので、計算能力の高いＣＰＵを用意しな
くてもよく、コストが飛躍的に低減される。

【００５３】また、演算処理に要する時間を大幅に短縮
することができる。

【００５４】そして、操縦レバー１４の操作範囲は、オ
ペレータが無理なく操作できる範囲に設定されるので、
操作性が向上し、姿勢角の制御の精度を向上させること
ができる。

【００５５】また、作業種類に適合した操作特性によっ
て操作がなされるので、操作性が向上し、姿勢角の制御
の精度が向上する。

【００５６】なお、この実施例では、第１アーム３につ
いての制御を代表させて説明したが、第２アーム８につ
いての制御も以上の説明と同様にして行うことができ
る。

【００５７】また、対応関係Ｌ1、Ｌ2のテーブル２４へ
の格納の仕方としては、関数等の数式の形式で格納して
もよく、数表として格納するようにしてもよい。ただ、
数表として格納し、入力された値αからβdを直接接読
み出す方式の方が、関数等の数式の形式で格納し、入力
された値α（変数）から演算よりβd（関数値）を求め
る方式よりも、より演算時間を短縮できるという効果が
得られる。

【００５８】なお、この実施例では、図１に示す構造の
作業機２１を有したマニピュレータを前提として、図４
に示す姿勢角の制御がなされる場合について説明した
が、図４の姿勢角の制御を行う場合の作業機の構成は任
意であり、たとえば図３に示す構成のものであってもよ
い。

【００５９】

【発明の効果】以上説明したように本発明によれば、操
縦レバーの操作範囲を所望の範囲に設定できるととも
に、制御の際の演算が不要となる。この結果、操作性向
上により制御精度が向上するとともに、演算能力の高い
計算機が不要となるのでコストが飛躍的に低減される。
また、演算処理能力も飛躍的に向上する。

【図面の簡単な説明】

【図１】図１の（ａ）および（ｂ）は本発明に係るマニ
ピュレータの姿勢角制御装置の実施例である自立式マニ
ピュレータの構成を示す正面図および上面図である。

【図２】図２は図１に示すマニピュレータの作業機の構
成を示す図で、その動きを説明する図である。

【図３】図３は図１に示す作業機の他の構成例を示す図
である。

【図４】図４は本発明に係るマスタ・スレーブ方式のマ
ニピュレータの姿勢角制御装置の実施例である制御装置
の構成を示す制御ブロック図である。

【図５】図５は図４に示すテーブルに記憶される内容を
説明する図で、マスタの操作角度とスレーブの姿勢角度
との対応をアームの姿勢で示す図である。

【図６】図６の（ａ）および（ｂ）は、図４に示すテー
ブルに記憶される内容を説明する図で、マスタの操作角
度とスレーブの姿勢角度との対応をグラフにて示す図で
ある。

【図７】図７は従来の制御装置の構成を示す制御ブロッ
ク図である。

【符号の説明】

３第１アーム４第１アーム駆動シリンダ５中間ブラケット６第１リンク７垂直リンク８第２アーム９第２アーム駆動シリンダ１４操縦レバー２１作業機２２ポテンショメータ２３ポテンショメータ２４テーブル

───────────────────────────────────────────────────── フロントページの続き (72)発明者大坪和彦神奈川県平塚市万田1200 株式会社小松製作所中央研究所内 (72)発明者大浦稔石川県小松市符津町ツ23番地株式会社小松製作所粟津工場内 (72)発明者北郁夫石川県小松市符津町ツ23番地株式会社小松製作所粟津工場内 (72)発明者竹内伸二石川県小松市今江町９丁目406番地 (56)参考文献特開平５−96477（ＪＰ，Ａ) 特開平４−57683（ＪＰ，Ａ) 特開昭56−157980（ＪＰ，Ａ) 特開昭63−257806（ＪＰ，Ａ) 実開昭48−60320（ＪＰ，Ｕ) 実開平２−99406（ＪＰ，Ｕ) (58)調査した分野(Int.Cl.⁷，ＤＢ名) B66F 9/065 B66F 9/24 B25J 3/00

Claims

(57)【特許請求の範囲】

【請求項１】マスタ側に設けられた操縦レバーの
操作角度に応じてスレーブ側に設けられた作業機の姿勢
角度を変化させる制御を行うマスタ・スレーブ方式マニ
ピュレータの姿勢角度制御装置において、前記操縦レバーの所望の操作範囲の中から異なる複数の
操作角度を抽出し、前記操縦レバーが前記所望の操作範
囲で操作された場合に前記作業機が所望の動作範囲で動
作するように、前記抽出された複数の操作角度と前記作
業機の姿勢角度との対応づけを行ない、この対応づけら
れた複数の角度間を補間する補間手段と、前記補間手段による補間によって求められた前記所望操
作範囲の操縦レバー操作角度と前記所望動作範囲の作業
機姿勢角度との対応関係を記憶する記憶手段と、前記操縦レバーの現在の操作角度に対応する作業機の姿
勢角度を、前記記憶手段に記憶された対応関係に基づい
て求め、該求められた姿勢角度が得られるように前記作
業機の姿勢角度を制御する制御手段とを具えたマスタ・
スレーブ方式マニピュレータの姿勢角度制御装置。
【請求項２】前記補間手段は、前記作業機が行う
作業の種類に応じた補間を行うものであり、前記記憶手段は、前記対応関係を、前記作業種類に対応
させて記憶するものであり、前記制御手段は、前記作業種類が選択された場合に、該
選択された作業種類に対応する前記対応関係を前記記憶
手段の記憶内容から読み出して、該読み出された対応関
係に基づいて作業機の姿勢角度を制御するものである、請求項１記載のマスタ・スレーブ方式マニピュレータの
姿勢角度制御装置。
【請求項３】前記作業機は、それぞれ異なる自由
度を有する複数のアームによって構成されているととも
に、前記操縦レバーは、前記複数のアームを各別に操作
するものであり、前記対応関係は、各アームごとに求められ、各アームに
対応させて前記記憶手段に記憶される請求項１記載のマ
スタ・スレーブ方式マニピュレータの姿勢角度制御装
置。
【請求項４】前記作業機は、第１アームと第２ア
ームとを有し、前記第１アームを四節点リンク機構と
し、この第１アームの一端の２節点を基台上に回動自在
に配設するとともに、前記第１アームの他端の２節点を
ブラケットに回動自在に配設し、さらに前記第２アーム
の一端および該第２アームを駆動するアクチュエータの
一端を前記ブラケットに回動自在に配設するように構成
されている請求項３記載のマスタ・スレーブ方式マニピ
ュレータの姿勢角度制御装置。