JPH09254079A - ロボットの制御装置 - Google Patents

ロボットの制御装置

Info

Publication number
JPH09254079A
JPH09254079A JP9339996A JP9339996A JPH09254079A JP H09254079 A JPH09254079 A JP H09254079A JP 9339996 A JP9339996 A JP 9339996A JP 9339996 A JP9339996 A JP 9339996A JP H09254079 A JPH09254079 A JP H09254079A
Authority
JP
Japan
Prior art keywords
brake
robot
speed
value
torque
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
JP9339996A
Other languages
English (en)
Inventor
Yasuyuki Inoue
康之 井上
Hirotaka Morita
裕隆 森田
Hideo Nagata
英夫 永田
Yoichi Tanaka
洋一 田中
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.)
Yaskawa Electric Corp
Original Assignee
Yaskawa Electric Corp
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 Yaskawa Electric Corp filed Critical Yaskawa Electric Corp
Priority to JP9339996A priority Critical patent/JPH09254079A/ja
Publication of JPH09254079A publication Critical patent/JPH09254079A/ja
Pending legal-status Critical Current

Links

Landscapes

  • Manipulator (AREA)

Abstract

(57)【要約】 【課題】 物体との衝突、挟み込み等の検出後の安全な
停止と復旧を行うことができる装置を提供する。 【解決手段】 関節部を駆動するモータのトルクの検出
または推定手段102と、トルクの検出値あるいは推定
値とあらかじめ設けてある設定値とを比較してその比較
結果を元にモータのブレーキの入切を判断する判断部1
03とブレーキの入切を制御する手段104とを設け
る。

Description

