# US 2022/0402132 A1 · Trajectory generating method, and trajectory generating apparatus

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

- Number: US 2022/0402132 A1
- Document ID: US20220402132A1
- Status: Published application
- Kind: A1
- Application number: 17/822,229
- Filed: 2022-08-25
- Published: 2022-12-22
- Earliest claimed: 2018-02-05
- Assignees: Canon Kabushiki Kaisha
- Applicants: Canon Kabushiki Kaisha
- Inventors: Gen Kimura
- Web page: https://patentgrep.com/patent/US20220402132A1

## CPC

- B25J 9/1664: {characterised by motion, path, trajectory planning}
- B25J 9/1666: {Avoiding collision or forbidden zones}
- B25J 9/0081: {with leader teach-in means}
- B25J 9/1651: {acceleration, rate control}
- B25J 9/1682: {Dual arm manipulator; Coordination of several manipulators}
- G05B 2219/39135: For multiple manipulators operating at same time, avoid collision
- G05B 2219/40428: Using rapidly exploring random trees algorithm RRT-algorithm
- G05B 2219/40463: Shortest distance in time, or metric, time optimal
- G05B 2219/40475: In presence of moving obstacles, dynamic environment
- G05B 2219/40477: Plan path independent from obstacles, then correction for obstacles
- 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 trajectory generating method includes a first generating process of generating a plurality of trajectories between a start teaching point and a target teaching point, an evaluation process of evaluating a motion of the robot arm on each trajectory to calculate an evaluation value of each trajectory, a selection process of selecting one of the plurality of trajectories based on calculated evaluation values, and an update process of updating the trajectory by repeating the processes of generating a plurality of new trajectories by changing a selected trajectory in the selection process, of calculating an evaluation value of a motion of the robot arm on each changed trajectory and of selecting a trajectory based on calculated evaluation values.

## Claims

### Claim at position 1

-22. (canceled)

### Claim 23

An information processing method configured to update a first trajectory to move a first robot between a first position and a second position, the information processing method comprising:
an update process of changing first time information of at least one position of the first position, the second position, and a first intermediate position through which the first robot is moved between the first position and the second position to update the first trajectory.

### Claim 24 (depends on 23)

The information processing method according to claim 23, wherein in the update process,
in a case where a second trajectory to move a second robot deferent from the first robot between a third position and a fourth position is acquired,
second time information of at least one position of the third position, the fourth position, and a second intermediate position through which the second robot is moved between the third position and the fourth position is changed to update the second trajectory.

### Claim 25 (depends on 24)

The information processing method according to claim 24, wherein
the first time information is a first halt time of the first robot, and
the second time information is a second halt time of the second robot.

### Claim 26 (depends on 25)

The information processing method according to claim 25, wherein
the first halt time is a time to maintain the first robot at a halt state in at least one position of the first position, the second position, and the first intermediate position, and
the second halt time is a time to maintain the second robot at a halt state in at least one position of the third position, the fourth position, and the second intermediate position.

### Claim 27 (depends on 24)

The information processing method according to claim 24, wherein in the update process,
the first trajectory is updated based on adding a first random number value to the first time information, and
the second trajectory is updated based on adding a second random number value to the second time information.

### Claim 28 (depends on 27)

The information processing method according to claim 27, wherein the first and second random number values are generated by using multivariate normal distribution.

### Claim 29 (depends on 27)

The information processing method according to claim 27, wherein
a range of the first random number value becomes narrower as a number of times of acquiring the first trajectory increases, and
a range of the second random number value becomes narrower as a number of times of acquiring the second trajectory increases.

### Claim 30 (depends on 27)

The information processing method according to claim 27, wherein
the first random number value is displacement magnitudes given in changing the first time information, and
the second random number value is displacement magnitudes given in changing the second time information.

### Claim 31 (depends on 24)

The information processing method according to claim 24, wherein in the update process,
in a condition where the first robot reaches at least one position of the first position, the second position, and the first intermediate position before the second robot reaches at least one position of the third position, the fourth position, and the second intermediate position,
the first trajectory and the second trajectory are updated.

### Claim 32 (depends on 24)

The information processing method according to claim 24, wherein in the update process,
in a condition where the first robot and the second robot do not interfere with each other, the first trajectory and the second trajectory are updated.

### Claim 33 (depends on 24)

The information processing method according to claim 24, further comprising:
an evaluation process of evaluating the updated first trajectory and the updated second trajectory based on a predetermined condition.

### Claim 34 (depends on 33)

The information processing method according to claim 33, wherein the predetermined condition is a magnitude of interference between the first robot, the second robot, and a peripheral object.

### Claim 35 (depends on 34)

The information processing method according to claim 34 wherein in the update process,
the first intermediate position, the second intermediate position, the first time information, and the second time information are changed so as to decrease the magnitude of interference.

