Control system of multi-joint arm robot apparatus

Claim 1

In a control system for multi-joint arm robot apparatus including a multi-joint arm having a plurality of unit arms coupled in tandem with each other through joints, said multi-joint arm having first motor means for controlling the joint angle of each of said joints, and first detecting means for detecting the joint angle of each of said joints in accordance with the rotation angle of said first motor means, and said multi-joint arm having contact sensor means for detecting which unit arm is in contact with an obstacle to generate a contact signal; and a movable support for supporting a proximal portion of said multi-joint arm, said movable support having second motor means for moving said movable support so as to move said multi-joint arm, and second detecting means for detecting the rotation angle of said second motor means; said control system comprises: data processing means responsive to the contact signal to cause a motor driving means to rotate the rearward joint of a contacting unit arm of said multi-joint arm until the contact signal disappears, and then rotate the forward joint of said contacting unit am in a direction opposite to the rotating direction of said rearward joint through approximately the same amount and responsive to coordinate data of a plurality of points on a path of said multi-joint arm which is determined in advance, for calculating a path equation indicating the path, and a joint angle for each of said joints such that said joints are put into the path when said movable support is moved a unit distance, and for storing calculated path and joint angle data; and said motor driving means responsive to output data from said data processing means for driving said second motor means to move said movable support by the unit distance and said first motor means of said multi-joint arm in such a way that said joints are set to the joint angles calculated by said data processing means.