基于FPGA的步进电机正弦波细分驱动器设计.docx

《基于FPGA的步进电机正弦波细分驱动器设计.docx》由会员分享，可在线阅读，更多相关《基于FPGA的步进电机正弦波细分驱动器设计.docx（12页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、基于FPGA的步进电机正弦波细分驱动器设计步进电机是一种将电脉冲信号转换成相应的角位移或者线位移的机电元件，具有构造简单巩固耐用工作可靠的优点因此广泛应用于工业控制领域。由于脉冲的不连续性又使步进电机运行存在很多缺乏之处，如低频振荡、噪声大、分辨率不高及驱动系统可靠性差等，严重制约了其应用范围。步进电机的细分控制有效地解决了这一问题，但是传统的步进电机驱动系统大多数采用的是用单片机作为控制芯片，外加分立的数字逻辑电路和模拟电路构成。受单片机工作频率的限制，细分数不是很高，因此驱动器的控制精度较低，控制性能不是很理想。随着高性能数字信号处理器DSP的出现，以DSP为控制核心，以软件方式实现电机控

2、制一度成为研究的热门。近年来随着可编程逻辑器件的飞速开展，使得可编程逻辑器件功能越来越强大进而促使高集成化高精度驱动器的出现。因此本文提出了一种基于SOPC片上可编程的全数字化步进电机控制系统，本系统是以FPGA为核心控制器件，将驱动逻辑功能模块和控制器成功地集成在FPGA上实现，充分发挥了硬件逻辑电路对数字信号高速的并行处理才能，可以使步进电机绕组电流细分到达4096，且细分数可以自动调节，极大地进步了控制精度和驱动器的集成度，减小了驱动器体积。2步进电机细分驱动原理步进电机的细分控制本质上是对步进电机励磁绕组中的电流进展控制，在普通驱动方式下，驱动电路只是通过对电动机绕组激磁电流的“开和“

3、关，使步进电动机转子以其本身的步距角分步旋转。步进电动机靠定子、转子磁极间的电磁力来进展工作，当它处于“双拍状态工作时，其定位位置是正好位于两通电磁极的中间，即依靠两通电磁极电磁吸引力的平衡而获得的。由此可以推论:假如可以进一步仔细地控制两磁极电磁吸引力的大小，使转子磁极获得更多种由于两相定子磁极的电磁吸引力差异而形成的平衡定位位置。步进电机细分驱动方式就是应用了这一原理，在细分驱动时，细分控制器通过控制各相激磁绕组电流的逐步增大及逐步减小，让转子处于多个磁力平衡状态使电机内部的合成磁场为均匀的圆形旋转磁场，实现步距角变小、电动机的旋转得到细化的目的。合成的磁场矢量的幅值决定了电机旋转力矩的大

4、小，相邻两个合成磁场矢量的夹角大小决定了该步距角的大小。对于三相步进电机而言，向A、B、C绕组分别通以相位相差2/3，而幅值一样的正弦波电流图1，那么合成的电流矢量在空间做幅值恒定的旋转运动，其对应的合成磁场矢量也作相应的旋转进而形成旋转力矩图2。细分驱动方式下，由于步距角小，步进电机的控制精度明显进步，同时这种驱动方式又有效抑制低速运行中产生的噪声和振荡现象。3控制器总体设计方案步进电机三相绕组的电流是正弦阶梯电流，通过改变给定电流的每一次变化的阶梯数可以实现可变细分功能。驱动器的任务就是控制绕组的电流，使之按正弦阶梯波的规律变化。每给一个步进脉冲，A、B、C三相绕组的电流沿正弦阶梯波前进一

5、步，电机转动一个步距角。步进电动机驱动主回路图如图3所示IA、IB为两个霍尔元件。图中6个IGBT集成在电源控制模块IPM内。align=center图3步进电动机驱动主回路图/align步进电机控制系统框图如图4所示。采用FPGA作为主控制芯片,将控制器与驱动器的数字电路局部集成在一片FPGA上实现。为了控制绕组电流，在设计中引入电流跟踪型闭环反应，反应电流与给定的正弦电流离散的正弦表经过改良的比例积分PI调节后进展SPWM调制，输出6路PWM波，来控制驱动电路三个桥臂上的6个IGBT开通关断。假如忽略死区时间控制每个桥臂的上下半桥的两路PWM波互补即上半桥PWM波为高/低电平时，下半桥PW

