From 7a1c7f352334914b44a29748cf1182a37662cba9 Mon Sep 17 00:00:00 2001
From: thfu <2779155576@qq.com>
Date: Tue, 8 Oct 2024 17:58:26 +0800
Subject: [PATCH] add verification code of matlab

---
 script_m/MeanIntp.m        |  6 ++++
 script_m/MyIIR.m           | 35 ++++++++++++++++++
 script_m/MyIIR_test.m      | 30 ++++++++++++++++
 script_m/PolyMean_Test.m   | 44 +++++++++++++++++++++++
 script_m/TailCorr.m        | 27 ++++++++++++++
 script_m/TailCorr_test.m   | 27 ++++++++++++++
 script_m/TailCorr_test_P.m | 72 ++++++++++++++++++++++++++++++++++++++
 script_m/diff_plot.m       | 26 ++++++++++++++
 8 files changed, 267 insertions(+)
 create mode 100755 script_m/MeanIntp.m
 create mode 100755 script_m/MyIIR.m
 create mode 100755 script_m/MyIIR_test.m
 create mode 100755 script_m/PolyMean_Test.m
 create mode 100755 script_m/TailCorr.m
 create mode 100755 script_m/TailCorr_test.m
 create mode 100755 script_m/TailCorr_test_P.m
 create mode 100755 script_m/diff_plot.m

