JP6487067B2 - 環境接触を考慮したロボットのアクチュエータの開ループおよび閉ループ制御の方法及び装置 - Google Patents

環境接触を考慮したロボットのアクチュエータの開ループおよび閉ループ制御の方法及び装置 Download PDF

Info

Publication number
JP6487067B2
JP6487067B2 JP2017560508A JP2017560508A JP6487067B2 JP 6487067 B2 JP6487067 B2 JP 6487067B2 JP 2017560508 A JP2017560508 A JP 2017560508A JP 2017560508 A JP2017560508 A JP 2017560508A JP 6487067 B2 JP6487067 B2 JP 6487067B2
Authority
JP
Japan
Prior art keywords
time interval
time
joint
ext
actuator
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
JP2017560508A
Other languages
English (en)
Other versions
JP2018515351A (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.)
Cavos Bagatelle Verwaltungs & CoKg GmbH
Cavos Bagatelle Verwaltungs GmbH and Co KG
Original Assignee
Cavos Bagatelle Verwaltungs & CoKg GmbH
Cavos Bagatelle Verwaltungs GmbH and Co KG
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 Cavos Bagatelle Verwaltungs & CoKg GmbH, Cavos Bagatelle Verwaltungs GmbH and Co KG filed Critical Cavos Bagatelle Verwaltungs & CoKg GmbH
Publication of JP2018515351A publication Critical patent/JP2018515351A/ja
Application granted granted Critical
Publication of JP6487067B2 publication Critical patent/JP6487067B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1674Programme controls characterised by safety, monitoring, diagnostic
    • B25J9/1676Avoiding collision or forbidden zones
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02Sensing devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/06Safety devices
    • B25J19/063Safety devices working only upon contact with an outside object
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/40Robotics, robotics mapping to robotics vision
    • G05B2219/40201Detect contact, collision with human
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/40Robotics, robotics mapping to robotics vision
    • G05B2219/40202Human robot coexistence
    • YGENERAL 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
    • Y10TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10STECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10S901/00Robots
    • Y10S901/02Arm motion controller
    • Y10S901/09Closed loop, sensor feedback controls arm movement
    • YGENERAL 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
    • Y10TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10STECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10S901/00Robots
    • Y10S901/14Arm movement, spatial
    • Y10S901/15Jointed arm
    • YGENERAL 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
    • Y10TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10STECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10S901/00Robots
    • Y10S901/46Sensing device

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Description

