72 lines
1 KiB
C
72 lines
1 KiB
C
#include "solve.h"
|
|
#include "comp.h"
|
|
|
|
#include <math.h>
|
|
#include <float.h>
|
|
#include <stdbool.h>
|
|
#include <stdint.h>
|
|
#include <string.h>
|
|
|
|
int t3_solve (
|
|
double (*f) (double),
|
|
double a, double b,
|
|
double eps, int m, double *x
|
|
) {
|
|
int it = 0;
|
|
uint64_t bits;
|
|
double c = DBL_MAX, y, y_a = f(a), y_b = f(b);
|
|
bool sgn_a, sgn_b, sgn_c;
|
|
|
|
memcpy(&bits, &y_a, sizeof(bits));
|
|
sgn_a = (bits >> 63) & 1;
|
|
memcpy(&bits, &y_b, sizeof(bits));
|
|
sgn_b = (bits >> 63) & 1;
|
|
|
|
if (is_eps(y_a, eps))
|
|
{
|
|
*x = a;
|
|
return 1;
|
|
} else if (is_eps(y_b, eps))
|
|
{
|
|
*x = b;
|
|
return 1;
|
|
}
|
|
|
|
if (sgn_a == sgn_b)
|
|
{
|
|
*x = DBL_MAX;
|
|
return -1;
|
|
}
|
|
|
|
for (it = 1; it <= m; ++it)
|
|
{
|
|
if (fabs(y_b) < fabs(y_a))
|
|
c = b - ((a - b) / (y_a - y_b)) * y_b;
|
|
else
|
|
c = a - ((a - b) / (y_a - y_b)) * y_a;
|
|
y = f(c);
|
|
|
|
memcpy(&bits, &y, sizeof(bits));
|
|
sgn_c = (bits >> 63) & 1;
|
|
|
|
if (is_eps(y, eps))
|
|
break;
|
|
else if (sgn_c == sgn_a)
|
|
{
|
|
a = c;
|
|
y_a = y;
|
|
} else if (sgn_c == sgn_b)
|
|
{
|
|
b = c;
|
|
y_b = y;
|
|
}
|
|
}
|
|
|
|
if (it > m)
|
|
it = -1;
|
|
|
|
*x = c;
|
|
|
|
return it;
|
|
}
|
|
|