Тригонометрический полином работает некорректно

#define pi 3.14159265359
double trig_pol(double x)
{
    int i,j;
    float a[tochki+1],b[tochki+1],suma=0.0,sumb=0.0,sum=0.0;
    cout << "Коэффициенты a(j) и b(j)" << endl;
    for (j=0;j<stepenb;j++)
    {
        for(i=0;i<tochki;i++)
        {
            suma+=kor_y[i]*cos((float)(stepenb)*kor_x[i]*2.0*pi);
            sumb+=kor_y[i]*sin((float)(stepenb+1)*kor_x[i]*2.0*pi);
        }
        a[j]=(2.0/tochki)*suma;
        b[j]=(2.0/tochki)*sumb;
        cout << "a[" << j+1 << "]=" << a[j] << "    b[" << j+1 << "]=" << b[j] << endl;
    }
    sum=a[0]/2.0;
    cout << "Интерполяционная функция:" << endl
         << "P(x)=(" <<sum <<")+";
    for(j=1;j<=stepenb;j++)
    {
        if(j==stepenb) cout << "+ (" << a[j] << ")*cos(" << j << "*" << "x" <<")+(" << b[j] << ")*sin(" << j << "*" << "x" <<")";
        cout << "(" << a[j] << ")*cos(" << j << "*" << "x" <<")+(" << b[j] << ")*sin(" << j << "*" << "x" <<") + ";
        sum+=a[j]*cos((float)j*x*2.0*pi)+b[j]*sin((float)j*x*2.0*pi);
    }
    return sum;
}