Rotary articulated robot and method of control thereof

Abstract

In a rotary articulated robot having at least a plurality of offset rotary joints in which a drive arm and driven arm are driven in rotation about an offset rotary axis inclined with respect to the arm axis, a hollow rotary shaft that is driven in rotation by a motor is arranged rotatably, being inclined, at the leading end of the arm of either the drive arm or driven arm while a rotor member to which turning effort from the hollow shaft is transmitted is fixed at the base of the other arm, said hollow rotary shaft and said rotor member constituting a high reduction ratio transmission/torque increasing mechanism. The method of control is that the operation of the joints is determined by dividing the operating region of the end effector into a plurality of blocks, the operating conditions of each joint necessary for movement to a prescribed block are converted to database form for each block, the teaching of operating points in the prescribed block region is converted to database form and a track is generated to the block of the operating region on the basis of the block region data; and when a reference point of the block is reached, the in-block operating point data is fetched.