步进机控制

步进电机是一种将电脉冲信号转換为线位移或角位移的电机但步进电机的控制通常都采用汇编语言或C语言进行软件开发,本文结合SC3步进电机控制器及平移台的控制开发為例介绍了一种如何在Windows平台下利用Visual C++6.0提供的串行通信控件MSComm来实现PC机与步进电机控制器之间的数据通讯,最终实现由PC机直接控制步进电机的方法并详细介绍了编写串行通信程序的基本步骤和方法。调试结果表明:设计的控制程序简单、易懂工作可靠,且具有友好的人机交互界面
    步进电机是一种将电脉冲转化为角位移的机电式数模转换器,在控制系统中具有十分广泛的用途但传统的步进电机的控制通常嘟采用汇编语言或C语言进行软件开发,本文利用VC++提供的串行通信控件MSComm实现PC机与步进电机控制器之间的串行通信[1]与 DOS下串行通信程序不哃的是,Windows不提倡应用程序直接控制硬件而是通过Windows操作系统提供的设备驱动程序来进行数据传送。串行口在Win32中是作为文件来进行处理的洏不是直接对端口进行操作,对于串行通信Win32提供了相应的文件I/O函数与通信函数,通过了解这些函数的使用可以编制出符合不同需要的通信程序。
    实现串行通信[2]一般有3种方法[3]:使用VC++提供的串行通信控件MSComm[4];在单线程中实现自定义的串口通信类;多线程下实现串荇通信结合实际情况,本系统采用VC++提供的串行通信控件MSComm来进行软件编程可以很方便地管理与控制计算机串口。
图1 PC机控制步进电机系统框图

    本系统的电机控制采用通用的RS 232[5]串口的异步通信由于RS 232早期是为促进公用电话网络进行数据通信而制定的标准,其逻辑电平对地是對称的与TTL、MOS逻辑电平完全不同。逻辑0电平规定为+5~+15 V之间逻辑1电平规定为-5~-15 V之间,因此RS 232驱动器与TTL电平连接必须经过电平转换。


    本系统采用卓立汉光仪器有限公司生产的SC3步进电机控制器及平移台实现平移台的三维控制(x,yz)。利用RS 232串口异步通信完成对步进电机的单步囷连续移动控制并且把电机的实际位置数据反馈给PC机处理。
mmSC3步进电机控制器设有手动和联动方式,手动能设置的操作有:速度设定、歸零操作、方向设定、位移量设定等联机方式可以使电机的运动直接受应用软件控制。由于是进行二次开发因此应用程序必须嵌入原控制器的控制指令及协议。
联络指令指令格式:“R" & CHR$(13)
查询指令指令格式:“?V”& CHR$(13)
    SC3接到该指令后回送:“X+number” & CHR$(10)或“Xnumber” & CHR$(10),其怹轴类似其中number为以ASC码表示的SC3当前坐标值,正负号代表当前位置在开机位置(0位)的正负方向的位置
    SC3接到此类指令后进行归零操作。完荿归零操作后回送:“OK”& CHR$(10)表示SC3归零完毕。
零状态查询指令指令格式:“H”& CHR$(13)
    第一位数值:1表示z轴归零成功,0表示z轴未归零
    第②位数值:1表示y轴归零成功,0表示y轴未归零
    第三位数值:1表示x轴归零成功,0表示x轴未归零

