Hi Everyone,
Last two weeks I'm trying to make a Real time streaming custom service on PCA10056 DK. I have modified the ble_image_transfer code according to my requirement.
The problem is
1. After Connect to nRFConnect ..its automatically disconnecting ...ERROR :GATT CONN TERMINATE LOCALHOST
2. As per my requirement it should stream to any BLE device..... will it be an any issue? .... or only Nordic dongle should be used in the receiver side ( for long term streaming).
Hi,
2. As per my requirement it should stream to any BLE device..... will it be an any issue? .... or only Nordic dongle should be used in the receiver side ( for long term streaming).
It should ideally act the same for every device that follows the BLE specification.
regards
Jared
Thanks for your Reply.
I have just removed all the functions which is related to Arducam_mini library. And I'm trying to send a hard code chunk to receiver instead of Image file.
Here is my code
main.c
#include <stdint.h>
#include <string.h>
#include "nordic_common.h"
#include "nrf.h"
#include "ble_hci.h"
#include "ble_advdata.h"
#include "ble_advertising.h"
#include "ble_conn_params.h"
#include "nrf_sdh.h"
#include "nrf_sdh_soc.h"
#include "nrf_sdh_ble.h"
#include "nrf_ble_gatt.h"
#include "nrf_ble_qwr.h"
#include "app_timer.h"
#include "ble_image_transfer_service.h"
#include "app_uart.h"
#include "app_util_platform.h"
#include "bsp_btn_ble.h"
#include "nrf_pwr_mgmt.h"
#if defined (UART_PRESENT)
#include "nrf_uart.h"
#endif
#if defined (UARTE_PRESENT)
#include "nrf_uarte.h"
#endif
//#include "ArducamMini2MP.h"
#include "nrf_delay.h"
#include "nrf_log.h"
#include "nrf_log_ctrl.h"
#include "nrf_log_default_backends.h"
#define PCA10056_USE_FRONT_HEADER 0 /**< Use the front header (P24) for the camera module. Requires SB10-15 and SB20-25 to be soldered/cut, as described in the readme. */
#define APP_BLE_CONN_CFG_TAG 1 /**< A tag identifying the SoftDevice BLE configuration. */
#define DEVICE_NAME "Camera Demo v2" /**< Name of device. Will be included in the advertising data. */
#define NUS_SERVICE_UUID_TYPE BLE_UUID_TYPE_VENDOR_BEGIN /**< UUID type for the Nordic UART Service (vendor specific). */
#define APP_BLE_OBSERVER_PRIO 3 /**< Application's BLE observer priority. You shouldn't need to modify this value. */
#define APP_ADV_INTERVAL 64 /**< The advertising interval (in units of 0.625 ms. This value corresponds to 40 ms). */
#define APP_ADV_DURATION 18000 /**< The advertising duration (180 seconds) in units of 10 milliseconds. */
#define MIN_CONN_INTERVAL MSEC_TO_UNITS(15, UNIT_1_25_MS) /**< Minimum acceptable connection interval (20 ms), Connection interval uses 1.25 ms units. */
#define MAX_CONN_INTERVAL MSEC_TO_UNITS(15, UNIT_1_25_MS) /**< Maximum acceptable connection interval (75 ms), Connection interval uses 1.25 ms units. */
#define SLAVE_LATENCY 0 /**< Slave latency. */
#define CONN_SUP_TIMEOUT MSEC_TO_UNITS(4000, UNIT_10_MS) /**< Connection supervisory timeout (4 seconds), Supervision Timeout uses 10 ms units. */
#define FIRST_CONN_PARAMS_UPDATE_DELAY APP_TIMER_TICKS(5000) /**< Time from initiating event (connect or start of notification) 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 DEAD_BEEF 0xDEADBEEF /**< Value used as error code on stack dump, can be used to identify stack location on stack unwind. */
#define UART_TX_BUF_SIZE 256 /**< UART TX buffer size. */
#define UART_RX_BUF_SIZE 256 /**< UART RX buffer size. */
BLE_ITS_DEF(m_its, NRF_SDH_BLE_TOTAL_LINK_COUNT); /**< BLE NUS service instance. */
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 uint8_t m_new_command_received = 0;
//static uint8_t m_new_resolution, m_new_phy;
//static arducam_mini_2mp_init_t m_camera_init;
static bool m_stream_mode_active = false;
static ble_its_ble_params_info_t m_ble_params_info = {20, 50, 1, 1};
static uint16_t m_conn_handle = BLE_CONN_HANDLE_INVALID; /**< Handle of the current connection. */
static uint16_t m_ble_its_max_data_len = BLE_GATT_ATT_MTU_DEFAULT - 3; /**< Maximum length of data (in bytes) that can be transmitted to the peer by the Nordic UART service module. */
static ble_uuid_t m_adv_uuids[] = /**< Universally unique service identifier. */
{
{BLE_UUID_ITS_SERVICE, NUS_SERVICE_UUID_TYPE}
};
enum {APP_CMD_NOCOMMAND = 0, APP_CMD_SINGLE_CAPTURE, APP_CMD_START_STREAM, APP_CMD_STOP_STREAM,
APP_CMD_CHANGE_RESOLUTION, APP_CMD_CHANGE_PHY, APP_CMD_SEND_BLE_PARAMS};
/**@brief Function for assert macro callback.
*
* @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 analyse
* 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] p_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 initializing the timer module.
*/
static void timers_init(void)
{
ret_code_t err_code = app_timer_init();
APP_ERROR_CHECK(err_code);
}
/**@brief Function for the GAP initialization.
*
* @details This function will set up all the necessary GAP (Generic Access Profile) parameters of
* the device. It also sets the permissions and appearance.
*/
static void gap_params_init(void)
{
uint32_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);
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);
#if 0
ble_gap_addr_t ble_address = {.addr_type = BLE_GAP_ADDR_TYPE_RANDOM_STATIC,
.addr_id_peer = 0,
.addr = {0xC3,0x11,0x99,0x33,0x44,0xFF}};
err_code = sd_ble_gap_addr_set(&ble_address);
APP_ERROR_CHECK(err_code);
#endif
}
/**@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 handling the data from the ITS Service.
*
* @details This function will process the data received from the ITS BLE Service.
*
* @param[in] p_its ITS Service structure.
* @param[in] p_data Data received.
* @param[in] length Length of the data.
*/
/**@snippet [Handling the data received over BLE] */
static void its_data_handler(ble_its_t * p_its, uint8_t const * p_data, uint16_t length)
{
/*switch(p_data[0])
{
// Take picture
case APP_CMD_SINGLE_CAPTURE:
case APP_CMD_SEND_BLE_PARAMS:
m_new_command_received = p_data[0];
break;
case APP_CMD_START_STREAM:
m_stream_mode_active = true;
m_new_command_received = p_data[0];
break;
case APP_CMD_STOP_STREAM:
m_stream_mode_active = false;
m_new_command_received = p_data[0];
break;
case APP_CMD_CHANGE_RESOLUTION:
m_new_command_received = APP_CMD_CHANGE_RESOLUTION;
m_new_resolution = p_data[1];
break;
case APP_CMD_CHANGE_PHY:
m_new_command_received = APP_CMD_CHANGE_PHY;
m_new_phy = p_data[1];
break;
default:
NRF_LOG_ERROR("Unknown command!!");
break;
}*/
}
/**@snippet [Handling the data received over BLE] */
/**@brief Function for initializing services that will be used by the application.
*/
static void services_init(void)
{
uint32_t err_code;
ble_its_init_t its_init;
nrf_ble_qwr_init_t qwr_init = {0};
// 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 ITS.
memset(&its_init, 0, sizeof(its_init));
its_init.data_handler = its_data_handler;
err_code = ble_its_init(&m_its, &its_init);
APP_ERROR_CHECK(err_code);
}
/**@brief Function for handling an event from 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)
{
switch(p_evt->evt_type)
{
case BLE_CONN_PARAMS_EVT_SUCCEEDED:
break;
case BLE_CONN_PARAMS_EVT_FAILED:
//err_code = sd_ble_gap_disconnect(m_conn_handle, BLE_HCI_CONN_INTERVAL_UNACCEPTABLE);
//APP_ERROR_CHECK(err_code);
NRF_LOG_ERROR("Conn params failed. Keep the connection anyway..");
break;
}
}
/**@brief Function for handling errors from the Connection Parameters module.
*
* @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)
{
uint32_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)
{
uint32_t err_code;
switch (ble_adv_evt)
{
case BLE_ADV_EVT_FAST:
err_code = bsp_indication_set(BSP_INDICATE_ADVERTISING);
APP_ERROR_CHECK(err_code);
break;
case BLE_ADV_EVT_IDLE:
NRF_LOG_INFO("BLE_ADV_EVT_IDLE...");
err_code = ble_advertising_start(&m_advertising, BLE_ADV_MODE_FAST);
APP_ERROR_CHECK(err_code);
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;
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);
ble_its_ble_params_info_send(&m_its, &m_ble_params_info);
break;
case BLE_GAP_EVT_DISCONNECTED:
NRF_LOG_INFO("Disconnected");
// LED indication will be changed when advertising starts.
m_stream_mode_active = false;
m_new_command_received = APP_CMD_CHANGE_RESOLUTION;
//m_new_resolution = 1;
m_conn_handle = BLE_CONN_HANDLE_INVALID;
NRF_LOG_INFO("disconnect reason %d", p_ble_evt->evt.gap_evt.params.disconnected.reason);
break;
case BLE_GAP_EVT_CONN_PARAM_UPDATE:
{
uint16_t max_con_int = p_ble_evt->evt.gap_evt.params.conn_param_update.conn_params.max_conn_interval;
uint16_t min_con_int = p_ble_evt->evt.gap_evt.params.conn_param_update.conn_params.min_conn_interval;
m_ble_params_info.con_interval = max_con_int;
ble_its_ble_params_info_send(&m_its, &m_ble_params_info);
NRF_LOG_INFO("Con params updated: CI %i, %i", (int)min_con_int, (int)max_con_int);
} break;
case BLE_GAP_EVT_PHY_UPDATE_REQUEST:
{
NRF_LOG_DEBUG("PHY update request.");
//ble_gap_phys_t const phys =
//{
// BLE_GAP_PHY_AUTO,
// 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_GAP_EVT_PHY_UPDATE:
m_ble_params_info.tx_phy = p_ble_evt->evt.gap_evt.params.phy_update.tx_phy;
m_ble_params_info.rx_phy = p_ble_evt->evt.gap_evt.params.phy_update.rx_phy;
ble_its_ble_params_info_send(&m_its, &m_ble_params_info);
//NRF_LOG_INFO("Phy update: %i, %i", (int)m_ble_params_info.tx_phy, (int)m_ble_params_info.rx_phy);
break;
case BLE_GAP_EVT_SEC_PARAMS_REQUEST:
// Pairing not supported
err_code = sd_ble_gap_sec_params_reply(m_conn_handle, BLE_GAP_SEC_STATUS_PAIRING_NOT_SUPP, NULL, NULL);
APP_ERROR_CHECK(err_code);
break;
case BLE_GATTS_EVT_SYS_ATTR_MISSING:
// No system attributes have been stored.
err_code = sd_ble_gatts_sys_attr_set(m_conn_handle, NULL, 0, 0);
APP_ERROR_CHECK(err_code);
break;
case BLE_GATTC_EVT_TIMEOUT:
NRF_LOG_INFO("GATT CLient time out");
// Disconnect on GATT Client timeout event.
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:
NRF_LOG_INFO("GATT Server time out");
// Disconnect on GATT Server timeout event.
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.
//NRF_LOG_INFO("BLE event not handled by app: %i", p_ble_evt->header.evt_id);
break;
}
}
/**@brief Function for the SoftDevice initialization.
*
* @details This function 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 GATT library. */
void gatt_evt_handler(nrf_ble_gatt_t * p_gatt, nrf_ble_gatt_evt_t const * p_evt)
{
uint32_t data_length;
if ((m_conn_handle == p_evt->conn_handle) && (p_evt->evt_id == NRF_BLE_GATT_EVT_ATT_MTU_UPDATED))
{
data_length = p_evt->params.att_mtu_effective - OPCODE_LENGTH - HANDLE_LENGTH;
//m_ble_params_info.mtu = m_ble_its_max_data_len;
NRF_LOG_INFO("gatt_event: ATT MTU is set to 0x%X (%d)", data_length, data_length);
}
else if ((m_conn_handle == p_evt->conn_handle) && (p_evt->evt_id == NRF_BLE_GATT_EVT_DATA_LENGTH_UPDATED))
{
data_length = p_evt->params.att_mtu_effective - OPCODE_LENGTH - HANDLE_LENGTH - 4;
m_ble_its_max_data_len = data_length;
m_ble_params_info.mtu = m_ble_its_max_data_len;
ble_its_ble_params_info_send(&m_its, &m_ble_params_info);
NRF_LOG_INFO("gatt_event: Data len is set to 0x%X (%d)", data_length, data_length);
}
//NRF_LOG_DEBUG("ATT MTU exchange completed. central 0x%x peripheral 0x%x",
// p_gatt->att_mtu_desired_central,
// p_gatt->att_mtu_desired_periph);
}
/**@brief Function for initializing the GATT library. */
void gatt_init(void)
{
ret_code_t err_code;
err_code = nrf_ble_gatt_init(&m_gatt, gatt_evt_handler);
APP_ERROR_CHECK(err_code);
err_code = nrf_ble_gatt_att_mtu_periph_set(&m_gatt, NRF_SDH_BLE_GATT_MAX_MTU_SIZE);
APP_ERROR_CHECK(err_code);
err_code = nrf_ble_gatt_data_length_set(&m_gatt, BLE_CONN_HANDLE_INVALID, NRF_SDH_BLE_GAP_DATA_LENGTH);
APP_ERROR_CHECK(err_code);
}
/**@brief Function for handling events from the BSP module.
*
* @param[in] event Event generated by button press.
*/
void bsp_event_handler(bsp_event_t event)
{
uint32_t err_code;
switch (event)
{
case BSP_EVENT_SLEEP:
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;
default:
break;
}
}
/**@brief Function for handling app_uart events.
*
* @details This function will receive a single character from the app_uart module and append it to
* a string. The string will be be sent over BLE when the last character received was a
* 'new line' '\n' (hex 0x0A) or if the string has reached the maximum data length.
*/
/**@snippet [Handling the data received over UART] */
void uart_event_handle(app_uart_evt_t * p_event)
{
}
/**@snippet [Handling the data received over UART] */
/**@brief Function for initializing the UART module.
*/
/**@snippet [UART Initialization] */
/*static void uart_init(void)
{
uint32_t err_code;
app_uart_comm_params_t const comm_params =
{
RX_PIN_NUMBER,
TX_PIN_NUMBER,
RTS_PIN_NUMBER,
CTS_PIN_NUMBER,
APP_UART_FLOW_CONTROL_DISABLED,
false,
#if defined (UART_PRESENT)
NRF_UART_BAUDRATE_115200
#else
NRF_UARTE_BAUDRATE_115200
#endif
};
APP_UART_FIFO_INIT(&comm_params,
UART_RX_BUF_SIZE,
UART_TX_BUF_SIZE,
uart_event_handle,
APP_IRQ_PRIORITY_LOWEST,
err_code);
APP_ERROR_CHECK(err_code);
}*/
/**@snippet [UART Initialization] */
/**@brief Function for initializing the Advertising functionality.
*/
static void advertising_init(void)
{
uint32_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 = false;
init.advdata.flags = BLE_GAP_ADV_FLAGS_LE_ONLY_LIMITED_DISC_MODE;
init.srdata.uuids_complete.uuid_cnt = sizeof(m_adv_uuids) / sizeof(m_adv_uuids[0]);
init.srdata.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 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(void)
{
bsp_event_t startup_event;
uint32_t 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);
}
/*static void camera_init(void)
{
#if defined(BOARD_PCA10056)
#if(PCA10056_USE_FRONT_HEADER == 1)
m_camera_init.pinScl = 13;
m_camera_init.pinSda = 15;
m_camera_init.pinSck = 21;
m_camera_init.pinMiso = 23;
m_camera_init.pinMosi = 25;
m_camera_init.pinCsn = 32 + 9;
#else
m_camera_init.pinScl = 27;
m_camera_init.pinSda = 26;
m_camera_init.pinSck = 32 + 15;
m_camera_init.pinMiso = 32 + 14;
m_camera_init.pinMosi = 32 + 13;
m_camera_init.pinCsn = 32 + 12;
#endif
#elif defined(BOARD_PCA10040)
m_camera_init.pinScl = 27;
m_camera_init.pinSda = 26;
m_camera_init.pinSck = 25;
m_camera_init.pinMiso = 24;
m_camera_init.pinMosi = 23;
m_camera_init.pinCsn = 22;
#else
#error Board not defined or not supported
#endif
arducam_mini_2mp_open(&m_camera_init);
arducam_mini_2mp_setResolution(OV2640_320x240);
}*/
/**@brief Function for initializing the nrf log module.
*/
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 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)
{
while(NRF_LOG_PROCESS());
sd_app_evt_wait();
}
/**@brief Function for starting advertising.
*/
static void advertising_start(void)
{
uint32_t err_code = ble_advertising_start(&m_advertising, BLE_ADV_MODE_FAST);
APP_ERROR_CHECK(err_code);
}
void conn_evt_len_ext_set(bool status)
{
ret_code_t err_code;
ble_opt_t opt;
memset(&opt, 0x00, sizeof(opt));
opt.common_opt.conn_evt_ext.enable = status ? 1 : 0;
err_code = sd_ble_opt_set(BLE_COMMON_OPT_CONN_EVT_EXT, &opt);
APP_ERROR_CHECK(err_code);
}
void data_len_set(uint8_t value)
{
ret_code_t err_code;
err_code = nrf_ble_gatt_data_length_set(&m_gatt, BLE_CONN_HANDLE_INVALID, value);
APP_ERROR_CHECK(err_code);
}
/**@brief Application main function.
*/
int main(void)
{
uint32_t img_data_length = 10;
uint8_t img_data_buffer[10];
// Initialize.
//uart_init();
log_init();
timers_init();
buttons_leds_init();
ble_stack_init();
gap_params_init();
gatt_init();
services_init();
advertising_init();
conn_params_init();
sd_power_dcdc_mode_set(NRF_POWER_DCDC_ENABLE);
// Start execution.
NRF_LOG_INFO("Debug logging for UART over RTT started.");
//camera_init();
advertising_start();
// Enter main loop.
for (;;)
{
memset(img_data_buffer, 10, img_data_length);
if(img_data_length > 0)
{
uint32_t ret_code;
do
{
if(img_data_length == 0)
{
img_data_length=10;
}
ret_code = ble_its_send_file_fragment(&m_its, img_data_buffer, img_data_length);
if(ret_code == NRF_SUCCESS)
{
img_data_length = 0;
}
}while(ret_code == NRF_SUCCESS);
}
idle_state_handle();
}
}
ble_image_transfer.c
#include <stdio.h>
#include "sdk_common.h"
//#if NRF_MODULE_ENABLED(BLE_NUS)
#include "ble_image_transfer_service.h"
#include "ble_srv_common.h"
#include "ble.h"
#include "nrf_gpio.h"
#define BLE_UUID_ITS_TX_CHARACTERISTIC 0x0003 /**< The UUID of the TX Characteristic. */
#define BLE_UUID_ITS_RX_CHARACTERISTIC 0x0002 /**< The UUID of the RX Characteristic. */
#define BLE_UUID_ITS_IMG_INFO_CHARACTERISTIC 0x0004
#define BLE_ITS_MAX_RX_CHAR_LEN BLE_ITS_MAX_DATA_LEN /**< Maximum length of the RX Characteristic (in bytes). */
#define BLE_ITS_MAX_TX_CHAR_LEN BLE_ITS_MAX_DATA_LEN /**< Maximum length of the TX Characteristic (in bytes). */
#define ITS_BASE_UUID {{0x3E, 0xCA, 0xDC, 0x24, 0x0E, 0xE5, 0xA9, 0xE0, 0x93, 0xF3, 0xA3, 0xB5, 0x00, 0x00, 0x40, 0x6E}} /**< Used vendor specific UUID. */
#include "nrf_log.h"
volatile uint32_t file_size = 0, file_pos = 0, m_max_data_length = 20;
uint8_t * file_data;
ble_its_t * m_its;
#define ITS_ENABLE_PIN_DEBUGGING 0
#if(ITS_ENABLE_PIN_DEBUGGING == 1)
#define ITS_DEBUG_PIN_SET(_pin) nrf_gpio_pin_set(DBG_PIN_ ## _pin)
#define ITS_DEBUG_PIN_CLR(_pin) nrf_gpio_pin_clear(DBG_PIN_ ## _pin)
#else
#define ITS_DEBUG_PIN_SET(_pin)
#define ITS_DEBUG_PIN_CLR(_pin)
#endif
static void its_enable_gpio_debug(void)
{
#if(ITS_ENABLE_PIN_DEBUGGING == 1)
nrf_gpio_cfg_output(DBG_PIN_0);
nrf_gpio_cfg_output(DBG_PIN_1);
nrf_gpio_cfg_output(DBG_PIN_2);
// Configure two GPIO's to signal TX and RX activity on the radio, for debugging throughput issues on different phones
NRF_GPIOTE->CONFIG[0] = GPIOTE_CONFIG_MODE_Task << GPIOTE_CONFIG_MODE_Pos |
GPIOTE_CONFIG_POLARITY_Toggle << GPIOTE_CONFIG_POLARITY_Pos |
DBG_PIN_3 << GPIOTE_CONFIG_PSEL_Pos;
NRF_GPIOTE->CONFIG[1] = GPIOTE_CONFIG_MODE_Task << GPIOTE_CONFIG_MODE_Pos |
GPIOTE_CONFIG_POLARITY_Toggle << GPIOTE_CONFIG_POLARITY_Pos |
DBG_PIN_4 << GPIOTE_CONFIG_PSEL_Pos;
NRF_PPI->CH[0].EEP = (uint32_t)&NRF_RADIO->EVENTS_TXREADY;
NRF_PPI->CH[0].TEP = (uint32_t)&NRF_GPIOTE->TASKS_SET[0];
NRF_PPI->CH[1].EEP = (uint32_t)&NRF_RADIO->EVENTS_RXREADY;
NRF_PPI->CH[1].TEP = (uint32_t)&NRF_GPIOTE->TASKS_SET[1];
NRF_PPI->CH[2].EEP = (uint32_t)&NRF_RADIO->EVENTS_DISABLED;
NRF_PPI->CH[2].TEP = (uint32_t)&NRF_GPIOTE->TASKS_CLR[0];
NRF_PPI->FORK[2].TEP = (uint32_t)&NRF_GPIOTE->TASKS_CLR[1];
NRF_PPI->CHENSET = 0x07;
#endif
}
/**@brief Function for handling the @ref BLE_GAP_EVT_CONNECTED event from the S110 SoftDevice.
*
* @param[in] p_its Nordic UART Service structure.
* @param[in] p_ble_evt Pointer to the event received from BLE stack.
*/
static void on_connect(ble_its_t * p_its, ble_evt_t const * p_ble_evt)
{
p_its->conn_handle = p_ble_evt->evt.gap_evt.conn_handle;
}
/**@brief Function for handling the @ref BLE_GAP_EVT_DISCONNECTED event from the S110 SoftDevice.
*
* @param[in] p_its Nordic UART Service structure.
* @param[in] p_ble_evt Pointer to the event received from BLE stack.
*/
static void on_disconnect(ble_its_t * p_its, ble_evt_t const * p_ble_evt)
{
UNUSED_PARAMETER(p_ble_evt);
p_its->conn_handle = BLE_CONN_HANDLE_INVALID;
}
/**@brief Function for handling the @ref BLE_GATTS_EVT_WRITE event from the S110 SoftDevice.
*
* @param[in] p_its Nordic UART Service structure.
* @param[in] p_ble_evt Pointer to the event received from BLE stack.
*/
static void on_write(ble_its_t * p_its, ble_evt_t const * p_ble_evt)
{
ble_gatts_evt_write_t const * p_evt_write = &p_ble_evt->evt.gatts_evt.params.write;
if (
(p_evt_write->handle == p_its->tx_handles.cccd_handle)
&&
(p_evt_write->len == 2)
)
{
if (ble_srv_is_notification_enabled(p_evt_write->data))
{
p_its->is_notification_enabled = true;
}
else
{
p_its->is_notification_enabled = false;
}
}
else if (
(p_evt_write->handle == p_its->img_info_handles.cccd_handle)
&&
(p_evt_write->len == 2)
)
{
if (ble_srv_is_notification_enabled(p_evt_write->data))
{
p_its->is_info_char_notification_enabled = true;
}
else
{
p_its->is_info_char_notification_enabled = false;
}
}
else if (
(p_evt_write->handle == p_its->rx_handles.value_handle)
&&
(p_its->data_handler != NULL)
)
{
p_its->data_handler(p_its, p_evt_write->data, p_evt_write->len);
}
else
{
// Do Nothing. This event is not relevant for this service.
}
}
/**@brief Function for adding TX characteristic.
*
* @param[in] p_its Nordic UART Service structure.
* @param[in] p_its_init Information needed to initialize the service.
*
* @return NRF_SUCCESS on success, otherwise an error code.
*/
static uint32_t tx_char_add(ble_its_t * p_its, const ble_its_init_t * p_its_init)
{
/**@snippet [Adding proprietary characteristic to S110 SoftDevice] */
ble_gatts_char_md_t char_md;
ble_gatts_attr_md_t cccd_md;
ble_gatts_attr_t attr_char_value;
ble_uuid_t ble_uuid;
ble_gatts_attr_md_t attr_md;
memset(&cccd_md, 0, sizeof(cccd_md));
BLE_GAP_CONN_SEC_MODE_SET_OPEN(&cccd_md.read_perm);
BLE_GAP_CONN_SEC_MODE_SET_OPEN(&cccd_md.write_perm);
cccd_md.vloc = BLE_GATTS_VLOC_STACK;
memset(&char_md, 0, sizeof(char_md));
char_md.char_props.notify = 1;
char_md.p_char_user_desc = NULL;
char_md.p_char_pf = NULL;
char_md.p_user_desc_md = NULL;
char_md.p_cccd_md = &cccd_md;
char_md.p_sccd_md = NULL;
ble_uuid.type = p_its->uuid_type;
ble_uuid.uuid = BLE_UUID_ITS_TX_CHARACTERISTIC;
memset(&attr_md, 0, sizeof(attr_md));
BLE_GAP_CONN_SEC_MODE_SET_OPEN(&attr_md.read_perm);
BLE_GAP_CONN_SEC_MODE_SET_OPEN(&attr_md.write_perm);
attr_md.vloc = BLE_GATTS_VLOC_STACK;
attr_md.rd_auth = 0;
attr_md.wr_auth = 0;
attr_md.vlen = 1;
memset(&attr_char_value, 0, sizeof(attr_char_value));
attr_char_value.p_uuid = &ble_uuid;
attr_char_value.p_attr_md = &attr_md;
attr_char_value.init_len = sizeof(uint8_t);
attr_char_value.init_offs = 0;
attr_char_value.max_len = BLE_ITS_MAX_TX_CHAR_LEN;
return sd_ble_gatts_characteristic_add(p_its->service_handle,
&char_md,
&attr_char_value,
&p_its->tx_handles);
/**@snippet [Adding proprietary characteristic to S110 SoftDevice] */
}
/**@brief Function for adding TX characteristic.
*
* @param[in] p_its Nordic UART Service structure.
* @param[in] p_its_init Information needed to initialize the service.
*
* @return NRF_SUCCESS on success, otherwise an error code.
*/
static uint32_t img_info_char_add(ble_its_t * p_its, const ble_its_init_t * p_its_init)
{
/**@snippet [Adding proprietary characteristic to S110 SoftDevice] */
ble_gatts_char_md_t char_md;
ble_gatts_attr_md_t cccd_md;
ble_gatts_attr_t attr_char_value;
ble_uuid_t ble_uuid;
ble_gatts_attr_md_t attr_md;
memset(&cccd_md, 0, sizeof(cccd_md));
BLE_GAP_CONN_SEC_MODE_SET_OPEN(&cccd_md.read_perm);
BLE_GAP_CONN_SEC_MODE_SET_OPEN(&cccd_md.write_perm);
cccd_md.vloc = BLE_GATTS_VLOC_STACK;
memset(&char_md, 0, sizeof(char_md));
char_md.char_props.notify = 1;
char_md.p_char_user_desc = NULL;
char_md.p_char_pf = NULL;
char_md.p_user_desc_md = NULL;
char_md.p_cccd_md = &cccd_md;
char_md.p_sccd_md = NULL;
ble_uuid.type = p_its->uuid_type;
ble_uuid.uuid = BLE_UUID_ITS_IMG_INFO_CHARACTERISTIC;
memset(&attr_md, 0, sizeof(attr_md));
BLE_GAP_CONN_SEC_MODE_SET_OPEN(&attr_md.read_perm);
BLE_GAP_CONN_SEC_MODE_SET_OPEN(&attr_md.write_perm);
attr_md.vloc = BLE_GATTS_VLOC_STACK;
attr_md.rd_auth = 0;
attr_md.wr_auth = 0;
attr_md.vlen = 1;
memset(&attr_char_value, 0, sizeof(attr_char_value));
attr_char_value.p_uuid = &ble_uuid;
attr_char_value.p_attr_md = &attr_md;
attr_char_value.init_len = 1 + sizeof(ble_its_img_info_t);
attr_char_value.init_offs = 0;
attr_char_value.max_len = 16;
return sd_ble_gatts_characteristic_add(p_its->service_handle,
&char_md,
&attr_char_value,
&p_its->img_info_handles);
/**@snippet [Adding proprietary characteristic to S110 SoftDevice] */
}
/**@brief Function for adding RX characteristic.
*
* @param[in] p_its Nordic UART Service structure.
* @param[in] p_its_init Information needed to initialize the service.
*
* @return NRF_SUCCESS on success, otherwise an error code.
*/
static uint32_t rx_char_add(ble_its_t * p_its, const ble_its_init_t * p_its_init)
{
ble_gatts_char_md_t char_md;
ble_gatts_attr_t attr_char_value;
ble_uuid_t ble_uuid;
ble_gatts_attr_md_t attr_md;
memset(&char_md, 0, sizeof(char_md));
char_md.char_props.write = 1;
char_md.char_props.write_wo_resp = 1;
char_md.p_char_user_desc = NULL;
char_md.p_char_pf = NULL;
char_md.p_user_desc_md = NULL;
char_md.p_cccd_md = NULL;
char_md.p_sccd_md = NULL;
ble_uuid.type = p_its->uuid_type;
ble_uuid.uuid = BLE_UUID_ITS_RX_CHARACTERISTIC;
memset(&attr_md, 0, sizeof(attr_md));
BLE_GAP_CONN_SEC_MODE_SET_OPEN(&attr_md.read_perm);
BLE_GAP_CONN_SEC_MODE_SET_OPEN(&attr_md.write_perm);
attr_md.vloc = BLE_GATTS_VLOC_STACK;
attr_md.rd_auth = 0;
attr_md.wr_auth = 0;
attr_md.vlen = 1;
memset(&attr_char_value, 0, sizeof(attr_char_value));
attr_char_value.p_uuid = &ble_uuid;
attr_char_value.p_attr_md = &attr_md;
attr_char_value.init_len = 1;
attr_char_value.init_offs = 0;
attr_char_value.max_len = BLE_ITS_MAX_RX_CHAR_LEN;
return sd_ble_gatts_characteristic_add(p_its->service_handle,
&char_md,
&attr_char_value,
&p_its->rx_handles);
}
/*static uint32_t push_data_packets()
{
uint32_t return_code = NRF_SUCCESS;
uint32_t packet_length = m_max_data_length;
uint32_t packet_size = 0;
ITS_DEBUG_PIN_SET(1);
while(return_code == NRF_SUCCESS)
{
if((file_size - file_pos) > packet_length)
{
packet_size = packet_length;
}
else if((file_size - file_pos) > 0)
{
packet_size = file_size - file_pos;
}
if(packet_size > 0)
{
return_code = ble_its_string_send(m_its, &file_data[file_pos], packet_size);
if(return_code == NRF_SUCCESS)
{
file_pos += packet_size;
}
}
else
{
file_size = 0;
break;
}
}
ITS_DEBUG_PIN_CLR(1);
return return_code;
}
*/
static volatile bool nrf_error_resources = false;
void ble_its_on_ble_evt(ble_evt_t const * p_ble_evt, void * p_context)
{
if ((p_context == NULL) || (p_ble_evt == NULL))
{
return;
}
ble_its_t * p_its = (ble_its_t*)p_context;
switch (p_ble_evt->header.evt_id)
{
case BLE_GAP_EVT_CONNECTED:
on_connect(p_its, p_ble_evt);
break;
case BLE_GAP_EVT_DISCONNECTED:
on_disconnect(p_its, p_ble_evt);
break;
case BLE_GATTS_EVT_WRITE:
on_write(p_its, p_ble_evt);
break;
case BLE_GATTS_EVT_HVN_TX_COMPLETE:
{
//uint32_t count = p_ble_evt->evt.gatts_evt.params.hvn_tx_complete.count;
ITS_DEBUG_PIN_SET(2);
ITS_DEBUG_PIN_CLR(1);
if(file_size > 0)
{
//push_data_packets();
}
ITS_DEBUG_PIN_CLR(2);
nrf_error_resources = false;
}
break;
default:
// No implementation needed.
break;
}
}
uint32_t ble_its_init(ble_its_t * p_its, const ble_its_init_t * p_its_init)
{
uint32_t err_code;
ble_uuid_t ble_uuid;
ble_uuid128_t its_base_uuid = ITS_BASE_UUID;
VERIFY_PARAM_NOT_NULL(p_its);
VERIFY_PARAM_NOT_NULL(p_its_init);
// Initialize the service structure.
p_its->conn_handle = BLE_CONN_HANDLE_INVALID;
p_its->data_handler = p_its_init->data_handler;
p_its->is_notification_enabled = false;
/**@snippet [Adding proprietary Service to S110 SoftDevice] */
// Add a custom base UUID.
err_code = sd_ble_uuid_vs_add(&its_base_uuid, &p_its->uuid_type);
VERIFY_SUCCESS(err_code);
ble_uuid.type = p_its->uuid_type;
ble_uuid.uuid = BLE_UUID_ITS_SERVICE;
// Add the service.
err_code = sd_ble_gatts_service_add(BLE_GATTS_SRVC_TYPE_PRIMARY,
&ble_uuid,
&p_its->service_handle);
/**@snippet [Adding proprietary Service to S110 SoftDevice] */
VERIFY_SUCCESS(err_code);
// Add the RX Characteristic.
err_code = rx_char_add(p_its, p_its_init);
VERIFY_SUCCESS(err_code);
// Add the TX Characteristic.
err_code = tx_char_add(p_its, p_its_init);
VERIFY_SUCCESS(err_code);
// Add the Image Info Characteristic.
err_code = img_info_char_add(p_its, p_its_init);
VERIFY_SUCCESS(err_code);
its_enable_gpio_debug();
return NRF_SUCCESS;
}
uint32_t ble_its_string_send(ble_its_t * p_its, uint8_t * p_string, uint16_t length)
{
ble_gatts_hvx_params_t hvx_params;
uint32_t err_code;
ITS_DEBUG_PIN_SET(0);
if(nrf_error_resources)
{
ITS_DEBUG_PIN_CLR(0);
return NRF_ERROR_RESOURCES;
}
VERIFY_PARAM_NOT_NULL(p_its);
if ((p_its->conn_handle == BLE_CONN_HANDLE_INVALID) || (!p_its->is_notification_enabled))
{
return NRF_ERROR_INVALID_STATE;
}
if (length > BLE_ITS_MAX_DATA_LEN)
{
return NRF_ERROR_INVALID_PARAM;
}
memset(&hvx_params, 0, sizeof(hvx_params));
hvx_params.handle = p_its->tx_handles.value_handle;
hvx_params.p_data = p_string;
hvx_params.p_len = &length;
hvx_params.type = BLE_GATT_HVX_NOTIFICATION;
err_code = sd_ble_gatts_hvx(p_its->conn_handle, &hvx_params);
if(err_code == NRF_ERROR_RESOURCES)
{
nrf_error_resources = true;
ITS_DEBUG_PIN_SET(1);
}
ITS_DEBUG_PIN_CLR(0);
//NRF_LOG_INFO("NOT - Len: %i, err_code: %i", length, err_code);
return err_code;
}
uint32_t ble_its_ble_params_info_send(ble_its_t * p_its, ble_its_ble_params_info_t * ble_params_info)
{
uint8_t data_buf[1 + sizeof(ble_its_ble_params_info_t)];
ble_gatts_hvx_params_t hvx_params;
VERIFY_PARAM_NOT_NULL(p_its);
if ((p_its->conn_handle == BLE_CONN_HANDLE_INVALID) || (!p_its->is_info_char_notification_enabled))
{
return NRF_ERROR_INVALID_STATE;
}
uint16_t length = 1 + sizeof(ble_its_ble_params_info_t);
data_buf[0] = 2;
memcpy(&data_buf[1], ble_params_info, sizeof(ble_its_ble_params_info_t));
memset(&hvx_params, 0, sizeof(hvx_params));
hvx_params.handle = p_its->img_info_handles.value_handle;
hvx_params.p_data = data_buf;
hvx_params.p_len = &length;
hvx_params.type = BLE_GATT_HVX_NOTIFICATION;
return sd_ble_gatts_hvx(p_its->conn_handle, &hvx_params);
}
/*uint32_t ble_its_img_info_send(ble_its_t * p_its, ble_its_img_info_t * img_info)
{
uint8_t data_buf[1 + sizeof(ble_its_img_info_t)];
ble_gatts_hvx_params_t hvx_params;
VERIFY_PARAM_NOT_NULL(p_its);
if ((p_its->conn_handle == BLE_CONN_HANDLE_INVALID) || (!p_its->is_info_char_notification_enabled))
{
return NRF_ERROR_INVALID_STATE;
}
uint16_t length = 1 + sizeof(ble_its_img_info_t);
data_buf[0] = 1;
memcpy(&data_buf[1], img_info, sizeof(ble_its_img_info_t));
memset(&hvx_params, 0, sizeof(hvx_params));
hvx_params.handle = p_its->img_info_handles.value_handle;
hvx_params.p_data = data_buf;
hvx_params.p_len = &length;
hvx_params.type = BLE_GATT_HVX_NOTIFICATION;
return sd_ble_gatts_hvx(p_its->conn_handle, &hvx_params);
}
uint32_t ble_its_send_file(ble_its_t * p_its, uint8_t * p_data, uint32_t data_length, uint32_t max_packet_length)
{
uint32_t err_code;
if ((p_its->conn_handle == BLE_CONN_HANDLE_INVALID) || (!p_its->is_notification_enabled))
{
return NRF_ERROR_INVALID_STATE;
}
if(file_size != 0)
{
return NRF_ERROR_BUSY;
}
ble_its_img_info_t image_info;
image_info.file_size_bytes = data_length;
ble_its_img_info_send(p_its, &image_info);
file_size = data_length;
file_pos = 0;
file_data = p_data;
m_max_data_length = max_packet_length;
m_its = p_its;
err_code = push_data_packets();
if(err_code == NRF_ERROR_RESOURCES) return NRF_SUCCESS;
return err_code;
}*/
uint32_t ble_its_send_file_fragment(ble_its_t * p_its, uint8_t * p_data, uint32_t data_length)
{
uint32_t err_code;
if ((p_its->conn_handle == BLE_CONN_HANDLE_INVALID) || (!p_its->is_notification_enabled))
{
return NRF_ERROR_INVALID_STATE;
}
if(file_size != 0)
{
return NRF_ERROR_BUSY;
}
err_code = ble_its_string_send(p_its, p_data, data_length);
return err_code;
}
bool ble_its_file_transfer_busy(void)
{
return file_size != 0;
}
//#endif // NRF_MODULE_ENABLED(BLE_NUS)
From the screenshot it seems that the phone has previously been bonded. Could you try to delete all bonding information from the phone or change the MAC-address from the DK.
regards
jared
Thanks Jared. i will try in sometime.
Another doubt is ....
Can you please guide me ...How should i start acquire the streaming data from server.
On Client side i just enabled the notification ....After that i'm not sure how to read it. ( There is a read box in the service ...But not reading it any more )
I have read some pdf and gone through some website https://embeddedcentric.com/lesson-2-ble-profiles-services-characteristics-device-roles-and-network-topology/
I'm not getting clear idea....I'm new to BLE
Hi,
A notification event will generate a BLE_GATTC_EVT_HVX event which contains the attribute data. See the message sequence chart for a example. The data is contained in the ble_gattc_evt_hvx_t event struct.
regards
Jared