本発明は、ロボットの周囲環境との機械的接触を考慮したロボットのアクチュエータの開ループおよび閉ループ制御の方法および装置に関し、当該ロボットは、アクチュエータにより駆動可能な関節継ぎ手によって互いに相対運動可能なように接続された少なくとも2つのパーツを有する。
アクチュエータ(ロボットアームのリンク等)によって運動可能なロボットのパーツの開ループおよび閉ループ制御において、機械的環境接触の検出と解釈とは、特にロボットと人間との相互作用および共同作業において、重要である。ここで鍵となるのは、望ましい接触イベントと、望ましくない接触イベント、すなわち衝突とを見分けることである。通常、望ましい接触イベントは、対象物を取り扱うなどといったロボットのタスク、および/または予め定義された相互作用範囲におけるロボットと人間との相互作用によって生じる。望ましくない接触イベントは、望ましい接触イベントを除く全ての接触イベントである。これらは、特に、ロボットの周囲環境における予め定義された相互作用範囲に含まれない対象物や人物との衝突、または周囲環境自体との衝突である。
本発明の目的は、環境接触を考慮したロボットのアクチュエータの開ループおよび閉ループ制御の改良された方法および改良された装置を提供することである。
本発明は、独立請求項の特徴から導かれる。好都合な改良点および実施形態は、従属請求項の主題である。本発明のさらなる特徴、適用オプション、および利点は、以下の説明、および図に示す本発明の例示的実施形態の説明から導かれる。
方法に関する本目的の様態は、アクチュエータにより駆動可能な関節継ぎ手によって接続された少なくとも2つのパーツを有するロボットのアクチュエータの、環境接触を考慮した、開ループおよび閉ループ制御の方法によって実現される。これらのパーツは、ロボットアームのリンクであってもよく、または人間の形をしたロボットの頭部、胴部、もしくは四肢であってもよい。特に、ロボットは、アクチュエータによって駆動可能な複数の関節継ぎ手によって接続された複数のパーツを有してもよい。
本方法は、以下のステップを含む。第1のステップにおいて、センサシステムを用いて、一次元的または多次元的な時間依存性変数G(t)であって、時間に応じてパーツに対する1以上の外部接触力Fextおよび/または1以上の外部モーメントMextの作用を表すために用いることができる変数G(t)を判定して格納する。特に、変数G(t)は、多次元的、つまり複数の要素g(t)を含むことができる。G(t)=[g(t),g(t),g(t),g(t),等]。例えば、変数G(t)は、1以上の力、および/または1以上のトルク、および/または1以上の機械的ストレス、および/または1以上の圧力を表してもよく、またはそこから判定される1以上の一次元的もしくは多次元的な変数を表してもよい。変数G(t)の要素は、j番目の関節継ぎ手またはj番目のパーツG(t)であってもよく、言い換えると、変数G(t)の要素は、パーツのうち複数および/または関節継ぎ手のうち複数のものについてそれぞれ判定することができる。
好都合には、センサシステムは、力、モーメント、ストレス、および/または圧力を検出する測定センサを備え、さらに、評価電子装置部と、少なくとも一時的に測定結果を格納する記憶部とを備える。好都合には、センサシステムは、近接センサ、すなわち機械的接触がまだ行われなくとも対象物が接近すると検出を行うセンサを備える。好都合には、センサシステムは、パーツの1つに設けられた少なくとも1つのセンサを備え、パーツに対する外力Fextおよび/またはモーメントMextの位置敏感検出のために平面状に設けられた複数のセンサ要素を備え、検出された外力Fextおよび/またはモーメントMextに基づいて変数G(t)を判定する。この改良点の一例として、パーツに作用する力、モーメント、ストレス、圧力、作用部分、その他を検出する触覚センサを備える「人工皮膚」の使用がある。特に、センサシステムは、関節継ぎ手にかかるトルク、および/または関節継ぎ手にかかる力、および/または関節継ぎ手にかかる加速度を検出するための、関節継ぎ手の1つに接続されたトルクセンサ、および/または力センサ、および/または加速度センサを含んでもよい。
好都合には、センサシステムは、測定センサの現在の測定データに基づいて、モーメント、ストレス、および/もしくは圧力を推定または予測するユニットを備える。好都合には、衝突の履歴測定データは、推定/予測において用いられる。
第2のステップにおいて、この変数G(t)の条件Bが与えられる。条件Bは、ロボットの状態について時間変異および/または時間依存性であってよい。例えば、単純な条件Bとして、G(t)の絶対値|G(t)|は限界値Fと等しいかこれより小さい、すなわち|G(t)|≦Fである。考えられる1次元の式として、例えば、G(t)=[g(t)]、F=[f]、i=1,2,…,Iであるとき、|g(t)|≦fである。好都合には、条件Bは、ロボットの動いているパーツに対する外力Fextおよび/またはモーメントMextの作用および非作用を区別することができるように選択され、この例の場合、条件Bが満たされる限り、外力Fextおよび/またはモーメントMextの作用が存在しないものとする。
好都合には、条件は、外力または外部モーメントの作用のないロボットの操作と、外力または外部モーメントが作用するロボットの操作との区別が可能となるように選択される。
好都合には、例えば、アクチュエータによって運動可能なパーツを有するロボットは、外力Fext(重力、および場合によりコリオリの力は除外される)の影響をうけることのないランダムな運動を行い、このような運動(力、モーメント、パルス、等)を記述するパラメータが、センサシステムによって検出・評価されることで、条件Bが決定されてもよい。よって、パラメータの範囲は、外力Fextの作用のないロボットの運動を定義する。
第3のステップにおいて、時刻tにおいて条件BがG(t)により満たされない場合、t=時間間隔の開始、t=時間間隔の終了、t∈T、t<tのとき、検出された変数G(t)の時間間隔T=[t,t]における
Figure 0006487067
を判定し、この特徴ベクターは以下の要素の全てを含む。
・時間間隔TにおけるG(t)のメジアンまたは平均値、
・時間間隔TにおけるG(t)の最小値および最大値、
・時間間隔Tにおけるメジアンまたは平均値からのG(t)の偏差値、
・時間間隔TにおけるG(t)の信号幅、
・時間間隔TにおけるG(t)の周波数スペクトル、
・周波数スペクトルの1以上の特性周波数。
上記の論理に従うと、tは、G(t)が予め定義された条件Bをもはや満たさない時点、つまり、パーツまたは関節継ぎ手のうち少なくとも1つに少なくとも1つの外力Fextまたはモーメントが作用し始める時点を示す。好都合には、時間間隔Tの開始時間tと、時間間隔Tの終了時間tは、時間依存性、つまりt=t(t)およびt=t(t)、または時間間隔Tの終了時間tのみが時間依存性、つまりt=t(t)である。前者においては、例えば、間隔Tは、時刻tとともに時系列にシフトしてもよい。後者においては、時間間隔Tは一方に対してより大きく、つまり、時刻tの時点は固定されてt(t)のみが時刻tとともにシフトする。好都合には、時間間隔Tは、10ms、20ms、50ms、75ms、100ms、250ms、500ms、750ms、1s、1.5s、2.0s、2.5s、3.0s、4.0s、5.0s、6.0s、7.0s、または10sの期間である。
第4のステップにおいて、予め定義されたカテゴリに基づいて、判定された
Figure 0006487067
を分類して分類結果KEを生成し、各カテゴリはパーツまたは関節継ぎ手の少なくとも1つと対象物との間の、対応する外部接触力Fextおよび/または外部接触モーメントMextによって引き起こされる接触タイプを示す。好都合には、「望ましい接触イベント」と「望ましくない接触イベント」との区別に加えて、カテゴリは接触をもたらす対象物のタイプに関する情報、例えば接触する対象物の接触部分が硬質な素材でできているかより硬質ではない素材でできているかなど、を与えることができる。カテゴリは、適切な一連の試験および/もしくはシミュレーション計算を行うことによって、または用意されたデータベース、例えばデータ「クラウド」から、容易に判定することができる。
好都合には、
Figure 0006487067
の分類は、サポートベクターマシン(SVM)、および/または隠れマルコフモデル、および/またはニューラル・ネットワーク、および/またはガウス過程、またはこれらの組み合わせによって行われる。
第5のステップにおいて、時間t>tであるときに、分類結果KEに応じて、少なくとも1つのアクチュエータの開ループおよび/または閉ループ制御を行う。好都合には、判定された分類結果KEに依存して、パーツの運動を停止、減速、加速、または逆方向への運動を開始させるように、アクチュエータの開ループおよび/または閉ループ制御が行われる。加速した運動および逆方向への運動は、ロボットまたは衝突対象の破損の可能性を軽減するための回避運動にあたる。
本発明の発明者は、提案される方法、特に提案される
Figure 0006487067
の要素を取りまとめたものが、望ましい接触イベントまたは望ましくない接触イベントである外力Fextの作用について非常に正確かつ堅牢な分析と分類とを可能とし、本方法が環境接触の考慮およびこれに対する反応を著しい向上によってロボットのアクチュエータの開ループおよび/または閉ループ制御を可能とすることを認識した。
好都合には、ロボットの環境接触の分析および分類は、この
Figure 0006487067
がさらに以下の要素を含む場合に向上させることができる。
・時間間隔TにおけるG(t)のシャノンエントロピーまたはシャノンエントロピー分布など、ある程度の情報内容、および/または
・時間間隔TにおけるG(t)の活動性、可動性、複雑性など、1以上のヨルト(Hjorth)パラメータ、および/または
・時間間隔TにおけるG(t)の1以上のエネルギー関連パラメータ、および/または
・時間間隔TにおけるG(t)の1以上の自己相関関連パラメータ、および/または
・時間間隔TにおけるG(t)の1以上の歪度パラメータ、および/または
・時間間隔TにおけるG(t)の1以上のスペクトル位相パラメータ、および/または
・時間間隔TにおけるG(t)の1以上のスペクトル振幅パラメータ。
また、好都合には、
Figure 0006487067
は、時系列に交互に配置された2つ以上の分類子のパラメータを含むことができ、この分類子は異なる時間間隔Tについてのパラメータを判定することもできる。
また、本発明の目的は、上記の方法をデータ処理装置上で行うことができるように構成されるデータ処理装置を備えるコンピュータシステムによって実現される。
また、本発明の目的は、電子的に読み取り可能な制御信号を有するデジタル記憶媒体によって実現され、この制御信号は、プログラム可能なコンピュータシステムと、上記の方法を行うように連携することができる。
また、本発明の目的は、プログラムコードがデータ処理装置上で実行されると上記の方法を行う機械可読キャリアに格納されたプログラムコードを含む、コンピュータプログラムプロダクトによって実現される。
最後に、本発明は、プログラムがデータ処理装置上で実行されると上記の方法を行うプログラムコードを含む、コンピュータプログラムに関する。このため、データ処理装置は、関連技術分野で知られる任意のコンピュータシステムとして構成することができる。
装置に関する本発明の様態は、アクチュエータにより駆動可能な関節継ぎ手によって接続された少なくとも2つのパーツを有するロボットのアクチュエータの、環境接触を考慮した、開ループおよび閉ループ制御を行う装置によって実現され、この装置は、時間に応じてパーツに対する1以上の外部接触力Fextおよび/または1以上の外部モーメントMextの作用を表すために用いることができる時間依存変数G(t)を判定して格納するセンサシステムと、当該変数G(t)の条件Bを与えるインターフェースと、時刻tにおいて条件BがG(t)により満たされない場合、t=時間間隔の開始、t=時間間隔の終了、t∈T、t<tのとき、検出された変数G(t)の時間間隔T=[t,t]における
Figure 0006487067
を判定するよう構成される評価部であって、特徴ベクターが、時間間隔TにおけるG(t)のメジアンまたは平均値、時間間隔TにおけるG(t)の最小値および最大値、時間間隔Tにおけるメジアンまたは平均値からのG(t)の偏差値、時間間隔TにおけるG(t)の信号幅、時間間隔TにおけるG(t)の周波数スペクトル、周波数スペクトルの1以上の特性周波数、の要素を含む、評価部と、可能性のある
Figure 0006487067
の予め定義されたカテゴリに基づいて、
Figure 0006487067
を分類して分類結果KEを生成する分類部であって、各カテゴリはパーツと周囲環境の対象物との間の、対応する外部接触力Fextおよび/または外部接触モーメントMextによって引き起こされる、接触タイプを示す、分類部と、分類結果KEに応じて、アクチュエータの開ループおよび閉ループ制御を行うユニットと、を備える。
好都合には、センサシステムのセンサは、近接センサと力センサとの組み合わせとすることができ、力センサは必ずしもプッシュとプルとを区別可能である必要はない(プッシュする力かプルする力かは、力が作用する本体の側に関する情報の結果である)。この場合、例えば、近接センサがこの曖昧さを解決する。
提案される装置の改良点および利点は、提案される方法についての議論を対応または類似の用法で当てはめることにより導かれる。
さらなる利点、特徴、および詳細は、少なくとも一例示的実施形態について、必要であれば図面を参照して詳細に記載する説明から明らかとなろう。同一のパーツ、または類似のパーツ、および/または同等の機能を有するパーツは、同じ参照符号で示される。
図1は、本発明にかかる方法のフローチャートである。 図2は、本発明にかかる装置の模式的構成を示す図である。
図1は、本発明にかかる、環境接触を考慮したロボットアームの3つのアクチュエータの開ループおよび閉ループ制御の方法のフローチャートである。本例示的実施形態における当該ロボットアームは、3つの関節継ぎ手により直列に接続された4つのアーム部を備え、各関節継ぎ手はアクチュエータの1つによって駆動可能である。また、本例示的実施形態において、3つの関節継ぎ手は、それぞれ、モーメント測定値m(t)を検出するモーメントセンサを備え、iは1、2、3である。時間の経過と共に、各モーメントセンサは、測定値m(t)を時系列に検出する。
モーメントセンサに加えて、センサシステムは、評価部と記憶部とを備える。第1のステップ101において、本例では、センサシステムは、モーメント測定値m(t)に基づいて、ロボットアームに作用する時間依存総モーメントG(t)を判定する。
一般に、慣性力、コリオリの力、および重力を考慮する必要があるため、モーメント測定値m(t)は外部総モーメントG(t)を直接的に導き出すものではない。このため、一般的にはまず外部総モーメントG(t)を推定、または少なくとも(加速度センサがある場合には)代数的に判定する必要がある。
したがって、本例示的実施形態において、変数G(t)はスカラー変数であり、時間に応じてロボットアームに対する1以上の外部接触力Fextおよび/または1以上の外部モーメントMextの作用を表すために用いることができるものである。また、当然ながら、変数G(t)は多次元的であってもよい。例えば、単純な多次元的ケースでは、G(t)=G(t)=[g(t),g(t),g(t)]=m(t)=[m(t),m(t),m(t)]である。
第2のステップ102において、変数G(t)の条件Bが与えられるが、このケースでは条件G(t)≦Fである。条件Bまたは限界値Fは、ロボットアームとの環境接触がおきない限り、すなわち望ましい接触イベントも望ましくない接触イベントも存在しない限り条件Bを満たすよう、選択される。このため、対応する限界値Fを、環境接触を生じないランダムな動作をロボットアームが行う一連の試験において判定することができる。アクチュエータの閉ループ制御は、外部トルクおよび/または外力の測定または推定を向上させることを目的とする較正ステップを含む。
時刻tにおいて条件BがG(t)により満たされない場合、すなわち環境接触が生じる場合、第3のステップ103において、検出された変数G(t)の時間間隔T=[t,t]における
Figure 0006487067
が判定される。ここで、t=時間間隔の開始、t=時間間隔の終了、t∈T、t<tである。この特徴ベクターは、以下の要素を全て含む。
・時間間隔TにおけるG(t)のメジアン、
・時間間隔TにおけるG(t)の最小値および最大値、
・時間間隔TにおけるメジアンからのG(t)の偏差値、
・時間間隔TにおけるG(t)の信号幅、
・時間間隔TにおけるG(t)の周波数スペクトル、
・周波数スペクトルの固有周波数。
第4のステップ104において、可能性のある
Figure 0006487067
の予め定義されたカテゴリに基づいて
Figure 0006487067
の分類を行い、分類結果KEを生成する。こうして、分類結果KEは特定の接触カテゴリを示すことになる。可能性のある
Figure 0006487067
の予め定義されたカテゴリは、例えば、多種多様な環境接触の状況を評価してカテゴリに分類する、対応する一連の試験に基づいて判定される。これらのカテゴリは、複数のアーム部および/または関節継ぎ手の1つと周囲環境の対象物との間の、外力Fextおよび/または接触モーメントMextよって引き起こされる、異なる接触タイプを示すことが好都合である。
第5のステップ105において、時間t>tであるときに、分類結果KEに応じて、アクチュエータの開ループおよび/または閉ループ制御が行われる。このため、開ループおよび/または閉ループ制御の仕様は、全ての分類結果に、ルックアップテーブルなどで与えられる。しかしながら、関連は微分方程式などの数式によって得られてもよい。
図2に、アクチュエータにより駆動可能な関節継ぎ手によって接続された少なくとも2つのパーツを有するロボットのアクチュエータの、環境接触を考慮した、開ループおよび閉ループ制御の装置を示す。本装置は、時間に応じてパーツに対する1以上の外部接触力Fextおよび/または1以上の外部モーメントMextの作用を表すために用いることができる時間依存変数G(t)を判定して格納するセンサシステム201と、当該変数G(t)の条件Bを与えるインターフェース202と、時刻tにおいて条件BがG(t)により満たされない場合、t=時間間隔の開始、t=時間間隔の終了、t∈T、t<tのとき、検出された変数G(t)の時間間隔T=[t,t]における
Figure 0006487067
を判定するよう構成される評価部であって、特徴ベクターが、時間間隔TにおけるG(t)のメジアンまたは平均値、時間間隔TにおけるG(t)の最小値および最大値、時間間隔Tにおけるメジアンまたは平均値からのG(t)の偏差値、時間間隔TにおけるG(t)の信号幅、時間間隔TにおけるG(t)の周波数スペクトル、周波数スペクトルの1以上の特性周波数、の要素を含む、評価部203と、予め定義されたカテゴリに基づいて、
Figure 0006487067
を分類して分類結果KEを生成する分類部であって、各カテゴリはパーツと周囲環境の対象物との間の、対応する外部接触力Fextおよび/または外部接触モーメントMextによって引き起こされる、接触タイプを示す分類部204と、分類結果KEに応じて、アクチュエータの開ループおよび/または閉ループ制御を行うユニット(205)と、を備える。
101〜105 方法ステップ
201 センサシステム
202 インターフェース
203 評価部
204 分類部
205 アクチュエータの開ループおよび/または閉ループ制御を行うユニット

