# Patent

## Title
Systems and methods for tracking a path using the null-space

## Abstract

Devices, systems, and methods for providing a desired movement of one or more joints of a manipulator arm having a plurality of joints with redundant degrees of freedom while effecting commanded movement of a distal end effector of the manipulator. Methods include defining a constraint, such as a network of paths, within a joint space defined by the one or more joints and determining a movement of the plurality of joints within a null-space to track the constraints with the one or more joints. Methods may further include calculating a reconfiguration movement of the joints and modifying the constraints to coincide with a reconfigured position of the one or more joints. Various configurations for devices and systems utilizing such methods are provided herein.

## Background
CROSS-REFERENCES TO RELATED APPLICATIONS
This application is a Non-Provisional of and claims the benefit of priority from U.S. Provisional Patent Application No. 61/799,444 filed on Mar. 15, 2013 and entitled “Systems and Methods for Tracking a Path Using the Null-Space”, the full disclosure of which is incorporated herein by reference.
The present application is generally related to the following commonly-owned applications: U.S. application Ser. No. 12/494,695 filed Jun. 30, 2009, entitled “Control of Medical Robotic System Manipulator About Kinematic Singularities;” U.S. application Ser. No. 12/406,004 filed Mar. 17, 2009, entitled “Master Controller Having Redundant Degrees of Freedom and Added Forces to Create Internal Motion;” U.S. application Ser. No. 11/133,423 filed May 19, 2005 (U.S. Pat. No. 8,004,229), entitled “Software Center and Highly Configurable Robotic Systems for Surgery and Other Uses;” U.S. application Ser. No. 10/957,077 filed Sep. 30, 2004 (U.S. Pat. No. 7,594,912), entitled “Offset Remote Center Manipulator For Robotic Surgery;” and U.S. application Ser. No. 09/398,507 filed Sep. 17, 1999 (U.S. Pat. No. 6,714,839), entitled “Master Having Redundant Degrees of Freedom;” U.S. Provisional Application No. 61/654,755 filed Jun. 1, 2012, entitled “Manipulator Arm-to-Patient Collision Avoidance Using a Null-Space;” and U.S. Provisional Application No. 61/654,773 filed Jun. 1, 2012, entitled “System and Methods for Avoiding Collisions Between Manipulator Arms Using a Null-Space,” the disclosures of which are incorporated herein by reference in their entireties.


BACKGROUND OF THE INVENTION
The present invention generally provides improved surgical and/or robotic devices, systems, and methods.
Minimally invasive medical techniques are aimed at reducing the amount of tissue which is damaged during diagnostic or surgical procedures, thereby reducing patient recovery time, discomfort, and deleterious side effects. Millions of “open” or traditional surgeries are performed each year in the United States; many of these surgeries can potentially be performed in a minimally invasive manner. However, only a relatively small number of surgeries currently use minimally invasive techniques due to limitations in surgical instruments, and techniques, and the additional surgical training required to master them.
Minimally invasive telesurgical systems for use in surgery are being developed to increase a surgeon's dexterity as well as to allow a surgeon to operate on a patient from a remote location. Telesurgery is a general term for surgical systems where the surgeon uses some form of remote control, e.g., a servomechanism, or the like, to manipulate surgical instrument movements rather than directly holding and moving the instruments by hand. In such a telesurgery system, the surgeon is provided with an image of the surgical site at the remote location. While viewing typically a three-dimensional image of the surgical site on a suitable viewer or display, the surgeon performs the surgical procedures on the patient by manipulating master control input devices, which in turn control the motion of robotic instruments. The robotic surgical instruments can be inserted through small, minimally invasive surgical apertures to treat tissues at surgical sites within the patient, often the trauma associated with accessing for open surgery. These robotic systems can move the working ends of the surgical instruments with sufficient dexterity to perform quite intricate surgical tasks, often by pivoting shafts of the instruments at the minimally invasive aperture, sliding of the shaft axially through the aperture, rotating of the shaft within the aperture, and/or the like.
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 of the robotic instruments displayed by the image capture device can help provide the surgeon with accurate control over the instruments associated with each hand. In many surgical robotic systems, one or more additional robotic manipulator arms are included for moving an endoscope or other image capture device, additional surgical instruments, or the like.
A variety of structural arrangements can be used to support the surgical instrument at the surgical site during robotic surgery. The driven linkage or “slave” is often called a robotic surgical manipulator, and exemplary linkage arrangements for use as a robotic surgical manipulator during minimally invasive robotic surgery are described in U.S. Pat. Nos. 6,758,843; 6,246,200; and 5,800,423, the full disclosures of which are incorporated herein by reference. These linkages often make use of a parallelogram arrangement to hold an instrument having a shaft. Such a manipulator structure can constrain movement of the instrument so that the instrument shaft pivots about a remote center of spherical rotation positioned in space along the length of the rigid shaft. By aligning this center of rotation with the incision point to the internal surgical site (for example, with a trocar or cannula at an abdominal wall during laparoscopic surgery), an end effector of the surgical instrument can be positioned safely by moving the proximal end of the shaft using the manipulator linkage without imposing potentially dangerous forces against the abdominal wall. Alternative manipulator structures are described, for example, in U.S. Pat. Nos. 6,702,805; 6,676,669; 5,855,583; 5,808,665; 5,445,166; and 5,184,601, the full disclosures of which are incorporated herein by reference.
While the new robotic surgical systems and devices have proven highly effective and advantageous, still further improvements would be desirable. For example, a manipulator arm may include additional redundant joints to provide increased movements or configurations under certain conditions. When moving surgical instruments within a minimally invasive surgical site, however, these joints may exhibit a significant amount of movement outside the patient, often more movement than needed or expected, particularly when pivoting instruments about minimally invasive apertures through large angular ranges. Alternative manipulator structures have been proposed which employ software control over a highly configurable kinematic manipulator joint set to restrain pivotal motion to the insertion site while inhibiting inadvertent manipulator/manipulator contact outside the patient (or the like). These highly configurable “software center” surgical manipulator systems may provide significant advantages, but may also present challenges. In particular, the mechanically constrained remote-center linkages may have safety advantages in some conditions. Additionally, the wide range of configurations of the numerous joints often included in these manipulators may result in the manipulators being difficult to manually set-up in a configuration that is desirable for a particular procedure. Nonetheless, as the range of surgeries being performed using telesurgical systems continues to expand, there is an increasing demand for expanding the available configurations and the range of motion of the instruments within the patient. Unfortunately, both of these changes can increase the challenges associated with the motion of the manipulators outside the body, and can also increase the importance of avoiding excessive movement of the manipulators arm for certain tasks.
For these and other reasons, it would be advantageous to provide improved devices, systems, and methods for surgery, robotic surgery, and other robotic applications, and it would be particularly beneficial if these improved technologies provided the ability to provide more consistent and predictable movement of the manipulator arm during certain tasks. It would be further desirable to provide such improvements while increasing the range of motion of the instruments for at least some tasks and without significantly increasing the size, mechanical complexity, or costs of these systems, and while maintaining or improving their dexterity.
BRIEF SUMMARY OF THE INVENTION
The present invention generally provides improved robotic and/or surgical devices, systems, and methods. In many embodiments, the invention will employ highly configurable surgical robotic manipulators. These manipulators, for example, may have more degrees of freedom of movement than the associated surgical end effectors have within a surgical workspace. A robotic surgical system in accordance with the present invention typically includes a manipulator arm supporting a robotic surgical instrument and a processor to calculate coordinated joint movements for manipulating an end effector of the instrument. The joints of the robotic manipulators supporting the end effectors allow the manipulator to move throughout a range of different configurations for a given end effector position and/or a given pivot point location. In one aspect, the invention provides improved consistency and predictability of movement of the manipulator arm by defining a set of constraints or path segments along which movement is desired for one or more joints of the manipulator arm.
In one aspect, the robotic surgical system may utilize holonomic or position-based constraints that are defined within a joint-space or Cartesian-coordinate space of the manipulator arm and correspond to a desired movement of one or more joints of a manipulator arm having a distal end effector. Virtual potential fields may be calculated and used to determine movement of the one or more joints within a null-space so that a position of the one or more joints moves toward the constraints thereby providing the desired movement of the one or more joints while maintaining a desired position of an end effector. This approach allows for improved control over the movement of one or more joints within a null-space, particularly in a manipulator arm utilizing a Jacobian based controller in which the primary calculations of the one or more joints are based on velocities rather than positions.
In some embodiments, a manipulator arm may include additional redundant joints to allow for various types of movement, such as a reconfiguration movement in response to a user command or an external manual articulation of a joint. In certain aspects, rather than relying on robotic devices that are mechanically constrained to pivot a tool about a fixed point in space, or robotic devices having passive joints which passively pivot about the tissues of a minimally invasive aperture, the present invention may calculate a motion that includes pivoting a link of the manipulator linkage about an aperture site. The degrees of freedom of the robotic linkages supporting the end effectors can allow the linkage to move throughout a range of configurations for a given end effector position, and the systems may drive the linkages to configurations which inhibit collisions involving one or more moving robotic structures. Set-up of highly flexible robotic linkages can be facilitated by processors which drive one or more joints of the linkage while the linkage is being manually positioned.
In some embodiments, the invention allows for movement of the manipulator arm to be directed towards a pre-determined set of constraints when moving to effect one or more tasks, such as a desired end effector movement, a reconfiguration movement or various others movements. It should be noted that the manipulator arm need not be mechanically “locked” to the set of constraints, but rather the constraints can be utilized to direct movement of one or more joints of the manipulator arm toward the constraints when moving according to one or more commanded movements. In some embodiments, the manipulator arm may include various movements or modes of operation in which joint movements of the manipulator arm are not limited by the defined constraints.
In general, commanded movement of the manipulator arm to effect movement of the distal end effector utilizes movement of all the joints of the manipulator arm. Various other types of movement, such as a commanded reconfiguration movement or collision avoidance, may utilize the same joints as used in manipulation of the end effector or may include various other selected joints or sets of joints. When effecting movement of the end effector a manipulator arm having redundant degrees of freedom, the motion of the joints according to one or more of these types of movement may result in unnecessary, unpredictable, or non-holonomic movement of the manipulator arm, since an unused null-space indicates unspecified motion. In addition, movement of an upper portion of a manipulator arm may unnecessarily limit the available range of motion of an adjacent manipulator arm. To provide improved movement of the manipulator arms, the redundant degrees of freedom may be used to adhere to a set of constraints to limit motion of the manipulator arm within or direct movement toward a repeatable pattern of movement. In some embodiments, the repeatable pattern of movement is based on pre-determined positions or a range of positions of the manipulator arm. In certain aspects, the constraints may be defined in either the joint-space using joint velocities or within the Cartesian-coordinate space using positions.
In one aspect, the movement of a manipulator arm having redundant degrees of freedom utilizes primary calculations based on joint velocities, such as by using a Jacobian based controller. The system may define a set of holonomic or position based constraints, such as a path or network of paths, in either the joint-space or the Cartesian-coordinate space. The constraints may be used to develop an artificial potential field to “pull” or direct the movement of the manipulator arm towards the constraints using movement of the joints within a null-space of the Jacobian. This allows the one or more joints of the manipulator arm to move according to the desired pattern of movement corresponding to the constraints, while maintaining a desired state of the end effector during commanded end effector movements.
In some embodiments, the invention provides a robotic system comprising a manipulator assembly for robotically moving a distal end effector relative to a proximal base. The manipulator assembly has a plurality of joints, the joints providing sufficient degrees of freedom to allow a range of joint states for an end effector state. An input receives a command to effect a desired movement of the end effector. A processor couples the input to the manipulator assembly. The processor has a first module and a second module. The first module is configured to help calculate movements of the joints in response to the command so as to move the end effector with the desired movement. The second module is configured to help drive at least one of the joints in response to an external articulation of another joint of the manipulator assembly.
In certain aspects, the first and second modules of the processor will be used differently in different control modes. For example, the processor may have first and second modes. The first mode will often comprise a mode for tracking the network of paths for the end effector in its Cartesian space, while the second mode may comprise a clutch mode. In the first mode, the tool tip responds to the surgeon's position and orientation commands. While in the clutch mode, in response to a manual articulation of a joint, at least one other joint is driven by the processor so that the combined movement of the joints in this second mode is within a null-space of the Jacobian. This can provide the manipulator assembly with an effective clutch degree of freedom which differs from a degree of freedom of the driven clutch joint, and from a degree of freedom of the other joint. For example, a manipulator assembly providing the end effector with six mechanical degrees of freedom could be constrained so as to allow the end effector to be moved in space solely about a pivotal rotation center located where no joint is present. Alternatively, such an end effector might be translatable along an arbitrary plane which is at a skew angle relative to every linkage and joint axis of the manipulator linkage assembly. To provide these and/or other capabilities, the driven clutch mode will often comprise a plurality of driven clutch joints, and the processor will be configured to drive each driven clutch joint in response to manual manipulation of a plurality of joints of the manipulator assembly so that the manipulator assembly has a plurality of effective clutch degrees of freedom when the processor is in the clutch mode.
The manipulator assembly will often comprise a surgical tool or instrument having a shaft extending between a mounting interface and the end effector. The processor in the first mode may be configured to derive the desired movement of the end effector within an internal surgical space so that the shaft passes through a minimally invasive aperture site. Such a master/slave controller may, for example, comprise a velocity controller using an inverse Jacobian matrix, which will often comprise a portion of the first module. The second module may be used in the second or clutch mode, providing joint velocities along the Jacobian's null-space to provide combinations of joint velocities that are allowed in the clutch mode. The processor in the clutch mode is configured to allow manual articulation of the other joint (and often of a plurality of joints of the manipulator system) while constraining motion of the end effector or some other structure of the manipulator assembly which is disposed distally of the manually articulated and/or clutch driven joints. For example, manipulator assemblies having more than six degrees of freedom may allow a user to push an intermediate linkage of the manipulator assembly from a first location to a second location while maintaining the end effector location in the workspace. This can result in a manipulator assembly having a pose which is manually reconfigurable while the base and end effector remain fixed in space. In some embodiments, an orientation of the end effector (or some other structure of the manipulator) may be orientationally constrained by driving of the driven clutch joints while that structure is manually translated to a new location.
In another aspect, movement of the arm may be calculated in accordance with the constraints to effect movement along the desired path in a first mode, such as a commanded end effector manipulation mode, while the movement of the arm while in a clutch mode or during a commanded reconfiguration movement is not similarly constrained. After the position of the manipulator arm is reconfigured in the clutch mode or by effecting a commanded reconfiguration within a null-space, the system may modify the constraints so as to translate or alter a position or orientation of the constraints to coincide with the reconfigured location of the manipulator arm, or alternatively may select a constraint from a set of constraints nearest the reconfigured location.
In one aspect of the present invention, a redundant degrees of freedom (RDOF) surgical robotic system with manipulate input is provided. The RDOF surgical robotic system comprises a manipulator assembly, one or more user input devices, and a processor with a controller. A manipulator arm of the assembly has a plurality of joints providing sufficient degrees of freedom that allow a range of joint states for a given end effector state. In response to a received reconfiguration command entered by a user, the system calculates velocities of the plurality of joints within a null-space. The joints are driven according to the reconfiguration command and the calculated movement so as to maintain the desired state of the end effector. Typically, in response to receiving a manipulation command to move the end effector with a desired movement, the system calculates end effector displacing movement of the joints by calculating joint velocities within a null-perpendicular-space of the Jacobian orthogonal to the null-space, and drives the joints according to the calculated movement to effect the desired end effector movement. To provide increased range of motion for the various other types of movements described above, the system may include a revolute proximal most joint that affects the pitch of a distal instrument shaft of the manipulator and/or a distal revolute joint coupling an instrument to a proximal portion of the manipulator arm that effects a pivotal movement of the instrument shaft. These joints may be utilized in any of the embodiments described herein.
In another aspect, the manipulator is configured to move such that an intermediate portion of the instrument shaft pivots about a remote center. Between the manipulator and the instrument, there are a plurality of driven joints providing sufficient degrees of freedom to allow a range of joint states for an end effector position when the intermediate portion of the instrument shaft passes through an access site. A processor having a controller couples the input device to the manipulator. In response to a reconfiguration command, the processor determines movements of one or more joints to effect the desired reconfiguration so that the intermediate portion of the instrument is within the access site during the end effector's desired movement and maintains the desired remote center location about which the shaft pivots. Typically, in response to receiving a manipulation command to effect a desired end effector's movement, the system calculates end effector displacing movement of the joints, comprising calculating joint velocities within a null-perpendicular-space of the Jacobian orthogonal to the null-space, and drives the joints according to the calculated movement to effect the desired end effector movement in which the instrument shaft pivots about the remote center.
In another aspect, a joint from the first set of joints of the manipulator is a revolute joint coupling the manipulator arm to the base. The desired state of the end effector may include a desired position, velocity or acceleration of the end effector. The manipulation command and the reconfiguration command may be separate inputs, typically being received from separate users on separate input devices, or may be separate inputs are received from the same user. In some embodiments, the end effector manipulation command is received from an input device by a first user, such as a surgeon entering the command on a surgical console master input, while the reconfiguration command is received from an input device by a second user on a separate input device, such as a physician's assistant entering the reconfiguration command on a patient side cart input device. In other embodiments, the end effector manipulation command and the reconfiguration command are both received by the same user from input devices at a surgical console.
In yet another aspect of the present invention, a surgical robotic manipulator with a proximal revolute joint and a distal parallelogram linkage is provided, the pivotal axis of the revolute joint substantially intersecting with the axis of the instrument shaft of the end effector, preferably at a remote center if applicable. The system further includes a processor having a controller coupling the input to the manipulator arm and configured to calculate a movement of the plurality of joints in response to a user input command. The system may include an input device for receiving a reconfiguration command to move a first set of joints of the plurality of joints with a desired reconfiguration movement within the null-space or may include a clutch mode that allows a user to manually reconfigure one or more joints of the manipulator arm within the null-space as to maintain the end effector the desired state. The system may be configured to adjust or translate the positional constraints in response to a user driven reconfiguration or a manual reconfiguration of the manipulator arm, such as in a clutch mode, to allow for improved consistency and predictability of one or more joints within the null-space, while maintaining the desired state of the end effector, while providing the additional capability of a user input or manual reconfiguration.
A further understanding of the nature and advantages of the present invention will become apparent by reference to the remaining portions of the specification and drawings. It is to be understood, however, that each of the figures is provided for the purpose of illustration only and is not intended as a definition of the limits of the scope of the invention. Furthermore, it is appreciated than any of the features in any of the described embodiments could be modified and combined with any of various other features described herein or known to one of skill in the art and still remain within the spirit and scope of the invention.



