b80325604d
1. add bluedroid 1st version 2. alarm adapter 3. task semaphore lock 4. other bugs resolved
107 lines
2.9 KiB
C
Executable file
107 lines
2.9 KiB
C
Executable file
/******************************************************************************
|
|
*
|
|
* Copyright (C) 2014 Google, Inc.
|
|
*
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
* you may not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at:
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*
|
|
******************************************************************************/
|
|
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include "bt_trace.h"
|
|
#include "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) {
|
|
// Every 3rd char must be ':'.
|
|
if (((i + 1) % 3) == 0 && string[i] != ':')
|
|
return false;
|
|
|
|
// All other chars must be a hex digit.
|
|
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;
|
|
bool ret = sscanf(string, "%02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx",
|
|
&ptr[0], &ptr[1], &ptr[2], &ptr[3], &ptr[4], &ptr[5]) == 6;
|
|
|
|
if (ret)
|
|
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;
|
|
}
|