【発明の詳細な説明】
【0001】
【発明の属する技術分野】本発明は、ロボットアームの
運動によって生じる、衝突、挟み込み等の事故に対して
ブレーキを制御することによりオペレータや機械類の安
全を確保する機能を有するロボットの制御装置に関す
る。
【0002】
【従来の技術】従来のロボットの危険回避方法は異常時
にはブレーキを作用させロボットアームの緊急停止を行
う方式が用いられている。異常の検出内容は暴走など速
度の異常に関しては、位置指令パルスの払い出し、速度
の監視、位置検出情報をもとにした速度監視、サーボ偏
差の異常、サーボ系モデルとの出力比較などの種々の検
出がおこなわれている。また発生トルクの異常に関して
はトルク指令の積分に基づくオーバーロードなどの検出
方法が用いられていた。以上の検出値等を設定値と比較
することによりブレーキを作動し、ロボットを停止させ
ることにより、危険の回避が行われている。また、直接
ブレーキを作動させることなく、外部出力端子に信号を
出力し、その情報をもとに外部機械で停止や衝突回避動
作を行うなどの処置を行う場合もある。
【0003】
【発明が解決しようとする課題】ところが、従来技術で
速度情報をもとにロボットを停止する場合には、暴走の
ように異常に大きな速度でアームが運動した場合には速
度過大異常により自動的に停止することができるが、外
部の物体との衝突時には速度の変化を用いても衝突の検
出を明確に判断し停止することができない。かりに速度
の判断により衝突が検出されてもブレーキを作動させた
後には、人体等を挟み込んだ状態が保持される恐れがあ
る。トルク指令の情報をもとにブレーキを作動させる場
合でも速度で判断する場合と同様に、惰走のためロボッ
トが停止した状態では人または物を挟み込む力が非常に
大きな値になってしまうことがある。その点は外部機器
を停止させる場合も同様である。また、人を挟み込んだ
場合は、大きな作用力が働いた状態で保持され脱出不可
能な状態になる。手動でブレーキを解放する手段を設け
ること方法が考えられるが、単独で作業で作業する場合
には長時間挟まれ続ける可能性があり非常に危険であ
る。従来の危険回避手段では以上に述べたような問題が
あった。そこで、本発明は、物体との衝突、挟み込み後
に安全な停止と復旧を行うことができる装置を提供する
ことを目的とする。
【0004】
【課題を解決するための手段】ロボットの制御装置にお
いて関節部を駆動するモータのトルクの検出または推定
手段を設け、トルクの検出値あるいは推定値とあらかじ
め設けてある設定値とを比較する手段を有し、その比較
結果を元にモータのブレーキの入切を判断する判断部と
ブレーキの入切を制御する手段を有することを特徴とす
る。また上記内容に加えて、関節部の速度の検出手段と
速度設定値を比較する手段を有し、トルクの比較結果に
加えてブレーキ制御の判断を行う。垂直方向に自由度を
有するロボットでは、緊急停止後に重力の補償トルクを
印可する手段を有することにより、ブレーキ解放後のア
ームの重力負荷の軽減を行う。
【0005】
【発明の実施の形態】以下、概念図を図1、詳細図を図
2に示して説明する。図において、100はロボットに
動作指令を発するロボット制御部、101は速度検出
部、102はトルク検出(または推定)部、103はブ
レーキ制御判断部、104はブレーキ制御回路、105
はロボット、106は重力補償部(図1にはなし)であ
る。速度の情報はロボット関節部に取り付けられたエン
コーダの情報をカウントし差分などの操作を行うことで
求めることができる。トルクの情報はサーボコントロー
ラ内部のトルク指令値、電機子電流の測定、あるいはト
ルクセンサ等により求められる。また、オブザーバによ
りトルク指令と検出速度から演算的に求めることができ
る。以上の情報をもとにロボットの衝突、物体の挟み込
みがブレーキ制御判断部103により判断され、ブレー
キ制御部104によりブレーキの入切の制御が行われ
る。トルク検出部102の出力のみにより判断する場合
には、急激なトルクの上昇により衝突が認識される。た
とえば、トルクの絶対値とトルクの変化率を比較手段に
より処理することなどにより衝突、挟み込みを判断す
る。その後、ブレーキ制御回路104にてブレーキの作
動後、ブレーキ制御判断部103中のタイマー手段で一
定時間計時後ブレーキの解放を行う。さらに速度情報を
含めた場合にはロボット運転中に物をはさみこんだり衝
突を生じた場合には速度の低下とトルクの増大が起こ
る。これらの情報をもとにトルクと速度の関数関係など
の比較手段により衝突、挟み込みを判断しブレーキを作
動させる。その後、速度がほぼ0と判断される場合には
ブレーキの解放を行う。
【0006】上述の手段でブレーキの解放を行った場合
はサーボ主電源を同時にシャットダウンすることで危険
性を小さくすることができる。ところが、垂直多関節ロ
ボットなど重力方向に運動を行うアームを有するロボッ
トでは、サーボが切れた瞬間アームの重量が物体または
人体に作用することになり危険性が残ることになる。こ
れに対してブレーキを非作動な状態にした後、ロボット
制御部でアームの重力を補償することで危険性をさらに
低減することができる。図2は判断部でブレーキを作用
させた後サーボ部において重力を補償することによりア
ームの重量の作用をキャンセルする機能を付加してい
る。重力を補償するためにはモータの衝突以前に速度ア
ンプに保持されている積分値を用いること、または重力
パラメータ(リンク重量、重心位置)から導かれる関節
トルクを用いることにより、モータからアームの重量と
バランスが可能なトルクを発生することができる。
【0007】物体との衝突や挟み込みはロボットアーム
のいずれの部分でもおこりうる。図では1自由度分の構
成を示しているが、実際は関節の自由度数分設けること
になる。以下でその働きを説明する。アームが運動し外
界の物体に衝突等を起こした場合、作用する力は外力推
定部で検出される。また速度は速度検出部101により
検出される。それら検出値をもとにブレーキ制御判断部
103の比較関数により危険な状態にあるかどうかが判
定される。危険な状態にあると判断されるとブレーキ制
御回路104によりブレーキを作動する。ブレーキが作
動するとブレーキ制御判断部103で速度の検出値が監
視され、モータがほぼ静止状態にあると判定された場合
にはブレーキの解放が行われる。さらに重力方向の運動
自由度を有するロボットではブレーキの解放後はロボッ
ト制御部100において重力補償値がトルク指令として
サーボアンプに入力されロボットの各関節は外力で軽く
動く状態になる。なお、ロボットの関節は通常多自由度
あるため1つの自由度でブレーキ制御判断部が励起され
た場合、全軸のブレーキ制御回路が起動し、またブレー
キ解放制御部は全自由度の速度を判定し、その結果によ
りブレーキの解放が行われる。
【0008】
【発明の効果】以上述べたように、本発明によれば、ロ
ボットの各関節を駆動するモータのトルクの検出値また
は推定値、および速度の値をもとに物体との衝突、挟み
込み等を検出しその値をもとにブレーキの入り切りを制
御することにより、安全な停止と復旧を行うことがで
き、ロボットの安全性を大幅に向上できる。
【図面の簡単な説明】
【図1】本発明の概念を示す図
【図2】本発明の具体的実施例を示す図
【符号の説明】
100 ロボット制御部 101 速度検出部 102 トルク検出部 103 ブレーキ制御判断部 104 ブレーキ制御回路 105 ロボット 106 重力補償演算部
───────────────────────────────────────────────────── フロントページの続き (72)発明者 田中 洋一 福岡県北九州市八幡西区黒崎城石2番1号 株式会社安川電機内

