JP2013193131A - ロボットの制御方法及びロボット制御装置、並びにロボット制御システム - Google Patents

ロボットの制御方法及びロボット制御装置、並びにロボット制御システム Download PDF

Info

Publication number
JP2013193131A
JP2013193131A JP2012059137A JP2012059137A JP2013193131A JP 2013193131 A JP2013193131 A JP 2013193131A JP 2012059137 A JP2012059137 A JP 2012059137A JP 2012059137 A JP2012059137 A JP 2012059137A JP 2013193131 A JP2013193131 A JP 2013193131A
Authority
JP
Japan
Prior art keywords
posture
load torque
link
torque
joint
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2012059137A
Other languages
English (en)
Other versions
JP5895628B2 (ja
Inventor
Hiromitsu Ota
浩充 太田
Yasuharu Mukai
康晴 向井
Kazuya Numazaki
和也 沼崎
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.)
JTEKT Corp
Original Assignee
JTEKT 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 JTEKT Corp filed Critical JTEKT Corp
Priority to JP2012059137A priority Critical patent/JP5895628B2/ja
Priority to CN201310076023.6A priority patent/CN103302667B/zh
Priority to US13/795,967 priority patent/US9002519B2/en
Priority to EP13158892.3A priority patent/EP2639020A3/en
Publication of JP2013193131A publication Critical patent/JP2013193131A/ja
Application granted granted Critical
Publication of JP5895628B2 publication Critical patent/JP5895628B2/ja
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • 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
    • 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/1641—Programme controls characterised by the control loop compensation for backlash, friction, compliance, elasticity in the joints
    • 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/1643—Programme controls characterised by the control loop redundant 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/40—Robotics, robotics mapping to robotics vision
    • G05B2219/40367—Redundant manipulator
    • 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/40—Robotics, robotics mapping to robotics vision
    • G05B2219/40461—Plan for even distribution of motor load of joints
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10S—TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10S901/00—Robots
    • Y10S901/02—Arm motion controller
    • Y10S901/09—Closed loop, sensor feedback controls arm movement

Abstract

【課題】
冗長自由度を利用して制御性を向上することができ、回転系アクチュエータの小型化、ロボットの小型化を実現できるロボットの制御方法及びロボット制御装置、並びにロボット制御システムを提供する。
【解決手段】
ロボット制御装置のＣＰＵは手先位置姿勢を目標値とした拘束条件の下で冗長自由度が許容するリンク位置姿勢を示す姿勢パラメータを順次変化させる毎に各リンクの関節軸の慣性力、遠心力・コリオリ力、重力、摩擦トルク及びアクチュエータ慣性トルクに基づく負荷トルクを算出する。ＣＰＵは姿勢パラメータの変化の中で、負荷トルクと第１〜７サーボモータの定格トルク比が最小となるリンク位置姿勢を求め、手先位置姿勢を目標値とした各関節軸の第１〜７サーボモータの制御指令に負荷トルクと第１〜７サーボモータの定格トルク比が最小となるときの各負荷トルクとなるフィードフォワード値を付与する。
【選択図】図１

Description

