JP4267027B2 - ロボット制御装置 - Google Patents

ロボット制御装置 Download PDF

Info

Publication number
JP4267027B2
JP4267027B2 JP2006330900A JP2006330900A JP4267027B2 JP 4267027 B2 JP4267027 B2 JP 4267027B2 JP 2006330900 A JP2006330900 A JP 2006330900A JP 2006330900 A JP2006330900 A JP 2006330900A JP 4267027 B2 JP4267027 B2 JP 4267027B2
Authority
JP
Japan
Prior art keywords
force
robot
robot arm
target
measuring means
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
JP2006330900A
Other languages
English (en)
Other versions
JP2008142810A (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.)
FANUC Corp
Original Assignee
FANUC 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 FANUC Corp filed Critical FANUC Corp
Priority to JP2006330900A priority Critical patent/JP4267027B2/ja
Priority to EP07023557A priority patent/EP1930131A3/en
Priority to US11/951,457 priority patent/US20080140257A1/en
Priority to CN200710186555XA priority patent/CN101195221B/zh
Publication of JP2008142810A publication Critical patent/JP2008142810A/ja
Application granted granted Critical
Publication of JP4267027B2 publication Critical patent/JP4267027B2/ja
Priority to US13/169,731 priority patent/US20110257787A1/en
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/1628—Programme controls characterised by the control loop
    • B25J9/1638—Programme controls characterised by the control loop compensation for arm bending/inertia, pay load weight/inertia
    • 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
    • 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/39178—Compensation inertia arms
    • 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/39194—Compensation gravity
    • 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/39319—Force control, force as reference, active compliance
    • 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/39341—Sliding mode based impedance control
    • 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/39343—Force based impedance control

Description

