FPGA-Implementation of Inverse Kinematics and Servo Controller for Robot Manipulator

The implementation of inverse kinematics and servo controller for robot manipulator using FPGA (field programmer gate array) is investigated in this paper. Firstly, the mathematical model and the servo controller of robot manipulator are described. Secondly, the inverse kinematics is formulated. Thirdly, the circuit design to implement the function of inverse kinematics and servo controller based on FPGA is introduced. To reduce the usage of the logic elements (LEs) in FPGA, a finite state machine (FSM) method by overall 42 steps to implement the computation of inverse kinematics is applied. Finally, to evaluate the performance of the proposed design circuits, an experimental system consisted by the proposed FPGA-based motion controller and a Mitsubishi RV-M1 micro robot are set up and some experimental results are demonstrated the correctness and effectiveness.

[1]  G. Yasuda.  Microcontroller implementation for distributed motion control of mobile robots , 2000, 6th International Workshop on Advanced Motion Control. Proceedings (Cat. No.00TH8494).

[2]  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..

[3]  Hong Liu,et al.  FPGA based hardware architecture for HIT/DLR hand , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[4]  Kab Il Kim,et al.  Motion control of biped robots using a single-chip drive , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[5]  Mansur R. Kabuka,et al.  Microcontroller-based architecture for control of a six joint robot arm , 1988 .

[6]  L. W. Tsai,et al.  Robot Analysis: The Mechanics of Serial and Parallel Ma-nipulators , 1999 .

[7]  Pin-Ging Huang,et al.  Development of a SOPC for PMSM drives , 2004, The 2004 47th Midwest Symposium on Circuits and Systems, 2004. MWSCAS '04..

[8]  Robert J. Schilling,et al.  Fundamentals of robotics - analysis and control , 1990 .

[9]  Dong Sun,et al.  A FPGA-based motion control IC design , 2005, 2005 IEEE International Conference on Industrial Technology.

[10]  Ying-Shieh Kung,et al.  Development of a FPGA-based motion control IC for robot arm , 2005, 2005 IEEE International Conference on Industrial Technology.

[11]  M. A. Hannan Bin Azhar,et al.  Design of an FPGA based adaptive neural controller for intelligent robot navigation , 2002, Proceedings Euromicro Symposium on Digital System Design. Architectures, Methods and Tools.