# Patent

## Title
Tool grip calibration for robotic surgery

## Abstract

Telerobotic, telesurgical, and surgical robotic devices, systems, and methods selectively calibrate end effector jaws by bringing the jaw elements into engagement with each other. Commanded torque signals may bring the end effector elements into engagement while monitoring the resulting position of a drive system, optionally using a second derivative of the torque/position relationship so as to identify an end effector engagement position. Calibration can allow the end effector engagement position to correspond to a nominal closed position of an input handle by compensating for wear on the end effector, the end effector drive system, then manipulator, the manipulator drive system, the manipulator/end effector interfacing, and manufacturing tolerances.

## Background
CROSS-REFERENCE TO RELATED APPLICATIONS
This application is a continuation of U.S. patent application Ser. No. 14/748,647, filed Jun. 24, 2015, which is a continuation of U.S. patent application Ser. No. 14/272,862, filed May 8, 2014, now U.S. Pat. No. 9,085,083, which is a continuation of U.S. patent application Ser. No. 13/873,363, filed Apr. 30, 2013, now U.S. Pat. No. 8,761,930, which is a continuation of U.S. patent application Ser. No. 13/246,421, filed Sep. 27, 2011, now U.S. Pat. No. 8,452,447, which is a continuation of U.S. patent application Ser. No. 11/972,771, filed Jan. 11, 2008, now U.S. Pat. No. 9,317,651, which is a continuation of U.S. patent application Ser. No. 10/839,805, filed May 4, 2004, now U.S. Pat. No. 7,386,365, the entire disclosures of which are incorporated herein by reference.