本発明は、ロボット制御装置に関する。特に、本発明は、ロボットによってバリ取り、研削、研磨等の加工作業を制御するロボット制御装置に関する。
ロボットによりバリ取り、研磨、研削等の加工作業を行うために、ロボットアーム先端部分に取付けた作業ツールを適切な力でワークに押付けながら作業ツールを移動させることが行われている。同様な目的のために、ロボットアーム先端部分に取付けたハンドにより把持されたワークを適切な力で固定された加工機械に押付けながらハンドを移動させる場合もある。
このとき、ワークと作業ツールとの間に働く力が適切な値になるように、コンプライアンス機構を有する作業ツールまたはそのような加工機械を使用することがある。また、力覚センサまたは機械駆動部のアクチュエータの電流値を用いることによりワークと作業ツールとの間に働く力を推定し、この力をフィードバックして作業ツールの位置または力を制御する場合もある。
力測定手段、例えば力覚センサにより検出される力には、作業ツールとワークとの間に作用する正味の力以外の力、例えばロボットのエンドエフェクタの重力およびジャイロモーメントによる外力も含まれている。特許文献１においては、力測定手段により検出された力から重力およびジャイロモーメントによる外力を減算することにより、力を補正することが開示されている。
さらに、倣い加工作業においてロボットアーム先端部分の移動方向を比較的大きく変更するときには、ロボットによる押付力の制御が不完全になり、ワークの加工が不十分または過剰になる場合がある。この問題を解決するために、特許文献２においては、予め定義したプログラムに従ってコーナ部における予め指定した所定範囲内においてエンドエフェクタの進行方向速度を減少させると共に目標押付力を減少させるようにしている。また、特許文献３および特許文献４には、加工経路上の曲率を算出して、算出された曲率に応じてロボットとワークとの間の相対速度や目標押付力を決定することが開示されている。
特許第３４１２２３６号 特許第３４０２８２９号 特許第２７３９７６４号 特開平５−１４３１４６号
しかしながら、実際には、力測定手段により検出された力には、ロボットアーム先端のエンドエフェクタがロボットアームと共に運動することにより発生する遠心力、コリオリ力といった慣性力などの動力学項も含まれている。
さらに、倣い加工作業において、ロボットアーム先端部分の移動方向を比較的大きく変化させる場合には、動力学項の値も比較的大きくなる。そのため、作業ツールとワークとの間に作用する正味の力をより正確に推定するためには、この動力学項を考慮する必要がある。
重力および動力学項の値はロボットの姿勢または作業ツールの質量などから推定するが、これらの値には誤差が必ず含まれるので完璧な推定をすることはできない。ロボットアーム先端部分の移動方向を比較的大きく変化させる場合には、動力学項が大きくなるので推定誤差も大きくなる傾向にある。また、制御系の遅れや追従性能の限界によって、力の補正だけではワークに対して所望の加工状態を実現できない事態も生じうる。
このような問題に対処するためには、前述した特許文献２等における、進行方向速度および目標押付力を減少させるという方法が有効になり得る。しかしながら、特許文献２においては、ワークの表面形状が既知であると共に進行方向速度および押付力を変化させる領域を予め指定する必要がある。
また、特許文献３および特許文献４においては、進行方向速度または目標押付力を変化させる判断基準として、曲率などの指標を別に算出する必要がある。さらに、特許文献３および特許文献４においては、作業ツールまたはハンド、もしくは把持するワークが異なる場合にはエンドエフェクタの質量、重心位置が変わるので、曲率が同じ値になる場合、例えば同一の軌道で動作させる場合であっても、ワークまたはエンドエフェクタの種類ごとに進行方向速度および押付力の調整値を変更する必要がある。
本発明はこのような事情に鑑みてなされたものであり、ロボットアーム先端部分の移動方向を比較的大きく変化させる場合であっても、ワークをより正確に加工することのできるロボット制御装置を提供することを目的とする。
前述した目的を達成するために１番目の発明によれば、ロボットアームの先端に取付けられた作業ツールとワークとの間に作用する力を制御するロボット制御装置において、前記制御をおこなう際に必要な力データを取得する力測定手段と、前記作業ツールから前記力測定手段に及ぼされる力のうち、重力が前記力測定手段に作用する力と前記ロボットアームの運動により発生する動力学項とを算出する算出手段と、前記算出手段により算出された、前記重力が前記力測定手段に作用する力と前記動力学項とを用いて、前記力測定手段により測定された力を補正する補正手段と、前記動力学項が所定の閾値より大きい場合には、前記動力学項および前記重力により前記力測定手段に及ぼされる力に応じて、前記ロボットアームの動作指令を調整する指令調整手段と、を具備するロボット制御装置が提供される。
さらに、２番目の発明によれば、ロボットアームの先端に取付けられたハンドにより把持されたワークと固定された作業ツールとの間に作用する力を制御するロボット制御装置において、前記制御をおこなう際に必要な力データを取得する力測定手段と、前記ワークを把持した前記ハンドから前記力測定手段に及ぼされる力のうち、重力が前記力測定手段に作用する力と前記ロボットアームの運動により発生する動力学項とを算出する算出手段と、前記算出手段により算出された、前記重力が前記力測定手段に作用する力と前記動力学項とを用いて、前記力測定手段により測定された力を補正する補正手段と、前記動力学項が所定の閾値より大きい場合には、前記動力学項および前記重力により前記力測定手段に及ぼされる力に応じて、前記ロボットアームの動作指令を調整する指令調整手段と、を具備するロボット制御装置が提供される。
すなわち１番目および２番目の発明においては、先端部分の移動方向が比較的大きく変化するような倣い加工動作を行う場合であっても、ロボットアーム先端部分のエンドエフェクタ、例えば作業ツールまたはハンドの重量と、ロボットアームの運動による動力学項、例えば遠心力、コリオリ力などの慣性力等の補正を行うことができる。従って、作業ツールとワークとの間に作用する正味の力の推定誤差を可能な限り小さくできる。このため、本発明においては、作業ツールとワークとの間に作用する押付力をより正確に制御することができる。
さらに、１番目および２番目の発明においては、ロボットアームの動作に関連する指令を調整する際に、加工経路上の調整箇所を予め教示する必要はなく、また加工経路上の曲率を別途算出する必要もない。さらに、１番目および２番目の発明においては、重力および動力学項から、加工が不十分または過剰になりそうであるかを判断し、それに応じて動作指令を調節することができる。また、閾値は、設定した目標押付力に基づいて定めるのが好ましく、それにより、作業ツール、ハンドまたはワークが取替えられた場合であっても同一の調整値を使用することができる。
３番目の発明によれば、１番目または２番目の発明において、前記指令調整手段により調整される前記ロボットアームの前記動作指令は、前記作業ツールと前記ワークとの間に作用すべき力の指令を含む。
すなわち３番目の発明においては、動力学項から得られた慣性力と作用方向に応じて力の目標値を変更することによって、ワークを所望の状態に加工することができる。
４番目の発明によれば、１番目から３番目のいずれかの発明において、前記指令調整手段により調整される前記ロボットアームの前記動作指令は、前記ロボットアームの進行方向速度を含む。
すなわち４番目の発明においては、動力学項から得られた慣性力と作用方向に応じて進行方向速度の目標値を変更することによって、ワークを所望の状態に加工することができる。
５番目の発明によれば、１番目から４番目のいずれかの発明において、前記指令調整手段により調整される前記ロボットアームの前記動作指令は、ロボットアームの目標軌道を含む。
すなわち５番目の発明においては、動力学項から得られた慣性力と作用方向に応じて目標軌道を変更することによって、ワークを所望の状態に加工することができる。
６番目の発明によれば、１番目から５番目のいずれかの発明において、前記指令調整手段により調整される前記ロボットアームの前記動作指令は、力制御のゲインを含む。
すなわち６番目の発明においては、動力学項から得られた慣性力と作用方向に応じて力制御のゲインを変更することによって、ワークを所望の状態に加工することができる。
７番目の発明によれば、１番目から６番目のいずれかの発明において、前記算出手段は、前記ロボットアームの姿勢、動作速度や動作加速度と、前記ロボットアーム先端部に取付けられたエンドエフェクタ部の質量と重心から、動力学項と重力とを算出する。
８番目の発明によれば、１番目から７番目のいずれかの発明において、前記力測定手段は力覚センサである。
９番目の発明によれば、１番目から７番目のいずれかの発明において、前記力測定手段は前記ロボットアームを駆動するアクチュエータの電流値に基づいて力を推定する。
すなわち８番目および９番目の発明においては、比較的簡易な手法により、力を測定することができる。また、９番目の発明においては、力覚センサを別途準備する必要がない。
１０番目の発明によれば、１番目から９番目のいずれかの発明において、前記ロボット制御装置により行われる力制御はインピーダンス制御である。
１１番目の発明によれば、１番目から９番目のいずれかの発明において、前記ロボット制御装置により行われる力制御はダンピング制御である。
以下、添付図面を参照して本発明の実施形態を説明する。以下の図面において同様の部材には同様の参照符号が付けられている。理解を容易にするために、これら図面は縮尺を適宜変更している。
図１は本発明に基づくロボット制御装置により制御されるロボットの斜視図である。図１に示されるロボット５０は、６自由度の多関節型ロボットである。このロボット５０はロボット制御装置１０により制御される。ロボット５０のロボットアーム５０ａの先端には作業ツール５２が取付けられている。図１に示される実施形態においては、作業ツール５２は例えばグラインダである。図１に示される作業ツール５２、例えばグラインダは作業台６１上に予め固定されたワーク６０を研磨するのに使用される。
さらに、力覚センサ５１がロボットアーム５０ａの先端と作業ツール５２との間に配置されている。力覚センサ５１は、作業ツール５２がワーク６０に押付けられるときの力を測定する。ここで、本願明細書において使用される用語「力」は、力とモーメントとの両方を含むものとする。図示されるように力覚センサ５１はロボット制御装置１０に接続されており、測定された力データはロボット制御装置１０に供給される。なお、以下においては、力覚センサ５１を適宜、「力測定手段５１」と呼ぶ場合がある。
また、力覚センサ５１を用いることなしに、ロボットアーム５０ａを駆動するアクチュエータ（図示しない）の電流値に基づいて力を推定するようにしてもよい。そのような場合には、電流値に基づいて力を推定する手段が力測定手段５１に相当するものとする。
図２は本発明に基づくロボット制御装置の機能ブロック図である。マイクロコンピュータであるロボット制御装置１０は、第一パラメータ格納部２０と第二パラメータ格納部２５とを含んでいる。図示されるように、第一パラメータ格納部２０には、予め設定された設定値である、目標押付力・目標モーメントＦｓ、目標進行方向速度Ｖｓ、目標軌道Ｔｓおよび制御ゲイン、例えば力制御ゲインＧｓが格納されている。また、第二パラメータ格納部２５には、作業ツール５２の質量・重心位置２６が格納されている。さらに、算出方法を記載しない後述する定数もこれらパラメータ格納部に予め格納されているものとする。
ここで、目標軌道Ｔｓは、ＣＡＤデータによって得られる軌道、加工作業前に作業ツール５２をワーク６０の表面上に実際に倣わせることにより得られる軌道、教示作業によって得られる軌道などを含むものとする。
さらに、ロボット制御装置１０は、種々のロボット操作指令を作成・演算してロボット５０に供給する指令演算部１１と、第一パラメータ格納部２０に格納されたパラメータの値に基づいて、重力および動力学項が力測定手段５１に及ぼす力に応じて、目標押付力、目標進行方向速度、目標軌道、制御ゲインなどを調整して、それらの値を指令演算部１１に送る指令調整手段１２と、ロボット５０に取付けられた位置、速度、加速度検出部５３から送られるデータと、第二パラメータ格納部に予め格納されたツールの質量、重心位置２６とに基づいて動力学項および重力を算出する動力学項・重力算出部１３（以下、「算出部１３」と称す。）と、ロボット５０の力測定手段５１、例えば力覚センサにより測定された力の出力値を、力覚センサ座標系から見た値に変換すると共に、重力および動力学項が及ぼす影響を補正し、作業ツール５２とワーク６０の間に作用する正味の力を算出する力補正手段１４とを備えている。
図３はロボット制御装置により制御されるロボットアーム先端部分の移動を説明するための図である。図３においては、ワーク６０の表面６２に沿って、ロボット５０の作業ツール５２が倣い加工作業する様子が示されている。図３に示されるようにワーク６０の表面６２は大きな凹凸を含んでいる。このため、作業ツール５２の移動方向は、表面６２の領域６３および領域６４において、比較的大きく変化するようになる。ここで、領域６３においては慣性力の押付方向成分（遠心力）の作用する方向と押付方向とが逆向きであり、領域６４においては慣性力の押付方向成分（遠心力）の作用する方向と押付方向とが同一の向きである。なお、図３においては、作業ツール５２の進行方向はワーク６０の表面６２に沿った方向であり、作業ツール５２がワーク６０を押付ける押付方向は作業ツール５２が対応するワーク６０の表面６２に対して垂直でかつワーク６０内部に向かう方向であるものとする。
以下、図２および図３を参照しつつ、本発明のロボット制御装置１０による制御について説明する。本発明においては、重力が力測定手段５１に作用する力と、ロボットアーム５０ａを駆動することによってエンドエフェクタ、例えば作業ツール５２が力測定手段５１に作用する力である動力学項とを算出する。
これらの力は、以下に表すマニピュレータの動力学方程式を解く際に用いられる公知の方法を利用することによって、算出することができる。
Figure 0004267027
 ここで、τは関節トルクベクトルであり、θは関節角度ベクトルであり、Ｍ（θ）は質量行列であり、Ｃ（θ、ｄθ／ｄｔ）は遠心力やコリオリ力などを表すベクトルであり、Ｇ（θ）は重力ベクトルである。
