200字范文 > 锁相环原理及数字化用FPGA实现全数字高阶锁相环

锁相环原理及数字化用FPGA实现全数字高阶锁相环

时间：2022-10-21 14:31:53

FPGA实现全数字高阶锁相环

本人通信专业大三学生，非常感谢杜勇老师的《数字通信同步技术》和《锁相环技术原理》，带领小白的我从零开始一点点了解数字同步技术。

第一次写文章，记录一下用FPGA实现二阶、三阶锁相环解调PSK信号

原理推导较多，设计过程也很详细，记录的时候也顺便重新梳理了一遍设计流程，码字不易。

锁相环原理及FPGA实现

FPGA实现全数字高阶锁相环锁相环技术原理基本工作原理鉴相器环路滤波器一阶锁相环二阶锁相环三阶锁相环压控振荡器模拟锁相环数字化从S域到Z域稳态响应数字环路滤波器数控振荡器相关参数计算设计要求输入信号鉴相器数控振荡器环路滤波器FPGA实现二阶、三阶锁相环鉴相器部分环路滤波器部分数控振荡器部分总模块仿真测试三阶锁相环最后

锁相环技术原理

相位锁定环路简称锁相环（PLL），它是以锁定输入载波信号的相位为目标的一种载波环形式。它是一个产生、输出周期信号的电子控制环路，通过不断地调整其输出信号的相位，使输出信号与输入信号相位保持一致，当输入信号、输出信号相位保持一致时称锁相环进入锁定状态，此时表现出锁相环的稳态特性；当输入、输出信号相位未达到一致但趋向于一致的时候成为捕获状态，此时表现锁相环的暂态特性，如果最终锁相环未能达到锁定状态，则称锁相环失锁，丢失信号。

锁相环技术被广泛应用在各种通信系统和仪器设备中，任何需要调制出稳定频率的系统基本上都用到了锁相环。

基本工作原理

首先是模拟锁相环的技术原理，之后是模拟锁相环的数字化。

锁相环由三部分组成，分别是相位鉴相器、环路滤波器、压控振荡器构成。结构如图所示：

从图中可以看出，锁相环是一个负反馈环路，ui(t)u_i(t)ui(t)是输入到锁相环的信号，ui(t)u_i(t)ui(t)是输出信号，锁相环任务就是使得这两个信号的相位保持一致，或者说，输出信号是输入信号的复制品。接下来对各个模块进行数学公式推导。

鉴相器

鉴相器用来鉴别输入信号和产生的复制信号间的相位差异，鉴相器的种类有很多种，最简单的就是一个乘法器。将输入信号和输出信号相乘，即：

ud(t)=ui(t)∗uo(t)=UiUosin(ωi+θi)cos(ωo+θo)=Kdsin{[(ωi+ωo)t+θi+θo]}+sin[(ωi−ωo)t+θi−θo]u_d(t) = u_i(t)*u_o(t)\\=U_iU_osin(\omega_i+\theta_i)cos(\omega_o+\theta_o)\\=K_dsin\left\{ \left[ (\omega_i+\omega_o)t+\theta_i+\theta_o \right] \right\}+sin\left[(\omega_i-\omega_o)t+\theta_i-\theta_o\right] ud(t)=ui(t)∗uo(t)=UiUosin(ωi+θi)cos(ωo+θo)=Kdsin{[(ωi+ωo)t+θi+θo]}+sin[(ωi−ωo)t+θi−θo]

其中KdK_dKd是鉴相器得增益

Kd=12UiUoK_d = \frac{1}{2}U_iU_o Kd=21UiUo

如果输出信号与输入信号非常相似（最终他们是要一样的），那么公式最后一个等式第一项就是两倍于ωi\omega_iωi的高频信号，第二项是低频信号。这时候将乘法器的结果通过一个低通滤波器，那么高频信号就会被滤除出去，而低频信号被保留下来，也就是拿到了输入信号和输出信号的相位差。

环路滤波器

环路滤波器输入信号ud(t)u_d(t)ud(t)包含了输入输出信号相位差的信息，而环路滤波器通常也是一个低通滤波器，但不仅仅是一个低通滤波器，我感觉环路滤波器是整个锁相环的核心，它控制着整个锁相环的性能。

