JP2011056601A - 多関節ロボットシステム、多関節ロボット、力測定モジュール、力測定方法およびプログラム - Google Patents
多関節ロボットシステム、多関節ロボット、力測定モジュール、力測定方法およびプログラム Download PDFInfo
- Publication number
- JP2011056601A JP2011056601A JP2009206803A JP2009206803A JP2011056601A JP 2011056601 A JP2011056601 A JP 2011056601A JP 2009206803 A JP2009206803 A JP 2009206803A JP 2009206803 A JP2009206803 A JP 2009206803A JP 2011056601 A JP2011056601 A JP 2011056601A
- Authority
- JP
- Japan
- Prior art keywords
- joint
- force
- articulated robot
- link
- strain
- 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
Links
Landscapes
- Manipulator (AREA)
- Force Measurement Appropriate To Specific Purposes (AREA)
Abstract
【解決手段】 本発明の多関節ロボットは、関節部に設けられ、駆動力発生側の駆動軸および駆動力出力先のリンク174側の出力軸176それぞれに、軸心から離間した箇所で固定され、該箇所に作用する偶力に応じて弾性的に曲げ歪みを発生する歪み発生部材190と、歪み発生部材190に接して配置され、曲げ歪みを検出する歪みセンサとを含む。測定制御手段は、関節部の軸まわりに発生する負荷トルクを歪みセンサの出力値から算出し、仮想仕事の原理に従って関節部の負荷トルクからリンクに作用する力に換算する演算手段を含む。
【選択図】 図4
Description
以下、本発明の実施形態による多関節ロボットシステムの全体構成について、図1を参照しながら説明する。図1は、本発明の多関節ロボットシステムの実施形態を示す図である。本発明の多関節ロボットシステム100は、コンピュータ装置104により制御されており、コンピュータ装置104は、プログラミング言語、例えばアセンブラ、フォートラン、COBOL、C、C++などによるプログラミングの下で、本発明の力測定手法を適用するプログラムを実装している。
以下、本実施形態の多関節ロボットシステムにおける多関節ロボットの構造について、図2および図3を参照しながら説明する。図2および図3は、本発明で使用する多関節ロボットの実施形態を示す。図2は、6自由度多関節ロボットを示した関節モデル150を示す。図2に示す多関節ロボットは、6つの関節J1〜J6と、これら関節を介して連結される7つのリンクL1〜L7とを含んで構成される。基盤部GからはリンクL1が第1関節J1へと延びている。第1関節J1からは、リンクL2が第2関節J2へと延び、第2関節J2からは、リンクL3が第3関節J3まで延びている。第3関節J3から第4関節J4までは、リンクL4が延びている。第2関節J2および第3関節J3は、リンクL2、L3の軸に直交する方向に回転軸を有する曲げ関節とされており、第1関節J1および第4関節J4は、リンクL1,L4の軸を中心とする回転軸を有するねじり関節とされている。なお、リンクL1および第1関節J1は、基盤部Gに固定されたモータなどを用いて実装してもよい。
以下、多関節ロボット120の各関節周りに作用する負荷トルクを測定するトルクセンサ機構について、図4〜図7および図11を参照しながら説明する。図4は、多関節ロボット120の関節に設けられるトルクセンサ機構の概略を示す図である。なお、図4は、リンク軸に直交する方向に回転軸を有する曲げ関節にトルクセンサ機構が設けられている場合を例示する。
以下、上述したトルクセンサ機構を用いた多関節ロボットの力測定およびロボット制御について説明する。図8は、本発明の多関節ロボットシステムの力測定およびロボット制御の機能ブロック図である。図8に示すように、コンピュータ装置104は、本発明の処理を実行する制御処理モジュール302を実装しており、制御処理モジュール302は、IDE(International Device Electronics)やSCSI(Small Computer System Interface)などのインタフェース310を介して接続されたHDD108から、制御プログラムをCPU(図示せず)が呼び出し、実行空間を提供するRAM306にプログラムを展開してプログラムを実行させることにより実現される。
Claims (11)
- 複数のリンクが1以上の関節部を介して連結される多関節ロボットと、前記多関節ロボットの力測定を実行する測定制御手段とを含む多関節ロボットシステムであって、前記多関節ロボットは、
前記関節部に設けられ、駆動力発生側の駆動軸および駆動力出力先のリンク側の出力軸それぞれに、軸心から離間した箇所で固定され、該箇所に作用する偶力に応じて弾性的に曲げ歪みを発生する歪み発生部材と、
前記歪み発生部材に接して配置され、前記曲げ歪みを検出する歪みセンサと
を含み、前記測定制御手段は、
前記関節部の軸まわりに発生する負荷トルクを前記歪みセンサの出力値から算出し、仮想仕事の原理に従って前記関節部の前記負荷トルクから前記リンクに作用する力に換算する演算手段
を含む、多関節ロボットシステム。 - 前記歪み発生部材および前記歪みセンサは、前記関節部のそれぞれに備えられ、前記測定制御手段は、前記複数のリンクのうちのひとつについて、前記1以上の関節部それぞれで発生する1以上の負荷トルクを要素としたトルク・ベクトルから、該リンクの仮想変位および関節の仮想角変位を関係付けるヤコビ行列を用いて、該リンクに作用する力およびモーメントを要素とするベクトルを算出する、請求項1に記載の多関節ロボットシステム。
- 前記歪み発生部材は、中央部と、前記中央部から離間し、それぞれ前記出力軸または前記駆動軸に固定される4以上の固定部と、前記中央部と前記固定部それぞれとを接続する4以上の弾性板状部とを含む、請求項1または2に記載の多関節ロボットシステム。
- 前記歪み発生部材は、前記出力軸側に固定される偶数個の前記固定部の一組と、前記駆動軸側に固定される偶数個の前記固定部の一組とを含む、請求項3に記載の多関節ロボットシステム。
- 前記歪み発生部材は、前記関節部の軸まわりに偶数回の回転対称性を有する、請求項1〜4のいずれか1項に記載の多関節ロボットシステム。
- 求められた前記リンクに作用する力を入力として、所与の目標値に前記多関節ロボットを力制御する力制御手段をさらに含む、請求項1〜5のいずれか1項に記載の多関節ロボットシステム。
- 複数のリンクが1以上の関節部を介して連結される多関節ロボットであって、前記多関節ロボットは、
前記関節部に設けられ、駆動力発生側の駆動軸および駆動力出力先のリンク側の出力軸それぞれに、軸心から離間した箇所で固定され、該箇所に作用する偶力に応じて弾性的に曲げ歪みを発生する歪み発生部材と、
前記歪み発生部材に接して配置され、前記曲げ歪みを検出する歪みセンサと、
前記関節部の軸まわりに発生する負荷トルクを前記歪みセンサの出力値から算出し、仮想仕事の原理に従って前記関節部の前記負荷トルクから前記リンクに作用する力に換算するために、検出した前記曲げ歪みを外部出力する出力端子と
を含む、多関節ロボット。 - 複数のリンクが1以上の関節部を介して連結される多関節ロボットの関節部に取り付けられる力測定モジュールであって、
前記関節部に設けられ、駆動力発生側の駆動軸および駆動力出力先のリンク側の出力軸それぞれに、軸心から離間した箇所で固定され、該箇所に作用する偶力に応じて弾性的に曲げ歪みを発生する歪み発生部材と、
前記歪み発生部材に接して配置され、前記曲げ歪みを検出する歪みセンサと、
前記関節部の軸まわりに発生する負荷トルクを前記歪みセンサの出力値から算出し、仮想仕事の原理に従って前記関節部の前記負荷トルクから前記リンクに作用する力に換算する測定制御手段と
を含む、力測定モジュール。 - 複数のリンクが1以上の関節部を介して連結される多関節ロボットの力測定方法であって、
前記関節部に設けられ、駆動力発生側の駆動軸および駆動力出力先のリンク側の出力軸それぞれに、軸心から離間した箇所で固定される歪み発生部材で、該箇所に作用する偶力に応じて発生する弾性的な曲げ歪みを検出するステップと、
検出した前記曲げ歪みから前記関節部の軸周りに発生する負荷トルクを算出するステップと、
仮想仕事の原理に従って前記関節部の前記負荷トルクから前記リンクに作用する力に換算するステップと
を含む、力測定方法。 - 前記換算するステップは、前記複数のリンクのうちのひとつについて、前記1以上の関節部それぞれで発生する1以上の負荷トルクを要素としたトルク・ベクトルを生成するサブステップと、該リンクの仮想変位および関節の仮想角変位を関係付けるヤコビ行列を用いて、該リンクに作用する力およびモーメントを要素とするベクトルを算出するサブステップとを含む、請求項9に記載の力測定方法。
- 請求項9または10に記載の力測定方法をコンピュータに実行させるためのコンピュータ実行可読なプログラム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009206803A JP5467290B2 (ja) | 2009-09-08 | 2009-09-08 | 多関節ロボットシステム、多関節ロボット、力測定モジュール、力測定方法およびプログラム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009206803A JP5467290B2 (ja) | 2009-09-08 | 2009-09-08 | 多関節ロボットシステム、多関節ロボット、力測定モジュール、力測定方法およびプログラム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2011056601A true JP2011056601A (ja) | 2011-03-24 |
JP5467290B2 JP5467290B2 (ja) | 2014-04-09 |
Family
ID=43944856
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2009206803A Expired - Fee Related JP5467290B2 (ja) | 2009-09-08 | 2009-09-08 | 多関節ロボットシステム、多関節ロボット、力測定モジュール、力測定方法およびプログラム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5467290B2 (ja) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013198955A (ja) * | 2012-03-23 | 2013-10-03 | Toyota Motor East Japan Inc | ロボット接触検知装置 |
WO2015166932A1 (ja) * | 2014-04-30 | 2015-11-05 | マッスル株式会社 | マスタスレーブシステム |
JP2017080841A (ja) * | 2015-10-27 | 2017-05-18 | キヤノン株式会社 | ロボットアームの関節構造、ロボット装置の測定方法、およびロボット装置の制御方法 |
JP2018059854A (ja) * | 2016-10-07 | 2018-04-12 | キヤノン株式会社 | 変位測定装置、ロボット、ロボットアーム及び物品の製造方法 |
US10323995B2 (en) | 2017-01-06 | 2019-06-18 | Fanuc Corporation | Rotation-shaft joint structure |
KR101973292B1 (ko) * | 2017-12-11 | 2019-08-16 | 한국산업기술대학교산학협력단 | 근력 보조 로봇용 구동 장치 |
JP2020034428A (ja) * | 2018-08-30 | 2020-03-05 | トヨタ自動車株式会社 | センサユニット、センサシステム、ロボットハンド、ロボットアーム、サーバ装置、演算方法、およびプログラム |
CN112949103A (zh) * | 2019-11-26 | 2021-06-11 | 中国科学院沈阳自动化研究所 | 一种协作机器人非线性刚度建模方法 |
JP2021522520A (ja) * | 2018-04-16 | 2021-08-30 | フレキシブル ロボティック ソリューションズ | 非破壊検査のためのロボットシステムと方法 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102015214170A1 (de) * | 2015-07-27 | 2017-02-02 | Kuka Roboter Gmbh | Roboter mit einer Kraftmesseinrichtung |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63163131A (ja) * | 1986-12-25 | 1988-07-06 | Toshiba Corp | 軸力センサ |
JPH0523982A (ja) * | 1991-07-15 | 1993-02-02 | Hitachi Ltd | ロボツトの制御方法及び装置 |
JPH05223665A (ja) * | 1992-02-18 | 1993-08-31 | Fujitsu Ltd | モータのトルク検出部 |
JP2003117006A (ja) * | 2001-10-11 | 2003-04-22 | Japan Science & Technology Corp | 下肢麻痺者らのための機能的電気刺激による移動装置 |
JP2004347548A (ja) * | 2003-05-26 | 2004-12-09 | Ts Corporation | 荷重検出システム |
JP2009058388A (ja) * | 2007-08-31 | 2009-03-19 | Tetsuya Mori | トルクセンサ及びトルクセンサ付モータ |
-
2009
- 2009-09-08 JP JP2009206803A patent/JP5467290B2/ja not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63163131A (ja) * | 1986-12-25 | 1988-07-06 | Toshiba Corp | 軸力センサ |
JPH0523982A (ja) * | 1991-07-15 | 1993-02-02 | Hitachi Ltd | ロボツトの制御方法及び装置 |
JPH05223665A (ja) * | 1992-02-18 | 1993-08-31 | Fujitsu Ltd | モータのトルク検出部 |
JP2003117006A (ja) * | 2001-10-11 | 2003-04-22 | Japan Science & Technology Corp | 下肢麻痺者らのための機能的電気刺激による移動装置 |
JP2004347548A (ja) * | 2003-05-26 | 2004-12-09 | Ts Corporation | 荷重検出システム |
JP2009058388A (ja) * | 2007-08-31 | 2009-03-19 | Tetsuya Mori | トルクセンサ及びトルクセンサ付モータ |
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013198955A (ja) * | 2012-03-23 | 2013-10-03 | Toyota Motor East Japan Inc | ロボット接触検知装置 |
WO2015166932A1 (ja) * | 2014-04-30 | 2015-11-05 | マッスル株式会社 | マスタスレーブシステム |
JP2015208829A (ja) * | 2014-04-30 | 2015-11-24 | 学校法人立命館 | マスタスレーブシステム |
US10239201B2 (en) | 2014-04-30 | 2019-03-26 | Muscle Corporation | Master-slave system |
JP2017080841A (ja) * | 2015-10-27 | 2017-05-18 | キヤノン株式会社 | ロボットアームの関節構造、ロボット装置の測定方法、およびロボット装置の制御方法 |
US11806873B2 (en) | 2015-10-27 | 2023-11-07 | Canon Kabushiki Kaisha | Driving mechanism, robot apparatus measurement method, robot apparatus control method and component manufacturing method |
CN113561217A (zh) * | 2015-10-27 | 2021-10-29 | 佳能株式会社 | 驱动机构、机器人设备测量和控制方法及部件制造方法 |
US10583570B2 (en) | 2016-10-07 | 2020-03-10 | Canon Kabushiki Kaisha | Displacement measurement device, robot, and robot arm |
JP2018059854A (ja) * | 2016-10-07 | 2018-04-12 | キヤノン株式会社 | 変位測定装置、ロボット、ロボットアーム及び物品の製造方法 |
CN107914265A (zh) * | 2016-10-07 | 2018-04-17 | 佳能株式会社 | 位移测量设备、机器人及机器人臂 |
US10323995B2 (en) | 2017-01-06 | 2019-06-18 | Fanuc Corporation | Rotation-shaft joint structure |
KR101973292B1 (ko) * | 2017-12-11 | 2019-08-16 | 한국산업기술대학교산학협력단 | 근력 보조 로봇용 구동 장치 |
JP2021522520A (ja) * | 2018-04-16 | 2021-08-30 | フレキシブル ロボティック ソリューションズ | 非破壊検査のためのロボットシステムと方法 |
CN110871460A (zh) * | 2018-08-30 | 2020-03-10 | 丰田自动车株式会社 | 传感器单元、传感器系统、机械手、机械臂、服务器装置 |
JP7053410B2 (ja) | 2018-08-30 | 2022-04-12 | トヨタ自動車株式会社 | センサユニット、センサシステム、ロボットハンド、ロボットアーム、サーバ装置、演算方法、およびプログラム |
US11524414B2 (en) | 2018-08-30 | 2022-12-13 | Toyota Jidosha Kabushiki Kaisha | Sensor unit, sensor system, robot hand, robot arm, server device, calculation method, and program |
JP2020034428A (ja) * | 2018-08-30 | 2020-03-05 | トヨタ自動車株式会社 | センサユニット、センサシステム、ロボットハンド、ロボットアーム、サーバ装置、演算方法、およびプログラム |
CN112949103A (zh) * | 2019-11-26 | 2021-06-11 | 中国科学院沈阳自动化研究所 | 一种协作机器人非线性刚度建模方法 |
Also Published As
Publication number | Publication date |
---|---|
JP5467290B2 (ja) | 2014-04-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5467290B2 (ja) | 多関節ロボットシステム、多関節ロボット、力測定モジュール、力測定方法およびプログラム | |
Kawasaki et al. | Dexterous anthropomorphic robot hand with distributed tactile sensor: Gifu hand II | |
JP5906506B1 (ja) | アクチュエータ装置、パワーアシストロボットおよびヒューマノイドロボット | |
US8463433B2 (en) | Control system, control method, and robot apparatus | |
US7324872B2 (en) | Robot apparatus | |
US8868240B2 (en) | Walking robot and pose control method thereof | |
JP2011152633A (ja) | ロボットの制御装置 | |
JP2011152634A (ja) | ロボットの制御装置 | |
Xu et al. | Method for six-legged robot stepping on obstacles by indirect force estimation | |
Jalali et al. | Dynamic modeling of tendon-driven co-manipulative continuum robots | |
Mashayekhi et al. | VirSense: A novel haptic device with fixed-base motors and a gravity compensation system | |
JP5467291B2 (ja) | 省エネルギー型ロボット関節駆動制御システム | |
Koco et al. | Hybrid compliance control for locomotion of electrically actuated quadruped robot | |
Williams et al. | A 4-degree-of-freedom parallel origami haptic device for normal, shear, and torsion feedback | |
JP4442464B2 (ja) | 多関節アーム機構 | |
JP2007139522A (ja) | 荷重変位算出装置および荷重変位算出方法 | |
Li et al. | End-point sensing and state observation of a flexible-link robot | |
Hunt et al. | Development of a low inertia parallel actuated shoulder exoskeleton robot for the characterization of neuromuscular property during static posture and dynamic movement | |
Choi et al. | Development of the Cartesian arm exoskeleton system (CAES) using a 3-axis force/torque sensor | |
Palmieri | On the positioning error of a 2-DOF spherical parallel wrist with flexible links and joints–an FEM approach | |
JP2011080945A (ja) | 力覚センサ | |
JP4988545B2 (ja) | 外力検出方法及び検出装置 | |
Izawa et al. | Prototyping force-controlled 3-DOF hydraulic arms for humanoid robots | |
Juang et al. | Spring-balanced 3-DoF serial planar manipulators for constant forces in arbitrary directions | |
JP2005329512A (ja) | ロボットハンド指先力検出方法及び装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20120822 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20130702 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130902 |
|
A711 | Notification of change in applicant |
Free format text: JAPANESE INTERMEDIATE CODE: A711 Effective date: 20130902 |
|
RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20130902 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20130902 |
|
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: 20131203 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20131225 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5467290 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 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 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313113 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |