# US 2022/0015846 A1 · Method and system for preventing collision between mechanical arms, and medical robot

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

- Number: US 2022/0015846 A1
- Document ID: US20220015846A1
- Status: Published application
- Kind: A1
- Application number: 17/299,627
- Filed: 2019-11-18
- Published: 2022-01-20
- Earliest claimed: 2018-12-04
- Assignees: Shanghai Microport Medbot (Group) Co., Ltd.
- Applicants: Shanghai Microport Medbot (Group) Co., Ltd.
- Inventors: Zihan LI; Jiayin WANG; Chao HE; Feijian NI; Peng ZHANG; Yuhui XIA
- Web page: https://patentgrep.com/patent/US20220015846A1

## CPC

- A61B 34/30: Surgical robots
- A61B 34/37: Leader-follower robots (A61B34/35 takes precedence)
- A61B 34/70: {Manipulators specially adapted for use in surgery}
- A61B 34/76: {Manipulators having means for providing feel, e.g. force or tactile feedback}
- A61B 90/03: {Automatic limiting or abutting means, e.g. for safety}
- B25J 9/0084: {comprising a plurality of manipulators}
- B25J 9/023: {Cartesian coordinate type}
- B25J 9/1607: {Calculation of inertia, jacobian matrixes and inverses}
- B25J 9/1676: {Avoiding collision or forbidden zones}
- B25J 9/1689: {Teleoperation}
- G05B 9/02: electric
- A61B 2018/00297: {Means for providing haptic feedback}
- A61B 2018/00303: {active, e.g. with a motor creating vibrations}
- A61B 2018/1452: {including means for cutting (A61B2018/146 takes precedence)}
- A61B 2034/2059: {Mechanical position encoders}
- A61B 2034/302: {specifically adapted for manipulations within body cavities, e.g. within abdominal or thoracic cavities}
- A61B 2090/064: {for measuring force, pressure or mechanical tension}
- G05B 2219/39135: For multiple manipulators operating at same time, avoid collision
- G05B 2219/39322: Force and position control
- G05B 2219/40184: Compliant teleoperation, operator controls motion, system controls contact, force
- G05B 2219/45123: Electrogoniometer, neuronavigator, medical robot used by surgeon to operate
- 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})
- 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 method and system for preventing a collision between mechanical arms (21), and a medical robot, belonging to the field of medical robot technology. The method includes: arranging (S10) discrete points (m, n) at a mechanical arm (21); acquiring (S40) an interaction force (Fm,n) corresponding to each discrete point (m, n) according to a calculated relative distance (L) between the discrete points (m, n) respectively on different mechanical arms (21), to obtain (S50) a resultant force of the interaction forces (Fm,n) each of which corresponds to each discrete point (m, n), and then obtaining a Cartesian force (Fd) corresponding to each mechanical arm (21), and making (S60) an operator perceive the Cartesian force (Fd) in real time, thereby effectively reducing the risk of interference and collision between the mechanical arms (21).

## Claims

### Claim 1

A method for preventing a collision between mechanical arms, applied to a medical robot, the medical robot comprising at least two mechanical arms, a mechanical arm of the at least two mechanical arms comprising a mechanical arm body, the mechanical arm body comprising a plurality of joints, the method comprising:
arranging a plurality of discrete points on each mechanical arm;
acquiring first coordinate information of each discrete point in a global coordinate system;
obtaining a first relative distance between two discrete points located on different mechanical arms according to the first coordinate information;
acquiring a first interaction force at each discrete point applied by each of discrete points on the other mechanical arm according to the first relative distance and a corresponding relationship between the first relative distance and the first interaction force; and
obtaining a Cartesian force of each mechanical arm according to a resultant force of first interaction forces each of which corresponds to each discrete point and each of discrete points on the other mechanical arm, and making the Cartesian force perceived by an operator.

### Claim 2 (depends on 1)

The method according to claim 1, wherein at least a part of the mechanical arms further comprises a medical instrument mounted on a distal end of the mechanical arm body, the arranging the plurality of discrete points on each mechanical arm comprises arranging the discrete points on a medical instrument and/or the mechanical arm body.

### Claim 3 (depends on 1)

The method according to claim 1, wherein the arranging the plurality of discrete points on each mechanical arm comprises:
acquiring first relative position information of a discrete point with respect to a corresponding joint.

### Claim 4 (depends on 3)

The method according to claim 3, wherein the mechanical arm further comprises a position sensor configured to acquire joint position information, the acquiring the first coordinate information of each discrete point in the global coordinate system comprises:
obtaining the joint position information of the joint by the position sensor, and obtaining second coordinate information of each joint in the global coordinate system according to the joint position information and a kinematic model; and
obtaining the first coordinate information of the discrete point in the global coordinate system according to the second coordinate information and the first relative position information.

### Claim 5 (depends on 1)

The method according to claim 1, wherein the acquiring the first interaction force corresponding to each discrete point and each of discrete points on the other mechanical arm according to the first relative distance and the corresponding relationship between the first relative distance and the first interaction force comprises:
setting a plurality of distance intervals in a value range of the first relative distance, wherein the corresponding relationship corresponding to at least one of the distance intervals is different from corresponding relationships corresponding to other distance intervals; and
obtaining the first interaction force corresponding to each discrete point and each of discrete points on the other mechanical arm according to the first relative distance between the discrete points and the corresponding relationship corresponding to a distance interval which the first relative distance is in.

