I'm communicating with a temperature sensor using I2C/TWI and I'm now trying to send that received data over BLE using the HTS service.
When I send a ble_hts_meas_t with dummy data straight away (without any communication to the temp sensor), using my < sendTemperature() > method, it works fine with no issues.
However, when I try and use data received from the temp sensor communication, using the < requestTemperatureReading() > method, or even using the dummy data but still running the I2C transfer, the application breaks without any error codes and then when I stop the debugger it says "Stopped by vector catch" in the debug terminal.
At the moment when I try and use real data I start the communication to the sensor in one the BLE event handlers, then I try and send the data from the TWIM event handler when the "Transfer Complete" event is triggered.
I understand that this could be a timing issue with the SoftDevice not enjoying waiting on the TWIM transfer but I have no idea how to begin fixing this as I am new to using the SoftDevices.
I am using SDK v15, Segger Embedded Studio and SoftDevice s132.
#include <stdio.h>
#include <time.h>
#include <stdint.h>
#include <string.h>
#include "boards.h"
#include "app_util_platform.h"
#include "app_error.h"
#include "nrfx_twim.h"
#include "nrf_delay.h"
#include "nrfx_log.h"
#include "nrf_log.h"
#include "nrf_log_ctrl.h"
#include "nrf_log_default_backends.h"
#include "nrfx_clock.h"
#include "nrfx_rtc.h"
#include "app_timer.h"
#include "nordic_common.h"
#include "nrf.h"
#include "ble.h"
#include "ble_err.h"
#include "ble_hci.h"
#include "ble_srv_common.h"
#include "ble_advdata.h"
#include "ble_advertising.h"
#include "ble_bas.h"
#include "ble_hts.h"
#include "ble_dis.h"
#include "ble_conn_params.h"
#include "nrf_sdh.h"
#include "nrf_sdh_soc.h"
#include "nrf_sdh_ble.h"
#include "peer_manager.h"
#include "bsp_btn_ble.h"
#include "fds.h"
#include "ble_conn_state.h"
#include "nrf_ble_gatt.h"
#include "nrf_ble_qwr.h"
#include "nrf_pwr_mgmt.h"
#define COMPARE_COUNTERTIME (20UL) //10 second constant to compare to
/* ================================= BLE STUFF ================================= */
#define DEVICE_NAME "BLE Thermometer"
#define MANUFACTURER_NAME "Metix Medical"
#define MODEL_NUM "PROTO_1"
#define MANUFACTURER_ID 0x1234
#define ORG_UNIQUE_ID 0x4321
#define APP_BLE_OBSERVER_PRIO 3
#define APP_BLE_CONN_CFG_TAG 1
#define APP_ADV_INTERVAL 40 /**< The advertising interval (in units of 0.625 ms. This value corresponds to 25 ms). */
#define APP_ADV_DURATION 18000 /**< The advertising duration (180 seconds) in units of 10 milliseconds. */
#define TEMP_TYPE_AS_CHARACTERISTIC 0 /**< Determines if temperature type is given as characteristic (1) or as a field of measurement (0). */
#define MIN_CONN_INTERVAL MSEC_TO_UNITS(500, UNIT_1_25_MS) /**< Minimum acceptable connection interval (0.5 seconds) */
#define MAX_CONN_INTERVAL MSEC_TO_UNITS(1000, UNIT_1_25_MS) /**< Maximum acceptable connection interval (1 second). */
#define SLAVE_LATENCY 0 /**< Slave latency. */
#define CONN_SUP_TIMEOUT MSEC_TO_UNITS(4000, UNIT_10_MS) /**< Connection supervisory timeout (4 seconds). */
#define FIRST_CONN_PARAMS_UPDATE_DELAY APP_TIMER_TICKS(5000) /**< Time from initiating event (connect or start of indication) to first time sd_ble_gap_conn_param_update is called (5 seconds). */
#define NEXT_CONN_PARAMS_UPDATE_DELAY APP_TIMER_TICKS(30000) /**< Time between each call to sd_ble_gap_conn_param_update after the first call (30 seconds). */
#define MAX_CONN_PARAMS_UPDATE_COUNT 3 /**< Number of attempts before giving up the connection parameter negotiation. */
#define SEC_PARAM_BOND 1 /**< Perform bonding. */
#define SEC_PARAM_MITM 0 /**< Man In The Middle protection not required. */
#define SEC_PARAM_LESC 0 /**< LE Secure Connections not enabled. */
#define SEC_PARAM_KEYPRESS 0 /**< Keypress notifications not enabled. */
#define SEC_PARAM_IO_CAPABILITIES BLE_GAP_IO_CAPS_NONE /**< No I/O capabilities. */
#define SEC_PARAM_OOB 0 /**< Out Of Band data not available. */
#define SEC_PARAM_MIN_KEY_SIZE 7 /**< Minimum encryption key size. */
#define SEC_PARAM_MAX_KEY_SIZE 16 /**< Maximum encryption key size. */
#define DEAD_BEEF 0xDEADBEEF /**< Value used as error code on stack dump, can be used to identify stack location on stack unwind. */
/* ============================================================================== */
/* ================================= I2C STUFF ================================= */
#define TWIM_INSTANCE_ID 0 /**< TWI instance ID. */
#define SLAVE_ADDR 0x5B /**< Default address of MLX90615. */
#define WRITE_BUF_SIZE 1
#define READ_BUF_SIZE 3
/* ============================================================================== */
BLE_HTS_DEF(m_hts); /**< Structure used to identify the health thermometer service. */
NRF_BLE_GATT_DEF(m_gatt); /**< GATT module instance. */
NRF_BLE_QWR_DEF(m_qwr); /**< Context for the Queued Write module.*/
BLE_ADVERTISING_DEF(m_advertising); /**< Advertising module instance. */
static uint16_t m_conn_handle = BLE_CONN_HANDLE_INVALID; /**< Handle of the current connection. */
static bool m_hts_meas_ind_conf_pending = false; /**< Flag to keep track of when an indication confirmation is pending. */
static ble_uuid_t m_adv_uuids[] = /**< Universally unique service identifiers. */
{
{BLE_UUID_HEALTH_THERMOMETER_SERVICE, BLE_UUID_TYPE_BLE},
{BLE_UUID_DEVICE_INFORMATION_SERVICE, BLE_UUID_TYPE_BLE}
};
volatile uint8_t readBuf[3];
/* RTC instance */
const nrfx_rtc_t rtc = NRFX_RTC_INSTANCE(0); /**< Declaring an instance of nrf_drv_rtc for RTC0. */
/* TWI instance. */
static const nrfx_twim_t twimInstance = NRFX_TWIM_INSTANCE(TWIM_INSTANCE_ID);
static void advertising_start(bool erase_bonds);
static void sendTemperature(void);
static void requestTemperatureReading(void);
/**@brief Callback function for asserts in the SoftDevice.
*
* @details This function will be called in case of an assert in the SoftDevice.
*
* @warning This handler is an example only and does not fit a final product. You need to analyze
* how your product is supposed to react in case of Assert.
* @warning On assert from the SoftDevice, the system can only recover on reset.
*
* @param[in] line_num Line number of the failing ASSERT call.
* @param[in] file_name File name of the failing ASSERT call.
*/
void assert_nrf_callback(uint16_t line_num, const uint8_t * p_file_name)
{
app_error_handler(DEAD_BEEF, line_num, p_file_name);
}
/**@brief Function for handling Peer Manager events.
*
* @param[in] p_evt Peer Manager event.
*/
static void pm_evt_handler(pm_evt_t const * p_evt)
{
ret_code_t err_code;
bool is_indication_enabled;
switch (p_evt->evt_id)
{
case PM_EVT_BONDED_PEER_CONNECTED:
{
NRF_LOG_INFO("Connected to a previously bonded device.");
} break;
case PM_EVT_CONN_SEC_SUCCEEDED:
{
NRF_LOG_INFO("Connection secured: role: %d, conn_handle: 0x%x, procedure: %d.",
ble_conn_state_role(p_evt->conn_handle),
p_evt->conn_handle,
p_evt->params.conn_sec_succeeded.procedure);
// Send a single temperature measurement if indication is enabled.
// NOTE: For this to work, make sure ble_hts_on_ble_evt() is called before
// pm_evt_handler() in ble_evt_dispatch().
err_code = ble_hts_is_indication_enabled(&m_hts, &is_indication_enabled);
APP_ERROR_CHECK(err_code);
if (is_indication_enabled)
{
NRF_LOG_INFO("Sending reading from peer handler");
requestTemperatureReading();
}
} break;
case PM_EVT_CONN_SEC_FAILED:
{
/* Often, when securing fails, it shouldn't be restarted, for security reasons.
* Other times, it can be restarted directly.
* Sometimes it can be restarted, but only after changing some Security Parameters.
* Sometimes, it cannot be restarted until the link is disconnected and reconnected.
* Sometimes it is impossible, to secure the link, or the peer device does not support it.
* How to handle this error is highly application dependent. */
} break;
case PM_EVT_CONN_SEC_CONFIG_REQ:
{
// Reject pairing request from an already bonded peer.
pm_conn_sec_config_t conn_sec_config = {.allow_repairing = false};
pm_conn_sec_config_reply(p_evt->conn_handle, &conn_sec_config);
} break;
case PM_EVT_STORAGE_FULL:
{
// Run garbage collection on the flash.
err_code = fds_gc();
if (err_code == FDS_ERR_NO_SPACE_IN_QUEUES)
{
// Retry.
}
else
{
APP_ERROR_CHECK(err_code);
}
} break;
case PM_EVT_PEERS_DELETE_SUCCEEDED:
{
advertising_start(false);
} break;
case PM_EVT_PEER_DATA_UPDATE_FAILED:
{
// Assert.
APP_ERROR_CHECK(p_evt->params.peer_data_update_failed.error);
} break;
case PM_EVT_PEER_DELETE_FAILED:
{
// Assert.
APP_ERROR_CHECK(p_evt->params.peer_delete_failed.error);
} break;
case PM_EVT_PEERS_DELETE_FAILED:
{
// Assert.
APP_ERROR_CHECK(p_evt->params.peers_delete_failed_evt.error);
} break;
case PM_EVT_ERROR_UNEXPECTED:
{
// Assert.
APP_ERROR_CHECK(p_evt->params.error_unexpected.error);
} break;
case PM_EVT_CONN_SEC_START:
case PM_EVT_PEER_DATA_UPDATE_SUCCEEDED:
case PM_EVT_PEER_DELETE_SUCCEEDED:
case PM_EVT_LOCAL_DB_CACHE_APPLIED:
case PM_EVT_LOCAL_DB_CACHE_APPLY_FAILED:
// This can happen when the local DB has changed.
case PM_EVT_SERVICE_CHANGED_IND_SENT:
case PM_EVT_SERVICE_CHANGED_IND_CONFIRMED:
default:
break;
}
}
/**@brief Function for the GAP initialization.
*
* @details This function sets up all the necessary GAP (Generic Access Profile) parameters of the
* device including the device name, appearance, and the preferred connection parameters.
*/
static void gap_params_init(void)
{
ret_code_t err_code;
ble_gap_conn_params_t gap_conn_params;
ble_gap_conn_sec_mode_t sec_mode;
BLE_GAP_CONN_SEC_MODE_SET_OPEN(&sec_mode);
err_code = sd_ble_gap_device_name_set(&sec_mode,
(const uint8_t *)DEVICE_NAME,
strlen(DEVICE_NAME));
APP_ERROR_CHECK(err_code);
err_code = sd_ble_gap_appearance_set(BLE_APPEARANCE_GENERIC_THERMOMETER);
APP_ERROR_CHECK(err_code);
memset(&gap_conn_params, 0, sizeof(gap_conn_params));
gap_conn_params.min_conn_interval = MIN_CONN_INTERVAL;
gap_conn_params.max_conn_interval = MAX_CONN_INTERVAL;
gap_conn_params.slave_latency = SLAVE_LATENCY;
gap_conn_params.conn_sup_timeout = CONN_SUP_TIMEOUT;
err_code = sd_ble_gap_ppcp_set(&gap_conn_params);
APP_ERROR_CHECK(err_code);
}
/**@brief Function for initializing the GATT module.
*/
static void gatt_init(void)
{
ret_code_t err_code = nrf_ble_gatt_init(&m_gatt, NULL);
APP_ERROR_CHECK(err_code);
}
static void convertToHTSMeasurement(uint8_t tempCelcius, ble_hts_meas_t * p_tempMeasurement)
{
static ble_date_time_t time_stamp = { 2012, 12, 5, 11, 50, 0 };
p_tempMeasurement->temp_in_fahr_units = false;
p_tempMeasurement->time_stamp_present = false;
p_tempMeasurement->temp_type_present = (TEMP_TYPE_AS_CHARACTERISTIC ? false : true);
//.temp_in_celcius = {.exponent = -2, .mantissa = tempCelcius*100},
//.temp_in_fahr = {.exponent = -2, .mantissa = (32 * 100) + ((tempCelcius*100 * 9) / 5)},
p_tempMeasurement->temp_in_celcius.exponent = -2;
p_tempMeasurement->temp_in_celcius.mantissa = tempCelcius;
p_tempMeasurement->temp_in_fahr.exponent = -2;
p_tempMeasurement->temp_in_fahr.mantissa = 3200 + ((tempCelcius * 9) / 5);
p_tempMeasurement->time_stamp = time_stamp;
p_tempMeasurement->temp_type = BLE_HTS_TEMP_TYPE_BODY;
}
/**@brief Function for simulating and sending one Temperature Measurement.
*/
static void sendTemperature(void)
{
ret_code_t err_code;
ble_hts_meas_t tempMeasurement;
static ble_date_time_t time_stamp = { 2012, 12, 5, 11, 50, 0 };
tempMeasurement.temp_in_fahr_units = false;
tempMeasurement.time_stamp_present = false;
tempMeasurement.temp_type_present = (TEMP_TYPE_AS_CHARACTERISTIC ? false : true);
tempMeasurement.temp_in_celcius.exponent = -2;
tempMeasurement.temp_in_celcius.mantissa = 2000;
tempMeasurement.temp_in_fahr.exponent = -2;
tempMeasurement.temp_in_fahr.mantissa = 3200 + ((2000 * 9) / 5);
tempMeasurement.time_stamp = time_stamp;
tempMeasurement.temp_type = BLE_HTS_TEMP_TYPE_BODY;
if (!m_hts_meas_ind_conf_pending)
{
//convertToHTSMeasurement(tempCelcius, &tempMeasurement);
NRF_LOG_INFO("Sending temperature measurement...");
err_code = ble_hts_measurement_send(&m_hts, &tempMeasurement);
switch (err_code)
{
case NRF_SUCCESS:
// Measurement was successfully sent, wait for confirmation.
m_hts_meas_ind_conf_pending = true;
NRF_LOG_INFO("Measurement successfully sent!");
break;
case NRF_ERROR_INVALID_STATE:
// Ignore error.
NRF_LOG_INFO("Invalid state");
break;
default:
NRF_LOG_INFO("Something has went and goofed!");
APP_ERROR_HANDLER(err_code);
break;
}
}
}
static void requestTemperatureReading()
{
NRF_LOG_INFO("Taking temperature...");
uint8_t command[1] = {0x27};
nrfx_twim_xfer_desc_t transferType = NRFX_TWIM_XFER_DESC_TXRX(SLAVE_ADDR, command, WRITE_BUF_SIZE, readBuf, READ_BUF_SIZE);
nrfx_err_t err_code;
err_code = nrfx_twim_xfer(&twimInstance, &transferType, 0);
NRF_LOG_INFO("Xfer error code: %s", NRF_LOG_ERROR_STRING_GET(err_code));
APP_ERROR_CHECK(err_code);
}
uint16_t getTempReading(uint8_t *reading)
{
NRF_LOG_INFO("Handling data...");
uint8_t dataLow = reading[0];
uint8_t dataHigh = reading[1];
uint16_t fullData = (dataHigh<<8) | (dataLow);
uint16_t temperature = fullData * 2 - 27315;
NRF_LOG_INFO("Temperature reading is " NRF_LOG_FLOAT_MARKER " degrees Celcius",NRF_LOG_FLOAT(temperature/100));
return temperature;
}
/** @brief: Function for handling the RTC0 interrupts.
* Triggered on COMPARE0 match.
*/
static void rtc_handler(nrfx_rtc_int_type_t int_type)
{
if (int_type == NRFX_RTC_INT_COMPARE0)
{
NRF_LOG_INFO("Timer finished!");
requestTemperatureReading();
NRF_LOG_INFO("Done! Resetting timer...");
nrfx_rtc_counter_clear(&rtc);
nrfx_rtc_int_enable(&rtc, NRF_RTC_INT_COMPARE0_MASK);
NRF_LOG_INFO("Timer reset!");
}
else
{
NRF_LOG_INFO("Something weird happened...");
}
}
static void clock_event_handler(nrfx_clock_evt_type_t event)
{
if (event == NRFX_CLOCK_EVT_LFCLK_STARTED) {
NRF_LOG_INFO("Low frequency clock started");
}
else {
NRF_LOG_INFO("Some other clock event happened?");
}
}
/**
* @brief TWIM events handler.
*/
void twim_handler(nrfx_twim_evt_t const * p_event, void * p_context)
{
switch (p_event->type)
{
case NRFX_TWIM_EVT_DONE:
NRF_LOG_INFO("Transfer complete!");
sendTemperature();
break;
case NRFX_TWIM_EVT_ADDRESS_NACK:
NRF_LOG_INFO("Received NACK after sending address!");
break;
case NRFX_TWIM_EVT_DATA_NACK:
NRF_LOG_INFO("Received NACK after sending data.");
break;
default:
break;
}
}
//========== CONFIG/INIT FUNCTIONS ==============
/** @brief Function starting the internal LFCLK XTAL oscillator.
*/
static void lfclk_config(void)
{
nrfx_err_t err_code = nrfx_clock_init(clock_event_handler);
APP_ERROR_CHECK(err_code);
nrfx_clock_lfclk_start();
}
/** @brief Function initialization and configuration of RTC driver instance.
*/
static void rtc_config(void)
{
nrfx_err_t err_code;
//Initialize RTC instance
nrfx_rtc_config_t config = NRFX_RTC_DEFAULT_CONFIG;
config.prescaler = 4095;
err_code = nrfx_rtc_init(&rtc, &config, rtc_handler);
APP_ERROR_CHECK(err_code);
//Enable tick event & interrupt
nrfx_rtc_tick_disable(&rtc);
//Set compare channel to trigger interrupt after COMPARE_COUNTERTIME seconds
err_code = nrfx_rtc_cc_set(&rtc,0,COMPARE_COUNTERTIME * 8,true);
APP_ERROR_CHECK(err_code);
//Power on RTC instance
nrfx_rtc_enable(&rtc);
}
/**
* @brief UART initialization.
*/
void twim_init (void)
{
ret_code_t err_code;
const nrfx_twim_config_t twimConfig = {
.scl = ARDUINO_SCL_PIN,
.sda = ARDUINO_SDA_PIN,
.frequency = NRF_TWIM_FREQ_100K,
.interrupt_priority = APP_IRQ_PRIORITY_HIGH,
.hold_bus_uninit = true
};
err_code = nrfx_twim_init(&twimInstance, &twimConfig, twim_handler, NULL);
APP_ERROR_CHECK(err_code);
nrfx_twim_enable(&twimInstance);
}
static void log_init(void)
{
ret_code_t err_code = NRF_LOG_INIT(NULL);
APP_ERROR_CHECK(err_code);
NRF_LOG_DEFAULT_BACKENDS_INIT();
}
/**@brief Function for handling the Health Thermometer Service events.
*
* @details This function will be called for all Health Thermometer Service events which are passed
* to the application.
*
* @param[in] p_hts Health Thermometer Service structure.
* @param[in] p_evt Event received from the Health Thermometer Service.
*/
static void on_hts_evt(ble_hts_t * p_hts, ble_hts_evt_t * p_evt)
{
switch (p_evt->evt_type)
{
case BLE_HTS_EVT_INDICATION_ENABLED:
// Indication has been enabled, send a single temperature measurement
NRF_LOG_INFO("Indication has been enabled");
requestTemperatureReading();
break;
case BLE_HTS_EVT_INDICATION_CONFIRMED:
NRF_LOG_INFO("Indication has been confirmed");
m_hts_meas_ind_conf_pending = false;
break;
default:
// No implementation needed.
NRF_LOG_INFO("Something goofed in on_hts_evt")
break;
}
}
/**@brief Function for handling Queued Write Module errors.
*
* @details A pointer to this function will be passed to each service which may need to inform the
* application about an error.
*
* @param[in] nrf_error Error code containing information about what went wrong.
*/
static void nrf_qwr_error_handler(uint32_t nrf_error)
{
APP_ERROR_HANDLER(nrf_error);
}
/**@brief Function for initializing services that will be used by the application.
*
* @details Initialize the Health Thermometer, Battery and Device Information services.
*/
static void services_init(void)
{
ret_code_t err_code;
ble_hts_init_t hts_init;
ble_dis_init_t dis_init;
nrf_ble_qwr_init_t qwr_init = {0};
ble_dis_sys_id_t sys_id;
// Initialize Queued Write Module.
qwr_init.error_handler = nrf_qwr_error_handler;
err_code = nrf_ble_qwr_init(&m_qwr, &qwr_init);
APP_ERROR_CHECK(err_code);
// Initialize Health Thermometer Service
memset(&hts_init, 0, sizeof(hts_init));
hts_init.evt_handler = on_hts_evt;
hts_init.temp_type_as_characteristic = TEMP_TYPE_AS_CHARACTERISTIC;
hts_init.temp_type = BLE_HTS_TEMP_TYPE_BODY;
// Here the sec level for the Health Thermometer Service can be changed/increased.
BLE_GAP_CONN_SEC_MODE_SET_ENC_NO_MITM(&hts_init.hts_meas_attr_md.cccd_write_perm);
BLE_GAP_CONN_SEC_MODE_SET_NO_ACCESS(&hts_init.hts_meas_attr_md.read_perm);
BLE_GAP_CONN_SEC_MODE_SET_NO_ACCESS(&hts_init.hts_meas_attr_md.write_perm);
BLE_GAP_CONN_SEC_MODE_SET_OPEN(&hts_init.hts_temp_type_attr_md.read_perm);
BLE_GAP_CONN_SEC_MODE_SET_NO_ACCESS(&hts_init.hts_temp_type_attr_md.write_perm);
err_code = ble_hts_init(&m_hts, &hts_init);
APP_ERROR_CHECK(err_code);
// Initialize Device Information Service.
memset(&dis_init, 0, sizeof(dis_init));
ble_srv_ascii_to_utf8(&dis_init.manufact_name_str, MANUFACTURER_NAME);
ble_srv_ascii_to_utf8(&dis_init.model_num_str, MODEL_NUM);
sys_id.manufacturer_id = MANUFACTURER_ID;
sys_id.organizationally_unique_id = ORG_UNIQUE_ID;
dis_init.p_sys_id = &sys_id;
BLE_GAP_CONN_SEC_MODE_SET_OPEN(&dis_init.dis_attr_md.read_perm);
BLE_GAP_CONN_SEC_MODE_SET_NO_ACCESS(&dis_init.dis_attr_md.write_perm);
err_code = ble_dis_init(&dis_init);
APP_ERROR_CHECK(err_code);
}
/**@brief Function for handling the Connection Parameters Module.
*
* @details This function will be called for all events in the Connection Parameters Module which
* are passed to the application.
* @note All this function does is to disconnect. This could have been done by simply
* setting the disconnect_on_fail config parameter, but instead we use the event
* handler mechanism to demonstrate its use.
*
* @param[in] p_evt Event received from the Connection Parameters Module.
*/
static void on_conn_params_evt(ble_conn_params_evt_t * p_evt)
{
ret_code_t err_code;
if (p_evt->evt_type == BLE_CONN_PARAMS_EVT_FAILED)
{
err_code = sd_ble_gap_disconnect(m_conn_handle, BLE_HCI_CONN_INTERVAL_UNACCEPTABLE);
APP_ERROR_CHECK(err_code);
}
}
/**@brief Function for handling a Connection Parameters error.
*
* @param[in] nrf_error Error code containing information about what went wrong.
*/
static void conn_params_error_handler(uint32_t nrf_error)
{
APP_ERROR_HANDLER(nrf_error);
}
/**@brief Function for initializing the Connection Parameters module.
*/
static void conn_params_init(void)
{
ret_code_t err_code;
ble_conn_params_init_t cp_init;
memset(&cp_init, 0, sizeof(cp_init));
cp_init.p_conn_params = NULL;
cp_init.first_conn_params_update_delay = FIRST_CONN_PARAMS_UPDATE_DELAY;
cp_init.next_conn_params_update_delay = NEXT_CONN_PARAMS_UPDATE_DELAY;
cp_init.max_conn_params_update_count = MAX_CONN_PARAMS_UPDATE_COUNT;
cp_init.start_on_notify_cccd_handle = BLE_GATT_HANDLE_INVALID;
cp_init.disconnect_on_fail = false;
cp_init.evt_handler = on_conn_params_evt;
cp_init.error_handler = conn_params_error_handler;
err_code = ble_conn_params_init(&cp_init);
APP_ERROR_CHECK(err_code);
}
/**@brief Function for handling advertising events.
*
* @details This function will be called for advertising events which are passed to the application.
*
* @param[in] ble_adv_evt Advertising event.
*/
static void on_adv_evt(ble_adv_evt_t ble_adv_evt)
{
ret_code_t err_code;
switch (ble_adv_evt)
{
case BLE_ADV_EVT_FAST:
NRF_LOG_INFO("Fast advertising.");
err_code = bsp_indication_set(BSP_INDICATE_ADVERTISING);
APP_ERROR_CHECK(err_code);
break;
case BLE_ADV_EVT_IDLE:
//sleep_mode_enter();
break;
default:
break;
}
}
/**@brief Function for handling BLE events.
*
* @param[in] p_ble_evt Bluetooth stack event.
* @param[in] p_context Unused.
*/
static void ble_evt_handler(ble_evt_t const * p_ble_evt, void * p_context)
{
uint32_t err_code = NRF_SUCCESS;
switch (p_ble_evt->header.evt_id)
{
case BLE_GAP_EVT_CONNECTED:
NRF_LOG_INFO("Connected.");
err_code = bsp_indication_set(BSP_INDICATE_CONNECTED);
APP_ERROR_CHECK(err_code);
m_conn_handle = p_ble_evt->evt.gap_evt.conn_handle;
err_code = nrf_ble_qwr_conn_handle_assign(&m_qwr, m_conn_handle);
APP_ERROR_CHECK(err_code);
break;
case BLE_GAP_EVT_DISCONNECTED:
NRF_LOG_INFO("Disconnected.");
m_conn_handle = BLE_CONN_HANDLE_INVALID;
m_hts_meas_ind_conf_pending = false;
break;
case BLE_GAP_EVT_PHY_UPDATE_REQUEST:
{
NRF_LOG_DEBUG("PHY update request.");
ble_gap_phys_t const phys =
{
.rx_phys = BLE_GAP_PHY_AUTO,
.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_GATTC_EVT_TIMEOUT:
// Disconnect on GATT Client timeout event.
NRF_LOG_DEBUG("GATT Client Timeout.");
err_code = sd_ble_gap_disconnect(p_ble_evt->evt.gattc_evt.conn_handle,
BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION);
APP_ERROR_CHECK(err_code);
break;
case BLE_GATTS_EVT_TIMEOUT:
// Disconnect on GATT Server timeout event.
NRF_LOG_DEBUG("GATT Server Timeout.");
err_code = sd_ble_gap_disconnect(p_ble_evt->evt.gatts_evt.conn_handle,
BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION);
APP_ERROR_CHECK(err_code);
break;
default:
// No implementation needed.
break;
}
}
/**@brief Function for initializing the BLE stack.
*
* @details Initializes the SoftDevice and the BLE event interrupt.
*/
static void ble_stack_init(void)
{
ret_code_t err_code;
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.
uint32_t ram_start = 0;
err_code = nrf_sdh_ble_default_cfg_set(APP_BLE_CONN_CFG_TAG, &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, ble_evt_handler, NULL);
}
/**@brief Function for handling events from the BSP module.
*
* @param[in] event Event generated by button press.
*/
static void bsp_event_handler(bsp_event_t event)
{
ret_code_t err_code;
switch (event)
{
case BSP_EVENT_SLEEP:
NRF_LOG_INFO("Sleep mode should be here")
break;
case BSP_EVENT_DISCONNECT:
err_code = sd_ble_gap_disconnect(m_conn_handle,
BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION);
if (err_code != NRF_ERROR_INVALID_STATE)
{
APP_ERROR_CHECK(err_code);
}
break;
case BSP_EVENT_WHITELIST_OFF:
if (m_conn_handle == BLE_CONN_HANDLE_INVALID)
{
err_code = ble_advertising_restart_without_whitelist(&m_advertising);
if (err_code != NRF_ERROR_INVALID_STATE)
{
APP_ERROR_CHECK(err_code);
}
}
break;
case BSP_EVENT_KEY_0:
if (m_conn_handle != BLE_CONN_HANDLE_INVALID)
{
NRF_LOG_INFO("BSP_EVENT_KEY_0");
requestTemperatureReading();
}
break;
default:
break;
}
}
/**@brief Function for the Peer Manager initialization.
*/
static void peer_manager_init(void)
{
ble_gap_sec_params_t sec_param;
ret_code_t err_code;
err_code = pm_init();
APP_ERROR_CHECK(err_code);
memset(&sec_param, 0, sizeof(ble_gap_sec_params_t));
// Security parameters to be used for all security procedures.
sec_param.bond = SEC_PARAM_BOND;
sec_param.mitm = SEC_PARAM_MITM;
sec_param.lesc = SEC_PARAM_LESC;
sec_param.keypress = SEC_PARAM_KEYPRESS;
sec_param.io_caps = SEC_PARAM_IO_CAPABILITIES;
sec_param.oob = SEC_PARAM_OOB;
sec_param.min_key_size = SEC_PARAM_MIN_KEY_SIZE;
sec_param.max_key_size = SEC_PARAM_MAX_KEY_SIZE;
sec_param.kdist_own.enc = 1;
sec_param.kdist_own.id = 1;
sec_param.kdist_peer.enc = 1;
sec_param.kdist_peer.id = 1;
err_code = pm_sec_params_set(&sec_param);
APP_ERROR_CHECK(err_code);
err_code = pm_register(pm_evt_handler);
APP_ERROR_CHECK(err_code);
}
/**@brief Clear bond information from persistent storage.
*/
static void delete_bonds(void)
{
ret_code_t err_code;
NRF_LOG_INFO("Erase bonds!");
err_code = pm_peers_delete();
APP_ERROR_CHECK(err_code);
}
/**@brief Function for initializing the Advertising functionality.
*
* @details Encodes the required advertising data and passes it to the stack.
* Also builds a structure to be passed to the stack when starting advertising.
*/
static void advertising_init(void)
{
ret_code_t err_code;
ble_advertising_init_t init;
memset(&init, 0, sizeof(init));
init.advdata.name_type = BLE_ADVDATA_FULL_NAME;
init.advdata.include_appearance = true;
init.advdata.flags = BLE_GAP_ADV_FLAGS_LE_ONLY_GENERAL_DISC_MODE;
init.advdata.uuids_complete.uuid_cnt = sizeof(m_adv_uuids) / sizeof(m_adv_uuids[0]);
init.advdata.uuids_complete.p_uuids = m_adv_uuids;
init.config.ble_adv_fast_enabled = true;
init.config.ble_adv_fast_interval = APP_ADV_INTERVAL;
init.config.ble_adv_fast_timeout = APP_ADV_DURATION;
init.evt_handler = on_adv_evt;
err_code = ble_advertising_init(&m_advertising, &init);
APP_ERROR_CHECK(err_code);
ble_advertising_conn_cfg_tag_set(&m_advertising, APP_BLE_CONN_CFG_TAG);
}
/**@brief Function for starting advertising.
*/
static void advertising_start(bool erase_bonds)
{
if (erase_bonds == true)
{
delete_bonds();
// Advertising is started by PM_EVT_PEERS_DELETE_SUCCEEDED event.
}
else
{
uint32_t err_code = ble_advertising_start(&m_advertising, BLE_ADV_MODE_FAST);
APP_ERROR_CHECK(err_code);
}
}
/**@brief Function for initializing buttons and leds.
*
* @param[out] p_erase_bonds Will be true if the clear bonding button was pressed to wake the application up.
*/
static void buttons_leds_init(bool * p_erase_bonds)
{
ret_code_t err_code;
bsp_event_t startup_event;
err_code = bsp_init(BSP_INIT_LEDS | BSP_INIT_BUTTONS, bsp_event_handler);
APP_ERROR_CHECK(err_code);
err_code = bsp_btn_ble_init(NULL, &startup_event);
APP_ERROR_CHECK(err_code);
*p_erase_bonds = (startup_event == BSP_EVENT_CLEAR_BONDING_DATA);
}
/**@brief Function for initializing power management.
*/
static void power_management_init(void)
{
ret_code_t err_code;
err_code = nrf_pwr_mgmt_init();
APP_ERROR_CHECK(err_code);
}
/**@brief Function for handling the idle state (main loop).
*
* @details If there is no pending log operation, then sleep until next the next event occurs.
*/
static void idle_state_handle(void)
{
if (NRF_LOG_PROCESS() == false)
{
nrf_pwr_mgmt_run();
}
}
/**
* @brief Function for main application entry.
*/
int main(void)
{
bool erase_bonds;
log_init();
twim_init();
//lfclk_config();
//rtc_config();
app_timer_init();
buttons_leds_init(&erase_bonds);
power_management_init();
ble_stack_init();
gap_params_init();
gatt_init();
advertising_init();
services_init();
conn_params_init();
peer_manager_init();
// Start execution.
advertising_start(erase_bonds);
//requestTemperatureReading();
// Enter main loop.
for (;;)
{
idle_state_handle();
}
}
/** @} */
