Пересчитаны коэфициенты фильтра-корректора. Добавлен скрипт матлаба от Капитанова, для расчета характеристик фильтров.

src/src/FftDataFiltering/DecimFilterWrapper.v

@@ -23,7 +23,7 @@ module	DecimFilterWrapper
 	parameter	AdcDataWidth		=	14,
 	parameter	N	=	8,
 	parameter	M	=	2,
-	parameter	FilteredDataWidth	=	42,
+	parameter	FilteredDataWidth	=	38,
 	parameter	FirOutDataWidth		=	48,
 	parameter	FirOutCutBit		=	42
 )
@@ -72,12 +72,12 @@ module	DecimFilterWrapper
 	localparam	extendBitNum	=	FilteredDataWidth-AdcDataWidth;
 	
 	localparam	maxWidthForR1	=	10'd16;	//msb for R = 2;
-	localparam	maxWidthForR2	=	10'd25;	//msb for R = 2;
+	localparam	maxWidthForR2	=	10'd21;	//msb for R = 2;
 	localparam	maxWidthForR3	=	10'd26;	//msb for R = 3;
 	localparam	maxWidthForR4	=	10'd28;	//msb for R = 4;
-	localparam	maxWidthForR5	=	10'd38;	//msb for R = 5;
-	localparam	maxWidthForR6	=	10'd40;	//msb for R = 6;
-	localparam	maxWidthForR7	=	10'd41;	//msb for R = 7;
+	localparam	maxWidthForR5	=	10'd31;	//msb for R = 5;
+	localparam	maxWidthForR6	=	10'd33;	//msb for R = 6;
+	localparam	maxWidthForR7	=	10'd34;	//msb for R = 7;
 	// localparam	maxWidthForR8	=	5'd26;	//msb for R = 8;
 	// localparam	maxWidthForR9	=	5'd27;	//msb for R = 9;
 	// localparam	maxWidthForR10	=	5'd28;	//msb for R = 10;

src/src/Sim/CicTest.m

@@ -1,6 +1,6 @@
 FormatSpec = '%d';
 PointsNum = 500;
-N = 12;
+N = 8;
 R = 2;
 B = 14;
 M = 1;

src/src/Sim/CorrFilterCoefs.txt

@@ -13,4 +13,4 @@
 -5332
 3543
 -1274
-247
+247

src/src/Sim/DecimFilterWrapperTb.v

@@ -47,10 +47,10 @@ always	#10 Clk50	=	~Clk50;
 
 //==========================================================================================
 
-parameter	N	=	12;
+parameter	N	=	8;
 parameter	M	=	1;
 
-parameter	MaxWidth	=	51;
+parameter	MaxWidth	=	38;
 
 initial begin
 	Clk50		=	1'b1;
