JP6506490B1 - Surgical support device, control method thereof, and surgical support system - Google Patents

Surgical support device, control method thereof, and surgical support system Download PDF

Info

Publication number
JP6506490B1
JP6506490B1 JP2019004430A JP2019004430A JP6506490B1 JP 6506490 B1 JP6506490 B1 JP 6506490B1 JP 2019004430 A JP2019004430 A JP 2019004430A JP 2019004430 A JP2019004430 A JP 2019004430A JP 6506490 B1 JP6506490 B1 JP 6506490B1
Authority
JP
Japan
Prior art keywords
body cavity
sound wave
surgical instrument
measurement
surgery support
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
JP2019004430A
Other languages
Japanese (ja)
Other versions
JP2020049198A (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.)
Asahi Surgical Robotics Co Ltd
Original Assignee
A Traction Inc
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 A Traction Inc filed Critical A Traction Inc
Priority to JP2019004430A priority Critical patent/JP6506490B1/en
Application granted granted Critical
Publication of JP6506490B1 publication Critical patent/JP6506490B1/en
Publication of JP2020049198A publication Critical patent/JP2020049198A/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Manipulator (AREA)
  • Surgical Instruments (AREA)

Abstract

【課題】体腔に挿入される医療器具の直動方向の移動を精度よく計測することが可能な手術支援装置を提供する。【解決手段】本発明に係る手術支援装置は、体腔に挿入される術具を用いた操作の可能な手術支援装置であって、操作の入力として、体腔に挿入される術具のシャフトの体腔への挿入深度と挿入角度とを計測する計測手段を有し、計測手段は、体腔への挿入位置から所定範囲の位置と術具とのいずれか一方に取り付けられた送信機と、他方に取り付けられた受信機との間の空間を伝わる音波を計測することにより、挿入深度を計測する。【選択図】図2[PROBLEMS] To provide a surgery support device capable of accurately measuring the movement of a medical instrument inserted into a body cavity in the linear movement direction. A surgery support apparatus according to the present invention is a surgery support apparatus capable of operation using a surgical instrument inserted into a body cavity, wherein a body cavity of a shaft of the surgical instrument inserted into the body cavity as an operation input. It has measuring means for measuring the insertion depth and insertion angle into the body cavity, and the measuring means is attached to the transmitter attached to one of the position within a predetermined range from the insertion position to the body cavity and the surgical instrument and the other The depth of insertion is measured by measuring the sound waves traveling in the space between the receiver and the receiver. [Selected figure] Figure 2

Description

本発明は、手術支援装置、その制御方法、並びに手術支援システムに関する。   The present invention relates to a surgery support device, a control method thereof, and a surgery support system.

腹壁に小径の複数の穴を空け、術者が手に持つ術具や内視鏡等の医療器具を小径の穴のそれぞれから体腔内に挿入することにより手術を行う腹腔鏡手術が知られている。一般に腹腔鏡手術では、超音波メスや鉗子など複数の術具を操作して手術を行う術者を、腹腔鏡を操作するスコーピストや鉗子によって臓器を牽引等する助手等が補助することによって行われるため、腹部を切開する開腹手術と比較して煩雑となる場合がある。このため、スコーピスト等による支援に代えてロボットアームによって術者を支援する技術が提案されている(特許文献1、特許文献2)。   Laparoscopic surgery is known in which surgery is performed by making multiple small-diameter holes in the abdominal wall and inserting medical instruments such as surgical instruments and endoscopes held by the operator into the body cavity from each of the small-diameter holes. There is. In general, in laparoscopic surgery, an operator who performs surgery by operating a plurality of surgical tools such as an ultrasonic scalpel and forceps is assisted by an assistant or the like who pulls an organ with a scorpist or forceps operating the laparoscope. Therefore, it may be complicated compared to open surgery in which the abdomen is incised. For this reason, a technique for assisting the operator with a robot arm in place of the assistance by a scorpist or the like has been proposed (Patent Document 1, Patent Document 2).

特許文献1は、トロッカに設けた傾斜角検出センサと進退量検出センサと回転量検出センサとにより、トロッカを通過させた医療処置具に対する操作を計測して、医療処置具の先端等の追従基準をエンドエフェクタが追従するように制御する技術を提案している。また、特許文献2は、トラカールに、傾斜センサ等の慣性センサと挿入量センサとを設けて術具の姿勢を計測し、術具の先端位置を追従するように腹腔鏡の姿勢を制御する技術を提案している。   Patent document 1 measures operation with respect to the medical treatment tool which made the trocar pass by the inclination-angle detection sensor provided in the trocar, an advancing / retracting amount detection sensor, and a rotation amount detection sensor, and follow-up criteria, such as a tip of a medical treatment tool. We propose a technology to control the end effector to follow. Further, Patent Document 2 provides an inertial sensor such as a tilt sensor and an insertion amount sensor in a trocar, measures the posture of the surgical tool, and controls the posture of the laparoscope to follow the tip position of the surgical tool Is proposed.

特開2015−24025号公報JP, 2015-24025, A 特開2007−301378号公報Unexamined-Japanese-Patent No. 2007-301378

特許文献1では、医療器具の長軸方向の移動を計測する進退量検出センサとして、医療処置具の表面と接触して回転するローラを採用している。しかしながら、ローラを用いて医療処置具の進退量を計測する場合、術具の直径や表面材質、物質の付着状態等によって接触時の回転が影響を受け、計測誤差が大きくなってしまう場合がある。一方、特許文献2では、医療器具の長軸方向の移動を計測する挿入量センサとして、光学式の変位センサを採用し、術具の表面で反射する半導体レーザの強度変化に基づいて挿入量を計測している。しかしながら、この技術もレーザ光の強度変化を測定するために医療器具を介在させるため、医療器具の表面材質や物質の対象物の状態によって計測誤差が大きくなる場合がある。   In patent document 1, the roller which contacts and rotates the surface of a medical treatment tool is employ | adopted as a movement amount detection sensor which measures the movement of the major axis direction of a medical device. However, when measuring the amount of advancement or withdrawal of the medical treatment tool using a roller, the rotation at the time of contact may be affected by the diameter of the surgical tool, the surface material, the adhesion state of the substance, etc., and the measurement error may increase. . On the other hand, in Patent Document 2, an optical displacement sensor is employed as an insertion amount sensor for measuring the movement of the medical instrument in the long axis direction, and the insertion amount is determined based on the intensity change of the semiconductor laser reflected on the surface of the surgical tool. I am measuring. However, since this technique also involves a medical instrument to measure the intensity change of the laser light, the measurement error may increase depending on the surface material of the medical instrument or the condition of the object of the substance.

本発明は、上述の問題点に鑑みてなされたものである。すなわち、体腔に挿入される医療器具の長軸方向の移動を精度よく計測することが可能な技術を提供することを目的とする。   The present invention has been made in view of the above problems. That is, it is an object of the present invention to provide a technology capable of accurately measuring the movement of the medical device inserted in a body cavity in the longitudinal direction.

この課題を解決するため、例えば本発明の手術支援装置は以下の構成を備える。すなわち、体腔に挿入される術具を用いた操作の可能な手術支援装置であって、前記操作の入力として、前記体腔に挿入される前記術具のシャフトの前記体腔への挿入深度と挿入角度とを計測する計測手段を有し、前記計測手段は、前記体腔への挿入位置から所定範囲の位置と前記術具とのいずれか一方に取り付けられた送信機と、他方に取り付けられた受信機との間の空間を伝わる音波を計測することにより、前記挿入深度を計測する、ことを特徴とする。   In order to solve this problem, for example, the surgery support device of the present invention has the following configuration. That is, it is a surgery support device that can be operated using a surgical instrument inserted into a body cavity, and the insertion depth and insertion angle of the shaft of the surgical instrument inserted into the body cavity as an input of the operation into the body cavity And a transmitter attached to one of a position within a predetermined range from the insertion position into the body cavity and the surgical instrument, and a receiver attached to the other. Measuring the insertion depth by measuring a sound wave propagating in the space between and.

本発明によれば、体腔に挿入される医療器具の長軸方向の移動を精度よく計測することが可能になる。   According to the present invention, it is possible to accurately measure the longitudinal movement of the medical device inserted into the body cavity.

手術支援システムの全体構成例を模式的に示す図Diagram schematically showing an example of the overall configuration of a surgery support system 本実施形態における、位置姿勢計測装置の構成例を模式的に示す図A diagram schematically showing a configuration example of a position and orientation measurement apparatus in the present embodiment 本実施形態における、距離計測のための制御部の構成例を模式的に示す図The figure which shows typically the structural example of the control part for distance measurement in this embodiment 本実施形態における、音波送信機と音波受信機との間の距離と、位相差との間の関係を示す図The figure which shows the relationship between the distance between an acoustic wave transmitter and an acoustic wave receiver, and a phase difference in this embodiment. 本実施形態における距離計測処理(正方向)を説明するための図A diagram for explaining distance measurement processing (forward direction) in the present embodiment 本実施形態における距離計測処理(反対方向)を説明するための図The figure for demonstrating the distance measurement process (opposite direction) in this embodiment 本実施形態における、音波受信機が手持ち医療器具のシャフト周りに回転した場合の処理を説明する図The figure which demonstrates the process in case an acoustic wave receiver rotates around the shaft of a hand-held medical instrument in this embodiment. 本実施形態における、音波受信機が手持ち医療器具のシャフト周りに回転した際の影響とその補正を説明するための図The figure for demonstrating the influence when the sound wave receiver rotates in the circumference of the shaft of a hand-held medical instrument in this embodiment, and its correction | amendment 本実施形態における絶対距離を計測するための構成例(光を用いる例)を示す図A diagram showing a configuration example (an example using light) for measuring an absolute distance in the present embodiment 本実施形態における絶対距離を計測するための構成例(機械式スイッチを用いる例)を示す図A figure showing an example of composition (example using a mechanical switch) for measuring absolute distance in this embodiment 手持ち医療器具を判別するためのタグとタグ検出用センサの構成例を説明する図A diagram for explaining a configuration example of a tag for identifying a hand-held medical instrument and a tag detection sensor 複数の手持ち医療器具を判別するための処理例(検出距離を用いる例)を説明するための図Diagram for explaining a processing example (example using detection distance) for discriminating a plurality of hand-held medical instruments 複数の手持ち医療器具を判別するための処理例(慣性センサを用いる例)を説明するための図Diagram for explaining a processing example (example using an inertial sensor) for discriminating a plurality of hand-held medical instruments 本実施形態における、音波受信機と慣性センサとを含むセンサユニットの構成例を模式的に示す図The figure which shows typically the example of a structure of the sensor unit containing an acoustic wave receiver and an inertial sensor in this embodiment. 本実施形態における、音波送信機を含むセンサユニットを外套管に取り付けた場合の構成例を模式的に示す図The figure which shows typically the structural example at the time of attaching the sensor unit containing an acoustic wave transmitter to a mantle tube in this embodiment.

以下、本発明の例示的な実施形態について、図面を参照して詳細に説明する。   Hereinafter, exemplary embodiments of the present invention will be described in detail with reference to the drawings.

(手術支援システムの全体構成例)
まず、図1を参照して、本発明に係る手術支援システムの全体構成例について説明する。図1は、本実施形態に係る手術支援システム1の機能構成例を模式的に示している。本実施形態に係る手術支援システム1は、手術支援装置2と、術具やエンドエフェクタの姿勢を制御する医療器具駆動部11とを含む。
(Example of the overall configuration of the surgery support system)
First, with reference to FIG. 1, the whole structural example of the surgery assistance system which concerns on this invention is demonstrated. FIG. 1 schematically shows an example of the functional configuration of a surgery support system 1 according to the present embodiment. The surgery support system 1 according to the present embodiment includes a surgery support apparatus 2 and a medical instrument drive unit 11 that controls the posture of the surgical instrument and the end effector.