前記動力学方程式を解く際に一般的に使用されている方法、例えばニュートン・オイラー法やラグランジュ法などを用いて、ロボットアームの各リンクの重心に作用する重力および慣性力（慣性モーメントも含む）を算出できる。この方法を用いて、ロボットアームの関節角度ベクトルθ、該関節角度ベクトルθの速度および加速度から、力覚センサの座標系から見た、作業ツール５２の重心に作用する慣性力が力覚センサの座標系中心に作用する力を求めることによって、動力学項を算出することができる。また、力覚センサの座標系から見た、作業ツール５２の重量が力覚センサの座標系中心に作用する力も同時に算出することができる。（ここで、ロボットアームの角速度を関節角度ベクトルから算出してもよく、角加速度を関節角度ベクトルや角速度から算出してもよい。）
ロボット制御装置１０の算出部１３は、重力が力覚センサ５１の座標系中心に作用する力と、ロボットアームを動かすことによってエンドエフェクタが力覚センサ５１の座標系中心に作用する力である動力学項とを上記のように算出する。
一方、ロボットアーム５０ａが図３を参照して説明したように移動するときに、力覚センサ５１は力を測定する。次いで、ロボット制御装置１０の力補正手段１４は、測定された力から動力学項および重力の及ぼす影響を補正する。具体的には、重力が力覚センサ５１の座標系中心に作用する力と前述した動力学項とを測定された力から減算する。これにより、ロボットアーム５０ａがその先端部分の移動方向が比較的大きく変化する動作を行うときに、作業ツール５２とワーク６０との間に作用する正味の力の推定誤差を小さくすることが可能となる。このため、本発明においては、作業ツール５２とワーク６０との間に作用する押付力をより正確に制御することが可能となる。
なお、作業ツール用の位置・速度・加速度検出部（図示しない）を作業ツール５２に取付け、これによって検出される作業ツール５２の加速度を用いて、動力学項および重力を算出するようにしてもよい。
その後、ロボット制御装置１０の指令調整手段１２は、重力および動力学項の合力、または動力学項のみを所定の閾値と比較することによって、ロボットアームの動作指令に関連するパラメータの値を調整する。この閾値は、以下の式（２）のように目標押付力Ｆｓから算出される。
ｈｔ＝ｋ０・Ｆｓ （２）
ここで、ｈｔは重力および動力学項の合力、または動力学項のみと比較するための閾値であり、ｋ０は定数であり、Ｆｓは予め設定した目標押付力である。このように閾値ｈｔを、予め設定した目標押付力Ｆｓに基づいて定める場合には、作業ツール５２、後述するハンド５４またはワーク６０が取替えられた場合であっても同一の調整値を使用することが可能となる。
以下では、動力学項として慣性力の押付方向成分を考え、指令調整手段１２は押付方向成分の値と上記閾値とを比較してロボットアームの動作指令に関連するパラメータの値の調整を行う。（ここで、動力学項における押付方向以外の力を用いた調整を行ってもよい。）
以下、動作指令に関連のあるパラメータの値の調整として、
（１）目標押付力および目標進行方向速度の両方を変更する場合、
（２）目標進行方向速度のみを変更する場合、
（３）目標押付力のみを変更する場合、
（４）目標軌道を調整する場合、
（５）力制御ゲインを調整する場合、について説明する。
（１）目標押付力および目標進行方向速度の両方を変更する場合
・慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより小さい場合には、目標進行方向速度Ｖｄはその設定値Ｖｓを使用する。
・慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きい場合には、目標進行方向速度Ｖｄを小さくすると共に、目標押付力Ｆｄも小さくする（１−１）、（１−２）。これにより、目標進行方向速度Ｖｄを小さくしてもワーク６０が過剰に加工されるのを防止できる。（ただし、ワーク６０と作業ツール５２とが離れやすくなるような部分において目標進行方向速度Ｖｄをそれほど低下させたくない場合には、目標押付力Ｆｄを大きくする。）
目標進行方向速度Ｖｄおよび目標押付力Ｆｄを小さくするために、以下の二つの手法を採用できる。
（１−１）慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きい場合には、閾値を超えてから経過した時間ｔに基づいて目標進行方向速度Ｖｄと目標押付力Ｆｄとを変更する。
図５は目標進行方向速度Ｖｄと閾値を超えてからの経過時間ｔとの関係を示す図である。図５においては、慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔを超えた時点における速度をＶｘとする。（ここで、Ｖｘは、｜ｈ｜が閾値ｈｔを超えた後に下回り、また超えると、新たな値に更新される。）
目標進行方向速度Ｖｄを以下の式（３）に基づいて滑らかに減速させつつ、式（４）に基づいて、目標押付力Ｆｄを小さく変更する。
Ｖｄ＝｛（１−ｋ１１）・ｅｘｐ（−ｌ１１・ｔ）＋ｋ１１｝・Ｖｘ （３）
ただし、０＜ｌ１１、０＜ｔ、０≦ｋ１１＜１、０＜ｈｔ＜｜ｈ｜
Ｆｄ＝ｍ１１・（Ｆｓ／Ｖｓ）・Ｖｄ＋ｎ１１ （４）
ただし、０＜ｍ１１
式（３）および式（４）においては、Ｖｄは目標進行方向速度であり、ｋ１１は定数であり、ｌ１１は定数であり、ｔは慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔを超えてから経過した時間を示している。さらに、Ｖｘは慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔを超えた時点での速度であり、Ｆｄは目標押付力であり、ｍ１１は定数であり、Ｆｓは予め設定した目標押付力であり、Ｖｓは予め設定した目標進行方向速度である。さらに、ｎ１１は定数であり、ｈは慣性力の押付方向成分であり、ｈｔは動力学項と比較するための閾値である。
（１−２）慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きい場合には、慣性力の押付方向成分の大きさ｜ｈ｜に基づいて目標進行方向速度Ｖｄと目標押付力Ｆｄとを変更する。
図６は係数α１、α２と慣性力の押付方向成分の大きさとの関係を示す図である。はじめに、以下の式（５）、（６）により表されるように、慣性力の押付方向成分の大きさ｜ｈ｜に応じて変化する係数α１、α２を求める。
α１＝（１−ｋ１２）・ｅｘｐ｛−ｌ１２・（｜ｈ｜−ｈｔ）｝＋ｋ１２ （５）
ただし、０＜ｌ１２、０≦ｋ１２＜１、０＜ｈｔ＜｜ｈ｜
α２＝（１−ｍ１２）・ｅｘｐ｛−ｎ１２・（｜ｈ｜−ｈｔ）｝＋ｍ１２ （６）
ただし、０＜ｎ１２、０≦ｍ１２＜１、０＜ｈｔ＜｜ｈ｜
次いで、これら係数α１、α２を用いて、目標進行方向速度Ｖｄおよび目標押付力Ｆｄを以下の式（７）、（８）に基づいて小さくする。
Ｖｄ＝α１・Ｖｓ （７）
Ｆｄ＝α２・Ｆｓ （８）
式（５）および式（６）においては、ｋ１２は定数であり、ｌ１２は定数であり、ｍ１２は定数であり、ｎ１２は定数である。なお、目標進行方向速度、目標押付力を変化させる場合には、ロボットアームの動きに過大な負荷がかからないように、滑らかに変化させるのが好ましい。
（２）目標進行方向速度のみを変化させる場合
以下のように、作業ツール５２とワーク６０との相対速度を調節することにより、加工が不十分または過剰になるのを防止する。
・慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより小さい場合には、目標進行方向速度Ｖｄはその設定値Ｖｓを使用する。
・慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きく、かつ、慣性力の押付方向成分の作用する方向と押付方向が逆向きである場合には、目標進行方向速度Ｖｄを小さくする（２−１）、（２−２）。
・慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きく、かつ、慣性力の押付方向成分の作用する方向と押付方向とが同じ向きである場合には、目標進行方向速度Ｖｄを大きくする（２−３）、（２−４）。なお、目標進行方向速度Ｖｄを大きくする理由は、目標進行方向速度Ｖｄの増加を、押付力が大きくなることによる単位時間当たりの切削量の増加と相殺するためである。
これらについて、以下に説明する。
（２−１）慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きく、かつ、慣性力の押付方向成分の作用する方向と押付方向が逆向きである場合には、閾値を超えてから経過した時間ｔに基づいて目標進行方向速度Ｖｄを小さくする。このときには、前述した式（３）を使用して、目標進行方向速度Ｖｄを小さくする。
（２−２）慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きく、かつ、慣性力の押付方向成分の作用する方向と押付方向が逆向きである場合には、慣性力の押付方向成分の大きさ｜ｈ｜に基づいて目標進行方向速度Ｖｄを小さくする。このときには、前述した式（５）から係数α１を算出した後で、前述した式（７）を用いて目標進行方向速度Ｖｄを小さくする。
次いで、慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きく、かつ、慣性力の押付方向成分の作用する方向と押付方向とが同じ向きである場合について説明する。
（２−３）、（２−４）に関して目標進行方向速度Ｖｄを大きくすることを記述したが、目標進行方向速度Ｖｄを大きくする場合には慣性力の押付方向成分の大きさ｜ｈ｜をさらに大きくする副作用が生じるので制御性能が悪化する場合がある。そのような場合には、（２−１）、（２−２）と同様に目標進行方向速度Ｖｄを小さくするのが好ましい。このことは、単位時間当たりの加工量が小さくて進行方向速度の影響を受けにくい、バフ掛けなどの研磨作業の場合に適用できる。
一方、単位時間当たりの切削量が大きい用途、例えばバリ取り作業などにおいては、目標進行方向速度Ｖｄを小さくして押付時間が長くなると加工が過剰になる不具合が発生する。
従って、バリ取り作業などでは、以下の（２−３）、（２−４）のように目標進行方向速度Ｖｄを大きくする。しかしながら、制御性能が著しく悪化する場合には、（１−１）、（１−２）のように目標進行方向速度Ｖｄと目標押付力Ｆｄとを変更するのが好ましい。
（２−３）慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きく、かつ、慣性力の押付方向成分の作用する方向と押付方向が同じ向きである場合には、閾値を超えてから経過した時間に基づいて目標進行方向速度Ｖｄを大きくする。
図７は目標進行方向速度Ｖｄと閾値を超えてからの経過時間ｔとの関係を示す他の図である。図７においては、慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔを超えた時点での速度をＶｘとする（ここで、Ｖｘは、｜ｈ｜が閾値ｈｔを超えた後に下回り、また超えると、新たな値に更新される）。
図７を参照しつつ、以下の式（９）に基づいて目標進行方向速度Ｖｄを算出する。
Ｖｄ＝｛（ｋ２３−１）・（１−ｅｘｐ（−ｌ２３・ｔ））＋１｝・Ｖｘ （９）
ただし、０＜ｌ２３、０＜ｔ、１≦ｋ２３、０＜ｈｔ＜｜ｈ｜
ここで、ｋ２３は定数であり、ｌ２３は定数である。
（２−４）慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きく、かつ、慣性力の押付方向成分の作用する方向と押付方向が同じ向きである場合には、慣性力の押付方向成分の大きさ｜ｈ｜に基づいて目標進行方向速度Ｖｄを大きくする。
図８は係数β１と慣性力の押付方向成分の大きさ｜ｈ｜との関係を示す図である。はじめに、以下の式（１０）に基づいて、慣性力の押付方向成分の大きさ｜ｈ｜に応じて変化するような係数β１を算出する。
β１＝（ｋ２４−１）・（１−ｅｘｐ｛−ｌ２４・（｜ｈ｜−ｈｔ）｝）＋１ （１０）
ただし、０＜ｌ２４、１≦ｋ２４、０＜ｈｔ＜｜ｈ｜
次いで、この係数β１に基づいて、以下の式（１１）から目標進行方向速度Ｖｄを算出する。
Ｖｄ＝β１・Ｖｓ （１１）
ここで、ｋ２４は定数であり、ｌ２４は定数である。なお、目標進行方向速度を変化させる場合には、ロボットアームの動きに過大な負荷がかからないように、滑らかに変化させるのが好ましい。
（３）目標押付力のみを変化させる場合
以下のように、目標押付力Ｆｄを調節することにより、加工が不十分または過剰になるのを防止する。
・慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより小さい場合には、目標押付力Ｆｄはその設定値Ｆｓを使用する。
・慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きく、かつ、慣性力の押付方向成分の作用する方向と押付方向が逆向きである場合には、目標押付力Ｆｄを大きくする。（３−１）、（３−２）
・慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きく、かつ、慣性力の押付方向成分の作用する方向と押付方向が同じ向きである場合には、目標押付力Ｆｄを小さくする。（３−３）、（３−４）
（３−１）慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きく、かつ、慣性力の押付方向成分の作用する方向と押付方向が逆向きである場合には、閾値を超えてから経過した時間ｔに基づいて目標押付力Ｆｄを大きくする。
図９は目標押付力Ｆｄと閾値を超えてからの経過時間ｔとの関係を示す図である。図９を参照しつつ、以下の式（１２）に基づいて目標押付力Ｆｄを算出する。
Ｆｄ＝｛（ｋ３１−１）・（１−ｅｘｐ（−ｌ３１・ｔ））＋１｝・Ｆｓ （１２）
ただし、０＜ｌ３１、０＜ｔ、１≦ｋ３１、０＜ｈｔ＜｜ｈ｜
ここで、ｋ３１は定数であり、ｌ３１は定数である。
（３−２）慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きく、かつ、慣性力の押付方向成分の作用する方向と押付方向が逆向きである場合には、慣性力の押付方向成分の大きさ｜ｈ｜に基づいて目標押付力Ｆｄを大きくする。このときには、前述した式（１０）から係数β１を算出した後で、以下の式（１３）を用いて目標押付力Ｆｄを大きくする。
Ｆｄ＝β１・Ｆｓ （１３）
（３−３）慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きく、かつ、慣性力の押付方向成分の作用する方向と押付方向が同じ向きである場合には、閾値を超えてから経過した時間に基づいて目標押付力Ｆｄを小さくする。
図１０は目標押付力Ｆｄと閾値を超えてからの経過時間ｔとの関係を示す他の図である。図１０を参照しつつ、以下の式（１４）に基づいて、目標押付力Ｆｄを算出する。
Ｆｄ＝｛（１−ｋ３３）・ｅｘｐ（−ｌ３３・ｔ）＋ｋ３３｝・Ｆｓ （１４）
ただし、０＜ｌ３３、０＜ｔ、０≦ｋ３３＜１、０＜ｈｔ＜｜ｈ｜
ここで、ｋ３３は定数であり、ｌ３３は定数である。
（３−４）慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きく、かつ、慣性力の押付方向成分の作用する方向と押付方向が同じ向きである場合には、慣性力の押付方向成分の大きさ｜ｈ｜に基づいて目標押付力Ｆｄを小さくする。このときには、前述した式（５）から係数α１を算出した後で、前述した式（１３）を用いて目標押付力Ｆｄを小さくする。なお、目標押付力を変化させる場合には、ロボットアームの動きに過大な負荷がかからないように、滑らかに変化させるのが好ましい。
なお、目標押付力Ｆｄおよび目標進行方向速度Ｖｄを小さくする場合にはワークが加工不足となることまたは過剰に加工されるのを防止でき、目標押付力Ｆｄを大きくおよび／または目標進行方向速度Ｖｄを小さくする場合にはワークが加工不足となるのを防止でき、目標押付力Ｆｄを小さくおよび／または目標進行方向速度Ｖｄを大きくする場合にはワークが過剰に加工されるのを防止できるのは、当業者であれば明らかであろう。
ところで、ロボット制御装置１０の指令調整手段１２が目標軌道Ｔｄの調整を行うようにしてもよい。以下では、動力学項として慣性力の押付方向成分を考え、その値と前述した閾値を比較して目標軌道Ｔｄの調整を行う（ここで、動力学項における押付方向以外の力を用いた調整を行ってもよい）。
（４）目標軌道を調整する場合
・慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより小さい場合には、目標軌道Ｔｄはその設定値Ｔｓを使用する。
・慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きい場合には、慣性力の押付方向成分の作用する方向と押付方向に応じて、以下のように目標軌道をずらす。
第一には、慣性力の押付方向成分の作用する方向と押付方向とが逆向きである場合には、押付方向に目標軌道をずらす。
第二には、慣性力の押付方向成分の作用する方向と押付方向とが同じ向きである場合には、押付方向とは逆向きに目標軌道をずらす。
目標軌道Ｔｄは、以下の式によって与えられるようにする。
Ｔｄ＝Ｔｓ＋Ｔｍ
目標軌道の修正量Ｔｍは以下の二通りで算出される。（４−１）、（４−２）
（４−１）目標軌道の修正量Ｔｍを、閾値を超えてから経過した時間ｔに基づいて算出する。図１１は軌道修正量Ｔｍと閾値を超えてからの経過時間ｔとの関係を示す図である。図１１を参照しつつ、目標軌道の修正量Ｔｍを以下の式（１５）から算出する。
Ｔｍ＝ｋ４１・（１−ｅｘｐ（−ｌ４１・ｔ）） （１５）
ただし、０＜ｌ４１、０＜ｔ、０≦ｋ４１、０＜ｈｔ＜｜ｈ｜
ここで、ｋ４１は定数であり、ｌ４１は定数である。
（４−２）目標軌道の修正量Ｔｍを、慣性力の押付方向成分の大きさ｜ｈ｜に基づいて算出する。図１２は軌道修正量Ｔｍと慣性力の押付方向成分の大きさ｜ｈ｜との関係を示す他の図である。図１２を参照しつつ、目標軌道の修正量Ｔｍを以下の式（１６）から算出する。
Ｔｍ＝ｋ４２・（１−ｅｘｐ｛−ｌ４２・（｜ｈ｜−ｈｔ）｝） （１６）
ただし、０＜ｌ４２、０≦ｋ４２、０＜ｈｔ＜｜ｈ｜
ここで、ｋ４２は定数であり、ｌ４２は定数である。さらに、Ｔｍは軌道修正量であり、ｈは慣性力の押付方向成分であり、ｈｔは動力学項と比較するための閾値である。これにより、ワークが加工不足または加工過剰になるのを防止できるのが分かるであろう。なお、目標軌道を変化させる場合には、ロボットアームの動きに過大な負荷がかからないように、滑らかに変化させるのが好ましい。
ところで、倣い加工作業において力測定手段５１によって得られる力は、ワーク６０と作業ツール５２とが接触しているためにワーク６０の表面状態、バリの大きさ、ロボットアーム５０ａ自体の動きによる撓みまたは揺れなどの影響を受けやすい。また、力測定手段５１の信号にのるノイズ、作業ツール５２の回転による力または作業ツール５２の振動によるノイズなどの外乱も存在する。このため、力制御ゲインを過度に大きな値に設定すると、外乱に対して過度に反応したりロボットアーム５０ａが発振しやすくなる。そのため、必要以上にゲインを大きく設定しないことが望ましい。
このため、通常は制御ゲインの大きさを比較的小さくしておき、慣性力が比較的大きい場合にのみ制御ゲインを比較的大きくするのが望まれる。この場合、動力学項の値に応じて、ロボットアーム５０ａの動作に関する指令を調整する指令調整手段１２が力制御ゲインを調整するようにしてもよい。これにより、制御ゲインを必要な領域においてのみ大きくし、通常は比較的小さくしておくことができる。従って、ワーク６０の加工状態を所望の状態にすることができる。
以下では、動力学項として慣性力の押付方向成分を考え、その値と前述した閾値とを比較して力制御ゲインの調整を行う（ここで、動力学項における押付方向以外の力を用いた調整を行ってもよい）。なお、ロボット制御装置１０により実施される力制御はインピーダンス制御またはダンピング制御のいずれであってもよい。
（５）力制御ゲインを調整する場合
・慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより小さい場合には、力制御ゲインＧｄはその設定値Ｇｓを使用する。
・慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きい場合には、力制御ゲインＧｄを大きくする（５−１）、（５−２）。
（５−１）慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きい場合には、閾値を超えてから経過した時間ｔに基づいて力制御ゲインＧｄを大きくする。図１３は力制御ゲインＧｄと閾値を超えてからの経過時間ｔとの関係を示す図である。図１３を参照しつつ、以下の式（１７）から力制御ゲインＧｄを算出する。
Ｇｄ＝｛（ｋ５１−１）・（１−ｅｘｐ（−ｌ５１・ｔ））＋１｝・Ｇｓ （１７）
ただし、０＜ｌ５１、０＜ｔ、１≦ｋ５１、０＜ｈｔ＜｜ｈ｜
ここで、ｋ５１は定数であり、ｌ５１は定数である。
（５−２）慣性力の押付方向成分の大きさ｜ｈ｜が閾値ｈｔより大きい場合には、慣性力の押付方向成分の大きさ｜ｈ｜に基づいて力制御ゲインＧｄを大きくする。このときには、前述した式（１０）から係数β１を算出した後で、以下の式（１８）を用いて力制御ゲインＧｄを算出する。
Ｇｄ＝β１・Ｇｓ （１８）
ここで、Ｇｓは予め第一パラメータ格納部２０に設定した力制御ゲインである。
また、上記(1)、(2)、(3)、(4)、(5)の場合において、目標進行方向速度Ｖｄ、目標押付力Ｆｄ、目標軌道修正量Ｔｍ、力制御ゲインＧｄを、慣性力の押付方向成分の大きさとその方向に応じて設定するようなテーブルを予め用意し、それを利用する方法をおこなってもよい。
このように本発明においては、ロボットアームの動作に関連する指令を調整する際に、加工経路上の調整箇所を予め教示する必要はなく、また加工経路上の曲率を別途算出する必要もない。また、重力および動力学項から、加工が不十分または過剰になりそうであるかを判断し、それに応じて動作指令を調節している。従って、ワークを容易かつ正確に加工できるのが分かるであろう。
ところで、図４は本発明に基づくロボット制御装置により制御される他のロボットの斜視図である。図４に示されるロボット５０’はロボットアーム５０ａの先端に、ワーク６０を把持するためのハンド５４が取付けられている。ハンド５４に把持されたワーク６０が床に固定されたグラインダ５２に押付けられつつ、倣い加工作業が行われる。そして、力覚センサ５１はロボットアーム５０ａとハンド５４との間に配置されている。なお、力覚センサ５１を用いることなしに、ロボットアーム５０ａを駆動するアクチュエータの電流値に基づいて力を推定するようにしてもよい。このような場合であっても、前述した制御を適用できるのは、当業者であれば明らかであろう。
本発明に基づくロボット制御装置により制御されるロボットの斜視図である。 本発明に基づくロボット制御装置の機能ブロック図である。 ロボット制御装置により制御されるロボットアーム先端部分の移動を説明するための図である。 本発明に基づくロボット制御装置により制御される他のロボットの斜視図である。 目標進行方向速度Ｖｄと閾値を超えてからの経過時間ｔとの関係を示す図である。 係数α１、α２と慣性力の押付方向成分の大きさとの関係を示す図である。 目標進行方向速度Ｖｄと閾値を超えてからの経過時間ｔとの関係を示す他の図である。 係数β１と慣性力の押付方向成分の大きさ｜ｈ｜との関係を示す図である。 目標押付力Ｆｄと閾値を超えてからの経過時間ｔとの関係を示す図である。 目標押付力Ｆｄと閾値を超えてからの経過時間ｔとの関係を示す他の図である。 軌道修正量Ｔｍと閾値を超えてからの経過時間ｔとの関係を示す図である。 軌道修正量Ｔｍと慣性力の押付方向成分の大きさ｜ｈ｜との関係を示す他の図である。 力制御ゲインＧｄと閾値を超えてからの経過時間ｔとの関係を示す図である。
符号の説明
１０ ロボット制御装置
１１ 指令演算部
１２ 指令調整手段
１３ 動力学項、重力算出部
１４ 力補正手段
２０ 第一パラメータ格納部
２５ 第二パラメータ格納部
２６ 重心位置
５０、５０’ ロボット
５０ａ ロボットアーム
５１ 力覚センサ（力測定手段）
５２ 作業ツール
５３ 位置・速度・加速度検出部
５４ ハンド
６０ ワーク
６１ 作業台
６２ 表面
６３ ワーク表面において、慣性力の押付方向成分の作用する方向と押付方向が逆向きである領域
６４ ワーク表面において、慣性力の押付方向成分の作用する方向と押付方向が同じ向きである領域
Ｔｄ 目標軌道
Ｔｓ 目標軌道の設定値
Ｔｍ 軌道修正量
Ｆｄ 目標押付力
Ｆｓ 目標押付力の設定値
Ｇ（θ） 重力ベクトル
Ｇｄ 力制御ゲイン
Ｇｓ 力制御ゲインの設定値
Ｃ（θ，ｄθ／ｄｔ） 遠心力やコリオリ力などを表すベクトル
ｈ 慣性力の押付方向成分
ｈｔ 閾値
ｔ 閾値を超えてからの経過時間
Ｖｄ 目標進行方向速度
Ｖｓ 目標進行方向速度の設定値
α１、α２、β１ 係数

