Method of teaching a robot

A method of teaching an articulated robot, including a plurality of articulations and an end effector having a tool center point, comprising the steps of:

• determining a first coordinate transformation matrix for transforming coordinates between the articulations from condition data of the articulations, said condition data comprising pulses produced by potentiometers mounted on the articulated robot;
• calculating a present position of the tool center point based on said first coordinate transformation matrix;
• determining a rotation matrix with respect to a reference coordinate system for displacing a posture of the end effector at said present position of the tool center point;
• determining a second coordinate transformation matrix for further transforming coordinates between the articulations so that the end effector with said displaced posture, which is calculated based on said first coordinate transformation matrix and said rotation matrix, coincides with said present position of the tool center point;
• moving the articulations according to said further transformed coordinates;
• and
• calculating new condition data of the articulations from said second coordinate transformation matrix.

A method of teaching an articulated robot, including a plurality of articulations and an end effector having a tool center point, for effecting linear interpolation between first and second teaching points, said method comprising the steps of:

• determining a first coordinate transformation matrix and a second coordinate transformation matrix for the first and second teaching points, respectively, from condition data of the articulations, for transforming coordinates between the articulations, said condition data comprising pulses produced by potentiometers mounted on the articulated robot;
• calculating a position of the tool center point at the first and second teaching points based on said first and second coordinate transformation matrices, respectively;
• determining an interpolating number for dividing a determined distance between the first and second teaching points at intervals;
• determining a cumulative change in a position of the tool center point and a cumulative change in a posture of the end effector as the end effector moves from the first teaching point to the second teaching point;
• dividing said cumulative change in position and said cumulative change in posture by said interpolating number to determine incremental changes of position of the tool center point and incremental changes of posture of the end effector at respective interpolating points between the first and second teaching points;
• determining corresponding positions of the tool center point and corresponding postures of the end effector at said respective interpolating points by using said incremental changes of position of the tool center point and said incremental changes of posture of the end effector between said respective interpolating points;
• and
• moving the articulations along said corresponding positions and postures according to said transformed coordinates.

A method of teaching an articulated robot, including a plurality of articulations and an end effector having a tool center point, for effecting circular interpolation between first, second, and third teaching points, said method comprising the steps of:

• determining first, second, and third coordinate transformation matrices for the first, second, and third teaching points, respectively, from condition data of the articulations, for transforming coordinates between the articulations, said condition data comprising pulses produced by potentiometers mounted on the articulated robot;
• calculating a position of the tool center point at the first, second, and third teaching points based on said first, second, and third coordinate transformation matrices, respectively;
• determining a center and a length of an arc extending from the first teaching point through the second teaching point to the third teaching point;
• determining an interpolating number for dividing said arc at intervals based on said length of said arc;
• determining an angle formed between a vector extending from said center to the first teaching point and a vector extending from said center to the third teaching point;
• dividing said angle by said interpolating number to determine a change in a direction of a vector extending from said center to an interpolating point;
• determining a rotation matrix for said vector extending to said interpolating point based on said change in said direction;
• operating said rotation matrix successively on said coordinate transformation matrices with respect to said first teaching point to determine respective positions of the tool center point and respective postures of the end effector at corresponding interpolating points;
• and
• moving the articulations along said respective positions and postures according to said transformed coordinates.

A method of teaching an articulated robot, having a plurality of articulations and an end effector having a tool center point, for correcting a position of the tool center point, comprising the steps of:

• determining a coordinate transformation matrix for transforming coordinates between the articulations from condition data of the articulations, said condition data comprising pulses produced by potentiometers mounted on the articulated robot;
• calculating a position of the tool center point before it is corrected, based on said coordinate transformation matrix;
• determining an interval of movement of the tool center point with respect to a workpiece to be processed by the articulated robot;
• calculating a position of the tool center point after it is corrected, from said position of the tool center point before it is corrected and said interval of movement;
• determining a new coordinate transformation matrix for transforming coordinates between the articulations from said position of the tool center point after it is corrected;
• moving the articulations according to said transforming coordinates corresponding to said new coordinate transformation matrix;
• and
• calculating new condition data of the articulations from said new coordinate transformation matrix.

A method of teaching an articulated robot, including a plurality of articulations and an end effector having a tool center point, for correcting old teaching data of the articulated robot, comprising the steps of:

• determining positions of three reference points corresponding to the old teaching data, which are not present on one straight line and which are selected prior to correction of the teaching data based on condition data comprising pulses produced by potentiometers mounted on the articulated robot;
• determining three new positions for the tool center point, corresponding to correction of teaching data, by moving the tool center point to said three new positions;
• determining a coordinate transformation matrix for transforming coordinates of the tool center point to said three new positions based upon said three reference points of the old teachings data and said three new positions;
• operating said coordinate transformation matrix on the old teaching data for correction thereof;
• and
• moving the articulations according to transformed coordinates corresponding to said corrected teaching data.

A method of teaching an articulated robot, having a plurality of articulations and a first end effector of a first shape having a tool center point, for replacing the first end effector with a second end effector of a second shape, comprising the steps of:

• determining a coordinate transformation matrix for transforming coordinates between the articulations from condition data of the articulations, said condition data comprising pulses produced by potentiometers mounted on the articulated robot;
• calculating a position of the tool center point of the first end effector based on said coordinate transformation matrix and dimensional data indicative of the first shape of the first end effector;
• determining a new coordinate transformation matrix for transforming coordinates between the articulations so that a position of the tool center point of the second end effector and a posture of the second end effector will coincide respectively with said position of the tool center point of the first end effector and a posture of the first end effector;
• moving the articulations according to said transforming coordinations corresponding to said new coordinate transformation matrix;
• and
• calculating new condition data of the articulations from said new coordinate transformation matrix.