Development of a New Robot Controller Architecture with FPGA-Based IC Design for Improved High-Speed Performance

In this paper, a new robot controller architecture is proposed to implement various complex control algorithms for improved high-speed performance. The main thrust of the research is to remove the servo control loop from the digital signal processor (DSP) and implement the high-speed servo loop in a field programmable gate array (FPGA). The main objective of this architecture is to utilize the ultra-high-speed hardwired logic of the FPGA to enhance the overall computational capability and relieve the computational load of the DSP for other tasks. The control algorithm is partitioned into a linear portion and a nonlinear portion. The linear portion with position/velocity feedback represents the major control loop and is implemented in the FPGA. The nonlinear portion acts as dynamic compensation to the linear portion to calculate model-related control gains/parameters, and it is implemented in the DSP. In tandem, with the newly developed control hardware architecture, an FPGA-based motion control integrated circuit (IC) is designed. Experiments are conducted on an industrial robot manipulator to compare the closed-loop performance with this new control architecture and the traditional one, when the same control algorithm is used. The experimental results demonstrate that the proposed new control architecture exhibits much improved motion performance indeed, especially in high-speed motions.

[1]  M. Nasir Uddin,et al.  High-Speed Control of IPMSM Drives Using Improved Fuzzy Logic Algorithms , 2007, IEEE Transactions on Industrial Electronics.

[2]  J. Lee,et al.  Hardware-software co-implementation of a H.263 video codec , 2000, IEEE Trans. Consumer Electron..

[3]  Wei-Yun Yau,et al.  A Pulsed Neural Network With On-Chip Learning and Its Practical Applications , 2007, IEEE Transactions on Industrial Electronics.

[4]  Wei-Shiu Wang,et al.  Implementation and experimental study of a multiprocessor system for real-time model-based robot motion control , 1994, IEEE Trans. Ind. Electron..

[5]  D. W. Engels,et al.  A new approach to solving the hardware-software partitioning problem in embedded system design , 2000, Proceedings 13th Symposium on Integrated Circuits and Systems Design (Cat. No.PR00843).

[6]  Tzuu-Hseng S. Li,et al.  Implementation of human-like driving skills by autonomous fuzzy behavior control on an FPGA-based car-like mobile robot , 2003, IEEE Trans. Ind. Electron..

[7]  Roberto Brega,et al.  Application of a nonlinear adaptive controller to a 6 DOF parallel manipulator , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[8]  Neville Hogan,et al.  Impedance Control: An Approach to Manipulation , 1984, 1984 American Control Conference.

[9]  Yaochu Jin,et al.  Decentralized adaptive fuzzy control of robot manipulators , 1998, IEEE Trans. Syst. Man Cybern. Part B.

[10]  T. Semba.  A design method of a multi-rate servo controller using H/sub /spl infin// , 2000 .

[11]  Neville Hogan,et al.  Impedance Control: An Approach to Manipulation: Part I—Theory , 1985 .

[12]  Li Li,et al.  Neuro-Fuzzy Dynamic-Inversion-Based Adaptive Control for Robotic Manipulators—Discrete Time Case , 2007, IEEE Transactions on Industrial Electronics.

[13]  James S. Thorp,et al.  Robust microprocessor control of robot manipulators , 1985, Autom..

[14]  Atsuo Kawamura,et al.  Perfect tracking control based on multirate feedforward control with generalized sampling periods , 2001, IEEE Trans. Ind. Electron..

[15]  K. Y. Zhu,et al.  Optimal Synchronization Control of High-Precision Motion Systems , 2006, IEEE Transactions on Industrial Electronics.

[16]  Yvon Savaria,et al.  A hardware-software co-design model for real-time 3D image computation using active laser range finders: a case study , 2003, 10th IEEE International Conference on Electronics, Circuits and Systems, 2003. ICECS 2003. Proceedings of the 2003.

[17]  Suguru Arimoto,et al.  Bettering operation of Robots by learning , 1984, J. Field Robotics.

[18]  Suguru Arimoto,et al.  Control Theory of Nonlinear Mechanical Systems , 1996 .

[19]  Jörg Henkel,et al.  Hardware-software cosynthesis for microcontrollers , 1993, IEEE Design & Test of Computers.

[20]  J. M. D. Murphy,et al.  Power Electronic Control of Ac Motors , 1988 .

[21]  Daniel Gajski,et al.  Partitioning and pipelining for performance-constrained hardware/software systems , 1999, IEEE Trans. Very Large Scale Integr. Syst..

[22]  P. A. Subrahmanyam,et al.  Hardware/software partitioning for multifunction systems , 1998, IEEE Trans. Comput. Aided Des. Integr. Circuits Syst..

[23]  Frank L. Lewis,et al.  Robot Manipulator Control: Theory and Practice , 2003 .

[24]  T. Takahashi,et al.  Implementation of complete AC servo control in a low cost FPGA and subsequent ASSP conversion , 2004, Nineteenth Annual IEEE Applied Power Electronics Conference and Exposition, 2004. APEC '04..

[25]  Camel Tanougast,et al.  Hardware partitioning software for dynamically reconfigurable SoC design , 2003, The 3rd IEEE International Workshop on System-on-Chip for Real-Time Applications, 2003. Proceedings..

[26]  Claus-Ulrich Karipidis,et al.  A Versatile DSP/FPGA Structure Optimized for Rapid Prototyping and Digital Real-time Simulation of Power Electronic and Electrical Drive Systems , 2001 .

[27]  T. Semba.  A design method of a mulilhate servo controller using H-infinity , 2000 .

[28]  Z. Bielewicz,et al.  A DSP and FPGA based integrated controller development solutions for high performance electric drives , 1996, Proceedings of IEEE International Symposium on Industrial Electronics.

[29]  Ying-Yu Tzou,et al.  Design and implementation of all FPGA-based motor control IC for permanent magnet AC servo motors , 1997, Proceedings of the IECON'97 23rd International Conference on Industrial Electronics, Control, and Instrumentation (Cat. No.97CH36066).

[30]  Faa-Jeng Lin,et al.  Robust Fuzzy Neural Network Sliding-Mode Control for Two-Axis Motion Control System , 2006, IEEE Transactions on Industrial Electronics.

[31]  Peng-Yung Woo,et al.  Fuzzy supervisory sliding-mode and neural-network control for robotic manipulators , 2006, IEEE Transactions on Industrial Electronics.

[32]  J. Slotine,et al.  On the Adaptive Control of Robot Manipulators , 1987 .

[33]  Qing-Wei Jia.  Intersample ripple-free multirate control with application to a hard disk drive servo , 2005, IEEE/ASME Transactions on Mechatronics.

[34]  S. Shankar Sastry,et al.  Adaptive Control of Mechanical Manipulators , 1987, Proceedings. 1986 IEEE International Conference on Robotics and Automation.

[35]  P. Agarwal,et al.  FPGA based PMAC motor control for system-on-chip applications , 2004, Proceedings. 2004 First International Conference on Power Electronics Systems and Applications, 2004..

[36]  G. Torri,et al.  A new, modular, programmable, high speed digital control for large drives , 1994, Proceedings of IECON'94 - 20th Annual Conference of IEEE Industrial Electronics.