# US 2026/0131450 A1 · Method and apparatus for controlling master-slave arm robot

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

- Number: US 2026/0131450 A1
- Document ID: US20260131450A1
- Status: Published application
- Kind: A1
- Application number: 18/995,293
- Filed: 2023-02-27
- Published: 2026-05-14
- Earliest claimed: 2022-07-29
- Assignees: Innolcon Medical Technology (Suzhou) Co., Ltd.
- Applicants: Innolcon Medical Technology (Suzhou) Co., Ltd.
- Inventors: Yi Sun; Pengfei Zhong; Wei Luo
- Web page: https://patentgrep.com/patent/US20260131450A1

## CPC

- B25J 3/04: involving servo mechanisms (servo-actuated heads B25J15/02)
- B25J 9/1628: {characterised by the control loop}
- B25J 9/1689: {Teleoperation}
- A61B 34/37: Leader-follower robots (A61B34/35 takes precedence)
- G05B 2219/1215: Leader-follower system
- G05B 2219/2231: Leader-follower
- 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})
- A61B: DIAGNOSIS; SURGERY; IDENTIFICATION (usefulness limited to only animals A61D)
- 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

Embodiments of the present application provide a control method and device of a master-slave-manipulator robot. The method includes: after acquiring a mapped position and a starting motion parameter of the slave-manipulator motor for the current cycle, performing planning on a motion trajectory of the slave-manipulator motor for the current cycle and acquiring a maximum planning distance, and finally determining a value that may be prioritized among the mapped motion distance and the maximum planning distance as an actual distance that the slave-manipulator motor needs to move for the current cycle. In this way, it is possible to avoid the problem of an error warning of the motor due to exceeding of a limit of the slave-manipulator motor caused by the master manipulator being directly mapped to the slave-manipulator motor, so that an excessive acceleration and velocity during motion of the master manipulator motion may be decreased to an acceptable level of the slave-manipulator motor while it is ensured that the overall trajectory remains substantially unchanged, thus prolonging a service life of the slave-manipulator motor.

## Claims

### Claim 1

A control method of a master-slave-manipulator robot, characterized in that at least one slave-manipulator motor is provided on a slave manipulator of the master-slave-manipulator robot, and the method is used for controlling motion of the slave-manipulator motor and comprises:
acquiring a mapped position of the slave-manipulator motor for a current cycle, wherein the mapped position is used for indicating a number of mapped rotational pulses, which is acquired by direct mapping based on three-dimensional coordinates of a master manipulator of the master-slave-manipulator robot and a mechanical structure of the master-slave-manipulator robot, the three-dimensional coordinates of the master manipulator being acquired at a preset acquisition cycle, and the current cycle being any acquisition cycle;
acquiring a starting motion parameter of the slave-manipulator motor for the current cycle, the starting motion parameter comprising a starting velocity Vs and a starting acceleration As;
performing planning on a motion trajectory of the slave-manipulator motor for the current cycle based on the starting motion parameter;
acquiring a maximum planning distance Pcm of the slave-manipulator motor for the current cycle;
determining, as a target distance, a value that is able to be reached preferentially among a mapped motion distance and the maximum planning distance Pcm, from an actual position of the slave-manipulator motor for a previous cycle based on the starting motion parameter, wherein the mapped motion distance is a difference between the mapped position of the slave-manipulator motor for the current cycle and the actual position of the slave-manipulator motor for the previous cycle, the actual position being used for indicating a number of actual rotational pulses, and the previous cycle being a previous-one acquisition cycle of the current cycle; and
determining, as an actual position of the slave-manipulator motor for the current cycle, a sum of the actual position of the slave-manipulator motor for a previous cycle and the target distance.

### Claim 2 (depends on 1)

The method according to claim 1, characterized by further comprising:
determining actual three-dimensional coordinates of the slave manipulator for the current cycle based on the actual position of the slave-manipulator motor for the current cycle;
detecting whether the actual three-dimensional coordinates are beyond maximal coordinates of the slave manipulator; and
if the actual three-dimensional coordinates are not beyond the maximal coordinates of the slave manipulator, controlling the slave-manipulator motor to move to the actual position for the current cycle.

### Claim 3 (depends on 2)

