mirror of
				https://github.com/espressif/esp-idf.git
				synced 2025-11-03 22:08:28 +00:00 
			
		
		
		
	
		
			
				
	
	
		
			155 lines
		
	
	
		
			5.8 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			155 lines
		
	
	
		
			5.8 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * SPDX-FileCopyrightText: 2022 Espressif Systems (Shanghai) CO LTD
 | 
						|
 *
 | 
						|
 * SPDX-License-Identifier: Apache-2.0
 | 
						|
 */
 | 
						|
 | 
						|
#include <string.h>
 | 
						|
#include "soc/soc_caps.h"
 | 
						|
#include "driver/dac_cosine.h"
 | 
						|
#include "hal/clk_tree_ll.h"
 | 
						|
#include "dac_priv_common.h"
 | 
						|
#include "clk_ctrl_os.h"
 | 
						|
 | 
						|
#if CONFIG_DAC_ENABLE_DEBUG_LOG
 | 
						|
// The local log level must be defined before including esp_log.h
 | 
						|
// Set the maximum log level for this source file
 | 
						|
#define LOG_LOCAL_LEVEL ESP_LOG_DEBUG
 | 
						|
#endif
 | 
						|
#include "esp_check.h"
 | 
						|
#if CONFIG_PM_ENABLE
 | 
						|
#include "esp_pm.h"
 | 
						|
#endif
 | 
						|
 | 
						|
struct dac_cosine_s {
 | 
						|
    dac_cosine_config_t     cfg;        /*!< Cosine mode configurations */
 | 
						|
    bool                    is_started; /*!< Flag: is the channel started(not cosine wave generator) */
 | 
						|
};
 | 
						|
 | 
						|
static const char *TAG = "dac_cosine";
 | 
						|
 | 
						|
/* Cosine wave generator reference count
 | 
						|
 * The cosine wave generator is shared by dac channels */
 | 
						|
static uint32_t s_cwg_refer_cnt = 0;
 | 
						|
 | 
						|
/* The frequency of cosine wave generator */
 | 
						|
static uint32_t s_cwg_freq = 0;
 | 
						|
 | 
						|
esp_err_t dac_cosine_new_channel(const dac_cosine_config_t *cos_cfg, dac_cosine_handle_t *ret_handle)
 | 
						|
{
 | 
						|
#if CONFIG_DAC_ENABLE_DEBUG_LOG
 | 
						|
    esp_log_level_set(TAG, ESP_LOG_DEBUG);
 | 
						|
#endif
 | 
						|
    /* Parameters validation */
 | 
						|
    DAC_NULL_POINTER_CHECK(cos_cfg);
 | 
						|
    DAC_NULL_POINTER_CHECK(ret_handle);
 | 
						|
    ESP_RETURN_ON_FALSE(cos_cfg->chan_id < SOC_DAC_CHAN_NUM, ESP_ERR_INVALID_ARG, TAG, "invalid dac channel id");
 | 
						|
    ESP_RETURN_ON_FALSE(cos_cfg->freq_hz >= (130 / clk_ll_rc_fast_get_divider()), ESP_ERR_NOT_SUPPORTED, TAG, "The cosine wave frequency is too low");
 | 
						|
    ESP_RETURN_ON_FALSE((!s_cwg_freq) || cos_cfg->flags.force_set_freq || (cos_cfg->freq_hz == s_cwg_freq),
 | 
						|
                        ESP_ERR_INVALID_STATE, TAG, "The cosine wave frequency has set already, not allowed to update unless `force_set_freq` is set");
 | 
						|
 | 
						|
    esp_err_t ret = ESP_OK;
 | 
						|
    /* Allocate cosine handle */
 | 
						|
    dac_cosine_handle_t handle = heap_caps_calloc(1, sizeof(struct dac_cosine_s), MALLOC_CAP_INTERNAL | MALLOC_CAP_8BIT);
 | 
						|
    ESP_RETURN_ON_FALSE(handle, ESP_ERR_NO_MEM, TAG, "no memory for the dac cosine handle");
 | 
						|
    /* Assign configurations */
 | 
						|
    memcpy(&handle->cfg, cos_cfg, sizeof(dac_cosine_config_t));
 | 
						|
    /* Register the handle */
 | 
						|
    ESP_GOTO_ON_ERROR(dac_priv_register_channel(cos_cfg->chan_id, "dac cosine"), err1, TAG, "register dac channel %d failed", cos_cfg->chan_id);
 | 
						|
 | 
						|
    /* Only enabled for getting the correct rtc clock frequency */
 | 
						|
    periph_rtc_dig_clk8m_enable();
 | 
						|
    /* Cosine wave generator uses RTC_FAST clock which is divided from RC_FAST */
 | 
						|
    // [clk_tree] TODO: replace the following calculation with the RTC_FAST frequency getter
 | 
						|
    uint32_t rtc_clk_freq = periph_rtc_dig_clk8m_get_freq() / clk_ll_rc_fast_get_divider();
 | 
						|
    /* Disabled after getting the frequency, will re-enabled again when start outputting cosine wave */
 | 
						|
    periph_rtc_dig_clk8m_disable();
 | 
						|
    if (rtc_clk_freq == 0) {
 | 
						|
        ESP_LOGW(TAG, "RTC clock calibration failed, using the approximate value as default");
 | 
						|
        rtc_clk_freq = SOC_CLK_RC_FAST_FREQ_APPROX;
 | 
						|
    }
 | 
						|
    DAC_RTC_ENTER_CRITICAL();
 | 
						|
    /* Set coefficients for cosine wave generator */
 | 
						|
    if ((!s_cwg_freq) || cos_cfg->flags.force_set_freq) {
 | 
						|
        dac_ll_cw_set_freq(cos_cfg->freq_hz, rtc_clk_freq);
 | 
						|
        s_cwg_freq = cos_cfg->freq_hz;
 | 
						|
    }
 | 
						|
    dac_ll_cw_set_atten(cos_cfg->chan_id, cos_cfg->atten);
 | 
						|
    dac_ll_cw_set_phase(cos_cfg->chan_id, cos_cfg->phase);
 | 
						|
    dac_ll_cw_set_dc_offset(cos_cfg->chan_id, cos_cfg->offset);
 | 
						|
    DAC_RTC_EXIT_CRITICAL();
 | 
						|
 | 
						|
    *ret_handle = handle;
 | 
						|
    return ret;
 | 
						|
 | 
						|
err1:
 | 
						|
    free(handle);
 | 
						|
    return ret;
 | 
						|
}
 | 
						|
 | 
						|
