1
0
mirror of https://github.com/esphome/esphome.git synced 2025-10-25 21:23:53 +01:00

[sensor] Optimize calibration and Or filters with FixedVector (#11437)

This commit is contained in:
J. Nick Koston
2025-10-20 21:38:05 -10:00
committed by GitHub
parent 66afe4a9be
commit a5542e0d2b
2 changed files with 17 additions and 12 deletions

View File

@@ -313,7 +313,7 @@ optional<float> DeltaFilter::new_value(float value) {
} }
// OrFilter // OrFilter
OrFilter::OrFilter(std::vector<Filter *> filters) : filters_(std::move(filters)), phi_(this) {} OrFilter::OrFilter(std::initializer_list<Filter *> filters) : filters_(filters), phi_(this) {}
OrFilter::PhiNode::PhiNode(OrFilter *or_parent) : or_parent_(or_parent) {} OrFilter::PhiNode::PhiNode(OrFilter *or_parent) : or_parent_(or_parent) {}
optional<float> OrFilter::PhiNode::new_value(float value) { optional<float> OrFilter::PhiNode::new_value(float value) {
@@ -326,14 +326,14 @@ optional<float> OrFilter::PhiNode::new_value(float value) {
} }
optional<float> OrFilter::new_value(float value) { optional<float> OrFilter::new_value(float value) {
this->has_value_ = false; this->has_value_ = false;
for (Filter *filter : this->filters_) for (auto *filter : this->filters_)
filter->input(value); filter->input(value);
return {}; return {};
} }
void OrFilter::initialize(Sensor *parent, Filter *next) { void OrFilter::initialize(Sensor *parent, Filter *next) {
Filter::initialize(parent, next); Filter::initialize(parent, next);
for (Filter *filter : this->filters_) { for (auto *filter : this->filters_) {
filter->initialize(parent, &this->phi_); filter->initialize(parent, &this->phi_);
} }
this->phi_.initialize(parent, nullptr); this->phi_.initialize(parent, nullptr);
@@ -386,18 +386,24 @@ void HeartbeatFilter::setup() {
} }
float HeartbeatFilter::get_setup_priority() const { return setup_priority::HARDWARE; } float HeartbeatFilter::get_setup_priority() const { return setup_priority::HARDWARE; }
CalibrateLinearFilter::CalibrateLinearFilter(std::initializer_list<std::array<float, 3>> linear_functions)
: linear_functions_(linear_functions) {}
optional<float> CalibrateLinearFilter::new_value(float value) { optional<float> CalibrateLinearFilter::new_value(float value) {
for (std::array<float, 3> f : this->linear_functions_) { for (const auto &f : this->linear_functions_) {
if (!std::isfinite(f[2]) || value < f[2]) if (!std::isfinite(f[2]) || value < f[2])
return (value * f[0]) + f[1]; return (value * f[0]) + f[1];
} }
return NAN; return NAN;
} }
CalibratePolynomialFilter::CalibratePolynomialFilter(std::initializer_list<float> coefficients)
: coefficients_(coefficients) {}
optional<float> CalibratePolynomialFilter::new_value(float value) { optional<float> CalibratePolynomialFilter::new_value(float value) {
float res = 0.0f; float res = 0.0f;
float x = 1.0f; float x = 1.0f;
for (float coefficient : this->coefficients_) { for (const auto &coefficient : this->coefficients_) {
res += x * coefficient; res += x * coefficient;
x *= value; x *= value;
} }

View File

@@ -422,7 +422,7 @@ class DeltaFilter : public Filter {
class OrFilter : public Filter { class OrFilter : public Filter {
public: public:
explicit OrFilter(std::vector<Filter *> filters); explicit OrFilter(std::initializer_list<Filter *> filters);
void initialize(Sensor *parent, Filter *next) override; void initialize(Sensor *parent, Filter *next) override;
@@ -438,28 +438,27 @@ class OrFilter : public Filter {
OrFilter *or_parent_; OrFilter *or_parent_;
}; };
std::vector<Filter *> filters_; FixedVector<Filter *> filters_;
PhiNode phi_; PhiNode phi_;
bool has_value_{false}; bool has_value_{false};
}; };
class CalibrateLinearFilter : public Filter { class CalibrateLinearFilter : public Filter {
public: public:
CalibrateLinearFilter(std::vector<std::array<float, 3>> linear_functions) explicit CalibrateLinearFilter(std::initializer_list<std::array<float, 3>> linear_functions);
: linear_functions_(std::move(linear_functions)) {}
optional<float> new_value(float value) override; optional<float> new_value(float value) override;
protected: protected:
std::vector<std::array<float, 3>> linear_functions_; FixedVector<std::array<float, 3>> linear_functions_;
}; };
class CalibratePolynomialFilter : public Filter { class CalibratePolynomialFilter : public Filter {
public: public:
CalibratePolynomialFilter(std::vector<float> coefficients) : coefficients_(std::move(coefficients)) {} explicit CalibratePolynomialFilter(std::initializer_list<float> coefficients);
optional<float> new_value(float value) override; optional<float> new_value(float value) override;
protected: protected:
std::vector<float> coefficients_; FixedVector<float> coefficients_;
}; };
class ClampFilter : public Filter { class ClampFilter : public Filter {