diff --git a/script_m/MeanIntp.m b/script_m/MeanIntp.m
new file mode 100755
index 0000000..e14a871
--- /dev/null
+++ b/script_m/MeanIntp.m
@@ -0,0 +1,6 @@
+%%% so means original, s_mean means mean value
+function [s,s_mean] = MeanIntp(s,s_r1)
+
+    s_mean = (s+s_r1)/2;
+
+end
diff --git a/script_m/MyIIR.m b/script_m/MyIIR.m
new file mode 100755
index 0000000..cc739bc
--- /dev/null
+++ b/script_m/MyIIR.m
@@ -0,0 +1,35 @@
+function out = MyIIR(a,b,x,YStartState,sel_double)
+
+len = length(x);
+
+switch sel_double 
+    case 0
+        x = int64(x);
+        a = int64(a);
+        b = int64(b);
+        y(1) = int64(YStartState);
+    case 1
+        x = double(x);
+        a = double(a);
+        b = double(b);
+        y(1) = double(YStartState);
+end
+
+switch sel_double 
+
+    case 0
+
+        for i = 1:len-1       
+            y_tmp(i+1) = a*x(i+1) - b*y(i)';
+            y(i+1) = bitsra(y_tmp(i+1),20) + bitget(y_tmp(i+1),64);       
+        end
+        out = bitsra(y,16);
+
+    case 1
+
+        for i = 1:len-1
+            y_tmp(i+1) = floor(a*x(i+1) - b*y(i)');
+            y(i+1) = floor(y_tmp(i+1)/2^20) + bitget(int64(y_tmp(i+1)),64);    
+        end
+        out = floor(y/2^16);
+end
diff --git a/script_m/MyIIR_test.m b/script_m/MyIIR_test.m
new file mode 100755
index 0000000..739e03a
--- /dev/null
+++ b/script_m/MyIIR_test.m
@@ -0,0 +1,30 @@
+clc;clear;close all
+
+cd('/data/work/thfu/TailCorr/script_m');
+
+a = 13740916;
+b = -1047703;
+y(1) = 0;
+
+sel_double = 0;
+
+switch sel_double
+    case 0
+        iir_in = int64(importdata("/home/thfu/work/TailCorr/v02/sim/in") -32768);
+        iir_out = int64(importdata("/home/thfu/work/TailCorr/v02/sim/out") -32768);
+    case 1
+        iir_in = double(importdata("/home/thfu/work/TailCorr/v02/sim/in") -32768);
+        iir_out = double(importdata("/home/thfu/work/TailCorr/v02/sim/out") -32768);
+end
+
+Script_out = MyIIR(a,b,iir_in,y(1),sel_double)';
+y_revised = iir_in + Script_out;
+tau = finddelay(y_revised,iir_out);
+
+Script_outPhi = cat(1,zeros(1,tau)',Script_out(1:end-tau,1));
+
+n = 1:length(iir_in);
+diff = iir_out(n)-Script_outPhi(n);
+
+diff_plot(iir_out, Script_outPhi)
+tau
diff --git a/script_m/PolyMean_Test.m b/script_m/PolyMean_Test.m
new file mode 100755
index 0000000..e60c531
--- /dev/null
+++ b/script_m/PolyMean_Test.m
@@ -0,0 +1,44 @@
+clc;clear all;close all
+
+fs = 1e8;
+t = (0:1:1e2)'/fs;
+% f = 20e6;
+% s = sin(2*pi*f*t);
+s = triang(1e2-1);
+s = [zeros(1,10) s' zeros(1,10)]';
+N = length(s);
+ts = (0:1:N-1)'/fs;
+%%%
+s_r1 = [0 s(1:end-1,1)']';
+[s2,s2_mean] = MeanIntp(s,s_r1);
+
+s_intp2 = zeros(2*N,1);
+s_intp2(1:2:2*N) = s2_mean;
+s_intp2(2:2:2*N) = s2;
+t_intp2 = (0:1:2*N-1)'/fs/2;
+%%%
+s2_r1 = [0 s2(1:end-1,1)']';
+
+[s4_4,s4_3] = MeanIntp(s2,s2_mean);
+[s4_2,s4_1] = MeanIntp(s2_mean,s2_r1);
+
+s_intp4 = zeros(4*N,1);
+s_intp4(1:4:4*N) = s4_1;
+s_intp4(2:4:4*N) = s4_2;
+s_intp4(3:4:4*N) = s4_3;
+s_intp4(4:4:4*N) = s4_4;
+
+t_intp4 = (0:1:4*N-1)'/fs/4;
+
+
+figure('Units','normalized','Position',[0.000390625,0.517361111111111,0.49921875,0.422916666666667]);
+plot(ts,s,t_intp2,s_intp2)
+grid on
+% xlim([0.58 0.62]*1e-6)
+% 
+% 
+figure('Units','normalized','Position',[0.500390625,0.517361111111111,0.49921875,0.422916666666667]);
+plot(t_intp4,s_intp4)
+grid on
+% xlim([0.58 0.62]*1e-6)
+
diff --git a/script_m/TailCorr.m b/script_m/TailCorr.m
new file mode 100755
index 0000000..8bec983
--- /dev/null
+++ b/script_m/TailCorr.m
@@ -0,0 +1,27 @@
+function out = TailCorr(alpha,beta,iir_in,YStartState,sel_double)
+
+len = length(iir_in);
+N = length(alpha);
+
+iir_inR1 = cat(1,0,iir_in(1:end-1,1));
+
+diff = iir_in - iir_inR1;
+
+Ystart = YStartState;
+
+for i = 1:1:N
+    y(1:len,i) = MyIIR(alpha(i),beta(i),diff,Ystart,sel_double);
+    y = floor(y);
+end
+
+switch sel_double 
+
+    case 0
+        y_sum = int64(sum(y,2));      
+
+    case 1
+        y_sum = double(sum(y,2));      
+
+end
+
+out = iir_in+y_sum;
diff --git a/script_m/TailCorr_test.m b/script_m/TailCorr_test.m
new file mode 100755
index 0000000..c4f3247
--- /dev/null
+++ b/script_m/TailCorr_test.m
@@ -0,0 +1,27 @@
+clc;clear;close all
+
+cd('/data/work/thfu/TailCorr/script_m');
+
+sel_double = 1;
+
+switch sel_double
+    case 0
+        iir_in = int64(importdata("/home/thfu/work/TailCorr/v02/sim/in") -32768);
+        iir_out = int64(importdata("/home/thfu/work/TailCorr/v02/sim/out") -32768);
+    case 1
+        iir_in = double(importdata("/home/thfu/work/TailCorr/v02/sim/in") -32768);
+        iir_out = double(importdata("/home/thfu/work/TailCorr/v02/sim/out") -32768);
+end
+
+alpha = [1757225200, 1045400392, 13740916];
+beta = -[1042856 1046395 1047703];
+
+
+Ystart = 0;
+
+y_revised = TailCorr(alpha,beta,iir_in,Ystart,sel_double);
+
+tau = finddelay(y_revised,iir_out);
+y_revisedPhi = cat(1,zeros(1,tau)',y_revised(1:end-tau,1));
+
+diff_plot(iir_out, y_revisedPhi,'verdi','matlab',[0 1e4])
diff --git a/script_m/TailCorr_test_P.m b/script_m/TailCorr_test_P.m
new file mode 100755
index 0000000..40fad92
--- /dev/null
+++ b/script_m/TailCorr_test_P.m
@@ -0,0 +1,72 @@
+clc;clear;close all
+
+cd('/data/work/thfu/TailCorr/script_m');
+
+sel_double = 1;
+
+switch sel_double
+
+    case 0
+        iir_in     = int64(importdata("/home/thfu/work/TailCorr/Test/sim/in") -32768);
+        iir_out_x1 = int64(importdata("/home/thfu/work/TailCorr/Test/sim/X1_data.dat") -32768);
+        iir_out_x2 = int64(importdata("/home/thfu/work/TailCorr/Test/sim/X2_data.dat") -32768);
+        iir_out_x4 = int64(importdata("/home/thfu/work/TailCorr/Test/sim/X4_data.dat") -32768);
+    case 1
+        iir_in     = double(importdata("/home/thfu/work/TailCorr/Test/sim/in") + 0);
+        iir_out_x1 = double(importdata("/home/thfu/work/TailCorr/Test/sim/X1_data.dat") - 32768);
+        iir_out_x2 = double(importdata("/home/thfu/work/TailCorr/Test/sim/X2_data.dat") - 32768);
+        iir_out_x4 = double(importdata("/home/thfu/work/TailCorr/Test/sim/X4_data.dat") - 32768);
+        
+end
+% iir_out_x1 = [iir_out_x1' zeros(1,2)]';
+% iir_out_x2 = [iir_out_x2' zeros(1,3)]';
+% iir_out_x4 = [iir_out_x4' zeros(1,6)]';
+
+alpha = [1757225200, 1045400392, 13740916];
+beta = -[1042856 1046395 1047703];
+
+
+Ystart = 0;
+
+y_revised = TailCorr(alpha,beta,iir_in,Ystart,sel_double);
+
+s = round(y_revised);
+N = length(s);
+
+s_r1 = [0 s(1:end-1,1)']';
+[s2,s2_mean] = MeanIntp(s,s_r1);
+s2 = floor(s2);
+s2_mean = floor(s2_mean);
+
+s2_r1 = [0 s2(1:end-1,1)']';
+[s4_4,s4_3] = MeanIntp(s2,s2_mean);
+[s4_2,s4_1] = MeanIntp(s2_mean,s2_r1);
+s4_1 = floor(s4_1);
+s4_2 = floor(s4_2);
+s4_3 = floor(s4_3);
+s4_4 = floor(s4_4);
+
+s_intp2 = zeros(2*N,1);
+s_intp2(1:2:2*N) = s2_mean;
+s_intp2(2:2:2*N) = s2;
+
+s_intp4 = zeros(4*N,1);
+s_intp4(1:4:4*N) = s4_1;
+s_intp4(2:4:4*N) = s4_2;
+s_intp4(3:4:4*N) = s4_3;
+s_intp4(4:4:4*N) = s4_4;
+%%%
+tau1 = finddelay(y_revised,iir_out_x1);
+y_revisedPhi1 = cat(1,zeros(1,tau1)',y_revised(1:end-tau1,1));
+figure('Units','normalized','Position',[0.000390625,0.517361111111111,0.49921875,0.422916666666667]);
+diff_plot(iir_out_x1, y_revisedPhi1,'verdi','matlab',[0 2e4])
+
+tau2 = finddelay(s_intp2,iir_out_x2);
+y_revisedPhi2 = cat(1,zeros(1,tau2)',s_intp2(1:end-tau2,1));
+figure('Units','normalized','Position',[0.500390625,0.517361111111111,0.49921875,0.422916666666667]);
+diff_plot(iir_out_x2, y_revisedPhi2,'verdi','matlab',[0 4e4])
+
+tau4 = finddelay(s_intp4,iir_out_x4);
+y_revisedPhi4 = cat(1,zeros(1,tau4)',s_intp4(1:end-tau4,1));
+figure('Units','normalized','Position',[0.000390625,0.034027777777778,0.49921875,0.422916666666667]);
+diff_plot(iir_out_x4, y_revisedPhi4,'verdi','matlab',[0 8e4])
\ No newline at end of file
diff --git a/script_m/diff_plot.m b/script_m/diff_plot.m
new file mode 100755
index 0000000..e88b75a
--- /dev/null
+++ b/script_m/diff_plot.m
@@ -0,0 +1,26 @@
+function diff_plot(iir_out, Script_out,leg1,leg2,a)
+
+N = length(iir_out);
+n = 0:1:N-1;
+diff = iir_out-Script_out;
+
+subplot(211)
+plot(n,iir_out,n,Script_out)
+xlabel('n')
+legend(leg1,leg2)
+xlim(a)
+title('time domain')
+grid on
+
+subplot(212)
+plot(n,diff)
+xlabel('n')
+title('diff')
+grid on
+hold on
+xlim(a)
+
+[diff_max,R_mpos] = max(abs(diff));
+plot(n(R_mpos),diff(R_mpos),'r*')
+text(n(R_mpos), diff(R_mpos), ['(',num2str(n(R_mpos)),',',num2str(diff(R_mpos)),')'],'color','k');
+% max(abs(diff))
\ No newline at end of file