42 lines
609 B
C++
42 lines
609 B
C++
#ifndef SAMPLERATEESTIMATOR_H
|
|
#define SAMPLERATEESTIMATOR_H
|
|
|
|
#include "../../data/Timestamp.h"
|
|
|
|
class SampleRateEstimator {
|
|
|
|
private:
|
|
|
|
const double a = 0.99;
|
|
double curHz = 0;
|
|
Timestamp tsLast;
|
|
|
|
public:
|
|
|
|
float update(const Timestamp ts) {
|
|
|
|
// first
|
|
if (tsLast.isZero()) {
|
|
tsLast = ts;
|
|
return 0;
|
|
}
|
|
|
|
const double diffSec = static_cast<double>((ts-tsLast).sec());
|
|
tsLast = ts;
|
|
|
|
if (diffSec != 0) {
|
|
curHz = a*curHz + (1-a) * (1.0/diffSec);
|
|
}
|
|
|
|
return static_cast<float>(curHz);
|
|
|
|
}
|
|
|
|
float getCurHz() const {
|
|
return static_cast<float>(curHz);
|
|
}
|
|
|
|
};
|
|
|
|
#endif // SAMPLERATEESTIMATOR_H
|