JPH11347983A - マニプレータの動作制限装置 - Google Patents

マニプレータの動作制限装置

Info

Publication number
JPH11347983A
JPH11347983A JP16327098A JP16327098A JPH11347983A JP H11347983 A JPH11347983 A JP H11347983A JP 16327098 A JP16327098 A JP 16327098A JP 16327098 A JP16327098 A JP 16327098A JP H11347983 A JPH11347983 A JP H11347983A
Authority
JP
Japan
Prior art keywords
distance
tip
area
arm
speed
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.)
Pending
Application number
JP16327098A
Other languages
English (en)
Inventor
Koichi Obitsu
浩一 帯津
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.)
Meidensha Corp
Meidensha Electric Manufacturing Co Ltd
Original Assignee
Meidensha Corp
Meidensha Electric Manufacturing Co 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 Meidensha Corp, Meidensha Electric Manufacturing Co Ltd filed Critical Meidensha Corp
Priority to JP16327098A priority Critical patent/JPH11347983A/ja
Publication of JPH11347983A publication Critical patent/JPH11347983A/ja
Pending legal-status Critical Current

Links

Landscapes

  • Manipulator (AREA)

Abstract

(57)【要約】 【課題】 周辺機器への干渉を防止したマニプレータの
動作制限装置を提供する。 【解決手段】 アーム先端の座標値に対して制限領域L
m を設定し、この制限領域Lm との距離Lに基づき速度
を制限すると共に、制限領域Lm に沿い更に仮想制限領
域Lmiを設定したものである。

Description

