IP Library Granted Patent US 11,850,014
Granted Patent B2
US 11,850,014 · App. 17/830,350 · Granted Dec 26, 2023

Control system, control method, and surgical arm system

Inventors: Yasuhiro Matsuda (Tokyo, JP); Jun Arai (Kanagawa, JP); Takara Kasai (Kanagawa, JP); Yohei Kuroda (Tokyo, JP); Wataru Kokubo (Tokyo, JP)
Assignee: SONY GROUP CORPORATION
A61B34/37B25J9/0096B25J9/1633A61B90/50A61B2034/2059A61G13/04
View Patent ↗
Loading inventors, assignments & file history…
Monitor This Case
Get email alerts when status or documents change.
Order Certified Copies
Most orders are placed with the USPTO same day — all within 24 business hours.
Order via The Patent Place →
Pre-filled with this patent's details
Quick Facts
Patent No.
US 11,850,014
App. No.
17/830,350
Granted
Dec 26, 2023
Kind
B2
Abstract

There is provided a control system for controlling a surgical arm device of a multi-link structure in which a plurality of links is coupled together by a joint unit in a force control mode. In generalized inverse dynamics, the control system sets a motion purpose and a constraint condition in an operation space describing an inertia of force acting on a multi-link structural body and an acceleration of the multi-link structural body, and for implementing an operation space acceleration indicating the motion purpose, calculates a virtual force acting on the operation space on the basis of a motion equation relating to the operation space including a term of an operation space bias acceleration in consideration to gravity compensation according to inclination information of the surgical arm device, and calculates a torque command value for a joint unit on the basis of a real force converted from the virtual force.

Claims (41)

1. A control system, comprising:

processing circuitry configured to

acquire inclination information of a device;

set a computational condition including gravity compensation in a direction set according to the inclination information;

calculate a command value to control the device according to the computational condition; and

control the device according to the command value.

2. The control system according to claim 1 , wherein the inclination information is angle information.

3. The control system according to claim 1 , wherein the processing circuitry is configured to acquire information regarding an inclination angle of a support surface of a table.

4. The control system according to claim 1 , wherein

the device includes a multi-link structural body in which a plurality of links is coupled together by a joint,

the processing circuitry is configured to set a motion purpose and a constraint condition of the multi-link structural body in an operation space describing inertia of force acting on the multi-link structural body and acceleration of the multi-link structural body in generalized inverse dynamics, and

the processing circuitry is configured to calculate a virtual force that acts on the operation space to implement the operation space acceleration indicating the motion purpose, on a basis of a motion equation relating to the operation space including a term of an operation space bias acceleration in consideration to the gravity compensation according to the inclination information, converts the virtual force to a real force in consideration to the constraint condition, and calculate a torque command value for driving the joint on a basis of the real force.

5. The control system according to claim 4 , wherein the processing circuitry is configured to make a further correction to the real force such that the joint does not deviate from a logical response model.

6. The control system according to claim 5 , wherein the processing circuitry is configured to correct a torque target value calculated on a basis of the logical response model according to the real force and external torque acting on the joint by using disturbance torque of the joint to calculate the torque command value.

7. The control system according to claim 6 , wherein the processing circuitry is configured to estimate torque acting on the joint from an angular velocity of the joint, and estimate the disturbance torque on a basis of a difference between the estimated torque and the torque command value.

8. The control system according to claim 1 , wherein the device is a multi-link structural body in which a plurality of links is coupled by a joint.

9. The control system according to claim 8 , wherein the device is an arm device.

10. The control system according to claim 1 , wherein the processing circuitry is configured to calculate a correct direction of gravity force based on the inclination information.

11. The control system according to claim 10 , wherein the processing circuitry is configured to set the computational condition including the gravity compensation that compensates for the gravity force in the calculated correct direction of the gravity force.

12. The control system according to claim 1 , wherein the processing circuitry is configured to acquire the inclination information of the device, the inclination information resulting from inclination of a fixture to which the device is attached.

13. The control system according to claim 12 , wherein the fixture is a table to which the device is attached.

14. A control method, comprising:

acquiring inclination information of a device;

setting, using processing circuitry, a computational condition including gravity compensation in a direction set according to the inclination information;

calculating, using the processing circuitry, a command value to control the device according to the computational condition; and

controlling the device according to the command value.

15. A control system comprising:

a device; and

processing circuitry configured to

acquire inclination information of the device,

set a computational condition including gravity compensation in a direction set according to the inclination information,

acquire a state of the device,

calculate a command value to control the device according to the computational condition and the state of the device, and

control driving of the device according to the calculated command value.

16. The control system according to claim 15 , wherein the device is a multi-link structural body in which a plurality of links is coupled by a joint.

17. The control system according to claim 16 , wherein the device is an arm device.

18. The control system according to claim 15 , wherein the processing circuitry is configured to calculate a correct direction of gravity force based on the inclination information.

19. The control system according to claim 18 , wherein the processing circuitry is configured to set the computational condition including the gravity compensation that compensates for the gravity force in the calculated correct direction of the gravity force.

20. The control system according to claim 15 , wherein

the processing circuitry is configured to acquire the inclination information of the device, the inclination information resulting from inclination of a fixture to which the device is attached, and

the fixture is an operating table to which the device is attached.

Assignments (1)
CHANGE OF NAME Recorded Jun 2, 2022
From: SONY CORPORATION
To: SONY GROUP CORPORATION
Reel/Frame 060254/0336 →
Priority Claims (1)
JP 2017-035965 · Feb 28, 2017 · national
Continuity (2)
Continuation 16484467
Related Publication 20220287787A1 · Sep 15, 2022