Программа, моделирующая кодер и декодер АДМ C32

//SciLab
 function y=GetHigh ( H   )   
y=uint8 (bitand(H,hex2dec('FF00') )/256)      
endfunction
 
function y=GetLow (H)   
y=uint8(bitand (H,hex2dec('00FF')))                  
endfunction
 
  function yd=getdigital( xa)
if xa>0 then 
 yd=1 
else yd=0
end
endfunction
 
function ya=getanalog( xd)
if xd>0 then 
 ya=2.5  //fix
else ya=-2.5   //fix for 0V/5V
end
endfunction
 
 
 
 
global qtmp;
qtmp(4)=0;
qtmp(3)=0;
qtmp(2)=0;
qtmp(1)=0; 
 
function  d__h=Get_dH (q)
 global qtmp;
 
qtmp(4)=qtmp(3);
qtmp(3)=qtmp(2);
qtmp(2)=qtmp(1);
qtmp(1)=q  ;
   if   (qtmp (4)==qtmp(3))&& (qtmp(3)==qtmp(2))&&(qtmp(2)==qtmp(1))   
                          then    
                                d__h=2
                       
                          else  
                                 d__h=0  
            end    
  
  
 
endfunction
 
 
global Hstep ;
global Hsteptemp  ; 
 Hstep =0;
 
 Htemp=0  ;
 
function st =Get_Step ( q_tx   ) 
 
global Hstep ;
 
 dh1=  Get_dH (q_tx  ) ;
 
Hmin=0;  //fix
Hmax=7;  //fix  
 
Htmpmax =255;
Htmpmax =3;//160, 4, 10
global Htemp  ;
Htemp=0;
//divide by 256 
 
 
Htemp=Htemp +1;
 
if (Htemp>Htmpmax )  then 
   Htemp=0;
   Hstep =Hstep -1;
 end;
 
 
  
if (Hstep< 0)  then  
 Hstep = Hmin;
end 
  
   
 disp('dh1='+string(dh1));
 
Hstep = Hstep +dh1;
 
 
 if(Hstep>=Hmax   )   then  
Hstep=Hmax;
 end  
 
  
 
st  =Hstep ;
endfunction
 
 
 
global qtmp1;
qtmp1(4)=0;
qtmp1(3)=0;
qtmp1(2)=0;
qtmp1(1)=0; 
 
function  dh1=Get_dH1 (q1)
 global qtmp1;
 
qtmp1(4)=qtmp1(3);
qtmp1(3)=qtmp1(2);
qtmp1(2)=qtmp1(1);
qtmp1(1)=q1  ;
   if   (qtmp1 (4)==qtmp1(3))&& (qtmp1(3)==qtmp1(2))&&(qtmp1(2)==qtmp1(1))   
                          then     
                              dh1=2 ;
                   
                          else  
                                dh1=0; 
                        end    
  
 
 
endfunction
 
 
 
global Hstep1 ;
 
Hstep1 =0;
Htemp1  =0;
 
function st1 =Get_Step1 (q  )
 
 
global Hstep1;
 
 
 
Hmin1=0;   //fix
Hmax1=7;  //fix
Htmpmax1=255;
Htmpmax1=3;//160, 2, 10
 
global Htemp1 ;
Htemp1 =0;
//divide by 256
 
dh2=  Get_dH1 ( q  ) ;
 
 
//160
 
Htemp1=Htemp1 +1;
 
if (Htemp1>Htmpmax1)  then 
Htemp1=0;   
Hstep1=Hstep1-1;
 
 end;
 
 
 
 if ( Hstep1  <  0)  then    
Hstep1= Hmin1 ;
end  
                                                                 
disp('dh2='+string(dh2));
Hstep1=  Hstep1+dh2  ;
  
   if( Hstep1  >= Hmax1  ) 
 then
 
 
  Hstep1=Hmax1;
end 
  
 
st1 = Hstep1   ;
endfunction
 
 
function y=Uin_int(t, Uin)  
y=Uin   
endfunction
 
 
function y=sign1(x1)   
if (x1>0 ) y= 1 else y=-1 end  
endfunction
 
