/*
 * Copyright (C) 2020 Freie Universität Berlin
 *
 * This file is subject to the terms and conditions of the GNU Lesser
 * General Public License v2.1. See the file LICENSE in the top level
 * directory for more details.
 */

/**
 * @ingroup     sys_shell_commands
 * @{
 *
 * @file
 * @brief       Shell commands to control the NimBLE netif statconn connection
 *              manager
 *
 * @author      Hauke Petersen <hauke.petersen@fu-berlin.de>
 *
 * @}
 */

#include <stdio.h>

#include "net/bluetil/addr.h"
#include "nimble_statconn.h"

int _nimble_statconn_handler(int argc, char **argv)
{
    if ((argc < 3)) {
        printf("usage: %s <addm|adds|rm> <BLE addr>\n", argv[0]);
        return 0;
    }

    /* parse address */
    uint8_t addr[BLE_ADDR_LEN];
    if (bluetil_addr_from_str(addr, argv[2]) == NULL) {
        puts("err: unable to parse BLE address");
        return 1;
    }

    if (strncmp(argv[1], "addm", 4) == 0) {
        if (nimble_statconn_add_master(addr) == NIMBLE_STATCONN_OK) {
            puts("success: connecting to peer as slave");
        }
        else {
            puts("err: unable to add peer");
        }
    }
    else if (strncmp(argv[1], "adds", 4) == 0) {
        if (nimble_statconn_add_slave(addr) == NIMBLE_STATCONN_OK) {
            puts("success: connecting to peer as master");
        }
        else {
            puts("err: unable to add peer");
        }
    }
    else if (strncmp(argv[1], "rm", 2) == 0) {
        if (nimble_statconn_rm(addr) == NIMBLE_STATCONN_OK) {
            puts("success: closed connection to peer");
        }
        else {
            puts("err: unable to remove peer");
        }
    }
    else {
        puts("err: unable to parse command");
        return 1;
    }

    return 0;
}