Trajectory generation device, trajectory generation method, and robot system
A trajectory generation device which generates a trajectory of a robot includes: a trajectory exploration graph generation unit which is configured to generate a trajectory exploration graph composed of a plurality of nodes for generating the trajectory; an acceleration upper limit value acquisition unit which is configured to acquire a first acceleration upper limit value based on orientations and an acceleration direction of the robot at a current node; a velocity and acceleration setting unit which is configured to set a first velocity representing a velocity when moving from the current node to a next node adjacent to the current node based on the acquired first acceleration upper limit value, and an acceleration; and a node cost calculation unit which is configured to calculate a moving time by using the set first velocity and the acceleration as cost from the current node to the next node.
1. A robot system comprising:
a robot;
a controller which controls the robot based on a generated trajectory; and
a processor coupled to the robot;
a memory coupled to the processor, the memory storing instructions that when executed by the processor configure the processor to:
generate a trajectory exploration graph composed of a plurality of nodes for generating the trajectory, the trajectory exploration graph is two-dimensional and a horizontal axis indicates a position and an orientation of the robot and a vertical axis indicates a velocity of the robot;
acquire a first acceleration upper limit value based on an orientation and an acceleration direction of the robot at a current node;
set an acceleration and set a first velocity representing a velocity when moving from the current node to a next node adjacent to the current node based on the acquired first acceleration upper limit value;
calculate a moving time, as a cost, by using the set first velocity and the set acceleration from the current node to the next node; and
explore, based on the calculated cost, a path passing through two or more nodes in the trajectory exploration graph as the trajectory.
2. The robot system according to claim 1 ,
wherein the processor is configured to acquire a second velocity representing a velocity at the current node, acquire the first velocity based on a distance between the current node and an obstacle, and calculate the acceleration based on the first velocity and the second velocity.
3. The robot system according to claim 1 ,
wherein the processor is configured to correct the first velocity and the acceleration when an absolute value of the acceleration is larger than the first acceleration upper limit value.
4. The robot system according to claim 1 ,
wherein the processor is configured to refer to first acceleration upper limit value information generated in advance, and acquire the first acceleration upper limit value based on the orientation and the acceleration direction of the robot at the current node.
5. The robot system according to claim 1 , wherein
the processor is configured to acquire grip information representing a gripped state of a gripped object by a hand of the robot, and acquire a second acceleration upper limit value based on the grip information, and
set the first velocity and the acceleration based on a smaller one of the acquired first acceleration upper limit value and the acquired second acceleration upper limit value.