锁相环一阶、二阶、三阶指的是整个系统的阶数（系统函数中分母包含关于s的最高阶次），具体不同阶的作用会在后面具体讨论分析。由于压控振荡器那里存在一阶，所以环路滤波器对应的阶数为常数、一阶、二阶等（锁相环系统阶数=环路滤波器阶数+1），设环路滤波器的系统函数是F(s),具体表达式如下：

一阶锁相环

一阶环路的环路滤波器是一个常数，其传递函数表达式如下：（分母包含关于s的最高阶次为0）

F(s)=1KωnF(s)=\frac{1}{K}\omega_nF(s)=K1ωn

此时环路滤波器相当于一个常数，或者说环路滤波器不存在

二阶锁相环

二阶锁相环环路滤波器传递函数表达式为：（分母包含关于s的最高阶次为1）

F(s)=τ2s+1τ1sF(s)=\frac{\tau_2s+1}{\tau_1s}F(s)=τ1sτ2s+1

定义特征频率和阻尼系数ωn\omega_nωn，ξ\xiξ，表达式为：

ωn=(Kτ1)12ξ=ωnτ22\omega_n=({\frac{K}{\tau_1}})^{\frac{1}{2}}\\\xi = \frac{\omega_n\tau_2}{2}ωn=(τ1K)21ξ=2ωnτ2

这两个参数完全决定了锁相环性能，参数选取不同带来的影响会在后面分析不同阶次锁相环作用时一起分析。

根据参数定义式，从而可以将二阶环路传递函数写成以下的形式：

F(s)=1K(2ξωn+ωn2s)F(s)=\frac{1}{K}(2\xi\omega_n+\frac{\omega_n^2}{s}) F(s)=K1(2ξωn+sωn2)

令a2=ξa_2=\xia2=ξ，则表达式化简为：

F(s)=1K(a2ωn+ωn2s)F(s)=\frac{1}{K}(a_2\omega_n+\frac{\omega_n^2}{s}) F(s)=K1(a2ωn+sωn2)

三阶锁相环

三阶锁相环传递函数为二阶，其表达式为：（分母包含关于s的最高阶次为2）

F(s)=(τ2s+1τ1s)2F(s)=(\frac{\tau_2s+1}{\tau_1s})^2F(s)=(τ1sτ2s+1)2

同理，我们也可以将其简化为以下的表达式：

F(s)=1K(b3ωn+a3ωn2s+ωn3s)F(s)=\frac{1}{K}(b_3\omega_n+\frac{a_3\omega_n^2 }{s}+\frac{\omega_n^3}{s})F(s)=K1(b3ωn+sa3ωn2+sωn3)

其中f3=(τ2τ1)2,f2=(2τ2τ1)2,f1=1(τ1)2f_3=(\frac{\tau_2}{\tau_1})^2 , f2=(\frac{2\tau_2}{\tau_1})^2,f_1=\frac{1}{(\tau_1)^2}f3=(τ1τ2)2,f2=(τ12τ2)2,f1=(τ1)21

b3=Kf3(Kf1)(13),a3=Kf2(Kf1)(23)b_3=\frac{Kf_3}{(Kf_1)^(\frac{1}{3})},a_3=\frac{Kf_2}{(Kf_1)^(\frac{2}{3})}b3=(Kf1)(31)Kf3,a3=(Kf1)(32)Kf2

压控振荡器

鉴相器的输出经过环路滤波器之后送入压控振荡器，压控振荡器基本功能是产生一定周期频率的信号，输入信号和产生信号关系为：

dωo(t)dt=Kouf(t)\frac{d\omega_o(t)}{dt}=K_ou_f(t)dtdωo(t)=Kouf(t)

kok_oko为压控振荡器的增益，ωo\omega_oωo是输出信号的瞬时角频率，我们还可以得到振荡器输出信号的瞬间初始相位为：

θo(t)=∫0tdωo(t)dtdt=Ko∫0tuf(t)dt\theta_o(t)=\int_0^t\frac{d\omega_o(t)}{dt}dt=K_o\int_0^tu_f(t)dtθo(t)=∫0tdtdωo(t)dt=Ko∫0tuf(t)dt

只要锁相环输入与输出信号之间存在一个相位差，压控振荡器就会根据信号相位的差异不断调整输出信号频率，使得最终相位保持一致。

通过对输出信号表达式进行拉普拉斯变换，可以得到压控振荡器的传递函数为：

V(s)=θo(s)uf(s)=kosV(s)=\frac{\theta_o(s)}{u_f(s)}=\frac{k_o}{s}V(s)=uf(s)θo(s)=sko

