mirror of
https://github.com/esphome/esphome.git
synced 2024-11-23 15:38:11 +01:00
pulse_counter_ulp: refactor UlpProgram class
This commit is contained in:
parent
2ba3b85440
commit
e736091950
2 changed files with 44 additions and 29 deletions
|
@ -28,20 +28,8 @@ const char *to_string(CountMode count_mode) {
|
|||
extern const uint8_t ulp_main_bin_start[] asm("_binary_ulp_main_bin_start");
|
||||
extern const uint8_t ulp_main_bin_end[] asm("_binary_ulp_main_bin_end");
|
||||
|
||||
bool UlpPulseCounterStorage::pulse_counter_setup(InternalGPIOPin *pin) {
|
||||
this->pin = pin;
|
||||
this->pin->setup();
|
||||
|
||||
auto rising = static_cast<uint32_t>(this->rising_edge_mode);
|
||||
auto falling = static_cast<uint32_t>(this->falling_edge_mode);
|
||||
|
||||
if (esp_sleep_get_wakeup_cause() == ESP_SLEEP_WAKEUP_UNDEFINED) {
|
||||
ESP_LOGD(TAG, "Did not wake up from sleep, assuming restart or first boot and setting up ULP program");
|
||||
} else {
|
||||
ESP_LOGD(TAG, "Woke up from sleep, skipping set-up of ULP program");
|
||||
return true;
|
||||
}
|
||||
|
||||
namespace {
|
||||
bool setup_ulp(gpio_num_t gpio_num) {
|
||||
esp_err_t error = ulp_load_binary(0, ulp_main_bin_start, (ulp_main_bin_end - ulp_main_bin_start) / sizeof(uint32_t));
|
||||
if (error != ESP_OK) {
|
||||
ESP_LOGE(TAG, "Loading ULP binary failed: %s", esp_err_to_name(error));
|
||||
|
@ -49,7 +37,6 @@ bool UlpPulseCounterStorage::pulse_counter_setup(InternalGPIOPin *pin) {
|
|||
}
|
||||
|
||||
/* GPIO used for pulse counting. */
|
||||
gpio_num_t gpio_num = static_cast<gpio_num_t>(pin->get_pin());
|
||||
int rtcio_num = rtc_io_number_get(gpio_num);
|
||||
if (!rtc_gpio_is_valid_gpio(gpio_num)) {
|
||||
ESP_LOGE(TAG, "GPIO used for pulse counting must be an RTC IO");
|
||||
|
@ -90,19 +77,44 @@ bool UlpPulseCounterStorage::pulse_counter_setup(InternalGPIOPin *pin) {
|
|||
|
||||
return true;
|
||||
}
|
||||
} // namespace
|
||||
|
||||
pulse_counter_t UlpPulseCounterStorage::read_raw_value() {
|
||||
bool UlpProgram::setup(InternalGPIOPin *pin) {
|
||||
this->pin = pin;
|
||||
this->pin->setup();
|
||||
|
||||
auto rising = static_cast<uint32_t>(this->rising_edge_mode);
|
||||
auto falling = static_cast<uint32_t>(this->falling_edge_mode);
|
||||
|
||||
if (esp_sleep_get_wakeup_cause() == ESP_SLEEP_WAKEUP_UNDEFINED) {
|
||||
ESP_LOGD(TAG, "Did not wake up from sleep, assuming restart or first boot and setting up ULP program");
|
||||
return setup_ulp(static_cast<gpio_num_t>(pin->get_pin()));
|
||||
} else {
|
||||
ESP_LOGD(TAG, "Woke up from sleep, skipping set-up of ULP program");
|
||||
return true;
|
||||
}
|
||||
}
|
||||
|
||||
UlpProgram::state UlpProgram::pop_state() {
|
||||
// TODO count edges separately
|
||||
auto count = static_cast<pulse_counter_t>(ulp_edge_count);
|
||||
auto edge_count = static_cast<uint16_t>(ulp_edge_count);
|
||||
auto run_count = static_cast<uint16_t>(ulp_run_count);
|
||||
ulp_edge_count = 0;
|
||||
return count;
|
||||
ulp_run_count = 0;
|
||||
return {.edge_count = edge_count, .run_count = run_count};
|
||||
}
|
||||
|
||||
UlpProgram::state UlpProgram::peek_state() const {
|
||||
auto edge_count = static_cast<uint16_t>(ulp_edge_count);
|
||||
auto run_count = static_cast<uint16_t>(ulp_run_count);
|
||||
return {.edge_count = edge_count, .run_count = run_count};
|
||||
}
|
||||
|
||||
/* === END ULP ===*/
|
||||
|
||||
void PulseCounterUlpSensor::setup() {
|
||||
ESP_LOGCONFIG(TAG, "Setting up pulse counter '%s'...", this->name_.c_str());
|
||||
if (!this->storage_.pulse_counter_setup(this->pin_)) {
|
||||
if (!this->storage_.setup(this->pin_)) {
|
||||
this->mark_failed();
|
||||
return;
|
||||
}
|
||||
|
@ -122,21 +134,21 @@ void PulseCounterUlpSensor::dump_config() {
|
|||
}
|
||||
|
||||
void PulseCounterUlpSensor::update() {
|
||||
pulse_counter_t raw = this->storage_.read_raw_value();
|
||||
UlpProgram::state raw = this->storage_.pop_state();
|
||||
timestamp_t now;
|
||||
timestamp_t interval;
|
||||
now = millis();
|
||||
interval = now - this->last_time_;
|
||||
if (this->last_time_ != 0) {
|
||||
float value = (60000.0f * raw) / float(interval); // per minute
|
||||
float value = (60000.0f * raw.edge_count) / float(interval); // per minute
|
||||
ESP_LOGD(TAG, "'%s': Retrieved counter: %0.2f pulses/min", this->get_name().c_str(), value);
|
||||
this->publish_state(value);
|
||||
}
|
||||
|
||||
if (this->total_sensor_ != nullptr) {
|
||||
current_total_ += raw;
|
||||
this->current_total_ += raw.edge_count;
|
||||
ESP_LOGD(TAG, "'%s': Total : %" PRIu32 " pulses", this->get_name().c_str(), current_total_);
|
||||
this->total_sensor_->publish_state(current_total_);
|
||||
this->total_sensor_->publish_state(this->current_total_);
|
||||
}
|
||||
this->last_time_ = now;
|
||||
}
|
||||
|
|
|
@ -11,17 +11,20 @@ namespace pulse_counter_ulp {
|
|||
|
||||
enum class CountMode { disable = 0, increment = 1, decrement = -1 };
|
||||
|
||||
using pulse_counter_t = int16_t;
|
||||
using timestamp_t = int64_t;
|
||||
|
||||
struct UlpPulseCounterStorage {
|
||||
bool pulse_counter_setup(InternalGPIOPin *pin);
|
||||
pulse_counter_t read_raw_value();
|
||||
struct UlpProgram {
|
||||
struct state {
|
||||
uint16_t edge_count;
|
||||
uint16_t run_count;
|
||||
};
|
||||
bool setup(InternalGPIOPin *pin);
|
||||
state pop_state();
|
||||
state peek_state() const;
|
||||
|
||||
InternalGPIOPin *pin;
|
||||
CountMode rising_edge_mode{CountMode::increment};
|
||||
CountMode falling_edge_mode{CountMode::disable};
|
||||
pulse_counter_t last_value{0};
|
||||
};
|
||||
|
||||
class PulseCounterUlpSensor : public sensor::Sensor, public PollingComponent {
|
||||
|
@ -43,7 +46,7 @@ class PulseCounterUlpSensor : public sensor::Sensor, public PollingComponent {
|
|||
|
||||
protected:
|
||||
InternalGPIOPin *pin_;
|
||||
UlpPulseCounterStorage storage_;
|
||||
UlpProgram storage_;
|
||||
timestamp_t last_time_{0};
|
||||
uint32_t current_total_{0};
|
||||
sensor::Sensor *total_sensor_{nullptr};
|
||||
|
|
Loading…
Reference in a new issue