Control system of multi-joint arm robot apparatus

Claim 1

In a control system for a 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 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 such 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, wherein said data processing means calculates path equations for a plurality of paths determined in advance, and joint angles of said joints for said plurality of paths, respectively, and is responsive to the contact signal from said contact sensor means to apply to said motor driving means data on a different path from the path along with said multi-joint arm has been moved thereby transferring the path of said multi-joint arm to the different one; and 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.