JPH05127714A - 冗長アームロボツトのアーム制御方式 - Google Patents
冗長アームロボツトのアーム制御方式Info
- Publication number
- JPH05127714A JPH05127714A JP28666591A JP28666591A JPH05127714A JP H05127714 A JPH05127714 A JP H05127714A JP 28666591 A JP28666591 A JP 28666591A JP 28666591 A JP28666591 A JP 28666591A JP H05127714 A JPH05127714 A JP H05127714A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- axis
- arm
- control
- control point
- 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
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
単な方法で実現する。 【構成】 本発明の冗長アームロボットのアーム制御方
式は、ロボットのツール部の制御点の位置姿勢を固定し
たまま、中間アームを周囲の対象物に衝突させないよう
な動きを実現する制御入力を与える軸を選択する軸選択
スイッチ11と、軸選択スイッチにより選択された軸を
微小変化させる移動指令スイッチ12と、選択された軸
が移動指令スイッチにより微小変化させられると、前記
ロボットのツール部の制御点の固定した位置姿勢を変化
させないように、他の軸を適宜変化させる制御部20と
を有する。
Description
長アームロボットのアーム制御方式に関するものであ
る。
多関節形ロボットかあるいはスカラ形ロボットといわれ
るもので、機械構造からみて冗長アームロボット(いわ
ゆるRedundant Robot またはReduntdant Manipulator)
とよばれるものの範疇外の形式のロボットである。最近
ロボットでより困難な仕事をなすように6軸以上の関節
をもつロボットが開発されてきている。とくに7軸の人
間腕形ロボットは人間がその動きに対しより親しみをも
つ故か研究開発が盛んになってきた。従来の6軸ロボッ
トというのは、ロボットツールの制御点の位置と姿勢が
6個の変数で定義されるということに対応して設計され
た汎用性の高いロボットであった。しかしこのロボット
の欠点は制御点における、位置姿勢の選択という立場か
らみて、到達可能な空間上であっても自分自身のアーム
が障害になったり、途中に障害物が存在するため、必ず
しも総ての点で任意の位置や姿勢を取り得るものではな
かった。このようなことを回避するためにまずとられた
方法はロボットの設置方法を壁掛けとか、天井吊りにす
ることであった。このような方法が有効な方法であるこ
とは否定されることではない。しかしこのような設置方
法が不可能である場合には、6軸以上の自由度を有する
ロボットの導入が必要であることは論をまたない。
いて、衝突を回避するというアーム動作において、ロボ
ットのツール部の位置や姿勢を多少変化させてもよい場
合がある。このような場合は、6軸ロボットでも可能な
方法が存在する。この方法はロボットアームの肩の位置
とロボットのツール部の制御点を結ぶ軸を計算し、この
軸を少しずらして、この軸回りにロボットのツール部の
制御点を回転させる方法である。この方法では残念なが
らロボットのツール部の位置および姿勢を変化させない
という条件を満足させることができない。
研究開発がなされてきているのであるが、研究開発の主
題が冗長アームロボットの動きの滑らかさをいかにして
実現するかという面に傾いているため、障害物回避のた
めに、この冗長性を積極的に使うといった制御装置の実
現がなされていない。つまり現在研究課題になっている
ことは、オペレータが介在しないでこの衝突回避の機能
を組み込もうということが目的になっている。理想的に
はこのことが実現されることが望ましいのであるが、現
状のロボット技術からみて、オペレータ介在形の衝突回
避操作というものが過渡的に存在してもよいのではない
かという点から、本願のアーム制御方式を発明するに到
った。
ットのアーム制御方式は、7自由度を有する冗長アーム
ロボットのアーム制御方式であって、ロボットのツール
部の制御点の位置姿勢を固定したまま、中間アームを周
囲の対象物に衝突させないような動きを実現する制御入
力を与える軸を選択する軸選択スイッチと、軸選択スイ
ッチにより選択された軸に微小変化入力を与える移動指
令スイッチと、選択された軸に移動指令スイッチにより
微小変化入力を与えると、前記ロボットのツール部の制
御点の位置と姿勢とを変化させないように、他の軸を適
宜変化させる制御部とを有する。
トを具体例として本発明の原理について説明する。課題
になっている衝突回避の問題が必ず解が存在するという
ものではないことに注意したい。解が存在しないという
理由の一つとして、冗長アームロボットであれその構造
が悪いと冗長アームロボットにならぬことがあること。
第二の理由として、制御点の現在の位置姿勢に対して衝
突を回避したいアーム方向には理論的に動けない場合
や、特異点問題が存在する場合があるということであ
る。説明を理解しやすくするために、このようなことは
奇なこととして話をすすめる。7軸多関節ロボットの位
置姿勢の決定に関わる重要な関係式は、ロボットのツー
ル部の現在の制御点での作業空間での微小変化分とロボ
ット関節空間での微小変化分との関係式(1)で与えら
れる。関係式(1)は回転軸からのみ成り立っているロ
ボットを想定して示してある。スライド軸を含むロボッ
トの場合も論理的に同じように展開可能であるので、回
転軸のみよりなるロボットでもって話を進めることにす
る。 [Δx,Δy,Δz,Δα,Δβ,Δγ]T =J*[Δ
q1,Δq2,Δq3,Δq4,Δq5,Δq6,Δq
7]T ・・・・・(1) ただし Δ : 微小変化分 x,y,z: 作業空間での位置 α,β,γ: 作業空間での座標軸廻りの回転角度 J : ヤコビアン(6 x 7 のマトリク
ス) q1,q2,q3,q4,q5,q6,q7: ロボッ
ト関節空間での角度 [ ]T : 転置を意味する 制御点でのロボットのツール部の状態を変えないという
ことは、作業空間での微小変化をゼロとすることであ
る。この場合の上記の式(1)を解くことをかんがえ
る。Δq1−Δq7の内いずれかが、値が与えられる変
数とする。そのように考えれば、Jが既知の値をもつマ
トリクスであるので、他の変数を計算でもとめることが
できる。つまり6次元の連立方程式を解く問題に帰着さ
れる。ロボットとしての動きからいうと、制御点での状
態をもとのままに維持して、値の与えられた関節を少し
動かした場合、他の関節がどのように動くかということ
が求められる。先述したように、このことは総ての場合
についていつでも求め得るものではない。どの関節を動
かすことが目的にかなった動きであるのか、あるいは制
御点での現在の位置姿勢、あるいはロボットの機械構造
上から解が存在しないということがありうる。このよう
なことは、実際のロボットをモデル化したロボットシミ
ュレータの上で検討しておけば目的とする動きの指針は
あたえられる。どの軸が有効な動きをする軸であるかも
決定することができる。有効な関節軸が決定されていて
も現在の制御点での条件で方程式が解けない場合がある
が、これも条件をゆるやかなものにして解くという、特
異点解決法という周知の技法を使えば回避出来ないわけ
ではない。条件をゆるやかに出来ない場合には、不可能
ということで再度制御点状態を変更してこの方法を使う
ということも実用上は特殊な場合を除き支障はない。ロ
ボットシミュレータで実験を重ね、衝突回避のアーム動
作を実現する有効関節軸をいくつかの場合に対応して決
定しておいて、この軸にオペレータが動作指令入力をあ
たえられるように移動指令スイッチを操作台に準備して
おいて、内部的に上述の論理を従来の制御装置に追加し
ておけば、衝突回避の有効な手段となる。
次に述べるように作用する。衝突回避すなわち周囲の対
象物との衝突を回避させる動作に最も好適な軸を軸選択
スイッチにより選択し、移動指令スイッチにより所望な
微小変化を与える。操作台10で選択された軸に微小変
化入力が与えられると、制御部がロボットのツール部の
制御点の位置姿勢を変化させないように他の軸を変化さ
せる。この操作を衝突回避が実現するまで繰り返して所
望の結果を得る。
て説明する。図1は本発明の実施例において制御される
冗長アームロボットのリンク構造を示す図、図2は図1
で示される冗長アームロボットを操作する操作台を示す
図である。図1のリンク構造をDH記法( Denavit-Har
tenberg の記法)で示すと表1のようになる。
ることが解っているので(シミュレータ上で確認済みと
なっていることによる)、図2の操作台10の軸選択ス
イッチ11で第2関節の軸を選択する。次に、移動指令
スイッチ12を操作して+方向また−方向に微小変化さ
せる。移動指令スイッチ12からの指令は、サーボユニ
ットを含むロボット制御装置20に与えられる。ロボッ
ト制御装置20は、指令に基づいて、ロボット30の第
2関節の軸を駆動するとともに、先端の制御点の固定し
た位置姿勢を変化させぬように、その他の関節の軸を制
御する。例えば第2関節の軸以外の関節の変位量は、ロ
ボット制御装置20内において、前述の式(1)により
逆運動学問題として解かれる。
ムロボットを衝突回避のために制御するのに際し、軸選
択スイッチおよび移動指令スイッチにより、特定の軸に
操作入力を与え、同時に制御部により他の軸も適宜に制
御することにより、簡単な方法で衝突回避を実行でき、
アームの冗長性を有効に利用できる。
ロボットのリンク構造を示す図である。
操作台を示す図である。
Claims (1)
- 【請求項1】 7自由度を有する冗長アームロボットの
アーム制御方式において、 ロボットのツール部の制御点の位置姿勢を固定したま
ま、中間アームを周囲の対象物に衝突させないような動
きを実現する制御入力を与える軸を選択する軸選択スイ
ッチと、 軸選択スイッチにより選択された軸に微小変化入力を与
える移動指令スイッチと、 選択された軸に移動指令スイッチにより微小変化入力を
与えると、前記ロボットのツール部の制御点の位置と姿
勢とを変化させないように、他の軸を適宜変化させる制
御部とを有することを特徴とする冗長アームロボットの
アーム制御方式。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP28666591A JP3379540B2 (ja) | 1991-10-31 | 1991-10-31 | 冗長アームロボットのアーム制御方式 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP28666591A JP3379540B2 (ja) | 1991-10-31 | 1991-10-31 | 冗長アームロボットのアーム制御方式 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH05127714A true JPH05127714A (ja) | 1993-05-25 |
JP3379540B2 JP3379540B2 (ja) | 2003-02-24 |
Family
ID=17707371
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP28666591A Expired - Lifetime JP3379540B2 (ja) | 1991-10-31 | 1991-10-31 | 冗長アームロボットのアーム制御方式 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3379540B2 (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007136590A (ja) * | 2005-11-16 | 2007-06-07 | Kawasaki Heavy Ind Ltd | 冗長関節部を有する冗長ロボットの制御装置および制御方法 |
CN106625666A (zh) * | 2016-12-16 | 2017-05-10 | 广州视源电子科技股份有限公司 | 冗余机械臂的控制方法及装置 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5755715B2 (ja) * | 2013-12-17 | 2015-07-29 | 川崎重工業株式会社 | ロボットの制御方法 |
-
1991
- 1991-10-31 JP JP28666591A patent/JP3379540B2/ja not_active Expired - Lifetime
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007136590A (ja) * | 2005-11-16 | 2007-06-07 | Kawasaki Heavy Ind Ltd | 冗長関節部を有する冗長ロボットの制御装置および制御方法 |
CN106625666A (zh) * | 2016-12-16 | 2017-05-10 | 广州视源电子科技股份有限公司 | 冗余机械臂的控制方法及装置 |
CN106625666B (zh) * | 2016-12-16 | 2019-03-01 | 广州视源电子科技股份有限公司 | 冗余机械臂的控制方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
JP3379540B2 (ja) | 2003-02-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3207728B2 (ja) | 冗長マニピュレータの制御方法 | |
US5430643A (en) | Configuration control of seven degree of freedom arms | |
Dubey et al. | Redundant robot control using task based performance measures | |
US4756662A (en) | Varible compliance manipulator | |
JP4903173B2 (ja) | 衝突回避機能を有するロボット | |
JP5114019B2 (ja) | エフェクタの軌道を制御するための方法 | |
US5737500A (en) | Mobile dexterous siren degree of freedom robot arm with real-time control system | |
KR101498836B1 (ko) | 7축 다관절 로봇의 제어 장치 및 교시 방법 | |
JP2009039852A (ja) | 衝突回避機能を有するロボット | |
JP3675004B2 (ja) | ロボットの制御装置 | |
JP7144754B2 (ja) | 多関節ロボットおよび多関節ロボットシステム | |
JP5220536B2 (ja) | ロボット制御方法、ロボット制御装置、及びロボット制御システム | |
JPH05127714A (ja) | 冗長アームロボツトのアーム制御方式 | |
CN111699079B (zh) | 协调系统、操作设备和方法 | |
JPH0693209B2 (ja) | ロボツトの円弧補間姿勢制御装置 | |
JPH11239988A (ja) | 多関節ロボットのダイレクトティーチングにおける特異点回避方法 | |
JP2005329521A (ja) | 多関節型ロボット | |
JP3904036B2 (ja) | 多指多関節ハンドの制御装置 | |
JP3402378B2 (ja) | 7軸マニピュレータの制御方法 | |
JP7352267B1 (ja) | 多関節ロボット、多関節ロボットの制御方法、ロボットシステム、及び、物品の製造方法 | |
JPS63289606A (ja) | 冗長自由度形ロボット | |
KR0155281B1 (ko) | 다관절 로보트의 직선보간방법 | |
WO2024048285A1 (ja) | 多関節ロボット、多関節ロボットの制御方法、ロボットシステム、及び、物品の製造方法 | |
Lim et al. | A real-time control system for a mobile dexterous 7 dof arm | |
JPH06259126A (ja) | ロボット動作のシミュレーション装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20081213 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091213 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091213 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101213 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101213 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111213 Year of fee payment: 9 |
|
EXPY | Cancellation because of completion of term |