mirror of
https://github.com/espressif/esp-idf.git
synced 2024-10-05 20:47:46 -04:00
d04a94320a
adc: fix calibration error when waking up from light sleep (v4.3) See merge request espressif/esp-idf!16929
78 lines
2.1 KiB
C
78 lines
2.1 KiB
C
/*
|
|
* SPDX-FileCopyrightText: 2020-2022 Espressif Systems (Shanghai) CO LTD
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include "regi2c_ctrl.h"
|
|
#include "esp_attr.h"
|
|
#include <stdint.h>
|
|
#include <freertos/FreeRTOS.h>
|
|
#include <freertos/semphr.h>
|
|
|
|
static portMUX_TYPE mux = portMUX_INITIALIZER_UNLOCKED;
|
|
|
|
uint8_t IRAM_ATTR regi2c_ctrl_read_reg(uint8_t block, uint8_t host_id, uint8_t reg_add)
|
|
{
|
|
portENTER_CRITICAL_SAFE(&mux);
|
|
uint8_t value = i2c_read_reg_raw(block, host_id, reg_add);
|
|
portEXIT_CRITICAL_SAFE(&mux);
|
|
return value;
|
|
}
|
|
|
|
uint8_t IRAM_ATTR regi2c_ctrl_read_reg_mask(uint8_t block, uint8_t host_id, uint8_t reg_add, uint8_t msb, uint8_t lsb)
|
|
{
|
|
portENTER_CRITICAL_SAFE(&mux);
|
|
uint8_t value = i2c_read_reg_mask_raw(block, host_id, reg_add, msb, lsb);
|
|
portEXIT_CRITICAL_SAFE(&mux);
|
|
return value;
|
|
}
|
|
|
|
void IRAM_ATTR regi2c_ctrl_write_reg(uint8_t block, uint8_t host_id, uint8_t reg_add, uint8_t data)
|
|
{
|
|
portENTER_CRITICAL_SAFE(&mux);
|
|
i2c_write_reg_raw(block, host_id, reg_add, data);
|
|
portEXIT_CRITICAL_SAFE(&mux);
|
|
}
|
|
|
|
void IRAM_ATTR regi2c_ctrl_write_reg_mask(uint8_t block, uint8_t host_id, uint8_t reg_add, uint8_t msb, uint8_t lsb, uint8_t data)
|
|
{
|
|
portENTER_CRITICAL_SAFE(&mux);
|
|
i2c_write_reg_mask_raw(block, host_id, reg_add, msb, lsb, data);
|
|
portEXIT_CRITICAL_SAFE(&mux);
|
|
}
|
|
|
|
void IRAM_ATTR regi2c_enter_critical(void)
|
|
{
|
|
portENTER_CRITICAL_SAFE(&mux);
|
|
}
|
|
|
|
void IRAM_ATTR regi2c_exit_critical(void)
|
|
{
|
|
portEXIT_CRITICAL_SAFE(&mux);
|
|
}
|
|
|
|
/**
|
|
* Restore regi2c analog calibration related configuration registers.
|
|
* This is a workaround, and is fixed on later chips
|
|
*/
|
|
#if REGI2C_ANA_CALI_PD_WORKAROUND
|
|
|
|
static DRAM_ATTR uint8_t reg_val[REGI2C_ANA_CALI_BYTE_NUM];
|
|
|
|
void IRAM_ATTR regi2c_analog_cali_reg_read(void)
|
|
{
|
|
for (int i = 0; i < REGI2C_ANA_CALI_BYTE_NUM; i++) {
|
|
reg_val[i] = regi2c_ctrl_read_reg(I2C_SAR_ADC, I2C_SAR_ADC_HOSTID, i);
|
|
}
|
|
}
|
|
|
|
void IRAM_ATTR regi2c_analog_cali_reg_write(void)
|
|
{
|
|
for (int i = 0; i < REGI2C_ANA_CALI_BYTE_NUM; i++) {
|
|
regi2c_ctrl_write_reg(I2C_SAR_ADC, I2C_SAR_ADC_HOSTID, i, reg_val[i]);
|
|
}
|
|
}
|
|
|
|
#endif //#if ADC_CALI_PD_WORKAROUND
|