Multiple-articulated robot control apparatus

Claim 1

A control apparatus for a multiple-articulated robot in which each arm is independently driven by a feedback-controlled joint driving servomotor, comprising: arithmetic means for computing mutual interference torque values for respective ones of the arms; status observing means for reproducing a status variable from a torque command and actual velocity of each servomotor, said status observing means including: constant term means for receiving an acceleration value and converting it to a constant term; integration means, connected to said converting means, for receiving and converting the constant term value to a velocity value; a first adder, connected to the servometer and said integration means, for calculating an error having a steady component and a non-steady component; error elimination means, connected to said first adder, for eliminating the steady error component; and torque means, connected to said error elimination means, for providing corrective torque to the non-steady error component from said error elimination means; a second adder, connected to said corrective means, for adding the outputs from said torque means; conversion means, connected to said status observing means, for receiving the velocity value from said integration means and for converting an output of the status observing means into a corrective value of torque produced by disturbance acting upon the servomotor; and correcting means, connected to said conversion means and said second adder, for receiving the output from said second adder and the corrective value and for correcting an error signal of the torque command of the servomotor by the converted corrective value and said interference torque value.