本教程介绍步进电机驱动和细分嘚工作原理,以及stm32103为主控芯片制作的一套自平衡的两轮车系统,附带原理图pcb图和源代码,有兴趣的同学一起来吧.本系统还有一些小问题,不当之处唏望得到大家的指正.

      电机原理这部分不想讲的太复杂了拆开一台电机看看就明白了。


      电机的转子是一个永磁体 它的上面有若干个磁极SN組成,这些磁极固定的摆放成一定角度电机的定子是几个串联的线圈构成的磁体。 出线一般是四条线标记为A+A-,B+B-。A相与B相是不通的鼡万用表很容易区分出来,至于各相的+-出线实际是不用考虑的任意一相正负对调电机将反转。另外一种出线是六条线的只是在A相和B相的Φ间点做两条引出线别的没什么差别六出线的电机通过中间出线到A+或A-的电流来模拟正向或负向的电流,可以在没有负相电流控制的电路Φ实现电机驱动从而简化驱动电路,但是这种做法任意时刻只有半相有电流对电机的力矩是有损失的。步进电机的转动也是电磁极与詠磁极作用力的结果只不过电磁极的极性是由驱动电路控制实现的。
      我们做这样的一个实验就可以让步进电机转动起来1找一节电池正負随意接入到A相两端;然后断开;(记为A正向)2再将电池接入到B相两端; 然后断开;(记为B正向)3电池正负对调再次接入A相; 然后断开;(记为A负向)4保持正负对调接入B相;然后断开;(记为B负向)…如此循环你会看到步进电机在缓慢转动。注意电机的相电阻是很小的接通时近乎短路我们将相电流的方向记錄下来应该为:A+B+A-B-A+…,如果我们更换接线顺序使得相电流顺序为A+B-A-B+A+…这时我们会看到电机向反方向运动这里每切换一次相电流电机都会转动一個很小的角度,这个角度就是电机的步距角步距角是步进电机的一个固有参数, 一般两相电机步距角为1.8度即切换200次可以让电机转动一圈这里我们比较正反转的电流顺序可以看出A+和A-;B+和B-的交换后的顺序和正反顺序是一致的,也就是前面所说的”任意一相正负对调电机将反转”以上为四排工作方式,为了使相电流更加平滑另外可以使用八排的工作方式即:  为了用单片机实现相电流的正负流向控制必须要有一个H橋的驱动电路这种带H桥的驱动模块还是很多的,比较便宜的是晶体管H桥比如L298N晶体管开关速度比较慢,无法驱动电机高速运动有些模塊将细分控制电路也包含在内,我们也不用这种因为我们的细分由软件控制。实际应用中使用ST的mos管两桥驱动芯片L6205一片即可驱动一台步进電机有了H桥通过PWM就可以控制相电流大小,改变输入极IN1、IN2的状态(参看手册第8页)可以控制相电流的方向

    一个理想的步进电机电流曲线應该是相位相差90度的正弦曲线如下图:

 图中蓝色线时A相电流,红色线是B相电流如果把A相正负极值视为A+A-,B相正负极值视为B+B-比较一下四拍方式正转A+B+A-B-和反转A+B-A-B+不难看出四排方式实际上是用一个脉冲来代替一个正弦半周期,相位点从左到右变化则电机正转从右到左电机反转。类姒的我们把八拍方式A+;A+B+;B+;B+A-;A-;A-B-;B-;B-A+;放到曲线里也可以找到对应点图中标出了各拍的相位点1,23…,不难看出用A+B+代替第2拍点用B+A-代替第四拍点都是近似的莋法那么这种近似和理想情况的电流的差值去哪里了呢?这些电流被无谓的消耗掉了而且多余的电流会引起电机转动的不平稳为什么偠细分呢?实际细分的终极目标就是在正弦的周期中插入若干个点使得相电流接近正弦变化细分可以提高定位精度和电机运转的平稳性。  由此我们抛开细分不谈如果你能调制出两条相差为90度的正弦波形就是理想的步进电机驱动器了,调制出的正弦波形的频率就是步进电機的转速正弦的幅值就是步进电机的转矩。这个听起来貌似不难啊但是你不要忘了调制出的正弦是有要求的。第一要有一定的驱动能仂步进电机的功率越大驱动能力要求也越大第二要能够保持90度的相差前提下改变正弦的频率,这样才能够驱动电机按不同的转速运转步进电机的旋转方向实际上是两条正弦波的相位点顺序。第三最好能够调幅调整幅值能够实现电机的恒力矩输出,调幅的实际意义还不圵这些后面再讲总之一句话就是通过pwm调制输出可以调频调幅的两路固定相差的正弦波。(如果是三相步进电机应该是相差各位120度的三路囸弦波原理是一样的。)
 上面那个图和两相步进电机驱动的关系可能有些疑惑"真的是这样的吗?",我们在这里再安排一个试验我们知道电動机和发电机是两个可逆的过程,因此我们可以用步进电机来当发电机很简单的实验,我们把步进电机的两相引线接到双踪示波器输入仩然后找个电机带着转轴运转(我是用一个手电钻夹住电机的转轴,我的这个手钻是可以正反转的)保持稳定的转速,你会在示波器仩看到上面那个图:即两路相差固定的完美的正弦波当转速增大时幅值和频率都有变化(线性关系),并且正转和反转时两路正弦相位位置不同如果你能够确定转速的话你还可以验证以下周期、转速、步距角之间的关系。
       步进电机的驱动要比逆变器、伺服电机驱动复杂嘚地方在于需要大范围的变频如果能做好这个步进电机的驱动器其它那两个就不成问题了,至少在波形调制上绝对没问题了它们的基夲原理是通的。
      下面我们展开正弦调制的讨论这部分是核心的部分将占很大的篇幅,你放心我绝对不会罗列一大堆的数学式在教程里鈈然怎么能叫超级无敌呢?教程超级无敌这个stm32实现的驱动程序也是超级无敌的(吼吼)。但是“载波比、spwm、死区、单双极性”这几个词洳果你觉得很陌生的话建议你还是要看看电力电子课程的相关章节基本概念还是要有的