esp_err_t dac_cosine_del_channel(dac_cosine_handle_t handle)
 | 
						|
{
 | 
						|
    DAC_NULL_POINTER_CHECK(handle);
 | 
						|
    ESP_RETURN_ON_FALSE(!handle->is_started, ESP_ERR_INVALID_STATE, TAG,
 | 
						|
                        "the dac cosine generator is not stopped yet");
 | 
						|
 | 
						|
    ESP_RETURN_ON_ERROR(dac_priv_deregister_channel(handle->cfg.chan_id), TAG,
 | 
						|
                        "deregister dac channel %d failed", handle->cfg.chan_id);
 | 
						|
    /* Clear the frequency if no channel using it */
 | 
						|
    if (!s_cwg_refer_cnt) {
 | 
						|
        s_cwg_freq = 0;
 | 
						|
    }
 | 
						|
    free(handle);
 | 
						|
 | 
						|
    return ESP_OK;
 | 
						|
}
 | 
						|
 | 
						|
esp_err_t dac_cosine_start(dac_cosine_handle_t handle)
 | 
						|
{
 | 
						|
    DAC_NULL_POINTER_CHECK(handle);
 | 
						|
    ESP_RETURN_ON_FALSE(!handle->is_started, ESP_ERR_INVALID_STATE, TAG,
 | 
						|
                        "the dac channel has already started");
 | 
						|
    /* Acquire the RTC clock */
 | 
						|
    periph_rtc_dig_clk8m_enable();
 | 
						|
    /* Enabled DAC channel */
 | 
						|
    ESP_RETURN_ON_ERROR(dac_priv_enable_channel(handle->cfg.chan_id), TAG,
 | 
						|
                        "enable dac channel %d failed", handle->cfg.chan_id);
 | 
						|
    /* Enabled the cosine wave generator if no channel using it before */
 | 
						|
    DAC_RTC_ENTER_CRITICAL();
 | 
						|
    if (s_cwg_refer_cnt == 0) {
 | 
						|
        dac_ll_cw_generator_enable();
 | 
						|
    }
 | 
						|
    /* Connect the DAC channel to the cosine wave generator */
 | 
						|
    dac_ll_cw_enable_channel(handle->cfg.chan_id, true);
 | 
						|
    s_cwg_refer_cnt++;
 | 
						|
    handle->is_started = true;
 | 
						|
    DAC_RTC_EXIT_CRITICAL();
 | 
						|
 | 
						|
    return ESP_OK;
 | 
						|
}
 | 
						|
 | 
						|
esp_err_t dac_cosine_stop(dac_cosine_handle_t handle)
 | 
						|
{
 | 
						|
    DAC_NULL_POINTER_CHECK(handle);
 | 
						|
    ESP_RETURN_ON_FALSE(handle->is_started, ESP_ERR_INVALID_STATE, TAG,
 | 
						|
                        "the dac channel has already stopped");
 | 
						|
 | 
						|
    /* Enabled DAC channel */
 | 
						|
    ESP_RETURN_ON_ERROR(dac_priv_disable_channel(handle->cfg.chan_id), TAG,
 | 
						|
                        "disable dac channel %d failed", handle->cfg.chan_id);
 | 
						|
    DAC_RTC_ENTER_CRITICAL();
 | 
						|
    /* Disconnect the DAC channel from the cosine wave generator */
 | 
						|
    dac_ll_cw_enable_channel(handle->cfg.chan_id, false);
 | 
						|
    s_cwg_refer_cnt--;
 | 
						|
    /* Disable the cosine wave generator if no channel using it */
 | 
						|
    if (s_cwg_refer_cnt == 0) {
 | 
						|
        dac_ll_cw_generator_disable();
 | 
						|
    }
 | 
						|
    handle->is_started = false;
 | 
						|
    DAC_RTC_EXIT_CRITICAL();
 | 
						|
    /* Release the RTC clock */
 | 
						|
    periph_rtc_dig_clk8m_disable();
 | 
						|
 | 
						|
    return ESP_OK;
 | 
						|
}
 |