Claims (11)

  1. ロボットアームの先端に取付けられた作業ツールとワークとの間に作用する力を制御するロボット制御装置において、
    前記制御をおこなう際に必要な力データを取得する力測定手段と、
    前記作業ツールから前記力測定手段に及ぼされる力のうち、重力が前記力測定手段に作用する力と前記ロボットアームの運動により発生する動力学項とを算出する算出手段と、
    前記算出手段により算出された、前記重力が前記力測定手段に作用する力と前記動力学項とを用いて、前記力測定手段により測定された力を補正する補正手段と、
    前記動力学項が所定の閾値より大きい場合には、前記動力学項および前記重力により前記力測定手段に及ぼされる力に応じて、前記ロボットアームの動作指令を調整する指令調整手段と、を具備するロボット制御装置。
  2. ロボットアームの先端に取付けられたハンドにより把持されたワークと固定された作業ツールとの間に作用する力を制御するロボット制御装置において、
    前記制御をおこなう際に必要な力データを取得する力測定手段と、
    前記ワークを把持した前記ハンドから前記力測定手段に及ぼされる力のうち、重力が前記力測定手段に作用する力と前記ロボットアームの運動により発生する動力学項とを算出する算出手段と、
    前記算出手段により算出された、前記重力が前記力測定手段に作用する力と前記動力学項とを用いて、前記力測定手段により測定された力を補正する補正手段と、
    前記動力学項が所定の閾値より大きい場合には、前記動力学項および前記重力により前記力測定手段に及ぼされる力に応じて、前記ロボットアームの動作指令を調整する指令調整手段と、を具備するロボット制御装置。
  3. 前記指令調整手段により調整される前記ロボットアームの前記動作指令は、前記作業ツールと前記ワークとの間に作用すべき力の指令を含む請求項１または２に記載のロボット制御装置。
  4. 前記指令調整手段により調整される前記ロボットアームの前記動作指令は、前記ロボットアームの進行方向速度を含む請求項１から３のいずれか一項に記載のロボット制御装置。
  5. 前記指令調整手段により調整される前記ロボットアームの前記動作指令は、ロボットアームの目標軌道を含む請求項１から４のいずれか一項に記載のロボット制御装置。
  6. 前記指令調整手段により調整される前記ロボットアームの前記動作指令は、力制御のゲインを含む請求項１から５のいずれか一項に記載のロボット制御装置。
  7. 前記算出手段は、前記ロボットアームの姿勢、動作速度や動作加速度と、前記ロボットアーム先端部に取付けられたエンドエフェクタ部の質量と重心から、動力学項と重力とを算出する請求項１から６のいずれか一項に記載のロボット制御装置。
  8. 前記力測定手段は力覚センサである、請求項１から７のいずれか一項に記載のロボット制御装置。
  9. 前記力測定手段は前記ロボットアームを駆動するアクチュエータの電流値に基づいて力を推定する請求項１から７のいずれか一項に記載のロボット制御装置。
  10. 前記ロボット制御装置により行われる力制御はインピーダンス制御である請求項１から９のいずれか一項に記載のロボット制御装置。
  11. 前記ロボット制御装置により行われる力制御はダンピング制御である請求項１から９のいずれか一項に記載のロボット制御装置。
