Trajectory planning apparatus, trajectory planning method, and production system

1. A trajectory planning apparatus, comprising:

a memory;

an input/output device; and

a processor communicatively coupled to the memory and the processor, wherein the processor is configured to:

classify a plurality of joint axes of a robot into a plurality of different axis groups, according to joint axis classification information for classifying into a plurality of different axis groups including at least a path search axis group;

generates a plurality of path search axes based on trajectory start point information representing a posture of the robot at a start point of the planned trajectory and trajectory end point information representing a posture of the robot at an end point of the planned trajectory, the plurality of path search axes include a plurality of nodes;

calculate an angle of the joint axis classified into each axis group other than a path search axis at the first adjacent node;

set a first node of the plurality of nodes, the first nodes corresponding to the start point, and a second node of the plurality of nodes corresponding to the end point;

associate the first node with at least one of a plurality of adjacent nodes of the plurality of nodes;

select as a first adjacent node, one of the at least one of the plurality of adjacent nodes;

determine, for each of the at least one of the plurality of adjacent nodes, an angle of a direction adjustment axis at the first adjacent node;

determine, for each of the at least one of the plurality of adjacent nodes, a cost for moving the first node to the first adjacent node;

select as a low cost node a node with a lowest cost, from each of the at least one of the plurality of adjacent nodes; and

compare the low cost node with the second node, and when the low cost node and the second node are the same, output a path between the first node and the second node based on the low cost node.

2. The trajectory planning apparatus according to claim 1 , wherein

the processor calculates the angle of the joint axis classified as a direction adjustment axis group, based on direction constraint information about a tip of a robot arm.

3. The trajectory planning apparatus according to claim 2 , wherein

the processor calculates the angle of the joint axis classified as the direction adjustment axis group by using inverse kinematics based on direction constraint information.

4. The trajectory planning apparatus according to claim 1 , wherein the processor is further configured to

construct a robot model based on robot configuration information including at least information on the joint axis of the robot and three-dimensional model data representing a shape of the robot, and constructing an interference object model based on interference object configuration information including three-dimensional model data of the interference object and information indicating an installation position of the interference object;

determine whether or not the robot model interferes with the interference object model, and

determines the cost for moving the first node to the adjacent node for a path from only the at least one the plurality of adjacent nodes where the robot model does not interfere with the interference object model.

5. The trajectory planning apparatus according to claim 1 , wherein

the processor classifies the plurality of joint axes into the plurality of different axis groups based on an evaluation function, when there is no joint axis classification information.

6. The trajectory planning apparatus according to claim 5 , wherein

the processor refers to a table in which the evaluation function and a classification pattern of the joint axis correspond to each other when there is no joint axis classification information, and then classifies the plurality of joint axes into the plurality of different axis groups based on the evaluation function.

7. The trajectory planning apparatus according to claim 1 , wherein the processor is further configured to

convert a position and a direction of the tip of the robot arm included in the trajectory start point information and the trajectory end point information into an angle of the joint axis of the robot.

8. The trajectory planning apparatus of claim 1 , wherein

an evaluation function outputs at least one of a total change amount of all the joint axes of the robot, a movement amount of the tip of the robot arm, an operation time of the robot, an acceleration applied to the tip of the robot arm, and an inverse number of a distance between the robot and the interference object.

9. The trajectory planning apparatus according to claim 8 , wherein

the memory stores evaluation function information including the evaluation function selected by a user, and

the processor searches for a path that minimizes the evaluation function represented by the evaluation function information.

10. The trajectory planning apparatus according to claim 9 , wherein

when a plurality of evaluation functions are selected by the user, the processor searches for a path that minimizes a weighted sum of the plurality of selected evaluation functions.

11. A trajectory planning method using a trajectory planning apparatus, comprising:

a memory;

an input/output device; and

a processor communicatively coupled to the memory and the processor, wherein the method includes:

classifying a plurality of joint axes of a robot into a plurality of different axis groups, according to joint axis classification information for classifying into a plurality of different axis groups including at least a path search axis group;

generates a plurality of path search axes based on trajectory start point information representing a posture of the robot at a start point of the planned trajectory and trajectory end point information representing a posture of the robot at an end point of the planned trajectory, the plurality of path search axes include a plurality of nodes;

calculating an angle of the joint axis classified into each axis group other than a path search axis at the first adjacent node;

set a first node of the plurality of nodes, the first nodes corresponding to the start point, and a second node of the plurality of nodes corresponding to the end point;

associating the first node with at least one of a plurality of adjacent nodes of the plurality of nodes;

selecting as a first adjacent node, one of the at least one of the plurality of adjacent nodes;

determining, for each of the at least one of the plurality of adjacent nodes, an angle of a direction adjustment axis at the first adjacent node;

determining, for each of the at least one of the plurality of adjacent nodes, a cost for moving the first node to the first adjacent node;

selecting as a low cost node a node with a lowest cost, from each of the at least one of the plurality of adjacent nodes; and

comparing the low cost node with the second node, and when the low cost node and the second node are the same, output a path between the first node and the second node based on the low cost node.

12. A production system comprising:

an assembly sequence/line configuration planning device;

a trajectory planning apparatus; and

a work time calculation device, wherein

the assembly sequence/line configuration planning device prepares an assembly sequence of the product and a line configuration plan using a robot based on product design information including product design data and robot production capability information indicating a production capability of the robot, thus generating trajectory start point information, trajectory end point information, and work content information,

the trajectory planning apparatus includes:

a memory;

an input/output device; and

a processor communicatively coupled to the memory and the processor, wherein the processor is configured to:

classify a plurality of joint axes of the robot into a plurality of different axis groups, according to joint axis classification information for classifying into a plurality of different axis groups including at least a path search axis group;

generates a plurality of path search axes based on trajectory start point information representing a posture of the robot at a start point of the planned trajectory and trajectory end point information representing a posture of the robot at an end point of the planned trajectory, the plurality of path search axes include a plurality of nodes;

calculate an angle of the joint axis classified into each axis group other than a path search axis at the first adjacent node;

set a first node of the plurality of nodes, the first nodes corresponding to the start point, and a second node of the plurality of nodes corresponding to the end point;

associate the first node with at least one of a plurality of adjacent nodes of the plurality of nodes;

select as a first adjacent node, one of the at least one of the plurality of adjacent nodes;

determine, for each of the at least one of the plurality of adjacent nodes, an angle of a direction adjustment axis at the first adjacent node;

determine, for each of the at least one of the plurality of adjacent nodes, a cost for moving the first node to the first adjacent node;

select as a low cost node a node with a lowest cost, from each of the at least one of the plurality of adjacent nodes; and

compare the low cost node with the second node, and when the low cost node and the second node are the same, and output trajectory information including a chronological angle of each joint axis of the robot and representing a trajectory connecting the first node and the second node based on the low cost node,

the work time calculation device calculates the work time of the robot based on the work content information and the trajectory information, and the work time of the robot calculated by the work time calculation device is fed back to the assembly sequence/line configuration planning device as the robot production capability information.