JP6165057B2 - Surgery support device - Google Patents

Surgery support device Download PDF

Info

Publication number
JP6165057B2
JP6165057B2 JP2013526973A JP2013526973A JP6165057B2 JP 6165057 B2 JP6165057 B2 JP 6165057B2 JP 2013526973 A JP2013526973 A JP 2013526973A JP 2013526973 A JP2013526973 A JP 2013526973A JP 6165057 B2 JP6165057 B2 JP 6165057B2
Authority
JP
Japan
Prior art keywords
unit
treatment
posture
attachment
detachment
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
JP2013526973A
Other languages
Japanese (ja)
Other versions
JPWO2013018908A1 (en
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.)
Olympus Corp
Original Assignee
Olympus 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 Olympus Corp filed Critical Olympus Corp
Priority claimed from PCT/JP2012/069919 external-priority patent/WO2013018908A1/en
Publication of JPWO2013018908A1 publication Critical patent/JPWO2013018908A1/en
Application granted granted Critical
Publication of JP6165057B2 publication Critical patent/JP6165057B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Description

本発明は、手術支援装置に関する。
本願は、2011年8月4日に米国で出願された仮出願61/515,203に基づき優先権を主張し、その内容をここに援用する。
The present invention relates to a surgery support device.
This application claims priority based on provisional application 61 / 515,203 for which it applied in the United States on August 4, 2011, and uses the content here.

従来、手技を遠隔操作にて行うために、種々の医療用マニピュレータが検討されている。その種の医療用マニピュレータとして、例えば、特許文献1および2に記載されたものが開示されている。 Conventionally, various medical manipulators have been studied in order to perform a procedure remotely. As this type of medical manipulator, for example, those described in Patent Documents 1 and 2 are disclosed.

この医療用マニピュレータを用いることで、操作卓において入力装置(入力部)を操作すると、一般的に外科医である使用者は、患者に低侵襲な外科的手術を行えるようになっている。患者の側に配置される台車システムを使うことで、操作卓のコンピュータにより、経内視鏡的に用いられる術具の動きを制御することができる。
典型的な台車システムは、組織を処置しているときに外形が変化しない基部と、操作卓による操作に基づいて関節による動作を行う駆動部とを備えている。典型的な駆動部には、複数の軸状部材が関節で接続されたロボットのようなスレーブマニピュレータが少なくとも3基備えられている。3基のスレーブマニピュレータのうち、中央のものは内視鏡を支持し、両側のものは組織を処置する術具を支持している。
By using this medical manipulator, a user who is generally a surgeon can perform a minimally invasive surgical operation on a patient when an input device (input unit) is operated on a console. By using the cart system arranged on the patient side, the operation of the surgical instrument used transendoscopically can be controlled by the computer of the console.
A typical cart system includes a base portion whose outer shape does not change when a tissue is being treated, and a drive unit that performs a joint operation based on an operation by a console. A typical drive unit includes at least three slave manipulators such as a robot in which a plurality of shaft-like members are connected by joints. Of the three slave manipulators, the central one supports the endoscope, and both ones support the surgical instrument for treating the tissue.

米国特許第6246200号明細書US Pat. No. 6,246,200 米国特許第6441577号明細書US Pat. No. 6,441,577

特許文献1および2に記載された医療用マニピュレータのスレーブマニピュレータでは、一般的に、各関節にブレーキシステムと角度センサが配置されているとともに、スレーブマニピュレータに術具が着脱可能な着脱部が設けられている。そして、各関節の角度情報を基にスレーブマニピュレータの着脱部の位置および姿勢(向き)、さらには、術具の先端部の位置および姿勢を算出している。
この場合、術具の先端部(処置部)の絶対的な位置および姿勢を求めるためには、スレーブマニピュレータの関節の数だけ角度センサが必要であり、装置が大型化するともにコストが高くなるという問題がある。
In the slave manipulators of the medical manipulators described in Patent Documents 1 and 2, generally, a brake system and an angle sensor are arranged at each joint, and an attachment / detachment unit to which a surgical tool can be attached and detached is provided in the slave manipulator. ing. Based on the angle information of each joint, the position and orientation (orientation) of the attachment / detachment portion of the slave manipulator and the position and orientation of the distal end portion of the surgical instrument are calculated.
In this case, in order to obtain the absolute position and posture of the distal end portion (treatment portion) of the surgical instrument, angle sensors are required as many as the number of joints of the slave manipulator, which increases the size and cost of the device. There's a problem.

本発明は、このような問題点に鑑みてなされたものであって、術具の先端部の位置および姿勢を検出するために必要なセンサの数を低減させることができる医療用マニピュレータを備える手術支援装置を提供することを目的とする。 The present invention was made in view of such problems, and a medical manipulator which can reduce the number of sensors required to detect the position and orientation of the end of the tool An object is to provide a surgery support device.

上記課題を解決するために、この発明は以下の手段を提案している。
本発明の手術支援装置は、基端部が揺動可能にベースに連結された保持部と、前記保持部の先端部に固定された固定部、処置部が着脱可能な着脱部、及び前記固定部と前記着脱部とに連結された辺要素を備え、前記辺要素の移動により前記着脱部が前記固定部に対して相対移動可能に構成された位置決め部と、前記位置決め部の基端部の前記辺要素に設けられ、前記位置決め部に設定された基準位置の姿勢を算出して検出する基準姿勢検出部と、前記固定部に対して前記処置部を移動させるための駆動部と、前記基準位置に対する前記着脱部の位置を算出して検出する着脱位置検出部と、前記着脱部の位置から前記処置部の姿勢または位置を算出して検出する処置部位置検出部と、前記着脱位置検出部および前記処置部位置検出部に基づいて前記駆動部を制御する駆動部制御部と、を備え、前記着脱位置検出部が、前記基準位置に原点が設定されたローカル座標系を用いて特定される前記基準位置に対する前記着脱部の距離に基づき前記基準位置に対する前記着脱部の位置を算出して検出し、前記基準姿勢検出部が、前記ベース上に原点が設定されたグローバル座標系の軸周りの回転角度を算出することにより前記基準位置の姿勢を算出して検出することにより、前記グローバル座標系における前記着脱部の位置及び姿勢を検出し、検出された前記着脱部の位置に基づき、前記処置部位置検出部が、前記処置部の姿勢を算出することを特徴としている。
In order to solve the above problems, the present invention proposes the following means.
The surgical operation support device of the present invention includes a holding portion whose base end portion is swingably connected to a base, a fixing portion fixed to a distal end portion of the holding portion, a detachable portion to which a treatment portion can be attached and detached, and comprising a side element connected to the said fixing portion and the detachable unit, and a relative moving configured to be capable positioning portion the detachable unit by the movement of the side elements with respect to the fixed portion, group of the positioning unit provided in the side elements of the end, and the reference attitude detecting unit for detect and calculate the orientation of the set criteria positioned at the positioning portion, a drive for moving the treatment portion with respect to the fixed part parts and the detaching position detecting unit for detecting and calculating the position of the detachable unit against the reference position, the detecting the position of the detachable unit calculates the attitude or position of the treatment section treatment section position detection unit And based on the attachment / detachment position detection unit and the treatment unit position detection unit A drive unit control unit for controlling the drive unit, wherein the attachment / detachment position detection unit has a distance of the attachment / detachment unit with respect to the reference position specified using a local coordinate system in which an origin is set at the reference position. And calculating and detecting the position of the attachment / detachment unit relative to the reference position, and the reference posture detection unit calculates a rotation angle around an axis of a global coordinate system in which an origin is set on the base. The position and orientation of the detachable part in the global coordinate system is detected by calculating and detecting the posture of the treatment part. Based on the detected position of the detachable part, the treatment part position detecting unit It is characterized by calculating the posture .

また、上記手術支援装置において、前記駆動部は、前記固定部に対して前記着脱部を移動させる着脱部駆動部と、前記着脱部に対して前記処置部を移動させる処置部駆動部とから構成され、前記着脱位置検出部は、前記固定部に対する前記着脱部の角度変位を含む移動量を検出し、前記処置部位置検出部は、前記着脱部に対する前記処置部の角度変位を含む移動量を検出することがより好ましい。
また、上記手術支援装置において、前記保持部は、前記保持部の基端部に対する前記先端部の位置を調節可能な調節モードと、前記保持部の基端部に対する前記先端部の位置を固定した固定モードとの間で切り替え可能であることがより好ましい。
In the surgery support apparatus, the driving unit includes an attaching / detaching unit driving unit that moves the attaching / detaching unit relative to the fixing unit, and a treatment unit driving unit that moves the treatment unit relative to the attaching / detaching unit. The attachment / detachment position detection unit detects a movement amount including an angular displacement of the attachment / detachment unit with respect to the fixing unit, and the treatment unit position detection unit calculates a movement amount including an angular displacement of the treatment unit with respect to the attachment / detachment unit. More preferably, it is detected.
In the above surgery supporting system, the holding portion includes an adjustment mode adjustable position of the tip relative to a base end portion of the holding portion, to fix the position of the tip relative to a base end portion of the holding portion More preferably, it can be switched between fixed modes.

た、上記手術支援装置において、前記基準姿勢検出部は、検出した前記基準位置の姿勢を無線通信により前記処置部位置検出部に送信することがより好ましい。 Also, in the operation support apparatus, wherein the reference posture detecting unit is more preferable to transmit the detected position of the reference positions to the treatment site置検out section by wireless communication.

また、上記手術支援装置において、使用者からの入力に基づいて操作指令を発する入力部を備え、前記駆動部制御部は、前記操作指令に表される前記処置部の前記単位時間当たりの目標位置の変化量を算出する目標変化量算出工程と、前記処置部が前記単位時間当たりに前記目標位置の変化量だけ移動するように前記駆動部を制御する移動工程と、を組にして繰り返すことがより好ましい。 The surgical operation support apparatus further includes an input unit that issues an operation command based on an input from a user, wherein the drive unit control unit is a target position per unit time of the treatment unit represented by the operation command. A target change amount calculating step for calculating a change amount of the target and a moving step for controlling the drive unit so that the treatment unit moves by the change amount of the target position per unit time. More preferred.

また、上記手術支援装置において、前記駆動部制御部は、前記目標変化量算出工程において、前記操作指令に表される前記処置部の前記単位時間当たりの目標姿勢の変化量を算出し、前記移動工程において、前記処置部が前記単位時間当たりに前記目標姿勢の変化量だけ移動するように前記駆動部を制御することがより好ましい。 Also, calculated Te upper Kite arthroplasty supporting device smell, before SL driver control unit, in the target change amount calculation step, a change amount of the target attitude per unit time of the treatment portion represented in the operation command In the moving step, it is more preferable to control the drive unit so that the treatment unit moves by the change amount of the target posture per unit time.

また、上記手術支援装置において、光軸に沿った外方の画像を取得するための観察部が設けられた内視鏡と、前記画像を表示するための表示部と、使用者からの入力に基づいて操作指令を発する入力部と、を備え、前記駆動部制御部は、前記入力部が発する前記操作指令を、前記処置部の先端側を向く第一の直交座標系から前記観察部の前記光軸に沿って先端側を向く第二の直交座標系に変換する変換行列で変換して変換操作指令を算出し、前記変換操作指令に基づいて前記駆動部を制御することがより好ましい。 In the surgery support apparatus, an endoscope provided with an observation unit for acquiring an outward image along the optical axis, a display unit for displaying the image, and input from a user An input unit that issues an operation command based on the input unit, and the drive unit control unit sends the operation command issued by the input unit from a first orthogonal coordinate system facing the distal end side of the treatment unit. More preferably, a conversion operation command is calculated by conversion using a conversion matrix that is converted to a second orthogonal coordinate system facing the tip side along the optical axis, and the drive unit is controlled based on the conversion operation command.

また、上記手術支援装置において、記処置部の位置および姿勢を記憶する記憶部と、前記記憶部に制御信号を送信可能な送信部と、を備え、前記保持部及び前記位置決め部を複数備え、各前記保持部にそれぞれ取り付けられた前記処置部同士が接触したときに、前記送信部が前記制御信号を前記記憶部に送信することで、互いに接触した前記処置部の位置および姿勢から各前記保持部の相対位置を算出し、前記記憶部が記録することがより好ましい。 In the above surgery supporting system, comprising: a storage unit for storing the position and orientation of the front Symbol treatment unit, and a transmission section capable of transmitting a control signal to the storage unit, a plurality provided with the holding portion and the positioning portion When the treatment units attached to the holding units are in contact with each other, the transmission unit transmits the control signal to the storage unit, so that the position and posture of the treatment units in contact with each other calculating a relative position of the holding portion, it is more preferable that pre-term memory unit records.

また、上記手術支援装置において、複数の前記保持部と、前記位置決め部と、を備え、
1つの前記基準姿勢検出部が、それぞれの前記位置決め部に着脱可能に取り付けられることがより好ましい。
Further, in the above Kite arthroplasty supporting apparatus, comprising a plurality of said holding portion, said positioning portion,
It is more preferable that one reference posture detection unit is detachably attached to each positioning unit.

本発明の手術支援装置によれば、術具の先端部の位置および姿勢を検出するために必要なセンサの数を低減させることができる。 According to surgery supporting apparatus of the present invention, it is possible to reduce the number of sensors required to detect the position and orientation of the end of the tool.

本発明の第1実施形態の手術支援装置の全体図である。1 is an overall view of a surgery support apparatus according to a first embodiment of the present invention. 同手術支援装置におけるスレーブマニピュレータの側面図である。It is a side view of the slave manipulator in the same surgery assistance apparatus. 同スレーブマニピュレータの位置決めアームの側面図を角度θが約90°の場合で示す模式図である。It is a schematic diagram which shows the side view of the positioning arm of the slave manipulator when the angle θ is about 90 °. 同手術支援装置のブロック図である。It is a block diagram of the surgery assistance apparatus. 同スレーブマニピュレータの位置決めアームの側面図を角度θが鋭角の場合で示す模式図である。It is a schematic diagram which shows the side view of the positioning arm of the slave manipulator when the angle θ is an acute angle. 操作指令による位置と鉗子部の位置との時間の経過にともなう変化を示す図である。It is a figure which shows the change with progress of time of the position by an operation command, and the position of a forceps part. 同スレーブマニピュレータの変形例における位置決めアームの側面図である。It is a side view of the positioning arm in the modification of the slave manipulator. 本発明の第2実施形態の手術支援装置におけるスレーブマニピュレータの側面図である。It is a side view of the slave manipulator in the surgery assistance apparatus of 2nd Embodiment of this invention. 同手術支援装置のブロック図である。It is a block diagram of the surgery assistance apparatus. 本発明の第3実施形態の手術支援装置におけるスレーブマニピュレータの側面図である。It is a side view of the slave manipulator in the surgery assistance apparatus of 3rd Embodiment of this invention. 同手術支援装置のブロック図である。It is a block diagram of the surgery assistance apparatus. 本発明の変形例の実施形態における手術支援装置の側面図である。It is a side view of the surgery assistance apparatus in embodiment of the modification of this invention. 本発明の変形例の実施形態における手術支援装置の側面図である。It is a side view of the surgery assistance apparatus in embodiment of the modification of this invention. 同手術支援装置の平面図である。It is a top view of the surgery assistance apparatus. 同手術支援装置におけるスレーブマニピュレータを退避させたときの側面図である。It is a side view when the slave manipulator in the surgery assistance apparatus is retracted.

