JPH10296671A - Manipulator system for surgical operation - Google Patents

Manipulator system for surgical operation

Info

Publication number
JPH10296671A
JPH10296671A JP9112589A JP11258997A JPH10296671A JP H10296671 A JPH10296671 A JP H10296671A JP 9112589 A JP9112589 A JP 9112589A JP 11258997 A JP11258997 A JP 11258997A JP H10296671 A JPH10296671 A JP H10296671A
Authority
JP
Japan
Prior art keywords
signal
manipulator
output
line
circuit
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.)
Withdrawn
Application number
JP9112589A
Other languages
Japanese (ja)
Inventor
Toshimasa Kawai
利昌 河合
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 Optical Co Ltd
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 Optical Co Ltd filed Critical Olympus Optical Co Ltd
Priority to JP9112589A priority Critical patent/JPH10296671A/en
Publication of JPH10296671A publication Critical patent/JPH10296671A/en
Withdrawn legal-status Critical Current

Links

Landscapes

  • Manipulator (AREA)
  • Surgical Instruments (AREA)

Abstract

PROBLEM TO BE SOLVED: To attain wire saving and miniaturization of a manipulator by detecting a part of the position and/or attitude decided by operating an operation means as binarization information, converting it to information consisting of three values, and deciding the position and/or attitude of a part of a plurality of shafts by a control means based on it. SOLUTION: Pulse-like signals detected with photointerrupters 22a, 22b of encoders 100, 200 and output to lines A1, B1 are input to a transmitting circuit 25, and a signal showing the output direction and the number of count indicating movement of a master arm is output to a line driver so as to output a signal consisting of three values. The signal is input to a receiving circuit 27, the signal level is converted to a TTL logic signal (binary) of fixed voltage and output to a line A3, the direction signal from a comparator is output to a line B3, they are received with an up/down counter 28, and the moved direction and the moved quantity of the master arm are detected. Hereby, the signal wires can be saved into two wires as a half of customary ones.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は、手術用マニピュレ
ータシステムに関するものであり、従来の多自由度の手
術用マニピュレータを細径化かつ小型化した手術用マニ
ピュレータシステムに関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a surgical manipulator system, and more particularly, to a surgical manipulator system in which a conventional multi-degree-of-freedom surgical manipulator is reduced in diameter and size.

【0002】[0002]

【従来の技術】手術用マニピュレータをモータで駆動す
る場合に、マニピュレータの位置検出手段として光学式
エンコーダが従来より用いられている。この光学式エン
コーダは位置検出精度が優れている反面、A、B、Z相
の3本の信号線が必要である。特に、このような光学式
エンコーダを病院等の施設で使用する場合には、ノイズ
の影響を除去するためにラインドライバ方式が採用され
ている。この場合は少なくとも6本の信号ラインを必要
とする。
2. Description of the Related Art When a surgical manipulator is driven by a motor, an optical encoder is conventionally used as a position detecting means of the manipulator. Although this optical encoder has excellent position detection accuracy, it needs three signal lines of A, B, and Z phases. In particular, when such an optical encoder is used in a facility such as a hospital, a line driver system is employed to remove the influence of noise. In this case, at least six signal lines are required.

【0003】[0003]

【発明が解決しようとする課題】上記したように、ライ
ンドライバ方式の手術用マニピュレータシステムは少な
くとも6本の信号ラインが必要になるので手術用マニピ
ュレータシステムの細径化の実現が難しいという問題点
があった。
As described above, the surgical manipulator system of the line driver system requires at least six signal lines, so that it is difficult to reduce the diameter of the surgical manipulator system. there were.

【0004】本発明の手術用マニピュレータシステムは
このような課題に着目してなされたものであり、その目
的とするところは、従来技術の欠点を克服して手術用マ
ニピュレータの小型化、省線化を実現できる手術用マニ
ピュレータシステムを提供することにある。
[0004] The surgical manipulator system of the present invention has been made in view of such a problem, and an object thereof is to overcome the drawbacks of the prior art and reduce the size and line-saving of the surgical manipulator. It is an object of the present invention to provide a surgical manipulator system capable of realizing the above.

【0005】[0005]

【課題を解決するための手段】上記の目的を達成するた
めに、本発明の手術用マニピュレータは、複数の軸を有
する多関節構造の手術用マニピュレータと、この手術用
マニピュレータに設けられ、体腔内に挿入可能な手術機
械と、前記手術用マニピュレータの位置及び/または姿
勢を決定するための操作手段と、この操作手段の操作に
より決定された位置及び/または姿勢の一部を2値化情
報として検出する検出手段と、この検出手段によって検
出された2値化情報を少なくとも3値からなる情報に変
換して送信する送信手段と、この送信手段からの少なく
とも3値からなる情報に基づいて、前記手術用マニピュ
レータの複数の軸の一部の位置及び/または姿勢を決定
する制御手段とを具備する。
In order to achieve the above-mentioned object, a surgical manipulator of the present invention is provided with a multi-joint structure surgical manipulator having a plurality of axes, and provided on the surgical manipulator, and provided in a body cavity. Operating device for determining the position and / or orientation of the surgical manipulator, and a part of the position and / or orientation determined by operating the operating device as binarized information. Detecting means for detecting, transmitting means for converting the binarized information detected by the detecting means into information comprising at least three values and transmitting the information, and based on the information comprising at least three values from the transmitting means, Control means for determining the position and / or posture of a part of the plurality of axes of the surgical manipulator.

【0006】すなわち、本発明の手術用マニピュレータ
は、複数の軸を有する多関節構造の手術用マニピュレー
タの位置及び/または姿勢を操作手段の操作により決定
し、決定された位置及び/または姿勢の一部を2値化情
報として検出する。そして、この2値化情報を3値から
なる情報に変換して送信する。制御部はこの送信された
少なくとも3値からなる情報に基づいて、前記手術用マ
ニピュレータの複数の軸の一部の位置及び/または姿勢
を決定する。
That is, in the surgical manipulator of the present invention, the position and / or posture of the multi-joint structure surgical manipulator having a plurality of axes is determined by operating the operating means, and one of the determined position and / or posture is determined. Is detected as binary information. The binarized information is converted into ternary information and transmitted. The control unit determines positions and / or postures of a part of a plurality of axes of the surgical manipulator based on the transmitted information including at least three values.

【0007】[0007]

【発明の実施の形態】以下、図面を参照して本発明の実
施形態を詳細に説明する。図1は本発明の第1実施形態
に係る手術用マニピュレータシステムの構成を示す図で
ある。図1において1は観察処置を行うための手術台で
あり、2は患者である。手術台1の両側にはベッドサイ
ドレール3が設けられている。このベッドサイドレール
3には患者の体腔内で処置を行うための処置具4を位置
決めするための処置用アーム5と、観察用の内視鏡6を
位置決めするための観察用アーム7が着脱自在に取り付
けられている。尚、処置具4及び内視鏡6は患者の体壁
に空けられた挿入口2aから体腔内に挿入される。
Embodiments of the present invention will be described below in detail with reference to the drawings. FIG. 1 is a diagram showing a configuration of a surgical manipulator system according to a first embodiment of the present invention. In FIG. 1, reference numeral 1 denotes an operating table for performing an observation procedure, and 2 denotes a patient. Bedside rails 3 are provided on both sides of the operating table 1. A treatment arm 5 for positioning a treatment tool 4 for performing a treatment in a patient's body cavity and an observation arm 7 for positioning an observation endoscope 6 are detachably attached to the bedside rail 3. Attached to. Note that the treatment tool 4 and the endoscope 6 are inserted into the body cavity from the insertion port 2a opened in the body wall of the patient.

【0008】処置用アーム5と処置具4との接続及び観
察用アーム7と内視鏡6との接続は複数の自由度を有す
る関節部である関節機構19により行われている。これ
は患者が例えば術中に動いて挿入口2aの位置がずれる
ようなことがあっても、挿入口2aに無理な力が加わら
ないようにするためである。
The connection between the treatment arm 5 and the treatment tool 4 and the connection between the observation arm 7 and the endoscope 6 are performed by a joint mechanism 19 which is a joint having a plurality of degrees of freedom. This is to prevent an excessive force from being applied to the insertion port 2a even if the position of the insertion port 2a is shifted during the operation, for example.

【0009】また制御装置11は後述するマニピュレー
タの動作を制御する機能を実現するためにその内部にマ
イクロコントローラ(図示しない)を内蔵している。処
置用アーム5及び観察用アーム7は機構的に、上下動作
(図1中に示すa方向)、旋回動作(図1中に示すb方
向)、伸縮動作(図1中に示すc方向)を行うことが可
能なように構成されている。このような動きを実現する
ためにアーム内にはアクチュエータ(図示しない)が配
置されている。なおこのアクチュエータとしてはロボッ
トの位置決めに多く利用されているサーボモータを使用
している。
The control device 11 has a built-in microcontroller (not shown) for realizing a function of controlling the operation of the manipulator described later. The treatment arm 5 and the observation arm 7 mechanically perform an up / down operation (a direction shown in FIG. 1), a turning operation (b direction shown in FIG. 1), and a telescopic operation (c direction shown in FIG. 1). It is configured to be able to do so. An actuator (not shown) is arranged in the arm to realize such a movement. As the actuator, a servomotor often used for positioning a robot is used.