@@ -103,7 +103,7 @@ ncoInst1
 	.Clk_i		(Clk50),
 	.Rst_i		(Rst),
 	.Val_i		(1'b1),
-	.PhaseInc_i	(32'h51eb851),
+	.PhaseInc_i	(32'h19999999),
 	.WindVal_i	(1'b1),
 	.WinType_i	(),
 	.Wind_o		(),
@@ -124,7 +124,7 @@ ncoInst2
 	.Clk_i		(Clk50),
 	.Rst_i		(Rst),
 	.Val_i		(1'b1),
-	.PhaseInc_i	(32'h33333333),
+	.PhaseInc_i	(32'h3d70a3d7),
 	.WindVal_i	(1'b1),
 	.WinType_i	(),
 	.Wind_o		(),

src/src/Sim/FFTTest.m

@@ -1,7 +1,7 @@
 FormatSpec = '%d';
 PointsNum = 500;
 N = 8;
-R = 2;
+R = 4;
 B = 14;
 M = 1;
 
@@ -23,48 +23,49 @@ ReadFilteredDataId = fopen('C:/S5243_FFT_REPO/src/src/Sim/FilteredData.txt','r')
 FilteredData = fscanf(ReadFilteredDataId,FormatSpec);
 fclose(ReadFilteredDataId);
 
-ReadFilterCoefsId = fopen('C:\Users\Work_Pc\Downloads\Telegram Desktop\filterTest.txt','r');
+ReadFilterCoefsId = fopen('C:\S5243_FFT_REPO\src\src\Sim\CorrFilterCoefs.txt','r');
 FilterCoefs = fscanf(ReadFilterCoefsId,FormatSpec);
 fclose(ReadFilterCoefsId);
 
 InDataFft = fft(InDataSignal);
 InDataFft = InDataFft(1:PointsNum/2);
+InDataDataAbs = abs(InDataFft);
 
 FilteredDataPNum    =   PointsNum/R;
 
 FilteredDataFft = fft(FilteredData);
 FilteredDataFft = FilteredDataFft(1:FilteredDataPNum/2);
+FilteredDataAbs = 20*log10(abs(FilteredDataFft));
 
 Freqs = Fs*(1:(PointsNum/2))/PointsNum;
 FreqsDecim = Fs/R*(1:(FilteredDataPNum/2))/FilteredDataPNum;
 
 figure(1)
-subplot(4,1,1)
+subplot(2,1,1)
 plot(x, InDataSignal)
 title("In Signal")
 xlabel("Time")
 ylabel("Amp")
 
-subplot(4,1,2)
-plot(Freqs,20*log10(abs(InDataFft)))
+subplot(2,1,2)
+plot(Freqs,InDataDataAbs)
 title("Single-Sided Amplitude Spectrum of InData")
 xlabel("f (Hz)")
 ylabel("Amp")
 
-subplot(4,1,3)
+figure(2)
+subplot(2,1,1)
 plot(xDecim, FilteredData)
 title("FilteredData")
 xlabel("Time")
 ylabel("Amp")
 
-subplot(4,1,4)
-plot(FreqsDecim,20*log10(abs(FilteredDataFft)))
+subplot(2,1,2)
+plot(FreqsDecim,FilteredDataAbs)
 title("Single-Sided Amplitude Spectrum of FilteredData")
 xlabel("f (Hz)")
 ylabel("Amp")
 
-FilterResponse = abs(FilteredDataFft);
-
 
 
 

src/src/Sim/FilteredData.txt

@@ -2,25 +2,25 @@
      0
      0
      0
+     2
+    -8
+     5
+    31
+  -107
+   135
+    16
+  -463
+  1120
+  1120
+  -463
+    16
+   135
+  -107
+    31
+     5
+    -8
+     2
      0
-     1
-    -6
-    10
-     4
-   -52
-    93
-   -58
-  -156
-   895
-   895
-  -156
-   -58
-    93
-   -52
-     4
-    10
-    -6
-     1
      0
      0
      0

src/src/Sim/KapitanovScriptForCicComp.m

@@ -0,0 +1,275 @@
+%% ------------------------------------------------------------------------
+%
+% Title       : test_cic.m
+% Author      : Alexander Kapitanov
+% E-mail      : sallador@bk.ru
+% Version     : 1.0
+%
+% -------------------------------------------------------------------------
+%
+% Description :
+%
+%    FIR filter compensator to correct freq response after CIC filter.
+%
+% -------------------------------------------------------------------------
+%
+% Version     : 1.0
+% Date        : 2017.06.03
+%
+%% ------------------------------------------------------------------------
+%
+%	GNU GENERAL PUBLIC LICENSE
+% Version 3, 29 June 2007
+%
+%	Copyright (c) 2018 Kapitanov Alexander
+%
+% This program is free software: you can redistribute it and/or modify
+% it under the terms of the GNU General Public License as published by
+% the Free Software Foundation, either version 3 of the License, or
+% (at your option) any later version.
+%
+% You should have received a copy of the GNU General Public License
+% along with this program.  If not, see <http://www.gnu.org/licenses/>.
+%
+% THERE IS NO WARRANTY FOR THE PROGRAM, TO THE EXTENT PERMITTED BY
+% APPLICABLE LAW. EXCEPT WHEN OTHERWISE STATED IN WRITING THE COPYRIGHT
+% HOLDERS AND/OR OTHER PARTIES PROVIDE THE PROGRAM "AS IS" WITHOUT WARRANTY
+% OF ANY KIND, EITHER EXPRESSED OR IMPLIED, INCLUDING, BUT NOT LIMITED TO,
+% THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
+% PURPOSE.  THE ENTIRE RISK AS TO THE QUALITY AND PERFORMANCE OF THE PROGRAM
+% IS WITH YOU.  SHOULD THE PROGRAM PROVE DEFECTIVE, YOU ASSUME THE COST OF
+%  ALL NECESSARY SERVICING, REPAIR OR CORRECTION.
+%
+%% ------------------------------------------------------------------------
+
+set(0, 'DefaultAxesFontSize', 11, 'DefaultAxesFontName', 'Times New Roman');
+set(0, 'DefaultTextFontSize', 11, 'DefaultTextFontName', 'Times New Roman');
+
+close all;
+clear all;
+
+%% ------------------------------------------------------------------------
+%  ---- CIC Filter Parameters
+%  ------------------------------------------------------------------------
+
+R = 2;         % Decimation factor
+N = 8;         % Number of stages
+M = 1;         % Differential delay (only 1)
+
+%% ------------------------------------------------------------------------
+%  ---- FIR filter parameters
+%  ------------------------------------------------------------------------
+
+NFIR  = 16;     % Filter order, must be odd when Fo = 0.5 !!!
+Bc    = 16;     % Coef. Bit-width
+Fo    = 0.2;    % Normalized Cutoff: 0.2 < Fo < 0.5;
+BETA  = 8;      % BETA parameter for Kaiser window (if IS_WIND = 'Y')
+
+%% ------------------------------------------------------------------------
+%  ---- Save data parameters
+%  ------------------------------------------------------------------------
+
+IS_COE      = 'Y'; % create *.COE Xilinx file
+IS_HDR      = 'N'; % create *.H file (header)
+IS_WIND     = 'N'; % use Kaiser Window for FIR corrector
+
+IS_PLOT_IDL = 'N'; % plot ideal response
+IS_PLOT_FIR = 'N'; % plot FIR filter IR
+IS_PLOT_ERR = 'N'; % plot total error response in passband
+
+%% ------------------------------------------------------------------------
+%  ---- CIC Compensator Design
+%  ------------------------------------------------------------------------
+
+NFFT  = 2^16;  % FFT points for Freq Response (spectrum)
+STEP = 1/NFFT;   % Step size
+w = -pi:2*pi/NFFT:pi-2*pi/NFFT;
+ff = 0:1/NFFT:1-1/NFFT;
+z = exp(1j * w);
+
+Fc = 1/(2*R);
+Fr = Fo/R;
+
+% 1 way:
+%HCIC = (1/R * (1-z.^(-R*M))./(1-z.^(-1))).^ N;
+% 2 way:
+HCIC = (R^-N*abs(1*M*sin(pi*M*R*ff) ./ sin(pi*ff)).^N);
+HCICdb = 20 * log10(abs(HCIC));
+
+Hcic = abs((sin(pi*M*R*ff) ./ sin(pi*ff))).^N;
+Hcicdb = 20 * log10(abs(Hcic));
+
+
+##figure('name','Cic Response', 'Numbertitle', 'off')
+##plot(ff, Hcicdb - max(Hcicdb), '-.', 'LineWidth', 2, 'Color',[0 0 1]);
+##
+##title([{'Cic Response'};{sprintf('Fo = %i',Fo)}]);
+##xlabel ('Freq (\pi x rad / samples)');
+##ylabel ('Magnitude');
+##axis tight;
+##grid on;
+##
+##figure('name','Cic Response', 'Numbertitle', 'off')
+##plot(ff, HCICdb - max(HCICdb), '-.', 'LineWidth', 2, 'Color',[0 0 1]);
+##
+##title([{'Cic Response'};{sprintf('Fo = %i',Fo)}]);
+##xlabel ('Freq (\pi x rad / samples)');
+##ylabel ('Magnitude');
+##axis tight;
+##grid on;
+
+fp = [0:STEP:Fo]; % Pass band frequency dots
+fs = [(Fo+STEP):STEP:0.5]; % Stop band frequency dots
+f = [fp fs]*2; % Normalized frequency dots
+f(end) = 1;
+
+% Calculate ideal response
+Mp = ones(1, length(fp)); % Pass band response; Mp(1) = 1
+Mp(2:end) = abs(M * R * sin(pi*fp(2:end)/R) ./ sin(pi*M*fp(2:end))).^(N);
+Mf = [Mp zeros(1, length(fs))];
+
+if (IS_PLOT_IDL == 'Y')
+  figure('name','FIR Ideal Response', 'Numbertitle', 'off')
+    plot(f/2, Mf, '-.', 'LineWidth', 2, 'Color',[0 0 1]);
+
+    title([{'FIR Ideal Response'};{sprintf('Fo = %i',Fo)}]);
+    xlabel ('Freq (\pi x rad / samples)');
+    ylabel ('Magnitude');
+    axis tight;
+    legend([{sprintf('Fo = %i',Fo)}]);
+    grid on;
+end
+
+% Calculate FIR
+hFIR = fir2(NFIR-1, f, Mf); % Filter length NFIR
+hFIR = hFIR / max(hFIR); % Double coefficients
+hCOE = round(hFIR*(2^(Bc-1)-1)); % Fixed point coefficients
+
+% Windowed FIR (Kaiser with BETA)
+if (IS_WIND == 'Y')
+  WIND = kaiser(NFIR, BETA); % KAISER WINDOW IS USED!
+  hWIND = fir1(NFIR-1, Fo/R, 'low', WIND);
+  hNEW = hCOE .* hWIND;% conv2(hCOE,Hwind);
+  hCOE = hNEW;
+end
+
+if (IS_PLOT_FIR == 'Y')
+  figure('name','FIR Response', 'Numbertitle', 'off')
+    plot(hFIR, '-', 'LineWidth', 2, 'Color',[1 0 0]);
+
+    title([{'FIR Response'};{sprintf('Order = %i',NFIR)}]);
+    xlabel ('Samples');
+    ylabel ('Magnitude');
+    axis tight;
+    legend([{sprintf('Order = %i',NFIR)}]);
+    grid on;
+end
+
+hFFT = 20 * log10(abs(fft(hCOE, ceil(NFFT/R))));
+hFFT = hFFT - max(hFFT);
+
+H_amp = repmat(hFFT, 1, R);
+H_amp = H_amp(1:length(ff));
+Test = max(H_amp);
+H_amp = H_amp - max(H_amp);
+
+H_comp = HCICdb + H_amp;
+H_comp = H_comp - max(H_comp);
+
+%% ------------------------------------------------------------------------
+%  ---- Plot results
+%  ------------------------------------------------------------------------
+
+% ---- Figure #1
+figure('name','CIC/FIR Frequency Response', 'Numbertitle', 'off')
+  plot(ff, HCICdb - max(HCICdb), '-.', 'LineWidth', 2, 'Color',[0 0 1]);
+  hold on;
+
+  plot(ff, H_amp, '--', 'LineWidth', 2, 'Color',[0 0.4 0]);
+  hold on;
+
+  plot(ff, H_comp, '-', 'LineWidth', 2, 'Color',[1 0 0]);
+  hold on;
+
+  title([{'CIC, Comp. FIR and Result'};{sprintf('Filter Order = %i, Coef. width = %i',NFIR,Bc)}]);
+  xlabel ('Freq (\pi x rad / samples)');
+  ylabel ('Magnitude (dB)');
+  axis([0 ff(NFFT)/2 -100 5]);
+  line([Fr Fr], [-400 200], 'LineWidth', 1, 'linestyle', '--', 'Color', [0 0 0]);
+  line([Fc Fc], [-400 200], 'LineWidth', 1, 'linestyle', '--', 'Color', [0 0 0]);
+  line([2*Fc 2*Fc], [-400 200], 'LineWidth', 1, 'linestyle', '--', 'Color', [0 0 0]);
+  legend('CIC filter','Comp. FIR','Sum Response','location','northeast');
+  grid on;
+
+% ---- Figure #2
+figure('name', 'CIC/FIR Frequency Response (Zoom)', 'Numbertitle', 'off')
+  plot(ff, HCICdb - max(HCICdb), '-.', 'LineWidth', 2, 'Color',[0 0 1]);
+  hold on;
+
+  plot(ff, H_amp, '--', 'LineWidth', 2, 'Color',[0 0.4 0]);
+  hold on;
+
+  plot(ff, H_comp, '-', 'LineWidth', 2, 'Color',[1 0 0]);
+  hold on;
+
+  title([{'CIC, Comp. FIR and Result'};{sprintf('Filter Order = %i, Coef. width = %i',NFIR,Bc)}]);
+  xlabel ('Freq (\pi x rad / samples)');
+  ylabel ('Magnitude (dB)');
+  axis([0 ff(NFFT)/(2*R) -7 1]);
+  line([Fr Fr], [-400 200], 'LineWidth', 1, 'linestyle', '--', 'Color', [0 0 0]);
+  grid on;
+
+%% ------------------------------------------------------------------------
+% ---- Passband irregularity
+%  ------------------------------------------------------------------------
+if (IS_PLOT_ERR == 'Y')
+  pass = ceil(0.85*length(H_comp)*Fr);
+  stp = 0:(0.9*Fr)/pass:(0.9*Fr)-(0.9*Fr)/pass;
+  stp = stp(2:pass);
+  Irr = H_comp(2:pass);
+  Ism = mean(Irr);
+  Iav = (max(Irr)-min(Irr))/2;
+
+  figure('name', 'Passband irregularity', 'Numbertitle', 'off')
+    plot(stp, Irr, '--', 'LineWidth', 2, 'Color',[0 0 1]);
+    line([0 (0.9*Fr)], [Ism Ism], 'LineWidth', 2, 'linestyle', '-', 'Color', [0 0 0]);
+    grid on;
+    title([{'Passband irregularity'};{sprintf('Mean value = %f',Ism)};{sprintf('Freq error = %f (dB)',Iav)}]);
+    xlabel ('Freq (\pi x rad / samples)');
+    ylabel ('Magnitude (dB)');
+    axis tight;
+    %axis([0 ff(NFFT)/(2*R) -0.05 1]);
+end
+
+%% ------------------------------------------------------------------------
+%  ---- Save coe data to files
+%  ------------------------------------------------------------------------
+if (IS_COE == 'Y')
+  fid = fopen ('fir_filter.coe', 'w');
+  fprintf(fid, 'Radix = 10;\n');
+  fprintf(fid, 'Coefficient_Width = %d;\n', Bc);
+  fprintf(fid, 'Coefdata =\n');
+  for i = 1:NFIR
+    if (i == NFIR)
+      fprintf(fid, '%d;\n', hCOE(1,i));
+    else
+      fprintf(fid, '%d,\n', hCOE(1,i));
+    end
+  end
+  fclose(fid);
+end
+
+if (IS_HDR == 'Y')
+  fid = fopen ('fir_filter.h', 'w');
+  fprintf(fid, 'const int BL = %d;\n',  NFIR);
+  fprintf(fid, 'const int B[%d] = {\n', NFIR);
+  for i = 1:NFIR
+    if (i == NFIR)
+      fprintf(fid, '%d}\n', hCOE(1,i));
+    else
+      fprintf(fid, '%d,\n', hCOE(1,i));
+    end
+  end
+  fclose(fid);
+end
+

src/src/Sim/fir_filter.coe

@@ -1,19 +1,19 @@
 Radix = 10;
 Coefficient_Width = 16;
 Coefdata =
-247,
--1274,
-3543,
--5332,
-1607,
-12268,
--32041,
+-27,
+615,
+1015,
+-1512,
+-5803,
+-2223,
+14818,
 32767,
 32767,
--32041,
-12268,
-1607,
--5332,
-3543,
--1274,
-247;
+14818,
+-2223,
+-5803,
+-1512,
+1015,
+615,
+-27;