Surgical robot and control method thereof

Patent metadata

Field	Value
Publication number	US-9658605-B2
Application number	US-201213723688-A
Country	US
Kind code	B2
Filing date	Dec 21, 2012
Priority date	Dec 23, 2011
Publication date	May 23, 2017
Grant date	May 23, 2017

Abstract

A method for controlling a surgical robot includes calculating an external force acting on a robot arm mounted with a surgical instrument, filtering the external force acting on the robot arm when a central point of an incision is set, calculating a virtual force to enable the surgical instrument which is positioned away from the central point of the incision to return to the central point of the incision, and applying the calculated virtual force to the filtered external force, to control movement of the robot arm. As a result, it is possible to compactly design the surgical robot and thereby reduce the volume of the surgical robot.

First claim

What is claimed is:

1. A method for controlling a surgical robot comprising:
calculating an external force acting on a robot arm mounted with a surgical instrument, based on an actual external force acting on the robot arm, the actual external force being a constant force over time;
filtering the calculated external force acting on the robot arm to calculate a filtered external force, when a central point of an incision is set, the filtering of the calculated external force acting on the robot arm including removing a deviation force from the calculated external force, the deviation force being a force enabling deviation of a remote center of motion of the surgical instrument from the central point of the incision;
calculating a virtual force independently of the filtered external force, the virtual force being a force enabling the remote center of motion of the surgical instrument deviating from the central point of the incision to return to the central point of the incision;
applying the calculated virtual force to the calculated filtered external force to control movement of the robot arm; and
subsequent to controlling movement of the arm,
updating a position of the remote center of motion,
recalculating the virtual force independently of the filtered external force, based on the updated remote center of motion, such that the filtered external force is unchanged, and
applying the recalculated virtual force to the unchanged filtered external force to subsequently control movement of the robot arm;

wherein the calculating of the virtual force includes,
setting a virtual spring and a virtual damper between the central point of the incision and the remote center of motion;
calculating a deviation between the central point of the incision and the remote center of motion; and
calculating the virtual force using the calculated deviation, stiffness of the virtual spring and a coefficient of the virtual damper.

2. The method according to claim 1 , wherein the control of movement of the robot arm is carried out in a manual positioning mode in which a user directly holds and moves the robot arm mounted with the surgical instrument by hand such that the surgical instrument is inserted through the incision and is positioned in a surgery site.

3. The method according to claim 1 , wherein the calculation of the external force acting on the robot arm comprises:
detecting torque information acting on respective pivot joints constituting a joint part using a force/torque sensor; and
subtracting torque information of pivot joints corresponding to a torque value required for maintenance of a present position or movement of the robot arm without the external force being applied, from the detected torque information, to calculate torque information of pivot joints generated by the external force externally applied to the robot arm.

4. The method according to claim 3 , wherein the filtering of the external force acting on the robot arm is carried out by removing torque information contributing to a deviation of the remote center of motion present on the surgical instrument from the central point of the incision, from torque information of the pivot joint generated by the external force externally applied to the robot arm.

5. The method of claim 1 , wherein applying the calculated virtual force to the filtered external force to control movement of the robot arm comprises: calculating a target joint torque, based on both the filtered external force and the calculated virtual force; and outputting the target joint torque to a servo control unit coupled to the robot arm.

6. A surgical robot comprising:
a control unit configured to,
calculate an external force acting on a robot arm associated with an operation of the surgical robot, based on an actual external force acting on the robot arm, the actual external force being a constant force over time,
filter the calculated external force acting on the robot arm to calculate a filtered external force, when a central point of an incision is set, the filtering of the calculated external force acting on the robot arm including removing a deviation force from the calculated external force, the deviation force being a force enabling deviation of the surgical instrument from the central point of the incision,
calculate a virtual force independently of the filtered external force, the virtual force being a force enabling a remote center of motion present on an instrument coupled to the robot arm which deviates away from the central point of the incision to return to the central point of the incision,
apply the calculated virtual force to the filtered external force to control movement of the robot arm, and
subsequent to controlling movement of the robot arm,
update a position of the remote center of motion,
recalculate the virtual force independently of the filtered external force, based on the updated remote center of motion, such that the filtered external force is unchanged, and
apply the recalculated virtual force to the unchanged filtered external force to subsequently control movement of the robot arm;

wherein, to calculate the virtual force, the control unit is configured to,
set a virtual spring and a virtual damper between the central point of the incision and the remote center of motion,
calculate a deviation between the central point of the incision and the remote center of motion, and
calculate the virtual force using the calculated deviation, stiffness of the virtual spring and a coefficient of the virtual damper.

7. The surgical robot according to claim 6 , wherein the control unit is configured to control movement of the robot arm in a manual positioning mode in which a user directly holds and moves the robot arm to which the instrument is coupled, by hand, such that the instrument is inserted through the incision and is positioned in a surgery site.

8. The surgical robot according to claim 7 , wherein the control unit is configured to,
receive torque information acting on at least one pivot joint constituting a joint part of the robot arm, and
subtract torque information of at least one pivot joint corresponding to a torque value required for maintenance of a present position or movement of the robot arm without an external force being applied, from the received torque information, to calculate torque information of at least one pivot joint generated by an external force externally applied to the robot arm.

9. The surgical robot according to claim 8 , wherein, to filter the external force acting on the robot arm, the control unit is configured to remove torque information contributing to a deviation of the remote center of motion present on the instrument from the central point of the incision, from torque information of at least one pivot joint generated by the external force externally applied to the robot arm.

10. The surgical robot of claim 6 , wherein applying the calculated virtual force to the filtered external force to control movement of the robot arm comprises: calculating a target joint torque, based on both the filtered external force and the calculated virtual force; and outputting the target joint torque to a servo control unit coupled to the robot arm.

Assignees

• Samsung Electronics Co Ltd

Inventors

• Lee Kwang Kyu
• Kwon Woong
• Roh Kyung Shik

Classifications

• A61B34/76

  Manipulators having means for providing feel, e.g. force or tactile feedback · CPC title

• A61B34/37

  Leader-follower robots (A61B34/35 takes precedence) · CPC title

• A61B34/30 Primary

  Surgical robots · CPC title

• G05B6/00 Primary

  Internal feedback arrangements for obtaining particular characteristics, e.g. proportional, integral or differential · CPC title

• B25J9/02

  characterised by movement of the arms, e.g. cartesian coordinate type (B25J9/06 takes precedence) · CPC title