JPS6258302A - ロボツトの制御方法 - Google Patents

ロボツトの制御方法

Info

Publication number
JPS6258302A
JPS6258302A JP19783685A JP19783685A JPS6258302A JP S6258302 A JPS6258302 A JP S6258302A JP 19783685 A JP19783685 A JP 19783685A JP 19783685 A JP19783685 A JP 19783685A JP S6258302 A JPS6258302 A JP S6258302A
Authority
JP
Japan
Prior art keywords
robot
joint
speed
hand
jacobian matrix
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
Application number
JP19783685A
Other languages
English (en)
Other versions
JPH0630008B2 (ja
Inventor
Tomoyuki Masui
増井 知幸
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.)
Hitachi Ltd
Original Assignee
Hitachi Ltd
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 Hitachi Ltd filed Critical Hitachi Ltd
Priority to JP60197836A priority Critical patent/JPH0630008B2/ja
Publication of JPS6258302A publication Critical patent/JPS6258302A/ja
Publication of JPH0630008B2 publication Critical patent/JPH0630008B2/ja
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Landscapes

  • Numerical Control (AREA)

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 〔発明の利用分野〕 本発明はロボットの制御方法に係り、特にロボットがど
のような姿勢にあっても確実に制御できるロボット制御
方法に関する。
〔発明の背景〕
多数の関節をもつ多自由度ロボットを制御する方法とし
て、直交座標系で与えられた手先の位置。
速度を、各関節の変位、速度に変換して関節を駆動する
サーボモータを制御するものが、「関節形ロボットアー
ムの冗長性の解析とその優先順位を有する作業への応用
」 (花房他、計測自動制御学会論文集第19巻5号1
983. p421〜426)と題する文献に示されて
いる。この場合、手先の速度と各関節の速度との関係は
、n自由度ロボットではヤコビ行列Jnを用いて次式で
表される。
≦” J (+ e n           ・・・
・・・(1)但し内は手先の並進速度2回転速度を表す
6次元ベクトル、6nは各関節の速度を01〜θ。とじ
たとき[θ目、・・・、θn]tなるn次元ベクトルで
ある。またヤコビ行列Jnは、関節角θh・・・onの
関数で手先の位置ベクトルtを表わしたときの、その関
数のヤコビ行列(6行n列)であって、口ポットの関節
角を与えるとその値が一意に定まる。
そこで、今ある状態でハンドの速度穴を与えると。
その時の関節角θh・・・はねかっているからJnも決
っており、従って所要の関節速度ベクトル6nをそれが
式(1)を満すように求めて制御が行われる。このため
に式(1)を解いた次式が用いられる。
1s=Js−1≦         ・・・・・・(2
)f3n=Jn”百          ・・・・・・
(3)但し式(2)は6自由度ロボット(n=6)でか
つヤコビ行列が正則な場合に用いられ、Jn−LはJn
の逆行列である。6自由度ロボットであってもJsが正
則でない場合(Js−’が存在しない)や7自由度以上
のロボット(n≧7)の場合には式(3)により5゜が
求められる。但しJ♂は一般化逆行列である。
次にロボットの特異姿勢について説明する。第4図に示
す関節形6自由度ロボットの関節102〜106の回転
軸が平行になった場合、ハンド100の速度に対し、各
関節の速度は一意には定まらない。
ロボットがこのような姿勢にあるときに、ロボットは特
異姿勢をとっているという。ロボットが特異姿勢にある
場合、ヤコビ行列J6がフルランクでなくなる、即ち行
列J6のランクが5又はそれ以下になる。前述のJsが
正則でない場合というのもこの特異姿勢の1例である。
このような特異姿勢にあるときでも、6自由度以上のロ
ボットでは式(3)によってハンド速度Sから関節速度
5゜を計算できるが、5自由度以下(n=5)の場合に
は有効な方法はなかった。
〔発明の目的〕
本発明の目的は、自由度が5またはそれ以下のロボット
が特異姿勢になった時でも、ハンド速度から関節速度を
算出する方法を与えることによって制御を行えるロボッ
トの制御方法を提供するにある。
〔発明の概要〕
本発明は、自由度nのロボットのヤコビ行列Jnのラン
クQがn=5の場合、ヤコビ行列JnのQ個の独立な6
次元ベクトルのいずれとも独立で、且つ互いに独立なm
個の6次元ベクトルを行列J0の列として付加し、こう
して得たランク6又はそれ以上の新なりコピ行列Hnを
ヤコビ行列Jnの代りに用いてハンド速度から関節速度
を算出するようにしたことを特徴とするものである。
〔発明の実施例〕
以下、本発明の詳細な説明する。第2図は5自由度ロボ
ット301とその制御装置302を示しており、演算装
置304は、検出部305により検出された関節の位置
、速度と記憶装置303にストアされた制御プログラム
に従って、ロボットの各関節を駆動するサーボモータ(
図示せず)に対する速度目標値(関節速度)を生成し、
これがサーボアンプ306から出力されロボットのハン
ド307が制御される。
この速度目標値の生成の方法が本発明の特徴とするもの
であって、その実施例を第1図に、またロボットの概略
構造を第3図に示す。前述したように、ハンド速度と関
節速度の関係は式(1)で与えられ、このうちハンド速
度穴は制御プログラム・により与えられる(ステップ4
01)。即ち、制御プログラムはハンドをどのように動
がすめがを決定するもので、現在の関節の位置、速度か
らどの方向へどれだけの速さで回転すべきが、つまり否
の値を決定する。次のステップ402では、まず各関節
501〜505を駆動するサーボモータに装着されたパ
ルスエンコーダ(位置検出器、図示せず)のカウント値
から関節角度を検出し、その値がら演算装置304がヤ
コビ行列Js(の各要素)を算出し、更にその行列J5
のランクQを計算する。次にステップ403でQの値を
しらべm=5なら従来の処理へ移るが、Qく5の場合に
はロボットは特異姿勢と判定されステップ404へ移る
。まずステップ404ではヤコビ行列J5からQ個の独
立な列ベクトル了i、・・・、iを選び、さらにステッ
プ405では ゛これらの列ベクトルとは独立でそれら
自身も互いに独立なm=6−Q個の列ベクトルに++・
・・+ j2mをつくって次式により新たなりコピ行列
H5=[jI、・・・yJ5+に菫、・・・+kmコ・
・・(4)を生成する。この行列H5のランクはつくり
方から明らかなように6である。このように、ヤコビ行
列をJ5に変わってH5とすることは、第3図に示した
ようにロボットの手先500に仮想的に関節511〜5
1II+を設けたのと等価である。そして関節511〜
51mの部分のヤコビ行列をKm = [k + +・
・・。
km]、これらの関節の速度をPl、・・・+ F m
 +9’y = [P++ ”・r Pm ] tとす
ると、第3図の仮想的なロボット先端部520の速度d
はQ”J58s+Km Pm      −・・・(5
)とおくと式(4)、 (5)から Q=Hs失5            ・・・・・・(
7)である。
次のステップ406では、式(5)に従って仮想ハンド
520の速度dを決定する。まず式(5)右辺の第1項
はステップ401で求めたハンド速度百であり与えられ
ている。右辺第2項のKffl= [k + +・・・
km]はやはりステップ405で与えられている。
右辺第2項の〆□=[P++・・・+ p m ]は仮
想関節511〜51mの速度であるが、これらは仮想関
節511〜51mが関節501〜505の回転軸と平行
でない(即ちVat・・・+  kmがJ5の列ベクト
ルと独立)という条件が満されていれば次ステツプ40
7での計算が可能となるので、どのような値であっても
ハンド500の制御には関係がない。従ってこれらは適
当に値を与えればよく、そうすることによって式(5)
からdの値が決定できる。そしてステップ407では今
求めた速度dとステップ405で定めたヤコビ行列H5
から又5を計算する。この場合、ヤコビ行列H5はその
ランクが6であるから、従来と同様に一般化逆行列 Hs!=Hst(HsHst)−1・・・・・・(8)
を用いれば式(6)の夫5は 叉5=[θ1.・・・、θ5+Plt”・+Pm]t=
Hs”Q           ・・・・・・(9)に
より計算できる。即ち所望のθ1.・・・、θ5が算出
できる。なおこれらの演算は演算装置304によって行
われ、求められた関節速度I3I〜θ5を各サーボモー
タの速度標値としてロボットのハンドが所定の道上を動
くように制御されるのは第2図で述べたとおりである。
本実施例によれば、ロボットが特異姿勢にあっても、制
御プログラムから与えられたハンド速度から関節速度を
一意に決定できるため、特異姿勢において関節速度が決
定されるという問題を解決できる。また、関節速度は、
四則演算、ベクトル。
行列演算のみで決定できるので、特別なハードウェアを
必要とせず、本実施例で示した一般的なロボット制御装
置をそのまま使うことができるので、従来使用されてい
る制御装置のプログラムに本発明の計算方法を組込むだ
けでよく、容易に実現可能である。
〔発明の効果〕
本発明によれば、5自由度以下のロボットが特異姿勢に
あっても、ハンドの速度から関節速度を決定できるので
、通常行なわれている直交座標系でハンド速度を制御プ
ログラムで決定してロボットを制御する方式を特異姿勢
を意識せずにそのまま適用できるという効果がある。ま
た、ロボットの種類が関節形以外のスカラー形、直交形
であってもよく、また、自由度の数によらずに関節速度
を同一の計算方式で算出できるので、制御するロボット
が異なってもプログラム変更が不要であり、汎用性の高
い制御装置を構成できる。また、関節速度は、数値演算
のみで決定されるため、従来のマイクロコンピュータで
実現可能であり、一般的なロボット制御装置で容易に実
現できるという効果がある。
【図面の簡単な説明】
第1図は本発明による関節速度の計算方法を示すフロー
チャート、第2図は5自由度ロボットとその制御装置を
示す図、第3図は仮想関節を設けた5自由度ロボットの
構成図、第4図は6自由度ロボットの構成図である。 301・・・5自由度ロボット、302・・・制御装置
、303・・・記憶装置、304・・・演算装置、30
7.500・・・ハント、501〜505・・・関節、
511〜51m・・・仮想関節、520・・・仮想ハン
ド。     代理人 弁理士 秋 本 正 実第1図

Claims (1)

    【特許請求の範囲】
  1. 自由度nの値が5又はそれ以下であるロボットのハンド
    の並進速度及び回転速度の目標値からその目標値を実現
    するための関節速度を、関節角を変数としたハンドの位
    置を表す関数のヤコビ行列を用いて算出してハンド制御
    を行うようにしたロボットの制御方法に於て、上記ヤコ
    ビ行列のランクlがn未満である場合には、上記ヤコビ
    行列の6次元列ベクトルとは一次独立で互いに独立な6
    −l個の列ベクトルを上記ヤコビ行列の列ベクトルに付
    加して構成した6行n+6−l列の新ヤコビ行列を上記
    ヤコビ行列の代りに用いて上記関節速度を算出するよう
    にしたことを特徴とするロボットの制御方法。
JP60197836A 1985-09-09 1985-09-09 ロボツトの制御方法 Expired - Lifetime JPH0630008B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP60197836A JPH0630008B2 (ja) 1985-09-09 1985-09-09 ロボツトの制御方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP60197836A JPH0630008B2 (ja) 1985-09-09 1985-09-09 ロボツトの制御方法

Publications (2)

Publication Number Publication Date
JPS6258302A true JPS6258302A (ja) 1987-03-14
JPH0630008B2 JPH0630008B2 (ja) 1994-04-20

Family

ID=16381148

Family Applications (1)

Application Number Title Priority Date Filing Date
JP60197836A Expired - Lifetime JPH0630008B2 (ja) 1985-09-09 1985-09-09 ロボツトの制御方法

Country Status (1)

Country Link
JP (1) JPH0630008B2 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104339349A (zh) * 2013-08-06 2015-02-11 佳能株式会社 机器人装置及机器人控制方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS58114888A (ja) * 1981-12-28 1983-07-08 富士通株式会社 ロボツトの軌跡制御方式
JPS591181A (ja) * 1982-06-23 1984-01-06 富士通株式会社 ロボツトの軌跡制御方式
JPS5930690A (ja) * 1982-08-09 1984-02-18 株式会社日立製作所 冗長度を持つ多関節形ロボツトの制御方法
JPS6057408A (ja) * 1983-09-08 1985-04-03 Fujitsu Ltd ロボツトの軌跡制御装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS58114888A (ja) * 1981-12-28 1983-07-08 富士通株式会社 ロボツトの軌跡制御方式
JPS591181A (ja) * 1982-06-23 1984-01-06 富士通株式会社 ロボツトの軌跡制御方式
JPS5930690A (ja) * 1982-08-09 1984-02-18 株式会社日立製作所 冗長度を持つ多関節形ロボツトの制御方法
JPS6057408A (ja) * 1983-09-08 1985-04-03 Fujitsu Ltd ロボツトの軌跡制御装置

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104339349A (zh) * 2013-08-06 2015-02-11 佳能株式会社 机器人装置及机器人控制方法
US9764462B2 (en) 2013-08-06 2017-09-19 Canon Kabushiki Kaisha Robot apparatus and robot controlling method

Also Published As

Publication number Publication date
JPH0630008B2 (ja) 1994-04-20

Similar Documents

Publication Publication Date Title
Hashimoto et al. Visual servoing with hand-eye manipulator-optimal control approach
Chen et al. Adaptive homography-based visual servo tracking for a fixed camera configuration with a camera-in-hand extension
Albu-Schaffer et al. Cartesian impedance control techniques for torque controlled light-weight robots
US4594671A (en) Velocity method of controlling industrial robot actuators
Handlykken et al. Control system analysis and synthesis for a six degree-of-freedom universal force-reflecting hand controller
KR20110041950A (ko) 여유자유도 제어를 이용한 로봇의 교시 및 재현 방법
Cai et al. Uncalibrated 3d stereo image-based dynamic visual servoing for robot manipulators
JP2566665B2 (ja) 慣性系におけるロボットの制御装置
Su et al. Hybrid adaptive/robust motion control of rigid-link electrically-driven robot manipulators
Yang et al. An acceleration-level visual servoing scheme for robot manipulator with IoT and sensors using recurrent neural network
Newman High-speed robot control in complex environments
Bascetta et al. Two-time scale visual servoing of eye-in-hand flexible manipulators
Secchi et al. An experience on stable control of mobile robots
JPH02205489A (ja) マニピュレータのインピーダンス制御方式
JPS6258302A (ja) ロボツトの制御方法
RU2054349C1 (ru) Устройство для программного управления манипулятором
Cong et al. Visual servoing control schemes of 4 DOF robot manipulators: VD Cong, LD Hanh
JPS62199383A (ja) ロボツトの制御方式
JP2594546B2 (ja) ロボツトの仮想内部モデルに基づく制御方法
Bascetta et al. Task space visual servoing of eye-in-hand flexible manipulators
Murotsu et al. Experimental studies for control of manipulators mounted on a free-flying space robot
Zhang et al. Robot Manipulator Control and Computational Cost
Mut et al. Tracking adaptive impedance robot control with visual feedback
Selig et al. Manipulating robots along helical trajectories
JPS6010309A (ja) ロボツトハンドの経路補間方法