【0010】また図2に示すように、処置用アーム5の
先端に取り付けられている処置具4の挿入部4a(図2
(a))と、観察用アーム7の先端に取り付けられてい
る内視鏡6の挿入部6a(図2(a))は、それぞれそ
の先端部がa方向及びb方向に湾曲駆動できるようにな
っている。
As shown in FIG. 2, an insertion portion 4a (FIG. 2) of the treatment instrument 4 attached to the distal end of the treatment arm 5 is provided.
(A)) and the insertion portion 6a (FIG. 2A) of the endoscope 6 attached to the distal end of the observation arm 7 so that the distal end can be driven to bend in the a direction and the b direction, respectively. Has become.

【0011】このような湾曲駆動は処置具4のサーボモ
ータ収納部4b及び内視鏡6のサーボモータ収納部6b
内にそれぞれ設けられたサーボモータ(図示しない)を
駆動させて挿入部4a内に挿通配置されたワイヤ(図示
しない)を牽引することによって行われる。処置具4と
内視鏡6は図2中に示すc方向に回転駆動できるように
なっている。このような回転駆動はフリー関節アーム上
に4c、6c内に設けられたサーボモータ4d、6dを
駆動させて図示しない回転機構を作動させることにより
行われる。
The bending drive is performed by the servo motor housing 4b of the treatment instrument 4 and the servo motor housing 6b of the endoscope 6.
This is performed by driving a servo motor (not shown) provided in each of the inside and pulling a wire (not shown) inserted through the insertion portion 4a. The treatment tool 4 and the endoscope 6 can be driven to rotate in the direction c shown in FIG. Such rotational driving is performed by driving servo motors 4d and 6d provided in the free joint arms 4c and 6c to operate a rotating mechanism (not shown).

【0012】特に処置具4の先端鉗子部4eにはこの鉗
子部4eを開閉させる開閉機構が設けられており、この
開閉機構はサーボモータ収納部4b内に設けられたサー
ボモータ(図示しない)を駆動させて挿入部4a内に挿
通配置されたロッドもしくはワイヤ部材を押し引き操作
することにより作動される。
In particular, an opening / closing mechanism for opening and closing the forceps section 4e is provided at the tip forceps section 4e of the treatment instrument 4, and the opening / closing mechanism is provided with a servomotor (not shown) provided in the servomotor housing 4b. It is operated by being driven to push and pull a rod or a wire member inserted and arranged in the insertion portion 4a.

【0013】ここで上記した処置具4を処置用アーム5
とを組み合わせたものを処置用スレーブマニピュレータ
と称し、内視鏡6と観察用アーム7とを組み合わせたも
のを観察用スレーブマニピュレータと称することにす
る。この処置用スレーブマニピュレータに対する入力手
段であるマスターアーム8と観察用スレーブマニピュレ
ータに対する入力手段であるヘッドマウンテッドディス
プレイ(以下HMDとする)9とが図1に示されてい
る。
Here, the above-described treatment tool 4 is connected to a treatment arm 5.
The combination of the above is referred to as a treatment slave manipulator, and the combination of the endoscope 6 and the observation arm 7 is referred to as an observation slave manipulator. FIG. 1 shows a master arm 8 as input means for the treatment slave manipulator and a head-mounted display (hereinafter referred to as HMD) 9 as input means for the observation slave manipulator.

【0014】本実施形態では入力手段であるマスターア
ーム8の動きが処置用スレーブマニピュレータへ伝達さ
れ得るモード、すなわち処置用スレーブマニピュレータ
がマスターアーム8の動きに追従するマスタースレーブ
モードで患者に対する処置が行われる。マスターアーム
8は複数のリンク機構で構成されている。このリンク機
構を構成する各リンクには後述する位置検知用のエンコ
ーダが設けられている。このエンコーダによって各リン
クの動作を検知することでマスターアーム8の移動量を
検知できる。
In the present embodiment, the treatment for the patient is performed in a mode in which the movement of the master arm 8 as the input means can be transmitted to the treatment slave manipulator, that is, in a master-slave mode in which the treatment slave manipulator follows the movement of the master arm 8. Will be The master arm 8 includes a plurality of link mechanisms. Each link constituting the link mechanism is provided with an encoder for position detection described later. The movement amount of the master arm 8 can be detected by detecting the operation of each link by this encoder.

【0015】また操作者がマスターアーム8から手を離
した場合にマスターアーム8がその自重によって勝手に
動作しないようにマスターアーム8の各アームリンクに
は電磁クラッチ(図示しない)が取り付けられている。
つまりマスターアーム8はこの電磁クラッチにより必要
以外の時には動かないようにその動作が制限される。
An electromagnetic clutch (not shown) is attached to each arm link of the master arm 8 so that the master arm 8 does not operate by its own weight when the operator releases his / her hand from the master arm 8. .
That is, the operation of the master arm 8 is restricted by the electromagnetic clutch so that it does not move when it is not necessary.

【0016】またマスタースレーブモードで実際に処置
用スレーブマニピュレータを動かす際、電磁クラッチは
図示せぬフットスイッチを踏む動作によってその作動が
制御される。つまりマスターアーム8の動作のロックと
いうこのロック動作をフットスイッチにより行えるよう
になっている。
When the treatment slave manipulator is actually moved in the master-slave mode, the operation of the electromagnetic clutch is controlled by an operation of depressing a foot switch (not shown). In other words, this locking operation of locking the operation of the master arm 8 can be performed by the foot switch.

【0017】一方、他の入力手段であるHMD9は内視
鏡6によって観察された映像を表示するディスプレイ
(図示しない)を備えている。このディスプレイはHM
D9を術者の頭部に装着した際に術者の目の位置にセッ
トされるように設けられている。またHMD9は術者の
頭がどのように動いても内視鏡6の先端で捉えた映像を
前記ディスプレイによって常時観察できるような構成に
なっている。
On the other hand, the HMD 9 as another input means has a display (not shown) for displaying an image observed by the endoscope 6. This display is HM
It is provided to be set at the position of the operator's eyes when D9 is mounted on the operator's head. Further, the HMD 9 is configured so that an image captured by the distal end of the endoscope 6 can always be observed on the display regardless of how the operator's head moves.

【0018】このような構成のHMD9によれば従来の
ように処置中に術者が手術室に設置されたTVモニター
の方に視線を移すと言った煩わしい動作を行わなくて済
むため操作性は向上する。また患部から視線を外すこと
なく常に患者の映像を明確に観察できるため安全な手術
を行うことができる。
According to the HMD 9 having such a configuration, the operability is reduced since the operator does not need to perform the troublesome operation of moving his / her gaze toward the TV monitor installed in the operating room during the procedure as in the prior art. improves. In addition, since the patient's image can always be clearly observed without removing the line of sight from the affected part, a safe operation can be performed.

【0019】術者の頭部の空間的な移動量は磁気センサ
10によって検知される。磁気センサ10は一様な磁場
を発生する磁気センサソース部10bと磁気センサセン
ス部10aとから成る。このうち磁気センサセンス部1
0aはHMD9のほぼ中央に取り付けられている。術者
の頭の動きは上記した磁気センサ10によって検知され
るがその検知方法を簡単に説明すると、HMD9以外の
所定の場所にセットされた磁気センサソース部10bか
ら発生する一様な磁場を磁気センサセンス部10aで検
知し、頭の動きに伴う磁場の変化分の情報を処理するこ
とにより磁気センサソース部10bと磁気センサセンス
部10aとの空間的絶対移動量及び磁気センサセンス部
10aの傾斜であるオイラー角(ロールピッチ)を求め
て術者の頭の移動量及び傾きを検知するというものであ
る。
The spatial movement of the surgeon's head is detected by a magnetic sensor 10. The magnetic sensor 10 includes a magnetic sensor source 10b for generating a uniform magnetic field and a magnetic sensor sense 10a. Of these, the magnetic sensor sense unit 1
Reference numeral 0a is attached substantially at the center of the HMD 9. The movement of the surgeon's head is detected by the magnetic sensor 10 described above. The detection method will be described briefly. The uniform magnetic field generated from the magnetic sensor source unit 10b set at a predetermined location other than the HMD 9 is generated by a magnetic field. The sensor sense unit 10a detects and processes information on the change in the magnetic field accompanying the movement of the head to process the absolute spatial movement amount of the magnetic sensor source unit 10b and the magnetic sensor sense unit 10a and the inclination of the magnetic sensor sense unit 10a. Then, the Euler angle (roll pitch) is obtained to detect the moving amount and inclination of the operator's head.

【0020】前記構成によって術者の頭の動きによって
観察用スレーブマニピュレータのマスタースレーブ動作
を行うと共にマスターアーム8の操作によって処置用ス
レーブマニピュレータのマスタースレーブ動作を行わせ
ることが可能となる。
With the above configuration, it is possible to perform the master-slave operation of the observation slave manipulator by the movement of the operator's head and to perform the master-slave operation of the treatment slave manipulator by operating the master arm 8.

【0021】図3(a)は従来のエンコーダの結線図で
ある。ここでは、簡単のために3軸分しか示していない
が、図に示すように各エンコーダ分の信号ケーブルを使
用している。本実施形態では図3(b)に示すように、
信号ケーブルを1本にすることによって小型化を可能に
している。
FIG. 3A is a connection diagram of a conventional encoder. Although only three axes are shown here for simplicity, signal cables for each encoder are used as shown in the figure. In the present embodiment, as shown in FIG.
By using only one signal cable, miniaturization is enabled.

