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, which are 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 the 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.

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, which are 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 the 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.