本発明は、ロボットの制御方法ロボット制御装置に関し、特に、作業自由度に対して少なくとも１つの冗長自由度を備えるロボットの制御方法及びロボット制御装置、並びにロボット制御システムに関する。
従来、ロボットアームの計算トルク制御器として、特許文献１が公知である。特許文献１では、この制御器により、ロボットアームの運動に伴って、所定のサンプリング周期毎の角度の出力値と、前記角度の目標値との偏差と角速度の目標値との偏差とからの状態フィードバック値とにより、目標角加速度を修正して慣性力、コリオリ力、求心力、重力をリアルタイムで計算し、それらと等価のトルクを関節駆動アクチュエータに発生させてロボットアームの運動を制御するようにしている。
上記のように前記慣性力等をリアルタイムで計算してロボットアームを回転駆動するモータに対し、トルクを与えることにより、制御性を向上させることができる。
特開平４−９８３０４号公報
ところで、作業自由度に対して冗長自由度を有するロボットに対して、上記のように慣性力等をリアルタイムで計算してロボットアームを回転駆動するモータに対し、トルクを与える場合、ロボット姿勢によっては、過大なトルクを発生させなければならない場合があり、逆に制御性が劣化することがある。
本発明の目的は、作業自由度に対して冗長自由度を有するロボットにおいて、冗長自由度を利用して制御性を向上することができ、さらには、回転系アクチュエータのトルク容量を必要最小限にできるため、回転系アクチュエータの小型化、ひいてはロボットの小型化を実現できるロボットの制御方法及びロボット制御装置、並びにロボット制御システムを提供することにある。
上記問題点を解決するために、請求項１の発明は、作業自由度に対して少なくとも１つの冗長自由度を備えるように複数のリンクが各関節軸にて連結されたマニピュレータを備え、前記関節軸を該関節毎に設けられた回転系アクチュエータにより駆動するロボットの制御方法において、手先位置姿勢を目標値とした拘束条件の下で、前記冗長自由度が許容するリンク位置姿勢を変化させた場合の、少なくとも各リンクの関節軸の慣性力と遠心力・コリオリ力と重力に基づく負荷トルクを算出し、変化させた場合の前記リンク位置姿勢の中で、前記負荷トルクと前記回転系アクチュエータの定格トルク比が最小となるリンク位置姿勢を求め、前記手先位置姿勢を目標値とした各関節軸の回転系アクチュエータの制御指令に、前記負荷トルクと前記回転系アクチュエータの定格トルク比が前記最小となるときの各負荷トルクとなるフィードフォワード値を付与することを特徴とするロボットの制御方法を要旨としている。
請求項２の発明は、作業自由度に対して少なくとも１つの冗長自由度を備えるように複数のリンクが各関節軸にて連結されたマニピュレータを備え、前記関節軸を該関節毎に設けられた回転系アクチュエータにより駆動するロボットの制御方法において、手先位置姿勢を目標値とした拘束条件の下で、前記冗長自由度が許容するリンク位置姿勢を示す姿勢パラメータを順次変化させる毎に、少なくとも各リンクの関節軸の慣性力と遠心力・コリオリ力と重力に基づく負荷トルクを算出し、前記姿勢パラメータの変化の中で、前記負荷トルクと前記回転系アクチュエータの定格トルク比が最小となるリンク位置姿勢を求め、前記手先位置姿勢を目標値とした各関節軸の回転系アクチュエータの制御指令に、前記負荷トルクと前記回転系アクチュエータの定格トルク比が前記最小となるときの各負荷トルクとなるフィードフォワード値を付与することを特徴とするロボットの制御方法を要旨としている。
請求項３の発明、請求項１または請求項２において、前記負荷トルクには、摩擦トルクが含まれていることを特徴とする。
請求項４の発明は、作業自由度に対して少なくとも１つの冗長自由度を備えるように複数のリンクが各関節軸にて連結されたマニピュレータを備え、前記関節軸を該関節毎に設けられた回転系アクチュエータにより駆動するロボット制御装置において、手先位置姿勢を目標値とした拘束条件の下で、前記冗長自由度が許容するリンク位置姿勢を示す姿勢パラメータを順次変化させる毎に、少なくとも各リンクの関節軸の慣性力と遠心力・コリオリ力と重力に基づく負荷トルクを算出する負荷トルク算出部と、前記姿勢パラメータの変化の中で、前記負荷トルクと前記回転系アクチュエータの定格トルク比が最小となるリンク位置姿勢を求めるリンク姿勢算出部と、前記手先位置姿勢を目標値とした各関節軸の回転系アクチュエータの制御指令に、前記負荷トルクと前記回転系アクチュエータの定格トルク比が前記最小となるときの各負荷トルクとなるフィードフォワード値を付与する付与部を備えることを特徴とするロボット制御装置を要旨としている。
請求項５の発明は、請求項４において、前記負荷トルク算出部は、各リンクの関節軸の慣性力と遠心力・コリオリ力と重力の他に摩擦トルクを含む負荷トルクを算出することを特徴とする。
請求項６の発明は、作業自由度に対して少なくとも１つの冗長自由度を備えるように複数のリンクが各関節軸にて連結されたマニピュレータを備え、前記関節軸を該関節毎に設けられた回転系アクチュエータにより駆動するロボット制御システムにおいて、手先位置姿勢を目標値とした拘束条件の下で、前記冗長自由度が許容するリンク位置姿勢を示す姿勢パラメータを順次変化させる毎に、少なくとも各リンクの関節軸の慣性力と遠心力・コリオリ力と重力に基づく負荷トルクを算出する負荷トルク算出部と、前記姿勢パラメータの変化の中で、前記負荷トルクと前記回転系アクチュエータの定格トルク比が最小となるリンク位置姿勢を求めるリンク姿勢算出部と、前記手先位置姿勢を目標値とした各関節軸の回転系アクチュエータの制御指令に、前記負荷トルクと前記回転系アクチュエータの定格トルク比が前記最小となるときの各負荷トルクとなるフィードフォワード値を付与する付与部を備えることを特徴とするロボット制御システムを要旨としている。
請求項１、請求項２、請求項４、請求項６の発明によれば、作業自由度に対して冗長自由度を有するロボットにおいて、冗長自由度を利用して制御性を向上することができ、さらには、回転系アクチュエータのトルク容量を必要最小限にできるため、回転系アクチュエータの小型化、ひいてはロボットの小型化を実現できる。
請求項３及び請求項５の発明によれば、負荷トルクに摩擦トルクが含まれることにより、さらに、制御性の精度が高めることができる。
本発明の一実施形態の冗長性を有するマニピュレータのスケルトン図。 一実施形態のロボット制御装置の概略構成図。 姿勢パラメータの説明図。 ロボット制御装置の制御フローチャート。 ロボット制御装置の制御フローチャート。 他の実施形態のロボット制御システムのブロック図。
以下、本発明を具体化した一実施形態の作業自由度に対して冗長自由度を有するロボット制御装置及びロボット制御方法を図１〜図５を参照して説明する。
まず、本実施形態の作業自由度に対して冗長自由度を有するマニピュレータについて説明する。
図１に示すように、マニピュレータ１０は、８個のリンク１１〜１８が７個の関節２１〜２７により直列に連結されて形成されている。多関節ロボットであるマニピュレータ１０は、７個の関節２１〜２７においてリンク１２〜１８が旋回することのできる７自由度（自由度ｎ＝７）を有するロボットであり、その作業空間の次元数（次元数ｍ）は６であって、１（＝ｎ−ｍ）の冗長性を有する。すなわち、本実施形態のマニピュレータは、作業自由度６に対して、１つの冗長自由度を有する。
第１リンク１１は一端が床面ＦＬに固定され、他端が第１関節２１の一側に接続されている。第１関節２１の他側には、第２リンク１２の一端が接続され、第２リンク１２の他端には第２関節２２の一側が接続されている。以下同様に、第３リンク１３、第４リンク１４、第５リンク１５、第６リンク１６、第７リンク１７及び第８リンク１８が、それぞれ第３関節２３、第４関節２４、第５関節２５、第６関節２６及び第７関節２７を介して順に連結されている。
第１関節２１の他側は一側に対して、矢印３１に示すように、図１において上下方向に延びる軸を中心に回転可能とされており、これにより、第２リンク１２は隣接する第１リンク１１に対して、第１関節２１の回転軸（Ｊ１軸）を中心に矢印３１方向に旋回可能である。
また、第２関節２２の他側は一側に対して、矢印３２に示すように、図１において紙面に垂直な方向に延びる軸（Ｊ２軸）を中心に回転可能とされている。これにより、第３リンク１３は隣接する第２リンク１２に対して、第２関節２２の回転軸を中心に矢印３２方向に回転可能である。
以下、第３関節２３、第４関節２４、第５関節２５、第６関節２６及び第７関節２７についてもそれぞれ、回転可能とされており、第４リンク１４、第５リンク１５、第６リンク１６、第７リンク１７及び第８リンク１８も、それぞれ関節２３〜２７の回転軸（Ｊ３軸〜Ｊ７軸）を中心に、矢印３３〜３７方向に旋回可能である。尚、本願の全体にわたって、第１関節２１〜２７を介して連結されているリンク１１〜１８同士を、互いに隣接するリンク１１〜１８という。また、Ｊ１軸〜Ｊ７軸は、関節軸に相当する。
図１に示すように、第１関節２１には第１サーボモータ４１が取り付けられており、電力が供給されることにより、第２リンク１２を図示しない減速機を介して第１リンク１１に対して旋回させる。
また、第２関節２２には第２サーボモータ４２が取り付けられており、電力が供給されることにより、第３リンク１３を図示しない減速機を介して第２リンク１２に対して旋回させる。以下、同様に、第３関節２３、第４関節２４、第５関節２５、第６関節２６及び第７関節２７にはそれぞれサーボモータ４３〜４７が取り付けられており、電力が供給されることにより、各々リンク１４〜１８を図示しない減速機を介して旋回させる。
なお、各モータは、各関節内に設けられるが、図１では、説明の便宜上、関節とは分離して図示している。また、本実施形態では回転系アクチュエータとしてサーボモータであるＡＣモータが使用されているが、限定されるものではない。
第８リンク１８の先端には、ツール４９が取り付けられている。ツール４９は第８リンク１８とともに、第７関節２７の回転軸（Ｊ７軸）を中心に図１に示すように矢印３７方向に旋回可能とされている。ツール４９は、例えば、ワーク等を把持可能なハンドである。なお、ツール４９の種類は、本発明とは関係しないため、限定されるものではない。
上述したようにマニピュレータ１０は、第１サーボモータ４１〜第７サーボモータ４７を駆動して第２リンク１２〜第８リンク１８を回転させることにより、第２リンク１２〜第８リンク１８の回転角度が累積して先端部にあるツール４９に働くため、ツール４９の先端の位置および姿勢を、その作業内容に応じた目標位置および目標姿勢に一致させることが可能である。
次に、図２を参照して、前記マニピュレータ１０を制御するロボット制御装置としてのコントローラーＲＣを中心とした多関節ロボットの電気的な構成を説明する。
コントローラーＲＣは、コンピュータ９０と、コンピュータ９０に電気的に接続されたＰＷＭジェネレータ５１〜５７と、ＰＷＭジェネレータ５１〜５７に電気的に接続されたサーボアンプ６１〜６７を有する。各サーボアンプ６１〜６７はそれぞれ第１サーボモータ４１〜第７サーボモータ４７に電気的に接続されている。
コンピュータ９０は、制御指令をＰＷＭジェネレータ５１〜５７に出力し、ＰＷＭジェネレータ５１〜５７は、当該制御令指令に基づいてＰＷＭ信号をサーボアンプ６１〜６７に出力する。サーボアンプ６１〜６７は、その出力に応じてサーボモータ４１〜４７を作動させることにより、各リンク１２〜１８を回転させる。
前記サーボモータ４１〜４７にはロータリエンコーダ７１〜７７が内蔵されており、インターフェイス８０を介してコンピュータ９０と接続されている。ロータリエンコーダ７１〜７７は、各々のサーボモータ４１〜４７の回動角度を検出することにより、すなわち、リンク１２〜１８のそれぞれが隣接するリンク１１〜１７に対する回転角度（関節角度）を検出して、その検出信号をコントローラーＲＣに送信する。ロータリエンコーダ７１〜７７は、回転角度検出器に相当する。なお、回転角度検出器としては、ロータリエンコーダに限定するものではなく、レゾルバ、或いは、ポテンショメータであってもよい。
なお、第１サーボモータ４１〜第７サーボモータ４７に対してロータリエンコーダ７１〜７７を設ける代わりに、リンク１１〜１８または第１関節２１〜第７関節２７に、リンク１１〜１８の回転角度（関節角度）を直接に検出可能なセンサを取り付けてもよい。
前記コンピュータ９０は、ＣＰＵ９１、ＲＯＭ９２、ＲＡＭ９３、及びハードディスク等の不揮発性の記憶部９４、及びインターフェイス９５等を備え、バス９６を介して電気的に接続されている。
記憶部９４には、各種データ、ロボットに各種作業を行わせるための作業プログラム、各種パラメータ等が記憶されている。すなわち、本実施形態のロボットは、ティーチングプレイバック方式で作動するロボットであり、前記作業プログラムが実行されることにより、前記マニピュレータ１０が動作する。ＲＯＭ９２は、システム全体のシステムプログラムが記憶されている。ＲＡＭ９３は、ＣＰＵ９１の作業用のメモリであって、各種演算等が実行されるときに一時的にデータが格納される。ＣＰＵ９１は、負荷トルク算出部、リンク姿勢算出部及び付与部に相当する。
コントローラーＲＣには入力装置８２が前記インターフェイス９５を介して接続されている。入力装置８２は、図示しないモニター画面及び各種入力キー等を有する操作盤であり、ユーザーが各種のデータを入力操作可能とされている。入力装置８２は、多関節ロボットの電源スイッチが設けられるとともに、コンピュータ９０に対して、マニピュレータ１０の先端部にあるツール４９の先端（以下、手先という）の最終目標位置および最終目標姿勢、ツール４９の先端の補間点における位置および姿勢の入力、並びに、冗長性を利用したマニピュレータ１０の姿勢変更のためのジョグ操作等による入力が可能となっている。
（第１実施形態の作用）
次に、本実施形態による多関節ロボットのコントローラーＲＣの作用を説明する。図４及び図５は、コントローラーＲＣのＣＰＵ９１が実行する作業プログラムに書き込まれている教示点（最終目標位置、並びにツール４９の先端の補間点における位置）に手先を位置させるときの制御フローチャートである。前記ロータリエンコーダ７１〜７７は下記各ステップが実行される制御周期よりも、十分に速い検出周期で回転角度（すなわち、関節角度）を検出している。
（ステップ１０）
まず、ステップ１０（以下、ステップをＳという）では、ＣＰＵ９１は、記憶部９４の作業プログラムに書き込まれている教示点（手先位置）、手先姿勢及び速度データをＲＡＭ９３の所定領域にセットする。なお、手先位置及び手先姿勢を合わせて手先位置姿勢という。
（Ｓ２０）
次に、ＣＰＵ９１は、Ｓ２０で、手先をＳ１０でセットした教示点（手先位置）において、負荷トルク／定格トルク比最小姿勢決定を行う。このＳ２０の処理の詳細を図５のフローチャートを参照して説明する。
（Ｓ２１）
Ｓ２１では、ＣＰＵ９１は、姿勢パラメータΦを初期化する、本実施形態ではΦ＝０にして初期化するが、初期値は０に限定するものではない。姿勢パラメータΦについて説明する。
姿勢パラメータΦは、冗長自由度を有する前記マニピュレータ１０が、手先位置を固定した場合、すなわち、手先位置姿勢を拘束した場合において、その冗長自由度により許容されるリンク位置姿勢を示すものである。具体的には、図３に示すようにマニピュレータ１０の第４関節２４は、第２関節２２（以下、第１基準点Ｗという）を中心とし、第３リンク１３〜第４リンク１４のリンク長の合計を半径とした球Ａ１と、第６関節２６（以下、第２基準点Ｋという）を中心とし、第５リンク１５〜第６リンク１６のリンク長の合計を半径とする球Ａ２とが形成する交差円Ｅ上の移動が可能である。従って、本実施形態では、この交差円Ｅ上に第４関節２４が位置するようにして、リンク位置姿勢が変わる。
前記交差円Ｅの中心を通る中心軸Ｏは、図３に示すように、第１基準点Ｗ（第２関節２２中心）と第２基準点Ｋ（第６関節２６中心）を通過する軸である。第４関節２４はこの交差円Ｅ上に位置するため、姿勢パラメータΦは、交差円Ｅ上のリンク位置姿勢を示すパラメータとして表すことができる。そこで、交差円Ｅ上の適宜の位置Ｒから、変更された位置までの角度を、ここでは、姿勢パラメータΦとして定義されている。本実施形態では位置Ｒは、第４関節２４の現在位置とする。
（Ｓ２２）
Ｓ２２では、ＣＰＵ９１は姿勢パラメータΦとして所定値を加算して更新する。すなわち、仮想的に姿勢パラメータΦを増加させてリンクの位置姿勢を変えたものとするのである。
（Ｓ２３）
Ｓ２３では、手先位置姿勢から関節角度を求めるために逆変換演算を行う。
ここで、第１関節２１〜第７関節２７の関節角度ｑ１，ｑ２，ｑ３，…，ｑ７とし、手先座標（ｘ，ｙ，ｚ）及び手先姿勢（ａ，ｂ，ｃ）とすると、ベクトルｑ及び手先位置姿勢Ｘは下記のように表される。
各関節角度ｑ１，ｑ２，ｑ３，…，ｑ７は、式（２）に示すように表すことができ、これらの式は、逆変換式である。本ステップでは、式（２）により、手先位置姿勢Ｘと姿勢パラメータΦにより、各関節角度ｑ１，ｑ２，ｑ３，…，ｑ７を算出する。
（Ｓ２４）
Ｓ２４では、ＣＰＵ９１は、各関節軸に設けられたモータの負荷トルクを式（３）により算出し、記憶部９４に格納する。
式（３）の右辺において、第１項は慣性力、第２項は遠心力・コリオリ力より導かれるトルク、第３項は重力負荷より導かれるトルク、第４項は摩擦トルク、及び第５項はアクチュエータ慣性トルクである。これらの式中、右辺の第１項から第３項は、ラグランジュ法により導かれた運動方程式であり、公知の式である。また、右辺の第４項及び第５項はアクチュエータの影響を考慮に入れた項である。
なお、関節ｉの角速度、各加速度は、求められた関節角度ｑｉと、Ｓ１０でセットされた速度データに基づいて算出する。
第１項の慣性力については下記の通りである。
なお、「既知」とかかれているパラメータ等は、記憶部９４に格納されている。
各軸の各関節軸に設けられたモータの負荷トルクの算出が終了すると、ＣＰＵ９１は、Ｓ２５に移行する。
（Ｓ２５）
Ｓ２５では、ＣＰＵ９１は、姿勢パラメータΦが、予め設定された上限値Φｍａｘ以下であれば、Ｓ２２に戻り、姿勢パラメータΦが予め設定された上限値Φｍを超えた場合には、Ｓ２６に移行する。この上限値Φｍは、予め試験等により設定されたものである。
（Ｓ２６）
Ｓ２６では、ＣＰＵ９１は、Ｓ２４で算出した各負荷トルクと、予め記憶部９４に格納されている各関節軸のモータの定格トルクの比（負荷トルク／定格トルク）を算出して、最小の比となった負荷トルクが算出された姿勢パラメータΦを導出する。
次に、図４のフローチャートに戻って説明する。
（Ｓ３０）
Ｓ３０では、ＣＰＵ９１は、前記最小の比となった負荷トルクが算出された姿勢パラメータΦにおいて、該負荷トルクとなるトルクフィードフォワード値、すなわち、前記負荷トルクを生成するためのモータ電流値を公知の方法で算出する。
（Ｓ４０）
Ｓ４０では、ＣＰＵ９１は、Ｓ１０でセットした手先位置姿勢を目標値とした各関節軸の回転系アクチュエータの制御指令に、前記算出したトルクフィードフォワード値を付与し、そのトルクフィードフォワード値が付与された制御指令を、今回の制御周期分の指令としてＰＷＭジェネレータ５１〜５７にそれぞれ出力する。ＰＷＭジェネレータ５１〜５７は、その制御指令に基づくＰＷＭ信号をサーボアンプ６１〜６７に出力する。サーボアンプ６１〜６７は、その出力に応じて各関節軸の第１サーボモータ４１〜第７サーボモータ４７を作動させることにより、各リンク１２〜１８を回転させる。
（Ｓ５０）
ＣＰＵ９１は、Ｓ５０において、各ロータリエンコーダ７１〜７７からの検出信号に基づいて、最終目標位置、及び最終目標姿勢（すなわち、最終の目標位置姿勢）に手先が到達したか否かを判定し、達していないと判定した場合はＳ１０に戻り、反対に作業プログラムの最終の目標位置姿勢に達していると判定した場合は、このフローチャートを終了する。なお、Ｓ１０に戻った場合、作業プログラムに記述されている次の手先位置姿勢、速度データをセットする。
本実施形態では、下記の特徴を有する。
（１） 本実施形態の制御方法は、作業自由度に対して１つの冗長自由度を備えるように複数の第１リンク１１〜第８リンク１８が各関節軸（Ｊ１軸〜Ｊ７軸）にて連結されたマニピュレータ１０を備え、前記関節軸を該関節毎に設けられた第１サーボモータ４１〜第７サーボモータ４７（回転系アクチュエータ）により駆動するロボットの制御方法であって、手先位置姿勢を目標値とした拘束条件の下で、冗長自由度が許容するリンク位置姿勢を変化させた場合の、各リンクの関節軸の慣性力と遠心力・コリオリ力と重力、摩擦トルク及びアクチュエータ慣性トルクに基づく負荷トルクを算出した。さらに、変化させた場合のリンク位置姿勢の中で、前記負荷トルクと第１サーボモータ４１〜第７サーボモータ４７の定格トルク比が最小となるリンク位置姿勢を求めるようにした。さらに、手先位置姿勢を目標値とした各関節軸の第１サーボモータ４１〜第７サーボモータ４７の制御指令に、前記負荷トルクと第１サーボモータ４１〜第７サーボモータ４７の定格トルク比が最小となるときの各負荷トルクとなるフィードフォワード値を付与するようにした。この結果、本実施形態の制御方法によれば、冗長自由度を利用して制御性を向上することができ、さらには、第１サーボモータ４１〜第７サーボモータ４７のトルク容量を必要最小限にできるため、第１サーボモータ４１〜第７サーボモータ４７の小型化、ひいてはロボットの小型化を実現できる。
（２）本実施形態の制御方法は、手先位置姿勢を目標値とした拘束条件の下で、冗長自由度が許容するリンク位置姿勢を示す姿勢パラメータΦを順次変化させる毎に、各リンクの関節軸の慣性力、遠心力・コリオリ力、重力、摩擦トルク及びアクチュエータ慣性トルクに基づく負荷トルクを算出した。さらに、姿勢パラメータΦの変化の中で、前記負荷トルクと第１サーボモータ４１〜第７サーボモータ４７（回転系アクチュエータ）の定格トルク比が最小となるリンク位置姿勢を求めるようにした。さらに、手先位置姿勢を目標値とした各関節軸の第１サーボモータ４１〜第７サーボモータ４７の制御指令に、前記負荷トルクと第１サーボモータ４１〜第７サーボモータ４７の定格トルク比が最小となるときの各負荷トルクとなるフィードフォワード値を付与するようにした。この結果、上記（１）と同様の効果を奏することができる。
（３） 本実施形態の制御方法は、負荷トルクには、摩擦トルクが含まれていることを特徴とする。この結果、本実施形態の制御方法によれば、負荷トルクに摩擦トルクが含まれることにより、さらに、制御性の精度を高めることができる。
（４） 本実施形態のロボット制御装置は、手先位置姿勢を目標値とした拘束条件の下で、冗長自由度が許容するリンク位置姿勢を示す姿勢パラメータΦを順次変化させる毎に、各リンクの関節軸の慣性力、遠心力・コリオリ力、重力、摩擦トルク及びアクチュエータ慣性トルクに基づく負荷トルクを算出するＣＰＵ９１（負荷トルク算出部）を備えている。また、前記ＣＰＵ９１は、姿勢パラメータΦの変化の中で、負荷トルクと第１サーボモータ４１〜第７サーボモータ４７（回転系アクチュエータ）の定格トルク比が最小となるリンク位置姿勢を求めるリンク姿勢算出部として機能する。
さらに、ＣＰＵ９１は、手先位置姿勢を目標値とした各関節軸の第１サーボモータ４１〜第７サーボモータ４７の制御指令に、負荷トルクと第１サーボモータ４１〜第７サーボモータ４７の定格トルク比が最小となるときの各負荷トルクとなるフィードフォワード値を付与する付与部として機能する。この結果、本実施形態によれば、冗長自由度を利用して制御性を向上することができ、さらには、第１サーボモータ４１〜第７サーボモータ４７のトルク容量を必要最小限にできるため、第１サーボモータ４１〜第７サーボモータ４７の小型化、ひいてはロボットの小型化を実現できるロボット制御装置を提供できる。
（５） 本実施形態のロボット制御装置は、ＣＰＵ９１（負荷トルク算出部）は、各リンクの関節軸の慣性力と遠心力・コリオリ力と重力の他に摩擦トルクを含む負荷トルクを算出する。この結果、本実施形態のロボット制御装置によれば、負荷トルクに摩擦トルクが含まれることにより、さらに、制御性の精度が高めることができる。
なお、本発明の実施形態は前記実施形態に限定されるものではなく、下記のように変更しても良い。
・ 前記実施形態では、Ｓ１０〜Ｓ５０の処理及びＳ２１〜Ｓ２６の処理は、作業プログラムの実行時に負荷トルク／定格トルク比最小姿勢の導出をリアルタイムに行うようにしている。この制御方法に代えて、ロボット制御システムとして具体化してもよい。
具体的には、図６に示すように、ティーチングプレイバック方式で作成された作業プログラムを、コントローラーＲＣと通信が可能に接続されたコンピュータ１００（例えばコントローラーＲＣの上位のコンピュータ）がシミュレーションで作業プログラムを実行して、該コンピュータ１００が、負荷トルク算出部として機能して、作業プログラムのステップに記述されている手先位置姿勢を目標値とした拘束条件の下で、冗長自由度が許容するリンク位置姿勢を示す姿勢パラメータを順次変化させる毎に、少なくとも各リンクの関節軸の慣性力と遠心力・コリオリ力と重力に基づく負荷トルクを算出する。なお、負荷トルクには、前記実施形態と同様に、摩擦トルク、アクチュエータ慣性トルクの少なくともいずれかを加えても良い。そして、コンピュータ１００は、リンク姿勢算出部として、姿勢パラメータΦの変化の中で、負荷トルクと前記回転系アクチュエータの定格トルク比が最小となるリンク位置姿勢を求める。なお、図６のコントローラーＲＣは、説明の便宜上、ＣＰＵ９１と記憶部９４のみ図示しているが、前記実施形態と同様の構成を有する。
この求めた負荷トルクと第１サーボモータ４１〜第７サーボモータ４７の定格トルク比が最小となるリンク位置姿勢を、該外部コンピュータ１００からコントローラーＲＣに出力して記憶部９４に前記作業プログラムに記述された複数のステップにそれぞれ関連付けて記憶させる。なお、前記作業プログラムに記述された複数のステップには、教示点、教示姿勢、速度データが記述されている。
そして、コントローラーＲＣのＣＰＵ９１は、前記作業プログラムの実行時に、前記実施形態と同様に付与部として、手先位置姿勢を目標値とした各関節軸の第１サーボモータ４１〜第７サーボモータ４７（回転系アクチュエータ）の制御指令に、記憶部９４に記憶した前記負荷トルクと第１サーボモータ４１〜第７サーボモータ４７（回転系アクチュエータ）の定格トルク比が前記最小となるときの各負荷トルクとなるフィードフォワード値を付与する。
このようにしても、前記実施形態と同様の効果を実現することができる。
・ 前記実施形態では、アクチュエータをサーボモータとしてのＡＣモータを使用したが、ＤＣモータでもよく、ステッピングモータ等を使用してもよい。
・前記実施形態では、式（３）において、第４項の摩擦トルク、及び第５項はアクチュエータ慣性トルクを加算するようにしたが、いずれか一方、或いは両方の加算を省略するようにしてもよい。この場合は、前記実施形態よりは制御性が若干劣るが、これらの場合でも、従来技術よりも制御性が向上する。
・ 前記実施形態では、１つの冗長自由度をもつようにしたが、１つの冗長自由度に限定するものではなく、２つ以上の冗長自由度をもつロボット制御装置及び制御方法にも適用できる。
ＲＣ…コントローラー（制御装置）、
１０…マニピュレータ、１１〜１８…リンク、
４１〜４７…サーボモータ（回転系アクチュエータ）、
９１…ＣＰＵ（リンク姿勢算出部、負荷トルク算出部、付与部）、
９４…記憶部。

