# US 2024/0173856 A1 · Systems and methods for controlling a robotic manipulator or associated tool

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

- Number: US 2024/0173856 A1
- Document ID: US20240173856A1
- Status: Published application
- Kind: A1
- Application number: 18/553,387
- Filed: 2022-03-30
- Published: 2024-05-30
- Earliest claimed: 2021-04-01
- Assignees: Intuitive Surgical Operations, Inc.
- Applicants: Intuitive Surgical Operations, Inc.
- Inventors: Ramu Sharat Chandra; Goran A. Lynch
- Web page: https://patentgrep.com/patent/US20240173856A1

## CPC

- B25J 9/1628: {characterised by the control loop}
- B25J 9/1635: {flexible-arm control}
- A61B 34/30: Surgical robots
- A61B 34/77: {Manipulators with motion or force scaling}
- B25J 9/1638: {compensation for arm bending/inertia, pay load weight/inertia}
- G05B 19/4155: characterised by program execution, i.e. part program or machine function execution, e.g. selection of a program
- G05B 2219/39195: Control, avoid oscillation, vibration due to low rigidity
- G05B 2219/39241: Force and vibration control
- G05B 2219/40269: Naturally compliant robot arm
- 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 robotic system includes a robotic manipulator, which includes a first joint and a link connected to the first joint. A processing unit including one or more processors is configured to receive sensor measurement data of the link from a sensor system, and generate, based on the sensor measurement data, a first joint velocity estimate of the first joint. A first vibration cancellation state for the first joint is determined based on one or more cancellation conditions of one or more of joints of the robotic manipulator. In response to the first vibration cancellation state indicating enablement of vibration cancellation for the first joint, a first cancellation force is applied to the first joint, the first cancellation force based on a first joint velocity estimate of the first joint.

## Claims

### Claim 1

A robotic system comprising:
a robotic manipulator including a first joint and a link connected to the first joint; and
a processing unit including one or more processors, the processing unit configured to:
receive sensor measurement data of the link from a sensor system,
generate, based on the sensor measurement data, a first joint velocity estimate of the first joint,
determine a first vibration cancellation state for the first joint based on one or more cancellation conditions of one or more of joints of the robotic manipulator, and
in response to the first vibration cancellation state indicating enablement of vibration cancellation for the first joint, apply a first cancellation force to the first joint, the first cancellation force based on a first joint velocity estimate of the first joint.

### Claim at position 2

2-5. (canceled)

### Claim 6 (depends on 1)

The robotic system of claim 1, wherein each cancellation condition of the one or more cancellation conditions includes at least one condition selected from the group consisting of: a linearity condition and a command tracking condition.

### Claim at position 4

7-9. (canceled)

### Claim 10 (depends on 1)

The robotic system of claim 1, wherein the robotic manipulator comprises a plurality of joints, and wherein the processing unit is further configured to:
for each joint of the plurality of joints, determine a vibration cancellation state for that joint and control that joint based on that vibration cancellation state.

### Claim at position 6

11-12. (canceled)

### Claim 13 (depends on 10)

The robotic system of claim 10, wherein, for each joint of the plurality of joints, determining the vibration cancellation state for that joint comprises:
determining the vibration cancellation state as a cancellation enabling state in response to determining that a cancellation condition is met for each joint of a group of joints.

### Claim at position 8

14-16. (canceled)

### Claim 17 (depends on 13)

The robotic system of claim 13, the group of joints includes
all joints of the plurality of joints; or
one or more joints of a second robotic manipulator of the robotic system.

### Claim 18

(canceled)

### Claim 19 (depends on 10)

The robotic system of claim 10, wherein the processing unit is further configured to, for each joint of the plurality of joints:
determine an initial vibration cancellation force;
limit, in accordance with the vibration cancellation state, the initial vibration cancellation force to generate a limited cancellation force; and
apply the limited cancellation force to the joint.

### Claim 20

(canceled)

### Claim 21 (depends on 1)

The robotic system of claim 1, wherein the one or more cancellation conditions comprise a cancellation condition determined based on:
an estimated or measured velocity of a joint of the one or more joints, or
a commanded joint velocity or a commanded joint position of the first joint.

### Claim 22

(canceled)

### Claim 23 (depends on 21)

The robotic system of claim 21, wherein the cancellation condition is determined based on the commanded joint velocity and the commanded joint position of the first joint.

### Claim 24

(canceled)

### Claim 25 (depends on 1)

The robotic system of claim 1, wherein the one or more cancellation conditions comprise a cancellation condition of a joint that is determined to be met in response to a first difference between a commanded joint position and a measured joint position being less than a first defined difference or in response to a second difference between the commanded joint position of the first joint and a previously commanded joint position of the first joint being less than a second defined difference.

