WO2023074332A1 - マスタ・スレーブシステム、制御装置、制御方法及びプログラム - Google Patents

マスタ・スレーブシステム、制御装置、制御方法及びプログラム Download PDF

Info

Publication number
WO2023074332A1
WO2023074332A1 PCT/JP2022/037745 JP2022037745W WO2023074332A1 WO 2023074332 A1 WO2023074332 A1 WO 2023074332A1 JP 2022037745 W JP2022037745 W JP 2022037745W WO 2023074332 A1 WO2023074332 A1 WO 2023074332A1
Authority
WO
WIPO (PCT)
Prior art keywords
master
slave
actuator
catheter
control
Prior art date
Application number
PCT/JP2022/037745
Other languages
English (en)
French (fr)
Inventor
公平 大西
貴弘 溝口
伸 牧
能行 羽生
俊弘 藤井
Original Assignee
慶應義塾
モーションリブ株式会社
テルモ株式会社
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 慶應義塾, モーションリブ株式会社, テルモ株式会社 filed Critical 慶應義塾
Publication of WO2023074332A1 publication Critical patent/WO2023074332A1/ja

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/30Surgical robots
    • A61B34/37Master-slave robots
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J3/00Manipulators of master-slave type, i.e. both controlling unit and controlled unit perform corresponding spatial movements
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00Control of position or direction
    • G05D3/12Control of position or direction using feedback