### Claim 6 (depends on 5)

The method according to claim 5, wherein
the plurality of distance intervals includes a first distance interval (0, Lmin+Rm+Rn], a second distance interval (Lmin+Rm+Rn, Lmax+Rm+Rn), and a third distance interval [Lmax+Rm+Rn, +∞); and
the first interaction force F is a preset maximum interaction force Fmax in the first distance interval (0, Lmin+Rm+Rn]; a relationship between the first interaction force and the first relative distance is a function in the second distance interval (Lmin+Rm+Rn, Lmax+Rm+Rn), the function is a continuous function in the second distance interval, a first derivative of the function is less than zero, and a second derivative of the function is greater than zero; the first interaction force F is equal to zero in the third distance interval [Lmax+Rm+Rn, +∞);
wherein discrete points m and n are two discrete points on different mechanical arms, Rm is a cross-sectional maximum radius of a mechanical arm at the discrete point m, with the discrete point m located on the mechanical arm; Rn is a cross-sectional maximum radius of a mechanical arm at the discrete point n, with the discrete point n located on the mechanical arm; Lmax is a preset collision warning distance of the first relative distance, and Lmin is a preset minimum safe distance of the first relative distance;
wherein the function is:
f
⁡
(
L
)
=
k
⁡
(
1
L
-
1
L
max
)
⁢
(
1
L
2
)
⁢
L
′
,
k is a distance-force gain coefficient, L is the first relative distance, and L′ is a derivative of L with respect to time.

### Claim 7

(canceled)

### Claim 8 (depends on 3)

The method according to claim 3, wherein the arranging the plurality of discrete points on each mechanical arm further comprises:
acquiring a discrete point gain coefficient of each discrete point;
wherein the obtaining the Cartesian force of each mechanical arm according to the resultant force of the first interaction forces each of which corresponds to each discrete point and each of discrete points on the other mechanical arm comprises:
obtaining a resultant force of all first interaction forces corresponding to each discrete point;
obtaining a torque corresponding to each discrete point with respect to a corresponding joint according to the resultant force of all the first interaction forces corresponding to each discrete point and the first relative position information of each discrete point with respect to a corresponding joint, and obtaining a resultant torque corresponding to each joint according to a discrete point gain coefficient of each discrete point; and
obtaining the Cartesian force of the mechanical arm according to the resultant torque corresponding to each joint and a force Jacobian matrix of the mechanical arm.

### Claim 9 (depends on 1)

The method according to claim 1, wherein the making the Cartesian force perceived by the operator comprises:
displaying the Cartesian force by a display device.

### Claim 10 (depends on 1)

The method according to claim 1, wherein the mechanical arm is connected to a master manipulator configured to control a movement of the mechanical arm, the making the Cartesian force perceived by the operator comprises:
obtaining a Cartesian force of the master manipulator configured to control the movement of the mechanical arm according to the Cartesian force of the mechanical arm;
obtaining a torque corresponding to each joint of the master manipulator according to a force Jacobian matrix and the Cartesian force of the master manipulator; and
causing a motor configured to control a movement of a joint of the master manipulator to correspondingly output a resistance torque having a same magnitude as but an opposite direction to the torque corresponding to each joint of the master manipulator.

### Claim 11

A system for preventing a collision between mechanical arms, applied to a medical robot, the medical robot comprising at least two mechanical arms, a mechanical arm comprising a mechanical arm body, the mechanical arm body comprising a plurality of joints, the system comprising:
a discrete point arranging unit configured to arrange a discrete point on the mechanical arm;
a memory configured to store instructions;
a processor in communication with the discrete point arranging unit and the memory, respectively;
wherein the instructions stored in the memory, when executed by the processor, perform the steps of:
acquiring first coordinate information of each discrete point in a global coordinate system;
obtaining a first relative distance between two discrete points on different mechanical arms according to the first coordinate information;
acquiring a first interaction force at each discrete point applied by each of discrete points on the other mechanical arm according to the first relative distance and a corresponding relationship between the first relative distance and the first interaction force; and
obtaining a Cartesian force of each mechanical arm according to a resultant force of first interaction forces each of which corresponds to each discrete point and each of discrete points on the other mechanical arm, and making the Cartesian force perceived by an operator.

### Claim 12 (depends on 11)

The system according to claim 11, wherein at least a part of the mechanical arms further comprises a medical instrument mounted on a distal end of the mechanical arm body, and the discrete point is arranged on the medical instrument and/or the mechanical arm body.

### Claim 13 (depends on 11)

The system according to claim 11, wherein,
the mechanical arm further comprises a position sensor configured to acquire joint position information, the position sensor being in communication with the processor;
the discrete point arranging unit is further configured to acquire first relative position information of the discrete point with respect to a corresponding joint;
the instructions stored on the memory, when executed by the processor, further perform the steps of:
acquiring, by the position sensor, joint position information of the joint, and acquiring second coordinate information of each joint in the global coordinate system according to the joint position information and a kinematic model; and
acquiring the first coordinate information of each discrete point in the global coordinate system according to the second coordinate information of each joint in the global coordinate system and the first relative position information.