function q=Compare(x1,x2 )   
q = getdigital( sign1( (x1 - x2)   )  )
endfunction 
 
 
 
 
 
global U0 ;
U0=0;
 
function Uint=IntegrTx( Uinp  , R1   )
global U0 ;
//R1=15e3;
C=4.7e-9;
 
U0=U0- (1/(R1*C))*Uinp*31.25e-6;
//U0=U0- (1/(R1*C))*Uinp*31.25e-6*DCY_TX*0.01;
//  U0=U0- (1/(R1*C))*integrate('Uin_int(t, Uinp)','t',0, 31.25e-6);  
  Uint =U0
 
endfunction 
 
 
global U01 ;
U01 =0;
 
function Uint1=IntegrRx( Uinp1, R2 )
global U01 ;
//R1=15e3;
C=4.7e-9;
U01=U01- (1/(R2*C))*Uinp1*31.25e-6;
 
 //U01=U01-  (1/(R2*C))*integrate('Uin_int(t, Uinp1)','t',0, 31.25e-6);
 Uint1=U01
  
   
endfunction 
 
 
 
//x=[0  0  0  -2 5 1 1 1 1  0  1  0  0  0 2  1  1  0  0  0 ];
x=[0  0  0  0 0.25 0 2 2 2  2  0  0  0  0 0  0  -1  0  0  0 ];
 
 
t=0;
 
 
 
function R1TX=SelectR1_TX ( step_tx) 
//fix
 
Rref=820000;
 
if         step_tx==0 then 
                                // R1TX =820000
                                    R1TX =Rref;
 
elseif  step_tx==1  then 
                                 //R1TX =200000
                                    R1TX =Rref/2;
elseif step_tx==2  then 
                                 //R1TX =51000 
                                    R1TX =Rref/4;
elseif step_tx==3  then 
                                 // R1TX =13000
                                      R1TX =Rref/8;
elseif step_tx==4  then 
                             
                                       R1TX =Rref/16;  
elseif step_tx==5  then 
                             
                                       R1TX =Rref/32; 
elseif step_tx==6  then 
                                       R1TX =Rref/64; 
 
elseif step_tx==7  then 
                                      R1TX =Rref/128; 
 
else
                                R1TX =Rref/128;
end
endfunction 
 
 
 
 
//Modulator
 
U_mid=0;
 
xq = U_mid;
scale_tx=1;
 
for n = 1:20
 
xsig=U_mid+x(n);
q =Compare( xq  ,   - xsig     );     
 
  q_out(n)=q; 
  
 
  st_1=   Get_Step ( q   )  ;   // for ADM 
  
  TX_R1=SelectR1_TX ( st_1) ;
 
 // st2(n)= st_1 
 
st_1
//Uin_tx=scale_tx*( q*st_1);
Uin_tx=getanalog( q ) ;
 
 
xq=IntegrTx(  Uin_tx  , TX_R1      );
 
Uxp(n)=xq;
 
end
 
n=1:20;
subplot(8,1,1) 
plot2d2( n-1, q_out(n) ); xtitle ('q')
subplot(8,1,2) 
plot2d2  ( n-1,  x(n))  ; xtitle ('x_n')
 
subplot(8,1,3)
 plot2d2  ( n-1,  -Uxp(n))  ; xtitle ('Uxp')
 
// subplot(8,1,4)
// plot2d2 (n-1, st2(n) )  ; xtitle ('st2')
//****************************************************
 
 
 
 
global y_scr  ;
global x_scr  ; 
  y_scr=0;
  x_scr=0;
 
 
 
 
 
function  yn=Scremble( xn  )
//ys(0)=xn(0) xor ys(0-6) xor ys(0-7)
global y_scr 
 
 w=uint8(y_scr); 
 y_scr =uint8(w+y_scr); //shift left y 1 bit , zero in the bit 0
 
 w= uint8 (bitand( uint8(xn) , 1))  ;
 temp_bit= uint8(bitget(y_scr, 8));
 w= uint8(bitxor(   w  ,  temp_bit) );
 temp_bit= uint8(bitget(y_scr, 7)); 
 w= uint8(bitxor(   w  ,  temp_bit  ) ) ;
 y_scr= uint8(bitor( uint8(y_scr) , uint8(w)  ) )   ; //append  
 
