Surgical manipulator and method for resuming semi-autonomous tool path position
Surgical manipulators and methods disclosed comprise an energy applicator extending from an instrument and actuators to move links to position the energy applicator. A force/torque sensor sense forces/torques applied to the instrument. Controller(s) control operation of the manipulator in a semi-autonomous mode wherein the manipulator moves the energy applicator along a tool path comprising a target position and advances the energy applicator along the tool path by moving the energy applicator to the target position. The controller(s) transition from the semi-autonomous mode to a manual mode wherein operation of the manipulator is controlled in response to forces/torques applied to the instrument. In the manual mode, the controller(s) enable movement of the energy applicator to one or more positions different from the target position. The controller(s) transition from the manual mode back to the semi-autonomous mode by moving the energy applicator back to the target position on the tool path.
1. A surgical manipulator for manipulating an instrument and an energy applicator extending from the instrument, the surgical manipulator comprising:
a plurality of links and a plurality of actuators configured to move the plurality of links to position the energy applicator;
a force/torque sensor configured to sense forces and torques applied to the instrument; and
at least one controller configured to:
control operation of the surgical manipulator in a semi-autonomous mode, and in the semi-autonomous mode, the surgical manipulator is configured to advance the energy applicator along a tool path by moving the energy applicator to a target position on the tool path;
transition from the semi-autonomous mode to a manual mode in response to a user action, and in the manual mode, operation of the surgical manipulator is controlled in response to forces and torques applied to the instrument;
in the manual mode, model the instrument and the energy applicator as a virtual rigid body and determine forces to apply to the virtual rigid body based on the forces and torques applied to the instrument and to enable movement of the energy applicator to one or more positions different from the target position; and
transition from the manual mode back to the semi-autonomous mode by moving the energy applicator back to the target position on the tool path.
2. The surgical manipulator of claim 1 , wherein in response to transitioning from the semi-autonomous mode to the manual mode, the at least one controller is configured to apply force and torques to the virtual rigid body to hold the instrument in a static pose at the target position.
3. The surgical manipulator of claim 1 , wherein, in the semi-autonomous mode, the at least one controller is configured to determine forces to apply to the virtual rigid body to advance the energy applicator from the target position to a subsequent target position on the tool path.
4. The surgical manipulator of claim 1 , wherein, in response to moving the energy applicator back to the target position on the tool path, the at least one controller controls the surgical manipulator in the semi-autonomous mode to resume movement of the energy applicator along the tool path by being configured to advance the energy applicator along the tool path by moving the energy applicator from the target position to a subsequent target position on the tool path.
5. The surgical manipulator of claim 1 , wherein in response to transitioning from the manual mode back to the semi-autonomous mode, the at least one controller is configured to generate a new tool path.
6. The surgical manipulator of claim 1 , wherein the tool path comprises a plurality of path segments and the at least one controller is configured to compute the target position for one path segment of the plurality of the path segments based on one or more of the following:
a feed rate of the instrument;
a relationship between an initial position of a coordinate system of the energy applicator and starting and ending points of the one path segment; and
geometric characteristics of the one path segment.
7. The surgical manipulator of claim 1 , wherein the instrument further comprises a switch, and wherein the at least one controller is configured to transition from the semi-autonomous mode to the manual mode in response to detecting actuation of the switch.
8. The surgical manipulator of claim 1 , further comprising a hand held pendant comprising a trigger and being configured to regulate operation of the surgical manipulator in the semi-autonomous mode, and wherein the at least one controller is configured to transition from the semi-autonomous mode to the manual mode in response to detecting release of the trigger.
9. The surgical manipulator of claim 1 , further comprising a hand held pendant comprising a trigger and wherein the at least one controller is configured to control operation of the surgical manipulator in the semi-autonomous mode in response to detecting actuation of the trigger.
10. A method of operating a surgical manipulator, the surgical manipulator configured to manipulate an instrument and an energy applicator extending from the instrument, the surgical manipulator comprising a plurality of links and a plurality of actuators configured to move the plurality of links to position the energy applicator, a force/torque sensor configured to sense forces and torques applied to the instrument, and at least one controller being configured to perform the steps of:
controlling operation of the surgical manipulator in a semi-autonomous mode, and in the semi-autonomous mode, the surgical manipulator advances the energy applicator along a tool path by moving the energy applicator to a target position on the tool path;
transitioning from the semi-autonomous mode to a manual mode in response to a user action, and in the manual mode, operation of the surgical manipulator is controlled in response to forces and torques applied to the instrument;
in the manual mode, modeling the instrument and the energy applicator as a virtual rigid body, determining forces for applying to the virtual rigid body based on the forces and torques applied to the instrument, and enabling movement of the energy applicator to one or more positions different from the target position; and
transitioning from the manual mode back to the semi-autonomous mode by moving the energy applicator back to the target position on the tool path.
11. The method of claim 10 , wherein in response to transitioning from the semi-autonomous mode to the manual mode, the at least one controller applies force and torques to the virtual rigid body for holding the instrument in a static pose at the target position.
12. The method of claim 10 , wherein, in the semi-autonomous mode, the at least one controller determines forces to apply to the virtual rigid body for advancing the energy applicator from the target position to a subsequent target position on the tool path.
13. The method of claim 10 , wherein, in response to moving the energy applicator back to the target position on the tool path, the at least one controller controls the surgical manipulator in the semi-autonomous mode for resuming movement of the energy applicator along the tool path by advancing the energy applicator along the tool path by moving the energy applicator from the target position to a subsequent target position on the tool path.
14. The method of claim 10 , wherein, in response to transitioning from the manual mode back to the semi-autonomous mode, the at least one controller generates a new tool path.
15. The method of claim 10 , wherein the tool path comprises a plurality of path segments and the at least one controller computes the target position for one path segment of the plurality of the path segments based on one or more of the following:
a feed rate of the instrument;
a relationship between an initial position of a coordinate system of the energy applicator and starting and ending points of the one path segment; and
geometric characteristics of the one path segment.
16. The method of claim 10 , wherein the instrument further comprises a switch, and wherein the at least one controller transitions from the semi-autonomous mode to the manual mode in response to detecting actuation of the switch.
17. The method of claim 10 , further comprising a hand held pendant comprising a trigger and being configured to regulate operation of the surgical manipulator in the semi-autonomous mode, and wherein the at least one controller transitions from the semi-autonomous mode to the manual mode in response to detecting release of the trigger.
18. The method of claim 10 , further comprising a hand held pendant comprising a trigger and wherein the at least one controller controls operation of the surgical manipulator in the semi-autonomous mode in response to detecting actuation of the trigger.