EEPW论坛

目前伺服控制器的设计多以DSP或MCU为控制核心，但DSP的灵活性不如FPGA，且在某些环境比较恶劣的条件如高温高压下DSP的应用效果会大打折扣，因此以FPGA为控制核心，对应用于机载三轴伺服控制平台的控制器进行了设计与优化。

2 控制器硬件与软件的设计与实现
本伺服控制器以FPGA为核心，在硬件设计中主要进行了驱动模块设计、控制模块设计和通信模块设计。驱动模块能够根据外部给定的驱动角度产生驱动信号，控制模块则能够对光电编码器测得的角度信号和速度信号进行分析、反馈及运算，最终给出PWM脉宽值驱动整个系统，在这期间还需要功放的放大作用，而通信模块的主要功能是实现与上位机的有效通信，并能够实现控制器的在线编程功能和上位机对三轴系统中力矩电机的远程控制功能。
驱动模块主要包括控制波产生单元、力矩电机光电编码器信号采集与处理、可编程死区发生器等部件。驱动模块中的信号功率放大部分和隔离措施的应用也是该部分中的重要设计内容，在此设计中功率放大采用普通的晶体管放大电路，而光电隔离器件的应用能够有效防止强电模块对弱电部分的影响。在驱动模块中辅助芯片采用可编程器件EPlK30QC208，它采用可重构的CMOS SRAM工艺，把连续的快速通道与独特的嵌入式阵列(EAB)相结合，同时结合众多可编程器件的优点来完成普通门阵列的宏功能，主要完成伺服控制器的各种硬件逻辑接口功能。 EPlK30QC208主要完成4个接口的逻辑功能，即：主机接口、D/A接口、码盘接口、I/O接口。D/A转换器件采用双通道DAC芯片DAC5573，相对TLC2543来说，硬件的连接简单很多，因为它采用标准的I2C总线，同时S3C4510里包含I2C的控制器，所以DAC5573只需接到4510的SDA和SCL这两个引脚，就可以实现两者之间的通信。需要注意的是，SDA和SCL这两个引脚需要上拉电阻值为10 kΩ的电阻来确保I2C总线能够释放出来。 控制模块方面速度环节和位置环节分别采用PD和PID控制。因此在控制器设计中需要在这方面有所体现。由于本控制器以控制直流力矩电机为最终目的，因此在控制模块的设计方面需要研究力矩电机的驱动及其电压值获取。在本控制器设计过程中需要对上述各项进行综合控制与处理，以达到合理地控制开销和控制精度的平衡。在三轴伺服装置中选用PID控制算法。引入通常的PID控制算法，并考虑功率放大、位置检测环的增益和速度环的PD控制算法，给定三轴电枢电压。 
在控制模块的设计中速度与位置调节的是整个控制的主体，本伺服控制器完成输入信号与输出信号的比较，再通过位置校正、速度校正、机械谐振校正之后，校正后的信号控制PWM发生器的占空比，具有一定占空比的PWM信号控制PWM功率级，进而驱动被控对象。如此就可以得到本伺服控制器在反馈环节中所需要的力矩电机位置信息，利用该位置信息对三轴平台实现高精度控制。
基于FPGA的三轴伺服控制器的通信模块设计在硬件设计中也占有很大的比重。整体的通讯设计接口采用基于RS232的通用串口通信方式。采用这种接口方式能够在满足系统现场编程通信的同时满足系统的远程通信要求。该通信模块采用一个带有UART口的MCU，由于该MCU的数据都是立即数，在运行过程中并没有取数据操作，因此设计的流水线结构采用三级结构，分别为取指令、译码和指令执行。而MCU的指令地址则由程序计数器给出。在通信模块的设计主要考虑的是正常上位机通信的进行和远程监控通信的有效实施。该设计采用了双PC设计，这样能够极大地减少复位时间，使上述MCU不会因为外界的干扰而错误地执行指令，这样就能提高系统的可靠性。
本三轴伺服控制器的硬件设计需要配合软件才能有效运行，该控制器软件设计的主要任务是：完成对接口的初始化;上位机能够对独立控制三轴的伺服控制设备进行指令控制;对于光电编码器反馈的速度信号和位置信号进行读取和分析处理;根据反馈的数据和外部的腔制命令完成整个控制系统的闭环控制。其具体的主程序控制流程图如图2所示。
本控制器软件的关键是PWM信号的设定与输出，一方面要考虑外部的输入角度，另一方面要考虑系统的反馈。要实现高精度的三轴定位，必须有一套合理的信号产生机制。系统的中断设计也是本控制器的重要研究内容，因为本控制器采用相对独立的三轴控制方式，在保证各轴独立运行的同时要兼顾到整体的运行情况，且在运行过程中一旦某一部分出现问题，其他所有的部分都要同时采取一定的措施解决这个问题。限于篇幅，本文并未列出该三轴伺服控制器的软件程序。

3 性能测试
为了验证所设计的三轴伺服控制器的有效性，对基于FPGA的控制、通信等模块进行了基于软件的Modelsim的仿真测试。首先进行了该控制模块的单次运行时间，本三轴伺服控制器的单次运行的平均时间为483ns，这种结果基本满足了该控制平台的实时性要求。系统的通信功能测试主要针对控制器的在线编程和上位机远程控制进行。以普通笔记本作为上位机，采用串口通信软件与该控制器进行通信，完成系统的三个力矩电机的启动、加速、调速、换向、制动等功能。控制器参数的在线编程也完全能够满足。
在性能测试方面还进行了该控制器的调速性能测试、及时中断性能测试、故障自动报警与处理性能测试、三轴综合配合高精度定位测试等一系列测试。从仿真测试结果上看，所设计的基于FPGA的三轴伺服控制器基本能够满足该机载平台的要求。

4 结语
以FPGA作为控制核心对某机载三轴运动平台的伺服控制器进行设计，主要对其硬件中的控制、驱动、通信模块进行了设计，同时给出了其软件控制流程和部分中断、复位等软件程序。通过后续的仿真测试验证了该控制器的有效性。