327 lines
		
	
	
		
			11 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			327 lines
		
	
	
		
			11 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /**
 | |
|  * Copyright (c) 2014 - 2020, Nordic Semiconductor ASA
 | |
|  *
 | |
|  * All rights reserved.
 | |
|  *
 | |
|  * Redistribution and use in source and binary forms, with or without modification,
 | |
|  * are permitted provided that the following conditions are met:
 | |
|  *
 | |
|  * 1. Redistributions of source code must retain the above copyright notice, this
 | |
|  *    list of conditions and the following disclaimer.
 | |
|  *
 | |
|  * 2. Redistributions in binary form, except as embedded into a Nordic
 | |
|  *    Semiconductor ASA integrated circuit in a product or a software update for
 | |
|  *    such product, must reproduce the above copyright notice, this list of
 | |
|  *    conditions and the following disclaimer in the documentation and/or other
 | |
|  *    materials provided with the distribution.
 | |
|  *
 | |
|  * 3. Neither the name of Nordic Semiconductor ASA nor the names of its
 | |
|  *    contributors may be used to endorse or promote products derived from this
 | |
|  *    software without specific prior written permission.
 | |
|  *
 | |
|  * 4. This software, with or without modification, must only be used with a
 | |
|  *    Nordic Semiconductor ASA integrated circuit.
 | |
|  *
 | |
|  * 5. Any software provided in binary form under this license must not be reverse
 | |
|  *    engineered, decompiled, modified and/or disassembled.
 | |
|  *
 | |
|  * THIS SOFTWARE IS PROVIDED BY NORDIC SEMICONDUCTOR ASA "AS IS" AND ANY EXPRESS
 | |
|  * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 | |
|  * OF MERCHANTABILITY, NONINFRINGEMENT, AND FITNESS FOR A PARTICULAR PURPOSE ARE
 | |
|  * DISCLAIMED. IN NO EVENT SHALL NORDIC SEMICONDUCTOR ASA OR CONTRIBUTORS BE
 | |
|  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 | |
|  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
 | |
|  * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 | |
|  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 | |
|  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
 | |
|  * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 | |
|  *
 | |
|  */
 | |
| #include "ble_serialization.h"
 | |
| #include "ble_app.h"
 | |
| #include "ble_evt_app.h"
 | |
| #include "ble_gap_evt_app.h"
 | |
| #include "ble_gattc_evt_app.h"
 | |
| #include "ble_gatts_evt_app.h"
 | |
| #include "ble_l2cap_evt_app.h"
 | |
| #include "app_util.h"
 | |
| 
 | |
| uint32_t ble_event_dec(uint8_t const * const p_buf,
 | |
|                        uint32_t              packet_len,
 | |
|                        ble_evt_t * const     p_event,
 | |
|                        uint32_t * const      p_event_len)
 | |