Claims (6)

  1. 作業自由度に対して少なくとも１つの冗長自由度を備えるように複数のリンクが各関節軸にて連結されたマニピュレータを備え、前記関節軸を該関節毎に設けられた回転系アクチュエータにより駆動するロボットの制御方法において、
    手先位置姿勢を目標値とした拘束条件の下で、前記冗長自由度が許容するリンク位置姿勢を変化させた場合の、少なくとも各リンクの関節軸の慣性力と遠心力・コリオリ力と重力に基づく負荷トルクを算出し、
    変化させた場合の前記リンク位置姿勢の中で、前記負荷トルクと前記回転系アクチュエータの定格トルク比が最小となるリンク位置姿勢を求め、
    前記手先位置姿勢を目標値とした各関節軸の回転系アクチュエータの制御指令に、前記負荷トルクと前記回転系アクチュエータの定格トルク比が前記最小となるときの各負荷トルクとなるフィードフォワード値を付与することを特徴とするロボットの制御方法。
  2. 作業自由度に対して少なくとも１つの冗長自由度を備えるように複数のリンクが各関節軸にて連結されたマニピュレータを備え、前記関節軸を該関節毎に設けられた回転系アクチュエータにより駆動するロボットの制御方法において、
    手先位置姿勢を目標値とした拘束条件の下で、前記冗長自由度が許容するリンク位置姿勢を示す姿勢パラメータを順次変化させる毎に、少なくとも各リンクの関節軸の慣性力と遠心力・コリオリ力と重力に基づく負荷トルクを算出し、
    前記姿勢パラメータの変化の中で、前記負荷トルクと前記回転系アクチュエータの定格トルク比が最小となるリンク位置姿勢を求め、
    前記手先位置姿勢を目標値とした各関節軸の回転系アクチュエータの制御指令に、前記負荷トルクと前記回転系アクチュエータの定格トルク比が前記最小となるときの各負荷トルクとなるフィードフォワード値を付与することを特徴とするロボットの制御方法。
  3. 前記負荷トルクには、摩擦トルクが含まれていることを特徴とする請求項１または請求項２に記載のロボットの制御方法。
  4. 作業自由度に対して少なくとも１つの冗長自由度を備えるように複数のリンクが各関節軸にて連結されたマニピュレータを備え、前記関節軸を該関節毎に設けられた回転系アクチュエータにより駆動するロボット制御装置において、
    手先位置姿勢を目標値とした拘束条件の下で、前記冗長自由度が許容するリンク位置姿勢を示す姿勢パラメータを順次変化させる毎に、少なくとも各リンクの関節軸の慣性力と遠心力・コリオリ力と重力に基づく負荷トルクを算出する負荷トルク算出部と、
    前記姿勢パラメータの変化の中で、前記負荷トルクと前記回転系アクチュエータの定格トルク比が最小となるリンク位置姿勢を求めるリンク姿勢算出部と、
    前記手先位置姿勢を目標値とした各関節軸の回転系アクチュエータの制御指令に、前記負荷トルクと前記回転系アクチュエータの定格トルク比が前記最小となるときの各負荷トルクとなるフィードフォワード値を付与する付与部を備えることを特徴とするロボット制御装置。
  5. 前記負荷トルク算出部は、各リンクの関節軸の慣性力と遠心力・コリオリ力と重力の他に摩擦トルクを含む負荷トルクを算出することを特徴とする請求項４に記載のロボット制御装置。
  6. 作業自由度に対して少なくとも１つの冗長自由度を備えるように複数のリンクが各関節軸にて連結されたマニピュレータを備え、前記関節軸を該関節毎に設けられた回転系アクチュエータにより駆動するロボット制御システムにおいて、
    手先位置姿勢を目標値とした拘束条件の下で、前記冗長自由度が許容するリンク位置姿勢を示す姿勢パラメータを順次変化させる毎に、少なくとも各リンクの関節軸の慣性力と遠心力・コリオリ力と重力に基づく負荷トルクを算出する負荷トルク算出部と、
    前記姿勢パラメータの変化の中で、前記負荷トルクと前記回転系アクチュエータの定格トルク比が最小となるリンク位置姿勢を求めるリンク姿勢算出部と、
    前記手先位置姿勢を目標値とした各関節軸の回転系アクチュエータの制御指令に、前記負荷トルクと前記回転系アクチュエータの定格トルク比が前記最小となるときの各負荷トルクとなるフィードフォワード値を付与する付与部を備えることを特徴とするロボット制御システム。
