Control device, control method, and control program for articulated robot

A control method for an articulated robot 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 method comprising:

• an interpolation point calculating step of 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 control step of driving the first articulated drive system and the second articulated drive system in accordance with the interpolation points calculated in the interpolation point calculating step;
• an exception condition determining step of 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 in the driving control step;
• and
• an exceptional operation step of, after the exception condition determining step 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 in the interpolation point calculating step, 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.

A control program for an articulated robot 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 program causing a processor to execute:

• an interpolation point calculating step of 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 control step of driving the first articulated drive system and the second articulated drive system in accordance with the interpolation points calculated in the interpolation point calculating step;
• an exception condition determining step of 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 in the driving control step;
• and
• an exceptional operation step of, after the exception condition determining step 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 in the interpolation point calculating step, 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.