BRIEF DESCRIPTION OF THE DRAWINGS
FIG. 1A is an overhead view of a robotic surgical system in accordance with embodiments of the present invention, the robotic surgical system having a surgical station with a plurality of robotic manipulators for robotically moving surgical instruments having surgical end effectors at an internal surgical site within a patient, in accordance with aspects of the invention.
FIG. 1B diagrammatically illustrates the robotic surgical system of FIG. 1A.
FIG. 2 is a perspective view illustrating a master surgeon console or workstation for inputting surgical procedure commands in the surgical system of FIG. 1A, the console including a processor for generating manipulator command signals in response to the input commands.
FIG. 3 is a perspective view of the electronics cart of FIG. 1A.
FIG. 4 is a perspective view of a patient side cart having four manipulator arms.
FIGS. 5A-5D show an exemplary manipulator arm.
FIGS. 6A-6B show an exemplary manipulator arm in the pitch forward configuration and pitch back configurations, respectively.
FIG. 6C shows a graphical representation of the range of motion of the surgical instrument tool tip of an exemplary manipulator arm, including a cone of silence or conical tool access limit zone in each of the pitch forward and pitch back configurations.
FIG. 7A shows exemplary manipulator arms having a proximal revolute joint that revolves the manipulator arm about an axis of a proximal revolute joint.
FIG. 7B shows an exemplary manipulator arm and the associated range of motion and cone of silence, the exemplary manipulator arm having a proximal revolute joint that revolves the manipulator arm around an axis of a proximal revolute joint the movement of which can be used to mitigate the depicted cone of silence.
FIGS. 8A-8B show an exemplary manipulator arms having a revolute joint near the distal instrument holder.
FIG. 9A schematically illustrates a highly flexible manipulator assembly having a clutch input switch so as to facilitate manual positioning of a surgical tool adjacent a minimally invasive aperture while a processor configures the manipulator joint in response to the manual movement.
FIGS. 9B and 9C schematically illustrate reconfiguring of the joints of the manipulator assembly within a range of alternative joint configurations during manual movement of the arm.
FIGS. 10A-10C show sequential views of an exemplary manipulator arm having a revolute joint near a distal instrument holder as the joint is moved throughout its range of joint movement.
FIGS. 11A-11B show the revolved profile of an exemplary manipulator arm having a distal revolute joint when the angular displacement of the joint is 0° versus an angular displacement of 90°, respectively, in accordance with aspects of the invention.
FIGS. 12A-12C show exemplary manipulator arms having a proximal joint that translates a proximal joint supporting the manipulator arm about a curved path, in accordance with aspects of the invention.
FIGS. 13A-13B graphically represent the relationship between the null-space and the null-perpendicular-space of the Jacobian of an example manipulator assembly, in accordance with aspects of the invention.
FIG. 13C graphically illustrates aspects of the null-clutch or null-space clutch feature in regard to Cart-space commands, in accordance with aspects of the invention.
FIG. 14A graphically illustrates an example of network path segments for use in controlling movement of a manipulator assembly within the null-space, in accordance with aspects of the invention.
FIG. 14B graphically illustrates example of network path segments for use in controlling movement of a manipulator assembly within the null-space, in accordance with aspects of the invention.
FIGS. 15-16 schematically illustrate methods in accordance with aspects of the invention.
FIGS. 17-18 illustrate example methods in accordance with aspects of the invention.



