基于FPGA机载三轴伺服控制平台的设计优化

2018-10-08 15:04:09 来源:21ic
标签:

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

 

1 总体方案

FPGA(Field-Prograromable Gate Array,现场可编程门阵列)是在PAL,GAL,CPLD等可编程器件的基础上进一步发展的产物。FPGA采用了逻辑单元阵列LCA(Logic Cell Array)这样一个概念,内部包括可配置逻辑模块CLB(Configurable Logic Block)、输出输入模块IOB(Input Output Block)和内部连线(Interconnect)三个部分。可以说,FPGA芯片是小批量系统提高系统集成度、可靠性的最佳选择之一,因此在设计中采用FPGA为控制核心。FPGA的基本特点主要有:采用FPGA设计ASIC电路,用户不需要投片生产,就能得到可用的芯片;FPGA可做其他全定制或半定制ASIC电路的中试样片;FPGA内部有丰富的触发器和I/O引脚;FPGA是ASIC电路中设计周期最短、开发费用最低、风险最小的器件之一;FPGA采用高速CHMOS工艺,功耗低,可以与CMOS、TTL电平兼容。

 


整个控制器由控制和驱动两部分组成,其结构如图1所示。控制部分由FPGA及一些附件组成,该控制器能够独立完成三轴控制器的电机驱动波形发生、闭环运算与控制、与上位机通信等任务,附件主要用来完成电枢电流的反馈等功能。驱动模块由光电耦合器件和放大驱动芯片等组成。该控制器的最终控制目标为对驱动三轴的力矩电机进行高精度定位与驱动。力矩电机的位置和速度反馈由光电编码器实现。

 

由于本控制器所应用的机载平台为三轴结构,因此,控制器采用独立式控制,即每个轴都具有图1所示的控制功能,三个相对独立的分控制器组成整体的三轴控制器。该基于FPGA的三轴伺服控制器的基本控制方案就是这种反馈式的高精度控制,其中速度环使用PD控制算法,位置环使用PID控制算法。调整PID参数,通过控制电压来控制跟踪瞄准精度,使得跟踪瞄准精度逐渐提高,达到所需盼精度要求。

 

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

 
关注与非网微信 ( ee-focus )
限量版产业观察、行业动态、技术大餐每日推荐
享受快时代的精品慢阅读
 

 

继续阅读
FPGA到底是啥?
FPGA到底是啥?

今天在群里有工程师问我,怎么才叫学会了FPGA,怎么才叫学好了FPGA?我相信有很多朋友有类似的问题,因为在多数人的潜意识里,FPGA是非常高深莫测的技术,能够玩转FPGA的都是大神级的人物。

挖掘机和它的控制器与MCU编程

最近的时间都浪费在两台小松PW128UU-1上面.旧的一台拆了变速箱,装上去以后就变得换挡不行了.新的一台一直都不行,弄过液压泵以后下部分的行走又出现一时正常一时不动的情况.

掌握这五大方法,让你的MCU轻松低功耗

低功耗是MCU的一项非常重要的指标,比如某些可穿戴的设备,其携带的电量有限,如果整个电路消耗的电量特别大的话,就会经常出现电量不足的情况,影响用户体验。

你对ARM了解多少?

全世界100多家公司购买了ARM授权,包括三星,Freescale、NXP Semiconductors、STMicroelectronics、Texas Instruments ,Toshiba,Analog Device,atmel,microsemi...具体参看ARM官网

选择合适的“连接器”其实非常伤脑!
选择合适的“连接器”其实非常伤脑!

如果你工作的地方只有一个饭馆,吃饭是件很自然的事情,去吃就好了。当你的周围有几十家饭馆的时候,你每天最困扰的就变成了“我今天要吃什么呢?”

更多资讯
简单几步让你看懂单片机时序图

操作时序永远是使用任何一片IC芯片的最主要的内容,看懂时序图,再操控这个芯片就非常容易了。而提取芯片器件手册上有用的信息是使用芯片的最基本步骤。

如何实现SoC全生命周期的监测?

SoC的设计越来越复杂,上市时间、软硬件集成、系统级验证、系统性能、异构、网络安全/功能安全等都是设计人员需要考虑的因素。流片前,设计师能通过仿真软件进行验证,但是流片过程中很多意想不到的结果,需要在流片后仍能被准确的检测出来。

如何将单片机的波特率作为形参的函数

不管是什么单片机,在使用串口通信的时候,有一个非常重要的参数:波特率。什么是波特率:波特率就是每秒传送的字节数。双方在传输数据的过程中,波特率一致,这是通讯成功的基本保障。

代码分享教你如何使用msp430单片机延时函数

今天看示例程序中出现了__delay_cycles()这个函数,在查找msp430x54x.h这个头文件的时候,发现这个头文件中没有该函数的声明,原来这个函数已经在IAR这个编译器中集成,这里总结一下__delay_cycles();这个函数的具体用法

如何控制51单片机液晶实现计时器的功能?

要想实现人机交互,显示装置是不可缺少的。前面讲到了如何利用单片机控制数码管的显示,这篇文章主要关于如何控制液晶显示,并在此基础上加上定时器的功能,把原来已用数码管显示的定时器搬到液晶屏上来。

Moore8直播课堂
电路方案