# US 2022/0032453 A1 · System and methods for managing multiple null-space objectives and sli behaviors

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2022/0032453 A1
- Document ID: US20220032453A1
- Status: Published application
- Kind: A1
- Application number: 17/505,566
- Filed: 2021-10-19
- Published: 2022-02-03
- Earliest claimed: 2013-03-15
- Assignees: Intuitive Surgical Operations, Inc.
- Applicants: Intuitive Surgical Operations, Inc.
- Inventors: Arjang Hourtash
- Web page: https://patentgrep.com/patent/US20220032453A1

## CPC

- B25J 9/1607: {Calculation of inertia, jacobian matrixes and inverses}
- A61B 34/30: Surgical robots
- A61B 34/37: Leader-follower robots (A61B34/35 takes precedence)
- B25J 9/1689: {Teleoperation}
- B25J 18/007: {the end effector rotating around a fixed point}
- A61B 34/77: {Manipulators with motion or force scaling}
- G05B 2219/39079: Solve inverse differential kinematics in closed, feedback loop, iterate
- G05B 2219/40327: Calculation, inverse kinematics solution using damped least squares method
- G05B 2219/41405: Inverse kinematic, dynamic
- B25J: MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES ({manipulators specially adapted for use in surgery A61B34/70; manipulators used in cleaning hollow articles B08B9/04}; manipulators associated with rolling mills B21B39/20; manipulators associated with forging machines B21J13/10; {manipulators associated with picking-up and placing mechanisms B23P19/007}; means for holding wheels or parts thereof B60B30/00; {vehicles with ground-engaging propulsion means, e.g. walking members B62D57/02, B62D57/032; devices for picking-up and depositing articles or materials between conveyors B65G47/90, B65G47/91; manipulators with gripping or holding means for transferring packages B65H67/065}; cranes B66C; {manipulators used in the protection or supervision of pipe-line installations F17D5/00; walking equipment adapted for nuclear steam-generators F22B37/006}; manipulators specially adapted for, or associated with, nuclear reactors G21C; {apparatus used for handling wafers during manufacture or treatment of semiconductor H10P72/50})
- A61B: DIAGNOSIS; SURGERY; IDENTIFICATION (usefulness limited to only animals A61D)
- G05B: CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS (systems for controlling or regulating non-electric variables G05D; systems for regulating electric or magnetic variables G05F; control devices or systems insofar as characterised by mechanical features only G05G)

## Abstract

A medical system includes a manipulator arm including a movable distal portion, a proximal portion coupled to a base, and joints between the distal portion and the base. A processor coupled to the manipulator arm performs operations including calculating a first movement of the joints in a null-space of a Jacobian of the manipulator arm, the first movement being calculated in accordance with a first objective for arm-to-patient collision avoidance. The operations further include calculating a second movement of the joints in the null-space, the second movement being calculated in accordance with a second objective for arm-to-arm collision avoidance, and combining at least the first and second movements into a combined movement in a manner allowing the first objective to overpower the second objective, and driving the joints to effect the combined movement.

## Claims

### Claim 1

A medical system comprising:
a manipulator arm including a movable distal portion, a proximal portion coupled to a base, and a plurality of joints between the distal portion and the base, the plurality of joints having sufficient degrees of freedom to allow a range of differing joint states of the plurality of joints for a given state of the distal portion; and
a processor coupled to the manipulator arm, the processor being configured to perform operations including:
calculating a first movement of the plurality of joints in a null-space of a Jacobian of the manipulator arm, the first movement being calculated in accordance with a first objective for arm-to-patient collision avoidance,
calculating a second movement of the plurality of joints in the null-space, the second movement being calculated in accordance with a second objective for arm-to-arm collision avoidance,
combining at least the first and second movements of the plurality of movements into a combined movement in a manner allowing the first objective to overpower the second objective, and
driving the plurality of joints to effect the combined movement.

### Claim 2 (depends on 1)

The medical system of claim 1, wherein combining at least the first and second movements of the plurality of movements into the combined movement in a manner allowing the first objective to overpower the second objective comprises:
combining at least the first and second movements based on at least a first attribute associated with the first objective and a second attribute associated with the second objective, wherein the first and second attributes allow the first objective to overpower the second objective.

### Claim 3 (depends on 2)

The medical system of claim 2, wherein the first attribute comprises a first saturation limit, wherein the second attribute comprises a second saturation limit, and wherein the first saturation limit is higher than the second saturation limit.

### Claim 4 (depends on 2)

The medical system of claim 2, wherein combining at least the first and second movements of the plurality of movements into the combined movement comprises:
when the first and second movements conflict, applying the first and second attributes.

### Claim 5 (depends on 2)

The medical system of claim 2, wherein the first attribute comprises a first weight, and wherein the second attribute comprises a second weight, and wherein the first weight is greater than the second weight.

### Claim 6 (depends on 2)

The medical system of claim 2, wherein the first attribute comprises a first priority, wherein the second attribute comprises a second priority, and wherein the first priority is higher than the second priority.

### Claim 7 (depends on 2)

The medical system of claim 2, wherein:
the operations further comprises: calculating a third movement of the plurality of joints in the null-space, the second movement being calculated in accordance with a third objective associated with a third attribute;
the first attribute comprises a first saturation limit and a first priority;
the second attribute comprises a second saturation limit and a second priority, the second priority equal to the first priority;
the third attribute comprises a third priority, the third priority being a next highest priority after the first and second priorities; and
combining at least the first and second movements of the plurality of movements into the combined movement comprises:
combining the first and second movements in accordance with the first and second saturation limits,
determining a remaining null-space after mapping the combined first and second movement into the null-space, and
mapping the third movement to the remaining null-space.

