Control system of multi-joint arm robot apparatus
First 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 actuating means for controlling a joint angle of each of said joints, first detecting means for detecting the joint angle of each of said joints;
- a movable support for supporting a base arm of said multi-joint arm; and
contact sensor means for detecting which unit arm is in contact with an obstacle to generate a contact signal, said movable support having second actuating means for moving said movable support so as to move said multi-joint arm, and second detecting means for detecting the distance by which said movable support moves;
said control system comprising;
means coupled to a foremost unit arm of said multi-joint arm for measuring the direction and distance in and by which said multi-joint arm is to be moved;
data processing means responsive to said measuring means, said first detecting means and said second detecting means for computing joint angles of said joints such that said joints are put into a path represented by measured distance and direction data obtained by said measuring means when said movable support is moved by a unit distance by said second actuating means; and
driving means responsive to said data processing means for actuating said second actuating means to move said movable support by the unit distance and actuating said first actuating means of said multi-joint arm in such a way that said joints are set to joint angles computed by said data processing means,said data processing means being responsive to the contact signal generated by said contact sensor means to cause said driving means to rotate the rearward joint of a unit arm of said multi-joint arm, which is in contact with the obstacle, until the contact signal disappears, and then rotate the forward joint of said contacting unit arm in a direction opposite to the rotating direction of said rearward joint through substantially the same amount.
1 Assignment
0 Petitions
Accused Products
Abstract
A multi-joint arm robot apparatus comprises a multi-joint arm having a plurality of unit arms coupled in tandem with each other through joints, and a movable support for supporting the proximal portion of the multi-joint arm. The multi-joint arm robot apparatus has motors for controlling joint angles of the joints and a motor for moving the movable support. These motors are driven by a control system. The control system controls the motors to obtain proper joint angles, in such a way that the joints of the multi-joint arm are put into a given path when the movable support is moved a given unit distance.
-
Citations
3 Claims
-
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 actuating means for controlling a joint angle of each of said joints, first detecting means for detecting the joint angle of each of said joints;
- a movable support for supporting a base arm of said multi-joint arm; and
contact sensor means for detecting which unit arm is in contact with an obstacle to generate a contact signal, said movable support having second actuating means for moving said movable support so as to move said multi-joint arm, and second detecting means for detecting the distance by which said movable support moves;said control system comprising; means coupled to a foremost unit arm of said multi-joint arm for measuring the direction and distance in and by which said multi-joint arm is to be moved; data processing means responsive to said measuring means, said first detecting means and said second detecting means for computing joint angles of said joints such that said joints are put into a path represented by measured distance and direction data obtained by said measuring means when said movable support is moved by a unit distance by said second actuating means; and driving means responsive to said data processing means for actuating said second actuating means to move said movable support by the unit distance and actuating said first actuating means of said multi-joint arm in such a way that said joints are set to joint angles computed by said data processing means, said data processing means being responsive to the contact signal generated by said contact sensor means to cause said driving means to rotate the rearward joint of a unit arm of said multi-joint arm, which is in contact with the obstacle, until the contact signal disappears, and then rotate the forward joint of said contacting unit arm in a direction opposite to the rotating direction of said rearward joint through substantially the same amount. - View Dependent Claims (2, 3)
- a movable support for supporting a base arm of said multi-joint arm; and
Specification