JP2006330900A 2006-12-07 2006-12-07 ロボット制御装置 Active JP4267027B2 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
JP2006330900A JP4267027B2 (ja) 2006-12-07 2006-12-07 ロボット制御装置
EP07023557A EP1930131A3 (en) 2006-12-07 2007-12-05 Robot control apparatus for force control
US11/951,457 US20080140257A1 (en) 2006-12-07 2007-12-06 Robot control apparatus for force control
CN200710186555XA CN101195221B (zh) 2006-12-07 2007-12-07 进行力控制的机器人控制装置
US13/169,731 US20110257787A1 (en) 2006-12-07 2011-06-27 Robot control apparatus for force control

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2006330900A JP4267027B2 (ja) 2006-12-07 2006-12-07 ロボット制御装置

Publications (2)

Publication Number Publication Date
JP2008142810A JP2008142810A (ja) 2008-06-26
JP4267027B2 true JP4267027B2 (ja) 2009-05-27

Family

ID=39166379

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2006330900A Active JP4267027B2 (ja) 2006-12-07 2006-12-07 ロボット制御装置

Country Status (4)

Country Link
US (2) US20080140257A1 (ja)
EP (1) EP1930131A3 (ja)
JP (1) JP4267027B2 (ja)
CN (1) CN101195221B (ja)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9149930B2 (en) 2012-07-20 2015-10-06 Seiko Epson Corporation Control system, program, and method of controlling mechanical equipment
JP2015202535A (ja) * 2014-04-14 2015-11-16 ファナック株式会社 作用された力に応じて移動されるロボットを制御するロボット制御装置
JP2015202536A (ja) * 2014-04-14 2015-11-16 ファナック株式会社 作用された力に応じて移動されるロボットを制御するロボット制御装置
DE102016008060B4 (de) 2015-07-09 2018-05-09 Fanuc Corporation Robotersteuereinheit für einen Roboter, der zwei Gegenstände in einen kombinierten Zustand versetzt
US10434647B2 (en) 2016-11-25 2019-10-08 Kabushiki Kaisha Toshiba Robot control device, a robot control method, and a picking device