JP2012059137A 2012-03-15 2012-03-15 ロボットの制御方法及びロボット制御装置、並びにロボット制御システム Expired - Fee Related JP5895628B2 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2012059137A JP5895628B2 (ja) 2012-03-15 2012-03-15 ロボットの制御方法及びロボット制御装置、並びにロボット制御システム
CN201310076023.6A CN103302667B (zh) 2012-03-15 2013-03-11 机器人控制方法、机器人控制装置和机器人控制系统
US13/795,967 US9002519B2 (en) 2012-03-15 2013-03-12 Robot control method, robot control device, and robot control system
EP13158892.3A EP2639020A3 (en) 2012-03-15 2013-03-13 Robot control method, robot control device, and robot control system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2012059137A JP5895628B2 (ja) 2012-03-15 2012-03-15 ロボットの制御方法及びロボット制御装置、並びにロボット制御システム

Publications (2)

Publication Number Publication Date
JP2013193131A true JP2013193131A (ja) 2013-09-30
JP5895628B2 JP5895628B2 (ja) 2016-03-30

Family

ID=47891434

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2012059137A Expired - Fee Related JP5895628B2 (ja) 2012-03-15 2012-03-15 ロボットの制御方法及びロボット制御装置、並びにロボット制御システム

Country Status (4)

