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