DDA输出脉冲序列控制步进电机正反转（加速、减速、匀速）

最新推荐文章于 2024-06-29 11:56:26 发布

Stephen_Lu_Fahai

最新推荐文章于 2024-06-29 11:56:26 发布

阅读量1.7k

点赞数

分类专栏： C/C++ 文章标签： DDA 脉冲序列步进电机正反转匀速

本文链接：https://blog.csdn.net/Stephen_Lu_Fahai/article/details/77716621

版权

C/C++ 专栏收录该内容

6 篇文章 0 订阅

订阅专栏

宏定义：

#define DI_FOWARD (1 << 0)
#define DI_REVERSE (1 << 1)
#define FOWARD_FREQ 1000
#define REVERSE_FREQ 1000
#define MAX_FREQ 2000
#define ACC 20000

main函数的循环：

while (!exit_flag)

{
read_iofpga(fd, 0x30, &di_pdata, sizeof(di_pdata));

if ((di_pdata & DI_FOWARD) && !(di_pdata & DI_REVERSE))
target_freq = FOWARD_FREQ;
else if (!(di_pdata & DI_FOWARD) && (di_pdata & DI_REVERSE))
target_freq = -REVERSE_FREQ;
else
target_freq = 0;

read_iofpga(fd, 0xe2, &fifo_len, sizeof(fifo_len));
fifo_len = 1024 - fifo_len > 25 ? 0 : 25 - (1024 - fifo_len);

generate_dda_data(fifo_len, &current_freq, target_freq, dda_data);

write_iofpga_fifo(fd, 0x100, dda_data, sizeof(short) * 8 * fifo_len);

usleep(10000);

}

脉冲发生函数：

void generate_dda_data(int fifo_len, int * current_freq, int target_freq, short dda_data[][8])
{
int i = 0;

*current_freq = *current_freq > MAX_FREQ ? MAX_FREQ : *current_freq;
*current_freq = *current_freq < -MAX_FREQ ? -MAX_FREQ : *current_freq;
target_freq = target_freq > MAX_FREQ ? MAX_FREQ : target_freq;
target_freq = target_freq < -MAX_FREQ ? -MAX_FREQ : target_freq;

while (i < fifo_len)
{
if (*current_freq < target_freq)
{
*current_freq += ACC / 1000;
*current_freq = *current_freq > target_freq ? target_freq : *current_freq;
}
else
{
*current_freq -= ACC / 1000;
*current_freq = *current_freq < target_freq ? target_freq : *current_freq;
}

calcul_freq += *current_freq;
if (calcul_freq > 0)
dda_data[i][0] = calcul_freq / 1000;
else
dda_data[i][0]= (-calcul_freq / 1000) | 0x8000;

calcul_freq %= 1000;

i++;
}
}