6、M波为低/高电平。系统采用14位宽度200MHz计数器产生PWM载波，载波频率12.2KHz，电流数据全部采用14位精度进展离散化。200MHz时钟由50MHz时钟经PLL倍频产生。FPGA输出的PWM波经功率模块放大后，控制步进电机运行。步进电机运行状态转速和转向通过LED指示。步进电机转速是由查表速度决定的，CP是用来决定查表频率，在细分等级一定的情况下CP速度越高电机转速越快。假如电机在高细分下高速旋转那么CP脉冲频率就会很高，导致PWM脉宽过小，使功率模块IGBT控制桥臂频繁开关，其结果是开关损耗大为增加，功率模块过热。而高细分在步进电机高速旋转时其上风并不明显，所以在不影响电机运行精

7、度的情况下，系统根据转速对细分精度在4096、2048、1024、512、256、128、64、32之间自动调节，使电机更加平稳可靠的运行。align=center图4控制系统框图/align3.1FPGA构造设计本系统是由集成在系统采用层次化开发方式，顶层模块由多个子模块组合而成，FPGA设计系统框图如图5所示。系统由NiosII微处理器模块和数字逻辑模块组成。align=center图5FPGA设计系统框图/align控制器采NiosII的32位CPU软核，由SOPCBuilder生成。用来接收外界控制信号并把信号处理后送给脉冲发生器，并通过输出端口控制LED来指示系统工作情况。系统顶层设

8、计图如图6所示，系统由CPU软核stepmotor_controller、CP发生器PatternGenerator、正弦查表控制模块interface、A/D电流采样模块currenttop、C相电流计算模块Current_c调节模块、PI调节模块pimodule、PWM发生模块PWM组成，各模块功能如下：CPU：承受外界控制信号把信号处理后得到相应的细分等级和与速度对应的控制信号送给CP发生器，把转向信号处理后送到查表控制模块,并把转速和转向信号送到LED数码管和发光二极管来指示电机运行情况；CP发生器：承受转速控制信号发出与转速相对应的CP脉冲并给出相应转速下对应的最正确细分等级；正弦查

9、表控制模块：根据CP脉冲和细分等级进展查表产生参考电流，根据转向控制信号来决定查表方向来实现转向控制；A/D电流采样模块：收集步进电机A、B两相电流值；C相电流计算模块：根据基尔霍夫电流定律A、B、C三相电流之和为零，由A/D收集的A、B两相的电流计算出C相电流；PI调节模块：将参考正弦电流与反应电流差值进展PI调节，把调节后的控制信号，为了防止IPM内上下半桥的IGBT同时导通，导致IPM短路，PI模块内设置的了死区时间。align=center图6系统顶层设计图/align顶层接口讲明：AD_in_a、AD_in_b是AD1674转换输出的数字信号；AD_CE、AD_RD、AD_STS为A

10、D的控制信号；clk、reset分别为系统时钟输入端口和系统复位端口；enable端口是PWM发生器使能端，功率模块温度过高热保护就会动作将enable置0停顿发出PWM波，保护驱动器；setspeet、rotate_dirc分别为转速和转向控制端口；led_sel、speeddisplay、led_indicator为工作情况指示电路；pl_a、ph_a、pl_b、ph_b、pl_c、ph_c为A、B、C三相桥臂的上下半桥控制端；3.2NiosII软核设计在本控制器中利用CPU控制灵敏的功能用来承受并处理外界控制号再将处理过的控制信号送到各个功能模块，因此NiosII软核采用了经济型即Nio

11、sII/e，参加了用于输入输出端口PIO、片上存储器模块OnchipMemory。控制器程序流程图软件程序工作流程如图7所示。align=center图7CPU控制流程图/alignCPU内部程序采用C+语言编写，并对电机的控制状态建立类。通过对电机的控制状态对象的操纵，即可输出各种控制命令到接口模块和CP脉冲发生模块，控制电机状态；同时在程序主循环中监视用户的各种输入，更新电机的控制状态对象的成员变量。3.3CP发生器模块和查表控制模块PatternGenerator模块根据设置的电机转速产生相应的CP脉冲和在该转速下的最适宜的细分等级，并把这些信号传送给查表控制模块。CP发生器模块和查表控

