DSP를 이용한 SCARA 로봇의 강인한 동적 제어시스템 실현

Implementation of a Robust Dynamic Control System for SCARA Robot Using DSPs

A contrp; suste, fpr SCARA robot is designed for implememting a robust dynamic control algorithm. this study forcuses on the use of DSPs in the design of joint controllers and interfaces in between the host cotroller and four joint controllers and in between the joint controllers and four servo drives. The mechanical body of SCARA robot and the servo drives are selected from the commercially available ones. The four joint controllers, assigned to each joint one by one, are combined into a common system through a mother board hardwarewise and through the global memeory softwarewise. The mother board is designed to connect joint controllers onto the board through the slots adopting PC/104 bus structures. And, the global memory stores the common data which can be shared by joint controllers and the host computer directly, which virtually combines the whole system into one. To demonstrate the performance and efficienty of the sytem, a robust inverse dynamic algorithm is proposed and implemented for a faster and more precise control. The robust inverse dynamic algorithm is basically derived from an inverse dynamci algorithm and a PID compensator. Based upon the derived dynamic equitions of SCARA robot, the inverse dynamic algorithm is intitially implemented within 0.3 msec of the control cycle in this system. The algoithm is found to be not accurate enough for the high speed and precision tasks due to inherent modelling errors and time-varying factors. Therefore, a variable PID algorithm is combined with the inverse dynamic algorithm to support robustness of control performance. Experimental datfor the proposed algorithm are presented and compared with the result obtained from PID and inverse dynamic algorithm.