Dual-Axis Motor Control Using FCL and SFRA On a Single C2000 MCU

Dual-Axis Motor Control Using FCL and SFRA On a Single C2000™ MCU

Trademarks

C2000 is a registered trademark of Texas Instruments.

1 Introduction

High performance motor drives in servo control and robotics applications are expected to provide high precision and high bandwidth control of current, speed and position loops for superior control of end applications such as robotic arm, CNC machines, and so forth. Since the current loop makes up the inner most control loop, it must have a high bandwidth to enable the outer speed or position loops to be faster. Hence, a high bandwidth FCL is needed in high performance industrial servo control applications. However, the delays due to ADC conversion and algorithm execution limit the current controller bandwidth to about a tenth of the sampling frequency.

Until recently, because of the time critical computational demand of the control algorithm and interface demands of various position encoders, FPGAs and external ADCs were needed to implement the fast current loop. However, with the advent of latest C2000 Delfino and Piccolo family of microcontrollers, it is now possible to replace FPGAs and external ADCs with these MCUs for a cost effective solution. This paper outlines the implementation of fast current loop on a C2000 platform running two motors, and verifies the frequency response of the control loops using TI’s Software Frequency Response Analyzer (SFRA) software library. Dynamic frequency response analysis in real-time on a motor drive system is unique among MCU suppliers and is currently capable only on C2000 MCUs.

Using the released FCL algorithm for this device and the Software Frequency Response Analyzer (SFRA) library for C2000 MCUs from TI, the control bandwidth of fast current loop and the operating speed range of motor are experimentally verified. This design guide documents the test platform setup, procedure and the quantitative results obtained. It is important to note that when the PWM carrier frequency is 10 KHz, the current loop bandwidth obtained is 5 KHz for a phase margin of 45° over a wide speed range. Compared to the traditional MCU based systems, FCL software can potentially triple a drive system’s torque response and double its maximum speed without increasing the PWM carrier frequency.

The Delfino F2837x and Piccolo F28004x series of C2000 microcontroller enable a new value point for dual-axis drives that also delivers very robust motion-control performance. The value comes not only from the achievable control performance and ability to drive two motors concurrently, but also from the high degree of on-chip integration of other key electronic system functions. Since both F2837x and F28004x devices support CPU and CLA cores, CPU offload encoder-feedback and torque control processing to the control law accelerator (CLA) to maximize the performance of dual-axis servo drive.

1.1 Acronyms and Descriptions

2 Benefits of the C2000 for High-Bandwidth Current Loop

The C2000 family of MCUs possesses the desired computation power to execute complex control algorithms along with the correct combination of peripherals such as ADC, enhanced pulse width modulator (ePWM), enhanced quadrature encoder pulse (eQEP) and enhanced capture (eCAP) to interface with various components of the digital motor control (DMC) hardware. These peripherals have necessary hooks to provide flexible PWM protection, such as trip zones for PWMs and comparators.

Both F2837x and F28004x MCUs contain additional hardware features such as the following:

• Higher CPU and control law accelerator (CLA) clock frequency
• Parallel processing floating point core (CLA) augmenting the main CPU
• Trigonometric Math Unit (TMU) to support high speed, precision trigonometric and math functions
• Four high speed precision 12bit and 16bit ADCs on F2837x, or three high speed precision 12-bit ADCs on F28004x.
• Configurable Logic Blocks (CLB) - using PM library from TI, a range of absolute encoders can be interfaced

Together, these features provide enough hardware support to increase computational bandwidth per CPU core compared to its predecessors and offer superior real-time control performance. In addition, the C2000 ecosystem of software (libraries and application software) and hardware (LAUNCHXL-F28379D, LAUNCHXL-F280049C, BOOSTXL-3PhGaNInv) help to reduce the time and effort needed to develop a high-end digital motor control solution.

3 Current Loops in Servo Drives

Figure 1 shows the basic speed control block diagram of a field oriented control (FOC) based AC motor control system used in servo drives. The current loop is highlighted here because this is the inner most loop and has a higher influence on the bandwidth of the outer speed and position loops. For the outer loop to have a higher bandwidth, the inner loop must have a far higher bandwidth, typically more than three times.

Figure 1. Basic Scheme of FOC for AC Motor

In the current loop, any two of the motor phase currents are measured, while the third can be estimated from these two sensing currents. These measurements feed the Clarke transformation module. The outputs of this projection are designated I_α and I_β. These two components of the current along with the rotor flux position are the inputs of the Park transformation, which transform them to currents (I_d and I_q ) in D-Q rotating reference frame. The I_d and I_q components are compared to the references I_dref (the flux reference) and I_qref (the torque reference). At this point, the control structure shows an interesting advantage; it can be used to control either synchronous (PM) or asynchronous (ACIM) machines by simply changing the flux reference and obtaining the rotor flux position. In the synchronous permanent magnet motor, the rotor flux is fixed as determined by the magnets, so there is no need to create it. Therefore, when controlling a PMSM motor, I_dref can be set to zero, except during field weakening. Unlike PM motor, ACIM motors do not have a rotor flux by default. Since the flux need to be created, the flux reference current must be greater than zero.

The torque command I_qref can be fed from the output of the speed regulator. The outputs of the current regulators are V_dref and V_qref. These outputs are applied to the inverse Park transformation. Using the position of rotor flux, this projection generates V_αref and V_βref, which are the components of the stator vector voltage in the stationary orthogonal reference frame. These components are the inputs of the PWM generation block. The outputs of this block are the signals that drive the inverter.

Both Park and inverse Park transformations need the rotor flux position. Obtaining this rotor flux position depends on the choice of AC machine observer in sensorless control or the position encoder in the case sensored control.