Claims (3)

    【特許請求の範囲】
  1. 【請求項1】 ロボットの制御装置において、 関節部を駆動するモータのトルクの検出または推定手段
    と、 前記トルクの検出値あるいは推定値とあらかじめ定めた
    設定値とを比較してその比較結果をもとにモータのブレ
    ーキの入切を判断する手段と、 前記ブレーキの入切を制御する手段と、を設けたことを
    特徴とするロボットの制御装置。
  2. 【請求項2】 ロボットの制御装置において、 関節部の速度の検出手段とその検出値および速度設定値
    とを比較してその比較結果をもとにブレーキの入切を判
    断する手段と、 前記ブレーキの入切手段を制御する手段と、を設けたこ
    とを特徴とするロボットの制御装置。
  3. 【請求項3】 トルクの制限手段と、緊急停止後にブレ
    ーキの解放ならびに重力の補償を行う手段と、を設けた
    ことを特徴とする請求項1または2記載のロボットの制
    御装置。
JP9339996A 1996-03-22 1996-03-22 ロボットの制御装置 Pending JPH09254079A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP9339996A JPH09254079A (ja) 1996-03-22 1996-03-22 ロボットの制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP9339996A JPH09254079A (ja) 1996-03-22 1996-03-22 ロボットの制御装置

Publications (1)

Publication Number Publication Date
JPH09254079A true JPH09254079A (ja) 1997-09-30

Family

ID=14081231

Family Applications (1)

Application Number Title Priority Date Filing Date
JP9339996A Pending JPH09254079A (ja) 1996-03-22 1996-03-22 ロボットの制御装置

Country Status (1)

Country Link
JP (1) JPH09254079A (ja)