(第1実施形態)
以下、本発明に係る手術支援装置の第1実施形態を、図1から図7を参照しながら説明する。
図1に示すように本実施形態の手術支援装置1は、マスタマニピュレータ(入力部)10と、表示部13と、1基の本発明のスレーブマニピュレータ(医療用マニピュレータ)20Aと、制御装置60とを備えている。また、手術支援装置1は、図2に示すように公知の硬性の処置具を術具200として着脱可能に取り付けることができるようになっている。
(First embodiment)
Hereinafter, a first embodiment of a surgery support apparatus according to the present invention will be described with reference to FIGS. 1 to 7.
As shown in FIG. 1, the surgery support apparatus 1 of the present embodiment includes a master manipulator (input unit) 10, a display unit 13, one slave manipulator (medical manipulator) 20 </ b> A of the present invention, and a control device 60. It has. In addition, as shown in FIG. 2, the surgery support apparatus 1 is configured so that a known hard treatment instrument can be detachably attached as a surgical instrument 200.

以下では、まず、術具200について説明する。
術具200の構成は特に限定されないが、本実施形態では鉗子が用いられている。術具200は、図2に示すように、ステンレス鋼などの硬性の材料で筒状に形成された術具挿入部201の先端部に一対の鉗子片202からなる鉗子部(処置部)203が備えられたものとなっている。それぞれの鉗子片202は、術具挿入部201の先端部に設けられた不図示のピンにより回動可能に支持されている。術具挿入部201内には、不図示の操作ワイヤが進退可能に挿通されている。操作ワイヤの先端部は鉗子片202に接続されて、操作ワイヤの基端部は術具挿入部201の基端側に延びている。術具挿入部201の基端部には、不図示のワイヤ操作モータが内蔵されている。操作ワイヤの基端部は、ワイヤ操作モータの回転軸に接続されていて、ワイヤ操作モータを駆動することで、術具挿入部201に対して操作ワイヤを進退させて一対の鉗子片202を互いに離間および接近させる、すなわち、開閉させることができる。
Hereinafter, first, the surgical instrument 200 will be described.
The configuration of the surgical instrument 200 is not particularly limited, but forceps are used in this embodiment. As shown in FIG. 2, the surgical instrument 200 has a forceps part (treatment part) 203 comprising a pair of forceps pieces 202 at the distal end of a surgical instrument insertion part 201 formed in a cylindrical shape with a hard material such as stainless steel. It has been provided. Each forceps piece 202 is rotatably supported by a pin (not shown) provided at the distal end portion of the surgical instrument insertion portion 201. An operation wire (not shown) is inserted into the surgical instrument insertion portion 201 so as to be able to advance and retreat. The distal end portion of the operation wire is connected to the forceps piece 202, and the proximal end portion of the operation wire extends to the proximal end side of the surgical instrument insertion portion 201. A wire operation motor (not shown) is built in the proximal end portion of the surgical instrument insertion portion 201. The proximal end portion of the operation wire is connected to the rotation shaft of the wire operation motor, and by driving the wire operation motor, the operation wire is advanced and retracted with respect to the surgical instrument insertion portion 201, thereby causing the pair of forceps pieces 202 to mutually move. It can be separated and approached, ie opened and closed.

ワイヤ操作モータの電気接点は、術具挿入部201の基端部から外部に露出している。
術具200における術具挿入部201の長手方向の長さはLに設定されている。
The electrical contact of the wire operation motor is exposed to the outside from the proximal end portion of the surgical instrument insertion portion 201.
The length of the surgical instrument insertion portion 201 in the surgical instrument 200 in the longitudinal direction is set to L.

続いて、手術支援装置1の各構成について説明する。
マスタマニピュレータ10としては公知の構成のものを用いることができ、本実施形態では、図1に示すように支持台11に一対のマスタマニピュレータ10が備えられている(一方のマスタマニピュレータ10は図示していない。)。術者などの使用者Qは、椅子12に座った状態で、一対のマスタマニピュレータ10のうちの一方を右手Q1で操作するとともに、他方を左手Q2で操作する。マスタマニピュレータ10は、使用者Qによる操作(入力)に基づいて操作指令となる信号を発することができる。操作指令については後述するが、操作指令には、鉗子部203の位置および姿勢が含まれる。
支持台11の上部には、液晶パネルなどの表示パネル13aを有する表示部13が固定されている。後述する内視鏡56の観察部で取得された画像を信号に変換したものが制御装置60で処理され、表示部13に処理された画像を表示することができる。
Then, each structure of the surgery assistance apparatus 1 is demonstrated.
As the master manipulator 10, a known configuration can be used. In the present embodiment, a pair of master manipulators 10 are provided on the support base 11 as shown in FIG. 1 (one master manipulator 10 is shown). Not.) The user Q such as an operator operates one of the pair of master manipulators 10 with the right hand Q1 while operating the other with the left hand Q2 while sitting on the chair 12. The master manipulator 10 can issue a signal serving as an operation command based on an operation (input) by the user Q. Although the operation command will be described later, the operation command includes the position and posture of the forceps unit 203.
A display unit 13 having a display panel 13 a such as a liquid crystal panel is fixed to the upper part of the support base 11. An image obtained by converting an image acquired by the observation unit of the endoscope 56 to be described later into a signal is processed by the control device 60, and the processed image can be displayed on the display unit 13.

スレーブマニピュレータ20Aは、図2および図3示すように、基端部22Aが手術用天板(ベース)16に固定されたスレーブアーム(保持部)21Aと、スレーブアーム21Aの先端部23Aに固定された位置決めアーム(位置決め部)24Aと、位置決めアーム24Aに設けられた姿勢センサ(基準姿勢検出部)27A、着脱部駆動部28A、および変位検出部29Aと、後述する着脱部52Aに取り付けられた術具200の鉗子部203の初期状態における位置および姿勢を記憶する処置部初期位置検出部30Aと、鉗子部203の位置および姿勢を算出して記憶する処置部位置検出部31Aを有している。
なお、以下では、スレーブマニピュレータ20Aの構成については、数字の後に英字「A」を付加して示すことにする。
2 and 3, the slave manipulator 20A is fixed to a slave arm (holding portion) 21A having a base end portion 22A fixed to a surgical top plate (base) 16, and to a distal end portion 23A of the slave arm 21A. Positioning arm (positioning portion) 24A, posture sensor (reference posture detection portion) 27A provided on the positioning arm 24A, attachment / detachment portion drive portion 28A, displacement detection portion 29A, and operation attached to an attachment / detachment portion 52A described later A treatment unit initial position detection unit 30A that stores the position and posture of the forceps unit 203 in the initial state of the instrument 200 and a treatment unit position detection unit 31A that calculates and stores the position and posture of the forceps unit 203 are provided.
In the following, the configuration of the slave manipulator 20A is indicated by adding an alphabetic character “A” after the number.

スレーブアーム21Aは、図2に示すように、台座32A、および2つの軸体33A、34Aが公知のボールジョイント35A、36Aにより接続された構成となっている。具体的には、台座32Aと軸体33Aとがボールジョイント35Aにより接続されていて、軸体33Aと軸体34Aとがボールジョイント36Aにより接続されている。台座32Aは手術用天板16に固定されている。なお、台座32Aがスレーブアーム21Aの基端部22Aを構成し、軸体34Aの先端部がスレーブアーム21Aの先端部23Aを構成する。
ボールジョイント35Aにより、台座32Aに対して軸体33Aを揺動させることができる。ボールジョイント36Aにより、軸体33Aに対して軸体34Aを揺動させることができる。
ボールジョイント35Aには、固定機構37Aが設けられていて、固定機構37Aによりボールジョイント35Aを構成する受け部に対してボールを固定させることができる。これにより、台座32Aに対して軸体33Aを固定させることができる。
同様に、ボールジョイント36Aには、固定機構38Aが設けられていて、軸体33Aに対して軸体34Aを固定させることができる。
As shown in FIG. 2, the slave arm 21A has a structure in which a pedestal 32A and two shaft bodies 33A and 34A are connected by known ball joints 35A and 36A. Specifically, the pedestal 32A and the shaft body 33A are connected by a ball joint 35A, and the shaft body 33A and the shaft body 34A are connected by a ball joint 36A. The pedestal 32 </ b> A is fixed to the surgical top plate 16. The pedestal 32A constitutes the proximal end portion 22A of the slave arm 21A, and the distal end portion of the shaft body 34A constitutes the distal end portion 23A of the slave arm 21A.
The shaft body 33A can be swung with respect to the base 32A by the ball joint 35A. The shaft body 34A can be swung with respect to the shaft body 33A by the ball joint 36A.
The ball joint 35A is provided with a fixing mechanism 37A, and the ball can be fixed to the receiving portion constituting the ball joint 35A by the fixing mechanism 37A. Thereby, shaft 33A can be fixed to pedestal 32A.
Similarly, the ball joint 36A is provided with a fixing mechanism 38A, and the shaft body 34A can be fixed to the shaft body 33A.

このように構成されたスレーブアーム21Aは、固定機構37A、38Aによる固定を解除したときには、台座32Aに対する軸体33A、34Aの位置を調節可能な調節モードとなる。一方で、固定機構37A、38Aにより固定したときには、台座32Aに対する軸体33A、34Aの位置を固定した固定モードとなる。
スレーブアーム21Aは、調節モードと固定モードとの間で切り替え可能となっている。
The slave arm 21A configured as described above is in an adjustment mode in which the positions of the shaft bodies 33A and 34A with respect to the base 32A can be adjusted when the fixing by the fixing mechanisms 37A and 38A is released. On the other hand, when fixed by the fixing mechanisms 37A and 38A, the fixing mode is set in which the positions of the shaft bodies 33A and 34A with respect to the base 32A are fixed.
The slave arm 21A can be switched between an adjustment mode and a fixed mode.

位置決めアーム24Aは、いわゆる平行リンク41Aを備えている。具体的には、平行リンク41Aは、図3に示すように、互いに平行に配置された第一の辺要素42A、43A、44A、および、互いに平行に配置された第二の辺要素45A、46A、47Aを有している。第一の辺要素42A、43A、44A、および、第二の辺要素45A、46A、47Aは、ステンレス鋼などの金属などで棒状に形成されている。この例では、第一の辺要素43A、44Aの長さは互いに等しく設定され、第一の辺要素42Aは第一の辺要素43Aより短く設定されている。第一の辺要素43Aは、第一の辺要素42Aと第一の辺要素44Aとの間に並べて配置されている。
第二の辺要素45A、46Aの長さは互いに等しく設定され、第二の辺要素47Aは第二の辺要素45Aより短く設定されている。第二の辺要素46Aは、第二の辺要素45Aと第二の辺要素47Aとの間に並べて配置されている。
The positioning arm 24A includes a so-called parallel link 41A. Specifically, as shown in FIG. 3, the parallel link 41A includes first side elements 42A, 43A, 44A arranged in parallel to each other, and second side elements 45A, 46A arranged in parallel to each other. 47A. The first side elements 42A, 43A, 44A and the second side elements 45A, 46A, 47A are formed in a rod shape from a metal such as stainless steel. In this example, the lengths of the first side elements 43A and 44A are set to be equal to each other, and the first side element 42A is set to be shorter than the first side element 43A. The first side element 43A is arranged side by side between the first side element 42A and the first side element 44A.
The lengths of the second side elements 45A and 46A are set to be equal to each other, and the second side element 47A is set to be shorter than the second side element 45A. The second side element 46A is arranged side by side between the second side element 45A and the second side element 47A.

第一の辺要素44Aに設けられたピン48Aにより、第一の辺要素44Aに対して第二の辺要素45A、46A、47Aが基準平面S上で回動可能に支持されている。
同様に、第一の辺要素43Aに設けられたピン48Aにより、第一の辺要素43Aに対して第二の辺要素45A、46A、47Aが基準平面S上で回動可能に支持されている。第一の辺要素42Aに設けられたピン48Aにより、第一の辺要素42Aに対して第二の辺要素45A、46Aが基準平面S上で回動可能に支持されている。
The second side elements 45A, 46A, and 47A are rotatably supported on the reference plane S with respect to the first side element 44A by pins 48A provided on the first side element 44A.
Similarly, the second side elements 45A, 46A, and 47A are rotatably supported on the reference plane S with respect to the first side element 43A by a pin 48A provided on the first side element 43A. . The second side elements 45A and 46A are rotatably supported on the reference plane S with respect to the first side element 42A by pins 48A provided on the first side element 42A.

