Medical robotic system and method of controlling the same

• US 8,740,882 B2
• Filed: 07/30/2010
• Issued: 06/03/2014
• Est. Priority Date: 07/30/2010
• Status: Active Grant

• Current Assignee: LG Electronics, Inc. (LG Corporation)
• Original Assignee: LG Electronics, Inc. (LG Corporation)
• Inventors: Jun, Honggul, Chang, Yoonyoung, Paik, Woohyun
• Primary Examiner(s): Thomson, Bill
• Assistant Examiner(s): LIPITZ, JEFFREY BRIAN
• Application Number:
  US12/847,269
• Publication Number:
  US 20120029529A1
• Time in Patent Office: 1,404 Days
• Field of Search: 901 9- 10, 901 14- 18, 901/33, 128/898, 606/1, 606/130
• US Class Current: 606/1
• CPC Class Codes: A61B 2034/102 Modelling of surgical devices, implants or prosthesis
• CPC Class Codes: A61B 2090/065 for measuring contact or contact pressure
• CPC Class Codes: A61B 34/30 Surgical robots
• CPC Class Codes: A61B 34/37 Master-slave robots A61B34/35 takes precedence
• CPC Class Codes: A61B 34/76 Manipulators having means for providing feel, e.g. force or tactile feedback

Abstract

A medical robotic system and method for controlling the system are provided to precisely measure contact force during the minimally invasive surgery. In one embodiment, a medical robotic system includes an input device, a robotic arm assembly, a surgical instrument operably coupled to the robotic arm assembly, the surgical instrument including a contact detection unit configured to detect a contact of the surgical instrument with tissue of a patient, a current measurement unit configured to measure a joint current in the robotic arm assembly, a position/velocity measurement unit configured to measure a joint position and a joint velocity in the robotic arm assembly, an external force calculation unit configured to calculate size and direction of a contact force caused by the contact of the surgical instrument to the tissue based on the joint currents, positions and velocities measured when the contact is occurred and measured when the contact is not occurred.

Claims

1. A medical robotic system comprising:

an input device;

a robotic arm assembly;

a surgical instrument operably coupled to the robotic arm assembly, the surgical instrument including a contact detection unit configured to detect a contact of the surgical instrument with tissue of a patient;

a current measurement unit configured to measure a joint current in the robotic arm assembly;

a position/velocity measurement unit configured to measure a joint position and a joint velocity in the robotic arm assembly;

an external force calculation unit configured to calculate size and direction of a contact force caused by the contact of the surgical instrument to the tissue based on the joint currents, the joint positions and the joint velocities measured when the contact is occurred and measured when the contact is not occurred,

wherein the external force calculation unit calculates the size and direction of a contact force based on a time domain response of a joint torque signal considering rotor inertia and friction of a joint motor by using a motor model, and

wherein the motor model is represented by the following formula;

2. The medical robotic system of claim 1, wherein the external force calculation unit includes an output unit configured to,

receive a contact signal from the contact detection unit,

output the contact force when the contact is occurred, and

output a reference value for the contact force when the contact is not occurred.

3. The medical robotic system of claim 2, wherein the external force calculation unit includes,

a coordinate calculation unit configured to receive the joint position and the joint velocity from the position/velocity measurement unit and convert the joint position and the joint velocity into a Cartesian position and a Cartesian velocity respectively,

a joint motor simulation unit configured to receive the joint current from the current measurement unit and convert the joint current into the joint torque signal, and

a force/moment calculation unit configured to,

receive the joint torque signal from the joint motor simulation unit,

receive the Cartesian position and the Cartesian velocity from the coordinate calculation unit, and

generate Cartesian force/moment of the contact force based on the joint torque signal and the Cartesian position/velocity.

4. The medical robotic system of claim 3, wherein the joint motor simulation unit further comprises:

a slave inverse dynamics unit configured to;

receive the joint position and the joint velocity from the position/velocity measurement unit,

receive the Cartesian force/moment as a feedback signal, and

compute torque components generated by friction and inertia of the joint motor based on the joint position, the joint velocity and the Cartesian force/moment when the contact is not occurred, and

a parameter learning unit configured to store the current/torque conversion constant, the rotor inertia constant and the friction constant when the contact is not occurred.

5. The medical robotic system of claim 1, wherein the surgical instrument has an end effector including the contact detection unit, and the contact detection unit is located at the end effector and configured to detect a contact between the end effector and the tissue.

6. The medical robotic system of claim 5, wherein the contact detection unit is configured to detect the contact between the end effector and the tissue by measuring a leakage current generated when the contact is occurred.

7. The medical robotic system of claim 5, wherein the contact detection unit is configured to detect the contact between the end effector and the tissue by measuring discharge induced by the contact.

8. The medical robotic system of claim 5, wherein the contact measurement unit includes a plurality of separate electrodes located on respective portions of the end effector such that a portion of the end effector at which a contact is occurred can be determined.

9. The medical robotic system of claim 1, wherein the input device is configured to receive the contact force.