Cited By (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1503261A2 (en) * 2003-08-01 2005-02-02 Fanuc Ltd Brake apparatus having braking condition monitoring section
JP2008229800A (ja) * 2007-03-22 2008-10-02 Toshiba Corp アーム搭載移動ロボットとその制御方法
US20100141197A1 (en) * 2008-12-05 2010-06-10 Samsung Electronics Co., Ltd. Robot arm and method of controlling the same
US8909373B2 (en) 2009-03-27 2014-12-09 Abb Ag Robot and method for controlling of a robot
JP2015103074A (ja) * 2013-11-26 2015-06-04 ファナック株式会社 ブレーキ落下量を低減する機能を備えたサーボ制御装置
CN104827471A (zh) * 2014-02-12 2015-08-12 库卡罗伯特有限公司 用于使操纵器轴止动的方法和装置
KR20170074840A (ko) * 2014-10-27 2017-06-30 인튜어티브 서지컬 오퍼레이션즈 인코포레이티드 기기 교란 보상을 위한 시스템 및 방법
JP2019098410A (ja) * 2017-11-28 2019-06-24 ファナック株式会社 ロボットの速度を制限する制御装置
US10617479B2 (en) 2014-10-27 2020-04-14 Intuitive Surgical Operations, Inc. System and method for integrated surgical table motion
US10624807B2 (en) 2014-10-27 2020-04-21 Intuitive Surgical Operations, Inc. System and method for integrated surgical table icons
US10682190B2 (en) 2014-10-27 2020-06-16 Intuitive Surgical Operations, Inc. System and method for monitoring control points during reactive motion
CN111546375A (zh) * 2020-04-14 2020-08-18 深圳市大象机器人科技有限公司 一种机器人制动器自动释放方法和装置
CN111993461A (zh) * 2019-05-27 2020-11-27 发那科株式会社 机器人
US10905500B2 (en) 2014-10-27 2021-02-02 Intuitive Surgical Operations, Inc. System and method for registering to a surgical table
US10993772B2 (en) 2014-10-27 2021-05-04 Intuitive Surgical Operations, Inc. System and method for integrated table motion
US11179221B2 (en) 2014-10-27 2021-11-23 Intuitive Surgical Operations, Inc. Medical device with active brake release control
CN114248260A (zh) * 2020-09-21 2022-03-29 苏州艾利特机器人有限公司 一种多关节机器人制动器释放管理方法
CN114248261A (zh) * 2020-09-24 2022-03-29 苏州艾利特机器人有限公司 一种冗余自由度机器人制动器释放管理方法
US11485012B2 (en) 2019-12-12 2022-11-01 Seiko Epson Corporation Control method and robot system
US11622821B2 (en) 2017-02-03 2023-04-11 Olympus Corporation Medical manipulator

Cited By (42)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1503261A2 (en) * 2003-08-01 2005-02-02 Fanuc Ltd Brake apparatus having braking condition monitoring section
EP1503261A3 (en) * 2003-08-01 2007-07-04 Fanuc Ltd Brake apparatus having braking condition monitoring section
JP2008229800A (ja) * 2007-03-22 2008-10-02 Toshiba Corp アーム搭載移動ロボットとその制御方法
JP4550849B2 (ja) * 2007-03-22 2010-09-22 株式会社東芝 アーム搭載移動ロボット
US20100141197A1 (en) * 2008-12-05 2010-06-10 Samsung Electronics Co., Ltd. Robot arm and method of controlling the same
US8405340B2 (en) * 2008-12-05 2013-03-26 Samsung Electronics Co., Ltd. Robot arm and method of controlling the same
US8909373B2 (en) 2009-03-27 2014-12-09 Abb Ag Robot and method for controlling of a robot
JP2015103074A (ja) * 2013-11-26 2015-06-04 ファナック株式会社 ブレーキ落下量を低減する機能を備えたサーボ制御装置
US9334911B2 (en) 2013-11-26 2016-05-10 Fanuc Corporation Servo controller having function for reducing dropping when braking
CN104827471A (zh) * 2014-02-12 2015-08-12 库卡罗伯特有限公司 用于使操纵器轴止动的方法和装置
US9415515B2 (en) 2014-02-12 2016-08-16 Kuka Roboter Gmbh Method and apparatus for fixing a manipulator axis
US10682190B2 (en) 2014-10-27 2020-06-16 Intuitive Surgical Operations, Inc. System and method for monitoring control points during reactive motion
US10993772B2 (en) 2014-10-27 2021-05-04 Intuitive Surgical Operations, Inc. System and method for integrated table motion
US11576737B2 (en) 2014-10-27 2023-02-14 Intuitive Surgical Operations, Inc. System and method for integrated surgical table
US10617479B2 (en) 2014-10-27 2020-04-14 Intuitive Surgical Operations, Inc. System and method for integrated surgical table motion
US10624807B2 (en) 2014-10-27 2020-04-21 Intuitive Surgical Operations, Inc. System and method for integrated surgical table icons
US11672618B2 (en) 2014-10-27 2023-06-13 Intuitive Surgical Operations, Inc. System and method for integrated surgical table motion
US11896326B2 (en) 2014-10-27 2024-02-13 Intuitive Surgical Operations, Inc. System and method for integrated surgical table
US11684448B2 (en) 2014-10-27 2023-06-27 Intuitive Surgical Operations, Inc. Device with active brake release control
US11806875B2 (en) 2014-10-27 2023-11-07 Intuitive Surgical Operations, Inc. Disturbance compensation in computer-assisted devices
KR20170074840A (ko) * 2014-10-27 2017-06-30 인튜어티브 서지컬 오퍼레이션즈 인코포레이티드 기기 교란 보상을 위한 시스템 및 방법
US10905500B2 (en) 2014-10-27 2021-02-02 Intuitive Surgical Operations, Inc. System and method for registering to a surgical table
JP2017533795A (ja) * 2014-10-27 2017-11-16 インテュイティブ サージカル オペレーションズ, インコーポレイテッド 器具外乱補償のためのシステム及び方法
JP2021130003A (ja) * 2014-10-27 2021-09-09 インテュイティブ サージカル オペレーションズ, インコーポレイテッド 器具外乱補償のためのシステム及び方法
US11130231B2 (en) 2014-10-27 2021-09-28 Intuitive Surgical Operations, Inc. System and method for instrument disturbance compensation
US11179221B2 (en) 2014-10-27 2021-11-23 Intuitive Surgical Operations, Inc. Medical device with active brake release control
US11759265B2 (en) 2014-10-27 2023-09-19 Intuitive Surgical Operations, Inc. System and method for registering to a table
US11737842B2 (en) 2014-10-27 2023-08-29 Intuitive Surgical Operations, Inc. System and method for monitoring control points during reactive motion
US11413103B2 (en) 2014-10-27 2022-08-16 Intuitive Surgical Operations, Inc. System and method for monitoring control points during reactive motion
US11419687B2 (en) 2014-10-27 2022-08-23 Intuitive Surgical Operations, Inc. System and method for integrated surgical table motion
US11622821B2 (en) 2017-02-03 2023-04-11 Olympus Corporation Medical manipulator
US10828776B2 (en) 2017-11-28 2020-11-10 Fanuc Corporation Control device for limiting speed of robot
JP2019098410A (ja) * 2017-11-28 2019-06-24 ファナック株式会社 ロボットの速度を制限する制御装置
JP2020192624A (ja) * 2019-05-27 2020-12-03 ファナック株式会社 ロボット
CN111993461A (zh) * 2019-05-27 2020-11-27 发那科株式会社 机器人
US11485012B2 (en) 2019-12-12 2022-11-01 Seiko Epson Corporation Control method and robot system
CN111546375B (zh) * 2020-04-14 2022-11-25 深圳市大象机器人科技有限公司 一种机器人制动器自动释放方法和装置
CN111546375A (zh) * 2020-04-14 2020-08-18 深圳市大象机器人科技有限公司 一种机器人制动器自动释放方法和装置
CN114248260A (zh) * 2020-09-21 2022-03-29 苏州艾利特机器人有限公司 一种多关节机器人制动器释放管理方法
CN114248260B (zh) * 2020-09-21 2024-05-24 苏州艾利特机器人有限公司 一种多关节机器人制动器释放管理方法
CN114248261A (zh) * 2020-09-24 2022-03-29 苏州艾利特机器人有限公司 一种冗余自由度机器人制动器释放管理方法
CN114248261B (zh) * 2020-09-24 2024-05-24 苏州艾利特机器人有限公司 一种冗余自由度机器人制动器释放管理方法

Similar Documents

Publication Publication Date Title
JPH09254079A (ja) ロボットの制御装置
CN101268003B (zh) 电梯装置
JP6585574B2 (ja) 作業者とロボットとの協働作業を行う生産システム
KR0144650B1 (ko) 서보모터의 이상부하 검출 제어방법
JP4218403B2 (ja) 車両ドア制御装置
KR20180067652A (ko) 로봇시스템의 감시장치
KR20190029286A (ko) 협동로봇제어장치 및 협동로봇을 제어하는 방법
EP3439168B1 (en) Motor control device
JP2000052286A (ja) ロボットの制御装置
WO1991010181A1 (en) Method of detecting collision using observer
KR101329853B1 (ko) 머니퓰레이터 충돌 감지 장치와 이를 이용한 머니퓰레이터 제어 장치 및 제어 방법
JP2635257B2 (ja) エレベータ制御装置
JP5778891B2 (ja) ロボット制御装置
JPS63245389A (ja) ロボツトの制御方法
JPH0840658A (ja) エレベータの非常制動制御方法及び装置
JPH1110580A (ja) 産業用ロボットの駆動軸制御方法及びその装置
JPH06246674A (ja) 産業用ロボットのブレーキ異常検出方法
JP3327205B2 (ja) ロボットの制御方法および装置
JP2011140363A (ja) エレベータドアの制御装置
JP3336696B2 (ja) エレベータドアの制御装置
JP3997405B2 (ja) 移動マニピュレータの制御装置および移動マニピュレータ
JP7488474B2 (ja) ロボット制御装置
JPH0791139A (ja) 自動開閉扉の駆動緊急安全制御方法
JPH0584681A (ja) ロボツトアームの異物との衝突検出方法
JP5309812B2 (ja) モータ制御装置及びモータ制御方法

Legal Events

Date Code Title Description
A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20040303

A521 Written amendment

Effective date: 20040415

Free format text: JAPANESE INTERMEDIATE CODE: A523

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20040705

A521 Written amendment

Effective date: 20040726

Free format text: JAPANESE INTERMEDIATE CODE: A523

A911 Transfer of reconsideration by examiner before appeal (zenchi)

Effective date: 20040820

Free format text: JAPANESE INTERMEDIATE CODE: A911

A912 Removal of reconsideration by examiner before appeal (zenchi)

Free format text: JAPANESE INTERMEDIATE CODE: A912

Effective date: 20040924