regi2c_ctrl.c 2.2 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879
  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 "regi2c_ctrl.h"
  11. static portMUX_TYPE mux = portMUX_INITIALIZER_UNLOCKED;
  12. uint8_t IRAM_ATTR regi2c_ctrl_read_reg(uint8_t block, uint8_t host_id, uint8_t reg_add)
  13. {
  14. portENTER_CRITICAL_SAFE(&mux);
  15. uint8_t value = regi2c_read_reg_raw(block, host_id, reg_add);
  16. portEXIT_CRITICAL_SAFE(&mux);
  17. return value;
  18. }
  19. 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)
  20. {
  21. portENTER_CRITICAL_SAFE(&mux);
  22. uint8_t value = regi2c_read_reg_mask_raw(block, host_id, reg_add, msb, lsb);
  23. portEXIT_CRITICAL_SAFE(&mux);
  24. return value;
  25. }
  26. void IRAM_ATTR regi2c_ctrl_write_reg(uint8_t block, uint8_t host_id, uint8_t reg_add, uint8_t data)
  27. {
  28. portENTER_CRITICAL_SAFE(&mux);
  29. regi2c_write_reg_raw(block, host_id, reg_add, data);
  30. portEXIT_CRITICAL_SAFE(&mux);
  31. }
  32. 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)
  33. {
  34. portENTER_CRITICAL_SAFE(&mux);
  35. regi2c_write_reg_mask_raw(block, host_id, reg_add, msb, lsb, data);
  36. portEXIT_CRITICAL_SAFE(&mux);
  37. }
  38. void IRAM_ATTR regi2c_enter_critical(void)
  39. {
  40. portENTER_CRITICAL_SAFE(&mux);
  41. }
  42. void IRAM_ATTR regi2c_exit_critical(void)
  43. {
  44. portEXIT_CRITICAL_SAFE(&mux);
  45. }
  46. /**
  47. * Restore regi2c analog calibration related configuration registers.
  48. * This is a workaround, and is fixed on later chips
  49. */
  50. #if REGI2C_ANA_CALI_PD_WORKAROUND
  51. #include "regi2c_saradc.h"
  52. static DRAM_ATTR uint8_t reg_val[REGI2C_ANA_CALI_BYTE_NUM];
  53. void IRAM_ATTR regi2c_analog_cali_reg_read(void)
  54. {
  55. for (int i = 0; i < REGI2C_ANA_CALI_BYTE_NUM; i++) {
  56. reg_val[i] = regi2c_ctrl_read_reg(I2C_SAR_ADC, I2C_SAR_ADC_HOSTID, i);
  57. }
  58. }
  59. void IRAM_ATTR regi2c_analog_cali_reg_write(void)
  60. {
  61. for (int i = 0; i < REGI2C_ANA_CALI_BYTE_NUM; i++) {
  62. regi2c_ctrl_write_reg(I2C_SAR_ADC, I2C_SAR_ADC_HOSTID, i, reg_val[i]);
  63. }
  64. }
  65. #endif //#if ADC_CALI_PD_WORKAROUND