【0022】図4は、本発明の第1実施形態において、
手術用マニピュレータのマスターアーム8に内蔵された
位置検知回路21の詳細な構成と、この位置検知回路2
1にケーブルライン26を介して接続された制御装置1
1側の構成を示すブロック図である。位置検知回路21
はエンコーダ100、200と、送信回路25とから構
成されている。エンコーダ100、200は、フォトイ
ンタラプター22a、22bと、このフォトインタラプ
ター22a、22bに電流を流すための抵抗23a、2
3bと、フォトインタラプター22a、22bの発光部
に定電流を流すための定電流回路を実現させているFE
T24a、24bからなる。送信回路25はエンコーダ
100、200の位置情報を制御装置11側に送信する
為の送信回路である。
FIG. 4 shows a first embodiment of the present invention.
The detailed configuration of the position detection circuit 21 built in the master arm 8 of the surgical manipulator and the position detection circuit 2
1 connected to the control device 1 via a cable line 26
FIG. 3 is a block diagram showing a configuration on one side. Position detection circuit 21
Is composed of encoders 100 and 200 and a transmission circuit 25. The encoders 100 and 200 include photointerrupters 22a and 22b, and resistors 23a and 2b for supplying current to the photointerrupters 22a and 22b.
3b and a FE realizing a constant current circuit for supplying a constant current to the light emitting portions of the photo interrupters 22a and 22b.
T24a and 24b. The transmission circuit 25 is a transmission circuit for transmitting the position information of the encoders 100 and 200 to the control device 11 side.

【0023】送信回路25はケーブライン26を介して
制御装置11側に設置された受信回路27に接続されて
いる。この受信回路27はエンコーダ100、200が
どれだけカウントしたかを検知するためのアップダウン
カウンタ28に接続されている。
The transmission circuit 25 is connected via a cable line 26 to a reception circuit 27 provided on the control device 11 side. The receiving circuit 27 is connected to an up / down counter 28 for detecting how much the encoders 100 and 200 have counted.

【0024】図5はA、B相の送信回路25の具体的な
内部構成を示す図である。この構成において、図4のエ
ンコーダ100、200のフォトインタラプター22
a、22bで検出されてラインA1及びB1上に出力さ
れたパルス状の信号は送信回路25に入力される。この
とき、エンコーダの回転方向にもよるが、例えばライン
A1から位相が90度ずれた信号がラインB1に出力さ
れる様、あるいはラインB1に出力されるパルスに対し
て90度位相が遅れたパルスがラインA1に出力される
様にパルス上の波形が送信回路25に入力される。
FIG. 5 is a diagram showing a specific internal configuration of the A and B phase transmission circuits 25. In this configuration, the photo interrupter 22 of the encoders 100 and 200 shown in FIG.
The pulse-like signals detected at a and 22b and output on the lines A1 and B1 are input to the transmission circuit 25. At this time, although it depends on the rotation direction of the encoder, for example, a signal whose phase is shifted by 90 degrees from line A1 is output to line B1, or a pulse whose phase is delayed by 90 degrees from the pulse output to line B1. Is output to the transmission circuit 25 such that is output to the line A1.

【0025】ラインA1あるいはラインB1から入力さ
れたパルス状の信号が図5のパルスモード変換回路29
に入力されると、マスターアーム8がどれだけ移動した
かを示すパルスの数とパルスの出力方向を示す信号に変
換(CW/CCWからパルス/DIRへの変換)され
る。したがって、パルスモード変換回路29からはパル
スの出力方向とそのカウント数を示す信号が出力される
が、パルスのカウント数の信号は非反転増幅器30、反
転増幅器31を介してアナログスイッチ32、33に出
力される。したがって、パルスのカウント数は、アナロ
グスイッチ32、33の切換に従ってラインドライバ3
5に出力されることになるが、アナログスイッチ32、
33の切換動作は、パルスモード変換回路29の方向信
号ラインから出力される信号と、インバータ34によっ
て制御される。
The pulse signal input from the line A1 or the line B1 is applied to the pulse mode conversion circuit 29 shown in FIG.
Is converted to a signal indicating the number of pulses indicating how much the master arm 8 has moved and the output direction of the pulse (conversion from CW / CCW to pulse / DIR). Therefore, the pulse mode conversion circuit 29 outputs a signal indicating the pulse output direction and the count number, but the signal of the pulse count number is supplied to the analog switches 32 and 33 via the non-inverting amplifier 30 and the inverting amplifier 31. Is output. Therefore, the pulse count is changed by the line driver 3 according to the switching of the analog switches 32 and 33.
5, the analog switch 32,
The switching operation of 33 is controlled by a signal output from the direction signal line of the pulse mode conversion circuit 29 and an inverter 34.

【0026】すなわち、例えばエンコーダが正方向に回
転したときにはプラス5Vのパルスがラインドライバ3
5から出力されるように、アナログスイッチ32を閉
じ、エンコーダが負の方向に回転した場合にはプラス5
Vの入力信号が反転増幅器31によって反転されたマイ
ナス5Vのパルスがラインドライバ35から出力される
ように、アナログスイッチ33を閉じるようにする。こ
のようにして、ラインドライバ35からは図に示すよう
に3値からなる信号が出力されることになる。また、ラ
インドライバ35は差動方式であるのでラインA2に出
力される信号を反転させた信号がラインB2に出力され
る。
That is, for example, when the encoder rotates in the positive direction, a plus 5 V pulse is applied to the line driver 3
5, the analog switch 32 is closed.
The analog switch 33 is closed so that a minus 5 V pulse obtained by inverting the V input signal by the inverting amplifier 31 is output from the line driver 35. In this way, a ternary signal is output from the line driver 35 as shown in FIG. Further, since the line driver 35 is of a differential type, a signal obtained by inverting the signal output to the line A2 is output to the line B2.

【0027】図6はA、B相の受信回路27の具体的な
内部構成を示す図である。受信回路27は図4中に示す
ケーブルライン26を介して送られてきた信号を受信す
る。この場合、ラインA2、ラインB2には送信回路2
5中のラインドライバ35から出力された信号がそのま
ま3値の状態で受信回路27のラインレシーバ36に入
力される。この信号はプラス5Vとマイナス5Vの信号
レベルを含んでいるので、信号レベルをプラス5VのT
TLロジック信号(2値からなる信号)に変換するため
に非反転増幅回路37と反転増幅回路38とを図のよう
に並列に接続し、アナログスイッチ40、41の切り替
えを制御することによりこの2つの増幅回路37、38
のいずれか一方の出力がラインA3上に出力されるよう
にする。
FIG. 6 is a diagram showing a specific internal configuration of the A and B phase receiving circuits 27. As shown in FIG. The receiving circuit 27 receives a signal transmitted via the cable line 26 shown in FIG. In this case, the transmission circuit 2 is connected to the line A2 and the line B2.
The signal output from the line driver 35 in No. 5 is input to the line receiver 36 of the receiving circuit 27 in a ternary state as it is. Since this signal includes signal levels of plus 5 V and minus 5 V, the signal level is changed to a plus 5 V T
A non-inverting amplifier circuit 37 and an inverting amplifier circuit 38 are connected in parallel as shown in the figure for conversion to a TL logic signal (binary signal), and the switching of the analog switches 40 and 41 is controlled. Amplifier circuits 37, 38
Is output on the line A3.

【0028】この場合、このアナログスイッチ40、4
1の切換制御は、ラインドライバ36の出力を受けるコ
ンパレータ39と、インバータ42とによって行われ
る。すなわち、コンパレータ39は入力信号レベルが5
V以上かあるいは5V以下かによって正負の判断を行な
い、正の場合は例えばアナログスイッチ40を閉じてプ
ラス5Vの信号がそのままラインA3に出力され、負の
場合はアナログスイッチ41を閉じてマイナス5Vの信
号が反転増幅器38によって反転されてプラス5Vにな
った信号がラインA3に出力されるようにする。
In this case, the analog switches 40, 4
The switching control of 1 is performed by the comparator 39 receiving the output of the line driver 36 and the inverter 42. That is, the comparator 39 determines that the input signal level is 5
A positive or negative determination is made depending on whether the voltage is equal to or more than V or less than 5 V. In the case of positive, for example, the analog switch 40 is closed and a signal of +5 V is output as it is to the line A3. The signal whose signal is inverted by the inverting amplifier 38 to become plus 5 V is output to the line A3.

【0029】このようにして、ラインA3には、アナロ
グスイッチ40あるいは41からプラス5VのTTLパ
ルス(2値からなる信号)が出力され、ラインB3に
は、コンパレータ39から方向信号が出力される。した
がって、これらの信号をアップダウンカウンタ28によ
って受信して処理することによってマスターアーム8が
どの方向にどれだけ動いたかを検知することが可能とな
る。
As described above, the analog switch 40 or 41 outputs a plus 5 V TTL pulse (binary signal) to the line A3, and the comparator 39 outputs a direction signal to the line B3. Therefore, by receiving and processing these signals by the up / down counter 28, it is possible to detect in which direction and how much the master arm 8 has moved.

【0030】上記した第1実施形態によれば、従来で
は、ラインドライバ方式で例えばA相、B相、各2本ず
つの少なくとも4本の信号線が必要であったが、その半
分の2本で位置検出を行なうことができる。したがっ
て、マスターアーム8の位置検出手段の省線化が実現で
き、これによって、手術用マニピュレータシステムの細
径化、小型化が可能になる。
According to the above-described first embodiment, conventionally, at least four signal lines of, for example, two each of A-phase and B-phase are required in the line driver method, but two half of the two signal lines are required. Can be used for position detection. Accordingly, it is possible to reduce the number of lines required for the position detecting means of the master arm 8, thereby making it possible to reduce the diameter and size of the surgical manipulator system.