### Claim 8 (depends on 1)

The medical system of claim 1, wherein combining at least the first and second movements of the plurality of movements into the combined movement comprises:
combining the first and second movements while limiting an overall magnitude of the combined movement without changing a direction of the combined movement; or
combining the first and second movements while limiting a magnitude of the combined movement degree-of-freedom by degree-of-freedom.

### Claim 9 (depends on 1)

The medical system of claim 1, wherein combining at least the first and second movements of the plurality of movements into the combined movement comprises:
limiting at least one movement in relation to a master velocity, wherein the master velocity is associated with a commanded movement to move the distal portion, and wherein the at least one movement is selected from a group consisting of: the first movement, the second movement, and the combined movement.

### Claim 10 (depends on 1)

The medical system of claim 1, wherein the operations further comprise:
receiving a manipulation command to move the distal portion;
calculating a distal-portion movement of the plurality of joints to move the distal portion;
driving the plurality of joints to effect the distal-portion movement of the plurality of joints in combination with the combined movement of the plurality of joints.

### Claim 11

A method for moving a manipulator arm of a medical system, the manipulator arm including a movable distal portion, a proximal portion coupled to a base, and a plurality of joints between the distal portion and the base, the plurality of joints having sufficient degrees of freedom to allow a range of differing joint states of the plurality of joints for a given state of the distal portion, the method comprising:
calculating a first movement of the plurality of joints in a null-space of a Jacobian of the manipulator arm, the first movement being calculated in accordance with a first objective for arm-to-patient collision avoidance;
calculating a second movement of the plurality of joints in the null-space, the second movement being calculated in accordance with a second objective for arm-to-arm collision avoidance;
combining at least the first and second movements of the plurality of movements into a combined movement in a manner allowing the first objective to overpower the second objective; and
driving the plurality of joints to effect the combined movement.

### Claim 12 (depends on 11)

The method of claim 11, wherein combining at least the first and second movements into the combined movement in a manner allowing the first objective to overpower the second objective comprises:
combining at least the first and second movements based on at least a first attribute associated with the first objective and a second attribute associated with the second objective, wherein the first and second attributes allow the first objective to overpower the second objective.

### Claim 13 (depends on 12)

The method of claim 12, wherein the first attribute comprises a first saturation limit, wherein the second attribute comprises a second saturation limit, and wherein the first saturation limit is higher than the second saturation limit.

### Claim 14 (depends on 12)

The method of claim 12, wherein:
the first attribute comprises a first weight, and wherein the second attribute comprises a second weight, and wherein the first weight is greater than the second weight; or
the first attribute comprises a first priority, wherein the second attribute comprises a second priority, and wherein the first priority is higher than the second priority.

### Claim 15 (depends on 12)

The method of claim 12, wherein:
the method further comprises: calculating a third movement of the plurality of joints in the null-space, the second movement being calculated in accordance with a third objective associated with a third attribute;
the first attribute comprises a first saturation limit and a first priority;
the second attribute comprises a second saturation limit and a second priority, the second priority equal to the first priority;
the third attribute comprises a third priority, the third priority being a next highest priority after the first and second priorities; and
combining at least the first and second movements of the plurality of movements into the combined movement comprises:
combining the first and second movements in accordance with the first and second saturation limits,
determining a remaining null-space after mapping the combined first and second movement into the null-space, and
mapping the third movement to the remaining null-space.

### Claim 16 (depends on 11)

The method of claim 11, wherein combining at least the first and second movements of the plurality of movements into the combined movement comprises:
combining the first and second movements while limiting an overall magnitude of the combined movement without changing a direction of the combined movement; or
combining the first and second movements while limiting a magnitude of the combined movement degree-of-freedom by degree-of-freedom.

### Claim 17 (depends on 11)

The method of claim 11, wherein combining at least the first and second movements of the plurality of movements into the combined movement comprises:
limiting at least one movement in relation to a master velocity, wherein the master velocity is associated with a commanded movement to move the distal portion, and wherein the at least one movement is selected from a group consisting of: the first movement, the second movement, and the combined movement.

### Claim 18

A processor-readable recording unit storing instructions that, when executed by a processor, cause the processor to perform operations for moving a manipulator arm of a medical system, the manipulator arm including a movable distal portion, a proximal portion coupled to a base, and a plurality of joints between the distal portion and the base, the plurality of joints having sufficient degrees of freedom to allow a range of differing joint states of the plurality of joints for a given state of the distal portion, the operations comprising:
calculating a first movement of the plurality of joints in a null-space of a Jacobian of the manipulator arm, the first movement being calculated in accordance with a first objective for arm-to-patient collision avoidance;
calculating a second movement of the plurality of joints in the null-space, the second movement being calculated in accordance with a second objective for arm-to-arm collision avoidance;
combining at least the first and second movements of the plurality of movements into a combined movement in a manner allowing the first objective to overpower the second objective; and
driving the plurality of joints to effect the combined movement.

### Claim 19 (depends on 18)

The processor-readable recording unit of claim 18, wherein combining at least the first and second movements into the combined movement in a manner allowing the first objective to overpower the second objective comprises:
combining at least the first and second movements based on at least a first attribute associated with the first objective and a second attribute associated with the second objective, wherein the first and second attributes allow the first objective to overpower the second objective.

### Claim 20 (depends on 18)

The processor-readable recording unit of claim 18, wherein the first attribute comprises a first saturation limit, wherein the second attribute comprises a second saturation limit, and wherein the first saturation limit is higher than the second saturation limit.