第一の辺要素42Aの先端側を支持し、第一の辺要素42Aを基準平面Sと直交する平面上で回動可能にする回動機構55Aが設けられている。回動機構55Aを固定する固定部51Aが設けられている。固定部51Aによって、位置決めアーム24Aはスレーブアーム21Aに対して位置決め固定される。具体的には、固定部51Aは、スレーブアーム21Aの先端部23A、すなわち、軸体34Aの先端部に固定される。スレーブアーム21Aの軸体34Aと固定部51Aとは、ネジ止めや溶接などで固定されている。
これらの構成により、位置決めアーム24Aを固定部51Aに対して互いに直交する方向D1(基準平面S上)、方向D2(基準平面Sと直交する平面上)に揺動させたりすることができる。
第二の辺要素47Aには、術具200の術具挿入部201の基端部が着脱可能とされた着脱部52Aが、着脱部移動機構(処置部駆動部)53Aを介して取り付けられている。なお、この着脱部移動機構53Aと前述の着脱部駆動部28Aとで、駆動部を構成する。
着脱部52Aには、図4に示すように、着脱部52Aに術具200を取り付けたときに、術具200のワイヤ操作モータの電気接点と電気的に接続可能な着脱部側電気接点54Aが外部に露出した状態で備えられている。
着脱部側電気接点54Aは、制御装置60に接続されている。
A rotation mechanism 55A that supports the tip side of the first side element 42A and allows the first side element 42A to rotate on a plane orthogonal to the reference plane S is provided. A fixing portion 51A for fixing the rotation mechanism 55A is provided. The positioning arm 24A is positioned and fixed with respect to the slave arm 21A by the fixing portion 51A. Specifically, the fixing portion 51A is fixed to the distal end portion 23A of the slave arm 21A, that is, the distal end portion of the shaft body 34A. The shaft body 34A and the fixing portion 51A of the slave arm 21A are fixed by screwing or welding.
With these configurations, the positioning arm 24A can be swung in a direction D1 (on the reference plane S) and a direction D2 (on a plane orthogonal to the reference plane S) perpendicular to the fixed portion 51A.
The second side element 47A is attached with an attachment / detachment portion 52A in which the proximal end portion of the surgical instrument insertion portion 201 of the surgical instrument 200 is attachable / detachable via an attachment / detachment portion moving mechanism (treatment portion drive portion) 53A. Yes. The attaching / detaching part moving mechanism 53A and the attaching / detaching part driving part 28A described above constitute a driving part.
As shown in FIG. 4, the detachable portion 52A has a detachable portion side electrical contact 54A that can be electrically connected to the electrical contact of the wire operation motor of the surgical tool 200 when the surgical tool 200 is attached to the detachable portion 52A. It is provided in an exposed state.
The attachment / detachment portion side electrical contact 54 </ b> A is connected to the control device 60.

着脱部移動機構53Aは、図3に示すように、着脱部52Aを移動させる公知の構成を有している。この例では、着脱部52Aに術具200を取り付けたときに、術具200の術具挿入部201は第二の辺要素47Aと平行になるように構成されている。
着脱部移動機構53Aは、着脱部52Aを、基準軸線C1上に設定される配置中心位置を中心として移動させることができる。具体的には、着脱部52Aに取り付けた術具200を着脱部52Aに対して、配置中心位置から基準軸線C1方向に進退させたり、基準軸線C1周りに回動させることができる。
As shown in FIG. 3, the attaching / detaching portion moving mechanism 53A has a known configuration for moving the attaching / detaching portion 52A. In this example, when the surgical instrument 200 is attached to the detachable part 52A, the surgical instrument insertion part 201 of the surgical instrument 200 is configured to be parallel to the second side element 47A.
The attaching / detaching portion moving mechanism 53A can move the attaching / detaching portion 52A around the arrangement center position set on the reference axis C1. Specifically, the surgical instrument 200 attached to the attachment / detachment part 52A can be moved forward / backward from the arrangement center position in the direction of the reference axis C1 or rotated around the reference axis C1 with respect to the attachment / detachment part 52A.

本実施形態では姿勢センサ27Aは、図示はしないが、公知のジャイロスコープ、および、ジャイロスコープによる検出結果を処理してジャイロスコープの姿勢(向き)を検出する基準姿勢演算基板を有している。ジャイロスコープの姿勢は、例えば、図2に示す手術用天板16の上面に原点Oが規定される直交座標系であるグローバル座標系Wのそれぞれの軸回りの回転角度として表される。
姿勢センサ27Aは、図3に示すように位置決めアーム24Aの第二の辺要素45Aの長軸方向に取り付けられている。すなわち、この例では姿勢センサ27Aが姿勢を検出する基準位置V1は、第二の辺要素45A上、言い換えれば、位置決めアーム24Aの基端部に設定されている。姿勢センサ27Aは、基準位置V1における第二の辺要素45Aの長軸方向の姿勢を検出することができる。
このとき、術具200は第二の辺要素45Aと平行になるように構成されていることから、第二の辺要素45Aの基準位置V1における第二の辺要素45Aの長軸方向の姿勢は術具200の挿入方向の姿勢と略一致する。
姿勢センサ27Aにより検出された基準位置V1の姿勢は、図4に示すように制御装置60に送信される。
In the present embodiment, the attitude sensor 27A includes a known gyroscope and a reference attitude calculation board that detects the attitude (orientation) of the gyroscope by processing the detection result of the gyroscope, although not shown. The attitude of the gyroscope is expressed as, for example, a rotation angle around each axis of the global coordinate system W 0 which is an orthogonal coordinate system in which the origin O 0 is defined on the upper surface of the surgical top plate 16 shown in FIG.
The attitude sensor 27A is attached in the major axis direction of the second side element 45A of the positioning arm 24A as shown in FIG. That is, in this example, the reference position V1 at which the posture sensor 27A detects the posture is set on the second side element 45A, in other words, at the base end portion of the positioning arm 24A. The attitude sensor 27A can detect the attitude of the second side element 45A in the major axis direction at the reference position V1.
At this time, since the surgical instrument 200 is configured to be parallel to the second side element 45A, the posture of the second side element 45A in the major axis direction at the reference position V1 of the second side element 45A is This substantially matches the posture of the surgical instrument 200 in the insertion direction.
The attitude of the reference position V1 detected by the attitude sensor 27A is transmitted to the control device 60 as shown in FIG.

着脱部駆動部28Aは、不図示のモータおよびギアを有している。モータを駆動してギアを回転させることで、図3に示す第一の辺要素43Aと第二の辺要素45Aとのなす角度θを、鋭角から鈍角まで調節することができる。
位置決めアーム24Aは前述のように構成されているため、角度θが定まれば位置決めアーム24Aの形状も一意に定まる。図3では角度θが約90°の状態を示しているが、着脱部駆動部28Aを駆動して図5に示すように角度θを鋭角にすると、固定部51Aに対する着脱部52Aの位置および姿勢を移動させることができる。
The attaching / detaching unit driving unit 28A has a motor and a gear (not shown). By driving the motor and rotating the gear, the angle θ formed by the first side element 43A and the second side element 45A shown in FIG. 3 can be adjusted from an acute angle to an obtuse angle.
Since the positioning arm 24A is configured as described above, the shape of the positioning arm 24A is uniquely determined when the angle θ is determined. 3 shows a state in which the angle θ is about 90 °, the position and orientation of the attaching / detaching portion 52A with respect to the fixing portion 51A when the attaching / detaching portion driving portion 28A is driven to make the angle θ acute as shown in FIG. Can be moved.

着脱位置検出部29Aは、図示はしないが、前述の角度θを検出するエンコーダなどの角度検出センサと、検出した角度θから基準位置V1に対する着脱部52Aの位置(距離)および姿勢(角度)を検出する着脱位置演算基板とを有している。着脱位置演算基板には、図示はしないが演算素子、メモリ、およびタイマが備えられている。
メモリには、隣り合うピン48A間の距離や、第二の辺要素45Aにおける基準位置V1が設定された位置や、第二の辺要素47Aにおける着脱部52Aが取り付けられた位置などが記憶されている。
演算素子は、メモリに記憶された各距離情報、および角度検出センサで検出された角度θから基準位置V1から着脱部52Aまでの距離(位置)および角度(姿勢)を算出することができる。
Although not shown, the attachment / detachment position detection unit 29A includes the angle detection sensor such as the encoder that detects the angle θ described above, and the position (distance) and posture (angle) of the attachment / detachment unit 52A with respect to the reference position V1 based on the detected angle θ. A detachable position calculation board for detection. The detachable position calculation board includes a calculation element, a memory, and a timer (not shown).
The memory stores the distance between adjacent pins 48A, the position where the reference position V1 is set in the second side element 45A, the position where the detachable portion 52A is attached in the second side element 47A, and the like. Yes.
The arithmetic element can calculate the distance (position) and angle (posture) from the reference position V1 to the detachable portion 52A from each distance information stored in the memory and the angle θ detected by the angle detection sensor.

また、演算素子は、タイマに設定された単位時間ごとに基準位置V1から着脱部52Aまでの距離および角度を検出し、検出した距離および角度情報は着脱部52Aの位置および姿勢としてメモリに記憶される。単位時間は、制御装置60の処理速度や手技の内容などに応じて、例えば、1ms(ミリ秒)から500ms程度に設定される。
演算素子は、メモリに記憶された単位時間おきの着脱部52Aの位置および姿勢から、基準位置V1に対する着脱部52Aの単位時間当たりの位置の変化量および姿勢の変化量を算出する。
着脱位置検出部29Aにより算出された前述の基準位置V1に対する着脱部52Aの位置および姿勢、着脱部52Aの位置の変化量および姿勢の変化量は、制御装置60に送信される(図4参照。)。
The arithmetic element detects the distance and angle from the reference position V1 to the detachable part 52A every unit time set in the timer, and the detected distance and angle information is stored in the memory as the position and orientation of the detachable part 52A. The The unit time is set, for example, from about 1 ms (milliseconds) to about 500 ms in accordance with the processing speed of the control device 60 and the contents of the procedure.
The arithmetic element calculates the amount of change in position and the amount of change in posture of the attachment / detachment unit 52A per unit time with respect to the reference position V1 from the position and posture of the attachment / detachment unit 52A in unit time stored in the memory.
The position and orientation of the attachment / detachment unit 52A relative to the reference position V1 calculated by the attachment / detachment position detection unit 29A, the change amount of the position of the attachment / detachment unit 52A, and the change amount of the orientation are transmitted to the control device 60 (see FIG. 4). ).

処置部位置検出部31Aは、術具200の長さLなどを予め記憶するとともに、着脱部52Aに対する鉗子部203の位置および姿勢を算出する。この例では、術具挿入部201の基端部の位置に対して、鉗子部203の位置は、術具挿入部201の長手方向に長さL移動した位置となっている。
なお、この処置部位置検出部31Aと前述の着脱位置検出部29Aとで、変位検出部を構成する。
The treatment unit position detection unit 31A stores the length L of the surgical instrument 200 in advance and calculates the position and posture of the forceps unit 203 with respect to the attachment / detachment unit 52A. In this example, the position of the forceps portion 203 is a position moved by a length L in the longitudinal direction of the surgical instrument insertion portion 201 with respect to the position of the proximal end portion of the surgical instrument insertion portion 201.
The treatment section position detection section 31A and the above-described attachment / detachment position detection section 29A constitute a displacement detection section.

処置部位置検出部31Aは、基準位置V1の初期位置および姿勢センサ27Aが検出した姿勢から、着脱位置検出部29Aが検出した着脱部52Aの移動距離および角度だけ移動させ、さらに、着脱部52Aに対する鉗子部203の位置および姿勢だけ移動させた位置および姿勢を、鉗子部203における位置および姿勢として算出する。
具体的には、演算素子は、基準位置V1の初期位置に原点が規制されて第二の辺要素45Aの長軸方向を向く直交座標系であるローカル座標系Wを構成するある1つの軸(例えば、Z軸。)に対して、着脱位置検出部29Aが検出した基準位置V1(原点)から着脱部52Aまでの距離を、着脱部52Aのその軸における位置として算出する。さらに、その軸において、着脱部52Aの位置から、着脱部52Aに対する鉗子部203の位置だけ移動させた位置として算出する。
この位置の算出は、ローカル座標系Wを構成する残りの2つの軸に対しても同様に行われる。
The treatment unit position detection unit 31A moves from the initial position of the reference position V1 and the posture detected by the posture sensor 27A by the movement distance and angle of the detachment unit 52A detected by the detachment position detection unit 29A, and further to the detachment unit 52A. The position and posture moved by the position and posture of the forceps unit 203 are calculated as the position and posture in the forceps unit 203.
Specifically, the arithmetic device is one axis constituting the local coordinate system W S origin to the initial position of the reference position V1 is an orthogonal coordinate system oriented in the long axis direction of the second side element 45A is restricted (e.g., Z S axis.) relative to the distance from the reference position V1 detaching position detecting section 29A has detected (origin) to detachable unit 52A, is calculated as the position of the axis of the detachable portion 52A. Further, on the axis, the position calculated by moving the position of the forceps part 203 relative to the attachment / detachment part 52A from the position of the attachment / detachment part 52A is calculated.
The calculation of the position is performed in the same manner for the remaining two axes constituting the local coordinate system W S.

一方で、鉗子部203の姿勢の算出については、グローバル座標系Wを構成するある1つの軸に対して、基準位置V1におけるその軸周りの回転角度に、着脱位置検出部29Aが検出した着脱部52Aのその軸周りの回転角度を足し合わせていくことで、着脱部52Aのその軸周りの回転角度(姿勢)を算出する。さらに、着脱部52Aの姿勢から、着脱部52Aに対する鉗子部203の姿勢だけ移動させた姿勢を、鉗子部203における姿勢として算出する。
この足し合わせによる回転角度、すなわち姿勢の算出は、グローバル座標系Wを構成する残りの2つの軸に対しても同様に行われる。
Meanwhile, the calculation of the orientation of the gripper 203, for a single axis constituting the global coordinate system W 0, the rotation angle around its axis at the reference position V1, detaching position detecting section 29A has detected removable The rotation angle (posture) around the axis of the detachable part 52A is calculated by adding the rotation angles around the axis of the part 52A. Further, a posture obtained by moving only the posture of the forceps portion 203 relative to the detachable portion 52A from the posture of the detachable portion 52A is calculated as a posture in the forceps portion 203.
Rotation angle by the summing, i.e. calculate the orientation is performed in the same manner for the remaining two axes constituting the global coordinate system W 0.

処置部初期位置検出部30Aは、初期状態において、処置部位置検出部31Aが算出した鉗子部203の位置および姿勢を記憶する。 The treatment unit initial position detection unit 30A stores the position and posture of the forceps unit 203 calculated by the treatment unit position detection unit 31A in the initial state.