【0031】以下に本発明の第2実施形態を説明する。
図7に第2実施形態の回路構成を示す。第2実施形態の
回路構成は、第1実施形態で示した回路構成と基本的に
は同じであるが、Z相の送信回路及び受信回路が新たに
付加された点が異なる。すなわち、図7において、Z相
の信号を検出するためのフォトインタラプタ22cと、
このフォトインタラプタ22cに電流を流すための抵抗
23cと、定電流回路を実現するためのFET24cと
からなるエンコーダ300と、Z相送信回路53と、
A、B、Z相の信号をまとめて送信するためのABZ相
送信回路52とが付加されている。
Hereinafter, a second embodiment of the present invention will be described.
FIG. 7 shows a circuit configuration of the second embodiment. The circuit configuration of the second embodiment is basically the same as the circuit configuration shown in the first embodiment, except that a Z-phase transmission circuit and a reception circuit are newly added. That is, in FIG. 7, a photo-interrupter 22c for detecting a Z-phase signal,
An encoder 300 including a resistor 23c for flowing a current through the photointerrupter 22c and an FET 24c for realizing a constant current circuit; a Z-phase transmission circuit 53;
An ABZ phase transmission circuit 52 for transmitting the A, B, and Z phase signals collectively is added.

【0032】作用については、基本的には第1実施形態
で示したAB相の回路と同じであるが異なる点として
は、AB相のラインにZ相を認識するための細かいクロ
ックパルスを重畳した点にある。通常はZ相の信号はエ
ンコーダが1回転したときに出力される信号であり、通
常は使われない。しかし、本実施形態のように、インク
リメンタルエンコーダの原点を検出するために用いるこ
とができる。これはZ相のためのラインを2本さらに追
加することになり、位置検出手段の省線化、すなわちマ
ニピュレータの小型化の観点から好ましくない。そこ
で、第2実施形態ではこのような課題を克服するため
に、以下に詳述するようにAB相の出力ラインにZ相の
細かいクロック信号を重畳させる方法を用いる。
The operation is basically the same as that of the AB-phase circuit shown in the first embodiment, except that a fine clock pulse for recognizing the Z-phase is superimposed on the AB-phase line. On the point. Normally, the Z-phase signal is a signal output when the encoder makes one rotation, and is not normally used. However, as in the present embodiment, it can be used to detect the origin of the incremental encoder. This results in adding two more lines for the Z phase, which is not preferable from the viewpoint of saving the line of the position detecting means, that is, downsizing the manipulator. Therefore, in the second embodiment, in order to overcome such a problem, a method of superimposing a fine Z-phase clock signal on an AB-phase output line is used as described in detail below.

【0033】図8は上記したABZ相送信回路52の具
体的な内部構成を示す図である。図中のラインA1、ラ
インB1、ラインA2、ラインB2に関しては前記した
第1実施形態と同じ動作を行っている。また、非反転増
幅器30、反転増幅器31、アナログスイッチ32、3
3、インバータ34、ラインドライバ35に関しても同
様である。第1実施形態と異なる点は、ある程度の幅を
もつ信号がZ1ラインを介してZ相送信回路53に入力
されたとき、Z相送信回路53はこれを図に示すような
ある一定周期のクロックに変換してZ2ライン上に出力
することである。OR回路154はAB相送信回路25
から出力されたクロックパルスにZ相送信回路53から
のクロックを重畳させる。これによって非反転増幅器3
0、反転増幅器31、アナログスイッチ32、33を介
した後、ラインドライバ35からは図に示すような波形
のクロックがラインA3、ラインB3上に出力される。
ここで、ラインA3、ラインB3上の波形として図では
マイナス5V、0Vのクロックしか示していないが、異
なる方向にエンコーダが回転した場合にはプラス5Vの
クロックが出力されることは勿論である。
FIG. 8 is a diagram showing a specific internal configuration of the ABZ phase transmission circuit 52 described above. The same operation as in the first embodiment is performed for the line A1, the line B1, the line A2, and the line B2 in the drawing. Further, a non-inverting amplifier 30, an inverting amplifier 31, analog switches 32, 3
3, the inverter 34 and the line driver 35 are the same. The difference from the first embodiment is that, when a signal having a certain width is input to the Z-phase transmission circuit 53 via the Z1 line, the Z-phase transmission circuit 53 And output it on the Z2 line. The OR circuit 154 is an AB phase transmission circuit 25
The clock from the Z-phase transmission circuit 53 is superimposed on the clock pulse output from. This allows the non-inverting amplifier 3
After passing through 0, the inverting amplifier 31, and the analog switches 32 and 33, the line driver 35 outputs a clock having a waveform as shown on the line A3 and the line B3.
Although only minus 5 V and 0 V clocks are shown in the figure as waveforms on the lines A3 and B3, when the encoder rotates in a different direction, it goes without saying that a plus 5 V clock is output.

【0034】図9はABZ相受信回路54の具体的な内
部構成を示す図である。ラインA3、ラインB3上のク
ロック信号はラインレシーバ36によって受信される。
この受信された信号はローパスフィルタ55に入力され
てAB相の信号に重畳されたZ相のクロックがここで除
去され、これによってAB相のクロック成分のみが取り
出される。これ以降は第1実施形態と同様に、インバー
タ42及びコンパレータ39によってアナログスイッチ
40、41を切り替えて非反転増幅回路37と反転増幅
回路38の出力をオンオフさせることにより5VのTT
Lレベルの信号がラインA3上に出力されるようにす
る。同様に、コンパレータ39によって、プラス5Vあ
るいはマイナス5Vの信号レベルに応じてエンコーダの
回転方向を検出してラインB4上に方向の信号が出力さ
れる。アップダウンカウンタ28は入力されたラインA
4及びB4上の2つの信号に基づいてエンコーダの移動
量と移動方向を検出する。
FIG. 9 is a diagram showing a specific internal configuration of the ABZ phase receiving circuit 54. The clock signals on the lines A3 and B3 are received by the line receiver 36.
The received signal is input to the low-pass filter 55, and the Z-phase clock superimposed on the AB-phase signal is removed here, whereby only the AB-phase clock component is extracted. Thereafter, as in the first embodiment, the analog switches 40 and 41 are switched by the inverter 42 and the comparator 39 to turn on and off the outputs of the non-inverting amplifier circuit 37 and the inverting amplifier circuit 38, thereby making the 5V TT
An L-level signal is output on line A3. Similarly, the comparator 39 detects the rotation direction of the encoder according to the signal level of plus 5 V or minus 5 V, and outputs a direction signal on line B4. The up / down counter 28 receives the input line A
4 and B4, the moving amount and moving direction of the encoder are detected.

【0035】また、ラインレシーバ36からの出力はZ
相受信回路56に入力されて以下の方法で検出される。
図10はこのZ相受信回路56の構成を示す図である。
Z相受信回路56には図に示すように、通常のAB相の
クロックにZ相のクロックが重畳され、かつプラス5
V、マイナス5Vの信号レベルをもつパルスが入力され
る。このパルスはまず、絶対値回路57によってレベル
変換が行われてプラス5V、0Vの信号に統一される。
さらに、この信号をローパスフィルタ58に通すことに
よって前記したローパスフィルタ55と同様な作用によ
ってAB相のクロックを取り出す。
The output from the line receiver 36 is Z
It is input to the phase receiving circuit 56 and detected by the following method.
FIG. 10 is a diagram showing the configuration of the Z-phase receiving circuit 56.
As shown in the figure, a Z-phase clock is superimposed on a normal AB-phase clock, and
V, a pulse having a signal level of -5 V is input. This pulse is first subjected to level conversion by the absolute value circuit 57 to be unified into plus 5V and 0V signals.
Further, by passing this signal through a low-pass filter 58, an AB-phase clock is extracted by the same operation as the above-described low-pass filter 55.

【0036】同時に、絶対値回路57からの信号を別の
ラインを介してカウンタ59に入力させてZ相の信号で
あるか否かを判断する。次のZ相パルス出力回路60は
カウンタ59に設定された値と一致したときのみにライ
ンZ4上に1クロックを出力するような構成になってい
る。
At the same time, the signal from the absolute value circuit 57 is input to the counter 59 via another line to determine whether or not the signal is a Z-phase signal. The next Z-phase pulse output circuit 60 is configured to output one clock on the line Z4 only when the value matches the value set in the counter 59.

【0037】ここで、ローパスフィルタ58からのAB
相のクロックはカウンタ59とZ相パルス出力回路60
のリセットラインに入力されている。これは、AB相の
クロックが入力されるごとにカウンタ59及びZ相パル
ス出力回路60をリセットする事によってその時点から
Z相の信号を認識するためのクロックのカウントをその
つど行なわせるためである。これによってZ相の信号を
認識して抽出することが可能になり、前記した第1実施
形態で示したAB相の回路にZ相受信回路と送信回路を
追加するだけでZ相の信号を検知することができる。
Here, AB from the low-pass filter 58
The phase clock is generated by a counter 59 and a Z-phase pulse output circuit 60.
Is input to the reset line. This is because the counter 59 and the Z-phase pulse output circuit 60 are reset every time the AB-phase clock is input, so that the clock for recognizing the Z-phase signal is counted from that time. . This makes it possible to recognize and extract the Z-phase signal, and detect the Z-phase signal simply by adding a Z-phase receiving circuit and a transmitting circuit to the AB-phase circuit described in the first embodiment. can do.

