djsundog/circuitpython
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

nrf5/sdk: Implementing simple event handler for bluetooth stack driver.

Browse Source
This commit is contained in:
Glenn Ruben Bakke 2017-02-13 00:18:47 +01:00
parent 7a43228a2d
commit a79c5ca7ab
1 changed files with 44 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

44
nrf5/sdk/softdevice.c
View File

@ -35,6 +35,7 @@
#include "ble_gap.h"
#include "ble.h" // sd_ble_uuid_encode
#define SD_TEST_OR_ENABLE() \
if (sd_enabled() == 0) { \
(void)sd_enable(); \
@ -440,3 +441,46 @@ bool sd_advertise_data(ubluepy_advertise_data_t * p_adv_params) {
return true;
}
static void ble_evt_handler(ble_evt_t * p_ble_evt) {
switch (p_ble_evt->header.evt_id) {
case BLE_GAP_EVT_CONNECTED:
printf(">>> GAP CONNECT\n");
break;
case BLE_GAP_EVT_DISCONNECTED:
printf(">>> GAP DISCONNECT\n");
break;
case BLE_GATTS_EVT_WRITE:
printf(">>> GATTS write\n");
break;
default:
printf(">>> unhandled evt: 0x" HEX2_FMT, p_ble_evt->header.evt_id);
break;
}
}
static uint8_t m_ble_evt_buf[sizeof(ble_evt_t) + (GATT_MTU_SIZE_DEFAULT)] __attribute__ ((aligned (4)));
#ifdef NRF51
void SWI2_IRQHandler(void) {
#else
void SWI2_EGU2_IRQHandler(void) {
#endif
printf("SWI2 IRQ\n");
uint32_t evt_id;
uint32_t err_code;
do {
err_code = sd_evt_get(&evt_id);
// TODO: handle non ble events
} while (err_code != NRF_ERROR_NOT_FOUND && err_code != NRF_SUCCESS);
uint16_t evt_len = sizeof(m_ble_evt_buf);
do {
err_code = sd_ble_evt_get(m_ble_evt_buf, &evt_len);
ble_evt_handler((ble_evt_t *)m_ble_evt_buf);
} while (err_code != NRF_ERROR_NOT_FOUND && err_code != NRF_SUCCESS);
}