The method according to claim 2, characterized by further comprising:
if the actual three-dimensional coordinates are beyond the maximal coordinates of the slave manipulator, acquiring a corrected position of the slave-manipulator motor for the current cycle based on the maximal coordinates of the slave manipulator; and
controlling the slave-manipulator motor to move to a corrected position for the current cycle.

### Claim 4 (depends on 2)

The method according to claim 2. characterized by further comprising: before controlling the slave-manipulator motor to move,
if multi-axis motions of respective ones of the slave manipulators of the master-slave-manipulator robot are not synchronized for the current cycle, acquiring target positions of the slave-manipulator motors on the respective ones of the slave manipulators by using an inverse kinematic solution method based on target three-dimensional coordinates of the respective ones of the slave manipulators for the current cycle and the mechanical structure of the master-slave-manipulator robot;
acquiring target three-dimensional coordinates of the master manipulator based on the target position of the slave-manipulator motor on each of the slave manipulators;
if the target three-dimensional coordinates of the master manipulator are beyond maximal coordinates of the master manipulator, correct the three-dimensional coordinates of the master manipulator for the current cycle to the maximal coordinates of the master manipulator; and
reacquiring, based on the maximal coordinates of the master manipulator, the mapped position of the slave-manipulator motor for the current cycle until the actual position of the slave-manipulator motor for the current cycle is re-determined.

### Claim 5 (depends on 4)

The method according to claim 4, characterized by further comprising:
if the target three-dimensional coordinates of the master manipulator are not beyond the maximal coordinates of the master manipulator, correcting the three-dimensional coordinates of the master manipulator for the current cycle to the target three-dimensional coordinates of the master manipulator; and
reacquiring, based on the target three-dimensional coordinates of the master manipulator, the mapped position of the slave-manipulator motor for the current cycle until the actual position of the slave-manipulator motor for the current cycle is re-determined.

### Claim 6 (depends on 1)

The method according to claim 1, characterized in that the acquiring a starting motion parameter of the slave-manipulator motor for the current cycle comprises:
acquiring actual positions of the slave-manipulator motor for three acquisition cycles previous to the current cycle, respectively; and
determining the starting velocity Vs and the starting acceleration As based on the actual positions of the slave-manipulator motor for the three acquisition cycles previous to the current cycle.

### Claim 7 (depends on 6)

The method according to claim 6, characterized in that the determining the starting velocity Vs and the starting acceleration As based on the actual positions of the slave-manipulator motor for the three acquisition cycles previous to the current cycle comprises:
determining a first average velocity of the slave-manipulator motor for the previous cycle based on a difference between a first actual position and a second actual position and a duration of the acquisition cycle, the first actual position being an actual position of the slave-manipulator motor for the previous cycle, and the second actual position being an actual position of the slave-manipulator motor for the previous-one acquisition cycle of the previous cycle;
determining a second average velocity of the slave-manipulator motor for the previous-one acquisition cycle of the previous cycle based on a difference between the second actual position and a third actual position and the duration of the acquisition cycle, the third actual position being an actual position of the slave-manipulator motor for a third acquisition cycle previous to the current cycle;
determining an average acceleration based on the second average velocity, the first average velocity and the duration of the acquisition cycle; and
determining the first average velocity as the starting velocity Vs, and determining the average acceleration as the starting acceleration As.

### Claim 8 (depends on 1)

The method according to claim 1, characterized by further comprising: before performing planning on a motion trajectory of the slave-manipulator motor for the current cycle based on the starting motion parameter,
determining a first motion direction of the slave-manipulator motor for the current cycle based on a mapped position of the slave-manipulator motor for the current cycle and an actual position of the slave-manipulator motor for the previous cycle;
determining a second motion direction of the slave-manipulator motor for the previous cycle based on the actual position of the slave-manipulator motor for the previous cycle and the actual position of the slave-manipulator motor for a previous-one acquisition cycle of the previous cycle; and
detecting whether the first motion direction is the same as the second motion direction.

### Claim 9 (depends on 8)