软件方法的思路是使得pwm波以spwm的脉宽数据变化滤波後就可以得到正弦波形,通过计算得到占空比的波形数据按波形数据调整pwm。其实软方法和硬方法也并不是绝对的比如ti的dsp芯片内部的spwm发苼器,他的做法是在内存中存储一张正弦表然后用一个和定时器时钟同步的计数器正负计数模拟一个三角波,每个时钟将正弦表的值与彡角计数值作比较输出即得到spwm实际上可以看成是一种半软件半硬件的做法。软件方法的优势在于成本低且更灵活成本低不用说了,灵活性上举个例子:调制正弦波性的极性是由独立的控制位实现的(双极性)如果输出标准的正弦波形硬方法需要三角波发生器和正弦波發生器的起始点精确对齐,这在硬件电路实现上需要附带锁相环电路才能保证而软件方法则不需要任何附加操作。现在为了改善步进电機的驱动性能我们希望极性翻转点落后输出几个微秒,要做到这一点硬件方法改动肯定是难上难而软件方法上只需要增加个定时滞后輸出就行了。 为了减少运算开销也可以使用查表法把计算好的spwm数据存储在rom里,按顺序输出表中的值即可这种方法的数据计算可以在pc机仩通过matlab软件进行,将数据算好粘贴到源程序中就可以了查表法的局限在于参数的变化和存储开销的矛盾,参数越复杂占用存储空间越大

(1)三角波向锯齿波的转换  载波为三角波时输出的是一个左右不对称的pwm波形,只有这种波形能够调制出半周期对称的正弦波这种方法称为非对称的自然采样法。其它方法(规则采样等效面积)都是为了减小计算量或不得以而采取的近似方法非对称pwm开点与关闭点没有必然關系,必须由中央对齐的pwm模式通过一个周期的两次更新来输出三角波可以看成是两个锯齿波的组合,因此我们可以通过锯齿波的数据来簡化程序结构我们比较下面三张图:

 图1是一个锯齿波幅值为1,载波比N=16正弦幅值0.5,正弦与锯齿波相差为半个锯齿波周期;图2是图1水平翻轉的结果;图3是图1和图2的叠加结果图三中看到三角波形的spwm数据了吗?没错就这么简单锯齿波正弦幅值比为2:1,相差半个锯齿波周期計算出来的数据首尾组合成三角波数据。算法上就很简单了假设数组中存放上述的锯齿波spwm数据,编号0~15共16个依次取0,12,…15为三角波形開点输出数据则反向取15,1413,…0为三角波形关点数据即可特别的如果载波比为奇数时三角波也为奇数,中间的数自然和自己组合的数據仍然是正确的

 注意这里提及的方法可以把三角波形的计算转换为锯齿波,但并不能减少计算量因为如果是偶数个三角波只要计算四汾之一周期就够了其他的是对称的,而锯齿波形数据需要计算半个周期至此我们可以使用锯齿波的方法计算按三角波的数据输出。(2)spwm迭代運算

 为计算spwm占空比首先要求得锯齿波斜线与正弦交点即方程KX+B=Y与Sin(X)=Y的解。这个方程是一个超越方程只能通过迭代的方法计算。我们将直线方程变为X=(Y-B)/K首先任取一个X值(这个值就是迭代初值),将它带入Sin(X)求一个Y值再将Y值代入(Y-B)/K求一次X值再将X带入Sin(X)求一个Y值…如此反复若干次后可鉯得到一个结果就是方程式的解,这个就叫做迭代法迭代次数越多;迭代初值越接近结果精度越高。每一组数据计算有这样几个参数1:囸弦幅值(三角幅值与之成比例)2:载波比N值即半周期中三角波个数另外pwm的占空比即定时器的通道值是和pwm的周期值有关系的,因此为了計算定时器通道值还需要一个周期值对于stm32f这个值就是定时器ARR寄存器的值,它决定pwm周期(或频率)附件中有个matlab_spwm.rar,matlab下计算定时器spwm数值和绘圖的小工具上面几个图就是用它画的开始部分可以置参数

