matlab带阻滤器

clc;
clear;
close;
%% 设置参数
Q  = 100;  % 滤波器的口质系数
G  = 60;   % (dB)中心频率负增益

f0 = 1000; % (Hz)中心频率
fs = 10000;% (Hz)采样频率

k  = tan(pi*f0/fs);
V  = 10^(G/20);
%% 计算IIR陷波器系数
a0 =(1 + k/Q + k^2)/(1 + V*k/Q + k^2);
a1 =2*(k^2 - 1)/(1 + V*k/Q + k^2);
a2 = (1 - k/Q + k^2)/(1 + V*k/Q + k^2);

b1 = a1;
b2 = (1 - V*k/Q + k^2)/(1 + V*k/Q + k^2);


%% 画图
num = [a0 a1 a2];
den = [1 b1 b2];
za = tf(num,den,0.0001)

opt = bodeoptions;
opt.FreqUnits = 'Hz';
opt.Grid      = 'on';
bode(za,opt)
%num_Q12 = (num*4096.0)
%den_Q12 = (den*4096.0) 
% round:四舍五入 
%fix：截尾取整（向零方向取整）
%floor：返回不大于x的最大整数值（向负无穷方向取整）
num_Q12 = round(num*65536.000);
den_Q12 = round(den*65536.000);
za_Q12 = tf(num_Q12,den_Q12,0.0001)
hold on;
bode(za_Q12,opt)

matlab运行结果：

za =
 
  0.2546 z^2 - 0.4108 z + 0.2531
  ------------------------------
     z^2 - 0.4108 z - 0.4922
 
Sample time: 0.0001 seconds
Discrete-time transfer function.


za_Q12 =
 
  16687 z^2 - 26921 z + 16589
  ---------------------------
  65536 z^2 - 26921 z - 32260
 
Sample time: 0.0001 seconds
Discrete-time transfer function.

#define num0 	(60654)	// 分子2次项
#define num1 	(0)		// 分子1次项
#define num2 	(60654)	// 分子0次项

#define den0 	(65536)	// 分母2次项
#define den1 	(-238)	// 分母1次项
#define den2 	(56007)	// 分母0次项

/*方法 2 ***********************************************************************/
In1 = (long)(AlphBeta->Alph);
bsf_alph.y_tmp = num0*In1 + num1*bsf_alph.in0[0] + num2*bsf_alph.in0[1];
bsf_alph.y_out = (bsf_alph.y_tmp - den1*bsf_alph.out[0] - den2*bsf_alph.out[1])>>16;

bsf_alph.in0[1]=bsf_alph.in0[0];
bsf_alph.in0[0]=In1;

bsf_alph.out[1]=bsf_alph.out[0];
bsf_alph.out[0]=bsf_alph.y_out;

Out = (int)bsf_alph.y_out;


/*方法1 matlab******************************************************************/
In1 = (long)(AlphBeta->Alph);
tmp = ((den0*In1 - den1* z_alpha[0])- den2* z_alpha[1])>>16;
OutTmp = ((num0*tmp + num1* z_alpha[0])+ num2* z_alpha[1])>>16;
z_alpha[1] = z_alpha[0];
z_alpha[0] = tmp;

Out = (int)OutTmp;