Прошивка на ОКАПИ-202

CM<2:0> = 101

  comp:=Compare (   xp , -x  ) ;

qn = sign(Xn – Xqn),

 Hn = Hn-1 – [{Hn-1}*2^-k] + dHn

   2, if qn=qn-1=qn-2=qn-3
   dHn = 0, в других случаях

Xqn = [{Hn(qn,qn-1,qn-2,qn-3)}]* P(z),

y[0]=x[0] xor y[-6] xor y[-7]

y[0]=x[0] xor x[-6] xor x[-7]

H(n,h).H(n,l)=H(h,n-1)-0.H(h,n-1)+dH(h,n).0

ha=[ 1  -1.544282  0.567961];
hb=[ 1 0.603896 -0.396104];
 
[xm,fr]=frmag(hb,ha,512);
subplot(6,1,5);
plot2d(fr',xm') ; xtitle ('AFR')
 
n=0:255;
 
x =[0 1 zeros(1,255)  ];
res =filter(hb,ha,x);
subplot (6,1,1);
plot2d(n,  x(n+1)      )      ;  xtitle (' Input signal ')
subplot (6,1,2);
plot2d(n,  res(n+1)      )      ;  xtitle (' Impulse response ')
 
x=[1 ones(1,255)  ];
res =filter(hb,ha,x);
subplot (6,1,3);
plot2d(n,  x(n+1)      )      ;  xtitle (' Input signal ')
subplot (6,1,4);
plot2d(n, res(n+1)     ) ; xtitle ('Step  response ')
 
 
 
 
 
 
 
 ha=[1 -1.611942  0.631574];
 hb=[1 0.603896 -0.396104];
 
 
[xm,fr]=frmag(hb,ha,512);
subplot(6,1,5);
plot2d(fr',xm'  ) ; xtitle ('AFR')
 
n=0:255;
 
x =[  1 zeros(1,255)  ];
res =filter(hb,ha,x);
subplot (6,1,1);
plot2d(n,  x(n+1)       )      ;  xtitle (' Input signal ')
subplot (6,1,2);
plot2d(n,  res(n+1)       )      ;  xtitle (' Impulse response ')
 
x=[  1 ones(1,255)  ];
res =filter(hb,ha,x);
subplot (6,1,3 );
plot2d(n,  x(n+1)    )      ;  xtitle (' Input signal ')
subplot (6,1,4);
plot2d(n, res(n+1)     )  ; xtitle ('Step  response ')

ha=[ 1  -1.544282  0.567961];
hb=[ 1 0.603896 -0.396104];

sign_deltafi=sign(res(n+1)/x(n+1))

//SciLab
 
 
  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=1   //fix
                           //d__h=2  
                          else  d__h=0  
            end    
  
  
 
endfunction
 
 
global Hprevh;
global Hprevl;
 Hprevh=0;
 Hprevl=0;
 
function st =Get_Step ( q  )
 
global Hprevh;
global Hprevl;
 dh1=  Get_dH (q  )  ;
Hmin=1;  //fix
Hmax=3;  //fix
 if(Hprevh>=Hmax   )  then dh1=0 end   
if (Hprevh < Hmin)  then   
                                            
                                           
                                            Hprevh =Hmin;  
                                            Hprevl =0 
                                            
else 
 
Hprevh=Hprevh+dh1;
Hprevl=Hprevl-Hprevh;
  
end
 
st  =  Hprevh ;
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=1  //fix
                      //   dh1=2  
                          else  dh1=0 
                        end    
  
 
 
endfunction
 
 
 
global Hprev1h;
global Hprev1l;
Hprev1h=0;
 Hprev1l=0;
 
function st1 =Get_Step1 (q  )
 
global Hprev1h;
global Hprev1l;
dh2=  Get_dH1 ( q  ) ;
Hmin1=1;   //fix
Hmax1=3;  //fix
 
if(Hprev1h> Hmax1 )  then dh2=0 end 
if (Hprev1h <Hmin1)  then   
                                              
                                           
                                            Hprev1h =Hmin1;  
                                            Hprev1l =0 
                                          else 
 
Hprev1h=Hprev1h+dh2;
Hprev1l=Hprev1l-Hprev1h;
end         
 
st1 =  Hprev1h ;
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 
 
 
 
hb=[ 1  0.603896 -0.396104 ];
ha=[  1 -1.544282  -0.567961   ];
 
 
 
 
 
 
global U0 ;
U0=0;
 
function Uint=IntegrTx( Uinp  , R1   )
global U0 ;
//R1=15e3;
C=4.7e-9;
  U0=U0- (1/(R1*C))*integrate('Uin_int(t, Uinp)','t',0, 31.25e-6);  
  Uint =U0
// Uint=filter(hb,ha, Uinp );  
endfunction 
 
 
 
 hb1=[1 0.603896 -0.396104]; 
 ha1=[1 -1.611942  0.631574];
 
global U01 ;
U01 =0;
function Uint1=IntegrRx( Uinp1, R2 )
global U01 ;
//R1=15e3;
C=4.7e-9;
 U01=U01-  (1/(R2*C))*integrate('Uin_int(t, Uinp1)','t',0, 31.25e-6);
 Uint1=U01
   //Uint1=filter(hb1,ha1, Uinp );  
   
endfunction 
 
 
 
//x=[0  0  0  -2 5 1 1 1 -2  0  0  0  0  0 2  1  1  0  0  0 ];
x=[0  0  0  0 0.25 0 -1 0 0  0  2  2  2  0 0  0  0  0  0  0 ];
 
 
t=0;
 
 
 
function R1TX=SelectR1_TX ( step_tx) 
//fix
if         step_tx==1 then 
                                 R1TX =820000
 
elseif step_tx==2  then 
                                 R1TX =200000
 
elseif step_tx==3  then 
                                 R1TX =51000
 
elseif step_tx==4  then 
                                 R1TX =13000
 
else
                                R1TX =13000
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;
 
 
//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
if         step_rx==1 then 
                                 R1RX =820000
 
elseif step_rx==2  then 
                                 R1RX =200000
 
elseif step_rx==3  then 
                                 R1RX =51000
 
elseif step_rx==4  then 
                                 R1RX =13000
 
else                           
                                 R1RX =13000
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;
 
 
//  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')