当前位置:首页 > EDA > 电子设计自动化
[导读]工业闭环别把所有控制都扔给CPU。合理切法是:FPGA跑采样、误差、PID、PWM、过流联锁,做到采样即算、逐拍输出;嵌入式C只做参数整定、模式切换、故障诊断、HMI和日志。关键回路不进中断批处理,整体延迟从“毫秒级软件环”降到“微秒/亚微秒级硬件环”。


工业闭环别把所有控制都扔给CPU。合理切法是:FPGA跑采样、误差、PID、PWM、过流联锁,做到采样即算、逐拍输出;嵌入式C只做参数整定、模式切换、故障诊断、HMI和日志。关键回路不进中断批处理,整体延迟从“毫秒级软件环”降到“微秒/亚微秒级硬件环”。

一、硬件闭环:采样—PID—PWM

用增量式PID最省资源,定点Q15、带饱和与抗积分。每个采样tick锁误差,输出占空比送PWM比较器:

module hw_pid_pwm #(parameter W=16, PW=12)(

 input clk, rst_n, input tick,

 input [W-1:0] set, meas,

 input [W-1:0] kp, ki, kd,

 output reg [PW-1:0] duty, output reg pwm_out,

 input [PW-1:0] period);

 reg [W-1:0] e0,e1,e2; reg [31:0] u; reg [PW-0:0] cnt;

 always @(posedge clk or negedge rst_n) begin

   if(!rst_n) {e0,e1,e2,u,duty,cnt}<=0;

   else begin

     if(tick) begin

       e2<=e1; e1<=e0; e0<=set-meas;

       u <= u + ($signed(kp)*(e0-e1)>>>15)

               + ($signed(ki)*e0>>>15)

               + ($signed(kd)*(e0-2*e1+e2)>>>15);

       if(u> period) u<=period; if(u<0) u<=0;   // 饱和限幅

       duty<=u[PW-1:0];

     end

     cnt<=cnt+1; if(cnt>=period) cnt<=0;

     pwm_out <= cnt<duty;                        // 定频PWM,无软件抖动

   end

 end

endmodule

伺服电流环用类似结构可把采样到输出压到1μs内,多轴并行、轴间同步误差远小于软件方案。

二、嵌入式C:AXI-Lite配置与监控

Zynq/MPSoC/SoC把PID挂AXI-Lite,C端只写Kp/Ki/Kd、读实际占空比和故障,不参加每个控制周期计算:

#define PID_BASE 0x43C00000

#define REG(o) (*(volatile unsigned*)(PID_BASE+(o)))

void pid_set(unsigned kp,unsigned ki,unsigned kd){

 REG(0x00)=0;          // 停算装载

 REG(0x04)=kp; REG(0x08)=ki; REG(0x0C)=kd;

 REG(0x00)=1;          // 启动硬件环

}

void pid_diag(unsigned *duty,unsigned *fault){

 *duty=REG(0x10); *fault=REG(0x14);

}

// 中断仅处理异常,不重算PID

void __attribute__((interrupt)) pl_irq(void){

 unsigned st=REG(0x14);

 if(st&0x1) fault_overcurrent();   // 过流:硬件已封锁PWM,软件记日志

 REG(0x18)=0x1;                    // 清中断标志

 (void)REG(0x18);                  // 写后读,确保AXI写到达PL

}

AXI写有缓冲,清中断后回读一次可避免“清了又进”的中断风暴。 大数据采集走AXI-DMA或AXI-Stream,C只等帧完成中断,不逐样本搬运。

三、协同分工与低延迟要点

硬实时路径全硬件:ADC→滤波→PID→PWM→驱动器;采样触发放在PWM中点,避开开关噪声。

软侧只做慢速:整定参数、自动调谐、配方切换、上位机通信、SD卡记录。参数改完通过AXI-Lite下发,硬件环不停。

多轴同步:FPGA内用同一tick计数器发采样/控制脉冲,各轴PID例化独立核;C只发统一“同步启动”,不逐个轮询。

跨时钟:ADC、PID、PWM若异钟,误差/输出先双寄存器同步,FIFO桥数据面;控制寄存器面用AXI时钟域双缓冲,避免亚稳态。

安全联锁:过流、限位、ESTOP在PL内组合直接封PWM,响应纳秒~百纳秒级;C仅做事后诊断,不依赖操作系统实时性。

Linux侧若跑管理任务,关键环别走普通内核线程;用PREEMPT_RT、UIO或裸机核处理配置与告警,硬件环不受调度影响。

四、落地与验收

先ModelSim/Verilator用阶跃数据验PID定点精度,再上板:C写参→ILA抓set/meas/duty/pwm_out→注入负载看超调与稳差。对比同算法纯软件中断环,通常硬件环延迟可降一个数量级以上;验收看三项——阶跃稳定时间、轴间同步偏差、异常封锁到PWM关断时间。资源紧张用时间复用PID核,实时性优先则每通道独立核。按“C管配置诊断、FPGA管采样控制输出、AXI-Lite下参、DMA搬数、PL硬联锁”分工,工业闭环既低延迟又易维护。



本站声明: 本文章由作者或相关机构授权发布,目的在于传递更多信息,并不代表本站赞同其观点,本站亦不保证或承诺内容真实性等。需要转载请联系该专栏作者,如若文章内容侵犯您的权益,请及时联系本站删除( 邮箱:macysun@21ic.com )。
关闭