Method of and arrangement for controlling manipulators and industrial robots

摘要

This disclosure is drawn to a method of and an arrangement for controlling the rotational and translatory motions of a manipulator or industrial robot, which automatically for the entire motion and speed range, even when there is simultaneous movement of a plurality of motion actuators, permit uniform, selectible and disturbance-independent dynamic control properties for individual or all motion parameters. The invention is characterized in that for each rotational or translational motion parameter of the manipulator or industrial robot to be controlled the positioning signal of the associated motion actuator is in part generated by a control means with selectible dynamics. This controller output signal is amplified multiplicatively by the output signal of an arrangement which for a rotational motion reproduces the associated variable moment of inertia and for a translatory motion the associated mass, respectively, inclusive of the variable load mass. The controller output signal is amplified to such an extent that thereby the effect of the variable moment of inertia or of the variable mass is compensated. The other part of the positioning signal of the associated motion actuator is supplied additively by the output of a further compensation arrangement which reproduces the dynamic intercouplings with the other motion variables so that the interference effect upon simultaneously varying a plurality of motion variables is eliminated.