ТЕМА:

pkg load signal;
clear;

M=1500; % порядок=2*M+1
N=6; % центр=N+1
K=3; % ширина=2*K

B=2*K+1;
a=1;
b=3/4-1/B; 
c=1/4-1/B; 

s=zeros(2*M+1,1);
for m=1:K-1;
	s(m)=1;
end 
s(K)=a;
s(K+1)=b;
s(K+2)=c;
s(2*M-K)=c;
s(2*M-K+1)=b;
s(2*M-K+2)=a;
for m=2*M-K+3:2*M+1;
	s(m)=1;
end 
S=fft(s);
h=real(fftshift(S));
hm=h(M+1);

hc=[];
hs=[];
for m=1:2*M+1;
	hc=[hc,h(m)*cos(2*pi*(m-(M+1))*N/(2*M+1))];
	hs=[hs,h(m)*sin(2*pi*(m-(M+1))*N/(2*M+1))];
end
hc=hc';
hs=hs';

A=2**15-1;

h=round(h/hm*A);
hc=round(hc/hm*A);
hs=round(hs/hm*A);
hm=A;

%save "hc3000.txt" hc;
%save "hs3000.txt" hs;


Z=25;
w = 0:pi/(M+1)/Z:pi;

Hc=abs(freqz(hc,1,w));
Hs=abs(freqz(hs,1,w));

Hm=Hc(N*Z);
figure(2);
subplot(2,1,1);
plot(h/hm,"color","g");
hold on;
plot(hc/hm,"color","r");
plot(hs/hm,"color","b");
hold off;
grid on;
subplot(2,1,2);
plot(20*log10(Hc/Hm),"color","r");
hold on;
plot(20*log10(Hs/Hm),"color","b");
hold off;
grid on;
clear;

//-----------------------------------------------------------------------------
ext [1] CLOCK_50;
ext [2] AMP_CMP;
bit  [2] AMP_SW; 
bit  [1] AMP_GEN; 
bit  [8] LED;
top(){

	bit [1] clk450, clk225; 
	pll2(9,1,2)(CLOCK_50, clk450, clk225); 
	
	bit [2][4] sig4clk2; 
	rx4clk2(clk450, AMP_CMP[0], sig4clk2[0]);		
	rx4clk2(clk450, AMP_CMP[1], sig4clk2[1]);			
	
	bit [2] sigOR;
	rx4(clk225, sigOR[0], sig4clk2[0]);
	rx4(clk225, sigOR[1], sig4clk2[1]);
		
	bit [1] data, ready;
	amp(clk225, data, ready, sigOR, AMP_GEN, AMP_SW);	
	
	filtled(clk225, data, ready, LED);
}
//-----------------------------------------------------------------------------
ext [1] data, rdy;
bit  [8] LED;
filtled(){

	bit [16] hs; rom("hsin.mif")(ah, hs);
	bit [16] hc; rom("hcos.mif")(ah, hc);
		
	bit [11] ah;
	bit [12] ar, aw;
	bit [1] isin;
	bit [1] re, we;
	agen(ah, ar, aw, isin, re, we, rdy);
	
	bit [1] qw, qr;
	mem(12,1)(qw, data, aw, we, qr, 0, ar, 0);
	
	filt(LED, qr, we, re, isin, hs, hc);
}
//-----------------------------------------------------------------------------
reg [11] ah;
reg [12] ar, aw;
reg [1] isin;
reg [1] re, we;
ext  [1] rdy;
agen(){
	reg [11] step; isin=step[10];
	reg [1] rdy0, we0, clr; 
	rdy0=rdy;
	we0=we;
	we=rdy0&~rdy;
	re=we0&~we;
	
	ah=ah+step;
	if(ah==1495) step=-1;	
	if(ah==0) step=0;	
	if(re){ ah=1; step=1; }

	ar=ar+1; 
	if(ar==2990) ar=0;
	if(re) ar=aw;
	
	if(we){ 
		aw=aw+1;
		if(aw==2990) aw=0;
	}
}
//-----------------------------------------------------------------------------
reg [8] LED;
ext [1] qr, we, re, isin;
ext [16] hs16, hc16;
filt(){
	reg [32] hs, hc;
	hs={{16{hs16[15]}},hs16};
	hc={{16{hc16[15]}},hc16};
	reg [32] sadd, ssub, cadd, csub;
	reg [32] m, mc, ms, ac, as;
	if(qr^isin) ssub=ssub+hs; if(~qr^isin) sadd=sadd+hs;
	if(qr) csub=csub+hc; if(~qr) cadd=cadd+hc;
	if(re){
		mc=cadd-csub;
		ms=sadd-ssub;
		ac=mc[31]?~mc:mc;  
		as=ms[31]?~ms:ms;  
		m=ac+as;		
		LED[7:2]=m[24:19];
		LED[0]=qr;	
		LED[1]=~qr;	
		ssub=0; sadd=0; 
		csub=0; cadd=0; 
	}
}
//-----------------------------------------------------------------------------
reg [1] sig;
ext [4] sig4clk2;
rx4(){ sig = |sig4clk2; }
//-----------------------------------------------------------------------------
reg [1] data, ready;
ext [2] ampcmp;
reg [1] AMP_GEN; 
reg [2] AMP_SW; 
amp(){ 
	reg [2][8] delay;
	reg [2][8] code1; 
	reg [2][8] code0; 
	reg enagen;
	
	ready=0; 
	delay=delay+1; 
		
	if(delay==0){ enagen=1; AMP_GEN=0; }		

	if(enagen){
		if(delay[0][1:0]==1) AMP_GEN=1; 
		if((delay[0][1:0]==2)&(|ampcmp)&(code0==0)){ code0=delay; code1=ampcmp; }		
		if(delay[0][1:0]==3) AMP_GEN=0;  
	}
	
	if(delay==2046) enagen=0; 
	if(delay==2048) data=code0[0][2]^code1[0][0];
	if(delay==2050) ready=1; 	
	if(delay==2127){ AMP_GEN=0; code0=0; code1=0; }													
	if(delay==2143) AMP_SW=0x0; 			
	if(delay==2600) AMP_SW=0xz; 			
	if(delay==2999) delay=0; 	
}
//-----------------------------------------------------------------------------