BACKGROUND OF THE INVENTION
The present invention is generally related to medical, telesurgical, and/or telerobotic devices, systems, and methods. In an exemplary embodiment, the invention provides structures and methods that calibrate an end effector/telerobotic manipulator combination when a new surgical robotic tool is mounted on a manipulator arm.
Minimally invasive medical techniques are intended to reduce the amount of extraneous tissue that is damaged during diagnostic or surgical procedures, thereby reducing patient recovery time, discomfort, and deleterious side effects. While many of the surgeries performed each year in the US could potentially be performed in a minimally invasive manner, only a portion of current surgeries use these advantageous techniques due to limitations in minimally invasive surgical instruments and the additional surgical training involved in mastering them.
Minimally invasive telesurgical systems for use in surgery have been developed to increase a surgeon's dexterity and avoid some of the limitations on traditional minimally invasive techniques. In telesurgery, the surgeon uses some form of remote control (such as a servomechanism or the like) to manipulate surgical instrument movements, rather than directly holding and moving the instruments by hand. In telesurgery systems, the surgeon can be provided with an image of the surgical site at the surgical workstation. While viewing a two or three dimensional image of the surgical site on a display, the surgeon performs the surgical procedures on the patient by manipulating master control devices, which in turn control the motion of servomechanically operated instruments. The servomechanism used for telesurgery will often accept input from two master controllers (one for each of the surgeon's hands) and may include two or more robotic arms or manipulators. Mapping of the hand movements to the image displayed from the image capture device can help the surgeon provide more direct control over movement of the surgical instruments.
While the new telesurgical systems and devices have proven highly effective and advantageous, still further improvements would be desirable. For example, work in connection with the present invention has shown that misalignment between a robotic surgical end effector and an input device can decrease the useful life of some tools, and efforts to limit such misalignment can make tool and manipulator fabrication more difficult than may be ideal. As many surgical tools may be mounted on any particular manipulator during a single surgical procedure, and as tool changes will be performed while a procedure is under way, it is generally preferable to avoid and/or minimize any tool-swap related delays to the surgical procedure.
For the reasons outlined above, it would be advantageous to provide improved devices, systems, and methods for robotic surgery, telesurgery, and other telerobotic applications. It would be particularly beneficial if these improved technologies enhanced the precision and alignment of sophisticated robotic systems without significantly increasing complexity or costs, ideally allowing greater tool useful life and reliability.
BRIEF SUMMARY OF THE INVENTION
The present invention generally provides improved telerobotic, telesurgical, and surgical robotic devices, systems, and methods. The present invention may calibrate end effectors having jaws or the like formed with two separate end effector elements. The grip calibration will often be performed selectively, without calibrating some or all of the other degrees of freedom of an end effector/manipulator assembly. Selective calibration of grip actuation can be performed by bringing the jaw elements into engagement with each other, such as by clamping a microforceps closed, fully closing an electrosurgical scissor, closing the jaws of a needle grasper (with no needle or other structure disposed between the grasper elements), and the like. Robotic systems employing commanded torque signals may be calibrated by bringing the end effector elements into engagement while monitoring the resulting position of a drive system, optionally identifying a maxima or minima of a second derivative of the torque data so as to identify an end effector engagement position. Calibration may be effected so that the end effector engagement position corresponds to a nominal closed position of an input handle. Such calibration can compensate for wear on the end effector, the end effector drive system, then manipulator, the manipulator drive system, the manipulator/end effector interfacing, and manufacturing tolerances of each of the components of the end effector/manipulator assembly.
In a first aspect, the invention provides a telesurgical system comprising an input handle having a first grip member that moves relative to a second grip member in response to a hand gripping the handle. A plurality of end effectors each have surgical jaws with a first end effector element moveable relative to a second end effector element. A manipulator transmits a signal in response to mounting an end effector on that manipulator. The mounted end effector may be one of the plurality of end effectors. A processor couples the input device to the manipulator, and is configured to calibrate the mounted end effector and manipulator in response to the signal. The processor does this by causing a calibration movement of at least one of the end effector elements so as to bring the elements into mutual engagement. The processor is configured to effect articulation of the jaws of the mounted end effector in response to the gripping of the handle per the calibration.
Typically, an input linkage supports the handle and a robotic arm of the manipulator supports the mounted end effector. The input linkage and robotic arm may each have a plurality of degrees of freedom. The processor may effect movement of the robotic arm in response to articulation of the input linkage. The processor may be configured to effect the calibration in response to mounting of the end effector onto the robotic arm before the end effector is used in a robotic surgical procedure. The processor may not determine calibration from a calibration movement of at least one degree of freedom of the robotic arm between mounting of the end effector and the robotic procedure, so that the processor selectively calibrates articulation of the jaws. Work in connection with the present invention indicates that end effector jaw alignment may limit robotic surgical tool life, may impose stringent manufacturing tolerances, and/or may impose drive system strength criteria which are more onerous than those needed for some or all other degrees of freedom in robotic surgical tools. Hence, by selectively calibrating end effector jaw engagement, overall surgical tool life, tolerances, and/or costs can be improved. In fact, the processor may not effect a calibration movement of any degree of freedom of the robotic arm between mounting of the mounted end effector and the robotic procedure, other than articulation of the jaws. While other degrees of freedom may benefit from calibration movements along with (or instead of) end effector jaw articulator, additional calibration movements of other degrees of freedom may undesirably delay resumption of a surgical procedure interrupted by a tool swap.
Typically, the calibration will compensate for manipulator offset, manipulator wear, manipulator manufacturing tolerances, surgical instrument offset, surgical instrument wear, surgical instrument manufacturing tolerances, manipulator/surgical tool interfacing, and/or the like. The processor may monitor movement of a drive system coupled to the end effector, and can identify a change in torque. The processor may optionally comprise a filter, and the processor may determine the change in torque by applying the filter to torque data. In the exemplary embodiment, the processor determines an end effector element initial engagement position by taking a second derivative of the torque data. As a servo control loop may calculate the commanded torque from a commanded trajectory and manipulator position data, the processor may command a trajectory and monitoring the commanded torque from the servo controller so as to determine a position of the end effector where the commanded torque changes.
The input device may apply a feedback force to the hand at a nominal closed position of the handle. The processor may affect the calibration so that the end effector initial engagement configuration corresponds to the nominal closed position of the handle. The handle may comprise a biasing means for increasing resistance to gripping of the handle beginning at the nominal closed position. The biasing means may comprise a spring, resilient bumper, or the like.
In some embodiments, a single-element end effector may also be couplable to the manipulator. A single-element end effector identifying signal may be transmitted by the manipulator when the single-element end effector is mounted thereon, and the processor may forego grip calibration in response to the single-element end effector signal. In an exemplary embodiment, a tool type identifier may be transmitted from a memory of a tool to the processor when a tool having the single-element end effector is mounted to the manipulator, the tool type identifier being used by the processor to look up, from a table of the processor's memory, a parameter indicating that grip calibration need not be performed.
In the exemplary embodiment, the processor is configured to effect the calibration once per robotic procedure for each end effector mounted on the manipulator. If an end effector is mounted on a second manipulator, the processor can again effect the calibration once per robotic surgical procedure for that end effector/manipulator combination. The calibration may be stored during the procedure in a memory of the processor so that when a tool has been removed from a particular manipulator and is subsequently remounted onto that manipulator, the calibration information can be applied without causing the calibration movement and the like.
In another aspect, the invention provides a telerobotic system comprising an input having a linkage supporting a handle. The handle has a first grip member that moves relative to a second group member when a hand grips the handle. The linkage is articulable for repositioning of the handle. A plurality of end effectors each comprise articulatable jaws with a first end effector element moveable relative to a second end effector element. A manipulator having a robotic arm movably supports a mounted end effector from among the plurality of end effectors. A processor couples the input device to the manipulator. The processor determines the calibration of the mounted end effector by causing a calibration movement of the end effector elements into mutual engagement. The processor effects articulation of the jaws of the mounted end effector in response to the gripping of the handle per the calibration.
In another aspect, the invention provides a telesurgical method comprising mounting a first surgical end effector to a manipulator. The end effector comprises jaws with a first end effector element movable relative to a second end effector element. The mounted first end effector and its supporting manipulator are calibrated by moving at least one of the end effector elements so as to bring the elements into mutual engagement. A handle is gripped with a hand so that a first grip member moves relative to a second grip member. An articulation signal is computed in response to the gripping of the handle per the calibration. The jaws articulate in response to the articulation signal so that the jaws of the first end effector move in correlation with the gripping of the handle.



