Robotic surgical system, control device of robotic surgical system, and control method of robotic surgical system
AssigneeKawasaki Jukogyo Kabushiki Kaisha
InventorsMasataka Tanabe, Tetsuo Ichii, Ayataka Kobayashi, Yuichi Mizohata
Life of this patent
Estimating the term…
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.
Claims10
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.
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.
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.
Dependencies are inferred from the claim text.