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