Blame onefile/equation.cpp

Ivan Mahonin 62033a
Ivan Mahonin 62033a
Ivan Mahonin 62033a
#include <ctime>
Ivan Mahonin 62033a
#include <cstdlib>
Ivan Mahonin 62033a
#include <cassert>
Ivan Mahonin 62033a
Ivan Mahonin 62033a
#include <complex>
Ivan Mahonin 62033a
Ivan Mahonin 62033a
Ivan Mahonin 62033a
Ivan Mahonin 62033a
typedef double Real;
Ivan Mahonin 62033a
typedef std::complex<Real> Complex;
Ivan Mahonin 62033a
Ivan Mahonin 62033a
Ivan Mahonin 62033a
const Real epsilon = 1e-6;
Ivan Mahonin 62033a
const Real epsilonSqr = epsilon*epsilon;
Ivan Mahonin 62033a
Ivan Mahonin 62033a
inline Real magSqr(Complex x)
Ivan Mahonin 62033a
  { return x.real()*x.real() + x.imag()*x.imag(); }
Ivan Mahonin 62033a
inline bool isZero(Real x)
Ivan Mahonin 62033a
  { return fabs(x) < epsilon; }
Ivan Mahonin 62033a
inline bool isZero(Complex x)
Ivan Mahonin 62033a
  { return magSqr(x) <= epsilonSqr; }