The method according to claim 8, characterized in that, when the first motion direction is the same as the second motion direction, the performing planning on a motion trajectory of the slave-manipulator motor for the current cycle based on the starting motion parameter comprises:
detecting whether the starting velocity Vs is equal to the maximal velocity Vm of the slave-manipulator motor, and
if the starting velocity Vs is equal to the maximal velocity Vm, performing planning on the motion trajectory of the slave-manipulator motor for the current cycle to move uniformly motion at the maximal velocity Vm until ending of the current cycle.

### Claim 10 (depends on 9)

The method according to claim 9, characterized by further comprising:
if the starting velocity Vs is less than the maximal velocity Vm, detecting whether the starting acceleration As is equal to the maximal acceleration Am;
if the starting acceleration As is equal to the maximal acceleration Am, determining a first duration required to accelerate uniformly to the maximal velocity Vm from the starting velocity Vs at the maximal acceleration Am; and
if the first duration is less than a duration of the current cycle, performing planning on the motion trajectory of the slave-manipulator motor for the current cycle to first accelerate uniformly to the maximal velocity Vm at the maximal acceleration Am, and then to move uniformly at the maximal velocity Vm for the remaining duration of the current cycle until the ending of the current cycle.

### Claim 11 (depends on 10)

The method according to claim 10, characterized by further comprising:
if the first duration is greater than the duration of the current cycle, performing planning on the motion trajectory of the slave-manipulator motor for the current cycle to accelerate uniformly from the starting velocity Vs at the maximal acceleration Am until the ending of the current cycle.

### Claim 12 (depends on 10)

The method according to claim 10, characterized by further comprising:
if the starting acceleration As is less than the maximal acceleration Am, determining a second duration required to accelerate to the maximal acceleration Am from the starting acceleration As at a first jerk;
if the second duration is less than the duration of the current cycle, acquiring an intermediate velocity at the ending of the second duration;
if the intermediate velocity is less than the maximal velocity Vm, determining a third duration required to accelerate uniformly to the maximal velocity Vm from the intermediate velocity at the maximal acceleration Am; and
if a sum of the second duration and the third duration is less than the duration of the current cycle, performing planning on the motion trajectory of the slave-manipulator motor for the current cycle to first accelerate to the maximal acceleration Am at the first jerk, then to accelerate uniformly to the maximal velocity Vm at the maximal acceleration Am, and finally to move uniformly at the maximal velocity Vm for the remaining duration of the current cycle until the ending of the current cycle.

### Claim 13 (depends on 12)

The method according to claim 12, characterized by further comprising:
if the sum of the second duration and the third duration is greater than the duration of the current cycle, performing planning on the motion trajectory of the slave-manipulator motor for the current cycle to first accelerate to the maximal acceleration Am from the starting acceleration As, and then to accelerate uniformly at the maximal acceleration Am for the remaining duration of the current cycle until the ending of the current cycle.

### Claim 14 (depends on 12)

The method according to claim 12, characterized by further comprising:
if the intermediate velocity is greater than the maximal velocity Vm, performing planning on the motion trajectory of the slave-manipulator motor for the current cycle to perform a uniform jerk to the maximal velocity Vm from the starting velocity Vs at the first jerk, and then to move uniformly at the maximal velocity Vm for the remaining duration of the current cycle until the ending of the current cycle.

### Claim 15 (depends on 12)

The method according to claim 12, characterized by further comprising:
if the second duration is greater than the duration of the current cycle, determining an end velocity to which a uniform jerk is performed from the starting velocity Vs at the first jerk until the ending of the current cycle; and
if the end velocity is less than the maximal velocity Vm, performing planning on the motion trajectory of the slave-manipulator motor for the current cycle to perform a uniform jerk from the starting velocity Vs at the first jerk until the ending of the current cycle.

### Claim 16 (depends on 15)

The method according to claim 15, characterized by further comprising:
if the end velocity is greater than the maximal velocity Vm, performing planning on the motion trajectory of the slave-manipulator motor for the current cycle to perform an uniform jerk to the maximal velocity Vm from the starting velocity Vs at the first jerk, and then to move uniformly at the maximal velocity Vm for the remaining duration of the current cycle until the ending of the current cycle.

### Claim 17 (depends on 9)

The method according to claim 9, characterized in that the acquiring a maximum planning distance Pcm of the slave-manipulator motor for the current cycle comprises:
determining, as the maximum planning distance Pcm of the slave-manipulator motor for the current cycle, a total motion distance traveled by the slave-manipulator motor for the current cycle.

