1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
34
35
42
43
50
51
58
59
60
61
62
63
64
67
68
69
70
71
72
73
74
75
76
77
78
79
80
83
84
95
96
97
98
99
100
101
102
103
104
105
106
107
108
114
115
116
117
118
/* ... */
#include <stdio.h>
#include <string.h>
#include "common/bt_trace.h"
#include "device/bdaddr.h"
static inline bool ets_isxdigit(char c)
{
if ((c >= '0') && (c <= '9')) {
return true;
}{...}
if ((c >= 'a') && (c <= 'f')) {
return true;
}{...}
return ((c >= 'A') && (c <= 'F'));
}{ ... }
bool bdaddr_is_empty(const bt_bdaddr_t *addr)
{
assert(addr != NULL);
uint8_t zero[sizeof(bt_bdaddr_t)] = { 0 };
return memcmp(addr, &zero, sizeof(bt_bdaddr_t)) == 0;
}{ ... }
bool bdaddr_equals(const bt_bdaddr_t *first, const bt_bdaddr_t *second)
{
assert(first != NULL);
assert(second != NULL);
return memcmp(first, second, sizeof(bt_bdaddr_t)) == 0;
}{ ... }
bt_bdaddr_t *bdaddr_copy(bt_bdaddr_t *dest, const bt_bdaddr_t *src)
{
assert(dest != NULL);
assert(src != NULL);
return (bt_bdaddr_t *)memcpy(dest, src, sizeof(bt_bdaddr_t));
}{ ... }
const char *bdaddr_to_string(const bt_bdaddr_t *addr, char *string, size_t size)
{
assert(addr != NULL);
assert(string != NULL);
if (size < 18) {
return NULL;
}{...}
const uint8_t *ptr = addr->address;
sprintf(string, "%02x:%02x:%02x:%02x:%02x:%02x",
ptr[0], ptr[1], ptr[2],
ptr[3], ptr[4], ptr[5]);
return string;
}{ ... }
bool string_is_bdaddr(const char *string)
{
assert(string != NULL);
size_t len = strlen(string);
if (len != 17) {
return false;
}{...}
for (size_t i = 0; i < len; ++i) {
if (((i + 1) % 3) == 0 && string[i] != ':') {
return false;
}{...}
if (((i + 1) % 3) != 0 && !ets_isxdigit(string[i])) {
return false;
}{...}
}{...}
return true;
}{ ... }
bool string_to_bdaddr(const char *string, bt_bdaddr_t *addr)
{
assert(string != NULL);
assert(addr != NULL);
bt_bdaddr_t new_addr;
uint8_t *ptr = new_addr.address;
uint32_t ptr_32[6];
bool ret = sscanf(string, "%02x:%02x:%02x:%02x:%02x:%02x",
&ptr_32[0], &ptr_32[1], &ptr_32[2], &ptr_32[3], &ptr_32[4], &ptr_32[5]) == 6;
if (ret) {
for (uint8_t i = 0; i < 6; i++){
ptr[i] = (uint8_t) ptr_32[i];
}{...}
memcpy(addr, &new_addr, sizeof(bt_bdaddr_t));
}{...}
return ret;
}{ ... }
hash_index_t hash_function_bdaddr(const void *key)
{
hash_index_t hash = 5381;
const char *bytes = (const char *)key;
for (size_t i = 0; i < sizeof(bt_bdaddr_t); ++i) {
hash = ((hash << 5) + hash) + bytes[i];
}{...}
return hash;
}{ ... }