/*
 * Licensed to the Apache Software Foundation (ASF) under one
 * or more contributor license agreements.  See the NOTICE file
 * distributed with this work for additional information
 * regarding copyright ownership.  The ASF licenses this file
 * to you 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 "os/mynewt.h"
#include "bsp/bsp.h"
#include "hal/hal_gpio.h"
#include "host/ble_gap.h"
#include "bleprph.h"

#if MYNEWT_VAL(BLEPRPH_LE_PHY_SUPPORT)

static const int button_gpio[4] = MYNEWT_VAL(BLEPRPH_LE_PHY_BUTTON_GPIO);
static const int led_gpio[3] = MYNEWT_VAL(BLEPRPH_LE_PHY_LED_GPIO);

#define PHY_TO_PTR(_mask, _opts) (void *)(((_opts) << 16) | ((_mask)))
#define PTR_TO_PHY_MASK(_ptr) (uint8_t)(((int)_ptr) & 0x0ff)
#define PTR_TO_PHY_OPTS(_ptr) (uint8_t)(((int)_ptr) >> 16)

static struct os_event gpio_event;

static uint16_t conn_handle = CONN_HANDLE_INVALID;

static void
gpio_irq_handler(void *arg)
{
    gpio_event.ev_arg = arg;
    os_eventq_put(os_eventq_dflt_get(), &gpio_event);
}

static void
gpio_event_handler(struct os_event *ev)
{
    uint8_t phy_mask;
    uint8_t phy_opts;
    int sr;

    OS_ENTER_CRITICAL(sr);
    phy_mask = PTR_TO_PHY_MASK(ev->ev_arg);
    phy_opts = PTR_TO_PHY_OPTS(ev->ev_arg);
    OS_EXIT_CRITICAL(sr);

    if (conn_handle != CONN_HANDLE_INVALID) {
        ble_gap_set_prefered_le_phy(conn_handle, phy_mask, phy_mask, phy_opts);
    }
}

static void
setup_button_gpio(int button, uint8_t phy_mask, uint8_t phy_opts)
{
    if (button < 0) {
        return;
    }

    hal_gpio_irq_init(button, gpio_irq_handler, PHY_TO_PTR(phy_mask, phy_opts),
                      HAL_GPIO_TRIG_FALLING, HAL_GPIO_PULL_UP);
    hal_gpio_irq_enable(button);
}

void
phy_init(void)
{
    gpio_event.ev_cb = gpio_event_handler;

    /*
     * XXX: we could make this configurable, but for now assume all pins are
     * valid, buttons gpio pins are pulled-up and LEDs are active-low - this
     * is valid for nRF52840 PDK.
     */
    setup_button_gpio(button_gpio[0], BLE_GAP_LE_PHY_1M_MASK,
                      BLE_GAP_LE_PHY_CODED_ANY);
    setup_button_gpio(button_gpio[1], BLE_GAP_LE_PHY_2M_MASK,
                      BLE_GAP_LE_PHY_CODED_ANY);
    setup_button_gpio(button_gpio[2], BLE_GAP_LE_PHY_CODED_MASK,
                      BLE_GAP_LE_PHY_CODED_S2);
    setup_button_gpio(button_gpio[3], BLE_GAP_LE_PHY_CODED_MASK,
                      BLE_GAP_LE_PHY_CODED_S8);

    hal_gpio_init_out(led_gpio[0], 1);
    hal_gpio_init_out(led_gpio[1], 1);
    hal_gpio_init_out(led_gpio[2], 1);
}

void
phy_conn_changed(uint16_t handle)
{
    uint8_t phy = 0;

    conn_handle = handle;

    if (handle != CONN_HANDLE_INVALID) {
        /* XXX: assume symmetric phy for now */
        ble_gap_read_le_phy(handle, &phy, &phy);
    }

    phy_update(phy);
}

void
phy_update(uint8_t phy)
{
    if (conn_handle == CONN_HANDLE_INVALID) {
        hal_gpio_write(led_gpio[0], 1);
        hal_gpio_write(led_gpio[1], 1);
        hal_gpio_write(led_gpio[2], 1);
    } else {
        hal_gpio_write(led_gpio[0], !(phy == BLE_GAP_LE_PHY_1M));
        hal_gpio_write(led_gpio[1], !(phy == BLE_GAP_LE_PHY_2M));
        hal_gpio_write(led_gpio[2], !(phy == BLE_GAP_LE_PHY_CODED));
    }
}

#endif