/*
|
* 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
|
