# US 12,746,081 B2 · Robotic surgical system, control device of robotic surgical system, and control method of robotic surgical system

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

- Number: US 12,746,081 B2
- Document ID: US12746081B2
- Status: Granted
- Kind: B2
- Application number: 18/248,064
- Filed: 2021-09-02
- Published: 2023-08-31
- Granted: 2026-09-29
- Earliest claimed: 2020-10-09
- Assignees: Kawasaki Jukogyo Kabushiki Kaisha
- Applicants: Kawasaki Jukogyo Kabushiki Kaisha
- Inventors: Masataka Tanabe; Tetsuo Ichii; Ayataka Kobayashi; Yuichi Mizohata
- Web page: https://patentgrep.com/patent/US12746081B2

## CPC

- A61B 34/37: Leader-follower robots (A61B34/35 takes precedence)
- A61B 34/30: Surgical robots
- A61B 34/35: for telesurgery
- A61B 90/50: Supports for surgical instruments, e.g. articulated arms
- A61B 2034/742: {Joysticks}
- A61B: DIAGNOSIS; SURGERY; IDENTIFICATION (usefulness limited to only animals A61D)

## Abstract

A robotic surgical system includes a controller configured or programmed to limit a speed command value within a range of a speed limit value, and limit an acceleration command value within a range of an acceleration limit value.

## Claims

### Claim 1

A robotic surgical system comprising:
a patient-side apparatus including a manipulator arm including a plurality of joints and a corresponding plurality of axes, and having a tip end side to which a surgical instrument is attached;
an operator-side apparatus including an operation unit to receive an operation on the surgical instrument; and
a controller configured or programmed to perform operations comprising operations to calculate, for each axis of the plurality of axes corresponding to the plurality of joints, a speed command value and an acceleration command value to operate the surgical instrument based on the received operation, and control operation of the surgical instrument based on the speed command value and the acceleration command value; wherein the controller is configured or programmed to perform operations further comprising operations to:
for each axis of the plurality of axes corresponding to the plurality of joints:
limit the speed command value to a limited speed command value within a range of speed limit values;
limit the acceleration command value to a limited acceleration command value within a range of acceleration limit values;
determine a speed excess ratio corresponding to a ratio between the calculated speed command value and the limited speed command value; and
determine an acceleration excess ratio corresponding to a ratio between the calculated acceleration command value and the limited acceleration command value;
determine a maximum speed excess ratio among the plurality of axes;
determine a maximum acceleration excess ratio among the plurality of axes;
limit the speed command values for remaining axes of the plurality of axes to the largest limited speed command value corresponding to the axis of the plurality of axes having the maximum speed excess ratio by dividing the speed command values for each of the remaining axes of the plurality of axes by the speed excess ratio;
limit the acceleration command values for remaining axes of the plurality of axes to the acceleration command value corresponding to the axis of the plurality of axes having the maximum acceleration excess ratio by dividing the acceleration command values for each the remaining axes of the plurality of axes by the acceleration excess ratio; and
the speed command values and the acceleration command values are limited, for each of the axes of the plurality of axes, to the speed command value corresponding to the axis of the plurality of axes having the maximum speed excess ratio, and the acceleration command value corresponding to the axis of the plurality of axes having the maximum acceleration excess ratio such that the amount of movement of the manipulator arm per unit time is reduced.

### Claim 2 (depends on 1)

The robotic surgical system according to claim 1, wherein the controller is configured or programmed to perform operations comprising operations to:
calculate an operation command value based on the largest limited speed command value limited within the range of the speed limit value and based on the largest limited acceleration command value limited within the range of the acceleration limit value; and
calculate a correction command value to correct a deviation of a pivot position that serves as a fulcrum for rotational movement of the surgical instrument based on the calculated operation command value.

### Claim 3 (depends on 2)

The robotic surgical system according to claim 2, wherein the controller is configured or programmed to perform operations comprising operations to add the correction command value to the speed command value before being limited within the range of the speed limit value.

### Claim 4 (depends on 2)

The robotic surgical system according to claim 2, wherein the controller is configured or programmed to perform operations comprising operations to:
feed back the calculated operation command value;
calculate a post-inverse-kinematics-conversion command value by performing conversion using inverse kinematics on the fed-back operation command value; and
calculate the correction command value based on the post-inverse-kinematics-conversion command value.

### Claim 5 (depends on 4)

The robotic surgical system according to claim 4, wherein
the operation unit receives an input position command value for the surgical instrument; and
the controller is configured or programmed to perform operations comprising operations to:
feed back the calculated operation command value;
calculate a post-forward-kinematics-conversion command value by performing conversion using forward kinematics on the fed-back operation command value;
calculate the post-inverse-kinematics-conversion command value by performing the conversion using the inverse kinematics on the input position command value and the post-forward-kinematics-conversion command value; and
calculate the correction command value based on the operation command value and the post-inverse-kinematics-conversion command value.