Claims (10)

  1. アクチュエータにより駆動可能な関節継ぎ手によって接続された少なくとも2つのパーツを有するロボットのアクチュエータの、環境接触を考慮した、開ループおよび閉ループ制御の方法であって、
    センサシステムによって、時間依存性の一次元的または多次元的変数G(t)であって、時間に応じて前記パーツに対する1以上の外部接触力Fextおよび/または1以上の外部モーメントMextの作用を表すために用いることができる変数G(t)を判定して格納するステップと、
    前記変数G(t)の条件Bを与えるステップと、
    時刻tにおいて前記条件BがG(t)により満たされない場合、t=時間間隔の開始、t=時間間隔の終了、t∈T、t<tのとき、検出された前記変数G(t)の時間間隔T=[t,t]における
    Figure 0006487067
    を判定するステップであって、前記特徴ベクターが、
    前記時間間隔TにおけるG(t)のメジアンまたは平均値、
    前記時間間隔TにおけるG(t)の最小値および最大値、
    前記時間間隔Tにおける前記メジアンまたは前記平均値からのG(t)の偏差値、
    前記時間間隔TにおけるG(t)の信号幅、
    前記時間間隔TにおけるG(t)の周波数スペクトル、
    前記周波数スペクトルの1以上の特性周波数、
    の要素を含む、ステップと、
    予め定義されたカテゴリに基づいて、
    Figure 0006487067
    を分類して分類結果KEを生成するステップであって、各カテゴリは前記パーツまたは前記関節継ぎ手の1つと周囲環境の対象物との間の、対応する外部接触力Fextおよび/または外部接触モーメントMextによって引き起こされる、接触タイプを示す、ステップと、
    時間t>tであるときに、前記分類結果KEに応じて、前記アクチュエータの開ループおよび/または閉ループ制御を行うステップと、を含む、開ループおよび閉ループ制御の方法。
  2. Figure 0006487067
    前記時間間隔TにおけるG(t)のシャノンエントロピーまたはシャノンエントロピー分布、および/または
    前記時間間隔TにおけるG(t)のヨルト(Hjorth)パラメータ、および/または
    前記時間間隔TにおけるG(t)の1以上のエネルギーパラメータ、および/または
    前記時間間隔TにおけるG(t)の1以上の自己相関パラメータ、および/または
    前記時間間隔TにおけるG(t)の歪度パラメータ、および/または
    前記時間間隔TにおけるG(t)の1以上のスペクトル位相パラメータ、および/または
    前記時間間隔TにおけるG(t)の1以上のスペクトル振幅パラメータ、
    の要素を含む、請求項1に記載の方法。
  3. 前記時間間隔Tの開始時間tおよび前記時間間隔Tの終了時間tは時間依存性であって、すなわちt=t(t)およびt=t(t)であり、または前記時間間隔Tの終了時間tは時間依存性であって、すなわちt=t(t)である、
    請求項1または請求項2に記載の方法。
  4. 前記ロボットは、アクチュエータにより駆動可能な複数の関節継ぎ手によって接続された複数のパーツを有する、
    請求項1から請求項3のいずれか一項に記載の方法。
  5. 前記変数G(t)は、1以上の力、および/または1以上のトルク、および/または1以上の機械的ストレス、および/または1以上の圧力を表す、
    請求項1から請求項4のいずれか一項に記載の方法。
  6. 前記センサシステムは、前記パーツの1つに設けられた少なくとも1つのセンサを備え、前記パーツに対する外力Fextの位置敏感検出のために平面状に設けられた複数のセンサ要素を備え、検出された前記外力Fextに基づいて前記変数G(t)を判定する、
    請求項1から請求項5のいずれか一項に記載の方法。
  7. 前記センサシステムは、前記関節継ぎ手にかかるトルク、および/または前記関節継ぎ手にかかる力、および/または前記関節継ぎ手にかかる加速度を検出するための、前記関節継ぎ手の1つに接続されたトルクセンサ、および/または力センサ、および/または加速度センサを備える、
    請求項1から請求項6のいずれか一項に記載の方法。
  8. 1以上の前記パーツおよび/または1以上の関節継ぎ手のそれぞれについて前記変数G(t)を判定する、
    請求項1から請求項7のいずれか一項に記載の方法。
  9. 判定された前記分類結果KEに応じて、前記アクチュエータの開ループおよび/または閉ループ制御は、前記パーツの運動を停止、減速、加速、または逆方向への運動を開始させるように行われる、
    請求項1から請求項8のいずれか一項に記載の方法。
  10. アクチュエータにより駆動可能な関節継ぎ手によって接続された少なくとも2つのパーツを有するロボットのアクチュエータの、環境接触を考慮した、開ループおよび/または閉ループ制御を行い、請求項1から請求項9のいずれか一項に記載の方法を実行する装置であって、
    時間に応じて前記パーツに対する1以上の外部接触力Fextおよび/または1以上の外部モーメントMextの作用を表すために用いることができる時間依存変数G(t)を判定して格納するセンサシステムと、
    当該変数G(t)の条件Bを与えるインターフェースと、
    時刻tにおいて前記条件BがG(t)により満たされない場合、t=時間間隔の開始、t=時間間隔の終了、t∈T、t<tのとき、前記検出された変数G(t)の時間間隔T=[t,t]における
    Figure 0006487067
    を判定するよう構成される評価部であって、前記特徴ベクターが、
    前記時間間隔TにおけるG(t)のメジアンまたは平均値、
    前記時間間隔TにおけるG(t)の最小値および最大値、
    前記時間間隔Tにおける前記メジアンまたは前記平均値からのG(t)の偏差値、
    前記時間間隔TにおけるG(t)の信号幅、
    前記時間間隔TにおけるG(t)の周波数スペクトル、
    前記周波数スペクトルの1以上の特性周波数、
    の要素を含む、評価部と、
    予め定義されたカテゴリに基づいて、
    Figure 0006487067
    を分類して分類結果KEを生成する分類部であって、各カテゴリは前記パーツと周囲環境の対象物との間の、対応する外部接触力Fextおよび/または外部接触モーメントMextによって引き起こされる、接触タイプを示す、分類部と、
    前記分類結果KEに応じて、前記アクチュエータの開ループおよび/または閉ループ制御を行うユニットと、
    を備える装置。
