| 摘要 |
In order to suppress fluctuations in specific components of posture angle in a target coordinate system while maintaining the position of the leading edge of the wrist, the velocity of movement of the leading edge of the wrist, and the permissible velocity of the shaft during velocity suppression, an articulated robot which moves while calculating the position in interpolated points on a teaching path, the posture and the angles in each axis is provided, wherein a judgment is made as to whether the velocity of the wrist shaft exceeds a permissible limit, and if the permissible limit is exceeded, a plurality of candidates for angle of the wrist shaft that maintain the velocity within permissible limits are calculated, and the candidate with the minimum fluctuation in the specific component of the posture angle of the weld line coordinate system is selected from said plurality of candidates and made to serve as the angle of the wrist shaft, the angles of other shafts that correspond to this angle are recalculated and made to serve as the subsequent interpolation point, and the articulated robot is driven. |
