| 摘要 |
A method for determining a number of load parameters (ml, xl, rl, alphal, Ix, Iy, Iz) for a load (6) which is carried by a manipulator. The manipulator comprises a number of links (2,3,4) which are movable in relation to one another, a handling member (5) for supporting a tool, which handling member is movable in relation to said links, a number of axes (A1-A6) around which the links or the handling member are/is movable as well as a motor for each axis which drives the movement of the axis in accordance with supplied reference values for the torque of the motor. According to the method, the manipulator adopts two selected axis configurations. A number of identification axes are appointed. The manipulator is run such that the identification axes carry out a plurality of movements according to predetermined patterns. During these movements, the motor torque and the axis angle are measured. The moments of gravitational force of the identification axes are calculated on the basis of measured motor torques during a first movement. The mass inertia is calculated with correlation between measured motor torques and calculated acceleration during a second movement. The load parameters are calculated from the calculated moments of gravitational force and the mass inertias with the aid of the movement equations of the identification axes. |