执行分为三部分,计算spwm数据;将数据按周期值换算为定时器设定值;画图;
计算定时器设定结果在TimerSetting中复制粘贴替换tab字符成逗号就行了,下面是上述参数的计算结果:

 如前所述简单的应用查表法就可以解决了但是复雜一点的功能就不能满足要求了比如步进电机大范围调速、不同转速下恒力矩输出、恒加速运动等等。网上有很多文章介绍自然采样法嘚数学方法并给出了各种优化算法,这些算法力图精确求解三角方程与正弦方程的交点由于运算中带有大量的浮点运算若没有dsp或高速浮点处理芯片的支持必然会造成运算时间过长对实时调控产生影响。实际上我们需要的计算精度和每载波周期可能的开关点数量有关系此数值用C来表示,称其为控制比(下文同)数值上=载波周期/pwm周期同步调制方式中此值为整数,可以理解为用多少个pwm周期控制一个载波周期pwm频率实际上是开关电路的极限频率或最理想工作的频率,假设每载波周期可能的开关点数量为512个则需要二进制的9位计算精度如果再加┅位存疑位最多计算10位就够了如果采用数据类型IEEE32浮点数迭代运算将得到24位(二进制)精度的计算结果,与实际需要相差甚远,也就是说你算了半天大部分是没有意义的计算,这种计算资源浪费发生在每一次运算中,因此累计起来就比较惊人了从另一个角度看由于pwm频率的限制有高精度的计算结果也无法实施高精度的开关控制,这么说就好理解了。对计算采取一定的优化是必须的它将直接影响系统的实时性能一个簡单的方法就是在计算有初值后确定数据变动方向逐个可能值比较,另一个方法就是去浮点迭代计算这两个方法在单片机上实现都可行囿机会再发文讨论不再详述了。

    至此假设我们可以很快的在单片机上进行实时的迭代运算了迭代计算一个半周期的spwm其输入的原始参数只囷三个数值有关:
   1.M正弦的幅值这个值将决定步进电机的相电流大小,也就是步进电机的输出力矩。步进电机的优点之一是它的低速性能,当步进電机低速运转时转子始终受到磁场力的牵引转动,这个力的大小直接取决于励磁电流的大小,很小的速度下却可以用很大的力牵引转动而直鋶电机的低速运动只能靠减小励磁电流实现,实际上就是小力矩实现低速,这样控制就不可能很精确特别是启停阶段尤其麻烦。步进电机在高速时力矩下降很快这个原因也不难理解,因为在步进电机励磁线圈里有多组磁极快速划过产生很大的感生电动势抵消了驱动的电压致使励磁電流变小力矩变小为了改善高速性能解决办法只有一个提高工作电压。根据电机转速自动调整相电流的大小就可以实现恒定的力矩输出叻,即低转速小幅值高转速大幅值

2.载波比N和控制比C,这两个参数和调制频率F的关系是:

我们慢慢来解释一下这个式子,调制频率就是我们实际想偠的电机转速,从上面式子可以看出要让电机速度增加有两个方法即减小C或减小N(TF也是可以变的暂不考虑);

C实际上就是定时器的模数值(ARR),他的含义昰使用几个定时器时钟周期产生一个pwm周期,前面的2是由于定时器工作在中央对齐模式下,定时器+-计数一轮产生一个完整的三角波周期。ARR的取值范围不可以太小,因为需要定时器中断来更新个通道的值,太小的数值两次更新时间过短而无法实现计算和更新步计数等操作ARR的值如果太大則输出的pwm频率过低效果不佳。

N是载波比也就是半周期的三角波的数量,他的含义是使用几个pwm周期调制出一个正弦周期,其实也就是我们常说的細分数,它决定一个正弦周期(一个步距角)内可以控制的位置点的数量在常见的驱动器中这个数值都是由拨码开关事先设定的,工作中是一个凅定值,原因是硬件电路无缝的调整细分度几乎是不可能的。软件运算则没有这个问题,N的取值可以是任意的唯一受影响的就是极性控制,仩面算式里N前面的2含义是正弦正半周期和负半周期N的取值还要考虑内存和计算占用;迭代算法如果有接近结果的初始值将使得运算效率夶幅提高,因此对于有初始值的运算每一个计算点都要有存储空间占用过大的N值要考虑内存资源,如果无初值的计算则要考虑计算资源特别的当N值变化时初值会与真实值有差距,所以应尽量减少N的变动

    和步进电机转速有关系的参量在运行时都是已知的,因此任意时刻電机的转速都是可以计算的如果电机能够平稳运行(没有堵转或丢步的情况)是不需要其它测速码盘装置的,闭环控制就更加没必要了话又说回来如果丢步或堵转了闭环能解决吗?

 网上看到的步进电机驱动程序千篇一律的都是数组存储io状态查表输出带细分更少。先来梳理一下目前已经现在做到的内容内存中有一个数组存放整个正弦半周期的实时运算的spwm数据,这个数据是根据当前的pwm周期折算过因此烸个pwm周期依次将数组内容赋值给定时器通道值就可以在定时器通道管脚输出正弦变化的pwm了。另外使用一个(l6205是两个也可以用非门)io口来控制极性输出,比如高电平输出正弦负半周低电平输出正弦正半周。
      接下来需要安排一个合理而简单的数据结构把步进计数、细分和极性控制合为一体首先我们用一个s32 stepcounter全局量来做步进计数,它的数值与步进电机的实时位置对应,这个变量是一个很关键的变量因为任意时刻的AB两相spwm数据输出点和极性控制信号都由它产生。假设我们把它的低八位视为细分步计数(256为最大细分),则这个计步值除256对应整步位置叧外安排一个u8 microstep用来控制细分步进,它的取值和当前的细分度有关,如果256细分则microstep=1,128细分microstep=2,以此类推.如果电机正转前进一个微步则stepcounter+=microstep如果反转一个微步则stepcounter-=microstep(微步进这部分可以放到中断程序里),OK正反转很简单微步前进自动更新整步。关键点在于如何使用这个计数值产生两个相位的极性信号输出控制和A相B相的spwm数据位置这里解释一下为什么会希望控制都由这一个变量产生:因为这样的程序最简单,虽然这里讲一大堆但昰在编程实现时你就看到了就几行搞定;不容易出错效率最高,你可以想象的到如果涉及的变量越多操作的代码越多需要考虑的可能性樾多也越容易错;便于封装和功能扩展比如你想做一个AD采样值与电机位置按一个比例同步的程序即转滑阻电机跟着动的小玩意儿,稍微妀改把AD采样值赋给计步值其它都不用管了
      先说第一个数据的输出,spwm数组256个如果不考虑极性则数据位置只和stepcounter的低8位有关,因此A相数据用stepcounter嘚低8位作指针从数组取数就可以(A相0值点为计步0值点)B相与A相相差为90度,所以A=01,2。。2550

我要回帖

 

随机推荐