00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011 #include <math.h>
00012 #include <stdlib.h>
00013 #include <stdio.h>
00014 #include "CouenneTypes.hpp"
00015
00016 #define MAX_ITER 1000
00017 #define COU_TRIG_TOLERANCE 1e-12
00018
00019 CouNumber trigNewton (CouNumber a, CouNumber l, CouNumber u) {
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029 if (l>u) {
00030 register CouNumber swap = l;
00031 l = u;
00032 u = swap;
00033 }
00034
00035 register CouNumber xk = 0.5 * (u+l);
00036
00037 CouNumber sina = sin (a),
00038 sinxk = sin (xk),
00039 cosxk = cos (xk),
00040 dy = sinxk - sina,
00041 dx = xk - a,
00042 dydx = dy/dx,
00043 F = cosxk - dydx;
00044
00045
00046 for (register int k = MAX_ITER; (fabs (F) > COU_TRIG_TOLERANCE) && k--;) {
00047
00048 CouNumber Fp = sinxk + (cosxk - dydx) / dx;
00049
00050 xk += F/Fp;
00051
00052 if (xk < l) xk = l;
00053 else if (xk > u) xk = u;
00054
00055 sinxk = sin (xk);
00056 cosxk = cos (xk);
00057 dy = sinxk - sina;
00058 dx = xk - a;
00059 dydx = dy/dx;
00060 F = cosxk - dydx;
00061 }
00062
00063 return xk;
00064 }
00065
00066
00067
00068
00069
00070
00071
00072
00073
00074
00075
00076
00077
00078
00079
00080
00081