由此证实压控振荡器的阶数为1。

三个模块传递函数均写出之后，可以得到锁相环系统的传递函数为：

H(s)=θo(s)θi(s)=KF(s)s+KF(s)H(s)=\frac{\theta_o(s)}{\theta_i(s)}=\frac{KF(s)}{s+KF(s)}H(s)=θi(s)θo(s)=s+KF(s)KF(s)

F(s)F(s)F(s)为环路滤波器的传递函数，K为系统总增益，K=KoKdK=K_oK_dK=KoKd

即鉴相器增益乘以压控振荡器的增益。

模拟锁相环数字化

现在所有的输入信号均是采样信号，所以我们要设计的是全数字锁相环，要对每个模块进行数字化。

从S域到Z域

之上讨论传递函数和系统函数时均对时域进行拉普拉斯变换到s域（连续），信号与系统课学过，离散的s域便是Z域，即我们要对系统时域做Z变换。

Z变换也可以看作从拉普拉斯变换的采样，在设计数字环路滤波器的时候可以采用双线性变换积分器和矩形波积分器两种方式，将s离散化，具体形式如下：

s=2T1−z−11+z−1s=1−z(−1)Ts=\frac{2}{T}\frac{1-z^{-1}}{1+z^{-1}}\\s=\frac{1-z^(-1)}{T}s=T21+z−11−z−1s=T1−z(−1)

上式中T为采样周期。

稳态响应

从系统函数H(z)分析，可以看出锁相环阶数对其跟踪能力的影响。

由Z变换终值定理可知，输出信号与输入信号相位差θe(n)=θo(n)−θi(n)\theta_e(n)=\theta_o(n)-\theta_i(n)θe(n)=θo(n)−θi(n)在n趋向于无穷时（锁相环稳定后的输出信号与输入信号相位差）应该等于其Z变换后Z趋近于1的值，即：

lim⁡n→+∞θe(n)=lim⁡z→1[(z−1)θe(z)]θe(z)=He(z)θi(z){\lim_{n \to +\infty}}\theta_e(n)={\lim_{z \to 1}}\left[(z-1)\theta_e(z)\right]\\\theta_e(z)=H_e(z)\theta_i(z) n→+∞limθe(n)=z→1lim[(z−1)θe(z)]θe(z)=He(z)θi(z)

H(z)为系统函数,He(z)H_e(z)He(z)为误差信号系统函数

总结一二三阶锁相环系统函数，可以给出N阶锁相环系统函数为：

H(z)=Ts∑n=0N−1bnz−n−1(1−z−1)N+Ts∑n=0N−1bnz−n−1H(z)=\frac{T_s \sum_{n=0}^{N-1}b_nz^{-n-1}}{(1-z^{-1})^N+T_s \sum_{n=0}^{N-1}b_nz^{-n-1}}H(z)=(1−z−1)N+Ts∑n=0N−1bnz−n−1Ts∑n=0N−1bnz−n−1

He(z)=1−H(z)=(1−z−1)N(1−z−1)N+Ts∑n=0N−1bnz−n−1H_e(z)=1-H(z)=\frac{(1-z^{-1})^N}{(1-z^{-1})^N+T_s \sum_{n=0}^{N-1}b_nz^{-n-1}} He(z)=1−H(z)=(1−z−1)N+Ts∑n=0N−1bnz−n−1(1−z−1)N

从而给定输入信号，可以求出稳态时锁相环的相位误差

以频率阶跃激励为例，θi(n)=Δωnu(n)\theta_i(n)=\Delta_\omega nu(n)θi(n)=Δωnu(n)，Δω\Delta_\omegaΔω为频率阶跃幅值，从而根据终值定理，我们可以求出

