esp-idf/components/esp_adc/adc_monitor.c

275 lines
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;
}