123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359 |
- #include "es_adv.h"
- #include "app_error.h"
- #include "es_adv_frame.h"
- #include "es_adv_timing.h"
- #include "es_tlm.h"
- #include "es_slot.h"
- #define MULTIPROT_BEACON_DELAY_MS 75
- static es_adv_evt_handler_t m_adv_evt_handler;
- static bool m_is_connected = false;
- static bool m_remain_connectable = false;
- static uint8_t m_ecs_uuid_type = 0;
- static uint16_t m_adv_interval = APP_CFG_NON_CONN_ADV_INTERVAL_MS;
- static uint8_t m_enc_advdata[BLE_GAP_ADV_SET_DATA_SIZE_MAX];
- static uint8_t m_enc_scan_response_data[BLE_GAP_ADV_SET_DATA_SIZE_MAX];
- static uint8_t *mp_adv_handle;
- static ble_gap_adv_data_t m_adv_data =
- {
- .adv_data =
- {
- .p_data = m_enc_advdata,
- .len = BLE_GAP_ADV_SET_DATA_SIZE_MAX
- },
- .scan_rsp_data =
- {
- .p_data = m_enc_scan_response_data,
- .len = BLE_GAP_ADV_SET_DATA_SIZE_MAX
-
- }
- };
- static void invoke_callback(es_adv_evt_t evt)
- {
- if (m_adv_evt_handler != NULL)
- {
- m_adv_evt_handler(evt);
- }
- }
- static void adv_start(ble_gap_adv_params_t * p_adv_params)
- {
- ret_code_t err_code = NRF_SUCCESS;
- es_tlm_adv_cnt_inc();
- err_code = sd_ble_gap_adv_set_configure(mp_adv_handle, &m_adv_data, p_adv_params);
- APP_ERROR_CHECK(err_code);
- err_code = sd_ble_gap_adv_start(*mp_adv_handle, BLE_CONN_CFG_TAG_DEFAULT);
- if (err_code != NRF_ERROR_BUSY && err_code != NRF_SUCCESS)
- {
- APP_ERROR_CHECK(err_code);
- }
- }
- static void get_adv_params(ble_gap_adv_params_t * p_adv_params,
- bool non_connectable,
- bool remain_connectable)
- {
-
- memset(p_adv_params, 0, sizeof(ble_gap_adv_params_t));
-
- p_adv_params->properties.type = non_connectable
- ? BLE_GAP_ADV_TYPE_NONCONNECTABLE_NONSCANNABLE_UNDIRECTED
- : BLE_GAP_ADV_TYPE_CONNECTABLE_SCANNABLE_UNDIRECTED;
- p_adv_params->p_peer_addr = NULL;
- p_adv_params->filter_policy = BLE_GAP_ADV_FP_ANY;
- p_adv_params->primary_phy = BLE_GAP_PHY_1MBPS;
- if (non_connectable)
- {
- #ifdef MULTIPROTOCOL_802154_MODE
-
- p_adv_params->interval = MSEC_TO_UNITS(((m_adv_interval - MULTIPROT_BEACON_DELAY_MS) > 0 ? (m_adv_interval - MULTIPROT_BEACON_DELAY_MS) : m_adv_interval), UNIT_0_625_MS);
- #else
- p_adv_params->interval = MSEC_TO_UNITS(m_adv_interval, UNIT_0_625_MS);
- #endif
- p_adv_params->duration = BLE_GAP_ADV_TIMEOUT_GENERAL_UNLIMITED;
- }
- else
- {
- p_adv_params->interval = MSEC_TO_UNITS(APP_CFG_CONNECTABLE_ADV_INTERVAL_MS, UNIT_0_625_MS);
- p_adv_params->duration = APP_CFG_CONNECTABLE_ADV_TIMEOUT;
- }
- }
- static void connectable_adv_start(void)
- {
- ble_gap_adv_params_t connectable_adv_params;
- ble_advdata_t scrsp_data;
- ble_uuid_t scrp_uuids[] = {{BLE_UUID_ESCS_SERVICE, m_ecs_uuid_type}};
- memset(&scrsp_data, 0, sizeof(scrsp_data));
- scrsp_data.name_type = BLE_ADVDATA_FULL_NAME;
- scrsp_data.include_appearance = false;
- scrsp_data.uuids_complete.uuid_cnt = sizeof(scrp_uuids) / sizeof(scrp_uuids[0]);
- scrsp_data.uuids_complete.p_uuids = scrp_uuids;
- m_adv_data.scan_rsp_data.p_data = m_enc_scan_response_data;
- m_adv_data.scan_rsp_data.len = BLE_GAP_ADV_SET_DATA_SIZE_MAX;
-
- es_adv_frame_fill_connectable_adv_data(&scrsp_data, &m_adv_data);
- get_adv_params(&connectable_adv_params, false, m_remain_connectable);
- adv_start(&connectable_adv_params);
- invoke_callback(ES_ADV_EVT_CONNECTABLE_ADV_STARTED);
- }
- static void adv_stop(void)
- {
- ret_code_t err_code;
- err_code = sd_ble_gap_adv_stop(*mp_adv_handle);
- if (err_code != NRF_ERROR_INVALID_STATE)
- {
- APP_ERROR_CHECK(err_code);
- }
- es_adv_timing_stop();
- }
- static void adv_restart(void)
- {
- if (!m_remain_connectable)
- {
- es_adv_start_non_connctable_adv();
- }
- else
- {
- connectable_adv_start();
- }
- }
- static void adv_timing_callback(const es_adv_timing_evt_t * p_evt)
- {
- ret_code_t err_code;
- ble_gap_adv_params_t non_connectable_adv_params;
- const es_slot_reg_t * p_reg = es_slot_get_registry();
-
- err_code = sd_ble_gap_adv_stop(*mp_adv_handle);
- if (err_code != NRF_ERROR_INVALID_STATE && err_code != BLE_ERROR_INVALID_ADV_HANDLE)
- {
- APP_ERROR_CHECK(err_code);
- }
-
- if (p_evt->evt_id == ES_ADV_TIMING_EVT_ADV_SLOT)
- {
- err_code = sd_ble_gap_tx_power_set(BLE_GAP_TX_POWER_ROLE_ADV, 0, p_reg->slots[p_evt->slot_no].radio_tx_pwr);
- if (err_code != BLE_ERROR_INVALID_ADV_HANDLE)
- {
- APP_ERROR_CHECK(err_code);
- }
- es_adv_frame_fill_non_connectable_adv_data(p_evt->slot_no, false, &m_adv_data);
- }
-
- else if (p_evt->evt_id == ES_ADV_TIMING_EVT_ADV_ETLM)
- {
- err_code = sd_ble_gap_tx_power_set(BLE_GAP_TX_POWER_ROLE_ADV, 0, p_reg->slots[p_reg->tlm_slot].radio_tx_pwr);
- APP_ERROR_CHECK(err_code);
- es_adv_frame_fill_non_connectable_adv_data(p_evt->slot_no, true, &m_adv_data);
- }
- invoke_callback(ES_ADV_EVT_NON_CONN_ADV);
- get_adv_params(&non_connectable_adv_params, true, m_remain_connectable);
- adv_start(&non_connectable_adv_params);
- }
- void es_adv_start_connectable_adv(void)
- {
- if (!m_is_connected)
- {
- adv_stop();
- connectable_adv_start();
- }
- }
- void es_adv_start_non_connctable_adv(void)
- {
- es_adv_timing_start(m_adv_interval);
- }
- void es_adv_remain_connectable_set(bool remain_connectable)
- {
- m_remain_connectable = remain_connectable;
- }
- bool es_adv_remain_connectable_get(void)
- {
- return m_remain_connectable;
- }
- void es_adv_on_ble_evt(ble_evt_t const * p_ble_evt)
- {
- switch (p_ble_evt->header.evt_id)
- {
- case BLE_GAP_EVT_CONNECTED:
- m_is_connected = true;
-
-
- es_adv_start_non_connctable_adv();
- break;
- case BLE_GAP_EVT_DISCONNECTED:
- m_is_connected = false;
-
- adv_stop();
- adv_restart();
- break;
- case BLE_GAP_EVT_ADV_SET_TERMINATED:
- if (p_ble_evt->evt.gap_evt.params.adv_set_terminated.reason == BLE_GAP_EVT_ADV_SET_TERMINATED_REASON_TIMEOUT &&
- !m_is_connected)
- {
- invoke_callback(ES_ADV_EVT_CONNECTABLE_ADV_STOPPED);
- adv_restart();
- }
- break;
- default:
- break;
- }
- }
- void es_adv_interval_set(nrf_ble_escs_adv_interval_t interval)
- {
- const es_slot_reg_t * p_reg = es_slot_get_registry();
- uint16_t min_valid_adv_interval;
- bool eTLM_required = (p_reg->num_configured_eid_slots > 0) && (p_reg->tlm_configured);
- min_valid_adv_interval = eTLM_required ? \
- p_reg->num_configured_slots * (APP_CONFIG_ADV_FRAME_SPACING_MS_MIN + \
- APP_CONFIG_ADV_FRAME_ETLM_SPACING_MS) \
- : \
- p_reg->num_configured_slots * APP_CONFIG_ADV_FRAME_SPACING_MS_MIN;
- m_adv_interval = (interval > min_valid_adv_interval) ? interval : min_valid_adv_interval;
- #ifdef APP_CONFIG_ADV_INTERVAL_MS_MAX
- if (m_adv_interval > APP_CONFIG_ADV_INTERVAL_MS_MAX)
- {
- m_adv_interval = APP_CONFIG_ADV_INTERVAL_MS_MAX;
- }
- #endif
- }
- nrf_ble_escs_adv_interval_t es_adv_interval_get(void)
- {
- return m_adv_interval;
- }
- void es_adv_init(uint8_t ecs_uuid_type,
- es_adv_evt_handler_t adv_event_handler,
- nrf_ble_escs_adv_interval_t adv_interval,
- bool remain_connectable,
- uint8_t * const p_adv_handle)
- {
- m_ecs_uuid_type = ecs_uuid_type;
- m_adv_evt_handler = adv_event_handler;
- m_is_connected = false;
- m_remain_connectable = remain_connectable;
- m_adv_interval = adv_interval;
- mp_adv_handle = p_adv_handle;
- es_tlm_init();
- es_adv_timing_init(adv_timing_callback);
- }
- void es_adv_timers_init(void)
- {
- es_adv_timing_timers_init();
- }
|