feat: initial
This commit is contained in:
@@ -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
|
||||
}
|
||||
Reference in New Issue
Block a user