Расчет порядка нормированного прототипа ФНЧ при расчете полосового фильтра

double Calc_StopBandPass_Freq(long BP,long BS,long BP1,long BS1,long SampleRate) //Расчет частоты заграждения для расчета прототипа ФНЧ для ПФ.
{
 //Перевожу все частоты в радианы.
 double BandPass = Round((2*M_PI*BP)/(float)SampleRate,0.00001);
 double BandStop = Round((2*M_PI*BS)/(float)SampleRate,0.00001);
 double BandPass1 = Round((2*M_PI*BP1)/(float)SampleRate,0.00001);
 double BandStop1 = Round((2*M_PI*BS1)/(float)SampleRate,0.00001);
 //Расчитываю Wc^2.
 double Wc = Round(BandPass*BandPass1,0.00001);
 //Теперь ищу чему приравнять значение Wzx.
 double Wzx;
  Wzx = 0.0;
 if ((Wc/(float)BandStop1) > BandStop) Wzx = BandStop1;
  else Wzx = BandStop;
 //Теперь считаю частоту заграждения нормированного прототипа ФНЧ для расчитываемого ПФ.
 double W1 = Round(fabs(((BandPass*BandPass1)-pow(Wzx,2))/((BandPass1-BandPass)*Wzx)),0.00001);
 return W1;
}

long Butter_Grad(long SampleRate,long Rs,long Rp,long BP,long BS)//Расчет порядка фильтра Баттерворта
{
 long N;
 double EpsP = sqrt(pow(10,Rp/10.0)-1);
 double EpsS = sqrt(pow(10,Rs/10.0)-1);
 double OmegaP = 2*M_PI*BP/(float)SampleRate;
 double OmegaS = 2*M_PI*BS/(float)SampleRate;
 double L = log10(EpsS/EpsP)/log10(OmegaS/OmegaP);
  L *= 10;
      N = floor(L+0.5);
   N /= 10;
 return N;
}