【0038】上記した第2実施形態によれば、第1実施
形態で用いたエンコーダ送受信回路の2本のラインだけ
でABZの信号ラインを構成することができ、これによ
って、第1実施形態と同様に構成がコンパクトになり手
術用マニピュレータシステムの細径化、小型化が可能に
なる。
According to the second embodiment, an ABZ signal line can be constituted by only two lines of the encoder transmitting / receiving circuit used in the first embodiment. In addition, the configuration becomes compact, and the diameter and size of the surgical manipulator system can be reduced.

【0039】以下に本発明の第3実施形態を説明する。
上記した第1、第2実施形態ではエンコーダ部分の省線
化について示したが、この実施形態はモータ及びアクチ
ュエータの駆動部を小型化するための実施形態である。
駆動制御を行なう場合に、アクチュエータを駆動するた
めの信号を生成するのに通常、DAコンバータが使われ
るが、本実施形態ではこのDAコンバータを小型化する
ことによってマニピュレータ及び制御装置を小型化する
ものである。
Hereinafter, a third embodiment of the present invention will be described.
In the first and second embodiments described above, the line saving of the encoder part has been described. However, this embodiment is an embodiment for miniaturizing the drive units of the motor and the actuator.
When performing drive control, a DA converter is usually used to generate a signal for driving the actuator. In the present embodiment, the manipulator and the control device are reduced by reducing the size of the DA converter. It is.

【0040】図11(a),(b)に第3実施形態の原
理図を示す。図11(a)、(b)では横軸に周波数、
縦軸に信号レベルを示しており、図11(a)中、四角
で囲まれている白い部分は元信号のレベルであって斜線
で書かれてある部分は量子化ノイズである。
FIGS. 11A and 11B show the principle of the third embodiment. In FIGS. 11A and 11B, the horizontal axis represents frequency,
The signal level is shown on the vertical axis. In FIG. 11A, the white portion surrounded by a square is the level of the original signal, and the portion hatched is the quantization noise.

【0041】小型化されたDAコンバータを実現するた
めにビット数を少なくした場合には、量子化ノイズが乗
ってきて、図11(a)の左図に示すように元信号に被
さる形になってしまうので元信号を正確に処理すること
ができなくなる。そこで、オーバーサンプリングという
技術を用いて元信号に重畳している量子化ノイズを、図
11(b)の右図に示すように高周波領域側に追いやる
と同時に高周波ノイズをカットすることにより、量子化
誤差を少なくしてノイズを減らすつつビット数の少ない
DAコンバータを実現することができる。
When the number of bits is reduced in order to realize a miniaturized DA converter, quantization noise is superimposed on the original signal as shown in the left diagram of FIG. Therefore, the original signal cannot be processed accurately. Therefore, the quantization noise superimposed on the original signal is driven to the high frequency region side as shown in the right diagram of FIG. A DA converter with a small number of bits can be realized while reducing noise by reducing errors.

【0042】このオーバーサンプリングという技術は、
図11(b)の上図において、元信号を、元信号に対し
て例えば4fsの周波数でオーバーサンプリングする
と、その半分の2fsの周波数(一般にはナイキスト周
波数と呼ばれている)と、他のナイキスト周波数6fs
の周辺領域で4fsの周波数を中心にして対称となる量
子化誤差ノイズ特性が得られる。ここで図中スプリアス
と書いてあるのは元信号に対しての折り返し成分の信号
である。
This oversampling technique is
In the upper diagram of FIG. 11B, when the original signal is oversampled at a frequency of, for example, 4 fs with respect to the original signal, half the frequency of 2 fs (generally called the Nyquist frequency) and another Nyquist frequency Frequency 6fs
, A quantization error noise characteristic symmetrical about the frequency of 4 fs is obtained. Here, what is written as spurious in the figure is a signal of a folded component with respect to the original signal.

【0043】このような特性において、オーバーサンプ
リング周波数を増やして高くしていくことにより図11
(b)の下図に示すように、斜線部分の量子化誤差ノイ
ズを除去することが可能となる。
In such a characteristic, by increasing the oversampling frequency to increase the oversampling frequency, FIG.
(B) As shown in the lower diagram, it is possible to remove the quantization error noise in the hatched portion.

【0044】図12はこれを実現するための具体的な回
路構成を示している。その1つは図12(a)に示すよ
うにローブースト70a、1ビット量子化器71a、ロ
ーカット72aとから構成される。このローブースト7
0aと、1ビット量子化器71aと、ローカット72a
の構成では、まず、1ビット量子化器71aの前段でロ
ーブースト70aによりローブーストを行って低い周波
数領域を持ち上げる。次に1ビット量子化器71aによ
り量子化した後にローカット72aでそれと逆特牲のロ
ーカット処理を行い元信号の周波数特性を元のフラット
な特性に戻している。
FIG. 12 shows a specific circuit configuration for realizing this. One of them is composed of a low boost 70a, a 1-bit quantizer 71a, and a low cut 72a as shown in FIG. This low boost 7
0a, 1-bit quantizer 71a, and low cut 72a
In the configuration of (1), first, the low boost is performed by the low boost 70a before the 1-bit quantizer 71a to raise a low frequency region. Next, after the signal is quantized by the 1-bit quantizer 71a, the low-cut 72a performs a low-cut process having inverse characteristics to the low-cut process to return the frequency characteristic of the original signal to the original flat characteristic.

【0045】図12(b)はデルタ変調方式の1ビット
量子化回路を示している。1ビットのDAコンバータは
マルチビット(例えば16ビット)のデジタル信号を再
量子化して1ビットのデジタル信号にする。この回路は
1ビット量子化器71bと、積分器70b1と、1サン
プル遅延73bと、積分器70b2とから構成されてい
る。ここで1ビット量子化器71bとしては具体的には
コンパレータが使用され、このコンパレータによって入
力信号の変化分を比較する。例えば入力信号の変化分が
プラスであった場合は1ビット量子化器71bの出力を
1とし、変化分がマイナスであった場合には1ビット量
子化器71bの出力を0とすることによって2値化を実
現することができる。
FIG. 12B shows a 1-bit quantization circuit of the delta modulation system. The 1-bit DA converter re-quantizes a multi-bit (for example, 16-bit) digital signal into a 1-bit digital signal. This circuit includes a one-bit quantizer 71b, an integrator 70b1, a one-sample delay 73b, and an integrator 70b2. Here, a comparator is specifically used as the 1-bit quantizer 71b, and the comparator compares changes in the input signal. For example, when the change of the input signal is positive, the output of the 1-bit quantizer 71b is set to 1; when the change is negative, the output of the 1-bit quantizer 71b is set to 0, Value can be realized.

【0046】図12(c)は、図12(b)のデルタ変
調方式の1ビット量子化回路を用いて、1次ノイズシェ
ーピング回路を構成した例を示している。この構成は、
図12(b)に示すデルタ変調方式の1ビット量子化回
路の前段に積分器70c1を加えるとともに、出力端の
部分に微分器72cをつけ加えたものである。図12
(c)の積分器70c1は図12(a)のローブースト
70aに対応し、図12(c)の点線で囲んだ部分は図
12(a)の1ビット量子化器71aに対応し、図12
(c)の微分器72cは図12(a)のローカット72
aに対応している。このような構成によって量子化誤差
を抑えながらかつ分解能が1ビットであるDAコンバー
タが構成される。これにより1ビットであっても元信号
を正確に復元してアクチュエータを駆動させることがで
きる。
FIG. 12C shows an example in which a 1st-order noise shaping circuit is configured using the 1-bit quantization circuit of the delta modulation system shown in FIG. 12B. This configuration,
In this embodiment, an integrator 70c1 is added to the front stage of the 1-bit quantization circuit of the delta modulation system shown in FIG. 12B, and a differentiator 72c is added to the output terminal. FIG.
The integrator 70c1 in FIG. 12C corresponds to the low boost 70a in FIG. 12A, and the portion surrounded by the dotted line in FIG. 12C corresponds to the one-bit quantizer 71a in FIG. 12
The differentiator 72c of FIG. 12C is the low cut 72 of FIG.
a. With such a configuration, a DA converter having a 1-bit resolution while suppressing a quantization error is configured. Thus, the actuator can be driven by accurately restoring the original signal even with one bit.

【0047】このオーバサンプリング技術を使ったこの
具体的な回路としては図13に示すように、積分器13
0と、1ビット量子化器131と、1サンプル遅延13
2により構成した回路が考えられる。このような構成は
ソフトウェア等でのデジタル演算あるいはフリップフロ
ップカウンタ等でのディスクリートICでも実現が可能
である。
As a specific circuit using this oversampling technique, as shown in FIG.
0, 1-bit quantizer 131, 1-sample delay 13
2 is conceivable. Such a configuration can be realized by a digital operation using software or the like or a discrete IC using a flip-flop counter or the like.

【0048】図14は上記した方法により構成された1
ビットDAコンバータを手術用マニピュレータに適用し
た例を示す。制御指令生成部80は検出されたマスター
アーム8の移動量に対応して、各手術用マニピュレータ
のリンクの移動量を指令する信号を生成する部分であ
り、この指令に従ってサーボ制御回路内であるいは通常
の制御等で位置決め制御等が行われる。
FIG. 14 shows the structure of the first embodiment constructed by the above method.
An example in which a bit DA converter is applied to a surgical manipulator will be described. The control command generation unit 80 is a unit that generates a signal for commanding the movement amount of the link of each surgical manipulator in accordance with the detected movement amount of the master arm 8. The positioning control and the like are performed by the control and the like.