Families Citing this family (87)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
SE530700C2 (sv) * 2006-12-21 2008-08-19 Hexagon Metrology Ab Förfarande och anordning för kompensering av geometriska fel i bearbetningsmaskiner
US8060250B2 (en) * 2008-12-15 2011-11-15 GM Global Technology Operations LLC Joint-space impedance control for tendon-driven manipulators
US8170718B2 (en) * 2008-12-18 2012-05-01 GM Global Technology Operations LLC Multiple priority operational space impedance control
JP2010234520A (ja) * 2009-03-10 2010-10-21 Canon Inc 研磨装置
JP4957753B2 (ja) * 2009-06-15 2012-06-20 セイコーエプソン株式会社 ロボット、搬送装置、及び慣性センサーを用いた制御方法
JP5236596B2 (ja) * 2009-08-19 2013-07-17 ファナック株式会社 加工ロボットシステム
US8525460B2 (en) * 2010-02-02 2013-09-03 GM Global Technology Operations LLC Architecture for robust force and impedance control of series elastic actuators
JP5645564B2 (ja) * 2010-09-14 2014-12-24 キヤノン株式会社 センサ装置及びロボット装置
JP5215378B2 (ja) * 2010-12-27 2013-06-19 ファナック株式会社 ３軸力センサを用いて力制御をおこなうロボットの制御装置
US8528955B2 (en) * 2011-01-24 2013-09-10 AMF automation Technologies, LLC Robot end effector with cable management
JP5149416B2 (ja) * 2011-04-06 2013-02-20 ファナック株式会社 ロボットの異常検出機能を有するロボットシステム及びその制御方法
JP2012232370A (ja) * 2011-04-28 2012-11-29 Seiko Epson Corp ロボットコントローラー、簡易設置型ロボット、及び簡易設置型ロボットの制御方法
US9566710B2 (en) 2011-06-02 2017-02-14 Brain Corporation Apparatus and methods for operating robotic devices using selective state space training
JP5907678B2 (ja) * 2011-07-20 2016-04-26 オリンパス株式会社 医療用動作機構およびマニピュレータ
JP5399593B2 (ja) * 2011-11-10 2014-01-29 パナソニック株式会社 ロボット、ロボットの制御装置、制御方法、及び制御プログラム
JP5966372B2 (ja) 2012-01-17 2016-08-10 セイコーエプソン株式会社 ロボット制御装置、ロボットシステム、ロボット制御方法及びロボット
JP5962020B2 (ja) 2012-01-17 2016-08-03 セイコーエプソン株式会社 ロボット制御装置、ロボットシステム、ロボット及びロボット制御方法
JP5895628B2 (ja) * 2012-03-15 2016-03-30 株式会社ジェイテクト ロボットの制御方法及びロボット制御装置、並びにロボット制御システム
JP6083145B2 (ja) * 2012-07-31 2017-02-22 セイコーエプソン株式会社 ロボットの制御装置、およびロボット
US9764468B2 (en) 2013-03-15 2017-09-19 Brain Corporation Adaptive predictor apparatus and methods
CA2902213C (en) * 2013-03-15 2021-05-18 John Alberti Force responsive power tool
US9242372B2 (en) 2013-05-31 2016-01-26 Brain Corporation Adaptive robotic interface apparatus and methods
US9314924B1 (en) 2013-06-14 2016-04-19 Brain Corporation Predictive robotic controller apparatus and methods
US9792546B2 (en) 2013-06-14 2017-10-17 Brain Corporation Hierarchical robotic controller apparatus and methods
US9384443B2 (en) 2013-06-14 2016-07-05 Brain Corporation Robotic training apparatus and methods
JP5845212B2 (ja) * 2013-06-28 2016-01-20 ファナック株式会社 視覚センサ及び力センサを備えたバリ取り装置
US9579789B2 (en) 2013-09-27 2017-02-28 Brain Corporation Apparatus and methods for training of robotic control arbitration
JP6248544B2 (ja) * 2013-10-30 2017-12-20 セイコーエプソン株式会社 ロボット、制御装置、ロボットシステム
JP6307838B2 (ja) * 2013-11-01 2018-04-11 セイコーエプソン株式会社 ロボット、ロボットシステムおよび制御装置
US9463571B2 (en) 2013-11-01 2016-10-11 Brian Corporation Apparatus and methods for online training of robots
CN104608113B (zh) 2013-11-01 2018-07-17 精工爱普生株式会社 机器人、机器人系统以及机器人控制装置
US9597797B2 (en) 2013-11-01 2017-03-21 Brain Corporation Apparatus and methods for haptic training of robots
US9358685B2 (en) * 2014-02-03 2016-06-07 Brain Corporation Apparatus and methods for control of robot actions based on corrective user inputs
US9259844B2 (en) * 2014-02-12 2016-02-16 General Electric Company Vision-guided electromagnetic robotic system
JP5877859B2 (ja) * 2014-03-12 2016-03-08 ファナック株式会社 バラ積みされたワークを取り出すロボットシステム及びワークの把持状態を判定する判定方法
JP5941083B2 (ja) * 2014-03-12 2016-06-29 ファナック株式会社 外部環境との接触を検知するロボット制御装置
JP5893666B2 (ja) * 2014-04-14 2016-03-23 ファナック株式会社 力に応じて動かすロボットのロボット制御装置およびロボットシステム
JP5946859B2 (ja) 2014-04-14 2016-07-06 ファナック株式会社 力に応じて動かすロボットのロボット制御装置およびロボットシステム
US9346167B2 (en) 2014-04-29 2016-05-24 Brain Corporation Trainable convolutional network apparatus and methods for operating a robotic vehicle
JP5972941B2 (ja) 2014-08-06 2016-08-17 ファナック株式会社 数値制御装置付き工作機械
JP5927259B2 (ja) * 2014-09-30 2016-06-01 ファナック株式会社 力制御を実行するロボットシステム
US9630318B2 (en) 2014-10-02 2017-04-25 Brain Corporation Feature detection apparatus and methods for training of robotic navigation
JP6310093B2 (ja) 2014-11-12 2018-04-11 エスゼット ディージェイアイ テクノロジー カンパニー リミテッドＳｚ Ｄｊｉ Ｔｅｃｈｎｏｌｏｇｙ Ｃｏ．，Ｌｔｄ 目標物体の検出方法、検出装置及びロボット
US9717387B1 (en) 2015-02-26 2017-08-01 Brain Corporation Apparatus and methods for programming and training of robotic household appliances
DE102015206121B3 (de) * 2015-04-07 2016-09-08 Kuka Systems Gmbh Verfahren zum Steuern von zumindest einem Manipulator unter Verwendung zumindest einer Kraftkompensationsvorrichtung
US9962833B2 (en) * 2015-04-07 2018-05-08 Mtm Robotics, Llc System and method for adjusting end-effector actuation based on relative position with respect to gravitational force
CN106142081B (zh) 2015-05-14 2021-03-02 发那科株式会社 对加工工具转速和工件进给速度进行调整的加工系统
JP6407810B2 (ja) * 2015-05-14 2018-10-17 ファナック株式会社 加工ツール回転数とワーク送り速度とを調整する加工システム
CN106239516B (zh) * 2015-06-03 2021-09-24 精工爱普生株式会社 机器人控制装置、机器人以及机器人系统
JP6489991B2 (ja) * 2015-10-02 2019-03-27 ファナック株式会社 ロボットを操作するハンドルを備えたロボット用操作装置
US10471594B2 (en) * 2015-12-01 2019-11-12 Kindred Systems Inc. Systems, devices, and methods for the distribution and collection of multimodal data associated with robots
CN108366835B (zh) * 2015-12-10 2021-07-27 柯惠Lp公司 具有独立的侧倾、俯仰和偏摆缩放的机器人外科手术系统
DE102017000063B4 (de) * 2016-01-14 2019-10-31 Fanuc Corporation Robotereinrichtung mit Lernfunktion
JP6746990B2 (ja) * 2016-03-18 2020-08-26 セイコーエプソン株式会社 ロボット制御装置及びロボットシステム
US10241514B2 (en) 2016-05-11 2019-03-26 Brain Corporation Systems and methods for initializing a robot to autonomously travel a trained route
US9987752B2 (en) 2016-06-10 2018-06-05 Brain Corporation Systems and methods for automatic detection of spills
US10282849B2 (en) 2016-06-17 2019-05-07 Brain Corporation Systems and methods for predictive/reconstructive visual object tracker
US10016896B2 (en) 2016-06-30 2018-07-10 Brain Corporation Systems and methods for robotic behavior around moving bodies
JPWO2018012110A1 (ja) 2016-07-11 2019-04-25 ソニー株式会社 処理装置、システム、および制御方法
IT201600097482A1 (it) 2016-09-28 2018-03-28 Gaiotto Automation S P A Metodo per il trattamento superficiale di un manufatto
US10493617B1 (en) * 2016-10-21 2019-12-03 X Development Llc Robot control
US10274325B2 (en) 2016-11-01 2019-04-30 Brain Corporation Systems and methods for robotic mapping
US10001780B2 (en) 2016-11-02 2018-06-19 Brain Corporation Systems and methods for dynamic route planning in autonomous navigation
US10723018B2 (en) 2016-11-28 2020-07-28 Brain Corporation Systems and methods for remote operating and/or monitoring of a robot
JP6714732B2 (ja) * 2016-12-28 2020-06-24 株式会社Ｓｕｂａｒｕ 機械加工用ロボット及び機械加工方法
JP6400749B2 (ja) 2017-01-24 2018-10-03 ファナック株式会社 力制御押付装置を備えたロボットシステム
US10377040B2 (en) 2017-02-02 2019-08-13 Brain Corporation Systems and methods for assisting a robotic apparatus
US10852730B2 (en) 2017-02-08 2020-12-01 Brain Corporation Systems and methods for robotic mobile platforms
US10293485B2 (en) 2017-03-30 2019-05-21 Brain Corporation Systems and methods for robotic path planning
CN109397072A (zh) * 2017-08-18 2019-03-01 均豪精密工业股份有限公司 工件加工方法及加工系统
WO2019098044A1 (ja) * 2017-11-14 2019-05-23 三菱電機株式会社 ロボットの動作調整装置、動作制御システム及びロボットシステム
US10967510B2 (en) * 2017-11-16 2021-04-06 Industrial Technology Research Institute Robot arm processing system and method thereof
CN109794932B (zh) * 2017-11-16 2021-03-16 财团法人工业技术研究院 机械手臂加工系统及其加工方法
CN108107842A (zh) * 2017-12-31 2018-06-01 芜湖哈特机器人产业技术研究院有限公司 基于力控制的机器人打磨轨迹估算方法
US20200367984A1 (en) * 2018-01-04 2020-11-26 Covidien Lp Robotic surgical systems including torque sensors
CN108284456A (zh) * 2018-01-31 2018-07-17 哈尔滨工业大学 基于降维解析的传感器载荷外力测量中的重力补偿方法
JP6950612B2 (ja) 2018-03-30 2021-10-13 オムロン株式会社 センサ、情報処理装置、センサ制御方法、情報処理方法、プログラム、および記録媒体
EP3859353A4 (en) * 2018-09-26 2022-06-29 IHI Corporation Acceleration-deriving device and method
US10976728B2 (en) * 2018-12-10 2021-04-13 Raytheon Technologies Corporation Automatic process planning for robotic deburring operations
US11796831B2 (en) 2018-12-17 2023-10-24 Semiconductor Components Industries, Llc Methods and system for position stabilization
US20200301510A1 (en) * 2019-03-19 2020-09-24 Nvidia Corporation Force estimation using deep learning
EP3981552B1 (en) * 2019-06-04 2022-12-21 Panasonic Intellectual Property Management Co., Ltd. Robot control method
JP7283994B2 (ja) * 2019-06-21 2023-05-30 ファナック株式会社 ロボットの制御装置およびプログラミング装置
JP7415447B2 (ja) * 2019-10-31 2024-01-17 セイコーエプソン株式会社 ロボットシステム
US20210268649A1 (en) * 2020-02-28 2021-09-02 Ati Industrial Automation, Inc. Controlling Contact Force in a Machine Tool
US20240083028A1 (en) * 2021-02-11 2024-03-14 Abb Schweiz Ag Method of Controlling Manipulator of Industrial Robot, Control System and Industrial Robot
CN113319855B (zh) * 2021-06-28 2022-04-12 哈尔滨工业大学 一种多关节诊疗机器人柔顺力控制模式下的重力补偿方法