### Claim 14 (depends on 11)

The system according to claim 11, wherein,
the corresponding relationship between the first relative distance and the first interaction force is pre-stored in the memory;
or,
the system further comprises an input device configured to acquire the corresponding relationship between the first relative distance and the first interaction force during a surgery, to directly be executed by the processor or stored in the memory.

### Claim 15 (depends on 11)

The system according to claim 11, wherein a value range of the first relative distance includes a plurality of distance intervals, and the corresponding relationship corresponding to at least one of the distance intervals is different from corresponding relationships corresponding to other distance intervals;
wherein the instructions stored on the memory, when executed by the processor, further perform the steps of:
obtaining a first interaction force corresponding to each discrete point and each of discrete points on the other mechanical arm according to the first relative distance of each discrete point and a corresponding relationship corresponding to a distance interval which the first relative distance is in.

### Claim 16 (depends on 15)

The system according to claim 15, wherein
the preset plurality of distance intervals comprise a first distance interval (0, Lmin+Rm+Rn], a second distance interval (Lmin+Rm+Rn, Lmax+Rm+Rn), and a third distance interval [Lmax+Rn+Rn, +∞); and
the first interaction force F is a preset maximum interaction force Fmax in the first distance interval (0, Lmin+Rm+Rn]; a relationship between the first interaction force and the first relative distance is a function in the second distance interval (Lmin+Rm+Rn, Lmax+Rm+Rn), the function is a continuous function in the second distance interval, and a first derivative of the function is less than zero, and a second derivative of the function is greater than zero; the first interaction force F is zero in the third distance interval [Lmax+Rm+Rn, +∞);
wherein discrete points m and n are two discrete points on different mechanical arms, Rm is a cross-sectional maximum radius of a mechanical arm at the discrete point m, with the discrete point m located on the mechanical arm; Rn is a cross-sectional maximum radius of a mechanical arm at the discrete point n, with the discrete point n located on the mechanical arm; Lmax is a preset collision warning distance of the first relative distance, and Lmin is a preset minimum safe distance of the first relative distance;
wherein the function is:
f
⁡
(
L
)
=
k
⁡
(
1
L
-
1
L
max
)
⁢
(
1
L
2
)
⁢
L
′
,
k is a distance-force gain coefficient, L is the first relative distance, and L′ is a derivative of L with respect to time.

### Claim 17

(canceled)

### Claim 18 (depends on 11)

The system according to claim 11, wherein the discrete point arranging unit is further configured to obtain a discrete point gain coefficient of each discrete point;
the instructions stored in the memory, when executed by the processor, further perform steps of:
obtaining a resultant force of first interaction forces each of which corresponds to each discrete point and each of discrete points on the other mechanical arm;
obtaining a torque corresponding to each discrete point with respect to a corresponding joint according to the resultant force of the first interaction forces corresponding to each discrete point and the first relative position information of each discrete point with respect to a corresponding joint, and obtaining a resultant torque corresponding to each joint according to the torque corresponding to the discrete point with respect to the corresponding joint and the discrete point gain coefficient of each discrete point; and
obtaining a Cartesian force of the mechanical arm according to the resultant torque corresponding to each joint and a force Jacobian matrix of the mechanical arm.

### Claim 19 (depends on 11)

The system according to claim 11, further comprising an alarm connected to the processor, wherein the instructions stored on the memory, when executed by the processor, further perform steps of:
when a first relative distance of any discrete point on the mechanical arm is less than or equal to a preset warning distance, and/or when the Cartesian force of the mechanical arm is greater than a preset force threshold, triggering the alarm to send out a warning message.

### Claim 20 (depends on 11)

The system according to claim 11, further comprising:
a display device, wherein the processor is further configured to display the Cartesian force through the display device.

### Claim 21 (depends on 11)

A medical robot, comprising:
at least two mechanical arms, a mechanical arm comprising a mechanical arm body, the mechanical arm body comprising a plurality of joints; and
the system for preventing the collision between mechanical arms according to claim 11.

### Claim 22 (depends on 21)

The medical robot according to claim 21, further comprising a physician side, a patient side, and a control end;
wherein the physician side, the patient side, and the system for preventing the collision between mechanical arms are respectively in communication with the control end; the mechanical arm is located at the patient side; the physician side comprises a master manipulator, the master manipulator comprises a plurality of joints and a motor driving the joint to move, the master manipulator is configured to control a movement of the mechanical arm; the control end is configured to set a Cartesian force of the master manipulator according to a Cartesian force of the mechanical arm obtained from the system for preventing the collision between the mechanical arms; and
the control end is further configured to obtain a torque corresponding to each joint of the master manipulator according to the Cartesian force and a force Jacobian matrix of the master manipulator, and control the motor to output a resistance torque having a same magnitude as but an opposite direction to the torque, to make the Cartesian force of the mechanical arm perceived by an operator.
