regi2c_ctrl.c 2.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114
  1. /*
  2. * SPDX-FileCopyrightText: 2020-2022 Espressif Systems (Shanghai) CO LTD
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. */
  6. #include "esp_attr.h"
  7. #include <stdint.h>
  8. #include "freertos/FreeRTOS.h"
  9. #include "freertos/semphr.h"
  10. #include "hal/regi2c_ctrl.h"
  11. #include "hal/regi2c_ctrl_ll.h"
  12. #include "esp_hw_log.h"
  13. static portMUX_TYPE mux = portMUX_INITIALIZER_UNLOCKED;
  14. static DRAM_ATTR __attribute__((unused)) const char *TAG = "REGI2C";
  15. uint8_t IRAM_ATTR regi2c_ctrl_read_reg(uint8_t block, uint8_t host_id, uint8_t reg_add)
  16. {
  17. portENTER_CRITICAL_SAFE(&mux);
  18. uint8_t value = regi2c_read_reg_raw(block, host_id, reg_add);
  19. portEXIT_CRITICAL_SAFE(&mux);
  20. return value;
  21. }
  22. 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)
  23. {
  24. portENTER_CRITICAL_SAFE(&mux);
  25. uint8_t value = regi2c_read_reg_mask_raw(block, host_id, reg_add, msb, lsb);
  26. portEXIT_CRITICAL_SAFE(&mux);
  27. return value;
  28. }
  29. void IRAM_ATTR regi2c_ctrl_write_reg(uint8_t block, uint8_t host_id, uint8_t reg_add, uint8_t data)
  30. {
  31. portENTER_CRITICAL_SAFE(&mux);
  32. regi2c_write_reg_raw(block, host_id, reg_add, data);
  33. portEXIT_CRITICAL_SAFE(&mux);
  34. }
  35. 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)
  36. {
  37. portENTER_CRITICAL_SAFE(&mux);
  38. regi2c_write_reg_mask_raw(block, host_id, reg_add, msb, lsb, data);
  39. portEXIT_CRITICAL_SAFE(&mux);
  40. }
  41. void IRAM_ATTR regi2c_enter_critical(void)
  42. {
  43. portENTER_CRITICAL_SAFE(&mux);
  44. }
  45. void IRAM_ATTR regi2c_exit_critical(void)
  46. {
  47. portEXIT_CRITICAL_SAFE(&mux);
  48. }
  49. /**
  50. * Restore regi2c analog calibration related configuration registers.
  51. * This is a workaround, and is fixed on later chips
  52. */
  53. #if REGI2C_ANA_CALI_PD_WORKAROUND
  54. #include "soc/regi2c_saradc.h"
  55. static DRAM_ATTR uint8_t reg_val[REGI2C_ANA_CALI_BYTE_NUM];
  56. void IRAM_ATTR regi2c_analog_cali_reg_read(void)
  57. {
  58. for (int i = 0; i < REGI2C_ANA_CALI_BYTE_NUM; i++) {
  59. reg_val[i] = regi2c_ctrl_read_reg(I2C_SAR_ADC, I2C_SAR_ADC_HOSTID, i);
  60. }
  61. }
  62. void IRAM_ATTR regi2c_analog_cali_reg_write(void)
  63. {
  64. for (int i = 0; i < REGI2C_ANA_CALI_BYTE_NUM; i++) {
  65. regi2c_ctrl_write_reg(I2C_SAR_ADC, I2C_SAR_ADC_HOSTID, i, reg_val[i]);
  66. }
  67. }
  68. /**
  69. * REGI2C_SARADC reference count
  70. */
  71. static int s_i2c_saradc_enable_cnt;
  72. void regi2c_saradc_enable(void)
  73. {
  74. regi2c_enter_critical();
  75. s_i2c_saradc_enable_cnt++;
  76. if (s_i2c_saradc_enable_cnt == 1) {
  77. regi2c_ctrl_ll_i2c_saradc_enable();
  78. }
  79. regi2c_exit_critical();
  80. }
  81. void regi2c_saradc_disable(void)
  82. {
  83. regi2c_enter_critical();
  84. s_i2c_saradc_enable_cnt--;
  85. if (s_i2c_saradc_enable_cnt < 0){
  86. regi2c_exit_critical();
  87. ESP_HW_LOGE(TAG, "REGI2C_SARADC is already disabled");
  88. } else if (s_i2c_saradc_enable_cnt == 0) {
  89. regi2c_ctrl_ll_i2c_saradc_disable();
  90. }
  91. regi2c_exit_critical();
  92. }
  93. #endif //#if ADC_CALI_PD_WORKAROUND