Roy_01
149 lines
4.5 KiB
C
149 lines
4.5 KiB
C
#include <stdbool.h>
|
|
#include <stdint.h>
|
|
|
|
#ifdef __cplusplus
|
|
extern "C"
|
|
{
|
|
#endif
|
|
|
|
#include "app_config.h"
|
|
#include "elite_board.h"
|
|
#include "sdk_config.h"
|
|
|
|
#include "nrf_log.h"
|
|
#include "nrf_log_ctrl.h"
|
|
#include "nrf_log_default_backends.h"
|
|
#include "nrf_sdh.h"
|
|
#include "nrf_sdh_ble.h"
|
|
#include "nrf_sdh_freertos.h"
|
|
|
|
#ifdef __cplusplus
|
|
}
|
|
#endif
|
|
|
|
#define APP_BLE_CONN_CFG_TAG 1 /**< A tag identifying the SoftDevice BLE configuration. */
|
|
#define APP_BLE_OBSERVER_PRIO 3 /**< Application's BLE observer priority. You shouldn't need to modify this value. */
|
|
|
|
static void le_evt_handler(ble_evt_t const *p_ble_evt, void *p_context)
|
|
{
|
|
ret_code_t err_code;
|
|
switch (p_ble_evt->header.evt_id)
|
|
{
|
|
case BLE_GAP_EVT_PHY_UPDATE:
|
|
NRF_LOG_INFO("PHY update procedure is complete.");
|
|
break;
|
|
case BLE_GAP_EVT_CONN_PARAM_UPDATE:
|
|
NRF_LOG_INFO("Connection parameters updated.");
|
|
break;
|
|
case BLE_GAP_EVT_CONNECTED:
|
|
NRF_LOG_INFO("Connect to peer.");
|
|
err_code = sd_ble_gap_tx_power_set(BLE_GAP_TX_POWER_ROLE_CONN, p_ble_evt->evt.gap_evt.conn_handle, 8);
|
|
APP_ERROR_CHECK(err_code);
|
|
led_set(LED_IDEL_CONNECTED);
|
|
break;
|
|
case BLE_GAP_EVT_DISCONNECTED:
|
|
NRF_LOG_INFO("Disconnect from peer.");
|
|
err_code = sd_ble_gap_tx_power_set(BLE_GAP_TX_POWER_ROLE_ADV, p_ble_evt->evt.gap_evt.conn_handle, 0);
|
|
APP_ERROR_CHECK(err_code);
|
|
led_set(LED_IDEL_DISCONNECT);
|
|
break;
|
|
case BLE_GAP_EVT_PHY_UPDATE_REQUEST: {
|
|
NRF_LOG_INFO("PHY update response. (AUTO)");
|
|
ble_gap_phys_t const phys = {
|
|
.rx_phys = BLE_GAP_PHY_AUTO, // adv&connection: 1M PHY, After connection: mobile-2M, PC-1M
|
|
.tx_phys = BLE_GAP_PHY_AUTO,
|
|
};
|
|
err_code = sd_ble_gap_phy_update(p_ble_evt->evt.gap_evt.conn_handle, &phys);
|
|
APP_ERROR_CHECK(err_code);
|
|
}
|
|
break;
|
|
case BLE_GATTS_EVT_SYS_ATTR_MISSING: {
|
|
ret_code_t err_code = sd_ble_gatts_sys_attr_set(p_ble_evt->evt.gatts_evt.conn_handle, NULL, 0, 0);
|
|
APP_ERROR_CHECK(err_code);
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void le_stack_Init(void)
|
|
{
|
|
ret_code_t err_code;
|
|
uint32_t ram_start = 0;
|
|
ble_cfg_t ble_cfg;
|
|
memset(&ble_cfg, 0x00, sizeof(ble_cfg));
|
|
ble_cfg.conn_cfg.conn_cfg_tag = APP_BLE_CONN_CFG_TAG;
|
|
ble_cfg.conn_cfg.params.gatts_conn_cfg.hvn_tx_queue_size = 12;
|
|
|
|
err_code = nrf_sdh_enable_request();
|
|
APP_ERROR_CHECK(err_code);
|
|
|
|
// Configure the BLE stack using the default settings.
|
|
// Fetch the start address of the application RAM.
|
|
err_code = nrf_sdh_ble_default_cfg_set(APP_BLE_CONN_CFG_TAG, &ram_start);
|
|
APP_ERROR_CHECK(err_code);
|
|
|
|
err_code = sd_ble_cfg_set(BLE_CONN_CFG_GATTS, &ble_cfg, ram_start);
|
|
APP_ERROR_CHECK(err_code);
|
|
|
|
// Enable BLE stack.
|
|
err_code = nrf_sdh_ble_enable(&ram_start);
|
|
APP_ERROR_CHECK(err_code);
|
|
|
|
// Register a handler for BLE events.
|
|
NRF_SDH_BLE_OBSERVER(m_ble_observer, APP_BLE_OBSERVER_PRIO, le_evt_handler, NULL);
|
|
}
|
|
|
|
static void nrf_sdh_freertos_task_hook(void *p_context)
|
|
{
|
|
UNUSED_PARAMETER(p_context);
|
|
|
|
elite_board_init();
|
|
|
|
#if DEF_ELITE_DEMO_WO_SOFTDEVICE
|
|
elite_board_demo();
|
|
for (;;)
|
|
{
|
|
}
|
|
#endif
|
|
|
|
elite_drv_init();
|
|
|
|
le_stack_Init(); // enable ble stack, but unscannable!! register "le_evt_handler" handle(CB)
|
|
|
|
extern void le_gap_init(const char *device_name, uint16_t usAppearance);
|
|
le_gap_init(ELITE_DEVICE_NAME, BLE_APPEARANCE_UNKNOWN); // set BT name & connection interval
|
|
|
|
extern void le_gatt_init(void);
|
|
le_gatt_init();
|
|
|
|
extern void le_srv_init(void);
|
|
le_srv_init(); // service
|
|
|
|
extern void le_adv_init(uint8_t ble_conn_cfg_tag);
|
|
le_adv_init(APP_BLE_CONN_CFG_TAG); // could be scanned
|
|
|
|
#if DEF_ELITE_DEMO_W_SOFTDEVICE
|
|
elite_board_demo();
|
|
#endif
|
|
}
|
|
|
|
int main(void)
|
|
{
|
|
NRF_LOG_INIT(NULL, 0);
|
|
NRF_LOG_DEFAULT_BACKENDS_INIT();
|
|
NRF_LOG_INFO("%s Build: %s %s", ELITE_DEVICE_NAME, __TIME__, __DATE__);
|
|
NRF_LOG_INFO("[Board] HW ver: %d.%d.%d.%d(%s)", MAJOR_PRODUCT_NUMBER, MINOR_PRODUCT_NUMBER, MAJOR_VERSION_NUMBER, MINOR_VERSION_NUMBER, ELITE_HW_NAME);
|
|
|
|
nrf_sdh_freertos_init(nrf_sdh_freertos_task_hook, NULL); // create event: softdevice_task - wireless protocal stack
|
|
|
|
vTaskStartScheduler();
|
|
|
|
for (;;)
|
|
{
|
|
// Will not get here unless there is insufficient RAM.
|
|
__BKPT(255);
|
|
}
|
|
}
|