FPGA驱动步进电机-Sin曲线加速

2023-10-25 08:20

本文主要是介绍FPGA驱动步进电机-Sin曲线加速,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

FPGA驱动步进电机-Sin曲线加速

  • 基本实现原理
  • 实际仿真的波形
  • 程序

以下由特权同学的FPGA文档摘取

Sin 曲线控制 step 脉冲信号生成的功能框图如下所示。
在这里插入图片描述

基本实现原理

①判断步进电机驱动的目标频率 stepper_delay_target 与当前频率 stepper_delay_current的值是否一致,若一致,则不做任何加速、减速操作,保持当前速度运行;若目标频率高于当前频率,则执行加速;若目标频率低于当前频率,则执行减速。

②在加速或减速控制开启状态下,1ms 分频计数逻辑每个 1ms 产生一个高脉冲,用于切换当前的速度。

③在每 1ms,步进电机的速度都会加速或减速一定的频率值,这个频率值和匀加速总是“固定”不同,它是变化的。在低频时,速度变化量较大,而高速时,速度变化量较小。这个速度到底如何变化?变化多少?我们现实用 matlab 产生了一个 0‐pi 的 sin 曲线,并且将曲线所对应的 1024 个 16bit 数据存储到了 FPGA 的片内 ROM 里(实际使用中,0~0.5pi 部分的上升曲线作为步进电机加速的频率曲线,而 0.5pi~pi 的下降曲线作为步进电机减速的频率曲线)。如图所示,X 取值为 0~511 的曲线(左侧曲线,取 0~0.5pi 的 512 个正弦值放大 32768倍,并且挪到 0 点以上)作为加速曲线,X 取值为 512~1023 的曲线(右侧曲线,取 0.5pi~pi的 512 个正弦值放大 32768 倍)作为减速曲线。

那么这两段曲线如何使用?
在这里插入图片描述
由于加速或减速所用到的 sin 查表值都是 512 个,所以我们加速或减速所需经过的中间频率都是 512 个。对于加速操作,目标频率 stepper_delay_target,加速起始频率stepper_delay_current 的差值,需要经过 x 个中间加速频率点(x 从 0 递增到 511),我们可以算得当前加速的 delta_speed_pulse = (stepper_delay_target ‐stepper_delay_current ) * (x 为地址对应的 ROM 数据)/32768,即最终用(stepper_delay_target ‐ delta_speed_pulse/32768)作为当前频率点。换句话说,就是用 sin 曲线作为整个加速过程的频率差值,用目标频率减去这个差值,就可以得到从其实频率逐渐靠近目标频率的加速过程,并且这个加速过程和图示左侧的曲线一样越来越平滑。对于减速操作也类似,只不过它是用停止频率或减速目标频率加上当前 sin 曲线算出的频率差值作为当前中间频率点。

④实际的 FPGA coding 中,必须把“频率”换算为“周期”,便于计数。这个换算很简单,用 1s 时间除以“频率”值即可。而由于“周期”必须换算为“时钟脉冲个数”为单位,所以我们把这个除法运算中的“除数”也换算为“时钟脉冲个数”为单位,因此 1s/20ns(时钟周期为 20ns)即除数 50_000_000。

⑤算出了加速或减速过程中不断变化的步进电机驱动的脉冲周期stepper_delay_current_period,就能够产生步进电机驱动的脉冲了。

实际仿真的波形

在这里插入图片描述
以上匀加速/减速操作下,设定步进电机的启动频率为 500Hz,可以稳定加速到 5KHz,加速时间需要 512*1ms = 512ms

程序

