| 摘要 |
The controller comprises (a) an interpolation calculator for dividing move data of a robot arm tip position into each sample period, the data fed from a position teaching section, (b) a load inertia calculator, (c) a gravity torque calculator, (d) acceleration and deceleration (A & D) time calculator for calculating an optimum A & D time by using the load inertia calculated by the load inertia calculator and the gravity torque calculated by the gravity torque calculator, (e) an A & D processor for providing an A & D process to move data of each sample time calculated by the interpolation calculator based on the A & D time calculated by the A & D time calculator, and (f) position controllers for controlling each motor based on the move data processed by the A & D processor. The A & D time is calculated with the following equation:T= alpha x(Jm+JL)/(Tm-TL)xVwhere: V=desirable speed, Jm=motor inertia, JL=load inertia, Tm=motor torque, TL=disturbance torque including gravity torque, alpha =proportional coefficient and T=A & D time. The robot having the above construction can figure out an optimum A & D time by considering change of load inertia and also that of gravity torque produced by a posture change of the robot, whereby A & D time can be varied. As a result, the robot can be operated at a higher speed. |
