Robot teaching device and work teaching method
An operation is generated in which a robot can perform work without causing interference with a surrounding structure within a movable range of the robot. The robot teaching device relates to a work teaching device that teaches work to a robot that holds and moves a held object. The device includes a teaching pose measurement unit configured to measure and/or calculate a teaching pose that is a pose of the held object during teaching work, and a robot operation generation unit configured to generate a joint displacement sequence of the robot such that a pose of a held object of the same type as the held object whose teaching pose is measured becomes the same pose as the teaching pose.
1. A robot teaching device for teaching work to a robot configured to hold and move a held object with a plurality of holding portions, the robot teaching device comprising:
a teaching pose measurement unit configured to measure and/or calculate a teaching pose that is a pose of a first held object held by a teacher during teaching work; and
a robot operation generation unit configured to generate a joint displacement sequence of the robot such that a pose of a second held object held by the robot becomes the same pose as the teaching pose, wherein
the robot operation generation unit is configured to display a countermeasure that is within the movable range and enables avoiding of the interference, and to allow a user to select the countermeasure; and
in a case where the calculated joint displacement sequence of the robot exceeds a movable range of the robot, or in a case where it is determined that interference occurs between the robot and a surrounding structure when the robot is driven according to the calculated joint displacement sequence, the robot operation generation unit changes at least one of
a position of the second held object,
displacement of another joint that is not a
driving target when it is determined that the movable range is exceeded or the interference occurs, or
a position of a pedestal on which the robot is mounted,
while maintaining a relationship of relative positions and relative postures between the holding portions.
2. The robot teaching device according to claim 1 , wherein
the teaching pose measurement unit measures and/or calculates a trajectory of at least one reference point of the first held object, and
the robot operation generation unit generates the joint displacement sequence based on the trajectory of the at least one reference point of the first held object.
3. The robot teaching device according to claim 1 , wherein
the teaching pose measurement unit measures and/or calculates the teaching pose in time series, and
the robot operation generation unit generates the joint displacement sequence synchronized with the time series of the teaching pose.
4. The robot teaching device according to claim 1 , wherein
the robot operation generation unit measures and/or calculates a pose of a holding portion of the robot by coordinate conversion based on a positional relationship between a held object coordinate system with reference to the first held object and a holding portion coordinate system with reference to the holding portion of the robot.
5. The robot teaching device according to claim 4 , wherein
the robot operation generation unit calculates a pose of a link tip of the robot based on the teaching pose by coordinate conversion based on a positional relationship between the holding portion coordinate system with reference to the holding portion of the robot and a link tip coordinate system with reference to a center of a wrist flange of the robot.
6. The robot teaching device according to claim 5 , wherein
the robot operation generation unit generates the joint displacement sequence by calculating joint displacement of the robot as a solution of inverse kinematics calculation based on time-series data on the pose of the link tip.
7. The robot teaching device according to claim 1 , wherein
the robot operation generation unit changes the position of the second held object by translating a position, where the second held object is to be located, in at least one of forward, backward, leftward, rightward, upward, and downward directions.
8. The robot teaching device according to claim 1 , wherein
the robot operation generation unit changes displacement of a waist joint of the robot as the other joint.
9. The robot teaching device according to claim 1 , wherein
the robot operation generation unit translates the position of the pedestal, on which the robot is mounted, in any one of forward, backward, leftward, rightward, upward, and downward directions.
10. The robot teaching device according to claim 1 , further comprising:
a work scenario editing unit configured to describe a series of work including at least one unit operation as a work scenario based on data generated by the robot operation generation unit; and
a work scenario execution unit configured to sequentially interpret the work scenarios and cause the robot to execute the unit operation.
11. The robot teaching device according to claim 10 , wherein
the work scenario editing unit includes a robot unit operation display portion configured to select the unit operation and display the unit operation as a two-dimensional or three-dimensional moving image or a trajectory of a holding portion of the robot, and
a robot state display portion configured to display joint displacement of the robot, a pose of the holding portion of the robot, a position of the pedestal on which the robot is mounted which are displayed by the robot unit operation display portion.
12. The robot teaching device according to claim 11 , wherein
in a case where another unit operation is to be added to the series of work, when the pose of the holding portion in the unit operation serving as a connection target does not match a pose of the holding portion in the unit operation to be added, the work scenario editing unit connects these poses by continuously interpolating.
13. The robot teaching device according to claim 12 , further comprising:
a display unit configured to display whether there is a mismatch between the pose of the holding portion in the unit operation serving as the connection target and a pose of the holding portion in the unit operation to be added.
14. A work teaching method for teaching work to a robot configured to hold and move a held object with a plurality of holding portions, the work teaching method comprising:
a teaching pose measurement step of measuring and/or calculating a teaching pose that is a pose of a first held object held by a teacher during teaching work;
a holding portion pose calculation step of calculating a pose of a holding portion of the robot that holds a second held object based on data on the pose of the first held object;
a robot operation generation step of searching for a solution of joint displacement that does not cause interference with a surrounding structure within a movable range of the robot and generating a joint displacement sequence executable by the robot by calculating a joint displacement sequence of the robot as a solution of inverse kinematics calculation based on data on the pose of the holding portion, and in a case where joint displacement of the robot exceeds the movable range at that time, or in a case where interference occurs between the robot and the surrounding structure when the robot is driven according to the calculated joint displacement sequence, changing at least one of
a pose to be taken by the second held object,
displacement of another joint that is not a driving target when it is determined that the movable range is exceeded or the interference occurs, or
a position of a pedestal on which the robot is mounted,
while maintaining a relationship of relative positions and relative postures between the holding portions;
a work scenario editing step of, treating the joint displacement sequence as a unit operation of the robot for a certain period of time, describing a series of work including at least one unit operation as a work scenario, and in a case of selecting a unit operation of the robot and adding and connecting the selected unit operation as a unit operation continuous with a certain unit operation in the work scenario, when a pose of the holding portion of the robot in the unit operation in the series of work does not match a pose of the holding portion of the robot in the unit operation to be added, generating a joint displacement sequence of the robot for continuously interpolating between these poses without causing interference with the surrounding structure within the movable range of the robot, and inserting the interpolation operation into the work scenario;
a work scenario execution step of sequentially interpreting and executing the work scenarios; and
a robot joint axis control step of performing drive control on a joint axis of the robot according to the work scenarios.
15. A robot teaching device for teaching work to a robot configured to hold and move a held object, the robot teaching device comprising:
a teaching pose measurement unit configured to measure and/or calculate a teaching pose that is a pose of a first held object held by a teacher during teaching work;
a robot operation generation unit configured to generate a joint displacement sequence of the robot such that a pose of a second held object held by the robot becomes the same pose as the teaching pose; and
a display unit configured to display a trajectory of a holding portion of the robot according to the sequence generated by the robot operation generation unit, wherein
the display unit is configured to display a position on the trajectory, the position exceeding a movable range of the robot or causing interference with a surrounding structure, and
the robot operation generation unit is configured to display a countermeasure that is within the movable range and enables avoiding of the interference, and to allow a user to select the countermeasure.