Country Link
US (1) US9002519B2 (ja)
EP (1) EP2639020A3 (ja)
JP (1) JP5895628B2 (ja)
CN (1) CN103302667B (ja)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105242677A (zh) * 2015-07-31 2016-01-13 中国人民解放军国防科学技术大学 四足机器人双足支撑相位力位混合控制方法
CN105404156A (zh) * 2015-12-31 2016-03-16 微创（上海）医疗机器人有限公司 触觉反馈装置及其变阻尼控制方法和应用
CN112894764A (zh) * 2019-12-03 2021-06-04 台达电子工业股份有限公司 机械手臂系统及机械手臂控制方法
CN112959297A (zh) * 2021-01-26 2021-06-15 清华大学 驱动冗余并联机器人的驱动力优化方法
CN114516052A (zh) * 2022-03-23 2022-05-20 杭州湖西云百生科技有限公司 并行实时高性能多轴机械臂的动力学控制方法及系统

Families Citing this family (58)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9566710B2 (en) 2011-06-02 2017-02-14 Brain Corporation Apparatus and methods for operating robotic devices using selective state space training
JP5938954B2 (ja) * 2012-03-06 2016-06-22 株式会社ジェイテクト ロボットのキャリブレーション方法及びキャリブレーション装置
JP6173677B2 (ja) * 2012-08-09 2017-08-02 日本電産サンキョー株式会社 産業用ロボットの原点位置復帰方法
US9486918B1 (en) * 2013-03-13 2016-11-08 Hrl Laboratories, Llc System and method for quick scripting of tasks for autonomous robotic manipulation
US9764468B2 (en) 2013-03-15 2017-09-19 Brain Corporation Adaptive predictor apparatus and methods
US9242372B2 (en) 2013-05-31 2016-01-26 Brain Corporation Adaptive robotic interface apparatus and methods
US9384443B2 (en) 2013-06-14 2016-07-05 Brain Corporation Robotic training apparatus and methods
US9792546B2 (en) 2013-06-14 2017-10-17 Brain Corporation Hierarchical robotic controller apparatus and methods
US9314924B1 (en) 2013-06-14 2016-04-19 Brain Corporation Predictive robotic controller apparatus and methods
US9579789B2 (en) 2013-09-27 2017-02-28 Brain Corporation Apparatus and methods for training of robotic control arbitration
JP6314426B2 (ja) 2013-10-31 2018-04-25 セイコーエプソン株式会社 ロボット制御装置およびロボット制御方法
US9463571B2 (en) 2013-11-01 2016-10-11 Brian Corporation Apparatus and methods for online training of robots
US9597797B2 (en) 2013-11-01 2017-03-21 Brain Corporation Apparatus and methods for haptic training of robots
US9505133B2 (en) * 2013-12-13 2016-11-29 Canon Kabushiki Kaisha Robot apparatus, robot controlling method, program and recording medium
US9358685B2 (en) * 2014-02-03 2016-06-07 Brain Corporation Apparatus and methods for control of robot actions based on corrective user inputs
JP5946859B2 (ja) * 2014-04-14 2016-07-06 ファナック株式会社 力に応じて動かすロボットのロボット制御装置およびロボットシステム
US9630318B2 (en) 2014-10-02 2017-04-25 Brain Corporation Feature detection apparatus and methods for training of robotic navigation
US9717387B1 (en) 2015-02-26 2017-08-01 Brain Corporation Apparatus and methods for programming and training of robotic household appliances
EP3294182B1 (en) * 2015-05-15 2020-04-01 Intuitive Surgical Operations Inc. System for force or torque limit compensation
JP6652292B2 (ja) * 2015-09-24 2020-02-19 キヤノン株式会社 制御方法、制御プログラム、ロボットシステム、回転駆動装置の制御方法、およびロボット装置
JP6648469B2 (ja) * 2015-10-07 2020-02-14 セイコーエプソン株式会社 ロボットシステム、及びロボット制御装置
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
CN105676896B (zh) * 2016-01-06 2018-12-07 西安交通大学 一种应用于机器人伺服系统的前馈控制方法
DE102016000187B3 (de) * 2016-01-11 2017-01-26 Kuka Roboter Gmbh Bestimmung einer Orientierung eines Roboters relativ zu einer Gravitationsrichtung
DE102017000063B4 (de) * 2016-01-14 2019-10-31 Fanuc Corporation Robotereinrichtung mit Lernfunktion
EP3436876B1 (en) * 2016-03-29 2021-07-07 Cognibotics AB Method, constraining device and system for determining geometric properties of a manipulator
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
CN107650121B (zh) * 2016-07-26 2022-07-01 深圳力合精密装备科技有限公司 一种用于机器人的控制方法
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
US10351189B2 (en) 2016-12-13 2019-07-16 Boston Dynamics, Inc. Whole body manipulation on a legged robot using dynamic balance
JP6464205B2 (ja) * 2017-01-17 2019-02-06 ファナック株式会社 ロボット制御装置
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
JP2018202504A (ja) * 2017-05-31 2018-12-27 ソニー株式会社 医療用支持アームシステム、医療用支持アームの制御方法、および医療用支持アームの制御装置
TWI642523B (zh) * 2017-09-21 2018-12-01 上銀科技股份有限公司 用於機械臂之負載估測重力補償的方法及其負載估測重力補償系統
CN108638060B (zh) * 2018-05-03 2021-09-28 大连理工大学 多自由度机器人参数标定中冗余参数分析剔除方法
JP7124440B2 (ja) * 2018-05-23 2022-08-24 セイコーエプソン株式会社 ロボット制御装置およびロボットシステム
WO2020002473A1 (en) * 2018-06-26 2020-01-02 Subblue Robotics Aps Robot arm, remotely operated vehicle and method of cleaning a sub-surface structure
CN109129475B (zh) * 2018-08-15 2021-02-02 珠海格力电器股份有限公司 机械臂的重力补偿方法、装置、系统及存储介质
JP7247572B2 (ja) * 2018-12-17 2023-03-29 京セラドキュメントソリューションズ株式会社 制御装置
DE102019101595B3 (de) * 2019-01-23 2020-03-12 Franka Emika Gmbh Verfahren zum Ermitteln einer Gewichtskraft und eines Schwerpunktes einer Robotermanipulatorlast
TWI708165B (zh) * 2019-04-17 2020-10-21 黃勤鎰 動感模擬系統
JP6906711B1 (ja) * 2020-03-26 2021-07-21 三菱電機株式会社 摩擦補償装置、衝突検知装置、トルクフィードフォワード演算装置およびロボット制御装置並びに摩擦補償方法
US11691285B2 (en) * 2020-05-07 2023-07-04 Mujin, Inc. Method and computing system for estimating parameter for robot operation
CN111673716A (zh) * 2020-06-08 2020-09-18 中冶南方城市建设工程技术有限公司 灵巧手定位方法及控制系统
CN111872942B (zh) * 2020-08-07 2023-06-20 四川福莫斯工业技术有限公司 一种多轴机器人的扭矩前馈方法
CN112045687B (zh) * 2020-09-15 2022-03-25 杭州新剑机器人技术股份有限公司 用于操作机械臂的动力学计算方法及机械臂的中央控制方法和系统
CN112171670B (zh) * 2020-09-22 2024-01-23 北京石油化工学院 一种康复机器人等张运动控制方法及系统
JP7276359B2 (ja) * 2021-01-07 2023-05-18 株式会社安川電機 動作指令生成装置、機構制御システム、コンピュータプログラム、動作指令生成方法及び機構制御方法
CN112894818B (zh) * 2021-01-28 2022-08-05 西安交通大学 一种移动操作机器人的零空间运动分配方法
DE102022206320A1 (de) * 2022-06-23 2023-12-28 Kuka Deutschland Gmbh Verfahren und System zum Betreiben eines Roboters
CN115816461B (zh) * 2022-12-26 2023-10-24 睿尔曼智能科技（北京）有限公司 一种机械臂负载质心范围计算与负载曲线图绘制方法

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60263206A (ja) * 1984-06-11 1985-12-26 Nissan Motor Co Ltd マニピユレ−タの制御装置
JPS62212805A (ja) * 1986-03-14 1987-09-18 Fanuc Ltd ロボツトア−ムの制御装置
US4999553A (en) * 1989-12-28 1991-03-12 The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration Method and apparatus for configuration control of redundant robots
JPH03240109A (ja) * 1990-02-16 1991-10-25 Komatsu Ltd ロボットの制御方法
JPH06143172A (ja) * 1992-10-30 1994-05-24 Fujitsu Ltd 冗長マニピュレータの制御方式
JPH06259126A (ja) * 1993-03-04 1994-09-16 Nissan Motor Co Ltd ロボット動作のシミュレーション装置
JPH081566A (ja) * 1994-06-22 1996-01-09 Toshiba Corp ロボット制御装置
JPH09201784A (ja) * 1996-01-30 1997-08-05 Komatsu Ltd ロボットの教示装置
JPH09282020A (ja) * 1996-04-16 1997-10-31 Denso Corp サーボモータ駆動装置
JP2008238396A (ja) * 2007-03-26 2008-10-09 Honda Research Inst Europe Gmbh ロボットのモーションの発生及び制御のための装置ならびに方法

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0498304A (ja) 1990-08-10 1992-03-31 Nippon Telegr & Teleph Corp <Ntt> ロボットアームの計算トルク制御器
US5341459A (en) * 1991-05-09 1994-08-23 The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration Generalized compliant motion primitive
JP3357143B2 (ja) * 1993-09-30 2002-12-16 ファナック株式会社 ロボットの負荷をモニタするロボット制御装置
GB0309662D0 (en) * 2003-04-28 2003-06-04 Crampton Stephen Robot CMM arm
GB2420634A (en) * 2004-11-24 2006-05-31 Perry Slingsby Systems Ltd Control system for articulated manipulator arm
US7453227B2 (en) * 2005-12-20 2008-11-18 Intuitive Surgical, Inc. Medical robotic system with sliding mode control
JP4267027B2 (ja) * 2006-12-07 2009-05-27 ファナック株式会社 ロボット制御装置
JP5056241B2 (ja) * 2007-07-31 2012-10-24 株式会社不二越 ロボットシステム制御装置
JP2009066738A (ja) * 2007-09-18 2009-04-02 Yaskawa Electric Corp ロボットの教示装置
KR101479233B1 (ko) * 2008-05-13 2015-01-05 삼성전자 주식회사 로봇 및 그 협조작업 제어방법
US8126114B2 (en) * 2008-09-12 2012-02-28 Accuray Incorporated Seven or more degrees of freedom robotic manipulator having at least one redundant joint
JP5353500B2 (ja) * 2009-07-08 2013-11-27 株式会社安川電機 ロボット
US8442684B2 (en) * 2009-09-22 2013-05-14 GM Global Technology Operations LLC Integrated high-speed torque control system for a robotic joint

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60263206A (ja) * 1984-06-11 1985-12-26 Nissan Motor Co Ltd マニピユレ−タの制御装置
JPS62212805A (ja) * 1986-03-14 1987-09-18 Fanuc Ltd ロボツトア−ムの制御装置
US4999553A (en) * 1989-12-28 1991-03-12 The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration Method and apparatus for configuration control of redundant robots
JPH03240109A (ja) * 1990-02-16 1991-10-25 Komatsu Ltd ロボットの制御方法
JPH06143172A (ja) * 1992-10-30 1994-05-24 Fujitsu Ltd 冗長マニピュレータの制御方式
JPH06259126A (ja) * 1993-03-04 1994-09-16 Nissan Motor Co Ltd ロボット動作のシミュレーション装置
JPH081566A (ja) * 1994-06-22 1996-01-09 Toshiba Corp ロボット制御装置
JPH09201784A (ja) * 1996-01-30 1997-08-05 Komatsu Ltd ロボットの教示装置
JPH09282020A (ja) * 1996-04-16 1997-10-31 Denso Corp サーボモータ駆動装置
JP2008238396A (ja) * 2007-03-26 2008-10-09 Honda Research Inst Europe Gmbh ロボットのモーションの発生及び制御のための装置ならびに方法

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105242677A (zh) * 2015-07-31 2016-01-13 中国人民解放军国防科学技术大学 四足机器人双足支撑相位力位混合控制方法
CN105404156A (zh) * 2015-12-31 2016-03-16 微创（上海）医疗机器人有限公司 触觉反馈装置及其变阻尼控制方法和应用
CN112894764A (zh) * 2019-12-03 2021-06-04 台达电子工业股份有限公司 机械手臂系统及机械手臂控制方法
CN112959297A (zh) * 2021-01-26 2021-06-15 清华大学 驱动冗余并联机器人的驱动力优化方法
CN112959297B (zh) * 2021-01-26 2022-08-30 清华大学 驱动冗余并联机器人的驱动力优化方法
CN114516052A (zh) * 2022-03-23 2022-05-20 杭州湖西云百生科技有限公司 并行实时高性能多轴机械臂的动力学控制方法及系统
CN114516052B (zh) * 2022-03-23 2023-12-22 杭州湖西云百生科技有限公司 并行实时高性能多轴机械臂的动力学控制方法及系统

