JPH0768489A - 多関節ロボットの制御方法 - Google Patents
多関節ロボットの制御方法Info
- Publication number
- JPH0768489A JPH0768489A JP24205693A JP24205693A JPH0768489A JP H0768489 A JPH0768489 A JP H0768489A JP 24205693 A JP24205693 A JP 24205693A JP 24205693 A JP24205693 A JP 24205693A JP H0768489 A JPH0768489 A JP H0768489A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- sum
- limit value
- control
- joint
- 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
- Manipulator (AREA)
Abstract
(57)【要約】
【目的】手先にケーブルを必要とするエンドエフェクタ
を取り付けた場合、手先の手首位置から見た回転角が±
π[rad] を越えるとケーブルが腕に巻き付き切断される
恐れを防止する。 【構成】Ｗ1 とＷ3 の関節角度の和に対して制限値を設
定し、逆運動学変換部により求められたＷ1 、Ｗ3 の関
節角度の和を求め、この値が前記設定した最大値を越え
た場合にロボットの制御を停止する。
を取り付けた場合、手先の手首位置から見た回転角が±
π[rad] を越えるとケーブルが腕に巻き付き切断される
恐れを防止する。 【構成】Ｗ1 とＷ3 の関節角度の和に対して制限値を設
定し、逆運動学変換部により求められたＷ1 、Ｗ3 の関
節角度の和を求め、この値が前記設定した最大値を越え
た場合にロボットの制御を停止する。
Description
【０００１】
【産業上の利用分野】多関節ロボットの制御方法に関す
る。
る。
【０００２】
【従来の技術】ロボットの手首部３自由度の構成を図３
に示す。２つの旋回軸Ｗ1 ，Ｗ3 と、Ｗ1 ，Ｗ3 の間に
Ｗ1 ，Ｗ3 の回転軸と垂直に交わる回転軸をもつ関節Ｗ
2 により構成される。一般には、このような手首部が３
自由度を持つ腕部の先端にとりつけられ、６自由度の多
関節ロボットを構成するが、ここでは手首部のみを示し
ている。以下図３に示すロボット手首部の制御について
説明する。一般的に旋回軸Ｗ1 、Ｗ3 には制限は設けら
れておらず自由に回転することが可能である。手先に力
センサ等の検出器やハンドなどのケーブルを必要とする
装置が取り付けられている場合、手首の基準位置から見
た手先の回転角が大きくなった時に取り付けられた装置
のケーブルがロボットの腕に巻き付き切断されてしまう
恐れがある。このため、従来は機械的なリミットをかけ
たり、図２に示すように各関節毎に関節角度の最大値を
設定し、関節にとりつけられた検出器の信号をフィード
バックし、最大値を越えた場合に制御を停止するように
していた。しかし、図４のように手先の先端が特異点つ
まりＷ2 の関節角度が０の点を内部に含む閉軌道で、図
４の手先の座標系ｘ，ｙ軸の方向を変えないようにして
回転させた場合、先端の姿勢は回転しなくてもＷ1 とＷ
3 は逆方向に無限に回転する。
に示す。２つの旋回軸Ｗ1 ，Ｗ3 と、Ｗ1 ，Ｗ3 の間に
Ｗ1 ，Ｗ3 の回転軸と垂直に交わる回転軸をもつ関節Ｗ
2 により構成される。一般には、このような手首部が３
自由度を持つ腕部の先端にとりつけられ、６自由度の多
関節ロボットを構成するが、ここでは手首部のみを示し
ている。以下図３に示すロボット手首部の制御について
説明する。一般的に旋回軸Ｗ1 、Ｗ3 には制限は設けら
れておらず自由に回転することが可能である。手先に力
センサ等の検出器やハンドなどのケーブルを必要とする
装置が取り付けられている場合、手首の基準位置から見
た手先の回転角が大きくなった時に取り付けられた装置
のケーブルがロボットの腕に巻き付き切断されてしまう
恐れがある。このため、従来は機械的なリミットをかけ
たり、図２に示すように各関節毎に関節角度の最大値を
設定し、関節にとりつけられた検出器の信号をフィード
バックし、最大値を越えた場合に制御を停止するように
していた。しかし、図４のように手先の先端が特異点つ
まりＷ2 の関節角度が０の点を内部に含む閉軌道で、図
４の手先の座標系ｘ，ｙ軸の方向を変えないようにして
回転させた場合、先端の姿勢は回転しなくてもＷ1 とＷ
3 は逆方向に無限に回転する。
【０００３】
【発明が解決しようとする課題】上述の従来の方法で
は、手先先端の姿勢を回転させずに手首を特異点周りで
回転させた場合に、Ｗ1 とＷ3 の関節角度が大きくなり
制限値を越えるため、手先が回転していないにも関わら
ず、制御が停止するという問題点があった。そこで本発
明は、特異点周りで姿勢を回転させずに手先を回転させ
た場合に、制御が停止することなく、また手先が手首位
置に対して大きく回転した場合は制御を停止するため、
エンドエフェクタのケーブルを切断するのを防ぐことが
できる。
は、手先先端の姿勢を回転させずに手首を特異点周りで
回転させた場合に、Ｗ1 とＷ3 の関節角度が大きくなり
制限値を越えるため、手先が回転していないにも関わら
ず、制御が停止するという問題点があった。そこで本発
明は、特異点周りで姿勢を回転させずに手先を回転させ
た場合に、制御が停止することなく、また手先が手首位
置に対して大きく回転した場合は制御を停止するため、
エンドエフェクタのケーブルを切断するのを防ぐことが
できる。
【０００４】
【課題を解決するための手段】上記課題を解決するた
め、Ｗ1 とＷ3 の関節角度の和に対して制限値を設定
し、逆運動学変換部により求められたＷ1 、Ｗ3 の関節
角度の和を求め、この値が前記設定した最大値を越えた
場合にロボットの制御を停止する。
め、Ｗ1 とＷ3 の関節角度の和に対して制限値を設定
し、逆運動学変換部により求められたＷ1 、Ｗ3 の関節
角度の和を求め、この値が前記設定した最大値を越えた
場合にロボットの制御を停止する。
【０００５】
【作用】上記手段により、手先が姿勢を回転させずに特
異点周りで回転するような場合に制御を停止することな
く実行することができるようになり、手首基準位置から
見た手先の回転角がケーブルが切断されるような角度に
なった場合にロボットの制御を停止するため、ケーブル
が巻き付いて切断されることを防ぐことができる。
異点周りで回転するような場合に制御を停止することな
く実行することができるようになり、手首基準位置から
見た手先の回転角がケーブルが切断されるような角度に
なった場合にロボットの制御を停止するため、ケーブル
が巻き付いて切断されることを防ぐことができる。
【０００６】
【実施例】図１に本発明の実施例を示す。与えられた位
置及び姿勢指令（１）から、逆運動学変換（２）により
それぞれの関節角度を求める。関節Ｗ1 とＷ3 以外の関
節は、各制限値と比較し（３）、制限値を越えた場合
（４）にロボットの制御を停止する（５）。これと同時
に、関節Ｗ1 とＷ3 の関節角度の和を求めて、設定され
たＷ1 ，Ｗ3 の和の制限値と比較し（６）、制限値を越
えた場合（７）に、ロボットの制御を停止する（５）。
つまり従来のフローに、ステップ６，７が並列に加わっ
たのが本発明である。
置及び姿勢指令（１）から、逆運動学変換（２）により
それぞれの関節角度を求める。関節Ｗ1 とＷ3 以外の関
節は、各制限値と比較し（３）、制限値を越えた場合
（４）にロボットの制御を停止する（５）。これと同時
に、関節Ｗ1 とＷ3 の関節角度の和を求めて、設定され
たＷ1 ，Ｗ3 の和の制限値と比較し（６）、制限値を越
えた場合（７）に、ロボットの制御を停止する（５）。
つまり従来のフローに、ステップ６，７が並列に加わっ
たのが本発明である。
【０００７】前記制限値は、手先に取り付けられたエン
ドエフェクタのケーブルの形状から決められる値を用い
る。一般的に手先にケーブルを必要とするエンドエフェ
クタを取り付けた場合、手先の手首位置から見た回転角
が±π[rad] を越えるとケーブルが腕に巻き付き切断さ
れるおそれがある。そこで、関節Ｗ1 とＷ3 について求
められた関節角度の和を計算し、その和が±π[rad] 以
上の場合にはロボットの制御を停止する。手先の姿勢を
回転させずに手先を特異点周りに回転するような場合、
Ｗ1 とＷ3 の和は変化しないため、制御が停止されるこ
とはない。
ドエフェクタのケーブルの形状から決められる値を用い
る。一般的に手先にケーブルを必要とするエンドエフェ
クタを取り付けた場合、手先の手首位置から見た回転角
が±π[rad] を越えるとケーブルが腕に巻き付き切断さ
れるおそれがある。そこで、関節Ｗ1 とＷ3 について求
められた関節角度の和を計算し、その和が±π[rad] 以
上の場合にはロボットの制御を停止する。手先の姿勢を
回転させずに手先を特異点周りに回転するような場合、
Ｗ1 とＷ3 の和は変化しないため、制御が停止されるこ
とはない。
【０００８】
【発明の効果】以上述べたように、本発明によれば、旋
回軸Ｗ1 、Ｗ3 の関節角度の和に対して制限を持たせる
ことにより、特異点周りで姿勢を回転させずに手先を回
転させた場合に、制御が停止することなくなり、また手
先が手首位置に対して大きく回転した場合は制御を停止
するため、エンドエフェクタのケーブルを切断するのを
防ぐことができる。
回軸Ｗ1 、Ｗ3 の関節角度の和に対して制限を持たせる
ことにより、特異点周りで姿勢を回転させずに手先を回
転させた場合に、制御が停止することなくなり、また手
先が手首位置に対して大きく回転した場合は制御を停止
するため、エンドエフェクタのケーブルを切断するのを
防ぐことができる。
【図１】本発明の実施例を示す図
【図２】従来例を示す図
【図３】ロボットの手先３自由度の構成
【図４】手先の特異点周りの回転の説明図
Claims (1)
- 【請求項１】 ２つの旋回軸Ｗ1 ，Ｗ3 の間に前記２つ
の旋回軸の回転軸と垂直に交わる回転軸Ｗ2 をもつよう
に関節を配置した関節部を持つロボットを、与えられた
位置または姿勢指令を各関節の角度（θ1 ，θ2 ，
θ3 ）に逆運動学変換して制御する多関節ロボットの制
御方法において、 前記Ｗ1 の関節角度θ1 と前記Ｗ3 の関節角度θ3 の和
の制限値を設定しておき、与えられた手首姿勢から前記
逆運動学変換部によって求められた前記Ｗ1 と前記Ｗ3
の関節角度の和を求め、求められた和が前記設定された
制限値以上になった場合にロボットの制御を停止するこ
とを特徴とする多関節ロボットの制御方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP24205693A JP3169152B2 (ja) | 1993-09-01 | 1993-09-01 | 多関節ロボットの制御方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP24205693A JP3169152B2 (ja) | 1993-09-01 | 1993-09-01 | 多関節ロボットの制御方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH0768489A true JPH0768489A (ja) | 1995-03-14 |
| JP3169152B2 JP3169152B2 (ja) | 2001-05-21 |
Family
ID=17083628
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP24205693A Expired - Fee Related JP3169152B2 (ja) | 1993-09-01 | 1993-09-01 | 多関節ロボットの制御方法 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3169152B2 (ja) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114474062A (zh) * | 2022-02-21 | 2022-05-13 | 乐聚(深圳)机器人技术有限公司 | 机器人控制方法、装置、机器人及存储介质 |
-
1993
- 1993-09-01 JP JP24205693A patent/JP3169152B2/ja not_active Expired - Fee Related
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114474062A (zh) * | 2022-02-21 | 2022-05-13 | 乐聚(深圳)机器人技术有限公司 | 机器人控制方法、装置、机器人及存储介质 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP3169152B2 (ja) | 2001-05-21 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP2610094B2 (ja) | 産業用マニプレータの制御装置 | |
| EP0072624B1 (en) | Mechanical wrist mechanisms | |
| WO1999033617A1 (fr) | Structure de bras pour robots de travail a morphologie de type humain | |
| US4716350A (en) | Method to avoid singularity in a robot mechanism | |
| JPH0438553B2 (ja) | ||
| JPH0550386A (ja) | ７自由度マニプレータの位置教示方式 | |
| JPH0768489A (ja) | 多関節ロボットの制御方法 | |
| JPS62194513A (ja) | ロボツトの円弧補間姿勢制御装置 | |
| JPH02168303A (ja) | ロボットの制御方法 | |
| JPH11123690A (ja) | 多関節形ロボット | |
| JP3082325B2 (ja) | ロボットハンド用３軸マニプレータ | |
| JPS6232794Y2 (ja) | ||
| JPH035605B2 (ja) | ||
| JPH0677205B2 (ja) | ロボツトの制御方法 | |
| JPH02279291A (ja) | ３指ハンド装置における作動方法 | |
| JPH0890463A (ja) | 水平多関節形ロボット | |
| Yoshikawa et al. | Four-joint redundant wrist mechanism and its control | |
| JP2566475B2 (ja) | ロボットの回動軸速度制御装置 | |
| JPH0647689A (ja) | 多関節形ロボットの制御方法 | |
| JP3078202B2 (ja) | 多関節ロボットの塗装姿勢制御方法 | |
| JP2003025263A (ja) | パラレルメカニズム機械の制御装置 | |
| JPS61192487A (ja) | 多関節型ロボツト | |
| JPH05116080A (ja) | ツール先端位置調整方法 | |
| KR102500148B1 (ko) | 관절 로봇 손 | |
| JPS62148182A (ja) | 関節装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| LAPS | Cancellation because of no payment of annual fees |