/* keys_br.c - Bluetooth BR/EDR key handling */

/*
 * Copyright (c) 2015-2016 Intel Corporation
 *
 * SPDX-License-Identifier: Apache-2.0
 */

#include <zephyr.h>
#include <string.h>
#include <atomic.h>
#include <util.h>

#include <bluetooth.h>
#include <conn.h>
#include <hci_host.h>
#include <settings.h>

#define BT_DBG_ENABLED  IS_ENABLED(CONFIG_BT_DEBUG_KEYS)
#define LOG_MODULE_NAME bt_keys_br
#include "log.h"

#include "hci_core.h"
#include "settings.h"
#include "keys.h"

static struct bt_keys_link_key key_pool[CONFIG_BT_MAX_PAIRED];

#if IS_ENABLED(CONFIG_BT_KEYS_OVERWRITE_OLDEST)
static uint32_t aging_counter_val;
static struct bt_keys_link_key *last_keys_updated;
#endif /* CONFIG_BT_KEYS_OVERWRITE_OLDEST */

struct bt_keys_link_key *bt_keys_find_link_key(const bt_addr_t *addr)
{
    struct bt_keys_link_key *key;
    int i;

    BT_DBG("%s", bt_addr_str(addr));

    for (i = 0; i < ARRAY_SIZE(key_pool); i++) {
        key = &key_pool[i];

        if (!bt_addr_cmp(&key->addr, addr)) {
            return key;
        }
    }

    return NULL;
}

struct bt_keys_link_key *bt_keys_get_link_key(const bt_addr_t *addr)
{
    struct bt_keys_link_key *key;

    key = bt_keys_find_link_key(addr);
    if (key) {
        return key;
    }

    key = bt_keys_find_link_key(BT_ADDR_ANY);
#if 0 //IS_ENABLED(CONFIG_BT_KEYS_OVERWRITE_OLDEST) //MBHJ
	if (!key) {
		int i;

		key = &key_pool[0];
		for (i = 1; i < ARRAY_SIZE(key_pool); i++) {
			struct bt_keys_link_key *current = &key_pool[i];

			if (current->aging_counter < key->aging_counter) {
				key = current;
			}
		}

		if (key) {
			bt_keys_link_key_clear(key);
		}
	}
#endif

    if (key) {
        bt_addr_copy(&key->addr, addr);
#if 0 //IS_ENABLED(CONFIG_BT_KEYS_OVERWRITE_OLDEST) //MBHJ
		key->aging_counter = ++aging_counter_val;
		last_keys_updated = key;
#endif
        BT_DBG("created %p for %s", key, bt_addr_str(addr));
        return key;
    }

    BT_DBG("unable to create keys for %s", bt_addr_str(addr));

    return NULL;
}

void bt_keys_link_key_clear(struct bt_keys_link_key *link_key)
{
    if (IS_ENABLED(CONFIG_BT_SETTINGS)) {
        char key[BT_SETTINGS_KEY_MAX];
        bt_addr_le_t le_addr;

        le_addr.type = BT_ADDR_LE_PUBLIC;
        bt_addr_copy(&le_addr.a, &link_key->addr);
        bt_settings_encode_key(key, sizeof(key), "link_key",
                               &le_addr, NULL);
        settings_delete(key);
    }

    BT_DBG("%s", bt_addr_str(&link_key->addr));
    (void)memset(link_key, 0, sizeof(*link_key));
}

void bt_keys_link_key_clear_addr(const bt_addr_t *addr)
{
    int i;
    struct bt_keys_link_key *key;

    if (!addr) {
        for (i = 0; i < ARRAY_SIZE(key_pool); i++) {
            key = &key_pool[i];
            bt_keys_link_key_clear(key);
        }
        return;
    }

    key = bt_keys_find_link_key(addr);
    if (key) {
        bt_keys_link_key_clear(key);
    }
}

void bt_keys_link_key_store(struct bt_keys_link_key *link_key)
{
#if 0 //MBHJ
	if (IS_ENABLED(CONFIG_BT_SETTINGS)) {
		int err;
		char key[BT_SETTINGS_KEY_MAX];
		bt_addr_le_t le_addr;

		le_addr.type = BT_ADDR_LE_PUBLIC;
		bt_addr_copy(&le_addr.a, &link_key->addr);
		bt_settings_encode_key(key, sizeof(key), "link_key",
				       &le_addr, NULL);

		err = settings_save_one(key, link_key->storage_start,
					BT_KEYS_LINK_KEY_STORAGE_LEN);
		if (err) {
			BT_ERR("Failed to svae link key (err %d)", err);
		}
	}
#endif
}

#if defined(CONFIG_BT_SETTINGS)

static int link_key_set(const char *name, size_t len_rd,
                        settings_read_cb read_cb, void *cb_arg)
{
    int err;
    ssize_t len;
    bt_addr_le_t le_addr;
    struct bt_keys_link_key *link_key;
    char val[BT_KEYS_LINK_KEY_STORAGE_LEN];

    if (!name) {
        BT_ERR("Insufficient number of arguments");
        return -EINVAL;
    }

    len = read_cb(cb_arg, val, sizeof(val));
    if (len < 0) {
        BT_ERR("Failed to read value (err %zu)", len);
        return -EINVAL;
    }

    BT_DBG("name %s val %s", log_strdup(name),
           len ? bt_hex(val, sizeof(val)) : "(null)");

    err = bt_settings_decode_key(name, &le_addr);
    if (err) {
        BT_ERR("Unable to decode address %s", name);
        return -EINVAL;
    }

    link_key = bt_keys_get_link_key(&le_addr.a);
    if (len != BT_KEYS_LINK_KEY_STORAGE_LEN) {
        if (link_key) {
            bt_keys_link_key_clear(link_key);
            BT_DBG("Clear keys for %s", bt_addr_le_str(&le_addr));
        } else {
            BT_WARN("Unable to find deleted keys for %s",
                    bt_addr_le_str(&le_addr));
        }

        return 0;
    }

    memcpy(link_key->storage_start, val, len);
    BT_DBG("Successfully restored link key for %s",
           bt_addr_le_str(&le_addr));
#if IS_ENABLED(CONFIG_BT_KEYS_OVERWRITE_OLDEST)
    if (aging_counter_val < link_key->aging_counter) {
        aging_counter_val = link_key->aging_counter;
    }
#endif /* CONFIG_BT_KEYS_OVERWRITE_OLDEST */

    return 0;
}

static int link_key_commit(void)
{
    return 0;
}

SETTINGS_STATIC_HANDLER_DEFINE(bt_link_key, "bt/link_key", NULL, link_key_set,
                               link_key_commit, NULL);

void bt_keys_link_key_update_usage(const bt_addr_t *addr)
{
    struct bt_keys_link_key *link_key = bt_keys_find_link_key(addr);

    if (!link_key) {
        return;
    }

    if (last_keys_updated == link_key) {
        return;
    }

    link_key->aging_counter = ++aging_counter_val;
    last_keys_updated = link_key;

    BT_DBG("Aging counter for %s is set to %u", bt_addr_str(addr),
           link_key->aging_counter);

    if (IS_ENABLED(CONFIG_BT_KEYS_SAVE_AGING_COUNTER_ON_PAIRING)) {
        bt_keys_link_key_store(link_key);
    }
}

#endif