// disp('y_scr='+string(dec2bin(y_scr)))
yn=uint8(bitand( y_scr, 1));
 
 
 
endfunction 
 
 
 
 
function  y_nd=Descremble( xn  )
 
//yd(0)=xn(0) xor xn(0-6) xor xn(0-7)
global x_scr  
 
w=uint8( x_scr );
x_scr=uint8(w+x_scr );   //shift left xn
w= uint8(bitand(uint8(xn), 1));
x_scr=uint8(bitor( w,   x_scr  )); // append bit x
 //disp('x_scr='+string(dec2bin(x_scr)))
 
w =uint8(bitget(x_scr,1));
tmp_bit=uint8( bitget(x_scr, 8 )); //bit 7 
w=uint8(bitxor( w ,    tmp_bit ));
tmp_bit=uint8( bitget(x_scr, 7 )); //bit 6
w=uint8(bitxor(w  ,   tmp_bit )); 
 
y_nd=uint8(bitand( w, 1)); 
endfunction 
//**************************
 
//q_out =[ 1 0  1  1  0  0 1   1       1  0  0    1  1  1  0 ]; 
 
   y_scr=0;
    x_scr=0;
for n=1:20
 
    if   modulo(n-1,8)==0 then 
 
      y_scr=0;
       x_scr=0;
     end
x_d1=getdigital( q_out(n));
x =uint8( x_d1)  ;
 
  ys =Scremble(  x );
 
//ys--->--tau_code--line--tau_decode->-ATS->- tau_decode-->line--> decode_tau-->ys
 
 
  yd =Descremble( ys  );
 yd1(n)=yd;
q_outrx(n)= yd1(n)  ; 
 disp('n='+string(n)+' x='+string(x)+' yscr='+string(ys) +' ydes='+string(yd1(n)) )
end 
 
 
 
 
 
//*****************************************************
 
function  R1RX=SelectR1_RX ( step_rx) 
//fix
 
Rref1=820000;
 
if         step_rx==0 then 
                                // R1RX =820000
                                    R1RX =Rref1;
 
elseif  step_rx==1  then 
                                 //R1RX =200000
                                    R1RX =Rref1/2;
elseif step_rx==2  then 
                                 //R1RX =51000 
                                    R1RX =Rref1/4;
elseif step_rx==3  then 
                                 // R1RX =13000
                                      R1RX =Rref1/8;
elseif step_rx==4  then 
                             
                                       R1RX =Rref1/16;  
elseif step_rx==5  then 
                             
                                       R1RX =Rref1/32; 
elseif step_rx==6  then 
                                       R1RX =Rref1/64; 
 
elseif step_rx==7  then 
                                      R1RX =Rref1/128; 
 
else
                                R1RX =Rref1/128; 
end
endfunction 
 
 
 
 
 
 
 scale_rx=1;
 
//Demodulator
for n = 1:20
 
   //qrx=q_out(n);
    
    qrx=getanalog( q_outrx(n)) ;                                  
 
     st_3=  Get_Step1 ( qrx  )  ;    //   for ADM 
     st4(n)=  st_3 ; 
 st_3
 
//  Uin_rx= scale_rx*(qrx*st_3);
   Uin_rx=qrx;
   R1_RX=SelectR1_RX (st_3) ;
 
  yrx=IntegrRx( Uin_rx ,  R1_RX);
  Uxout(n)=double(-yrx);
 
 
 
end
 
 
n = 1:20; 
 
 subplot(8,1,5) 
 
plot2d2(  n-1,   double(q_outrx(n))  ); xtitle ('qout rx')
subplot(8,1,6)
 plot2d2  ( n-1,  Uxout(n))  ; xtitle ('Uxout')
 
 //subplot(8,1,7)
 //plot2d2 (n-1, st4(n) )  ; xtitle ('st4')