| 摘要 |
The purpose of the present invention is to have the angles of each of the drive shafts of the first articulated drive system infallibly reach the angle of the work completed position, while maintaining the rate of movement and position of the working parts of an articulated robot. If exception conditions are not satisfied, the drive shafts of first and second articulation drive systems are driven individually (S64) on the basis of interpolated points calculated in step 5 (S5). After exception conditions are satisfied (Yes side of S61), until the working parts reach the work completed position (No side of S12), the angle of each of the drive shafts of the first articulated drive system required to vary each of the drive shafts of the first articulated drive system in a linear manner with the angle at the work completed position as a target is calculated (S8), and the angle of each of the drive shafts of the second articulated drive system is calculated on the basis of the position of the working part at the interpolated point calculated in step 5 (S5) and the angle of each of the drive shafts of the first articulated drive system as calculated (S9), and the drive shafts of the first and second articulated drive systems are driven according to said calculation results (S11). |
