基于FPGA的PID算法学习———实现PI比例控制算法

文章目录

前言

学习内容:参考网站:
PID算法控制

PID即:Proportional(比例)、Integral(积分)、Differential(微分)的缩写。也就是说,PID算法是结合这三种环节在一起的。

闭环控制:输出会影响到输入,进而逐渐逼近目标。

一、PI环控制算法

积分控制算法,就是为了消除稳态误差,由于积分是从0时刻一直积分到当前时刻 t,并且是对e(t)函数进行积分。

PI比例控制算法:

核心部分,大部分作用来自于P,I和D主要控制减小误差。

目标值:Target

实际值:Pid_out

误差值:e_t

上一时刻误差值:e_t

弥补值:u_t

相关公式:

误差值:e_t=Target - Pid_out

上一时刻误差值:e_t_1=e_t

弥补值:*u(t)=Kp ( e(t) - e(t-1)) + Ki * e(t)

输出值:Pid_out = Pid_out + u(t)

二、仿真分析验证

1.P环仿真

c 复制代码
module PID_trol(
     input                     sys_clk  ,  
     input                     rst_n,   
     //signal  
	  input		 signed	[7:0]  target,
	  output reg signed	[7:0]  Pid_out
    );
	 
	 reg	signed	[15:0]		e_t;//目标值和现在值的差距
	 reg	signed	[32:0]		u_t;//补偿值
     
	 parameter signed K_p = 32'd300;
	 parameter signed div = 8'd3;
//	 assign e_t = target - Pid_out;
	 always @(posedge sys_clk or negedge rst_n)begin
		  if(!rst_n)begin
				e_t <= 16'd0;
		  end
		  else begin
				e_t <= target - Pid_out;
		  end
	 end
	 
	 always @(posedge sys_clk or negedge rst_n)begin
		  if(!rst_n)begin
				u_t <= 32'd0;
		  end
		  else begin
				u_t <= (e_t * K_p )/1000;
		  end
	 end
	 
	 always @(posedge sys_clk or negedge rst_n)begin
		  if(!rst_n)begin
				Pid_out <= 8'd0;
		  end
		  else begin
		        Pid_out <= Pid_out + u_t;
		  end
	 end
	 
	 
	 
endmodule

2.PI环仿真

c 复制代码
module PID_control(
     input                     sys_clk  ,  
     input                     rst_n,   
     //signal  
	  input		 signed	[7:0]  target,
	  output reg signed	[7:0]  Pid_out
    );
	 
	 reg	signed	[15:0]		e_t;//目标值和现在值的差距
	 reg	signed	[15:0]		e_t_1;//上一时刻差距
	 reg	signed	[32:0]		u_t;//补偿值
     
	 parameter signed K_p = 32'd200;
	 parameter signed div_p = 8'd3;
	 
	 parameter signed K_i = 32'd310;
	 parameter signed div_i = 8'd3;
//	 assign e_t = target - Pid_out;
	 always @(posedge sys_clk or negedge rst_n)begin
		  if(!rst_n)begin
				e_t <= 16'd0;
		  end
		  else begin
				e_t <= target - Pid_out;
		  end
	 end
	 
	 always @(posedge sys_clk or negedge rst_n)begin
		  if(!rst_n)begin
				e_t_1 <= 16'd0;
		  end
		  else begin
				e_t_1 <= e_t;
		  end
	 end
	 
	 always @(posedge sys_clk or negedge rst_n)begin
		  if(!rst_n)begin
				u_t <= 32'd0;
		  end
		  else begin
				u_t <= ((e_t - e_t_1) * K_p )/1000 + ( e_t * K_i)/1000 ;
		  end
	 end
	 
	 always @(posedge sys_clk or negedge rst_n)begin
		  if(!rst_n)begin
				Pid_out <= 8'd0;
		  end
		  else begin
		        Pid_out <= Pid_out + u_t;
		  end
	 end
	 
	 
	 
endmodule

3.顶层

c 复制代码
`timescale 1ns / 1ps
//
// Company: 
// Engineer: 
// 
// Create Date: 2025/06/10 13:45:03
// Design Name: 
// Module Name: top
// Project Name: 
// Target Devices: 
// Tool Versions: 
// Description: 
// 
// Dependencies: 
// 
// Revision:
// Revision 0.01 - File Created
// Additional Comments:
// 
//


module top(
     input                     sys_clk  ,  
     input                     rst_n,   
     //signal  
	  input		  signed	[7:0]  target,
	  output wire signed	[7:0]  P_out,
	  output wire signed	[7:0]  Pi_out
    );
    
    
    
   PID_control u_PI (
        .sys_clk   (sys_clk),
        .rst_n     (rst_n),
        .target    (target),
        .Pid_out   (Pi_out) 
    );
    
    PID_trol u_P(
    .sys_clk   (sys_clk),
    .rst_n     (rst_n),
    .target    (target),
    .Pid_out   (P_out)
);
endmodule

4.测试文件

c 复制代码
`timescale 1ns / 1ps
//
// Company: 
// Engineer: 
// 
// Create Date: 2025/06/10 13:48:03
// Design Name: 
// Module Name: tb_top
// Project Name: 
// Target Devices: 
// Tool Versions: 
// Description: 
// 
// Dependencies: 
// 
// Revision:
// Revision 0.01 - File Created
// Additional Comments:
// 
//

`timescale 1ns / 1ps

module tb_top();
    // 输入信号
    reg         sys_clk;
    reg         rst_n;
    reg signed [7:0] target;
    
    // 输出信号
    wire signed [7:0] P_out;
    wire signed [7:0] Pi_out;
    
    // 实例化顶层模块
    top u_top (
        .sys_clk (sys_clk),
        .rst_n   (rst_n),
        .target  (target),
        .P_out   (P_out),
        .Pi_out  (Pi_out)
    );
    
    // 时钟生成(100MHz)
    initial begin
        sys_clk = 0;
        forever #10 sys_clk = ~sys_clk;  // 10ns周期 = 100MHz
    end
    
    // 测试激励
    initial begin
        // 初始化并复位
        rst_n = 0;
        target = 0;
        #20;  // 等待两个时钟周期
        
        // 释放复位
        rst_n = 1;
        #10;
        
        // 测试场景 1:正目标值
        target = 8'd100;   // +50


    end
    

endmodule

5.仿真波形

总结

加上I之后,整体上升缓和了一点,同时调整速度缩短了一点。

相关推荐
尘似鹤2 分钟前
微信小程序学习(一)
学习·微信小程序
做运维的阿瑞2 小时前
Python零基础入门:30分钟掌握核心语法与实战应用
开发语言·后端·python·算法·系统架构
weixin_307779134 小时前
Redshift SQL搜索表中所有字段的值
数据仓库·sql·算法·云计算·aws
GilgameshJSS5 小时前
STM32H743-ARM例程3-SYSTICK定时闪烁LED
arm开发·stm32·单片机·嵌入式硬件·学习
十八岁讨厌编程5 小时前
【算法训练营Day26】动态规划part2
算法·动态规划
智者知已应修善业6 小时前
【C++无数组矩阵对角线平均值保留2位小数】2022-11-18
c语言·c++·经验分享·笔记·算法·矩阵
papership7 小时前
【入门级-算法-6、排序算法: 计数排序】
数据结构·算法·排序算法
pengpeng027 小时前
力扣每日一题 611. 有效三角形的个数
算法·leetcode·职场和发展
东临碣石827 小时前
【AI论文】潜在区域划分网络:生成建模、表征学习与分类的统一原理
学习
xinfei08037 小时前
第五天——为什么要学习
学习·每天一篇小感悟