JP2017560508A 2015-05-20 2016-05-10 環境接触を考慮したロボットのアクチュエータの開ループおよび閉ループ制御の方法及び装置 Active JP6487067B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
DE102015108010.9A DE102015108010B3 (de) 2015-05-20 2015-05-20 Steuern und Regeln von Aktoren eines Roboters unter Berücksichtigung von Umgebungskontakten
DE102015108010.9 2015-05-20
PCT/EP2016/060419 WO2016184726A1 (de) 2015-05-20 2016-05-10 Steuern und regeln von aktoren eines roboters unter berücksichtigung von umgebungskontakten

Publications (2)

Publication Number Publication Date
JP2018515351A JP2018515351A (ja) 2018-06-14
JP6487067B2 true JP6487067B2 (ja) 2019-03-20

Family

ID=55953164

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017560508A Active JP6487067B2 (ja) 2015-05-20 2016-05-10 環境接触を考慮したロボットのアクチュエータの開ループおよび閉ループ制御の方法及び装置

Country Status (9)

Country Link
US (1) US10710243B2 (ja)
EP (1) EP3297792B1 (ja)
JP (1) JP6487067B2 (ja)
KR (1) KR102003206B1 (ja)
CN (1) CN107969120B (ja)
DE (1) DE102015108010B3 (ja)
DK (1) DK3297792T3 (ja)
SG (1) SG11201709577QA (ja)
WO (1) WO2016184726A1 (ja)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102017118982A1 (de) * 2017-04-23 2018-10-25 Franka Emika Gmbh Roboter und Verfahren zum Betrieb eines Roboters
EP3755504A1 (en) * 2018-02-23 2020-12-30 ABB Schweiz AG Robot system and operation method
DE102018109320A1 (de) * 2018-04-19 2019-10-24 Gottfried Wilhelm Leibniz Universität Hannover Verfahren zur Erkennung einer Intention eines Partners gegenüber einer mehrgliedrigen aktuierten Kinematik
KR102285631B1 (ko) * 2018-11-26 2021-08-04 한국전자기술연구원 로봇피부를 이용한 충돌감지 시스템 및 방법
DE102019129338B3 (de) * 2019-10-30 2021-02-18 Pilz Gmbh & Co. Kg Modellprädiktive Interaktionsregelung
CN111546345B (zh) * 2020-05-26 2021-08-17 广州纳丽生物科技有限公司 一种基于接触动力学模型的肌肤材质力学性能测量方法
CN114603599A (zh) * 2020-12-08 2022-06-10 山东新松工业软件研究院股份有限公司 一种机器人碰撞检测方法、装置、计算机设备及存储介质
CN114310898B (zh) * 2022-01-07 2022-09-06 深圳威洛博机器人有限公司 一种机器手同步控制系统及控制方法