BRIEF DESCRIPTION OF THE DRAWINGS
FIGS. 1A and 1B are perspective views illustrating a master surgeon console or workstation for inputting a surgical procedure, and a robotic patient-side cart for robotically moving surgical instruments having surgical end effectors at a surgical site, respectively.
FIG. 2 is a side view showing an exemplary input device for use with the master control workstation of FIG. 1A.
FIG. 2A is a perspective view of a handle and wrist of the input device of FIG. 2.
FIG. 3 is a perspective view of an exemplary robotic surgical instrument or tool having a memory and a data interface.
FIGS. 3A-3F are perspective views of a plurality of different end effectors for surgical instruments of different types.
FIG. 4 shows a block diagram representing control steps followed by the control system of a minimally invasive surgical robotic apparatus in effecting movement of the end effector of the instrument of FIG. 3 in response to the movement of the input device of FIG. 2.
FIG. 5A-5D schematically illustrate master/slave following forces applied to grip different sized objects.
FIGS. 6A-6C are functional block diagrams schematically illustrating master/slave arrangements for manipulating the position, orientation, and jaws of a robotic surgical instrument.
FIG. 7 schematically illustrates an exemplary master/slave robotic control system for actuating jaws of an end effector while providing tactile feedback to a hand of an operator.
FIG. 8 is a functional block diagram schematically illustrating a telesurgical system according to the principles of the present invention.
FIG. 9 graphically illustrates a relationship between joint position and servo counts during actuation of a surgical robotic end effector in the system of FIG. 8.
FIG. 10 graphically illustrates a relationship between commanded torque and servo counts during end effector actuation in the system of FIG. 8.
FIG. 11 graphically illustrates a relationship between commanded torque and servo counts as taken from the data of FIG. 10, in which the commanded torque has been filtered.
FIGS. 12A-12C graphically illustrate taking of a second derivative of the relationship illustrated in FIG. 11.
FIG. 13 graphically illustrates a relationship between commanded torque and joint position, and identifies an initial end effector engagement configuration at which the end effector elements are brought into mutual engagement.



