DSP+FPGA四轴运动控制器方案与对策

DSP+FPGA四轴运动控制器设计方案

引言

运动控制技术是制造自动化的关键基础，其水平高低是衡量一个工业现代化的重要标志，研究和开发具有开放式结构的运动控制器是当前运动控制领域的一个重要发展方向。设计了一种基于DSP与FPGA的运动控制器。该控制器以DSP和FPGA为核心器件，针对运动控制中的实时控制、高精度等具体问题，规划了DSP的功能扩展，并在FPGA上扩展了功能相互独立的四轴运动控制电路。该电路实现了四路控制信号输出，四路编码信号的接收和处理，以及原点信号，正负限位信号等数字量的接收和处理。具有结构简单、开放性、模块化等特点，能够较好的满足运动控制器的实时性和精确性。

1 系统概述

该四轴运动控制器系统以TI公司C2000系列DSP芯片TMS320F2812和ALTERA公司CycloneⅡ系列FPGA芯片EP2C8F256C6为核心，DSP通过网口接收上位机的控制参数，完成系统位置、速度控制及运动轨迹规划;FPGA完成运动控制器的精确插补功能和外围电路的扩展，系统总体框图如图1所示。

运动控制器的主要功能包括：4路模拟电压输出，电压围为-10～+10V，分辨率为16b;4路脉冲量信号输出;4路脉冲方向信号输出;4路驱动复位信号输出;4路驱动使能信号输出;4路差分编码信号输入;4路驱动报警信号输入;8路正负限位信号输入;4路原点信号输入;16路通用数字量。I/O。

2 DSP模块设计

DSP根据从上位机接收的运动模式和运动参数实时计算规划位置和规划速度，生成所需的速度曲线，实时的输出规划位置。TMS320F2812是TI推出的一款专门用于电机控制的32位定点DSP芯片，采用高性能静态CMOS技术，主频高达150MHz（指令周期6.67ns），低功耗，核心电压为1.8V，I/O电压3.3V，支持JTAG边界扫描，128K×16b的片FLASH。有两个事件管理器（EVA和EVB），它们都是特定的外围设备，为多轴运动控制器而设计的。可通过外部存储器接口XINTF扩展外部存储器。DSP外围模块设计如图2所示。

为增强抗干扰性，DSP通过以太网控制器RTL8019AS与上位机连接，RTL8019AS部含有一个16KB的SDRAM，DSP通过外部存储器接口对其进行读写来接收上位机的命令或向上位机传送反馈信号。在数据处理过程中要占用大量的存储空间，DSP部仅含有18K×16b的SARAM 和128K×16b的FLASH，存储空间显得过小，所以通过外部接口扩展了256K×16b RAM和512K ×16b FLASH，RAM和FLASH芯片分别选择IS61LV25616 AL、SST39VF800，它们都具有接口简单、读写速度快等优点。SCI模块用于扩展RS 232串行通信接口，串口芯片使用MAX3232。

运动控制器所需电压为5V，3.3V，1.8V，1.2V。输入电压5V，分别采用稳压芯片

LM1085IS3.3，LM1117-1.8将其转换成3.3V和1.8V，由于TMS320F2812的I/O电压3.3V

要先于核电源上电，所以1.8V要由3.3V降压得到，以确保上电次序。1.2V是FPGA核所需电压，由稳压芯片LM317S稳压得到，LM317S的输出电压围为1.2～25V，复位电路采用SP708低功耗微处理器监控器件，此器件有众多的组件，有效的增强了系统的可靠性及工作效率。

3 FPGA模块设计

FPGA用于轴资源的扩展，当接收到DSP中的规划位置后，在轴资源中对其进行变换处理，输出到伺服控制器中，伺服控制器将规划位置与编码反馈的计数位置进行比较，获得跟随误差，并通过伺服控制算法得到实时的控制量，将控制量传递给D/A转换器，由D/A转换器转换成控制电压输出。

