CMS 3D CMS Logo

/afs/cern.ch/work/a/aaltunda/public/www/CMSSW_6_2_7/src/RecoLocalTracker/SiStripRecHitConverter/src/VVIObj.cc

Go to the documentation of this file.
00001 //
00002 //  VVIObj.cc  Version 2.0 
00003 //
00004 //  Port of CERNLIB G116 Functions vviden/vvidis
00005 //
00006 // Created by Morris Swartz on 1/14/2010.
00007 // Copyright 2010 __TheJohnsHopkinsUniversity__. All rights reserved.
00008 //
00009 // V1.1 - make dzero call both fcns with a switch
00010 // V1.2 - remove inappriate initializers and add methods to return non-zero/normalized region
00011 // V2.0 - restructuring and speed improvements by V. Innocente
00012 //
00013 
00014 #ifndef SI_PIXEL_TEMPLATE_STANDALONE
00015 // put CMSSW location of SimpleHelix.h here
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   // Make sure that the inputs are reasonable
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   // Set up limits for the root search
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   //    double (*fp2)(double) = reinterpret_cast<double(*)(double)>(&VVIObj::f2);
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   //    double (*fp1)(double) = reinterpret_cast<double(*)(double)>(&VVIObj::f1);
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 } // VVIObj
00131 
00132 // *************************************************************************************************************************************
00136 // ************************************************************************************************************************************* 
00137 
00138 
00139 double VVIObj::fcn(double x) const {
00140         
00141         // Local variables
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 } // fcn
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 } // limits
00194 
00195 
00196 namespace VVIObjDetails {
00197   double cosint(double x) {
00198     // Initialized data
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     // System generated locals
00221     double d__1;
00222     
00223     // Local variables
00224     double h__;
00225     int i__;
00226     double r__, y, b0, b1, b2, pp, qq, alfa;
00227     
00228     // If x==0, return same
00229     
00230     if (x == zero) {
00231       return zero;
00232     }
00233     if (fabs(x) <= eight) {
00234       y = x / eight;
00235       // Computing 2nd power
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       // Computing 2nd power
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   } // cosint
00274   
00275   double sinint(double x) {
00276     // Initialized data
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     // System generated locals
00299     double d__1;
00300     
00301     // Local variables
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   } // sinint
00348   
00349   void sincosint(double x, double & sint, double & cint) {
00350     // Initialized data
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     // System generated locals
00380     double d__1;
00381     
00382     // Local variables
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       // Computing 2nd power
00394       d__1 = y;
00395       h__ = two * (d__1 * d__1) - one;
00396       alfa = -two * h__;
00397       
00398       // cos
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       // sin
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       // Computing 2nd power
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       // cos
00443       cint = r__ * (qq * sin(x) - r__ * pp * cos(x));
00444       // sin
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   // Initialized data
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   /* Local variables */
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       /* L1: */
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 } // expint
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     /* System generated locals */
00577     double d__1, d__2, d__3, d__4;
00578     
00579     // Local variables
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     // Computing MIN
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     /* L4: */
00701     rv = ee;
00702     ff = func(x0);
00703     return 0;
00704   } // dzero
00705   
00706 }
00707 }