Зейдель надоел уже, помогите с методом

const int n = 3;
int main()
{
    double A[n][n]; // входная матрца
    double b[n]; // свободные члены
    double x[n]; // решение
    double eps; // требуемая точность вычисления
    double c = 0;
    double p = 0;
    cout << "eps: ";
    cin >> eps;
    cout << "Matrix:" << endl;
    for (int i = 0; i<n; i++)
        for (int j = 0; j<n; j++)
            cin >> A[i][j];
    cout << "Koef:" << endl;
    for (int i = 0; i<n; i++)
        cin >> b[i];
    for (int i = 0; i < n; i++)
    {
        p = 0;
        for (int j = 0; j < n; j++)
        {
            if (i != j)
                p = p + fabs(A[i][j] / A[i][i]);
        }
        if (c < p)
            c = p;
    }
    for (int i = 0; i < n; i++)
        x[i] = b[i] / A[i][i];
    do {
        p = 0;
        for (int j = 0; j < n; j++)
        {
            c = x[j];
            x[j] = b[j];
            for (int i = 0; i < n; i++)
            {
                if (i != j)
                    x[j] = x[j] - A[j][i] * x[i];
            }
            x[j] = x[j] / A[j][j];
            if (abs(c - x[j]) >(1 - c) / c * eps)
                p += 1;
        }
    } while (p > 1);
    cout << endl << "Results:" << endl;
    for (int i = 0; i < n; i++)
        cout << x[i] << endl;
    _getch();
    return 0;
}

Собственно код, помогите довести до ума, входит в бесконечный цикл. Если у кого есть другой рабочий код, то киньте его ниже. Задание у меня такое:

4x 3x x = 10
0.5 x x = 20
3.5 x = 24

Есть ещё код из Википедии, но я не могу его никак запустить, он лучше

https://ru.wikipedia.org/wiki/Метод_Гаусса_—_Зейделя_решения_системы_линейных_уравнений

запускаю на VS2017