kopia lustrzana https://github.com/espressif/esp-idf
274 wiersze
12 KiB
C
274 wiersze
12 KiB
C
|
/*
|
||
|
* SPDX-FileCopyrightText: 2023 Espressif Systems (Shanghai) CO LTD
|
||
|
*
|
||
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
*/
|
||
|
|
||
|
#include <stdatomic.h>
|
||
|
#include "esp_check.h"
|
||
|
#include "esp_memory_utils.h"
|
||
|
#include "esp_intr_alloc.h"
|
||
|
#include "esp_heap_caps.h"
|
||
|
#include "freertos/FreeRTOS.h"
|
||
|
#include "adc_continuous_internal.h"
|
||
|
#include "soc/periph_defs.h"
|
||
|
#include "esp_adc/adc_monitor.h"
|
||
|
|
||
|
static const char *MNTOR_TAG = "adc_monitor";
|
||
|
|
||
|
/**
|
||
|
* @brief context for adc continuous driver
|
||
|
*/
|
||
|
typedef struct adc_monitor_platform_t {
|
||
|
adc_continuous_ctx_t *continuous_ctx; // ADC continuous driver context
|
||
|
intr_handle_t monitor_intr_handle; // monitor intr handler
|
||
|
portMUX_TYPE monitor_spinlock; // spinlock
|
||
|
} adc_monitor_platform_t;
|
||
|
|
||
|
// Global context of adc monitor, other member will be lazy loaded
|
||
|
static adc_monitor_platform_t s_adc_monitor_platform = {.monitor_spinlock = portMUX_INITIALIZER_UNLOCKED};
|
||
|
|
||
|
#if CONFIG_IDF_TARGET_ESP32S2
|
||
|
// Monitor unit index need equal to ADC unit index on ESP32S2
|
||
|
static atomic_bool s_adc_monitor_claimed[SOC_ADC_DIGI_MONITOR_NUM] = {};
|
||
|
static esp_err_t s_adc_monitor_claim(adc_continuous_handle_t handle, adc_monitor_t *monitor_ctx, adc_unit_t unit)
|
||
|
{
|
||
|
assert(handle && monitor_ctx);
|
||
|
esp_err_t ret = ESP_ERR_NOT_FOUND;
|
||
|
bool false_var = false;
|
||
|
if (atomic_compare_exchange_strong(&s_adc_monitor_claimed[unit], &false_var, true)) {
|
||
|
monitor_ctx->monitor_id = unit;
|
||
|
handle->adc_monitor[unit] = monitor_ctx;
|
||
|
ret = ESP_OK;
|
||
|
} else {
|
||
|
ESP_LOGE(MNTOR_TAG, "monitor %d already in use", (int)unit);
|
||
|
}
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static esp_err_t s_adc_monitor_release(adc_monitor_t *monitor_ctx)
|
||
|
{
|
||
|
assert(monitor_ctx);
|
||
|
esp_err_t ret = ESP_ERR_NOT_FOUND;
|
||
|
bool true_var = true;
|
||
|
if (atomic_compare_exchange_strong(&s_adc_monitor_claimed[monitor_ctx->monitor_id], &true_var, false)) {
|
||
|
s_adc_monitor_platform.continuous_ctx->adc_monitor[monitor_ctx->monitor_id] = NULL;
|
||
|
ret = ESP_OK;
|
||
|
}
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
#else
|
||
|
static esp_err_t s_adc_monitor_claim(adc_continuous_handle_t handle, adc_monitor_t *monitor_ctx, adc_unit_t unit)
|
||
|
{
|
||
|
(void)unit;
|
||
|
assert(handle && monitor_ctx);
|
||
|
portENTER_CRITICAL(&s_adc_monitor_platform.monitor_spinlock);
|
||
|
for (int i = 0; i < SOC_ADC_DIGI_MONITOR_NUM; i++) {
|
||
|
if (!handle->adc_monitor[i]) {
|
||
|
monitor_ctx->monitor_id = i;
|
||
|
handle->adc_monitor[i] = monitor_ctx;
|
||
|
portEXIT_CRITICAL(&s_adc_monitor_platform.monitor_spinlock);
|
||
|
return ESP_OK;
|
||
|
}
|
||
|
}
|
||
|
portEXIT_CRITICAL(&s_adc_monitor_platform.monitor_spinlock);
|
||
|
ESP_LOGE(MNTOR_TAG, "no free monitor");
|
||
|
return ESP_ERR_NOT_FOUND;
|
||
|
}
|
||
|
|
||
|
static esp_err_t s_adc_monitor_release(adc_monitor_t *monitor_ctx)
|
||
|
{
|
||
|
assert(monitor_ctx);
|
||
|
portENTER_CRITICAL(&s_adc_monitor_platform.monitor_spinlock);
|
||
|
s_adc_monitor_platform.continuous_ctx->adc_monitor[monitor_ctx->monitor_id] = NULL;
|
||
|
portEXIT_CRITICAL(&s_adc_monitor_platform.monitor_spinlock);
|
||
|
|
||
|
return ESP_OK;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
static void IRAM_ATTR s_adc_digi_monitor_isr(void *args)
|
||
|
{
|
||
|
bool need_yield = false;
|
||
|
uint32_t intr_val = *((uint32_t *)adc_ll_digi_monitor_get_intr_status_addr());
|
||
|
|
||
|
// clear all intr flags as have save intr status in `intr_val`
|
||
|
adc_ll_digi_monitor_clear_intr();
|
||
|
|
||
|
for (uint8_t i = 0; i < SOC_ADC_DIGI_MONITOR_NUM; i++) {
|
||
|
adc_monitor_handle_t monitor_handle = s_adc_monitor_platform.continuous_ctx->adc_monitor[i];
|
||
|
|
||
|
// check if high threshold alert
|
||
|
if (intr_val & ADC_LL_GET_HIGH_THRES_MASK(i)) {
|
||
|
assert(monitor_handle);
|
||
|
assert(monitor_handle->monitor_id == i);
|
||
|
|
||
|
if (monitor_handle->cbs.on_over_high_thresh) {
|
||
|
adc_monitor_evt_data_t event_data = {};
|
||
|
need_yield |= monitor_handle->cbs.on_over_high_thresh(monitor_handle, &event_data, monitor_handle->user_data);
|
||
|
}
|
||
|
}
|
||
|
// check if low threshold alert
|
||
|
if (intr_val & ADC_LL_GET_LOW_THRES_MASK(i)) {
|
||
|
assert(monitor_handle);
|
||
|
assert(monitor_handle->monitor_id == i);
|
||
|
|
||
|
if (monitor_handle->cbs.on_below_low_thresh) {
|
||
|
adc_monitor_evt_data_t event_data = {};
|
||
|
need_yield |= monitor_handle->cbs.on_below_low_thresh(monitor_handle, &event_data, monitor_handle->user_data);
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
if (need_yield) {
|
||
|
portYIELD_FROM_ISR();
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static esp_err_t adc_monitor_intr_alloc(void)
|
||
|
{
|
||
|
esp_err_t ret = ESP_OK;
|
||
|
int intr_flags = ESP_INTR_FLAG_LOWMED;
|
||
|
#if CONFIG_ADC_CONTINUOUS_ISR_IRAM_SAFE
|
||
|
intr_flags |= ESP_INTR_FLAG_IRAM;
|
||
|
#endif
|
||
|
|
||
|
#if SOC_ADC_TEMPERATURE_SHARE_INTR
|
||
|
intr_flags |= ESP_INTR_FLAG_SHARED;
|
||
|
ret = esp_intr_alloc_intrstatus(ETS_APB_ADC_INTR_SOURCE, intr_flags,
|
||
|
(uint32_t)adc_ll_digi_monitor_get_intr_status_addr(),
|
||
|
ADC_LL_THRES_ALL_INTR_ST_M, s_adc_digi_monitor_isr, NULL, &s_adc_monitor_platform.monitor_intr_handle);
|
||
|
#else
|
||
|
|
||
|
ret = esp_intr_alloc(ETS_APB_ADC_INTR_SOURCE, intr_flags, s_adc_digi_monitor_isr, NULL, &s_adc_monitor_platform.monitor_intr_handle);
|
||
|
#endif //SOC_ADC_TEMPERATURE_SHARE_INTR
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
//-------------------------------------------PUBLIC APIs--------------------------------------------//
|
||
|
esp_err_t adc_new_continuous_monitor(adc_continuous_handle_t handle, const adc_monitor_config_t *monitor_cfg, adc_monitor_handle_t *ret_handle)
|
||
|
{
|
||
|
esp_err_t ret;
|
||
|
ESP_RETURN_ON_FALSE(handle && monitor_cfg && ret_handle, ESP_ERR_INVALID_ARG, MNTOR_TAG, "invalid argument: null pointer");
|
||
|
ESP_RETURN_ON_FALSE(monitor_cfg->adc_unit < SOC_ADC_PERIPH_NUM, ESP_ERR_INVALID_ARG, MNTOR_TAG, "invalid adc_unit");
|
||
|
ESP_RETURN_ON_FALSE(handle->fsm == ADC_FSM_INIT, ESP_ERR_INVALID_STATE, MNTOR_TAG, "ADC continuous driver should be in init state");
|
||
|
#if CONFIG_IDF_TARGET_ESP32S2
|
||
|
ESP_RETURN_ON_FALSE(!((monitor_cfg->h_threshold >= 0) && (monitor_cfg->l_threshold >= 0)), ESP_ERR_NOT_SUPPORTED, MNTOR_TAG, "ESP32S2 support only one threshold");
|
||
|
#endif
|
||
|
|
||
|
// alloc handler memory
|
||
|
adc_monitor_t *monitor_ctx = heap_caps_calloc(1, sizeof(adc_monitor_t), MALLOC_CAP_INTERNAL);
|
||
|
ESP_RETURN_ON_FALSE(monitor_ctx, ESP_ERR_NO_MEM, MNTOR_TAG, "no mem");
|
||
|
|
||
|
// alloc monitor hardware
|
||
|
ESP_GOTO_ON_ERROR(s_adc_monitor_claim(handle, monitor_ctx, monitor_cfg->adc_unit), claim_err, MNTOR_TAG, "ADC monitor claim failed");
|
||
|
memcpy(&monitor_ctx->config, monitor_cfg, sizeof(adc_monitor_config_t));
|
||
|
s_adc_monitor_platform.continuous_ctx = handle;
|
||
|
|
||
|
// alloc cpu intr
|
||
|
portENTER_CRITICAL(&s_adc_monitor_platform.monitor_spinlock);
|
||
|
bool alloc_intr = !s_adc_monitor_platform.monitor_intr_handle;
|
||
|
portEXIT_CRITICAL(&s_adc_monitor_platform.monitor_spinlock);
|
||
|
if (alloc_intr) {
|
||
|
ESP_GOTO_ON_ERROR(adc_monitor_intr_alloc(), intr_err, MNTOR_TAG, "esp intr alloc failed");
|
||
|
}
|
||
|
|
||
|
// config hardware
|
||
|
adc_ll_digi_monitor_clear_intr();
|
||
|
adc_ll_digi_monitor_set_thres(monitor_ctx->monitor_id, monitor_ctx->config.adc_unit, monitor_ctx->config.channel, monitor_ctx->config.h_threshold, monitor_ctx->config.l_threshold);
|
||
|
|
||
|
*ret_handle = monitor_ctx;
|
||
|
return ESP_OK;
|
||
|
|
||
|
intr_err:
|
||
|
s_adc_monitor_release(monitor_ctx);
|
||
|
claim_err:
|
||
|
free(monitor_ctx);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
esp_err_t adc_continuous_monitor_register_event_callbacks(adc_monitor_handle_t monitor_handle, const adc_monitor_evt_cbs_t *cbs, void *user_data)
|
||
|
{
|
||
|
ESP_RETURN_ON_FALSE(monitor_handle && cbs, ESP_ERR_INVALID_ARG, MNTOR_TAG, "invalid argument: null pointer");
|
||
|
ESP_RETURN_ON_FALSE(monitor_handle->fsm == ADC_MONITOR_FSM_INIT, ESP_ERR_INVALID_STATE, MNTOR_TAG, "monitor should be in init state");
|
||
|
ESP_RETURN_ON_FALSE(!(monitor_handle->cbs.on_over_high_thresh || monitor_handle->cbs.on_below_low_thresh), ESP_ERR_INVALID_STATE, MNTOR_TAG, "callbacks had beed registered");
|
||
|
#if CONFIG_IDF_TARGET_ESP32S2
|
||
|
ESP_RETURN_ON_FALSE(!(cbs->on_below_low_thresh && cbs->on_over_high_thresh), ESP_ERR_NOT_SUPPORTED, MNTOR_TAG, "ESP32S2 support only one threshold");
|
||
|
#endif
|
||
|
|
||
|
// If iram_safe enabled, check if user_data and cbs is iram_safe
|
||
|
#if CONFIG_ADC_CONTINUOUS_ISR_IRAM_SAFE
|
||
|
if (cbs->on_over_high_thresh) {
|
||
|
ESP_RETURN_ON_FALSE(esp_ptr_in_iram(cbs->on_over_high_thresh), ESP_ERR_INVALID_ARG, MNTOR_TAG, "on_over_high_thresh func not in iram");
|
||
|
}
|
||
|
if (cbs->on_below_low_thresh) {
|
||
|
ESP_RETURN_ON_FALSE(esp_ptr_in_iram(cbs->on_below_low_thresh), ESP_ERR_INVALID_ARG, MNTOR_TAG, "on_below_low_thresh func not in iram");
|
||
|
}
|
||
|
if (user_data) {
|
||
|
ESP_RETURN_ON_FALSE(esp_ptr_in_dram(user_data) || esp_ptr_in_diram_dram(user_data), ESP_ERR_INVALID_ARG, MNTOR_TAG, "user_data not in iram");
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
memcpy(&monitor_handle->cbs, cbs, sizeof(adc_monitor_evt_cbs_t));
|
||
|
monitor_handle->user_data = user_data;
|
||
|
return ESP_OK;
|
||
|
}
|
||
|
|
||
|
esp_err_t adc_continuous_monitor_enable(adc_monitor_handle_t monitor_handle)
|
||
|
{
|
||
|
ESP_RETURN_ON_FALSE(monitor_handle, ESP_ERR_INVALID_ARG, MNTOR_TAG, "invalid argument: null pointer");
|
||
|
ESP_RETURN_ON_FALSE(monitor_handle->fsm == ADC_MONITOR_FSM_INIT, ESP_ERR_INVALID_STATE, MNTOR_TAG, "monitor should be in init state");
|
||
|
|
||
|
// enable peripheral intr_ena
|
||
|
if ((monitor_handle->config.h_threshold >= 0)) {
|
||
|
adc_ll_digi_monitor_enable_intr(monitor_handle->monitor_id, ADC_MONITOR_MODE_HIGH, true);
|
||
|
}
|
||
|
if ((monitor_handle->config.l_threshold >= 0)) {
|
||
|
adc_ll_digi_monitor_enable_intr(monitor_handle->monitor_id, ADC_MONITOR_MODE_LOW, true);
|
||
|
}
|
||
|
|
||
|
adc_ll_digi_monitor_user_start(monitor_handle->monitor_id, true);
|
||
|
monitor_handle->fsm = ADC_MONITOR_FSM_ENABLED;
|
||
|
return esp_intr_enable(s_adc_monitor_platform.monitor_intr_handle);
|
||
|
}
|
||
|
|
||
|
esp_err_t adc_continuous_monitor_disable(adc_monitor_handle_t monitor_handle)
|
||
|
{
|
||
|
ESP_RETURN_ON_FALSE(monitor_handle, ESP_ERR_INVALID_ARG, MNTOR_TAG, "invalid argument: null pointer");
|
||
|
ESP_RETURN_ON_FALSE(monitor_handle->fsm == ADC_MONITOR_FSM_ENABLED, ESP_ERR_INVALID_STATE, MNTOR_TAG, "monitor not in running");
|
||
|
|
||
|
// disable peripheral intr_ena
|
||
|
if ((monitor_handle->config.h_threshold >= 0)) {
|
||
|
adc_ll_digi_monitor_enable_intr(monitor_handle->monitor_id, ADC_MONITOR_MODE_HIGH, false);
|
||
|
}
|
||
|
if ((monitor_handle->config.l_threshold >= 0)) {
|
||
|
adc_ll_digi_monitor_enable_intr(monitor_handle->monitor_id, ADC_MONITOR_MODE_LOW, false);
|
||
|
}
|
||
|
|
||
|
adc_ll_digi_monitor_user_start(monitor_handle->monitor_id, false);
|
||
|
monitor_handle->fsm = ADC_MONITOR_FSM_INIT;
|
||
|
return esp_intr_disable(s_adc_monitor_platform.monitor_intr_handle);
|
||
|
}
|
||
|
|
||
|
esp_err_t adc_del_continuous_monitor(adc_monitor_handle_t monitor_handle)
|
||
|
{
|
||
|
ESP_RETURN_ON_FALSE(monitor_handle, ESP_ERR_INVALID_ARG, MNTOR_TAG, "invalid argument: null pointer");
|
||
|
ESP_RETURN_ON_FALSE((monitor_handle->fsm == ADC_MONITOR_FSM_INIT) && (s_adc_monitor_platform.continuous_ctx->fsm == ADC_FSM_INIT), \
|
||
|
ESP_ERR_INVALID_STATE, MNTOR_TAG, "monitor and ADC continuous driver should all be in init state");
|
||
|
ESP_RETURN_ON_ERROR(s_adc_monitor_release(monitor_handle), MNTOR_TAG, "monitor not find or isn't in use");
|
||
|
|
||
|
for (int i = 0; i < SOC_ADC_DIGI_MONITOR_NUM; i++) {
|
||
|
if (s_adc_monitor_platform.continuous_ctx->adc_monitor[i]) {
|
||
|
// If any other monitor not freed, then delete self and exit now. del_monitor is complete
|
||
|
free(monitor_handle);
|
||
|
return ESP_OK;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
// If no monitor is using, the release intr handle as well
|
||
|
ESP_RETURN_ON_ERROR(esp_intr_free(s_adc_monitor_platform.monitor_intr_handle), MNTOR_TAG, "esp intr release failed\n");
|
||
|
s_adc_monitor_platform.monitor_intr_handle = NULL;
|
||
|
free(monitor_handle);
|
||
|
return ESP_OK;
|
||
|
}
|