Also Published As

Publication number Publication date
CN103302667A (zh) 2013-09-18
US20130245829A1 (en) 2013-09-19
EP2639020A3 (en) 2017-01-04
CN103302667B (zh) 2016-08-03
US9002519B2 (en) 2015-04-07
EP2639020A2 (en) 2013-09-18
JP5895628B2 (ja) 2016-03-30

Similar Documents

Publication Publication Date Title
JP5895628B2 (ja) ロボットの制御方法及びロボット制御装置、並びにロボット制御システム
JP6504864B2 (ja) ロボット制御方法、ロボット装置、プログラム、記録媒体及び物品の製造方法
JP6314426B2 (ja) ロボット制御装置およびロボット制御方法
JP5946859B2 (ja) 力に応じて動かすロボットのロボット制御装置およびロボットシステム
JP6584102B2 (ja) ロボット装置、ロボット制御方法、プログラム、記録媒体、及び物品の製造方法
JP6512790B2 (ja) ロボット制御方法、ロボット装置、プログラム、記録媒体及び物品の製造方法
JP5701055B2 (ja) ７軸多関節ロボットの制御方法、制御プログラム及びロボット制御装置
JP5916583B2 (ja) 多関節ロボットのウィービング制御装置
JP2017124455A (ja) ロボット装置、ロボット制御方法、プログラム及び記録媒体
JP2018058181A (ja) 外乱オブザーバ及びロボット制御装置
JP2013223895A (ja) ロボット制御方法及びロボット制御装置
JP6697544B2 (ja) 最適化装置及びそれを備えた垂直型多関節ロボット
JP2012051043A (ja) ロボットシステムまたはロボット制御装置
JP6700679B2 (ja) 制御方法、物品の製造方法、ロボット装置、制御プログラム及び記録媒体
JP2013215839A (ja) 冗長自由度を持つロボットの制御方法及びロボット制御装置、並びにロボット制御システム
JP2013220501A (ja) ロボット制御方法及びロボット制御装置
JP2013226619A (ja) ロボット制御方法及びロボット制御装置
JP5184502B2 (ja) ロボットの関節機構の制御装置
JP4970492B2 (ja) 多関節ロボット
JP2014137626A (ja) ロボットの制御方法及びロボット制御装置
WO2018212199A1 (ja) 操作装置及びその運転方法
JP2013223896A (ja) ロボット制御方法及びロボット制御装置
JP2013215818A (ja) 冗長自由度を持つロボットの制御方法及びロボット制御装置、並びにロボット制御システム
JP2014159066A (ja) ロボット制御装置及びロボットの制御方法
JP2010036293A (ja) 多関節ロボット

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20150218

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20160125

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20160215

R150 Certificate of patent or registration of utility model

Ref document number: 5895628

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

LAPS Cancellation because of no payment of annual fees