# US 2025/0025247 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 2025/0025247 A1
- Document ID: US20250025247A1
- Status: Published application
- Kind: A1
- Application number: 18/904,838
- Filed: 2024-10-02
- Published: 2025-01-23
- Earliest claimed: 2017-11-10
- Assignees: Intuitive Surgical Operations, Inc.
- Applicants: Intuitive Surgical Operations, Inc.
- Inventors: Daniel N. Miller; Dinesh Rabindran; Kollin M. Tierling
- Web page: https://patentgrep.com/patent/US20250025247A1

## CPC

- A61B 34/30: Surgical robots
- B25J 9/1607: {Calculation of inertia, jacobian matrixes and inverses}
- B25J 9/1638: {compensation for arm bending/inertia, pay load weight/inertia}
- B25J 9/1641: {compensation for backlash, friction, compliance, elasticity in the joints}
- B25J 13/08: by means of sensing devices, e.g. viewing or touching devices
- B25J 15/0019: {End effectors other than grippers}
- A61B 34/37: Leader-follower robots (A61B34/35 takes precedence)
- A61B 34/74: {Manipulators with manual electric input means}
- A61B 34/76: {Manipulators having means for providing feel, e.g. force or tactile feedback}
- A61B 2034/2048: {using an accelerometer or inertia sensor}
- A61B 2034/2051: {Electromagnetic tracking systems}
- A61B 2034/2055: {Optical tracking systems}
- A61B 2034/2059: {Mechanical position encoders}
- A61B 2034/2061: {using shape-sensors, e.g. fiber shape sensors with Bragg gratings}
- A61B 2034/2065: {Tracking using image or pattern recognition}
- A61B 2034/301: {for introducing or steering flexible instruments inserted into the body, e.g. catheters or endoscopes}
- A61B 2090/066: {for measuring torque}
- A61B 2090/0818: {Redundant systems, e.g. using two independent measuring systems and comparing the signals}
- A61B: DIAGNOSIS; SURGERY; IDENTIFICATION (usefulness limited to only animals A61D)
- 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})

## Abstract

A system comprises a robotic manipulator for control of motion of a medical tool. The robotic manipulator including a joint and a link connected to the joint. The link is configured to connect to the medical tool. A processing unit of the system is configured to receive first data from an encoder of the joint. A first tool tip estimate of a first parameter of a tool tip coupled at a distal end of the medical tool is generated using the first data. The first parameter of the tool tip is a position or a velocity of the tool tip. Second data is received from a sensor system located at a sensor portion of the link or the medical tool. The joint is controlled based on a first difference between the first tool tip estimate and a second tool tip estimate generated using the first and second data.

## Claims

### Claim at position 1

1-21. (canceled)

### Claim 22

A system comprising:
a robotic manipulator configured for control of motion of a tool, the robotic manipulator including a joint and a link connected to the joint, wherein the link is configured to connect to a tool;
a processing unit including one or more processors, the processing unit configured to:
receive joint measurement data of the joint;
receive load side measurement data from a sensor system located at the link;
provide a dynamic model associated with dynamics between the sensor system and the tool;
generate a first estimate of a first parameter of the tool using the joint measurement data, the load side measurement data, and the dynamic model; and
control the joint based on the first estimate of the tool.

### Claim 23 (depends on 22)

The system of claim 22, wherein the sensor system is located at a sensor portion of the link; and
wherein the dynamic model is associated with dynamics between the sensor portion of the link and a tool tip of the tool.

### Claim 24 (depends on 23)

The system of claim 23, wherein the dynamic model is determined based on physical properties of the link and the tool.

### Claim 25 (depends on 23)

The system of claim 23, wherein the processing unit is configured to:
generate a fused state estimate of the first parameter of the tool using the joint measurement data and the load side measurement data;
generate, based on the dynamic model, a Cartesian transform from a world reference frame to a tool tip reference frame associated with the tool tip; and
generate the first estimate of the first parameter of the tool by applying the Cartesian transform to the fused state estimate.

### Claim 26 (depends on 22)

The system of claim 22, wherein to generate the first estimate, the processing unit is configured to:
generate a sensor portion estimate of a first parameter of a sensor portion of the link using the joint measurement data and load side measurement data, wherein the sensor system is located at the sensor portion of the link; and
generate the first estimate based on the sensor portion estimate and a dynamic model between the sensor portion and the tool.

### Claim 27 (depends on 26)