【0049】1軸目のサーボ制御回路901は図14に
示すように、サンプルホールダ811と、デジタルフィ
ルタ821(これはPIDなどのアルゴリズムを処理す
る部分である)と、ノイズシェーピング回路831、カ
ウンタ(累算器)881とから構成され、これに、1ビ
ットDAコンバータ841、電力変換部851、モータ
861、エンコーダ871が接続されている。他のサー
ボ制御回路902乃至90nの構成もこれと同様であ
る。
As shown in FIG. 14, the servo control circuit 901 for the first axis includes a sample holder 811, a digital filter 821 (which is a part for processing an algorithm such as PID), a noise shaping circuit 831, and a counter ( A 1-bit DA converter 841, a power converter 851, a motor 861, and an encoder 871 are connected to the accumulator 881. The other servo control circuits 902 to 90n have the same configuration.

【0050】このようなサーボ制御回路を複数軸接続さ
せることにより多軸のロボットで行われている位置決め
制御が可能になる。すなわち、マスターアーム8の移動
量が制御指令生成部80に入力され、制御指令生成部8
0は1軸目から6軸目までの各軸に対して指令値を出力
して各サーボ制御回路内の演算によって位置決め制御を
行わせている。
By connecting such servo control circuits to a plurality of axes, positioning control performed by a multi-axis robot can be performed. That is, the movement amount of the master arm 8 is input to the control command generation unit 80, and the control command generation unit 8
0 outputs a command value to each axis from the first axis to the sixth axis to perform positioning control by calculation in each servo control circuit.

【0051】上記した第3実施形態によれば、制御装置
11側でモータを駆動するために用いられるDAコンバ
ータの構成を簡単化して小型化することができる。した
がって、上記した第1実施形態及び第2実施形態の構成
に加えることにより、マニピュレータの構成だけでな
く、制御装置側の構成も小型化することができ、よりい
っそうの省スペース化を実現することができる。
According to the third embodiment, the configuration of the DA converter used for driving the motor on the control device 11 side can be simplified and downsized. Therefore, in addition to the configuration of the first embodiment and the configuration of the second embodiment, not only the configuration of the manipulator but also the configuration of the control device can be reduced, and further space saving can be realized. Can be.

【0052】以下に、本発明の第4実施形態を説明す
る。図15(a)、(b)は本発明の第4実施形態の構
成を示す図である。図15(a)において、80は処置
用マニピュレータのベース座標、81は観察用マニピュ
レータのベース座標である。図中のTCPM は処置用マ
ニピュレータのツールセンターポイント手先座標に対応
しており、図中のTCPS は観察用マニピュレータの手
先座標に対応している。その他の参照番号は上記した図
1の参照番号に対応しているので、各部の詳細な説明は
省略する。
Hereinafter, a fourth embodiment of the present invention will be described. FIGS. 15A and 15B are diagrams showing the configuration of the fourth embodiment of the present invention. In FIG. 15A, reference numeral 80 denotes base coordinates of the treatment manipulator, and reference numeral 81 denotes base coordinates of the observation manipulator. TCP M in the figure corresponds to the hand coordinates of the tool center point of the treatment manipulator, and TCP S in the figure corresponds to the hand coordinates of the observation manipulator. Other reference numbers correspond to the reference numbers in FIG. 1 described above, and thus detailed description of each unit will be omitted.

【0053】従来は、処置用マニピュレータと観察用マ
ニピュレータとが独立した座標系で設定されていたので
処置用マニピュレータを動かした場合に観察対象域から
処置用マニピュレータがずれてしまう、あるいは観察用
マニピュレータを動かしたために処置用マニピュレータ
が観察対象域からずれてしまうという問題があり、これ
によって操作が煩わしくなってしまうという欠点があっ
た。
Conventionally, the manipulator for treatment and the manipulator for observation are set in independent coordinate systems. Therefore, when the manipulator for treatment is moved, the manipulator for treatment is displaced from the observation target area, or the manipulator for observation is moved. There is a problem that the treatment manipulator is displaced from the observation target area due to the movement, and this has a disadvantage that the operation becomes complicated.

【0054】そこで、第4実施形態ではこれを解決する
ために処置用マニピュレータのベース座標系と観察用マ
ニピュレータのベース座標系をあらかじめ所定の位置に
設定しておくことにより、観察用マニピュレータと処置
用マニピュレータとの対応関係が分かるようする。具体
的には座標変換を行わせてロボットの位置指令を生成す
ればよい。手術用マニピュレータシステムの座標変換に
ついては特願平6−131811号公報あるいは特願平
6−208815号公報に開示されているので、ここで
の詳細な説明は省くことにする。
In order to solve this problem, the fourth embodiment sets the base coordinate system of the treatment manipulator and the base coordinate system of the observation manipulator at predetermined positions in advance. The correspondence with the manipulator is understood. Specifically, it is only necessary to generate a position command for the robot by performing coordinate conversion. The coordinate conversion of the surgical manipulator system is disclosed in Japanese Patent Application No. Hei 6-131811, or Japanese Patent Application No. Hei 6-208815, and a detailed description thereof will be omitted.

【0055】以下に、本発明の第4実施形態の実際の動
作方法を図16(a)、(b)を参照して説明する。図
16(a)は、処置用マニピュレータを構成する処置具
4の先端部と観察用マニピュレータを構成する内視鏡6
の先端部を示している。ここで、通常であれば観察用マ
ニピュレータはTCPS を基準に逆座標変換を行うこと
によってロボットの各関節の移動量を決定する。例えば
図16(a)中に示す点Lを擬似的にTCPとして逆座
標変換を解いてやれば点Lの空間的な位置が求まる。
Hereinafter, an actual operation method according to the fourth embodiment of the present invention will be described with reference to FIGS. 16 (a) and 16 (b). FIG. 16A shows the distal end of the treatment tool 4 constituting the treatment manipulator and the endoscope 6 constituting the observation manipulator.
Of FIG. Here, usually, the observation manipulator determines the movement amount of each joint of the robot by performing inverse coordinate transformation based on TCP S. For example, the spatial position of the point L can be obtained by solving the inverse coordinate transformation using the point L shown in FIG.

【0056】ここで、処置用マニピュレータのベース座
標系と、観察用マニピュレータのベース座標系との対応
が決まっているので、そこから処置用マニピュレータベ
ース座標系のTCPM が点Lに来るように制御座標変換
を行わせることができる。これによって、観察用マニピ
ュレータが動いた場合でも、観察用マニピュレータが示
す画面の範囲内に処置用マニピュレータが入るように処
置用マニピュレータを制御することができる。実際には
図16(b)に示すように、TCPM1が処置用マニピュ
レータの現在位置であった場合に、点Lに対して移動ベ
クトルPを引き、この移動ベクトルを計算することによ
り処置用マニピュレータを駆動させて観察用マニピュレ
ータの観察視野内に入るようにする。
Since the correspondence between the base coordinate system of the treatment manipulator and the base coordinate system of the observation manipulator is determined, control is performed so that the TCP M of the treatment manipulator base coordinate system comes to the point L. Coordinate transformation can be performed. Thus, even when the observation manipulator moves, the treatment manipulator can be controlled so that the treatment manipulator falls within the range of the screen indicated by the observation manipulator. Actually, as shown in FIG. 16 (b), when TCP M1 is the current position of the treatment manipulator, the movement vector P is subtracted from the point L, and this treatment vector is calculated to obtain the treatment manipulator. Is driven to enter the observation field of view of the observation manipulator.

【0057】上記した第4実施形態によれば、例えば体
腔内の目的部位を探すために観察用マニピュレータが移
動を繰り返している場合でも、処置用マニピュレータが
画面から消えることがなくなり、これによって操作性の
向上を図ることができる。 A.なお、上記した具体的実施形態には以下の構成(1
−1)〜(3−5)を有する発明が含まれている。 (1−1)複数の軸を有する多関節構造の手術用マニピ
ュレータと、この手術用マニピュレータに設けられ、体
腔内に挿入可能な手術機械と、前記手術用マニピュレー
タの位置及び/または姿勢を決定するための操作手段
と、この操作手段の操作により決定された位置及び/ま
たは姿勢の一部を2値化情報として検出する検出手段
と、この検出手段によって検出された2値化情報を少な
くとも3値からなる情報に変換して送信する送信手段
と、この送信手段からの少なくとも3値からなる情報に
基づいて、前記手術用マニピュレータの複数の軸の一部
の位置及び/または姿勢を決定する制御手段と、を具備
することを特徴とする手術用マニピュレータ。 (1−2)前記(1−1)において、前記制御手段は、
前記少なくとも3値からなる情報を前記送信手段から受
信した後に、この情報を再度、2値化情報に変換する変
換手段を具備する。 (1−3)前記(1−1)において、前記送信手段はラ
インドライバ方式の駆動部を有する。 (1−4)前記(1−2)において、光エンコーダをさ
らに含み、この光エンコーダはインクリメンタル方式で
前記手術用マニピュレータの位置をカウントする。 (2−1)複数の軸を有する多関節構造の手術用マニピ
ュレータと、この手術用マニピュレータに設けられ、体
腔内に挿入可能な手術機械と、前記手術用マニピュレー
タの位置及び/または姿勢を決定するための操作手段
と、この操作手段の操作により決定された位置及び/ま
たは姿勢の一部を検出する検出手段と、この検出手段に
よって検出された前記操作手段により決定された位置及
び/または姿勢の一部に関する情報に基づいて、前記手
術用マニピュレータの複数の軸の一部の位置及び/また
は姿勢を決定する制御手段と、を具備し、前記制御手段
は、決定された前記手術用マニピュレータの複数の軸の
一部の位置及び/または姿勢に基づいて、前記手術用マ
ニピュレータを駆動するための指令を単ビットコンバー
タを用いて生成する駆動手段を有することを特徴とする
手術用マニピュレータ。 (2−2)前記(2−1)において、前記駆動手段はデ
ジタル信号処理手段を含む。 (2−3)前記(2−1)において、前記駆動手段は多
関節の各関節を駆動するための指令−エネルギー変換手
段を含む。 (2−4)前記(2−2)において、前記デジタル信号
処理手段による処理がノイズシェーピング処理を含む。 (2−5)前記(2−4)において、前記ノイズシェー
ピング処理がデルタシグマ方式であることを特徴とす
る。 (3−1)複数の軸を有する多関節構造の手術用マニピ
ュレータと、この手術用マニピュレータに設けられ、体
腔内に挿入可能な手術機械と、前記手術用マニピュレー
タの位置及び/または姿勢を決定するための操作手段
と、この操作手段の操作により決定された位置及び/ま
たは姿勢の一部を検出する検出手段と、この検出手段に
よって検出された前記操作手段により決定された位置及
び/または姿勢の一部に関する情報に基づいて、前記手
術用マニピュレータの複数の軸の一部の位置及び/また
は姿勢を決定する制御手段と、を具備し、前記手術用マ
ニピュレータは、観察用マニピュレータと処置用のマニ
ピュレータとからなり、前記観察用マニピュレータと処
置用マニピュレータとの相対的な位置を一定にする位置
設定手段をさらに具備することを特徴とする手術用マニ
ピュレータ。 (3−2)前記(3−1)において、前記位置設定手段
は、前記観察用マニピュレータの遠位端と、前記処置用
マニピュレータの遠位端との位置を一定にする。 (3−3)前記(3−2)において、前記位置設定手段
は、前記観察用マニピュレータの遠位端と、前記処置用
マニピュレータの遠位端との位置を任意に一定にする手
段を有する。 (3−4)前記(3−1)において、前記位置設定手段
は、前記観察用マニピュレータの遠位端の向く方向と、
前記処置用マニピュレータの遠位端の向く方向とのなす
角度を一定にする。 (3−5)前記(3−4)において、前記位置設定手段
は、前記観察用マニピュレータの遠位端の向く方向と、
前記処置用マニピュレータの遠位端の向く方向とのなす
角度を任意に一定にする手段を具備する。B.上記した
(1−1)乃至(3−5)の従来技術の問題点は以下の
通りである。 (1−1)乃至(1−4)手術用マニピュレータをモー
タで駆動する場合に、マニピュレータの位置検出手段と
して光学式エンコーダが従来より用いられている。この
光学式エンコーダは位置検出精度が優れている反面、
A、B、Z相の3本の信号線が必要である。特に、この
ような光学式エンコーダを病院等の施設で使用する場合
には、ノイズの影響を除去するためにラインドライバ方
式が採用されている。ところが、ラインドライバ方式の
手術用マニピュレータシステムは少なくとも6本の信号
ラインが必要になりこれによる手術用マニピュレータシ
ステムの細径化の実現が難しいという問題点があった。 (2−1)乃至(2−5) 特願平7−115873号公報はエンコーダの省線化に
関する技術を開示しているが、駆動手段を小型化するた
めの技術的な対策については何も開示していない。 (3−1)乃至(3−5) 特願平7−2185号公報に示されている様に、手術用
マニピュレータシステムにおいて、観察用マニピュレー
タと処置用マニピュレータ間での関連した動きについ
て、観察画像に対する処置器具先端のスケーリングにつ
いて開示しているが、観察用マニピュレータと処置用マ
ニピュレータとの関連した動きを自動的に行わせること
は開示していない。したがって、処置用マニピュレータ
が観察画像から外れてしまう可能性があり、この場合は
操作が煩わしくなってしまう。 C.上記した(1−1)乃至(3−5)の発明の目的は
以下の通りである。 (1−1)乃至(1−4) 従来技術の問題点を克服して、手術用マニピュレータ制
御回路の小型化及び省線化を可能にして、細径化を実現
できる手術用マニピュレータシステムを提供することに
ある。 (2−1)乃至(2−5) 従来技術の問題点を克服して、手術用マニピュレータ制
御回路の小型化及び省線化を実現することにある。 (3−1)から(3−5) 従来技術の問題点を解消して、煩わしい操作をなくして
操作性を向上した手術用マニピュレータシステムを提供
することにある。
According to the above-described fourth embodiment, even when the observation manipulator repeatedly moves to search for a target site in the body cavity, the treatment manipulator does not disappear from the screen, thereby improving operability. Can be improved. A. The specific embodiment described above includes the following configuration (1)
-1) to (3-5). (1-1) A multi-joint-structured surgical manipulator having a plurality of axes, a surgical machine provided in the surgical manipulator, and insertable into a body cavity, and a position and / or posture of the surgical manipulator are determined. Means for detecting a part of the position and / or orientation determined by the operation of the operating means as binarized information, and converting the binarized information detected by the detecting means into at least ternary information. Transmitting means for converting the information into information consisting of at least three values, and controlling means for determining positions and / or postures of a part of a plurality of axes of the surgical manipulator based on at least three-value information from the transmitting means. And a surgical manipulator comprising: (1-2) In the above (1-1), the control means comprises:
After receiving the information consisting of at least three values from the transmitting means, the information processing apparatus further comprises a converting means for converting the information into binary information again. (1-3) In the above (1-1), the transmission means has a line driver type driving unit. (1-4) In (1-2), the optical encoder further includes an optical encoder, and the optical encoder counts the position of the surgical manipulator in an incremental manner. (2-1) A multi-joint surgical manipulator having a plurality of axes, a surgical machine provided in the surgical manipulator and insertable into a body cavity, and a position and / or posture of the surgical manipulator are determined. For detecting a part of the position and / or posture determined by the operation of the operation unit, and the position and / or posture of the position and / or posture determined by the operation unit detected by the detection unit. Control means for determining a position and / or orientation of a part of a plurality of axes of the surgical manipulator based on information about the part, wherein the control means determines the plurality of the determined surgical manipulators. Generating a command for driving the surgical manipulator using a single-bit converter based on the position and / or orientation of a part of the axis of the robot Surgical manipulator and having a motion means. (2-2) In (2-1), the driving unit includes a digital signal processing unit. (2-3) In (2-1), the driving unit includes a command-energy conversion unit for driving each of the multiple joints. (2-4) In the above (2-2), the processing by the digital signal processing means includes a noise shaping processing. (2-5) In the above (2-4), the noise shaping process is a delta-sigma method. (3-1) A multi-joint surgical manipulator having a plurality of axes, a surgical machine provided in the surgical manipulator and insertable into a body cavity, and a position and / or a posture of the surgical manipulator are determined. For detecting a part of the position and / or posture determined by the operation of the operation unit, and the position and / or posture of the position and / or posture determined by the operation unit detected by the detection unit. Control means for determining a position and / or orientation of a part of a plurality of axes of the surgical manipulator based on information on the part, wherein the surgical manipulator includes an observation manipulator and a treatment manipulator Position setting means for keeping the relative position between the observation manipulator and the treatment manipulator constant. Surgical manipulator which is characterized in that. (3-2) In the above (3-1), the position setting means makes the positions of the distal end of the observation manipulator and the distal end of the treatment manipulator constant. (3-3) In the above (3-2), the position setting means has means for arbitrarily keeping the positions of the distal end of the observation manipulator and the distal end of the treatment manipulator constant. (3-4) In the above (3-1), the position setting means includes: a direction in which a distal end of the observation manipulator faces;
The angle between the distal end of the treatment manipulator and the direction toward the distal end is made constant. (3-5) In the above (3-4), the position setting means includes: a direction in which a distal end of the observation manipulator faces;
Means are provided for arbitrarily making an angle between the distal end of the treatment manipulator and a direction facing the distal end arbitrary. B. The problems of the above-mentioned prior arts (1-1) to (3-5) are as follows. (1-1) to (1-4) When a surgical manipulator is driven by a motor, an optical encoder is conventionally used as a position detecting means of the manipulator. Although this optical encoder has excellent position detection accuracy,
Three signal lines of A, B and Z phases are required. In particular, when such an optical encoder is used in a facility such as a hospital, a line driver system is employed to remove the influence of noise. However, the surgical manipulator system of the line driver type requires at least six signal lines, and it is difficult to reduce the diameter of the surgical manipulator system. (2-1) to (2-5) Japanese Patent Application No. 7-115873 discloses a technology related to line saving of an encoder, but does not take any technical measures to reduce the size of the driving means. Not disclosed. (3-1) to (3-5) As disclosed in Japanese Patent Application No. 7-2185, in a surgical manipulator system, an observation image is obtained for a related movement between an observation manipulator and a treatment manipulator. But does not disclose that the related movement of the observation manipulator and the treatment manipulator is automatically performed. Therefore, the treatment manipulator may deviate from the observation image, and in this case, the operation becomes cumbersome. C. The objects of the inventions (1-1) to (3-5) are as follows. (1-1) to (1-4) To provide a surgical manipulator system that overcomes the problems of the prior art, enables downsizing and line saving of a surgical manipulator control circuit, and can realize a small diameter. Is to do. (2-1) to (2-5) An object of the present invention is to overcome the problems of the related art and realize a downsized and line-saving surgical manipulator control circuit. (3-1) to (3-5) An object of the present invention is to provide a surgical manipulator system which solves the problems of the conventional technology, eliminates troublesome operations, and improves operability.