module stepper_motor_controller(input clk,		//50MHzinput rst_n,	//复位信号,低电平有效output stepper_motor_reset_n,	//步进电机复位信号,低电平有效output reg stepper_motor_en_n,				//步进电机驱动信号输出有效信号,低电平有效output reg stepper_motor_clk,				//步进电机的前进脉冲,上升沿有效发起一个步进电机转动input stepper_work_en,	//步进电机使能input[19:0] stepper_delay_target,	//步进电机两次stpe之间的延时,取值必须大于2,目标延时值output reg[19:0] stepper_delay_current	//步进电机两次stpe之间的延时,取值必须大于2,当前延时值);parameter START_FRE = 20'd1000;	//步进电机起步频率,单位Hz
parameter TIMER_1MS = 20'd50_000;	//1ms定时计数最大值,时钟为50MHz(20ns)
parameter CLK_NUMER_PERIORD = 32'd50_000_000;	//除数,单位20ns//---------------------------------------------------------------------------
reg speed_up_en;		//加速功能开启
reg[1:0] speed_up_en_r; //加速寄存器打一拍
reg speed_down_en; 		//减速功能开启
reg[1:0] speed_down_en_r;//减速寄存器打一拍
reg[19:0] stepper_cnt; wire pos_speed_up_en;	//speed_up_en上升沿,表示开始启动加速	
wire pos_speed_down_en;	//speed_down_en上升沿,表示开始启动减速 //---------------------------------------------------------------------------
//复位
assign stepper_motor_reset_n = rst_n; //---------------------------------------------------------------------------
//1s加速/减速定时
reg[19:0] xcnt;always @(posedge clk or negedge rst_n)if(!rst_n) xcnt <= 20'd0;else if(!speed_up_en && !speed_down_en) xcnt <= 20'd0;else if(xcnt < (TIMER_1MS-1)) xcnt <= xcnt+1'b1;else xcnt <= 20'd0;	wire motor_speed_change = (xcnt == (TIMER_1MS-1));	//ms定时信号,高电平有效,切换速度//---------------------------------------------------------------------------
//例化ROM,存储sin输出1024个0-pi的结果,放大1024倍
reg[9:0] rom_addr;
wire[15:0] rom_data;blk_mem_gen_0	uut_blk_mem_gen_0 (	//IP核.address ( rom_addr ),.clock ( clk ),.q ( rom_data ));		//---------------------------------------------------------------------------
//匀加速、减速控制 //加速控制使能
always @(posedge clk or negedge rst_n)if(!rst_n) speed_up_en <= 1'b0; else if(motor_speed_change && (rom_addr == 10'd511)) speed_up_en <= 1'b0;	else if(((stepper_delay_current < stepper_delay_target) && stepper_work_en)) speed_up_en <= 1'b1;else speed_up_en <= 1'b0;always @(posedge clk)speed_up_en_r <= {speed_up_en_r[0],speed_up_en};	//记录电平变化assign pos_speed_up_en = ~speed_up_en_r[1] & speed_up_en_r[0];	//speed_up_en上升沿,表示开始启动加速//减速控制使能
always @(posedge clk or negedge rst_n)if(!rst_n) speed_down_en <= 1'b0; else if(motor_speed_change && (rom_addr == 10'd1023)) speed_down_en <= 1'b0;  else if(stepper_work_en) beginif(stepper_delay_current > stepper_delay_target) speed_down_en <= 1'b1; else speed_down_en <= 1'b0;endelse beginif(stepper_delay_current > START_FRE) speed_down_en <= 1'b1;else speed_down_en <= 1'b0;	endalways @(posedge clk)	speed_down_en_r <= {speed_down_en_r[0],speed_down_en};assign pos_speed_down_en = ~speed_down_en_r[1] & speed_down_en_r[0];	//speed_down_en上升沿,表示开始启动减速	
wire neg_speed_down_en = speed_down_en_r[1] & ~speed_down_en_r[0];//---------------------------------------------------------------------------
//ROM地址产生,对应加速/减速参数选择控制always @(posedge clk or negedge rst_n)if(!rst_n) rom_addr <= 10'd0;else if(pos_speed_up_en) rom_addr <= 10'd0;else if(pos_speed_down_en) rom_addr <= 10'd512;else if(motor_speed_change && (speed_up_en || speed_down_en)) rom_addr <= rom_addr+1'b1;else ;	//---------------------------------------------------------------------------
//乘法运算
wire[35:0] mult_result;
reg[19:0] mult_datab;
reg[19:0] speed_up_start;//锁存加速起始频率
always @(posedge clk or negedge rst_n)if(!rst_n) speed_up_start <= 20'd0;else if(pos_speed_up_en) speed_up_start <= stepper_delay_current;//计算当前运行频率和目标频率差
always @(posedge clk or negedge rst_n)if(!rst_n) mult_datab <= 20'd0;else if(pos_speed_up_en) mult_datab <= stepper_delay_target - stepper_delay_current;	//加速else if(pos_speed_down_en) beginif(!stepper_work_en) mult_datab <= stepper_delay_current - START_FRE;				//停止的减速else mult_datab <= stepper_delay_current - stepper_delay_target;					//运行中减速end//频率差*(加速频率/32768)
mult_gen_0	uut_mult_gen_0 (.clock ( clk ),.dataa ( rom_data ),.datab ( mult_datab ),.result ( mult_result ));wire[19:0] delta_speed_down_pulse = mult_result[34:15];	//加速或减速频率差值
wire[19:0] delta_speed_up_pulse = mult_result[34:15];	//加速或减速频率差值//---------------------------------------------------------------------------
//步进电机使能控制always @(posedge clk or negedge rst_n)if(!rst_n) stepper_motor_en_n <= 1'b1;else if(stepper_work_en) stepper_motor_en_n <= 1'b0;else if(!stepper_work_en && (stepper_delay_current == START_FRE)) stepper_motor_en_n <= 1'b1;//---------------------------------------------------------------------------
//步进电机的step产生//步进电机当前频率产生
always @(posedge clk or negedge rst_n)if(!rst_n) stepper_delay_current <= START_FRE;else if(neg_speed_down_en) beginif(stepper_work_en) stepper_delay_current <= stepper_delay_target;else stepper_delay_current <= START_FRE;endelse if(motor_speed_change) beginif(stepper_work_en) beginif(speed_up_en) stepper_delay_current <= speed_up_start + delta_speed_up_pulse;else if(speed_down_en) stepper_delay_current <= stepper_delay_target + delta_speed_down_pulse;else stepper_delay_current <= stepper_delay_target;endelse beginif(speed_down_en) stepper_delay_current <= START_FRE + delta_speed_down_pulse;else stepper_delay_current <= START_FRE;endendwire[19:0] stepper_delay_current_period;	
wire[31:0] div_result;		div_gen_0	uut_div_gen_0 (.clock ( clk ),.denom ( stepper_delay_current ),.numer ( CLK_NUMER_PERIORD ),.quotient ( div_result ),.remain (  ));assign stepper_delay_current_period = div_result[19:0];	reg[19:0] r_stepper_delay_current_period;	//步进电机驱动周期锁存
always @(posedge clk or negedge rst_n)if(!rst_n) r_stepper_delay_current_period <= 1'd0;else if(stepper_cnt == 20'd0) r_stepper_delay_current_period <= stepper_delay_current_period;	//步进电机时钟频率的计数
always @(posedge clk or negedge rst_n)if(!rst_n) stepper_cnt <= 20'd0;else if(stepper_cnt < r_stepper_delay_current_period[19:0]) stepper_cnt <= stepper_cnt+1'b1;else stepper_cnt <= 20'd0;//步进电机时钟频率产生	
always @(posedge clk or negedge rst_n)if(!rst_n) stepper_motor_clk <= 1'b0;else if(stepper_cnt < {1'b0,r_stepper_delay_current_period[19:1]}) stepper_motor_clk <= 1'b0;else stepper_motor_clk <= 1'b1;endmodule