lim⁡n→∞θe(n)={ΔωTsb0N=10N>1{\lim_{n \to \infty}}\theta_e(n)=\left\{ \begin{aligned} \frac{\Delta_\omega}{T_sb0} & & N=1 \\ 0 & &N>1 \\ \end{aligned} \right. n→∞limθe(n)=⎩⎪⎨⎪⎧Tsb0Δω0N=1N>1

由此可见，一阶锁相环稳态响应时相位误差为一个常数，二阶以上的锁相环稳态响应相位误差为0。

同理，可以计算当输入信号为频率斜升激励时，一阶锁相环稳态时会失锁，二阶锁相环稳态时有恒定相位跟踪误差，三阶以上锁相环稳态响应为0

接下来用matlab对锁相环稳态响应进行仿真。

当输入信号频率恒定时，即相位与时间成线性关系，用二阶锁相环对输入信号进行捕获，稳态时信号波形和相位结果如下：

上图中红色为输入信号波形和相位变化曲线，蓝色为锁相环输出信号波形和相位变化曲线。从图中可以看出，输入信号相位随时间增长线性增加，信号频率保持不变。用二阶锁相环进行捕获时，稳态相差为零，可以完全复制输入信号。

接下来将输入信号变为线性调频信号，即输入信号相位与时间成平方关系，仍然用二阶锁相环进行捕获，结果如下：

这回可以发现，当输入信号为线性调频信号，即相位随时间平方倍增加时，锁相环输出相位会与输入信号存在一个稳态相差。

改用三阶锁相环对信号进行捕获：

可以看出，三阶锁相环可以完美捕获线性调频信号。

通过公式推导，我们可以得出结论，一个N阶锁相环可以最多准确无误地跟踪相位按照时间(N-1)次方变化的信号，否则会出现稳态相差甚至失锁。

接下来分析锁相环的暂态性能。对于二阶锁相环，ξ\xiξ和ωn\omega_nωn决定着锁相环的跟踪速度和灵敏程度，结果如下：

ξ\xiξ越小，锁相环越灵敏，ωn\omega_nωn越大，锁相环跟踪速度越快。

数字环路滤波器

根据变换表达式，我们可以得到数字环路滤波器的Z域表达式，以二阶、三阶为例：

二阶锁相环环路滤波器：F(z)=C1+C2z−11−z−1C1=2ξωnTKC2=(ωnT)2KF(z)=C_1+C_2\frac{z^{-1}}{1-z^{-1}}\\C_1=2\frac{\xi\omega_nT}{K}\\C_2 = \frac{(\omega_nT)^2}{K}F(z)=C1+C21−z−1z−1C1=2KξωnTC2=K(ωnT)2

三阶锁相环环路滤波器：F(z)=C1+C2z−11−z−1+C3(z−11−z−1)2C1=b3ωnTKC2=a3ωn2T2KC3=ωn3T3KF(z)=C_1+C_2\frac{z^{-1}}{1-z^{-1}}+C_3(\frac{z^{-1}}{1-z^{-1}})^2\\ C_1=\frac{b_3\omega_nT}{K}\\ C_2 = \frac{a_3\omega_n^2T^2}{K}\\ C_3=\frac{\omega_n^3T^3}{K} F(z)=C1+C21−z−1z−1+C3(1−z−1z−1)2C1=Kb3ωnTC2=Ka3ωn2T2C3=Kωn3T3

根据其Z域表达式可以反推出时域表达式，从而进行FPGA设计。二阶、三阶时域表达式可以写为：

二阶锁相环：uf(t)=C1ud(t)+temp(t)temp(t)=temp(t−1)+C2ud(t)u_f(t)=C_1u_d(t)+temp(t)\\temp(t)=temp(t-1)+C_2u_d(t)uf(t)=C1ud(t)+temp(t)temp(t)=temp(t−1)+C2ud(t)

三阶锁相环：uf(t)=C1ud(t)+temp1(t)+temp2(t)temp1(t)=temp1(t−1)+C2ud(t)temp2(t)=2temp2(t−1)−temp2(t−2)+C3ud(t)u_f(t)=C_1u_d(t)+temp1(t)+temp2(t)\\temp1(t)=temp1(t-1)+C_2u_d(t)\\temp2(t)=2temp2(t-1)-temp2(t-2)+C_3u_d(t)uf(t)=C1ud(t)+temp1(t)+temp2(t)temp1(t)=temp1(t−1)+C2ud(t)temp2(t)=2temp2(t−1)−temp2(t−2)+C3ud(t)

数控振荡器

数控振荡器（NCO）输出一个阶梯形周期信号，通过正弦、余弦查表将输出转换成为正弦、余弦信号。

输出频率为fo=Mfclk2Nf_o=\frac{Mf_{clk}}{2^N}fo=2NMfclk

M为相位增量控制字，N为数控振荡器的位数。

根据时钟频率，确定了输出信号频率后，可以求出控制字大小。

M=2NfofclkM=\frac{2^Nf_o}{f_{clk}}M=fclk2Nfo

FPGA实现二阶、三阶锁相环

计算完参数以后，接下来进行FPGA设计。我采用的是vivado.4的版本进行仿真测试的

鉴相器部分

首先是乘法器部分，调用乘法器IP核，将输入信号din分别和输出信号的IQ两路（sine、cosine）相乘

mult_gen_0 mq(.clk(clk),.a(din),.b(cosine),.p(mdq));mult_gen_0 mi(.clk(clk),.a(din),.b(sine),.p(mdi));

滤波器环节调用滤波器IP核，设置采样频率为30Mhz，量化位宽为12bit，输入信号为乘法器鉴相后的的输出结果。位宽为19bit（第一位为符号位，舍去）

将matlab产生的滤波器系数导入，vivado给出的滤波器幅频特性为：

将滤波器ip核实例化，滤波器输出为32位（IQ两路分别实例化一个ip核）：

fir_compiler_0 fq(.aclk(clk),.s_axis_data_tdata(mdq[18:0]),.s_axis_data_tready(m_axis_data_tvalid_q),.s_axis_data_tvalid(1'b1),.m_axis_data_tdata(dq),.m_axis_data_tvalid(m_axis_data_tvalid_q));fir_compiler_0 fi(.aclk(clk),.s_axis_data_tdata(mdi[18:0]),.s_axis_data_tready(m_axis_data_tvalid_i),.s_axis_data_tvalid(1'b1),.m_axis_data_tdata(di),.m_axis_data_tvalid(m_axis_data_tvalid_i));

接下来是通过IQ两路鉴别相位差异：

module phase_detect(rst,clk,di,dq,pd);input rst;input clk;input signed[31:0]di;input signed[31:0]dq;output signed[31:0]pd;reg signed [31:0]pdout;always@(posedge clk or posedge rst)if(!rst)pdout <= 32'd0;elsebeginif(di[31])pdout <= -dq;elsepdout <= dq;endassign pd = pdout;endmodule

环路滤波器部分

module filter_loop(rst,clk,pd,frequency_df);input rst;input clk;input signed[31:0]pd;output signed[31:0]frequency_df;reg signed[31:0]sum_d;wire signed[31:0]pd_c2,pd_c1,sum;wire signed[31:0]df;assign pd_c1 = {{6{pd[31]}},pd[31:6]};assign pd_c2 = {{12{pd[31]}},pd[31:12]};always@(posedge clk or posedge rst)if(!rst)sum_d <= 0;elsesum_d <= sum;assign sum = pd_c2+sum_d;assign df = sum_d+pd_c1;assign frequency_df = df;endmodule

数控振荡器部分

数控振荡器调用DDSip核产生正弦和余弦信号，设置频率控制字为可编程状态，通过设置芜杂散动态范围来控制输出正余弦的位宽。

实例化DDSip核如下：

assign carrier = 32'd809332900;assign s_axis_config_tdata = frequency_df + carrier;dds_compiler_0 dd1(.aclk(clk),.aresetn(rst),.s_axis_config_tdata(s_axis_config_tdata),.s_axis_config_tvalid(1'b1),.m_axis_data_tdata(m_axis_data_tdata),.m_axis_data_tvalid(m_axis_data_tvalid),.m_axis_phase_tdata(m_axis_phase_tdata),.m_axis_phase_tvalid(m_axis_phase_tvalid));wire signed[9:0]cosine;wire signed[9:0]sine;assign cosine = m_axis_data_tdata[9:0];assign sine = m_axis_data_tdata[25:16];

