nfa_dm_main.c revision e9df6ba5a8fcccf306a80b1670b423be8fe7746a
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*****************************************************************************/
35static 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
44tNFA_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 */
50typedef BOOLEAN (*tNFA_DM_ACTION) (tNFA_DM_MSG *p_data);
51
52/* action function list */
53const 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)
84static 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*******************************************************************************/
95void 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*******************************************************************************/
117BOOLEAN 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*******************************************************************************/
145void 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*******************************************************************************/
181BOOLEAN 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*******************************************************************************/
200BOOLEAN 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*******************************************************************************/
220tNFA_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*******************************************************************************/
449static 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