? ? ? ? 步進(jìn)電機(jī)驅(qū)動(dòng)器的細(xì)分原理介紹,步進(jìn)電機(jī)安裝有帶永久磁性的轉(zhuǎn)子,而定子至少具有兩個(gè)繞線。當(dāng)轉(zhuǎn)子磁性與定子繞線保持一致時(shí),將驅(qū)動(dòng)第二個(gè)繞線。兩個(gè)繞線交替開啟和關(guān)閉,這將導(dǎo)致電機(jī)鎖定在想要的步進(jìn)位置。通過繞線的電流方向還可反向。在帶有兩個(gè)定子繞線的步進(jìn)電機(jī)中,有四個(gè)步進(jìn)以 90 °隔開。步進(jìn)電機(jī)驅(qū)動(dòng)器的細(xì)分原理介紹,根據(jù)向定子繞線提供的脈沖,可精確控制步進(jìn)電機(jī)移動(dòng)的步進(jìn)。步進(jìn)電機(jī)的速度控制可通過向繞線提供脈沖頻率實(shí)現(xiàn),而旋轉(zhuǎn)方向可通過反向脈沖序列進(jìn)行更改。電機(jī)內(nèi)部的極片有許多齒,有助于定位相對于定子的轉(zhuǎn)子位置。一些步進(jìn)電機(jī)的定子級(jí)也有齒。根據(jù)使用的控制技術(shù),可全步進(jìn)、半步進(jìn)或微步進(jìn)控制步進(jìn)電機(jī)。簡單的方形脈沖可以控制處于全步進(jìn)的電機(jī),而先進(jìn)控制技術(shù)(如脈寬調(diào)制 (PWM))可用于微步進(jìn)。步進(jìn)電機(jī)驅(qū)動(dòng)器的細(xì)分原理介紹,在國內(nèi),大家對細(xì)分還不是特別了解,有的只是認(rèn)為,細(xì)分是為了提高精度,其實(shí)不然,細(xì)分主要是改善電機(jī)的運(yùn)行性能,現(xiàn)說明如下:步進(jìn)伺服電機(jī)的細(xì)分控制是由驅(qū)動(dòng)器精確控制步進(jìn)電機(jī)的相電流來實(shí)現(xiàn)的,以二相電機(jī)為例,假如電機(jī)的額定相電流為3A,如果使用常規(guī)驅(qū)動(dòng)器(如常用的恒流斬波方式)驅(qū)動(dòng)該電機(jī),電機(jī)每運(yùn)行一步,其繞組內(nèi)的電流將從0突變?yōu)?A或從3A突變到0,相電流的巨大變化,必然會(huì)引起電機(jī)運(yùn)行的振動(dòng)和噪音。如果使用細(xì)分驅(qū)動(dòng)器,在10細(xì)分的狀態(tài)下驅(qū)動(dòng)該電機(jī),電機(jī)每運(yùn)行一微步,其繞組內(nèi)的電流變化只有0.3A而不是3A,且電流是以正弦曲線規(guī)律變化,這樣就大大的改善了電機(jī)的振動(dòng)和噪音,因此,在性能上的優(yōu)點(diǎn)才是細(xì)分的真正優(yōu)點(diǎn)。由于細(xì)分驅(qū)動(dòng)器要精確控制電機(jī)的相電流,所以對驅(qū)動(dòng)器要有相當(dāng)高的技術(shù)要求和工藝要求,成本亦會(huì)較高。需要注意的是,國內(nèi)有一些驅(qū)動(dòng)器采用平滑來取代細(xì)分,有的亦稱為細(xì)分,但這不是真正的細(xì)分,一定要分清兩者的本質(zhì)不同。
? ? ? ? 步進(jìn)電機(jī)驅(qū)動(dòng)器的細(xì)分1.平滑并不精確控制電機(jī)的相電流,只是把電流的變化率變緩一些,所以平滑并不產(chǎn)生微步,而細(xì)分的微步是可以用來精確定位的。步進(jìn)電機(jī)驅(qū)動(dòng)器的細(xì)分2.電機(jī)的相電流被平滑后,會(huì)引起電機(jī)力矩的下降,而細(xì)分控制不但不會(huì)引起電機(jī)力矩的下降,相反,力矩會(huì)有所增加。步進(jìn)電機(jī)驅(qū)動(dòng)器的細(xì)分原理介紹,步進(jìn)電機(jī)安裝有帶永久磁性的轉(zhuǎn)子,而定子至少具有兩個(gè)繞線。當(dāng)轉(zhuǎn)子磁性與定子繞線保持一致時(shí),將驅(qū)動(dòng)第二個(gè)繞線。兩個(gè)繞線交替開啟和關(guān)閉,這將導(dǎo)致電機(jī)鎖定在想要的步進(jìn)位置。通過繞線的電流方向還可反向。
全步和半步:步進(jìn)驅(qū)動(dòng)器控制步進(jìn)電機(jī)的運(yùn)行方式,步進(jìn)電機(jī)常用的勵(lì)磁模式有全步、半步和微步三種。這些勵(lì)磁模式對電機(jī)提供的運(yùn)行特性和扭矩都有影響。每次將輸入脈沖施加到電機(jī)時(shí),步進(jìn)電機(jī)都會(huì)將電子信號(hào)轉(zhuǎn)換為機(jī)械運(yùn)動(dòng)。每個(gè)脈沖以固定增量移動(dòng)軸。如果步進(jìn)電機(jī)的步進(jìn)分辨率為1.8°,那么為了讓軸旋轉(zhuǎn)一整圈,在全步進(jìn)操作中,步進(jìn)電機(jī)需要接收200個(gè)脈沖,360°÷1.8=200。 有兩種全步勵(lì)磁模式: 在單相全步中,電機(jī)一次僅在一個(gè)相通電的情況下運(yùn)行。在任何激勵(lì)模式中,這種模式需要來自驅(qū)動(dòng)器的最少功率。
在雙相全步中,電機(jī)在兩相同時(shí)通電的情況下運(yùn)行。此模式提供了改進(jìn)的扭矩和速度性能。兩相開啟比單相開啟提供大約30%到40%的扭矩,但它需要來自驅(qū)動(dòng)器的兩倍功率。
半步勵(lì)磁模式是一相開啟和兩相開啟全步模式的組合。這導(dǎo)致基本步距角的一半。由于角度分辨率的提高,這個(gè)較小的步距角提供了更平滑的操作。半步產(chǎn)生的轉(zhuǎn)矩比兩相全步低約15%,但修改后的半步通過增加單相通電時(shí)施加到電機(jī)的電流來消除轉(zhuǎn)矩降低。
微步可實(shí)現(xiàn)更好的控制和更平穩(wěn)的操作: 微步可以將電機(jī)的基本步長分割多達(dá)256倍,使小步距變小。微型驅(qū)動(dòng)器使用兩個(gè)相隔90°的電流正弦波,這非常適合實(shí)現(xiàn)電機(jī)的平穩(wěn)運(yùn)行。您會(huì)注意到電機(jī)運(yùn)行安靜,沒有真正可檢測到的步進(jìn)動(dòng)作。
通過控制每個(gè)繞組中電流的方向和幅度,分辨率提高,電機(jī)特性改善,振動(dòng)更小,運(yùn)行更平穩(wěn)。因?yàn)檎也ㄒ黄鸸ぷ鳎詮囊粋€(gè)繞組到另一個(gè)繞組的平滑過渡。當(dāng)一個(gè)電流增加時(shí),另一個(gè)電流減小,從而實(shí)現(xiàn)平穩(wěn)的步進(jìn)進(jìn)展并保持扭矩輸出。 ?細(xì)分的原理和輸出控制:
? ?一個(gè)理想的步進(jìn)電機(jī)電流曲線應(yīng)該是相位相差90度的正弦曲線如下圖:
? ?? ?圖中藍(lán)色線時(shí)A相電流,紅色線是B相電流。如果把A相正負(fù)極值視為A+A-,B相正負(fù)極值視為B+B-,比較一下四拍方式正轉(zhuǎn)A+B+A-B-和反轉(zhuǎn)A+B-A-B+不難看出四排方式實(shí)際上是用一個(gè)脈沖來代替一個(gè)正弦半周期,相位點(diǎn)從左到右變化則電機(jī)正轉(zhuǎn),從右到左電機(jī)反轉(zhuǎn)。類似的我們把八拍方式A+;A+B+;B+;B+A-;A-;A-B-;B-;B-A+;放到曲線里也可以找到對應(yīng)點(diǎn),圖中標(biāo)出了各拍的相位點(diǎn)1,2,3…,不難看出用A+B+代替第2拍點(diǎn)用B+A-代替第四拍點(diǎn)都是近似的做法。那么這種近似和理想情況的電流的差值去哪里了呢?這些電流被無謂的消耗掉了而且多余的電流會(huì)引起電機(jī)轉(zhuǎn)動(dòng)的不平穩(wěn)。為什么要細(xì)分呢?實(shí)際細(xì)分的終極目標(biāo)就是在正弦的周期中插入若干個(gè)點(diǎn)使得相電流接近正弦變化,細(xì)分可以提高定位精度和電機(jī)運(yùn)轉(zhuǎn)的平穩(wěn)性。
spwm運(yùn)算和輸出 ? ?? Spwm的產(chǎn)生可以分為軟件方法和硬件方法,硬件方法通過硬件產(chǎn)生一路三角波一路正弦波,經(jīng)過一個(gè)比較器比較正弦波幅值與三角波幅值的關(guān)系即可得到spwm波。這種方法也應(yīng)用于很多spwm集成芯片。硬件方法在波形產(chǎn)生上不需要軟件參與,并且調(diào)頻和調(diào)幅控制上都是比較簡單的。硬件方法的功能和性能取決于芯片本身,對于比較復(fù)雜的應(yīng)用上會(huì)受到限制。 軟件方法的思路是使得pwm波以spwm的脈寬數(shù)據(jù)變化濾波后就可以得到正弦波形,通過計(jì)算得到占空比的波形數(shù)據(jù),按波形數(shù)據(jù)調(diào)整pwm。其實(shí)軟方法和硬方法也并不是絕對的,比如ti的dsp芯片內(nèi)部的spwm發(fā)生器,他的做法是在內(nèi)存中存儲(chǔ)一張正弦表,然后用一個(gè)和定時(shí)器時(shí)鐘同步的計(jì)數(shù)器正負(fù)計(jì)數(shù)模擬一個(gè)三角波,每個(gè)時(shí)鐘將正弦表的值與三角計(jì)數(shù)值作比較輸出即得到spwm,實(shí)際上可以看成是一種半軟件半硬件的做法。軟件方法的優(yōu)勢在于成本低且更靈活,成本低不用說了,靈活性上舉個(gè)例子:調(diào)制正弦波性的極性是由獨(dú)立的控制位實(shí)現(xiàn)的(雙極性),如果輸出標(biāo)準(zhǔn)的正弦波形硬方法需要三角波發(fā)生器和正弦波發(fā)生器的起始點(diǎn)精確對齊,這在硬件電路實(shí)現(xiàn)上需要附帶鎖相環(huán)電路才能保證,而軟件方法則不需要任何附加操作。現(xiàn)在為了改善步進(jìn)電機(jī)的驅(qū)動(dòng)性能,我們希望極性翻轉(zhuǎn)點(diǎn)落后輸出幾個(gè)微秒,要做到這一點(diǎn)硬件方法改動(dòng)肯定是難上難,而軟件方法上只需要增加個(gè)定時(shí)滯后輸出就行了。 ? ? 為了減少運(yùn)算開銷也可以使用查表法,把計(jì)算好的spwm數(shù)據(jù)存儲(chǔ)在rom里,按順序輸出表中的值即可。這種方法的數(shù)據(jù)計(jì)算可以在pc機(jī)上通過matlab軟件進(jìn)行,將數(shù)據(jù)算好粘貼到源程序中就可以了。查表法的局限在于參數(shù)的變化和存儲(chǔ)開銷的矛盾,參數(shù)越復(fù)雜占用存儲(chǔ)空間越大。 (1)三角波向鋸齒波的轉(zhuǎn)換 ? ?載波為三角波時(shí)輸出的是一個(gè)左右不對稱的pwm波形,只有這種波形能夠調(diào)制出半周期對稱的正弦波,這種方法稱為非對稱的自然采樣法。其它方法(規(guī)則采樣等效面積…)都是為了減小計(jì)算量或不得以而采取的近似方法。非對稱pwm開點(diǎn)與關(guān)閉點(diǎn)沒有必然關(guān)系,必須由中央對齊的pwm模式通過一個(gè)周期的兩次更新來輸出。三角波可以看成是兩個(gè)鋸齒波的組合,因此我們可以通過鋸齒波的數(shù)據(jù)來簡化程序結(jié)構(gòu)。我們比較下面三張圖:
? ?? ?圖1是一個(gè)鋸齒波幅值為1,載波比N=16,正弦幅值0.5,正弦與鋸齒波相差為半個(gè)鋸齒波周期;圖2是圖1水平翻轉(zhuǎn)的結(jié)果;圖3是圖1和圖2的疊加結(jié)果。圖三中看到三角波形的spwm數(shù)據(jù)了嗎?沒錯(cuò)就這么簡單,鋸齒波正弦幅值比為2:1,相差半個(gè)鋸齒波周期,計(jì)算出來的數(shù)據(jù)首尾組合成三角波數(shù)據(jù)。算法上就很簡單了,假設(shè)數(shù)組中存放上述的鋸齒波spwm數(shù)據(jù),編號(hào)0~15共16個(gè),依次取0,1,2,…15為三角波形開點(diǎn)輸出數(shù)據(jù),則反向取15,14,13,…0為三角波形關(guān)點(diǎn)數(shù)據(jù)即可。特別的如果載波比為奇數(shù)時(shí)三角波也為奇數(shù),中間的數(shù)自然和自己組合的數(shù)據(jù)仍然是正確的。 ?注意這里提及的方法可以把三角波形的計(jì)算轉(zhuǎn)換為鋸齒波,但并不能減少計(jì)算量,因?yàn)槿绻桥紨?shù)個(gè)三角波只要計(jì)算四分之一周期就夠了其他的是對稱的,而鋸齒波形數(shù)據(jù)需要計(jì)算半個(gè)周期。至此我們可以使用鋸齒波的方法計(jì)算按三角波的數(shù)據(jù)輸出。 (2)spwm迭代運(yùn)算 ? ?? ?為計(jì)算spwm占空比首先要求得鋸齒波斜線與正弦交點(diǎn),即方程KX+B=Y與Sin(X)=Y的解。這個(gè)方程是一個(gè)超越方程,只能通過迭代的方法計(jì)算。我們將直線方程變?yōu)閄=(Y-B)/K,首先任取一個(gè)X值(這個(gè)值就是迭代初值),將它帶入Sin(X)求一個(gè)Y值再將Y值代入(Y-B)/K求一次X值,再將X帶入Sin(X)求一個(gè)Y值…如此反復(fù)若干次后可以得到一個(gè)結(jié)果就是方程式的解,這個(gè)就叫做迭代法。迭代次數(shù)越多;迭代初值越接近結(jié)果精度越高。每一組數(shù)據(jù)計(jì)算有這樣幾個(gè)參數(shù)1:正弦幅值(三角幅值與之成比例)2:載波比N值即半周期中三角波個(gè)數(shù)。另外pwm的占空比即定時(shí)器的通道值是和pwm的周期值有關(guān)系的,因此為了計(jì)算定時(shí)器通道值還需要一個(gè)周期值,對于stm32f這個(gè)值就是定時(shí)器ARR寄存器的值,它決定pwm周期(或頻率)。附件中有個(gè)matlab_spwm.rar,matlab下計(jì)算定時(shí)器spwm數(shù)值和繪圖的小工具上面幾個(gè)圖就是用它畫的,開始部分可以置參數(shù) s_M=32768/65536 %正弦波幅值比0~1 s_N=16? ???%半周期三角波個(gè)數(shù) s_Pre=16384? ???%單片機(jī)定時(shí)器模數(shù)值 執(zhí)行分為三部分,計(jì)算spwm數(shù)據(jù);將數(shù)據(jù)按周期值換算為定時(shí)器設(shè)定值;畫圖;
計(jì)算定時(shí)器設(shè)定結(jié)果在TimerSetting中,復(fù)制粘貼替換tab字符成逗號(hào)就行了,下面是上述參數(shù)的計(jì)算結(jié)果: 1780? ?? ?? ?5246? ?? ?? ?8444? ?? ?? ?11221? ?? ? 13461? ?? ? 15088? ?? ? 16063? ?? ? 16384? ?? ? 16075? ?? ? 15182? ?? ? 13764? ?? ? 11893? ?? ? 9645? ?? ?? ?7102? ?? ?? ?4346? ?? ?? ?1463 (3)spwm實(shí)時(shí)運(yùn)算的優(yōu)化 ? ?? ?如前所述簡單的應(yīng)用查表法就可以解決了但是復(fù)雜一點(diǎn)的功能就不能滿足要求了,比如步進(jìn)電機(jī)大范圍調(diào)速、不同轉(zhuǎn)速下恒力矩輸出、恒加速運(yùn)動(dòng)等等。網(wǎng)上有很多文章介紹自然采樣法的數(shù)學(xué)方法,并給出了各種優(yōu)化算法,這些算法力圖精確求解三角方程與正弦方程的交點(diǎn),由于運(yùn)算中帶有大量的浮點(diǎn)運(yùn)算若沒有dsp或高速浮點(diǎn)處理芯片的支持必然會(huì)造成運(yùn)算時(shí)間過長對實(shí)時(shí)調(diào)控產(chǎn)生影響。實(shí)際上我們需要的計(jì)算精度和每載波周期可能的開關(guān)點(diǎn)數(shù)量有關(guān)系,此數(shù)值用C來表示,稱其為控制比數(shù)值上=載波周期/pwm周期,同步調(diào)制方式中此值為整數(shù),可以理解為用多少個(gè)pwm周期控制一個(gè)載波周期。pwm頻率實(shí)際上是開關(guān)電路的極限頻率或最理想工作的頻率,假設(shè)每載波周期可能的開關(guān)點(diǎn)數(shù)量為512個(gè)則需要二進(jìn)制的9位計(jì)算精度如果再加一位存疑位最多計(jì)算10位就夠了。如果采用數(shù)據(jù)類型IEEE32浮點(diǎn)數(shù)迭代運(yùn)算將得到24位(二進(jìn)制)精度的計(jì)算結(jié)果,與實(shí)際需要相差甚遠(yuǎn),也就是說你算了半天大部分是沒有意義的計(jì)算,這種計(jì)算資源浪費(fèi)發(fā)生在每一次運(yùn)算中,因此累計(jì)起來就比較驚人了。從另一個(gè)角度看由于pwm頻率的限制有高精度的計(jì)算結(jié)果也無法實(shí)施高精度的開關(guān)控制,這么說就好理解了。對計(jì)算采取一定的優(yōu)化是必須的它將直接影響系統(tǒng)的實(shí)時(shí)性能。? ? ? ? ?? 步進(jìn)電機(jī)運(yùn)行控制 ? ? 至此假設(shè)我們可以很快的在單片機(jī)上進(jìn)行實(shí)時(shí)的迭代運(yùn)算了。迭代計(jì)算一個(gè)半周期的spwm其輸入的原始參數(shù)只和三個(gè)數(shù)值有關(guān):
? ?? 1.M正弦的幅值這個(gè)值將決定步進(jìn)電機(jī)的相電流大小,也就是步進(jìn)電機(jī)的輸出力矩。步進(jìn)電機(jī)的優(yōu)點(diǎn)之一是它的低速性能,當(dāng)步進(jìn)電機(jī)低速運(yùn)轉(zhuǎn)時(shí)轉(zhuǎn)子始終受到磁場力的牽引轉(zhuǎn)動(dòng),這個(gè)力的大小直接取決于勵(lì)磁電流的大小,很小的速度下卻可以用很大的力牽引轉(zhuǎn)動(dòng)。而直流電機(jī)的低速運(yùn)動(dòng)只能靠減小勵(lì)磁電流實(shí)現(xiàn),實(shí)際上就是小力矩實(shí)現(xiàn)低速,這樣控制就不可能很精確特別是啟停階段尤其麻煩。步進(jìn)電機(jī)在高速時(shí)力矩下降很快這個(gè)原因也不難理解,因?yàn)樵诓竭M(jìn)電機(jī)勵(lì)磁線圈里有多組磁極快速劃過產(chǎn)生很大的感生電動(dòng)勢抵消了驅(qū)動(dòng)的電壓致使勵(lì)磁電流變小力矩變小。為了改善高速性能解決辦法只有一個(gè)提高工作電壓。根據(jù)電機(jī)轉(zhuǎn)速自動(dòng)調(diào)整相電流的大小就可以實(shí)現(xiàn)恒定的力矩輸出了,即低轉(zhuǎn)速小幅值高轉(zhuǎn)速大幅值。 2.載波比N和控制比C,這兩個(gè)參數(shù)和調(diào)制頻率F的關(guān)系是: F*2C*2N=TF(TF是定時(shí)器的時(shí)鐘頻率) 我們慢慢來解釋一下這個(gè)式子,調(diào)制頻率就是我們實(shí)際想要的電機(jī)轉(zhuǎn)速,從上面式子可以看出要讓電機(jī)速度增加有兩個(gè)方法即減小C或減小N(TF也是可以變的暫不考慮); C實(shí)際上就是定時(shí)器的模數(shù)值(ARR),他的含義是使用幾個(gè)定時(shí)器時(shí)鐘周期產(chǎn)生一個(gè)pwm周期,前面的2是由于定時(shí)器工作在中央對齊模式下,定時(shí)器+-計(jì)數(shù)一輪產(chǎn)生一個(gè)完整的三角波周期。ARR的取值范圍不可以太小,因?yàn)樾枰〞r(shí)器中斷來更新個(gè)通道的值,太小的數(shù)值兩次更新時(shí)間過短而無法實(shí)現(xiàn)計(jì)算和更新步計(jì)數(shù)等操作。ARR的值如果太大則輸出的pwm頻率過低效果不佳。 N是載波比也就是半周期的三角波的數(shù)量,他的含義是使用幾個(gè)pwm周期調(diào)制出一個(gè)正弦周期,其實(shí)也就是我們常說的細(xì)分?jǐn)?shù),它決定一個(gè)正弦周期(一個(gè)步距角)內(nèi)可以控制的位置點(diǎn)的數(shù)量。在常見的驅(qū)動(dòng)器中這個(gè)數(shù)值都是由撥碼開關(guān)事先設(shè)定的,工作中是一個(gè)固定值,原因是硬件電路無縫的調(diào)整細(xì)分度幾乎是不可能的。軟件運(yùn)算則沒有這個(gè)問題,N的取值可以是任意的,唯一受影響的就是極性控制,上面算式里N前面的2含義是正弦正半周期和負(fù)半周期。N的取值還要考慮內(nèi)存和計(jì)算占用;迭代算法如果有接近結(jié)果的初始值將使得運(yùn)算效率大幅提高,因此對于有初始值的運(yùn)算每一個(gè)計(jì)算點(diǎn)都要有存儲(chǔ)空間占用,過大的N值要考慮內(nèi)存資源,如果無初值的計(jì)算則要考慮計(jì)算資源。特別的當(dāng)N值變化時(shí)初值會(huì)與真實(shí)值有差距,所以應(yīng)盡量減少N的變動(dòng)。 步值計(jì)數(shù)產(chǎn)生AB極性邏輯和正反轉(zhuǎn):
? ?? 先來梳理一下目前已經(jīng)現(xiàn)在做到的內(nèi)容,內(nèi)存中有一個(gè)數(shù)組存放整個(gè)正弦半周期的實(shí)時(shí)運(yùn)算的spwm數(shù)據(jù),這個(gè)數(shù)據(jù)是根據(jù)當(dāng)前的pwm周期折算過,因此每個(gè)pwm周期依次將數(shù)組內(nèi)容賦值給定時(shí)器通道值就可以在定時(shí)器通道管腳輸出正弦變化的pwm了。另外使用一個(gè)(l6205是兩個(gè),也可以用非門)io口來控制極性輸出,比如高電平輸出正弦負(fù)半周,低電平輸出正弦正半周。
? ?? ?接下來需要安排一個(gè)合理而簡單的數(shù)據(jù)結(jié)構(gòu)把步進(jìn)計(jì)數(shù)、細(xì)分和極性控制合為一體。首先我們用一個(gè)s32 stepcounter全局量來做步進(jìn)計(jì)數(shù),它的數(shù)值與步進(jìn)電機(jī)的實(shí)時(shí)位置對應(yīng),這個(gè)變量是一個(gè)很關(guān)鍵的變量,因?yàn)槿我鈺r(shí)刻的AB兩相spwm數(shù)據(jù)輸出點(diǎn)和極性控制信號(hào)都由它產(chǎn)生。假設(shè)我們把它的低八位視為細(xì)分步計(jì)數(shù)(256為最大細(xì)分),則這個(gè)計(jì)步值除256對應(yīng)整步位置。另外安排一個(gè)u8 microstep用來控制細(xì)分步進(jìn),它的取值和當(dāng)前的細(xì)分度有關(guān),如果256細(xì)分則microstep=1,128細(xì)分microstep=2,以此類推.如果電機(jī)正轉(zhuǎn)前進(jìn)一個(gè)微步則stepcounter+=microstep,如果反轉(zhuǎn)一個(gè)微步則stepcounter-=microstep(微步進(jìn)這部分可以放到中斷程序里),OK正反轉(zhuǎn)很簡單,微步前進(jìn)自動(dòng)更新整步。關(guān)鍵點(diǎn)在于如何使用這個(gè)計(jì)數(shù)值產(chǎn)生兩個(gè)相位的極性信號(hào)輸出控制和A相B相的spwm數(shù)據(jù)位置,這里解釋一下為什么會(huì)希望控制都由這一個(gè)變量產(chǎn)生:因?yàn)檫@樣的程序最簡單,雖然這里講一大堆但是在編程實(shí)現(xiàn)時(shí)你就看到了就幾行搞定;不容易出錯(cuò),效率最高,你可以想象的到如果涉及的變量越多操作的代碼越多需要考慮的可能性越多也越容易錯(cuò);便于封裝和功能擴(kuò)展,比如你想做一個(gè)AD采樣值與電機(jī)位置按一個(gè)比例同步的程序即轉(zhuǎn)滑阻電機(jī)跟著動(dòng)的小玩意兒,稍微改改把AD采樣值賦給計(jì)步值其它都不用管了。
? ?? ?先說第一個(gè)數(shù)據(jù)的輸出,spwm數(shù)組256個(gè),如果不考慮極性則數(shù)據(jù)位置只和stepcounter的低8位有關(guān),因此A相數(shù)據(jù)用stepcounter的低8位作指針從數(shù)組取數(shù)就可以(A相0值點(diǎn)為計(jì)步0值點(diǎn)),B相與A相相差為90度,所以A=0,1,2,255,0 則B=128,129,130,127,128能看出來嗎?(A的數(shù)據(jù)指針+128)%256等同于 A的數(shù)據(jù)指針^128就是B的數(shù)據(jù)指針。
程序上這樣寫:
A通道值=spwm數(shù)組[(u8)stepcounter];
B通道值=spwm數(shù)組[(u8)stepcounter^128];
這里數(shù)組大小是256,所以一個(gè)邏輯異或就解決,如果你非要取大小是100個(gè)的話你就得(point+50)%100才能找到B相位點(diǎn)了。 步進(jìn)電機(jī)基本算法,S算法:
為了實(shí)現(xiàn)步進(jìn)電機(jī)的平緩啟停以及避免轉(zhuǎn)高轉(zhuǎn)速時(shí)不失步停轉(zhuǎn)。在步進(jìn)電機(jī)啟動(dòng)、停止過程中,需要采用加減速的算法對啟動(dòng)過程進(jìn)行控制。S曲線是加減速控制最理想的方案。但是S曲線的公式以及控制過程都比較復(fù)雜。
將S曲線離散化,在整個(gè)加減速過程中,以一定的時(shí)間間隔更新頻率,總的更新次數(shù)為2*N,i表示為第i次的更新,則第i次更新的頻率f(i)表示為:
其中fb為開始的頻率,fr是最終運(yùn)行的頻率,α是曲線的伸縮系數(shù),一般可以取3-5之間的常數(shù)。
比如,啟動(dòng)加速,開始頻率為400Hz,運(yùn)行頻率為5KHz。
停止減速,開始頻率為5KHz,停止頻率為400Hz,
加減速的時(shí)間均為1s,按10ms的時(shí)間間隔更新頻率,總共更新100次,α取5。
通過以下步驟實(shí)現(xiàn)實(shí)現(xiàn)步進(jìn)電機(jī)的S曲線的加減速控制:
配置1ms的定時(shí)器以及1ms的中斷程序在中斷程序中對加減速的頻率更新次數(shù)i進(jìn)行計(jì)數(shù)配置產(chǎn)生步進(jìn)電機(jī)驅(qū)動(dòng)信號(hào)的PWM模塊,設(shè)置PWM的定時(shí)中斷以及中斷程序在PWM的定時(shí)中斷程序中,計(jì)算當(dāng)前更新次數(shù)對應(yīng)的頻率,并按出來的頻率更新PWM的頻率以及占空比在PWM的定時(shí)中斷程序中,計(jì)算步進(jìn)電機(jī)運(yùn)行的步數(shù),如果達(dá)到設(shè)置的步數(shù)減去停止的S曲線減速運(yùn)行所設(shè)置的步數(shù),則開始減速運(yùn)行。同時(shí)檢測外部輸入,如果有需要停止運(yùn)行的輸入條件,則開始減速運(yùn)行。
整個(gè)加減速控制過程的難點(diǎn)在于:
步進(jìn)電機(jī)的計(jì)步以及頻率更新需要在每一個(gè)PWM中斷中進(jìn)行。步進(jìn)電機(jī)的運(yùn)行頻率最高到40KHz,這種頻率下,PWM的定時(shí)中斷周期達(dá)到了25us,PWM定時(shí)器中斷程序運(yùn)行總時(shí)間盡量小,根據(jù)經(jīng)驗(yàn)至少小于中斷周期的30%,即7.5us。一旦超過這個(gè)數(shù)值,導(dǎo)致所有中斷程序(包括PWM定時(shí)中斷程序)漏運(yùn)行,基本主程序無法運(yùn)行,導(dǎo)致整個(gè)控制器假死現(xiàn)象。根據(jù)S曲線的公司是一個(gè)復(fù)雜的非線性的指數(shù)浮點(diǎn)數(shù)運(yùn)算,需要耗費(fèi)大量的時(shí)間,直接調(diào)用C語言的庫函數(shù)計(jì)算這一數(shù)值可能耗費(fèi)幾十上百毫秒。
為了解決S曲線的運(yùn)算時(shí)間問題,基于STM32F103,我采用了查表法,具體步驟如下:
1. 將α值定義5,
的取值范圍為-5~5之間。
2. 在整個(gè)加減速過程中,表達(dá)式
在取值范圍-5~5內(nèi)均勻取1024個(gè)數(shù)值,得到數(shù)值表。
3. 定義一個(gè)unsigned short型有1024個(gè)元素的const類型的數(shù)組,用于存儲(chǔ)數(shù)值表。
4. Const數(shù)組存儲(chǔ)在內(nèi)部的flash,數(shù)值表共占用2048字節(jié)。
STM32F103RTC6共256K,程序組和設(shè)置參數(shù)占用48K,bootloader程序占用了8K,遠(yuǎn)程升級(jí)空間占用了100K,目前應(yīng)用程序只用到40K左右。
剩余60K左右的空間,騰出2K的空間來存儲(chǔ)數(shù)值表,有空間,就是這么任性。
5. 在中斷程序中,根據(jù)總的更新次數(shù)以及當(dāng)前的更新計(jì)數(shù)值,計(jì)算
值,再映射到0-1023的數(shù)值有的索引值,通過索引獲取數(shù)值。
6. 需要注意的是stm32f103不支持浮點(diǎn)數(shù)的運(yùn)算,所以對于浮點(diǎn)數(shù)的運(yùn)算,需要換算成乘以一個(gè)數(shù)再除以另一個(gè)數(shù),比如*α,需要轉(zhuǎn)變?yōu)?65535/13107。
下面一段代碼是根據(jù)更新的計(jì)數(shù)值獲取頻率的函數(shù):
U16 fnMC_GetFreq(U16 n, U16 halftn, U16 alpha, U16 minfreq, U16 maxfreq){//alpha=alpha * 4096
signed int udataA;
signed short uiDataA;
U16 uiRes;
U32 uwData;
udataA=(signed int)alpha * (signed int)n;
udataA=(signed int)udataA / halftn;
if(udataA > 32767){
udataA=32767;
}
uiDataA=(signed short)alpha - (signed short)udataA;
uiDataA=(signed short)4 * 4096 - uiDataA;
if(uiDataA < 0){
uiDataA=0;
}
uiRes=(U16)uiDataA;
uiRes=uiRes / 32;//*1023/8/4096
if(uiRes > 1023){
uiRes=1023;
}
udataA=(signed int)(maxfreq - minfreq) * g_mc_uchExp[uiRes];
udataA=udataA / 65535;
uiDataA=(signed int)udataA;
uiDataA +=minfreq;
if(uiDataA < 200){
uiDataA=200;
}
return(uiDataA);
}
下面一段代碼是產(chǎn)生步進(jìn)電機(jī)控制信號(hào)的PWM周期中斷程序:
int data;
U16 freq;
STRMotorRegs *motor;
motor=&g_motor_regs[0];
MOTOR_A_CLEARINT();
motor->steps ++;
data=(int)MOTOR_A_STEPS_GET();
if(motor->direction==0)
{
data=data + 1;
}
else
{
data=data - 1;
}
MOTOR_A_STEPS_SET(data);
freq=motor->runfrequency;
if(motor->runstate==MOTOR_RUN_STATE_INC){
if(motor->runtimer >=motor->starttime){
motor->runstate=MOTOR_RUN_STATE_IDLE;
}else{
freq=fnMC_GetFreq(motor->runtimer, motor->halfstarttime, motor->alpha, motor->startfreq, motor->runfrequency);//U16 n,U16 halftn,U16 alpha,U16 maxfreq,U16 minfreq)
}
motor->runsnapfreq=freq;
}else if(motor->runstate==MOTOR_RUN_STATE_IDLE){
if(motor->totalstep <=(motor->steps + motor->stopremainstep)){
motor->runstate=MOTOR_RUN_STATE_DEC;
motor->runtimer=0;
}
motor->runsnapfreq=freq;
}else{
if(motor->runtimer >=motor->stoptime){
freq=motor->stopfreq;
}else{
freq=fnMC_GetFreq(motor->runtimer, motor->halfstoptime, motor->alpha, motor->runsnapfreq, motor->stopfreq);//U16 n,U16 halftn,U16 alpha,U16 maxfreq,U16 minfreq)
}
}
if(motor->steps >=motor->totalstep)
{
motor->starting=FALSE;
}
if(FALSE==motor->starting)
{
MOTOR_A_DISABLE();
}else{
motor->curfrequency=freq;
fnMT_Cal_MotorA_TimeConf();
}
下面是生成S曲線數(shù)值表、控制步進(jìn)電機(jī)啟動(dòng)、停止的視頻,從視頻上可以明顯看到啟動(dòng)時(shí)慢加速->快加速->慢加速的過程,以及停止時(shí)慢減速->快減速->慢減速的過程。
評(píng)論
查看更多