ubluepy_scan_entry.c 5.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146
  1. /*
  2. * This file is part of the MicroPython project, http://micropython.org/
  3. *
  4. * The MIT License (MIT)
  5. *
  6. * Copyright (c) 2017 Glenn Ruben Bakke
  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 <string.h>
  27. #include "py/obj.h"
  28. #include "py/runtime.h"
  29. #include "py/objstr.h"
  30. #include "py/objlist.h"
  31. #include "py/objarray.h"
  32. #include "py/objtuple.h"
  33. #include "py/qstr.h"
  34. #if MICROPY_PY_UBLUEPY_CENTRAL
  35. #include "ble_drv.h"
  36. STATIC void ubluepy_scan_entry_print(const mp_print_t *print, mp_obj_t o, mp_print_kind_t kind) {
  37. ubluepy_scan_entry_obj_t * self = (ubluepy_scan_entry_obj_t *)o;
  38. (void)self;
  39. mp_printf(print, "ScanEntry");
  40. }
  41. /// \method addr()
  42. /// Return address as text string.
  43. ///
  44. STATIC mp_obj_t scan_entry_get_addr(mp_obj_t self_in) {
  45. ubluepy_scan_entry_obj_t *self = MP_OBJ_TO_PTR(self_in);
  46. return self->addr;
  47. }
  48. STATIC MP_DEFINE_CONST_FUN_OBJ_1(bluepy_scan_entry_get_addr_obj, scan_entry_get_addr);
  49. /// \method addr_type()
  50. /// Return address type value.
  51. ///
  52. STATIC mp_obj_t scan_entry_get_addr_type(mp_obj_t self_in) {
  53. ubluepy_scan_entry_obj_t *self = MP_OBJ_TO_PTR(self_in);
  54. return mp_obj_new_int(self->addr_type);
  55. }
  56. STATIC MP_DEFINE_CONST_FUN_OBJ_1(bluepy_scan_entry_get_addr_type_obj, scan_entry_get_addr_type);
  57. /// \method rssi()
  58. /// Return RSSI value.
  59. ///
  60. STATIC mp_obj_t scan_entry_get_rssi(mp_obj_t self_in) {
  61. ubluepy_scan_entry_obj_t *self = MP_OBJ_TO_PTR(self_in);
  62. return mp_obj_new_int(self->rssi);
  63. }
  64. STATIC MP_DEFINE_CONST_FUN_OBJ_1(bluepy_scan_entry_get_rssi_obj, scan_entry_get_rssi);
  65. /// \method getScanData()
  66. /// Return list of the scan data tupples (ad_type, description, value)
  67. ///
  68. STATIC mp_obj_t scan_entry_get_scan_data(mp_obj_t self_in) {
  69. ubluepy_scan_entry_obj_t * self = MP_OBJ_TO_PTR(self_in);
  70. mp_obj_t retval_list = mp_obj_new_list(0, NULL);
  71. // TODO: check if self->data is set
  72. mp_obj_array_t * data = MP_OBJ_TO_PTR(self->data);
  73. uint16_t byte_index = 0;
  74. while (byte_index < data->len) {
  75. mp_obj_tuple_t *t = MP_OBJ_TO_PTR(mp_obj_new_tuple(3, NULL));
  76. uint8_t adv_item_len = ((uint8_t * )data->items)[byte_index];
  77. uint8_t adv_item_type = ((uint8_t * )data->items)[byte_index + 1];
  78. mp_obj_t description = mp_const_none;
  79. mp_map_t *constant_map = mp_obj_dict_get_map(ubluepy_constants_ad_types_type.locals_dict);
  80. mp_map_elem_t *ad_types_table = MP_OBJ_TO_PTR(constant_map->table);
  81. uint16_t num_of_elements = constant_map->used;
  82. for (uint16_t i = 0; i < num_of_elements; i++) {
  83. mp_map_elem_t element = (mp_map_elem_t)*ad_types_table;
  84. ad_types_table++;
  85. uint16_t element_value = mp_obj_get_int(element.value);
  86. if (adv_item_type == element_value) {
  87. qstr key_qstr = MP_OBJ_QSTR_VALUE(element.key);
  88. const char * text = qstr_str(key_qstr);
  89. size_t len = qstr_len(key_qstr);
  90. vstr_t vstr;
  91. vstr_init(&vstr, len);
  92. vstr_printf(&vstr, "%s", text);
  93. description = mp_obj_new_str(vstr.buf, vstr.len);
  94. vstr_clear(&vstr);
  95. }
  96. }
  97. t->items[0] = MP_OBJ_NEW_SMALL_INT(adv_item_type);
  98. t->items[1] = description;
  99. t->items[2] = mp_obj_new_bytearray(adv_item_len - 1,
  100. &((uint8_t * )data->items)[byte_index + 2]);
  101. mp_obj_list_append(retval_list, MP_OBJ_FROM_PTR(t));
  102. byte_index += adv_item_len + 1;
  103. }
  104. return retval_list;
  105. }
  106. STATIC MP_DEFINE_CONST_FUN_OBJ_1(ubluepy_scan_entry_get_scan_data_obj, scan_entry_get_scan_data);
  107. STATIC const mp_rom_map_elem_t ubluepy_scan_entry_locals_dict_table[] = {
  108. { MP_ROM_QSTR(MP_QSTR_addr), MP_ROM_PTR(&bluepy_scan_entry_get_addr_obj) },
  109. { MP_ROM_QSTR(MP_QSTR_addr_type), MP_ROM_PTR(&bluepy_scan_entry_get_addr_type_obj) },
  110. { MP_ROM_QSTR(MP_QSTR_rssi), MP_ROM_PTR(&bluepy_scan_entry_get_rssi_obj) },
  111. { MP_ROM_QSTR(MP_QSTR_getScanData), MP_ROM_PTR(&ubluepy_scan_entry_get_scan_data_obj) },
  112. };
  113. STATIC MP_DEFINE_CONST_DICT(ubluepy_scan_entry_locals_dict, ubluepy_scan_entry_locals_dict_table);
  114. const mp_obj_type_t ubluepy_scan_entry_type = {
  115. { &mp_type_type },
  116. .name = MP_QSTR_ScanEntry,
  117. .print = ubluepy_scan_entry_print,
  118. .locals_dict = (mp_obj_dict_t*)&ubluepy_scan_entry_locals_dict
  119. };
  120. #endif // MICROPY_PY_UBLUEPY_CENTRAL