制御装置60は、図4に示すように、バス61に接続された主制御部62、スレーブ制御部(駆動部制御部)63、入力部64、および、電源67を有している。
バス61には、公知の内視鏡56、そして前述のマスタマニピュレータ10、表示部13、姿勢センサ27A、着脱位置検出部29A、処置部初期位置検出部30A、処置部位置検出部31A、着脱部駆動部28A、着脱部52A、および、着脱部移動機構53Aが金属製の配線により接続されている。
主制御部62、スレーブ制御部63は、それぞれがCPU(中央処理装置)、制御プログラムなどで構成される。
As shown in FIG. 4, the control device 60 includes a main control unit 62, a slave control unit (drive unit control unit) 63, an input unit 64, and a power source 67 connected to the bus 61.
The bus 61 includes a known endoscope 56, the master manipulator 10, the display unit 13, the posture sensor 27A, the attachment / detachment position detection unit 29A, the treatment unit initial position detection unit 30A, the treatment unit position detection unit 31A, and the attachment / detachment unit. The drive unit 28A, the attachment / detachment unit 52A, and the attachment / detachment unit moving mechanism 53A are connected by metal wiring.
Each of the main control unit 62 and the slave control unit 63 includes a CPU (Central Processing Unit), a control program, and the like.

スレーブ制御部63は、前述の操作指令に基づいて着脱部駆動部28Aおよび着脱部移動機構53Aを制御する。この制御方法については、後述する。 The slave control unit 63 controls the attaching / detaching unit driving unit 28A and the attaching / detaching unit moving mechanism 53A based on the above-described operation command. This control method will be described later.

主制御部62は、内視鏡56においてCCD(Charge Coupled Device)などを有する観察部で取得した画像を信号に変換したものを処理して表示部13に送信するなど、制御装置60に関する全般的な処理をする。
入力部64は、例えばキーボードであり、介助者が必要な指示を入力する。入力された指示は主制御部62などに送信される。
電源67は、マスタマニピュレータ10、内視鏡56、表示部13、スレーブマニピュレータ20A、および制御装置60の各構成に電力を供給する。
The main control unit 62 performs general processing related to the control device 60 such as processing an image obtained by converting an image acquired by an observation unit having a CCD (Charge Coupled Device) in the endoscope 56 into a signal and transmitting the signal to the display unit 13. Process.
The input unit 64 is a keyboard, for example, and inputs a necessary instruction by an assistant. The input instruction is transmitted to the main control unit 62 and the like.
The power supply 67 supplies power to each component of the master manipulator 10, the endoscope 56, the display unit 13, the slave manipulator 20A, and the control device 60.

次に、以上のように構成された本実施形態の手術支援装置1を用いた手技を、スレーブマニピュレータ20A、および制御装置60の動作に重点をおいて説明する。以下では、患者の体腔内に術具200を導入して対象組織を処置する場合を例にとって説明する。 Next, a procedure using the surgery support apparatus 1 of the present embodiment configured as described above will be described with emphasis on the operations of the slave manipulator 20A and the control apparatus 60. Hereinafter, a case where the target tissue is treated by introducing the surgical instrument 200 into the body cavity of the patient will be described as an example.

手術支援装置1を起動すると、制御装置60の電源67からマスタマニピュレータ10、スレーブマニピュレータ20Aなどに電力が供給される。この時点では、スレーブアーム21Aは固定モードになっている。
介助者は、手術用天板16に図1および2に示すように患者Pを寝かせて必要な処置をする。不図示のナイフなどで、図3に示すように患者Pの体壁P1を切開して開口P2を形成する。この開口P2には、図示はしないがトロッカーを取り付けておく。
使用者Qの指示に基づいて、着脱部52Aに術具200の術具挿入部201の基端部を取り付ける。体壁P1に形成した別の開口から内視鏡56を導入し、観察部で取得した画像を表示部13で確認しながら処置を行う。
スレーブアーム21Aを調節モードに切り替えてスレーブアーム21Aを変形させ、術具200の鉗子部203を開口P2を通して患者Pの体腔P3内に導入する。このとき、術具200は下方に延びており、位置決めアーム24Aの角度θは、約90°になっているとする。
When the surgery support device 1 is activated, power is supplied from the power source 67 of the control device 60 to the master manipulator 10, the slave manipulator 20A, and the like. At this time, the slave arm 21A is in the fixed mode.
The caregiver lays the patient P on the surgical top 16 as shown in FIGS. 1 and 2 and performs necessary treatment. An opening P2 is formed by incising the body wall P1 of the patient P with a knife (not shown) as shown in FIG. Although not shown, a trocar is attached to the opening P2.
Based on the instruction of the user Q, the proximal end portion of the surgical instrument insertion portion 201 of the surgical instrument 200 is attached to the attachment / detachment portion 52A. The endoscope 56 is introduced from another opening formed in the body wall P1, and treatment is performed while confirming an image acquired by the observation unit on the display unit 13.
The slave arm 21A is switched to the adjustment mode to deform the slave arm 21A, and the forceps portion 203 of the surgical instrument 200 is introduced into the body cavity P3 of the patient P through the opening P2. At this time, the surgical instrument 200 extends downward, and the angle θ of the positioning arm 24A is about 90 °.

このように術具200を位置決めした後で、スレーブアーム21Aを固定モードに切り替える。
入力部64を操作して、姿勢センサ27A、着脱位置検出部29A、および処置部位置検出部31Aで検出した回転角度を足し合わせた鉗子部203における回転角度を鉗子部203の初期姿勢として処置部初期位置検出部30Aに記憶させる(イニシャライズする。)。また、基準位置V1における初期位置を仮想原点としたときの鉗子部203の位置を鉗子部203の初期位置として処置部初期位置検出部30Aに記憶させる。
処置部初期位置検出部30Aは、記憶した鉗子部203の初期位置および初期姿勢をスレーブ制御部63に送信する。
After positioning the surgical instrument 200 in this manner, the slave arm 21A is switched to the fixed mode.
By operating the input unit 64, the rotation angle in the forceps unit 203 obtained by adding the rotation angles detected by the posture sensor 27A, the attachment / detachment position detection unit 29A, and the treatment unit position detection unit 31A is set as the initial posture of the forceps unit 203. Store (initialize) the initial position detection unit 30A. In addition, the position of the forceps unit 203 when the initial position at the reference position V1 is set as the virtual origin is stored in the treatment unit initial position detection unit 30A as the initial position of the forceps unit 203.
The treatment unit initial position detection unit 30A transmits the stored initial position and initial posture of the forceps unit 203 to the slave control unit 63.

続いて、使用者Qは椅子12に座り、右手Q1および左手Q2で一対のマスタマニピュレータ10をそれぞれ把持し操作する。ここでは、使用者Qがマスタマニピュレータ10を操作して着脱部駆動部28Aを駆動させることで術具200を揺動させて、鉗子部203の水平方向の位置を変化させる場合で説明する。
以下では、説明の便宜のため鉗子部203の位置のみに着目して説明する。
Subsequently, the user Q sits on the chair 12 and holds and operates the pair of master manipulators 10 with the right hand Q1 and the left hand Q2, respectively. Here, a case where the user Q operates the master manipulator 10 to drive the attachment / detachment unit driving unit 28A to swing the surgical instrument 200 and change the horizontal position of the forceps unit 203 will be described.
Hereinafter, for convenience of explanation, only the position of the forceps portion 203 will be described.

図6において、曲線L1は操作指令による鉗子部203の水平方向の位置(目標値)であり、曲線L2は制御装置60が認識している鉗子部203の位置(測定値)である。
操作開始時刻Tから、使用者Qはマスタマニピュレータ10を操作して、術具200の鉗子部203を図3中の矢印Bのように移動させる操作指令を曲線L1に示すように発したとする。
In FIG. 6, a curved line L1 is a horizontal position (target value) of the forceps part 203 according to an operation command, and a curved line L2 is a position (measured value) of the forceps part 203 recognized by the control device 60.
From the operation start time T 0 , the user Q operates the master manipulator 10 to issue an operation command to move the forceps portion 203 of the surgical instrument 200 as indicated by an arrow B in FIG. To do.

まず、目標変化量算出工程において、スレーブ制御部63は、操作開始時刻Tから単位時間△T経過した時刻Tに、操作指令に表される鉗子部203における操作開始時刻Tから時刻Tまでの単位時間△T当たりの目標位置の変化量△Zを算出する。
次に、移動工程において、スレーブ制御部63は、鉗子部203が単位時間△T当たりに目標位置の変化量△Zだけ移動するように、すなわちイニシャライズ時に記憶した鉗子部203の初期位置からの変化量が△Zとなるように着脱部駆動部28Aを制御する。具体的には、時刻Tに前述の角度θが小さくなるように(図5参照。)制御する。
First, the target change amount calculation step, the slave controller 63, the time T 1 has elapsed the unit time △ T from the operation start time T 0, the time from the operation start time T 0 in the gripper 203 represented on the operation command T calculates the amount of change △ Z 1 of the target position of the unit time △ per T until 1.
Then, in the moving step, the slave controller 63, as gripper 203 moves per unit time △ T by variation △ Z 1 of the target position, i.e. from the initial position of the gripper 203 stored during initialization the amount of change is to control the detachable unit driver 28A such that the △ Z 1. Specifically, the control is performed so that the angle θ described above becomes small at time T 1 (see FIG. 5).

続いて、目標変化量算出工程において、スレーブ制御部63は、時刻Tから単位時間△T経過した時刻Tに、操作指令に表される鉗子部203における操作開始時刻Tから時刻Tまでの単位時間△T当たりの目標位置の変化量△Zを算出する。
次に、移動工程において、スレーブ制御部63は、鉗子部203が単位時間△T当たりに目標位置の変化量△Zだけ移動するように、すなわち時刻Tでの鉗子部203の位置からの変化量が△Zとなるように着脱部駆動部28Aを制御する。具体的には、時刻Tに角度θが小さくなるように制御する。
Subsequently, the target change amount calculation step, the slave controller 63, the time T 2, which has passed the unit time △ T from the time T 1, the start operation at the gripper 203 represented on the operation command time T 1 from the time T 2, The amount of change ΔZ 2 of the target position per unit time ΔT is calculated.
Then, in the moving step, the slave controller 63, from the position of the gripper 203 of the △ per T gripper 203 is a unit time so as to move only the change amount △ Z 2 of the target position, i.e. at time T 1 the amount of change is to control the detachable unit driver 28A such that the △ Z 2. Specifically, it controlled so that the angle θ decreases the time T 2.

このように、目標変化量算出工程と移動工程とを組にして所望の回数だけ繰り返し、変化量△Z、△Z、・・と順々に鉗子部203を図3中に矢印Bのように揺動させる。組にして繰り返す数は、1回だけでもよいし2回以上でもよい。
なお、術具200は、前述のように平行リンク41Aに取り付けられているため、第一の辺要素42Aと、着脱部52Aに取り付けられた術具200との交点を不動点(ポート位置)としたときに、平行リンク41Aの角度θによらず、術具200は不動点上に配置される。すなわち、患者Pの開口P2が不動点に一致するようにスレーブマニピュレータ20Aを移動させることで、平行リンク41Aの角度θによらず術具200が開口P2を通る。
In this way, the target change amount calculation step and the movement step are repeated as many times as desired, and the change amount ΔZ 3 , ΔZ 4 ,. Oscillate as follows. The number of repetitions in a set may be only once or two or more times.
Since the surgical instrument 200 is attached to the parallel link 41A as described above, the intersection of the first side element 42A and the surgical instrument 200 attached to the detachable portion 52A is defined as a fixed point (port position). When this is done, the surgical instrument 200 is placed on the fixed point regardless of the angle θ of the parallel link 41A. That is, the surgical instrument 200 passes through the opening P2 regardless of the angle θ of the parallel link 41A by moving the slave manipulator 20A so that the opening P2 of the patient P coincides with the fixed point.

また、このようにマスタマニピュレータ10を操作して術具200を揺動させる途中で、例えば、電源67の故障などにより手術支援装置1の動作が緊急的に停止してしまうことが考えられる。
例えば、図6に示すように、鉗子部203を変化量△Z移動させる直前に手術支援装置1の動作が緊急的に停止したとする。この場合、鉗子部203の移動は変化量で制御されているため、電源67が治って手術支援装置1の動作が開始されたときに、曲線L3で示されるように変化量△Zだけ移動しようとする。
一方で、本発明とは異なり、鉗子部203を目標位置で制御した場合には、手術支援装置の動作が開始されたときに、曲線L4で示されるように、手術支援装置の動作が開始したときの目標位置に移動させようとして、鉗子部が、例えば(△Z+△Z+△Z)の式で求められる値だけ、大きく移動する恐れがある。
ここでは鉗子部203の位置のみに着目して説明したが、鉗子部203の姿勢に関しても同様である。
Further, during the operation of the master manipulator 10 to swing the surgical instrument 200 in this way, it is conceivable that the operation of the surgery support apparatus 1 is urgently stopped due to a failure of the power supply 67, for example.
For example, as shown in FIG. 6, the operation of the operation support apparatus 1 immediately before moving the change amount △ Z 2 forceps portion 203 and stopped in emergency. In this case, the movement because it is controlled by the movement change amount of the gripper 203, when the power supply 67 is the operation of the operation support apparatus 1 is started heal, only the change amount △ Z 2 as shown by the curve L3 try to.
On the other hand, unlike the present invention, when the forceps unit 203 is controlled at the target position, when the operation of the surgery support apparatus is started, the operation of the surgery support apparatus starts as indicated by the curve L4. When trying to move to the target position, the forceps may move greatly by a value obtained by, for example, the equation (ΔZ 2 + ΔZ 3 + ΔZ 4 ).
Here, the description has been made focusing only on the position of the forceps portion 203, but the same applies to the posture of the forceps portion 203.

再び、手術支援装置1を用いた手技の説明を行う。
使用者Qは、マスタマニピュレータ10を操作して着脱部駆動部28Aにより術具200を揺動させ、図3に示すように鉗子部203を体腔P3内の処置対象となる病変部P6に対向させる。着脱部移動機構53Aにより術具200が取り付けられた着脱部52Aを押し込んで病変部P6に鉗子部203を当接させる。必要に応じて、着脱部移動機構53Aにより、術具200を基準軸線C1周りに回動させる。
着脱部52Aを介して術具200のワイヤ操作モータに電力を供給して一対の鉗子片202を閉じさせ、病変部P6を把持させる。
この後で、病変部P6に対して適切な処置を行い、一連の手技を終了する。
The procedure using the surgery support apparatus 1 will be described again.
The user Q operates the master manipulator 10 to swing the surgical instrument 200 by the attaching / detaching part driving unit 28A, and causes the forceps part 203 to face the lesioned part P6 to be treated in the body cavity P3 as shown in FIG. . The attachment / detachment part 52A to which the surgical instrument 200 is attached is pushed by the attachment / detachment part moving mechanism 53A to bring the forceps part 203 into contact with the lesioned part P6. If necessary, the surgical instrument 200 is rotated around the reference axis C1 by the attaching / detaching portion moving mechanism 53A.
Electric power is supplied to the wire operation motor of the surgical instrument 200 via the attachment / detachment part 52A to close the pair of forceps pieces 202 and grip the lesioned part P6.
Thereafter, appropriate treatment is performed on the lesioned part P6, and a series of procedures is completed.

