temperature_sensor: Apply new-shared interface in temperature sensor driver

This commit is contained in:
Cao Sen Miao
2023-07-24 14:34:55 +08:00
parent 35e88d5f8f
commit 60f8d164fa
10 changed files with 76 additions and 53 deletions

View File

@@ -31,13 +31,16 @@ typedef enum {
TSENS_DAC_DEFAULT = TSENS_DAC_L2, TSENS_DAC_DEFAULT = TSENS_DAC_L2,
} temp_sensor_dac_offset_t; } temp_sensor_dac_offset_t;
/**
* @brief tsens dac offset, internal use only
*/
typedef struct { typedef struct {
int index; int index; /*!< temperature dac offset index */
int offset; int offset; /*!< temperature dac offset */
int set_val; int set_val; /*!< temperature dac set value */
int range_min; int range_min; /*!< temperature current range minimum */
int range_max; int range_max; /*!< temperature current range maximum */
int error_max; int error_max; /*!< temperature current range error */
} tsens_dac_offset_t; } tsens_dac_offset_t;
extern const tsens_dac_offset_t dac_offset[TSENS_DAC_MAX]; extern const tsens_dac_offset_t dac_offset[TSENS_DAC_MAX];

View File

@@ -28,6 +28,7 @@
#include "regi2c_ctrl.h" #include "regi2c_ctrl.h"
#include "esp32c3/rom/ets_sys.h" #include "esp32c3/rom/ets_sys.h"
#include "esp32c3/esp_efuse_rtc_calib.h" #include "esp32c3/esp_efuse_rtc_calib.h"
#include "esp_private/sar_periph_ctrl.h"
static const char *TAG = "tsens"; static const char *TAG = "tsens";
@@ -38,6 +39,8 @@ static const char *TAG = "tsens";
} \ } \
}) })
#define TSENS_XPD_WAIT_DEFAULT 0xFF /* Set wait cycle time(8MHz) from power up to reset enable. */ #define TSENS_XPD_WAIT_DEFAULT 0xFF /* Set wait cycle time(8MHz) from power up to reset enable. */
#define TEMPERATURE_SENSOR_MEASURE_MAX (125)
#define TEMPERATURE_SENSOR_MEASURE_MIN (-40)
const tsens_dac_offset_t dac_offset[TSENS_DAC_MAX] = { const tsens_dac_offset_t dac_offset[TSENS_DAC_MAX] = {
/* DAC Offset reg_val min max error */ /* DAC Offset reg_val min max error */
@@ -58,7 +61,7 @@ esp_err_t temp_sensor_set_config(temp_sensor_config_t tsens)
REGI2C_WRITE_MASK(I2C_SAR_ADC, I2C_SARADC_TSENS_DAC, dac_offset[tsens.dac_offset].set_val); REGI2C_WRITE_MASK(I2C_SAR_ADC, I2C_SARADC_TSENS_DAC, dac_offset[tsens.dac_offset].set_val);
APB_SARADC.apb_tsens_ctrl.tsens_clk_div = tsens.clk_div; APB_SARADC.apb_tsens_ctrl.tsens_clk_div = tsens.clk_div;
APB_SARADC.apb_tsens_ctrl2.tsens_xpd_wait = TSENS_XPD_WAIT_DEFAULT; APB_SARADC.apb_tsens_ctrl2.tsens_xpd_wait = TSENS_XPD_WAIT_DEFAULT;
APB_SARADC.apb_tsens_ctrl2.tsens_xpd_force = 1; temp_sensor_sync_tsens_idx(tsens.dac_offset);
ESP_LOGD(TAG, "Config temperature range [%d°C ~ %d°C], error < %d°C", ESP_LOGD(TAG, "Config temperature range [%d°C ~ %d°C], error < %d°C",
dac_offset[tsens.dac_offset].range_min, dac_offset[tsens.dac_offset].range_min,
dac_offset[tsens.dac_offset].range_max, dac_offset[tsens.dac_offset].range_max,
@@ -86,13 +89,13 @@ esp_err_t temp_sensor_start(void)
{ {
REG_SET_BIT(SYSTEM_PERIP_CLK_EN1_REG, SYSTEM_TSENS_CLK_EN); REG_SET_BIT(SYSTEM_PERIP_CLK_EN1_REG, SYSTEM_TSENS_CLK_EN);
APB_SARADC.apb_tsens_ctrl2.tsens_clk_sel = 1; APB_SARADC.apb_tsens_ctrl2.tsens_clk_sel = 1;
APB_SARADC.apb_tsens_ctrl.tsens_pu = 1; temperature_sensor_power_acquire();
return ESP_OK; return ESP_OK;
} }
esp_err_t temp_sensor_stop(void) esp_err_t temp_sensor_stop(void)
{ {
APB_SARADC.apb_tsens_ctrl.tsens_pu = 0; temperature_sensor_power_release();
APB_SARADC.apb_tsens_ctrl2.tsens_clk_sel = 0; APB_SARADC.apb_tsens_ctrl2.tsens_clk_sel = 0;
return ESP_OK; return ESP_OK;
} }
@@ -117,12 +120,12 @@ static void read_delta_t_from_efuse(void)
ESP_LOGD(TAG, "s_deltaT = %f", s_deltaT); ESP_LOGD(TAG, "s_deltaT = %f", s_deltaT);
} }
static float parse_temp_sensor_raw_value(uint32_t tsens_raw, const int dac_offset) static float parse_temp_sensor_raw_value(uint32_t tsens_raw)
{ {
if (isnan(s_deltaT)) { //suggests that the value is not initialized if (isnan(s_deltaT)) { //suggests that the value is not initialized
read_delta_t_from_efuse(); read_delta_t_from_efuse();
} }
float result = (TSENS_ADC_FACTOR * (float)tsens_raw - TSENS_DAC_FACTOR * dac_offset - TSENS_SYS_OFFSET) - s_deltaT / 10.0; float result = tsens_raw - s_deltaT / 10.0;
return result; return result;
} }
@@ -130,18 +133,16 @@ esp_err_t temp_sensor_read_celsius(float *celsius)
{ {
TSENS_CHECK(celsius != NULL, ESP_ERR_INVALID_ARG); TSENS_CHECK(celsius != NULL, ESP_ERR_INVALID_ARG);
temp_sensor_config_t tsens; temp_sensor_config_t tsens;
uint32_t tsens_out = 0; temp_sensor_get_config(&tsens);
esp_err_t ret = temp_sensor_get_config(&tsens); bool range_changed;
if (ret == ESP_OK) { uint16_t tsens_out = temp_sensor_get_raw_value(&range_changed);
ret = temp_sensor_read_raw(&tsens_out); *celsius = parse_temp_sensor_raw_value(tsens_out);
printf("tsens_out %d\r\n", tsens_out); if (*celsius < TEMPERATURE_SENSOR_MEASURE_MIN || *celsius > TEMPERATURE_SENSOR_MEASURE_MAX) {
TSENS_CHECK(ret == ESP_OK, ret); ESP_LOGE(TAG, "Exceeding temperature measure range.");
const tsens_dac_offset_t *dac = &dac_offset[tsens.dac_offset]; return ESP_ERR_INVALID_STATE;
*celsius = parse_temp_sensor_raw_value(tsens_out, dac->offset);
if (*celsius < dac->range_min || *celsius > dac->range_max) {
ESP_LOGW(TAG, "Exceeding the temperature range!");
ret = ESP_ERR_INVALID_STATE;
} }
if (range_changed) {
temp_sensor_get_config(&tsens);
} }
return ret; return ESP_OK;
} }

View File

@@ -42,13 +42,16 @@ typedef struct {
uint8_t clk_div; /*!< Default: 6 */ uint8_t clk_div; /*!< Default: 6 */
} temp_sensor_config_t; } temp_sensor_config_t;
/**
* @brief tsens dac offset, internal use only
*/
typedef struct { typedef struct {
int index; int index; /*!< temperature dac offset index */
int offset; int offset; /*!< temperature dac offset */
int set_val; int set_val; /*!< temperature dac set value */
int range_min; int range_min; /*!< temperature current range minimum */
int range_max; int range_max; /*!< temperature current range maximum */
int error_max; int error_max; /*!< temperature current range error */
} tsens_dac_offset_t; } tsens_dac_offset_t;
extern const tsens_dac_offset_t dac_offset[TSENS_DAC_MAX]; extern const tsens_dac_offset_t dac_offset[TSENS_DAC_MAX];