总模块

总模块将其他模块实例化：

module PLL_TWO(rst,clk,din,datai,dataq,pd,frequency_df);input rst;input clk;input signed[9:0]din;output signed[31:0]datai;output signed[31:0]dataq;output signed[31:0]pd;output signed[31:0]frequency_df;wire signed[31:0] s_axis_config_tdata;wire signed[31:0] m_axis_data_tdata;//sine and cosinewire m_axis_data_tvalid;wire m_axis_phase_tvalid;wire signed[31:0] m_axis_phase_tdata;wire signed[31:0] carrier;assign carrier = 32'd809332900;assign s_axis_config_tdata = frequency_df + carrier;dds_compiler_0 dd1(.aclk(clk),.aresetn(rst),.s_axis_config_tdata(s_axis_config_tdata),.s_axis_config_tvalid(1'b1),.m_axis_data_tdata(m_axis_data_tdata),.m_axis_data_tvalid(m_axis_data_tvalid),.m_axis_phase_tdata(m_axis_phase_tdata),.m_axis_phase_tvalid(m_axis_phase_tvalid));wire signed[9:0]cosine;wire signed[9:0]sine;assign cosine = m_axis_data_tdata[9:0];assign sine = m_axis_data_tdata[25:16];wire signed[19:0]mdq;wire signed[19:0]mdi;mult_gen_0 mq1(.CLK(clk),.A(din),.B(cosine),.P(mdq));mult_gen_0 mi1(.CLK(clk),.A(din),.B(sine),.P(mdi));wire signed[31:0]dq;wire signed[31:0]di;wire m_axis_data_tvalid_q;wire m_axis_data_tvalid_i;fir_compiler_0 fq(.aclk(clk),.s_axis_data_tdata(mdq[18:0]),.s_axis_data_tready(m_axis_data_tvalid_q),.s_axis_data_tvalid(1'b1),.m_axis_data_tdata(dq),.m_axis_data_tvalid(m_axis_data_tvalid_q));fir_compiler_0 fi(.aclk(clk),.s_axis_data_tdata(mdi[18:0]),.s_axis_data_tready(m_axis_data_tvalid_i),.s_axis_data_tvalid(1'b1),.m_axis_data_tdata(di),.m_axis_data_tvalid(m_axis_data_tvalid_i));wire signed[31:0]pd;phase_detect ph1(.rst(rst),.clk(clk),.di(di),.dq(dq),.pd(pd));wire signed[31:0]frequency_df;filter_loop f1(.rst(rst),.clk(clk),.pd(pd),.frequency_df(frequency_df));assign datai = di;assign dataq = dq;endmodule