【発明の詳細な説明】
【0001】
【発明の属する技術分野】本発明は、例えばマスタ・ス
レーブマニプレータにおいて、スレーブアームの動作範
囲を制限する装置に関する。
【0002】
【従来の技術】産業用ロボット、例えばマスタ・スレー
ブマニプレータにおいては、現在、スレーブアームと周
辺機器との干渉を防止するために、スレーブアームの各
軸の動作範囲を制限している。
【0003】
【発明が解決しようとする課題】しかしながら、図10
に示すようにスレーブアーム1の各軸の動作を制限した
だけでは、アームの動作空間内に周辺機器2があるとき
干渉を生じ、換言すれば各軸の動作を制限してもハンド
先端位置を制限したことにはならない。
【0004】本発明は、上述の問題に鑑み、周辺機器へ
の干渉を防止したマニプレータの動作制限装置の提供を
目的とする。
【0005】
【課題を解決するための手段】上述の目的を達成する本
発明は、次の発明特定事項を有する。 (1)アーム先端の座標値に対して制限領域を設定し、
この制限領域と上記アーム先端との距離を求め、この距
離により移動速度を制限するようにしたことを特徴とす
る。 (2)上記(1)において、制限領域上もしくは制限領
域を越えた状態にて、設定した制限領域に対して更に仮
想制限領域を求めて、これを新たな制限領域としたこと
を特徴とする。
【0006】
【発明の実施の形態】ここで、図1〜図9を参照して本
発明の実施の形態の一例を説明する。図1は、マスタ・
スレーブマニプレータにおいて、マスタ指示角度からス
レーブ指示角度までの処理ブロックを示しており、オペ
レータによるマスタアームの操作に基づき、このマスタ
アームの動きに追従するようにスレーブアームが動作す
るものであるが、この場合、マスタアームとスレーブア
ームとは1対1の制御である。したがって、マスタ・ス
レーブ変換器10では、マスタアームからの指示角度θ
n (n=1〜5)に対して図2に示す如くスレーブアー
ム1の目標角度θn'(n=1〜5)への変換は次式
(1)に示すものとなる。 θn'=θn (n=1〜5) ・・・・・(1)
【0007】ついで、順変換器11では、設定されたス
レーブアーム1の目標角度θn'に対してスレーブアーム
1の先端座標Ps を算出する。すなわち、図3に示す
X,Y,Z座標にあってスレーブアーム先端座標基準位
置に対する先端座標(Xs ,Ys ,Zs )を算出する。
【0008】制限領域処理回路12では、順変換器11
にて求めたスレーブアーム1の先端座標Ps に対して、
図4に示すような制限領域Lm を設けることによって補
正し、この補正後のスレーブアーム1の先端座標Ps'を
求めるものである。つまり、スレーブアーム1の先端座
標Ps が設定した制限領域を越える場合には、その先端
座標Ps を制限領域上に補正するものである。
【0009】逆変換器13では、制限領域処理を行なっ
たスレーブアーム先端座標Ps'からスレーブアーム1の
目標角度θn"を求め、順変換器11と逆の処理を行な
い、ついでソフトリミット処理回路14にてスレーブア
ーム1の指示角度θn を求めている。この結果、マスタ
アームからの指示角度θn に対して制限領域処理を施し
たスレーブアーム指示角度θn が得られることになる。
【0010】図1では、制限領域処理回路12によって
スレーブアーム先端座標Ps を補正する処理を行なって
いるのであるが、本発明では更にハンドのオーバシュー
トをも防止するものである。すなわち、図5に示すよう
に例えばX方向とZ方向について制限領域Lm での領域
A,Bを設定したとき、この領域は次式(2)にて表現
できる。 AX+BZ+C=0 ・・・・・(2) この場合、Y方向の座標値は、制限領域がなくその座標
値は任意となっている。こうして、図1に示す制限領域
処理回路12にて制限領域が定まることになるが、実際
上ハンドが高速にて動作中では領域を越えた状態で停止
することが生じ、オーバシュートが生じてしまう。
【0011】このため、スレーブアームの各軸角度から
アーム先端の座標を演算し、この座標値を用いてハンド
先端位置を演算し、図6に示すようにこのハンド位置と
設定した制限領域Lm との距離Lを求め、距離Lがある
境界値LB 以下に達した時点で速度Vの成分Va ,Vb
のうち制限領域に垂直な方向の速度Va に着目する。そ
して、図7に示す制限領域Lm からの距離Lと接近速度
Va'との関係から速度Va'を補正して図8に示すように
現在位置P0 より動作指令位置P1 を修正して補正後の
動作指令位置P1'にて動作するようにしている。つま
り、ハンドが境界値LB を過ぎた状態では減速をするこ
とによりオーバシュートを防止するものである。
【0012】更に、本発明では、ハンドが制限領域上に
あったり、又は制限領域を越えてしまった場合の動作と
して、図9に示すように更に制限領域Lm と平行に仮想
制限領域Lmiを設定して、これを新たな制限領域として
いる。つまり、図5に対応させた場合を考えると、図9
に示すように次式による仮想制限領域Lmiを設ける。 A'X+B'Z+C=0 ・・・・・(3) そして、オペレータの操作によるマスタアームによる目
標点P2 へ点P0 から移動しようとする場合、つまり点
0 は制限領域Lm を越えており、新たな仮想制限領域
Lmiを越えて点P2 へ移動しようとする場合、点P2
写像点である点P2'を目標点として移動させるようにし
ている。このようにして、仮想制限領域Lmiへのハンド
の侵入を防止する。オペレータの操作によって元の制限
領域Lm へ戻る位置を目標にした場合には、そのままも
とに移動することになるが、この場合、仮想制限領域も
平行移動する。
【0013】ハンド先端が制限領域を越えた場合、目標
位置を常に制限領域上にするという処理あるいは動作を
停止して異常を出力するという処理が考えられるが、前
者は制限領域を大きく越えたとき制限領域上の戻りが速
い動作となって危険であり、また後者は異常復帰操作が
必要で作業が中断し使い勝手が悪くなる。このため、仮
想制限領域Lmiを設けることで、ハンド先端を常に制限
領域Lmを越えないようにするが、越えた場合、この仮
想制限領域Lmiを制限領域として作業を続行し得るもの
である。
【0014】
【発明の効果】以上説明したように本発明によれば、制
限領域の設定による補正、減速、仮想制限領域の設定に
より、ハンド先端の周辺機器への干渉を防止することが
でき、また高速移動をさせても減速によりオーバシュー
トがなく、更に制限領域の侵入があっても作業を続行す
ることができ、制限領域を加工面とすることによりグラ
インド作業も可能となる。
【図面の簡単な説明】
【図1】本発明の実施の形態の一例の処理ブロック図。
【図2】スレーブアーム各軸の目標角度の説明図。
【図3】スレーブアーム先端座標基準位置の説明図。
【図4】制限領域と補正後のスレーブアーム先端位置の
説明図。
【図5】制限領域設定説明図。
【図6】ハンド先端と制限領域までの距離に係る説明
図。
【図7】距離と速度との関係図。
【図8】動作指令位置の説明図。
【図9】仮想制限領域の説明図。
【図10】干渉状態を示す説明図。
【符号の説明】
1 スレーブアーム 12 制限領域処理回路 A,B,Lm 制限領域 L 距離 V,Va ,Va',Vb 速度(速度成分) LB 境界値 P0 ,P1 ,P1',P2 ,P2'位置

Claims (2)

    【特許請求の範囲】
  1. 【請求項1】 アーム先端の座標値に対して制限領域を
    設定し、 この制限領域と上記アーム先端との距離を求め、 この距離により移動速度を制限するようにしたマニプレ
    ータの動作制限装置。
  2. 【請求項2】 制限領域上もしくは制限領域を越えた状
    態にて、設定した制限領域に対して更に仮想制限領域を
    求めて、これを新たな制限領域とした請求項1記載のマ
    ニプレータの動作制限装置。