【0058】[0058]

【発明の効果】本発明によれば、制御装置の小型化及び
手術用マニピュレータの細線化、小型化が可能になるの
で、手術用マニピュレータシステムの細径化、小型化が
実現される。しいては、病院内での省スペース化を行わ
すことができ、従来の煩雑な作業等がなくなる。
According to the present invention, it is possible to reduce the size of the control device and the thickness and size of the surgical manipulator, so that the surgical manipulator system can be reduced in diameter and size. As a result, space can be saved in the hospital, and the conventional complicated work is eliminated.

【図面の簡単な説明】[Brief description of the drawings]

【図1】本発明の第1実施形態に係る手術用マニピュレ
ータシステムの構成を示す図である。
FIG. 1 is a diagram showing a configuration of a surgical manipulator system according to a first embodiment of the present invention.

【図2】処置用アームの先端に取り付けられている処置
具の先端部と、観察用アームの先端に取り付けられてい
る内視鏡の先端部の湾曲動作を説明するための図であ
る。
FIG. 2 is a view for explaining a bending operation of a distal end portion of a treatment tool attached to a distal end of a treatment arm and a distal end portion of an endoscope attached to a distal end of an observation arm.

【図3】従来のエンコーダの結線と本実施形態のエンコ
ーダの結線を比較して示す図である。
FIG. 3 is a diagram showing a comparison between a connection of a conventional encoder and a connection of an encoder of the present embodiment.

