/******************************************************************************
 *
 *  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 <assert.h>
#include <ctype.h>
#include <stdio.h>
#include <string.h>

#include "btcore/include/bdaddr.h"
#include "wm_bt_def.h"

uint8_t bdaddr_is_empty(const tls_bt_addr_t *addr)
{
    assert(addr != NULL);
    uint8_t zero[sizeof(tls_bt_addr_t)] = { 0 };
    return memcmp(addr, &zero, sizeof(tls_bt_addr_t)) == 0;
}

uint8_t bdaddr_equals(const tls_bt_addr_t *first, const tls_bt_addr_t *second)
{
    assert(first != NULL);
    assert(second != NULL);
    return memcmp(first, second, sizeof(tls_bt_addr_t)) == 0;
}

tls_bt_addr_t *bdaddr_copy(tls_bt_addr_t *dest, const tls_bt_addr_t *src)
{
    assert(dest != NULL);
    assert(src != NULL);
    return (tls_bt_addr_t *)wm_memcpy(dest, src, sizeof(tls_bt_addr_t));
}

const char *bdaddr_to_string(const tls_bt_addr_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;
}
const char *bd_to_string(const uint8_t *addr, char *string, size_t size)
{
    assert(addr != NULL);
    assert(string != NULL);

    if(size < 18)
    {
        return NULL;
    }

    const uint8_t *ptr = addr;
    sprintf(string, "%02x:%02x:%02x:%02x:%02x:%02x",
            ptr[0], ptr[1], ptr[2],
            ptr[3], ptr[4], ptr[5]);
    return string;
}


uint8_t 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 && !isxdigit(string[i]))
        {
            return false;
        }
    }

    return true;
}

uint8_t string_to_bdaddr(const char *string, tls_bt_addr_t *addr)
{
    assert(string != NULL);
    assert(addr != NULL);
    tls_bt_addr_t new_addr;
    uint8_t *ptr = new_addr.address;
    uint8_t 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(tls_bt_addr_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(tls_bt_addr_t); ++i)
    {
        hash = ((hash << 5) + hash) + bytes[i];
    }

    return hash;
}