这篇关于FPGA驱动步进电机-Sin曲线加速的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/281248

相关文章

Python并行处理实战之如何使用ProcessPoolExecutor加速计算

《Python并行处理实战之如何使用ProcessPoolExecutor加速计算》Python提供了多种并行处理的方式,其中concurrent.futures模块的ProcessPoolExecu... 目录简介完整代码示例代码解释1. 导入必要的模块2. 定义处理函数3. 主函数4. 生成数字列表5.

如何在Ubuntu上安装NVIDIA显卡驱动? Ubuntu安装英伟达显卡驱动教程

《如何在Ubuntu上安装NVIDIA显卡驱动?Ubuntu安装英伟达显卡驱动教程》Windows系统不同,Linux系统通常不会自动安装专有显卡驱动,今天我们就来看看Ubuntu系统安装英伟达显卡... 对于使用NVIDIA显卡的Ubuntu用户来说,正确安装显卡驱动是获得最佳图形性能的关键。与Windo

Gradle在国内配置镜像加速的实现步骤

《Gradle在国内配置镜像加速的实现步骤》在国内使用Gradle构建项目时,最大的痛点就是依赖下载贼慢,甚至卡死,下面教你如何配置国内镜像加速Gradle下载依赖,主要是通过改写repositori... 目录引言一、修改 build.gradle 或 settings.gradle 的 reposito

