1/****************************************************************************** 2 * 3 * Copyright (C) 2010-2014 Broadcom Corporation 4 * 5 * Licensed under the Apache License, Version 2.0 (the "License"); 6 * you may not use this file except in compliance with the License. 7 * You may obtain a copy of the License at: 8 * 9 * http://www.apache.org/licenses/LICENSE-2.0 10 * 11 * Unless required by applicable law or agreed to in writing, software 12 * distributed under the License is distributed on an "AS IS" BASIS, 13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 14 * See the License for the specific language governing permissions and 15 * limitations under the License. 16 * 17 ******************************************************************************/ 18 19/****************************************************************************** 20 * 21 * This is the main implementation file for the NFA device manager. 22 * 23 ******************************************************************************/ 24 25#include <string.h> 26#include "nfa_api.h" 27#include "nfa_dm_int.h" 28#include "nfa_sys.h" 29#include "nfa_sys_int.h" 30 31/***************************************************************************** 32** Constants and types 33*****************************************************************************/ 34static const tNFA_SYS_REG nfa_dm_sys_reg = {nfa_dm_sys_enable, nfa_dm_evt_hdlr, 35 nfa_dm_sys_disable, 36 nfa_dm_proc_nfcc_power_mode}; 37 38tNFA_DM_CB nfa_dm_cb = { 39 0, 40}; 41 42#define NFA_DM_NUM_ACTIONS (NFA_DM_MAX_EVT & 0x00ff) 43 44/* type for action functions */ 45typedef bool (*tNFA_DM_ACTION)(tNFA_DM_MSG* p_data); 46 47/* action function list */ 48const tNFA_DM_ACTION nfa_dm_action[] = { 49 /* device manager local device API events */ 50 nfa_dm_enable, /* NFA_DM_API_ENABLE_EVT */ 51 nfa_dm_disable, /* NFA_DM_API_DISABLE_EVT */ 52 nfa_dm_set_config, /* NFA_DM_API_SET_CONFIG_EVT */ 53 nfa_dm_get_config, /* NFA_DM_API_GET_CONFIG_EVT */ 54 nfa_dm_act_request_excl_rf_ctrl, /* NFA_DM_API_REQUEST_EXCL_RF_CTRL_EVT */ 55 nfa_dm_act_release_excl_rf_ctrl, /* NFA_DM_API_RELEASE_EXCL_RF_CTRL_EVT */ 56 nfa_dm_act_enable_polling, /* NFA_DM_API_ENABLE_POLLING_EVT */ 57 nfa_dm_act_disable_polling, /* NFA_DM_API_DISABLE_POLLING_EVT */ 58 nfa_dm_act_enable_listening, /* NFA_DM_API_ENABLE_LISTENING_EVT */ 59 nfa_dm_act_disable_listening, /* NFA_DM_API_DISABLE_LISTENING_EVT */ 60 nfa_dm_act_pause_p2p, /* NFA_DM_API_PAUSE_P2P_EVT */ 61 nfa_dm_act_resume_p2p, /* NFA_DM_API_RESUME_P2P_EVT */ 62 nfa_dm_act_send_raw_frame, /* NFA_DM_API_RAW_FRAME_EVT */ 63 nfa_dm_set_p2p_listen_tech, /* NFA_DM_API_SET_P2P_LISTEN_TECH_EVT */ 64 nfa_dm_act_start_rf_discovery, /* NFA_DM_API_START_RF_DISCOVERY_EVT */ 65 nfa_dm_act_stop_rf_discovery, /* NFA_DM_API_STOP_RF_DISCOVERY_EVT */ 66 nfa_dm_act_set_rf_disc_duration, /* NFA_DM_API_SET_RF_DISC_DURATION_EVT */ 67 nfa_dm_act_select, /* NFA_DM_API_SELECT_EVT */ 68 nfa_dm_act_update_rf_params, /* NFA_DM_API_UPDATE_RF_PARAMS_EVT */ 69 nfa_dm_act_deactivate, /* NFA_DM_API_DEACTIVATE_EVT */ 70 nfa_dm_act_power_off_sleep, /* NFA_DM_API_POWER_OFF_SLEEP_EVT */ 71 nfa_dm_ndef_reg_hdlr, /* NFA_DM_API_REG_NDEF_HDLR_EVT */ 72 nfa_dm_ndef_dereg_hdlr, /* NFA_DM_API_DEREG_NDEF_HDLR_EVT */ 73 nfa_dm_act_reg_vsc, /* NFA_DM_API_REG_VSC_EVT */ 74 nfa_dm_act_send_vsc, /* NFA_DM_API_SEND_VSC_EVT */ 75 nfa_dm_act_disable_timeout /* NFA_DM_TIMEOUT_DISABLE_EVT */ 76}; 77 78/***************************************************************************** 79** Local function prototypes 80*****************************************************************************/ 81#if (BT_TRACE_VERBOSE == TRUE) 82static char* nfa_dm_evt_2_str(uint16_t event); 83#endif 84/******************************************************************************* 85** 86** Function nfa_dm_init 87** 88** Description Initialises the NFC device manager 89** 90** Returns void 91** 92*******************************************************************************/ 93void nfa_dm_init(void) { 94 NFA_TRACE_DEBUG0("nfa_dm_init ()"); 95 memset(&nfa_dm_cb, 0, sizeof(tNFA_DM_CB)); 96 nfa_dm_cb.poll_disc_handle = NFA_HANDLE_INVALID; 97 nfa_dm_cb.disc_cb.disc_duration = NFA_DM_DISC_DURATION_POLL; 98 nfa_dm_cb.nfcc_pwr_mode = NFA_DM_PWR_MODE_FULL; 99 100 /* register message handler on NFA SYS */ 101 nfa_sys_register(NFA_ID_DM, &nfa_dm_sys_reg); 102} 103 104/******************************************************************************* 105** 106** Function nfa_dm_evt_hdlr 107** 108** Description Event handling function for DM 109** 110** 111** Returns void 112** 113*******************************************************************************/ 114bool nfa_dm_evt_hdlr(NFC_HDR* p_msg) { 115 bool freebuf = true; 116 uint16_t event = p_msg->event & 0x00ff; 117 118#if (BT_TRACE_VERBOSE == TRUE) 119 NFA_TRACE_EVENT2("nfa_dm_evt_hdlr event: %s (0x%02x)", 120 nfa_dm_evt_2_str(event), event); 121#else 122 NFA_TRACE_EVENT1("nfa_dm_evt_hdlr event: 0x%x", event); 123#endif 124 125 /* execute action functions */ 126 if (event < NFA_DM_NUM_ACTIONS) { 127 freebuf = (*nfa_dm_action[event])((tNFA_DM_MSG*)p_msg); 128 } 129 return freebuf; 130} 131 132/******************************************************************************* 133** 134** Function nfa_dm_sys_disable 135** 136** Description This function is called after all subsystems have been 137** disabled. 138** 139** Returns void 140** 141*******************************************************************************/ 142void nfa_dm_sys_disable(void) { 143 /* Disable the DM sub-system */ 144 /* If discovery state is not IDLE or DEACTIVATED and graceful disable, */ 145 /* then we need to deactivate link or stop discovery */ 146 147 if (nfa_sys_is_graceful_disable()) { 148 if ((nfa_dm_cb.disc_cb.disc_state == NFA_DM_RFST_IDLE) && 149 ((nfa_dm_cb.disc_cb.disc_flags & NFA_DM_DISC_FLAGS_DISABLING) == 0)) { 150 /* discovery is not started */ 151 nfa_dm_disable_complete(); 152 } else { 153 /* probably waiting to be disabled */ 154 NFA_TRACE_WARNING2("DM disc_state state = %d disc_flags:0x%x", 155 nfa_dm_cb.disc_cb.disc_state, 156 nfa_dm_cb.disc_cb.disc_flags); 157 } 158 159 } else { 160 nfa_dm_disable_complete(); 161 } 162} 163 164/******************************************************************************* 165** 166** Function nfa_dm_is_protocol_supported 167** 168** Description Check if protocol is supported by RW module 169** 170** Returns TRUE if protocol is supported by NFA 171** 172*******************************************************************************/ 173bool nfa_dm_is_protocol_supported(tNFC_PROTOCOL protocol, uint8_t sel_res) { 174 return ( 175 (protocol == NFC_PROTOCOL_T1T) || 176 ((protocol == NFC_PROTOCOL_T2T) && 177 (sel_res == NFC_SEL_RES_NFC_FORUM_T2T)) || 178 (protocol == NFC_PROTOCOL_T3T) || (protocol == NFC_PROTOCOL_ISO_DEP) || 179 (protocol == NFC_PROTOCOL_NFC_DEP) || (protocol == NFC_PROTOCOL_15693)); 180} 181/******************************************************************************* 182** 183** Function nfa_dm_is_active 184** 185** Description check if all modules of NFA is done with enable process and 186** NFA is not restoring NFCC. 187** 188** Returns TRUE, if NFA_DM_ENABLE_EVT is reported and it is not 189** restoring NFCC 190** 191*******************************************************************************/ 192bool nfa_dm_is_active(void) { 193 NFA_TRACE_DEBUG1("nfa_dm_is_active () flags:0x%x", nfa_dm_cb.flags); 194 if ((nfa_dm_cb.flags & NFA_DM_FLAGS_DM_IS_ACTIVE) && 195 ((nfa_dm_cb.flags & 196 (NFA_DM_FLAGS_ENABLE_EVT_PEND | NFA_DM_FLAGS_NFCC_IS_RESTORING | 197 NFA_DM_FLAGS_POWER_OFF_SLEEP)) == 0)) { 198 return true; 199 } else 200 return false; 201} 202/******************************************************************************* 203** 204** Function nfa_dm_check_set_config 205** 206** Description Update config parameters only if it's different from NFCC 207** 208** 209** Returns tNFA_STATUS 210** 211*******************************************************************************/ 212tNFA_STATUS nfa_dm_check_set_config(uint8_t tlv_list_len, uint8_t* p_tlv_list, 213 bool app_init) { 214 uint8_t type, len, *p_value, *p_stored, max_len; 215 uint8_t xx = 0, updated_len = 0, *p_cur_len; 216 bool update; 217 tNFC_STATUS nfc_status; 218 uint32_t cur_bit; 219 220 NFA_TRACE_DEBUG0("nfa_dm_check_set_config ()"); 221 222 /* We only allow 32 pending SET_CONFIGs */ 223 if (nfa_dm_cb.setcfg_pending_num >= NFA_DM_SETCONFIG_PENDING_MAX) { 224 NFA_TRACE_ERROR0( 225 "nfa_dm_check_set_config () error: pending number of SET_CONFIG " 226 "exceeded"); 227 return NFA_STATUS_FAILED; 228 } 229 230 while (tlv_list_len - xx >= 2) /* at least type and len */ 231 { 232 update = false; 233 type = *(p_tlv_list + xx); 234 len = *(p_tlv_list + xx + 1); 235 p_value = p_tlv_list + xx + 2; 236 p_cur_len = NULL; 237 238 switch (type) { 239 /* 240 ** Poll F Configuration 241 */ 242 case NFC_PMID_PF_RC: 243 p_stored = nfa_dm_cb.params.pf_rc; 244 max_len = NCI_PARAM_LEN_PF_RC; 245 break; 246 case NFC_PMID_TOTAL_DURATION: 247 p_stored = nfa_dm_cb.params.total_duration; 248 max_len = NCI_PARAM_LEN_TOTAL_DURATION; 249 break; 250 251 /* 252 ** Listen A Configuration 253 */ 254 case NFC_PMID_LA_BIT_FRAME_SDD: 255 p_stored = nfa_dm_cb.params.la_bit_frame_sdd; 256 max_len = NCI_PARAM_LEN_LA_BIT_FRAME_SDD; 257 p_cur_len = &nfa_dm_cb.params.la_bit_frame_sdd_len; 258 break; 259 case NFC_PMID_LA_PLATFORM_CONFIG: 260 p_stored = nfa_dm_cb.params.la_platform_config; 261 max_len = NCI_PARAM_LEN_LA_PLATFORM_CONFIG; 262 p_cur_len = &nfa_dm_cb.params.la_platform_config_len; 263 break; 264 case NFC_PMID_LA_SEL_INFO: 265 p_stored = nfa_dm_cb.params.la_sel_info; 266 max_len = NCI_PARAM_LEN_LA_SEL_INFO; 267 p_cur_len = &nfa_dm_cb.params.la_sel_info_len; 268 break; 269 case NFC_PMID_LA_NFCID1: 270 p_stored = nfa_dm_cb.params.la_nfcid1; 271 max_len = NCI_NFCID1_MAX_LEN; 272 p_cur_len = &nfa_dm_cb.params.la_nfcid1_len; 273 break; 274 case NFC_PMID_LA_HIST_BY: 275 p_stored = nfa_dm_cb.params.la_hist_by; 276 max_len = NCI_MAX_HIS_BYTES_LEN; 277 p_cur_len = &nfa_dm_cb.params.la_hist_by_len; 278 break; 279 280 /* 281 ** Listen B Configuration 282 */ 283 case NFC_PMID_LB_SENSB_INFO: 284 p_stored = nfa_dm_cb.params.lb_sensb_info; 285 max_len = NCI_PARAM_LEN_LB_SENSB_INFO; 286 p_cur_len = &nfa_dm_cb.params.lb_sensb_info_len; 287 break; 288 case NFC_PMID_LB_NFCID0: 289 p_stored = nfa_dm_cb.params.lb_nfcid0; 290 max_len = NCI_PARAM_LEN_LB_NFCID0; 291 p_cur_len = &nfa_dm_cb.params.lb_nfcid0_len; 292 break; 293 case NFC_PMID_LB_APPDATA: 294 p_stored = nfa_dm_cb.params.lb_appdata; 295 max_len = NCI_PARAM_LEN_LB_APPDATA; 296 p_cur_len = &nfa_dm_cb.params.lb_appdata_len; 297 break; 298 case NFC_PMID_LB_ADC_FO: 299 p_stored = nfa_dm_cb.params.lb_adc_fo; 300 max_len = NCI_PARAM_LEN_LB_ADC_FO; 301 p_cur_len = &nfa_dm_cb.params.lb_adc_fo_len; 302 break; 303 case NFC_PMID_LB_H_INFO: 304 p_stored = nfa_dm_cb.params.lb_h_info; 305 max_len = NCI_MAX_ATTRIB_LEN; 306 p_cur_len = &nfa_dm_cb.params.lb_h_info_len; 307 break; 308 309 /* 310 ** Listen F Configuration 311 */ 312 case NFC_PMID_LF_PROTOCOL: 313 p_stored = nfa_dm_cb.params.lf_protocol; 314 max_len = NCI_PARAM_LEN_LF_PROTOCOL; 315 p_cur_len = &nfa_dm_cb.params.lf_protocol_len; 316 break; 317 case NFC_PMID_LF_T3T_FLAGS2: 318 p_stored = nfa_dm_cb.params.lf_t3t_flags2; 319 max_len = NCI_PARAM_LEN_LF_T3T_FLAGS2; 320 p_cur_len = &nfa_dm_cb.params.lf_t3t_flags2_len; 321 break; 322 case NFC_PMID_LF_T3T_PMM: 323 p_stored = nfa_dm_cb.params.lf_t3t_pmm; 324 max_len = NCI_PARAM_LEN_LF_T3T_PMM; 325 break; 326 327 /* 328 ** ISO-DEP and NFC-DEP Configuration 329 */ 330 case NFC_PMID_FWI: 331 p_stored = nfa_dm_cb.params.fwi; 332 max_len = NCI_PARAM_LEN_FWI; 333 break; 334 case NFC_PMID_WT: 335 p_stored = nfa_dm_cb.params.wt; 336 max_len = NCI_PARAM_LEN_WT; 337 break; 338 case NFC_PMID_ATR_REQ_GEN_BYTES: 339 p_stored = nfa_dm_cb.params.atr_req_gen_bytes; 340 max_len = NCI_MAX_GEN_BYTES_LEN; 341 p_cur_len = &nfa_dm_cb.params.atr_req_gen_bytes_len; 342 break; 343 case NFC_PMID_ATR_RES_GEN_BYTES: 344 p_stored = nfa_dm_cb.params.atr_res_gen_bytes; 345 max_len = NCI_MAX_GEN_BYTES_LEN; 346 p_cur_len = &nfa_dm_cb.params.atr_res_gen_bytes_len; 347 break; 348 default: 349 /* 350 ** Listen F Configuration 351 */ 352 if ((type >= NFC_PMID_LF_T3T_ID1) && 353 (type < NFC_PMID_LF_T3T_ID1 + NFA_CE_LISTEN_INFO_MAX)) { 354 p_stored = nfa_dm_cb.params.lf_t3t_id[type - NFC_PMID_LF_T3T_ID1]; 355 max_len = NCI_PARAM_LEN_LF_T3T_ID; 356 } else { 357 /* we don't stored this config items */ 358 update = true; 359 p_stored = NULL; 360 } 361 break; 362 } 363 364 if ((p_stored) && (len <= max_len)) { 365 if (p_cur_len) { 366 if (*p_cur_len != len) { 367 *p_cur_len = len; 368 update = true; 369 } else if (memcmp(p_value, p_stored, len)) { 370 update = true; 371 } 372 } else if (len == max_len) /* fixed length */ 373 { 374 if (memcmp(p_value, p_stored, len)) { 375 update = true; 376 } 377 } 378 } 379 380 if (update) { 381 /* we don't store this type */ 382 if (p_stored) { 383 memcpy(p_stored, p_value, len); 384 } 385 386 /* If need to change TLV in the original list. (Do not modify list if 387 * app_init) */ 388 if ((updated_len != xx) && (!app_init)) { 389 memcpy(p_tlv_list + updated_len, p_tlv_list + xx, (len + 2)); 390 } 391 updated_len += (len + 2); 392 } 393 xx += len + 2; /* move to next TLV */ 394 } 395 396 /* If any TVLs to update, or if the SetConfig was initiated by the 397 * application, then send the SET_CONFIG command */ 398 if (updated_len || app_init) { 399 nfc_status = NFC_SetConfig(updated_len, p_tlv_list); 400 if (nfc_status == NFC_STATUS_OK) { 401 /* Keep track of whether we will need to notify NFA_DM_SET_CONFIG_EVT on 402 * NFC_SET_CONFIG_REVT */ 403 404 /* Get the next available bit offset for this setconfig (based on how many 405 * SetConfigs are outstanding) */ 406 cur_bit = (uint32_t)(1 << nfa_dm_cb.setcfg_pending_num); 407 408 /* If setconfig is due to NFA_SetConfig: then set the bit 409 * (NFA_DM_SET_CONFIG_EVT needed on NFC_SET_CONFIG_REVT) */ 410 if (app_init) { 411 nfa_dm_cb.setcfg_pending_mask |= cur_bit; 412 } 413 /* Otherwise setconfig is internal: clear the bit (NFA_DM_SET_CONFIG_EVT 414 not needed on NFC_SET_CONFIG_REVT) */ 415 else { 416 nfa_dm_cb.setcfg_pending_mask &= ~cur_bit; 417 } 418 419 /* Increment setcfg_pending counter */ 420 nfa_dm_cb.setcfg_pending_num++; 421 } 422 return (nfc_status); 423 424 } else { 425 return NFA_STATUS_OK; 426 } 427} 428 429#if (BT_TRACE_VERBOSE == TRUE) 430/******************************************************************************* 431** 432** Function nfa_dm_nfc_revt_2_str 433** 434** Description convert nfc revt to string 435** 436*******************************************************************************/ 437static char* nfa_dm_evt_2_str(uint16_t event) { 438 switch (NFA_SYS_EVT_START(NFA_ID_DM) | event) { 439 case NFA_DM_API_ENABLE_EVT: 440 return "NFA_DM_API_ENABLE_EVT"; 441 442 case NFA_DM_API_DISABLE_EVT: 443 return "NFA_DM_API_DISABLE_EVT"; 444 445 case NFA_DM_API_SET_CONFIG_EVT: 446 return "NFA_DM_API_SET_CONFIG_EVT"; 447 448 case NFA_DM_API_GET_CONFIG_EVT: 449 return "NFA_DM_API_GET_CONFIG_EVT"; 450 451 case NFA_DM_API_REQUEST_EXCL_RF_CTRL_EVT: 452 return "NFA_DM_API_REQUEST_EXCL_RF_CTRL_EVT"; 453 454 case NFA_DM_API_RELEASE_EXCL_RF_CTRL_EVT: 455 return "NFA_DM_API_RELEASE_EXCL_RF_CTRL_EVT"; 456 457 case NFA_DM_API_ENABLE_POLLING_EVT: 458 return "NFA_DM_API_ENABLE_POLLING_EVT"; 459 460 case NFA_DM_API_DISABLE_POLLING_EVT: 461 return "NFA_DM_API_DISABLE_POLLING_EVT"; 462 463 case NFA_DM_API_ENABLE_LISTENING_EVT: 464 return "NFA_DM_API_ENABLE_LISTENING_EVT"; 465 466 case NFA_DM_API_DISABLE_LISTENING_EVT: 467 return "NFA_DM_API_DISABLE_LISTENING_EVT"; 468 469 case NFA_DM_API_PAUSE_P2P_EVT: 470 return "NFA_DM_API_PAUSE_P2P_EVT"; 471 472 case NFA_DM_API_RESUME_P2P_EVT: 473 return "NFA_DM_API_RESUME_P2P_EVT"; 474 475 case NFA_DM_API_RAW_FRAME_EVT: 476 return "NFA_DM_API_RAW_FRAME_EVT"; 477 478 case NFA_DM_API_SET_P2P_LISTEN_TECH_EVT: 479 return "NFA_DM_API_SET_P2P_LISTEN_TECH_EVT"; 480 481 case NFA_DM_API_START_RF_DISCOVERY_EVT: 482 return "NFA_DM_API_START_RF_DISCOVERY_EVT"; 483 484 case NFA_DM_API_STOP_RF_DISCOVERY_EVT: 485 return "NFA_DM_API_STOP_RF_DISCOVERY_EVT"; 486 487 case NFA_DM_API_SET_RF_DISC_DURATION_EVT: 488 return "NFA_DM_API_SET_RF_DISC_DURATION_EVT"; 489 490 case NFA_DM_API_SELECT_EVT: 491 return "NFA_DM_API_SELECT_EVT"; 492 493 case NFA_DM_API_UPDATE_RF_PARAMS_EVT: 494 return "NFA_DM_API_UPDATE_RF_PARAMS_EVT"; 495 496 case NFA_DM_API_DEACTIVATE_EVT: 497 return "NFA_DM_API_DEACTIVATE_EVT"; 498 499 case NFA_DM_API_POWER_OFF_SLEEP_EVT: 500 return "NFA_DM_API_POWER_OFF_SLEEP_EVT"; 501 502 case NFA_DM_API_REG_NDEF_HDLR_EVT: 503 return "NFA_DM_API_REG_NDEF_HDLR_EVT"; 504 505 case NFA_DM_API_DEREG_NDEF_HDLR_EVT: 506 return "NFA_DM_API_DEREG_NDEF_HDLR_EVT"; 507 508 case NFA_DM_TIMEOUT_DISABLE_EVT: 509 return "NFA_DM_TIMEOUT_DISABLE_EVT"; 510 } 511 512 return "Unknown or Vendor Specific"; 513} 514#endif /* BT_TRACE_VERBOSE */ 515