以上説明したように、本実施形態のスレーブマニピュレータ20Aによれば、位置決めアーム24Aにはグローバル座標系Wにおける姿勢を検出可能な姿勢センサ27Aが設けられている。このため、従来のようにスレーブアーム21Aの各関節に角度検出センサなどを設けることなく、位置決めアーム24Aの基準位置V1の位置および姿勢を検出することができる。さらに、変位検出部により、基準位置V1に対する鉗子部203の姿勢を検出することができる。
このように、姿勢センサ27A、変位検出部という2つのセンサを備えることで、グローバル座標系Wにおける着脱部52Aの姿勢を検出することができる。したがって、鉗子部203の姿勢を検出するために必要なセンサの数を低減させることができる。
As described above, according to the slave manipulator 20A of the present embodiment, the detectable position sensor 27A is provided the orientation of the global coordinate system W 0 is the positioning arm 24A. For this reason, the position and posture of the reference position V1 of the positioning arm 24A can be detected without providing an angle detection sensor or the like at each joint of the slave arm 21A as in the prior art. Further, the posture of the forceps 203 with respect to the reference position V1 can be detected by the displacement detector.
Thus, by providing orientation sensor 27A, two sensors of the displacement detecting section can detect the orientation of the detachable portion 52A in the global coordinate system W 0. Therefore, the number of sensors necessary for detecting the posture of the forceps portion 203 can be reduced.

位置決めアーム24Aが平行リンク41Aを備えることで、患者Pの開口P2が不動点に一致するようにスレーブマニピュレータ20Aを移動させた状態でスレーブアーム21Aを固定モードにすることで、平行リンク41Aの角度θによらず術具200が開口P2を通る。
このため、術具200の揺動角度によらず、術具200が開口P2の縁部に外力を及ぼすことを抑制することができる。
Since the positioning arm 24A includes the parallel link 41A, the slave arm 21A is set to the fixed mode in a state in which the slave manipulator 20A is moved so that the opening P2 of the patient P coincides with the fixed point, thereby the angle of the parallel link 41A. The surgical instrument 200 passes through the opening P2 regardless of θ.
For this reason, it can suppress that the surgical instrument 200 exerts an external force on the edge part of the opening P2, regardless of the swing angle of the surgical instrument 200.

基準位置V1が、スレーブアーム21Aの第二の辺要素45A上、すなわち、位置決めアーム24Aの基端部に設定されているため、スレーブアーム21Aを固定モードにした後で基準位置V1が移動しない。着脱位置検出部29Aで検出する着脱部52Aの位置および姿勢の起点となる基準位置V1が移動しないため、着脱部52Aの位置および姿勢を容易に算出することができる。
処置部位置検出部31Aは、予め記憶した術具200の長さLなどの情報、および、算出した着脱部52Aの位置および姿勢から、鉗子部203の位置および姿勢を算出する。したがって、着脱部52Aの位置および姿勢だけでなく、実際に処置を行う部位である鉗子部203の位置および姿勢を算出し、精度よく制御を行うことができる。
Since the reference position V1 is set on the second side element 45A of the slave arm 21A, that is, the base end portion of the positioning arm 24A, the reference position V1 does not move after the slave arm 21A is set to the fixed mode. Since the reference position V1 that is the starting point of the position and orientation of the attachment / detachment unit 52A detected by the attachment / detachment position detection unit 29A does not move, the position and orientation of the attachment / detachment unit 52A can be easily calculated.
The treatment unit position detection unit 31A calculates the position and posture of the forceps unit 203 from information such as the length L of the surgical instrument 200 stored in advance and the calculated position and posture of the attachment / detachment unit 52A. Therefore, not only the position and posture of the detachable portion 52A but also the position and posture of the forceps portion 203, which is the part that is actually treated, can be calculated and controlled accurately.

また、本実施形態の手術支援装置1によれば、スレーブ制御部63が操作指令に表される着脱部52Aの単位時間△T当たりの目標位置の変化量および目標姿勢の変化量にしたがって着脱部駆動部28Aを制御する。このため、手術支援装置1の動作が緊急的に停止した場合であっても、動作が開始した手術支援装置1の着脱部52Aや鉗子部203が大きく移動するのを抑制することができる。
さらに、単位時間△T当たりの目標位置の変化量にしたがって着脱部駆動部28Aを制御することで、グローバル座標系Wにおける着脱部52Aの絶対値位置座標が不明であっても、イニシャライズにより設定された基準位置V1あるいは着脱部52Aの初期位置に対して、術具200の位置を相対的に制御することができる。
Moreover, according to the surgery support apparatus 1 of the present embodiment, the detachable unit according to the amount of change in the target position and the amount of change in the target posture per unit time ΔT of the detachable unit 52A indicated by the slave control unit 63 in the operation command. The drive unit 28A is controlled. For this reason, even when the operation of the surgery support apparatus 1 is urgently stopped, it is possible to prevent the attachment / detachment part 52A and the forceps part 203 of the surgery support apparatus 1 that has started to move from moving greatly.
Further setting, by controlling the detachable unit driver 28A according to a change amount of the target position per unit time △ T, even absolute position coordinates of the removable portion 52A in the global coordinate system W 0 is unknown, the initialization The position of the surgical instrument 200 can be controlled relative to the reference position V1 or the initial position of the attaching / detaching part 52A.

なお、本実施形態では、イニシャライズ時に着脱部52Aの位置および姿勢を初期位置および初期姿勢として記憶したが、基準位置V1の位置および姿勢を初期位置および初期姿勢として記憶してもよい。この場合も、本実施形態と同様の効果を奏することができるからである。
本実施形態では、位置決めアーム24Aに術具200を着脱可能に支持する着脱部52Aを設けたが、位置決めアーム24Aと術具200を一体として固定支持するように構成してもよい。この場合も、イニシャライズ時に基準位置V1の位置および姿勢を初期位置および初期姿勢として記憶しておけば、基準位置V1に対して、術具200の位置を相対的に制御することができる。
本実施形態では、位置決めアーム24Aに着脱部52Aを移動させる着脱部駆動部28Aを設けたが、位置決めアーム24Aに着脱部駆動部28Aを設けず、術具200のみを移動させる着脱部移動機構53Aを設けるような構成にしてもよい。この場合も、イニシャライズ時に基準位置V1あるいは着脱部52Aの位置および姿勢を初期位置および初期姿勢として記憶しておけば、初期位置に対して、術具200の位置を相対的に制御することができる。
In the present embodiment, the position and orientation of the detachable portion 52A are stored as the initial position and initial posture at the time of initialization, but the position and posture of the reference position V1 may be stored as the initial position and initial posture. This is because the same effect as in the present embodiment can be obtained in this case as well.
In the present embodiment, the attachment / detachment portion 52A that removably supports the surgical instrument 200 is provided on the positioning arm 24A. However, the positioning arm 24A and the surgical instrument 200 may be integrally fixed and supported. Also in this case, if the position and posture of the reference position V1 are stored as the initial position and initial posture at the time of initialization, the position of the surgical instrument 200 can be controlled relative to the reference position V1.
In this embodiment, the attachment / detachment part drive unit 28A for moving the attachment / detachment part 52A is provided on the positioning arm 24A, but the attachment / detachment part moving mechanism 53A that moves only the surgical instrument 200 without providing the attachment / detachment part drive unit 28A on the positioning arm 24A. You may make it the structure which provides. Also in this case, if the position and posture of the reference position V1 or the detachable portion 52A are stored as the initial position and the initial posture at the time of initialization, the position of the surgical instrument 200 can be controlled relative to the initial position. .

本実施形態では、手術支援装置1に複数のスレーブマニピュレータ20Aを備えるとともに、1つの姿勢センサ27Aが、それぞれのスレーブマニピュレータ20Aの第二の辺要素45A上に着脱可能に取り付けられるように構成してもよい。第二の辺要素45Aと姿勢センサ27Aとの着脱は、係合部と被係合部とによる機械的な方式や、磁石などの磁気的な方式を用いることができる。
1つのスレーブマニピュレータ20Aについて、スレーブアーム21Aを固定モードにした後で、一度、姿勢センサ27Aにより基準位置V1の位置および姿勢を検出すれば、そのスレーブマニピュレータ20Aについてはスレーブアーム21Aを固定モードにしている間は姿勢センサ27Aは不要となる。
姿勢センサ27Aをこのように構成することで、手術支援装置1全体としての製造コストを低減させることができる。
In the present embodiment, the surgery support apparatus 1 includes a plurality of slave manipulators 20A, and one posture sensor 27A is configured to be detachably mounted on the second side element 45A of each slave manipulator 20A. Also good. For attachment / detachment between the second side element 45A and the posture sensor 27A, a mechanical method using an engaging portion and an engaged portion or a magnetic method such as a magnet can be used.
After the slave arm 21A is set to the fixed mode for one slave manipulator 20A, once the position and posture of the reference position V1 are detected by the posture sensor 27A, the slave arm 21A is set to the fixed mode for the slave manipulator 20A. The posture sensor 27 </ b> A is not necessary during the period of being.
By configuring the posture sensor 27A in this way, the manufacturing cost of the surgical operation support apparatus 1 as a whole can be reduced.

本実施形態では、姿勢センサ27Aは位置決めアーム24Aの第二の辺要素45Aに取り付けられているとしたが、姿勢センサ27Aが取り付けられる位置は、位置決めアーム24Aの基準位置V1の位置および姿勢が検出可能であれば特に限定されない。例えば、図7に示す手術支援装置1のように、姿勢センサ27Aを着脱部移動機構53Aに取り付けてもよい。この場合であっても、姿勢センサ27Aを着脱部移動機構53Aに取り付ける位置の情報が予め姿勢センサ27Aに記憶されていれば、位置決めアーム24Aにおける基準位置の位置および姿勢を検出可能であるからである。
また、姿勢センサ27Aはスレーブアーム21Aに取り付けてもよい。スレーブアーム21Aと位置決めアーム24Aとの位置・姿勢関係が予め姿勢センサ27Aに記憶されていれば、位置決めアーム24Aにおける基準位置の位置および姿勢を検出可能であるからである。
In this embodiment, the posture sensor 27A is attached to the second side element 45A of the positioning arm 24A. However, the position and posture of the reference position V1 of the positioning arm 24A is detected as the position where the posture sensor 27A is attached. There is no particular limitation if possible. For example, like the surgery support apparatus 1 shown in FIG. 7, the posture sensor 27A may be attached to the attachment / detachment unit moving mechanism 53A. Even in this case, it is possible to detect the position and posture of the reference position in the positioning arm 24A if information on the position where the posture sensor 27A is attached to the attaching / detaching portion moving mechanism 53A is stored in the posture sensor 27A in advance. is there.
Further, the posture sensor 27A may be attached to the slave arm 21A. This is because if the position / posture relationship between the slave arm 21A and the positioning arm 24A is stored in the posture sensor 27A in advance, the position and posture of the reference position in the positioning arm 24A can be detected.

着脱位置検出部29Aは、第一の辺要素42A、43A、44Aのいずれかと、第二の辺要素45A、46A、47Aのいずれかとがなす角度θが検出可能であれば、取り付け位置は特に限定されない。
また、本実施形態では、姿勢センサ27Aにおける基準姿勢演算基板、および、着脱位置検出部29Aにおける着脱位置演算基板を制御装置60内に配置してもよい。このように構成することで、制御基板を一体化して、制御基板を全体としてコンパクトに構成することができる。
平行リンク41Aが第一の辺要素43Aおよび第二の辺要素46Aを備えずに、平行リンク41Aが一対の第一の辺要素42A、44A、および、一対の第二の辺要素45A、47Aだけを有するように構成してもよい。
The attachment / detachment position detection unit 29A is particularly limited as long as the angle θ formed by any one of the first side elements 42A, 43A, and 44A and any one of the second side elements 45A, 46A, and 47A can be detected. Not.
In the present embodiment, the reference posture calculation board in the posture sensor 27A and the attach / detach position calculation board in the attach / detach position detection unit 29A may be arranged in the control device 60. By comprising in this way, a control board can be integrated and a control board can be comprised compactly as a whole.
The parallel link 41A does not include the first side element 43A and the second side element 46A, but the parallel link 41A includes only the pair of first side elements 42A and 44A and the pair of second side elements 45A and 47A. You may comprise so that it may have.

本実施形態では、スレーブアーム21Aの先端部23Aに、位置決めアーム24Aの固定部51Aが固定されているとしたが、スレーブアーム21Aの先端部23Aに固定部51Aが着脱可能となるように構成してもよい。
ここで、スレーブアーム21Aを患者Pの開口P2に対応させて適切な形状に変形させるスレーブアーム変形工程、位置決めアーム24Aを自身の不動点が患者Pの開口P2に一致するように配置する位置決めアーム配置工程、および、スレーブアーム21Aの先端部23Aに位置決めアーム24Aの固定部51Aを取り付ける取り付け工程を規定する。これら、スレーブアーム変形工程、位置決めアーム配置工程、および取り付け工程の順序は特に制限はなく、任意の順序で行うことができる。これら3つの工程を行った後で、前述の目標変化量算出工程と移動工程とを組にして繰り返すことになる。
In the present embodiment, the fixed portion 51A of the positioning arm 24A is fixed to the distal end portion 23A of the slave arm 21A. However, the fixed portion 51A is configured to be detachable from the distal end portion 23A of the slave arm 21A. May be.
Here, a slave arm deforming step for deforming the slave arm 21A into an appropriate shape corresponding to the opening P2 of the patient P, a positioning arm for positioning the positioning arm 24A so that its fixed point coincides with the opening P2 of the patient P An arrangement step and an attachment step of attaching the fixing portion 51A of the positioning arm 24A to the distal end portion 23A of the slave arm 21A are defined. The order of these slave arm deformation process, positioning arm arrangement process, and attachment process is not particularly limited, and can be performed in any order. After performing these three steps, the aforementioned target change amount calculating step and moving step are repeated as a set.