JP16327098A 1998-06-11 1998-06-11 マニプレータの動作制限装置 Pending JPH11347983A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP16327098A JPH11347983A (ja) 1998-06-11 1998-06-11 マニプレータの動作制限装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP16327098A JPH11347983A (ja) 1998-06-11 1998-06-11 マニプレータの動作制限装置

Publications (1)

Publication Number Publication Date
JPH11347983A true JPH11347983A (ja) 1999-12-21

Family

ID=15770627

Family Applications (1)

Application Number Title Priority Date Filing Date
JP16327098A Pending JPH11347983A (ja) 1998-06-11 1998-06-11 マニプレータの動作制限装置

Country Status (1)

Country Link
JP (1) JPH11347983A (ja)

Cited By (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1332841A2 (de) * 2002-01-16 2003-08-06 Dürr Systems GmbH Verfahren zur Steuerung eines Roboters und Steuereinheit für einen Roboter
JP2005196488A (ja) * 2004-01-07 2005-07-21 Okuma Corp 送り駆動系の制御装置
JP2007038059A (ja) * 2005-08-01 2007-02-15 Nagoya Institute Of Technology 作業補助装置
JP2007038314A (ja) * 2005-08-01 2007-02-15 Nagoya Institute Of Technology 作業補助装置
EP2072195A1 (de) * 2007-12-19 2009-06-24 KUKA Roboter GmbH Verfahren zum Steuern der Bewegung eines Roboters innerhalb eines Arbeitsraums
US7664570B2 (en) 2003-04-23 2010-02-16 Toyota Jidosha Kabushiki Kaisha Method and apparatus for limiting the movement of a robot, and a robot equipped with said apparatus
JP2011515280A (ja) * 2008-02-08 2011-05-19 エフエムセ テクノロジーズ ソシエテ アノニム 流体船積みおよび/または荷降ろしシステム用の直接制御、特に比例制御および/または直線的制御式装置
JP2011125975A (ja) * 2009-12-18 2011-06-30 Denso Wave Inc ロボットの干渉回避装置
JP2011245614A (ja) * 2010-05-26 2011-12-08 GM Global Technology Operations LLC 速度制御ロボット機構におけるワークスペース制限の応用
JP2013039635A (ja) * 2011-08-16 2013-02-28 Yaskawa Electric Corp ロボット制御システムおよびロボット制御方法
KR20170102485A (ko) 2014-12-26 2017-09-11 카와사키 주코교 카부시키 카이샤 로봇 시스템
JP2017209781A (ja) * 2016-05-16 2017-11-30 クリオン、インコーポレイテッド ロボットマニピュレータシステムのためのシステムおよび方法
JP2018015870A (ja) * 2016-07-29 2018-02-01 ファナック株式会社 ロボットの制御装置および制御方法
JP2018062026A (ja) * 2016-10-12 2018-04-19 ファナック株式会社 ロボットの速度や加速度を制限する機能を備えたロボット制御装置
JP2020001137A (ja) * 2018-06-29 2020-01-09 三菱電機株式会社 ロボット制御装置およびロボットシステム
JP2020003958A (ja) * 2018-06-26 2020-01-09 ファナック株式会社 数値制御装置
JP2021044020A (ja) * 2018-06-26 2021-03-18 ファナック株式会社 数値制御装置
JPWO2021064809A1 (ja) * 2019-09-30 2021-04-08

Cited By (26)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1332841A2 (de) * 2002-01-16 2003-08-06 Dürr Systems GmbH Verfahren zur Steuerung eines Roboters und Steuereinheit für einen Roboter
EP1332841A3 (de) * 2002-01-16 2004-03-17 Dürr Systems GmbH Verfahren zur Steuerung eines Roboters und Steuereinheit für einen Roboter
US7664570B2 (en) 2003-04-23 2010-02-16 Toyota Jidosha Kabushiki Kaisha Method and apparatus for limiting the movement of a robot, and a robot equipped with said apparatus
JP2005196488A (ja) * 2004-01-07 2005-07-21 Okuma Corp 送り駆動系の制御装置
JP2007038059A (ja) * 2005-08-01 2007-02-15 Nagoya Institute Of Technology 作業補助装置
JP2007038314A (ja) * 2005-08-01 2007-02-15 Nagoya Institute Of Technology 作業補助装置
EP2072195A1 (de) * 2007-12-19 2009-06-24 KUKA Roboter GmbH Verfahren zum Steuern der Bewegung eines Roboters innerhalb eines Arbeitsraums
JP2011515280A (ja) * 2008-02-08 2011-05-19 エフエムセ テクノロジーズ ソシエテ アノニム 流体船積みおよび/または荷降ろしシステム用の直接制御、特に比例制御および/または直線的制御式装置
JP2011125975A (ja) * 2009-12-18 2011-06-30 Denso Wave Inc ロボットの干渉回避装置
JP2014054722A (ja) * 2010-05-26 2014-03-27 Gm Grobal Technology Operations Llc 速度制御ロボット機構におけるワークスペース制限の応用
US8676382B2 (en) 2010-05-26 2014-03-18 GM Global Technology Operations LLC Applying workspace limitations in a velocity-controlled robotic mechanism
JP2011245614A (ja) * 2010-05-26 2011-12-08 GM Global Technology Operations LLC 速度制御ロボット機構におけるワークスペース制限の応用
US9108315B2 (en) 2011-08-16 2015-08-18 Kabushiki Kaisha Yaskawa Denki Robot control system and robot control method
JP2013039635A (ja) * 2011-08-16 2013-02-28 Yaskawa Electric Corp ロボット制御システムおよびロボット制御方法
US10345788B2 (en) 2014-12-26 2019-07-09 Kawasaki Jukogyo Kabushiki Kaisha Robot system
KR20170102485A (ko) 2014-12-26 2017-09-11 카와사키 주코교 카부시키 카이샤 로봇 시스템
JP2017209781A (ja) * 2016-05-16 2017-11-30 クリオン、インコーポレイテッド ロボットマニピュレータシステムのためのシステムおよび方法
DE102017116788B4 (de) * 2016-07-29 2020-11-26 Fanuc Corporation Roboter-Steuerungsvorrichtung und Verfahren zur Steuerung derselben
CN107662206A (zh) * 2016-07-29 2018-02-06 发那科株式会社 机器人的控制装置和控制方法
JP2018015870A (ja) * 2016-07-29 2018-02-01 ファナック株式会社 ロボットの制御装置および制御方法
JP2018062026A (ja) * 2016-10-12 2018-04-19 ファナック株式会社 ロボットの速度や加速度を制限する機能を備えたロボット制御装置
JP2020003958A (ja) * 2018-06-26 2020-01-09 ファナック株式会社 数値制御装置
JP2021044020A (ja) * 2018-06-26 2021-03-18 ファナック株式会社 数値制御装置
JP2020001137A (ja) * 2018-06-29 2020-01-09 三菱電機株式会社 ロボット制御装置およびロボットシステム
JPWO2021064809A1 (ja) * 2019-09-30 2021-04-08
WO2021064809A1 (ja) * 2019-09-30 2021-04-08 株式会社Fuji ロボット制御装置およびロボットの直接教示方法

Similar Documents

Publication Publication Date Title
JPH11347983A (ja) マニプレータの動作制限装置
US11103996B2 (en) Robot joint space point-to-point movement trajectory planning method
CN108568815B (zh) 机器人***和机器人控制方法
CN108942880B (zh) 机器人***
JP2015030078A (ja) ロボット装置及びロボット制御方法
JP6316909B1 (ja) 協働動作領域を有するロボットシステム
WO2020183026A3 (de) Verfahren zur ansteuerung einer bearbeitunsgmaschine oder eines industrieroboters
US10994422B2 (en) Robot system for adjusting operation parameters
KR102033241B1 (ko) 로봇의 이동 속도 제어 장치 및 방법
JP6447141B2 (ja) ロボットの非常停止方法、ロボットの制御装置
JP2018176341A5 (ja)
CN111331618A (zh) 机器人控制装置、机器人控制***以及机器人控制方法
CN112959327B (zh) 机器人运动控制方法、***、电子设备及存储介质
JPH01131905A (ja) ロボット・ジョイント制御方法
JP2007168000A (ja) ロボットのダイレクト操作装置
JP2005118995A (ja) ロボットの制御方法および制御装置
JP2650464B2 (ja) 産業用ロボット
JPH11239988A (ja) 多関節ロボットのダイレクトティーチングにおける特異点回避方法
KR20210127746A (ko) 미리 정해져 있는 과제를 로봇을 통해 수행하기 위한 방법 및 시스템
US10723023B2 (en) Control device and control method for controlling workpiece moving device and robot to operate in cooperation with each other
KR20200090852A (ko) 로봇을 제어하기 위한 방법 및 시스템
JPS60200313A (ja) ロボツト座標補正装置
JPS63134124A (ja) ワイヤ放電加工装置
JPH0424809A (ja) ロボット制御装置
JPH04360777A (ja) マスタ・スレーブマニピュレータの制御方法

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20040823

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20050301

A02 Decision of refusal

Effective date: 20050628

Free format text: JAPANESE INTERMEDIATE CODE: A02