View File

@@ -28,6 +28,7 @@
#include "regi2c_ctrl.h" #include "regi2c_ctrl.h"
#include "esp_log.h" #include "esp_log.h"
#include "esp32s2/esp_efuse_rtc_table.h" #include "esp32s2/esp_efuse_rtc_table.h"
#include "esp_private/sar_periph_ctrl.h"
static const char *TAG = "tsens"; static const char *TAG = "tsens";
@@ -38,6 +39,9 @@ static const char *TAG = "tsens";
} \ } \
}) })
#define TSENS_XPD_WAIT_DEFAULT 0xFF /* Set wait cycle time(8MHz) from power up to reset enable. */ #define TSENS_XPD_WAIT_DEFAULT 0xFF /* Set wait cycle time(8MHz) from power up to reset enable. */
#define TEMPERATURE_SENSOR_MEASURE_MAX (125)
#define TEMPERATURE_SENSOR_MEASURE_MIN (-40)
const tsens_dac_offset_t dac_offset[TSENS_DAC_MAX] = { const tsens_dac_offset_t dac_offset[TSENS_DAC_MAX] = {
/* DAC Offset reg_val min max error */ /* DAC Offset reg_val min max error */
@@ -60,11 +64,10 @@ esp_err_t temp_sensor_set_config(temp_sensor_config_t tsens)
SET_PERI_REG_MASK(ANA_CONFIG2_REG, ANA_SAR_CFG2_M); SET_PERI_REG_MASK(ANA_CONFIG2_REG, ANA_SAR_CFG2_M);
REGI2C_WRITE_MASK(I2C_SAR_ADC, I2C_SARADC_TSENS_DAC, dac_offset[tsens.dac_offset].set_val); REGI2C_WRITE_MASK(I2C_SAR_ADC, I2C_SARADC_TSENS_DAC, dac_offset[tsens.dac_offset].set_val);
SENS.sar_tctrl.tsens_clk_div = tsens.clk_div; SENS.sar_tctrl.tsens_clk_div = tsens.clk_div;
SENS.sar_tctrl.tsens_power_up_force = 1;
SENS.sar_tctrl2.tsens_xpd_wait = TSENS_XPD_WAIT_DEFAULT; SENS.sar_tctrl2.tsens_xpd_wait = TSENS_XPD_WAIT_DEFAULT;
SENS.sar_tctrl2.tsens_xpd_force = 1;
SENS.sar_tctrl2.tsens_reset = 1;// Reset the temp sensor. SENS.sar_tctrl2.tsens_reset = 1;// Reset the temp sensor.
SENS.sar_tctrl2.tsens_reset = 0;// Clear the reset status. SENS.sar_tctrl2.tsens_reset = 0;// Clear the reset status.
temp_sensor_sync_tsens_idx(tsens.dac_offset);
ESP_LOGI(TAG, "Config temperature range [%d°C ~ %d°C], error < %d°C", ESP_LOGI(TAG, "Config temperature range [%d°C ~ %d°C], error < %d°C",
dac_offset[tsens.dac_offset].range_min, dac_offset[tsens.dac_offset].range_min,
dac_offset[tsens.dac_offset].range_max, dac_offset[tsens.dac_offset].range_max,
@@ -96,15 +99,15 @@ esp_err_t temp_sensor_start(void)
rtc_tsens_mux = xSemaphoreCreateMutex(); rtc_tsens_mux = xSemaphoreCreateMutex();
} }
TSENS_CHECK(rtc_tsens_mux != NULL, ESP_ERR_NO_MEM); TSENS_CHECK(rtc_tsens_mux != NULL, ESP_ERR_NO_MEM);
temperature_sensor_power_acquire();
SENS.sar_tctrl.tsens_dump_out = 0; SENS.sar_tctrl.tsens_dump_out = 0;
SENS.sar_tctrl2.tsens_clkgate_en = 1; SENS.sar_tctrl2.tsens_clkgate_en = 1;
SENS.sar_tctrl.tsens_power_up = 1;
return ESP_OK; return ESP_OK;
} }
esp_err_t temp_sensor_stop(void) esp_err_t temp_sensor_stop(void)
{ {
SENS.sar_tctrl.tsens_power_up = 0; temperature_sensor_power_release();
SENS.sar_tctrl2.tsens_clkgate_en = 0; SENS.sar_tctrl2.tsens_clkgate_en = 0;
if (rtc_tsens_mux != NULL) { if (rtc_tsens_mux != NULL) {
vSemaphoreDelete(rtc_tsens_mux); vSemaphoreDelete(rtc_tsens_mux);
@@ -139,12 +142,12 @@ static void read_delta_t_from_efuse(void)
ESP_LOGD(TAG, "s_deltaT = %f\n", s_deltaT); ESP_LOGD(TAG, "s_deltaT = %f\n", s_deltaT);
} }
static float parse_temp_sensor_raw_value(uint32_t tsens_raw, const int dac_offset) static float parse_temp_sensor_raw_value(uint32_t tsens_raw)
{ {
if (isnan(s_deltaT)) { //suggests that the value is not initialized if (isnan(s_deltaT)) { //suggests that the value is not initialized
read_delta_t_from_efuse(); read_delta_t_from_efuse();
} }
float result = (TSENS_ADC_FACTOR * (float)tsens_raw - TSENS_DAC_FACTOR * dac_offset - TSENS_SYS_OFFSET) - s_deltaT; float result = tsens_raw - s_deltaT / 10.0;
return result; return result;
} }
@@ -152,17 +155,17 @@ esp_err_t temp_sensor_read_celsius(float *celsius)
{ {
TSENS_CHECK(celsius != NULL, ESP_ERR_INVALID_ARG); TSENS_CHECK(celsius != NULL, ESP_ERR_INVALID_ARG);
temp_sensor_config_t tsens; temp_sensor_config_t tsens;
uint32_t tsens_out = 0; temp_sensor_get_config(&tsens);
esp_err_t ret = temp_sensor_get_config(&tsens); bool range_changed;
if (ret == ESP_OK) { uint16_t tsens_out = temp_sensor_get_raw_value(&range_changed);
ret = temp_sensor_read_raw(&tsens_out); *celsius = parse_temp_sensor_raw_value(tsens_out);
TSENS_CHECK(ret == ESP_OK, ret); if (*celsius < TEMPERATURE_SENSOR_MEASURE_MIN || *celsius > TEMPERATURE_SENSOR_MEASURE_MAX) {
const tsens_dac_offset_t *dac = &dac_offset[tsens.dac_offset]; ESP_LOGE(TAG, "Exceeding temperature measure range.");
*celsius = parse_temp_sensor_raw_value(tsens_out, dac->offset); return ESP_ERR_INVALID_STATE;
if (*celsius < dac->range_min || *celsius > dac->range_max) {
ESP_LOGW(TAG, "Exceeding the temperature range!");
ret = ESP_ERR_INVALID_STATE;
} }
if (range_changed) {
temp_sensor_get_config(&tsens);
} }
return ret; return ESP_OK;
} }

View File

@@ -9,8 +9,6 @@ set(srcs "compare_set.c" "cpu_util.c")
if(NOT BOOTLOADER_BUILD) if(NOT BOOTLOADER_BUILD)
list(APPEND srcs "clk_ctrl_os.c" list(APPEND srcs "clk_ctrl_os.c"
"regi2c_ctrl.c") "regi2c_ctrl.c")
list(APPEND requires driver freertos)
endif() endif()
idf_component_register(SRCS ${srcs} idf_component_register(SRCS ${srcs}

View File

@@ -41,6 +41,14 @@ void temperature_sensor_power_release(void);
*/ */
int16_t temp_sensor_get_raw_value(bool *range_changed); int16_t temp_sensor_get_raw_value(bool *range_changed);
/**
* @brief Synchronize the tsens_idx between sar_periph and driver
*
* @param tsens_idx index value of temperature sensor attribute
*/
void temp_sensor_sync_tsens_idx(int tsens_idx);
#ifdef __cplusplus #ifdef __cplusplus
} }
#endif #endif

View File

@@ -17,7 +17,6 @@
extern __attribute__((unused)) portMUX_TYPE rtc_spinlock; extern __attribute__((unused)) portMUX_TYPE rtc_spinlock;
/*------------------------------------------------------------------------------------------------------------ /*------------------------------------------------------------------------------------------------------------
-----------------------------------------Temperature Sensor--------------------------------------------------- -----------------------------------------Temperature Sensor---------------------------------------------------
------------------------------------------------------------------------------------------------------------*/ ------------------------------------------------------------------------------------------------------------*/

View File

@@ -16,6 +16,7 @@
*/ */
static bool s_wifi_adc_xpd_flag; static bool s_wifi_adc_xpd_flag;
static bool s_wifi_tsens_xpd_flag;
void include_esp_phy_override(void) void include_esp_phy_override(void)
{ {
@@ -56,6 +57,13 @@ IRAM_ATTR void phy_i2c_exit_critical(void)
void phy_set_tsens_power(bool en) void phy_set_tsens_power(bool en)
{ {
if (s_wifi_tsens_xpd_flag == en) {
/* ignore repeated calls to phy_set_tsens_power when the state is already correct */
return;
}
s_wifi_tsens_xpd_flag = en;
if (en) { if (en) {
temperature_sensor_power_acquire(); temperature_sensor_power_acquire();
} else { } else {