Systems and methods for controlling movement of a surgical tool along a predefined path

Patent metadata

Field	Value
Publication number	US-11564761-B2
Application number	US-202016811909-A
Country	US
Kind code	B2
Filing date	Mar 6, 2020
Priority date	Mar 8, 2019
Publication date	Jan 31, 2023
Grant date	Jan 31, 2023

Abstract

A robotic surgical system comprises a surgical tool, a manipulator configured to support the surgical tool, a force/torque sensor to measure forces and torques applied to the surgical tool, and a control system. The control system obtains a three-dimensional milling path for the surgical tool. The control system also receives one or more signals from the force/torque sensor in response to a user manually applying user forces and torques to the surgical tool. The control system determines a commanded pose to which to command the manipulator to advance the surgical tool along the milling path based on a tangential component of the user forces and torques, based on a virtual simulation using virtual constraints, and/or based on other suitable factors to promote guided, manual movement of the surgical tool along the milling path.

First claim

The invention claimed is:

1. A robotic surgical system comprising:
a surgical tool;
a manipulator configured to support the surgical tool, the manipulator comprising a plurality of links;
a force/torque sensor to measure forces and torques applied to the surgical tool; and
a control system configured to:
obtain a milling path for the surgical tool wherein the milling path is three-dimensional and predetermined;
define virtual constraints to constrain movement of the surgical tool to be along the milling path, wherein the virtual constraints are defined with respect to two degrees of freedom each being normal to the milling path, and wherein movement of the surgical tool with respect to one degree of freedom tangential to the milling path is unconstrained by the virtual constraints;
receive an input from the force/torque sensor in response to user forces and torques manually applied to the surgical tool by a user;
simulate dynamics of the surgical tool in a virtual simulation based on the virtual constraints and the input from the force/torque sensor; and
command the manipulator to advance the surgical tool along the milling path based on the virtual simulation.

2. The robotic surgical system of claim 1 wherein the control system is further configured to simulate dynamics of the surgical tool by representing the surgical tool as a virtual rigid body having a virtual mass and by applying a constraint force to the virtual mass in the virtual simulation to yield a commanded pose, wherein the constraint force is based on the virtual constraints.

3. The robotic surgical system of claim 1 , wherein the control system is configured to determine a first commanded pose based on the virtual simulation and to calculate a first constraint application pose on the milling path that is at a point nearest to the first commanded pose.

4. The robotic surgical system of claim 3 , wherein the control system is configured to determine the point nearest to the first commanded pose by: performing a broad-phase search to determine a subset of path segments within a specified distance of the first commanded pose; performing a narrow-band search to compute a normal line and a length of the normal line from the first commanded pose to each of the path segments of the subset determined in the broad-phase search; and selecting the normal line that has the length that is shortest.

5. The robotic surgical system of claim 3 , wherein the control system is configured to:
define first virtual constraints with respect to the two degrees of freedom normal to the milling path based on a distance between the first commanded pose and the first constraint application pose, wherein the first virtual constraints are defined at the first constraint application pose;
determine a second commanded pose based on the first virtual constraints; and
command the manipulator to move to the second commanded pose.

6. The robotic surgical system of claim 1 , wherein the control system is configured to calculate a tangential component of force tangential to the milling path based on the input from the force/torque sensor.

7. The robotic surgical system of claim 1 , wherein the control system is configured to:
determine a first commanded pose based on the virtual simulation;
calculate a first constraint application pose on the milling path based on a distance between the first commanded pose and a previous commanded pose, the distance being projected onto the milling path to compute a point on the milling path at which to define the first constraint application pose;
define first virtual constraints with respect to the two degrees of freedom normal to the milling path based on a distance between the first commanded pose and the first constraint application pose;
define the first virtual constraints with respect to the two degrees of freedom normal to the milling path at the first constraint application pose;
determine a second commanded pose based on the first virtual constraints; and
command the manipulator to move to the second commanded pose.

8. The robotic surgical system of claim 1 , wherein the manipulator is operable in a guided-manual mode and a semi-autonomous mode and wherein the control system is further configured to utilize the virtual constraints in the guided-manual mode.

9. The robotic surgical system of claim 8 , in response to transitioning to the semi-autonomous mode from the guided-manual mode, the control system is configured to calculate a transition path from a current position of a tool center point of the surgical tool to a last known point of the surgical tool on the milling path before transitioning from the semi-autonomous mode.

10. The robotic surgical system of claim 1 , wherein the control system is configured to:
define a starting position for the surgical tool on the milling path;
determine a current position of the surgical tool; and
define a lead-in path from the current position of the surgical tool to the starting position of the milling path.

11. The robotic surgical system of claim 1 , wherein the control system is configured to:
track locations at which the surgical tool has been applied to an anatomy;
track locations at which the surgical tool has not been applied to the anatomy; and
define the milling path along one or more of the locations at which the surgical tool has not been applied to the anatomy.

12. The robotic surgical system of claim 1 , wherein the control system is configured to determine a direction of movement to move the surgical tool along the milling path based on the input from the force/torque sensor, the surgical tool being movable in opposing directions along the milling path.

13. The robotic surgical system of claim 12 , wherein the control system is configured to define an end constraint with respect to one degree of freedom tangential to the milling path to constrain the surgical tool to remain on the milling path by constraining movement beyond an end of the milling path, and wherein the control system is configured to perform one or more of the following:
provide an indication of when to apply the end constraint; and
disable the virtual constraints based on reaching an end of the milling path.

14. The robotic surgical system of claim 1 , wherein the virtual constraints are defined as velocity constraints, wherein each of the velocity constraints comprises stiffness and damping parameters and one or more force limits and one or more activation limits.

15. The robotic surgical system of claim 1 , wherein the control system is configured to:
obtain a virtual boundary for the surgical tool with the virtual boundary being three-dimensional tube defining the milling path; and
define virtual constraints on movement of the surgical tool inside the tube and along the milling path, the virtual constraints being defined to constrain movement of the surgical tool to be along the milling path.

16. A method for operating a robotic surgical system, the robotic surgical system comprising a surgical tool, a manipulator configured to support the surgical tool, and a force/torque sensor to measure forces and torques applied to the surgical tool, the method comprising the steps of:
obtaining a milling path for the surgical tool wherein the milling path is three-dimensional and predetermined;
defining virtual constraints to constrain movement of the surgical tool to be along the milling path, wherein the virtual constraints are defined with respect to two degrees of freedom each being normal to the milling path, and wherein movement of the surgical tool with respect to o

Assignees

• Mako Surgical Corp

Inventors

• Rohs Helmut
• Dozeman Michael Dale
• Arora Bharat
• Ferko Michael
• Roessler Patrick
• Deluca Richard Thomas
• Bowling David Gene

Classifications

• A61B34/10

  Computer-aided planning, simulation or modelling of surgical operations · CPC title

• A61B2034/108

  Computer aided selection or customisation of medical implants or cutting guides · CPC title

• A61B34/37

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

• A61B2034/107

  Visualisation of planned trajectories or target regions · CPC title

• A61B34/74

  Manipulators with manual electric input means · CPC title