Family Cites Families (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01234141A (ja) * 1988-03-16 1989-09-19 Nitta Ind Corp 工具の慣性による影響を除去する方法および装置
JP2770982B2 (ja) * 1989-05-25 1998-07-02 株式会社豊田中央研究所 マニピユレータの位置と力の協調制御装置
DE3922524A1 (de) * 1989-07-08 1991-01-17 Kuka Schweissanlagen & Roboter Verfahren zur regelung der bewegungen einer achse an programmgesteuerten maschinen und regelsystem
JP2739764B2 (ja) * 1989-12-15 1998-04-15 富士通株式会社 ロボットの倣い速度制御方式
KR940003204B1 (ko) * 1990-02-27 1994-04-16 가부시끼가이샤 도시바 제어로봇
JPH05143146A (ja) 1991-09-30 1993-06-11 Yamaha Corp ロボツトの教示装置
US5327790A (en) * 1992-06-19 1994-07-12 Massachusetts Institute Of Technology Reaction sensing torque actuator
US5448146A (en) * 1993-01-29 1995-09-05 Board Of Regents, The University Of Texas System Method for applying constant force with nonlinear feedback control and constant force device using same
JP3412236B2 (ja) * 1993-03-31 2003-06-03 株式会社日立製作所 多自由度ロボット及びそのコンプライアンス制御方法
US5497061A (en) * 1993-03-31 1996-03-05 Hitachi, Ltd. Method of controlling robot's compliance
JP3402829B2 (ja) 1995-03-17 2003-05-06 東芝機械株式会社 力制御ロボット
EP1418026A1 (en) * 1995-09-11 2004-05-12 Kabushiki Kaisha Yaskawa Denki Control apparatus for robot
US5767648A (en) * 1996-04-19 1998-06-16 Massachusetts Institute Of Technology Base force/torque sensor apparatus for the precise control of manipulators with joint friction and a method of use thereof
US6253120B1 (en) * 1997-04-28 2001-06-26 Seiko Seiki Kabushiki Kaisha Position and/or force controlling apparatus using sliding mode decoupling control
DE19748822A1 (de) * 1997-11-05 1999-05-06 Kuka Roboter Gmbh Roboterarm mit Gewichtsausgleich
US6565554B1 (en) * 1999-04-07 2003-05-20 Intuitive Surgical, Inc. Friction compensation in a minimally invasive surgical apparatus
US6470225B1 (en) * 1999-04-16 2002-10-22 Siemens Energy & Automation, Inc. Method and apparatus for automatically tuning feedforward parameters
JP2000301479A (ja) * 1999-04-19 2000-10-31 Denso Corp ロボット制御装置
US7118452B2 (en) * 2004-02-12 2006-10-10 The Boeing Company Pneumatically actuated flexible coupling end effectors for lapping/polishing
US9110456B2 (en) * 2004-09-08 2015-08-18 Abb Research Ltd. Robotic machining with a flexible manipulator
DE602007008206D1 (de) * 2006-02-23 2010-09-16 Abb Ab System zur steuerung der position und orientierung eines objekts je nach von einem benutzer empfangenen kräften und drehmomenten
US20080065257A1 (en) * 2006-09-13 2008-03-13 Jianmin He Controlled material removal rate (CMRR) and self-tuning force control in robotic machining process

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9149930B2 (en) 2012-07-20 2015-10-06 Seiko Epson Corporation Control system, program, and method of controlling mechanical equipment
JP2015202535A (ja) * 2014-04-14 2015-11-16 ファナック株式会社 作用された力に応じて移動されるロボットを制御するロボット制御装置
JP2015202536A (ja) * 2014-04-14 2015-11-16 ファナック株式会社 作用された力に応じて移動されるロボットを制御するロボット制御装置
US9555548B2 (en) 2014-04-14 2017-01-31 Fanuc Corporation Robot control device for controlling robot moved according to applied force
US9623567B2 (en) 2014-04-14 2017-04-18 Fanuc Corporation Robot control device for controlling robot moved according to applied force
DE102015004481B4 (de) 2014-04-14 2018-12-06 Fanuc Corporation Robotersteuervorrichtung zum Steuern eines gemäß einer ausgeübten Kraft bewegten Roboters
DE102016008060B4 (de) 2015-07-09 2018-05-09 Fanuc Corporation Robotersteuereinheit für einen Roboter, der zwei Gegenstände in einen kombinierten Zustand versetzt
US10434647B2 (en) 2016-11-25 2019-10-08 Kabushiki Kaisha Toshiba Robot control device, a robot control method, and a picking device

Also Published As

Publication number Publication date
CN101195221A (zh) 2008-06-11
CN101195221B (zh) 2011-07-27
US20110257787A1 (en) 2011-10-20
EP1930131A3 (en) 2011-03-02
US20080140257A1 (en) 2008-06-12
EP1930131A2 (en) 2008-06-11
JP2008142810A (ja) 2008-06-26

Similar Documents

Publication Publication Date Title
JP4267027B2 (ja) ロボット制御装置
US9452532B2 (en) Robot, device and method for controlling robot, and computer-readable non-transitory recording medium
US8626341B2 (en) Apparatus and method for adjusting parameter of impedance control
JP5236596B2 (ja) 加工ロボットシステム
KR940003204B1 (ko) 제어로봇
JP6582483B2 (ja) ロボット制御装置およびロボットシステム
EP2586577A1 (en) Robot control device
JP6044511B2 (ja) ロボットの制御方法及びロボットシステム
JP4997145B2 (ja) パワーアシスト装置およびその制御方法
JP2007076807A (ja) パワーアシスト装置とその適応モデル予測制御方法
JP5897645B2 (ja) 機械先端点のたわみを低減するサーボ制御装置
JP2016190292A (ja) ロボット制御装置、ロボットシステムおよびロボット制御方法
US20150051735A1 (en) Control apparatus of robot, robot, and program thereof
CN112405566A (zh) 机器人控制装置
JP4639417B2 (ja) ロボットの制御装置
Lange et al. Revised force control using a compliant sensor with a position controlled robot
US9827673B2 (en) Robot controller inhibiting shaking of tool tip in robot equipped with travel axis
JP7068133B2 (ja) 制御システム、制御方法、及び制御プログラム
US10639799B2 (en) Robot system
JP3217351B2 (ja) 力制御装置及びそれを用いたロボット
JP2003216243A (ja) ロボットの制御装置
JP2013255981A (ja) ロボット制御装置および撓み補正方法
US11660742B2 (en) Teaching method and robot system
JP4222338B2 (ja) 適応型ビジュアルフィードバック制御方法
JP6565622B2 (ja) ロボットシステム及びロボット制御方法

Legal Events

Date Code Title Description
A871 Explanation of circumstances concerning accelerated examination

Free format text: JAPANESE INTERMEDIATE CODE: A871

Effective date: 20080417

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20080909

A975 Report on accelerated examination

Free format text: JAPANESE INTERMEDIATE CODE: A971005

Effective date: 20080908

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20080916

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: 20090203

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20090217

R150 Certificate of patent or registration of utility model

Ref document number: 4267027

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120227

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120227

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130227

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140227

Year of fee payment: 5