JPH0445313B2 - - Google Patents

Info

Publication number
JPH0445313B2
JPH0445313B2 JP62172070A JP17207087A JPH0445313B2 JP H0445313 B2 JPH0445313 B2 JP H0445313B2 JP 62172070 A JP62172070 A JP 62172070A JP 17207087 A JP17207087 A JP 17207087A JP H0445313 B2 JPH0445313 B2 JP H0445313B2
Authority
JP
Japan
Prior art keywords
axis
arm
command speed
freedom
hand
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.)
Expired - Lifetime
Application number
JP62172070A
Other languages
English (en)
Other versions
JPS6416389A (en
Inventor
Jujiro Shimizu
Shigetaka Hosaka
Tetsuji Hayashi
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
National Institute of Advanced Industrial Science and Technology AIST
Original Assignee
Agency of Industrial Science and Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Agency of Industrial Science and Technology filed Critical Agency of Industrial Science and Technology
Priority to JP17207087A priority Critical patent/JPS6416389A/ja
Publication of JPS6416389A publication Critical patent/JPS6416389A/ja
Publication of JPH0445313B2 publication Critical patent/JPH0445313B2/ja
Granted legal-status Critical Current

Links

Landscapes

  • Numerical Control (AREA)
  • Manipulator (AREA)

Description

【発明の詳細な説明】 〈産業上の利用分野〉 本発明は原子力プラント内の点検補修ロボツト
等の冗長度を有する多関節形アームロボツトに関
する。
〈発明の技術的背景〉 一般に、ロボツトハンド(以下、単に「ハン
ド」という)の位置および姿勢を表わす座標系を
作業座標系と云い、ロボツトアーム(以下、単に
「アーム」という)の各関節の回転角や位置を表
わす座標系を関節座標系という。
ロボツトのハンドを目標の軌道上に制御するた
めには、作業座標系での指令を関節座標系の指令
に変換し、各関節のサーボ機構を制御しなければ
ならない。
冗長度を有するアーム(例えば、9自由度アー
ム)は潜在的に高い性能を持ちながら、上述した
作業座標系の指令を関節座標系の指令に変換する
ためには演算量が莫大であるため、実時間で処理
し、冗長度を有するアームを制御することは困難
で、ほとんど実用に供されていない。
一方、冗長度を持たないアーム(例えば、6自
由度アーム)が用いられ、分離速度制御方式と呼
ばれる方式、すなわち、下記の(1)式で示される比
較的演算量の少ない変換式に従つて変換する冗長
度を持たないアームが実用化されていた。
〓・=J1 -1・〓・〓 (1) ただし、〓・は作業座標系でのハンド指令速度、 〓・は関節座標系での各軸の指令速度、 J1 -1は逆ヤコビ行列である。
冗長度を有しない従来の6自由度アームの装置
構成は、第4図に示すごとく、オペレータ100
が操縦桿200を操作すると、ハンド指令速度発
生器300がハンド指令速度〓・を指令速度変換器
400aへ出力する。指令速度変換器400aは
アームの現在位置から、逆ヤコビ行列J1 -1を演算
し、(1)式によつてハンド指令速度〓を各軸の指令
速度〓・に変換し、各軸のサーボ機構500aへ指
令する構成になつていた。
〈発明が解決しようとする問題点〉 ところが、第4図の6自由度アームは演算量が
少い変換にしたがつているから演算処理時間が少
いが、ある自由度が故障したり、あるいは障害物
のために動作しなくなつた場合は動作を停止しな
ければならない欠点があつた。
この発明は、このような従来の多関節形アーム
ロボツトの欠点を除去するためになされたもので
あつて、演算処理時間を6自由度アーム並みに保
つたまま、かかる状況にある冗長度を有するアー
ム(例えば、9自由度アーム)の潜在的に高い性
能、つまり動作範囲の広さ、障害物の回避能力、
故障に対する耐故障性を有効に引出しうる多関節
形アームロボツトを提供しようとするものであ
る。
〈問題点を解決するための手段〉 上記目的を達成する本発明の構成は、冗長度を
有する多関節形アームロボツトにおいて、オペレ
ータが操縦する操縦桿と、操縦桿の変位量からハ
ンドに固定された作業座標系におけるハンド指令
速度発生器と、ハンド指令速度の内容とアームの
現在の位置及び姿勢から定まる判別式によつて固
定する冗長軸を決定する冗長軸判別器と、冗長度
分の自由度を固定して仮想の6自由度アームを再
構成する再構成器と、ハンド指令速度を作業座標
系から関節座標系へ変換する変換器と、ブレーキ
機能を有するアームのサーボ機構とを有すること
を特徴とする。
〈作用〉 以上の手段により、ハンド指令速度の内容とア
ームの現在の位置と姿勢とから定める判別式を用
いて冗長度分の自由度を固定して、仮想の6自由
度アームを再構成して、演算処理時間を従来の6
自由度アーム並みに保つたまま、冗長度を有する
アームが潜在的にもつ動作範囲の広さを、作業内
容に応じて有効に引出すことができる。
また、オペレータの意志により軸番号を指定
し、上述の判別式の決定に優先して冗長度分の自
由度を固定して、仮想の6自由度アームを再構成
して、演算処理時間を従来の6自由度アーム並み
に保つたまま、冗長度を有するアームが潜在的に
もつ障害物の回避能力を、オペレータの指示に応
じて有効に引出すことができる。
〈実施例〉 つぎに、本発明にかかる冗長度を有する多関節
形アームロボツトの実施例を説明する。
第1図は9自由度アームにおける本発明の実施
例を示している。
人間オペレータ100が操縦桿200を操作す
ると、ハンド指令速度発生器300がハンド指令
速度〓・を指令速度変換器400、及び冗長軸判別
器10へ出力する。指令速度変換器400ではハ
ンド指令速度〓・が次に示す(2)式によつて作業座標
系から関節座標系へ変換され、各関節の指令速度
〓・として出力され、各サーボ機構500へ与えら
れる。
〓=〓123456789=KJ2 -1123456 ここで、 Kは9×6の行列 であつて、次の要素以外は0、すなわち Kij=〓i<l,m,nでかつi=j 〓i>l,m,nの内いずれか1つでかつi=j+1 〓i>l,m,nの内いずれか2つでかつi=j+2 〓i>l,m,nでかつi=j+3 〓但し、iは1から9,jは1から6の値 J2 -1は6×6の行列で、6×9のヤコビ行列J3
のl,m,n列を除いた正規なヤコビ行列J2の逆
ヤコビ行列である。
lは故障した軸番号(1〜9)を示す。
mはオペレータの意志によつて固定した軸番号
(1〜9)を示す。
nは判別式により決定された軸番号(1〜9)
を示す。
次に本発明の特徴を最もよく示す冗長軸判別器
10について述べる。
冗長軸判別器10への入力信号は、ハンド指令
速度〓・〓と各関節角θである。次の(3)式に示す演
算により、ハンドの作業内容に最も有利となるよ
う固定する冗長軸の信号、すなわち軸番号信号n
を出力する。
Dbba=1 |J3ab||〓・a|b=1〜9 nはDb(b=1〜9)の中で最も小 さな値をとる軸番号を表わす。
J3abは6×9ヤコビ行列の要素、〓・aはハンド
指令速度〓・の要素を表わす。
(2) なお、(2)式で示す判別式Dbの意味するところ
は、例えばJ3a1〜J3a9は現在のアームの位置及び
姿勢において、ハンド指令速度〓・aに対しての感
度を示すものであり、さらにb=1〜9につい
て、ハンド指令速度の絶対値(大きさ)|〓・a|で
重みづけを行い、ハンド指令速度〓・aに対する貢
献度の相対的な量を示すものである。
9自由度アームは、例えば第3図に示すごと
く、軌道上において点0に支持され第1軸a、第
2軸b、第3軸c、第4軸d、第5軸e、第6軸
f、第7軸g、第8軸h、第9軸iからなつてお
り第9軸の先端にハンドが設けられたのである。
第1軸a、第6軸fおよび第9軸iはロール軸で
あり、第6軸fは冗長軸判別式によつて固定する
軸(n=n6)第2軸b、第3軸c、第4軸d、第
7軸gおよび第8軸hはピツチ軸であり、これら
のピツチ軸のうち第2軸bは故障して固定した軸
(l=l2)を、第7軸gはオペレータが指示して
固定した軸(m=m7)を表わす。
また、第5軸eはヨー軸を表わしている。
再び第1図において、故障診断装置40は、各
サーボ機構500の故障を診断する。たとえば、
ある軸の指令速度〓・と実際の速θ・度〓との偏差が
あるしきい値以上の場合は、その軸は故障と診断
し、故障した軸番号lを信号として出力する。
また、軸選択器30は、人間オペレータ指示、
例えばスイツチ操作により、障害物を回避する目
的で、ある軸を動作させたくない場合(例えばm
=m7)、その軸を固定するために、その軸の軸番
号mを信号として出力する。
再構成器20では軸番号l、軸番号m、軸番号
nの信号から冗長度を有するアームの自由度構成
を優先度の高いl、次にm、次にnの順に固定し
て、仮想的に6自由度アームを構成してその結
果、6自由度を構成する軸番号のxの信号を出力
する。
第2図は冗長軸判別器10、再構成器20の構
成について詳しい説明を示すものである。すなわ
ち、ヤコビ行列演算器11はアームの現在位置θ
を入力してヤコビ行列|J3ab|を出力し、乗算器
はハンド指令速度〓・とヤコビ行列|J3ab|から判
別式Dbの値を出力する。最小値判別器13はb
=1〜9についてDbの値を比較して、最小値を
判別し、その軸番号nの信号を出力する。
優先順位判別器21は軸番号l,m,nの信号
を入力とし、nよりもm,mよりもlを優先させ
て、冗長度分の数だけ、すなわち、9自由度アー
ムであれば3つの軸番号、たとえば軸番号l,
m,nの信号を出力する。但し、l,mのうち指
定されないものがあれば、その分|θb|の小さい
軸番号をとる再構成行列生成器22は軸番号l,
m,nの信号を入力とし、要素Kijが1或いは0
からなる行列Kを出力する。
〈発明の効果〉 以上の説明から明らかなごとく、本発明の冗長
度を有する多関節形アームロボツトによれば、ハ
ンド指令速度の内容とアームの現在の位置と姿勢
とから定める判別式を用いて冗長度分の自由度を
固定して、仮想の6自由度アームを再構成して、
演算処理時間を従来の6自由度アーム並みに保つ
たまま、冗長度を有するアームが潜在的にもつ動
作範囲の広さを、作業内容に応じて有効に引出す
ことができる。
また、オペレータの意志により軸番号を指定
し、上述の判別式の決定に優先して冗長度分の自
由度を固定して、仮想の6自由度アームを再構成
して、演算処理時間を従来の6自由度アーム並み
に保つたまま、冗長度を有するアームが潜在的に
もつ障害物の回避能力を、オペレータの指示に応
じて有効に引出すことができる。
さらに、サーボ機構の故障診断装置により故障
した軸番号を自動的に選び、上述の判別式の決定
或いはオペレータの指示に優先して、冗長度分の
自由度を固定し、仮想の6自由度アームを再構成
して、演算処理時間を従来の6自由度アーム並み
に保つたまま、冗長度を有するアームが潜在的に
もつ耐故障性を故障の内容に応じて有効に引出す
ことができる。
【図面の簡単な説明】
第1図は本発明の冗長度を有する関節アームロ
ボツトの実施例概略構成図、第2図は第1図中の
冗長軸判別器と再構成器の構成の詳細図、第3図
は冗長度を有する9自由度アームの構成図、第4
図は従来の6自由度アームの構成図である。 10……冗長軸判別器、20……再構成器、3
0……軸選択器、40……故障診断装置、11…
…ヤコビ行列演算器、12……乗算器、13……
最小値判別器、21……優先順位判別器、22…
…再構成行列生成器、100……人間オペレー
タ、200……操縦桿、300……ハンド指令速
度発生器、400……指令速度変換器、500…
…各軸サーボ機構(9自由度)、400a……指
令速度変換器(6自由度アーム用)、500a…
…各軸サーボ機構(6自由度)。

Claims (1)

    【特許請求の範囲】
  1. 1 冗長度を有する多関節形アームロボツトにお
    いて、オペレータが操縦する操縦桿と、操縦桿の
    変位量からハンドに固定された作業座標系におけ
    るハンド指令速度発生器と、ハンド指令速度の内
    容とアームの現在の位置及び姿勢から定まる判別
    式によつて固定する冗長軸を決定する冗長軸判別
    器と、冗長度分の自由度を固定して仮想の6自由
    度アームを再構成する再構成器と、ハンド指令速
    度を作業座標系から関節座標系へ変換する変換器
    と、ブレーキ機能を有するアームのサーボ機構と
    を有することを特徴とする冗長度を有する多関節
    形アームロボツト。
JP17207087A 1987-07-11 1987-07-11 Control system of multi-joint type arm robot having redundancy Granted JPS6416389A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP17207087A JPS6416389A (en) 1987-07-11 1987-07-11 Control system of multi-joint type arm robot having redundancy

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP17207087A JPS6416389A (en) 1987-07-11 1987-07-11 Control system of multi-joint type arm robot having redundancy

Publications (2)

Publication Number Publication Date
JPS6416389A JPS6416389A (en) 1989-01-19
JPH0445313B2 true JPH0445313B2 (ja) 1992-07-24

Family

ID=15934981

Family Applications (1)

Application Number Title Priority Date Filing Date
JP17207087A Granted JPS6416389A (en) 1987-07-11 1987-07-11 Control system of multi-joint type arm robot having redundancy

Country Status (1)

Country Link
JP (1) JPS6416389A (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2009069653A1 (ja) * 2007-11-28 2009-06-04 Toyota Jidosha Kabushiki Kaisha ロボットの動作経路作成装置及びロボットの動作経路作成方法
WO2012099111A1 (ja) * 2011-01-20 2012-07-26 オリンパス株式会社 マスタスレーブマニピュレータ及び医療用マスタスレーブマニピュレータ

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0360991A (ja) * 1989-07-28 1991-03-15 Meidensha Corp ロボットアームの制御方式
US5169535A (en) * 1989-09-22 1992-12-08 Kurita Water Industries Ltd. Method of removing endotoxin
JP2874238B2 (ja) * 1990-01-23 1999-03-24 株式会社安川電機 多関節形ロボットの制御方法
JP4046378B2 (ja) * 1996-09-19 2008-02-13 株式会社カネカ エンドトキシン吸着システム
US8785141B2 (en) 2000-08-25 2014-07-22 Kaneka Corporation Bacterial toxin adsorbing material, method of removing the toxin by adsorbing, and an adsorber formed by filling the adsorbing material therein
US8170718B2 (en) * 2008-12-18 2012-05-01 GM Global Technology Operations LLC Multiple priority operational space impedance control
JP5612971B2 (ja) * 2010-09-07 2014-10-22 オリンパス株式会社 マスタスレーブマニピュレータ
JP5948932B2 (ja) * 2012-02-16 2016-07-06 セイコーエプソン株式会社 ロボット制御装置、ロボット制御方法およびロボット制御プログラムならびにロボットシステム
JP6418483B2 (ja) * 2014-06-18 2018-11-07 株式会社Ihi 加工軌道生成装置と方法
CN111413862A (zh) * 2020-03-31 2020-07-14 涵涡智航科技(玉溪)有限公司 一种无人机摇杆冗余控制系统及其控制方法
CN111687834B (zh) * 2020-04-30 2023-06-02 广西科技大学 移动机械手冗余机械臂逆优先级阻抗控制系统及控制方法
CN111687833B (zh) * 2020-04-30 2023-06-02 广西科技大学 机械手逆优先级阻抗控制系统及控制方法
CN111687832B (zh) * 2020-04-30 2023-06-02 广西科技大学 空间机械手冗余机械臂逆优先级阻抗控制系统及控制方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS62108301A (ja) * 1985-11-07 1987-05-19 Agency Of Ind Science & Technol 遠隔操作ロボツト
JPS63267177A (ja) * 1987-04-25 1988-11-04 富士電機株式会社 マスタスレ−ブマニピユレ−タ

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS62108301A (ja) * 1985-11-07 1987-05-19 Agency Of Ind Science & Technol 遠隔操作ロボツト
JPS63267177A (ja) * 1987-04-25 1988-11-04 富士電機株式会社 マスタスレ−ブマニピユレ−タ

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2009069653A1 (ja) * 2007-11-28 2009-06-04 Toyota Jidosha Kabushiki Kaisha ロボットの動作経路作成装置及びロボットの動作経路作成方法
WO2012099111A1 (ja) * 2011-01-20 2012-07-26 オリンパス株式会社 マスタスレーブマニピュレータ及び医療用マスタスレーブマニピュレータ
JP2012148379A (ja) * 2011-01-20 2012-08-09 Olympus Corp マスタスレーブマニピュレータ及び医療用マスタスレーブマニピュレータ
US9283679B2 (en) 2011-01-20 2016-03-15 Olympus Corporation Master-slave manipulator and medical master-slave manipulator

Also Published As

Publication number Publication date
JPS6416389A (en) 1989-01-19

Similar Documents

Publication Publication Date Title
JPH0445313B2 (ja)
US6047610A (en) Hybrid serial/parallel manipulator
US5179525A (en) Method and apparatus for controlling geometrically simple parallel mechanisms with distinctive connections
CA2397313C (en) Method of generating poses and motions of a tree structure link system
US4756662A (en) Varible compliance manipulator
JP3207728B2 (ja) 冗長マニピュレータの制御方法
US20110093119A1 (en) Teaching and playback method based on control of redundancy resolution for robot and computer-readable medium controlling the same
Xu et al. Analytical and semi-analytical inverse kinematics of SSRMS-type manipulators with single joint locked failure
JP2874238B2 (ja) 多関節形ロボットの制御方法
Ouyang et al. Hybrid rigid-continuum dual-arm space robots: Modeling, coupling analysis, and coordinated motion planning
Notash Uncertainty configurations of parallel manipulators
Gogoussis et al. Coulomb friction effects on the dynamics of bearings and transmissions in precision robot mechanisms
JPS62251284A (ja) 多脚機構の協調制御方式
JPH0693209B2 (ja) ロボツトの円弧補間姿勢制御装置
CN112828862B (zh) 并联平台的主从映射方法、机械臂系统和存储介质
JP2019093487A (ja) ロボットの制御装置及びロボットの逆変換処理方法
JPH0428507B2 (ja)
JP2507449B2 (ja) 冗長関節を有するマスタ・スレ―ブマニピュレ―タ及び該マニピュレ―タの制御方法
JP3146463B2 (ja) 冗長軸マニピュレータの肘移動制御装置
JP3063863B2 (ja) マニピュレ−タの操作装置
JPH0938877A (ja) ダイレクトティーチング制御装置
JPH05177563A (ja) マスタスレーブマニピュレータの制御方法
JPH0420203B2 (ja)
JP2676721B2 (ja) 多関節型ロボットの制御装置
JP3402378B2 (ja) 7軸マニピュレータの制御方法

Legal Events

Date Code Title Description
EXPY Cancellation because of completion of term