Ivan Mahonin 62033a
Ivan Mahonin 62033a
Ivan Mahonin 62033a
inline Complex verify2(Complex r, Real a, Real b, Real c) {
Ivan Mahonin 62033a
  assert(isZero(a*r*r + b*r + c));
Ivan Mahonin 62033a
  return r;
Ivan Mahonin 62033a
}
Ivan Mahonin 62033a
Ivan Mahonin 62033a
Ivan Mahonin 62033a
inline Complex verify3(Complex r, Real a, Real b, Real c, Real d) {
Ivan Mahonin 62033a
  assert(isZero(a*r*r*r + b*r*r + c*r + d));
Ivan Mahonin 62033a
  return r;
Ivan Mahonin 62033a
}
Ivan Mahonin 62033a
Ivan Mahonin 62033a
Ivan Mahonin 62033a
inline Complex verify4(Complex r, Real a, Real b, Real c, Real d, Real e) {
Ivan Mahonin 62033a
  assert(isZero(a*r*r*r*r + b*r*r*r + c*r*r + d*r + e));
Ivan Mahonin 62033a
  return r;
Ivan Mahonin 62033a
}
Ivan Mahonin 62033a
Ivan Mahonin 62033a
Ivan Mahonin 62033a
int solve2(Complex *roots, Real a, Real b, Real c) {
Ivan Mahonin 62033a
  if (isZero(a)) {
Ivan Mahonin 62033a
    if (isZero(b)) return 0;
Ivan Mahonin 62033a
    roots[0] = verify2(-c/b, a, b, c);
Ivan Mahonin 62033a
    return 1;
Ivan Mahonin 62033a
  }
Ivan Mahonin 62033a
Ivan Mahonin 62033a
  Real D = b*b - a*c*4;
Ivan Mahonin 62033a
  Real k = Real(0.5)/a;
Ivan Mahonin 62033a
  Complex d = D < 0 ? Complex(0, sqrt(-D)) : Complex(sqrt(D));
Ivan Mahonin 62033a
  roots[0] = verify2((-b - d)*k, a, b, c);
Ivan Mahonin 62033a
  roots[1] = verify2((-b + d)*k, a, b, c);
Ivan Mahonin 62033a
  return 2;
Ivan Mahonin 62033a
}
Ivan Mahonin 62033a
Ivan Mahonin 62033a
Ivan Mahonin 62033a
int solve3(Complex *roots, Real a, Real b, Real c, Real d) {
Ivan Mahonin 62033a
  if (isZero(a)) return solve2(roots, b, c, d);
Ivan Mahonin 62033a
Ivan Mahonin 62033a
  // x = y - b/(3*a)
Ivan Mahonin 62033a
  // y*y*y + p*y + q = 0
Ivan Mahonin 62033a
  Real p = (3*a*c - b*b)/(3*a*a);
Ivan Mahonin 62033a
  Real q = (27*a*a*d - 9*a*b*c + 2*b*b*b)/(27*a*a*a);
Ivan Mahonin 62033a
Ivan Mahonin 62033a
  Real Q = p*p*p/27 + q*q/4;
Ivan Mahonin 62033a
  Complex Qs = Q < 0 ? Complex(0, sqrt(-Q)) : Complex(sqrt(Q));
Ivan Mahonin 62033a
  Complex A = pow(-q/2 + Qs, Real(1)/3);
Ivan Mahonin 62033a
  Complex B = pow(-q/2 - Qs, Real(1)/3);
Ivan Mahonin 62033a
Ivan Mahonin 62033a
  // choose complimentary B for A (A*B must be equal -p/3)
Ivan Mahonin 62033a
  Complex rot(Real(-0.5), sqrt(Real(3))/2);
Ivan Mahonin 62033a
  if (!isZero(A*B + p/3)) B *= rot;
Ivan Mahonin 62033a
  if (!isZero(A*B + p/3)) B *= rot;
Ivan Mahonin 62033a
Ivan Mahonin 62033a
  Complex Y = (A - B)*Complex(0, sqrt(Real(3)));
Ivan Mahonin 62033a
  Complex y0 = A + B;
Ivan Mahonin 62033a
  Complex y1 = (-y0 - Y)/Real(2);
Ivan Mahonin 62033a
  Complex y2 = (-y0 + Y)/Real(2);
Ivan Mahonin 62033a
Ivan Mahonin 62033a
  Real dd = b/(3*a);
Ivan Mahonin 62033a
  roots[0] = verify3(y0 - dd, a, b, c, d);
Ivan Mahonin 62033a
  roots[1] = verify3(y1 - dd, a, b, c, d);
Ivan Mahonin 62033a
  roots[2] = verify3(y2 - dd, a, b, c, d);
Ivan Mahonin 62033a
  return 3;
Ivan Mahonin 62033a
}
Ivan Mahonin 62033a
Ivan Mahonin 62033a
Ivan Mahonin 62033a
int solve4(Complex *roots, Real a, Real b, Real c, Real d, Real e) {
Ivan Mahonin 62033a
  if (isZero(a)) return solve3(roots, b, c, d, e);
Ivan Mahonin 62033a
Ivan Mahonin 62033a
  //printf("%g*x^4 + %g*x^3 + %g*x^2 + %g*x + %g = 0\n", a, b, c, d, e);
Ivan Mahonin 62033a
Ivan Mahonin 62033a
  // x = y - b/(4*a)
Ivan Mahonin 62033a
  // y^4 + p*y^2 + q*y + r = 0
Ivan Mahonin 62033a
  Real dd = b/(4*a);
Ivan Mahonin 62033a
  Real p = (8*a*c - 3*b*b)/(8*a*a);
Ivan Mahonin 62033a
  Real q = (8*a*a*d - 4*a*b*c + b*b*b)/(8*a*a*a);
Ivan Mahonin 62033a
  Real r = (256*a*a*a*e - 64*a*a*b*d + 16*a*b*b*c - 3*b*b*b*b)/(256*a*a*a*a);
Ivan Mahonin 62033a
  //printf(", y^4 + %g*y^2 + %g*y + %g = 0", p, q, r);
Ivan Mahonin 62033a
Ivan Mahonin 62033a
  if (isZero(q)) {
Ivan Mahonin 62033a
    // biquadratic equation
Ivan Mahonin 62033a
    // y^4 + p*y^2 + r = 0
Ivan Mahonin 62033a
    Complex y[2];
Ivan Mahonin 62033a
    solve2(y, 1, p, r);
Ivan Mahonin 62033a
    y[0] = sqrt(y[0]);
Ivan Mahonin 62033a
    y[1] = sqrt(y[1]);
Ivan Mahonin 62033a
    roots[0] = verify4(-y[0] - dd, a, b, c, d, e);
Ivan Mahonin 62033a
    roots[1] = verify4( y[0] - dd, a, b, c, d, e);
Ivan Mahonin 62033a
    roots[2] = verify4(-y[1] - dd, a, b, c, d, e);
Ivan Mahonin 62033a
    roots[3] = verify4( y[1] - dd, a, b, c, d, e);
Ivan Mahonin 62033a
    return 4;
Ivan Mahonin 62033a
  }
Ivan Mahonin 62033a
Ivan Mahonin 62033a
  // solve cubic equation
Ivan Mahonin 62033a
  // z*z*z + (p/2)*z*z + ((p*p - 4*r)/16)*z - q*q/64 = 0
Ivan Mahonin 62033a
  Real pp = p/2;
Ivan Mahonin 62033a
  Real qq = (p*p - 4*r)/16;
Ivan Mahonin 62033a
  Real rr = -q*q/64;
Ivan Mahonin 62033a
  //printf("z^3 + %g*z^2 + %g*z + %g = 0\n", pp, qq, rr);
Ivan Mahonin 62033a
  Complex z[3];
Ivan Mahonin 62033a
  solve3(z, 1, pp, qq, rr);
Ivan Mahonin 62033a
Ivan Mahonin 62033a
  z[0] = sqrt(z[0]);
Ivan Mahonin 62033a
  z[1] = sqrt(z[1]);
Ivan Mahonin 62033a
  z[2] = sqrt(z[2]);
Ivan Mahonin 62033a
Ivan Mahonin 62033a
  // we need to find signs combination where following is valid:
Ivan Mahonin 62033a
  // (+-z0)*(+-z1)*(+-z2) = -q/8
Ivan Mahonin 62033a
  Complex zzz = z[0]*z[1]*z[2];
Ivan Mahonin 62033a
  //printf(
Ivan Mahonin 62033a
  //  "sqrt(z): (%g, %g), (%g, %g), (%g, %g), zzz: (%g, %g)\n",
Ivan Mahonin 62033a
  //  z[0].real(), z[0].imag(),
Ivan Mahonin 62033a
  //  z[1].real(), z[1].imag(),
Ivan Mahonin 62033a
  //  z[2].real(), z[2].imag(),
Ivan Mahonin 62033a
  //  zzz.real(), zzz.imag() );
Ivan Mahonin 62033a
  assert(isZero(zzz.imag()));
Ivan Mahonin 62033a
  assert(isZero(fabs(zzz.real()) - fabs(q/8)));
Ivan Mahonin 62033a
  if ((zzz.real() > 0) == (q > 0))
Ivan Mahonin 62033a
    z[0] = -z[0];
Ivan Mahonin 62033a
  assert(isZero(z[0]*z[1]*z[2] + q/8));
Ivan Mahonin 62033a
Ivan Mahonin 62033a
  roots[0] = verify4( z[0] - z[1] - z[2] - dd, a, b, c, d, e);
Ivan Mahonin 62033a
  roots[1] = verify4(-z[0] + z[1] - z[2] - dd, a, b, c, d, e);
Ivan Mahonin 62033a
  roots[2] = verify4(-z[0] - z[1] + z[2] - dd, a, b, c, d, e);
Ivan Mahonin 62033a
  roots[3] = verify4( z[0] + z[1] + z[2] - dd, a, b, c, d, e);
Ivan Mahonin 62033a
  return 4;
Ivan Mahonin 62033a
}
Ivan Mahonin 62033a
Ivan Mahonin 62033a
Ivan Mahonin 62033a
int main() {
Ivan Mahonin 62033a
  srand(time(NULL));
Ivan Mahonin 62033a
Ivan Mahonin 62033a
  bool failed = false;
Ivan Mahonin 62033a
  for(int i = 0; i < 1000000; ++i) {
Ivan Mahonin 62033a
    Real a = rand()%20 - 10;
Ivan Mahonin 62033a
    Real b = rand()%20 - 10;
Ivan Mahonin 62033a
    Real c = rand()%20 - 10;
Ivan Mahonin 62033a
    Real d = rand()%20 - 10;
Ivan Mahonin 62033a
    Real e = rand()%20 - 10;
Ivan Mahonin 62033a
    printf("%6d: %g*x^4 + %g*x^3 + %g*x^2 + %g*x + %g = 0", i, a, b, c, d, e);
Ivan Mahonin 62033a
Ivan Mahonin 62033a
    int vcnt = a ? 4
Ivan Mahonin 62033a
             : b ? 3
Ivan Mahonin 62033a
             : c ? 2
Ivan Mahonin 62033a
             : d ? 1 : 0;
Ivan Mahonin 62033a
Ivan Mahonin 62033a
    Complex roots[4];
Ivan Mahonin 62033a
    int cnt = solve4(roots, a, b, c, d, e);
Ivan Mahonin 62033a
    bool f = cnt != vcnt;
Ivan Mahonin 62033a
    for(int i = 0; i < cnt; ++i) {
Ivan Mahonin 62033a
      const Complex &x = roots[i];
Ivan Mahonin 62033a
      printf(", (%g, %g)", x.real(), x.imag());
Ivan Mahonin 62033a
      Complex r = a*x*x*x*x + b*x*x*x + c*x*x + d*x + e;
Ivan Mahonin 62033a
      if (!isZero(r))
Ivan Mahonin 62033a
        { printf(" ![%g, %g]", r.real(), r.imag()); f = true; }
Ivan Mahonin 62033a
    }
Ivan Mahonin 62033a
Ivan Mahonin 62033a
    printf(", %s\n", f ? "FAILED" : "passed");
Ivan Mahonin 62033a
    if (f) {
Ivan Mahonin 62033a
      printf("^^^^^^^^^^\n");
Ivan Mahonin 62033a
      failed = true;
Ivan Mahonin 62033a
      break;
Ivan Mahonin 62033a
    }
Ivan Mahonin 62033a
  }
Ivan Mahonin 62033a
Ivan Mahonin 62033a
  printf("\n%s\n\n", failed ? "FAILED" : "success");
Ivan Mahonin 62033a
  return failed;
Ivan Mahonin 62033a
}
Ivan Mahonin 62033a