| {
 | |
|     uint32_t err_code;
 | |
|     SER_ASSERT_NOT_NULL(p_buf);
 | |
|     SER_ASSERT_NOT_NULL(p_event_len);
 | |
|     SER_ASSERT_LENGTH_LEQ(SER_EVT_HEADER_SIZE, packet_len);
 | |
|     SER_ASSERT_NOT_NULL(p_event);
 | |
|     SER_ASSERT_LENGTH_LEQ(sizeof (ble_evt_hdr_t), *p_event_len);
 | |
|     *p_event_len -= sizeof (ble_evt_hdr_t);
 | |
| 
 | |
|     const uint16_t  event_id       = uint16_decode(&p_buf[SER_EVT_ID_POS]);
 | |
|     const uint8_t * p_sub_buffer   = &p_buf[SER_EVT_HEADER_SIZE];
 | |
|     const uint32_t  sub_packet_len = packet_len - SER_EVT_HEADER_SIZE;
 | |
| 
 | |
|     uint32_t (*fp_event_decoder)(uint8_t const * const p_buf,
 | |
|                                  uint32_t              packet_len,
 | |
|                                  ble_evt_t * const     p_event,
 | |
|                                  uint32_t * const      p_event_len) = NULL;
 | |
| 
 | |
|     switch (event_id)
 | |
|     {
 | |
| #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION < 4
 | |
|         case BLE_EVT_TX_COMPLETE:
 | |
|             fp_event_decoder = ble_evt_tx_complete_dec;
 | |
|             break;
 | |
|         case BLE_EVT_DATA_LENGTH_CHANGED:
 | |
|             fp_event_decoder = ble_evt_data_length_changed_dec;
 | |
|             break;
 | |
| #endif
 | |
|         case BLE_EVT_USER_MEM_REQUEST:
 | |
|             fp_event_decoder = ble_evt_user_mem_request_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_EVT_USER_MEM_RELEASE:
 | |
|             fp_event_decoder = ble_evt_user_mem_release_dec;
 | |
|             break;
 | |
| 
 | |
| 
 | |
|         case BLE_GAP_EVT_PASSKEY_DISPLAY:
 | |
|             fp_event_decoder = ble_gap_evt_passkey_display_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GAP_EVT_AUTH_KEY_REQUEST:
 | |
|             fp_event_decoder = ble_gap_evt_auth_key_request_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GAP_EVT_CONN_PARAM_UPDATE:
 | |
|             fp_event_decoder = ble_gap_evt_conn_param_update_dec;
 | |
|             break;
 | |
| 
 | |
| #ifndef S112
 | |
|         case BLE_GAP_EVT_CONN_PARAM_UPDATE_REQUEST:
 | |
|             fp_event_decoder = ble_gap_evt_conn_param_update_request_dec;
 | |
|             break;
 | |
| #endif
 | |
|         case BLE_GAP_EVT_CONN_SEC_UPDATE:
 | |
|             fp_event_decoder = ble_gap_evt_conn_sec_update_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GAP_EVT_CONNECTED:
 | |
|             fp_event_decoder = ble_gap_evt_connected_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GAP_EVT_DISCONNECTED:
 | |
|             fp_event_decoder = ble_gap_evt_disconnected_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GAP_EVT_TIMEOUT:
 | |
|             fp_event_decoder = ble_gap_evt_timeout_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GAP_EVT_RSSI_CHANGED:
 | |
|             fp_event_decoder = ble_gap_evt_rssi_changed_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GAP_EVT_SEC_INFO_REQUEST:
 | |
|             fp_event_decoder = ble_gap_evt_sec_info_request_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GAP_EVT_SEC_PARAMS_REQUEST:
 | |
|             fp_event_decoder = ble_gap_evt_sec_params_request_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GAP_EVT_AUTH_STATUS:
 | |
|             fp_event_decoder = ble_gap_evt_auth_status_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GAP_EVT_SEC_REQUEST:
 | |
|             fp_event_decoder = ble_gap_evt_sec_request_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GAP_EVT_KEY_PRESSED:
 | |
|             fp_event_decoder = ble_gap_evt_key_pressed_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GAP_EVT_LESC_DHKEY_REQUEST:
 | |
|             fp_event_decoder = ble_gap_evt_lesc_dhkey_request_dec;
 | |
|             break;
 | |
| #if NRF_SD_BLE_API_VERSION >= 5
 | |
|         case BLE_GAP_EVT_PHY_UPDATE:
 | |
|             fp_event_decoder = ble_gap_evt_phy_update_dec;
 | |
|             break;
 | |
|         case BLE_GAP_EVT_PHY_UPDATE_REQUEST:
 | |
|             fp_event_decoder = ble_gap_evt_phy_update_request_dec;
 | |
|             break;
 | |
| #endif
 | |
| #if NRF_SD_BLE_API_VERSION >= 6
 | |
| #ifndef S112
 | |
|         case BLE_GAP_EVT_QOS_CHANNEL_SURVEY_REPORT:
 | |
|             fp_event_decoder = ble_gap_evt_qos_channel_survey_report_dec;
 | |
|             break;
 | |
| #endif
 | |
|         case BLE_GAP_EVT_ADV_SET_TERMINATED:
 | |
|             fp_event_decoder = ble_gap_evt_adv_set_terminated_dec;
 | |
|             break;
 | |
| #endif
 | |
| #if NRF_SD_BLE_API_VERSION >= 4  && !defined(S112)
 | |
|         case BLE_GAP_EVT_DATA_LENGTH_UPDATE_REQUEST:
 | |
|             fp_event_decoder = ble_gap_evt_data_length_update_request_dec;
 | |
|             break;
 | |
|         case BLE_GAP_EVT_DATA_LENGTH_UPDATE:
 | |
|             fp_event_decoder = ble_gap_evt_data_length_update_dec;
 | |
|             break;
 | |
| #endif
 | |
|         case BLE_GATTC_EVT_CHAR_DISC_RSP:
 | |
|             fp_event_decoder = ble_gattc_evt_char_disc_rsp_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTC_EVT_CHAR_VAL_BY_UUID_READ_RSP:
 | |
|             fp_event_decoder = ble_gattc_evt_char_val_by_uuid_read_rsp_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTC_EVT_DESC_DISC_RSP:
 | |
|             fp_event_decoder = ble_gattc_evt_desc_disc_rsp_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTC_EVT_PRIM_SRVC_DISC_RSP:
 | |
|             fp_event_decoder = ble_gattc_evt_prim_srvc_disc_rsp_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTC_EVT_READ_RSP:
 | |
|             fp_event_decoder = ble_gattc_evt_read_rsp_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTC_EVT_HVX:
 | |
|             fp_event_decoder = ble_gattc_evt_hvx_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTC_EVT_TIMEOUT:
 | |
|             fp_event_decoder = ble_gattc_evt_timeout_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTC_EVT_WRITE_RSP:
 | |
|             fp_event_decoder = ble_gattc_evt_write_rsp_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTC_EVT_CHAR_VALS_READ_RSP:
 | |
|             fp_event_decoder = ble_gattc_evt_char_vals_read_rsp_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTC_EVT_REL_DISC_RSP:
 | |
|             fp_event_decoder = ble_gattc_evt_rel_disc_rsp_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTC_EVT_ATTR_INFO_DISC_RSP:
 | |
|             fp_event_decoder = ble_gattc_evt_attr_info_disc_rsp_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTC_EVT_EXCHANGE_MTU_RSP:
 | |
|             fp_event_decoder = ble_gattc_evt_exchange_mtu_rsp_dec;
 | |
|             break;
 | |
| #if NRF_SD_BLE_API_VERSION >= 4
 | |
|         case BLE_GATTC_EVT_WRITE_CMD_TX_COMPLETE:
 | |
|             fp_event_decoder = ble_gattc_evt_write_cmd_tx_complete_dec;
 | |
|             break;
 | |
| #endif
 | |
|         case BLE_GATTS_EVT_WRITE:
 | |
|             fp_event_decoder = ble_gatts_evt_write_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTS_EVT_TIMEOUT:
 | |
|             fp_event_decoder = ble_gatts_evt_timeout_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTS_EVT_SC_CONFIRM:
 | |
|             fp_event_decoder = ble_gatts_evt_sc_confirm_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTS_EVT_HVC:
 | |
|             fp_event_decoder = ble_gatts_evt_hvc_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTS_EVT_SYS_ATTR_MISSING:
 | |
|             fp_event_decoder = ble_gatts_evt_sys_attr_missing_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTS_EVT_RW_AUTHORIZE_REQUEST:
 | |
|             fp_event_decoder = ble_gatts_evt_rw_authorize_request_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_GATTS_EVT_EXCHANGE_MTU_REQUEST:
 | |
|             fp_event_decoder = ble_gatts_evt_exchange_mtu_request_dec;
 | |
|             break;
 | |
| #if NRF_SD_BLE_API_VERSION >= 4
 | |
|         case BLE_GATTS_EVT_HVN_TX_COMPLETE:
 | |
|             fp_event_decoder = ble_gatts_evt_hvn_tx_complete_dec;
 | |
|             break;
 | |
| #endif
 | |
| #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION < 4
 | |
|         case BLE_L2CAP_EVT_RX:
 | |
|             fp_event_decoder = ble_l2cap_evt_rx_dec;
 | |
|             break;
 | |
| #endif
 | |
| 
 | |
| #if defined(NRF_SD_BLE_API_VERSION) && NRF_SD_BLE_API_VERSION >= 5 && !defined(S112)
 | |
|         case BLE_L2CAP_EVT_CH_SETUP_REQUEST:
 | |
|             fp_event_decoder = ble_l2cap_evt_ch_setup_request_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_L2CAP_EVT_CH_SETUP_REFUSED:
 | |
|             fp_event_decoder = ble_l2cap_evt_ch_setup_refused_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_L2CAP_EVT_CH_SETUP:
 | |
|             fp_event_decoder = ble_l2cap_evt_ch_setup_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_L2CAP_EVT_CH_RELEASED:
 | |
|             fp_event_decoder = ble_l2cap_evt_ch_released_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_L2CAP_EVT_CH_SDU_BUF_RELEASED:
 | |
|             fp_event_decoder = ble_l2cap_evt_ch_sdu_buf_released_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_L2CAP_EVT_CH_CREDIT:
 | |
|             fp_event_decoder = ble_l2cap_evt_ch_credit_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_L2CAP_EVT_CH_RX:
 | |
|             fp_event_decoder = ble_l2cap_evt_ch_rx_dec;
 | |
|             break;
 | |
| 
 | |
|         case BLE_L2CAP_EVT_CH_TX:
 | |
|             fp_event_decoder = ble_l2cap_evt_ch_tx_dec;
 | |
|             break;
 | |
| 
 | |
| #endif
 | |
| #ifndef S112
 | |
|         case BLE_GAP_EVT_ADV_REPORT:
 | |
|             fp_event_decoder = ble_gap_evt_adv_report_dec;
 | |
|             break;
 | |
| #endif
 | |
|         case BLE_GAP_EVT_SCAN_REQ_REPORT:
 | |
|             fp_event_decoder = ble_gap_evt_scan_req_report_dec;
 | |
|             break;
 | |
|         default:
 | |
|             break;
 | |
|     }
 | |
| 
 | |
|     if (fp_event_decoder)
 | |
|     {
 | |
|         err_code = fp_event_decoder(p_sub_buffer, sub_packet_len, p_event, p_event_len);
 | |
|     }
 | |
|     else
 | |
|     {
 | |
|         err_code = NRF_ERROR_NOT_FOUND;
 | |
|     }
 | |
| 
 | |
|     *p_event_len += offsetof(ble_evt_t, evt);
 | |
|     p_event->header.evt_id  = (err_code == NRF_SUCCESS) ? event_id : 0;
 | |
|     p_event->header.evt_len = (err_code == NRF_SUCCESS) ? (uint16_t)*p_event_len : 0;
 | |
| 
 | |
|     return err_code;
 | |
| }
 |