姿勢センサ27Aと処置部初期位置検出部30Aとが配線により接続されているとした。しかし、姿勢センサ27Aが、検出した基準位置V1の姿勢を無線通信により処置部初期位置検出部30Aに送信するように構成してもよい。
このように構成することで、スレーブマニピュレータ20Aを小型化することができる。
It is assumed that the posture sensor 27A and the treatment unit initial position detection unit 30A are connected by wiring. However, the posture sensor 27A may be configured to transmit the detected posture of the reference position V1 to the treatment unit initial position detection unit 30A through wireless communication.
With this configuration, the slave manipulator 20A can be reduced in size.

本実施形態では、スレーブ制御部63は、目標変化量算出工程において、処置部203の単位時間△T当たりの目標位置の変化量および目標姿勢の変化量を算出し、移動工程において目標位置の変化量および目標姿勢の変化量に基づいて制御するとした。しかし、スレーブ制御部63は、目標変化量算出工程において、標位置の変化量および目標姿勢の変化量の一方のみを算出し、移動工程においてこの一方のみに基づいて制御するとしてもよい。 In the present embodiment, the slave control unit 63 calculates the change amount of the target position and the change amount of the target posture per unit time ΔT of the treatment unit 203 in the target change amount calculation step, and changes the target position in the movement step. The control is based on the amount and the amount of change in the target posture. However, the slave control unit 63 may calculate only one of the change amount of the target position and the change amount of the target posture in the target change amount calculation step, and control based on only one of them in the movement step.

(第2実施形態)
次に、本発明の第2実施形態について図8および図9を参照しながら説明するが、前記実施形態と同一の部位には同一の符号を付してその説明は省略し、異なる点についてのみ説明する。
図8に示すように、本実施形態の手術支援装置2は、第1実施形態の手術支援装置1の各構成に加えて、前述の内視鏡56が着脱可能な着脱部52Bを有する本発明のスレーブマニピュレータ20Bを備えている。
なお、スレーブマニピュレータ20Bの構成はスレーブマニピュレータ20Aと同一であるため、スレーブマニピュレータ20Bの構成については、スレーブマニピュレータ20Aにおける対応する構成の符号の数字に英字「B」を付加することで示す。これにより、重複する説明を省略する。
(Second Embodiment)
Next, a second embodiment of the present invention will be described with reference to FIG. 8 and FIG. 9. However, the same parts as those of the above embodiment are denoted by the same reference numerals, and the description thereof will be omitted. explain.
As shown in FIG. 8, the surgery support apparatus 2 according to the present embodiment has an attachment / detachment part 52 </ b> B to which the endoscope 56 can be attached and detached in addition to the components of the surgery support apparatus 1 according to the first embodiment. Slave manipulator 20B.
Since the configuration of the slave manipulator 20B is the same as that of the slave manipulator 20A, the configuration of the slave manipulator 20B is indicated by adding the letter “B” to the numeral of the corresponding configuration in the slave manipulator 20A. Thereby, the overlapping description is omitted.

位置決めアーム24Bに取り付けられた着脱部52Bには、光軸C2に沿った外方の画像を取得するための観察部56aが設けられた内視鏡56が着脱可能となっている。
着脱部52Bに内視鏡56を取り付けたときに、観察部56aで取得された画像は、主制御部62で処理されて表示部13に表示されるようになっている(図9参照。)。
An endoscope 56 provided with an observation unit 56a for acquiring an outward image along the optical axis C2 can be attached to and detached from the attaching / detaching part 52B attached to the positioning arm 24B.
When the endoscope 56 is attached to the detachable unit 52B, the image acquired by the observation unit 56a is processed by the main control unit 62 and displayed on the display unit 13 (see FIG. 9). .

ここで、図8に示すように術具200の処置部203に原点Oが規定されて処置部203の先端側を向く直交座標系である第一のローカル座標系(第一の直交座標系)Wを規定する。すなわち、この第一のローカル座標系WのZ軸は、処置部203を起点として処置部203の先端側を向いている。同様に、内視鏡56の観察部56aに原点Oが規定されて光軸C2に沿って先端側を向く直交座標系である第二のローカル座標系(第二の直交座標系)Wを規定する。すなわち、この第二のローカル座標系WのZ軸は、観察部56aを起点として光軸C2に沿って先端側を向いている。
第一のローカル座標系Wから第二のローカル座標系Wへの変換は、公知のように変換行列Aで表される。
スレーブ制御部63は、マスタマニピュレータ10が発するグローバル座標系Wにおける目標位置および目標姿勢を表す操作指令を、変換行列Aで変換して変換操作指令を算出し、この変換操作指令に基づいて着脱部駆動部28Aを制御する。
Here, as shown in FIG. 8, a first local coordinate system (first orthogonal coordinate system) which is an orthogonal coordinate system in which the origin O 1 is defined in the treatment section 203 of the surgical instrument 200 and faces the distal end side of the treatment section 203. ) to define the W 1. That is, the Z 1 axis of the first local coordinate system W 1 faces the distal end side of the treatment unit 203 with the treatment unit 203 as a starting point. Similarly, a second local coordinate system (second orthogonal coordinate system) W 2, which is an orthogonal coordinate system in which the origin O 2 is defined in the observation unit 56 a of the endoscope 56 and faces the distal end along the optical axis C 2. Is specified. That is, the second Z 2 axes of the local coordinate system W 2 is oriented distally along the optical axis C2 of the observation portion 56a as a starting point.
The conversion of one of the local coordinate system W 1 to the second local coordinate system W 2 is represented by the transformation matrix A as known.
The slave control unit 63 converts an operation command representing the target position and target posture in the global coordinate system W 0 issued by the master manipulator 10 using the conversion matrix A to calculate a conversion operation command, and attach / detach based on the conversion operation command The unit drive unit 28A is controlled.

このように構成された本実施形態の手術支援装置2によれば、鉗子部203の位置および姿勢を検出するために必要なセンサの数を低減させることができる。
さらに、内視鏡56の光軸C2の先端側の姿勢と、処置部203の先端側の姿勢とが一致するように座標変換することで、表示部13に表示される画像上に映し出される処置部203の先端(処置部203)の姿勢とマスタマニピュレータ10の姿勢とを対応させやすくなる。したがって、表示部13に表示される画像を見ながらのマスタマニピュレータ10の操作性を向上させることができる。
According to the surgery support apparatus 2 of the present embodiment configured as described above, the number of sensors necessary for detecting the position and posture of the forceps unit 203 can be reduced.
Further, the treatment displayed on the image displayed on the display unit 13 is performed by performing coordinate conversion so that the posture of the endoscope 56 on the distal end side of the optical axis C2 and the posture of the treatment unit 203 are matched. It becomes easy to make the posture of the tip of the unit 203 (the treatment unit 203) correspond to the posture of the master manipulator 10. Therefore, the operability of the master manipulator 10 while viewing the image displayed on the display unit 13 can be improved.

なお、本実施形態では、手術支援装置2がスレーブマニピュレータ20Bを備え、スレーブマニピュレータ20Bの着脱部52Bに内視鏡56が着脱可能であるとした。しかし、スレーブマニピュレータ20Bは手術支援装置2に必須の構成ではなく、手術支援装置2が内視鏡56および表示部13を備えていればよい。内視鏡56が何に取り付けられていても、本実施形態と同様の効果を奏することができるからである。
ただし、手術支援装置2がスレーブマニピュレータ20Bを備え、スレーブマニピュレータ20Bに内視鏡56が着脱可能とすることで、内視鏡56の観察部56aの操作性を向上させることができる。
In the present embodiment, the surgery support apparatus 2 includes the slave manipulator 20B, and the endoscope 56 can be attached to and detached from the attachment / detachment part 52B of the slave manipulator 20B. However, the slave manipulator 20 </ b> B is not an essential component for the surgery support apparatus 2, and the surgery support apparatus 2 only needs to include the endoscope 56 and the display unit 13. This is because the same effect as that of the present embodiment can be obtained no matter what the endoscope 56 is attached to.
However, the operation support apparatus 2 includes the slave manipulator 20B, and the operability of the observation unit 56a of the endoscope 56 can be improved by making the endoscope 56 detachable from the slave manipulator 20B.

(第3実施形態)
次に、本発明の第3実施形態について図10および図11を参照しながら説明するが、前記実施形態と同一の部位には同一の符号を付してその説明は省略し、異なる点についてのみ説明する。
図10および11に示すように、本実施形態の手術支援装置3は、第1実施形態の手術支援装置1の各構成に加えて、術具(第二の術具)210が着脱可能な着脱部52Bを有する本発明のスレーブマニピュレータ(第二の医療用マニピュレータ)20Bを備えている。
すなわち、手術支援装置3は、スレーブマニピュレータ(第一の医療用マニピュレータ)20Aおよびスレーブマニピュレータ20Bの2つのスレーブマニピュレータを備えている。
前述の術具(第一の術具)200の術具挿入部201の先端部には接触センサ(送信部)205が設けられている。
制御装置60には記憶部65が備えられている(図11参照。)。
(Third embodiment)
Next, a third embodiment of the present invention will be described with reference to FIG. 10 and FIG. explain.
As shown in FIGS. 10 and 11, the surgery support apparatus 3 of the present embodiment is detachable with a surgical tool (second surgical tool) 210 in addition to the components of the surgery support apparatus 1 of the first embodiment. A slave manipulator (second medical manipulator) 20B of the present invention having a portion 52B is provided.
That is, the surgery support apparatus 3 includes two slave manipulators, a slave manipulator (first medical manipulator) 20A and a slave manipulator 20B.
A contact sensor (transmission unit) 205 is provided at the distal end portion of the surgical instrument insertion portion 201 of the surgical instrument (first surgical instrument) 200 described above.
The control device 60 includes a storage unit 65 (see FIG. 11).

第二の術具210の構成は硬性であれば特に限定されないが、本実施形態では前述の術具200と同一の鉗子が用いられている。すなわち、第二の術具210は、術具挿入部211の先端部に一対の鉗子片212からなる鉗子部(処置部)213が設けられたものである。
術具200に設けられた接触センサ205は、鉗子部203に外力が加わったことを検出するセンサである。接触センサ205は、術具200の鉗子部203と術具210の鉗子部213とが接触したときに、着脱部52Aの着脱部側電気接点54Aを介してスレーブ制御部63および記憶部65に制御信号を送信する。
The configuration of the second surgical instrument 210 is not particularly limited as long as it is rigid, but in the present embodiment, the same forceps as those of the aforementioned surgical instrument 200 are used. That is, the second surgical instrument 210 is provided with a forceps part (treatment part) 213 including a pair of forceps pieces 212 at the distal end of the surgical instrument insertion part 211.
A contact sensor 205 provided in the surgical instrument 200 is a sensor that detects that an external force is applied to the forceps portion 203. The contact sensor 205 is controlled by the slave control unit 63 and the storage unit 65 via the attachment / detachment portion side electrical contact 54A of the attachment / detachment portion 52A when the forceps portion 203 of the operation tool 200 contacts the forceps portion 213 of the operation tool 210. Send a signal.

スレーブ制御部63は制御信号を受信したときの、基準位置V1に対する鉗子部203の位置および姿勢、および基準位置V2に対する鉗子部213の位置および姿勢から、基準位置V1と基準位置V2との相対的な位置関係を算出する。
記憶部65はメモリなどで構成されていて、スレーブ制御部63で算出された基準位置V1と基準位置V2との相対的な位置関係、すなわちスレーブマニピュレータ20Aとスレーブマニピュレータ20Bの相対位置関係を記憶する。
When the slave control unit 63 receives the control signal, the relative position between the reference position V1 and the reference position V2 is determined based on the position and posture of the forceps unit 203 with respect to the reference position V1 and the position and posture of the forceps unit 213 with respect to the reference position V2. The relative positional relationship is calculated.
The storage unit 65 is configured by a memory or the like, and stores the relative positional relationship between the reference position V1 and the reference position V2 calculated by the slave control unit 63, that is, the relative positional relationship between the slave manipulator 20A and the slave manipulator 20B. .

次に、以上のように構成された本実施形態の手術支援装置3の動作について説明する。
手術支援装置3を起動し、スレーブマニピュレータ20Aの着脱部52Aに術具200を取り付けるとともに、スレーブマニピュレータ20Bの着脱部52Bに術具210を取り付ける。スレーブアーム21A、21Bを所望の形状に変形させた後で、スレーブアーム21A、21Bをそれぞれ固定モードにする。
Next, operation | movement of the surgery assistance apparatus 3 of this embodiment comprised as mentioned above is demonstrated.
The surgery support device 3 is activated, and the surgical instrument 200 is attached to the attachment / detachment part 52A of the slave manipulator 20A, and the surgical instrument 210 is attached to the attachment / detachment part 52B of the slave manipulator 20B. After the slave arms 21A and 21B are deformed into a desired shape, the slave arms 21A and 21B are set to the fixed mode, respectively.

使用者Qは、一対のマスタマニピュレータ10を操作してスレーブ制御部63により着脱部駆動部28A、28Bを駆動し、術具200の鉗子部203と術具210の鉗子部213とを接触させる。すると、接触センサ205は鉗子部203に外力が加わったことを検出し、記憶部65に制御信号を送信する。記憶部65は、鉗子部203と鉗子部213とが接触したときの鉗子部203、213の位置および姿勢を、鉗子部203の接触位置および接触姿勢、鉗子部213の接触位置および接触姿勢としてそれぞれ記憶する。 The user Q operates the pair of master manipulators 10 to drive the attachment / detachment unit driving units 28A and 28B by the slave control unit 63 to bring the forceps unit 203 of the surgical instrument 200 into contact with the forceps unit 213 of the surgical instrument 210. Then, the contact sensor 205 detects that an external force has been applied to the forceps unit 203 and transmits a control signal to the storage unit 65. The storage unit 65 sets the positions and postures of the forceps units 203 and 213 when the forceps unit 203 and the forceps unit 213 come into contact as the contact position and the contact posture of the forceps unit 203 and the contact position and the contact posture of the forceps unit 213, respectively. Remember.