また、手術支援装置2は、例えば、術者が持つ術具(手持ち医療器具21)の姿勢を計測する位置姿勢計測装置22と、制御状態を切り替えるためのモード切替部3と、座標変換、制御対象の位置等の演算や医療器具駆動部11を制御する制御部4と、表示部7、及び不揮発性メモリ8とを含む。なお、医療器具駆動部11によって制御される術具を、手持ち医療器具21と区別してロボット医療器具12という。   In addition, the surgery support device 2 includes, for example, a position and orientation measurement device 22 that measures the posture of a surgical tool (handheld medical instrument 21) held by the operator, a mode switching unit 3 for switching the control state, coordinate conversion, and control It includes a control unit 4 for calculating the position of an object or the like and controlling the medical instrument drive unit 11, a display unit 7, and a non-volatile memory 8. The surgical instrument controlled by the medical instrument drive unit 11 is referred to as a robot medical instrument 12 in distinction from the hand-held medical instrument 21.

図1は、手術台6上に横たわる患者の体腔内に外套管を通して術具やエンドエフェクタが挿入されている様子を示している。本実施形態に係る手術支援システム1は、術者及び患者の近くに設置され、術者による術具の操作と協調するように医療器具駆動部11を制御することにより術者による手術を支援する。術者は、手持ち医療器具21を操作して、処置(例えば臓器の一部を切開したり、切除、縫合したりする)と、ロボット医療器具12やエンドエフェクタ13の制御(例えば鉗子によって臓器を牽引する)とを交互に行うことができる。このとき、手持ち医療器具21を用いた処置と、ロボット医療器具12やエンドエフェクタ13の制御とはモード切替部3を操作することにより切り替えることができる。   FIG. 1 shows a surgical instrument and an end effector being inserted through a mantle into a body cavity of a patient lying on a surgical table 6. The operation support system 1 according to the present embodiment is installed near the operator and the patient, and supports the operation by the operator by controlling the medical instrument drive unit 11 in coordination with the operation of the operation tool by the operator. . The operator manipulates the hand-held medical instrument 21 to perform treatment (for example, incising, excision, or suturing of a part of an organ) and control of the robot medical instrument 12 or the end effector 13 (for example, forceps for the organ And tow) can be performed alternately. At this time, the treatment using the hand-held medical instrument 21 and the control of the robot medical instrument 12 and the end effector 13 can be switched by operating the mode switching unit 3.

このため、本実施形態に係るロボット医療器具12の制御は、術者が使用する術具の先端位置を常に計測してその先端位置付近を腹腔鏡等に追従させる制御とは異なり、切開等の処置のために手持ち医療器具21を操作する合間に行われる。従って、ロボット医療器具12やエンドエフェクタ13を制御するために行う手持ち医療器具21の姿勢の計測は、比較的短時間で終了する。   Therefore, the control of the robot medical instrument 12 according to the present embodiment is different from the control of constantly measuring the tip position of the surgical instrument used by the operator and making the vicinity of the tip position follow the laparoscope etc. It takes place during the operation of the hand-held medical device 21 for treatment. Therefore, measurement of the posture of the hand-held medical instrument 21 performed to control the robot medical instrument 12 and the end effector 13 is completed in a relatively short time.

医療器具駆動部11は、ロボット医療器具12の移動やエンドエフェクタ13の姿勢を制御する駆動部(例えばロボットアーム)を含む。例えば、ロボット医療器具12の腹壁5に対する挿入角度、ロボット医療器具12のシャフトの長軸方向への移動(挿入深度)、及びエンドエフェクタ13の駆動を制御可能に構成される。駆動部の機構は、例えばRガイドを用いた機構、平行リンクを用いた機構、又は垂直多関節アームによる機構等であってよいが、エンドエフェクタ13の姿勢を能動的に制御することが可能であればその形状は任意でよい。駆動部にはサーボモータ等の位置決め用アクチュエータが複数含まれており、アクチュエータに含まれるエンコーダから機構の関節角等の現在位置情報を取得可能である。医療器具駆動部11は、手術支援装置2と、LAN等の通信路或いはバスを介して接続され、手術支援装置2の制御部4とデータの受送信を行う。医療器具駆動部11は、エンコーダによって取得した関節角等の現在位置情報を手術支援装置2の制御部4へ出力することができる。また、制御部4から出力された制御情報に基づいて、ロボット医療器具12の移動やエンドエフェクタ13の姿勢を制御することができる。なお、以後の説明において単に「ロボット」という場合は、医療器具駆動部11、ロボット医療器具12、エンドエフェクタ13のすべてを指すものとする。   The medical instrument drive unit 11 includes a drive unit (for example, a robot arm) that controls the movement of the robot medical instrument 12 and the attitude of the end effector 13. For example, the insertion angle of the robot medical instrument 12 with respect to the abdominal wall 5, the movement of the shaft of the robot medical instrument 12 in the longitudinal direction (insertion depth), and the drive of the end effector 13 can be controlled. The mechanism of the drive unit may be, for example, a mechanism using an R guide, a mechanism using parallel links, or a mechanism using a vertical articulated arm, etc., but it is possible to actively control the attitude of the end effector 13 If it is, the shape may be arbitrary. The drive unit includes a plurality of positioning actuators such as a servomotor, and can obtain current position information such as a joint angle of a mechanism from an encoder included in the actuator. The medical instrument drive unit 11 is connected to the surgery support device 2 via a communication path such as a LAN or a bus, and transmits and receives data with the control unit 4 of the surgery support device 2. The medical instrument drive unit 11 can output current position information such as a joint angle acquired by the encoder to the control unit 4 of the surgery support device 2. In addition, based on the control information output from the control unit 4, the movement of the robot medical instrument 12 and the attitude of the end effector 13 can be controlled. In the following description, the term “robot” refers to all of the medical instrument driving unit 11, the robot medical instrument 12, and the end effector 13.

ロボット医療器具12は、腹壁5に開けた小径の穴に挿入された外套管14を通過して、その一部が体腔内に挿入される。例えば、ロボット医療器具12とエンドエフェクタ13には、体腔内に挿入して使用される鉗子、攝子、電気メス、吸引管、超音波凝固切開装置、止血装置、ラジオ波焼灼装置、内視鏡、胸腔鏡、腹腔鏡等を含み、その形状は直線状であっても屈曲関節を有していてもよい。   The robot medical instrument 12 passes through the cannula 14 inserted in a small diameter hole made in the abdominal wall 5 and a part thereof is inserted into the body cavity. For example, the forceps, forceps, electric scalpel, suction tube, ultrasonic coagulating / cutting device, hemostasis device, hemostasis device, radio wave cautery device, endoscope used for inserting into the body cavity and using the robot medical instrument 12 and the end effector 13 A thoracoscope, a laparoscope, etc. are included and the shape may be linear or may have a flexion joint.

手持ち医療器具21は、術者が実際に手で動かして通常の処置を行う医療器具であり、腹壁5に開けた小径の穴に挿入された外套管23を通して体腔内に挿入されており、腹壁5と外套管23とが交わる点を中心とした回転運動が可能である。また、外套管23を通して手持ち医療器具21を挿抜することで、直動の自由度が加わる。すなわち、回転の3自由度の運動と直動の1自由度の運動とを計測することができれば、手持ち医療器具21の持つすべての自由度を計測することが可能となる。手持ち医療器具21と外套管23には、位置姿勢計測装置22が取り付けられており、後述するセンサにより手持ち医療器具21の位置姿勢を計測する。このセンサは一般的な6自由度の絶対位置姿勢を計測可能なセンサでもよいが、ある時刻、位置からの相対的な位置姿勢を測定するセンサであってよい。   The hand-held medical instrument 21 is a medical instrument which the operator actually moves by hand to carry out the usual treatment, and is inserted into the body cavity through the outer tube 23 inserted in the small diameter hole opened in the abdominal wall 5, It is possible to rotate about the point where 5 and mantle tube 23 meet. Further, by inserting and removing the hand-held medical instrument 21 through the sheath tube 23, a degree of freedom of linear movement is added. That is, if it is possible to measure the motion with three degrees of freedom of rotation and the motion with one degree of freedom for linear motion, it is possible to measure all the degrees of freedom of the hand-held medical instrument 21. A position and orientation measurement device 22 is attached to the hand-held medical instrument 21 and the sheath tube 23, and the position and orientation of the hand-held medical instrument 21 is measured by a sensor described later. This sensor may be a sensor capable of measuring a general position / orientation of six degrees of freedom, but may be a sensor for measuring a relative position / orientation from a certain time or position.

位置姿勢計測装置22は、3自由度の姿勢を計測可能な慣性センサと、直動の1自由度である体腔内への挿入深度を計測可能な音波センサとの組み合わせで構成される。慣性センサとしては、例えば加速度センサ、傾斜センサ、ジャイロセンサ、地磁気センサなどの一般的なセンサおよびそれらの組み合わせを利用することができる。このような手持ち医療器具21を用いることにより、ロボット医療器具12の制御や表示部7に表示されるユーザインタフェースの操作を行う場合の入力装置として使用することが可能になる。   The position and orientation measurement device 22 is configured by a combination of an inertial sensor capable of measuring a posture with three degrees of freedom and a sound wave sensor capable of measuring an insertion depth into a body cavity that is one degree of freedom of linear motion. As an inertial sensor, for example, general sensors such as an acceleration sensor, a tilt sensor, a gyro sensor, a geomagnetic sensor, and a combination thereof can be used. By using such a hand-held medical instrument 21, it becomes possible to use it as an input device when performing control of the robot medical instrument 12 and operation of a user interface displayed on the display unit 7.

