cf2725e028
I am very tempted to drop all the ble advertisement abstraction and deal directly with the 31-byte raw payload.
125 lines
No EOL
3.8 KiB
C
125 lines
No EOL
3.8 KiB
C
#include "prst/ble.h"
|
|
|
|
#include <ble_advdata.h>
|
|
#include <ble_gap.h>
|
|
#include <nordic_common.h>
|
|
#include <nrf_log.h>
|
|
#include <nrf_sdh.h>
|
|
#include <nrf_sdh_ble.h>
|
|
|
|
#include "prst_config.h"
|
|
|
|
// We need to pick a service UUID for broadcasting our sensor data.
|
|
// 0x181a is defined as "environmental sensing", which seems appopriate.
|
|
#define SERVICE_UUID 0x181a
|
|
|
|
// The connection to configure. We only have the one.
|
|
#define PRST_CONN_CFG_TAG 1
|
|
|
|
#define NON_CONNECTABLE_ADV_INTERVAL MSEC_TO_UNITS(100, UNIT_0_625_MS)
|
|
|
|
// Sensor data payload that will go into the advertisement message.
|
|
#define SERVICE_DATA_LEN 8
|
|
static uint8_t service_data[SERVICE_DATA_LEN];
|
|
|
|
// Stores the encoded advertisement data. As per BLE spec, 31 bytes max.
|
|
static uint8_t encoded_adv_data_[BLE_GAP_ADV_SET_DATA_SIZE_MAX];
|
|
|
|
// Structure holding high level advertisement data and contains a pointer to
|
|
// the actual encoded advertised bytes.
|
|
static ble_gap_adv_data_t gap_adv_data_ = {
|
|
.adv_data = {.p_data = encoded_adv_data_,
|
|
.len = BLE_GAP_ADV_SET_DATA_SIZE_MAX},
|
|
.scan_rsp_data = {.p_data = NULL, .len = 0}};
|
|
|
|
// We'll put our sensor data inside an advertisement service.
|
|
static ble_advdata_service_data_t advdata_service_data_ = {
|
|
.service_uuid = SERVICE_UUID,
|
|
.data = {
|
|
.p_data = service_data,
|
|
.size = SERVICE_DATA_LEN,
|
|
}};
|
|
|
|
// Holds the service data to be broadcasted. The contents of this struct
|
|
// will be encoded into gap_adv_data.
|
|
// Warning: do not update this while advertising.
|
|
static ble_advdata_t adv_data_ = {
|
|
.name_type = BLE_ADVDATA_FULL_NAME,
|
|
.flags = BLE_GAP_ADV_FLAG_BR_EDR_NOT_SUPPORTED,
|
|
.p_service_data_array = &advdata_service_data_,
|
|
.service_data_count = 1,
|
|
};
|
|
|
|
// NRF supports multiple advertisement sets. This initialization is a request
|
|
// for configuring a new one.
|
|
static uint8_t adv_handle_ = BLE_GAP_ADV_SET_HANDLE_NOT_SET;
|
|
|
|
// Advertisement parameters.
|
|
static ble_gap_adv_params_t adv_params_;
|
|
|
|
static void init_advertisement_data() {
|
|
UNUSED_VARIABLE(adv_data_);
|
|
UNUSED_VARIABLE(advdata_service_data_);
|
|
|
|
// We'll just broadcast our data, so we disallow connections and scan
|
|
// requests.
|
|
adv_params_.properties.type =
|
|
BLE_GAP_ADV_TYPE_NONCONNECTABLE_NONSCANNABLE_UNDIRECTED;
|
|
|
|
// No particular peer - undirected advertisement.
|
|
adv_params_.p_peer_addr = NULL;
|
|
adv_params_.filter_policy = BLE_GAP_ADV_FP_ANY;
|
|
adv_params_.interval = NON_CONNECTABLE_ADV_INTERVAL;
|
|
adv_params_.duration = 0; // Never time out.
|
|
|
|
ble_gap_conn_sec_mode_t sec_mode;
|
|
BLE_GAP_CONN_SEC_MODE_SET_OPEN(&sec_mode);
|
|
sd_ble_gap_device_name_set(&sec_mode, (const uint8_t *)PRST_BLE_ADV_NAME,
|
|
strlen(PRST_BLE_ADV_NAME));
|
|
|
|
uint32_t err_code =
|
|
sd_ble_gap_adv_set_configure(&adv_handle_, &gap_adv_data_, &adv_params_);
|
|
APP_ERROR_CHECK(err_code);
|
|
}
|
|
|
|
void prst_ble_init() {
|
|
uint32_t err_code;
|
|
|
|
// Enable SoftDevice request.
|
|
err_code = nrf_sdh_enable_request();
|
|
APP_ERROR_CHECK(err_code);
|
|
|
|
// Set the default config and get the starting RAM address.
|
|
uint32_t ram_start = 0;
|
|
err_code = nrf_sdh_ble_default_cfg_set(PRST_CONN_CFG_TAG, &ram_start);
|
|
APP_ERROR_CHECK(err_code);
|
|
|
|
// Enable SoftDevice.
|
|
err_code = nrf_sdh_ble_enable(&ram_start);
|
|
APP_ERROR_CHECK(err_code);
|
|
|
|
init_advertisement_data();
|
|
}
|
|
|
|
void prst_ble_update_adv_data(uint8_t n) {
|
|
service_data[0] = n;
|
|
|
|
// Encodes adv_data_ into .gap_adv_data_.
|
|
uint32_t err_code = ble_advdata_encode(
|
|
&adv_data_, gap_adv_data_.adv_data.p_data, &gap_adv_data_.adv_data.len);
|
|
APP_ERROR_CHECK(err_code);
|
|
}
|
|
|
|
void prst_adv_start() {
|
|
ret_code_t err_code;
|
|
err_code = sd_ble_gap_adv_start(adv_handle_, PRST_CONN_CFG_TAG);
|
|
APP_ERROR_CHECK(err_code);
|
|
NRF_LOG_INFO("Advertising started.\n");
|
|
}
|
|
|
|
void prst_adv_stop() {
|
|
ret_code_t err_code;
|
|
err_code = sd_ble_gap_adv_stop(adv_handle_);
|
|
APP_ERROR_CHECK(err_code);
|
|
NRF_LOG_INFO("Advertising stopped.\n");
|
|
} |