続いて、使用者Qは、スレーブ制御部63により着脱部駆動部28A、28Bを駆動するが、このとき、スレーブ制御部63は、算出した基準位置V1と基準位置V2との相対的な位置関係を基に、スレーブマニピュレータ20Aおよびスレーブマニピュレータ20Bの動作範囲を算出し、鉗子部203と鉗子部213、あるいはスレーブマニピュレータ20Aとスレーブマニピュレータ20Bが互いに干渉しないように制御する。
具体的には、使用者Qが鉗子部203、213あるいはスレーブマニピュレータ20A、20B同士が接触するような操作指令を発したときには、スレーブ制御部63は、例えば着脱部駆動部28A、28Bの動作を停止させるとともに、警告を意味する表示や音を発して使用者Qに注意を促すことが好ましい。
Subsequently, the user Q drives the attachment / detachment unit driving units 28A and 28B by the slave control unit 63. At this time, the slave control unit 63 determines the relative positional relationship between the calculated reference position V1 and the reference position V2. Based on the above, the operation ranges of the slave manipulator 20A and the slave manipulator 20B are calculated, and the forceps 203 and the forceps 213, or the slave manipulator 20A and the slave manipulator 20B are controlled so as not to interfere with each other.
Specifically, when the user Q issues an operation command such that the forceps units 203 and 213 or the slave manipulators 20A and 20B come into contact with each other, the slave control unit 63 performs the operation of the attachment / detachment unit drive units 28A and 28B, for example. While stopping, it is preferable to alert the user Q with a display or sound indicating a warning.

このように構成された本実施形態の手術支援装置3によれば、鉗子部203の位置および姿勢を検出するために必要なセンサの数を低減させることができる。
さらに、接触センサ205および記憶部65を備えて前述のようにスレーブ制御部63が制御することで、スレーブ制御部63は鉗子部203と鉗子部213とが接触するときのスレーブマニピュレータ20A、20Bの相対位置を認識することができ、各スレーブマニピュレータ20A、20Bの動作範囲がどのように干渉するかなどを確認することができる。
そして、スレーブマニピュレータ20A、20B同士が接触などの動作干渉が起きないように制御することができる。
According to the surgery support apparatus 3 of the present embodiment configured as described above, the number of sensors necessary for detecting the position and posture of the forceps portion 203 can be reduced.
In addition, the slave control unit 63 includes the contact sensor 205 and the storage unit 65 and controls the slave manipulator 20A and 20B when the forceps unit 203 and the forceps unit 213 come into contact with each other. The relative position can be recognized, and how the operation ranges of the slave manipulators 20A and 20B interfere can be confirmed.
The slave manipulators 20A and 20B can be controlled so as not to cause operation interference such as contact.

本実施形態では送信部として接触センサ205を用いたが、術具200の鉗子部203術具210の鉗子部213とが接触したときに、記憶部65に制御信号を送信可能なものであればよい。送信部は、以下に説明するような様々な構成とすることができる。
例えば、術具200の術具挿入部201の先端部に、送信部として微弱振動の発生源と、振動の振幅を検出する振幅検出センサとを備えてもよい。一定の振幅で振動している鉗子部203に鉗子部213が接触すると、鉗子部203の振幅が変化する。このため、鉗子部203に鉗子部213が接触しているか否かを検出することができる。
In the present embodiment, the contact sensor 205 is used as the transmission unit. However, any device that can transmit a control signal to the storage unit 65 when the forceps unit 203 of the surgical tool 200 contacts the forceps unit 213 of the surgical tool 210. Good. The transmission unit can have various configurations as described below.
For example, the distal end portion of the surgical instrument insertion portion 201 of the surgical instrument 200 may include a weak vibration generation source and an amplitude detection sensor that detects the amplitude of vibration as a transmission unit. When the forceps portion 213 comes into contact with the forceps portion 203 that vibrates with a constant amplitude, the amplitude of the forceps portion 203 changes. For this reason, it is possible to detect whether or not the forceps portion 213 is in contact with the forceps portion 203.

送信部として、超音波を発生させる超音波発生源と、鉗子部213で反射された超音波を検出する超音波受信部とを備えてもよい。
鉗子部203の周辺の画像をCCDなどの撮像素子で取得し、この画像を公知の画像処理技術により解析することで、鉗子部203に鉗子部213が接触しているか否かを検出してもよい。
また、送信部をスイッチなどで構成してもよい。この場合、鉗子部203の周辺を介助者などが内視鏡により観察し、鉗子部203と鉗子部213とが接触したときに介助者がスイッチを切り替えて記憶部65に制御信号を送信することになる。
As a transmission part, you may provide the ultrasonic wave generation source which generates an ultrasonic wave, and the ultrasonic wave reception part which detects the ultrasonic wave reflected by the forceps part 213.
Even if it detects whether the forceps part 213 is contacting the forceps part 203 by acquiring the image around the forceps part 203 with an image sensor such as a CCD and analyzing the image by a known image processing technique. Good.
Further, the transmission unit may be configured by a switch or the like. In this case, an assistant or the like observes the periphery of the forceps unit 203 with an endoscope, and when the forceps unit 203 and the forceps unit 213 come into contact with each other, the assistant switches a switch and transmits a control signal to the storage unit 65. become.

以上、本発明の第1実施形態から第3実施形態について図面を参照して詳述したが、具体的な構成はこの実施形態に限られるものではなく、本発明の要旨を逸脱しない範囲の構成の変更なども含まれる。さらに、各実施形態で示した構成のそれぞれを適宜組み合わせて利用できることは、言うまでもない。
たとえば、前記第1実施形態から第3実施形態では、スレーブマニピュレータ20Aが手術用天板16に固定されているとしたが、図12に示す手術支援装置4のように構成してもよい。すなわち、手術支援装置4では、ロボット用天板71を結合具72により手術台15の手術用天板16に固定するとともに、このロボット用天板71の側面に設けられた一対のガイドレール73にスレーブマニピュレータ20A、20Bを固定している。
なお、図12以下では、説明の便宜のために前述の平行リンクを箱状に描いて示している。
The first to third embodiments of the present invention have been described in detail with reference to the drawings. However, the specific configuration is not limited to this embodiment, and the configuration does not depart from the gist of the present invention. Changes are also included. Furthermore, it goes without saying that the configurations shown in the embodiments can be used in appropriate combinations.
For example, in the first to third embodiments, the slave manipulator 20A is fixed to the surgical top plate 16. However, the slave manipulator 20A may be configured like the surgery support device 4 shown in FIG. That is, in the surgery support apparatus 4, the robot top plate 71 is fixed to the surgical top plate 16 of the operating table 15 by the coupler 72, and a pair of guide rails 73 provided on the side surface of the robot top plate 71 are attached. Slave manipulators 20A and 20B are fixed.
In FIG. 12 and subsequent figures, the above-described parallel links are illustrated in a box shape for convenience of explanation.

各ガイドレール73は、図12を表示する表示面に直交するように延びていて、スレーブマニピュレータ20A、20Bはガイドレール73の長手方向の任意の位置にスライドした状態で固定できるようになっている。すなわち、スレーブマニピュレータ20A、20Bの相対位置の情報を、スレーブマニピュレータ20A、20Bの拘束条件として制御装置60の記憶部などに設定できるようになっている。
なお、本変形例では、手術支援装置4に2基のスレーブマニピュレータ20A、20Bが備えられているとしたが、手術支援装置4に備えられるスレーブマニピュレータの数に制限はなく、1基でもよいし、3基以上でもよい。これは、前記第1実施形態から第3実施形態でも同様である。
Each guide rail 73 extends so as to be orthogonal to the display surface displaying FIG. 12, and the slave manipulators 20 </ b> A and 20 </ b> B can be fixed while being slid to arbitrary positions in the longitudinal direction of the guide rail 73. . That is, information on the relative positions of the slave manipulators 20A and 20B can be set in a storage unit of the control device 60 as a constraint condition of the slave manipulators 20A and 20B.
In this modification, the surgery support device 4 is provided with two slave manipulators 20A and 20B. However, the number of slave manipulators provided in the surgery support device 4 is not limited, and may be one. Three or more groups may be used. The same applies to the first to third embodiments.

図13および14に示す手術支援装置5のように、手術用天板16の側面に設けられた回転機構76を介してスレーブマニピュレータ20A、20Bを固定してもよい。
回転機構76は、公知の構成を有していて、手術用天板16の側面に設けられた一対の支持部材77と、支持部材77により自身の軸線C4周りに回動可能に支持されたベッドレール78とを有している。ベッドレール78は、支持部材77に設けられた不図示の固定機構により、支持部材77に対して軸線C4周りに回動可能な回動モードと、この回動を規制された規制モードとの間で切り替えることができる。
ベッドレール78の一方の端部にはハンドル79が取り付けられている。
スレーブマニピュレータ20Aの台座32A、およびスレーブマニピュレータ20Bの台座32Bは、ベッドレール78に固定されている。
The slave manipulators 20 </ b> A and 20 </ b> B may be fixed via a rotation mechanism 76 provided on the side surface of the surgical top plate 16 as in the surgery support device 5 shown in FIGS. 13 and 14.
The rotation mechanism 76 has a known configuration and a pair of support members 77 provided on the side surface of the surgical top plate 16 and a bed supported by the support member 77 so as to be rotatable about its own axis C4. Rail 78. The bed rail 78 is between a rotation mode in which the bed rail 78 can be rotated around the axis C4 with respect to the support member 77 by a fixing mechanism (not shown) provided in the support member 77, and a regulation mode in which the rotation is restricted. Can be switched.
A handle 79 is attached to one end of the bed rail 78.
The base 32A of the slave manipulator 20A and the base 32B of the slave manipulator 20B are fixed to the bed rail 78.

このように構成された本変形例の手術支援装置5を用いて、術具200をスレーブマニピュレータ20Aに取り付け、患者Pの体腔P3内に術具200を導入して処置を行う。このとき、スレーブアーム21Aは固定モードになり、固定機構は規制モードになっている。
処置を行う間に、場合によっては、緊急的に術具200を患者Pから引き抜く必要がある。
このような場合には、介助者は、体腔P3内から術具200を引き抜いた後で、スレーブマニピュレータ20Aから術具200を取り外し、固定機構を回動モードに切り替える。ハンドル79を把持して、図15に示すようにベッドレール78を軸線C4周りに回動させ、スレーブマニピュレータ20A、およびスレーブマニピュレータ20Bを手術用天板16上から手術用天板16の下方に退避させる。
このように構成された本変形例の手術支援装置5によれば、スレーブマニピュレータ20A、20Bを手術用天板16上から素早く退避させることができる。
Using the surgical operation support device 5 of this modification configured as described above, the surgical instrument 200 is attached to the slave manipulator 20A, and the surgical instrument 200 is introduced into the body cavity P3 of the patient P to perform the treatment. At this time, the slave arm 21A is in the fixing mode, and the fixing mechanism is in the restriction mode.
In some cases, it is necessary to urgently withdraw the surgical instrument 200 from the patient P during the treatment.
In such a case, the assistant removes the surgical instrument 200 from the slave manipulator 20A after pulling out the surgical instrument 200 from the body cavity P3, and switches the fixing mechanism to the rotation mode. The handle 79 is gripped, and the bed rail 78 is rotated around the axis C4 as shown in FIG. 15, and the slave manipulator 20A and the slave manipulator 20B are retracted from above the surgical top plate 16 to below the surgical top plate 16. Let
According to the surgical operation support device 5 of the present modification configured as described above, the slave manipulators 20A and 20B can be quickly retracted from the surgical top plate 16.

前記第1実施形態から第3実施形態では、位置決めアームが平行リンクを備えるとした。しかし、開腹手術などの場合のように、術具を不動点を通す必要がない場合には、位置決めアームは平行リンクを備えなくてもよい。
また、着脱部の位置および姿勢から着脱部に取り付けられた術具の鉗子部の位置および姿勢が容易に推測できてマスタマニピュレータ10で操作できるような場合などには、処置部位置検出部は備えられなくてもよい。
着脱部52Aを第二の辺要素47Aに設定したが、着脱部52Aは第二の辺要素45A、46Aに設定してもよい。
In the first to third embodiments, the positioning arm includes the parallel link. However, when it is not necessary to pass the surgical tool through the fixed point as in the case of open surgery, the positioning arm may not include the parallel link.
In addition, in the case where the position and posture of the forceps portion of the surgical instrument attached to the detachable portion can be easily estimated from the position and posture of the detachable portion and can be operated by the master manipulator 10, the treatment portion position detecting portion is provided. It does not have to be done.
Although the detachable portion 52A is set to the second side element 47A, the detachable portion 52A may be set to the second side elements 45A and 46A.

スレーブアームを、軸体をボールジョイントで接続することで構成したが、スレーブアームの構成はこれに限定されない。スレーブアームの自由度が3以上であれば、例えば、スレーブアームを複数のリニアガイドや関節部で構成してもよい。 Although the slave arm is configured by connecting the shaft bodies with ball joints, the configuration of the slave arm is not limited to this. If the degree of freedom of the slave arm is 3 or more, for example, the slave arm may be composed of a plurality of linear guides or joints.

1、2、3、4、5 手術支援装置
10 マスタマニピュレータ(入力部)
13 表示部
16 手術用天板(ベース)
20A スレーブマニピュレータ(医療用マニピュレータ、第一の医療用マニピュレータ)
20B スレーブマニピュレータ(医療用マニピュレータ、第二の医療用マニピュレータ)
21A、21B スレーブアーム(保持部)
22A 基端部
23A 先端部
24A、24B 位置決めアーム(位置決め部)
27A、27B 姿勢センサ(基準姿勢検出部)
28A、28B 着脱部駆動部
29A、29B 着脱位置検出部
30A 処置部初期位置検出部
31A、31B 処置部位置検出部
51A 固定部
52A、52B 着脱部
53A 着脱部移動機構(処置部駆動部)
56 内視鏡
56a 観察部
63 スレーブ制御部(駆動部制御部)
65 記憶部
200 術具(第一の術具)
203、213 鉗子部(処置部)
205 接触センサ(送信部)
210 術具(第二の術具)
C2 光軸
S 基準平面
V1、V2 基準位置
第一のローカル座標系(第一の直交座標系)
第二のローカル座標系(第二の直交座標系)
θ 角度
1, 2, 3, 4, 5 Surgery support device 10 Master manipulator (input unit)
13 Display 16 Surgical top plate (base)
20A Slave manipulator (medical manipulator, first medical manipulator)
20B Slave manipulator (medical manipulator, second medical manipulator)
21A, 21B Slave arm (holding part)
22A Base end 23A Tip 24A, 24B Positioning arm (positioning part)
27A, 27B Posture sensor (reference posture detection unit)
28A, 28B Attachment / detachment drive unit 29A, 29B Attachment / detachment position detection unit 30A Treatment unit initial position detection unit 31A, 31B Treatment unit position detection unit 51A Fixation unit 52A, 52B Attachment / detachment unit 53A Attachment / detachment unit moving mechanism (treatment unit drive unit)
56 Endoscope 56a Observation unit 63 Slave control unit (drive unit control unit)
65 storage unit 200 surgical instrument (first surgical instrument)
203, 213 Forceps part (treatment part)
205 Contact sensor (transmitter)
210 surgical tool (second surgical tool)
C2 Optical axis S Reference plane V1, V2 Reference position W 1 First local coordinate system (first orthogonal coordinate system)
W2 second local coordinate system (second orthogonal coordinate system)
θ angle