モード切替部3は、手術支援システムの操作モードを適切に切り替えるための操作部材を含み、例えば手元スイッチ、フットスイッチ等により構成される。操作モードは、処置のために手持ち医療器具21を操作して実際に手術を行うモード(単に処置モードともいう)と、ロボット医療器具12やエンドエフェクタを操作するため手持ち医療器具21を用いるモード(単にロボット操作モードともいう)とを含む。術者がモード切替部3を介して操作モードを切り替えると、制御部4はモード切替部3からの信号に応じてシステムの操作モードを切り替え、現在の操作モードを不図示のRAMに記録する。なお、モード切替部3を介して所定の音声、所定のジェスチャーの情報を取得し、制御部4が入力された情報に対応する操作モードに切り替えるようにしてもよい。   The mode switching unit 3 includes an operation member for appropriately switching the operation mode of the surgery support system, and is configured of, for example, a hand switch, a foot switch, and the like. The operation mode includes a mode (also referred to simply as a treatment mode) in which the hand-held medical device 21 is operated to perform an actual operation for treatment and a mode in which the hand-held medical device 21 is used to operate the robot medical device 12 and the end effector ( (Also referred to simply as robot operation mode). When the operator switches the operation mode via the mode switching unit 3, the control unit 4 switches the operation mode of the system according to the signal from the mode switching unit 3, and records the current operation mode in the RAM (not shown). Note that information of a predetermined voice and a predetermined gesture may be acquired via the mode switching unit 3, and the control unit 4 may switch to an operation mode corresponding to the input information.

制御部4は、CPU又はMPUなどの中央演算装置、ROM及びRAMを含み、ROM或いは不揮発性メモリ8等の記録媒体に記憶されたプログラムを実行して、手術支援装置2の各ブロックの動作を制御する。また、制御部4は、後述するように、位置姿勢計測装置22との間で信号を送受信して、術者によって操作された手持ち医療器具21の挿入角度及び挿入深度を求める。また、医療器具駆動部11のエンコーダから関節角等の現在位置情報(或いはこれらに基づいて得られる関節角等の間の変位情報)を取得する。制御部4は、手持ち医療器具21の腹壁に対する挿入角度及び挿入深度に基づいて、ロボット医療器具12の移動やエンドエフェクタ13の姿勢を制御するための制御情報を医療器具駆動部11へ出力する。なお、手持ち医療器具21の挿入角度及び挿入深度に基づく、ロボット医療器具12の移動やエンドエフェクタ13の姿勢を制御する方法には、様々な方法を用いてよいが、例えば、特開第2018−110747号公報に開示された公知の方法を用いることができる。   The control unit 4 includes a central processing unit such as a CPU or an MPU, a ROM, and a RAM, executes a program stored in a storage medium such as a ROM or a non-volatile memory 8, and performs operations of each block of the surgery support device 2. Control. Further, as described later, the control unit 4 transmits / receives a signal to / from the position / orientation measurement device 22 to obtain an insertion angle and an insertion depth of the hand-held medical instrument 21 operated by the operator. Further, current position information such as a joint angle (or displacement information between joint angles etc. obtained based on these) is acquired from the encoder of the medical instrument drive unit 11. The control unit 4 outputs control information for controlling the movement of the robot medical instrument 12 and the attitude of the end effector 13 to the medical instrument drive unit 11 based on the insertion angle and insertion depth of the hand-held medical instrument 21 with respect to the abdominal wall. Note that various methods may be used to control the movement of the robot medical instrument 12 and the attitude of the end effector 13 based on the insertion angle and the insertion depth of the hand-held medical instrument 21. For example, The known method disclosed in the publication 110747 can be used.

表示部7は、例えば、液晶ディスプレイ、有機ELディスプレイ等の表示デバイスを含み、腹壁に挿入された不図示の腹腔鏡で撮影された体腔内の画像又は映像を表示する。また、表示部7は、(ロボットや手持ち医療器具21の姿勢を示す数値等を含む)システム内部の状態表示や、本システムを操作するための操作画面等を表示する。表示部7は、術者が装着するヘッドマウントディスプレイ内に配置されてもよい。   The display unit 7 includes, for example, a display device such as a liquid crystal display or an organic EL display, and displays an image or a video in a body cavity taken by a laparoscope (not shown) inserted into an abdominal wall. Further, the display unit 7 displays an internal state display (including a robot and a numerical value indicating the posture of the hand-held medical instrument 21), an operation screen for operating the system, and the like. The display unit 7 may be disposed in a head mounted display worn by the operator.

不揮発性メモリ8は、半導体メモリや磁気ディスク等から構成される記録媒体を含み、制御部4が実行するプログラムや動作用の定数などを記憶する。   The nonvolatile memory 8 includes a recording medium including a semiconductor memory, a magnetic disk, and the like, and stores programs executed by the control unit 4 and constants for operation.

(位置姿勢計測装置の構成例)
次に、図2に参照して、位置姿勢計測装置22を手持ち医療器具21と外套管23に取り付けた場合を例に、位置姿勢計測装置22の構成例について説明する。図2に示す例では、外套管23には音波送信機201が、また、手持ち医療器具21には音波受信機202がそれぞれ取り付けられており、音波送信機201と音波受信機202とは互いに対向する向きに配置されている。また、手持ち医療器具21には、慣性センサ203が取り付けられている。
(Example of configuration of position and orientation measurement device)
Next, referring to FIG. 2, a configuration example of the position and orientation measurement device 22 will be described by taking the case where the position and orientation measurement device 22 is attached to the hand-held medical instrument 21 and the outer tube 23 as an example. In the example shown in FIG. 2, the acoustic wave transmitter 201 is attached to the outer tube 23, and the acoustic wave receiver 202 is attached to the hand-held medical instrument 21, and the acoustic wave transmitter 201 and the acoustic wave receiver 202 face each other. It is arranged in the same direction. In addition, an inertial sensor 203 is attached to the hand-held medical instrument 21.

本実施形態の例では、音波送信機201および音波受信機202とは、例えば超音波を送受信可能な素子によって構成されるが、超音波に限らずマイクとスピーカのような音波を送受信可能なペアであれば同様の原理で計測が可能である。また、慣性センサ203は、例えばジャイロセンサと加速度センサのいずれかまたは両方が含まれている。音波送信機201、音波受信機202、及び慣性センサのそれぞれは、制御部4と無線又は有線で接続されて、計測した信号や制御コマンド等を互いに送受信可能に構成される。制御部4は、送受信した信号に基づいて、対抗した音波送信機201と音波受信機202の間の距離(すなわち外套管23に対する手持ち医療器具21の挿入深度)を計測する。なお、本実施形態では、計測した信号を位置姿勢計測装置22から制御部4に送信し、制御部4によって挿入深度を算出する例を示すが、挿入深度の計測を位置姿勢計測装置22のみで行ってもよい。また、本実施形態の例では、位置姿勢計測装置22が手持ち医療器具21と外套管23とに取り付けられた例を説明する。しかし、位置姿勢計測装置22を、更に、ロボット医療器具12と外套管14とに取り付けて、外套管14に対するロボット医療器具12の挿入深度を計測可能にすることもできる。   In the example of the present embodiment, the sound wave transmitter 201 and the sound wave receiver 202 are configured by, for example, elements capable of transmitting and receiving ultrasonic waves, but not limited to ultrasonic waves, pairs capable of transmitting and receiving sound waves such as microphones and speakers If it is, measurement is possible on the same principle. Further, the inertial sensor 203 includes, for example, either or both of a gyro sensor and an acceleration sensor. Each of the sound wave transmitter 201, the sound wave receiver 202, and the inertia sensor is connected to the control unit 4 wirelessly or by wire, and is configured to be able to transmit and receive measured signals, control commands, and the like to each other. The control unit 4 measures the distance between the sound wave transmitter 201 and the sound wave receiver 202 (that is, the insertion depth of the hand-held medical instrument 21 with respect to the mantle tube 23) based on the transmitted and received signals. In this embodiment, an example in which the measured signal is transmitted from the position and orientation measurement device 22 to the control unit 4 and the control unit 4 calculates the insertion depth is described. However, the measurement of the insertion depth is performed only by the position and orientation measurement device 22. You may go. Further, in the example of the present embodiment, an example in which the position and orientation measurement device 22 is attached to the hand-held medical instrument 21 and the mantle tube 23 will be described. However, the position and orientation measurement device 22 may be further attached to the robot medical instrument 12 and the mantle tube 14 so that the insertion depth of the robot medical instrument 12 with respect to the mantle tube 14 can be measured.

図2に示す構成では、音波送信機201が外套管23に、音波受信機202が医療器具21にそれぞれ取り付けられているが、これとは反対に、音波受信機202を外套管23に、音波送信機201を医療器具21に取り付けてもよい。また、後述するように、音波送信機201、音波受信機202の数は必ずしも1対1である必要はなく、多対多であってもよい。   In the configuration shown in FIG. 2, the sound wave transmitter 201 is attached to the outer tube 23 and the sound wave receiver 202 is attached to the medical instrument 21. Conversely, the sound wave receiver 202 is attached to the outer tube 23 The transmitter 201 may be attached to the medical device 21. Further, as described later, the number of sound wave transmitters 201 and sound wave receivers 202 does not have to be one to one, and may be many to many.

音波は空気中を約340m/sの速さで伝わるため、送信から受信までの時間を測ることで音波送信機と音波受信機との間の距離を計測することが可能である。なお、一般に、タイミングを計測する目的ではパルス状の音波を送受信可能であることが望ましいが、現実的には(音波送信機および音波受信機の機械的な共振周波数の特性等により)パルス状の音波を発受信することは困難である。このため、一般には、バースト波と呼ばれる数波長〜数十波長の音波を用いられる。バースト波を用いた場合、受信のタイミングはバースト波の包絡線の閾値によって判断する。この方法では距離を絶対値として求めることが可能であるものの、信号強度によって時間計測の誤差が生まれ易く、結果的に高精度な距離計測結果が得られない場合がある。そこで、以下に説明する実施形態では位相計測による手法を用いて相対的な距離を高精度に計測する手法を用いる。   Since the sound waves travel through the air at a speed of about 340 m / s, it is possible to measure the distance between the sound wave transmitter and the sound wave receiver by measuring the time from transmission to reception. Generally, it is desirable to be able to transmit and receive pulse-like sound waves for the purpose of measuring timing, but in reality it is pulse-like (due to the characteristics of the mechanical resonance frequency of the sound wave transmitter and sound wave receiver, etc.) It is difficult to emit and receive sound waves. For this reason, generally, sound waves of several wavelengths to several tens of wavelengths called burst waves are used. When a burst wave is used, the timing of reception is determined by the threshold value of the burst wave envelope. In this method, although it is possible to obtain the distance as an absolute value, an error in time measurement is likely to be generated due to the signal strength, and as a result, there may be a case where a highly accurate distance measurement result can not be obtained. Therefore, in the embodiment described below, a method of measuring a relative distance with high accuracy using a method of phase measurement is used.

(距離計測のための制御部の構成)
更に、図3を参照して、距離計測のための制御部4の構成例について説明する。制御部4は、音波を用いた距離計測を行うための構成を含み、図3には、制御部4の有する機能のうちの、音波を用いた距離計測を行うための構成のみを示している。
(Configuration of control unit for distance measurement)
Furthermore, with reference to FIG. 3, the structural example of the control part 4 for distance measurement is demonstrated. The control unit 4 includes a configuration for performing distance measurement using a sound wave, and FIG. 3 shows only the configuration for performing distance measurement using a sound wave among the functions of the control unit 4. .

制御部4は、音波送信機201に音波信号を出力する音波信号出力部301と、音波受信機202で受信した信号を増幅およびノイズフィルタリングする音波信号増幅部302と、振幅計測部303と、コンパレータ部304とを含む。音波信号出力部301から送信された信号と、音波受信機202で受信された信号とのそれぞれは、振幅計測部303とコンパレータ部304とに入力される。   The control unit 4 includes a sound wave signal output unit 301 that outputs a sound wave signal to the sound wave transmitter 201, a sound wave signal amplification unit 302 that amplifies and noise filters a signal received by the sound wave receiver 202, an amplitude measurement unit 303, and a comparator And a unit 304. Each of the signal transmitted from the sound wave signal output unit 301 and the signal received by the sound wave receiver 202 is input to the amplitude measurement unit 303 and the comparator unit 304.

振幅計測部303は、送信された音波信号と受信された音波信号の振幅を計測する。なお、計測する物理量としては必ずしも振幅である必要ではなく、RMS(Root Mean Square)やそれに準ずるような振幅に相関する信号であってもよい。コンパレータ部304は、音波信号を矩形波に変換することで送信と受信の位相差を計測するための前処理を行う。コンパレータ部304は、矩形波に変換した音波信号を演算部305に出力し、演算部305は、送信・受信間の位相差を計測する。なお、コンパレータ部304は、位相差計測を簡便に行うためのものであり、音波波形から位相差が計測できれば必須ではない。また、図3では、301〜304の構成が制御部4に含まれており、音波送信機201や音波受信機202と離れた位置に配置される例を示したが、これらの301〜304の構成は、音波送信機201又は音波受信機202の周辺に配置されてもよい。また、これらの301〜304の構成の一部又は全ては、制御部4が実行するソフトウェアによって実現されてもよい。   The amplitude measurement unit 303 measures the amplitudes of the transmitted sound wave signal and the received sound wave signal. The physical quantity to be measured is not necessarily the amplitude, and may be a signal correlated with the RMS (Root Mean Square) or an amplitude according to it. The comparator unit 304 performs preprocessing for measuring a phase difference between transmission and reception by converting a sound wave signal into a rectangular wave. The comparator unit 304 outputs the sound wave signal converted into the rectangular wave to the calculation unit 305, and the calculation unit 305 measures the phase difference between transmission and reception. The comparator unit 304 is for simply performing phase difference measurement, and is not essential as long as the phase difference can be measured from the sound wave waveform. Further, FIG. 3 shows an example in which the configuration of 301 to 304 is included in the control unit 4 and is arranged at a position distant from the sound wave transmitter 201 and the sound wave receiver 202. The configuration may be arranged around the sound wave transmitter 201 or the sound wave receiver 202. Further, some or all of the configurations 301 to 304 may be realized by software executed by the control unit 4.

なお、図1及び図3では明示していないが、制御部4は、演算部305によって演算された演算結果を他の機器に出力するためのインターフェース(演算結果出力部として機能する)を有してよい。また、制御部4は、慣性センサ203から出力された信号を入力し、演算部305によって音波信号と同時に処理してもよい。   Although not explicitly shown in FIGS. 1 and 3, the control unit 4 has an interface (functioning as an operation result output unit) for outputting the operation result calculated by the operation unit 305 to another device. You may In addition, the control unit 4 may receive the signal output from the inertial sensor 203 and process the sound signal simultaneously with the operation unit 305.

(距離計測処理の例)
図4は、演算部305によって計測される位相差と、音波送信機201と音波受信機202との間の距離とをそれぞれ縦軸と横軸とで表したグラフを示している。図4に示すように、位相差と距離との関係は、0〜360°の間で周期的に変化する波形で表される。1周期に相当する距離(d1)までを移動するのであれば、位相と距離が比例しているため、位相から一意に距離を算出することが可能である。しかし、d1以上の距離では、どの周期に相当する位相なのか判別ができないため、距離を決定することができない。
(Example of distance measurement process)
FIG. 4 shows a graph in which the phase difference measured by the calculation unit 305 and the distance between the sound wave transmitter 201 and the sound wave receiver 202 are represented by the vertical axis and the horizontal axis, respectively. As shown in FIG. 4, the relationship between the phase difference and the distance is represented by a waveform that periodically changes between 0 and 360 degrees. If the distance (d1) corresponding to one cycle is moved, it is possible to calculate the distance uniquely from the phase because the phase and the distance are proportional. However, at a distance of d1 or more, it can not be determined which phase the phase corresponds to, so the distance can not be determined.

そこで、演算部305は、位相の変化量を逐次計算することによって、位相をまたいだ場合でも適切な移動量(すなわち距離の変化量)に変換する。図5に示すように、距離が変化して位相が360°から0°に戻った場合を考える。この場合、計測される値としては、ある時刻tにおける位相p、及び時刻tk+1における位相pk+1である。上述したように、位相の値のみに着目する場合、pからpk+1への経路は2通り考えられる。このため、波長λを用いて表すと、位置d=λ(pk+1−p)/360+d、もしくはd=λ(pk+1−p)/360+λ+dのどちらかとなる。そこで、実際にどちらの位置にいるかを判断するために、速度に対する制約条件を設ける。 Therefore, the computing unit 305 converts the amount of change in phase into an appropriate amount of movement (that is, the amount of change in distance) by sequentially calculating the amount of change in phase even when the phase is crossed. As shown in FIG. 5, consider the case where the distance changes and the phase returns from 360 ° to 0 °. In this case, the values to be measured are the phase p k at a certain time t k and the phase p k + 1 at the time t k + 1 . As described above, when attention is paid only to the phase value, the path from p k to p k + 1 are considered two ways. Therefore, when expressed using the wavelength λ, either the position d n = λ (p k + 1 −p k ) / 360 + d k or the d m = λ (p k + 1 −p k ) / 360 + λ + d k is obtained. Therefore, in order to determine which position it is actually in, a constraint condition on the speed is provided.

時刻tからtk+1になる間に位相がpからpk+1になった場合、それに対応する速度は(d−d)/(tk+1−t)か、(d−d)/(tk+1−t)のどちらかとなる。この状態を定性的に表すと、非常に速い速度で距離が減少したか遅い速度で距離が増加したかのどちらかである。このとき、本実施形態では、あるサンプリング間隔の間に半波長以上移動しないという仮定を設ける。この仮定に係る閾値を、波長λを用いて表すとv=λ(tk+1−t)/2である。この場合、図5に示す例では、演算部305は、位置dに移動した場合は閾値を超える(サンプリング間隔の間に半波長以上移動する)速度であるためにこの移動を除き、(当該閾値を超えない速度で移動した)位置dに移動したと決定することができる。 When the phase during the time t k becomes t k + 1 becomes the p k to p k + 1, the rate corresponding thereto (d m -d k) / ( t k + 1 -t k) or, (d n -d k ) / becomes either (t k + 1 -t k) . Expressing this condition qualitatively, either the distance is reduced at a very high speed or the distance is increased at a low speed. At this time, in the present embodiment, an assumption is made that the laser does not move by more than half a wavelength during a certain sampling interval. The threshold according to this assumption is expressed by using wavelength λ, and is v t = λ (t k + 1 −t k ) / 2. In this case, in the example illustrated in FIG. 5, when the arithmetic unit 305 moves to the position d n , the movement speed exceeds the threshold (moving by half a wavelength or more during the sampling interval), except for the movement (the movement It can be determined that it moved to position d m ) which moved at a speed not exceeding the threshold.

図5を参照した例では、pk+1−pが負の値になる場合を考えたがこれが正の場合にも同様の手順で考えることができる。図6は、pk+1−pが正の値となる状況を示している。図6に示す例では、位相から求められる位置は、d=λ(pk+1−p)/360+dもしくはd=λ(pk+1−p)/360−λ+dと求められる。この例においても、演算部305は、速度の閾値によって判断すれば実際にどちらに移動したかを判断可能である。 In the example with reference to FIG. 5, p k + 1 -p k is but consider the case where a negative value which can be considered in the same procedure in the case of positive. FIG. 6 shows a situation in which p k + 1 −p k is a positive value. In the example illustrated in FIG. 6, the position obtained from the phase is obtained as d n = λ (p k + 1 −p k ) / 360 + d k or d m = λ (p k + 1 −p k ) / 360−λ + d k . Also in this example, the arithmetic operation unit 305 can determine to which position it actually moved by judging by the threshold value of the speed.

このように、演算部305は、位相の変化の周期をまたぐ際に適切な処理をすることによって、相対的な移動量を特定することが可能となる。この手法では、音波信号の振幅の情報を必要としていないため、周辺環境の外乱の影響で受信強度が変化したとしても計測結果に全く影響を及ぼさないという利点がある。   As described above, the computing unit 305 can specify the relative movement amount by performing appropriate processing when the phase change period is crossed. Since this method does not require the information of the amplitude of the sound wave signal, there is an advantage that even if the reception intensity changes due to the influence of the disturbance of the surrounding environment, the measurement result is not affected at all.

計測の分解能は、位相差計測の時間分解能によって決定される。一般に、この時間分解能はマイクロコントローラやFPGAのクロック周波数に相当するものである。例えば、16MHzのクロックによって位相差を計測したとすると、分解能としては約0.02mmとなる。また、FPGAのようなデバイスを使用すれば音波の周波数と同じ周期で位相差計測が可能であるため、速度の閾値vは音速の半分の速度となる。これは人が手にもって動かす速度に対して十分高速である。 The resolution of measurement is determined by the time resolution of phase difference measurement. Generally, this time resolution corresponds to the clock frequency of a microcontroller or FPGA. For example, if the phase difference is measured by a 16 MHz clock, the resolution is about 0.02 mm. In addition, since a phase difference can be measured in the same cycle as the frequency of the sound wave if a device such as an FPGA is used, the speed threshold v t is half the speed of sound. This is fast enough for the speed at which people move with their hands.

このように、本実施形態では、外套管23と手持ち医療器具21の一方に取り付けられた音波送信機201と他方に取り付けられた音波受信機202との間の空間を伝わる音波を計測することにより、手持ち医療器具21の挿入深度を計測するようにした。具体的に、外套管23に配置した音波送信機201から音波を送信して、手持ち医療器具21に配置した音波受信機202で受信することで、空気中を伝わる音波の時間に基づいて手持ち医療器具21の直動方向の挿入深度を計測するようにした。このようにすることで、挿入深度の計測に対して手持ち医療器具21の表面材質や軽微な付着物などの影響を大幅に低減できるようになる。すなわち、体腔に挿入される医療器具の長軸方向の移動を精度よく計測することが可能になる。   Thus, in the present embodiment, by measuring the sound waves transmitted through the space between the sound wave transmitter 201 attached to one of the outer tube 23 and the hand-held medical instrument 21 and the sound wave receiver 202 attached to the other. The insertion depth of the hand-held medical instrument 21 was measured. Specifically, the sound wave is transmitted from the sound wave transmitter 201 disposed in the outer tube 23 and received by the sound wave receiver 202 disposed in the hand-held medical instrument 21 so that the hand-held medical treatment is performed based on the time of the sound wave transmitted in the air. The insertion depth in the linear movement direction of the device 21 was measured. By doing this, it is possible to significantly reduce the influence of the surface material of the hand-held medical instrument 21 and minor deposits on the measurement of the insertion depth. That is, it is possible to accurately measure the movement of the medical device inserted into the body cavity in the long axis direction.

また、上述の実施形態では、送信された音波信号と受信された音波信号の位相差に基づいて、外套管23に配置した音波送信機201と手持ち医療器具21に配置した音波受信機202との間の移動距離を計測するようにした。このとき、音波信号の位相差に基づく距離の計測では、手持ち医療器具21が所定の閾値を超える(サンプリング間隔の間に半波長以上移動する)速度での移動を除くことにより、手持ち医療器具21の相対的な移動量を決定するようにした。位相差によって移動量を計測するようにしたことで、音波信号の振幅の情報を必要とせず、周辺環境の外乱によって受信強度が変化するような場合にも精度良く移動量を計測することができる。   Further, in the above-described embodiment, the sound wave transmitter 201 disposed in the outer tube 23 and the sound wave receiver 202 disposed in the hand-held medical instrument 21 based on the phase difference between the transmitted sound wave signal and the received sound wave signal. The movement distance between them was measured. At this time, in the measurement of the distance based on the phase difference of the sound wave signal, the hand-held medical device 21 is removed by removing the movement at a speed exceeding the predetermined threshold (moving by half a wavelength or more during the sampling interval). Was made to determine the relative movement amount of. By measuring the movement amount by the phase difference, the movement amount can be accurately measured even when the reception intensity changes due to the disturbance of the surrounding environment without requiring the information of the amplitude of the sound wave signal. .

(障害物の検知処理)
次に、上述した距離計測処理を適用して、障害物の検知処理を行う例について説明する。本計測手法では音波送信機201および音波受信機202は互いに対向した向きに配置されているため、この間に障害物が存在すると計測ができなくなる。そこで、手持ち医療器具21のシャフトの周囲にいくつかの音波送信機201と音波受信機202を配置することで、音波の経路に障害物がない音波送信機201と音波受信機202のペアを使用することが可能になる。障害物の有無は、制御部4内の振幅計測部303によって計測された値から判断することが可能である。計測される信号の振幅は距離によっても増減するが、手持ち医療器具21のシャフトの長さの範囲で変化する量と、障害物の有無によって変化する量が明確に異なるため、実験等によって適切な閾値を予め設定すれば、障害物を検出することが可能となる。このため、制御部4は、音波送信機201と音波受信機202の複数のペアから得られる複数の音波信号について、障害物検知用の閾値を上回る振幅を有するかを判定する。そして、障害物検知用の閾値を上回る振幅を有すると判定した音声信号を、障害物によって遮られていない音声信号として選択し、選択した音声信号を用いて距離計測処理を行う。
(Detection processing of obstacles)
Next, an example in which the above-described distance measurement process is applied to perform an obstacle detection process will be described. In the present measurement method, since the sound wave transmitter 201 and the sound wave receiver 202 are disposed in the directions facing each other, measurement can not be performed if there is an obstacle during this time. Therefore, by arranging several sound wave transmitters 201 and sound wave receivers 202 around the shaft of the hand-held medical instrument 21, a pair of the sound wave transmitter 201 and the sound wave receiver 202 with no obstacle in the sound wave path is used. It will be possible to The presence or absence of an obstacle can be determined from the value measured by the amplitude measurement unit 303 in the control unit 4. The amplitude of the signal to be measured also increases or decreases with distance, but the amount that changes with the range of the shaft length of the hand-held medical instrument 21 and the amount that changes with the presence or absence of obstacle clearly differ, so it is appropriate by experiment etc. If the threshold is set in advance, it becomes possible to detect an obstacle. For this reason, the control unit 4 determines whether or not the plurality of sound wave signals obtained from the plurality of pairs of the sound wave transmitter 201 and the sound wave receiver 202 have an amplitude that exceeds the threshold for obstacle detection. Then, a voice signal determined to have an amplitude exceeding the threshold for obstacle detection is selected as a voice signal not blocked by the obstacle, and distance measurement processing is performed using the selected voice signal.

(シャフト周りの回転による影響の低減)
一般に、複数の音源が存在する場合には音波が干渉して空間上に音圧分布ができてしまう。複数の音波送信機201を外套管23に配置する場合であっても、ある時間幅では、送信側としては1つだけを使用するような状態で距離計測処理を行うことが望ましい。これに対し、受信側は2つ以上を同時に使用することができる。本実施形態では、この特性を利用して、手持ち医療器具21のシャフト周りの回転に対して距離の計測誤差を小さくするように処理を行う。
(Reduced influence of rotation around shaft)
In general, when there are a plurality of sound sources, the sound waves interfere with each other to create a sound pressure distribution in space. Even in the case where a plurality of sound wave transmitters 201 are disposed in the sheath tube 23, it is desirable that the distance measurement process be performed in a state where only one transmitting side is used in a certain time width. On the other hand, the receiver can use two or more at the same time. In this embodiment, processing is performed to reduce the measurement error of the distance with respect to the rotation around the shaft of the hand-held medical instrument 21 by using this characteristic.

音波送信機201と音波受信機202は、例えば図2に示したように、手持ち医療器具21のシャフト周囲に配置することができる。この場合、手持ち医療器具21がシャフト周りで回転した場合、挿入深さが同じでも、対応する音波送信機201と音波受信機202の間の距離が変化する。   The sound wave transmitter 201 and the sound wave receiver 202 can be arranged around the shaft of the hand-held medical instrument 21 as shown for example in FIG. In this case, when the hand-held medical instrument 21 rotates around the shaft, the distance between the corresponding sound wave transmitter 201 and the sound wave receiver 202 changes even if the insertion depth is the same.

シャフト周りの回転による影響を、図7を参照して、より具体的に説明する。図7に示す例では、2つの音波受信機202である音波受信機Aと音波受信機Bとが手持ち医療器具21のシャフトを挟むようにhrxだけ離れて対称に取り付けられている。また、それぞれの音波送信機201はシャフトからhtxだけ離れて外套管23に取り付けられている。このとき、音波送信機201と音波受信機Aの間の距離Lを、シャフト上での距離lとシャフト周りの回転角θによって表すと以下のようになる。 The influence of rotation around the shaft will be more specifically described with reference to FIG. In the example shown in FIG. 7, two sound wave receivers 202, a sound wave receiver A and a sound wave receiver B, are symmetrically attached apart by h rx so as to sandwich the shaft of the hand-held medical instrument 21. Also, each sound wave transmitter 201 is attached to the mantle tube 23 away from the shaft by h tx . At this time, the distance L A between the sound wave transmitter 201 and the sound wave receiver A can be expressed as follows by the distance 1 on the shaft and the rotation angle θ around the shaft.

ここで、音波受信機Bの位置はθ+180°に相当する。上述の式を用いて、あるlのときにθが変化した場合の様子をプロットしたグラフを図8に示す。ここで、θの速度は360°/s、lは100mmとした場合を示している。計測の性質上、絶対距離は意味を持たないので、縦軸はLとLの速度である。lが固定された状態のため、LとLの速度は0になるはずであるが、各音波受信機の計測値そのままではθの変化によって実際のlの速度から大きく外れてしまう。ここで、各受信機の音波信号から得られた距離の変化(速度)などの計測値を加算して2で割ると(すなわち複数の計測値で平準化すると)、θに対してほとんど影響を受けない結果が得られる。このように、音波受信機が複数ある場合、例えば所定の位置関係にある複数の音波受信機に基づく計測値を平均化することによって、手持ち医療器具21のシャフト周りの回転(すなわちθ)の影響をキャンセルし、より精度の高い距離計測が可能となる。 Here, the position of the sound wave receiver B corresponds to θ + 180 °. A graph is shown in FIG. 8 in which the situation where θ changes at a certain l is plotted using the above equation. Here, the speed of θ is 360 ° / s, and l is 100 mm. Due to the nature of the measurement, since the absolute distance has no meaning, and the vertical axis represents the rate of L A and L B. Because l is fixed, the velocities of L A and L B should be 0, but with the measurement values of the respective acoustic wave receivers as they are, they will deviate significantly from the actual l velocity due to changes in θ. Here, adding measured values such as change (velocity) of the distance obtained from the sound wave signal of each receiver and dividing by 2 (that is, leveling with a plurality of measured values) gives almost no influence on θ. You get results that you do not receive. Thus, when there are a plurality of sound wave receivers, for example, by averaging measurements based on a plurality of sound wave receivers in a predetermined positional relationship, the effect of rotation (ie, θ) around the shaft of the hand-held medical instrument 21. Cancel, and more accurate distance measurement becomes possible.

図7を参照して説明した例では、2つの音波受信機202を、手持ち医療器具21のシャフトを軸対称として取り付けた場合について説明した。しかし、本実施形態は、3つ以上の音波受信機202がある場合、シャフトを中心として均等な角度で割り振るように配置することで、2つの場合と同様にそれらの計測結果を平均すれば上記と同様の結果が得られる。   In the example described with reference to FIG. 7, the case where the two acoustic wave receivers 202 are attached with the shaft of the hand-held medical instrument 21 as the axisymmetric is described. However, in the present embodiment, when there are three or more sound wave receivers 202, if the measurement results are averaged as in the two cases by arranging them so as to be distributed at equal angles around the shaft, the above The same result is obtained.

(絶対距離を計測する構成)
これまでに説明した距離計測処理は、計測開始からの相対距離を計測するものであるが、ここでは音波送信機と音波受信機の間の距離を絶対距離として計測する構成について説明する。
(Configuration to measure absolute distance)
Although the distance measurement processing described above measures the relative distance from the start of measurement, here, a configuration for measuring the distance between the sound wave transmitter and the sound wave receiver as an absolute distance will be described.

本実施形態における絶対距離を計測する構成として、位置姿勢計測装置22は、手持ち医療器具21のシャフトの先端が外套管23を通過したことを検知するための挿入検知センサ(図9及び図10を参照して後述する)を、外套管23に備える。なお、本実施形態では、挿入検知センサの一例として、光(フォトセンサ)を用いた挿入検知センサと、機械式スイッチを用いた挿入検知センサについて説明するが、手持ち医療器具21の挿入を検知可能なセンサであれば、他の方法を用いてもよい。他の方法には、例えば、インダクタンスの変化、キャパシタンスの変化、シャフトを通過させる空間の圧力の変化等を計測する方法を用いてもよい。   As a configuration for measuring the absolute distance in the present embodiment, the position and orientation measurement device 22 is an insertion detection sensor for detecting that the tip of the shaft of the hand-held medical instrument 21 has passed the mantle tube 23 (see FIGS. 9 and 10). The sheath tube 23 is provided with a reference (to be described later). In this embodiment, an insertion detection sensor using light (photo sensor) and an insertion detection sensor using a mechanical switch will be described as an example of the insertion detection sensor, but the insertion of the hand-held medical instrument 21 can be detected. If it is a sensor, other methods may be used. As another method, for example, a method of measuring a change in inductance, a change in capacitance, a change in pressure in a space passing the shaft, or the like may be used.

図9は、光を用いた挿入検知センサを示している。この例では、手持ち医療器具21のシャフトが通る部分に光送信機901と光受信機902が取り付けられている。光送信機901から発光される光は、シャフトが横切ると遮断されるため、光受信機902の受光状態の変化によって手持ち医療器具21が挿入されたことを検知することができる。   FIG. 9 shows an insertion detection sensor using light. In this example, an optical transmitter 901 and an optical receiver 902 are attached to a portion through which the shaft of the hand-held medical instrument 21 passes. Since the light emitted from the light transmitter 901 is blocked when the shaft crosses, it is possible to detect that the hand-held medical instrument 21 has been inserted by the change in the light reception state of the light receiver 902.

相対距離を絶対距離にするために、制御部4は、挿入検知センサによって外套管23に手持ち医療器具21のシャフトが挿入されたことを検知すると同時に音波による相対距離の計測を開始する(計測値をクリアする)。ここで、医療器具の先端から音波受信機202までの距離は既知であるため、結果として挿入検知センサを原点とした絶対距離に変換が可能となる。なお、原点となる挿入検知センサの位置は、例えば、外套管23の回転中心の絶対位置を予め特定しておき、回転中心から検出位置までの距離と外套管23の角度によって定めることができる。   In order to make the relative distance an absolute distance, the control unit 4 starts the measurement of the relative distance by the sound wave while detecting that the shaft of the hand-held medical instrument 21 is inserted into the mantle tube 23 by the insertion detection sensor (measurement value Clear). Here, since the distance from the tip of the medical instrument to the sound wave receiver 202 is known, as a result, conversion to an absolute distance with the insertion detection sensor as the origin becomes possible. The position of the insertion detection sensor as the origin can be determined, for example, by specifying the absolute position of the rotation center of the sheath tube 23 in advance and determining the distance from the rotation center to the detection position and the angle of the sheath tube 23.

図9に示す例では、外套管23の内部に光送信機901と光受信機902が存在している。しかし、外套管23の材質が光を通すものであれば、光送信機901と光受信機902を外套管23の外側に着脱可能に取り付けるようにしてもよい。ここで、血液等の生体組織が付着しても反応しないようにするために、光の波長には近赤外領域を用いることができる。   In the example shown in FIG. 9, an optical transmitter 901 and an optical receiver 902 exist inside the envelope tube 23. However, if the material of the jacket tube 23 allows light to pass, the light transmitter 901 and the light receiver 902 may be detachably attached to the outside of the jacket tube 23. Here, a near infrared region can be used as the wavelength of light in order to prevent reaction even when living tissue such as blood adheres.

また、図10には、機械式スイッチを用いた、挿入検知センサの他の例を示している。この例では、手持ち医療器具21のシャフトが外套管23を通過する際にスイッチ1001が押されるような機構になっている。また、スイッチだけでなく反力を受けるためのガイドローラ1002をスイッチと反対側に設けることによって、誤検知を低下させることができる。ガイドローラ1002は必ずしも回転をする必要はなく、摩擦が小さければ突起物のようなものでもよい。また、スイッチ1001は、一般的な機械的スイッチの他に、物体の移動や変形を検知してオン・オフされるものであればこれに限らない。例えば、ホールセンサ、光センサ、インダクタンスセンサ、キャパシタンスセンサ等が利用可能である。   Further, FIG. 10 shows another example of the insertion detection sensor using a mechanical switch. In this example, the switch 1001 is pressed when the shaft of the hand-held medical instrument 21 passes the sheath tube 23. Further, false detection can be reduced by providing not only the switch but also the guide roller 1002 for receiving the reaction force on the opposite side to the switch. The guide roller 1002 does not necessarily have to rotate, and may be a protrusion if the friction is small. Further, the switch 1001 is not limited to a general mechanical switch as long as it can be turned on / off by detecting movement or deformation of an object. For example, a Hall sensor, an optical sensor, an inductance sensor, a capacitance sensor, etc. can be used.

(絶対距離を計測する他の構成)
手持ち医療器具21のシャフトに対する挿入検知センサを使用することなく、他の構成を用いて絶対位置を求めてもよい。例えば、絶対距離を計測するための構成として、間欠的に音波を送信する構成を用いてもよい。間欠的な音波を用いる場合、音波の送信が開始した又は停止した際に、受信信号の立ち上がりもしくは立ち下りを検出することにより、音波の到達時間に基づいた絶対距離の計測が可能である。なお、受信信号の立ち上がりもしくは立ち下りの検出は、図2において上述したバースト波を用いた計測方法と同様にすればよい。すなわち、受信のタイミングはバースト波の包絡線の閾値によって判断する。このように、音波の到達時間に基づいて絶対距離を求めてしまえば、上述した正確な相対位置の計測によって、音波送信機と音波受信機の間の絶対距離が常に計測可能となる。
(Other configuration to measure absolute distance)
Other configurations may be used to determine absolute position without using an insertion detection sensor on the shaft of the hand-held medical device 21. For example, as a configuration for measuring an absolute distance, a configuration may be used in which a sound wave is intermittently transmitted. When using an intermittent sound wave, it is possible to measure an absolute distance based on the arrival time of the sound wave by detecting the rising or falling of the reception signal when the transmission of the sound wave is started or stopped. The detection of the rising or falling of the reception signal may be performed in the same manner as the measurement method using the burst wave described above with reference to FIG. That is, the timing of reception is determined by the threshold value of the burst wave envelope. As described above, when the absolute distance is obtained based on the arrival time of the sound wave, the absolute distance between the sound wave transmitter and the sound wave receiver can always be measured by the measurement of the relative position described above.

(交換した手持ち医療器具を自動的に判別する構成)
上述の構成では、外套管23と手持ち医療器具が1対1に対応して使用される例を説明した。しかし、実際の手術では、複数の医療器具の中から使用する医療器具を選択し、1つの外套管23に挿入する医療器具を切り替えて使用する。
(Configuration to automatically identify the replaced hand-held medical device)
In the above-described configuration, an example has been described in which the sheath tube 23 and the hand-held medical device are used in one-to-one correspondence. However, in actual surgery, a medical instrument to be used is selected from a plurality of medical instruments, and the medical instrument to be inserted into one mantle tube 23 is switched and used.

新たに外套管23に挿入する手持ち医療器具21との間で計測を実行するために、使用済みの(交換前の)手持ち医療器具21に取り付けたセンサを、逐次これから使用する(交換後の)手持ち医療器具21に取りつけ直すのでは手間がかかる。このため、複数の手持ち医療器具21のそれぞれに予め音波受信機202を装着しておき、制御部4が(手持ち医療器具21を交換した際に)どのセンサのデータを処理対象とするかを切り替える方が手術の進行を妨げず、手術支援システムの操作が容易になる。   In order to perform measurements with the hand-held medical device 21 to be newly inserted into the outer tube 23, a sensor attached to the used (before replacement) hand-held medical device 21 is sequentially used (after replacement) Reattachment to the hand-held medical instrument 21 takes time. Therefore, the sound wave receiver 202 is attached to each of the plurality of hand-held medical instruments 21 in advance, and the control unit 4 switches which sensor data is to be processed (when the hand-held medical instruments 21 is replaced) One does not disturb the progress of the surgery, and the operation of the surgery support system becomes easier.

特に、手術の進行を妨げないようにするためには、手持ち医療器具21の切り替えをスイッチ等によって術者が手動で切り替えるのではなく、システム側で手持ち医療器具21の切り替わりを自動で判別することできるとよい。そこで、図11及び図12を参照して、使用する手持ち医療器具21のセンサを自動的に判別する構成について説明する。なお、複数の手持ち医療器具21に取り付けられた各センサ(すなわち位置姿勢計測装置22)は、いずれも有線又は無線によって制御部4と接続されているものとする。   In particular, in order to prevent the progress of the operation, the system side automatically determines the switching of the hand-held medical device 21 instead of manually switching the switching of the hand-held medical device 21 by a switch or the like. It should be possible. Therefore, with reference to FIGS. 11 and 12, a configuration for automatically determining the sensor of the hand-held medical instrument 21 to be used will be described. In addition, each sensor (namely, position and orientation measurement device 22) attached to a plurality of hand-held medical instruments 21 is connected to the control unit 4 by wire or wireless.

使用している術具を判別する方法として、図11に示すように、術者の手に着脱可能なタグ1101〜1103を装着させておき、手持ち医療器具21に備わるタグ検出用センサ1104を用いて、当該タグの近接又は接触を検出する。例えば、磁石で構成されるタグを術者の手に取り付けておき、磁力センサで構成されるタグ検出用センサによってタグを検出する。制御部4は、タグ検出用センサからタグを検出したことを示す検出信号を受信したことに応じて、当該タグを検出したタグ検出用センサが取り付けられた手持ち医療器具を、使用する手持ち医療術具として判別する。   As a method for determining a surgical tool being used, as shown in FIG. 11, the tags 1101 to 1103 attachable to and detachable from the operator's hand are used, and the tag detection sensor 1104 provided in the hand-held medical instrument 21 is used. To detect proximity or contact of the tag. For example, a tag composed of a magnet is attached to the hand of the operator, and the tag detection sensor composed of a magnetic sensor detects the tag. The control unit 4 performs a hand-held medical technique using a hand-held medical instrument to which the tag detection sensor that has detected the tag is attached in response to receiving a detection signal indicating that the tag is detected from the tag detection sensor. Determine as a tool.

タグ検出用センサ1104は、検出信号を制御部4に送信する際に、タグ検出センサ114を識別するID(タグ検出センサID)を合わせて送信してもよい。制御部4は、タグ検出センサ114からタグ検出センサIDと検出信号を受信すると、当該IDに基づいて、使用している手持ち医療器具21を特定し、手持ち医療器具21の情報を取得するようにしてもよい。手持ち医療器具21の情報には、例えば、医療器具の種別やシャフトの長さなどの医療器具情報のほか、取り付けられている音波受信機の数、各音波受信機の間の角度、シャフトからの距離、などの情報を含む。例えば、タグ検出センサ1104を取り付けた手持ち医療器具の情報とタグ検出センサIDとを関連付けたテーブルを予め不揮発性メモリ8に記憶させておく。このようにすれば、制御部4は、タグ検出センサ1104がタグを検出したことに応じて、当該テーブルからタグ検出センサを取り付けた手持ち医療器具の情報を取得することができる。そして、例えば音波受信機の数に応じて距離計測処理を切り替えたり、手持ち医療器具21の特性に応じて制御情報を調整したりすることができる。制御部4は、タグ検出センサ1104がタグを検出したことに応じて、使用している手持ち医療器具21が検出されたこと、検出された手持ち医療器具の種別や特性を示す情報の少なくともいずれかを表示部7に表示させてもよい。このようにすれば、術者は、手持ち医療器具の交換がシステムによって認識されたこと、システムに認識されている手持ち医療器具の情報などを把握することができる。   When transmitting the detection signal to the control unit 4, the tag detection sensor 1104 may also transmit an ID (tag detection sensor ID) for identifying the tag detection sensor 114. When the control unit 4 receives the tag detection sensor ID and the detection signal from the tag detection sensor 114, the control unit 4 specifies the hand-held medical instrument 21 being used based on the ID and acquires information of the hand-held medical instrument 21. May be The information on the hand-held medical device 21 includes, for example, medical device information such as the type of medical device and the length of the shaft, the number of acoustic wave receivers attached, the angle between the respective acoustic wave receivers, and the shaft Contains information such as distance. For example, a non-volatile memory 8 is stored in advance with a table in which information of a hand-held medical instrument attached with a tag detection sensor 1104 is associated with a tag detection sensor ID. In this way, in response to the tag detection sensor 1104 detecting a tag, the control unit 4 can acquire, from the table, information of a hand-held medical instrument to which the tag detection sensor is attached. Then, for example, the distance measurement process can be switched according to the number of sound wave receivers, or the control information can be adjusted according to the characteristics of the hand-held medical instrument 21. The control unit 4 detects that the handheld medical device 21 being used is detected in response to the tag detection sensor 1104 detecting the tag, and at least any one of information indicating the type and characteristics of the detected handheld medical device. May be displayed on the display unit 7. In this way, the operator can grasp that replacement of the hand-held medical instrument has been recognized by the system, information on the hand-held medical instrument recognized in the system, and the like.

術者にタグをつける位置や取り付け態様は、図11に示すように異なってよい。また、タグの位置や取り付け態様は手持ち医療器具21の形状によって異なってもよい。例えば、1101のように指先に装着可能なもの、1102のように手のひらにタグを取り付けるもの、1103のように手首から伸びるストラップ状の形状にタグを埋め込んだものがあってよい。このようにしたタグであれば、手持ち医療器具21を使用する際にタグを手持ち医療器具21のタグ検出用センサに近接させ易く都合がよい。また、タグやタグ検出用センサは1つである必要はなく、すべての術具に対応できるように何か所かに取り付けてもよい。タグ検出用センサは、磁力に限らず、近接を判定可能であれば他の方法であってもよく、例えばRFID等の近距離無線通信を用いるものであってもよい。   The position and attachment manner of tagging the operator may be different as shown in FIG. Also, the position and mounting manner of the tag may differ depending on the shape of the hand-held medical instrument 21. For example, there may be one that can be attached to the fingertip like 1101, one that attaches the tag to the palm like 1102, and one that embeds the tag in a strap shape extending from the wrist like 1103. With such a tag, it is convenient to easily bring the tag close to the tag detection sensor of the hand-held medical device 21 when using the hand-held medical device 21. Also, the tag and the tag detection sensor do not have to be one, but may be attached at some places so as to be compatible with all the surgical instruments. The tag detection sensor is not limited to the magnetic force, and may be another method as long as proximity can be determined. For example, near field communication such as RFID may be used.

このように、術者の手に近接した手持ち医療器具を使用する手持ち医療器具として自動選択するようにすれば、術者が手持ち医療器具を誤って手から落下させた際に操作を無効にする用途にも使用可能である。この場合、術者の手から手持ち医療器具21は離れるとタグを認識できなくなるため、制御部4は、このタグの識別状態の変更に応じて、手持ち医療器具21を使用していないものとして扱う(例えば位置姿勢計測装置22からの信号を無視する)ことができる。   In this way, automatic selection as a hand-held medical device using a hand-held medical device close to the hand of the operator invalidates the operation when the operator accidentally drops the hand-held medical device from the hand It can also be used for applications. In this case, since the tag can not be recognized when the hand-held medical instrument 21 is separated from the operator's hand, the control unit 4 treats the hand-held medical instrument 21 as not being used according to the change of the identification state of the tag. (For example, the signal from the position and orientation measurement device 22 can be ignored).

(音波による手持ち医療器具の選択)
使用している手持ち医療器具21を、音波を用いて識別することもできる。図12に示すように、手持ち医療器具21である医療器具A〜Cが存在し、図12に示す例では、術者は医療器具Aを使用し、残りの医療器具は外套管23からある程度離れた場所(すなわち計測可能距離を超える場所)にある機械台に置かれている。
(Selection of hand-held medical device by sound wave)
The hand-held medical device 21 being used can also be identified using sound waves. As shown in FIG. 12, there are medical devices A to C which are hand-held medical devices 21, and in the example shown in FIG. 12, the operator uses the medical device A and the remaining medical devices are somewhat separated from the mantle tube 23. It is placed on the machine stand located in the area where the

ここで、それぞれの音波受信機202で計測される音波の振幅を計測する。通常、医療器具が機械台に置かれている場合、ほとんど音波が計測できない距離にあるために音波の振幅が所定の閾値より小さくなる。このため、例えば、制御部4は、計測された音波の振幅が所定の閾値以上である場合に、当該手持ち医療器具21が使用されていると判別することができる。   Here, the amplitudes of the sound waves measured by the respective sound wave receivers 202 are measured. Usually, when the medical instrument is placed on the machine base, the amplitude of the sound wave is smaller than a predetermined threshold because the sound wave can not be measured at a distance that can hardly be measured. Therefore, for example, when the amplitude of the measured sound wave is equal to or greater than a predetermined threshold value, the control unit 4 can determine that the handheld medical device 21 is used.

上記の例では、使用していない医療器具が音波を計測できない距離に置かれていることを想定しているが、音波を計測可能な位置に置かれてしまう可能性は否定できない。このため、本実施形態では、より精度良く手持ち医療器具を選択するため、上記の振幅に加えて、バースト波による絶対距離の計測を行う。一般に、腹腔鏡手術で使用される術具の長さはほぼ一定である。このため、万が一使用していない医療器具が音波を計測可能な位置に存在しても、制御部4は、音波送信機201からの距離が一般的な医療器具の長さ(すなわち予め定めた長さの閾値)以上であった場合には、その医療器具を使用していないものと判別する。   In the above example, it is assumed that the medical device not in use is placed at a distance where the sound wave can not be measured, but it can not be denied that the sound wave can be placed at a measurable position. For this reason, in this embodiment, in order to select a hand-held medical instrument with high accuracy, in addition to the above-mentioned amplitude, measurement of absolute distance by a burst wave is performed. Generally, the length of the surgical tool used in laparoscopic surgery is approximately constant. For this reason, even if a medical device which is not used is present at a position where the sound wave can be measured, the control unit 4 determines the length of the medical device whose distance from the sound wave transmitter 201 is general (ie, a predetermined length If the threshold value is not less than the threshold value), it is determined that the medical device is not in use.

さらに、使用していない医療器具が、音波送信機201から一般的な医療器具の長さより近い距離に置かれた場合を考慮して、慣性センサを更に用いた判別処理を行ってもよい。この実施形態では、図13に示すように、手持ち医療器具21に取り付けた慣性センサ203である慣性センサ1301、1302と、外套管23に取り付けた外套管側慣性センサ1303とを用いる。   Furthermore, in consideration of the case where a medical device not in use is placed at a distance closer to the length of the general medical device from the sound wave transmitter 201, a discrimination process using an inertial sensor may be further performed. In this embodiment, as shown in FIG. 13, inertia sensors 1301 and 1302 which are inertia sensors 203 attached to the hand-held medical instrument 21 and an outer tube side inertia sensor 1303 attached to the outer tube 23 are used.

使用している手持ち医療器具21である医療器具Aは、外套管23に挿入されているため、手持ち医療器具21と外套管23のそれぞれの慣性センサから得られる姿勢は一致するはずである。一方、外套管23の近くに置かれているが使用されていない医療器具Bは、その姿勢が外套管23の姿勢と平行になることはほぼ無い。すなわち、制御部4は、各手持ち医療器具の姿勢の角度差に基づいて、使用している医療器具を判別することができる。実際には外套管と医療器具のシャフトに隙間があるため完全に平行にはならず、また、重力軸回りの回転に関しては相対値しか計測できないため比較することができない。このため、制御部4は、例えば、外套管23の重力軸に対する傾きと手持ち医療器具21の重力軸に対する傾きが、ある程度一致した場合(すなわち所定の閾値より角度差が小さい場合)に挿入されている手持ち医療器具を判別することができる。   Since the medical instrument A, which is the hand-held medical instrument 21 used, is inserted into the mantle tube 23, the postures obtained from the respective inertial sensors of the handheld medical instrument 21 and the mantle tube 23 should match. On the other hand, the medical device B placed near the mantle tube 23 but not used is almost never parallel to the posture of the mantle tube 23. That is, the control unit 4 can determine which medical device is being used based on the difference in posture of the hand-held medical devices. In fact, because there is a gap between the outer tube and the shaft of the medical instrument, they are not completely parallel, and because rotations about the gravity axis can only be measured, they can not be compared. Therefore, the control unit 4 is inserted, for example, when the inclination of the outer tube 23 with respect to the gravity axis and the inclination of the hand-held medical instrument 21 with respect to the gravity axis coincide with each other to a certain extent (that is, when the angular difference is smaller than a predetermined threshold). You can determine which medical instruments are in hand.

(着脱式センサユニットの構成)
音波受信機202と慣性センサ203とは手持ち医療器具21に内蔵されていてもよいが、多様な医療器具に対応するためには着脱可能に取り付けられる方が都合のよいことが多い。図14には、音波受信機202と慣性センサ203とを含む本実施形態に係るセンサユニット1401の構成例を示している。このセンサユニット1401は、手持ち医療器具21に着脱可能な筐体として構成される。センサユニット1401は、固定具1402のねじ1403を締めこむことにより、手持ち医療器具21のシャフトに固定される。
(Configuration of detachable sensor unit)
The sound wave receiver 202 and the inertial sensor 203 may be built in the hand-held medical instrument 21 but in many cases it is convenient to be detachably attached to cope with various medical instruments. FIG. 14 shows a configuration example of a sensor unit 1401 according to the present embodiment including the sound wave receiver 202 and the inertia sensor 203. The sensor unit 1401 is configured as a housing that can be attached to and detached from the hand-held medical instrument 21. The sensor unit 1401 is fixed to the shaft of the hand-held medical instrument 21 by tightening the screw 1403 of the fixture 1402.

手持ち医療器具21の形状によってはシャフトではなく、手持ち医療器具21の持ち手部分に直接取り付けるようにしてもよい。また、図14に示すように、音波受信機202及び慣性センサ203に加えて、スイッチ操作を行うためのレバー1404を備えるようにしてもよい。この場合、術者は、手持ち医療器具21を保持しながらスイッチ操作を行うことができる。図14に示す例ではレバー1404は左右に存在するが、その配置は問わない。   Depending on the shape of the hand-held medical instrument 21, the hand-held medical instrument 21 may be attached directly to the handle portion of the hand-held medical instrument 21 instead of the shaft. Further, as shown in FIG. 14, in addition to the sound wave receiver 202 and the inertia sensor 203, a lever 1404 for performing a switch operation may be provided. In this case, the operator can perform the switch operation while holding the hand-held medical instrument 21. In the example shown in FIG. 14, the levers 1404 exist on the left and right, but the arrangement is not limited.

また、音波送信機201を含むセンサユニット1501についても同様に、外套管23に着脱可能に取り付けられる方が都合がよい。図15には、音波送信機201を含むセンサユニット1501を外套管23に取り付けた場合の構成例を示している。この例では、センサユニット1501は外套管23に着脱可能な筐体を構成し、3つの音波送信機201を含んでいる。また、センサユニット1501は固定具1502によって外套管23に固定されている。センサユニット1501の中心には、手持ち医療器具21のシャフトを通すための穴が設けられている。   Similarly, the sensor unit 1501 including the sound wave transmitter 201 may be conveniently attached to the sheath tube 23 in a removable manner. FIG. 15 shows a configuration example in the case where the sensor unit 1501 including the sound wave transmitter 201 is attached to the sheath tube 23. In this example, the sensor unit 1501 constitutes a casing that is attachable to and detachable from the sheath tube 23, and includes three sound wave transmitters 201. Further, the sensor unit 1501 is fixed to the outer tube 23 by a fixing tool 1502. In the center of the sensor unit 1501, a hole for passing the shaft of the hand-held medical instrument 21 is provided.

なお、上述の説明では、位置姿勢計測装置22を、手持ち医療器具21と外套管23に設けて、手持ち医療器具21の位置姿勢を計測する場合を例に説明した。しかし、本実施形態の位置姿勢計測装置22は、ロボット医療器具12と外套管14とに取り付けて、ロボット医療器具12の位置姿勢を計測するようにしてもよい。すなわち、位置姿勢計測装置22は、ロボット医療器具12の運動を制御するためのセンサとして用いることも可能であり、医療器具駆動部11の関節部のエンコーダの代わりとして使用することができる。   In the above description, the position and orientation measurement device 22 is provided for the hand-held medical instrument 21 and the outer tube 23 to measure the position and orientation of the hand-held medical instrument 21 as an example. However, the position and orientation measurement apparatus 22 of the present embodiment may be attached to the robot medical instrument 12 and the outer tube 14 to measure the position and orientation of the robot medical instrument 12. That is, the position and orientation measurement device 22 can also be used as a sensor for controlling the motion of the robot medical instrument 12, and can be used as a substitute for the encoder of the joint of the medical instrument drive unit 11.

(他の実施形態)
さらに、上述した手術支援システムの構成のそれぞれが分離され又は統合された構成として実現されてもよい。また、本発明は、上述した処理を実行するコンピュータのプログラムを、制御部が記録媒体から読み出して実行する場合のほか、当該プログラムを有線通信又は無線通信を介して取得して実行する場合を含み得る。
(Other embodiments)
Furthermore, each of the configurations of the surgical support system described above may be realized as separate or integrated configurations. Furthermore, the present invention includes the case where the control unit reads out and executes the program of the computer that executes the above-described processing from the recording medium and also acquires and executes the program via wired communication or wireless communication. obtain.

4…制御部、21…手持ち医療器具、22…位置姿勢計測装置、23…外套管、201…音波送信機、202…音波受信機、   DESCRIPTION OF SYMBOLS 4 ... Control part, 21 ... Hand-held medical instrument, 22 ... Position and orientation measuring device, 23 ... Outer tube, 201 ... Sound wave transmitter, 202 ... Sound wave receiver,

Claims (14)

体腔に挿入される術具を用いた操作の可能な手術支援装置であって、
前記操作の入力として、前記体腔に挿入される前記術具のシャフトの前記体腔への挿入深度と挿入角度とを計測する計測手段を有し、
前記計測手段は、前記体腔への挿入位置から所定範囲の位置と前記術具とのいずれか一方に取り付けられた送信機と、他方に取り付けられた受信機との間の空間を伝わる音波を計測することにより、前記挿入深度を計測する、ことを特徴とする手術支援装置。
A surgical support device capable of operation using a surgical instrument inserted into a body cavity, comprising:
It has measuring means for measuring the insertion depth and insertion angle of the shaft of the surgical instrument inserted into the body cavity into the body cavity as the input of the operation,
The measuring means measures a sound wave transmitted through a space between a transmitter attached to one of the position from the insertion position into the body cavity and the surgical instrument and the other attached to the other. By measuring the insertion depth.
前記計測手段は、前記送信機から送信された音波信号と前記受信機で受信された音波信号の位相差に基づいて、前記挿入深度を計測する、ことを特徴とする請求項1に記載の手術支援装置。   The operation according to claim 1, wherein the measurement means measures the insertion depth based on a phase difference between the sound wave signal transmitted from the transmitter and the sound wave signal received by the receiver. Support device. 前記計測手段は、前記挿入深度を計測するために、前記送信機から送信された音波信号と前記受信機で受信された音波信号の位相差に基づいて、前記送信機と前記受信機との間の距離の変化量を計測する、ことを特徴とする請求項1に記載の手術支援装置。   The measuring unit measures the depth of insertion between the transmitter and the receiver based on a phase difference between the sound signal transmitted from the transmitter and the sound signal received by the receiver. The surgery support device according to claim 1, wherein the change amount of the distance is measured. 前記計測手段は、前記位相差に基づく計測において、前記術具の所定の閾値を超える速度での移動を除くことにより、前記送信機と前記受信機との間の距離の変化量を計測する、ことを特徴とする請求項3に記載の手術支援装置。   The measurement means measures the amount of change in the distance between the transmitter and the receiver by excluding the movement of the surgical instrument at a speed exceeding a predetermined threshold in the measurement based on the phase difference. The surgery support device according to claim 3, characterized in that: 前記受信機は、前記術具のシャフト周りに、所定の角度ごとに配置される複数の受信機から構成され、
前記計測手段は、1つの送信機から送信された音波を前記複数の受信機で受信し、前記複数の受信機で受信した音波信号に基づく計測値の平準化を行うことにより、前記挿入深度を計測する、ことを特徴とする請求項1から4のいずれか1項に記載の手術支援装置。
The receiver comprises a plurality of receivers disposed at predetermined angles around the shaft of the surgical instrument,
The measurement means receives the sound waves transmitted from one transmitter by the plurality of receivers, and performs leveling of the measurement value based on the sound wave signals received by the plurality of receivers to obtain the insertion depth. The operation support apparatus according to any one of claims 1 to 4, wherein measurement is performed.
前記計測手段は、前記術具のシャフトの先端が前記体腔に挿入された外套管を通過したことを検知する挿入検知手段を更に有する、ことを特徴とする請求項1から5のいずれか1項に記載の手術支援装置。   The said measurement means further has an insertion detection means which detects that the front-end | tip of the shaft of the said surgical instrument passed through the outer tube inserted in the said body cavity, It is characterized by the above-mentioned. The surgery support device described in. 前記計測手段は、前記受信機からの音波信号の振幅が所定の閾値以上である場合に、前記術具が使用されていると判別する、ことを特徴とする請求項1から6のいずれか1項に記載の手術支援装置。   7. The apparatus according to any one of claims 1 to 6, wherein the measuring unit determines that the surgical tool is used when the amplitude of the sound wave signal from the receiver is equal to or greater than a predetermined threshold. The surgery support device described in the section. 前記計測手段は、前記術具に取り付けられるタグ検出手段であって、術者に取り付けされたタグが近接又は接触したことを検出するタグ検出手段を更に有し、
複数の前記術具が存在する場合、前記タグ検出手段が前記タグを検出したことに応じて、前記タグを検出した前記タグ検出手段に対応する前記術具を、使用している前記術具として判別する、ことを特徴とする請求項1から6のいずれか1項に記載の手術支援装置。
The measurement means further includes tag detection means attached to the surgical instrument, the tag detection means detecting that the tag attached to the operator has approached or touched.
When a plurality of surgical tools are present, the surgical tool using the surgical tool corresponding to the tag detection means that has detected the tag in response to the tag detection means detecting the tag The operation support apparatus according to any one of claims 1 to 6, wherein the determination is made.
前記計測手段は、前記術具に取り付けた慣性センサを用いて、前記挿入角度を計測する、ことを特徴とする請求項1から8のいずれか1項に記載の手術支援装置。   The surgery support device according to any one of claims 1 to 8, wherein the measurement unit measures the insertion angle using an inertial sensor attached to the surgical instrument. 前記計測手段は、前記体腔への挿入位置から前記所定範囲の位置と前記術具とのいずれか一方に取り付けられた送信機と、他方に取り付けられた受信機との間の空間を伝わる超音波を計測する、ことを特徴とする請求項1から9のいずれか1項に記載の手術支援装置。   The measuring means is an ultrasonic wave propagating in a space between a transmitter attached to one of the position within the predetermined range from the position of insertion into the body cavity and the surgical instrument and a receiver attached to the other. The surgery support device according to any one of claims 1 to 9, wherein: 前記受信機は、前記術具から着脱可能な筐体に配置される、ことを特徴とする請求項1から10のいずれか1項に記載の手術支援装置。   The surgery support device according to any one of claims 1 to 10, wherein the receiver is disposed in a housing that is detachable from the surgical instrument. 前記計測手段によって計測された前記挿入深度と前記挿入角度とに基づいて、前記体腔に挿入され且つ機械的に駆動される術具の姿勢を制御するための制御情報を出力する制御手段を更に有する、ことを特徴とする請求項1から11のいずれか1項に記載の手術支援装置。   It further has control means for outputting control information for controlling the posture of the surgical instrument inserted in the body cavity and mechanically driven based on the insertion depth measured by the measurement means and the insertion angle. The surgery support device according to any one of claims 1 to 11, characterized in that. 体腔に挿入される術具を用いた操作の可能な手術支援装置の制御方法であって、前記手術支援装置は計測手段を含み、前記制御方法は、
前記計測手段が、前記操作の入力として、前記体腔に挿入される前記術具のシャフトの前記体腔への挿入深度と挿入角度とを計測する計測工程を有し、
前記計測工程では、前記体腔への挿入位置から所定範囲の位置と前記術具とのいずれか一方に取り付けられた送信機と、他方に取り付けられた受信機との間の空間を伝わる音波を計測することにより、前記挿入深度を計測する、ことを特徴とする手術支援装置の制御方法。
A control method of a surgery support apparatus capable of operation using a surgical instrument inserted into a body cavity, the surgery support apparatus including a measuring means, the control method comprising
The measurement unit has a measurement step of measuring an insertion depth and an insertion angle of the shaft of the surgical instrument to be inserted into the body cavity into the body cavity as an input of the operation.
In the measurement step, the sound wave transmitted between the transmitter attached to one of the position of the predetermined range from the insertion position to the body cavity and the surgical instrument and the receiver attached to the other is measured The control method of the surgery support device, wherein the insertion depth is measured by performing.
手術支援装置と医療器具駆動装置とを含む手術支援システムであって、
前記手術支援装置は、体腔に挿入される第1の術具を用いた操作の可能な前記手術支援装置であって、
前記操作の入力として、前記体腔に挿入される前記第1の術具のシャフトの前記体腔への挿入深度と挿入角度とを計測する計測手段を有し、
前記計測手段は、前記体腔への挿入位置から所定範囲の位置と前記第1の術具とのいずれか一方に取り付けられた送信機と、他方に取り付けられた受信機との間の空間を伝わる音波を計測することにより、前記挿入深度を計測し、
前記医療器具駆動装置は、
前記手術支援装置の前記計測手段によって計測された前記挿入深度と前記挿入角度とに基づく制御情報に応じて、前記体腔に挿入され且つ機械的に駆動される第2の術具の姿勢を制御する駆動手段を有する、ことを特徴とする手術支援システム。
A surgery support system comprising a surgery support device and a medical instrument drive device, comprising:
The surgery support device is the surgery support device capable of operation using a first surgical instrument inserted into a body cavity,
It has measurement means for measuring an insertion depth and an insertion angle of the shaft of the first surgical instrument to be inserted into the body cavity into the body cavity as an input of the operation,
The measuring means transmits a space between a transmitter attached to one of the first surgical tool and a position within a predetermined range from the insertion position into the body cavity and a receiver attached to the other. Measuring the insertion depth by measuring a sound wave;
The medical instrument drive device is
According to control information based on the insertion depth and the insertion angle measured by the measurement unit of the surgery support apparatus, controlling a posture of a second surgical instrument inserted into the body cavity and mechanically driven A surgery support system comprising drive means.
JP2019004430A 2019-01-15 2019-01-15 Surgical support device, control method thereof, and surgical support system Active JP6506490B1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2019004430A JP6506490B1 (en) 2019-01-15 2019-01-15 Surgical support device, control method thereof, and surgical support system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019004430A JP6506490B1 (en) 2019-01-15 2019-01-15 Surgical support device, control method thereof, and surgical support system

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2018178054A Division JP6469295B1 (en) 2018-09-21 2018-09-21 Surgery support apparatus, control method therefor, and surgery support system

Publications (2)

Publication Number Publication Date
JP6506490B1 true JP6506490B1 (en) 2019-04-24
JP2020049198A JP2020049198A (en) 2020-04-02

Family

ID=66324238

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019004430A Active JP6506490B1 (en) 2019-01-15 2019-01-15 Surgical support device, control method thereof, and surgical support system

Country Status (1)

Country Link
JP (1) JP6506490B1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021153771A (en) * 2020-03-26 2021-10-07 株式会社メディカロイド Robot surgery support device, robot surgery support method, and program

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7198724B2 (en) * 2019-05-24 2023-01-04 大和 川▲崎▼ game controller

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001275931A (en) * 2000-04-03 2001-10-09 Olympus Optical Co Ltd Medical treatment system
US20130172907A1 (en) * 2012-01-02 2013-07-04 Bernard Michael HARRIS System and method for spatial location and tracking
US9192439B2 (en) * 2012-06-29 2015-11-24 Covidien Lp Method of manufacturing a surgical instrument
JP6474034B2 (en) * 2015-01-18 2019-02-27 鈴木 秀幸 Ultrasound distance measuring device for endoscopic surgery
JP6149175B1 (en) * 2017-01-12 2017-06-14 株式会社A−Traction Surgery support apparatus, control method thereof, program, and surgery support system

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021153771A (en) * 2020-03-26 2021-10-07 株式会社メディカロイド Robot surgery support device, robot surgery support method, and program
JP7414611B2 (en) 2020-03-26 2024-01-16 株式会社メディカロイド Robotic surgery support device, processing method, and program

Also Published As

Publication number Publication date
JP2020049198A (en) 2020-04-02

Similar Documents

Publication Publication Date Title
KR102291452B1 (en) Surgical assistance device, control method therefor, and surgical assistance system
US20230093745A1 (en) Scanner independent tracking of interventional instruments
KR101785751B1 (en) Systems and methods for providing vibration feedback in robotic systems
JP7271551B2 (en) Apparatus and method for registering facial landmarks for surgical navigation systems
KR20170093200A (en) System for robot-assisted medical treatment
CN109589091B (en) Interactive display for selected ECG channels
JP2006081900A (en) Radio determination for direction of endoscope
JP6506490B1 (en) Surgical support device, control method thereof, and surgical support system
KR101954402B1 (en) Device for detecting lesion location by hall effect sensor, and gyro sensor
JP6149175B1 (en) Surgery support apparatus, control method thereof, program, and surgery support system
JP6388686B2 (en) Surgery support apparatus, control method thereof, program, and surgery support system
JPWO2018003140A1 (en) Surgical support device, control method and program thereof, and surgical support system
CN113015489B (en) System and method for estimating a position of a tip of an interventional device in acoustic imaging
CN108185973A (en) A kind of ultrasonic wave coordinate detection image processing system
CN110996778B (en) Catheter probe navigation method and apparatus employing opposing transducers
CN116113380A (en) Triangulation of items within a patient
JP2015211771A (en) Vertical puncture support system
JP6108509B1 (en) Surgery support device, control method and program thereof, and surgery support system
US20170209223A1 (en) Instrument Annular Location Sensor
JP2015159849A (en) Ultrasonic measurement device and control method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190115

A871 Explanation of circumstances concerning accelerated examination

Free format text: JAPANESE INTERMEDIATE CODE: A871

Effective date: 20190115

A975 Report on accelerated examination

Free format text: JAPANESE INTERMEDIATE CODE: A971005

Effective date: 20190129

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20190328

R150 Certificate of patent or registration of utility model

Ref document number: 6506490

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

S533 Written request for registration of change of name

Free format text: JAPANESE INTERMEDIATE CODE: R313533

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250