sascha/esphome
1
0
Fork 0
mirror of https://github.com/esphome/esphome.git synced 2025-10-31 15:12:06 +00:00
Code Issues Releases Wiki Activity

Sensor Average Filter Fix Floating Pointer Error Accumulating (#1624)

Browse Source
This commit is contained in:
Otto Winter
2021-04-09 10:27:18 +02:00
committed by GitHub
parent af616473aa
commit d8e4f5d56b
2 changed files with 14 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

16
esphome/components/sensor/filter.cpp
View File

@@ -148,10 +148,10 @@ void SlidingWindowMovingAverageFilter::set_window_size(size_t window_size) { thi
optional<float> SlidingWindowMovingAverageFilter::new_value(float value) { optional<float> SlidingWindowMovingAverageFilter::new_value(float value) {
if (!isnan(value)) { if (!isnan(value)) {
if (this->queue_.size() == this->window_size_) { if (this->queue_.size() == this->window_size_) {
this->sum_ -= this->queue_.front(); this->sum_ -= this->queue_[0];
this->queue_.pop(); this->queue_.pop_front();
} }
this->queue_.push(value); this->queue_.push_back(value);
this->sum_ += value; this->sum_ += value;
} }
float average; float average;
@@ -161,8 +161,16 @@ optional<float> SlidingWindowMovingAverageFilter::new_value(float value) {
average = this->sum_ / this->queue_.size(); average = this->sum_ / this->queue_.size();
ESP_LOGVV(TAG, "SlidingWindowMovingAverageFilter(%p)::new_value(%f) -> %f", this, value, average); ESP_LOGVV(TAG, "SlidingWindowMovingAverageFilter(%p)::new_value(%f) -> %f", this, value, average);
if (++this->send_at_ >= this->send_every_) { if (++this->send_at_ % this->send_every_ == 0) {
if (this->send_at_ >= 10000) {
// Recalculate to prevent floating point error accumulating
this->sum_ = 0;
for (auto v : this->queue_)
this->sum_ += v;
average = this->sum_ / this->queue_.size();
this->send_at_ = 0; this->send_at_ = 0;
}
ESP_LOGVV(TAG, "SlidingWindowMovingAverageFilter(%p)::new_value(%f) SENDING", this, value); ESP_LOGVV(TAG, "SlidingWindowMovingAverageFilter(%p)::new_value(%f) SENDING", this, value);
return average; return average;
} }

2
esphome/components/sensor/filter.h
View File

@@ -162,7 +162,7 @@ class SlidingWindowMovingAverageFilter : public Filter {
protected: protected:
float sum_{0.0}; float sum_{0.0};
std::queue<float> queue_; std::deque<float> queue_;
size_t send_every_; size_t send_every_;
size_t send_at_; size_t send_at_;
size_t window_size_; size_t window_size_;