DETAILED DESCRIPTION OF THE INVENTION
The present invention generally provides telerobotic, telesurgical, and surgical systems, devices, and methods. The invention is particularly advantageous for use with robotic surgical systems, in which a plurality of surgical instruments will be sequentially mounted on a manipulator during the surgical procedure. Loss of correlation between an input handle grip actuation and jaw articulation of telesurgical systems can be particularly problematic during telesurgery, and may be significantly more problematic than maintaining correlation between other input and output degrees of freedom in a surgical master/slave system. In some embodiments, by selectively calibrating end effector jaw movement (as opposed to calibrating all degrees of freedom of the slave), unnecessary surgical delays during tool swaps (in which one surgical instrument is removed from the manipulator and replaced with a different surgical instrument) can be avoided. In other embodiments, calibration of all axes may be performed.
While the most immediate applications for the present invention may include telesurgical systems, the inventions described herein may also find applications in other telerobotic and robotic surgical systems.
As used herein, the term “tool” encompasses robotic tools having robotic end effectors for coupling to robotic systems. The term “instrument” encompasses medical instruments, including both those having articulatable jaws (such as microforceps, needle graspers, staplers, electrosurgical scissors, and the like) and those having a single end effector element (such as scalpels, electrosurgical coagulators, and the like). In the exemplary embodiment, a robotic surgical system makes use of a series of removable and replaceable end effectors supported by a robotic arm, so that the end effector assembly is both a tool and an instrument. In robotic embodiments used in non-surgical applications, the end effector assembly may comprise a robotic tool that is not a medical instrument.
The data, reprogrammable software, program method steps, and method steps described herein may be embodied in a machine readable code and stored as a tangible medium in a wide variety of differing configurations, including random access memory, non-volatile memory, write once memory, magnetic recording media, optical recording media, and the like. Along with software, at least some of the programming and data may be embodied in the form of hardware or firmware.
Referring to FIG. 1A of the drawings, an operator workstation or surgeon's console of a minimally invasive telesurgical system is generally indicated by reference numeral 200. The workstation 200 includes a viewer 202 where an image of a surgical site is displayed in use. A support tool 4 is provided on which an operator, typically a surgeon, can rest his or her forearms while gripping two master controls (see FIG. 2), one in each hand. The master controls or input devices are positioned in a space 206 inwardly beyond the support 204. When using the control workstation 200, the surgeon typically sits in a chair in front of the control station, positions his or her eyes in front of the viewer 202 and grips the master controls, one in each hand, while resting his or her forearms on the support 204.
In FIG. 1B of the drawings, a cart or surgical station of the telesurgical system is generally indicated by reference numeral 300. In use, the cart 300 is positioned close to a patient for whom surgery is planned, and the base of the cart is then maintained at a stationary position until a surgical procedure has been completed. Cart 300 typically has wheels or castors to render it mobile. The workstation 200 is typically positioned at some distance from the cart 300, optionally being separated by a few feet within an operating room, although cart 300 and workstation 200 may alternatively be separated by a significant distance.
The cart 300 typically caries three robotic arm assemblies, although more than three arms may also be provided or may be the norm for some embodiments. One of the robotic arm assemblies, indicated by reference numeral 302, is arranged to hold an image capturing device 304, e.g., an endoscope, or the like. Each of the two other arm assemblies 10 includes a surgical instrument 14. The endoscope 304 has a viewing end 306 at a distal end of an elongate shaft. Endoscope 304 has an elongate shaft to permit viewing end 306 to be inserted through an entry port into an internal surgical site of a patient's body. The endoscope 304 is operatively connected to the viewer 202 to display an image captured at its viewing end 306 on the viewer. Each robotic arm assembly 10 is normally operatively connected to one of the master controls, although the processor may alter which robotic arm assembly is operatively connected with a master control. Thus, the movement of the robotic arm assemblies 10 is controlled by manipulation of the master controls. The instruments 14 of the robotic arm assemblies 10 have end effectors mounted on wrist members, which are in turn pivotally mounted on distal ends of elongate shafts of the instruments 14. Instruments 14 have elongate shafts to permit the end effectors to also be inserted through entry ports into the internal surgical site of a patient's body. Movement of the end effectors relative to the ends of the shafts of the instruments 14 is also controlled by the master controls.
The robotic arms 10, 302 are mounted on a carriage 97 by means of setup joint linkages 95. The carriage 97 can be adjusted selectively to vary its height relative to a base 99 of the cart 300, as indicated by arrows K. The setup joint linkages 95 are arranged to enable the lateral positions and orientations of the arms 10, 302 to be varied relative to a vertically extending column 93 of cart 300. Accordingly, the positions, orientations and heights of the arms 10, 302 can be adjusted to facilitate passing the elongate shafts of the instruments 14 and the endoscope 304 through the entry ports to desired positions relative to the surgical site. When the surgical instruments 14 and endoscope 304 are so positioned, the setup joint arms 95 and carriage 97 are typically locked in position. Workstation 200 and cart 300 are described in more detail in U.S. Pat. No. 6,424,885, the full disclosure of which is incorporated herein by reference.
An exemplary input device 220 and surgical instrument 14 are illustrated in FIGS. 2 and 3, respectively. Input device 220 includes an arm 222 and a wrist 224 which allow positional and orientational movement of an input handle 226 relative to the structure of workstation 200 (see FIG. 1A). Handle 226 will generally move with a plurality of degrees of freedom relative to the workstation structure, the exemplary input device 220 providing six degrees of freedom for movement of handle 226. The linkage supporting the handle may include more or less than six degrees of freedom.
FIG. 2A illustrates wrist 224 and handle 226 in more detail. Wrist 224 generally comprises a gimbal assembly supporting handle 226, with the handle having first and second grip members 30a, 30b. Wrist 224 generally accommodates changes in orientation of handle 226 with three orientational degrees of freedom.
In the exemplary embodiment, wrist 224 includes links 32a, 32b, and 32c. Wrist 224 is mounted to input arm or linkage 222 (see FIG. 2). The links of the wrist can rotate about axes 34a, 34b, 34c, and 34d. Hence, wrist 224 provides four orientational degrees of freedom, including one redundant orientational degree of freedom. A drive system is coupled to the wrist links so as to take advantage of this redundant degree of freedom and provide a wide range of motion as described in U.S. Pat. No. 6,714,839 entitled “Master Having Redundant Degrees of Freedom”, the full disclosure of which is incorporated herein by reference.
Unlike the joints of wrist 224 and input linkage 222, grip members 30a and 30b of handle 226 pivot passively about an axis 36 with no drive motor provided for feedback from the slave. In the exemplary embodiment, a hall effect transducer is mounted in one of the grip members and a magnet is mounted in the other, so that handle 30 generates a grip signal indicating the angular separation between grip numbers 30a and 30b. A biasing system urges the grip members apart, and the grip members may include loops of VelcroTM or the like to more firmly position the grip members relative to a thumb and finger of the system operator. A wide variety of grip member structures might be used within the scope of the invention, including any surgical instrument handles, optionally including rigid or flexible loops for the thumb and/or fingers.
Referring now to FIG. 3, surgical instrument 14 generally includes a surgical end effector 50 supported relative to a housing 53 by an elongate shaft 14.1. End effector 50 may be supported relative to the shaft by a distal joint or wrist so as to facilitate orienting the end effector within an internal surgical workspace. Proximal housing 53 will typically be adapted to be supported by a holder of a robot arm.
As described in more detail in U.S. Pat. No. 6,331,181, the full disclosure of which is incorporated herein by reference, instrument 14 will often include a memory 230, with the memory typically being electrically coupled to a data interface of a holder engaging surface 232 of housing 53. This allows data communication between memory 230 and a robotic surgical processor 210 of workstation 200 (see FIG. 1A). In the exemplary embodiment, memory 230 comprises a Dallas chip sold with part number DS2505 having 69 kilobits of data storage capacity.
Referring now to FIGS. 3A-3F, a variety of alternative robotic surgical tools of differing types and having differing end effectors 50 may be provided. Several of these end effectors, including DeBakey forceps 56i, microforceps 56ii, Potts scissors 56iii, and clip plier 56iv include first and second end effector elements 56a, 56b which pivot relative to each other so as to define a pair of end effector jaws. Other end effectors, including scalpel 56v and electrocautery probe 56vi have a single end effector element.
While the present invention may find applications with surgical robotic end effectors having a single element, the invention is particularly advantageous for use with end effectors defined by multiple end effector elements. In many embodiments, the tool or end effector type can be recognized by the system through reading of some or all of the data stored by memory 230 mounted on tool 14 (see FIG. 3).
Information from the memory can be used to perform a number of functions when the tool is loaded on the tool holder of the manipulator arm. For example, the memory can be used to provide a signal verifying that the tool is compatible with the robotic system. The tool memory may store data identifying the tool type to the robotic system so that the robotic system can reconfigure its programming to take full advantage of the tool's specialized capabilities. The tool memory can also store a specific or unique identifier for that particular tool for use in controlling tool life and hence reliability, for determining whether calibration of that particular tool has already been performed during the current (or in some embodiments, a prior) procedure, and the like. Exemplary surgical robotic tool/manipulator interface structures and details regarding data transfer between tools and robotic system processors are more fully described in U.S. Pat. No. 6,331,181 and in an application entitled, “Tool Memory Based Software Upgrades for Robotic Surgery”, filed concurrently herewith.
As can be understood by reference to FIGS. 1A, 1B, and 4, processor 210 of workstation 200 may be configured to effect corresponding movement of a surgical instrument mounted to a robotic arm in response to movement of an input handle by employing software embodying a control logic 212. Control logic 212 effects movement of end effector 50 within an internal surgical site by pivoting an instrument shaft 14.1 about a minimally invasive insertion point (see FIG. 3). The control logic 212 employed by processor 210 generates motor drive signals in response to an input handle movement. These motor drive signals are transmitted to the robot arms, and cause movement at the end effector that corresponds to movement at the input handle. Logic 212 of processor 210 can accommodate a wide variety of differing tool kinematics of a variety of differing tools (such as those illustrated in FIGS. 3A-3F) when information regarding the tool type currently mounted to a robotic arm is made available to the processor.
Maintaining precise control over movement of surgical tools in general, and robotic surgical tools in particular, enhances the safety and therapeutic benefits of surgery. The use of elongate, relatively thin surgical instruments also enhances the benefits of robotic surgery, as such thin-shafted instruments can be inserted to an internal surgical site with less trauma to the patient. The surgical instruments, however, can be fairly sophisticated and complex mechanical assemblies, particularly where a plurality of end effector elements and/or degrees of freedom are provided at the distal end of the elongate shaft. Instruments 14 may include drive systems comprising cables, pulleys, rods, gears, and the like, and these mechanical components are subject to both manufacturing tolerances and wear during the life of the tool. Additionally, the manipulator or robotic arm on which the tool is mounted may have a drive system for both transmitting motion to the tool and for moving the tool holder in space, along with having motors and position sensors for receiving drive signals from and transmitting feedback signals to the processor of the robotic system. Many of these components are also subject to deterioration from wear, along with having an initial resolution or tolerance when new. Lastly, coupling of the instrument to the robotic arm via the holder will often comprise a mechanical engagement so as to transmit mechanical movement from the motor and drive system of the robotic arm to the end effector, along with structural engagement between the housing of the instrument and the holder itself. Hence, misalignment between the end effector and an input device may have a number of sources, and may vary significantly between different robotic arms and tools mounted on robotic arm combinations.
Telesurgical and other telerobotic systems can accommodate a certain amount of misalignment between an input device and an end effector, as described more fully in U.S. Pat. No. 6,424,885, the full disclosure of which is incorporated herein by reference. However, misalignment between the gripping members of a handle and the end effector elements of a pair of jaws can be particularly problematic.
Referring now to FIG. 6A, a simplified reciprocal master/slave arrangement is used to illustrate actuation of manipulator 10 so as to provide orientation and positioning of end effector 50 in response to movement of handle 226 of the input controller 200. It should be understood that the various master and slave positions θ may comprise vectors (in Cartesian space, polar space, joint space, or the like) as well as simple angles or linear separations, and the kinematic chains of the master and slave may be quite different, often even having different degrees of freedom. To provide force feedback to the operator, the master input device is actively driven by its motors toward alignment with the position occupied by slave 10. The amount of following force applied by the operator on the slave (and the reciprocal feedback on the operator's hand) are a function of a misalignment between a position (and orientation) of the master input device and apposition (and orientation) of the slave end effector.
As illustrated schematically in FIG. 6A, master input device 200 defines an actual master position θma. This actual position of the master is fed into the slave portion of the controller as a desired slave position θsd. The amount of force applied by the end effectors of the slave will vary with the difference between the desired position of the slave θsd and the actual position of the slave θma, with the following force on the end effectors increasing with increasing misalignment between the actual and desired positions, often with a proportional relationship.
To provide force feedback to the operator manipulating the master input device 200, the actual slave position θma is fed back into the motors of the input device as a desired master position θsd. Once again, the amount of force imposed by the motors of the master on the operator through the input device will vary with the misalignment or positional separation between the desired master position and the actual master position. This allows the operator to apply varying amounts of force through the servomechanism using the end effectors, and to have tactile feedback regarding the amount of force that has been applied.
While the reciprocal master/slave arrangement of FIG. 6A may be implemented to actuate end effector 50 in response to manipulation of handle 226 for gripping of objects between end effector elements 56a and 56b, the uniform following forces provided by this arrangement can have disadvantages, as can be understood with reference to FIGS. 5A-5D. End effector 50 is first shown engaging a relatively large tissue T1 with no gripping force. The master position θm is equal to the slave position θs. As there is no difference between the signals generated to measure these positions, the positional error signal, separation misalignment, and following forces are all zero.
Referring now to FIG. 5B, as the operator imposes squeezing forces on handle 226 to bring gripping members 30a, 30b closer together (and thereby reducing the separation angle), the servomechanism begins to apply the following forces against end effector 50. As the difference between the grip angle and end effector angle increases, the following forces imposed by the end effector elements against the large tissue T1 (and the reactive forces of the tissue against the end effector) increase. Eventually, the following forces reach a maximum Fm, which may be determined by a strength of the surgical tool, a limitation of the motor torque, or a limitation based on the intended uses of the tool (for example, to avoid severing of tissues with forceps). Regardless, the servomechanism will preferably limit the following forces before irreparable damage is inflicted on the robotic system.
To implement maximum following forces Fm, the operator has squeezed gripping members 30a, 30b well beyond the separation angle between the end effector elements. While it is generally preferable to maintain a one-to-one correlation between the angles of the gripping members and end effector elements, having a significant misalignment to effect the maximum following forces is generally acceptable when the separation angle of the gripping members remains significantly above zero once the maximum following force Fm is imposed. Optionally, handle 30 may impose reciprocal forces Fr against the hand of the operator to provide a tactile indication of the strength with which thick tissue T1 is being gripped to the operator.
As illustrated in FIGS. 5C and 5D, the situation is less acceptable when a thin tissue T2 of negligible thickness is gripped. When just engaging the tissue with the elements of end effector 50, the gripping members of handle 226 again define a separation angle that is substantially equal to the separation angle defined by the end effector elements. However, as this gripping configuration provides a quite small angular separation between the gripping members, imposition of maximum following forces Fm against small tissue T2 only results when the gripping members are pushed beyond each other to define a negative gripping angle. This unnatural gripping actuation detracts from the operator's ability to accurately control the end effectors, particularly during delicate telepresence procedures involving the gripping of small objects, such as sutures, needles, and small tissues during telesurgery.
Referring now to FIG. 6B, an alternative servomechanism arrangement artificially alters the actual master position θma, according to a function f to derive a desired slave position θsd. Function f takes the form θsd=f (θma), and is preferably an invertible (monotonic) and continuous function of the actual master position. Function g represents reciprocal forces imposed on the hand of the system operator, and will preferably also comprise a continuous, invertible function. Preferably g will provide one-to-one actuation when open, will have the slave just closed when the master is just closed, and will have a slope below the “just closed” point so that the restoring force applied against the operator's hand matches that of a conventional tool, thereby providing feedback to the operator accurately reflecting the enhanced forces provided when the end effector and handle are near their closed configurations.
As can be understood with reference to FIGS. 6B and 5D, function f may be tailored so that once the separation between the gripping members drops below a predetermined point a small additional decrease in gripping member separation θma will result in a significantly larger change in the desired position of the slave θsd. Above the predetermined point, the actual master position and desired slave position can remain the same, thereby providing the greatest dexterity for the system operator's control over the end effector.
Referring now to FIG. 6C, an alternative servomechanism arrangement makes use of function f to alter the actual position of the grip members so as to generate the desired position of the slave end effector, as described above. However, rather than relying on a reciprocal master/slave arrangement to provide feedback of the augmented end effector forces as the grip members and end effector elements approach their closed configuration, the system of FIG. 5C relies on a biasing system 60 which interacts with the operator's hand 62 to provide tactile feedback to the operator with a feed forward system, as can be understood with reference to U.S. Pat. No. 6,594,552, the full disclosure of which is incorporated herein by reference.
As can be understood with reference to FIG. 7, a biasing mechanism such as a spring, magnet, resilient bumper, or the like can define a predetermined transition point or nominally closed position of the input handle. In the exemplary embodiment, a biasing system includes an elastomeric bushing 60a surrounding a grip return spring 60b. The grip return spring opens the gripping members of handle 226 throughout their range, while the bushing provides tactile feedback to a hand of an operator when the handle reaches a nominal closed position. Continued movement of the gripping members is possible beyond the nominal closed position so as to apply force at the end effector elements. Torques are applied to end effector elements 56a, 56b and positions of the end effector elements are measured via a drive system 70, as described more fully in the '555 patent.
Referring now to FIG. 8, a robotic surgical system 400 includes a processor 402 coupling first and second input devices 404 to associated robotic manipulators 406. Each manipulator includes a tool holder 408 that both holds and provides a data interface with a mounted tool 410. As tools will often be removed and replaced repeatedly during a surgical procedure, for example, to allow use of an electrocautery paddle followed by a needle grasper, a plurality of alternative tools 412 are available to be used in place of either of the mounted tools.
When one type of tool is removed from holder 408 and replaced by another type of tool, data from tool memory 230 (see FIG. 3) is transmitted from the newly mounted tool to the processor 402. This allows the processor to be reconfigured so as to allow the surgeon to accurately and safely use tools of different types. This data may also include a specific tool identifier so as to allow the processor to determine or monitor characteristics and use of that particular tool, including tool life, etc. As explained in more detail in an application entitled “Tool Memory-Based Software Upgrades for Robotic Surgery,”, filed concurrently herewith and incorporated herein by reference, the tool memory may also be used to update data and/or software stored in a memory of processor 402, thereby allowing the use of new tools which have been developed, approved, and/or distributed a most recent software revision has been downloaded to processor 402 using conventional storage media, network connections, or the like. The grip calibration procedure described herein may take place at least in part during downloading of data from mounted tool 410 so as to avoid unnecessary delays in a procedure, and need not be implemented if processor 402 determines it is not needed, for example, if a tool type identifier stored in a memory of the tool and transmitted from the slave indicates that the mounted tool has only a single end effector or if the desired grip calibration data is already stored in a grip calibration table 405 in a memory of the processor.
For the present invention, processor 402 may determine whether a particular tool has been loaded on a specific manipulator, and may store grip calibration data for that tool/manipulator combination in grip calibration table 405. That grip calibration data may optionally be used if the same tool is remounted on the same manipulator. Such re-use of grip calibration data may be limited, so that the data will only be used if the tool is remounted within a time span, during a surgical procedure, a number or amount of tool use, or prior to some event.
Manipulator 406 often transmits a signal to processor 402 indicating that a tool has been mounted to holder 408. Processor 402 includes a grip calibration module 403, which may include hardware, software, and/or a combination of both, the grip calibration module often comprising machine readable code embodying programming instructions for implementing a grip calibration method, optionally in response to the tool-mounting signal. Using this grip calibration method, processor 402 can determine and store an end effector/manipulator grip offset, which can include offsets of the instrument (due to cable stretch, manufacturing offsets, and the like), offsets of the manipulator 406 (including homing error, calibration, cable stretch, and the like), and/or interface offsets resulting from the combination of tool interface 232 (see FIG. 3) with holder 408. Hence, the grip calibration module of processor 402 can compensate for these offsets so as to improve following of end effector jaws in response to grasping of a handle 404. By adjusting processor 402 so as to compensate for aging of the manipulator and/or end effector, the grip calibration module may maintain or improve performance of used instruments.
Referring now to FIGS. 8, 9, and 10, after instrument mounting, processor 402 implements the grip calibration method. A tool type identifier and a specific tool identifier may be transmitted by the manipulator from the memory of the tool to the processor, allowing the processor to determine whether grip calibration is appropriate. For example, the processor may look-up a parameter in a table of the processor memory associated with the tool type identifier, so that tools having single end-effector elements do not undergo a grip calibration, or so that a clip applier (as illustrated in FIG. 3D) does not deploy a clip during calibration. Alternatively, the processor may determine from the tool identifier that the mounted tool has previously been mounted to the same manipulator previously during the same procedure, and may therefore look-up the desired calibration information from a calibration data table 405. The calibration data table my comprise jaw closure offset for specific tool manipulator combinations.
If processor 402 determines that a new calibration procedure is appropriate for the mounted tool, the processor transmits drive signals to manipulator 408 on which a tool 410 has been mounted. In response to these signals, one or more motors of manipulator 406 move the end effectors into mutual engagement, with the motors typically applying torque to the end effectors via a coupling drive system (see FIG. 12) so as to attempt to move even further against each other, thereby squeezing the end effector closed. In the exemplary embodiment, the processor may command a trajectory or movement of the end effector, causing a servo controller loop of the processor to calculate a commanded motor torque using a position of the end effector element. Processor 402 monitors and stores joint position and commanded torque data as illustrated in FIGS. 9 and 10, respectively. The servo counts shown in FIGS. 9-12C can represent time, with the exemplary servo loop operating with a cycle frequency of 1333 Hz.
When the end effector elements are commanded to move from an open configuration to beyond a closed configuration, a significant change in commanded torque may be expected where the end effector are first fully closed, which may be referred to as a mutual engagement configuration. In other words, the associated motor will be driven harder to effect the commanded movement after the end effectors begin pushing against each other. This change in commanded torque may appear as a “knee” in the commanded torque graph of FIG. 10. However, the precise location of the knee may not be immediately clear. To facilitate identification of the end effector mutual engagement position, it is helpful to limit the analysis of the data to a limited range. The data may be restricted to a position range within which engagement is expected to occur, thereby assuming that the calibration offset will be within a predetermined range. For example, it may be assumed that the calibration offset for the end effector mutual engagement configuration will be between a nominal or initially commanded configuration of the jaws being open by 5 degrees (+5 degrees), and the jaws being squeezed past closed by 20 degrees (−20 degrees).
The commanded torque plot of FIG. 10 may reflect variations in torque applied to compensate for friction in the manipulator, to enhance precision, and the like, as more fully described in U.S. Pat. No. 6,565,554. These commanded torques are effectively noise when determining grip calibration, with the noise primarily being at approximately the Nyquiest frequency, largely above the frequency of interest for calibration analysis. Hence, it may be helpful to include in processor 402 a filter to help identify the knee in the commanded torque draft. The filter may comprise a low pass filter, the exemplary filter comprising a 5 Hz low pass Butterworth filter, although other frequencies might also be used. The filtered commanded torque in the area of interest is illustrated in FIG. 11, showing the expected knee.
Referring now to FIGS. 11 and 12A-12C, the mutual engagement configuration of the end effector should correlate with the position of greatest curvature in the negative direction of the commanded torque data. This can be identified from the minima of the second derivative of the commanded torque. Once the mutual engagement configuration is known, calibration of the mounted tool can then be effected by applying a difference between the actual position and the commanded position of the end effectors as an offset to the grip controllers described above, for example, so that the closed configuration of the handle 226 (at which the handle members first engage the resilient bumper 60a) corresponds to the mutual engagement configuration of the end effectors. This difference can be stored as an offset in grip calibration data table 405 for the tool/manipulator combination.
Typically, grip calibration will take over a half a second to implement, often taking over a second, with the exemplary embodiment taking about 2 seconds. To avoid excessive delays during a procedure, processor 402 may store the grip calibration offset or other grip data in a memory of the processor, with the memory ideally storing a table of grip calibrations and instrument identifiers for each manipulator, so that the processor records each end effector/manipulator combination used during a surgical procedure. If an instrument has already been used during a procedure, the stored calibration may be used without repeating the grip calibration—if the mounted instrument has not previously been mounted on that particular manipulator during a procedure, the grip calibration will be performed. Grip calibration may be performed during data reading from and/or writing to information on the memory of the tool, which may occur when a tool is first used in each procedure.
Grip calibration may not determine an appropriate offset for a tool/manipulator combination for a variety of reasons, including a broken cable or failure of the tool interface to properly engage with the tool holder, a tool never reaching the commanded or mutual engagement configuration, and the like. For calibration failures, the grip calibration offset can be safely set to zero, so that the tool is assumed to be at the nominally commanded configuration, as the instruments may be inoperative (and hence will not be used anyway). By not storing data for calibration failures, the processor may treat the tool as not previously having been mounted on the manipulator, so that calibration can again be attempted.
Optionally, the grip calibration procedure may be deemed inappropriate for one or more tool types having two end effector elements. For example, although a clip applier as illustrated in FIG. 3D may benefit a grip calibration, such a calibration may actuate a clip prior to the clip reaching the target tissue. Hence, the processor may forego grip calibration in response to some tool type identifiers of such tools.
While the exemplary embodiments have been described in detail, for clarity of understanding and by way of example, a variety of changes, adaptations, and modifications will be obvious to those of skill in the art. Hence, the scope of the present invention is limited solely by the appended claims.

## Claims

1. An apparatus comprising:
a master input device configured to generate a master input signal; and
a processor configured to receive the master input signal;
a robotic manipulator configured to support a mounted end effector and manipulate the mounted end effector in a plurality of degrees of freedom, the robotic manipulator transmitting a signal to the processor indicating mounting of the end effector onto the robotic manipulator;
wherein the processor is configured to:
calibrate a static configuration of the master input device to a predetermined configuration of the mounted end effector in response to receiving the signal indicating mounting of the end effector onto the robotic manipulator, the calibration generating a calibration offset;
based on the calibration offset, drive the end effector in the plurality of degrees of freedom in response to the master input signal.

2. The apparatus of claim 1, the master input device comprising:
an input handle movable with a plurality of degrees of freedom;
an arm and a wrist, the arm and the wrist allowing positional and orientational movement of the input handle relative to a structure of the apparatus.

3. The apparatus of claim 2, the wrist comprising a gimbal assembly supporting a handle having first and second grip members.

4. The apparatus of claim 3, further comprising a Hall effect transducer mounted in one of the first and second grip members and a magnet mounted in another of the first and second grip members to generate a grip signal indicating the angular separation between the first and second grip members.

5. The apparatus of claim 3, further comprising a biasing system urging the first and second grip members apart.

6. The apparatus of claim 5, the biasing system comprising a spring or a resilient bumper.

7. The apparatus of claim 1, the end effector coupled to a housing by an elongate shaft, the end effector supported relative to the shaft by a distal joint, the robotic manipulator configured to support the mounted end effector by supporting the housing coupled to the end effector.

8. The apparatus of claim 7, the end effector comprising first and second end effector elements which pivot relative to each other, the end effector further coupled to a memory used to provide a signal verifying that the end effector is compatible with the processor.

9. The apparatus of claim 2, the end effector comprising a pair of end effector elements, the predetermined configuration of the mounted end effector comprising mutual engagement of the end effector elements, the static configuration of the master input device corresponding to gripping of the input handle.

10. The apparatus of claim 1, wherein the processor is further configured not to calibrate any other degree of freedom of the robotic manipulator between mounting of the end effector to the robotic manipulator and a robotic procedure performed using the end effector.

11. The apparatus of claim 1, further comprising a second robotic manipulator configurable to support a mounted end effector, wherein the processor is further configured to calibrate the end effector when mounted to the second robotic manipulator.

12. The apparatus of claim 1, the robotic manipulator comprising a drive system to drive the end effector, wherein the processor is configured to calibrate the end effector by monitoring movement of the drive system when driving the end effector, and identifying a change in torque applied by the drive system during the monitoring.

13. The apparatus of claim 12, the processor further configured to identify the change in torque by applying the filter to torque data derived from the drive system.

14. The apparatus of claim 13, the processor configured to determine an end effector initial engagement position by taking a second derivative of the torque data versus time, and identifying a maximum or minimum in the second derivative.

15. The apparatus of claim 1, further comprising a memory coupled to the processor, wherein the calibration offset derived by the processor is stored in the memory coupled to the processor.

16. The apparatus of claim 15, wherein the processor is configured to apply the calibration offset to driving the manipulator when the end effector corresponding to the stored calibration offset is removed from the manipulator, and subsequently re-mounted.

17. The apparatus of claim 1, wherein a feedback force is applied by the master input device at a nominal closed position of the input device, and the processor affects calibration so that initial engagement of the end effector corresponds to the nominal closed position of the master input device.

18. The apparatus of claim 1, the robotic manipulator further transmitting a single-element end effector signal to the processor in response to a single-element end effector being mounted on the processor, wherein the processor is configured to forego calibration of the end effector in response to receiving the single-element end effector signal.

19. The apparatus of claim 1, the transmitted signal specifying a tool type of the end effector to the processor, wherein the processor is configured to forego calibration of the end effector in response to receiving a signal specifying that the end effector is a single-element end effector.

20. The apparatus of claim 1, wherein a plurality of end effectors are mountable on the robotic manipulator over time, and the processor is further configured to effect calibration of each of the plurality of end effectors once per robotic procedure utilizing an end effector.