### Claim 6 (depends on 4)

The robotic surgical system according to claim 4, wherein the controller is configured or programmed to perform operations comprising operations to:
multiply the calculated speed command value by a gain of a feedforward control; and
set the gain of the feedforward control based on a difference between a target value, which is a value of a target position for movement of the surgical instrument, and a current value, which is a value of a current position of the surgical instrument, so as to increase a contribution of a feedback control relative to a contribution of the feedforward control to the speed command value.

### Claim 7 (depends on 6)

The robotic surgical system according to claim 6, wherein the gain decreases as the difference between the target value and the current value increases.

### Claim 8 (depends on 7)

The robotic surgical system according to claim 7, wherein the gain linearly decreases as the difference between the target value and the current value increases.

### Claim 9

A control device of a robotic surgical system, the robotic surgical system including a patient-side apparatus including a manipulator arm including a plurality of joints and a corresponding plurality of axes, and having a tip end side to which a surgical instrument is attached, and an operator-side apparatus including an operation unit to receive an operation on the surgical instrument, the control device comprising:
a controller configured or programmed to perform operations comprising operations to calculate, for each axis of the plurality of axes corresponding to the plurality of joints, a speed command value and an acceleration command value to operate the surgical instrument based on the received operation, and control operation of the surgical instrument based on the speed command value and the acceleration command value; wherein
the controller is configured or programmed to perform operations further comprising operations to:
for each axis of the plurality of axes corresponding to the plurality of joints:
limit the speed command value to a limited speed command value within a range of speed limit values; and
limit the acceleration command value to a limited acceleration command value within a range of acceleration limit values;
determine a speed excess ratio corresponding to a ratio between the calculated speed command value and the limited speed command value; and
determine an acceleration excess ratio corresponding to a ratio between the calculated acceleration command value and the limited acceleration command value;
determine a maximum speed excess ratio among the plurality of axes;
determine a maximum acceleration excess ratio among the plurality of axes;
limit the speed command values for remaining axes of the plurality of axes to the speed command value corresponding to the axis of the plurality of axes having the maximum speed excess ratio by dividing the speed command values for each of the remaining axes of the plurality of axes by the speed excess ratio;
limit the acceleration command values for remaining axes of the plurality of axes to the acceleration command value corresponding to the axis of the plurality of axes having the maximum acceleration excess ratio by dividing the acceleration command values for each of the remaining axes of the plurality of axes by the acceleration excess ratio; and
the speed command values and the acceleration command values are limited, for each of the axes of the plurality of axes, to the speed command value corresponding to the axis of the plurality of axes having the maximum speed excess ratio, and the acceleration command value corresponding to the axis of the plurality of axes having the maximum acceleration excess ratio such that the amount of movement of the manipulator arm per unit time is reduced.

### Claim 10

A control method of a robotic surgical system, the robotic surgical system including a patient-side apparatus including a manipulator arm including a plurality of joints and a corresponding plurality of axes, and having a tip end side to which a surgical instrument is attached, and an operator-side apparatus including an operation unit to receive an operation on the surgical instrument, the control method comprising:
receiving an operation on the surgical instrument; and
calculating, for each axis of the plurality of axes corresponding to the plurality of joints, a speed command value and an acceleration command value to operate the surgical instrument based on the received operation, and controlling operation of the surgical instrument based on the speed command value and the acceleration command value; wherein
the controlling the operation of the surgical instrument based on the speed command value and the acceleration command value includes:
for each axis of the plurality of axes corresponding to the plurality of joints:
limiting the speed command value to a limited speed command value within a range of speed limit values; and
limiting the acceleration command value to a limited acceleration command value within a range of acceleration limit values;
determining a speed excess ratio corresponding to a ratio between the calculated speed command value and the limited speed command value; and
determining an acceleration excess ratio corresponding to a ratio between the calculated acceleration command value and the limited acceleration command value;
determining a maximum speed excess ratio among the plurality of axes;
determining a maximum acceleration excess ratio among the plurality of axes;
limiting the speed command values for remaining axes of the plurality of axes to the speed command value corresponding to the axis of the plurality of axes having the maximum speed excess ratio by dividing the speed command values for each of the remaining axes of the plurality of axes by the speed excess ratio;
limiting the acceleration command values for remaining axes of the plurality of axes to the acceleration command value corresponding to the axis of the plurality of axes having the maximum acceleration excess ratio by dividing the acceleration command values for each of the remaining axes of the plurality of axes by the acceleration excess ratio; and
the speed command values and the acceleration command values are limited, for each of the axes of the plurality of axes, to the speed command value corresponding to the axis of the plurality of axes having the maximum speed excess ratio, and the acceleration command value corresponding to the axis of the plurality of axes having the maximum acceleration excess ratio such that the amount of movement of the manipulator arm per unit time is reduced.