DETAILED DESCRIPTION OF THE INVENTION
The present invention generally provides improved surgical and robotic devices, systems, and methods. The invention is particularly advantageous for use with surgical robotic systems in which a plurality of surgical tools or instruments may be mounted on and moved by an associated plurality of robotic manipulators during a surgical procedure. The robotic systems will often comprise telerobotic, telesurgical, and/or telepresence systems that include processors configured as master-slave controllers. By providing robotic systems employing processors appropriately configured to move manipulator assemblies with articulated linkages having relatively large numbers of degrees of freedom, the motion of the linkages can be tailored for work through a minimally invasive access site. The large number of degrees of freedom allows a system operator, or an assistant, to reconfigure the linkages of the manipulator assemblies while maintaining the desired end effector state, optionally in preparation for surgery and/or while another use maneuvers the end effector during a surgical procedure. While aspects of the invention are generally described manipulators having redundant degrees of freedom, it is appreciated that aspects may apply to non-redundant manipulators, for example a manipulator experiencing or approaching a singularity.
The robotic manipulator assemblies described herein will often include a robotic manipulator and a tool mounted thereon (the tool often comprising a surgical instrument in surgical versions), although the term “robotic assembly” will also encompass the manipulator without the tool mounted thereon. The term “tool” encompasses both general or industrial robotic tools and specialized robotic surgical instruments, with these later structures often including an end effector which is suitable for manipulation of tissue, treatment of tissue, imaging of tissue, or the like. The tool/manipulator interface will often be a quick disconnect tool holder or coupling, allowing rapid removal and replacement of the tool with an alternate tool. The manipulator assembly will often have a base which is fixed in space during at least a portion of a robotic procedure, and the manipulator assembly may include a number of degrees of freedom between the base and an end effector of the tool. Actuation of the end effector (such as opening or closing of the jaws of a gripping device, energizing an electrosurgical paddle, or the like) will often be separate from, and in addition to, these manipulator assembly degrees of freedom.
The end effector will typically move in the workspace with between two and six degrees of freedom. As used herein, the term “position” encompasses both location and orientation. Hence, a change in a position of an end effector (for example) may involve a translation of the end effector from a first location to a second location, a rotation of the end effector from a first orientation to a second orientation, or a combination of both. When used for minimally invasive robotic surgery, movement of the manipulator assembly may be controlled by a processor of the system so that a shaft or intermediate portion of the tool or instrument is constrained to a safe motion through a minimally invasive surgical access site or other aperture. Such motion may include, for example, axial insertion of the shaft through the aperture site into a surgical workspace, rotation of the shaft about its axis, and pivotal motion of the shaft about a pivot point adjacent the access site.
Many of the exemplary manipulator assemblies described herein have more degrees of freedom than are needed to position and move an end effector within a surgical site. For example, a surgical end effector that can be positioned with six degrees of freedom at an internal surgical site through a minimally invasive aperture and may in some embodiments have nine degrees of freedom (six end effector degrees of freedom—three for location, and three for orientation—plus three degrees of freedom to comply with the access site constraints), but will often have ten or more degrees of freedom. Highly configurable manipulator assemblies having more degrees of freedom than are needed for a given end effector position can be described as having or providing sufficient degrees of freedom to allow a range of joint states for an end effector position in a workspace. For example, for a given end effector position, the manipulator assembly may occupy (and be driven between) any of a range of alternative manipulator linkage positions. Similarly, for a given end effector velocity vector, the manipulator assembly may have a range of differing joint movement speeds for the various joints of the manipulator assembly within the null-space of the Jacobian.
The invention provides robotic linkage structures which are particularly well suited for surgical (and other) applications in which a wide range of motion is desired, and for which a limited dedicated volume is available due to the presence of other robotic linkages, surgical personnel and equipment, and the like. The large range of motion and reduced volume needed for each robotic linkage may also provide greater flexibility between the location of the robotic support structure and the surgical or other workspace, thereby facilitating and speeding up setup.
The term “state” of a joint or the like will often herein refer to the control variables associated with the joint. For example, the state of an angular joint can refer to the angle defined by that joint within its range of motion, and/or to the angular velocity of the joint. Similarly, the state of an axial or prismatic joint may refer to the joint's axial position, and/or to its axial velocity. While many of the controllers described herein comprise velocity controllers, they often also have some position control aspects. Alternative embodiments may rely primarily or entirely on position controllers, acceleration controllers, or the like. Many aspects of control system that can be used in such devices are more fully described in U.S. Pat. No. 6,699,177, the full disclosure of which is incorporated herein by reference. Hence, so long as the movements described are based on the associated calculations, the calculations of movements of the joints and movements of an end effector described herein may be performed using a position control algorithm, a velocity control algorithm, a combination of both, and/or the like.
In many embodiments, the tool of an exemplary manipulator arm pivots about a pivot point adjacent a minimally invasive aperture. In some embodiments, the system may utilize a hardware remote center, such as the remote center kinematics described in U.S. Pat. No. 6,786,896, the entire contents of which are incorporated herein in its entirety. Such systems may utilize a double parallelogram linkage which constrains the movement of the linkages such that the shaft of the instrument supported by the manipulator pivots about a remote center point. Alternative mechanically constrained remote center linkage systems are known and/or may be developed in the future. Surprisingly, work in connection with various aspects of the invention indicates that remote center linkage systems may benefit from highly configurable kinematic architectures. In particular when a surgical robotic system has a linkage that allows pivotal motion about two axes intersecting at or near a minimally invasive surgical access site, the spherical pivotal motion may encompass the full extent of a desired range of motion within the patient, but may still suffer from avoidable deficiencies (such as being poorly conditioned, being susceptible to arm-to-arm or arm-to-patient contact outside the patient, and/or the like). At first, adding one or more additional degrees of freedom that are also mechanically constrained to pivotal motion at or near the access site may appear to offer few or any improvements in the range of motion. Nonetheless, such joints can provide significant advantages by allowing the overall system to be configured in or driven toward a collision-inhibiting pose, by further extending the range of motion for other surgical procedures, and the like. In other embodiments, the system may utilize software to achieve a remote center, such as described in U.S. Pat. No. 8,004,229, the entire contents of which are incorporated herein by reference. In a system having a software remote center, the processor calculates movement of the joints so as to pivot an intermediate portion of the instrument shaft about a pivot point determined, as opposed to a mechanical constraint. By having the capability to compute software pivot points, different modes characterized by the compliance or stiffness of the system can be selectively implemented. More particularly, different system modes over a range of pivot points/centers (e.g., moveable pivot points, passive pivot points, fixed/rigid pivot point, soft pivot points) can be implemented as desired.
Despite the many advantages of a robotic surgical system having multiple highly configurable manipulators, since the manipulators include a relatively large number of joints and links between the base and instrument, manual positioning of the links can be challenging and complicated. Even when the manipulator structure is balanced so as to avoid gravitational effects, attempting to align each of the joints in an appropriate arrangement or to reconfigure the manipulator as desired can be difficult, time consuming, and may involve significant training and/or skill. The challenges can be even greater when the links of the manipulator are not balanced about the joints, such that positioning such a highly configurable structures in an appropriate configuration before or during surgery can be a struggle due to the manipulator arm length and the passive and limp design in many surgical systems.
These issues can be addressed by allowing a user, such as a physician's assistant, to quickly and easily reconfigure the manipulator arm, while and maintaining the desired end effector state, optionally even during movement of the end effector during a surgical procedure. One or more additional joints may be included in the manipulator arm to increase the range of motion and configurations of the manipulator arm to enhance this capability. While providing additional joints may provide increased range of motion for certain tasks, the large number of redundant joints in the manipulator arm may cause various movements of the arm to be overly complex for other tasks, such that the movements appear unpredictable or the amount of overall movements causes various other clinical concerns
In some embodiments, calculated movement relating to various other tasks, such as an avoidance movement based on an autonomous algorithm, may overlay the tracking movement so that the one or more joints may be moved to effect various other tasks, as needed. Examples of such avoidance movement are described in U.S. Provisional Application No. 61/654,755 filed Jun. 1, 2012, entitled “Manipulator Arm-to-Patient Collision Avoidance Using a Null-Space;” and U.S. Provisional Application No. 61/654,773 filed Jun. 1, 2012, entitled “System and Methods for Avoiding Collisions Between Manipulator Arms Using a Null-Space,” the disclosures of which are incorporated herein by reference in their entireties. The calculated movement that overlays the tracking movement of the one or more joints, however, is not limited to the autonomous movement and may include various other movements, such as a commanded reconfiguration movement or various other movements.
Embodiments of the invention may include a user input which is configured to take advantage of the degrees of freedom of a manipulator structure. Rather than manually reconfiguring the manipulator, the input facilitates use of driven joints of the kinematic linkage to reconfigure the manipulator structure in response to entry of a reconfiguration command by a user. In many embodiments, the user input for receiving the reconfiguration command is incorporated into and/or disposed near the manipulator arm. In other embodiments, the input comprises a centralized input device to facilitate reconfiguration of one or more joints, such as a cluster of buttons on the patient side cart or a joystick. Typically, the input device for receiving the reconfiguration command is separate from the input for receiving a manipulation command to effect movement of the end effector. A controller of the surgical system may include a processor with readable memory having joint controller programming instructions or code recorded thereon which allows the processor to derive suitable joint commands for driving the joints recorded thereon so as to allow the controller to effect the desired reconfiguration in response to entry of the reconfiguration command. It is appreciated, however, that the invention may be used in a manipulator arms with or without a reconfiguration feature.
In the following description, various embodiments of the present invention will be described. For purposes of explanation, specific configurations and details are set forth in order to provide a thorough understanding of the embodiments. However, it will also be apparent to one skilled in the art that the present invention may be practiced without the specific details. Furthermore, well-known features may be omitted or simplified in order not to obscure the embodiment being described.
Referring now to the drawings, in which like reference numerals represent like parts throughout the several views, FIG. 1A is an overhead view illustration of a Minimally Invasive Robotic Surgical (MIRS) system 10, in accordance with many embodiments, for use in performing a minimally invasive diagnostic or surgical procedure on a Patient 12 who is lying down on an Operating table 14. The system can include a Surgeon's Console 16 for use by a Surgeon 18 during the procedure. One or more Assistants 20 may also participate in the procedure. The MIRS system 10 can further include a Patient Side Cart 22 (surgical robot) and an Electronics Cart 24. The Patient Side Cart 22 can manipulate at least one removably coupled tool assembly 26 (hereinafter simply referred to as a “tool”) through a minimally invasive incision in the body of the Patient 12 while the Surgeon 18 views the surgical site through the Console 16. An image of the surgical site can be obtained by an endoscope 28, such as a stereoscopic endoscope, which can be manipulated by the Patient Side Cart 22 so as to orient the endoscope 28. The Electronics Cart 24 can be used to process the images of the surgical site for subsequent display to the Surgeon 18 through the Surgeon's Console 16. The number of surgical tools 26 used at one time will generally depend on the diagnostic or surgical procedure and the space constraints within the operating room among other factors. If it is necessary to change one or more of the tools 26 being used during a procedure, an Assistant 20 may remove the tool 26 from the Patient Side Cart 22, and replace it with another tool 26 from a tray 30 in the operating room.
FIG. 1B diagrammatically illustrates a robotic surgery system 50 (such as MIRS system 10 of FIG. 1A). As discussed above, a Surgeon's Console 52 (such as Surgeon's Console 16 in FIG. 1A) can be used by a Surgeon to control a Patient Side Cart (Surgical Robot) 54 (such as Patent Side Cart 22 in FIG. 1A) during a minimally invasive procedure. The Patient Side Cart 54 can use an imaging device, such as a stereoscopic endoscope, to capture images of the procedure site and output the captured images to an Electronics Cart 56 (such as the Electronics Cart 24 in FIG. 1A). As discussed above, the Electronics Cart 56 can process the captured images in a variety of ways prior to any subsequent display. For example, the Electronics Cart 56 can overlay the captured images with a virtual control interface prior to displaying the combined images to the Surgeon via the Surgeon's Console 52. The Patient Side Cart 54 can output the captured images for processing outside the Electronics Cart 56. For example, the Patient Side Cart 54 can output the captured images to a processor 58, which can be used to process the captured images. The images can also be processed by a combination the Electronics Cart 56 and the processor 58, which can be coupled together so as to process the captured images jointly, sequentially, and/or combinations thereof. One or more separate displays 60 can also be coupled with the processor 58 and/or the Electronics Cart 56 for local and/or remote display of images, such as images of the procedure site, or other related images.
FIG. 2 is a perspective view of the Surgeon's Console 16. The Surgeon's Console 16 includes a left eye display 32 and a right eye display 34 for presenting the Surgeon 18 with a coordinated stereo view of the surgical site that enables depth perception. The Console 16 further includes one or more input control devices 36, which in turn cause the Patient Side Cart 22 (shown in FIG. 1A) to manipulate one or more tools. The input control devices 36 can provide the same degrees of freedom as their associated tools 26 (shown in FIG. 1A) so as to provide the Surgeon with telepresence, or the perception that the input control devices 36 are integral with the tools 26 so that the Surgeon has a strong sense of directly controlling the tools 26. To this end, position, force, and tactile feedback sensors (not shown) may be employed to transmit position, force, and tactile sensations from the tools 26 back to the Surgeon's hands through the input control devices 36.
The Surgeon's Console 16 is usually located in the same room as the patient so that the Surgeon may directly monitor the procedure, be physically present if necessary, and speak to an Assistant directly rather than over the telephone or other communication medium. However, the Surgeon can be located in a different room, a completely different building, or other remote location from the Patient allowing for remote surgical procedures.
FIG. 3 is a perspective view of the Electronics Cart 24. The Electronics Cart 24 can be coupled with the endoscope 28 and can include a processor to process captured images for subsequent display, such as to a Surgeon on the Surgeon's Console, or on another suitable display located locally and/or remotely. For example, where a stereoscopic endoscope is used, the Electronics Cart 24 can process the captured images so as to present the Surgeon with coordinated stereo images of the surgical site. Such coordination can include alignment between the opposing images and can include adjusting the stereo working distance of the stereoscopic endoscope. As another example, image processing can include the use of previously determined camera calibration parameters so as to compensate for imaging errors of the image capture device, such as optical aberrations.
FIG. 4 shows a Patient Side Cart 22 having a plurality of manipulator arms, each supporting a surgical instrument or tool 26 at a distal end of the manipulator arm. The Patient Side Cart 22 shown includes four manipulator arms 100 which can be used to support either a surgical tool 26 or an imaging device 28, such as a stereoscopic endoscope used for the capture of images of the site of the procedure. Manipulation is provided by the robotic manipulator arms 100 having a number of robotic joints. The imaging device 28 and the surgical tools 26 can be positioned and manipulated through incisions in the patient so that a kinematic remote center is maintained at the incision so as to minimize the size of the incision. Images of the surgical site can include images of the distal ends of the surgical instruments or tools 26 when they are positioned within the field-of-view of the imaging device 28.
Regarding surgical tool 26, a variety of alternative robotic surgical tools or instruments of different types and differing end effectors may be used, with the instruments of at least some of the manipulators being removed and replaced during a surgical procedure. Several of these end effectors, including DeBakey Forceps, microforceps, Potts scissors, and clip applier include first and second end effector elements which pivot relative to each other so as to define a pair of end effector jaws. Other end effectors, including scalpel and electrocautery probe have a single end effector element. For instruments having end effector jaws, the jaws will often be actuated by squeezing the grip members of handle. Single end effector instruments may also be actuated by gripping of the grip members, for example, so as to energize an electrocautery probe.
The elongate shaft of instrument 26 allow the end effectors and the distal end of the shaft to be inserted distally into a surgical worksite through a minimally invasive aperture, often through an abdominal wall or the like. The surgical worksite may be insufflated, and movement of the end effectors within the patient will often be effected, at least in part, by pivoting of the instrument 26 about the location at which the shaft passes through the minimally invasive aperture. In other words, manipulators 100 will move the proximal housing of the instrument outside the patient so that shaft extends through a minimally invasive aperture location so as to help provide a desired movement of end effector. Hence, manipulators 100 will often undergo significant movement outside patient P during a surgical procedure.
Exemplary manipulator arms in accordance with many embodiments of the present invention can be understood with reference to FIGS. 5A-13C. As described above, a manipulator arm generally supports a distal instrument or surgical tool and effects movements of the instrument relative to a base. As a number of different instruments having differing end effectors may be sequentially mounted on each manipulator during a surgical procedure (typically with the help of a surgical assistant), a distal instrument holder will preferably allow rapid removal and replacement of the mounted instrument or tool. As can be understood with reference to FIG. 4, manipulators are proximally mounted to a base of the patient side cart. Typically, the manipulator arm includes a plurality of linkages and associated joints extending between the base and the distal instrument holder. In one aspect, an exemplary manipulator includes a plurality of joints having redundant degrees of freedom such that the joints of the manipulator arm can be driven into a range of differing configurations for a given end effector position. This may be the case for any of the embodiments of manipulator arms disclosed herein.
In many embodiments, such as shown for example in FIG. 5A, an exemplary manipulator arm includes a proximal revolute joint J1 that rotates about a first joint axis so as to revolve the manipulator arm distal of the joint about the joint axis. In some embodiments, revolute joint J1 is mounted directly to the base, while in other embodiments, joint J1 may be mounted to one or more movable linkages or joints. The joints of the manipulator, in combination, have redundant degrees of freedom such that the joints of the manipulator arm can be driven into a range of differing configurations for a given end effector position. For example, the manipulator arm of FIGS. 5A-5D may be maneuvered into differing configurations while the distal member 511 (such as a cannula through which the tool 512 or instrument shaft extends) supported within the instrument holder 510 maintains a particular state and may include a given position or velocity of the end effector. Distal member 511 is typically a cannula through which the tool shaft 512 extends, and the instrument holder 510 is typically a carriage (shown as a brick-like structure that translates on a spar) to which the instrument attaches before extending through the cannula 511 into the body of the patient through the minimally invasive aperture.
Describing the individual links of manipulator arm 500 of FIGS. 5A-5D along with the axes of rotation of the joints connecting the links as illustrated in FIG. 5A-5D, a first link 504 extends distally from a pivotal joint J2 which pivots about its joint axis and is coupled to revolute joint J1 which rotates about its joint axis. Many of the remainder of the joints can be identified by their associated rotational axes, as shown in FIG. 5A. For example, a distal end of first link 504 is coupled to a proximal end of a second link 506 at a pivotal joint J3 that pivots about its pivotal axis, and a proximal end of a third link 508 is coupled to the distal end of the second link 506 at a pivotal joint J4 that pivots about its axis, as shown. The distal end of the third link 508 is coupled to instrument holder 510 at pivotal joint J5. Typically, the pivotal axes of each of joints J2, J3, J4, and J5 are substantially parallel and the linkages appear “stacked” when positioned next to one another, as shown in FIG. 5D, so as to provide a reduced width w of the manipulator arm and improve patient clearance during maneuvering of the manipulator assembly. In many embodiments, the instrument holder also includes additional joints, such as a prismatic joint J6 that facilitates axial movement of instrument 306 through the minimally invasive aperture and facilitates attachment of the instrument holder to a cannula through which the instrument is slidably inserted.
The distal member or cannula 511 through which the tool 512 extends may include additional degrees of freedom distal of instrument holder 510. Actuation of the degrees of freedom of the instrument will often be driven by motors of the manipulator, and alternative embodiments may separate the instrument from the supporting manipulator structure at a quickly detachable instrument holder/instrument interface so that one or more joints shown here as being on the instrument are instead on the interface, or vice versa. In some embodiments, cannula 511 includes a rotational joint J8 (not shown) near or proximal of the insertion point of the tool tip or the pivot point PP, which generally is disposed at the site of a minimally invasive aperture. A distal wrist of the instrument allows pivotal motion of an end effector of surgical tool 512 about instrument joints axes of one or more joints at the instrument wrist. An angle between end effector jaw elements may be controlled independently of the end effector location and orientation.
The range of motion of an exemplary manipulator assembly can be appreciated by referring to FIGS. 6A-6C. During a surgical procedure, an exemplary manipulator arm can be maneuvered into a pitch forward configuration, as shown in FIG. 6A, or into a pitch back configuration, as shown in FIG. 6B, as needed to access particular patient tissues within a surgical workspace. A typical manipulator assembly includes an end effector that can pitch forwards and backwards about an axis by at least ±60 degrees, preferably by about ±75 degrees, and can also yaw about an axis by ±80 degrees. Although this aspect allows for increased maneuverability of the end effector with the assembly, there may be configurations in which movement of the end effector may be limited, particularly when the manipulator arm is in the full pitch forward or full pitch back configuration as in FIGS. 6A and 6B. In one embodiment, the manipulator arm has a Range of Motion (ROM) of (+/−75 deg) for the outer pitch, and (+/−300 degrees) for the outer yaw joints, respectively. In some embodiments, the ROM may be increased for the outer pitch to provide a ROM larger than (+/−90 deg) in which case the “cone of silence” could be made to disappear entirely, although generally the inner sphere associated with insertion limitations would remain. It is appreciated that various embodiments may be configured to have increased or decreased ROM, that the above noted ROMs are provided for illustrative purposed, and further that the invention is not limited to the ROMs described herein.
FIG. 6C graphically represents the overall range of motion and workspace of the tool tip of the exemplary manipulator of FIGS. 5A-5B. Although the workspace is shown as hemisphere, it may also be represented as a sphere depending on the range of motion and configuration of one or more revolute joints of the manipulator, such as joint J1. As shown, the hemisphere in FIG. 6C includes a central, small spherical void as well as two conical voids. The voids represent the areas in which movement of the tool tip may be impossible due to mechanical constraints or unfeasible due to extremely high joint velocities that make movement of the end effector difficult or slow. For these reasons, the conical void are referred to as the “cone of silence.” In some embodiments, the manipulator arm may reach a singularity at a point within the cone. Since movement of the manipulator within or near the cone of silence may be impaired, it can be difficult to move the manipulator arm away from the cone of silence without manually moving one or more links of the manipulator to reconfigure the linkages and joints of the manipulator, which often requires an alternative operating mode and delays the surgical procedure.
Movement of the instrument shaft into or near these conical portions typically occurs when the angle between distal linkages in the manipulator is relatively small. Such configurations can be avoided by reconfiguring the manipulator to increase the angles between linkages (so that the linkages are moved into a more orthogonal position relative to each other). For example, in the configurations shown in FIGS. 6A and 6B, when the angle between the distal most link and the instrument holder (angle a) becomes relatively small movement of the manipulator may become more difficult. Depending on the range of joint movements in the remaining joints in various embodiments, when the angle between certain linkages decreases, movement of the manipulator may be inhibited and in some cases, the manipulator arm may no longer be redundant. A manipulator configuration in which the instrument shaft nears these conical portions, or in which the angles between linkages are relatively low is said to be “poorly conditioned” such that maneuverability and dexterity of the manipulator arm is limited. It is desirable that the manipulator be “well conditioned” so as to maintain dexterity and range of movement. In one aspect, the present invention allows a user to avoid movement of the instrument shaft near the above described conical portions by simply entering a command to reconfigure the manipulator as desired, even during movement of the end effector in a surgical procedure. This aspect is particularly useful should the manipulator, for whatever reason, become “poorly conditioned.”
While the embodiments of the manipulator described above may be utilized in the present invention, some embodiments may include additional joints, which may also be used to improve dexterity and the conditioning of the manipulator arm. For example, an exemplary manipulator may include a revolute joint and/or linkage proximal of joint J1 which can be used to revolve the manipulator arm of FIG. 5A, and its associated cone of silence, about an axis of the revolute joint so as to reduce or eliminate the cone of silence. In another embodiment, the exemplary manipulator may also include a distal pivotal joint that pivots the instrument holder about an axis substantially perpendicular to joint J5, thereby offsetting the tool tip so as to further reduce the cone of silence and improve the range of movement of the surgical tool. In still another embodiment, a proximal joint of the manipulator arm, such as J1, may be movably mounted on the base, so as to move or shift the cone of silence as needed and improve the range of motion of the manipulator tool tip. The use and advantages of such additional joints can be understood by referring to FIGS. 7A-13C, which illustrate examples of such joints, which may each be used independent of one another or used in combination, in any of the exemplary manipulator arms described herein.
FIGS. 7A-7B illustrate an additional redundant joint for use with exemplary manipulator arms—a first joint coupling a proximal portion of the manipulator arm to the base. The first joint is a proximal revolute joint J1′ that revolves the manipulator arm about a joint axis of joint J1′. The proximal revolute J1′ includes a link 501 that offsets joint J1 from the proximal revolute J1′ by a pre-determined distance or angle. The link 501 can be a curved linkage, as shown in FIG. 7A, or a linear or angled linkage, as shown in FIG. 7B. Typically, the joint axis of the joint J1′ is aligned with the remote center RC or insertion point of the tool tip, as shown in each of FIG. 7A. In an exemplary embodiment, the joint axis of joint J1′ passes through the remote center, as does each other revolute joint axis in the manipulator arm, to prevent motion at the body wall and can therefore be moved during surgery. The axis of joint J1′ is coupled to a proximal portion of the arm so it can be used to change the position and orientation of the back of the arm. In general, redundant axes, such as this, allow the instrument tip to follow the surgeon's commands while simultaneously avoiding collisions with other arms or patient anatomy. In one aspect, the proximal revolute J1′ is used solely to change the mounting angle of the manipulator with respect to the floor. This angle is important in order to 1) avoid collisions with external patient anatomy and 2) reach anatomy inside the body. Typically, the angle a between the proximal link of the manipulator attached to the proximal revolute joint J1′ and the axis of the proximal revolute is about 15 degrees.
FIG. 7B illustrates the relationship of the proximal revolute joint J1′ and its associated joint axis and the cone of silence in an exemplary manipulator arm. The joint axis of the proximal revolute joint J1′ may pass through the cone of silence or may be completely outside of the cone of silence. By revolving the manipulator arm about the axis of the proximal revolute J1′, the cone of silence can be reduced (in an embodiment where the joint J1′ axis passes through the cone of silence), or can be effectively eliminated (in an embodiment where the proximal revolute joint axis extends completely outside the cone of silence). The distance and angle of the link 501 determines the position of the joint J1′ axis relative to the cone of silence.
FIGS. 8A-8B illustrates another type of redundant joint for use with exemplary manipulator arms, a distal revolute joint J7 coupling the instrument holder 510 to a distal link of the manipulator arm 508. The distal revolute joint J7 allows the system to laterally pivot or twist the instrument holder 510 about the joint axis, which typically passes through the remote center or insertion point. Ideally, the revolute joint is located distally on the arm and is therefore particularly well suited to moving the orientation of the insertion axis. The addition of this redundant axis allows the manipulator to assume multiple positions for any single instrument tip position. In general, redundant axes, such as this, allow the instrument tip to follow the surgeon's commands while simultaneously avoiding collisions with other arms or patient anatomy. Because the distal revolute joint J7 has the ability to move the insertion axis closer to the yaw axis, it is able to increase the range of motion when the manipulator arm is in a pitch back position. The relationship between the axis of the distal revolute joint J7, the yaw axis of J1 and the insertion axis of tool tip is shown in FIG. 9. FIGS. 10A-10C show the sequential movement of joint J7 and how movement of joint J7 shifts the insertion axis of tool tip from side to side.
Referring now to FIG. 9A, another alternative manipulator assembly 520 includes a manipulator linkage arm 522 for removably supporting a surgical tool 524. A clutch input 516 comprises an input button which can be actuated by a hand engaging a link 518 of the manipulator that is to be disposed adjacent to access site 514 during surgery. This allows the hand to both actuate the input and help maneuver the manipulator into the appropriate position for surgery. In some embodiments, additional clutch inputs may be mounted on various other links so as to allow manual articulation of a link on which the clutch input is disposed. In many embodiments, the link 518 on which clutch input 516 is coupled to a shaft of a removable tool by an axial insertion joint. In some embodiments, the hand which actuates the clutch input 516 may be capable of repositioning the manipulator in the clutch mode without assistance from another hand. In other embodiments, repositioning of the manipulator may be facilitated by having a user position both a first hand on the manipulator link 518 adjacent clutch input 516, and a second hand at a distance from the clutch input, particularly when reorienting the link to a desired axial insertion angle. While clutch input 516 is actuated by the hand, the system processor will drive joints of manipulator 520 in response to manual movement of link 518.
If the clutched degrees of freedom of the slave manipulator linkage coincide with one or more joint degrees of freedom (that is, if some joints are locked and some joints are free to move in the clutch mode), then clutching is direct: one simply turns off the controller for those joints that are free to move. However, it will often be advantageous to clutch joints in a dependent way, where motion of one joint is linked by the controller to motion of at least one other joint so that they can be manually articulated together as a single degree of freedom. This may be achieved by driving at least one joint of a robotic manipulator assembly in response to external articulation of at least one other joint. The controller can effect this motion, which will often be different than any degree of freedom of the mechanical system, by defining any desired arbitrary linear combination of rates that can be treated as a single degree of freedom that the operator may manipulate, optionally while some or all of the other mechanical degrees of freedom remain locked. This general concept includes port clutching, instrument clutching, elbow clutching (in which an intermediate elbow is allowed to move, for example, from an upward oriented apex configuration around to a laterally oriented apex configuration while movement at the end effector remains inhibited), and other clutching modes.
Referring now to FIGS. 9A and 9B, manipulator assembly 502 may be reconfigured by the processor for any of a variety of differing reasons. For example, a joint 526 may be driven from a downward oriented apex configuration to an upward oriented apex configuration so as to inhibit collisions with an adjacent arm, equipment, or personnel; to enhance a range of motion of the end effector 508; in response to physiological movement of the patient such as patient breathing or the like; in response to repositioning of the patient, such as by reorienting a surgical table; and the like. Some, but not all, of these changes in configuration of the manipulator assembly may be in response to external forces applied to the manipulator assembly, with the processor often driving a different joint of the manipulator than that which is being acted upon by the external force. In other cases, the processor will reconfigure the manipulator assembly in response to calculations performed by the processor. In either case, the processor may vary from a simple master-slave controller so as to drive manipulator assembly in response to a signal so as to provide a preferred manipulator assembly configuration. Such configuring of the manipulator assembly may occur during master-slave end effector movements, during manual or other repositioning of the manipulator assembly, and/or at least in part a different time, such as after releasing a clutch input.
In some embodiments, movement of the arm may be calculated in accordance with the constraints to effect movement along the desired path in a first mode, such as a commanded end effector manipulation mode, while the movement of the arm when in the clutch mode is not similarly constrained. After the position of the manipulator arm is reconfigured in the clutch mode, the system may modify the constraint so as to translate or alter the desired path associated with the constraints to the reconfigured location of the manipulator arm. For example, the constraints may be modified to move the desired path to the nearest point on the reconfigured manipulator arm so that subsequent movement of the manipulator arm at its reconfigured location moves toward or along the altered path of movement.
In another aspect, any of the systems described herein may utilize a user input device to drive one or more joints and reconfigure one or more joints of the manipulator arm within a null-space to effect a desired reconfiguration for a variety of reasons. In an embodiment having one or both of a user input for commanded reconfiguration or a clutch mode as described above, the system may utilize the constraints described above during movement to effect commanded manipulation movement and suspend application of the constraints during a reconfiguration movement or while in the clutch mode. When the reconfiguration movement is completed or the manipulator arm is switched out of clutch mode, the system may modify the position-based constraints according to the reconfigured location of the manipulator arm. In other embodiments, the constraints may define multiple positional paths of movement such that the constraints associated with the closest path within the Cartesian-coordinate space can be selected. These aspects allow the system to provide the desired movement of the one or more joints of the manipulator arm after being reconfigured, by a driven reconfiguration or a manual reconfiguration while in a clutch mode.
One advantage of the distal revolute joint J7 is that it may reduce the patient clearance cone, which is the swept volume of the distal portion of the manipulator arm proximal of the insertion point which must clear the patient to avoid collision between the patient and the instrument holder or distal linkages of the manipulator arm. FIG. 11A illustrates the patient clearance cone of the proximal portion of the manipulator arm while the angular displacement of the distal revolute joint remains at 0°. FIG. 11B illustrates the reduced patient clearance cone of the proximal portion of the manipulator arm while the distal revolute joint is shown having an angular displacement of 90° about its axis. Thus, in procedures having minimal patient clearance near the insertion point, use of the joint J7 in accordance with the present invention may provide additional clearance while maintaining the remote center location or the position of the end effector as desired.
FIGS. 12A-12C illustrate another type of redundant joint for use with exemplary manipulator arms, a proximal joint that translates or revolves the manipulator arm about an axis. In many embodiments, this proximal translatable joint translates a proximal joint of the manipulator, such as joint J1 or J1′, along a path so as to reduce or eliminate the cone of silence by shifting or rotating the range of motion of the manipulator arm to provide for better conditioning and improved maneuverability of the manipulator arm. The translatable joint may include a circular path, such as shown in joint J1′′ in FIGS. 12A-12D, or may include a semi-circular or arcuate path, such as shown in FIGS. 13A-13C. Generally, the joint revolves the manipulator arm about an axis of the translatable joint that intersects with the remote center RC about which the shaft of the tool 512 extending through cannula 511 pivots. Although in the embodiment shown in FIGS. 12A-12C, the axis of J1′′ is a vertical axis, it is appreciated that the axis of J1′′ may be horizontal or various angles of inclination.
In exemplary embodiments, the manipulator arm 500 may include any or all of a proximal or distal revolute joint, a proximal translatable joint and a parallelogram configuration of the distal linkages. Use of any or all of these features provide additional redundant degrees of freedom and facilitate reconfiguration in accordance with the present invention so as to provide for a better “conditioned” manipulator assembly by increasing the angles between linkages thereby improving the dexterity and motion of the manipulator. The increased flexibility of this exemplary manipulator can also be used to optimize the kinematics of the manipulator linkage so as to avoid joint limits, singularities, and the like.
In an exemplary embodiment, the joint movements of the manipulator are controlled by driving one or more joints by a controller using motors of the system, the joints being driven according to coordinated and joint movements calculated by a processor of the controller. Mathematically, the controller may perform at least some of the calculations of the joint commands using vectors and/or matrices, some of which may have elements corresponding to configurations or velocities of the joints. The range of alternative joint configurations available to the processor may be conceptualized as a joint space. The joint space may, for example, have as many dimensions as the manipulator has degrees of freedom, and a particular configuration of the manipulator may represent a particular point in the joint space, with each coordinate corresponding to a joint state of an associated joint of the manipulator.
In an exemplary embodiment, the system includes a controller in which a commanded position and velocity of a feature in the work-space, denoted here as its Cartesian space, are inputs. The feature may be any feature on or off the manipulator, which can be used as a control frame to be articulated using control inputs. An example of a feature on the manipulator, used in many examples described herein, would be the tool-tip. Another example of a feature on the manipulator would be a physical feature which is not on the tool-tip, but is a part of the manipulator, such as a pin or a painted pattern. An example of a feature off the manipulator would be a reference point in empty space which is exactly a certain distance and angle away from the tool-tip. Another example of a feature off the manipulator would be a target tissue whose position relative to the manipulator can be established. In all these cases, the end effector is associated with an imaginary control frame which is to be articulated using control inputs. However, in the following, the “end effector” and the “tool tip” are used synonymously. Although generally, there is no closed form relationship which maps a desired Cartesian space end effector position to an equivalent joint-space position, there is generally a closed form relationship between the Cartesian space end effector and joint-space velocities. The kinematic Jacobian is the matrix of partial derivatives of Cartesian space position elements of the end effector with respect to joint space position elements. In this way, the kinematic Jacobian captures the kinematic relationship between the end effector and the joints. In other words, the kinematic Jacobian captures the effect of joint motion on the end effector. The kinematic Jacobian (J) can be used to map joint-space velocities (dq/dt) to Cartesian space end effector velocities (dx/dt) using the relationship below:

dx/dt=Jdq/dt 

Thus, even when there is no closed-form mapping between input and output positions, mappings of the velocities can iteratively be used, such as in a Jacobian-based controller to implement a movement of the manipulator from a commanded user input, however a variety of implementations can be used. Although many embodiments include a Jacobian-based controller, some implementations may use a variety of controllers that may be configured to access the Jacobian of the manipulator arm to provide any of the features described herein.
One such implementation is described in simplified terms below. The commanded joint position is used to calculate the Jacobian (J). During each time step (Δt) a Cartesian space velocity (dx/dt) is calculated to perform the desired move (dxdes/dt) and to correct for built up deviation (Δx) from the desired Cartesian space position. This Cartesian space velocity is then converted into a joint-space velocity (dq/dt) using the pseudo-inverse of the Jacobian (J#). The resulting joint-space commanded velocity is then integrated to produce joint-space commanded position (q). These relationships are listed below:

dx/dt=dxdes/dt+kΔx  (1)

dq/dt=J#dx/dt  (2)

qi=qi-1+dq/dtΔt  (3)

The pseudo-inverse of the Jacobian (J) directly maps the desired tool tip motion (and, in some cases, a remote center of pivotal tool motion) into the joint velocity space. If the manipulator being used has more useful joint axes than tool tip degrees of freedom (up to six), (and when a remote center of tool motion is in use, the manipulator should have an additional 3 joint axes for the 3 degrees of freedom associated with location of the remote center), then the manipulator is said to be redundant. A redundant manipulator's Jacobian includes a “null-space” having a dimension of at least one. In this context, the “null-space” of the Jacobian (N(J)) is the space of joint velocities which instantaneously achieves no tool tip motion (and when a remote center is used, no movement of the pivotal point location); and “null-motion” is the combination, trajectory or path of joint positions which also produces no instantaneous movement of the tool tip and/or location of the remote center. Incorporating or injecting the calculated null-space velocities into the control system of the manipulator to achieve the desired reconfiguration of the manipulator (including any reconfigurations described herein) changes above equation (2) to the following:

dq/dt=dqperp/dt+dqnull/dt  (4)

dqperp/dt=J#dx/dt  (5)

dqnull/dt=(1−J#J)z=VnVnTz=Vnα  (6)

The joint velocity according to Equation (4) has two components: the first being the null-perpendicular-space component, the “purest” joint velocity (shortest vector length) which produces the desired tool tip motion (and when the remote center is used, the desired remote center motion); and the second being the null-space component. Equations (2) and (5) show that without a null-space component, the same equation is achieved. Equation (6) starts with a traditional form for the null-space component on the left, and on the far right side, shows the form used in an exemplary system, wherein (Vn) is the set of orthonormal basis vectors for the null-space, and (α) are the coefficients for blending those basis vectors. In some embodiments, a is determined by control parameters, variables or setting, such as by use of knobs or other control means, to shape or control the motion within the null-space as desired.
Alternatively, in certain aspects, an augmented Jacobian that incorporates a potential function gradient and is applied to the Cartesian Space end effector velocities may be used. The augmentation of the Jacobian calculates the joint velocities as desired. It is understood that in referring to calculating joint movements using the Jacobian, such calculations may include the augmented Jacobian approach. In accordance with the augmented Jacobian approach, the following equations may be used, although it is appreciated that column vectors may be used:

dx/dt=J*dq/dt 

y=h(q)

dy/dt=∂h/∂q*dq/dt 

[dx/dtTdy/dtT]T=[JT∂h/∂qT]T*dq/dt 

d(x;y)/dt=[J;h′]*dq/dt 

dq/dt=[J;h′]#d(x;y)/dt 

In one example, set y=h(q) the complex network of potential field functions. dy/dt=∂h/∂q*dq/dt. dy/dt and ∂h/∂q and dy/dt can be dictated as desired based on the potential field functions, and the augmented equation would produce the combined desired result of both driving the end effector and tracking the paths in joint space. In one aspect, the augmented Jacobian incorporates a potential function gradient and is applied to the Cartesian space end effector velocities, wherein the augmentation of the Jacobian calculated the joint velocities as desired, to provide the advantageous features described herein.
FIG. 13A graphically illustrates the relationship between the null-space of the Jacobian and the null-perpendicular-space of the Jacobian. FIG. 14A shows a two-dimensional schematic showing the null-space along the horizontal axis, and the null-perpendicular-space along the vertical axis, the two axes being orthogonal to one another. The diagonal vector represents the sum of a velocity vector in the null-space and a velocity vector in the null-perpendicular-space, which is representative of Equation (4) above. FIG. 13B graphically illustrates the relationship between the null-space and the null-motion manifold within a four-dimensional joint space, shown as the “null-motion manifold.” Each arrow (q1, q2, q3, and q4) representing a principal joint axis. The closed curve represents a null-motion manifold which is a set of joint-space positions which instantaneously achieves the same end effector position. For a given point A on the curve, since the null-space is a space of joint velocities which instantaneously produce no movement of the end effector, the null-space is parallel to the tangent of the null-motion manifold at point A. To further highlight and illustrate the null-space concepts described herein, FIG. 13C graphically illustrates aspects of the null-space clutch feature in regard to Cart-space commands, in accordance with aspects of the invention. In regard to the null-clutch or null-space clutch feature, the concept is that a sensed joint motion is matched as closely as possible by the joint commands, but only along the null-space.
FIG. 14A graphically illustrates the two-dimensional subspace of the joint-space of an exemplary manipulator arm, in accordance with one aspect of the present invention. The horizontal and vertical axes represent the movement of two joints having independent joint movement, movement of joint affecting a pitch of an instrument holder of the manipulator arm (horizontal axis) versus movement of a distal revolute joint that pivots the instrument holder laterally from a plane through which a proximal portion of the manipulator arm extends (vertical axis). The right-most point of the joint patch represents the maximum forward pitch of the tool tip, while the left most points of the path represent the maximum backward pitch of the tool tip. In certain embodiments, the manipulator arm uses a parallelogram linkage in which joints J3, J4 and J5 are configured with interrelated movement to maintain the parallelogram formed by joints J3, J4, J5 and pivot point PP (see for example FIG. 5A). Due to this interrelated movement, the pitch of the instrument shaft may be determined by the state of a pitch joint (e.g. J3). Movement of the pitch joint, such as by joint J3 in FIG. 5A, changes the pitch of the insertion axis from a pitch forward position (see FIG. 6A) to a pitch back position (see FIG. 6B). In various other embodiments, the pitch joint may include one or more joints of a manipulator arm the movement of which determine the pitch of the instrument shaft. Movement of the distal revolute joint, such as distal revolute joint J7 (see FIG. 8A) supporting the instrument holder 510 and associated cannula 511, pivots or twists the instrument shaft extending through instrument holder 510 laterally relative to a plane through which the portion of the manipulator proximal of joint J7 extends. The sub-space of the manipulator joint space illustrates the range of possible combinations of joint states for the pitch joint, J3, and the revolute joint, J7. Although in this embodiment, the positional constraints are defined within a subspace of the joint space defined by the pitch joint and the distal revolute joint described above, it is appreciated that the subspace may be defined by various other joints or by three or more joints.
In some embodiments, the positional constraints are defined by a network of paths within the subspace; each network defining a positional path along which a user desires the manipulator arm to move corresponds to path segments extending through the subspace of the manipulator joint space that illustrate the combination of states between the pitch joint and the revolute joint. In the example of FIG. 14A, the desired positional path of the manipulator arm is defined by three one-dimensional path segments defined to be piecewise continuous, segments A, B and C connected at a common intersection. In this example, since the range of motion of the distal revolute joint J7 can pivot the instrument holder laterally in either direction from the plane of the portion of the manipulator arm proximal joint J7, the desired path is defined to include movement of the joint in either direction (as shown by segments A and B). In such an embodiment, the system may be configured to control a tracking movement of the manipulator arm so that the position of the one or more joints move toward the nearest point on the desired path. For example, the revolute joint J7 could be made to move along segment B, rather than segment A, if joint J7 was nearer segment B when the path tracking movement is effected.
In this embodiment, the desired path includes relative movement of the distal revolute joint and pitch joint so that movement of the pitch joint to an increased pitch back position corresponds to increased rotational displacement of the revolute joint, and movement of the pitch joint to a pitch forward position corresponds to minimal or zero displacement of the distal revolute joint. As the outer pitch joint is pitched back, the tool tip on the instrument shaft moves forward. If the outer pitch joint reaches its limit in the pitch-back position, forward movement of a tool tip on the end of the instrument shaft 512 can still be achieved by movement of the distal revolute joint J7. It may be useful however, to initiate movement of the distal revolute joint, J7, as the outer pitch joint J3 approaches its limit in the pitch-back position. Similarly, in the pitch-forward direction, which causes tool tip motion in the backwards direction, the most backward tool tip positioning can be obtained when the movement of the distal revolute joint is minimal, which is at zero angular displacement of the distal revolute joint. In addition, when the angular displacement of the distal revolute joint is greater or less than zero, the cross-section of the manipulator arm appears larger such that the arm may be more susceptible to collisions with adjacent arms; therefore, it is advantageous to constrain the distal revolute joint using the positional constraints described herein so that the angular displacement of the distal revolute joint is at zero unless movement is desired for the reasons noted above; hence, to provide this desired movement between the outer pitch joint and the distal revolute joints, the constraints are defined as three network paths shown in FIG. 14A.
At any point in time, being on any of the network of path segments coincides with meeting a one-dimensional constraint requiring a one-dimensional null-space. This two-dimensional subspace of manipulator joint space can be used to direct the movement of the manipulator arm to the desired positional path by creating an attractive potential field which tends to “pull” or direct the Position P of the joint states toward or along the defined path segments, typically the nearest path segment or segments. The system may be configured so that the tracking movement of the joints cause the specified joints to move along the defined path segments or may use various magnitudes of attraction within the potential field to cause the joints to move toward the segment paths so that general movement is closer to the desired path. In one approach, this is accomplished by generating a potential field in joint-space, such that high potentials represent longer distances between the X (e.g. the current or calculated manipulator joint position) and the positional constraint (e.g. the network of paths), and lower potentials represent shorter distances. The null-space coefficients (a) are then calculated to descend down the negative gradient of the potential field, to the greatest extent possible. In some embodiments, a potential associated with each path (e.g. b′ and Cr) are determined from a distance between the calculated position of the one or more manipulator joints and the defined paths. In response to the calculated attractive force of the artificial potential field on the current joint positions, the system calculates movement of one or more joints of the manipulator arm within the null-space.
While the constraints may be defined as three segments A, B and C within a subspace defined by a distal revolute joint and an outer pitch joint as shown in FIGS. 14A-14B, it is appreciated that the above noted advantages are associated with the particular kinematics of a given manipulator arm. Thus, as the kinematics may differ between manipulator arms, so may the desired joint movements and the configuration of network path segments differ between manipulator arms. For example, depending on the design of a manipulator arm, it may be useful to define the subspace in which the positional constraints are defined by two or more other joints of the manipulator arm. For example, assuming an N-dimensional null-space, a network of N-dimensional manifolds in any M-dimensional subspace of the full P-dimensional joint space may be defined, where N≦M≦P. In a first example, in a one or more dimensional null-space, a network of one-dimensional curves or line segments may be defined in the entire joint space or in any subspace of therein. Attractive potentials or velocities may then be calculated and projected onto the null-space to determine the tracking movement so that a position of the one or more joints tracks the defined paths. In a second example, assuming a null-space of two or more dimensions, a network of two-dimensional surfaces may be defined in the entire joint space or in any subspace therein. Again, attractive potentials or velocities may then be calculated and projected on the null-space as described above. In both examples, the approach causes the manipulator to follow the network of paths to produce the desired movement. In a third example, assuming a null-space of one dimension, a network of two-dimensional surfaces could still be defined in the entire joint space or in a subspace thereof, however, mapping velocities or attractive potentials onto the null-space may provide limited capability in following the network surfaces, e.g. only a one-dimensional subset of the surfaces may be followed.
FIG. 14B illustrates a method of determining a tracking movement of a manipulator arm along a desired path, similar to that described in FIG. 14A, except that the path segments may be modified, such as by translating or shifting a position or orientation of the path segments in response to various calculated joint states or operating mode of the manipulator arm. For example, as described above, a manipulator arm may include a clutch mode in which a user can manually reconfigure a manipulator arm by applying an external force to one or more joints of the manipulator arm or a reconfiguration input allowing a user to drive one or more joints to reconfigure a position or configuration of the manipulator arm as desired. After reconfiguration of the manipulator arm is completed upon exiting the clutch mode, the path segments corresponding to the desired positional path may be modified to coincide with the position of the one or more joints having been reconfigured by the user, or alternatively reconfigured by an autonomous algorithm such as a collision avoidance algorithm. This aspect allows the manipulator arm to retain the advantages of reconfiguration capabilities while providing the desired movement of the one or more joints and any advantages associated with such desired movement (e.g. increased range of motion, increased predictability and consistency of movement, decreased likelihood of collision, etc.).
In other embodiments, the defined path may include a plurality of different networks of path segments, each network of path segments corresponding to a different position or range of positions of the one or more joints. Thus, rather than modifying a particular network of paths when the manipulator arm is reconfigured into a different position, the system may select a particular network of paths nearest the position of the manipulator arm.
In one aspect, the approach includes defining positional constraints, such as in a joint-space or in the Cartesian-coordinate space of the tool tip (or some other portion of the manipulator and may include a remote center, such as found in either a hardware or software center system). For a manipulator with n-DOF of redundancy (e.g. an n-dimensional null-space of up to n constraints can be satisfied simultaneously). For a case having one-dimensional constraints, this may include a set of piece-wise continuous constraints. For example, a network of line segments or curves may be used to define a network of paths in either the joint-space of the Cartesian-coordinate space. The network of paths may be either static or may be dynamically redefined during the course of surgery. A static network path may be defined at start-up or may be selected by a user or the system from a plurality of static network paths, while a dynamic network path may be dynamically redefined by the system, or by a user, during the course of surgery.
Once the network of paths is determined, the movement of the joints of the manipulator arm is calculated so that the position of the one or more joints tracks the paths so as to provide the desired movement of the one or more joints. In one aspect, the joints of the manipulator arm tracks the network of path segments based on a virtual or artificial potential field generated for each segment of that path to attract the manipulator to the path. The movement resulting from the calculated potential may then be projected onto the null-space for calculation of null-space coefficient to provide joint velocities that provide the desired tracking movement. In cases where there is a network of paths, the resulting potential fields from the entire set of path segment (or a portion thereof) may be added together and may include some type of weighting. Alternatively, the system may be configured to utilize only the potential field associated with the closest path segment. The resulting motion provides that the null-space controller moves the joints so that the manipulator arm traversed the specified network of paths to produce the desired movement of the joints within the null-space, even during commanded end effector movement by the surgeon.
FIGS. 15-16 illustrate methods of reconfiguring a manipulator assembly of a robotic surgical system in accordance with many embodiments of the present invention. FIG. 15 shows a simplified schematic of the required blocks need to implement the general algorithms to control the patient side cart joint states, in relation to the equations discussed above. According to the method of FIG. 15, the system: calculates the forward kinematics of the manipulator arm; then calculates dx/dt using Equation (1), calculates dqperp/dt using Equation (5), then calculates dqnull/dt from z which may depend on dqperp/dt and the Jacobian using Equation (6). From the calculated dqperp/dt and dqnull/dt the system then calculates dq/dt and q using Equations (4) and (3), respectively, thereby providing the movement by which the controller can effect the desired reconfiguration of the manipulator while maintaining the desired state of the end effector and/or location of the remote center.
FIG. 16 shows a block diagram of an exemplary embodiment of the system. In response to a manipulation command, which commands a desired tool tip state, a processor of the system determines the velocities of the tool tip and the states of the joints from which the dqperp/dt is calculated. To provide a desired path of joint movement for the manipulator arm, the system determined position-based constraints within the subspace of the joints for which controlled movement is desired, such as a network of paths. Optionally, the defined constraints may be altered by a user input, such as a reconfiguration of one or more joints driven by a user or manually reconfigured in a clutch mode. The dqnull/dt is then calculated so as to move the joints along the defined network paths, such as through the use of an attractive potential field for one or more segments of the network path which may be added to the dqperp/dt to calculate dq/dt so as to drive the joint(s) of the system and effect the desired movement (or state) of the end effector while providing the desired movement of one or more joints within the null-space according to the desired movement.
FIGS. 17-18 illustrate methods of providing a desired movement of one or more joints of a manipulator. The method of FIG. 17 includes: determining a set of position-based constraints within a joint space that correspond to a desired joint movement of one or more joints; determine a potential between the position of the one or more joints and the constraints within an artificial potential field; calculating a movement of the manipulator arm within a null-space using the determined potential so that the one or more joints track the constraints; and driving the joints according to the calculated movement to effect the desired movement of the one or more joints, even concurrent with various other movement of the joints. The method of FIG. 18 includes: providing a manipulator arm having a plurality of joints extending to a distal end effector, the arm having a range of differing configurations for a given end effector state; defining a set of position-based constraints that correspond to a desired movement of one or more joints of the plurality; optionally, modifying the constraints based on a reconfigured position of the one or more joints; determining a tracking movement of the plurality of joints within a null-space using a potential between the constraints and a calculated position of the one or more joints; and driving the joints according to the calculated movement to effect the desired movement of the one or more joints, even concurrent with various other movement of the joints.
While the exemplary embodiments have been described in some detail for clarity of understanding and by way of example, a variety of adaptations, modifications, and changes 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. A robotic method for a manipulator arm that includes a movable distal end effector, a proximal portion coupled to a base, and a plurality of joints between a distal portion and the base, the plurality of joints together having sufficient degrees of freedom to allow a range of differing joint states for an individual state of the distal end effector, and the method comprising:
defining a position-based constraint of one or more joints of the plurality of joints within a joint space of the plurality of joints, the position-based constraint including one or more paths corresponding to a desired movement of the one or more joints within the joint space of the plurality of joints;
receiving a manipulation command to move the end effector with a desired end effector movement;
calculating an end effector displacing movement of the plurality of joints to effect the desired end effector movement, wherein calculating the end effector displacing movement of the plurality of joints comprises calculating joint velocities within a null-perpendicular-space of a Jacobian;
calculating a tracking movement of the plurality of joints so as to move a position of the one or more joints towards at least one of the one or more paths, wherein calculating the tracking movement comprises calculating joint velocities of the one or more joints within a null-space of the Jacobian in a direction towards the at least one of the one or more paths, the null-perpendicular space being orthogonal to the null-space; and
driving the plurality of joints according to the calculated movements so as to effect the desired end effector movement concurrently with the desired movement of the one or more joints.

2. The method of claim 1, wherein the one or more paths each have at least one dimension, and the one or more paths are each defined within a subspace of the joint space defined by at least two joints of the plurality of joints.

3. The method of claim 2, wherein the at least two joints have independent joint states such that the subspace comprises at least two dimensions.

4. The method of claim 2, wherein calculating the tracking movement comprises:
defining an attractive potential field between a calculated position of the one or more joints and the one or more paths, wherein an increase in potential of the potential field corresponds to an increase in distance between the calculated position and the one or more paths;
determining a potential between the calculated position and the one or more paths; and
calculating the tracking movement by using the potential to determine the direction towards the at least one of the one or more paths.

5. The method of claim 2, wherein the one or more paths comprise a network of paths that are piecewise continuous so as to provide consistent and predictable movement along the one or more paths when the one or more joints are driven along the one or more paths.

6. The method of claim 5, wherein calculating the tracking movement comprises:
determining a movement of the plurality of joints within the joint space based on a potential determined by the one or more joints; and
determining joint velocities of the plurality of joints that track the position-based constraint of the one or more joints by projecting the movement of the plurality of joints on a null space of the Jacobian.

7. The method of claim 2, wherein the at least two joints comprise a first and a second joint, and wherein movement of the first joint controls a pitch of a distal instrument shaft of the manipulator arm and movement of the second joint pivots the instrument shaft laterally relative to a plane along which a portion of the manipulator arm proximal of the second joint extends.

8. The method of claim 6, wherein the distal portion of the manipulator arm is coupled with an instrument holder that releasably supports a surgical instrument having an elongate shaft extending distally to the end effector, wherein the instrument shaft pivots about a remote center during surgery.

9. The method of claim 1, further comprising:
driving at least one joint of the plurality of joints to effect a desired reconfiguration of the manipulator arm;
calculating a reconfiguration movement of the one or more joints in response to the driving of the at least one joint so that the calculated movement in combination with driving of the at least one joint is within the null-space;
modifying the position-based constraint in response to a determined position of the one or more joints within the calculated reconfiguration movement; and
driving the plurality of joints according to the calculated movements while driving the at least one joint to effect the desired reconfiguration of the manipulator arm and the desired movement of the one or more joints while maintaining a desired state of the end effector.

10. The method of claim 9, wherein modifying the position-based constraint comprises translating a position or orientation of the constraint within the joint space based on the calculated reconfiguration movement.

11. The method of claim 9, wherein modifying the position-based constraint comprises selecting one of a set of position-based constraints in response to the determined position of the one or more joints.

12. The method of claim 9, wherein driving the at least one joint comprises manual articulation of the at least one joint, wherein the calculated movements of the manipulator arm are determined by a processor having a tissue manipulation mode and a clutch mode, the processor in the tissue manipulation mode calculating joint movements to provide the desired end effector movement in response to the end effector manipulation command, the processor in the clutch mode driving at least one other joint in response to the manual articulation of the at least one joint so as to maintain the desired state of the end effector, and
wherein modifying the position-based constraint occurs in response to the determined position of the one or more joints reconfigured within the clutch mode.

13. A system comprising:
a manipulator arm configured for robotically moving a distal end effector relative to a proximal base, the manipulator arm having a plurality of joints between the distal end effector and the proximal portion coupled to the base, the plurality of joints together providing sufficient degrees of freedom to allow a range of joint states for an individual state of the distal end effector;
an input for receiving a manipulation command to move the end effector with a desired end effector movement; and
a processor coupling the input device to the manipulator arm, the processor configured to perform operations including:
calculating an end effector displacing movement of the plurality of joints in response to the manipulation command by calculating joint velocities within a null-perpendicular-space of a Jacobian;
defining a position-based constraint of one or more joints of the plurality of joints within a joint space of the plurality of joints, the position-based constraint including one or more paths corresponding to a desired movement of the one or more joints within the joint space of the plurality of joints;
calculating a tracking movement of the plurality of joints so that a position of the one or more joints tracks at least one of the one or more paths, wherein calculating the tracking movement comprises calculating joint velocities of the one or more joints within a null-space of the Jacobian in a direction towards the at least one of the one or more paths, the null-space being orthogonal to the null-perpendicular space; and
transmitting a command to the manipulator arm to drive the plurality of joints according to the calculated movements so as to effect the desired end effector displacing movement concurrently with the desired movement of the one or more joints.

14. The system of claim 13 wherein the one or more joints comprise at least two joints defining a subspace of the joint space, the subspace including the one or more paths corresponding to the desired movement of the one or more joints.

15. The system of claim 14, wherein the at least two joints have independent joints states such that the subspace comprises at least two dimensions.

16. The system of claim 13, wherein the processor is configured such that calculating the tracking movement comprises:
defining an attractive potential field within the joint space such that an increase in potential of the potential field corresponds to an increased distance between a calculated position of the one or more joints and the one or more paths and a decrease in potential corresponds to a decreased distance between the calculation position and the one or more paths;
determining a potential between the calculated position and the one or more paths; and
calculating the tracking movement of the plurality of joints by using the determined potential to determine the direction towards the at least one of the one or more paths.

17. The system of claim 14, wherein the one or more paths comprise a network of paths that are piecewise continuous.

18. The system of claim 14, wherein the at least two joints comprise a first and a second joint, the second joint coupling a distal portion of the manipulator arm having an instrument shaft to a proximal portion of the manipulator arm and the first joint being disposed between a proximal base of the manipulator arm and the second joint,
wherein movement of the first joint controls a pitch of the distal instrument shaft of the manipulator arm and movement of the second joint pivots the instrument shaft laterally relative to a plane through which the proximal portion of the manipulator arm extends.

19. The system method of claim 14, wherein a distal portion of the manipulator arm is coupled with an instrument holder configured to releasably support a surgical instrument having an elongate shaft extending distally to the end effector, wherein the instrument shaft pivots about a remote center during surgery, and
wherein the at least two joints comprise a first and second joint of the plurality of joints, the first joint comprising a revolute joint, a state of the first joint corresponding to an outer pitch of the instrument holder, the second joint comprising a revolute joint distal of the first joint, a state of the second joint corresponding to an angular displacement of the instrument holder relative a plane through which a portion of the manipulator arm proximal the second joint extends, such that the subspace defined by the first and second joints corresponds to the pitch of the instrument shaft versus the angular displacement of the instrument shaft.

20. The system of claim 14, further comprising:
an input device for receiving a reconfiguration command to drive at least one joint to effect a desired reconfiguration of the manipulator arm,
wherein the processor is further configured to perform operations including:
calculating a reconfiguration movement of one or more joints in response to driving of the at least one joint so that the calculated reconfiguration movement combined with driving of the at least one joint is within the null-space of the Jacobian;
driving the plurality of joints according to the calculated reconfiguration movement concurrently with driving the at least one joint to effect the desired reconfiguration of the manipulator arm while maintaining a desired state of the end effector; and
modifying the position-based constraint in response to the calculated reconfiguration movement.

21. The system of claim 20, wherein the processor is configured such that modifying the position-based constraint comprises translating at least one of a position or orientation of the constraint within the subspace based on the calculated reconfiguration movement.

22. The system of claim 20, wherein the constraint comprises a plurality of alternatively selectable constraints, and wherein the processor is configured such that modifying the constraint comprises selecting one of the plurality of constraints in response to the calculated reconfiguration movement.

23. The system of claim 16, wherein the processor is further configured to calculate the tracking movement by determining a movement of the plurality of joints within the joint space from the determined potential and projecting the movement onto the null-space of the Jacobian to calculate joint velocities so as to track the constraint with the one or more joints.

24. The system of claim 20, wherein the processor is further configured with a tissue manipulation mode and a clutch mode, the processor in the tissue manipulation mode calculating joint movements to provide the desired end effector movement in response to the end effector manipulation command, the processor in the clutch mode driving at least one joint in response to an external articulation of another joint while maintaining a given state of the end effector.

25. The system of claim 24, further comprising:
a clutch input for changing between the clutch mode and the manipulation mode,
wherein modifying the constraint occurs in response to reconfiguration of the one or more joints within the clutch mode.

26. The system of claim 13, wherein the processor is further configured to perform operations including:
calculating a collision avoidance to avoid a collision between the manipulator arm and an adjacent manipulator arm, wherein the collision avoidance movement is calculated within the null-space of the Jacobian to avoid collision while maintain the desired state of the end effector; and
overlaying the collision avoidance movement with the tracking movement so as to avoid collisions while effecting the desired movement of the one or more joints.

27. The robotic system of claim 24, wherein each joint of the manipulator assembly has an associated joint degree of freedom, and wherein the processor in the clutch mode is configured to drive the at least one joint in response to the manual articulation of the other joint so as to provide the manipulator assembly with an effective clutch degree of freedom, the clutch degree of freedom differing from each of the joint degrees of freedom.

28. The robotic system of claim 27, wherein the at least one joint driven by the processor in the clutch mode comprises some or all of the plurality of joints of the manipulator assembly, the processor in the clutch mode configured to drive the manipulator assembly in response to manual articulation of a first plurality of the plurality of joints of the manipulator assembly so that the manipulator assembly has a plurality of effective degrees of freedom when the processor is in the clutch mode.

29. The system of claim 18, wherein at least some of the plurality of joints comprise remote center joints mechanically constrained to pivotal movement about a remote center along an insertion axis and adjacent a minimally invasive aperture through which the instrument shaft of the distal end effector extends.

30. The system of claim 29, wherein the first joint comprises one joint within a parallelogram linkage system including:
a parallelogram linkage base coupled to the base for rotation about a first remote center axis intersecting the remote center;
a first link having a first link proximal end and a first link distal end, the first link proximal end coupled to the parallelogram linkage base at a base joint, the first link distal end configured to support the tool;
a second link having a second link proximal end and a second link distal end, the second link proximal end coupled to the first link distal end, the second link distal end configured to support the tool so that an insertion axis of the tool is constrained to rotation about a second remote center axis intersecting the remote center,
wherein movement of the links and joints of the parallelogram linkage system are interrelated such that movement of the first joint in combination with the other joints of the paralleglogram linkage system determines the pitch of the instrument shaft relative to a remote center axis intersecting the first joint.