00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014 #ifndef SI_PIXEL_TEMPLATE_STANDALONE
00015
00016 #include "RecoLocalTracker/SiStripRecHitConverter/interface/VVIObj.h"
00017 #else
00018 #include "VVIObj.h"
00019 #endif
00020
00021
00022 #include <cmath>
00023 #include <algorithm>
00024 #include<boost/bind.hpp>
00025
00026
00027 namespace sistripvvi {
00028
00029 namespace VVIObjDetails {
00030 void sincosint(double x, double & sint, double & cint);
00031 double cosint(double x);
00032 double sinint(double x);
00033 double expint(double x);
00034
00035 inline double f1(double x, double const * h_) { return h_[0]+h_[1]*std::log(h_[2]*x)-h_[3]*x;}
00036 inline double f2(double x, double const * h_) { return h_[4]-x+h_[5]*(std::log(std::abs(x))+expint(x))-h_[6]*std::exp(-x);}
00037 template<typename F>
00038 int dzero(double a, double b, double& x0,
00039 double& rv, double eps, int mxf, F func);
00040 }
00041
00042
00043
00044
00050
00051
00052 VVIObj::VVIObj(double kappa, double beta2, int mode) : mode_(mode) {
00053
00054 const double xp[9] = { 9.29,2.47,.89,.36,.15,.07,.03,.02,0.0 };
00055 const double xq[7] = { .012,.03,.08,.26,.87,3.83,11.0 };
00056 double h_[7];
00057 double q, u, x, c1, c2, c3, c4, d1, h4, h5, h6, q2, x1, d, ll, ul, xf1, xf2, rv;
00058 int lp, lq, k, l, n;
00059
00060
00061
00062 if(kappa < 0.01) kappa = 0.01;
00063 if(kappa > 10.) kappa = 10.;
00064 if(beta2 < 0.) beta2 = 0.;
00065 if(beta2 > 1.) beta2 = 1.;
00066
00067 h_[4] = 1. - beta2*0.42278433999999998 + 7.6/kappa;
00068 h_[5] = beta2;
00069 h_[6] = 1. - beta2;
00070 h4 = -7.6/kappa - (beta2 * .57721566 + 1);
00071 h5 = log(kappa);
00072 h6 = 1./kappa;
00073 t0_ = (h4 - h_[4]*h5 - (h_[4] + beta2)*(log(h_[4]) + VVIObjDetails::expint(h_[4])) + exp(-h_[4]))/h_[4];
00074
00075
00076
00077 for (lp = 0; lp < 9; ++lp) {
00078 if (kappa >= xp[lp]) break;
00079 }
00080 ll = -lp - 1.5;
00081 for (lq = 0; lq < 7; ++lq) {
00082 if (kappa <= xq[lq]) break;
00083 }
00084 ul = lq - 6.5;
00085
00086 VVIObjDetails::dzero(ll, ul, u, rv, 1.e-5, 1000, boost::bind(&VVIObjDetails::f2, _1,h_));
00087 q = 1./u;
00088 t1_ = h4 * q - h5 - (beta2 * q + 1) * (log((fabs(u))) + VVIObjDetails::expint(u)) + exp(-u) * q;
00089 t_ = t1_ - t0_;
00090 omega_ = 6.2831853000000004/t_;
00091 h_[0] = kappa * (beta2 * .57721566 + 2.) + 9.9166128600000008;
00092 if (kappa >= .07) {h_[0] += 6.90775527;}
00093 h_[1] = beta2 * kappa;
00094 h_[2] = h6 * omega_;
00095 h_[3] = omega_ * 1.5707963250000001;
00096
00097 VVIObjDetails::dzero(5., 155., x0_, rv, 1.e-5, 1000, boost::bind(&VVIObjDetails::f1, _1,h_));
00098 n = x0_ + 1.;
00099 d = exp(kappa * (beta2 * (.57721566 - h5) + 1.)) * .31830988654751274;
00100 a_[n - 1] = 0.;
00101 if (mode_ == 0) {
00102 a_[n - 1] = omega_ * .31830988654751274;
00103 }
00104 q = -1.;
00105 q2 = 2.;
00106 for (k = 1; k < n; ++k) {
00107 l = n - k;
00108 x = omega_ * k;
00109 x1 = h6 * x;
00110 VVIObjDetails::sincosint(x1,c2,c1);
00111 c1 = log(x) - c1;
00112 c3 = sin(x1);
00113 c4 = cos(x1);
00114 xf1 = kappa * (beta2 * c1 - c4) - x * c2;
00115 xf2 = x * c1 + kappa * (c3 + beta2 * c2) + t0_ * x;
00116 if (mode_ == 0) {
00117 d1 = q * d * omega_ * exp(xf1);
00118 a_[l - 1] = d1 * cos(xf2);
00119 b_[l - 1] = -d1 * sin(xf2);
00120 } else {
00121 d1 = q * d * exp(xf1)/k;
00122 a_[l - 1] = d1 * sin(xf2);
00123 b_[l - 1] = d1 * cos(xf2);
00124 a_[n - 1] += q2 * a_[l - 1];
00125 }
00126 q = -q;
00127 q2 = -q2;
00128 }
00129
00130 }
00131
00132
00136
00137
00138
00139 double VVIObj::fcn(double x) const {
00140
00141
00142
00143 double f, u, y, a0, a1;
00144 double a2 = 0.;
00145 double b1, b0, b2, cof;
00146 int k, n, n1;
00147
00148 n = x0_;
00149 if (x < t0_) {
00150 f = 0.;
00151 } else if (x <= t1_) {
00152 y = x - t0_;
00153 u = omega_ * y - 3.141592653589793;
00154 cof = cos(u) * 2.;
00155 a1 = 0.;
00156 a0 = a_[0];
00157 n1=n+1;
00158 for (k = 2; k <= n1; ++k) {
00159 a2 = a1;
00160 a1 = a0;
00161 a0 = a_[k - 1] + cof * a1 - a2;
00162 }
00163 b1 = 0.;
00164 b0 = b_[0];
00165 for (k = 2; k <= n; ++k) {
00166 b2 = b1;
00167 b1 = b0;
00168 b0 = b_[k - 1] + cof * b1 - b2;
00169 }
00170 f = (a0 - a2) * .5 + b0 * sin(u);
00171 if (mode_ != 0) {f += y / t_;}
00172 } else {
00173 f = 0.;
00174 if (mode_ != 0) {f = 1.;}
00175 }
00176 return f;
00177 }
00178
00179
00180
00181
00185
00186
00187
00188 void VVIObj::limits(double& xl, double& xu) const {
00189
00190 xl = t0_;
00191 xu = t1_;
00192 return;
00193 }
00194
00195
00196 namespace VVIObjDetails {
00197 double cosint(double x) {
00198
00199
00200 const double zero = 0.;
00201 const double one = 1.;
00202 const double two = 2.;
00203 const double eight = 8.;
00204 const double ce = .57721566490153;
00205 const double c__[14] = { 1.9405491464836,.9413409132865,
00206 -.579845034293,.3091572011159,-.0916101792208,.0164437407515,
00207 -.0019713091952,1.692538851e-4,-1.09393296e-5,5.522386e-7,
00208 -2.23995e-8,7.465e-10,-2.08e-11,5e-13 };
00209 const double p[23] = { .96074783975204,-.0371138962124,
00210 .00194143988899,-1.7165988425e-4,2.112637753e-5,-3.27163257e-6,
00211 6.0069212e-7,-1.2586794e-7,2.932563e-8,-7.45696e-9,2.04105e-9,
00212 -5.9502e-10,1.8323e-10,-5.921e-11,1.997e-11,-7e-12,2.54e-12,
00213 -9.5e-13,3.7e-13,-1.4e-13,6e-14,-2e-14,1e-14 };
00214 const double q[20] = { .98604065696238,-.0134717382083,
00215 4.5329284117e-4,-3.067288652e-5,3.13199198e-6,-4.2110196e-7,
00216 6.907245e-8,-1.318321e-8,2.83697e-9,-6.7329e-10,1.734e-10,
00217 -4.787e-11,1.403e-11,-4.33e-12,1.4e-12,-4.7e-13,1.7e-13,-6e-14,
00218 2e-14,-1e-14 };
00219
00220
00221 double d__1;
00222
00223
00224 double h__;
00225 int i__;
00226 double r__, y, b0, b1, b2, pp, qq, alfa;
00227
00228
00229
00230 if (x == zero) {
00231 return zero;
00232 }
00233 if (fabs(x) <= eight) {
00234 y = x / eight;
00235
00236 d__1 = y;
00237 h__ = two * (d__1 * d__1) - one;
00238 alfa = -two * h__;
00239 b1 = zero;
00240 b2 = zero;
00241 for (i__ = 13; i__ >= 0; --i__) {
00242 b0 = c__[i__] - alfa * b1 - b2;
00243 b2 = b1;
00244 b1 = b0;
00245 }
00246 b1 = ce + log((fabs(x))) - b0 + h__ * b2;
00247 } else {
00248 r__ = one / x;
00249 y = eight * r__;
00250
00251 d__1 = y;
00252 h__ = two * (d__1 * d__1) - one;
00253 alfa = -two * h__;
00254 b1 = zero;
00255 b2 = zero;
00256 for (i__ = 22; i__ >= 0; --i__) {
00257 b0 = p[i__] - alfa * b1 - b2;
00258 b2 = b1;
00259 b1 = b0;
00260 }
00261 pp = b0 - h__ * b2;
00262 b1 = zero;
00263 b2 = zero;
00264 for (i__ = 19; i__ >= 0; --i__) {
00265 b0 = q[i__] - alfa * b1 - b2;
00266 b2 = b1;
00267 b1 = b0;
00268 }
00269 qq = b0 - h__ * b2;
00270 b1 = r__ * (qq * sin(x) - r__ * pp * cos(x));
00271 }
00272 return b1;
00273 }
00274
00275 double sinint(double x) {
00276
00277
00278 const double zero = 0.;
00279 const double one = 1.;
00280 const double two = 2.;
00281 const double eight = 8.;
00282 const double pih = 1.5707963267949;
00283 const double s[14] = { 1.9522209759531,-.6884042321257,
00284 .4551855132256,-.1804571236838,.0410422133759,-.0059586169556,
00285 6.001427414e-4,-4.44708329e-5,2.5300782e-6,-1.141308e-7,4.1858e-9,
00286 -1.273e-10,3.3e-12,-1e-13 };
00287 const double p[23] = { .96074783975204,-.0371138962124,
00288 .00194143988899,-1.7165988425e-4,2.112637753e-5,-3.27163257e-6,
00289 6.0069212e-7,-1.2586794e-7,2.932563e-8,-7.45696e-9,2.04105e-9,
00290 -5.9502e-10,1.8323e-10,-5.921e-11,1.997e-11,-7e-12,2.54e-12,
00291 -9.5e-13,3.7e-13,-1.4e-13,6e-14,-2e-14,1e-14 };
00292 const double q[20] = { .98604065696238,-.0134717382083,
00293 4.5329284117e-4,-3.067288652e-5,3.13199198e-6,-4.2110196e-7,
00294 6.907245e-8,-1.318321e-8,2.83697e-9,-6.7329e-10,1.734e-10,
00295 -4.787e-11,1.403e-11,-4.33e-12,1.4e-12,-4.7e-13,1.7e-13,-6e-14,
00296 2e-14,-1e-14 };
00297
00298
00299 double d__1;
00300
00301
00302 double h__;
00303 int i__;
00304 double r__, y, b0, b1, b2, pp, qq, alfa;
00305
00306 if (fabs(x) <= eight) {
00307 y = x / eight;
00308 d__1 = y;
00309 h__ = two * (d__1 * d__1) - one;
00310 alfa = -two * h__;
00311 b1 = zero;
00312 b2 = zero;
00313 for (i__ = 13; i__ >= 0; --i__) {
00314 b0 = s[i__] - alfa * b1 - b2;
00315 b2 = b1;
00316 b1 = b0;
00317 }
00318 b1 = y * (b0 - b2);
00319 } else {
00320 r__ = one / x;
00321 y = eight * r__;
00322 d__1 = y;
00323 h__ = two * (d__1 * d__1) - one;
00324 alfa = -two * h__;
00325 b1 = zero;
00326 b2 = zero;
00327 for (i__ = 22; i__ >= 0; --i__) {
00328 b0 = p[i__] - alfa * b1 - b2;
00329 b2 = b1;
00330 b1 = b0;
00331 }
00332 pp = b0 - h__ * b2;
00333 b1 = zero;
00334 b2 = zero;
00335 for (i__ = 19; i__ >= 0; --i__) {
00336 b0 = q[i__] - alfa * b1 - b2;
00337 b2 = b1;
00338 b1 = b0;
00339 }
00340 qq = b0 - h__ * b2;
00341 d__1 = fabs(pih);
00342 if(x < 0.) d__1 = -d__1;
00343 b1 = d__1 - r__ * (r__ * pp * sin(x) + qq * cos(x));
00344 }
00345
00346 return b1;
00347 }
00348
00349 void sincosint(double x, double & sint, double & cint) {
00350
00351
00352 const double zero = 0.;
00353 const double one = 1.;
00354 const double two = 2.;
00355 const double eight = 8.;
00356 const double ce = .57721566490153;
00357 const double pih = 1.5707963267949;
00358 const double s__[14] = { 1.9522209759531,-.6884042321257,
00359 .4551855132256,-.1804571236838,.0410422133759,-.0059586169556,
00360 6.001427414e-4,-4.44708329e-5,2.5300782e-6,-1.141308e-7,4.1858e-9,
00361 -1.273e-10,3.3e-12,-1e-13 };
00362
00363 const double c__[14] = { 1.9405491464836,.9413409132865,
00364 -.579845034293,.3091572011159,-.0916101792208,.0164437407515,
00365 -.0019713091952,1.692538851e-4,-1.09393296e-5,5.522386e-7,
00366 -2.23995e-8,7.465e-10,-2.08e-11,5e-13 };
00367
00368 const double p[23] = { .96074783975204,-.0371138962124,
00369 .00194143988899,-1.7165988425e-4,2.112637753e-5,-3.27163257e-6,
00370 6.0069212e-7,-1.2586794e-7,2.932563e-8,-7.45696e-9,2.04105e-9,
00371 -5.9502e-10,1.8323e-10,-5.921e-11,1.997e-11,-7e-12,2.54e-12,
00372 -9.5e-13,3.7e-13,-1.4e-13,6e-14,-2e-14,1e-14 };
00373 const double q[20] = { .98604065696238,-.0134717382083,
00374 4.5329284117e-4,-3.067288652e-5,3.13199198e-6,-4.2110196e-7,
00375 6.907245e-8,-1.318321e-8,2.83697e-9,-6.7329e-10,1.734e-10,
00376 -4.787e-11,1.403e-11,-4.33e-12,1.4e-12,-4.7e-13,1.7e-13,-6e-14,
00377 2e-14,-1e-14 };
00378
00379
00380 double d__1;
00381
00382
00383 double h__;
00384 int i__;
00385 double r__, y, b0, b1, b2, pp, qq, alfa;
00386
00387 sint=0;
00388 cint=0;
00389
00390
00391 if (fabs(x) <= eight) {
00392 y = x / eight;
00393
00394 d__1 = y;
00395 h__ = two * (d__1 * d__1) - one;
00396 alfa = -two * h__;
00397
00398
00399 if (x!=0) {
00400 b1 = zero;
00401 b2 = zero;
00402 for (i__ = 13; i__ >= 0; --i__) {
00403 b0 = c__[i__] - alfa * b1 - b2;
00404 b2 = b1;
00405 b1 = b0;
00406 }
00407 cint = ce + log((fabs(x))) - b0 + h__ * b2;
00408 }
00409
00410 b1 = zero;
00411 b2 = zero;
00412 for (i__ = 13; i__ >= 0; --i__) {
00413 b0 = s__[i__] - alfa * b1 - b2;
00414 b2 = b1;
00415 b1 = b0;
00416 }
00417 sint = y * (b0 - b2);
00418
00419 } else {
00420 r__ = one / x;
00421 y = eight * r__;
00422
00423 d__1 = y;
00424 h__ = two * (d__1 * d__1) - one;
00425 alfa = -two * h__;
00426 b1 = zero;
00427 b2 = zero;
00428 for (i__ = 22; i__ >= 0; --i__) {
00429 b0 = p[i__] - alfa * b1 - b2;
00430 b2 = b1;
00431 b1 = b0;
00432 }
00433 pp = b0 - h__ * b2;
00434 b1 = zero;
00435 b2 = zero;
00436 for (i__ = 19; i__ >= 0; --i__) {
00437 b0 = q[i__] - alfa * b1 - b2;
00438 b2 = b1;
00439 b1 = b0;
00440 }
00441 qq = b0 - h__ * b2;
00442
00443 cint = r__ * (qq * sin(x) - r__ * pp * cos(x));
00444
00445 d__1 = pih;
00446 if(x < 0.) d__1 = -d__1;
00447 sint = d__1 - r__ * (r__ * pp * sin(x) + qq * cos(x));
00448 }
00449 }
00450
00451
00452 double expint(double x) {
00453
00454
00455
00456 const double zero = 0.;
00457 const double q2[7] = { .10340013040487,3.319092135933,
00458 20.449478501379,41.280784189142,32.426421069514,10.041164382905,
00459 1. };
00460 const double p3[6] = { -2.3909964453136,-147.98219500504,
00461 -254.3763397689,-119.55761038372,-19.630408535939,-.9999999999036
00462 };
00463 const double q3[6] = { 177.60070940351,530.68509610812,
00464 462.23027156148,156.81843364539,21.630408494238,1. };
00465 const double p4[8] = { -8.6693733995107,-549.14226552109,
00466 -4210.0161535707,-249301.39345865,-119623.66934925,
00467 -22174462.775885,3892804.213112,-391546073.8091 };
00468 const double q4[8] = { 34.171875,-1607.0892658722,35730.029805851,
00469 -483547.43616216,4285596.2461175,-24903337.574054,89192576.757561,
00470 -165254299.72521 };
00471 const double a1[8] = { -2.1808638152072,-21.901023385488,
00472 9.3081638566217,25.076281129356,-33.184253199722,60.121799083008,
00473 -43.253113287813,1.0044310922808 };
00474 const double b1[8] = { 0.,3.9370770185272,300.89264837292,
00475 -6.2504116167188,1003.6743951673,14.325673812194,2736.2411988933,
00476 .52746885196291 };
00477 const double a2[8] = { -3.4833465360285,-18.65454548834,
00478 -8.2856199414064,-32.34673303054,17.960168876925,1.7565631546961,
00479 -1.9502232128966,.99999429607471 };
00480 const double b2[8] = { 0.,69.500065588743,57.283719383732,
00481 25.777638423844,760.76114800773,28.951672792514,-3.4394226689987,
00482 1.0008386740264 };
00483 const double a3[6] = { -27.780928934438,-10.10479081576,
00484 -9.1483008216736,-5.0223317461851,-3.0000077799358,
00485 1.0000000000704 };
00486 const double one = 1.;
00487 const double b3[6] = { 0.,122.39993926823,2.7276100778779,
00488 -7.1897518395045,-2.9990118065262,1.999999942826 };
00489 const double two = 2.;
00490 const double three = 3.;
00491 const double x0 = .37250741078137;
00492 const double xl[6] = { -24.,-12.,-6.,0.,1.,4. };
00493 const double p1[5] = { 4.293125234321,39.894153870321,
00494 292.52518866921,425.69682638592,-434.98143832952 };
00495 const double q1[5] = { 1.,18.899288395003,150.95038744251,
00496 568.05252718987,753.58564359843 };
00497 const double p2[7] = { .43096783946939,6.9052252278444,
00498 23.019255939133,24.378408879132,9.0416155694633,.99997957705159,
00499 4.656271079751e-7 };
00500
00501
00502 double v, y, ap, bp, aq, dp, bq, dq;
00503
00504 if (x <= xl[0]) {
00505 ap = a3[0] - x;
00506 for ( int i__ = 2; i__ <= 5; ++i__) {
00507
00508 ap = a3[i__ - 1] - x + b3[i__ - 1] / ap;
00509 }
00510 y = exp(-x) / x * (one - (a3[5] + b3[5] / ap) / x);
00511 } else if (x <= xl[1]) {
00512 ap = a2[0] - x;
00513 for ( int i__ = 2; i__ <= 7; ++i__) {
00514 ap = a2[i__ - 1] - x + b2[i__ - 1] / ap;
00515 }
00516 y = exp(-x) / x * (a2[7] + b2[7] / ap);
00517 } else if (x <= xl[2]) {
00518 ap = a1[0] - x;
00519 for ( int i__ = 2; i__ <= 7; ++i__) {
00520 ap = a1[i__ - 1] - x + b1[i__ - 1] / ap;
00521 }
00522 y = exp(-x) / x * (a1[7] + b1[7] / ap);
00523 } else if (x < xl[3]) {
00524 v = -two * (x / three + one);
00525 bp = zero;
00526 dp = p4[0];
00527 for ( int i__ = 2; i__ <= 8; ++i__) {
00528 ap = bp;
00529 bp = dp;
00530 dp = p4[i__ - 1] - ap + v * bp;
00531 }
00532 bq = zero;
00533 dq = q4[0];
00534 for ( int i__ = 2; i__ <= 8; ++i__) {
00535 aq = bq;
00536 bq = dq;
00537 dq = q4[i__ - 1] - aq + v * bq;
00538 }
00539 y = -log(-x / x0) + (x + x0) * (dp - ap) / (dq - aq);
00540 } else if (x == xl[3]) {
00541 return zero;
00542 } else if (x < xl[4]) {
00543 ap = p1[0];
00544 aq = q1[0];
00545 for ( int i__ = 2; i__ <= 5; ++i__) {
00546 ap = p1[i__ - 1] + x * ap;
00547 aq = q1[i__ - 1] + x * aq;
00548 }
00549 y = -log(x) + ap / aq;
00550 } else if (x <= xl[5]) {
00551 y = one / x;
00552 ap = p2[0];
00553 aq = q2[0];
00554 for ( int i__ = 2; i__ <= 7; ++i__) {
00555 ap = p2[i__ - 1] + y * ap;
00556 aq = q2[i__ - 1] + y * aq;
00557 }
00558 y = exp(-x) * ap / aq;
00559 } else {
00560 y = one / x;
00561 ap = p3[0];
00562 aq = q3[0];
00563 for ( int i__ = 2; i__ <= 6; ++i__) {
00564 ap = p3[i__ - 1] + y * ap;
00565 aq = q3[i__ - 1] + y * aq;
00566 }
00567 y = exp(-x) * y * (one + y * ap / aq);
00568 }
00569 return y;
00570 }
00571
00572
00573 template<typename F>
00574 int dzero(double a, double b, double& x0,
00575 double& rv, double eps, int mxf, F func) {
00576
00577 double d__1, d__2, d__3, d__4;
00578
00579
00580 double f1, f2, f3, u1, u2, x1, x2, u3, u4, x3, ca, cb, cc, fa, fb, ee, ff;
00581 int mc;
00582 double xa, xb, fx, xx, su4;
00583
00584 xa = std::min(a,b);
00585 xb = std::max(a,b);
00586 fa = func(xa);
00587 fb = func(xb);
00588 if (fa * fb > 0.) {
00589 rv = (xb - xa) * -2;
00590 x0 = 0.;
00591 return 1;
00592 }
00593 mc = 0;
00594 L1:
00595 x0 = (xa + xb) * .5;
00596 rv = x0 - xa;
00597 ee = eps * (fabs(x0) + 1);
00598 if (rv <= ee) {
00599 rv = ee;
00600 ff = func(x0);
00601 return 0;
00602 }
00603 f1 = fa;
00604 x1 = xa;
00605 f2 = fb;
00606 x2 = xb;
00607 L2:
00608 fx = func(x0);
00609 ++mc;
00610 if (mc > mxf) {
00611 rv = (d__1 = xb - xa, fabs(d__1)) * -.5;
00612 x0 = 0.;
00613 return 0;
00614 }
00615 if (fx * fa > 0.) {
00616 xa = x0;
00617 fa = fx;
00618 } else {
00619 xb = x0;
00620 fb = fx;
00621 }
00622 L3:
00623 u1 = f1 - f2;
00624 u2 = x1 - x2;
00625 u3 = f2 - fx;
00626 u4 = x2 - x0;
00627 if (u2 == 0. || u4 == 0.) {goto L1;}
00628 f3 = fx;
00629 x3 = x0;
00630 u1 /= u2;
00631 u2 = u3 / u4;
00632 ca = u1 - u2;
00633 cb = (x1 + x2) * u2 - (x2 + x0) * u1;
00634 cc = (x1 - x0) * f1 - x1 * (ca * x1 + cb);
00635 if (ca == 0.) {
00636 if (cb == 0.) {goto L1;}
00637 x0 = -cc / cb;
00638 } else {
00639 u3 = cb / (ca * 2);
00640 u4 = u3 * u3 - cc / ca;
00641 if (u4 < 0.) {goto L1;}
00642 su4 = fabs(u4);
00643 if (x0 + u3 < 0.f) {su4 = -su4;}
00644 x0 = -u3 + su4;
00645 }
00646 if (x0 < xa || x0 > xb) {goto L1;}
00647
00648 d__3 = (d__1 = x0 - x3, fabs(d__1)), d__4 = (d__2 = x0 - x2, fabs(d__2));
00649 rv = std::min(d__3,d__4);
00650 ee = eps * (fabs(x0) + 1);
00651 if (rv > ee) {
00652 f1 = f2;
00653 x1 = x2;
00654 f2 = f3;
00655 x2 = x3;
00656 goto L2;
00657 }
00658 fx = func(x0);
00659 if (fx == 0.) {
00660 rv = ee;
00661 ff = func(x0);
00662 return 0;
00663 }
00664 if (fx * fa < 0.) {
00665 xx = x0 - ee;
00666 if (xx <= xa) {
00667 rv = ee;
00668 ff = func(x0);
00669 return 0;
00670 }
00671 ff = func(xx);
00672 fb = ff;
00673 xb = xx;
00674 } else {
00675 xx = x0 + ee;
00676 if (xx >= xb) {
00677 rv = ee;
00678 ff = func(x0);
00679 return 0;
00680 }
00681 ff = func(xx);
00682 fa = ff;
00683 xa = xx;
00684 }
00685 if (fx * ff > 0.) {
00686 mc += 2;
00687 if (mc > mxf) {
00688 rv = (d__1 = xb - xa, fabs(d__1)) * -.5;
00689 x0 = 0.;
00690 return 0;
00691 }
00692 f1 = f3;
00693 x1 = x3;
00694 f2 = fx;
00695 x2 = x0;
00696 x0 = xx;
00697 fx = ff;
00698 goto L3;
00699 }
00700
00701 rv = ee;
00702 ff = func(x0);
00703 return 0;
00704 }
00705
00706 }
00707 }