STM32步進電機驅(qū)動的算法

在脈沖模式下，步進電機啟動器的脈沖頻率與速度成正比，函數(shù)void CalculateSModelLine(float fre[], unsigned short period[], float len, float fre_max, float fre_min, float flexible)主要目的就是生成每一個細分步加速的速度。芯片用的是stm32f103c8t6，驅(qū)動器用的是2DM420。

程序流程如下：

• STM32硬件基本初始化，主要是針對定時器

• 調(diào)用函數(shù)CalculateSModelLine（）生 成每一個細分步定時器的自動重裝載值（實際就是改變脈沖的周期）

• 打開定時器

• 更新中斷發(fā)生，將數(shù)組中的數(shù)據(jù)賦值給定時器的自動重裝載寄存器

• 跳出中斷后脈沖頻頻率就變化了

• 下一次更新中斷產(chǎn)生

對應(yīng)的計算接口code:

/* calculate the Period and Freq array value, fill the Period value into the Period register during the timer interrupt.

*calculate the acceleration procedure , a totally 1000 elements array.

* parameter fre[]: point to the array that keeps the freq value.

* period[]: point to the array that keeps the timer period value.

* len: the procedure of acceleration length.it is best thing to set the float number, some compile software maybe transfer error if set it as a int

* fre_max: maximum speed, frequency vale.

* fre_min: start minimum speed, frequency vale. mind : 10000000/65535 = 152, so fre_min can't less than 152.

* flexible: flexible value. adjust the S curves

*/

void CalculateSModelLine(float fre[], unsigned short period[], float len, float fre_max, float fre_min, float flexible)

{

int i=0;

float deno ;

float melo ;

float delt = fre_max-fre_min;

for(; i

{

melo = flexible * (i-len/2) / (len/2);

deno = 1.0 / (1 + expf(-melo)); //expf is a library function of exponential(e)

fre[i] = delt * deno + fre_min;

period[i] = (unsigned short)(10000000.0 / fre[i]); // 10000000 is the timer driver frequency

}

return ;

}

文章整合自：CSDN

編輯:ymf