machine_adc.c 4.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132
  1. /*
  2. * This file is part of the MicroPython project, http://micropython.org/
  3. *
  4. * The MIT License (MIT)
  5. *
  6. * Copyright (c) 2017 Nick Moore
  7. *
  8. * Permission is hereby granted, free of charge, to any person obtaining a copy
  9. * of this software and associated documentation files (the "Software"), to deal
  10. * in the Software without restriction, including without limitation the rights
  11. * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  12. * copies of the Software, and to permit persons to whom the Software is
  13. * furnished to do so, subject to the following conditions:
  14. *
  15. * The above copyright notice and this permission notice shall be included in
  16. * all copies or substantial portions of the Software.
  17. *
  18. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  19. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  20. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  21. * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  22. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  23. * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  24. * THE SOFTWARE.
  25. */
  26. #include <stdio.h>
  27. #include "esp_log.h"
  28. #include "driver/gpio.h"
  29. #include "driver/adc.h"
  30. #include "py/runtime.h"
  31. #include "py/mphal.h"
  32. #include "modmachine.h"
  33. typedef struct _madc_obj_t {
  34. mp_obj_base_t base;
  35. gpio_num_t gpio_id;
  36. adc1_channel_t adc1_id;
  37. } madc_obj_t;
  38. STATIC const madc_obj_t madc_obj[] = {
  39. {{&machine_adc_type}, GPIO_NUM_36, ADC1_CHANNEL_0},
  40. {{&machine_adc_type}, GPIO_NUM_37, ADC1_CHANNEL_1},
  41. {{&machine_adc_type}, GPIO_NUM_38, ADC1_CHANNEL_2},
  42. {{&machine_adc_type}, GPIO_NUM_39, ADC1_CHANNEL_3},
  43. {{&machine_adc_type}, GPIO_NUM_32, ADC1_CHANNEL_4},
  44. {{&machine_adc_type}, GPIO_NUM_33, ADC1_CHANNEL_5},
  45. {{&machine_adc_type}, GPIO_NUM_34, ADC1_CHANNEL_6},
  46. {{&machine_adc_type}, GPIO_NUM_35, ADC1_CHANNEL_7},
  47. };
  48. STATIC mp_obj_t madc_make_new(const mp_obj_type_t *type, size_t n_args, size_t n_kw,
  49. const mp_obj_t *args) {
  50. static int initialized = 0;
  51. if (!initialized) {
  52. adc1_config_width(ADC_WIDTH_12Bit);
  53. initialized = 1;
  54. }
  55. mp_arg_check_num(n_args, n_kw, 1, 1, true);
  56. gpio_num_t pin_id = machine_pin_get_id(args[0]);
  57. const madc_obj_t *self = NULL;
  58. for (int i = 0; i < MP_ARRAY_SIZE(madc_obj); i++) {
  59. if (pin_id == madc_obj[i].gpio_id) { self = &madc_obj[i]; break; }
  60. }
  61. if (!self) mp_raise_ValueError("invalid Pin for ADC");
  62. esp_err_t err = adc1_config_channel_atten(self->adc1_id, ADC_ATTEN_0db);
  63. if (err == ESP_OK) return MP_OBJ_FROM_PTR(self);
  64. mp_raise_ValueError("Parameter Error");
  65. }
  66. STATIC void madc_print(const mp_print_t *print, mp_obj_t self_in, mp_print_kind_t kind) {
  67. madc_obj_t *self = self_in;
  68. mp_printf(print, "ADC(Pin(%u))", self->gpio_id);
  69. }
  70. STATIC mp_obj_t madc_read(mp_obj_t self_in) {
  71. madc_obj_t *self = self_in;
  72. int val = adc1_get_raw(self->adc1_id);
  73. if (val == -1) mp_raise_ValueError("Parameter Error");
  74. return MP_OBJ_NEW_SMALL_INT(val);
  75. }
  76. MP_DEFINE_CONST_FUN_OBJ_1(madc_read_obj, madc_read);
  77. STATIC mp_obj_t madc_atten(mp_obj_t self_in, mp_obj_t atten_in) {
  78. madc_obj_t *self = self_in;
  79. adc_atten_t atten = mp_obj_get_int(atten_in);
  80. esp_err_t err = adc1_config_channel_atten(self->adc1_id, atten);
  81. if (err == ESP_OK) return mp_const_none;
  82. mp_raise_ValueError("Parameter Error");
  83. }
  84. MP_DEFINE_CONST_FUN_OBJ_2(madc_atten_obj, madc_atten);
  85. STATIC mp_obj_t madc_width(mp_obj_t cls_in, mp_obj_t width_in) {
  86. adc_bits_width_t width = mp_obj_get_int(width_in);
  87. esp_err_t err = adc1_config_width(width);
  88. if (err == ESP_OK) return mp_const_none;
  89. mp_raise_ValueError("Parameter Error");
  90. }
  91. MP_DEFINE_CONST_FUN_OBJ_2(madc_width_fun_obj, madc_width);
  92. MP_DEFINE_CONST_CLASSMETHOD_OBJ(madc_width_obj, MP_ROM_PTR(&madc_width_fun_obj));
  93. STATIC const mp_rom_map_elem_t madc_locals_dict_table[] = {
  94. { MP_ROM_QSTR(MP_QSTR_read), MP_ROM_PTR(&madc_read_obj) },
  95. { MP_ROM_QSTR(MP_QSTR_atten), MP_ROM_PTR(&madc_atten_obj) },
  96. { MP_ROM_QSTR(MP_QSTR_width), MP_ROM_PTR(&madc_width_obj) },
  97. { MP_ROM_QSTR(MP_QSTR_ATTN_0DB), MP_ROM_INT(ADC_ATTEN_0db) },
  98. { MP_ROM_QSTR(MP_QSTR_ATTN_2_5DB), MP_ROM_INT(ADC_ATTEN_2_5db) },
  99. { MP_ROM_QSTR(MP_QSTR_ATTN_6DB), MP_ROM_INT(ADC_ATTEN_6db) },
  100. { MP_ROM_QSTR(MP_QSTR_ATTN_11DB), MP_ROM_INT(ADC_ATTEN_11db) },
  101. { MP_ROM_QSTR(MP_QSTR_WIDTH_9BIT), MP_ROM_INT(ADC_WIDTH_9Bit) },
  102. { MP_ROM_QSTR(MP_QSTR_WIDTH_10BIT), MP_ROM_INT(ADC_WIDTH_10Bit) },
  103. { MP_ROM_QSTR(MP_QSTR_WIDTH_11BIT), MP_ROM_INT(ADC_WIDTH_11Bit) },
  104. { MP_ROM_QSTR(MP_QSTR_WIDTH_12BIT), MP_ROM_INT(ADC_WIDTH_12Bit) },
  105. };
  106. STATIC MP_DEFINE_CONST_DICT(madc_locals_dict, madc_locals_dict_table);
  107. const mp_obj_type_t machine_adc_type = {
  108. { &mp_type_type },
  109. .name = MP_QSTR_ADC,
  110. .print = madc_print,
  111. .make_new = madc_make_new,
  112. .locals_dict = (mp_obj_t)&madc_locals_dict,
  113. };