Family Cites Families (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003071778A (ja) * 2001-09-05 2003-03-12 National Institute Of Advanced Industrial & Technology ロボットアーム用触覚センサー
DE10226853B3 (de) * 2002-06-15 2004-02-19 Kuka Roboter Gmbh Verfahren zum Begrenzen der Krafteinwirkung eines Roboterteils
DE102007028390A1 (de) * 2007-06-15 2008-12-18 Abb Research Ltd. Prozesssteuerung, System und Verfahren zur automatisierten Anpassung von Prozessparametern wenigstens einer Handhabungsvorrichtung
JP5109573B2 (ja) * 2007-10-19 2012-12-26 ソニー株式会社 制御システム及び制御方法、並びにロボット装置
EP2364243B1 (en) * 2008-12-03 2012-08-01 ABB Research Ltd. A robot safety system and a method
JP2011240468A (ja) * 2010-05-21 2011-12-01 Toyota Motor Corp ロボットの接触種類判別システム
EP2586577A4 (en) * 2010-06-22 2013-12-04 Toshiba Kk ROBOT CONTROL DEVICE
EP2572838A1 (en) * 2010-08-31 2013-03-27 Kabushiki Kaisha Yaskawa Denki Robot, robot system, robot control device, and state determining method
DE102010063208A1 (de) * 2010-12-16 2012-06-21 Robert Bosch Gmbh Verfahren zum Betreiben einer Sicherungseinrichtung für eine Handhabungsvorrichtung, Sicherungseinrichtung für eine Handhabungsvorrichtung und Handhabungsvorrichtung
JP5902425B2 (ja) * 2011-09-21 2016-04-13 株式会社東芝 ロボット制御装置、外乱判定方法およびアクチュエータ制御方法
JP2013101020A (ja) * 2011-11-08 2013-05-23 Seiko Epson Corp センサー素子、力検出装置およびロボット
US8805584B2 (en) * 2011-11-22 2014-08-12 Disney Enterprises, Inc Kinematic and dynamic calibration methods for legged robots with force-controlled joints
JP5915214B2 (ja) * 2012-02-01 2016-05-11 セイコーエプソン株式会社 ロボット装置、組立て方法、及び組立てプログラム
KR101401415B1 (ko) * 2012-06-29 2014-05-30 한국과학기술연구원 접촉 및 힘 제어를 포함한 일관된 동작 생성을 위한 로봇 제어 장치 및 방법
DE102013212887B4 (de) * 2012-10-08 2019-08-01 Deutsches Zentrum für Luft- und Raumfahrt e.V. Verfahren zum Steuern einer Robotereinrichtung,Robotereinrichtung, Computerprogrammprodukt und Regler
DE102013110901B4 (de) * 2013-10-01 2022-11-10 Mercedes-Benz Group AG MRK Planungstechnologie
US9597797B2 (en) * 2013-11-01 2017-03-21 Brain Corporation Apparatus and methods for haptic training of robots
JP6252241B2 (ja) * 2014-02-27 2017-12-27 セイコーエプソン株式会社 力検出装置、およびロボット
CN103995984A (zh) * 2014-06-09 2014-08-20 武汉科技大学 一种基于椭圆约束的机器人路径规划方法和装置
DE102014114234B4 (de) * 2014-09-30 2020-06-25 Kastanienbaum GmbH Verfahren und Vorrichtung zur Steuerung/Regelung eines Roboter-Manipulators
US9481086B2 (en) * 2015-02-18 2016-11-01 Disney Enterprises, Inc. Control method for floating-base robots including generating feasible motions using time warping

Also Published As

Publication number Publication date
DK3297792T3 (da) 2019-06-24
KR20180028413A (ko) 2018-03-16
US20180161981A1 (en) 2018-06-14
CN107969120A (zh) 2018-04-27
DE102015108010B3 (de) 2016-06-02
EP3297792A1 (de) 2018-03-28
SG11201709577QA (en) 2017-12-28
CN107969120B (zh) 2020-12-04
US10710243B2 (en) 2020-07-14
EP3297792B1 (de) 2019-03-27
KR102003206B1 (ko) 2019-07-24
JP2018515351A (ja) 2018-06-14
WO2016184726A1 (de) 2016-11-24

Similar Documents

Publication Publication Date Title
JP6487067B2 (ja) 環境接触を考慮したロボットのアクチュエータの開ループおよび閉ループ制御の方法及び装置
JP6431017B2 (ja) 機械学習により外力の検出精度を向上させた人協調ロボットシステム
Dimeas et al. Human-robot collision detection and identification based on fuzzy and time series modelling
JP6494331B2 (ja) ロボット制御装置およびロボット制御方法
Hoelscher et al. Evaluation of tactile feature extraction for interactive object recognition
Reinecke et al. Experimental comparison of slip detection strategies by tactile sensing with the BioTac® on the DLR hand arm system
JP6897037B2 (ja) 作業性評価装置
US20200150601A1 (en) Solution for controlling a target system
US11305428B2 (en) Robot motion planning device, robotic system, and method
Platt et al. Using bayesian filtering to localize flexible materials during manipulation
US20180210407A1 (en) Control device, control program, and control system
Petković et al. Intelligent rotational direction control of passive robotic joint with embedded sensors
Bandyopadhyaya et al. Tactile sensing based softness classification using machine learning
CN108472809B (zh) 机器人和用于运行机器人的方法
Molchanov et al. Contact localization on grasped objects using tactile sensing
Schindeler et al. Online identification of environment hunt–crossley models using polynomial linearization
Armendariz et al. Force feedback controller based on fuzzy-rules emulated networks and Hertzian contact with ultrasound
US9868213B2 (en) Incidental robot-human contact detection
JPWO2020213062A1 (ja) モータ制御装置
Zhang et al. Robot collision detection without external sensors based on time-series analysis
WO2021060104A1 (ja) 情報処理装置、情報処理システム及び情報処理方法
Pan et al. A sensor glove for the interaction with a nursing-care assistive robot
Dimeas et al. Robot collision detection based on fuzzy identification and time series modelling
Bayer et al. Signal-based metamodels for predictive reliability analysis and virtual testing
US11656759B2 (en) Semitransparent tactile surface sensor and a method of sensing an interaction with an object using the semitransparent tactile surface sensor

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20180122

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20180302

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20190121

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20190220

R150 Certificate of patent or registration of utility model

Ref document number: 6487067

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250