| 1 | #ifndef MARS_MExtralgoSpline | 
|---|
| 2 | #define MARS_MExtralgoSpline | 
|---|
| 3 |  | 
|---|
| 4 | #ifndef ROOT_TMath | 
|---|
| 5 | #include <TMath.h> | 
|---|
| 6 | #endif | 
|---|
| 7 |  | 
|---|
| 8 | class MArrayF; | 
|---|
| 9 | class TComplex; | 
|---|
| 10 |  | 
|---|
| 11 | class MExtralgoSpline | 
|---|
| 12 | { | 
|---|
| 13 | public: | 
|---|
| 14 | enum ExtractionType_t | 
|---|
| 15 | { | 
|---|
| 16 | kIntegral = BIT(0), | 
|---|
| 17 | kTimeRel  = BIT(1), | 
|---|
| 18 | kMaximum  = BIT(2), | 
|---|
| 19 |  | 
|---|
| 20 | // For backward compatibility | 
|---|
| 21 | kAmplitudeAbs = 0,                   // Height of maximum, absolute height leading edge | 
|---|
| 22 | kAmplitudeRel = kTimeRel,            // Height of maximum, relative height leading edge | 
|---|
| 23 | kAmplitude    = kMaximum,            // Position and height of maximum | 
|---|
| 24 | kIntegralAbs  = kIntegral,           // Integral, absolute height leading edge | 
|---|
| 25 | kIntegralRel  = kIntegral|kTimeRel,  // Integral, relative height leading edge | 
|---|
| 26 | }; | 
|---|
| 27 |  | 
|---|
| 28 | private: | 
|---|
| 29 | ExtractionType_t fExtractionType; | 
|---|
| 30 |  | 
|---|
| 31 | private: | 
|---|
| 32 | //Bool_t fIsOwner; // Owner of derivatives.... | 
|---|
| 33 |  | 
|---|
| 34 | // Input | 
|---|
| 35 | Float_t const *fVal; | 
|---|
| 36 | const Int_t    fNum; | 
|---|
| 37 |  | 
|---|
| 38 | Float_t *fDer1; | 
|---|
| 39 | Float_t *fDer2; | 
|---|
| 40 |  | 
|---|
| 41 | Float_t fRiseTime; | 
|---|
| 42 | Float_t fFallTime; | 
|---|
| 43 |  | 
|---|
| 44 | Float_t fHeightTm; | 
|---|
| 45 |  | 
|---|
| 46 | // Result | 
|---|
| 47 | Float_t fTime; | 
|---|
| 48 | Float_t fTimeDev; | 
|---|
| 49 | Float_t fWidth; | 
|---|
| 50 | Float_t fWidthDev; | 
|---|
| 51 | Float_t fSignal; | 
|---|
| 52 | Float_t fSignalDev; | 
|---|
| 53 | Float_t fHeight; | 
|---|
| 54 |  | 
|---|
| 55 | Double_t ReMul(const TComplex &c1, const TComplex &th) const; | 
|---|
| 56 |  | 
|---|
| 57 | inline Float_t Eval(Float_t val, Float_t a, Float_t deriv) const | 
|---|
| 58 | { | 
|---|
| 59 | return a*val + (a*a*a-a)*deriv; | 
|---|
| 60 | } | 
|---|
| 61 |  | 
|---|
| 62 | // Evaluate value of spline in the interval i with x=[0;1[ | 
|---|
| 63 | inline Float_t Eval(const Int_t i, const Float_t x) const | 
|---|
| 64 | { | 
|---|
| 65 | // Eval(i,x) =  (fDer2[i+1]-fDer2[i])*x*x*x + 3*fDer2[i]*x*x + | 
|---|
| 66 | //              (fVal[i+1]-fVal[i] -2*fDer2[i]-fDer2[i+1])*x + fVal[i]; | 
|---|
| 67 |  | 
|---|
| 68 | // x := [0; 1[ | 
|---|
| 69 | return Eval(fVal[i], 1-x, fDer2[i]) + Eval(fVal[i+1], x, fDer2[i+1]); | 
|---|
| 70 | } | 
|---|
| 71 |  | 
|---|
| 72 | // Evaluate first derivative of spline in the interval i with x=[0;1[ | 
|---|
| 73 | inline Double_t EvalDeriv1(const Int_t i, const Float_t x) const | 
|---|
| 74 | { | 
|---|
| 75 | // x := [0; 1[ | 
|---|
| 76 | const Double_t difval = fVal[i+1]-fVal[i]; | 
|---|
| 77 | const Double_t difder = fDer2[i+1]-fDer2[i]; | 
|---|
| 78 |  | 
|---|
| 79 | //return 3*difder*x*x + 6*fDer2[i]*x - 2*fDer2[i] - fDer2[i+1] + difval; | 
|---|
| 80 | return 3*difder*x*x + (6*x - 2)*fDer2[i] - fDer2[i+1] + difval; | 
|---|
| 81 | } | 
|---|
| 82 |  | 
|---|
| 83 | // Evaluate second derivative of spline in the interval i with x=[0;1[ | 
|---|
| 84 | inline Double_t EvalDeriv2(const Int_t i, const Float_t x) const | 
|---|
| 85 | { | 
|---|
| 86 | // x := [0; 1[ | 
|---|
| 87 | return 6*(fDer2[i+1]*x + fDer2[i]*(1-x)); | 
|---|
| 88 | } | 
|---|
| 89 |  | 
|---|
| 90 | Int_t SolvePol3(Int_t i, Double_t y, Double_t &x1, Double_t &x2, Double_t &x3) const; | 
|---|
| 91 | Double_t FindYdn(Int_t i, Double_t y=0, Double_t min=0, Double_t max=1) const; | 
|---|
| 92 | Double_t FindYup(Int_t i, Double_t y=0, Double_t min=0, Double_t max=1) const; | 
|---|
| 93 | //Double_t FindY(Int_t i, Bool_t downwards, Double_t y=0, Double_t min=0, Double_t max=1) const; | 
|---|
| 94 |  | 
|---|
| 95 | Int_t EvalDerivEq0(const Int_t i, Double_t &x1, Double_t &x2) const; | 
|---|
| 96 | /* | 
|---|
| 97 | inline void EvalDerivEq0(const Int_t i, Float_t &rc1, Float_t &rc2) const | 
|---|
| 98 | { | 
|---|
| 99 | // --- ORIGINAL CODE --- | 
|---|
| 100 | Double_t sumder = fDer2[i]+fDer2[i+1]; | 
|---|
| 101 | Double_t difder = fDer2[i]-fDer2[i+1]; | 
|---|
| 102 |  | 
|---|
| 103 | Double_t sqt1  = sumder*sumder - fDer2[i]*fDer2[i+1]; | 
|---|
| 104 | Double_t sqt2  = difder*(fVal[i+1]-fVal[i]); | 
|---|
| 105 | Double_t sqt3  = sqrt(3*sqt1 + 3*sqt2); | 
|---|
| 106 | Double_t denom = -3*(fDer2[i+1]-fDer2[i]); | 
|---|
| 107 |  | 
|---|
| 108 | rc1 = (3*fDer2[i] + sqt3)/denom; | 
|---|
| 109 | rc2 = (3*fDer2[i] - sqt3)/denom; | 
|---|
| 110 |  | 
|---|
| 111 | // --- NEW CODE --- | 
|---|
| 112 | Double_t sumder = fDer2[i]+fDer2[i+1]; | 
|---|
| 113 | Double_t difder = fDer2[i]-fDer2[i+1]; | 
|---|
| 114 |  | 
|---|
| 115 | Double_t sqt1  = sumder*sumder - fDer2[i]*fDer2[i+1]; | 
|---|
| 116 | Double_t sqt2  = difder*(fVal[i+1]-fVal[i]); | 
|---|
| 117 | Double_t sqt3  = sqt1+sqt2<0 ? 0 : sqrt((sqt1 + sqt2)/3); | 
|---|
| 118 |  | 
|---|
| 119 | rc1 = (fDer2[i] + sqt3)/difder; | 
|---|
| 120 | rc2 = (fDer2[i] - sqt3)/difder; | 
|---|
| 121 | }*/ | 
|---|
| 122 |  | 
|---|
| 123 | // Calculate the "Stammfunktion" of the Eval-function | 
|---|
| 124 | inline Double_t EvalPrimitive(Int_t i, Float_t x) const | 
|---|
| 125 | { | 
|---|
| 126 | Align(i, x); | 
|---|
| 127 |  | 
|---|
| 128 | if (x==0) | 
|---|
| 129 | return -fDer2[i]/4; | 
|---|
| 130 |  | 
|---|
| 131 | if (x==1) | 
|---|
| 132 | return (fVal[i+1] + fVal[i])/2 - fDer2[i+1]/4 - fDer2[i]/2; | 
|---|
| 133 |  | 
|---|
| 134 | const Double_t x2  = x*x; | 
|---|
| 135 | const Double_t x4  = x2*x2; | 
|---|
| 136 | const Double_t x1  = 1-x; | 
|---|
| 137 | const Double_t x14 = x1*x1*x1*x1; | 
|---|
| 138 |  | 
|---|
| 139 | return x2*fVal[i+1]/2 + (x4/2-x2)*fDer2[i+1]/2 + (x-x2/2)*fVal[i] + (x2/2-x-x14/4)*fDer2[i]; | 
|---|
| 140 |  | 
|---|
| 141 | } | 
|---|
| 142 |  | 
|---|
| 143 | inline void Align(Int_t &i, Float_t &x) const | 
|---|
| 144 | { | 
|---|
| 145 | if (i<0) | 
|---|
| 146 | { | 
|---|
| 147 | x += i; | 
|---|
| 148 | i=0; | 
|---|
| 149 | } | 
|---|
| 150 | if (i>=fNum-1) | 
|---|
| 151 | { | 
|---|
| 152 | x += i-(fNum-2); | 
|---|
| 153 | i=fNum-2; | 
|---|
| 154 | } | 
|---|
| 155 | } | 
|---|
| 156 |  | 
|---|
| 157 | // Calculate the intgeral of the Eval-function in | 
|---|
| 158 | // bin i from 0 <= a < b < 1 | 
|---|
| 159 | inline Double_t EvalInteg(Int_t i, Float_t a, Float_t b) const | 
|---|
| 160 | { | 
|---|
| 161 | return EvalPrimitive(i, b)-EvalPrimitive(i, a); | 
|---|
| 162 | } | 
|---|
| 163 |  | 
|---|
| 164 | // Identical to EvalInteg(i, 0, 1) but much faster | 
|---|
| 165 | // Be carefull: NO RANGECHECK! | 
|---|
| 166 | inline Double_t EvalInteg(Int_t i) const | 
|---|
| 167 | { | 
|---|
| 168 | return (fVal[i+1] + fVal[i])/2 - (fDer2[i+1] + fDer2[i])/4; | 
|---|
| 169 | } | 
|---|
| 170 |  | 
|---|
| 171 | // Identical to sum of EvalInteg(i, 0, 1) for i=a to i=b-1, | 
|---|
| 172 | // but much faster | 
|---|
| 173 | // It is identical to EvalInteg(fVal[a], fVal[b]) | 
|---|
| 174 | // Be carefull: NO RANGECHECK! | 
|---|
| 175 | inline Double_t EvalInteg(Int_t a, Int_t b) const | 
|---|
| 176 | { | 
|---|
| 177 | /* | 
|---|
| 178 | Double_t sum = 0; | 
|---|
| 179 | for (int i=a; i<b; i++) | 
|---|
| 180 | sum += EvalInteg(i); | 
|---|
| 181 |  | 
|---|
| 182 | return sum; | 
|---|
| 183 | */ | 
|---|
| 184 |  | 
|---|
| 185 | if (a==b) | 
|---|
| 186 | return 0; | 
|---|
| 187 |  | 
|---|
| 188 | Double_t sum=0; | 
|---|
| 189 | for (const Float_t *ptr=fDer2+a+1; ptr<fDer2+b; ptr++) | 
|---|
| 190 | sum -= *ptr; | 
|---|
| 191 |  | 
|---|
| 192 | sum -= (fDer2[a]+fDer2[b])/2; | 
|---|
| 193 |  | 
|---|
| 194 | sum /= 2; | 
|---|
| 195 |  | 
|---|
| 196 | for (const Float_t *ptr=fVal+a+1; ptr<fVal+b; ptr++) | 
|---|
| 197 | sum += *ptr; | 
|---|
| 198 |  | 
|---|
| 199 | sum += (fVal[a]+fVal[b])/2; | 
|---|
| 200 |  | 
|---|
| 201 | return sum; | 
|---|
| 202 | } | 
|---|
| 203 |  | 
|---|
| 204 | // Calculate the intgeral of the Eval-function betwen x0 and x1 | 
|---|
| 205 | inline Double_t EvalInteg(Float_t x0, Float_t x1) const | 
|---|
| 206 | { | 
|---|
| 207 | // RANGE CHECK MISSING! | 
|---|
| 208 |  | 
|---|
| 209 | const Int_t min = TMath::CeilNint(x0); | 
|---|
| 210 | const Int_t max = TMath::FloorNint(x1); | 
|---|
| 211 |  | 
|---|
| 212 | // This happens if x0 and x1 are in the same interval | 
|---|
| 213 | if (min>max) | 
|---|
| 214 | return EvalInteg(max, x0-max, x1-max); | 
|---|
| 215 |  | 
|---|
| 216 | // Sum complete intervals | 
|---|
| 217 | Double_t sum = EvalInteg(min, max); | 
|---|
| 218 |  | 
|---|
| 219 | // Sum the incomplete intervals at the beginning and end | 
|---|
| 220 | sum += EvalInteg(min-1, 1-(min-x0), 1); | 
|---|
| 221 | sum += EvalInteg(max,   0, x1-max); | 
|---|
| 222 |  | 
|---|
| 223 | // return result | 
|---|
| 224 | return sum; | 
|---|
| 225 | } | 
|---|
| 226 |  | 
|---|
| 227 | // We search for the maximum from x=i-1 to x=i+1 | 
|---|
| 228 | // (Remeber: i corresponds to the value in bin i, i+1 to the | 
|---|
| 229 | //  next bin and i-1 to the last bin) | 
|---|
| 230 | inline void GetMaxAroundI(Int_t i, Float_t &xmax, Float_t &ymax) const | 
|---|
| 231 | { | 
|---|
| 232 | Float_t xmax1=0, xmax2=0; | 
|---|
| 233 | Float_t ymax1=0, ymax2=0; | 
|---|
| 234 |  | 
|---|
| 235 | Bool_t rc1 = i>0      && GetMax(i-1, xmax1, ymax1); | 
|---|
| 236 | Bool_t rc2 = i<fNum-1 && GetMax(i,   xmax2, ymax2); | 
|---|
| 237 |  | 
|---|
| 238 | // In case the medium bin is the first or last bin | 
|---|
| 239 | // take the lower or upper edge of the region into account. | 
|---|
| 240 | if (i==0) | 
|---|
| 241 | { | 
|---|
| 242 | xmax1 = 0; | 
|---|
| 243 | ymax1 = fVal[0]; | 
|---|
| 244 | rc1 = kTRUE; | 
|---|
| 245 | } | 
|---|
| 246 | if (i>=fNum-1) | 
|---|
| 247 | { | 
|---|
| 248 | xmax2 = fNum-1; | 
|---|
| 249 | ymax2 = fVal[fNum-1]; | 
|---|
| 250 | rc2 = kTRUE; | 
|---|
| 251 | } | 
|---|
| 252 |  | 
|---|
| 253 | // Take a default in case no maximum is found | 
|---|
| 254 | // FIXME: Check THIS!!! | 
|---|
| 255 | xmax=i; | 
|---|
| 256 | ymax=fVal[i]; | 
|---|
| 257 |  | 
|---|
| 258 | if (rc1) | 
|---|
| 259 | { | 
|---|
| 260 | ymax = ymax1; | 
|---|
| 261 | xmax = xmax1; | 
|---|
| 262 | } | 
|---|
| 263 | else | 
|---|
| 264 | if (rc2) | 
|---|
| 265 | { | 
|---|
| 266 | ymax = ymax2; | 
|---|
| 267 | xmax = xmax2; | 
|---|
| 268 | } | 
|---|
| 269 |  | 
|---|
| 270 | if (rc2 && ymax2>ymax) | 
|---|
| 271 | { | 
|---|
| 272 | ymax = ymax2; | 
|---|
| 273 | xmax = xmax2; | 
|---|
| 274 | } | 
|---|
| 275 | } | 
|---|
| 276 |  | 
|---|
| 277 | inline Bool_t GetMax(Int_t i, Float_t &xmax, Float_t &ymax, Float_t min=0, Float_t max=1) const | 
|---|
| 278 | { | 
|---|
| 279 | // Find analytical maximum in the bin i in the interval [min,max[ | 
|---|
| 280 |  | 
|---|
| 281 | Double_t x1=-1;  // This initialisation should not really be | 
|---|
| 282 | Double_t x2=-1;  // necessary but makes valgriund happy. | 
|---|
| 283 |  | 
|---|
| 284 | if (!EvalDerivEq0(i, x1, x2)) | 
|---|
| 285 | return kFALSE; | 
|---|
| 286 |  | 
|---|
| 287 | const Bool_t ismax1 = x1>=min && x1<max && EvalDeriv2(i, x1)<0; | 
|---|
| 288 | const Bool_t ismax2 = x2>=min && x2<max && EvalDeriv2(i, x2)<0; | 
|---|
| 289 |  | 
|---|
| 290 | if (!ismax1 && !ismax2) | 
|---|
| 291 | return kFALSE; | 
|---|
| 292 |  | 
|---|
| 293 | if (ismax1 && !ismax2) | 
|---|
| 294 | { | 
|---|
| 295 | xmax = i+x1; | 
|---|
| 296 | ymax = Eval(i, x1); | 
|---|
| 297 | return kTRUE; | 
|---|
| 298 | } | 
|---|
| 299 |  | 
|---|
| 300 | if (!ismax1 && ismax2) | 
|---|
| 301 | { | 
|---|
| 302 | xmax = i+x2; | 
|---|
| 303 | ymax = Eval(i, x2); | 
|---|
| 304 | return kTRUE; | 
|---|
| 305 | } | 
|---|
| 306 |  | 
|---|
| 307 | // Somehting must be wrong... | 
|---|
| 308 | return kFALSE; | 
|---|
| 309 | } | 
|---|
| 310 |  | 
|---|
| 311 | void InitDerivatives() const; | 
|---|
| 312 | Float_t CalcIntegral(Float_t start) const; | 
|---|
| 313 |  | 
|---|
| 314 | public: | 
|---|
| 315 | MExtralgoSpline(const Float_t *val, Int_t n, Float_t *der1, Float_t *der2) | 
|---|
| 316 | : fExtractionType(kIntegralRel), fVal(val), fNum(n), fDer1(der1), fDer2(der2), fHeightTm(0.5), fTime(0), fTimeDev(-1), fSignal(0), fSignalDev(-1) | 
|---|
| 317 | { | 
|---|
| 318 | InitDerivatives(); | 
|---|
| 319 | } | 
|---|
| 320 |  | 
|---|
| 321 | void SetRiseFallTime(Float_t rise, Float_t fall) { fRiseTime=rise; fFallTime=fall; } | 
|---|
| 322 | void SetExtractionType(ExtractionType_t typ)     { fExtractionType = typ; } | 
|---|
| 323 | void SetHeightTm(Float_t h)                      { fHeightTm = h; } | 
|---|
| 324 |  | 
|---|
| 325 | Float_t GetTime() const      { return fTime; } | 
|---|
| 326 | Float_t GetWidth() const     { return fWidth; } | 
|---|
| 327 | Float_t GetSignal() const    { return fSignal; } | 
|---|
| 328 | Float_t GetHeight() const    { return fHeight; } | 
|---|
| 329 |  | 
|---|
| 330 | Float_t GetTimeDev() const   { return fTimeDev; } | 
|---|
| 331 | Float_t GetWidthDev() const  { return fWidthDev; } | 
|---|
| 332 | Float_t GetSignalDev() const { return fSignalDev; } | 
|---|
| 333 |  | 
|---|
| 334 | void GetSignal(Float_t &sig, Float_t &dsig) const { sig=fSignal; dsig=fSignalDev; } | 
|---|
| 335 | void GetWidth(Float_t &sig, Float_t &dsig) const  { sig=fWidth; dsig=fWidthDev; } | 
|---|
| 336 | void GetTime(Float_t &sig, Float_t &dsig) const   { sig=fTime; dsig=fTimeDev; } | 
|---|
| 337 |  | 
|---|
| 338 | Float_t ExtractNoise(/*Int_t iter*/); | 
|---|
| 339 | void Extract(Int_t maxpos, Bool_t width=kFALSE); | 
|---|
| 340 |  | 
|---|
| 341 | Float_t EvalAt(const Float_t x) const; | 
|---|
| 342 | Float_t Deriv1(const Float_t x) const; | 
|---|
| 343 |  | 
|---|
| 344 | Double_t SearchYdn(Float_t maxpos, Float_t y) const; | 
|---|
| 345 | Double_t SearchYup(Float_t maxpos, Float_t y) const; | 
|---|
| 346 |  | 
|---|
| 347 | Double_t SearchYdn(Float_t y) const { return SearchYdn(fNum, y); } | 
|---|
| 348 | Double_t SearchYup(Float_t y) const { return SearchYup(0,    y); } | 
|---|
| 349 |  | 
|---|
| 350 | MArrayF GetIntegral(bool norm=false) const; | 
|---|
| 351 | }; | 
|---|
| 352 |  | 
|---|
| 353 | inline Float_t MExtralgoSpline::EvalAt(const Float_t x) const | 
|---|
| 354 | { | 
|---|
| 355 | Int_t   i = TMath::FloorNint(x); | 
|---|
| 356 | Float_t f = x-i; | 
|---|
| 357 |  | 
|---|
| 358 | Align(i, f); | 
|---|
| 359 |  | 
|---|
| 360 | return Eval(i, f); | 
|---|
| 361 | } | 
|---|
| 362 |  | 
|---|
| 363 | inline Float_t MExtralgoSpline::Deriv1(const Float_t x) const | 
|---|
| 364 | { | 
|---|
| 365 | Int_t   i = TMath::FloorNint(x); | 
|---|
| 366 | Float_t f = x-i; | 
|---|
| 367 |  | 
|---|
| 368 | Align(i, f); | 
|---|
| 369 |  | 
|---|
| 370 | return EvalDeriv1(i, f); | 
|---|
| 371 | } | 
|---|
| 372 |  | 
|---|
| 373 | #endif | 
|---|