sigmadelta.c 2.5 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061
  1. // Copyright 2015-2016 Espressif Systems (Shanghai) PTE LTD
  2. //
  3. // Licensed under the Apache License, Version 2.0 (the "License");
  4. // you may not use this file except in compliance with the License.
  5. // You may obtain a copy of the License at
  6. // http://www.apache.org/licenses/LICENSE-2.0
  7. //
  8. // Unless required by applicable law or agreed to in writing, software
  9. // distributed under the License is distributed on an "AS IS" BASIS,
  10. // WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  11. // See the License for the specific language governing permissions and
  12. // limitations under the License.
  13. #include "esp_log.h"
  14. #include "soc/soc.h"
  15. #include "driver/periph_ctrl.h"
  16. #include "driver/sigmadelta.h"
  17. static const char* SIGMADELTA_TAG = "SIGMADELTA";
  18. #define SIGMADELTA_CHANNEL_ERR_STR "SIGMADELTA CHANNEL ERROR"
  19. #define SIGMADELTA_IO_ERR_STR "SIGMADELTA GPIO NUM ERROR"
  20. #define SIGMADELTA_CHECK(a,str,ret_val) if(!(a)) { \
  21. ESP_LOGE(SIGMADELTA_TAG,"%s:%d (%s):%s", __FILE__, __LINE__, __FUNCTION__, str); \
  22. return (ret_val); \
  23. }
  24. esp_err_t sigmadelta_config(sigmadelta_config_t *config)
  25. {
  26. SIGMADELTA_CHECK(config->channel < SIGMADELTA_CHANNEL_MAX, SIGMADELTA_CHANNEL_ERR_STR, ESP_ERR_INVALID_ARG);
  27. SIGMADELTA_CHECK(GPIO_IS_VALID_OUTPUT_GPIO(config->sigmadelta_gpio), SIGMADELTA_IO_ERR_STR, ESP_ERR_INVALID_ARG);
  28. sigmadelta_set_duty(config->channel, config->sigmadelta_duty);
  29. sigmadelta_set_prescale(config->channel, config->sigmadelta_prescale);
  30. sigmadelta_set_pin(config->channel, config->sigmadelta_gpio);
  31. return ESP_OK;
  32. }
  33. esp_err_t sigmadelta_set_duty(sigmadelta_channel_t channel, int8_t duty)
  34. {
  35. SIGMADELTA_CHECK(channel < SIGMADELTA_CHANNEL_MAX, SIGMADELTA_CHANNEL_ERR_STR, ESP_ERR_INVALID_ARG);
  36. SIGMADELTA.channel[channel].duty = duty;
  37. return ESP_OK;
  38. }
  39. esp_err_t sigmadelta_set_prescale(sigmadelta_channel_t channel, uint8_t prescale)
  40. {
  41. SIGMADELTA_CHECK(channel < SIGMADELTA_CHANNEL_MAX, SIGMADELTA_CHANNEL_ERR_STR, ESP_ERR_INVALID_ARG);
  42. SIGMADELTA.channel[channel].prescale = prescale;
  43. return ESP_OK;
  44. }
  45. esp_err_t sigmadelta_set_pin(sigmadelta_channel_t channel, gpio_num_t gpio_num)
  46. {
  47. SIGMADELTA_CHECK(channel < SIGMADELTA_CHANNEL_MAX, SIGMADELTA_CHANNEL_ERR_STR, ESP_ERR_INVALID_ARG);
  48. SIGMADELTA_CHECK(GPIO_IS_VALID_OUTPUT_GPIO(gpio_num), SIGMADELTA_IO_ERR_STR, ESP_ERR_INVALID_ARG);
  49. PIN_FUNC_SELECT(GPIO_PIN_MUX_REG[gpio_num], PIN_FUNC_GPIO);
  50. gpio_set_direction(gpio_num, GPIO_MODE_OUTPUT);
  51. gpio_matrix_out(gpio_num, GPIO_SD0_OUT_IDX + channel, 0, 0);
  52. return ESP_OK;
  53. }