嵌入式Linux之使用设备树驱动GPIO的实现方式

《嵌入式Linux之使用设备树驱动GPIO的实现方式》:本文主要介绍嵌入式Linux之使用设备树驱动GPIO的实现方式,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐... 目录一、设备树配置1.1 添加 pinctrl 节点1.2 添加 LED 设备节点二、编写驱动程序2.1

嵌入式Linux驱动中的异步通知机制详解

《嵌入式Linux驱动中的异步通知机制详解》:本文主要介绍嵌入式Linux驱动中的异步通知机制,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录前言一、异步通知的核心概念1. 什么是异步通知2. 异步通知的关键组件二、异步通知的实现原理三、代码示例分析1. 设备结构

usb接口驱动异常问题常用解决方案

《usb接口驱动异常问题常用解决方案》当遇到USB接口驱动异常时,可以通过多种方法来解决,其中主要就包括重装USB控制器、禁用USB选择性暂停设置、更新或安装新的主板驱动等... usb接口驱动异常怎么办,USB接口驱动异常是常见问题,通常由驱动损坏、系统更新冲突、硬件故障或电源管理设置导致。以下是常用解决

Python使用国内镜像加速pip安装的方法讲解

《Python使用国内镜像加速pip安装的方法讲解》在Python开发中,pip是一个非常重要的工具,用于安装和管理Python的第三方库,然而,在国内使用pip安装依赖时,往往会因为网络问题而导致速... 目录一、pip 工具简介1. 什么是 pip?2. 什么是 -i 参数?二、国内镜像源的选择三、如何

Linux_kernel驱动开发11

一、改回nfs方式挂载根文件系统         在产品将要上线之前,需要制作不同类型格式的根文件系统         在产品研发阶段,我们还是需要使用nfs的方式挂载根文件系统         优点:可以直接在上位机中修改文件系统内容,延长EMMC的寿命         【1】重启上位机nfs服务         sudo service nfs-kernel-server resta

PR曲线——一个更敏感的性能评估工具

在不均衡数据集的情况下,精确率-召回率(Precision-Recall, PR)曲线是一种非常有用的工具,因为它提供了比传统的ROC曲线更准确的性能评估。以下是PR曲线在不均衡数据情况下的一些作用: 关注少数类:在不均衡数据集中,少数类的样本数量远少于多数类。PR曲线通过关注少数类(通常是正类)的性能来弥补这一点,因为它直接评估模型在识别正类方面的能力。 精确率与召回率的平衡:精确率(Pr

【电机控制】数字滤波算法(持续更新)

文章目录 前言1. 数字低通滤波 前言 各种数字滤波原理,离散化公式及代码。 1. 数字低通滤波 滤波器公式 一阶低通滤波器的输出 y [ n ] y[n] y[n] 可以通过以下公式计算得到: y [ n ] = α x [ n ] + ( 1 − α ) y [ n − 1 ] y[n] = \alpha x[n] + (1 - \alpha) y[n-1]