Claims (9)

基端部が揺動可能にベースに連結された保持部と、
前記保持部の先端部に固定された固定部、処置部が着脱可能な着脱部、及び前記固定部と前記着脱部とに連結された辺要素を備え、前記辺要素の移動により前記着脱部が前記固定部に対して相対移動可能に構成された位置決め部と、
前記位置決め部の基端部の前記辺要素に設けられ、前記位置決め部に設定された基準位置の姿勢を算出して検出する基準姿勢検出部と、
前記固定部に対して前記処置部を移動させるための駆動部と、
前記基準位置に対する前記着脱部の位置を算出して検出する着脱位置検出部と、
前記着脱部の位置から前記処置部の姿勢または位置を算出して検出する処置部位置検出部と、
前記着脱位置検出部および前記処置部位置検出部に基づいて前記駆動部を制御する駆動部制御部と、
を備え、
前記着脱位置検出部が、前記基準位置に原点が設定されたローカル座標系を用いて特定される前記基準位置に対する前記着脱部の距離に基づき前記基準位置に対する前記着脱部の位置を算出して検出し、前記基準姿勢検出部が、前記ベース上に原点が設定されたグローバル座標系の軸周りの回転角度を算出することにより前記基準位置の姿勢を算出して検出することにより、前記グローバル座標系における前記着脱部の位置及び姿勢を検出し、検出された前記着脱部の位置に基づき、前記処置部位置検出部が、前記処置部の姿勢を算出することを特徴とする手術支援装置。
A holding portion whose base end portion is swingably connected to the base;
A fixing unit fixed to a distal end of the holding unit; an attaching / detaching unit to which a treatment unit is attachable / detachable; and a side element connected to the fixing unit and the attaching / detaching unit. A positioning portion configured to be movable relative to the fixed portion;
A reference posture detection unit that is provided in the side element of the base end portion of the positioning unit and calculates and detects a posture of a reference position set in the positioning unit;
A drive unit for moving the treatment unit relative to the fixed unit;
An attachment / detachment position detection unit that calculates and detects the position of the attachment / detachment unit with respect to the reference position;
A treatment part position detection unit that calculates and detects the posture or position of the treatment part from the position of the attachment / detachment part;
A drive unit control unit for controlling the drive unit based on the attachment / detachment position detection unit and the treatment unit position detection unit;
With
The attach / detach position detecting unit calculates and detects the position of the attach / detach unit with respect to the reference position based on a distance of the attach / detach unit with respect to the reference position specified using a local coordinate system in which an origin is set at the reference position. Then, the reference orientation detection unit calculates and detects the orientation of the reference position by calculating the rotation angle around the axis of the global coordinate system in which the origin is set on the base, thereby detecting the global coordinate system An operation support apparatus, wherein the position and posture of the attachment / detachment portion in the device are detected, and the treatment portion position detection portion calculates the posture of the treatment portion based on the detected position of the attachment / detachment portion.
前記駆動部は、
前記固定部に対して前記着脱部を移動させる着脱部駆動部と、
前記着脱部に対して前記処置部を移動させる処置部駆動部とから構成され、
前記着脱位置検出部は、前記固定部に対する前記着脱部の角度変位を含む移動量を検出し、
前記処置部位置検出部は、前記着脱部に対する前記処置部の角度変位を含む移動量を検出することを特徴とする請求項1に記載の手術支援装置。
The drive unit is
An attaching / detaching unit driving unit for moving the attaching / detaching unit with respect to the fixing unit;
A treatment unit driving unit that moves the treatment unit relative to the attachment / detachment unit;
The attachment / detachment position detection unit detects a movement amount including an angular displacement of the attachment / detachment unit with respect to the fixed unit,
The operation support apparatus according to claim 1, wherein the treatment unit position detection unit detects a movement amount including an angular displacement of the treatment unit with respect to the attachment / detachment unit.
前記保持部は、
前記保持部の基端部に対する前記先端部の位置を調節可能な調節モードと、
前記保持部の基端部に対する前記先端部の位置を固定した固定モードとの間で切り替え可能である請求項1又は2に記載の手術支援装置。
The holding part is
An adjustment mode capable of adjusting the position of the distal end portion with respect to the proximal end portion of the holding portion ;
The surgery support apparatus according to claim 1, wherein the operation support apparatus is switchable between a fixed mode in which a position of the distal end portion with respect to a proximal end portion of the holding portion is fixed.
前記基準姿勢検出部は、検出した前記基準位置の姿勢を無線通信により前記処置部位置検出部に送信することを特徴とする請求項1に記載の手術支援装置。   The surgery support apparatus according to claim 1, wherein the reference posture detection unit transmits the detected posture of the reference position to the treatment unit position detection unit by wireless communication. 使用者からの入力に基づいて操作指令を発する入力部を備え、
前記駆動部制御部は、
前記操作指令に表される前記処置部の単位時間当たりの目標位置の変化量を算出する目標変化量算出工程と、
前記処置部が前記単位時間当たりに前記目標位置の変化量だけ移動するように前記駆動部を制御する移動工程と、
を組にして繰り返すことを特徴とする請求項1に記載の手術支援装置。
An input unit that issues an operation command based on an input from a user is provided.
The drive unit controller
A target change amount calculation step of calculating a change amount of the target position per unit of time of the treatment portion represented in the operation command,
A moving step of controlling the driving unit so that the treatment unit moves by a change amount of the target position per unit time;
The operation support apparatus according to claim 1, wherein the operation support apparatus is repeated as a set.
前記駆動部制御部は、
前記目標変化量算出工程において、前記操作指令に表される前記処置部の前記単位時間当たりの目標姿勢の変化量を算出し、
前記移動工程において、前記処置部が前記単位時間当たりに前記目標姿勢の変化量だけ移動するように前記駆動部を制御することを特徴とする請求項5に記載の手術支援装置。
The drive unit controller
In the target change amount calculating step, a change amount of the target posture per unit time of the treatment unit represented by the operation command is calculated,
The operation support apparatus according to claim 5, wherein, in the moving step, the driving unit is controlled so that the treatment unit moves by the amount of change in the target posture per unit time.
光軸に沿った外方の画像を取得するための観察部が設けられた内視鏡と、
前記画像を表示するための表示部と、
使用者からの入力に基づいて操作指令を発する入力部と、
を備え、
前記駆動部制御部は、前記入力部が発する前記操作指令を、前記処置部の先端側を向く第一の直交座標系から前記観察部の前記光軸に沿って先端側を向く第二の直交座標系に変換する変換行列で変換して変換操作指令を算出し、前記変換操作指令に基づいて前記駆動部を制御することを特徴とする
請求項1に記載の手術支援装置。
An endoscope provided with an observation unit for acquiring an outward image along the optical axis;
A display for displaying the image;
An input unit that issues an operation command based on an input from a user;
With
The drive unit control unit sends the operation command issued by the input unit from a first orthogonal coordinate system facing the distal end side of the treatment unit to a second orthogonal direction facing the distal end side along the optical axis of the observation unit. The surgery support apparatus according to claim 1, wherein a conversion operation command is calculated by conversion using a conversion matrix that is converted into a coordinate system, and the drive unit is controlled based on the conversion operation command.
記処置部の位置および姿勢を記憶する記憶部と、
前記記憶部に制御信号を送信可能な送信部と、
を備え、
前記保持部及び前記位置決め部を複数備え、
各前記保持部にそれぞれ取り付けられた前記処置部同士が接触したときに、前記送信部が前記制御信号を前記記憶部に送信することで、互いに接触した前記処置部の位置および姿勢から各前記保持部の相対位置を算出し、前記記憶部が記録することを特徴とする
請求項1に記載の手術支援装置。
A storage unit that stores the position and attitude of the front Symbol treatment unit,
A transmission unit capable of transmitting a control signal to the storage unit;
With
A plurality of the holding part and the positioning part are provided,
When the treatment units attached to the holding units are in contact with each other, the transmission unit transmits the control signal to the storage unit, so that the holding units can be held from the positions and postures of the treatment units in contact with each other. calculating a relative position of the parts, surgery supporting system according to claim 1, before term memory unit, characterized in that the recording.
複数の前記保持部と、前記位置決め部と、を備え、
1つの前記基準姿勢検出部が、それぞれの前記位置決め部に着脱可能に取り付けられることを特徴とする請求項1に記載の手術支援装置。
A plurality of the holding portions, and the positioning portion,
The operation support apparatus according to claim 1, wherein one reference posture detection unit is detachably attached to each positioning unit.
JP2013526973A 2011-08-04 2012-08-03 Surgery support device Active JP6165057B2 (en)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
US201161515203P 2011-08-04 2011-08-04
US61/515,203 2011-08-04
PCT/JP2012/069919 WO2013018908A1 (en) 2011-08-04 2012-08-03 Manipulator for medical use and surgery support device

Publications (2)

Publication Number Publication Date
JPWO2013018908A1 JPWO2013018908A1 (en) 2015-03-05
JP6165057B2 true JP6165057B2 (en) 2017-07-19

Family

ID=52696962

Family Applications (3)

Application Number Title Priority Date Filing Date
JP2013526954A Expired - Fee Related JP5855656B2 (en) 2011-08-04 2012-08-02 Medical manipulator and method of operating the same
JP2013526968A Active JP6010027B2 (en) 2011-08-04 2012-08-03 Surgical tools and medical manipulators
JP2013526973A Active JP6165057B2 (en) 2011-08-04 2012-08-03 Surgery support device

Family Applications Before (2)

Application Number Title Priority Date Filing Date
JP2013526954A Expired - Fee Related JP5855656B2 (en) 2011-08-04 2012-08-02 Medical manipulator and method of operating the same
JP2013526968A Active JP6010027B2 (en) 2011-08-04 2012-08-03 Surgical tools and medical manipulators

Country Status (1)

Country Link
JP (3) JP5855656B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI511700B (en) * 2013-11-19 2015-12-11 Univ Nat Taiwan Science Tech Surgical holder

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0789293B2 (en) * 1986-07-23 1995-09-27 松下電器産業株式会社 Arm control device
JP3339953B2 (en) * 1993-12-29 2002-10-28 オリンパス光学工業株式会社 Medical master-slave manipulator
JP2001087281A (en) * 1999-09-20 2001-04-03 Olympus Optical Co Ltd Multifunctional manipulator
JP3613551B2 (en) * 2000-03-31 2005-01-26 株式会社東芝 Medical manipulator
EP3097863A1 (en) * 2001-02-15 2016-11-30 Hansen Medical, Inc. Flexible instrument
JP3766805B2 (en) * 2002-03-15 2006-04-19 株式会社日立製作所 Surgery support device
JP4472361B2 (en) * 2004-01-06 2010-06-02 オリンパス株式会社 Medical instrument holding device and medical instrument holding system.
JP2006321027A (en) * 2005-05-20 2006-11-30 Hitachi Ltd Master slave type manipulator system and its operation input device
JP4015161B2 (en) * 2005-06-13 2007-11-28 川崎重工業株式会社 Industrial robot controller
JP4488312B2 (en) * 2005-07-08 2010-06-23 オリンパス株式会社 Medical manipulator system
JP2007029274A (en) * 2005-07-25 2007-02-08 Hitachi Ltd Operation tool device
JP4755047B2 (en) * 2006-08-08 2011-08-24 テルモ株式会社 Working mechanism and manipulator
JP5154961B2 (en) * 2008-01-29 2013-02-27 テルモ株式会社 Surgery system

Also Published As

Publication number Publication date
JP6010027B2 (en) 2016-10-19
JP5855656B2 (en) 2016-02-09
JPWO2013018861A1 (en) 2015-03-05
JPWO2013018908A1 (en) 2015-03-05
JPWO2013018897A1 (en) 2015-03-05

Similar Documents

Publication Publication Date Title
WO2013018908A1 (en) Manipulator for medical use and surgery support device
KR102345782B1 (en) Surgical assistance device, control method therefor, and recording medium
KR102520799B1 (en) Computer-assisted medical systems and methods
US20190216555A1 (en) Base positioning system for a controllable arm and related methods
JP5744455B2 (en) Master / slave manipulator control device and control method thereof
JP6010225B2 (en) Medical manipulator
JP6117922B2 (en) Medical manipulator and method of operating the same
EP2550926A1 (en) Medical manipulator system
JP7085400B2 (en) Surgical system
JP2019188038A (en) Surgical system and control method for surgical system
JP6546361B1 (en) Surgery support device
JP2017104455A (en) Remote handling equipment and remote surgery system
JP2019187995A (en) Surgery system
JP2006312079A (en) Medical manipulator
JP6238844B2 (en) Surgical manipulator operating device and surgical manipulator system
JP6097390B2 (en) Medical manipulator
JP2020065910A (en) Surgery assistance apparatus
US11399910B2 (en) Medical system
JP2016028652A (en) Treatment instrument and treatment instrument system
JP6165057B2 (en) Surgery support device
US20220395350A1 (en) Surgical robot and control method of surgical robot
US20220175479A1 (en) Surgical operation system and method of controlling surgical operation system
JP7153335B2 (en) Surgery support device
CN115103650B (en) Surgical robot and control unit for surgical robot
EP4070919A1 (en) Surgical robot, surgical system, and control method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20150708

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20160628

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20160826

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20160829

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20170207

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20170315

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20170316

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20170620

R151 Written notification of patent or utility model registration

Ref document number: 6165057

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151

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

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250