Patent ID: 9242373
Filing Date: 2016-01-26
CPC Classification: B23K,B25J,G05B

Claim Text:
1. An articulated robot control device for controlling an articulated robot including a first articulated drive system, which includes three drive shafts for changing an attitude of a working part disposed at a forward end, and a second articulated drive system, which includes at least three drive shafts for changing a position of the first articulated drive system, the control device comprising: an interpolation point calculator for calculating a plurality of interpolation points to move a position of the working part at a predetermined speed on a teaching path interconnecting respective positions and attitudes at a work start point and a work end point, which are set in advance; a driving controller for driving the first articulated drive system and the second articulated drive system in accordance with the interpolation points calculated by the interpolation point calculator; an exception condition determiner for determining whether or not a preset exception condition, which is different from a condition for detecting a singular attitude of the first articulated drive system, is satisfied when the first articulated drive system and the second articulated drive system are driven by the driving controller; and an exceptional operator for, after the exception condition determiner determines that the exception condition is satisfied, calculating respective angles of the drive shafts of the first articulated drive system, the angles being adapted to linearly change the drive shafts of the first articulated drive system with angles to be taken at the work end point being targets, until the working part reaches the work end point, calculating respective angles of the drive shafts of the second articulated drive system based on the respective calculated angles of the drive shafts of the first articulated drive system and on the position of the working part at a next interpolation point calculated by the interpolation point calculator, and driving the respective drive shafts of the first articulated drive system and the second articulated drive system based on calculation results; wherein the exception condition is given as a condition that a speed of at least one of the drive shafts of the first articulated drive system, which is defined by a remaining moving time or a remaining moving distance from a next interpolation point to the work end point, exceeds a preset allowable range when the respective angles of the drive shafts of the first articulated drive system are made to reach the angles to be taken at the work end point in the remaining moving time or the remaining moving distance of the working part from the next interpolation point.