| 摘要 |
The invention is directed to a method of controlling acceleration and deceleration time constants for a robot wherein the acceleration and deceleration time constants of a servo motor are each set at an optimum value based on the amount of movement, load, etc., thereby achieving a reduction in the operation time of the robot. The control method controls the operation of the robot while setting the acceleration and deceleration time constants at optimum values for each block instruction, and comprises the following five stages: the first stage comprising determining from the distance to the target position whether or not the speed will reach the taught speed (S1), setting the taught speed as velocity V if it is determined that the speed will reach the taught speed (S2), otherwise obtaining an ultimate velocity (S3) and setting the obtained ultimate velocity as velocity V (S4); the second stage comprising obtaining an output torque corresponding to the velocity V from a velocity-torque curve (S5); the third stage comprising obtaining an acceleration torque and a deceleration torque by subtracting a static load torque from the output torque (S6); the fourth stage comprising obtaining the magnitude of acceleration for acceleration and for deceleration (S7); and the fifth stage comprising obtaining an acceleration time constant and a deceleration time constant from the magnitudes of acceleration and the velocity V (S8), and then determining the largest acceleration time constant and largest deceleration time constant in absolute value terms or determining the optimum acceleration time constant and deceleration time constant for each individual axis (S9).
|
