feat: initial

This commit is contained in:
2026-02-01 09:34:54 +03:00
parent a6e0f2876c
commit aa0883dd8b
4 changed files with 47 additions and 9 deletions

View File

@@ -18,7 +18,7 @@ static esp_err_t _zh_tachometer_pcnt_init(const zh_tachometer_init_config_t *con
static esp_err_t _zh_tachometer_timer_init(zh_tachometer_handle_t *handle);
static void _zh_tachometer_timer_on_alarm_cb(void *arg);
esp_err_t zh_tachometer_init(const zh_tachometer_init_config_t *config, zh_tachometer_handle_t *handle)
esp_err_t zh_tachometer_init(const zh_tachometer_init_config_t *config, zh_tachometer_handle_t *handle) // -V2008
{
ZH_LOGI("Tachometer initialization started.");
ZH_ERROR_CHECK(config != NULL && handle != NULL, ESP_ERR_INVALID_ARG, NULL, "Tachometer initialization failed. Invalid argument.");
@@ -29,6 +29,7 @@ esp_err_t zh_tachometer_init(const zh_tachometer_init_config_t *config, zh_tacho
ZH_ERROR_CHECK(err == ESP_OK, err, NULL, "Tachometer initialization failed. Timer initialization failed.");
err = _zh_tachometer_pcnt_init(config, handle);
ZH_ERROR_CHECK(err == ESP_OK, err, esp_timer_stop(handle->esp_timer_handle); esp_timer_delete(handle->esp_timer_handle), "Tachometer initialization failed. PCNT initialization failed.");
handle->encoder_pulses = config->encoder_pulses;
handle->is_initialized = true;
ZH_LOGI("Tachometer initialization completed successfully.");
return ESP_OK;
@@ -69,7 +70,7 @@ static esp_err_t _zh_tachometer_validate_config(const zh_tachometer_init_config_
return ESP_OK;
}
static esp_err_t _zh_tachometer_pcnt_init(const zh_tachometer_init_config_t *config, zh_tachometer_handle_t *handle)
static esp_err_t _zh_tachometer_pcnt_init(const zh_tachometer_init_config_t *config, zh_tachometer_handle_t *handle) // -V2008
{
ZH_ERROR_CHECK(config->a_gpio_number < GPIO_NUM_MAX && config->b_gpio_number < GPIO_NUM_MAX, ESP_ERR_INVALID_ARG, NULL, "Invalid GPIO number.")
ZH_ERROR_CHECK(config->a_gpio_number != config->b_gpio_number, ESP_ERR_INVALID_ARG, NULL, "Encoder A and B GPIO is same.")
@@ -141,7 +142,7 @@ static esp_err_t _zh_tachometer_timer_init(zh_tachometer_handle_t *handle)
};
esp_err_t err = esp_timer_create(&timer_args, &handle->esp_timer_handle);
ZH_ERROR_CHECK(err == ESP_OK, err, NULL, "Timer initialization failed.");
err = esp_timer_start_periodic(handle->esp_timer_handle, 10000); // 0.01 sec.
err = esp_timer_start_periodic(handle->esp_timer_handle, 10000);
ZH_ERROR_CHECK(err == ESP_OK, err, esp_timer_delete(handle->esp_timer_handle), "Timer initialization failed.");
return ESP_OK;
}
@@ -152,5 +153,6 @@ static void IRAM_ATTR _zh_tachometer_timer_on_alarm_cb(void *arg)
int pcnt_count = 0;
pcnt_unit_get_count(handle->pcnt_unit_handle, &pcnt_count);
pcnt_unit_clear_count(handle->pcnt_unit_handle);
handle->value = (uint16_t)pcnt_count;
float value_temp = ((pcnt_count * 100.0) / handle->encoder_pulses) * 60;
handle->value = (value_temp < 0) ? -(uint16_t)value_temp : (uint16_t)value_temp; // -V2004
}