Control device, robot system, control method, and non-transitory computer-readable medium
A control device includes a target position setting part, a trajectory estimation part, and a target position selector. The target position setting part determines a target position of an actor of a robot based on a form of an object located in an operating environment of the robot. The trajectory estimation part estimates a predicted trajectory of the actor based on motion of the actor up to the present, and estimates a trajectory of the actor from a current position to the target position as an approach trajectory using a predetermined function. The target position selector selects one target position based on a degree of similarity between the predicted trajectory and each of the approach trajectory.
1. A control device, comprising:
a processor, configured to:
determine a plurality of target positions of an actor of a robot based on a form of an object located in an operating environment of the robot;
estimate a predicted trajectory of the actor based on motion of the actor up to the present, and estimating a trajectory of the actor from a current position respectively to each of the plurality of target positions as an approach trajectory using a predetermined function;
select one target position among the plurality of target positions based on a degree of similarity respectively between the predicted trajectory and each of the plurality of approach trajectories; and
control the actor of the robot to move toward the selected target position,
wherein with respect to the object having dimensions larger than predetermined dimensions, the processor further determines an intersection of a surface of the object and a line-of sight direction of an operator, classifies the intersection into a plurality of clusters, and determines a representative point of the distribution of the intersection of each of the plurality of clusters respectively as each of the plurality of target positions.
2. The control device according to claim 1 , wherein
the processor determines a shape of the object from an image indicating the operating environment, and, based on feature point data indicating an arrangement of feature points for each shape, determines positions of the feature points corresponding to the determined shape as the plurality of target positions.
3. The control device according to claim 2 , wherein
the processor rejects a target position, among the plurality of target positions, that interferes with another object.
4. A non-transitory computer-readable medium storing a program, the program causing a computer to function as the control device according to claim 1 .
5. A robot system, comprising the control device according to claim 1 and the robot.
6. A control method in a control device, comprising:
determining a plurality of target positions of an actor of a robot based on a form of an object located in an operating environment of the robot;
estimating a predicted trajectory of the actor based on motion of the actor up to the present, and estimating a trajectory of the actor from a current position to each of the plurality of target positions as an approach trajectory using a predetermined function;
selecting one target position among the plurality of target positions based on a degree of similarity respectively between the predicted trajectory and each of the plurality of approach trajectories; and
controlling the actor of the robot to move toward the selected target position,
wherein with respect to the object having dimensions larger than predetermined dimensions, the method further comprising:
determining an intersection of a surface of the object and a line-of sight direction of an operator;
classifying the intersection into a plurality of clusters; and
determining a representative point of the distribution of the intersection of each of the plurality of clusters respectively as each of the plurality of target positions.