12、制模块如图8所示。align=center图8CP发生器模块和查表控制模块/align查表控制模块interface内部例化了一个只读存储器，存放一个周期的正弦数据表。正弦表数据宽度与系统数据流数据宽度一致，因此选择14位宽度。正弦表深度决定了驱动器的最大细分等级，关系式表示为：NMAX=2N，当N=12时，到达最高细分等级4096细分。外部输入CP和CCW信号后，通过顺序的给出三相绕组对应的地址数据，即可查得三相相电流的给定数据，并同时更新三个给定数据存放器，送入下一个环节。转向交换也在本模块实现。输入的CCW信号将控制一个路选择器，控制正弦表的查表方向来改变步进电机转向。本模块通过输入的细

13、分等级信号和CP脉冲信号共同决定三相绕组的地址数据的每次增量大小。当细分等级最高时，地址计数器每次增1或者减1；当处于非最高细分精度时，地址计数器每次递增2的N次幂，N由当前的细分等级确定。3.4AD采样模块与C相电流计算模块步进电机A、B两相电流通过霍尔元件进展收集，AD采样模块通过收集采样电阻上的电压来将电机A、B两相电流的模拟量转换为数字量，C相电流模块由基尔霍夫电流定律ia+ib+ic=0计算得到。图9为两模块的端口。align=center图9AD采样模块与C相电流计算模块/align3.5PI调节模块PI调节模块是对给定数据和反应数据进展离散化PI调节。模块的数据宽度统一为14位，

14、即给定数据/反应数据/控制数据都用14位宽度无符号整型数据表示。本模块实现一个PI控制器功能，如图10所示。align=center图10PI控制逻辑框图/alignPI调节离散化公式如4式所示。IK=IK-1+KPEK-EK-1+KIEK4其中，1500IK14384，I0=8192，EK=IREF-IOUT模块在收到启动信号后，先存放给定数据/反应数据，再对二者扩宽符号位做有符号减法，并启动KI乘法器计算KI乘以误差e的结果。对减法的计算结果取绝对值，并与阀值作比拟常数比拟器，比拟的结果存入存放器。计算e的误差增量，即EK-EK-1，并用KP乘法器计算KP乘以误差增量的结果。将KI乘法器计

15、算的结果先送入累加器，然后再将KP乘法器计算的结果送入累加器；模块的累加器在每次累加的时候会进展溢出处理和数据超出边界处理，无论哪种情况都会置为边界值最大/最小值。3.6PWM发生器模块PWM发生器模块将PI调节后输出的数据转化为PWM波形输出给IGBT模块，通过IGBT的通断切换调整相电压，进而改变相电流按照给定进展变化。PWM波形的生成是通过将给定控制数据和载波数据比拟，通过比拟二者大小情况确定PWM的上下电平，实现PWM调制，如图11所示。align=center图11PWM模块总体框图/align锯齿波作为PWM载波，驱动时钟频率为200MHz，14位存放器宽度。为减少计数器的进位链长

16、度，采用计数器，拆分为3位计数器和11位计数器，减少了组合逻辑延迟。死区保护发生器模块根据给定的死区长度数据，将输入的PWM信号输出为PH和PL信号，分别对应IGBT的上下桥臂，并在PH和PL数据的变沿插入死区保护同时置为低电平。插入的死区保护是通过上升计数器和下降计数器来实现的，保证上桥臂和下桥臂不同时导通。4仿真结果对PWM模块进展功能仿真，仿真波形如图12所示。经分析，六路PWM波知足时序和死区保护的要求，实现了设计所要到达的目。将图12进展放大可见IGBT死区如图13所示。 align=center图15步进电机反转时电流波形/align实验结果说明步进电机运行时三相电流相位差120度，三相电流为正弦波，电机运行平稳，电机反转时进展反相查表，转换方向时反响时间短，电流波动小。6结论本控制器采用Altera公司嵌入NiosII处理器软核的FPGA实现了步进电机正弦波可变细分控制，大大进步了系统的可靠性，降低了设计本钱。控制局部采用NiosIICPU软核是系统控制更加方便灵敏。CPU和各个控制模块集成在单片FPGA内，使驱动器集成度大为进步，减小了驱动器的体积。大大进步了细分精度，实现了步进电机在是低转速下的4096高细分的运行，消除了步进电机存在的低频振荡问题，控制精度显著进步，在高精细数控机床中有广泛的应用前景。0