Построение АЧХ цифрового БИХ фильтра и его реализация

short *IIR_Filtration(long Size,long Num_Size,long Den_Size,short *In,double *Numerator,double *Denumerator)
{
 short *Result = (short*)malloc(sizeof(short)*Size);
  for (long i = 0; i < Size; i++) Result[i] = 0;
 //Часть для входного сигнала.
 double X,Y;
 for (long i = 100; i < Size; i++)
  {
   X = 0;
   for (long j = 0; j < Num_Size; j++)
    {
     X += In[abs(i-j)]*Numerator[j];
    }
   Y = 0;
   for (long j = 1; j < Den_Size; j++)
    {
     Y += Result[abs(i-j)]*Denumerator[j];
    }
   Result[i] = X-Y;
   Result[i] = Result[i];
  }
 return Result;
}

long double ACHX_Butter_LPF(long N,double Tetta,double *Poles,double Freq)// АЧХ фильтра Баттерворта считаю.
{
 long double Point;
  TComplex A,B,C,D;
 //Рсчитываю нижнее произведение. Результаты вычитания в скобках друг на друга домножаю.
 for (long i = 0; i < 2*N; i++)
  {
   if (i == 0) 
    {
     A.a = 0; A.b = 0;
     B.a = 0; B.b = 0; 
     C.a = 0; C.b = 0;
     A.a = 0; A.b = Freq;
     B.a = Poles[i]; i++; B.b = Poles[i];
     C = Raznost_Complex(A,B);     
    }
    else
     {   
      A.a = 0; A.b = 0;
      B.a = 0; B.b = 0; 
      A.a = 0; A.b = Freq;
      B.a = Poles[i]; i++; B.b = Poles[i];
      D.a = 0; D.b = 0;
      D = Raznost_Complex(A,B);
      A.a = 0; A.b = 0;
      A.a = C.a; A.b = C.b;
      C.a = 0; C.b = 0;
      C = Multiply_Complex(A,D);
     }
  }
  //Делю теперь знаменатель на числитель
  A.a = 0; A.b = 0;
  B.a = 0; B.b = 0;
  A.a = pow(Tetta,N); A.b = 0;
  B.a = C.a; B.b = C.b;
  C.a = 0; C.b = 0;
  C = Div_Complex(A,B);
  //Результирующая точка.
  Point = sqrt(pow(C.a,2)+pow(C.b,2));
 return Point;
}

double *PolesOfButter_LPF(long N,long SampleRate,long BP) //Расчет полюсов ФНЧ Баттерворта
{
//Считаем нормированную полосу среза.
 double Tetta = tan(M_PI*(BP/(float)SampleRate));
 double *Poles = (double*)malloc(sizeof(double)*(N*2));//массив, содержащий значение нолей и полюсов фильтра
 long Count;
  Count = -1;
 for (long i = 0; i < N; i++)
  {
   Count++;
   Poles[Count] = Tetta*cos(M_PI*(0.5+((2*i+1)/(float)(2*N))));//Действительная часть
   Count++;
   Poles[Count] =  Tetta*sin(M_PI*(0.5+((2*i+1)/(float)(2*N))));//Мнимая часть.
  }
 return Poles;
}