초록 ▼

A robot controller for having a workpiece held by a robot and having the workpiece machined by moving it relative to a stationary tool. The robot controller can control the velocity of relative motion, against the tool, of a machining point on the workpiece. At each teaching point, a transformation

A robot controller for having a workpiece held by a robot and having the workpiece machined by moving it relative to a stationary tool. The robot controller can control the velocity of relative motion, against the tool, of a machining point on the workpiece. At each teaching point, a transformation matrix is calculated to convert a position matrix of the flange center as teaching data (i.e., 4×4 matrix giving position and attitude in homogeneous coordinates) into a position matrix of the tool tip. Between two adjacent teaching points, interpolation points are set according to a specified velocity. Transformation matrices applicable to the two teaching points are put to interpolation calculations to provide a transformation matrix at each interpolation point. An inverse matrix of the transformation matrix at each interpolation point is applied to the position matrix for the tool tip. This allows the position matrix for the flange center keyed to each interpolation point to be calculated. Using the position matrix for the flange center, rotation angles on the controllable axes of the robot are calculated. With the distance between interpolation points set based on a given velocity, the machining velocity at any machining point may be controlled.

대표청구항 ▼

A robot controller for having a workpiece held by a robot in a hand thereof and for having said workpiece machined by moving it through control over the position and attitude of said hand against a tool fixedly mounted on a tool bed, comprising: a first memory means for storing as tool data those da

A robot controller for having a workpiece held by a robot in a hand thereof and for having said workpiece machined by moving it through control over the position and attitude of said hand against a tool fixedly mounted on a tool bed, comprising: a first memory means for storing as tool data those data representing the position of the tip of said tool fixedly mounted on said tool bed as well as the attitude of said tool; a second memory means for storing as teaching data at a plurality of teaching points, those data representing the position of the origin of a coordinate system fixed to said hand of said robot as well as the attitude of said hand with respect to each of said plurality of teachings points along a machining path determined on said workpiece; a calculating means for calculating as relative tool data at each teaching point those data representing the attitude of said tool and the position of the tip thereof located in said coordinate system fixed to said hand of said robot, said calculating being accomplished through the use of tool data stored in said first memory means and of said teaching data at each teaching point stored in said second memory means; a first interpolation means for setting interpolation points along the machining path between any adjacent two of said teaching points according to a specified machining velocity, in order to calculate as interpolation relative tool data the position of said tool in said coordinate system fixed to said hand as well as the attitude of said tool at each of said interpolation points by the use of said relative tool data in effect at said two adjacent teaching points; a second interpolation means for calculating as interpolation teaching data those data representing the attitude of said hand and the position of the origin of said coordinate system fixed to said hand of said robot at each of said interpolation points, said calculation being accomplished through the use of said interpolation relative tool data at each interpolation point calculated by said first interpolation means and of said tool data stored in said first memory means; and a control means for calculating rotation angles on movable axes of said robot based on said interpolation teaching data in effect at each interpolation point and calculated by said second interpolation means, in order to control the position and attitude of said hand of said robot by having said movable axes follow said rotation angles.