### Claim at position 18

26-29. (canceled)

### Claim 30 (depends on 1)

The robotic system of claim 1, wherein the robotic manipulator is configured to physically support and move a tool; and
wherein the processing unit is configured to:
generate, based on the sensor measurement data, a control point velocity estimate of a control point associated with the tool,
generate the joint velocity estimate of the first joint based on the control point velocity estimate, and
set a location of the control point relative to the tool based on one or more mathematically singular configurations of the robotic manipulator.

### Claim at position 20

31-33. (canceled)

### Claim 34

A method of operating a robotic system comprising:
receiving, with processing unit and from a sensor system, sensor measurement data of a link of a robotic manipulator of the robotic system, wherein the robotic manipulator includes a first joint connected to the link;
generating, with the processing unit and based on the sensor measurement data, a first joint velocity estimate of the first joint;
determining, with the processing unit, a first vibration cancellation state for the first joint based on one or more cancellation conditions of one or more of joints of the robotic manipulator; and
in response to the first vibration cancellation state indicating enablement of vibration cancellation for the first joint, applying, with the processing unit, a first cancellation force to the first joint, the first cancellation force based on a first joint velocity estimate of the first joint.

### Claim at position 22

35-36. (canceled)

### Claim 37 (depends on 34)

The method of claim 34, wherein each cancellation condition of the one or more cancellation conditions includes at least one condition selected from the group consisting of: a linearity condition and a command tracking condition.

### Claim at position 24

38-39. (canceled)

### Claim 40 (depends on 34)

The method of claim 34, wherein the robotic manipulator comprises a plurality of joints, further comprising:
for each joint of the plurality of joints, determining a vibration cancellation state for that joint and control the joint based on that vibration cancellation state.

### Claim at position 26

41-42. (canceled)

### Claim 43 (depends on 40)

The method of claim 40, wherein, for each joint of the plurality of joints, determining the vibration cancellation state for that joint comprises:
determining a cancellation enabling state in response to determining that a cancellation condition is met for each joint of a group of joints.

### Claim 44 (depends on 43)

The method of claim 43, wherein the group of joints is a subset of the plurality of joints.

### Claim 45 (depends on 43)

The method of claim 43, wherein the group of joints includes:
all joints of the plurality of joints; or
one or more joints of a second robotic manipulator of the robotic system.

### Claim 46 (depends on 40)

The method of claim 40, further comprising:
for each joint of the plurality of joints:
determining an initial vibration cancellation force;
limiting, in accordance with the vibration cancellation state, the initial vibration cancellation force to generate a limited cancellation force; and
applying the limited cancellation force to the joint.

### Claim at position 31

47-48. (canceled)

### Claim 49 (depends on 34)

The method of claim 34, wherein the one or more cancellation conditions comprise:
a cancellation condition determined based on an estimated or measured velocity of a joint of the one or more joints; or
a cancellation condition determined based on a commanded joint velocity or a commanded joint position of the first joint; or
a cancellation condition that is determined to be met in response to a determination that a magnitude of a commanded joint velocity of a joint of the one or more joints is less than a defined velocity value; or
a cancellation condition of a joint that is determined to be met in response to a difference between a commanded joint position and a measured joint position being less than a defined difference; or
a cancellation condition of a joint that is determined to be met based on a difference between a commanded joint position of the first joint and a previously commanded joint position of the first joint being is less than a determined difference value.

### Claim 50

(canceled)

### Claim 51 (depends on 34)

The method of claim 34, wherein the robotic manipulator is configured to physically support and move a tool, further comprising:
generating, based on the sensor measurement data, a control point velocity estimate of a control point associated with the tool, and
generating the joint velocity estimate of the first joint based on the control point velocity estimate; and
setting a location of the control point relative to the tool based on one or more mathematically singular configurations of the robotic manipulator.

### Claim 52

(canceled)

### Claim 53

A non-transitory machine-readable medium comprising a plurality of machine-readable instructions which, when executed by one or more processors, are adapted to cause the one or more processors to perform a method comprising:
receiving, from a sensor system, sensor measurement data of a link of a robotic manipulator of a robotic system, wherein the robotic manipulator includes a first joint connected to the link;
generating, based on the sensor measurement data, a first joint velocity estimate of the first joint;
determining, a first vibration cancellation state for the first joint based on one or more cancellation conditions of one or more of joints of the robotic manipulator; and
in response to the first vibration cancellation state indicating enablement of vibration cancellation for the first joint, applying a first cancellation force to the first joint, the first cancellation force based on a first joint velocity estimate of the first joint.
