JP2009285099A - 力覚提示機能を有する操縦システム - Google Patents
力覚提示機能を有する操縦システム Download PDFInfo
- Publication number
- JP2009285099A JP2009285099A JP2008140181A JP2008140181A JP2009285099A JP 2009285099 A JP2009285099 A JP 2009285099A JP 2008140181 A JP2008140181 A JP 2008140181A JP 2008140181 A JP2008140181 A JP 2008140181A JP 2009285099 A JP2009285099 A JP 2009285099A
- Authority
- JP
- Japan
- Prior art keywords
- slave
- force
- pneumatic
- manipulator
- control
- 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
Images
Landscapes
- Manipulator (AREA)
Abstract
【解決手段】主操作装置101の手動操作に倣った従操作装置105の自動操作を通信によりバイラテラル制御する際、主操作装置は、電気駆動系による速度制御を主とし、従操作装置は、空気圧駆動系による力制御を主とし、従操作装置側に働く力を主操作装置側で力覚提示する。主操作装置は、デルタ機構で構成された並進部110と、当該並進部に連結されジンバル機構で構成された姿勢部120を備え、従操作装置は、平行リンク機構とジンバル機構の組み合わせで構成された保持部150と、当該保持部に保持されワイヤ機構とリンク機構で構成された挟持部160を備える。挟持部は、2つの空気圧アクチュエータに接続されたサーボバルブ及びワイヤを備えた拮抗駆動系を備え、サーボバルブを制御してワイヤの張力を可変することにより駆動される。
【選択図】図1
Description
−fs=Kd(xs−xm)+Bdx・s…(1)
マスタマニピュレータ101
fm−fs=Cdx・m…(2)
ここで、
xs:スレーブマニピュレータ105の先端(鉗子爪173、174)の位置及び姿勢
xm:マスタマニピュレータ101の先端(操作子132)の位置及び姿勢
fs:スレーブマニピュレータ105の先端が外部環境に加える力
fm:術者がマスタマニピュレータ101の先端に加える力
Kd:スレーブマニピュレータ105の設定剛性
Bd:スレーブマニピュレータ105の設定粘性
Cd:マスタマニピュレータ101の設定粘性
スレーブマニピュレータ105側では式(1)を実現するため力制御ループを内包するインピーダンス制御を適用する。まず、スレーブマニピュレータ105の運動方程式は関節座標系で以下のように記述される。
ここで、
τdr:スレーブマニピュレータ105の各関節の駆動トルク
Z:スレーブマニピュレータ105の逆動力学関数
q:スレーブマニピュレータ105の各関節の変位
Js:スレーブマニピュレータ105の関節変位から先端位置までのヤコビ行列
式(1)を実現するためにスレーブマニピュレータ105の先端が発生すべき力fdrと、空気圧シリンダ155、156、157、175、186、187、188、189及び空圧揺動アクチュエータ182の駆動トルクの目標値τdrrefを以下のように計算する。
τdrref=−Js(転置)fdr+Z(qs,q・s,q¨s)…(5)(図中2の枠内)
空気圧シリンダ155、156、157、175、186、187、188、189及び空圧揺動アクチュエータ182の動特性が十分でτdrrefとτdrが一致すると仮定し、式(4)を式(5)に代入し、さらに式(3)に代入すれば式(1)が導かれる。実際には式(5)において位相遅れによる不安定化を避けるため、逆動力学モデルの入力のうち速度、加速度についてはマスタマニピュレータ101からの目標軌道値を用いている(図中3の枠内)。式(5)で計算されるトルクを各関節で発生させるため、次式(6)として機構学計算により空気圧シリンダ155、156、157、175、186、187、188、189及び空圧揺動アクチュエータ182の駆動力目標値Fdrrefに変換する。
ここで、
Ja:空気圧シリンダ155、156、157、175、186、187、188、189及び空圧揺動アクチュエータ182の変位から関節変位までのヤコビアン
次に、式(6)で計算された駆動力を発生させるためPI制御を行う。
ここで、
u:サーボバルブ72への制御電圧
Kap:比例ゲイン
Kai:積分ゲイン
Fdr:圧力値から計算される空気圧シリンダ155、156、157、175、186、187、188、189及び空圧揺動アクチュエータ182の駆動力
マスタマニピュレータ101側では以下のようにアドミタンス制御により式(2)を実現する。
q・m=Jm(インバース)x・m…(9)(図中7の枠内)
式(8)から分かるようにスレーブマニピュレータ105と外部環境と接触力が必要であるが、スレーブマニピュレータ105側でのインピーダンス制御が実現されている場合、
fdrはfsと一致するため推定値としてそれぞれ相手側のマスタ制御部103、スレーブ制御部107に与えられる(図中8の枠内)。空気圧シリンダ155、156、157、175、186、187、188、189及び空圧揺動アクチュエータ182の駆動力目標値Fdrrefは、内包された差圧制御ループによって高速、高精度に発生することができる。このため、空気の圧縮性やバルブの中立点のずれ等の位置決めに悪影響を及ぼす特性を補償することが可能となる。
Claims (6)
- 主操作装置の手動操作に倣った従操作装置の自動操作を通信によりバイラテラル制御可能であり、前記主操作装置は、電気駆動系による速度制御を主とし、前記従操作装置は、空気圧駆動系による力制御を主とし、前記従操作装置側に働く力を前記主操作装置側で力覚提示する力覚提示機能を有する操縦システムであって、
前記主操作装置は、デルタ機構で構成された3自由度の並進部と、当該並進部に連結されジンバル機構で構成された4自由度の姿勢部とを備え、前記従操作装置は、平行リンク機構とジンバル機構の組み合わせで構成された3自由度の保持部と、当該保持部に保持されワイヤ機構とリンク機構で構成された4自由度の挟持部とを備え、
前記挟持部は、2つの空気圧アクチュエータと、当該空気圧アクチュエータに接続されたサーボバルブと、前記空気圧アクチュエータに接続されたワイヤとを備えた拮抗駆動系を備え、前記サーボバルブを制御して前記ワイヤの張力を可変することにより駆動されることを特徴とする力覚提示機能を有する操縦システム。 - 前記挟持部は、先端に内蔵された空気圧アクチュエータとリンクにより駆動される鉗子部を備えていることを特徴とする請求項1に記載の力覚提示機能を有する操縦システム。
- 前記挟持部に働く力は、前記空気圧アクチュエータのバックドライバビリティを利用し、それぞれの駆動力から推定されることを特徴とする請求項1又は2に記載の力覚提示機能を有する操縦システム。
- 前記従操作装置は、コンプライアンスを持たせた制御が行われることを特徴とする請求項1〜3の何れか一項に記載の力覚提示機能を有する操縦システム。
- 前記主操作装置は、力制御ループに運動制御ループを内包した運動制御型のインピーダンス制御が行われ、前記従操作装置は、運動制御ループに力制御ループを内包した力制御型のインピーダンス制御が行われることを特徴とする請求項1〜4の何れか一項に記載の力覚提示機能を有する操縦システム。
- 前記主操作装置の手動操作に倣った前記従操作装置の自動操作が、有線通信によりバイラテラル制御されることを特徴とする請求項1〜5の何れか一項に記載の力覚提示機能を有する操縦システム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008140181A JP5452813B2 (ja) | 2008-05-28 | 2008-05-28 | 力覚提示機能を有する操縦システム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008140181A JP5452813B2 (ja) | 2008-05-28 | 2008-05-28 | 力覚提示機能を有する操縦システム |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2013185779A Division JP5769209B2 (ja) | 2013-09-07 | 2013-09-07 | 力覚提示機能を有する操縦システム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2009285099A true JP2009285099A (ja) | 2009-12-10 |
JP5452813B2 JP5452813B2 (ja) | 2014-03-26 |
Family
ID=41454894
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2008140181A Expired - Fee Related JP5452813B2 (ja) | 2008-05-28 | 2008-05-28 | 力覚提示機能を有する操縦システム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5452813B2 (ja) |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2013179693A1 (ja) * | 2012-05-29 | 2013-12-05 | 国立大学法人東京工業大学 | 内視鏡操作システム |
JP2014004655A (ja) * | 2012-06-25 | 2014-01-16 | Univ Of Tsukuba | マニピュレーションシステム |
WO2014073121A1 (ja) * | 2012-11-07 | 2014-05-15 | 国立大学法人東京工業大学 | 操作対象装置の操作システム、操作入力装置 |
WO2014073122A1 (ja) * | 2012-11-07 | 2014-05-15 | 国立大学法人東京工業大学 | 内視鏡操作システム |
WO2014155725A1 (ja) * | 2013-03-29 | 2014-10-02 | 国立大学法人 東京工業大学 | 内視鏡操作システムおよび内視鏡操作プログラム |
JP2016147057A (ja) * | 2015-02-11 | 2016-08-18 | エンジニアリング サービスィズ インコーポレーテッド | 外科手術用ロボット |
JP2017087322A (ja) * | 2015-11-05 | 2017-05-25 | 国立大学法人九州大学 | 微細作業支援システム及び微細作業用マニピュレータ |
JP2017515615A (ja) * | 2014-03-19 | 2017-06-15 | エンドマスター・プライベート・リミテッドEndomaster Pte Ltd | マスタースレーブ軟性内視鏡ロボットシステム |
WO2018012110A1 (ja) * | 2016-07-11 | 2018-01-18 | ソニー株式会社 | 処理装置、システム、および制御方法 |
JP2018102804A (ja) * | 2016-12-28 | 2018-07-05 | 川崎重工業株式会社 | ロボット鉗子 |
WO2019150810A1 (ja) * | 2018-01-30 | 2019-08-08 | ソニー株式会社 | マスタ-スレーブシステム、操作装置、並びにロボット装置 |
CN113081289A (zh) * | 2021-04-06 | 2021-07-09 | 天津大学医疗机器人与智能***研究院 | 手术机器人用主操作臂 |
JP2021522894A (ja) * | 2018-05-18 | 2021-09-02 | オーリス ヘルス インコーポレイテッド | ロボット対応の遠隔操作システムのためのコントローラ |
WO2022190593A1 (ja) * | 2021-03-09 | 2022-09-15 | ソニーグループ株式会社 | ロボット装置、手術マニピュレータ、並びにシステム |
JP7335026B1 (ja) * | 2022-08-23 | 2023-08-29 | リバーフィールド株式会社 | 手術ロボット、及び手術ロボットの制御ユニット |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05253230A (ja) * | 1992-03-13 | 1993-10-05 | Olympus Optical Co Ltd | 処置具 |
US20060235368A1 (en) * | 2002-09-30 | 2006-10-19 | Sightline Technologies Ltd. | Piston-actuated endoscopic tool |
-
2008
- 2008-05-28 JP JP2008140181A patent/JP5452813B2/ja not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05253230A (ja) * | 1992-03-13 | 1993-10-05 | Olympus Optical Co Ltd | 処置具 |
US20060235368A1 (en) * | 2002-09-30 | 2006-10-19 | Sightline Technologies Ltd. | Piston-actuated endoscopic tool |
Non-Patent Citations (2)
Title |
---|
JPN6012056904; 只野 耕太郎: '力覚提示機能を有する空気圧駆動多自由度かん子システムの開発' 第14回コンピュータ支援画像診断学会・第15回日本コンピュータ外科学会大会合同論文集 , 20051230, pp.219-220, 日本コンピュータ外科学会 * |
JPN6012056905; 只野 耕太郎: '空気圧駆動多自由度鉗子による力覚提示機能を有するマスタスレーブシステムの開発-鉗子保持マニピュレータ' 日本機械学会ロボティクス・メカトロニクス講演会2006講演論文集 Vol.2006, 20060526, Page.1A1-A03, 日本機械学会 * |
Cited By (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013244377A (ja) * | 2012-05-29 | 2013-12-09 | Tokyo Institute Of Technology | 内視鏡操作システム |
WO2013179693A1 (ja) * | 2012-05-29 | 2013-12-05 | 国立大学法人東京工業大学 | 内視鏡操作システム |
JP2014004655A (ja) * | 2012-06-25 | 2014-01-16 | Univ Of Tsukuba | マニピュレーションシステム |
WO2014073121A1 (ja) * | 2012-11-07 | 2014-05-15 | 国立大学法人東京工業大学 | 操作対象装置の操作システム、操作入力装置 |
WO2014073122A1 (ja) * | 2012-11-07 | 2014-05-15 | 国立大学法人東京工業大学 | 内視鏡操作システム |
WO2014155725A1 (ja) * | 2013-03-29 | 2014-10-02 | 国立大学法人 東京工業大学 | 内視鏡操作システムおよび内視鏡操作プログラム |
CN108968889A (zh) * | 2014-03-19 | 2018-12-11 | 恩达马斯特有限公司 | 主-从柔性机器人内窥镜*** |
JP2017515615A (ja) * | 2014-03-19 | 2017-06-15 | エンドマスター・プライベート・リミテッドEndomaster Pte Ltd | マスタースレーブ軟性内視鏡ロボットシステム |
JP2016147057A (ja) * | 2015-02-11 | 2016-08-18 | エンジニアリング サービスィズ インコーポレーテッド | 外科手術用ロボット |
US9974619B2 (en) | 2015-02-11 | 2018-05-22 | Engineering Services Inc. | Surgical robot |
JP2017087322A (ja) * | 2015-11-05 | 2017-05-25 | 国立大学法人九州大学 | 微細作業支援システム及び微細作業用マニピュレータ |
US11110612B2 (en) | 2016-07-11 | 2021-09-07 | Sony Corporation | Processing device, system, and control method |
WO2018012110A1 (ja) * | 2016-07-11 | 2018-01-18 | ソニー株式会社 | 処理装置、システム、および制御方法 |
JP2018102804A (ja) * | 2016-12-28 | 2018-07-05 | 川崎重工業株式会社 | ロボット鉗子 |
CN109996503A (zh) * | 2016-12-28 | 2019-07-09 | 川崎重工业株式会社 | 机器人钳子 |
WO2018123601A1 (ja) * | 2016-12-28 | 2018-07-05 | 川崎重工業株式会社 | ロボット鉗子 |
WO2019150810A1 (ja) * | 2018-01-30 | 2019-08-08 | ソニー株式会社 | マスタ-スレーブシステム、操作装置、並びにロボット装置 |
JP2021522894A (ja) * | 2018-05-18 | 2021-09-02 | オーリス ヘルス インコーポレイテッド | ロボット対応の遠隔操作システムのためのコントローラ |
JP7314175B2 (ja) | 2018-05-18 | 2023-07-25 | オーリス ヘルス インコーポレイテッド | ロボット対応の遠隔操作システムのためのコントローラ |
US11918316B2 (en) | 2018-05-18 | 2024-03-05 | Auris Health, Inc. | Controllers for robotically enabled teleoperated systems |
WO2022190593A1 (ja) * | 2021-03-09 | 2022-09-15 | ソニーグループ株式会社 | ロボット装置、手術マニピュレータ、並びにシステム |
CN113081289A (zh) * | 2021-04-06 | 2021-07-09 | 天津大学医疗机器人与智能***研究院 | 手术机器人用主操作臂 |
CN113081289B (zh) * | 2021-04-06 | 2022-10-25 | 山东威高手术机器人有限公司 | 手术机器人用主操作臂 |
JP7335026B1 (ja) * | 2022-08-23 | 2023-08-29 | リバーフィールド株式会社 | 手術ロボット、及び手術ロボットの制御ユニット |
WO2024042623A1 (ja) * | 2022-08-23 | 2024-02-29 | リバーフィールド株式会社 | 手術ロボット、及び手術ロボットの制御ユニット |
Also Published As
Publication number | Publication date |
---|---|
JP5452813B2 (ja) | 2014-03-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5452813B2 (ja) | 力覚提示機能を有する操縦システム | |
JP5327687B2 (ja) | 力覚提示機能を有する操縦システム | |
US8897916B2 (en) | Maneuvering system having inner force sense presenting function | |
JP5769209B2 (ja) | 力覚提示機能を有する操縦システム | |
US8306656B1 (en) | Method and system for performing medical procedure | |
US11944397B2 (en) | System and method for providing surgical instrument force feedback | |
US9888974B2 (en) | Friction compensation in a minimally invasive surgical apparatus | |
KR20200045967A (ko) | 수술 지원 장치, 그 제어 방법 및 기록 매체 | |
JP6892967B2 (ja) | ロボット手首を制御するためのシステム及び方法 | |
Bardou et al. | Control of a multiple sections flexible endoscopic system | |
KR20220057638A (ko) | 액티브 바이어스를 가진 일정 힘 스프링 | |
US20210196413A1 (en) | Manual actuator for robotic medical system | |
Lee et al. | Modeling and control of robotic surgical platform for single-port access surgery | |
WO2022228149A1 (zh) | 输入装置、主操作设备及手术机器人 | |
WO2023083057A1 (zh) | 主手手腕、主操作设备及手术机器人 | |
CN112203610A (zh) | 外科机器人工具多电机致动器和控制器 | |
JP2023539863A (ja) | 外科用ロボットシステムにおける外部負荷をかけられた状態のバックラッシュ、摩擦、及びコンプライアンスを有する外科用器具の制御 | |
JPH08224246A (ja) | 医療用マニピュレータ | |
WO2021049189A1 (ja) | 医療用アームシステム、アーム装置、及びマスタースレーブシステムの作動方法 | |
WO2021147264A1 (zh) | 操作组件及手术机器人 | |
Tadano et al. | Evaluation of a master slave system with force sensing using pneumatic servo system for laparoscopic surgery | |
CN113613849A (zh) | 控制设备、控制方法和主从*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20110528 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20121120 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130114 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20130709 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130905 |
|
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: 20140102 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5452813 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 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |