JP6924146B2 - ロボットシステムの監視装置 - Google Patents

ロボットシステムの監視装置 Download PDF

Info

Publication number
JP6924146B2
JP6924146B2 JP2017547617A JP2017547617A JP6924146B2 JP 6924146 B2 JP6924146 B2 JP 6924146B2 JP 2017547617 A JP2017547617 A JP 2017547617A JP 2017547617 A JP2017547617 A JP 2017547617A JP 6924146 B2 JP6924146 B2 JP 6924146B2
Authority
JP
Japan
Prior art keywords
external force
robot
value
current
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.)
Active
Application number
JP2017547617A
Other languages
English (en)
Other versions
JPWO2017073052A1 (ja
Inventor
宗藤　康治
康治 宗藤
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.)
Kawasaki Motors Ltd
Original Assignee
Kawasaki Jukogyo KK
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 Kawasaki Jukogyo KK filed Critical Kawasaki Jukogyo KK
Publication of JPWO2017073052A1 publication Critical patent/JPWO2017073052A1/ja
Application granted granted Critical
Publication of JP6924146B2 publication Critical patent/JP6924146B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/06—Safety devices
    • B25J19/063—Safety devices working only upon contact with an outside object
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/085—Force or torque sensors
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/06—Safety devices
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B25J9/12—Programme-controlled manipulators characterised by positioning means for manipulator elements electric
    • B25J9/126—Rotary actuators
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1602—Programme controls characterised by the control system, structure, architecture
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1628—Programme controls characterised by the control loop
    • B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01L—MEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L5/00—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes
    • G01L5/0052—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes measuring forces due to impact
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01L—MEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L5/00—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes
    • G01L5/22—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes for measuring the force applied to control members, e.g. control members of vehicles, triggers
    • G01L5/226—Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes for measuring the force applied to control members, e.g. control members of vehicles, triggers to manipulators, e.g. the force due to gripping
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/37—Measurements
    • G05B2219/37285—Load, current taken by motor
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/37—Measurements
    • G05B2219/37624—Detect collision, blocking by measuring change of velocity or torque
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/39—Robotics, robotics to robotics hand
    • G05B2219/39353—Joint space observer
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/41—Servomotor, servo controller till figures
    • G05B2219/41372—Force estimator using disturbance estimator observer

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Human Computer Interaction (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Description

本発明は、ロボットシステムの監視装置に関する。
従来、力センサを用いないで、ロボットに外力が加わったときに、外力に追従するようにロボットを制御する制御装置が知られている（特許文献１〜特許文献５を参照）。この制御装置は、ロボットの関節軸を駆動するモータに流れる電流値とモータの回転速度を検出して、ロボットにかかった外乱トルクを算出し、外乱トルクに応じて位置指令値を変更する。
近年では、生産性向上の観点から、ロボットと作業者が同じ作業空間内で共同して作業を行うことが提案されている。そのため、安全性の観点から、ロボットの動作を監視して、衝突を高精度に検出するための様々な技術が開発されている（特許文献６、特許文献７を参照）。例えば特許文献７に記載された制御装置は、検出されたモータ回転角と入力されたロボットアームの負荷の重量及び重心位置から、逆動力学演算を行うことにより、モータ駆動に必要なモータ電流を計算する。そして、このモータ電流計算値とモータから検出される電流検出値との差を、衝突により発生する外乱電流値として計算し、この外乱電流値に基づいて衝突を検出する。
特開平１０−１５６７７１号公報 特開平１１−０４２５７５号公報 特開平１１−０４２５７６号公報 特開平１１−０４２５７７号公報 特開平１１−０４２５７８号公報 特開２００６−０７５９３１号公報 特開２００６−１２３０１２号公報
しかし、特許文献７のような従来の構成では、ロボットの関節軸を駆動するモータの電流値に基づいて衝突を検出するため、衝突を高精度に検出するものではなかった。
そこで本発明は、ロボット運転時の衝突を高精度に検出可能なロボットシステムの監視装置を提供することを目的とする。
本発明の一態様に係るロボットシステムの監視装置は、１以上の関節軸と、その関節軸を駆動させるサーボモータを備えたロボットと、前記各関節軸を駆動するサーボモータを制御する制御装置と、を備えたロボットシステムの監視装置であって、各サーボモータに流れる電流値を検出する電流センサと、前記電流センサで検出された各サーボモータを流れる電流値をトルク値に変換する電流トルク変換部と、各サーボモータの駆動に必要な駆動トルクの少なくとも一部を推定する駆動トルク推定部と、前記電流トルク変換部で変換されたトルク値と前記駆動トルクの推定値との差分トルクを演算する差分トルク演算部と、前記差分トルク演算部で演算された前記差分トルクを前記ロボットの外力に変換する外力変換部と、前記外力変換部で変換された前記外力の値に基づいて前記ロボットの停止信号を生成し、これを前記制御装置に供給する停止信号生成部と、を備える。
上記構成によれば、ロボットの各関節軸を駆動するモータに流れる電流値を検出し、検出した電流値をトルク値に変換し、変換したトルク値をロボットの外力に変換する。ロボットに働く外力を直接算出するので、ロボット運転時の衝突を高精度に検出することができる。また、外力の値に基づいて停止信号を生成するので管理者は閾値等の設定が容易である。
本発明のその他の態様に係るロボットシステムの監視装置は、１以上の関節軸と、その関節軸を駆動させるサーボモータを備えたロボットと、前記各関節軸を駆動するサーボモータを制御する制御装置と、を備えたロボットシステムの監視装置であって、各サーボモータに流れる電流値を検出する電流センサと、前記電流センサで検出された各サーボモータを流れる電流値を前記ロボットの外力の検出値に変換する電流外力変換部と、各サーボモータの駆動に必要な駆動トルクの少なくとも一部を推定する駆動トルク推定部と、前記駆動トルクの推定値を前記ロボットの外力の推定値に変換するトルク外力変換部と、前記ロボットの外力の検出値と前記ロボットの外力の推定値との差分を演算することにより前記ロボットの外力に変換する外力変換部と、前記外力変換部で変換された前記外力の値に基づいて前記ロボットの停止信号を生成し、これを前記制御装置に供給する停止信号生成部と、を備える。
本発明のその他の態様に係るロボットシステムの監視装置は、１以上の関節軸と、その関節軸を駆動させるサーボモータを備えたロボットと、前記各関節軸を駆動するサーボモータを制御する制御装置と、を備えたロボットシステムの監視装置であって、各サーボモータに流れる電流値を検出する電流センサと、各サーボモータを流れる電流値を推定する電流推定部と、各サーボモータを流れる検出電流値と推定電流値との差分電流を演算する差分電流演算部と、前記差分電流演算部で算出された差分電流を前記ロボットの外力に変換する外力変換部と、前記外力変換部で変換された前記外力の値に基づいて前記ロボットの停止信号を生成し、これを前記制御装置に供給する停止信号生成部と、を備える。
本発明のその他の態様に係るロボットシステムの監視装置は、１以上の関節軸と、その関節軸を駆動させるサーボモータを備えたロボットと、前記各関節軸を駆動するサーボモータを制御する制御装置と、を備えたロボットシステムの監視装置であって、各サーボモータに流れる電流値を検出する電流センサと、前記電流センサで検出された各サーボモータを流れる電流値をトルクの検出値に変換する第１電流トルク変換部と、各サーボモータを流れる電流値を推定する電流推定部と、前記電流推定部で推定された各サーボモータを流れる推定電流値をトルクの推定値に変換する第２電流トルク変換部と、前記トルクの検出値と前記トルクの推定値との差分トルクを演算する差分トルク演算部と、前記差分トルク演算部で算出された差分トルクを前記ロボットの外力に変換する外力変換部と、前記外力変換部で変換された前記外力の値に基づいて前記ロボットの停止信号を生成し、これを前記制御装置に供給する停止信号生成部と、を備える。
本発明のその他の態様に係るロボットシステムの監視装置は、１以上の関節軸と、その関節軸を駆動させるサーボモータを備えたロボットと、前記各関節軸を駆動するサーボモータを制御する制御装置と、を備えたロボットシステムの監視装置であって、各サーボモータに流れる電流値を検出する電流センサと、各サーボモータを流れる電流値を推定する電流推定部と、前記電流センサで検出された各サーボモータを流れる電流値を前記ロボットの外力の検出値に変換する第１電流外力変換部と、前記電流推定部で推定された各サーボモータを流れる推定電流値を前記ロボットの外力の推定値に変換する第２電流外力変換部と、前記ロボットの外力の検出値と前記ロボットの外力の推定値との差分を演算することにより前記ロボットの外力に変換する外力変換部と、前記外力変換部で変換された前記外力の値に基づいて前記ロボットの停止信号を生成し、これを前記制御装置に供給する停止信号生成部と、を備える。
前記停止信号生成部は、前記外力変換部で変換された前記外力の値が予め設定された第１閾値を超えたときに前記ロボットの停止信号を生成してもよい。
衝突判断の際の閾値が電流値であると、管理者は電流値からロボットに働く外力を見積もらねばならず設定が煩雑である。上記構成によれば、ロボットに働く外力の値が、予め設定した閾値を超えたか否かを判定するので、管理者は閾値設定が容易である。これにより、例えば１００Ｎというような外力値を直接閾値として設定することができる。
前記トルク外力変換部で変換された前記外力の値を入力値とするローパスフィルタを更に備え、前記停止信号生成部は、前記ローパスフィルタの出力値が予め設定された第２閾値を超えたときに前記ロボットの停止信号を生成してもよい。
上記構成によれば、ローパスフィルタによって、ロボットに瞬間的に作用する外力の変化に過剰に反応することなく、ノイズ成分を抑制し好適に衝突判定を行うことができる。
上記ロボットシステムの監視装置では、トルクから前記ロボットの外力への変換、又は、電流から前記ロボットの外力への変換は、前記ロボットの所定の点（例えばロボットの先端）を外力の作用点としたヤコビ行列を用いて演算されてもよい。
本発明によれば、ロボット運転時の衝突を高精度に検出可能なロボットシステムの監視装置を提供することができる。
図１は、本発明の第１実施形態に係る監視装置が実装されたロボットシステムの全体構成を示すブロックダイアグラムである。 図２は、図１の監視装置の構成を示すブロックダイアグラムである。 図３は、制御装置の処理の流れを示すフローチャートである。 図４は、監視装置の処理の流れを示すフローチャートである。 図５は、本発明の第２実施形態に係る監視装置の構成を示すブロックダイアグラムである。 図６は、本発明の第３実施形態に係る監視装置の構成を示すブロックダイアグラムである。 図７は、本発明の第４実施形態に係る監視装置の構成を示すブロックダイアグラムである。 図８は、本発明の第５実施形態に係る監視装置の構成を示すブロックダイアグラムである。
本発明の実施の形態について、図面を参照しつつ説明する。以下では、全ての図面を通じて同一又は相当する要素には同じ符号を付して、重複する説明は省略する。
［ロボットシステム］
図１は、本発明の第１実施形態に係る監視装置が実装されたロボットシステムの全体構成を示すブロックダイアグラムである。図１に示すように、ロボットシステム１は、ロボット２と、制御装置３と、監視装置４を備える。ロボットシステム１は、ロボット２と作業者が同じ作業空間内で共同して作業を行うためのものである。このため、本実施形態のロボットシステム１は、作業者の安全性を向上させるためにロボット２の監視装置４を備える。
ロボット２は、１以上の関節軸と、その関節軸を駆動させるサーボモータを備える。ロボット２は、本実施形態では、６つの関節軸Ｊ１〜Ｊ６と、それらの関節軸を駆動させる６つのサーボモータＭ１〜Ｍ６備える。ロボット２は、いわゆる６軸多関節ロボットである。各サーボモータＭ１〜Ｍ６にはモータを駆動する電流を検出する電流センサ５、サーボモータＭ１〜Ｍ６の回転を制動するブレーキ（図示せず）、及び、サーボモータＭ１〜Ｍ６のモータの回転角度位置を検出するエンコーダ等の位置センサ（図示せず）がそれぞれ設けられる。ここでモータの回転角度位置とは、サーボモータＭ１〜Ｍ６の関節座標系における関節軸Ｊ１〜Ｊ６の角度の位置である（以下では、関節軸角度位置ともいう）。
制御装置３は、ロボット２とケーブルＬ１〜Ｌ６（太字で図示）を介して接続される。ここでケーブルＬ１〜Ｌ６は関節軸Ｊ１〜Ｊ６のサーボモータＭ１〜Ｍ６やブレーキ等に電源を供給するための電源ライン、サーボモータＭ１〜Ｍ６に取り付けられた位置センサ（図示せず）からのセンサ信号を受信するための信号ライン等が含まれる。制御装置３は、位置指令値に基づいて各関節軸Ｊ１〜Ｊ６を駆動するサーボモータＭ１〜Ｍ６を制御するように構成される。
また、制御装置３は監視装置４と通信ケーブル（図示しない）を介して接続される。ここで通信ケーブルは、例えばＲＳ４２２等のシリアル通信用のケーブルである。制御装置３は、通信ケーブルを介して、監視装置４に監視信号を供給するとともに、監視装置４から停止信号を受信したときにはロボット２の動作を停止させる停止機能を備える。
制御装置３は、演算処理器６、サーボアンプ７、メモリ、入出力インタフェース、通信インタフェース等を備えたロボットコントローラである。演算処理器６は、電流指令値生成部６１と、駆動トルク推定部６２を備える。電流指令値生成部６１及び駆動トルク推定部６２は、演算処理器６において、所定のプログラムが実行されることによって、実現される機能ブロックである。電流指令値生成部６１は、予め定められた位置指令値と位置センサからの関節軸角度位置に基づいて電流指令値を演算し、サーボアンプ７に出力する。サーボアンプ７は、サーボモータＭ１〜Ｍ６に対応して設けられ、与えられる電流指令値に基づいて電流を発生し、ケーブルＬ１〜Ｌ６を介して発生した電流をサーボモータＭ１〜Ｍ６に供給する。つまり、各サーボアンプ７は電流指令値に応じてサーボモータＭ１〜Ｍ６の駆動電流を発生する増幅器である。このように制御装置３は、位置指令値に基づいて各関節軸Ｊ１〜Ｊ６に設けられたサーボモータＭ１〜Ｍ６を位置制御するように構成される。
駆動トルク推定部６２は、位置センサにより算出された関節軸角度位置から、ロボット２の関節軸Ｊ１〜Ｊ６のサーボモータＭ１〜Ｍ６を駆動するのに必要な駆動トルクを推定する。駆動トルク推定部６２は、本実施形態では、重力トルク、慣性力トルク、及び摩擦力トルクをそれぞれ算出し、これらを加算することにより、駆動トルクの推定値を算出する。ここで重力トルクは各リンクの重量分に打ち勝って姿勢を維持するためのトルクである。慣性力トルクはリンクの慣性分に打ち勝つために必要なトルクである。摩擦力トルクは減速機の摩擦分に打ち勝つために必要なトルクである。この駆動トルク推定値は、電流センサ５で検出されたセンサ電流値とともに、監視信号として制御装置３から監視装置４に送信される。
監視装置４は、ロボットシステム１においてロボット２の動作を監視して衝突を検出するように構成される。監視装置４は、制御装置３からロボット２の監視信号（センサ電流値、駆動トルク推定値）を受信し、衝突を検出した場合には、制御装置３に停止信号を供給する。監視装置４は、ロボット２とともに作業を行う作業者の安全性を向上させるために、制御装置３から独立して設けられる。例えば制御装置３と監視装置４は一つの筐体の中に収容される。
［監視装置］
次に、監視装置４の具体的な構成について図２のブロックダイアグラムを用いて説明する。図２に示すように、監視装置４は、電流トルク変換部４１と、差分トルク演算部４２と、外力変換部４３と、停止信号生成部４４を備える。ここで監視装置４は、１以上のプロセッサ、メモリ、入出力インタフェース、通信インタフェース等を備えたコンピュータである。ここで監視装置４は、管理者により、衝突検知の際の閾値を任意の値に調整可能な構成を備える。各部（４１〜４４）は、プロセッサにおいて、所定のプログラムが実行されることによって、実現される機能ブロックである。
電流トルク変換部４１は、電流センサ５で検出された各サーボモータＭ１〜Ｍ６を流れるセンサ電流値をトルク値に変換する。電流センサ５で検出されたセンサ電流値は監視信号として、通信ケーブルを介して制御装置３から監視装置４に送信され、電流トルク変換部４１に入力される。電流トルク変換部４１は、入力されたセンサ電流値をトルク値に変換し、これを差分トルク演算部４２に出力する。
差分トルク演算部４２は、電流トルク変換部４１で変換されたトルク値と駆動トルクの推定値との差を差分トルクとして演算する。ここで駆動トルク推定値は、駆動トルク推定部６２で演算された後に、監視信号として、通信ケーブルを介して制御装置３から監視装置４に送信され、差分トルク演算部４２に入力される。尚、本実施形態では、制御装置３が駆動トルク推定部６２を備えたが、監視装置４が駆動トルク推定部６２を備えてもよい。差分トルク演算部４２は、本実施形態では、加減算器５１を備える。加減算器５１は、電流トルク変換部４１から入力される各サーボモータＭ１〜Ｍ６のトルク値から、駆動トルク推定部６２から入力される駆動トルク推定値を減算して差分トルクを算出し、これを外力変換部４３に出力する。
外力変換部４３は、差分トルク演算部４２で演算された差分トルク値をロボット２の外力に変換し、これを停止信号生成部４４に出力する。
停止信号生成部４４は、外力変換部４３で変換された外力のスカラ値に基づいてロボット２の停止信号を生成し、これを制御装置３に供給する。停止信号生成部４４は、本実施形態では、第１衝突判定部５２と、ローパスフィルタ５３と、第２衝突判定部５４、を備える。
第１衝突判定部５２は、外力変換部４３から入力された外力の値｜ｆｄ｜が予め設定された第１閾値ｆｔｈ１を超えたか否かを判定し、第１閾値ｆｔｈ１を超えたときにロボット２が衝突したとして第１停止信号を生成し、これを制御装置３に出力するように構成されている。ここで第１閾値ｆｔｈ１は、本実施形態では１００Ｎに設定される。第１閾値ｆｔｈ１との比較対象である外力の値｜ｆｄ｜は外力ｆｄのスカラ値である。
ローパスフィルタ５３は、外力変換部４３で変換された外力の値ｆｄを入力値として、フィルタ演算を施し、これを第２衝突判定部５４に出力するように構成されている。
第２衝突判定部５４は、ローパスフィルタ５３の出力値が予め設定された第２閾値ｆｔｈ２を超えたか否かを判定し、第２閾値ｆｔｈ２を超えたときにロボット２の第２停止信号を生成し、これを制御装置３に出力するように構成されている。ここで第２閾値ｆｔｈ２は、本実施形態では８０Ｎに設定される。第２閾値ｆｔｈ２との比較対象であるローパスフィルタ５３の出力値もスカラ値である。
［ロボットの動作］
次に、以上のような構成のロボットシステム１におけるロボット２の動作について図１を用いて説明する。
制御装置３は、予め定められた位置指令値と位置センサからの関節軸角度位置情報に基づいて電流指令値を演算する。サーボアンプ７は、電流指令値に基づいて電流を発生し、ケーブルＬ１〜Ｌ６を介して発生した電流をサーボモータＭ１〜Ｍ６に供給する。サーボモータＭ１〜Ｍ６に電流が流れると、各関節軸Ｊ１〜Ｊ６の関節軸角度が変位してロボット２の手先の位置が目的の位置へ移動する。このように制御装置３は、位置指令値に基づいて各関節軸Ｊ１〜Ｊ６に設けられたサーボモータＭ１〜Ｍ６を位置制御する。
［ロボットの監視］
次に、ロボットシステム１におけるロボット２の動作監視について図３及び図４のフローチャートも参照しつつ説明する。図３に示すように、まず、制御装置３は、ロボット２の動作を監視するために必要な監視信号を生成する（図３のステップＳ３１）。制御装置３は、監視信号として、電流センサ５によりセンサ電流値を検出するとともに、駆動トルク推定部６２により駆動トルク推定値を推定する（図１参照）。駆動トルク推定部６２は、位置センサにより算出された関節軸角度位置から例えば時間差分を取ることにより駆動軸速度を算出する。そして、予めメモリに記憶された摩擦係数を読み出して、算出された駆動軸速度と摩擦係数からクーロン摩擦、粘性摩擦等に相当する摩擦力トルクを算出する。駆動トルク推定部６２は、位置センサにより算出された関節軸角度位置から関節角速度を算出する。そして、算出された関節角速度から関節角加速度を算出する。予めメモリに記憶されたリンクパラメータを読み出し、リンクパラメータ及び位置センサにより算出された関節軸角度位置から各リンクの慣性モーメントを算出する。算出された関節角加速度、及び各リンクの慣性モーメントから慣性力トルクを算出する。駆動トルク推定部６２は、予めメモリに記憶されたリンクパラメータを読み出し、リンクパラメータを用いて、位置センサにより算出された関節軸角度位置から各リンクに作用する重力を算出し、この重力を補償する重力トルクを算出する。駆動トルク推定部６２は、摩擦力トルク、慣性力トルク及び重力トルクを加算して駆動トルクの推定値を算出する。
次に、制御装置３は、ステップＳ１で生成した監視信号を所定期間ごとに監視装置４に送信する（図３のステップＳ３２）。ここで監視信号には、電流センサ５で検出された各サーボモータＭ１〜Ｍ６を流れるセンサ電流値と、駆動トルク推定部６２で演算された各サーボモータＭ１〜Ｍ６を駆動するのに必要な駆動トルク推定値が含まれる。
一方、監視装置４は、図４に示すように、制御装置３から所定期間ごとに送信される監視信号を受信する（図４のステップＳ４１）。
監視装置４は、監視信号を受信したときは、電流トルク変換部４１により、電流センサ５で検出された各サーボモータＭ１〜Ｍ６を流れるセンサ電流値をトルク値に変換する（図４のステップＳ４２）。電流トルク変換部４１は、入力されたセンサ電流値をトルク値に変換し、これを差分トルク演算部４２に出力する。
次に、差分トルク演算部４２は、電流トルク変換部４１で変換されたトルク値と駆動トルクの推定値との差を差分トルクとして演算する（図４のステップＳ４３）。加減算器５１は、電流トルク変換部４１から入力される各サーボモータＭ１〜Ｍ６のトルク値から、駆動トルク推定部６２から入力される駆動トルク推定値を減算して差分トルクを算出し、これを外力変換部４３に出力する（図２参照）。
次に、外力変換部４３は、差分トルク演算部４２で演算された差分トルク値をロボット２の外力に変換する（図４のステップＳ４４）。ここでは外力変換部４３は、差分トルク演算部４２から入力された差分トルクτｄからロボット２の先端に働く外力ｆｄを、仮想仕事の原理によって次式（１）のように求める。
ｆｄ＝（ＪＴ）−１τｄ・・・（１）
ここでＪはヤコビ行列であり、ロボットの座標系と関節座標系との間の微小変位関係を表現した行列である。ヤコビ行列Ｊについて、誤差Δｘと関節角差分Δθには式（２）の関係が成立している。
Δｘ＝ＪΔθ・・・・・・（２）
このように外力変換部４３は、式（１）のように差分トルクτｄにヤコビ行列Ｊの転置行列ＪＴの逆行列を乗じることによりロボット２の外力ｆｄに変換し、これを停止信号生成部４４に出力する。ここで、式（１）の外力ｆｄはロボット２の先端で作用していると想定したときの外力である。外力ｆｄがロボット２の先端以外を作用点としている場合は、外力ｆｄを実際の作用点での外力に座標変換してもよい。
次に、停止信号生成部４４は、外力変換部４３で変換された外力の値に基づいてロボット２が衝突したか否かを検出する（図４のステップＳ４５）。具体的には、図２の第１衝突判定部５２が、外力変換部４３から入力された外力の値｜ｆｄ｜が予め設定された第１閾値ｆｔｈ１を超えたか否かを判定し、第１閾値ｆｔｈ１を超えたときにロボット２が衝突したとして第１停止信号を生成し、これを制御装置３に出力する（図４のステップＳ４６）。第１閾値ｆｔｈ１との比較対象である外力の値｜ｆｄ｜は外力ｆｄのスカラ値である。本実施形態では、図２の第２衝突判定部５４も、ローパスフィルタ５３の出力値が予め設定された第２閾値ｆｔｈ２を超えたか否かを判定し、第２閾値ｆｔｈ２を超えたときにロボット２の第２停止信号を生成し、これを制御装置３に出力する（図４のステップＳ４６）。第２閾値ｆｔｈ２との比較対象であるローパスフィルタ５３の出力値もスカラ値である。ローパスフィルタ５３によって、ロボット２に瞬間的に作用する外力の値ｆｄの変化に過剰に反応することなく、ノイズ成分を抑制し好適に衝突判定を行うことができる。
ここで第１閾値ｆｔｈ１（１００Ｎ）及び第２閾値ｆｔｈ２（８０Ｎ）は、管理者により、予め任意の値に設定される。衝突判断の際の閾値が電流値であると、管理者は電流値からロボット２に働く外力を見積もらねばならず設定が煩雑であるが、ロボットに働く外力の値が、予め設定した閾値を超えたか否かを判定するので、管理者は閾値設定が容易である。例えば１００Ｎというような外力値を直接閾値として設定することができる。
一方、制御装置３は、図３に示すように、監視装置４から停止信号を受信したとき（図３のステップＳ３３でＹＥＳ）にはロボット２の動作を停止させる。ここでロボット２の停止態様は任意である。例えば動力を遮断することにより即座に停止させてもよいし（いわゆる非常停止）、動力を遮断し且つ減速して停止させてもよいし（いわゆる減速停止）、動力を遮断することなく、減速して停止させてもよい（いわゆる一時停止）。
従って、本実施形態によれば、監視装置４において、ロボット２の各関節軸を駆動するモータに流れる電流値を検出し、検出した電流値をトルク値に変換し、変換したトルク値をロボットの外力に変換する。つまり、ロボット２に働く外力ｆｄを直接算出するので、ロボット運転時の衝突を高精度に検出することができる。制御装置３において、ロボット２を安全に停止することができる。
尚、本実施形態では、駆動トルク推定部６２は、重力トルク、慣性力トルク、及び摩擦力トルクをそれぞれ算出し、これらを加算することにより、駆動トルクの推定値を算出したが、これらの重力トルク、慣性力トルク、及び摩擦力トルクのうちの少なくとも一つを駆動トルクの推定値としてもよい。
以下、本発明の第２乃至第５実施形態について説明する。以下では、第１実施形態と共通する構成の説明は省略し、相違する構成を中心に説明する。
図５は、本発明の第２実施形態に係る監視装置の構成を示すブロックダイアグラムである。図５に示すように、監視装置４Ａは、電流センサ５で検出された各サーボモータを流れる電流値をロボット２の外力の検出値に変換する電流外力変換部４５と、駆動トルクの推定値をロボット２の外力の推定値に変換するトルク外力変換部４６とを備え、外力変換部４３がロボット２の外力の検出値とロボット２の外力の推定値との差分を演算することによりロボット２の外力に変換する点が第１実施形態（図２参照）と異なる。
尚、電流外力変換部４５による電流ｉからロボット２の外力ｆへの変換は、ロボットの所定の点（例えばロボット２の先端）を外力の作用点としたヤコビ行列Ｊを用いて次式（３）のように演算される。ここでＸは電流ｉからトルクτへの変換を表している。
ｆ＝（ＪＴ）−１Ｘｉ・・・（３）
トルク外力変換部４６によるトルクτからロボット２の外力ｆへの変換はロボットの所定の点（例えばロボット２の先端）を外力の作用点としたヤコビ行列Ｊを用いて演算される（式（１）参照）。
停止信号生成部４４は、外力変換部４３（加減算器５５）で変換された外力の値に基づいてロボットの第１停止信号及び第２停止信号を生成し、これを制御装置３に供給する。
図６は、本発明の第３実施形態に係る監視装置の構成を示すブロックダイアグラムである。図６に示すように、制御装置３が各サーボモータを流れる電流値を推定する電流推定部６３を備え、監視装置４Ｂが、電流センサ５で検出された各サーボモータを流れる検出電流値と、各サーボモータを流れる推定電流値との差分電流を演算する差分電流演算部４７を備え、外力変換部４３が、差分電流演算部４７（加減算器５６）で算出された差分電流をロボット２の外力に変換する点が第１実施形態（図２参照）と異なる。
尚、外力変換部４３による電流ｉからロボット２の外力ｆへの変換は、ロボットの所定の点（例えばロボット２の先端）を外力の作用点としたヤコビ行列Ｊを用いて上記式（３）のように演算される。停止信号生成部４４は、外力変換部４３で変換された外力の値に基づいてロボット２の第１停止信号及び第２停止信号を生成し、これを制御装置３に供給する。
図７は、本発明の第４実施形態に係る監視装置の構成を示すブロックダイアグラムである。図７に示すように、制御装置３が各サーボモータを流れる電流値を推定する電流推定部６３を備え、監視装置４Ｃが、電流センサ５で検出された各サーボモータを流れる電流値をトルクの検出値に変換する電流トルク変換部４１Ａと、各サーボモータを流れる推定電流値をトルクの推定値に変換する電流トルク変換部４１Ｂを備える点が第１実施形態（図２参照）と異なる。
尚、電流トルク変換部４１Ａ，４１Ｂによる電流ｉからトルクτへの変換は次式（４）で演算される。ここでＸは電流ｉからトルクτへの変換を表している。
τ＝Ｘｉ・・・（４）
外力変換部４３によるトルクτからロボット２の外力ｆへの変換は、ロボットの所定の点（例えばロボット２の先端）を外力の作用点としたヤコビ行列を用いて演算される（式（１）参照）。
図８は、本発明の第５実施形態に係る監視装置の構成を示すブロックダイアグラムである。図８に示すように、制御装置３が各サーボモータを流れる電流値を推定する電流推定部６３を備え、監視装置４Ｄが電流センサ５で検出された各サーボモータを流れる電流値をロボット２の外力の検出値に変換する電流外力変換部４５Ａと、電流推定部６３で推定された各サーボモータを流れる推定電流値をロボット２の外力の推定値に変換する電流外力変換部４５Ｂと、を備え、外力変換部４３がロボットの外力の検出値とロボットの外力の推定値との差分を演算することによりロボットの外力に変換する点が第１実施形態（図２参照）と異なる。
尚、電流外力変換部４５Ａ及び４５Ｂによる電流ｉからロボット２の外力ｆへの変換は、ロボットの所定の点（例えばロボット２の先端）を外力の作用点としたヤコビ行列Ｊを用いて演算される（式（３）参照）。
尚、図６〜図８の電流推定部６３で推定される各サーボモータを流れる電流の推定値は、制御装置３の電流指令値生成部６１において、予め定められた位置指令値と位置センサからの関節軸角度位置に基づいて演算された電流指令値でもよいし、その他の公知の方法により、演算されてもよい。また、電流推定部６３は、監視装置４Ｂ〜４Ｄに含まれてもよい。
尚、上記実施形態の監視装置４は制御装置３と別々に設けたが、制御装置３に含まれていてもよい。例えば制御装置３の演算処理器６において、監視装置４の各部（４１〜４４）の機能ブロックが実行されるように構成されていてもよい。
以上の第２乃至第５実施形態の監視装置４Ａ〜４Ｄの構成は第１実施形態の監視装置４の構成と実質的に等価であるので、第１実施形態な効果を奏することができる。
［その他の実施形態］
尚、上記実施形態では、監視装置４は、外力の値を直接衝突判定に用いる第１衝突判定部５２と、ローパスフィルタ５３を通過させた外力の値を衝突判定に用いる第２衝突判定部５４の双方を備えたが、これに限られるものではなく、第１衝突判定部５２、又は、第２衝突判定部５４のいずれかのみを備えてもよい。
また、外力の値の変化量を所定の閾値と比較して衝突判定を行ってもよい。これにより、ロボットに働く外力の急激な変動を検知することができる。
尚、上記実施形態では、ロボット２は、６軸多関節ロボットであったが、１軸以上であれば、これに限られない。また、２つのアームを備えた双腕ロボットでもよい。
上記説明から、当業者にとっては、本発明の多くの改良や他の実施形態が明らかである。従って、上記説明は、例示としてのみ解釈されるべきであり、本発明を実行する最良の態様を当業者に教示する目的で提供されたものである。本発明の精神を逸脱することなく、その構造及び機能の双方又は一方の詳細を実質的に変更できる。
本発明は、多関節ロボットの監視に適用可能である。
１ ロボットシステム
２ ロボット
３ 制御装置
４，４Ａ〜４Ｄ 監視装置
５ 電流センサ
６ 演算処理器
７ サーボアンプ
４１，４１Ａ，４１Ｂ 電流トルク変換部
４２ 差分トルク演算部
４３ 外力変換部
４４ 停止信号生成部
４５，４５Ａ，４５Ｂ 電流外力変換部
４６ トルク外力変換部
４７ 差分電流演算部
５１ 加減算器（トルク）
５２ 第１衝突判定部
５３ ローパスフィルタ
５４ 第２衝突判定部
５５ 加減算器（外力）
５６ 加減算器（電流）
６１ 電流値生成部
６２ 駆動トルク推定部
６３ 電流推定部
Ｊ１〜Ｊ６ 関節軸
Ｍ１〜Ｍ６ サーボモータ
Ｌ１〜Ｌ６ 電源ライン

Claims (8)

  1. １以上の関節軸と、その関節軸を駆動させるサーボモータを備えたロボットと、前記各関節軸を駆動するサーボモータを制御する制御装置と、を備えたロボットシステムの監視装置であって、
    各サーボモータに流れる電流値を検出する電流センサと、
    前記電流センサで検出された各サーボモータを流れる電流値をトルク値に変換する電流トルク変換部と、
    各サーボモータの駆動に必要な駆動トルクの少なくとも一部を推定する駆動トルク推定部と、
    前記電流トルク変換部で変換されたトルク値と前記駆動トルクの推定値との差分トルクを演算する差分トルク演算部と、
    前記差分トルク演算部で演算された前記差分トルクを前記ロボットの外力に変換する外力変換部と、
    前記外力変換部で変換された前記外力の値に基づいて前記ロボットの停止信号を生成し、これを前記制御装置に供給する停止信号生成部と、
    を備え、
    前記停止信号生成部は、前記外力変換部で変換された前記外力の値が予め設定された第１閾値を超えたときに前記ロボットの停止信号を生成する、ロボットシステムの監視装置。
  2. １以上の関節軸と、その関節軸を駆動させるサーボモータを備えたロボットと、前記各関節軸を駆動するサーボモータを制御する制御装置と、を備えたロボットシステムの監視装置であって、
    各サーボモータに流れる電流値を検出する電流センサと、
    前記電流センサで検出された各サーボモータを流れる電流値を前記ロボットの外力の検出値に変換する電流外力変換部と、
    各サーボモータの駆動に必要な駆動トルクの少なくとも一部を推定する駆動トルク推定部と、
    前記駆動トルクの推定値を前記ロボットの外力の推定値に変換するトルク外力変換部と、
    前記ロボットの外力の検出値と前記ロボットの外力の推定値との差分を演算することにより前記ロボットの外力に変換する外力変換部と、
    前記外力変換部で変換された前記外力の値に基づいて前記ロボットの停止信号を生成し、これを前記制御装置に供給する停止信号生成部と、
    を備え、
    前記停止信号生成部は、前記外力変換部で変換された前記外力の値が予め設定された第１閾値を超えたときに前記ロボットの停止信号を生成する、ロボットシステムの監視装置。
  3. １以上の関節軸と、その関節軸を駆動させるサーボモータを備えたロボットと、前記各関節軸を駆動するサーボモータを制御する制御装置と、を備えたロボットシステムの監視装置であって、
    各サーボモータに流れる電流値を検出する電流センサと、
    各サーボモータを流れる電流値を推定する電流推定部と、
    各サーボモータを流れる検出電流値と推定電流値との差分電流を演算する差分電流演算部と、
    前記差分電流演算部で算出された差分電流を前記ロボットの外力に変換する外力変換部と、
    前記外力変換部で変換された前記外力の値に基づいて前記ロボットの停止信号を生成し、これを前記制御装置に供給する停止信号生成部と、
    を備え、
    前記停止信号生成部は、前記外力変換部で変換された前記外力の値が予め設定された第１閾値を超えたときに前記ロボットの停止信号を生成する、ロボットシステムの監視装置。
  4. １以上の関節軸と、その関節軸を駆動させるサーボモータを備えたロボットと、前記各関節軸を駆動するサーボモータを制御する制御装置と、を備えたロボットシステムの監視装置であって、
    各サーボモータに流れる電流値を検出する電流センサと、
    前記電流センサで検出された各サーボモータを流れる電流値をトルクの検出値に変換する第１電流トルク変換部と、
    各サーボモータを流れる電流値を推定する電流推定部と、
    前記電流推定部で推定された各サーボモータを流れる推定電流値をトルクの推定値に変換する第２電流トルク変換部と、
    前記トルクの検出値と前記トルクの推定値との差分トルクを演算する差分トルク演算部と、
    前記差分トルク演算部で算出された差分トルクを前記ロボットの外力に変換する外力変換部と、
    前記外力変換部で変換された前記外力の値に基づいて前記ロボットの停止信号を生成し、これを前記制御装置に供給する停止信号生成部と、
    を備えるロボットシステムの監視装置。
  5. １以上の関節軸と、その関節軸を駆動させるサーボモータを備えたロボットと、前記各関節軸を駆動するサーボモータを制御する制御装置と、を備えたロボットシステムの監視装置であって、
    各サーボモータに流れる電流値を検出する電流センサと、
    各サーボモータを流れる電流値を推定する電流推定部と、
    前記電流センサで検出された各サーボモータを流れる電流値を前記ロボットの外力の検出値に変換する第１電流外力変換部と、
    前記電流推定部で推定された各サーボモータを流れる推定電流値を前記ロボットの外力の推定値に変換する第２電流外力変換部と、
    前記ロボットの外力の検出値と前記ロボットの外力の推定値との差分を演算することにより前記ロボットの外力に変換する外力変換部と、
    前記外力変換部で変換された前記外力の値に基づいて前記ロボットの停止信号を生成し、これを前記制御装置に供給する停止信号生成部と、
    を備えるロボットシステムの監視装置。
  6. 前記停止信号生成部は、前記外力変換部で変換された前記外力の値が予め設定された第１閾値を超えたときに前記ロボットの停止信号を生成する、請求項４又は５に記載のロボットシステムの監視装置。
  7. 前記外力変換部で変換された前記外力の値を入力値とするローパスフィルタを更に備え、
    前記停止信号生成部は、前記ローパスフィルタの出力値が予め設定された第２閾値を超えたときに前記ロボットの停止信号を生成する、請求項１乃至６のいずれか一項に記載のロボットシステムの監視装置。
  8. トルクから前記ロボットの外力への変換、又は、電流から前記ロボットの外力への変換は、前記ロボットの所定の点を外力の作用点としたヤコビ行列を用いて演算される、請求項１乃至７のいずれか一項に記載のロボットシステムの監視装置。
JP2017547617A 2015-10-30 2016-10-25 ロボットシステムの監視装置 Active JP6924146B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2015213711 2015-10-30
JP2015213711 2015-10-30
PCT/JP2016/004694 WO2017073052A1 (ja) 2015-10-30 2016-10-25 ロボットシステムの監視装置

Publications (2)

Publication Number Publication Date
JPWO2017073052A1 JPWO2017073052A1 (ja) 2018-08-16
JP6924146B2 true JP6924146B2 (ja) 2021-08-25

Family

ID=58630095

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017547617A Active JP6924146B2 (ja) 2015-10-30 2016-10-25 ロボットシステムの監視装置

Country Status (7)

Country Link
US (1) US10730191B2 (ja)
EP (1) EP3369536A4 (ja)
JP (1) JP6924146B2 (ja)
KR (1) KR20180067652A (ja)
CN (1) CN108136604A (ja)
TW (1) TWI621004B (ja)
WO (1) WO2017073052A1 (ja)

Families Citing this family (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018219952A1 (en) * 2017-05-29 2018-12-06 Franka Emika Gmbh Collision handling by a robot
KR102370879B1 (ko) * 2017-09-12 2022-03-07 주식회사 한화 협동로봇제어장치 및 협동로봇을 제어하는 방법
US10145747B1 (en) 2017-10-10 2018-12-04 Auris Health, Inc. Detection of undesirable forces on a surgical robotic arm
WO2019111582A1 (ja) * 2017-12-06 2019-06-13 日本電産株式会社 デバイスｉｄ設定装置及び設定方法
JP7180165B2 (ja) * 2018-07-23 2022-11-30 セイコーエプソン株式会社 ロボット、制御装置および制御方法
US11691293B2 (en) * 2018-08-31 2023-07-04 Fanuc Corporation Robot
JP7181055B2 (ja) * 2018-11-02 2022-11-30 ファナック株式会社 ロボット装置
CN109202873A (zh) * 2018-11-22 2019-01-15 北京秘塔网络科技有限公司 一种柔性协作机械臂及其控制方法
KR102149008B1 (ko) * 2018-12-13 2020-08-31 (주)미래컴퍼니 수술용 로봇의 충돌을 완화시키는 방법 및 시스템
JP7290472B2 (ja) * 2019-05-29 2023-06-13 ファナック株式会社 ロボットシステム
CN110355786A (zh) * 2019-06-21 2019-10-22 珠海格力电器股份有限公司 一种机器人撞击检测方法及机器人
EP4000820A4 (en) * 2019-07-18 2023-03-22 Kabushiki Kaisha Yaskawa Denki ROBOT SYSTEM, ROBOT CONTROL METHOD AND SERVO SYSTEM
TWI764377B (zh) * 2020-11-16 2022-05-11 達明機器人股份有限公司 機器人安全補償重量的系統及方法
US20230405851A1 (en) * 2020-12-07 2023-12-21 Sony Interactive Entertainment Inc. Information processing device, information processing method, and program
CN113319853B (zh) * 2021-06-18 2022-11-22 广东智源机器人科技有限公司 机器人控制方法、装置、电子设备以及机器人系统
CN114964593A (zh) * 2022-06-21 2022-08-30 郑州安杰莱智能科技有限公司 电流力矩的转换方法、装置及康复机器人
CN116494251A (zh) * 2023-06-26 2023-07-28 佛山隆深机器人有限公司 机器人紧急制动方法、装置、设备及存储介质

Family Cites Families (36)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01230107A (ja) * 1988-03-10 1989-09-13 Fanuc Ltd サーボモータにより駆動される被駆動体の衝突検出方法
JP3070498B2 (ja) 1996-12-03 2000-07-31 松下電器産業株式会社 ロボットの制御装置
JPH1142577A (ja) 1997-07-28 1999-02-16 Matsushita Electric Ind Co Ltd ロボットの制御方法および装置
JP3436087B2 (ja) 1997-07-28 2003-08-11 松下電器産業株式会社 ロボットの制御方法および装置
JPH1142578A (ja) 1997-07-28 1999-02-16 Matsushita Electric Ind Co Ltd ロボットの制御方法および装置
JPH1142576A (ja) 1997-07-28 1999-02-16 Matsushita Electric Ind Co Ltd ロボットの制御方法および装置
US6243624B1 (en) * 1999-03-19 2001-06-05 Northwestern University Non-Linear muscle-like compliant controller
JP3459973B2 (ja) * 1999-10-22 2003-10-27 川崎重工業株式会社 駆動制御方法および駆動制御装置
JP4756618B2 (ja) * 2001-03-21 2011-08-24 株式会社ダイヘン 多関節ロボットにおける衝突検出・停止制御法
JP3808321B2 (ja) * 2001-04-16 2006-08-09 ファナック株式会社 ロボット制御装置
JP3878054B2 (ja) * 2001-05-08 2007-02-07 三菱電機株式会社 ロボット制御装置
US7386364B2 (en) * 2002-03-15 2008-06-10 Sony Corporation Operation control device for leg-type mobile robot and operation control method, and robot device
WO2004033160A1 (ja) * 2002-10-10 2004-04-22 Sony Corporation ロボット装置の動作制御装置及び動作制御方法
US7212886B2 (en) * 2002-12-12 2007-05-01 Kabushiki Kaisha Yaskawa Denki Robot control apparatus and method
SE0301531L (sv) * 2003-05-22 2004-11-23 Abb Ab A Control method for a robot
JP4305340B2 (ja) 2004-09-08 2009-07-29 パナソニック株式会社 ロボットに取り付けられた負荷の質量と重心位置の算出方法
JP4440072B2 (ja) 2004-10-26 2010-03-24 パナソニック株式会社 ロボットの制御方法
US7298108B2 (en) * 2004-11-29 2007-11-20 Smc Kabushiki Kaisha Control system for electric actuator
DE102005015317B4 (de) * 2005-04-01 2007-02-01 Siemens Ag Verfahren und Steuereinrichtung zur gezielten Reaktion bei einem Kontakt zwischen einem Maschinenelement einer Maschine mit einem Gegenstand
JP4595727B2 (ja) * 2005-07-22 2010-12-08 ソニー株式会社 外力推定システム及び外力推定方法、並びにコンピュータ・プログラム
EP2013671B1 (en) * 2006-03-17 2018-04-25 iRobot Corporation Lawn care robot
US8924021B2 (en) * 2006-04-27 2014-12-30 Honda Motor Co., Ltd. Control of robots from human motion descriptors
JP2008290228A (ja) * 2007-04-24 2008-12-04 Fanuc Ltd 嵌合装置
DE102007063099A1 (de) * 2007-12-28 2009-07-02 Kuka Roboter Gmbh Roboter und Verfahren zum Überwachen der Momente an einem solchen
JP4445038B2 (ja) * 2008-02-06 2010-04-07 パナソニック株式会社 ロボット、ロボットの制御装置及び制御方法、並びに、ロボットの制御装置の制御プログラム
KR101262277B1 (ko) 2008-04-30 2013-05-08 현대중공업 주식회사 로봇의 충돌검지 방법
CN102036789B (zh) * 2008-05-21 2014-09-17 松下电器产业株式会社 机器人的异常判定方法
JP2010069585A (ja) * 2008-09-19 2010-04-02 Yaskawa Electric Corp 衝突検出装置及び方法並びにロボット制御装置
JP5242342B2 (ja) 2008-10-31 2013-07-24 株式会社東芝 ロボット制御装置
JP5177008B2 (ja) * 2009-02-20 2013-04-03 株式会社安川電機 ロボットの制御装置およびロボット
WO2010108518A1 (en) 2009-03-27 2010-09-30 Abb Ag Intrinsically safe small robot and method for controlling this robot
JP5219956B2 (ja) * 2009-07-23 2013-06-26 本田技研工業株式会社 移動体の制御装置
US8369992B2 (en) * 2009-09-22 2013-02-05 GM Global Technology Operations LLC Embedded diagnostic, prognostic, and health management system and method for a humanoid robot
JP5633623B2 (ja) * 2013-12-11 2014-12-03 株式会社デンソーウェーブ ロボットシステム
JP5941083B2 (ja) 2014-03-12 2016-06-29 ファナック株式会社 外部環境との接触を検知するロボット制御装置
CN104985598B (zh) * 2015-06-24 2016-11-23 南京埃斯顿机器人工程有限公司 一种工业机器人碰撞检测方法

Also Published As

Publication number Publication date
JPWO2017073052A1 (ja) 2018-08-16
KR20180067652A (ko) 2018-06-20
WO2017073052A1 (ja) 2017-05-04
TW201723711A (zh) 2017-07-01
US10730191B2 (en) 2020-08-04
TWI621004B (zh) 2018-04-11
CN108136604A (zh) 2018-06-08
US20180311836A1 (en) 2018-11-01
EP3369536A1 (en) 2018-09-05
EP3369536A4 (en) 2019-07-10

Similar Documents

Publication Publication Date Title
JP6924146B2 (ja) ロボットシステムの監視装置
US10442080B2 (en) Monitoring device of robot system
US9821459B2 (en) Multi-joint robot having function for repositioning arm
US11548153B2 (en) Robot comprising safety system ensuring stopping time and distance
KR20190029286A (ko) 협동로봇제어장치 및 협동로봇을 제어하는 방법
CN111902248B (zh) 机器人的控制装置
JP2009184095A (ja) 部品保護機能を備えたロボット制御装置及びロボット制御方法
JP7275488B2 (ja) ロボットシステム
JP2011206886A (ja) ロボットの制御装置及び方法
JP5371882B2 (ja) 力制御装置
JP3286842B2 (ja) ロボットの柔軟制御装置
JP2019042906A (ja) ロボットの外部接触２重チェック装置
JP5904445B2 (ja) ロボット用制御装置
JP2017077600A (ja) マニピュレータ装置
TWI753287B (zh) 機器人之控制裝置
JPH1142577A (ja) ロボットの制御方法および装置
JP2024041086A (ja) ロボット制御装置及びロボット制御方法
JP2013006230A (ja) 回転動力源制御方法および回転動力源制御装置、並びにロボット

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20180402

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20180412

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190925

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20201104

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20201201

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210302

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210323

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20210706

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210730

R150 Certificate of patent or registration of utility model

Ref document number: 6924146

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150