systolic.cpp

qrdrls算法

#include <math.h>
#include "systolic.h"


//#define TAPS 3; 

double lamda=1;



TRIANGULAR::TRIANGULAR()
{
	x=0;
	c=1;
	s=0;
}

void TRIANGULAR::circle(complex2 Uin)
{
	//complex2 x0;
	double temp;
	cb=c;
	sb=s;
	if(Uin==0)
	{
      c=1;
	  s=0;
	  x=x*(sqrt(lamda));
	}
	else
	{   
		temp=sqrt(Uin.magnitude2()+lamda*x.get_real()*x.get_real());
		//x0.get_real()=temp;
        x*=sqrt(lamda);
		c=x.get_real()/temp;
		s=Uin/temp;
		x=complex2(temp,0);
	}
}

void TRIANGULAR::square(complex2 Uin,complex2 cc,complex2 ss)
{

	Uout=cc*Uin-(ss.conjugate())*(sqrt(lamda))*x;
	x=ss*Uin+cc*(sqrt(lamda))*x;
	s=ss;
	c=cc;
}