xclk.c 1.7 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061
  1. #include "driver/gpio.h"
  2. #include "driver/ledc.h"
  3. #include "esp_err.h"
  4. #include "esp_log.h"
  5. #include "esp_system.h"
  6. #include "xclk.h"
  7. #if defined(ARDUINO_ARCH_ESP32) && defined(CONFIG_ARDUHAL_ESP_LOG)
  8. #include "esp32-hal-log.h"
  9. #else
  10. #include "esp_log.h"
  11. static const char* TAG = "camera_xclk";
  12. #endif
  13. esp_err_t xclk_timer_conf(int ledc_timer, int xclk_freq_hz)
  14. {
  15. ledc_timer_config_t timer_conf;
  16. timer_conf.duty_resolution = 2;
  17. timer_conf.freq_hz = xclk_freq_hz;
  18. timer_conf.speed_mode = LEDC_HIGH_SPEED_MODE;
  19. #if ESP_IDF_VERSION_MAJOR >= 4
  20. timer_conf.clk_cfg = LEDC_AUTO_CLK;
  21. #endif
  22. timer_conf.timer_num = (ledc_timer_t)ledc_timer;
  23. esp_err_t err = ledc_timer_config(&timer_conf);
  24. if (err != ESP_OK) {
  25. ESP_LOGE(TAG, "ledc_timer_config failed for freq %d, rc=%x", xclk_freq_hz, err);
  26. }
  27. return err;
  28. }
  29. esp_err_t camera_enable_out_clock(camera_config_t* config)
  30. {
  31. periph_module_enable(PERIPH_LEDC_MODULE);
  32. esp_err_t err = xclk_timer_conf(config->ledc_timer, config->xclk_freq_hz);
  33. if (err != ESP_OK) {
  34. ESP_LOGE(TAG, "ledc_timer_config failed, rc=%x", err);
  35. return err;
  36. }
  37. ledc_channel_config_t ch_conf;
  38. ch_conf.gpio_num = config->pin_xclk;
  39. ch_conf.speed_mode = LEDC_HIGH_SPEED_MODE;
  40. ch_conf.channel = config->ledc_channel;
  41. ch_conf.intr_type = LEDC_INTR_DISABLE;
  42. ch_conf.timer_sel = config->ledc_timer;
  43. ch_conf.duty = 2;
  44. ch_conf.hpoint = 0;
  45. err = ledc_channel_config(&ch_conf);
  46. if (err != ESP_OK) {
  47. ESP_LOGE(TAG, "ledc_channel_config failed, rc=%x", err);
  48. return err;
  49. }
  50. return ESP_OK;
  51. }
  52. void camera_disable_out_clock()
  53. {
  54. periph_module_disable(PERIPH_LEDC_MODULE);
  55. }