仿真测试

用matlab产生输入信号并导出。

添加并编写vivado仿真文件进行仿真测试，导入产生的输入信号。仿真结果如下：

pd为鉴相器的输出，即输出信号与输入信号的相位差异。

frequency_df为环路滤波器的输出。从图中可以看出，在第九百个周期左右锁相环达到锁定状态。

三阶锁相环

三阶锁相环与二阶锁相环只有环路滤波器不一样，其余完全一致，根据环路滤波器公式：

F(z)=C1+C2z−11−z−1+C3(z−11−z−1)2C1=b3ωnTKC2=a3ωn2T2KC3=ωn3T3KF(z)=C_1+C_2\frac{z^{-1}}{1-z^{-1}}+C_3(\frac{z^{-1}}{1-z^{-1}})^2\\ C_1=\frac{b_3\omega_nT}{K}\\ C_2 = \frac{a_3\omega_n^2T^2}{K}\\ C_3=\frac{\omega_n^3T^3}{K} F(z)=C1+C21−z−1z−1+C3(1−z−1z−1)2C1=Kb3ωnTC2=Ka3ωn2T2C3=Kωn3T3取a3=1.1,b3=2.4,ωn=0.5Mhza_3=1.1,b_3=2.4,\omega_n=0.5Mhza3=1.1,b3=2.4,ωn=0.5Mhz可以求出三阶锁相环的环路滤波器参数C1,C2,C3C_1,C_2,C_3C1,C2,C3，从而在FPGA中进行相对应的移位操作，具体原理公式上面有写，计算结果如下：

C1=2−5C2=2−12C3=2−18C_1=2^{-5}\\ C_2=2^{-12}\\ C_3=2^{-18} C1=2−5C2=2−12C3=2−18

更改环路滤波器代码如下：

module filter_loop(rst,clk,pd,frequency_df);input rst;input clk;input signed[31:0]pd;output signed[31:0]frequency_df;reg signed[31:0]sum_c2,sum_c3,sum_c3_2;wire signed[31:0]pd_c2,pd_c1,pd_c3,sum_2,sum_3;wire signed[31:0]df;assign pd_c1 = {{5{pd[31]}},pd[31:5]};assign pd_c2 = {{12{pd[31]}},pd[31:12]};assign pd_c3 = {{18{pd[31]}},pd[31:18]}; always@(posedge clk or posedge rst)if(!rst)beginsum_c2 <= 0;sum_c3 <= 0;sum_c3_2 <= 0;endelsebeginsum_c2 <= sum_2;sum_c3 = sum_c3_2;sum_c3_2 = sum_3;endassign sum_2 = pd_c2+sum_c2;assign sum_3 = pd_c3-sum_c3+2*sum_c3_2;assign df = sum_c2+pd_c1+sum_c3;assign frequency_df = df;endmodule

仿真结果如下：