EP2C8F256C6是ALTERA公司CycloneⅡ系列芯片，其特点为高性能低功耗，核供电电压为1.2V，8256个逻辑单元（LEs），182个用户I/O口（项目中使用了157个I/O口），165888b 的部RAM，嵌入了18b的乘法器，每个乘法器又可拆成2个9b的乘法器，芯片部含有2个锁相环（PLL），8个全局时钟（Global Clocks）。该芯片所具有的逻辑单元数、频率和用户I/O口等都能很好的满足设计需求。FPGA的外围模块扩展如图3所示。

3.1 与DSP接口设计

DSP芯片的事件管理器（EVA，EVB）用于和FPGA连接，当输出脉冲量控制驱动器时，DSP使用两个事件管理器进行PWM波的控制，当输出模拟量时，DSP使用GPIOA/GPIOB向FPGA 输出规划位置。

3.2 模拟信号输出电路设计

采用D/A转换器AD669进行模拟信号的输出，AD669具有两级锁存，在设计中，将其四路D/A芯片的第一级锁存处于透明状态，第二级锁存控制信号LDAC连在一起，当四路D/A 芯片的数据预装好后，打开第二级锁存，四路D/A芯片即可同时转换，实现了四轴驱动的同时控制。

3.3 脉冲信号输出电路设计

脉冲输出电路由FPGA部精插补器完成，精插补器根据DSP发送来的粗插补数据产生均匀的脉冲输出，脉冲的输出有两种格式：“脉冲+方向”和“正负脉冲”。由于差分信号对外部电磁等信号有很好的抗干扰性，特别是对共模干扰有很好的抑制作用。所以脉冲经过光耦隔离后，再将信号接入差分线驱动器AM26LS31后输出，差分线驱动器AM26LS31的作用是将输入的单极性方波信号转化为一对极性相反的电机驱动信号。

3.4 编码反馈电路设计

电机编码信号直接传入电机驱动器中，电机驱动器将三对差分编码信号A+，A-，B+，B-，N+，N-作为反馈传给运动控制器。在电机旋转时，所发出的编码信号会出现非常多的毛刺，并且经过驱动器大电源的干扰，如果直接接到FPGA中，可能会引起误判断，所以先将

三对编码信号经过差分芯片AM26LS32转化成单路信号A，B，N后再接入FPGA中。芯片

AM26LS32功能是将输入的一对极性相反的编码器差分信号转化成单极性的脉冲信号，与

AM32LS31正好相反。

3.5 开关量接口和通用I/O电路设计

输出信号包括复位信号和使能信号，由FPGA产生，经光耦隔离后直接输出;输入信号包括驱动报警信号，正负限位信号和原点信号，这些信号经光耦隔离、电平转换后再由FPGA 接收，当FPGA检测到这些信号后，确定具体的触发信号，做出相应的反应。另外运动控制器还提供了八路数字量输入通道和八路数字量输出通道，输入、输出通道都经光电隔离，以提高抗干扰性。

4 网口模块设计

DSP通过以太网控制器RTL8019AS与上位机连接，RTL8019AS在一块芯片上集成了

RTL8019AS核和一个16KB的SDRAM存储器，兼容RTL8019AS控制软件和NE20008b或16b传输，其接口符合Ethernet2和IEEE802.3标准。RTL8019AS与主机的接口模式有三种模式：跳线模式，PnP模式，RT模式。此运动控制器使用便于DSP应用的跳线模式。DSP与RTL8019AS 的连接如图4所示。

（1）数据总线和地址总线。RTL8019AS的数据总线和DSP的16位数据总线直接相连即可。RTL8019AS片NE2000寄存器组都是通过其映射I/O端口进行访问，I/O端口共32个，地址偏移量为00H～1FH，把I/O基地址设为300H，则对应的I/O端口寻址围为：300H～31FH。只需要10根地址线就可以对I/O端口进行寻址，把SA10～SA19接低电平，SA0～SA9按照表1接法即可。

由表1可以看出，只需要5根地址线就可以寻址32位I/O端口，所以可以直接把SA9，SA8接高电平，SA5～SA7接低电平，SA0～SA4与DSP的低5位地址线XA0～XA4相接。