### Claim 18 (depends on 8)

The method according to claim 8, characterized in that, when the first motion direction is opposite to the second motion direction, said the performing planning on a motion trajectory of the slave-manipulator motor for the current cycle based on the starting motion parameter comprises:
detecting, based on the starting motion parameter and a second jerk, whether the slave-manipulator motor is able to decelerate to zero from the starting velocity Vs for the current cycle;
if the slave-manipulator motor is able to decelerate to zero from the starting velocity Vs for the current cycle, acquiring an intermediate position and an intermediate acceleration of the slave-manipulator motor when the slave-manipulator motor decelerates to zero from the starting velocity Vs; and
performing planning on the motion trajectory of the slave-manipulator motor for the remaining duration of the current cycle based on the motion parameter of the slave-manipulator motor at the intermediate position and the remaining duration of the current cycle, wherein the slave-manipulator motor at the intermediate position has a starting velocity of zero and a starting acceleration as the intermediate acceleration.

### Claim 19 (depends on 18)

The method according to claim 18, characterized by further comprising:
if the slave-manipulator motor is not able to decelerate to zero from the starting velocity Vs for the current cycle, detecting whether the slave-manipulator motor is able to reach the maximum acceleration in a deceleration section for the current cycle; and
if the slave-manipulator motor is able to reach the maximum acceleration in the deceleration section for the current cycle, performing planning on the motion trajectory of the slave-manipulator motor for the current cycle to first decelerate to the maximum acceleration in the deceleration section at the second jerk, and then to move by a uniform deceleration for the remaining duration of the current cycle until the ending of the current cycle.

### Claim 20 (depends on 19)

The method according to claim 19, characterized by further comprising:
if the slave-manipulator motor is not able to reach the maximum acceleration in the deceleration section for the current cycle, performing planning on the motion trajectory of the slave-manipulator motor for the current cycle to move by a deceleration at the second jerk until the ending of the current cycle.

### Claim 21 (depends on 18)

The method according to claim 18, characterized in that the acquiring a maximum planning distance Pcm of the slave-manipulator motor for the current cycle comprises:
acquiring an end position of the slave-manipulator motor at the ending of the current cycle; and
determining, as the maximum planning distance Pcm of the slave-manipulator motor for the current cycle, a difference between the end position and the actual position of the slave-manipulator motor for the previous cycle.

### Claim 22

A control device of a master-slave-manipulator robot, characterized in that at least one slave-manipulator motor is provided on a slave manipulator of the master-slave-manipulator robot, the device is configured to control motion of the slave-manipulator motor and comprises:
a mapping position acquisition module configured for acquiring a mapping position of the slave-manipulator motor for a current cycle, wherein the mapping position is used for indicating a number of mapped rotational pulses, which is acquired by direct mapping based on three-dimensional coordinates of the master manipulator and a mechanical structure of the master-slave-manipulator robot, the three-dimensional coordinates of the master manipulator being acquired at a preset acquisition cycle, and the current cycle being any acquisition cycle;
a starting motion parameter acquisition module configured for acquiring a starting motion parameter of the slave-manipulator motor for the current cycle, the starting motion parameter comprising a starting velocity Vs and a starting acceleration As;
a motion planning module configured for performing planning on a motion trajectory of the slave-manipulator motor for the current cycle based on the starting motion parameter;
a maximum planning distance acquisition module configured for acquiring a maximum planning distance Pcm of the slave-manipulator motor for the current cycle;
a target distance determination module configured for determining, as a target distance, a value that is able to be reached preferentially among a mapped motion distance and the maximum planning distance Pcm, from an actual position of the slave-manipulator motor for a previous cycle based on the starting motion parameter, wherein the mapped motion distance is a difference between the mapped position of the slave-manipulator motor for the current cycle and the actual position of the slave-manipulator motor for the previous cycle, the actual position being used for indicating a number of actual rotational pulses, and the previous cycle being a previous-one acquisition cycle of the current cycle; and
an actual position determination module configured for determining, as an actual position of the slave-manipulator motor for the current cycle, a sum of the actual position of the slave-manipulator motor for a previous cycle and the target distance.
