| 1 | // toiinterpolator.cc
 | 
|---|
| 2 | // Eric Aubourg         CEA/DAPNIA/SPP   juillet 1999
 | 
|---|
| 3 | 
 | 
|---|
| 4 | 
 | 
|---|
| 5 | #include "toiinterpolator.h"
 | 
|---|
| 6 | 
 | 
|---|
| 7 | void TOIInterpolator::enterValue(double value, long sample)
 | 
|---|
| 8 | {
 | 
|---|
| 9 |   // $CHECK$ sample > back.sample
 | 
|---|
| 10 |   if (!hist.empty() && sample == hist.back().t) return; // pour eviter /0
 | 
|---|
| 11 |   hist.push_back(pair(value, sample));
 | 
|---|
| 12 | }
 | 
|---|
| 13 | 
 | 
|---|
| 14 | bool TOIInterpolator::needMoreDataFor(long sample)
 | 
|---|
| 15 | {
 | 
|---|
| 16 |   if (hist.empty()) return true;
 | 
|---|
| 17 |   int xx = hist.back().t;
 | 
|---|
| 18 |   return (hist.empty() || sample > xx);
 | 
|---|
| 19 | }
 | 
|---|
| 20 | 
 | 
|---|
| 21 | bool TOIInterpolator::canGet(long sample)
 | 
|---|
| 22 | {
 | 
|---|
| 23 |   return (!hist.empty() && (sample >= hist.front().t && sample <= hist.back().t));
 | 
|---|
| 24 | }
 | 
|---|
| 25 | 
 | 
|---|
| 26 | double TOIInterpolator::getEValue(long sample) // can forget before sample
 | 
|---|
| 27 | {
 | 
|---|
| 28 |   if (!canGet(sample)) return -9.e99;   // user should have checked before
 | 
|---|
| 29 |   deque<pair>::iterator i = hist.begin();
 | 
|---|
| 30 |   while ((*i).t < sample) i++;
 | 
|---|
| 31 |   if ((*i).t > sample) i--;
 | 
|---|
| 32 |   double value = (*i).val;
 | 
|---|
| 33 |   if (i != hist.begin()) {
 | 
|---|
| 34 |     i--;
 | 
|---|
| 35 |     hist.erase(hist.begin(), i);
 | 
|---|
| 36 |   }
 | 
|---|
| 37 |   return value;
 | 
|---|
| 38 | }
 | 
|---|
| 39 | 
 | 
|---|
| 40 | double TOIInterpolator::getIValue(long sample) // can forget before sample
 | 
|---|
| 41 | {
 | 
|---|
| 42 |   if (!canGet(sample)) return -9.e99;   // user should have checked before
 | 
|---|
| 43 |   
 | 
|---|
| 44 |   deque<pair>::iterator i = hist.begin();
 | 
|---|
| 45 |   while ((*i).t < sample) i++;
 | 
|---|
| 46 |   double value;
 | 
|---|
| 47 |   if ((*i).t == sample) {
 | 
|---|
| 48 |     value = (*i).val;
 | 
|---|
| 49 |   } else {    
 | 
|---|
| 50 |     long samp2 = (*i).t;
 | 
|---|
| 51 |     double val2 = (*i).val;
 | 
|---|
| 52 |     i--;
 | 
|---|
| 53 |     long samp1 = (*i).t;
 | 
|---|
| 54 |     double val1 = (*i).val;
 | 
|---|
| 55 |     value = val1 + (val2-val1)*(sample-samp1)/(samp2-samp1);
 | 
|---|
| 56 |   }
 | 
|---|
| 57 |   if (i != hist.begin()) {
 | 
|---|
| 58 |     i--;
 | 
|---|
| 59 |     hist.erase(hist.begin(), i);
 | 
|---|
| 60 |   }
 | 
|---|
| 61 |   return value;
 | 
|---|
| 62 | }
 | 
|---|
| 63 | 
 | 
|---|
| 64 | bool TOIInterpolator::isNewValue(long sample) 
 | 
|---|
| 65 | {
 | 
|---|
| 66 |   deque<pair>::iterator i = hist.begin();
 | 
|---|
| 67 |   while (i!=hist.end()) {
 | 
|---|
| 68 |     if ((*i).t == sample) return true;
 | 
|---|
| 69 |     if ((*i).t > sample) return false;
 | 
|---|
| 70 |     i++;
 | 
|---|
| 71 |   }
 | 
|---|
| 72 |   return false;
 | 
|---|
| 73 | }
 | 
|---|
| 74 | 
 | 
|---|
| 75 | 
 | 
|---|
| 76 | long TOIInterpolator::nextSample(long sampleMin)
 | 
|---|
| 77 | {
 | 
|---|
| 78 |   for (deque<pair>::iterator i = hist.begin(); i<hist.end(); i++) 
 | 
|---|
| 79 |     if ((*i).t >= sampleMin) return (*i).t;
 | 
|---|
| 80 |   return -1;
 | 
|---|
| 81 | }
 | 
|---|
| 82 | 
 | 
|---|