### Claim 36 (depends on 35)

The information processing method according to claim 35, wherein in the update process,
in a case where the magnitude of interference is zeroed, changes of the first intermediate position, the second intermediate position, the first time information, and the second time information are stopped.

### Claim 37 (depends on 34)

The information processing method according to claim 34, wherein
the magnitude of interference is an interference time during which the first robot and the second robot, and/or the first robot and the peripheral object, and/or the second robot and the peripheral object are occupied the same space, or
the magnitude of interference is an interference distance between the first robot and the second robot, and/or the first robot and the peripheral object, and/or the second robot and the peripheral object.

### Claim 38 (depends on 33)

The information processing method according to claim 33, wherein the predetermined condition is a required time of moving of the first robot in the first trajectory and the second robot in the second trajectory.

### Claim 39 (depends on 38)

The information processing method according to claim 38, wherein in the update process,
the first intermediate position, the second intermediate position, the first time information, and the second time information are changed so as to shorten the required time.

### Claim 40 (depends on 39)

The information processing method according to claim 39, wherein in the update process,
in a case where the required time satisfies a predetermined reference, changes of the first intermediate position, the second intermediate position, the first time information, and the second time information are stopped.

### Claim 41 (depends on 40)

The information processing method according to claim 40, wherein the predetermined reference is in a case where the required time becomes a time determined as the shortest time.

### Claim 42 (depends on 35)

The information processing method according to claim 35, wherein in the update process,
variations of changes of the first intermediate position, the second intermediate position, the first time information, and the second time information become smaller as a number of times of the changes increases.

### Claim 43 (depends on 42)

The information processing method according to claim 42, wherein
in the update process, in a case where the number of times of the changes reaches a predetermined number, or
in the evaluation process, in a case where a number of times in which an evaluation value acquired based on evaluating in the evaluation process does not change continuously reaches a predetermined number,
the changes are stopped.

### Claim 44 (depends on 24)

The information processing method according to claim 24, wherein in the update process,
in updating the first trajectory and the second trajectory, the first position, the second position, the third position, the fourth position, the first intermediate position, and the second intermediate position are updated by curve interpolation.

### Claim 45 (depends on 44)

The information processing method according to claim 44, wherein the curve interpolation is at least one of Spline interpolation, B-Spline interpolation, and Bezier curve interpolation.

### Claim 46 (depends on 24)

The information processing method according to claim 24, wherein in the update process,
in acquiring the first trajectory and the second trajectory, the first trajectory and the second trajectory are acquired so as to satisfy at least one of a joint torque constraint, a joint angular speed constraint, a joint angular acceleration constraint, a jerk constraint, a hand speed constraint, and a hand acceleration constraint of the first robot and the second robot.

### Claim 47 (depends on 23)

The information processing method according to claim 23, further comprising:
a display process of displaying the updated first trajectory on a display portion.

### Claim 48 (depends on 23)

A non-transitory computer readable medium storing a control program rendering a controller execute a process of the information processing method as set forth in claim 23.

### Claim 49

An information processing apparatus for updating a first trajectory to move a first robot between a first position and a second position, the information processing apparatus comprising a controller executing:
an update process of changing first time information of at least one position of the first position, the second position, and a first intermediate position through which the first robot is moved between the first position and the second position to update the first trajectory.

### Claim 50 (depends on 49)

A robot system, comprising:
the first robot; and
the information processing apparatus as set forth in claim 49.

### Claim 51 (depends on 50)

A manufacturing method for manufacturing an article, using the robot system as set forth in claim 50.

### Claim 52

An information processing apparatus for updating a trajectory to move a robot between a first position and a second position, the information processing apparatus comprising a controller executing:
a set process, in a case where time information of at least one position of the first position, the second position, and an intermediate position through which the robot is moved between the first position and the second position is changed to update the trajectory, an initial value of the time information is set.

### Claim 53 (depends on 52)

The information processing apparatus according to claim 52, wherein a halt time of the robot is set as the time information.

### Claim 54 (depends on 53)

The information processing apparatus according to claim 53, wherein a time to maintain the robot at a halt state in at least one position of the first position, the second position, and the intermediate position is set as the halt time.

### Claim 55 (depends on 54)

The information processing apparatus according to claim 54, wherein a time to maintain the robot at the halt state in one position of the first position, the second position, and the intermediate position is set as the halt time.

### Claim 56 (depends on 52)

The information processing apparatus according to claim 52, wherein a method of changing the time information is set.

### Claim 57

An information processing method configured to update a trajectory to move a robot between a first position and a second position, the information processing method comprising:
a set process, in a case where time information of at least one position of the first position, the second position, and an intermediate position through which the robot is moved between the first position and the second position is changed to update the trajectory, an initial value of the time information is set.
