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 *****************************************************************************/
34 static 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
38 tNFA_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 */
45 typedef bool (*tNFA_DM_ACTION)(tNFA_DM_MSG* p_data);
46
47 /* action function list */
48 const 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)
82 static 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 *******************************************************************************/
nfa_dm_init(void)93 void 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 *******************************************************************************/
nfa_dm_evt_hdlr(NFC_HDR * p_msg)114 bool 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 *******************************************************************************/
nfa_dm_sys_disable(void)142 void 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 *******************************************************************************/
nfa_dm_is_protocol_supported(tNFC_PROTOCOL protocol,uint8_t sel_res)173 bool 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 *******************************************************************************/
nfa_dm_is_active(void)192 bool 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 *******************************************************************************/
nfa_dm_check_set_config(uint8_t tlv_list_len,uint8_t * p_tlv_list,bool app_init)212 tNFA_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 *******************************************************************************/
nfa_dm_evt_2_str(uint16_t event)437 static 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