Definitions

  • the present invention relates to a master/slave system, control device, control method and program.
  • a configuration for executing bilateral control such as force feedback control in which an operation reaction force corresponding to the operating load on the slave device side is applied to an operation tool on the master device side (for example, see Patent Reference 1).
  • an object of the present invention is to make the mode of operation of a slave more appropriate in a master/slave system.
  • a master-slave system includes: A master-slave system comprising a master device to which an operator's operation is input, and a slave device that remotely operates a device to be operated according to the operation input to the master device, Execution of haptic transmission control between the master device and the slave device based on an operation input to the master device and an external force input to the device to be operated that operates in accordance with the operation.
  • a haptic control means for an operation control means for causing the slave device to execute a set operation of the device to be operated in response to an operation input to the master device characterized by comprising
  • FIG. 1 is a schematic diagram showing the overall configuration of a master/slave system 1 according to an embodiment of the present invention
  • FIG. 3 is a schematic diagram (perspective view) showing the configuration of the slave device 20.
  • FIG. 3 is a schematic diagram (side view) showing the configuration of the slave device 20.
  • FIG. It is a schematic diagram which shows the structural example of the locking mechanism 22e.
  • FIG. 4 is a schematic diagram showing a configuration example of a roller interval switching mechanism; 4 is a schematic diagram showing the basic principle of haptic transmission control executed by the control device 30 in the fine movement mode;
  • FIG. 2 is a block diagram showing a hardware configuration of a control system in the master/slave system 1;
  • FIG. 3 is a schematic diagram showing a hardware configuration of an information processing device that constitutes the control device 30;
  • FIG. 2 is a block diagram showing a functional configuration of the master/slave system 1;
  • FIG. 4 is a flowchart for explaining the flow of operation control processing executed by the control device 30;
  • 4 is a flowchart for explaining the flow of haptic sensation transmission processing executed by the control device 30.
  • FIG. FIG. 2 is a schematic diagram showing the overall configuration of a master/slave system 1 according to a second embodiment;
  • FIG. 3 is a schematic diagram (perspective view) showing the configuration of the slave device 20.
  • FIG. 3 is a schematic diagram (side view) showing the configuration of the slave device 20.
  • FIG. 3 is a schematic diagram showing a configuration example of a gripping/rubbing portion 23d.
  • FIG. 11 is a block diagram showing the hardware configuration of a control system in the master/slave system 1 of the second embodiment;
  • FIG. 4 is a flowchart for explaining the flow of operation control processing executed by the control device 30;
  • 4 is a flowchart for explaining the flow of haptic sensation transmission processing executed by the control device 30.
  • FIG. FIG. 11 is a schematic diagram showing another configuration example of the fine movement execution unit 22;
  • FIG. 1 is a schematic diagram showing the overall configuration of a master/slave system 1 according to one embodiment of the present invention.
  • a master/slave system 1 according to this embodiment includes a master device 10 and a slave device 20 that are mechanically separated.
  • the master-slave system 1 in this embodiment is a catheter system in which the master device 10 has a function of a manipulator (operation unit) operated by a user, and the slave device 20 has an end effector inserted into a subject. shall constitute
  • the master/slave system 1 includes a master device 10, a slave device 20, and a control device 30.
  • the master device 10, the slave device 20, and the control device 30 are connected to a network 40. It is configured to enable wired or wireless communication via.
  • the master/slave system 1 can include a display L and a plurality of cameras C as appropriate.
  • the camera C various imaging devices such as a video camera for imaging the exterior of the subject into which the slave device 20 is inserted, or an X-ray camera for imaging the interior of the subject with X-rays can be used.
  • the master/slave system 1 also has a coarse movement mode for moving the catheter T including the end effector and the catheter sheath over a long distance at high speed, and a coarse movement mode for moving the end effector and the catheter sheath (catheter T) accurately over a short distance.
  • the fine movement mode the haptic sensation is transmitted between the master and the slave.
  • the master device 10 includes a coarse/fine movement switch 11 for switching between a coarse movement mode and a fine movement mode, an operation lever 12 for performing a straight movement operation in the coarse movement mode, and a rotary movement operation in the fine movement mode and the coarse movement mode. and a manipulator 13 for performing straight movement operation in the fine movement mode.
  • the catheter T is moved straight in the coarse movement mode, and the catheter T is moved straight and rotated in the fine movement mode.
  • a signal set by the coarse/fine movement switch 11 is transmitted to the control device 30 . That is, by switching the coarse/fine movement switch 11, the master/slave system 1 is set to a state in which the catheter T rotates, rectilinearly advances during coarse movement, or rectilinearly advances during fine movement.
  • the operation lever 12 accepts operations for controlling the slave device 20 in the coarse movement mode.
  • the catheter T is moved straight forward (inserted), and when the operation lever 12 is moved forward, the catheter T is retracted (pulled back).
  • the content of the operation input to the operating lever 12 (the position of the operating lever 12 ) is detected by a sensor, and a signal indicating the content of the detected operation is sent to the control device 30 .
  • the manipulator 13 has a form similar to that of a mechanically configured conventional catheter operation section, and receives, in the fine movement mode, an operation similar to that for a mechanically configured conventional catheter.
  • the sensor detects the position of the movable part (such as the movable member of the manipulator 13) that moves due to the operation of the manipulator 13, and a signal indicating the detected position is transmitted to the control device 30.
  • the actuator In response to an operation input to the manipulator 13 , the actuator outputs a reaction force according to instructions from the control device 30 .
  • the manipulator 13 performs an operation to accurately move the catheter T by a short distance (for example, an operation to transmit a haptic sensation in the vicinity of the lesion), an operation to rotate the catheter T around its axis (for example, the orientation of the end effector). and the like), and an operation to operate the end effector (for example, if the end effector is a balloon, an operation to expand and contract it, and if the end effector is forceps, an operation to open and close it, etc.) are received, and a reaction force is applied to these operations, and information indicating the position of the movable portion moved by each operation is detected and transmitted to the control device 30 .
  • a short distance for example, an operation to transmit a haptic sensation in the vicinity of the lesion
  • an operation to rotate the catheter T around its axis for example, the orientation of the end effector. and the like
  • an operation to operate the end effector for example, if the end effector is a balloon, an operation to expand and contract it, and if
  • the slave device 20 drives an actuator according to instructions from the control device 30 to perform an action corresponding to the operation input to the master device 10, and a movable part (a mover of the actuator or the actuator moved by the action) that moves according to the action. catheter T, etc.).
  • a movable part a mover of the actuator or the actuator moved by the action
  • various external forces are input to the slave device 20 from the environment.
  • the position of the movable portion in the slave device 20 indicates the result of various external forces acting on the output of the actuator.
  • the slave device 20 transmits information representing the detected position of the movable portion to the control device 30 .
  • FIGS. 2 and 3 are schematic diagrams showing the configuration of the slave device 20.
  • FIG. 2 is a perspective view showing the configuration of the slave device 20, and
  • FIG. 3 is a side view showing the configuration of the slave device 20.
  • the slave device 20 includes a support 21, a fine movement executing section 22, and a coarse movement executing section .
  • the support 21 is a member that supports the slave device 20 as a whole. 21b, and a housing portion 21c formed at one end (rear end) opposite to the side wall 21b.
  • a through hole through which the catheter T is inserted is formed in the side wall 21b.
  • the accommodation portion 21c has a space in which parts can be accommodated therein, and accommodates an actuator 23a for straight movement during rough movement and an actuator 23c for switching a roller interval, which will be described later.
  • the fine movement execution unit 22 constitutes a mechanism that moves the catheter T while transmitting the haptic sensation of the catheter T in the fine movement mode.
  • the fine movement execution unit 22 includes a linear movement shaft 22a, a fine movement linear actuator 22b, a support plate 22c, a lock actuator 22d, a lock mechanism 22e, a case 22f, and a fine movement rotation actuator. 22g and
  • the linear motion shaft 22a is a member that guides the linear motion of the actuator 22b for linear movement during fine movement, and is installed between the side wall 21b of the support 21 and the housing portion 21c.
  • the direct-acting shaft 22a functions as a shaft of an actuator 22b for straight movement during fine movement, which is configured as a shaft motor. They are arranged continuously in a state where they are joined together.
  • the direct-acting shaft 22a is installed in a frame fixed to the bottom portion 21a.
  • the actuator 22b for fine movement rectilinear movement is configured by, for example, a shaft motor, and moves a slider (slider) having a movable coil along a linear movement axis 22a (shaft) according to an instruction from the control device 30.
  • the position of the movable portion of the actuator 22 b for fine movement straight movement is detected by the linear encoder 207 , and a signal indicating the detected position is sent to the control device 30 .
  • the support plate 22c is a plate-like member that is erected and fixed to the upper surface of the moving element of the actuator 22b for straight movement during fine movement, and rotatably supports one end of a case 22f in which the lock actuator 22d and the lock mechanism 22e are accommodated. do.
  • the lock actuator 22d is composed of, for example, a direct-acting motor, and when set to the fine movement mode, the catheter T is locked according to instructions from the control device 30 (that is, the fine movement execution unit 22 grips the catheter T).
  • the lock mechanism 22e is switched so as to be in the closed state). Further, when the lock actuator 22d is set to the coarse movement mode, the catheter T is released (that is, the fine movement executing section 22 does not grip the catheter T) according to the instruction of the control device 30.
  • the lock mechanism 22e is switched as follows.
  • FIG. 4 is a schematic diagram showing a configuration example of the lock mechanism 22e.
  • the lock mechanism 22e includes a wedge-shaped member W and a receiving member R.
  • the wedge-shaped member W has a conical portion W2 at the tip of the rod W1, which is divided into a plurality of portions by radially formed air gaps. Further, the wedge-shaped member W has a through hole through which the catheter T is inserted through the center of the rod W1 and the conical portion W2.
  • the receiving member R has a recess having a shape corresponding to the conical portion W2 of the wedge-shaped member W, and a through hole is formed in the center of the recess.
  • the catheter T is locked by the locking mechanism 22e (the fine movement execution unit 22 grips the catheter T).
  • the locking actuator 22d releases the catheter T, the wedge-shaped member W is separated from the receiving member R so that the conical portion W2 does not sandwich the catheter T. As shown in FIG.
  • the case 22f is a case in which the lock actuator 22d and the lock mechanism 22e are installed.
  • the case 22f is connected to the output shaft of the fine movement rotation actuator 22g, and when fine movement rotation is performed, the case 22f as a whole grips the catheter T and rotates together with the output shaft of the fine movement rotation actuator 22g. do.
  • the fine movement rotation actuator 22g is configured by, for example, a rotary motor, and rotates the output shaft according to instructions from the control device 30 in the fine movement mode.
  • the position (rotation angle) of the movable portion of the fine movement rotation actuator 22 g is detected by the rotary encoder 204 , and a signal indicating the detected position (rotation angle) is sent to the control device 30 .
  • the coarse movement execution unit 23 includes a coarse movement linear actuator 23a, a pair of rollers 23b, and a roller interval switching actuator 23c.
  • the coarse movement straight movement actuator 23a is composed of, for example, a rotary motor, and rotates a pair of rollers 23b according to instructions from the control device 30 in the coarse movement mode.
  • the catheter T can be moved at high speed over a long distance without transmission of haptic sensation.
  • the pair of rollers 23b are in a state in which the outer peripheral surfaces of the pair of rollers 23b are in contact with each other, or in a state in which there is a minute interval (an interval smaller than the diameter of the catheter T) (a state in which the catheter T is sandwiched), and in which the outer peripheral surfaces of the rollers 23b (the state in which the catheter T is released) and the state in which the catheter T is released. Further, when the pair of rollers 23b are switched to a state in which the catheter T is sandwiched, the gear G2 installed on the rotation shaft of each roller 23b is installed on the rotation shaft of the actuator 23a for coarse motion rectilinear movement. It is arranged at a position that meshes with the gear G1 (see FIG. 5).
  • roller interval switching mechanism a mechanism for switching the interval between the rotation shafts of the pair of rollers 23b
  • the roller interval switching actuator 23c is composed of, for example, a direct-acting motor, and operates a roller interval switching mechanism to change the distance between the rotation shafts of the pair of rollers 23b, thereby holding the catheter T between the states. To switch between the state in which the catheter T is released.
  • FIG. 5 is a schematic diagram showing a configuration example of a roller interval switching mechanism. As shown in FIG. 5, the roller interval switching mechanism has a parallel link P consisting of four equal-length links, and the rotational shafts of a pair of rollers 23b are held at the diagonally opposite joints of the parallel link P. It is Another node of the parallel link P is connected to the output shaft of the roller interval switching actuator 23c. The rotation shaft of each roller 23b can move along a through hole formed in the upper surface of the housing portion 21c and guiding the linear motion.
  • the roller interval switching actuator 23c advances and retracts the output shaft, the connection angle of the parallel link P changes, and the joints holding the rotation shafts of the rollers 23b approach each other or move away from each other. move to That is, the roller interval switching actuator 23c brings the rotation shafts of the pair of rollers 23b close to each other, and the gear G2 installed on the rotation shaft of each roller 23b is the gear installed on the rotation shaft of the coarse motion straight movement actuator 23a.
  • G1 the pair of rollers 23b sandwiches the catheter T, and it becomes possible to perform a rectilinear movement during rough movement.
  • roller interval switching actuator 23c separates the rotation shafts of the pair of rollers 23b, and separates the outer peripheral surfaces of the pair of rollers 23b by a distance larger than the diameter of the catheter T, so that the pair of rollers 23b releases the catheter T, allowing it to perform fine mode or coarse rotational motion.
  • the control device 30 is composed of, for example, an information processing device such as a personal computer or a server computer, and controls the master device 10, the slave device 20, the display L and the camera C.
  • the control device 30 acquires the positions of the movable parts of the master device 10 and the slave device 20 (such as the rotation angle of the actuator detected by a rotary encoder or the forward/backward position of the movable part detected by a linear encoder). and control for transmitting the haptic sensation between the master device 10 and the slave device 20 .
  • the control device 30 acquires the details of the operation of the operation lever 12 in the master device 10, and causes the coarse movement execution unit 23 of the slave device 20 to perform an operation according to the details of the operation of the operation lever 12.
  • the control device 30 in the present embodiment uses information representing the position of the movable part (the position of the movable element of the actuator or the Coordinate transformation (transformation by transformation matrix) of real space parameters (input vectors) calculated based on the information representing the position of the member to be processed) into a virtual space that can handle position and force independently . That is, the input vector is coordinate-transformed from the real space of the oblique coordinate system in which the position and the force are related to each other to the virtual space of the orthogonal coordinate system in which the position and the force are mutually independent.
  • the parameters calculated by the coordinate transformation represent the position and force state values corresponding to the input vector in the virtual space.
  • the control device 30 converts the state values of the position and force calculated from the input vector to the position and force for controlling the position and force (in this case, transmitting the haptic sensation). , and performs inverse transformation (transformation using the inverse matrix of the transformation matrix) to return the computation result to the real space. Further, the control device 30 drives each actuator based on the real space parameters (current command value, etc.) acquired by the inverse transformation, thereby transmitting the haptic sensation between the master device 10 and the slave device 20. Realize a master-slave system that
  • position and velocity (or acceleration) or angle and angular velocity (or angular acceleration) are parameters that can be replaced by calculus, so when performing processing related to position or angle, replace them with velocity or angular velocity as appropriate. is possible.
  • FIG. 6 is a schematic diagram showing the basic principle of haptic transmission control executed by the control device 30 in the fine movement mode.
  • the basic principle shown in FIG. 6 determines the operation of the actuator by inputting information representing the position of the movable part (current position of the movable part) and performing calculations in at least one of the speed and force regions. be. That is, the basic principle of the present invention includes a system to be controlled S, a functional force/velocity assignment transformation block FT, at least one of an ideal force source block FC or an ideal velocity source block PC, and an inverse transformation block IFT. It is expressed as a control law.
  • the controlled system S is the master device 10 or the slave device 20 equipped with an actuator, and controls the actuator based on acceleration and the like.
  • acceleration, velocity and position or angular acceleration, angular velocity and angle
  • acceleration, velocity and position or angular acceleration, angular velocity and angle
  • the control law is mainly expressed using the velocity calculated from the position.
  • the function-specific force/velocity allocation conversion block FT is a block that defines the conversion of control energy into the velocity and force regions set according to the function of the controlled system S.
  • a coordinate transformation is defined in which a value (reference value) serving as a reference for the function of the controlled system S and the current position of the movable part are input.
  • This coordinate transformation generally converts an input vector whose elements are the reference value and the current velocity into an output vector composed of velocities for calculating the velocity control target value, and an input vector whose elements are the reference value and the current force. It converts the vector into an output vector consisting of force for calculating the force control target value.
  • the coordinate transformation in the functional force/velocity allocation transformation block FT is generalized as shown in the following equations (1) and (2).
  • x' 1 to x' n are velocity vectors for deriving the state value of velocity
  • x' a to x' m are 1 or more
  • ) is a vector whose elements are the reference value and the speed based on the action of the actuator (the speed of the mover of the actuator or the speed of the member moved by the actuator)
  • h 1a to h nm are the elements of the conversion matrix representing the function. be.
  • f′′ 1 to f′′ n are force vectors for deriving force state values
  • f′′ a to f′′ m is an integer equal to or greater than 1
  • f′′ a to f′′ m is an integer equal to or greater than 1 is a vector whose elements are the force based on the reference value and the action of the actuator (the force of the mover of the actuator or the force of the member moved by the actuator).
  • the coordinate transformation in the functional force/velocity allocation transformation block FT By setting the coordinate transformation in the functional force/velocity allocation transformation block FT according to the function to be realized, various operations can be realized and scaling can be performed. That is, in the basic principle of the present invention, in the function-specific force/velocity assignment conversion block FT, the variables of the actuator alone (variables in the real space) are converted to the variable group of the entire system (the virtual space variable) and assign the control energy to the control energy of velocity and the control energy of force. In other words, according to the basic principle of the present invention, a coordinate space in which velocity and force are related to each other is transformed into a coordinate space in which velocity and force are independent of each other, and then calculations related to velocity and force control are performed. Therefore, compared to the case where the control is performed with the variables of the actuator alone (variables in the real space), it is possible to independently apply the velocity control energy and the force control energy.
  • the ideal force source block FC is a block that performs calculations in the force domain according to the coordinate transformation defined by the functional force/velocity assignment transformation block FT.
  • a target value is set for the force when performing calculations based on the coordinate transformation defined by the functional force/velocity assignment transformation block FT.
  • This target value is set as a fixed value or a variable value depending on the function to be implemented. For example, when realizing a function similar to the function indicated by the reference value, set the target value to zero, or when performing scaling, set a value obtained by expanding or reducing the information indicating the function to be realized. can.
  • the ideal velocity source block PC is a block that performs calculations in the velocity domain according to the coordinate transformation defined by the functional force/velocity assignment transformation block FT.
  • the ideal velocity source block PC there are set target values relating to velocity when performing calculations based on the coordinate transformation defined by the functional force/velocity assignment transformation block FT.
  • This target value is set as a fixed value or a variable value depending on the function to be implemented. For example, when realizing a function similar to the function indicated by the reference value, set the target value to zero, or when performing scaling, set a value obtained by expanding or reducing the information indicating the function to be realized. can.
  • the inverse transform block IFT is a block that transforms values in the domain of velocity and force into values in the domain of inputs to the controlled system S (for example, voltage values or current values).
  • the functional force/velocity assignment conversion block FT when the positional information of the actuators of the controlled system S is input to the functional force/velocity assignment conversion block FT, the velocity and force information obtained based on the positional information is used to , in the function-specific force/velocity assignment conversion block FT, the control law for each of the position and force regions according to the function is applied.
  • the ideal force source block FC force calculation is performed according to the function
  • the ideal velocity source block PC velocity calculation is performed according to the function, and control energy is distributed to force and velocity respectively.
  • the calculation results in the ideal force source block FC and the ideal velocity source block PC become information indicating the control target of the controlled system S, and these calculation results are used as input values for the actuators in the inverse transformation block IFT, and the controlled system S is entered in As a result, the actuators of the controlled system S perform operations according to the functions defined by the functional force/velocity assignment conversion block FT, and the intended operation of the device is realized.
  • x'p is the velocity for deriving the state value of velocity
  • x'f is the velocity related to the state value of force
  • x'm is the speed of the reference value (input from the master device 10) (differential value of the current position of the master device 10)
  • x 's is the current speed of the slave device 20 (differential value of the current position).
  • f p is the force related to the state value of velocity
  • f f is the force for deriving the state value of force
  • f m is the force of the reference value (input from the master device 10 )
  • f s is the current force of the slave device 20 .
  • the position of the slave device 20 is multiplied by ⁇ ( ⁇ is a positive number)
  • the force of the slave device 20 is multiplied by ⁇ ( ⁇ is a positive number)
  • the master It will be transmitted to the device 10 .
  • FIG. 7 is a block diagram showing the hardware configuration of the control system in the master/slave system 1. As shown in FIG.
  • the master/slave system 1 includes, as a hardware configuration of a control system, a control device 30 configured by an information processing device such as a personal computer or a server computer, a control unit 101 of the master device 10, Communication unit 102 , coarse/fine movement switch 11 , operating lever sensor 103 , rotary actuator 104 , linear actuator 105 , linear encoder 106 , rotary encoder 107 , drivers 108 and 109 , slave device 20 a control unit 201, a communication unit 202, a fine movement straight movement actuator 22b, a lock actuator 22d, a fine movement rotation actuator 22g, a coarse movement straight movement actuator 23a, a roller gap switching actuator 23c, A linear encoder 203, rotary encoders 204 and 205, drivers 206 to 210, a display L, and a camera C are provided.
  • a control device 30 configured by an information processing device such as a personal computer or a server computer
  • Communication unit 102 a control unit 101 of the master device 10
  • a control unit 101 of the master device 10 is composed of a microcomputer including a processor, memory, etc., and controls the operation of the master device 10 .
  • the control unit 101 controls driving of the coarse/fine switch 11, the straight/rotary switch 14, the rotary actuator 104, and the straight actuator 105 of the master device 10 according to control parameters transmitted from the control device 30.
  • Communication unit 102 controls communication between master device 10 and other devices via network 40 .
  • a coarse/fine movement switch 11 is a switch for switching between a coarse movement mode and a fine movement mode.
  • the operating lever sensor 103 detects the content of the operation input to the operating lever 12 (the position of the operating lever 12) and outputs a signal indicating the content of the detected operation to the control unit 101.
  • the rotation actuator 104 is composed of, for example, a rotary motor, and applies a reaction force to the operator's operation to rotate the master device 10 around the rotation axis along the advancing/retreating direction according to instructions from the control unit 101 .
  • the rectilinear actuator 105 is composed of, for example, a direct-acting motor, and according to instructions from the control unit 101, applies a reaction force to an operation input by the operator to a lever (grip) or the like for operating the end effector. do.
  • the linear encoder 106 detects the position of the mover of the rectilinear actuator (advance/retreat position on the rectilinear axis).
  • the rotary encoder 109 detects the position (rotational angle) of the mover of the rotary actuator 104 .
  • the driver 108 outputs drive current to the rotation actuator 104 according to instructions from the control unit 101 .
  • a driver 109 outputs a drive current to the linear actuator 105 according to an instruction from the control unit 101 .
  • a control unit 201 of the slave device 20 is configured by a microcomputer having a processor, memory, etc., and controls the operation of the slave device 20 .
  • the control unit 201 according to the control parameters transmitted from the control device 30, controls the actuator 22b for fine movement straight movement, the lock actuator 22d, the fine movement rotation actuator 22g, the coarse movement straight movement actuator 23a, the roller It controls driving of the interval switching actuator 23c.
  • the communication unit 202 controls communication between the slave device 20 and other devices via the network 40 .
  • the actuator 22b for straight movement during fine movement is composed of, for example, a direct-acting motor.
  • the catheter T of the slave device 20 is moved forward and backward according to the forward and backward operation.
  • the lock actuator 22d is composed of, for example, a direct-acting motor, and according to instructions from the control unit 201, in the fine movement mode, the catheter T is locked (that is, the catheter T is gripped by the fine movement executing section 22).
  • the lock mechanism 22e is switched so that In addition, the lock actuator 22d follows an instruction from the control unit 201 to lock the catheter T in the coarse movement mode so that the catheter T is released (that is, the fine movement execution unit 22 does not grip the catheter T). Switch the mechanism 22e.
  • the fine movement rotation actuator 22g is composed of, for example, a rotary motor.
  • the catheter T of the slave device 20 is advanced or retracted in accordance with an instruction from the control unit 201 according to the operation input to the master device 10 by the operator. Rotate around the axis of rotation along
  • the actuator 23a for straight movement at coarse movement is constituted by, for example, a rotary motor, and in the coarse movement mode, it rotates a pair of rollers 23b in accordance with the instruction of the control unit 201 and according to the operation input to the operation lever 12 by the operator. Let As a result, in the coarse motion mode, the catheter T can be moved at high speed over a long distance without transmission of haptic sensation.
  • the roller interval switching actuator 23c is composed of, for example, a direct-acting motor, and in accordance with an instruction from the control unit 201, when the straight motion is performed in the coarse motion mode, the pair of rollers 22b bring their outer peripheral surfaces into contact with each other.
  • the roller interval switching mechanism is controlled so as to be in a closed state or a minute interval (a interval smaller than the diameter of the catheter T) (a state in which the catheter T is sandwiched). Further, the roller interval switching actuator 23c is operated in the coarse movement mode and in the fine movement mode, in which the outer peripheral surfaces of the pair of rollers 22b are separated from each other by a distance greater than the diameter of the catheter T ( The roller interval switching mechanism is controlled so that the catheter T is released). In other words, the roller interval switching actuator 23c puts the pair of rollers 23b in a state in which the catheter T is held between them only when straight movement is performed in the coarse motion mode, and puts the catheter T in a state of releasing it otherwise.
  • the linear encoder 203 detects the position of the mover of the actuator 22b for straight movement during fine movement (advance/retreat position on the linear movement axis).
  • the rotary encoder 204 detects the position (rotation angle) of the mover of the actuator 22g for fine movement rotation.
  • the rotary encoder 205 detects the position (rotational angle) of the mover of the actuator 23a for straight movement during coarse movement.
  • the rotary encoder 212 detects the position (rotational angle) of the mover of the lifting actuator 234d.
  • the driver 206 outputs a drive current to the actuator 22b for straight movement during fine movement according to an instruction from the control unit 201 .
  • the driver 207 outputs a drive current to the lock actuator 22d according to instructions from the control unit 201 .
  • the driver 208 outputs a drive current to the fine movement rotation actuator 22g according to an instruction from the control unit 201 .
  • the driver 209 outputs a drive current to the coarse motion rectilinear actuator 23a in accordance with an instruction from the control unit 201 .
  • the driver 210 outputs a driving current to the roller gap switching actuator 23c according to the instruction of the control unit 201.
  • the display L is installed in a place where the operator of the master device 10 can visually recognize the screen, and displays an image instructed to be displayed by the control device 30 (visible light image or X-ray image of the subject captured by the camera C). indicate.
  • the camera C is installed in a place where the slave device 20 can capture images of the subject into which the catheter T is to be inserted. Send.
  • FIG. 8 is a schematic diagram showing a hardware configuration of an information processing device that constitutes the control device 30.
  • the control device 30 includes a processor 311, a ROM (Read Only Memory) 312, a RAM (Random Access Memory) 313, a bus 314, an input section 315, an output section 316, and a storage section. 317 , a communication unit 318 and a drive 319 .
  • the processor 311 executes various processes according to programs recorded in the ROM 312 or programs loaded from the storage unit 317 to the RAM 313 .
  • the RAM 313 also stores data necessary for the processor 311 to execute various types of processing.
  • the processor 311 , ROM 312 and RAM 313 are interconnected via a bus 314 .
  • An input unit 315 , an output unit 316 , a storage unit 317 , a communication unit 318 and a drive 319 are connected to the bus 314 .
  • the input unit 315 is composed of various buttons and the like, and inputs various information according to instruction operations.
  • the output unit 316 includes a display, a speaker, and the like, and outputs images and sounds. Note that when the control device 30 is configured as a smartphone or a tablet terminal, the display of the input unit 315 and the display of the output unit 316 may be overlapped to configure a touch panel.
  • the storage unit 317 is composed of a hard disk, a DRAM (Dynamic Random Access Memory), or the like, and stores various data managed by each server.
  • the communication unit 318 controls communication between the control device 30 and other devices via the network.
  • a removable medium 331 consisting of a magnetic disk, an optical disk, a magneto-optical disk, a semiconductor memory, or the like is appropriately mounted in the drive 319 .
  • a program read from the removable medium 331 by the drive 319 is installed in the storage unit 317 as required.
  • FIG. 9 is a block diagram showing the functional configuration of the master/slave system 1.
  • the control device 30 executes various processes so that the processor 311 includes a mode setting unit 351 , a sensor information acquisition unit 352 , an operation control unit 353 , and a power supply unit 353 .
  • the haptic transmission unit 354 functions.
  • a control parameter storage unit 371 is also formed in the storage unit 317 .
  • the control parameter storage unit 371 controls the control device 30 to transmit haptic sensations between the master device 10 and the slave device 20 (fine movement mode control) or controls the master device 10 to operate the slave device 20 with the operation lever 12.
  • the control parameters acquired in (coarse motion mode control) are stored in chronological order. That is, the history data of the operation of the master/slave system 1 is stored in the control parameter storage unit 371 .
  • the mode setting unit 351 switches between coarse movement mode and fine movement mode according to the operation of the operator. Specifically, when the coarse/fine movement switch 11 is set to the fine movement mode, the mode setting unit 351 switches the master/slave system 1 to the fine movement mode, and sets the coarse/fine movement switch 11 to the coarse movement mode. If so, switch the master/slave system 1 to the coarse mode.
  • the sensor information acquisition unit 352 acquires information (sensor information) detected by various sensors installed in the master device 10 and slave devices 20 .
  • the sensor information acquisition unit 302 acquires information indicating the position (forward/backward position or rotation angle) of the mover of each actuator detected by the linear encoders 106, 203 and the rotary encoders 107, 204, 205. Further, the sensor information acquisition unit 352 stores the acquired sensor information in the control parameter storage unit 371 as time-series data.
  • the operation control unit 353 controls the slave device 20 in accordance with operations input to the coarse/fine movement switch 11 and the operation lever 12 of the master device 10 . Specifically, when the coarse/fine movement switch 11 is set to the coarse movement mode, the operation control unit 353 controls the lock actuator 22d to the unlocked state (the state in which the catheter T is released). The roller interval switching actuator 23c is controlled so that the pair of rollers 23b sandwich the catheter T.
  • the operation control unit 353 controls the lock actuator 22d to the locked state (the state in which the catheter T is gripped), and the pair of rollers 23b is moved.
  • the roller interval switching actuator 23c is controlled so that the catheter T is released.
  • the operation control section 353 controls the actuator of the slave device 20 in the coarse movement mode according to the details of the operation input to the operation lever 12 of the master device 10 . Specifically, when the operation lever 12 is moved to the back, the operation control unit 353 rotates the straight movement actuator 23a in one direction to move the catheter T straight (insert) so that the operation lever 12 moves forward. , the coarse motion rectilinear actuator 23a is rotated in the opposite direction to retract (pull back) the catheter T.
  • the haptic transmission unit 354 controls haptic transmission in the master device 10 and the slave device 20 according to the control algorithm shown in FIG. 6 in the fine movement mode. For example, in the haptic transmission process, the haptic transmission unit 354 performs control to transmit haptic sensations between actuators for corresponding actions of the master device 10 and the slave device 20 . At this time, the haptic transmission unit 354 may receive the setting of the amplification factor, amplify the external force or position detected by the slave device 20 with the set amplification factor, and transmit the amplified external force or position to the master device 10 .
  • FIG. 10 is a flowchart for explaining the flow of operation control processing executed by the control device 30. As shown in FIG. The operation control process is started in response to an instruction to execute the operation control process via the input unit 315 or the communication unit 318 .
  • step S1 the operation control unit 353 determines whether the coarse movement mode or the fine movement mode is set. If it is determined that the coarse motion mode is set, the process proceeds to step S2 after step S1. On the other hand, if it is determined that the fine movement mode is set, the process proceeds to step S5 after step S1.
  • step S2 the operation control unit 353 controls the lock actuator 22d so that the lock mechanism 22e is in the unlocked state (the catheter T is released).
  • step S3 the operation control unit 353 controls the roller interval switching actuator 23c so that the catheter T is sandwiched between the pair of rollers 23b.
  • step S ⁇ b>4 the operation control section 353 advances and retreats the catheter T according to the content of the operation on the master device 10 .
  • step S5 haptic sensation transmission processing, which will be described later, is executed. After steps S4 and S5, the operation control process is repeated.
  • FIG. 11 is a flowchart for explaining the flow of haptic transmission processing executed by the control device 30.
  • the operation control unit 353 determines whether straight movement or rotation is set. If it is determined that the straight running operation is set, the process proceeds to step S12 after step S11. On the other hand, if it is determined that the rotation operation is set, the process proceeds to step S15 after step S11.
  • step S12 the operation control unit 353 controls the lock actuator 22d so that the lock mechanism 22e is in a locked state (a state in which the catheter T is gripped).
  • step S13 the operation control unit 353 controls the roller interval switching actuator 23c so that the pair of rollers 23b releases the catheter T.
  • step S14 the haptic transmission unit 354 starts controlling the fine movement straight movement actuator 22b. After step S14, the process proceeds to step S18.
  • step S15 the operation control unit 353 controls the lock actuator 22d so that the lock mechanism 22e is in a locked state (a state in which the catheter T is gripped).
  • step S16 the operation control unit 353 controls the roller interval switching actuator 23c so that the pair of rollers 23b releases the catheter T.
  • FIG. the haptic transmission unit 354 starts controlling the fine movement rotation actuator 22b.
  • step S ⁇ b>18 the sensor information acquisition unit 352 acquires information (sensor information) detected by various sensors installed in the master device 10 and the slave device 20 .
  • the sensor information acquired in step S18 is stored in the control parameter storage unit 371 as time-series data.
  • step S19 the haptic transmission unit 354 receives the acquired sensor information, performs coordinate conversion (see, for example, formulas (1) and (2)), and executes haptic transmission control (straight ahead or rotation). .
  • step S ⁇ b>20 the operation control unit 353 determines whether or not switching between the straight-ahead movement and the rotation movement has been performed. If the straight-ahead motion and the rotation motion have not been switched, it is determined as NO in step S20, and the process proceeds to step S21. On the other hand, when switching between the straight-ahead movement and the rotation movement is performed, a determination of YES is made in step S20, and the process proceeds to step S11.
  • step S21 the operation control unit 353 determines whether or not an instruction to end the fine movement mode has been issued (that is, whether or not an operation for switching to the coarse movement mode has been performed). If the end of the fine movement mode has not been instructed, NO is determined in step S21, and the process proceeds to step S18. On the other hand, if termination of the fine movement mode is instructed, YES is determined in step S21, and the process returns to the operation control process.
  • the master-slave system 1 has a fine movement mode in which the catheter T is accurately moved by a short distance while transmitting a haptic sensation between the catheter T and the master device 10, and a A rough motion mode in which the catheter T is moved at high speed over a long distance without transmitting a haptic sensation to the master device 10 can be executed.
  • the master/slave system 1 is set to the coarse movement mode, the slave device 20 moves the catheter T at high speed over a long distance according to the operation of the control lever 12 of the master device 10 .
  • the slave device 20 transmits the force tactile sensation of the operation input to the master device 10 to the catheter T according to the operation of the manipulator 13 of the master device 10.
  • the haptic sensation input to the catheter T is transmitted to the master device 10 to accurately move the catheter T by a short distance.
  • the mode of operation for moving the slave device 20 in the master/slave system 1 can be made more appropriate.
  • the master/slave system 1 also includes a micro-movement rotation actuator 22g that rotates the catheter T about its axis.
  • a micro-movement rotation actuator 22g that rotates the catheter T about its axis.
  • FIG. 12 is a schematic diagram showing the overall configuration of the master/slave system 1 according to the second embodiment of the present invention. 12, the master/slave system 1 according to the present embodiment differs from the master/slave system 1 according to the first embodiment shown in FIG. 1 in the configuration of a master device 10 and a slave device 20 .
  • the master device 10 includes a coarse/fine movement switch 11 for switching between a coarse movement mode and a fine movement mode, an operation lever 12 for performing a straight movement operation in the coarse movement mode, and a rotary movement operation in the fine movement mode and the coarse movement mode. and a manipulator 13 for operating the straight motion in the fine movement mode, and a straight/rotation switch 14 for switching between the straight motion (insertion and withdrawal motion) and the rotary motion (rotational motion around the axis) of the catheter T.
  • a coarse/fine movement switch 11 and straight/rotation switch 14 are sent to the control device 30 .
  • the master/slave system 1 performs linear movement during coarse movement, rotational movement during coarse movement, linear movement during fine movement, and rotational movement during fine movement. It is set to a state in which either
  • the operation lever 12 receives an operation for controlling the slave device 20 in the coarse movement mode.
  • moving the operating lever 12 backward causes the catheter T to advance (insert)
  • moving the operating lever 12 forward causes the catheter T to retreat (pull back)
  • the operation lever 12 is moved to the left, the operation of rotating the catheter T about the axis to the left is performed in the slave device 20 .
  • the content of the operation input to the operating lever 12 (the position of the operating lever 12 ) is detected by a sensor, and a signal indicating the content of the detected operation is sent to the control device 30 .
  • the configuration of the manipulator 13 is similar to that of the manipulator 13 of the first embodiment shown in FIG.
  • the slave device 20 drives an actuator according to instructions from the control device 30 to perform an action corresponding to the operation input to the master device 10, and a movable part (a mover of the actuator or the actuator moved by the action) that moves according to the action. catheter T, etc.).
  • a movable part a mover of the actuator or the actuator moved by the action
  • various external forces are input to the slave device 20 from the environment.
  • the position of the movable portion in the slave device 20 indicates the result of various external forces acting on the output of the actuator.
  • the slave device 20 transmits information representing the detected position of the movable portion to the control device 30 .
  • FIGS. 13 and 14 are schematic diagrams showing the configuration of the slave device 20.
  • FIG. 13 is a perspective view showing the configuration of the slave device 20
  • FIG. 14 is a side view showing the configuration of the slave device 20.
  • the slave device 20 includes a support 21, a fine movement executing section 22, and a coarse movement executing section .
  • the support 21 is a member that supports the slave device 20 as a whole. 21b, and a housing portion 21c formed at one end (rear end) opposite to the side wall 21b.
  • a through hole through which the catheter T is inserted is formed in the side wall 21b.
  • the accommodation portion 21c has a space in which parts can be accommodated therein, and accommodates an actuator 23a for straight movement during rough movement and an actuator 23c for switching a roller interval, which will be described later.
  • the fine movement execution unit 22 constitutes a mechanism that moves the catheter T while transmitting the haptic sensation of the catheter T in the fine movement mode.
  • the fine movement execution unit 22 includes a linear movement shaft 22a, a fine movement linear actuator 22b, a support plate 22c, a lock actuator 22d, a lock mechanism 22e, a case 22f, and a fine movement rotation actuator. 22g and
  • the linear motion shaft 22a is a member that guides the linear motion of the actuator 22b for linear movement during fine movement, and is installed between the side wall 21b of the support 21 and the housing portion 21c.
  • the direct-acting shaft 22a functions as a shaft of an actuator 22b for straight movement during fine movement, which is configured as a shaft motor. They are arranged continuously in a state where they are joined together.
  • the actuator 22b for fine movement rectilinear movement is configured by, for example, a shaft motor, and moves a slider (slider) having a movable coil along a linear movement axis 22a (shaft) according to an instruction from the control device 30.
  • the position of the movable portion of the actuator 22 b for fine movement straight movement is detected by the linear encoder 203 , and a signal indicating the detected position is sent to the control device 30 .
  • the support plate 22c is a plate-like member that is erected and fixed to the upper surface of the moving element of the actuator 22b for straight movement during fine movement, and rotatably supports one end of a case 22f in which the lock actuator 22d and the lock mechanism 22e are accommodated. do.
  • the lock actuator 22d is composed of, for example, a direct-acting motor, and when set to the fine movement mode, the catheter T is locked according to instructions from the control device 30 (that is, the fine movement execution unit 22 grips the catheter T).
  • the lock mechanism 22e is switched so as to be in the closed state). Further, when the lock actuator 22d is set to the coarse movement mode, the catheter T is released (that is, the fine movement executing section 22 does not grip the catheter T) according to the instruction of the control device 30.
  • the lock mechanism 22e is switched as follows.
  • the lock mechanism 22e switches between a state in which the catheter T is locked and a state in which the catheter T is released according to the operation of the lock actuator 22d.
  • the configuration example shown in FIG. 4 can also be used for the lock mechanism 22e of the present embodiment.
  • the case 22f is a case in which the lock actuator 22d and the lock mechanism 22e are installed.
  • the case 22f is connected to the output shaft of the fine movement rotation actuator 22g, and when fine movement rotation is performed, the case 22f as a whole grips the catheter T and rotates together with the output shaft of the fine movement rotation actuator 22g. do.
  • the fine movement rotation actuator 22g is configured by, for example, a rotary motor, and rotates the output shaft according to instructions from the control device 30 in the fine movement mode.
  • the position (rotation angle) of the movable portion of the fine movement rotation actuator 22 g is detected by the rotary encoder 204 , and a signal indicating the detected position (rotation angle) is sent to the control device 30 .
  • the coarse movement execution unit 23 includes a coarse movement linear actuator 23a, a pair of rollers 23b, a roller interval switching actuator 23c, and a gripping/rubbing unit 23d.
  • the actuator 23a for coarse movement straight movement, the pair of rollers 23b, and the actuator 23c for roller interval switching are the same as those of the first embodiment shown in FIGS.
  • FIG. 15 is a schematic diagram showing a configuration example of the gripping/rubbing portion 23d.
  • the gripping/rubbing portion 23d includes a lower gripping member 231d, a lifting member 232d, a rack gear 233d, a lifting actuator 234d, a pinion gear 235d, a rubbing actuator 236d, and a guide. 237d, an upper grip member 238d, and a case 239d.
  • FIG. 15 shows the internal structure of the gripping/rubbing portion 23d through the case 239d.
  • the lower gripping member 231d includes a plate-shaped support portion 231d-1 fixed to the side surface of the housing portion 21c, and parallel (horizontal) to the upper surface of the housing portion 21c toward the outside of the case 239d from the upper end of the support portion 231d-1. ) and a top plate portion 231d-2 extending from the top plate portion 231d-2.
  • the top plate portion 231d-2 grips the catheter T with the upper grip member 238d and serves as a base for rubbing the catheter T together when the catheter T is rotated around the axis in the coarse motion mode. Therefore, the upper surface of the top plate portion 231d-2 has a shape that gives a certain amount of friction to the catheter T (such as a shape in which minute unevenness is formed).
  • a material that provides friction for rubbing the catheter T against the upper surface of the top plate portion 231d-2 is used. It is good also as installing the member which becomes.
  • the elevating member 232d includes a plate-like sliding portion 232d-1 that contacts the support portion 231d-1 of the lower gripping member 231d and slides in the vertical direction, and the upper end of the sliding portion 232d-1 to the inside of the case 239d. and a top plate portion 232d-2 extending horizontally toward the .
  • the slide portion 232d-1 has a rack gear 233d on the back side of the surface that contacts the support portion 231d-1 of the lower grip member 231d.
  • a rubbing actuator 236d, a guide 237d and an upper gripping member 238d are installed on the upper surface of the top plate portion 232d-2.
  • the rack gear 233d is installed in a state in which spur teeth are arranged vertically on the back side of the surface that contacts the support portion 231d-1 of the lower gripping member 231d in the sliding portion 232d-1 of the lifting member 232d. .
  • a pinion gear 235d rotated by a lifting actuator 234d is meshed with the rack gear 233d.
  • the lifting actuator 234d is composed of, for example, a rotary motor.
  • the lifting actuator 234d rotates a pinion gear 235d installed on the output shaft and vertically moves a rack gear 233d that meshes with the pinion gear 235d, thereby lifting the lifting member 232d.
  • the pinion gear 235d meshes with the rack gear 233d and rotates integrally with the output shaft of the lifting actuator 234d. That is, the pinion gear 235d transmits the driving force of the lifting actuator 234d to the lifting member 232d.
  • the rubbing actuator 236d is composed of, for example, a direct-acting motor, and is installed on the upper surface of the top plate portion 232d-2 of the lifting member 232d. The rubbing actuator 236d advances and retracts the upper gripping member 238d connected to the output shaft in parallel with the top plate portion 231d-2 of the lower gripping member 231d when the catheter T is rotated around its axis in the coarse movement mode.
  • the guide 237d is a member that guides the movement of the rubbing actuator 236d, and is installed on the upper surface of the top plate portion 232d-2 of the lifting member 232d. Specifically, the guide 237d is configured so that the upper gripping member 238d moves parallel to the top plate portion 231d-2 of the lower gripping member 231d when the upper gripping member 238d is moved by the rubbing actuator 236d. invite.
  • the upper gripping member 238d is connected to the output shaft of the rubbing actuator 236d, and is installed so as to face the top plate portion 231d-2 of the lower gripping member 231d. Further, the upper gripping member 238d is advanced and retracted parallel to the top plate portion 231d-2 of the lower gripping member 231d by the rubbing actuator 236d. Since the rubbing actuator 236d is installed on the top plate portion 232d-2 of the lifting member 232d, the upper gripping member 238d can be lifted and lowered by the lifting actuator 234d, and can be lowered by the rubbing actuator 236d. It can advance and retreat in parallel with the top plate portion 231d-2 of the gripping member 231d.
  • the case 239d is a case that accommodates each component of the gripping/rubbing portion 23d.
  • the top plate portion 231d-2 of the lower gripping member 231d and the upper gripping member 238d are provided with an opening 239d-1 protruding from the case 239d.
  • the upper gripping member 238d moves vertically within the opening 239d-1 when lifted by the lifting actuator 234d.
  • the control device 30 is configured by, for example, an information processing device such as a personal computer or a server computer, and controls the master device 10, the slave device 20, the display L and the camera C.
  • the control device 30 acquires the positions of the movable parts of the master device 10 and the slave device 20 (such as the rotation angle of the actuator detected by a rotary encoder or the forward/backward position of the movable part detected by a linear encoder). and control for transmitting the haptic sensation between the master device 10 and the slave device 20 .
  • the control device 30 acquires the details of the operation of the operation lever 12 in the master device 10, and causes the coarse movement execution unit 23 of the slave device 20 to perform an operation according to the details of the operation of the operation lever 12.
  • the basic principle of haptic transmission control executed by the control device 30 in this embodiment is the same as the basic principle of the first embodiment shown in FIG.
  • FIG. 16 is a block diagram showing the hardware configuration of the control system in the master/slave system 1 of this embodiment.
  • the master/slave system 1 includes, as a hardware configuration of a control system, a control device 30 configured by an information processing device such as a personal computer or a server computer, a control unit 101 of the master device 10, Communication unit 102, coarse/fine movement switch 11, operating lever sensor 103, rotary actuator 104, linear actuator 105, linear encoder 106, rotary encoder 107, drivers 108 and 109, straight/rotation Switch 14, control unit 201 of slave device 20, communication unit 202, actuator 22b for fine movement straight movement, lock actuator 22d, fine movement rotary actuator 22g, coarse movement straight movement actuator 23a, roller interval switching actuator 23c, lifting actuator 234d, rubbing actuator 236d, linear encoders 203, 211, rotary encoders 204, 205, 212, drivers 206 to 210, 213, 214, display L, A camera C is provided.
  • a control device 30 configured by an information processing device such as a personal computer or a server computer
  • a control unit 101 of the master device 10 10
  • a control unit 101 of the master device 10 is composed of a microcomputer including a processor, memory, etc., and controls the operation of the master device 10 .
  • the control unit 101 controls driving of the coarse/fine switch 11, the straight/rotary switch 14, the rotary actuator 104, and the straight actuator 105 of the master device 10 according to control parameters transmitted from the control device 30.
  • Communication unit 102 controls communication between master device 10 and other devices via network 40 .
  • a coarse/fine movement switch 11 is a switch for switching between a coarse movement mode and a fine movement mode.
  • the operating lever sensor 103 detects the content of the operation input to the operating lever 12 (the position of the operating lever 12) and outputs a signal indicating the content of the detected operation to the control unit 101.
  • the rotation actuator 104 is composed of, for example, a rotary motor, and applies a reaction force to the operator's operation to rotate the master device 10 around the rotation axis along the advancing/retreating direction according to instructions from the control unit 101 .
  • the rectilinear actuator 105 is composed of, for example, a direct-acting motor, and according to instructions from the control unit 101, applies a reaction force to an operation input by the operator to a lever (grip) or the like for operating the end effector. do.
  • the linear encoder 106 detects the position of the mover of the rectilinear actuator (advance/retreat position on the rectilinear axis).
  • the rotary encoder 107 detects the position (rotational angle) of the mover of the rotary actuator 104 .
  • the driver 108 outputs drive current to the rotation actuator 104 according to instructions from the control unit 101 .
  • a driver 109 outputs a drive current to the linear actuator 105 according to an instruction from the control unit 101 .
  • the rectilinear/rotational switch 14 is a switch for switching between the rectilinear motion and the rotational motion of the catheter T, and a signal indicating either the set rectilinear motion or the rotational motion is input to the control unit 101 .
  • a control unit 201 of the slave device 20 is configured by a microcomputer having a processor, memory, etc., and controls the operation of the slave device 20 .
  • the control unit 201 controls the actuator 22b for fine movement straight movement, the lock actuator 22d, the fine movement rotation actuator 22g, the coarse movement straight movement actuator 23a, the roller It controls driving of the interval switching actuator 23c, the lifting actuator 234d, and the rubbing actuator 236d.
  • the communication unit 202 controls communication between the slave device 20 and other devices via the network 40 .
  • the actuator 22b for straight movement during fine movement is composed of, for example, a direct-acting motor.
  • the catheter T of the slave device 20 is moved forward and backward according to the forward and backward operation.
  • the lock actuator 22d is composed of, for example, a direct-acting motor, and according to instructions from the control unit 201, in the fine movement mode, the catheter T is locked (that is, the catheter T is gripped by the fine movement executing section 22).
  • the lock mechanism 22e is switched so that In addition, the lock actuator 22d follows an instruction from the control unit 201 to lock the catheter T in the coarse movement mode so that the catheter T is released (that is, the fine movement execution unit 22 does not grip the catheter T). Switch the mechanism 22e.
  • the fine movement rotation actuator 22g is composed of, for example, a rotary motor.
  • the catheter T of the slave device 20 is advanced or retracted in accordance with an instruction from the control unit 201 according to the operation input to the master device 10 by the operator. Rotate around the axis of rotation along
  • the actuator 23a for straight movement at coarse movement is constituted by, for example, a rotary motor, and in the coarse movement mode, it rotates a pair of rollers 23b in accordance with the instruction of the control unit 201 and according to the operation input to the operation lever 12 by the operator. Let As a result, in the coarse motion mode, the catheter T can be moved at high speed over a long distance without transmission of haptic sensation.
  • the roller interval switching actuator 23c is composed of, for example, a direct-acting motor, and in accordance with an instruction from the control unit 201, when the straight motion is performed in the coarse motion mode, the pair of rollers 22b bring their outer peripheral surfaces into contact with each other.
  • the roller interval switching mechanism is controlled so as to be in a closed state or a minute interval (a interval smaller than the diameter of the catheter T) (a state in which the catheter T is sandwiched). Further, the roller interval switching actuator 23c is operated in the coarse movement mode and in the fine movement mode, in which the outer peripheral surfaces of the pair of rollers 22b are separated from each other by a distance larger than the diameter of the catheter T ( The roller interval switching mechanism is controlled so that the catheter T is released). In other words, the roller interval switching actuator 23c puts the pair of rollers 23b in a state in which the catheter T is held between them only when straight movement is performed in the coarse motion mode, and puts the catheter T in a state of releasing it otherwise.
  • the lifting actuator 234d is composed of, for example, a rotary motor.
  • the lifting actuator 234d rotates a pinion gear 235d installed on the output shaft and vertically moves a rack gear 233d that meshes with the pinion gear 235d, thereby lifting the lifting member 232d.
  • the lifting actuator 234d moves the lifting member 232d upward in the fine movement mode, and the catheter T is released.
  • the lift actuator 234d has a distance between the top plate portion 231d-2 of the lower gripping member 231d and the upper gripping member 238d longer than the diameter of the catheter T.
  • the lifting member 232d is moved so as to suppress the Further, in the coarse movement mode, the lifting actuator 234d moves the lifting member 232d downward so that the top plate portion 231d-2 of the lower gripping member 231d and the upper gripping member 238d grip the catheter T.
  • the rubbing actuator 236d is composed of, for example, a direct-acting motor, and in the coarse motion mode, according to the instruction of the control unit 201, according to the operation input to the operation lever 12 by the operator, the upper grip connected to the output shaft.
  • the member 238d is advanced and retracted parallel to the top plate portion 231d-2 of the lower gripping member 231d.
  • the linear encoder 203 detects the position of the mover of the actuator 22b for straight movement during fine movement (advance/retreat position on the linear movement axis).
  • the linear encoder 211 detects the position of the mover of the rubbing actuator 236d (advance/retreat position on the linear motion axis).
  • the rotary encoder 204 detects the position (rotation angle) of the mover of the actuator 22g for fine movement rotation.
  • the rotary encoder 205 detects the position (rotational angle) of the mover of the actuator 23a for straight movement during coarse movement.
  • the rotary encoder 212 detects the position (rotational angle) of the mover of the lifting actuator 234d.
  • the driver 206 outputs a drive current to the actuator 22b for straight movement during fine movement according to an instruction from the control unit 201 .
  • the driver 207 outputs a drive current to the lock actuator 22d according to instructions from the control unit 201 .
  • the driver 208 outputs a drive current to the fine movement rotation actuator 22g according to an instruction from the control unit 201 .
  • the driver 209 outputs a drive current to the coarse motion rectilinear actuator 23a in accordance with an instruction from the control unit 201 .
  • the driver 210 outputs a driving current to the roller gap switching actuator 23c according to the instruction of the control unit 201.
  • the driver 213 outputs a drive current to the lifting actuator 234d according to instructions from the control unit 201 .
  • the driver 214 outputs a driving current to the rubbing actuator 236d according to an instruction from the control unit 201.
  • the display L is installed in a place where the operator of the master device 10 can visually recognize the screen, and displays an image instructed to be displayed by the control device 30 (visible light image or X-ray image of the subject captured by the camera C). indicate.
  • the camera C is installed in a place where the slave device 20 can capture images of the subject into which the catheter T is to be inserted. Send.
  • the functional configuration of the master/slave system 1 in this embodiment is the same as that of the first embodiment shown in FIG. However, in the functional configuration of the master/slave system 1 in this embodiment, the specific configurations of the sensor information acquisition unit 352 and the operation control unit 353 are different from those in the first embodiment.
  • the sensor information acquisition unit 352 acquires information (sensor information) detected by various sensors installed in the master device 10 and slave devices 20 .
  • the sensor information acquisition unit 302 acquires information indicating the position (advance/retreat position or rotation angle) of the mover of each actuator detected by the linear encoders 106, 203, 211 and the rotary encoders 107, 204, 205, 212.
  • the sensor information acquisition unit 352 stores the acquired sensor information in the control parameter storage unit 371 as time-series data.
  • the operation control unit 353 controls the slave device 20 according to the operations input to the coarse/fine movement switch 11 , the straight/rotation switch 14 and the operation lever 12 in the master device 10 . Specifically, when the coarse/fine movement switch 11 is set to the coarse movement mode and the straight/rotary switch 14 is set to the straight movement operation, the operation control unit 353 sets the lock actuator 22d to the unlocked state (catheter T is released), and the roller interval switching actuator 23c is controlled so that the pair of rollers 23b sandwich the catheter T, and the lower grip member 231d is placed in the grip/rubbing portion 23d.
  • the lift member 232d is moved by the lift actuator 234d so that the distance between the top plate portion 231d-2 and the upper grip member 238d is longer than the diameter of the catheter T and is such that the catheter T is restrained from being disorderly moved back and forth. is moved (that is, the catheter T is released).
  • the operation control unit 353 sets the lock actuator 22d to the unlocked state (releases the catheter T).
  • the roller interval switching actuator 23c is controlled so that the pair of rollers 23b release the catheter T, and the top plate of the lower gripping member 231d at the gripping/rubbing portion 23d.
  • the lift member 232d is moved by the lift actuator 234d so that the catheter T is gripped by the portion 231d-2 and the upper grip member 238d.
  • the operation control unit 353 sets the lock actuator 22d to the locked state (the state in which the catheter T is gripped). ), and the roller interval switching actuator 23c is controlled so that the pair of rollers 23b releases the catheter T.
  • the lift member 232d is moved by the lift actuator 234d so that the distance between the -2 and the upper grip member 238d is longer than the diameter of the catheter T to suppress random movements of the catheter T being advanced and retracted (that is, , with the catheter T in the released state).
  • the operation control unit 353 sets the lock actuator 22d to the locked state (the catheter T is gripped). ), and the roller interval switching actuator 23c is controlled so that the pair of rollers 23b releases the catheter T.
  • the lift member 232d is moved by the lift actuator 234d so that the distance between the -2 and the upper grip member 238d is longer than the diameter of the catheter T to suppress random movements of the catheter T being advanced and retracted (that is, , with the catheter T in the released state).
  • the operation control section 353 controls the actuator of the slave device 20 in the coarse movement mode according to the details of the operation input to the operation lever 12 of the master device 10 . Specifically, when the operation lever 12 is moved to the back, the operation control unit 353 rotates the straight movement actuator 23a in one direction to move the catheter T straight (insert) so that the operation lever 12 moves forward. , the coarse motion rectilinear actuator 23a is rotated in the opposite direction to retract (pull back) the catheter T. Further, in the coarse movement mode, when the operation lever 12 is moved to the right, the operation control unit 353 moves the rubbing actuator 236d in one direction to rotate the catheter T to the right about the axis, so that the operation lever 12 moves to the right. When moved to the left, the rubbing actuator 236d is moved in the opposite direction to rotate the catheter T to the left about its axis.
  • FIG. 17 is a flowchart for explaining the flow of operation control processing executed by the control device 30. As shown in FIG. The operation control process is started in response to an instruction to execute the operation control process via the input unit 315 or the communication unit 318 .
  • step S21 the operation control unit 353 determines whether the coarse movement mode or the fine movement mode is set. If it is determined that the coarse motion mode is set, the process proceeds to step S22 after step S21. On the other hand, if it is determined that the fine movement mode is set, the process proceeds to step S31 after step S21.
  • step S22 the operation control unit 353 determines whether straight-ahead movement or rotation movement is set. If it is determined that the straight running operation is set, the process proceeds to step S23 after step S22. On the other hand, if it is determined that the rotating motion is set, the process proceeds to step S27 after step S22.
  • step S23 the operation control unit 353 controls the lock actuator 22d so that the lock mechanism 22e is in the unlocked state (the catheter T is released).
  • step S24 the operation control unit 353 controls the roller interval switching actuator 23c so that the catheter T is sandwiched between the pair of rollers 23b.
  • step S25 the operation control section 353 controls the elevation actuator 234d so that the catheter T is released by the grasping/rubbing section 23d.
  • step S ⁇ b>26 the operation control section 353 advances and retreats the catheter T according to the content of the operation on the master device 10 .
  • step S27 the operation control unit 353 controls the lock actuator 22d so that the lock mechanism 22e is in the unlocked state (the catheter T is released).
  • step S28 the operation control unit 353 controls the roller interval switching actuator 23c so that the pair of rollers 23b releases the catheter T.
  • step S29 the operation control unit 353 controls the elevation actuator 234d so that the catheter T is gripped by the grip/rub portion 23d.
  • step S ⁇ b>30 the operation control section 353 rotates the catheter T around the axis according to the content of the operation on the master device 10 .
  • step S31 haptic sensation transmission processing, which will be described later, is executed. After steps S26, S30 and S31, the operation control process is repeated.
  • FIG. 18 is a flowchart for explaining the flow of the haptic sensation transmission process executed by the control device 30.
  • the operation control unit 353 determines whether straight-ahead movement or rotation movement is set. If it is determined that the straight running operation is set, the process proceeds to step S42 after step S41. On the other hand, if it is determined that the rotating motion is set, the process proceeds to step S46 after step S41.
  • step S42 the operation control unit 353 controls the lock actuator 22d so that the lock mechanism 22e is in a locked state (a state in which the catheter T is gripped).
  • step S43 the operation control unit 353 controls the roller interval switching actuator 23c so that the pair of rollers 23b releases the catheter T.
  • step S44 the operation control unit 353 controls the lifting actuator 234d so that the catheter T is released by the grasping/rubbing portion 23d.
  • step S45 the haptic transmission unit 354 starts controlling the fine movement straight movement actuator 22b. After step S45, the process proceeds to step S50.
  • step S46 the operation control unit 353 controls the lock actuator 22d so that the lock mechanism 22e is in a locked state (a state in which the catheter T is gripped).
  • step S47 the operation control unit 353 controls the roller interval switching actuator 23c so that the pair of rollers 23b releases the catheter T.
  • step S48 the operation control section 353 controls the elevation actuator 234d so that the catheter T is released by the grasping/rubbing section 23d.
  • step S49 the haptic transmission unit 354 starts controlling the fine movement rotation actuator 22b.
  • step S ⁇ b>50 the sensor information acquisition unit 352 acquires information (sensor information) detected by various sensors installed in the master device 10 and the slave device 20 .
  • the sensor information acquired in step S50 is stored in the control parameter storage unit 371 as time-series data.
  • the haptic transmission unit 354 receives the acquired sensor information, performs coordinate conversion (see, for example, formulas (1) and (2)), and executes haptic transmission control (straight ahead or rotation). .
  • step S ⁇ b>52 the operation control unit 353 determines whether switching between the straight-ahead movement and the rotation movement has been performed. If the straight-ahead motion and the rotation motion have not been switched, a determination of NO is made in step S52, and the process proceeds to step S53. On the other hand, when switching between the straight-ahead movement and the rotation movement is performed, a determination of YES is made in step S52, and the process proceeds to step S41.
  • step S53 the operation control unit 353 determines whether or not an instruction to end the fine movement mode has been issued (that is, whether or not an operation for switching to the coarse movement mode has been performed). If the end of the fine movement mode has not been instructed, a determination of NO is made in step S53, and the process proceeds to step S50. On the other hand, if the end of the fine movement mode is instructed, YES is determined in step S53, and the process returns to the operation control process.
  • the master-slave system 1 has a fine movement mode in which the catheter T is accurately moved by a short distance while transmitting a haptic sensation between the catheter T and the master device 10, and a A rough motion mode in which the catheter T is moved at high speed over a long distance without transmitting a haptic sensation to the master device 10 can be executed.
  • the master/slave system 1 is set to the coarse movement mode, the slave device 20 moves the catheter T at high speed over a long distance according to the operation of the control lever 12 of the master device 10 .
  • the slave device 20 transmits the force tactile sensation of the operation input to the master device 10 to the catheter T according to the operation of the manipulator 13 of the master device 10.
  • the haptic sensation input to the catheter T is transmitted to the master device 10 to accurately move the catheter T by a short distance.
  • the mode of operation for moving the slave device 20 in the master/slave system 1 can be made more appropriate.
  • the master/slave system 1 also includes a grasping/rubbing unit 23d that rotates the catheter T around its axis in the coarse movement mode, and a fine movement rotation actuator 22g that rotates the catheter T around its axis in the fine movement mode.
  • a grasping/rubbing unit 23d that rotates the catheter T around its axis in the coarse movement mode
  • a fine movement rotation actuator 22g that rotates the catheter T around its axis in the fine movement mode.
  • the fine movement execution unit 22 has a configuration example in which the rotation shaft of the fine movement rotation actuator 22g is hollow, and the catheter T is inserted through the hollow rotation shaft.
  • FIG. 19 is a schematic diagram showing another configuration example of the fine movement executing section 22. As shown in FIG. As shown in FIG. 19, the fine movement rotation actuator 22g and the lock mechanism 22e are offset (arranged with their axes shifted), and the rotation of the fine movement rotation actuator 22g is transferred to the lock mechanism 22e via a gear. It is good also as a structure which transmits.
  • the fine movement rotation actuator 22g can be installed with a degree of freedom, and the use of a gear enables a smaller actuator to obtain the required rotation torque. Further, since the actuator can be made smaller, the overall size and weight of the slave device 20 can be reduced.
  • the grasping/rubbing portion 23d is provided to rotate the catheter T during rough movement, but the present invention is not limited to this.
  • the coarse movement executing unit 23 includes a case in which an actuator 23a for straight movement during rough movement, a pair of rollers 23b, and an actuator 23c for roller interval switching are provided inside, and rotates the catheter T during coarse movement.
  • An actuator for rotating the case may rotate the catheter T gripped by the pair of rollers 23b.
  • the haptic transmission control is executed by setting either the linear movement or the rotational movement, but the present invention is not limited to this. That is, in the fine movement mode, the haptic transmission control for the linear movement and the rotational movement may be executed in parallel. In the fine movement mode, the master/slave system 1 determines whether to execute haptic transmission control by setting either linear movement or rotational movement, or to execute haptic transmission control in parallel for linear movement and rotational movement. Depending on the situation in which it is used, it is possible to select a control form that performs a more appropriate operation.
  • the master/slave system 1 configured according to this embodiment includes the master device 10 , the slave device 20 , and the control device 30 .
  • the control device 30 also includes an operation control section 353 and a haptic transmission section 354 .
  • the haptic transmission unit 354 communicates between the master device 10 and the slave device based on an operation input to the master device 10 and an external force input to a device (catheter or guidewire) to be operated that operates according to the operation. 20 to perform haptic transmission control.
  • the operation control unit 353 causes the slave device 20 to execute the set operation of the device to be operated according to the operation input to the master device 10 .
  • the function of executing an action by haptic transmission control between the master device 10 and the slave device 20 and the slave device 20 according to the operation from the master device 10 are set. It is possible to have both functions to perform actions. Therefore, the mode of operation for moving the slave device 20 in the master/slave system 1 can be made more appropriate.
  • the master/slave system 1 includes a lock mechanism 22e, a pair of rollers 23b, and a grip/rub portion 23d.
  • the lock mechanism 22e, the pair of rollers 23b, and the gripping/rubbing unit 23d operate in a first mode (fine movement mode) in which haptic transmission control is performed in response to an operation input to the master device 10; and a second mode (coarse motion mode) in which a set operation is performed without performing haptic transmission control in response to an operation input to .
  • a device to be operated (catheter, guide wire, etc.) has a portion (catheter sheath, guide wire main body, etc.) configured linearly.
  • the haptic transmission unit 354 executes haptic transmission control for each of the forward/backward movement of the device to be operated in the axial direction and the rotational movement around the axis.
  • the equipment to be operated includes a catheter or guidewire inserted into the subject, and slave device 20 axially advances or retracts the catheter or guidewire in response to manipulation of the catheter or guidewire by master device 10. Rotate around.
  • the system is capable of moving the catheter or guide wire over a long distance at high speed and moving the catheter or guide wire accurately over a short distance while transmitting the haptic sensation.
  • a master/slave system 1 capable of performing movement and rotation can be realized.
  • the master/slave system 1 includes an actuator 22g for rotation during fine movement and a grasping/rubbing portion 23d.
  • the micro-movement rotation actuator 22g rotates the device to be operated about the axis while performing haptic transmission control.
  • the grasping/rubbing unit 23d rotates the device to be operated about the axis as a set operation without executing haptic transmission control.
  • the gripping/rubbing unit 23d sandwiches the device to be operated between the lower gripping member 231d and the upper gripping member 238d, and grips the device by rubbing the lower gripping member 231d and the upper gripping member 238d. Rotate the device to be operated around the axis. As a result, even in the second mode in which haptic sensation transmission control is not performed, the catheter or the like can be rotated around the axis.
  • the present invention is not limited to the above-described embodiments, and includes modifications, improvements, and the like within the scope of achieving the object of the present invention.
  • the devices remotely operated by the master/slave system 1 can be various devices.
  • a medical device such as a scope can be targeted.
  • the present invention can be implemented by a control device for controlling the master/slave system 1, and a control system configured by each step executed in the master/slave system 1. It can be implemented as a method or a program executed by a processor to implement the functions of the master/slave system 1 . Further, in the above-described embodiment, the configuration in which the control device 30 is implemented as an independent device has been described as an example. It can be implemented in one or distributed in both of them.
  • the present invention can be carried out by appropriately combining the above-described embodiments and modifications.
  • the catheter T when rotating the catheter T at the time of coarse movement, the catheter T is rotated without transmitting the haptic sensation in response to moving the operation lever 12 of the master device 10 left and right. T may be rotated left and right.
  • the processing for control in the above-described embodiments can be executed by either hardware or software. That is, the master/slave system 1 only needs to have a function capable of executing the above-described processing, and the functional configuration and hardware configuration for realizing this function are not limited to the above example.
  • a program that constitutes the software is installed in the computer from a network or a storage medium.
  • the storage medium that stores the program consists of a removable medium that is distributed separately from the device main body, or a storage medium that is pre-installed in the device main body.
  • Removable media are composed of, for example, a semiconductor memory, a magnetic disk, an optical disk, or a magneto-optical disk.
  • Optical discs are composed of, for example, CD-ROMs (Compact Disk-Read Only Memory), DVDs (Digital Versatile Disks), Blu-ray Discs (registered trademark), and the like.
  • the magneto-optical disk is composed of an MD (Mini-Disk) or the like.
  • the storage medium pre-installed in the device main body is composed of, for example, a ROM (Read Only Memory) storing programs, a hard disk, or a semiconductor memory.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Health & Medical Sciences (AREA)
  • Surgery (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Heart & Thoracic Surgery (AREA)
  • General Health & Medical Sciences (AREA)
  • Biomedical Technology (AREA)
  • Mechanical Engineering (AREA)
  • Medical Informatics (AREA)
  • Molecular Biology (AREA)
  • Animal Behavior & Ethology (AREA)
  • Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
  • Public Health (AREA)
  • Veterinary Medicine (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

【課題】マスタ・スレーブシステムにおいてスレーブの動作形態をより適切なものとする。 【解決手段】マスタ・スレーブシステム1は、マスタ装置10と、スレーブ装置20と、制御装置30と、を備える。また、制御装置30は、操作制御部353と、力触覚伝達部354と、を備える。力触覚伝達部354は、マスタ装置10に入力された操作と当該操作に応じて動作する操作対象となる機器(カテーテル)に入力された外力とに基づいて、マスタ装置10とスレーブ装置20との間で力触覚の伝達制御を実行する。操作制御部353は、マスタ装置10に入力された操作に応じて、操作対象となる機器の設定された動作をスレーブ装置20に実行させる。

Description

マスタ・スレーブシステム、制御装置、制御方法及びプログラム
 本発明は、マスタ・スレーブシステム、制御装置、制御方法及びプログラムに関する。
 従来、マスタスレーブマニピュレータにおいて、スレーブ装置側の動作負荷に応じた操作反力をマスタ装置側の操作具に付与する力帰還制御等のバイラテラル制御を実行する構成が知られている(例えば、特許文献1参照)。
特開昭64-34686号公報
 ところで、マスタ・スレーブシステムをカテーテル等として実現した場合、スレーブを動作させる上で種々の動作形態が求められる場合がある。例えば、スレーブがカテーテルを移動させる構成とし、病変付近に到達するまで高速に長い距離を移動させたり、病変付近において正確に短い距離を移動させたりする等のケースである。
 しかしながら、バイラテラル制御を実行する従来のマスタ・スレーブシステムは、マスタとスレーブとの間で正確に位置あるいは力の伝達を行うことに主眼が置かれており、スレーブを動作させる上で種々の動作形態が求められるという要求に適切に応えるものとはなっていなかった。
 即ち、従来のマスタ・スレーブシステムは、スレーブの動作形態において改善の余地があった。
 本発明の課題は、マスタ・スレーブシステムにおいてスレーブの動作形態をより適切なものとすることである。
 上記課題を解決するため、本発明の一態様に係るマスタ・スレーブシステムは、
 操作者の操作が入力されるマスタ装置と、前記マスタ装置に入力された操作に応じて操作対象となる機器を遠隔的に動作させるスレーブ装置と、を含むマスタ・スレーブシステムであって、
 前記マスタ装置に入力された操作と当該操作に応じて動作する前記操作対象となる機器に入力された外力とに基づいて、前記マスタ装置と前記スレーブ装置との間で力触覚の伝達制御を実行する力触覚制御手段と、
 前記マスタ装置に入力された操作に応じて、前記操作対象となる機器の設定された動作を前記スレーブ装置に実行させる操作制御手段と、
 を備えることを特徴とする。
 本発明によれば、マスタ・スレーブシステムにおいてスレーブの動作形態をより適切なものとすることが可能となる。
本発明の一実施形態に係るマスタ・スレーブシステム1の全体構成を示す模式図である。 スレーブ装置20の構成を示す模式図(斜視図)である。 スレーブ装置20の構成を示す模式図(側面図)である。 ロック機構22eの構成例を示す模式図である。 ローラ間隔切替機構の構成例を示す模式図である。 微動モードにおいて制御装置30で実行される力触覚伝達制御の基本的原理を示す模式図である。 マスタ・スレーブシステム1における制御系統のハードウェア構成を示すブロック図である。 制御装置30を構成する情報処理装置のハードウェア構成を示す模式図である。 マスタ・スレーブシステム1の機能的構成を示すブロック図である。 制御装置30が実行する操作制御処理の流れを説明するフローチャートである。 制御装置30が実行する力触覚伝達処理の流れを説明するフローチャートである。 第2実施形態に係るマスタ・スレーブシステム1の全体構成を示す模式図である。 スレーブ装置20の構成を示す模式図(斜視図)である。 スレーブ装置20の構成を示す模式図(側面図)である。 把持・擦り合わせ部23dの構成例を示す模式図である。 第2実施形態のマスタ・スレーブシステム1における制御系統のハードウェア構成を示すブロック図である。 制御装置30が実行する操作制御処理の流れを説明するフローチャートである。 制御装置30が実行する力触覚伝達処理の流れを説明するフローチャートである。 微動実行部22の他の構成例を示す模式図である。
 以下、本発明の実施形態について、図面を参照して説明する。
[第1実施形態]
[構成]
 図1は、本発明の一実施形態に係るマスタ・スレーブシステム1の全体構成を示す模式図である。
 図1に示すように、本実施形態に係るマスタ・スレーブシステム1は、機械的に分離したマスタ装置10とスレーブ装置20とを含んで構成される。一例として、本実施形態におけるマスタ・スレーブシステム1は、マスタ装置10がユーザにより操作されるマニピュレータ(操作部)の機能を備え、スレーブ装置20が被検体に挿入されるエンドエフェクタを備えたカテーテルシステムを構成するものとする。
 図1において、マスタ・スレーブシステム1は、マスタ装置10と、スレーブ装置20と、制御装置30と、を含んで構成され、マスタ装置10及びスレーブ装置20と、制御装置30とは、ネットワーク40を介して有線または無線通信可能に構成されている。なお、マスタ・スレーブシステム1は、ディスプレイLと、複数のカメラCとを適宜備えることが可能である。カメラCとして、スレーブ装置20が挿入される被検体の外観を撮影するビデオカメラ、あるいは、X線により被検体の内部を撮影するX線カメラ等の種々の撮影装置を用いることができる。また、複数のカメラCによって各種画像を撮影し、これらの画像を表示する複数のディスプレイLを備えることもできる。
 また、マスタ・スレーブシステム1は、エンドエフェクタ及びカテーテルシースを備えるカテーテルTを高速に長い距離移動させるための粗動モードと、エンドエフェクタ及びカテーテルシース(カテーテルT)を正確に短い距離移動させるための微動モードとを実行可能であり、微動モードにおいて、マスタ・スレーブ間で力触覚の伝達を行う。
 マスタ装置10は、粗動モードと微動モードとを切り替える粗動・微動スイッチ11と、粗動モードにおいて直進動作の操作を行うための操作レバー12と、微動モード及び粗動モードにおける回転動作の操作と微動モードにおける直進動作の操作とを行うためのマニピュレータ13と、を備えている。なお、本実施形態において、粗動モードではカテーテルTの直進動作が実行され、微動モードではカテーテルTの直進動作及び回転動作が実行される。
 粗動・微動スイッチ11において設定された信号は、制御装置30に送信される。
 即ち、粗動・微動スイッチ11切り替えにより、マスタ・スレーブシステム1は、カテーテルTの回転動作、粗動時の直進動作、微動時の直進動作のいずれかを行う状態に設定される。
 操作レバー12は、粗動モードにおいて、スレーブ装置20を制御するための操作を受け付ける。本実施形態において、操作レバー12を奥に移動させるとカテーテルTを直進(挿入)させる動作、操作レバー12を手前に移動させるとカテーテルTを後退(引き戻し)させる動作がスレーブ装置20において実行される。なお、操作レバー12に入力された操作の内容(操作レバー12の位置)はセンサによって検出され、検出された操作の内容を示す信号は、制御装置30に送信される。
 マニピュレータ13は、機械的に構成された従来のカテーテルの操作部と同様の形態を有し、微動モードにおいて、機械的に構成された従来のカテーテルに対する操作と同様の操作を受け付ける。マニピュレータ13に対する操作が行われると、マニピュレータ13の操作により移動する可動部(マニピュレータ13の可動部材等)の位置がセンサによって検出され、検出された位置を示す信号は、制御装置30に送信される。また、マニピュレータ13に入力される操作に対して、制御装置30の指示に従って、アクチュエータにより反力が出力される。
 具体的には、マニピュレータ13は、カテーテルTを正確に短い距離移動させる操作(例えば、病変付近で力触覚を伝達する操作等)、カテーテルTを軸回りに回転させる操作(例えば、エンドエフェクタの向きを変化させる操作等)、及び、エンドエフェクタを動作させる操作(例えば、エンドエフェクタがバルーンである場合、これを拡張、収縮させる操作、またエンドエフェクタが鉗子等の場合、これを開閉する操作等)を受け付け、これらの操作に対する反力を付与すると共に、それぞれの操作により移動される可動部の位置を表す情報を検出して制御装置30に送信する。
 スレーブ装置20は、制御装置30の指示に従って、アクチュエータを駆動することにより、マスタ装置10に入力された操作に対応する動作を行い、動作により移動する可動部(アクチュエータの可動子あるいはアクチュエータによって移動されるカテーテルT等)の位置を検出する。スレーブ装置20が動作することにより、スレーブ装置20に対して環境から各種外力が入力する。この結果、スレーブ装置20における可動部の位置は、アクチュエータの出力に対して各種外力が作用した結果を示すものとなる。そして、スレーブ装置20は、検出した可動部の位置を表す情報を制御装置30に送信する。
 図2及び図3は、スレーブ装置20の構成を示す模式図であり、図2は、スレーブ装置20の構成を示す斜視図、図3は、スレーブ装置20の構成を示す側面図である。
 図2及び図3に示すように、スレーブ装置20は、支持体21と、微動実行部22と、粗動実行部23と、を備えている。
 支持体21は、スレーブ装置20全体を支持する部材であり、スレーブ装置20の各部が配置される底部21aと、カテーテルTが患者に向けて送出される側の一端(前端)に形成された側壁21bと、側壁21bと反対側の一端(後端)に形成された収容部21cと、を備えている。なお、側壁21bには、カテーテルTを挿通する貫通穴が形成されている。また、収容部21cは、内部に部品を収容可能な空間を有し、後述する粗動時直進用アクチュエータ23a及びローラ間隔切替用アクチュエータ23cを収容している。
 微動実行部22は、微動モードにおいて、カテーテルTの力触覚を伝達しながらカテーテルTを移動させる機構を構成している。具体的には、微動実行部22は、直動軸22aと、微動時直進用アクチュエータ22bと、支持板22cと、ロック用アクチュエータ22dと、ロック機構22eと、ケース22fと、微動時回転用アクチュエータ22gと、を備えている。
 直動軸22aは、微動時直進用アクチュエータ22bの直動を案内する部材であり、支持体21の側壁21bと収容部21cとの間に設置される。本実施形態において、直動軸22aは、シャフトモータとして構成される微動時直進用アクチュエータ22bのシャフトとして機能し、直動軸22a内部には、円筒型の永久磁石が、N極同士、S極同士を接合された状態で連続的に配置されている。なお、本実施形態において、直動軸22aは、底部21aに固定されたフレーム内に設置されている。
 微動時直進用アクチュエータ22bは、例えばシャフトモータによって構成され、制御装置30の指示に従って、直動軸22a(シャフト)に沿って、可動コイルを備えた移動子(スライダ)を移動させる。なお、微動時直進用アクチュエータ22bの可動部の位置は、リニアエンコーダ207によって検出され、検出された位置を示す信号は、制御装置30に送信される。
 支持板22cは、微動時直進用アクチュエータ22bの移動子の上面に起立して固定された板状部材であり、ロック用アクチュエータ22d及びロック機構22eが収容されたケース22fの一端を回転可能に支持する。
 ロック用アクチュエータ22dは、例えば直動型モータによって構成され、微動モードに設定された場合に、制御装置30の指示に従って、カテーテルTがロックされた状態(即ち、微動実行部22がカテーテルTを把持した状態)となるようにロック機構22eを切り替える。また、ロック用アクチュエータ22dは、粗動モードに設定された場合、制御装置30の指示に従って、カテーテルTがリリースされた状態(即ち、微動実行部22がカテーテルTを把持していない状態)となるようにロック機構22eを切り替える。
 ロック機構22eは、ロック用アクチュエータ22dの動作に従って、カテーテルTをロックした状態と、カテーテルTをリリースした状態とを切り替える。
 図4は、ロック機構22eの構成例を示す模式図である。
 図4に示すように、ロック機構22eは、楔状部材Wと、受け部材Rとを備えている。
 楔状部材Wは、ロッドW1の先端に円錐部W2を備えており、円錐部W2は、半径方向に形成された空隙によって複数の部分に分割されている。また、楔状部材Wは、ロッドW1及び円錐部W2の中心にカテーテルTを挿通する貫通穴を有している。また、受け部材Rは、楔状部材Wの円錐部W2に対応する形状の凹部を有し、凹部の中央には貫通穴が形成されている。ロック用アクチュエータ22dがカテーテルTをロックした状態とする場合、楔状部材Wが受け部材Rに押し付けられた状態となる。すると、楔状部材Wの円錐部W2が受け部材Rの凹部の内周面に押圧され、空隙の間隔が狭まることにより径が縮小する方向に変形し、挿通されているカテーテルTを挟み込む作用が生じる。カテーテルTを挟み込む作用により、ロック機構22eにおいてカテーテルTがロックされた状態(微動実行部22がカテーテルTを把持した状態)となる。
 なお、ロック用アクチュエータ22dがカテーテルTをリリースした状態とする場合、楔状部材Wを受け部材Rから離間させ、円錐部W2がカテーテルTを挟み込む作用を与えない状態とされる。
 ケース22fは、ロック用アクチュエータ22d及びロック機構22eが内部に設置されるケースである。ケース22fは、微動時回転用アクチュエータ22gの出力軸に連結され、微動時の回転動作が行われる場合、ケース22f全体がカテーテルTを把持した状態で、微動時回転用アクチュエータ22gの出力軸と共に回転する。
 微動時回転用アクチュエータ22gは、例えば回転型モータによって構成され、微動モードにおいて、制御装置30の指示に従って、出力軸を回転させる。なお、微動時回転用アクチュエータ22gの可動部の位置(回転角度)は、ロータリーエンコーダ204によって検出され、検出された位置(回転角度)を示す信号は、制御装置30に送信される。
 図2及び図3に戻り、粗動実行部23は、粗動時直進用アクチュエータ23aと、1対のローラ23bと、ローラ間隔切替用アクチュエータ23cと、を備えている。
 粗動時直進用アクチュエータ23aは、例えば回転型モータによって構成され、粗動モードにおいて、制御装置30の指示に従って、1対のローラ23bを回転させる。これにより、粗動モードにおいて、カテーテルTが力触覚の伝達を伴わない動作で、高速に長い距離を移動することが可能となる。
 1対のローラ23bは、互いの外周面を接触させた状態または微小な間隔(カテーテルTの直径より小さい間隔)を空けた状態(カテーテルTを挟持した状態)と、互いの外周面をカテーテルTの直径よりも大きく離間した状態(カテーテルTをリリースした状態)とを切り替え可能に構成されている。また、1対のローラ23bは、カテーテルTを挟持した状態に切り替えられた場合に、各ローラ23bそれぞれの回転軸に設置されたギアG2が粗動時直進用アクチュエータ23aの回転軸に設置されたギアG1と噛み合う位置に配置される(図5参照)。即ち、1対のローラ23bは、カテーテルTを挟持した状態において、粗動時直進用アクチュエータ23aの回転軸が一方向に回転するとカテーテルTを送出し、粗動時直進用アクチュエータ23aの回転軸が逆方向に回転するとカテーテルTを引き戻す動作を実行する。なお、1対のローラ23bの回転軸間の間隔を切り替える機構(以下、「ローラ間隔切替機構」と称する。)の具体例については後述する。
 ローラ間隔切替用アクチュエータ23cは、例えば直動型モータによって構成され、ローラ間隔切替機構を動作させることにより、1対のローラ23bの回転軸間の距離を変化させて、カテーテルTを挟持した状態とカテーテルTをリリースした状態とを切り替える。
 図5は、ローラ間隔切替機構の構成例を示す模式図である。
 図5に示すように、ローラ間隔切替機構は、等長の4つのリンクからなる平行リンクPを有し、平行リンクPの対角に位置する節に1対のローラ23bの回転軸がそれぞれ保持されている。また、平行リンクPの他の1つの節には、ローラ間隔切替用アクチュエータ23cの出力軸が連結されている。なお、各ローラ23bの回転軸は、収容部21cの上面に形成された直動を案内する貫通穴に沿って移動可能となっている。
 このような構成により、ローラ間隔切替用アクチュエータ23cが出力軸を進退させると、平行リンクPの連結角度が変化し、各ローラ23bの回転軸を保持する節が互いに近接する方向または互いに離間する方向に移動する。即ち、ローラ間隔切替用アクチュエータ23cが1対のローラ23bの回転軸を近接させ、各ローラ23bそれぞれの回転軸に設置されたギアG2が粗動時直進用アクチュエータ23aの回転軸に設置されたギアG1と噛み合う状態とすることで、1対のローラ23bがカテーテルTを挟持し、粗動時の直進動作を実行することが可能となる。また、ローラ間隔切替用アクチュエータ23cが1対のローラ23bの回転軸を離間させ、1対のローラ23bの外周面をカテーテルTの直径よりも大きく離間させた状態とすることで、1対のローラ23bがカテーテルTをリリースし、微動モードあるいは粗動時の回転動作を実行することが可能となる。
 図1に戻り、制御装置30は、例えば、パーソナルコンピュータあるいはサーバコンピュータ等の情報処理装置によって構成され、マスタ装置10、スレーブ装置20、ディスプレイL及びカメラCを制御する。例えば、制御装置30は、微動モードにおいて、マスタ装置10及びスレーブ装置20の可動部の位置(ロータリーエンコーダによって検出されるアクチュエータの回転角度あるいはリニアエンコーダによって検出される可動部の進退位置等)を取得し、マスタ装置10及びスレーブ装置20の間で力触覚を伝達するための制御を実行する。また、制御装置30は、粗動モードにおいて、マスタ装置10における操作レバー12の操作の内容を取得し、操作レバー12の操作の内容に応じた動作をスレーブ装置20の粗動実行部23に実行させる。
 本実施形態における制御装置30は、微動モードにおいて、マスタ装置10とスレーブ装置20とをマスタ・スレーブシステムとして動作させる際に、可動部の位置を表す情報(アクチュエータの可動子の位置あるいはアクチュエータによって移動される部材の位置等を表す情報)を基に算出した実空間のパラメータ(入力ベクトル)を、位置と力とを独立して取り扱うことが可能な仮想空間に座標変換(変換行列によって変換)する。即ち、入力ベクトルが、位置と力とが互いに関連する斜交座標系の実空間から、位置と力とが互いに独立した直交座標系の仮想空間に座標変換される。座標変換によって算出されたパラメータは、仮想空間において、入力ベクトルに対応する位置及び力の状態値を表すものとなる。そして、制御装置30は、座標変換後の仮想空間において、入力ベクトルから算出された位置及び力の状態値を、位置及び力の制御(ここでは力触覚の伝達)を行うための位置及び力それぞれの目標値に追従させる演算を行い、演算結果を実空間に戻すための逆変換(変換行列の逆行列による変換)を行う。さらに、制御装置30は、逆変換によって取得された実空間のパラメータ(電流指令値等)に基づいて、各アクチュエータを駆動することにより、マスタ装置10とスレーブ装置20との間で力触覚を伝達するマスタ・スレーブシステムを実現する。
 なお、位置と速度(または加速度)あるいは角度と角速度(または角加速度)は、微積分演算により置換可能なパラメータであるため、位置あるいは角度に関する処理を行う場合、適宜、速度あるいは角速度等に置換することが可能である。
 図6は、微動モードにおいて制御装置30で実行される力触覚伝達制御の基本的原理を示す模式図である。
 図6に示す基本的原理は、可動部の位置を表す情報(可動部の現在位置)を入力として、速度あるいは力の少なくとも一方の領域における演算を行うことにより、アクチュエータの動作を決定するものである。
 即ち、本発明の基本的原理は、制御対象システムSと、機能別力・速度割当変換ブロックFTと、理想力源ブロックFCあるいは理想速度源ブロックPCの少なくとも1つと、逆変換ブロックIFTとを含む制御則として表される。
 制御対象システムSは、アクチュエータを備えるマスタ装置10あるいはスレーブ装置20であり、加速度等に基づいてアクチュエータの制御を行う。ここで、上述したように、加速度、速度及び位置(あるいは角加速度、角速度及び角度)は、微積分によって相互に換算可能な物理量であるため、加速度、速度及び位置(あるいは角加速度、角速度及び角度)のいずれを用いて制御することとしてもよい。ここでは、主として、位置から算出される速度を用いて制御則を表現するものとする。
 機能別力・速度割当変換ブロックFTは、制御対象システムSの機能に応じて設定される速度及び力の領域への制御エネルギーの変換を定義するブロックである。具体的には、機能別力・速度割当変換ブロックFTでは、制御対象システムSの機能の基準となる値(基準値)と、可動部の現在位置とを入力とする座標変換が定義されている。この座標変換は、一般に、基準値及び現在速度を要素とする入力ベクトルを速度の制御目標値を算出するための速度からなる出力ベクトルに変換すると共に、基準値及び現在の力を要素とする入力ベクトルを力の制御目標値を算出するための力からなる出力ベクトルに変換するものである。具体的には、機能別力・速度割当変換ブロックFTにおける座標変換は、次式(1)及び(2)のように一般化して表される。
Figure JPOXMLDOC01-appb-M000001
 ただし、式(1)において、x’1~x’n(nは1以上の整数)は速度の状態値を導出するための速度ベクトルであり、x’a~x’m(mは1以上の整数)は、基準値及びアクチュエータの作用に基づく速度(アクチュエータの可動子の速度またはアクチュエータが移動させる部材の速度)を要素とするベクトル、h1a~hnmは機能を表す変換行列の要素である。また、式(2)において、f’’1~f’’n(nは1以上の整数)は力の状態値を導出するための力ベクトルであり、f’’a~f’’m(mは1以上の整数)は、基準値及びアクチュエータの作用に基づく力(アクチュエータの可動子の力またはアクチュエータが移動させる部材の力)を要素とするベクトルである。
 機能別力・速度割当変換ブロックFTにおける座標変換を、実現する機能に応じて設定することにより、各種動作を実現したり、スケーリングを行ったりすることができる。
 即ち、本発明の基本的原理では、機能別力・速度割当変換ブロックFTにおいて、アクチュエータ単体の変数(実空間上の変数)を、実現する機能を表現するシステム全体の変数群(仮想空間上の変数)に“変換”し、速度の制御エネルギーと力の制御エネルギーとに制御エネルギーを割り当てる。換言すると、本発明の基本的原理では、速度と力とが互いに関連する座標空間から、速度と力とが互いに独立した座標空間に変換した上で、速度及び力の制御に関する演算を行う。そのため、アクチュエータ単体の変数(実空間上の変数)のまま制御を行う場合と比較して、速度の制御エネルギーと力の制御エネルギーとを独立に与えることが可能となっている。
 理想力源ブロックFCは、機能別力・速度割当変換ブロックFTによって定義された座標変換に従って、力の領域における演算を行うブロックである。理想力源ブロックFCにおいては、機能別力・速度割当変換ブロックFTによって定義された座標変換に基づく演算を行う際の力に関する目標値が設定されている。この目標値は、実現される機能に応じて固定値または可変値として設定される。例えば、基準値が示す機能と同様の機能を実現する場合には、目標値としてゼロを設定したり、スケーリングを行う場合には、実現する機能を示す情報を拡大・縮小した値を設定したりできる。
 理想速度源ブロックPCは、機能別力・速度割当変換ブロックFTによって定義された座標変換に従って、速度の領域における演算を行うブロックである。理想速度源ブロックPCにおいては、機能別力・速度割当変換ブロックFTによって定義された座標変換に基づく演算を行う際の速度に関する目標値が設定されている。この目標値は、実現される機能に応じて固定値または可変値として設定される。例えば、基準値が示す機能と同様の機能を実現する場合には、目標値としてゼロを設定したり、スケーリングを行う場合には、実現する機能を示す情報を拡大・縮小した値を設定したりできる。
 逆変換ブロックIFTは、速度及び力の領域の値を制御対象システムSへの入力の領域の値(例えば電圧値または電流値等)に変換するブロックである。
 このような基本的原理により、制御対象システムSのアクチュエータにおける位置の情報が機能別力・速度割当変換ブロックFTに入力されると、位置の情報に基づいて得られる速度及び力の情報を用いて、機能別力・速度割当変換ブロックFTにおいて、機能に応じた位置及び力の領域それぞれの制御則が適用される。そして、理想力源ブロックFCにおいて、機能に応じた力の演算が行われ、理想速度源ブロックPCにおいて、機能に応じた速度の演算が行われ、力及び速度それぞれに制御エネルギーが分配される。
 理想力源ブロックFC及び理想速度源ブロックPCにおける演算結果は、制御対象システムSの制御目標を示す情報となり、これらの演算結果が逆変換ブロックIFTにおいてアクチュエータの入力値とされて、制御対象システムSに入力される。
 その結果、制御対象システムSのアクチュエータは、機能別力・速度割当変換ブロックFTによって定義された機能に従う動作を実行し、目的とする装置の動作が実現される。
 また、スケーリング(力あるいは位置の増幅)を伴う力触覚伝達機能が実現される場合、図6における機能別力・速度割当変換ブロックFTにおける座標変換は、次式(3)及び(4)として表される。
Figure JPOXMLDOC01-appb-M000002
 ただし、式(3)において、x’pは速度の状態値を導出するための速度、x’fは力の状態値に関する速度である。また、x’mは基準値(マスタ装置10からの入力)の速度(マスタ装置10の現在位置の微分値)、x’sはスレーブ装置20の現在の速度(現在位置の微分値)である。また、式(4)において、fpは速度の状態値に関する力、ffは力の状態値を導出するための力である。また、fmは基準値(マスタ装置10からの入力)の力、fsはスレーブ装置20の現在の力である。
 式(3)及び式(4)に示す座標変換とした場合、スレーブ装置20の位置がα倍(αは正数)、スレーブ装置20の力がβ倍(βは正数)されて、マスタ装置10に伝達されることとなる。スレーブ装置20からマスタ装置10に伝達される力のみを増幅する場合には、α=1とすると共に、βの値を目的に応じて設定すればよい。
[ハードウェア構成]
 次に、マスタ・スレーブシステム1における制御系統のハードウェア構成について説明する。
 図7は、マスタ・スレーブシステム1における制御系統のハードウェア構成を示すブロック図である。
 図7に示すように、マスタ・スレーブシステム1は、制御系統のハードウェア構成として、パーソナルコンピュータあるいはサーバコンピュータ等の情報処理装置によって構成される制御装置30と、マスタ装置10の制御ユニット101と、通信ユニット102と、粗動・微動スイッチ11と、操作レバーセンサ103と、回転用アクチュエータ104と、直進用アクチュエータ105と、リニアエンコーダ106と、ロータリーエンコーダ107と、ドライバ108,109と、スレーブ装置20の制御ユニット201と、通信ユニット202と、微動時直進用アクチュエータ22bと、ロック用アクチュエータ22dと、微動時回転用アクチュエータ22gと、粗動時直進用アクチュエータ23aと、ローラ間隔切替用アクチュエータ23cと、リニアエンコーダ203と、ロータリーエンコーダ204,205と、ドライバ206~210と、ディスプレイLと、カメラCと、を備えている。
 マスタ装置10の制御ユニット101は、プロセッサ及びメモリ等を備えるマイクロコンピュータによって構成され、マスタ装置10の動作を制御する。例えば、制御ユニット101は、制御装置30から送信される制御パラメータに従って、マスタ装置10の粗動・微動スイッチ11、直進・回転スイッチ14、回転用アクチュエータ104及び直進用アクチュエータ105の駆動を制御する。
 通信ユニット102は、ネットワーク40を介してマスタ装置10が他の装置との間で行う通信を制御する。
 粗動・微動スイッチ11は、粗動モードと微動モードとを切り替えるスイッチであり、設定された粗動モード及び微動モードのいずれかを示す信号は制御ユニット101に入力される。
 操作レバーセンサ103は、操作レバー12に入力された操作の内容(操作レバー12の位置)を検出し、検出した操作の内容を示す信号を制御ユニット101に出力する。
 回転用アクチュエータ104は、例えば回転型モータによって構成され、制御ユニット101の指示に従って、操作者がマスタ装置10を進退方向に沿う回転軸周りに回転させる操作に対して、反力を付与する。
 直進用アクチュエータ105は、例えば直動型モータによって構成され、制御ユニット101の指示に従って、操作者がエンドエフェクタを動作させるためのレバー(把持部)等に入力した操作に対して、反力を付与する。
 リニアエンコーダ106は、直進用アクチュエータの可動子の位置(直動軸における進退位置)を検出する。
 ロータリーエンコーダ109は、回転用アクチュエータ104の可動子の位置(回転角度)を検出する。
 ドライバ108は、制御ユニット101の指示に従って、回転用アクチュエータ104に駆動電流を出力する。
 ドライバ109は、制御ユニット101の指示に従って、直進用アクチュエータ105に駆動電流を出力する。
 スレーブ装置20の制御ユニット201は、プロセッサ及びメモリ等を備えるマイクロコンピュータによって構成され、スレーブ装置20の動作を制御する。例えば、制御ユニット201は、制御装置30から送信される制御パラメータに従って、スレーブ装置20の微動時直進用アクチュエータ22b、ロック用アクチュエータ22d、微動時回転用アクチュエータ22g、粗動時直進用アクチュエータ23a、ローラ間隔切替用アクチュエータ23cの駆動を制御する。
 通信ユニット202は、ネットワーク40を介してスレーブ装置20が他の装置との間で行う通信を制御する。
 微動時直進用アクチュエータ22bは、例えば直動型モータによって構成され、微動モードにおいて、制御ユニット201の指示に従って、操作者がマスタ装置10に入力した、カテーテルTを血管内に挿入していくために進退させる操作に応じて、スレーブ装置20のカテーテルTを進退させる。
 ロック用アクチュエータ22dは、例えば直動型モータによって構成され、制御ユニット201の指示に従って、微動モードにおいては、カテーテルTがロックされた状態(即ち、微動実行部22がカテーテルTを把持した状態)となるようにロック機構22eを切り替える。また、ロック用アクチュエータ22dは、制御ユニット201の指示に従って、粗動モードにおいては、カテーテルTがリリースされた状態(即ち、微動実行部22がカテーテルTを把持していない状態)となるようにロック機構22eを切り替える。
 微動時回転用アクチュエータ22gは、例えば回転型モータによって構成され、微動モードにおいて、制御ユニット201の指示に従って、操作者がマスタ装置10に入力した操作に応じて、スレーブ装置20のカテーテルTを進退方向に沿う回転軸周りに回転させる。
 粗動時直進用アクチュエータ23aは、例えば回転型モータによって構成され、粗動モードにおいて、制御ユニット201の指示に従って、操作者が操作レバー12に入力した操作に応じて、1対のローラ23bを回転させる。これにより、粗動モードにおいて、カテーテルTが力触覚の伝達を伴わない動作で、高速に長い距離を移動することが可能となる。
 ローラ間隔切替用アクチュエータ23cは、例えば直動型モータによって構成され、制御ユニット201の指示に従って、粗動モードにおいて直進動作が行われる場合に、1対のローラ22bが、互いの外周面を接触させた状態または微小な間隔(カテーテルTの直径より小さい間隔)を空けた状態(カテーテルTを挟持した状態)となるようにローラ間隔切替機構を制御する。また、ローラ間隔切替用アクチュエータ23cは、粗動モードにおいて回転動作が行われる場合、及び、微動モードにおいて、1対のローラ22bが、互いの外周面をカテーテルTの直径よりも大きく離間した状態(カテーテルTをリリースした状態)となるようにローラ間隔切替機構を制御する。即ち、ローラ間隔切替用アクチュエータ23cは、粗動モードにおいて直進動作が行われる場合にのみ、1対のローラ23bがカテーテルTを挟持する状態とし、それ以外においてはカテーテルTをリリースした状態とする。
 リニアエンコーダ203は、微動時直進用アクチュエータ22bの可動子の位置(直動軸における進退位置)を検出する。
 ロータリーエンコーダ204は、微動時回転用アクチュエータ22gの可動子の位置(回転角度)を検出する。
 ロータリーエンコーダ205は、粗動時直進用アクチュエータ23aの可動子の位置(回転角度)を検出する。
 ロータリーエンコーダ212は、昇降用アクチュエータ234dの可動子の位置(回転角度)を検出する。
 ドライバ206は、制御ユニット201の指示に従って、微動時直進用アクチュエータ22bに駆動電流を出力する。
 ドライバ207は、制御ユニット201の指示に従って、ロック用アクチュエータ22dに駆動電流を出力する。
 ドライバ208は、制御ユニット201の指示に従って、微動時回転用アクチュエータ22gに駆動電流を出力する。
 ドライバ209は、制御ユニット201の指示に従って、粗動時直進用アクチュエータ23aに駆動電流を出力する。
 ドライバ210は、制御ユニット201の指示に従って、ローラ間隔切替用アクチュエータ23cに駆動電流を出力する。
 ディスプレイLは、マスタ装置10の操作者が画面を視認できる場所に設置され、制御装置30によって表示を指示された画像(カメラCによって撮影された被検体の可視光画像あるいはX線画像等)を表示する。
 カメラCは、スレーブ装置20がカテーテルTを挿入する被検体を撮影可能な場所に設置され、被検体の画像(可視光画像あるいはX線画像等)を撮影し、撮影した画像を制御装置30に送信する。
 図8は、制御装置30を構成する情報処理装置のハードウェア構成を示す模式図である。
 図8に示すように、制御装置30は、プロセッサ311と、ROM(Read Only Memory)312と、RAM(Random Access Memory)313と、バス314と、入力部315と、出力部316と、記憶部317と、通信部318と、ドライブ319と、を備えている。
 プロセッサ311は、ROM312に記録されているプログラム、または、記憶部317からRAM313にロードされたプログラムに従って各種の処理を実行する。
 RAM313には、プロセッサ311が各種の処理を実行する上において必要なデータ等も適宜記憶される。
 プロセッサ311、ROM312及びRAM313は、バス314を介して相互に接続されている。バス314には、入力部315、出力部316、記憶部317、通信部318及びドライブ319が接続されている。
 入力部315は、各種ボタン等で構成され、指示操作に応じて各種情報を入力する。
 出力部316は、ディスプレイやスピーカ等で構成され、画像や音声を出力する。
 なお、制御装置30がスマートフォンやタブレット端末として構成される場合には、入力部315と出力部316のディスプレイとを重ねて配置し、タッチパネルを構成することとしてもよい。
 記憶部317は、ハードディスクあるいはDRAM(Dynamic Random Access Memory)等で構成され、各サーバで管理される各種データを記憶する。
 通信部318は、ネットワークを介して制御装置30が他の装置との間で行う通信を制御する。
 ドライブ319には、磁気ディスク、光ディスク、光磁気ディスク、あるいは半導体メモリ等よりなる、リムーバブルメディア331が適宜装着される。ドライブ319によってリムーバブルメディア331から読み出されたプログラムは、必要に応じて記憶部317にインストールされる。
[機能的構成]
 次に、マスタ・スレーブシステム1の機能的構成について説明する。
 図9は、マスタ・スレーブシステム1の機能的構成を示すブロック図である。
 図9に示すように、マスタ・スレーブシステム1では、制御装置30が各種処理を実行することにより、プロセッサ311において、モード設定部351と、センサ情報取得部352と、操作制御部353と、力触覚伝達部354と、が機能する。また、記憶部317には、制御パラメータ記憶部371が形成される。
 制御パラメータ記憶部371は、制御装置30がマスタ装置10とスレーブ装置20との間で力触覚を伝達する制御(微動モードの制御)またはマスタ装置10からスレーブ装置20を操作レバー12で操作する制御(粗動モードの制御)において取得された制御パラメータを時系列に記憶する。即ち、制御パラメータ記憶部371には、マスタ・スレーブシステム1の動作の履歴データが記憶される。
 モード設定部351は、操作者の操作に応じて、粗動モードと微動モードとを切り替える。具体的には、モード設定部351は、粗動・微動スイッチ11が微動モードに設定されている場合、マスタ・スレーブシステム1を微動モードに切り替え、粗動・微動スイッチ11が粗動モードに設定されている場合、マスタ・スレーブシステム1を粗動モードに切り替える。
 センサ情報取得部352は、マスタ装置10及びスレーブ装置20に設置された各種センサによって検出された情報(センサ情報)を取得する。例えば、センサ情報取得部302は、リニアエンコーダ106,203及びロータリーエンコーダ107,204,205によって検出された各アクチュエータの可動子の位置(進退位置または回転角度)を示す情報を取得する。また、センサ情報取得部352は、取得したセンサ情報を時系列のデータとして、制御パラメータ記憶部371に記憶する。
 操作制御部353は、マスタ装置10における粗動・微動スイッチ11及び操作レバー12に入力された操作に応じて、スレーブ装置20を制御する。
 具体的には、操作制御部353は、粗動・微動スイッチ11が粗動モードに設定されている場合、ロック用アクチュエータ22dを非ロック状態(カテーテルTをリリースした状態)に制御すると共に、1対のローラ23bがカテーテルTを挟持する状態となるようにローラ間隔切替用アクチュエータ23cを制御する。
 また、操作制御部353は、粗動・微動スイッチ11が微動モードに設定されている場合、ロック用アクチュエータ22dをロック状態(カテーテルTを把持した状態)に制御すると共に、1対のローラ23bがカテーテルTをリリースした状態となるようにローラ間隔切替用アクチュエータ23cを制御する。
 また、操作制御部353は、粗動モードにおいて、マスタ装置10の操作レバー12に入力された操作の内容に応じて、スレーブ装置20のアクチュエータを制御する。
 具体的には、操作制御部353は、操作レバー12が奥に移動された場合、粗動時直進用アクチュエータ23aを一方向に回転させてカテーテルTを直進(挿入)させ、操作レバー12が手前に移動された場合、粗動時直進用アクチュエータ23aを逆方向に回転させてカテーテルTを後退(引き戻し)させる。
 力触覚伝達部354は、微動モードにおいて、図6に示す制御アルゴリズムに従って、マスタ装置10及びスレーブ装置20における力触覚の伝達を制御する。例えば、力触覚伝達部354は、力触覚伝達処理において、マスタ装置10及びスレーブ装置20の対応する動作のためのアクチュエータ間で力触覚を伝達する制御を実行する。このとき、力触覚伝達部354は、増幅率の設定を受け付け、設定された増幅率で、スレーブ装置20において検出された外力あるいは位置等を増幅してマスタ装置10に伝達することとしてもよい。
[動作]
 次に、マスタ・スレーブシステム1の動作を説明する。
[操作制御処理]
 図10は、制御装置30が実行する操作制御処理の流れを説明するフローチャートである。
 操作制御処理は、入力部315あるいは通信部318を介して操作制御処理の実行が指示されることに対応して開始される。
 ステップS1において、操作制御部353は、粗動モードまたは微動モードのいずれに設定されているかの判定を行う。
 粗動モードに設定されていると判定された場合、ステップS1の後、処理はステップS2に移行する。
 一方、微動モードに設定されていると判定された場合、ステップS1の後、処理はステップS5に移行する。
 ステップS2において、操作制御部353は、ロック機構22eが非ロック状態(カテーテルTをリリースした状態)となるようにロック用アクチュエータ22dを制御する。
 ステップS3において、操作制御部353は、1対のローラ23bがカテーテルTを挟持した状態となるようにローラ間隔切替用アクチュエータ23cを制御する。
 ステップS4において、操作制御部353は、マスタ装置10に対する操作の内容に応じてカテーテルTを進退させる。
 ステップS5において、後述する力触覚伝達処理が実行される。
 ステップS4及びステップS5の後、操作制御処理が繰り返される。
[力触覚伝達処理]
 次に、操作制御処理のステップS5において実行される力触覚伝達処理について説明する。
 図11は、制御装置30が実行する力触覚伝達処理の流れを説明するフローチャートである。
 ステップS11において、操作制御部353は、直進動作または回転動作のいずれに設定されているかの判定を行う。
 直進動作に設定されていると判定された場合、ステップS11の後、処理はステップS12に移行する。
 一方、回転動作に設定されていると判定された場合、ステップS11の後、処理はステップS15に移行する。
 ステップS12において、操作制御部353は、ロック機構22eがロック状態(カテーテルTを把持した状態)となるようにロック用アクチュエータ22dを制御する。
 ステップS13において、操作制御部353は、1対のローラ23bがカテーテルTをリリースした状態となるようにローラ間隔切替用アクチュエータ23cを制御する。
 ステップS14において、力触覚伝達部354は、微動時直進用アクチュエータ22bの制御を開始する。
 ステップS14の後、処理はステップS18に移行する。
 ステップS15において、操作制御部353は、ロック機構22eがロック状態(カテーテルTを把持した状態)となるようにロック用アクチュエータ22dを制御する。
 ステップS16において、操作制御部353は、1対のローラ23bがカテーテルTをリリースした状態となるようにローラ間隔切替用アクチュエータ23cを制御する。
 ステップS17において、力触覚伝達部354は、微動時回転用アクチュエータ22bの制御を開始する。
 ステップS18において、センサ情報取得部352は、マスタ装置10及びスレーブ装置20に設置された各種センサによって検出された情報(センサ情報)を取得する。ステップS18において取得されたセンサ情報は、時系列のデータとして制御パラメータ記憶部371に記憶される。
 ステップS19において、力触覚伝達部354は、取得されたセンサ情報を入力として座標変換(例えば、式(1)及び(2)参照)を行い、力触覚の伝達制御(直進または回転)を実行する。
 ステップS20において、操作制御部353は、直進動作及び回転動作の切り替えが行われたか否かの判定を行う。
 直進動作及び回転動作の切り替えが行われていない場合、ステップS20においてNOと判定されて、処理はステップS21に移行する。
 一方、直進動作及び回転動作の切り替えが行われた場合、ステップS20においてYESと判定されて、処理はステップS11に移行する。
 ステップS21において、操作制御部353は、微動モードの終了が指示されたか否か(即ち、粗動モードへの切り替え操作が行われたか否か)の判定を行う。
 微動モードの終了が指示されていない場合、ステップS21において、NOと判定されて、処理はステップS18に移行する。
 一方、微動モードの終了が指示された場合、ステップS21において、YESと判定されて、処理は操作制御処理に戻る。
 以上のように、本実施形態に係るマスタ・スレーブシステム1は、カテーテルTとマスタ装置10との間で力触覚を伝達しながら、カテーテルTを正確に短い距離移動させる微動モードと、カテーテルTとマスタ装置10との間で力触覚を伝達することなく、カテーテルTを高速に長い距離移動させる粗動モードとを実行可能である。そして、マスタ・スレーブシステム1が粗動モードに設定された場合、マスタ装置10の操作レバー12に対する操作に応じて、スレーブ装置20は、カテーテルTを高速に長い距離移動させる。また、マスタ・スレーブシステム1が微動モードに設定された場合、マスタ装置10のマニピュレータ13に対する操作に応じて、スレーブ装置20は、マスタ装置10に入力された操作の力触覚をカテーテルTに伝達すると共に、カテーテルTに入力した力触覚をマスタ装置10に伝達して、カテーテルTを正確に短い距離移動させる。
 これにより、マスタ・スレーブシステム1においてスレーブ装置20を移動させる動作形態をより適切なものとすることができる。
 また、マスタ・スレーブシステム1は、カテーテルTを軸周りに回転させる微動時回転用アクチュエータ22gを備えている。
 これにより、カテーテルTの微動時において、力触覚の伝達を行いながら、カテーテルTを回転させることができる。
 したがって、カテーテルTを被検体の体内に挿入する際に、カテーテルTをより柔軟に動かしながら、適切な動作を行うことが可能となる。
[第2実施形態]
 次に、本発明の第2実施形態について説明する。
 第1実施形態においては、カテーテルTを進退方向に沿う回転軸周りに回転させる場合、カテーテルTがロックされた状態(即ち、微動実行部22がカテーテルTを把持した状態)とし、微動実行部22の微動時回転用アクチュエータ22gによって回転させるものとした。
 これに対し、粗動時における回転動作と、微動時における回転動作とを異なる機構によって実行することが可能である。
[構成]
 図12は、本発明の第2実施形態に係るマスタ・スレーブシステム1の全体構成を示す模式図である。
 図12において、本実施形態に係るマスタ・スレーブシステム1は、図1に示す第1実施形態のマスタ・スレーブシステム1に対し、マスタ装置10及びスレーブ装置20の構成が異なっている。
 マスタ装置10は、粗動モードと微動モードとを切り替える粗動・微動スイッチ11と、粗動モードにおいて直進動作の操作を行うための操作レバー12と、微動モード及び粗動モードにおける回転動作の操作と微動モードにおける直進動作の操作を行うためのマニピュレータ13と、カテーテルTの直進動作(挿入及び引き戻し動作)と回転動作(軸周りの回転動作)とを切り替える直進・回転スイッチ14と、を備えている。
 粗動・微動スイッチ11及び直進・回転スイッチ14において設定された信号は、制御装置30に送信される。
 即ち、粗動・微動スイッチ11及び直進・回転スイッチ14の切り替えにより、マスタ・スレーブシステム1は、粗動時の直進動作、粗動時の回転動作、微動時の直進動作及び微動時の回転動作のいずれかを行う状態に設定される。
 操作レバー12は、粗動モードにおいて、スレーブ装置20を制御するための操作を受け付ける。本実施形態において、操作レバー12を奥に移動させるとカテーテルTを直進(挿入)させる動作、操作レバー12を手前に移動させるとカテーテルTを後退(引き戻し)させる動作、操作レバー12を右に移動させるとカテーテルTを軸周りに右回転させる動作、操作レバー12を左に移動させるとカテーテルTを軸周りに左回転させる動作がスレーブ装置20において実行される。なお、操作レバー12に入力された操作の内容(操作レバー12の位置)はセンサによって検出され、検出された操作の内容を示す信号は、制御装置30に送信される。
 マニピュレータ13の構成は、図1に示す第1実施形態のマニピュレータ13と同様である。
 スレーブ装置20は、制御装置30の指示に従って、アクチュエータを駆動することにより、マスタ装置10に入力された操作に対応する動作を行い、動作により移動する可動部(アクチュエータの可動子あるいはアクチュエータによって移動されるカテーテルT等)の位置を検出する。スレーブ装置20が動作することにより、スレーブ装置20に対して環境から各種外力が入力する。この結果、スレーブ装置20における可動部の位置は、アクチュエータの出力に対して各種外力が作用した結果を示すものとなる。そして、スレーブ装置20は、検出した可動部の位置を表す情報を制御装置30に送信する。
 図13及び図14は、スレーブ装置20の構成を示す模式図であり、図13は、スレーブ装置20の構成を示す斜視図、図14は、スレーブ装置20の構成を示す側面図である。
 図13及び図14に示すように、スレーブ装置20は、支持体21と、微動実行部22と、粗動実行部23と、を備えている。
 支持体21は、スレーブ装置20全体を支持する部材であり、スレーブ装置20の各部が配置される底部21aと、カテーテルTが患者に向けて送出される側の一端(前端)に形成された側壁21bと、側壁21bと反対側の一端(後端)に形成された収容部21cと、を備えている。なお、側壁21bには、カテーテルTを挿通する貫通穴が形成されている。また、収容部21cは、内部に部品を収容可能な空間を有し、後述する粗動時直進用アクチュエータ23a及びローラ間隔切替用アクチュエータ23cを収容している。
 微動実行部22は、微動モードにおいて、カテーテルTの力触覚を伝達しながらカテーテルTを移動させる機構を構成している。具体的には、微動実行部22は、直動軸22aと、微動時直進用アクチュエータ22bと、支持板22cと、ロック用アクチュエータ22dと、ロック機構22eと、ケース22fと、微動時回転用アクチュエータ22gと、を備えている。
 直動軸22aは、微動時直進用アクチュエータ22bの直動を案内する部材であり、支持体21の側壁21bと収容部21cとの間に設置される。本実施形態において、直動軸22aは、シャフトモータとして構成される微動時直進用アクチュエータ22bのシャフトとして機能し、直動軸22a内部には、円筒型の永久磁石が、N極同士、S極同士を接合された状態で連続的に配置されている。
 微動時直進用アクチュエータ22bは、例えばシャフトモータによって構成され、制御装置30の指示に従って、直動軸22a(シャフト)に沿って、可動コイルを備えた移動子(スライダ)を移動させる。なお、微動時直進用アクチュエータ22bの可動部の位置は、リニアエンコーダ203によって検出され、検出された位置を示す信号は、制御装置30に送信される。
 支持板22cは、微動時直進用アクチュエータ22bの移動子の上面に起立して固定された板状部材であり、ロック用アクチュエータ22d及びロック機構22eが収容されたケース22fの一端を回転可能に支持する。
 ロック用アクチュエータ22dは、例えば直動型モータによって構成され、微動モードに設定された場合に、制御装置30の指示に従って、カテーテルTがロックされた状態(即ち、微動実行部22がカテーテルTを把持した状態)となるようにロック機構22eを切り替える。また、ロック用アクチュエータ22dは、粗動モードに設定された場合、制御装置30の指示に従って、カテーテルTがリリースされた状態(即ち、微動実行部22がカテーテルTを把持していない状態)となるようにロック機構22eを切り替える。
 ロック機構22eは、ロック用アクチュエータ22dの動作に従って、カテーテルTをロックした状態と、カテーテルTをリリースした状態とを切り替える。
 なお、本実施形態のロック機構22eにおいても、図4に示す構成例とすることができる。
 ケース22fは、ロック用アクチュエータ22d及びロック機構22eが内部に設置されるケースである。ケース22fは、微動時回転用アクチュエータ22gの出力軸に連結され、微動時の回転動作が行われる場合、ケース22f全体がカテーテルTを把持した状態で、微動時回転用アクチュエータ22gの出力軸と共に回転する。
 微動時回転用アクチュエータ22gは、例えば回転型モータによって構成され、微動モードにおいて、制御装置30の指示に従って、出力軸を回転させる。なお、微動時回転用アクチュエータ22gの可動部の位置(回転角度)は、ロータリーエンコーダ204によって検出され、検出された位置(回転角度)を示す信号は、制御装置30に送信される。
 粗動実行部23は、粗動時直進用アクチュエータ23aと、1対のローラ23bと、ローラ間隔切替用アクチュエータ23cと、把持・擦り合わせ部23dと、を備えている。
 これらのうち、粗動時直進用アクチュエータ23a、1対のローラ23b及びローラ間隔切替用アクチュエータ23cの構成は、図2及び図3に示す第1実施形態の構成と同様である。
 把持・擦り合わせ部23dは、粗動モードにおいて、カテーテルTを把持して軸周りに回転させたり、進退されるカテーテルTの乱雑な動きを抑制するようカテーテルT周囲の空間(主として上下方向の空間)を制限したりする。
 図15は、把持・擦り合わせ部23dの構成例を示す模式図である。
 図15に示すように、把持・擦り合わせ部23dは、下側把持部材231dと、昇降部材232dと、ラックギア233dと、昇降用アクチュエータ234dと、ピニオンギア235dと、擦り合わせ用アクチュエータ236dと、ガイド237dと、上側把持部材238dと、ケース239dと、を備えている。なお、図15においては、説明の便宜のため、ケース239dを透視して把持・擦り合わせ部23dの内部構造を示している。
 下側把持部材231dは、収容部21cの側面に固定された板状の支持部231d-1と、支持部231d-1の上端からケース239dの外側に向かって収容部21cの上面に平行(水平)に延びる天板部231d-2と、を備えている。天板部231d-2は、粗動モードにおいてカテーテルTが軸周りに回転される際に、上側把持部材238dとの間でカテーテルTを把持し、カテーテルTを擦り合わせる動作の基台となる。そのため、天板部231d-2の上面は、カテーテルTに対して一定の摩擦を与える形状(微小な凹凸が形成された形状等)となっている。なお、天板部231d-2の上面の形状によってカテーテルTに摩擦を与えることの他、天板部231d-2の上面にカテーテルTを擦り合わせるための摩擦を与える素材(ゴムまたはシリコーン等)からなる部材を設置することとしてもよい。
 昇降部材232dは、下側把持部材231dの支持部231d-1に接触して上下方向に摺動する板状の摺動部232d-1と、摺動部232d-1の上端からケース239dの内側に向かって水平に延びる天板部232d-2と、を備えている。摺動部232d-1は、下側把持部材231dの支持部231d-1と接触する面の裏面側に、ラックギア233dを備えている。また、天板部232d-2の上面には、後述するように、擦り合わせ用アクチュエータ236d、ガイド237d及び上側把持部材238dが設置される。
 ラックギア233dは、昇降部材232dの摺動部232d-1において、下側把持部材231dの支持部231d-1と接触する面の裏面側に上下方向に平歯が配列された状態で設置されている。また、ラックギア233dには、昇降用アクチュエータ234dによって回転されるピニオンギア235dが噛み合っている。
 昇降用アクチュエータ234dは、例えば回転型モータによって構成される。昇降用アクチュエータ234dは、出力軸に設置されたピニオンギア235dを回転させ、ピニオンギア235dと噛み合うラックギア233dを上下方向に移動させることにより、昇降部材232dを昇降させる。
 ピニオンギア235dは、ラックギア233dと噛み合い、昇降用アクチュエータ234dの出力軸と一体に回転する。即ち、ピニオンギア235dは、昇降用アクチュエータ234dの駆動力を昇降部材232dに伝達する。
 擦り合わせ用アクチュエータ236dは、例えば直動型モータによって構成され、昇降部材232dの天板部232d-2の上面に設置される。擦り合わせ用アクチュエータ236dは、粗動モードにおいてカテーテルTが軸周りに回転される際に、出力軸に連結された上側把持部材238dを下側把持部材231dの天板部231d-2に平行に進退させる。
 ガイド237dは、擦り合わせ用アクチュエータ236dの動きを案内する部材であり、昇降部材232dの天板部232d-2の上面に設置される。具体的には、ガイド237dは、上側把持部材238dが擦り合わせ用アクチュエータ236dによって移動される際に、上側把持部材238dが下側把持部材231dの天板部231d-2と平行に移動するように案内する。
 上側把持部材238dは、擦り合わせ用アクチュエータ236dの出力軸に連結され、下側把持部材231dの天板部231d-2と対向するように設置されている。また、上側把持部材238dは、擦り合わせ用アクチュエータ236dによって、下側把持部材231dの天板部231d-2と平行に進退される。擦り合わせ用アクチュエータ236dは、昇降部材232dの天板部232d-2に設置されていることから、上側把持部材238dは、昇降用アクチュエータ234dによって昇降可能であると共に、擦り合わせ用アクチュエータ236dによって下側把持部材231dの天板部231d-2と平行に進退可能となっている。
 ケース239dは、把持・擦り合わせ部23dの各構成部を収容するケースであり、収容部21cの側面に設置されていると共に、収容部21cの上面よりも上方に延びる側面(即ち、収容部21cの上面を臨む側面)に、下側把持部材231dの天板部231d-2及び上側把持部材238dがケース239dから突出する開口部239d-1を備えている。なお、上側把持部材238dは、昇降用アクチュエータ234dによって昇降されると、開口部239d-1内を上下方向に移動する。
 図12に戻り、制御装置30は、例えば、パーソナルコンピュータあるいはサーバコンピュータ等の情報処理装置によって構成され、マスタ装置10、スレーブ装置20、ディスプレイL及びカメラCを制御する。例えば、制御装置30は、微動モードにおいて、マスタ装置10及びスレーブ装置20の可動部の位置(ロータリーエンコーダによって検出されるアクチュエータの回転角度あるいはリニアエンコーダによって検出される可動部の進退位置等)を取得し、マスタ装置10及びスレーブ装置20の間で力触覚を伝達するための制御を実行する。また、制御装置30は、粗動モードにおいて、マスタ装置10における操作レバー12の操作の内容を取得し、操作レバー12の操作の内容に応じた動作をスレーブ装置20の粗動実行部23に実行させる。
 微動モードにおいて、本実施形態における制御装置30が実行する力触覚伝達制御の基本的原理は、図6に示す第1実施形態の基本的原理と同様である。
[ハードウェア構成]
 次に、本実施形態のマスタ・スレーブシステム1における制御系統のハードウェア構成について説明する。
 図16は、本実施形態のマスタ・スレーブシステム1における制御系統のハードウェア構成を示すブロック図である。
 図16に示すように、マスタ・スレーブシステム1は、制御系統のハードウェア構成として、パーソナルコンピュータあるいはサーバコンピュータ等の情報処理装置によって構成される制御装置30と、マスタ装置10の制御ユニット101と、通信ユニット102と、粗動・微動スイッチ11と、操作レバーセンサ103と、回転用アクチュエータ104と、直進用アクチュエータ105と、リニアエンコーダ106と、ロータリーエンコーダ107と、ドライバ108,109と、直進・回転スイッチ14と、スレーブ装置20の制御ユニット201と、通信ユニット202と、微動時直進用アクチュエータ22bと、ロック用アクチュエータ22dと、微動時回転用アクチュエータ22gと、粗動時直進用アクチュエータ23aと、ローラ間隔切替用アクチュエータ23cと、昇降用アクチュエータ234dと、擦り合わせ用アクチュエータ236dと、リニアエンコーダ203,211と、ロータリーエンコーダ204,205,212と、ドライバ206~210,213,214と、ディスプレイLと、カメラCと、を備えている。
 マスタ装置10の制御ユニット101は、プロセッサ及びメモリ等を備えるマイクロコンピュータによって構成され、マスタ装置10の動作を制御する。例えば、制御ユニット101は、制御装置30から送信される制御パラメータに従って、マスタ装置10の粗動・微動スイッチ11、直進・回転スイッチ14、回転用アクチュエータ104及び直進用アクチュエータ105の駆動を制御する。
 通信ユニット102は、ネットワーク40を介してマスタ装置10が他の装置との間で行う通信を制御する。
 粗動・微動スイッチ11は、粗動モードと微動モードとを切り替えるスイッチであり、設定された粗動モード及び微動モードのいずれかを示す信号は制御ユニット101に入力される。
 操作レバーセンサ103は、操作レバー12に入力された操作の内容(操作レバー12の位置)を検出し、検出した操作の内容を示す信号を制御ユニット101に出力する。
 回転用アクチュエータ104は、例えば回転型モータによって構成され、制御ユニット101の指示に従って、操作者がマスタ装置10を進退方向に沿う回転軸周りに回転させる操作に対して、反力を付与する。
 直進用アクチュエータ105は、例えば直動型モータによって構成され、制御ユニット101の指示に従って、操作者がエンドエフェクタを動作させるためのレバー(把持部)等に入力した操作に対して、反力を付与する。
 リニアエンコーダ106は、直進用アクチュエータの可動子の位置(直動軸における進退位置)を検出する。
 ロータリーエンコーダ107は、回転用アクチュエータ104の可動子の位置(回転角度)を検出する。
 ドライバ108は、制御ユニット101の指示に従って、回転用アクチュエータ104に駆動電流を出力する。
 ドライバ109は、制御ユニット101の指示に従って、直進用アクチュエータ105に駆動電流を出力する。
 直進・回転スイッチ14は、カテーテルTの直進動作と回転動作とを切り替えるスイッチであり、設定された直進動作及び回転動作のいずれかを示す信号は制御ユニット101に入力される。
 スレーブ装置20の制御ユニット201は、プロセッサ及びメモリ等を備えるマイクロコンピュータによって構成され、スレーブ装置20の動作を制御する。例えば、制御ユニット201は、制御装置30から送信される制御パラメータに従って、スレーブ装置20の微動時直進用アクチュエータ22b、ロック用アクチュエータ22d、微動時回転用アクチュエータ22g、粗動時直進用アクチュエータ23a、ローラ間隔切替用アクチュエータ23c、昇降用アクチュエータ234d及び擦り合わせ用アクチュエータ236dの駆動を制御する。
 通信ユニット202は、ネットワーク40を介してスレーブ装置20が他の装置との間で行う通信を制御する。
 微動時直進用アクチュエータ22bは、例えば直動型モータによって構成され、微動モードにおいて、制御ユニット201の指示に従って、操作者がマスタ装置10に入力した、カテーテルTを血管内に挿入していくために進退させる操作に応じて、スレーブ装置20のカテーテルTを進退させる。
 ロック用アクチュエータ22dは、例えば直動型モータによって構成され、制御ユニット201の指示に従って、微動モードにおいては、カテーテルTがロックされた状態(即ち、微動実行部22がカテーテルTを把持した状態)となるようにロック機構22eを切り替える。また、ロック用アクチュエータ22dは、制御ユニット201の指示に従って、粗動モードにおいては、カテーテルTがリリースされた状態(即ち、微動実行部22がカテーテルTを把持していない状態)となるようにロック機構22eを切り替える。
 微動時回転用アクチュエータ22gは、例えば回転型モータによって構成され、微動モードにおいて、制御ユニット201の指示に従って、操作者がマスタ装置10に入力した操作に応じて、スレーブ装置20のカテーテルTを進退方向に沿う回転軸周りに回転させる。
 粗動時直進用アクチュエータ23aは、例えば回転型モータによって構成され、粗動モードにおいて、制御ユニット201の指示に従って、操作者が操作レバー12に入力した操作に応じて、1対のローラ23bを回転させる。これにより、粗動モードにおいて、カテーテルTが力触覚の伝達を伴わない動作で、高速に長い距離を移動することが可能となる。
 ローラ間隔切替用アクチュエータ23cは、例えば直動型モータによって構成され、制御ユニット201の指示に従って、粗動モードにおいて直進動作が行われる場合に、1対のローラ22bが、互いの外周面を接触させた状態または微小な間隔(カテーテルTの直径より小さい間隔)を空けた状態(カテーテルTを挟持した状態)となるようにローラ間隔切替機構を制御する。また、ローラ間隔切替用アクチュエータ23cは、粗動モードにおいて回転動作が行われる場合、及び、微動モードにおいて、1対のローラ22bが、互いの外周面をカテーテルTの直径よりも大きく離間した状態(カテーテルTをリリースした状態)となるようにローラ間隔切替機構を制御する。即ち、ローラ間隔切替用アクチュエータ23cは、粗動モードにおいて直進動作が行われる場合にのみ、1対のローラ23bがカテーテルTを挟持する状態とし、それ以外においてはカテーテルTをリリースした状態とする。
 昇降用アクチュエータ234dは、例えば回転型モータによって構成される。昇降用アクチュエータ234dは、出力軸に設置されたピニオンギア235dを回転させ、ピニオンギア235dと噛み合うラックギア233dを上下方向に移動させることにより、昇降部材232dを昇降させる。このような機構により、昇降用アクチュエータ234dは、微動モードにおいては、昇降部材232dを上方に移動させ、カテーテルTがリリースされた状態とする。ただし、微動モードにおいて、昇降用アクチュエータ234dは、下側把持部材231dの天板部231d-2と上側把持部材238dとの距離が、カテーテルTの直径より長く、進退されるカテーテルTの乱雑な動きを抑制する程度となるように、昇降部材232dを移動させる。また、粗動モードにおいて、昇降用アクチュエータ234dは、下側把持部材231dの天板部231d-2と上側把持部材238dとがカテーテルTを把持するように、昇降部材232dを下方に移動させる。
 擦り合わせ用アクチュエータ236dは、例えば直動型モータによって構成され、粗動モードにおいて、制御ユニット201の指示に従って、操作者が操作レバー12に入力した操作に応じて、出力軸に連結された上側把持部材238dを下側把持部材231dの天板部231d-2に平行に進退させる。
 リニアエンコーダ203は、微動時直進用アクチュエータ22bの可動子の位置(直動軸における進退位置)を検出する。
 リニアエンコーダ211は、擦り合わせ用アクチュエータ236dの可動子の位置(直動軸における進退位置)を検出する。
 ロータリーエンコーダ204は、微動時回転用アクチュエータ22gの可動子の位置(回転角度)を検出する。
 ロータリーエンコーダ205は、粗動時直進用アクチュエータ23aの可動子の位置(回転角度)を検出する。
 ロータリーエンコーダ212は、昇降用アクチュエータ234dの可動子の位置(回転角度)を検出する。
 ドライバ206は、制御ユニット201の指示に従って、微動時直進用アクチュエータ22bに駆動電流を出力する。
 ドライバ207は、制御ユニット201の指示に従って、ロック用アクチュエータ22dに駆動電流を出力する。
 ドライバ208は、制御ユニット201の指示に従って、微動時回転用アクチュエータ22gに駆動電流を出力する。
 ドライバ209は、制御ユニット201の指示に従って、粗動時直進用アクチュエータ23aに駆動電流を出力する。
 ドライバ210は、制御ユニット201の指示に従って、ローラ間隔切替用アクチュエータ23cに駆動電流を出力する。
 ドライバ213は、制御ユニット201の指示に従って、昇降用アクチュエータ234dに駆動電流を出力する。
 ドライバ214は、制御ユニット201の指示に従って、擦り合わせ用アクチュエータ236dに駆動電流を出力する。
 ディスプレイLは、マスタ装置10の操作者が画面を視認できる場所に設置され、制御装置30によって表示を指示された画像(カメラCによって撮影された被検体の可視光画像あるいはX線画像等)を表示する。
 カメラCは、スレーブ装置20がカテーテルTを挿入する被検体を撮影可能な場所に設置され、被検体の画像(可視光画像あるいはX線画像等)を撮影し、撮影した画像を制御装置30に送信する。
[機能的構成]
 次に、マスタ・スレーブシステム1の機能的構成について説明する。
 本実施形態におけるマスタ・スレーブシステム1の機能的構成は、図9に示す第1実施形態の機能的構成と同様である。
 ただし、本実施形態におけるマスタ・スレーブシステム1の機能的構成では、センサ情報取得部352及び操作制御部353の具体的な構成が第1実施形態と異なっている。
 センサ情報取得部352は、マスタ装置10及びスレーブ装置20に設置された各種センサによって検出された情報(センサ情報)を取得する。例えば、センサ情報取得部302は、リニアエンコーダ106,203,211及びロータリーエンコーダ107,204,205,212によって検出された各アクチュエータの可動子の位置(進退位置または回転角度)を示す情報を取得する。また、センサ情報取得部352は、取得したセンサ情報を時系列のデータとして、制御パラメータ記憶部371に記憶する。
 操作制御部353は、マスタ装置10における粗動・微動スイッチ11、直進・回転スイッチ14及び操作レバー12に入力された操作に応じて、スレーブ装置20を制御する。
 具体的には、操作制御部353は、粗動・微動スイッチ11が粗動モードに設定され、直進・回転スイッチ14が直進動作に設定されている場合、ロック用アクチュエータ22dを非ロック状態(カテーテルTをリリースした状態)に制御すると共に、1対のローラ23bがカテーテルTを挟持する状態となるようにローラ間隔切替用アクチュエータ23cを制御し、把持・擦り合わせ部23dにおいて、下側把持部材231dの天板部231d-2と上側把持部材238dとの距離が、カテーテルTの直径より長く、進退されるカテーテルTの乱雑な動きを抑制する程度となるように、昇降用アクチュエータ234dによって昇降部材232dを移動させる(即ち、カテーテルTをリリースした状態とする)。
 また、操作制御部353は、粗動・微動スイッチ11が粗動モードに設定され、直進・回転スイッチ14が回転動作に設定されている場合、ロック用アクチュエータ22dを非ロック状態(カテーテルTをリリースした状態)に制御すると共に、1対のローラ23bがカテーテルTをリリースした状態となるようにローラ間隔切替用アクチュエータ23cを制御し、把持・擦り合わせ部23dにおいて、下側把持部材231dの天板部231d-2と上側把持部材238dとがカテーテルTを把持する状態となるように、昇降用アクチュエータ234dによって昇降部材232dを移動させる。
 また、操作制御部353は、粗動・微動スイッチ11が微動モードに設定され、直進・回転スイッチ14が直進動作に設定されている場合、ロック用アクチュエータ22dをロック状態(カテーテルTを把持した状態)に制御すると共に、1対のローラ23bがカテーテルTをリリースした状態となるようにローラ間隔切替用アクチュエータ23cを制御し、把持・擦り合わせ部23dにおいて、下側把持部材231dの天板部231d-2と上側把持部材238dとの距離が、カテーテルTの直径より長く、進退されるカテーテルTの乱雑な動きを抑制する程度となるように、昇降用アクチュエータ234dによって昇降部材232dを移動させる(即ち、カテーテルTをリリースした状態とする)。
 また、操作制御部353は、粗動・微動スイッチ11が微動モードに設定され、直進・回転スイッチ14が回転動作に設定されている場合、ロック用アクチュエータ22dをロック状態(カテーテルTを把持した状態)に制御すると共に、1対のローラ23bがカテーテルTをリリースした状態となるようにローラ間隔切替用アクチュエータ23cを制御し、把持・擦り合わせ部23dにおいて、下側把持部材231dの天板部231d-2と上側把持部材238dとの距離が、カテーテルTの直径より長く、進退されるカテーテルTの乱雑な動きを抑制する程度となるように、昇降用アクチュエータ234dによって昇降部材232dを移動させる(即ち、カテーテルTをリリースした状態とする)。
 また、操作制御部353は、粗動モードにおいて、マスタ装置10の操作レバー12に入力された操作の内容に応じて、スレーブ装置20のアクチュエータを制御する。
 具体的には、操作制御部353は、操作レバー12が奥に移動された場合、粗動時直進用アクチュエータ23aを一方向に回転させてカテーテルTを直進(挿入)させ、操作レバー12が手前に移動された場合、粗動時直進用アクチュエータ23aを逆方向に回転させてカテーテルTを後退(引き戻し)させる。また、操作制御部353は、粗動モードにおいて、操作レバー12が右に移動された場合、擦り合わせ用アクチュエータ236dを一方向に移動させてカテーテルTを軸周りに右回転させ、操作レバー12が左に移動された場合、擦り合わせ用アクチュエータ236dを逆方向に移動させてカテーテルTを軸周りに左回転させる。
[動作]
 次に、マスタ・スレーブシステム1の動作を説明する。
[操作制御処理]
 図17は、制御装置30が実行する操作制御処理の流れを説明するフローチャートである。
 操作制御処理は、入力部315あるいは通信部318を介して操作制御処理の実行が指示されることに対応して開始される。
 ステップS21において、操作制御部353は、粗動モードまたは微動モードのいずれに設定されているかの判定を行う。
 粗動モードに設定されていると判定された場合、ステップS21の後、処理はステップS22に移行する。
 一方、微動モードに設定されていると判定された場合、ステップS21の後、処理はステップS31に移行する。
 ステップS22において、操作制御部353は、直進動作または回転動作のいずれに設定されているかの判定を行う。
 直進動作に設定されていると判定された場合、ステップS22の後、処理はステップS23に移行する。
 一方、回転動作に設定されていると判定された場合、ステップS22の後、処理はステップS27に移行する。
 ステップS23において、操作制御部353は、ロック機構22eが非ロック状態(カテーテルTをリリースした状態)となるようにロック用アクチュエータ22dを制御する。
 ステップS24において、操作制御部353は、1対のローラ23bがカテーテルTを挟持した状態となるようにローラ間隔切替用アクチュエータ23cを制御する。
 ステップS25において、操作制御部353は、把持・擦り合わせ部23dがカテーテルTをリリースした状態となるよう昇降用アクチュエータ234dを制御する。
 ステップS26において、操作制御部353は、マスタ装置10に対する操作の内容に応じてカテーテルTを進退させる。
 ステップS27において、操作制御部353は、ロック機構22eが非ロック状態(カテーテルTをリリースした状態)となるようにロック用アクチュエータ22dを制御する。
 ステップS28において、操作制御部353は、1対のローラ23bがカテーテルTをリリースした状態となるようにローラ間隔切替用アクチュエータ23cを制御する。
 ステップS29において、操作制御部353は、把持・擦り合わせ部23dがカテーテルTを把持した状態となるよう昇降用アクチュエータ234dを制御する。
 ステップS30において、操作制御部353は、マスタ装置10に対する操作の内容に応じてカテーテルTを軸周りに回転させる。
 ステップS31において、後述する力触覚伝達処理が実行される。
 ステップS26、ステップS30及びステップS31の後、操作制御処理が繰り返される。
[力触覚伝達処理]
 次に、操作制御処理のステップS31において実行される力触覚伝達処理について説明する。
 図18は、制御装置30が実行する力触覚伝達処理の流れを説明するフローチャートである。
 ステップS41において、操作制御部353は、直進動作または回転動作のいずれに設定されているかの判定を行う。
 直進動作に設定されていると判定された場合、ステップS41の後、処理はステップS42に移行する。
 一方、回転動作に設定されていると判定された場合、ステップS41の後、処理はステップS46に移行する。
 ステップS42において、操作制御部353は、ロック機構22eがロック状態(カテーテルTを把持した状態)となるようにロック用アクチュエータ22dを制御する。
 ステップS43において、操作制御部353は、1対のローラ23bがカテーテルTをリリースした状態となるようにローラ間隔切替用アクチュエータ23cを制御する。
 ステップS44において、操作制御部353は、把持・擦り合わせ部23dがカテーテルTをリリースした状態となるよう昇降用アクチュエータ234dを制御する。
 ステップS45において、力触覚伝達部354は、微動時直進用アクチュエータ22bの制御を開始する。
 ステップS45の後、処理はステップS50に移行する。
 ステップS46において、操作制御部353は、ロック機構22eがロック状態(カテーテルTを把持した状態)となるようにロック用アクチュエータ22dを制御する。
 ステップS47において、操作制御部353は、1対のローラ23bがカテーテルTをリリースした状態となるようにローラ間隔切替用アクチュエータ23cを制御する。
 ステップS48において、操作制御部353は、把持・擦り合わせ部23dがカテーテルTをリリースした状態となるよう昇降用アクチュエータ234dを制御する。
 ステップS49において、力触覚伝達部354は、微動時回転用アクチュエータ22bの制御を開始する。
 ステップS50において、センサ情報取得部352は、マスタ装置10及びスレーブ装置20に設置された各種センサによって検出された情報(センサ情報)を取得する。ステップS50において取得されたセンサ情報は、時系列のデータとして制御パラメータ記憶部371に記憶される。
 ステップS51において、力触覚伝達部354は、取得されたセンサ情報を入力として座標変換(例えば、式(1)及び(2)参照)を行い、力触覚の伝達制御(直進または回転)を実行する。
 ステップS52において、操作制御部353は、直進動作及び回転動作の切り替えが行われたか否かの判定を行う。
 直進動作及び回転動作の切り替えが行われていない場合、ステップS52においてNOと判定されて、処理はステップS53に移行する。
 一方、直進動作及び回転動作の切り替えが行われた場合、ステップS52においてYESと判定されて、処理はステップS41に移行する。
 ステップS53において、操作制御部353は、微動モードの終了が指示されたか否か(即ち、粗動モードへの切り替え操作が行われたか否か)の判定を行う。
 微動モードの終了が指示されていない場合、ステップS53において、NOと判定されて、処理はステップS50に移行する。
 一方、微動モードの終了が指示された場合、ステップS53において、YESと判定されて、処理は操作制御処理に戻る。
 以上のように、本実施形態に係るマスタ・スレーブシステム1は、カテーテルTとマスタ装置10との間で力触覚を伝達しながら、カテーテルTを正確に短い距離移動させる微動モードと、カテーテルTとマスタ装置10との間で力触覚を伝達することなく、カテーテルTを高速に長い距離移動させる粗動モードとを実行可能である。そして、マスタ・スレーブシステム1が粗動モードに設定された場合、マスタ装置10の操作レバー12に対する操作に応じて、スレーブ装置20は、カテーテルTを高速に長い距離移動させる。また、マスタ・スレーブシステム1が微動モードに設定された場合、マスタ装置10のマニピュレータ13に対する操作に応じて、スレーブ装置20は、マスタ装置10に入力された操作の力触覚をカテーテルTに伝達すると共に、カテーテルTに入力した力触覚をマスタ装置10に伝達して、カテーテルTを正確に短い距離移動させる。
 これにより、マスタ・スレーブシステム1においてスレーブ装置20を移動させる動作形態をより適切なものとすることができる。
 また、マスタ・スレーブシステム1は、粗動モードにおいてカテーテルTを軸周りに回転させる把持・擦り合わせ部23dと、微動モードにおいてカテーテルTを軸周りに回転させる微動時回転用アクチュエータ22gとを備えている。
 これにより、カテーテルTの粗動時において、操作レバー12に対する操作に応じてカテーテルTを回転させることができると共に、カテーテルTの微動時において、力触覚の伝達を行いながら、カテーテルTを回転させることができる。
 したがって、カテーテルTを被検体の体内に挿入する際に、カテーテルTをより柔軟に動かしながら、適切な動作を行うことが可能となる。
[変形例1]
 第1実施形態において、微動実行部22は、図1~図4に示すように、微動時回転用アクチュエータ22gの回転軸が中空となっており、中空の回転軸をカテーテルTが挿通する構成例であるものとしたが、これに限られない。
 図19は、微動実行部22の他の構成例を示す模式図である。
 図19に示すように、微動時回転用アクチュエータ22gとロック機構22eとをオフセットさせて配置(軸をずらして配置)し、微動時回転用アクチュエータ22gの回転を、ギアを介してロック機構22eに伝達する構成としてもよい。
 この場合、微動時回転用アクチュエータ22gの設置形態に自由度を持たせることができると共に、ギアを介することによって、より小型のアクチュエータで必要な回転トルクを得ることが可能となる。また、アクチュエータを小型化できることから、スレーブ装置20全体の小型化・軽量化を図ることができる。
[変形例2]
 第2実施形態において、粗動時にカテーテルTを回転させるために、把持・擦り合わせ部23dを備えるものとして説明したが、これに限られない。例えば、粗動実行部23において、粗動時直進用アクチュエータ23aと、1対のローラ23bと、ローラ間隔切替用アクチュエータ23cと、を内部に設置するケースを備え、粗動時にカテーテルTを回転させるためのアクチュエータによって、このケースを回転させることにより、1対のローラ23bに把持されたカテーテルTを回転させることとしてもよい。
 これにより、粗動時において、カテーテルTの直進動作及び回転動作を同時に実行することが可能となる。
[変形例3]
 上述の実施形態及び変形例において、微動モードが実行される場合に、直進動作または回転動作のいずれかに設定して力触覚伝達制御を実行するものとしたが、これに限られない。
 即ち、微動モードにおいては、直進動作及び回転動作における力触覚伝達制御を並列に実行することとしてもよい。
 微動モードにおいて、直進動作または回転動作のいずれかに設定して力触覚伝達制御を実行するか、直進動作及び回転動作における力触覚伝達制御を並列に実行するかについては、マスタ・スレーブシステム1が用いられる状況に応じて、より適切な動作が行われる制御形態を選択することができる。
 以上のように、本実施形態に係る構成されるマスタ・スレーブシステム1は、マスタ装置10と、スレーブ装置20と、制御装置30と、を備える。また、制御装置30は、操作制御部353と、力触覚伝達部354と、を備える。
 力触覚伝達部354は、マスタ装置10に入力された操作と当該操作に応じて動作する操作対象となる機器(カテーテルまたはガイドワイヤ)に入力された外力とに基づいて、マスタ装置10とスレーブ装置20との間で力触覚の伝達制御を実行する。
 操作制御部353は、マスタ装置10に入力された操作に応じて、操作対象となる機器の設定された動作をスレーブ装置20に実行させる。
 これにより、マスタ・スレーブシステム1において、マスタ装置10とスレーブ装置20との間で力触覚の伝達制御による動作を実行する機能と、マスタ装置10からの操作に応じてスレーブ装置20が設定された動作を実行する機能との両方を備えることが可能となる。
 したがって、マスタ・スレーブシステム1においてスレーブ装置20を移動させる動作形態をより適切なものとすることができる。
 マスタ・スレーブシステム1は、ロック機構22e、1対のローラ23b及び把持・擦り合わせ部23dを備える。
 ロック機構22e、1対のローラ23b及び把持・擦り合わせ部23dは、マスタ装置10に入力された操作に対して力触覚の伝達制御を実行する第1のモード(微動モード)と、マスタ装置10に入力された操作に対して力触覚の伝達制御を実行することなく、設定された動作を実行する第2のモード(粗動モード)と、を切り替える。
 これにより、マスタ装置10とスレーブ装置20との間で力触覚の伝達制御による動作を実行する機能と、マスタ装置10からの操作に応じてスレーブ装置20が設定された動作を実行する機能とを目的に応じて切り替えて実行することが可能となる。
 操作対象となる機器(カテーテルやガイドワイヤ等)は、線状に構成された部分(カテーテルシースやガイドワイヤ本体等)を有する。
 力触覚伝達部354は、第1のモードにおいて、操作対象となる機器の軸方向への進退動作及び軸周りの回転動作それぞれについて、力触覚の伝達制御を実行する。
 これにより、例えば、操作対象となる機器を対象物に挿入する過程及び対象物に挿入された操作対象となる機器を回転させる過程のそれぞれにおいて、機械的な機器を用いている場合と同様の力触覚を操作者に与えることができる。
 操作対象となる機器は、被検体に挿入されるカテーテルまたはガイドワイヤを備え、マスタ装置10におけるカテーテルまたはガイドワイヤの操作に応じて、スレーブ装置20が当該カテーテルまたはガイドワイヤを軸方向に進退または軸周りに回転させる。
 これにより、被検体に対して、カテーテルまたはガイドワイヤを高速に長い距離移動させる動作と力触覚を伝達しながら正確に短い距離移動させる動作を実行可能なシステムであって、カテーテルまたはガイドワイヤの進退動作及び回転動作を実行可能なマスタ・スレーブシステム1を実現することができる。
 マスタ・スレーブシステム1は、微動時回転用アクチュエータ22gと、把持・擦り合わせ部23dと、を備える。
 微動時回転用アクチュエータ22gは、第1のモードにおいて、力触覚の伝達制御を実行しながら操作対象となる機器を軸周りに回転させる。
 把持・擦り合わせ部23dは、第2のモードにおいて、力触覚の伝達制御を実行することなく、設定された動作として操作対象となる機器を軸周りに回転させる。
 これにより、力触覚の伝達制御を伴うカテーテル等の回転動作と、力触覚の伝達制御を伴うことなく、操作に応じてカテーテル等を回転させる回転動作とを切り替えて実行することが可能となる。
 把持・擦り合わせ部23dは、操作対象となる機器を下側把持部材231d及び上側把持部材238dで挟み、下側把持部材231dと上側把持部材238dとを擦り合わせる動作を行うことにより、把持された操作対象となる機器を軸周りに回転させる。
 これにより、力触覚の伝達制御を行わない第2のモードにおいても、カテーテル等の軸周りの回転動作を実現することができる。
 なお、本発明は、上述の実施形態に限定されるものではなく、本発明の目的を達成できる範囲での変形、改良等は本発明に含まれるものである。
 例えば、上述の実施形態では、マスタ・スレーブシステム1によってカテーテルを遠隔的に操作する場合を例に挙げて説明したが、これに限られない。即ち、マスタ・スレーブシステム1によって遠隔的に操作される機器として、種々のものを対象とすることが可能であり、例えば、線状に構成された部分を有する各種機器、一例として、鉗子あるいは内視鏡等の医療機器を対象とすることができる。
 また、本発明は、上述の実施形態におけるマスタ・スレーブシステム1として実現することの他、マスタ・スレーブシステム1を制御する制御装置、マスタ・スレーブシステム1において実行される各ステップによって構成される制御方法、あるいは、マスタ・スレーブシステム1の機能を実現するためにプロセッサによって実行されるプログラムとして実現することができる。
 また、上述の実施形態では、制御装置30を独立した装置として実現する構成を例に挙げて説明したが、制御装置30の機能をマスタ装置10の制御ユニット101及びスレーブ装置20の制御ユニット201の一方に実装したり、これらの両方に分散して実装したりすることができる。
 また、上述の実施形態及び変形例を適宜組み合わせて、本発明を実施することが可能である。
 例えば、第1実施形態の構成において、粗動時におけるカテーテルTの回転動作を行う場合、マスタ装置10の操作レバー12を左右に移動させることに対応して、力触覚伝達を行うことなく、カテーテルTを左右に回転動作させることとしてもよい。
 また、上述の実施形態における制御のための処理は、ハードウェア及びソフトウェアのいずれにより実行させることも可能である。
 即ち、上述の処理を実行できる機能がマスタ・スレーブシステム1に備えられていればよく、この機能を実現するためにどのような機能構成及びハードウェア構成とするかは上述の例に限定されない。
 上述の処理をソフトウェアにより実行させる場合には、そのソフトウェアを構成するプログラムが、コンピュータにネットワークや記憶媒体からインストールされる。
 プログラムを記憶する記憶媒体は、装置本体とは別に配布されるリムーバブルメディア、あるいは、装置本体に予め組み込まれた記憶媒体等で構成される。リムーバブルメディアは、例えば、半導体メモリ、磁気ディスク、光ディスク、または光磁気ディスク等により構成される。光ディスクは、例えば、CD-ROM(Compact Disk-Read Only Memory),DVD(Digital Versatile Disk),Blu-ray Disc(登録商標)等により構成される。光磁気ディスクは、MD(Mini-Disk)等により構成される。また、装置本体に予め組み込まれた記憶媒体は、例えば、プログラムが記憶されているROM(Read Only Memory)やハードディスク、あるいは、半導体メモリ等で構成される。
 なお、上記実施形態は、本発明を適用した一例を示しており、本発明の技術的範囲を限定するものではない。即ち、本発明は、本発明の要旨を逸脱しない範囲で、省略や置換等種々の変更を行うことができ、上記実施形態以外の各種実施形態を取ることが可能である。本発明が取ることができる各種実施形態及びその変形は、特許請求の範囲に記載された発明とその均等の範囲に含まれる。
 1 マスタ・スレーブシステム、10 マスタ装置、20 スレーブ装置、30 制御装置、40 ネットワーク、L ディスプレイ、C カメラ、T カテーテル、FT 機能別力・速度割当変換ブロック、FC 理想力源ブロック、PC 理想速度(位置)源ブロック、IFT 逆変換ブロック、S 制御対象システム、11 粗動・微動スイッチ、12 操作レバー、13 マニピュレータ、14 直進・回転スイッチ、21 支持体、21a 底部、21b 側壁、21c 収容部、22 微動実行部、22a 直動軸、22b 微動時直進用アクチュエータ、22c 支持板、22d ロック用アクチュエータ、22e ロック機構、W 楔状部材、W1 ロッド、W2 円錐部、R 受け部材、22f ケース、22g 微動時回転用アクチュエータ、23 粗動実行部、23a 粗動時直進用アクチュエータ、23b ローラ、23c ローラ間隔切替用アクチュエータ、P 平行リンク、G1,G2 ギア、23d 把持・擦り合わせ部、231d 下側把持部材、231d-1 支持部、231d-2,232d-2 天板部、232d 昇降部材、232d-1 摺動部、233d ラックギア、234d 昇降用アクチュエータ、235d ピニオンギア、236d 擦り合わせ用アクチュエータ、237d ガイド、238d 上側把持部材、239d ケース、W 楔状部材、R 受け部材、101,201 制御ユニット、102,202 通信ユニット、103 操作レバーセンサ、104 回転用アクチュエータ、105 直進用アクチュエータ、106,203,211 リニアエンコーダ、107,204,205,212 ロータリーエンコーダ、108,109,206~210,213,214 ドライバ、311 プロセッサ、312 ROM、313 RAM、314 バス、315 入力部、316 出力部、317 記憶部、318 通信部、319 ドライブ、331 リムーバブルメディア、351 モード設定部、352 センサ情報取得部、353 操作制御部、354 力触覚伝達部、371 制御パラメータ記憶部

Claims (9)

  1.  操作者の操作が入力されるマスタ装置と、前記マスタ装置に入力された操作に応じて操作対象となる機器を遠隔的に動作させるスレーブ装置と、を含むマスタ・スレーブシステムであって、
     前記マスタ装置に入力された操作と当該操作に応じて動作する前記操作対象となる機器に入力された外力とに基づいて、前記マスタ装置と前記スレーブ装置との間で力触覚の伝達制御を実行する力触覚制御手段と、
     前記マスタ装置に入力された操作に応じて、前記操作対象となる機器の設定された動作を前記スレーブ装置に実行させる操作制御手段と、
     を備えることを特徴とするマスタ・スレーブシステム。
  2.  前記マスタ装置に入力された操作に対して前記力触覚の伝達制御を実行する第1のモードと、前記マスタ装置に入力された操作に対して前記力触覚の伝達制御を実行することなく、前記設定された動作を実行する第2のモードと、を切り替える切り替え手段を備えることを特徴とする請求項1に記載のマスタ・スレーブシステム。
  3.  前記操作対象となる機器は、線状に構成された部分を有し、
     前記力触覚制御手段は、前記第1のモードにおいて、前記操作対象となる機器の軸方向への進退動作及び軸周りの回転動作それぞれについて、前記力触覚の伝達制御を実行することを特徴とする請求項1または2に記載のマスタ・スレーブシステム。
  4.  前記操作対象となる機器は、被検体に挿入されるカテーテルまたはガイドワイヤを備え、前記マスタ装置におけるカテーテルまたはガイドワイヤの操作に応じて、前記スレーブ装置が当該カテーテルまたはガイドワイヤを軸方向に進退または軸周りに回転させることを特徴とする請求項1から3のいずれか1項に記載のマスタ・スレーブシステム。
  5.  前記第1のモードにおいて、前記力触覚の伝達制御を実行しながら前記操作対象となる機器を軸周りに回転させる回転用アクチュエータと、
     前記第2のモードにおいて、前記力触覚の伝達制御を実行することなく、前記設定された動作として前記操作対象となる機器を軸周りに回転させる回転機構と、
     を備えることを特徴とする請求項3または4に記載のマスタ・スレーブシステム。
  6.  前記回転機構は、前記操作対象となる機器を第1の把持部材及び第2の把持部材で挟み、前記第1の把持部材と前記第2の把持部材とを擦り合わせる動作を行うことにより、把持された前記操作対象となる機器を軸周りに回転させることを特徴とする請求項5に記載のマスタ・スレーブシステム。
  7.  操作者の操作が入力されるマスタ装置と、前記マスタ装置に入力された操作に応じて操作対象となる機器を遠隔的に動作させるスレーブ装置と、を含むマスタ・スレーブシステムにおける前記マスタ装置及びスレーブ装置を制御する制御装置であって、
     前記スレーブ装置が前記操作対象となる機器を把持した状態で、前記マスタ装置と前記スレーブ装置との間で力触覚の伝達制御を実行する力触覚制御手段と、
     前記マスタ装置における操作に応じて、前記スレーブ装置が前記操作対象となる機器の設定された動作を実行する操作制御手段と、
     を備えることを特徴とする制御装置。
  8.  操作者の操作が入力されるマスタ装置と、前記マスタ装置に入力された操作に応じて操作対象となる機器を遠隔的に動作させるスレーブ装置と、を含むマスタ・スレーブシステムが実行する制御方法であって、
     前記マスタ装置に入力された操作と当該操作に応じて動作する前記操作対象となる機器に入力された外力とに基づいて、前記マスタ装置と前記スレーブ装置との間で力触覚の伝達制御を実行する力触覚制御ステップと、
     前記マスタ装置に入力された操作に応じて、前記操作対象となる機器の設定された動作を前記スレーブ装置に実行させる操作制御ステップと、
     を含むことを特徴とする制御方法。
  9.  操作者の操作が入力されるマスタ装置と、前記マスタ装置に入力された操作に応じて操作対象となる機器を遠隔的に動作させるスレーブ装置と、を含むマスタ・スレーブシステムにおける前記マスタ装置及びスレーブ装置を制御するコンピュータに、
     前記マスタ装置に入力された操作と当該操作に応じて動作する前記操作対象となる機器に入力された外力とに基づいて、前記マスタ装置と前記スレーブ装置との間で力触覚の伝達制御を実行する力触覚制御機能と、
     前記マスタ装置に入力された操作に応じて、前記操作対象となる機器の設定された動作を前記スレーブ装置に実行させる操作制御機能と、
     を実現させることを特徴とするプログラム。
PCT/JP2022/037745 2021-10-29 2022-10-10 マスタ・スレーブシステム、制御装置、制御方法及びプログラム WO2023074332A1 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2021178387 2021-10-29
JP2021-178387 2021-10-29

Publications (1)

Publication Number Publication Date
WO2023074332A1 true WO2023074332A1 (ja) 2023-05-04

Family

ID=86159272

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2022/037745 WO2023074332A1 (ja) 2021-10-29 2022-10-10 マスタ・スレーブシステム、制御装置、制御方法及びプログラム

Country Status (1)

Country Link
WO (1) WO2023074332A1 (ja)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01121186A (ja) * 1987-11-05 1989-05-12 Hitachi Ltd マスタ・スレーブマニピユレータの制御装置
JPH06138945A (ja) * 1992-10-26 1994-05-20 Toshiba Corp マスタスレーブマニピュレータの制御装置
JP2010253168A (ja) * 2009-04-28 2010-11-11 Shibaura Institute Of Technology ワイヤ状操作対象物制御装置
WO2014010177A1 (ja) * 2012-07-10 2014-01-16 パナソニック株式会社 力計測装置及び力計測方法、マスタースレーブ装置、力計測プログラム、並びに、集積電子回路
US20150272683A1 (en) * 2012-10-05 2015-10-01 Imperial Innovations Ltd Device
JP2018019987A (ja) * 2016-08-05 2018-02-08 国立大学法人 香川大学 カテーテルおよびガイドワイヤ連携挿入システム
US20180168751A1 (en) * 2015-06-16 2018-06-21 Industry-University Cooperation Foundation Hanyang University Erica Campus Vascular intervention robot and vascular intervention system

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01121186A (ja) * 1987-11-05 1989-05-12 Hitachi Ltd マスタ・スレーブマニピユレータの制御装置
JPH06138945A (ja) * 1992-10-26 1994-05-20 Toshiba Corp マスタスレーブマニピュレータの制御装置
JP2010253168A (ja) * 2009-04-28 2010-11-11 Shibaura Institute Of Technology ワイヤ状操作対象物制御装置
WO2014010177A1 (ja) * 2012-07-10 2014-01-16 パナソニック株式会社 力計測装置及び力計測方法、マスタースレーブ装置、力計測プログラム、並びに、集積電子回路
US20150272683A1 (en) * 2012-10-05 2015-10-01 Imperial Innovations Ltd Device
US20180168751A1 (en) * 2015-06-16 2018-06-21 Industry-University Cooperation Foundation Hanyang University Erica Campus Vascular intervention robot and vascular intervention system
JP2018019987A (ja) * 2016-08-05 2018-02-08 国立大学法人 香川大学 カテーテルおよびガイドワイヤ連携挿入システム

Similar Documents

Publication Publication Date Title
EP2907467B1 (en) Master devices for surgical robots and control methods thereof
Li et al. A cable-pulley transmission mechanism for surgical robot with backdrivable capability
Do et al. Nonlinear friction modelling and compensation control of hysteresis phenomena for a pair of tendon-sheath actuated surgical robots
US20120245595A1 (en) System and Method for Endovascular Telerobotic Access
JP5893362B2 (ja) マスタ操作入力装置及びマスタスレーブマニピュレータ
US9132552B2 (en) Robot and friction compensation method therefor
JP6157258B2 (ja) マニピュレータ及びマニピュレータシステム
WO2008133956A9 (en) Robotic instrument control system
Do et al. Real-time enhancement of tracking performances for cable-conduit mechanisms-driven flexible robots
US20140148819A1 (en) Surgical instrument and control method thereof
US20150272683A1 (en) Device
US20120310221A1 (en) Surgical instrument with control for detected fault condition
WO2015168177A1 (en) Multi-link modular continuum robotic endoscope system
US11850741B2 (en) Control device, control method, and master-slave system
JP6762280B2 (ja) 鉗子システム
KR102199910B1 (ko) 탈부착형 로봇 수술 도구를 이용한 다자유도 복강경 수술 장치
US11478928B2 (en) Estimating joint friction and tracking error of a robotics end effector
WO2023074332A1 (ja) マスタ・スレーブシステム、制御装置、制御方法及びプログラム
Cha et al. A robotic system for percutaneous coronary intervention equipped with a steerable catheter and force feedback function
CN111163905A (zh) 双制动器装配接头
WO2018216204A1 (ja) マスタスレーブマニピュレータとその制御方法
JP4346615B2 (ja) 医療用マニピュレータ
WO2022210800A1 (ja) 制御システム、制御装置、制御方法及びプログラム
WO2022210801A1 (ja) 制御システム、制御装置、制御方法及びプログラム
Yu et al. Master-slave system research of a vascular interventional surgical robot

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 22886662

Country of ref document: EP

Kind code of ref document: A1