【図4】本発明の第1実施形態において、手術用マニピ
ュレータのマスターアームに内蔵された位置検知回路の
構成を主として詳細に示すブロック図である。
FIG. 4 is a block diagram mainly showing in detail a configuration of a position detection circuit built in a master arm of the surgical manipulator in the first embodiment of the present invention.

【図5】A、B相の送信回路の具体的な内部構成を示す
図である。
FIG. 5 is a diagram showing a specific internal configuration of A and B phase transmission circuits.

【図6】A、B相の受信回路の具体的な内部構成を示す
図である。
FIG. 6 is a diagram showing a specific internal configuration of the A and B phase receiving circuits.

【図7】本発明の第2実施形態の回路構成を示す図であ
る。
FIG. 7 is a diagram showing a circuit configuration of a second embodiment of the present invention.

【図8】ABZ相送信回路の具体的な内部構成を示す図
である。
FIG. 8 is a diagram showing a specific internal configuration of an ABZ phase transmission circuit.

【図9】ABZ相受信回路の具体的な内部構成を示す図
である。
FIG. 9 is a diagram showing a specific internal configuration of an ABZ phase receiving circuit.

【図10】Z相受信回路の構成を示す図である。FIG. 10 is a diagram illustrating a configuration of a Z-phase receiving circuit.

【図11】本発明の第3実施形態の原理を説明するため
の図である。
FIG. 11 is a diagram for explaining the principle of a third embodiment of the present invention.

【図12】本発明の第3実施形態を実現するための具体
的な回路構成を示す図である。
FIG. 12 is a diagram showing a specific circuit configuration for realizing a third embodiment of the present invention.

【図13】オーバサンプリング技術を使った具体的な回
路構成を示す図である。
FIG. 13 is a diagram showing a specific circuit configuration using an oversampling technique.

【図14】第3実施形態の1ビットDAコンバータを手
術用マニピュレータに適用した例を示す図である。
FIG. 14 is a diagram illustrating an example in which the 1-bit DA converter according to the third embodiment is applied to a surgical manipulator.

【図15】本発明の第4実施形態の構成を示す図であ
る。
FIG. 15 is a diagram showing a configuration of a fourth embodiment of the present invention.

【図16】本発明の第4実施形態の実際の動作方法を説
明するための図である。
FIG. 16 is a diagram for explaining an actual operation method according to the fourth embodiment of the present invention.

【符号の説明】[Explanation of symbols]

4…処置具、 5…処置用アーム、 6…内視鏡、 7…観察用アーム、 8…マスターアーム、 11…制御装置、 19…関節機構、 21…位置検知回路、 25…送信回路、 26…ケーブルライン、 27…受信回路、 28…アップダウンカウンタ。 4 treatment instrument, 5 treatment arm, 6 endoscope, 7 observation arm, 8 master arm, 11 control device, 19 joint mechanism, 21 position detection circuit, 25 transmission circuit, 26 ... Cable line, 27 ... Receiving circuit, 28 ... Up-down counter.

Claims (1)

【特許請求の範囲】[Claims] 【請求項1】 複数の軸を有する多関節構造の手術用マ
ニピュレータと、 この手術用マニピュレータに設けられ、体腔内に挿入可
能な手術機械と、 前記手術用マニピュレータの位置及び/または姿勢を決
定するための操作手段と、 この操作手段の操作により決定された位置及び/または
姿勢の一部を2値化情報として検出する検出手段と、 この検出手段によって検出された2値化情報を少なくと
も3値からなる情報に変換して送信する送信手段と、 この送信手段からの少なくとも3値からなる情報に基づ
いて、前記手術用マニピュレータの複数の軸の一部の位
置及び/または姿勢を決定する制御手段と、 を具備することを特徴とする手術用マニピュレータシス
テム。
An articulated surgical manipulator having a plurality of axes, a surgical machine provided in the surgical manipulator and insertable into a body cavity, and a position and / or posture of the surgical manipulator are determined. Operating means for detecting a part of the position and / or orientation determined by operating the operating means as binarized information, and converting the binarized information detected by the detecting means into at least ternary information. Transmitting means for converting the information into information comprising: transmitting means for converting the information into at least three values from the transmitting means; and determining a position and / or orientation of a part of a plurality of axes of the surgical manipulator based on the information. And a surgical manipulator system comprising:
JP9112589A 1997-04-30 1997-04-30 Manipulator system for surgical operation Withdrawn JPH10296671A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP9112589A JPH10296671A (en) 1997-04-30 1997-04-30 Manipulator system for surgical operation

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP9112589A JPH10296671A (en) 1997-04-30 1997-04-30 Manipulator system for surgical operation

Publications (1)

Publication Number Publication Date
JPH10296671A true JPH10296671A (en) 1998-11-10

Family

ID=14590531

Family Applications (1)

Application Number Title Priority Date Filing Date
JP9112589A Withdrawn JPH10296671A (en) 1997-04-30 1997-04-30 Manipulator system for surgical operation

Country Status (1)

Country Link
JP (1) JPH10296671A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011037130A1 (en) * 2009-09-28 2011-03-31 Ntn株式会社 Remote operation actuator

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011037130A1 (en) * 2009-09-28 2011-03-31 Ntn株式会社 Remote operation actuator
JP2011067505A (en) * 2009-09-28 2011-04-07 Ntn Corp Remotely operated actuator
US8739643B2 (en) 2009-09-28 2014-06-03 Ntn Corporation Remote-controlled actuator

Similar Documents

Publication Publication Date Title
JP6382203B2 (en) Position / force control device, position / force control method and program
CA2651780C (en) A method and apparatus for controlling a haptic device
Thielmann et al. Mica-a new generation of versatile instruments in robotic surgery
CN110709211B (en) Robot system and control method for robot system
JP2015506850A (en) Application of force feedback at the input device that prompts the operator of the input device to command the joint device to take a suitable posture
JP2013071231A (en) Teaching device of robot arm, robot apparatus, teaching method, control device of robot arm, control program of robot arm, and integrated electronic circuit
WO2022228149A1 (en) Input device, main operating device, and surgical robot
KR20200030209A (en) Multi degree-of-freedom laparoscopic apparatus using disposable surgical robot tool
WO2017198217A1 (en) Desktop-level mechanical arm device
KR101763766B1 (en) Surgical robot system and control method thereof
JPH10296671A (en) Manipulator system for surgical operation
AU2019369303A1 (en) Binding and non-binding articulation limits for robotic surgical systems
JP6427253B1 (en) Medical equipment for robot control, drape adapter and operation support system
EP0480419B1 (en) Positioning device
JPS6257884A (en) Manipulator device
DK180627B1 (en) Method of suppressing vibrations of a robot arm with external objects
JP2007030136A (en) Minute object handling system
JP7185749B2 (en) ROBOT SYSTEM AND ROBOT SYSTEM CONTROL METHOD
CN114760950A (en) Surgical intervention robotic device with articulated arm carrying instruments
KR102004228B1 (en) The universal high speed/precision controller for six axis manipulator
JPH0428507B2 (en)
JPS63174893A (en) Manipulator
WO2023176141A1 (en) End effector unit, surgical device, arm device, and manipulator system
JP7426333B2 (en) robot control device
JPH0631670A (en) Method and device of exchanging tool for manipulator

Legal Events

Date Code Title Description
A300 Application deemed to be withdrawn because no request for examination was validly filed

Free format text: JAPANESE INTERMEDIATE CODE: A300

Effective date: 20040706