Development of an FPGA-Based Motion Control ASIC for Robotic Manipulators

摘要

In this paper, a fully digital motion controller is designed by using a new developed FPGA based ASIC. The FPGA based ASIC has functions of closed current loop control, closed position/velocity loop control, incremental encoder logic, PWM modulation, fault/brake logic, velocity estimator, host communication module, UART module and Delta-Sigma analog to digital converter. The hardware system executes quickly in dedicated parallel hardware without timing overhead penalty of a serial processor. The update rates of the current control loop and position/velocity control loop are 120 kHz and 20 kHz, respectively. The new designed ASIC can be incorporated with a general-purpose microcontroller or DSP to provide a simple, compact, low-cost, and effective solution for high-performance motion control. An adaptive control algorithm is implemented in the new designed system in order to control a SCARA robotic manipulator. In order to increase the sampling frequency of the system when using model based control algorithm, 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 based ASIC. The nonlinear portion acts as dynamic compensation to the linear portion to perform complex modeling related calculations, and is implemented in the DSP. Experimental results demonstrate that the new proposed system is successful and it exhibits much improved motion performance especially during high-speed motions.