摘要:
An industrial robot has a position controller (PR) for each one of the axes of the robot and a computer for control of the robot. The computer continuously determines, with the aid of a mathematical model (MODEL) set up in advance, in dependence on the robot configuration (0i) and load (mL) in question, the mass moment of inertia (Ji) of the axes, the coupled mass moment of inertia (Jij), and the moment (Mgi) caused by gravity. From the relationships between acceleration and deceleration and the drive motor torque for the different axes, the maximum available acceleration/deceleration ( i) for the axis is determined while assuming that maximum torque prevails for each axis. For each axis this value (STABCRIT) is compared with the maximum acceleration/deceleration value that may be allowed from the point of view of stability. On the basis of the lower of these values, optimum gain (Kpi) is determined and set in the position controller and/or a path planning parameter.
摘要:
Industrial robot of the so-called agile type which has a lower arm (16) with double-sided journalling in a stand consisting of two separated, upright parts (12a, 12b), the arm (16) being pivotable in the space between the stand parts. A pivot shaft (24) for pivoting the upper arm of the robot via a crank and a parallel link rod extends from one of the stand parts (12a) and through a lead-in opening (28) in the lower arm (16). From the other stand part (12b) extends a drive shaft (30), which is substantially coaxially opposite to the pivot shaft (24) of the crank and is connected to the lower arm (16).