The system of claim 26, wherein the sensor portion estimate is generated using a state estimator algorithm selected from the group consisting of a Kalman filter, a particle filter, a nonlinear observer, and an alpha-beta-gamma filter.

### Claim 28 (depends on 22)

The system of claim 22, wherein the processing unit is further configured to:
generate a second estimate of a second parameter of the tool using the joint measurement data,
wherein the first parameter of the tool is one of a position and a velocity of the tool,
wherein the second parameter of the tool is the other of the position and the velocity of the tool;
generate a third estimate of the second parameter of the tool using the joint measurement data and load side measurement data; and
control the joint based on the first estimate and a first difference between the second estimate and the third estimate.

### Claim 29 (depends on 22)

The system of claim 22, wherein the joint measurement data includes data associated with at least one of a position and a velocity of the joint.

### Claim 30 (depends on 22)

The system of claim 22, wherein the load side measurement data includes translational acceleration data and angular velocity data.

### Claim 31 (depends on 22)

The system of claim 22, further comprising:
an actuation assembly coupled to the joint to drive motion of the joint;
wherein to control the joint based on the first estimate, the processing unit is configured to:
generate joint adjustment data based on the first estimate; and
generate a control signal based on the joint adjustment data for controlling the actuation assembly.

### Claim 32

A method comprising:
receiving joint measurement data of a joint of a robotic manipulator, the robotic manipulator including a link connected to the joint, wherein the link is configured to connect to a tool;
receiving load side measurement data from a sensor system located at the link;
providing a dynamic model associated with dynamics between the sensor system and a tool;
generating a first estimate of a first parameter of the tool using the joint measurement data, the load side measurement data, and the dynamic model; and
controlling the joint based on the first estimate of the tool.

### Claim 33 (depends on 32)

The method of claim 32, wherein the sensor system is located at a sensor portion of the link; and
wherein the dynamic model is associated with dynamics between the sensor portion of the link and a tool tip of the tool.

### Claim 34 (depends on 33)

The method of claim 33, wherein the dynamic model is determined based on physical properties of the link and the tool.

### Claim 35 (depends on 33)

The method of claim 33, further comprising:
generating a fused state estimate of the first parameter of the tool using the joint measurement data and the load side measurement data;
generating, based on the dynamic model, a Cartesian transform from a world reference frame to a tool tip reference frame associated with the tool tip; and
generating the first estimate of the first parameter of the tool by applying the Cartesian transform to the fused state estimate.

### Claim 36 (depends on 32)

The method of claim 32, further comprising:
generating a sensor portion estimate of a first parameter of a sensor portion of the link using the joint measurement data and load side measurement data, wherein the sensor system is located at the sensor portion of the link; and
generating the first estimate based on the sensor portion estimate and a dynamic model between the sensor portion and the tool.

### Claim 37 (depends on 36)

The method of claim 36, wherein the sensor portion estimate is generated using a state estimator algorithm selected from the group consisting of a Kalman filter, a particle filter, a nonlinear observer, and an alpha-beta-gamma filter.

### Claim 38 (depends on 32)

The method of claim 32, further comprising:
generating a second estimate of a second parameter of the tool using the joint measurement data,
wherein the first parameter of the tool is one of a position and a velocity of the tool,
wherein the second parameter of the tool is the other of the position and the velocity of the tool;
generating a third estimate of the second parameter of the tool using the joint measurement data and load side measurement data; and
controlling the joint based on the first estimate and a first difference between the second estimate and the third estimate.

### Claim 39 (depends on 32)

The method of claim 32, wherein the joint measurement data includes data associated with at least one of a position and a velocity of the joint.

### Claim 40 (depends on 32)

The method of claim 32, further comprising:
generating joint adjustment data based on the first estimate; and
generating a control signal based on the joint adjustment data for controlling an actuation assembly, wherein the actuation assembly is coupled to the joint to drive motion of the joint.

### Claim 41

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 one or more processors to perform a method comprising:
receiving joint measurement data of a joint of a robotic manipulator, wherein the robotic manipulator includes a link connected to the joint, wherein the link is configured to connect to a tool;
receiving load side measurement data from a sensor system located at the link;
provide a dynamic model is associated with dynamics between the sensor system and a tool;
generate a first estimate of a first parameter of the tool using the joint measurement data, the load side measurement data, and the dynamic model; and
control the joint based on the first estimate of the tool.
