/******************************************************************************* ** ** Function nfa_p2p_sys_disable ** ** Description Deregister NFA P2P from NFA SYS/DM ** ** ** Returns None ** *******************************************************************************/ static void nfa_p2p_sys_disable (void) { P2P_TRACE_DEBUG0 ("nfa_p2p_sys_disable()"); nfa_sys_stop_timer (&nfa_p2p_cb.active_listen_restore_timer); /* deregister message handler on NFA SYS */ nfa_sys_deregister (NFA_ID_P2P); }
/******************************************************************************* ** ** Function nfa_p2p_set_config ** ** Description Set General bytes and WT parameters for LLCP ** ** ** Returns void ** *******************************************************************************/ void nfa_p2p_set_config (tNFA_DM_DISC_TECH_PROTO_MASK disc_mask) { UINT8 wt, gen_bytes_len = LLCP_MAX_GEN_BYTES; UINT8 params[LLCP_MAX_GEN_BYTES + 5], *p, length; P2P_TRACE_DEBUG0 ("nfa_p2p_set_config ()"); LLCP_GetDiscoveryConfig (&wt, params + 2, &gen_bytes_len); if (nfa_dm_is_p2p_paused ()) { gen_bytes_len = 0; } if (disc_mask & ( NFA_DM_DISC_MASK_PA_NFC_DEP |NFA_DM_DISC_MASK_PF_NFC_DEP |NFA_DM_DISC_MASK_PAA_NFC_DEP |NFA_DM_DISC_MASK_PFA_NFC_DEP) ) { p = params; UINT8_TO_BE_STREAM (p, NFC_PMID_ATR_REQ_GEN_BYTES); UINT8_TO_BE_STREAM (p, gen_bytes_len); p += gen_bytes_len; length = gen_bytes_len + 2; nfa_dm_check_set_config (length, params, FALSE); } if (disc_mask & ( NFA_DM_DISC_MASK_LA_NFC_DEP |NFA_DM_DISC_MASK_LF_NFC_DEP |NFA_DM_DISC_MASK_LAA_NFC_DEP |NFA_DM_DISC_MASK_LFA_NFC_DEP) ) { p = params; UINT8_TO_BE_STREAM (p, NFC_PMID_ATR_RES_GEN_BYTES); UINT8_TO_BE_STREAM (p, gen_bytes_len); p += gen_bytes_len; length = gen_bytes_len + 2; UINT8_TO_BE_STREAM (p, NFC_PMID_WT); UINT8_TO_BE_STREAM (p, NCI_PARAM_LEN_WT); UINT8_TO_BE_STREAM (p, wt); length += 3; nfa_dm_check_set_config (length, params, FALSE); } }
/******************************************************************************* ** ** Function nfa_p2p_init ** ** Description Initialize NFA P2P ** ** ** Returns None ** *******************************************************************************/ void nfa_p2p_init (void) { UINT8 xx; P2P_TRACE_DEBUG0 ("nfa_p2p_init ()"); /* initialize control block */ memset (&nfa_p2p_cb, 0, sizeof (tNFA_P2P_CB)); nfa_p2p_cb.dm_disc_handle = NFA_HANDLE_INVALID; nfa_p2p_cb.trace_level = APPL_INITIAL_TRACE_LEVEL; for (xx = 0; xx < LLCP_MAX_SDP_TRANSAC; xx++) { nfa_p2p_cb.sdp_cb[xx].local_sap = LLCP_INVALID_SAP; } /* register message handler on NFA SYS */ nfa_sys_register (NFA_ID_P2P, &nfa_p2p_sys_reg); }
/******************************************************************************* ** ** Function nfa_p2p_activate_llcp ** ** Description Activate LLCP link ** ** ** Returns None ** *******************************************************************************/ void nfa_p2p_activate_llcp (tNFC_DISCOVER *p_data) { tLLCP_ACTIVATE_CONFIG config; P2P_TRACE_DEBUG0 ("nfa_p2p_activate_llcp ()"); if ( (p_data->activate.rf_tech_param.mode == NFC_DISCOVERY_TYPE_POLL_A) ||(p_data->activate.rf_tech_param.mode == NFC_DISCOVERY_TYPE_POLL_F) ||(p_data->activate.rf_tech_param.mode == NFC_DISCOVERY_TYPE_POLL_A_ACTIVE) ||(p_data->activate.rf_tech_param.mode == NFC_DISCOVERY_TYPE_POLL_F_ACTIVE) ) { config.is_initiator = TRUE; } else { config.is_initiator = FALSE; } if ( (p_data->activate.rf_tech_param.mode == NFC_DISCOVERY_TYPE_POLL_A_ACTIVE) ||(p_data->activate.rf_tech_param.mode == NFC_DISCOVERY_TYPE_POLL_F_ACTIVE) ||(p_data->activate.rf_tech_param.mode == NFC_DISCOVERY_TYPE_LISTEN_A_ACTIVE) ||(p_data->activate.rf_tech_param.mode == NFC_DISCOVERY_TYPE_LISTEN_F_ACTIVE) ) { nfa_p2p_cb.is_active_mode = TRUE; } else { nfa_p2p_cb.is_active_mode = FALSE; } nfa_p2p_cb.is_initiator = config.is_initiator; config.max_payload_size = p_data->activate.intf_param.intf_param.pa_nfc.max_payload_size; config.waiting_time = p_data->activate.intf_param.intf_param.pa_nfc.waiting_time; config.p_gen_bytes = p_data->activate.intf_param.intf_param.pa_nfc.gen_bytes; config.gen_bytes_len = p_data->activate.intf_param.intf_param.pa_nfc.gen_bytes_len; LLCP_ActivateLink (config, nfa_p2p_llcp_link_cback); }
/******************************************************************************* ** ** Function nfa_p2p_deactivate_llcp ** ** Description Deactivate LLCP link ** ** ** Returns None ** *******************************************************************************/ void nfa_p2p_deactivate_llcp (void) { P2P_TRACE_DEBUG0 ("nfa_p2p_deactivate_llcp ()"); LLCP_DeactivateLink (); }
/******************************************************************************* ** ** Function nfa_p2p_llcp_link_cback ** ** Description Processing event from LLCP link management callback ** ** ** Returns None ** *******************************************************************************/ void nfa_p2p_llcp_link_cback (UINT8 event, UINT8 reason) { tNFA_LLCP_ACTIVATED llcp_activated; tNFA_LLCP_DEACTIVATED llcp_deactivated; P2P_TRACE_DEBUG2 ("nfa_p2p_llcp_link_cback () event:0x%x, reason:0x%x", event, reason); if (event == LLCP_LINK_ACTIVATION_COMPLETE_EVT) { LLCP_GetLinkMIU (&nfa_p2p_cb.local_link_miu, &nfa_p2p_cb.remote_link_miu); nfa_p2p_cb.llcp_state = NFA_P2P_LLCP_STATE_ACTIVATED; if (nfa_p2p_cb.is_initiator) { /* notify NFA DM to send Activate Event to applicaiton with status */ nfa_dm_notify_activation_status (NFA_STATUS_OK, NULL); } llcp_activated.is_initiator = nfa_p2p_cb.is_initiator; llcp_activated.local_link_miu = nfa_p2p_cb.local_link_miu; llcp_activated.remote_link_miu = nfa_p2p_cb.remote_link_miu; llcp_activated.remote_lsc = LLCP_GetRemoteLSC (); llcp_activated.remote_wks = LLCP_GetRemoteWKS (); nfa_dm_act_conn_cback_notify (NFA_LLCP_ACTIVATED_EVT, (tNFA_CONN_EVT_DATA *) &llcp_activated); } else if (event == LLCP_LINK_ACTIVATION_FAILED_EVT) { nfa_p2p_cb.llcp_state = NFA_P2P_LLCP_STATE_IDLE; if (nfa_p2p_cb.is_initiator) { /* notify NFA DM to send Activate Event to applicaiton with status */ nfa_dm_notify_activation_status (NFA_STATUS_FAILED, NULL); } nfa_dm_rf_deactivate (NFA_DEACTIVATE_TYPE_DISCOVERY); } else if (event == LLCP_LINK_FIRST_PACKET_RECEIVED_EVT) { nfa_dm_act_conn_cback_notify (NFA_LLCP_FIRST_PACKET_RECEIVED_EVT, NULL); } else /* LLCP_LINK_DEACTIVATED_EVT */ { nfa_p2p_cb.llcp_state = NFA_P2P_LLCP_STATE_IDLE; /* if got RF link loss without any rx LLC PDU */ if (reason == LLCP_LINK_RF_LINK_LOSS_NO_RX_LLC) { /* if it was active listen mode */ if ( (nfa_p2p_cb.is_active_mode) &&(!nfa_p2p_cb.is_initiator)) { /* if it didn't retry without active listen mode and passive mode is available */ if ( (nfa_p2p_cb.listen_tech_mask_to_restore == 0x00) &&(nfa_p2p_cb.listen_tech_mask & ( NFA_TECHNOLOGY_MASK_A |NFA_TECHNOLOGY_MASK_F))) { P2P_TRACE_DEBUG0 ("Retry without active listen mode"); /* retry without active listen mode */ nfa_p2p_update_active_listen (); } } else if (nfa_p2p_cb.listen_tech_mask_to_restore) { nfa_sys_start_timer (&nfa_p2p_cb.active_listen_restore_timer, 0, NFA_P2P_RESTORE_ACTIVE_LISTEN_TIMEOUT); } reason = LLCP_LINK_RF_LINK_LOSS_ERR; } else { if (nfa_p2p_cb.listen_tech_mask_to_restore) { /* restore active listen mode */ nfa_p2p_update_active_listen (); } } llcp_deactivated.reason = reason; nfa_dm_act_conn_cback_notify (NFA_LLCP_DEACTIVATED_EVT, (tNFA_CONN_EVT_DATA *)&llcp_deactivated); if (reason != LLCP_LINK_RF_LINK_LOSS_ERR) /* if NFC link is still up */ { if (nfa_p2p_cb.is_initiator) { nfa_dm_rf_deactivate (NFA_DEACTIVATE_TYPE_DISCOVERY); } else if ((nfa_p2p_cb.is_active_mode) && (reason == LLCP_LINK_TIMEOUT)) { /* ** target needs to trun off RF in case of receiving invalid frame from initiator */ P2P_TRACE_DEBUG0 ("Got LLCP_LINK_TIMEOUT in active mode on target"); nfa_dm_rf_deactivate (NFA_DEACTIVATE_TYPE_DISCOVERY); } } } }
/******************************************************************************* ** ** Function nfa_p2p_enable_listening ** ** Description Configure listen technologies and protocols for LLCP ** If LLCP WKS is changed then LLCP Gen bytes will be updated. ** ** Returns void ** *******************************************************************************/ void nfa_p2p_enable_listening (tNFA_SYS_ID sys_id, BOOLEAN update_wks) { tNFA_DM_DISC_TECH_PROTO_MASK p2p_listen_mask = 0; P2P_TRACE_DEBUG2 ("nfa_p2p_enable_listening () sys_id = %d, update_wks = %d", sys_id, update_wks); if (sys_id == NFA_ID_P2P) nfa_p2p_cb.is_p2p_listening = TRUE; else if (sys_id == NFA_ID_CHO) nfa_p2p_cb.is_cho_listening = TRUE; else if (sys_id == NFA_ID_SNEP) nfa_p2p_cb.is_snep_listening = TRUE; if (nfa_p2p_cb.dm_disc_handle != NFA_HANDLE_INVALID) { /* if need to update WKS in LLCP Gen bytes */ if (update_wks) { /* update LLCP Gen Bytes */ nfa_p2p_set_config (NFA_DM_DISC_MASK_PA_NFC_DEP|NFA_DM_DISC_MASK_LA_NFC_DEP); } return; } /* collect listen technologies with NFC-DEP protocol */ if (nfa_p2p_cb.listen_tech_mask & NFA_TECHNOLOGY_MASK_A) p2p_listen_mask |= NFA_DM_DISC_MASK_LA_NFC_DEP; if (nfa_p2p_cb.listen_tech_mask & NFA_TECHNOLOGY_MASK_F) p2p_listen_mask |= NFA_DM_DISC_MASK_LF_NFC_DEP; if (nfa_p2p_cb.listen_tech_mask & NFA_TECHNOLOGY_MASK_A_ACTIVE) p2p_listen_mask |= NFA_DM_DISC_MASK_LAA_NFC_DEP; if (nfa_p2p_cb.listen_tech_mask & NFA_TECHNOLOGY_MASK_F_ACTIVE) p2p_listen_mask |= NFA_DM_DISC_MASK_LFA_NFC_DEP; if (p2p_listen_mask) { #if(NFC_NXP_NOT_OPEN_INCLUDED == TRUE) /*For P2P mode(Default DTA mode) open Raw channel to bypass LLCP layer. For LLCP DTA mode activate LLCP * Bypassing LLCP is handled in nfa_dm_poll_disc_cback*/ if ((appl_dta_mode_flag == 1) && (nfa_dm_cb.eDtaMode == NFA_DTA_DEFAULT_MODE)) { /* Configure listen technologies and protocols and register callback to NFA DM discovery */ P2P_TRACE_DEBUG0 ("DTA mode2:Registering nfa_dm_poll_disc_cback to avoid LLCP in P2P "); nfa_p2p_cb.dm_disc_handle = nfa_dm_add_rf_discover (p2p_listen_mask, NFA_DM_DISC_HOST_ID_DH, nfa_dm_poll_disc_cback_dta_wrapper); } else #endif { /* Configure listen technologies and protocols and register callback to NFA DM discovery */ nfa_p2p_cb.dm_disc_handle = nfa_dm_add_rf_discover (p2p_listen_mask, NFA_DM_DISC_HOST_ID_DH, nfa_p2p_discovery_cback); } } }
/******************************************************************************* ** ** Function nfa_p2p_update_active_listen ** ** Description Remove active listen mode temporarily or restore it ** ** ** Returns None ** *******************************************************************************/ static void nfa_p2p_update_active_listen (void) { tNFA_DM_DISC_TECH_PROTO_MASK p2p_listen_mask = 0; BT_HDR *p_msg; P2P_TRACE_DEBUG1 ("nfa_p2p_update_active_listen (): listen_tech_mask_to_restore:0x%x", nfa_p2p_cb.listen_tech_mask_to_restore); /* if active listen mode was removed temporarily */ if (nfa_p2p_cb.listen_tech_mask_to_restore) { /* restore listen technologies */ nfa_p2p_cb.listen_tech_mask = nfa_p2p_cb.listen_tech_mask_to_restore; nfa_p2p_cb.listen_tech_mask_to_restore = 0; nfa_sys_stop_timer (&nfa_p2p_cb.active_listen_restore_timer); } else { /* start timer in case of no passive activation */ nfa_p2p_cb.active_listen_restore_timer.p_cback = (TIMER_CBACK *)nfa_p2p_update_active_listen_timeout_cback; nfa_sys_start_timer (&nfa_p2p_cb.active_listen_restore_timer, 0, NFA_P2P_RESTORE_ACTIVE_LISTEN_TIMEOUT); /* save listen techonologies */ nfa_p2p_cb.listen_tech_mask_to_restore = nfa_p2p_cb.listen_tech_mask; /* remove active listen mode */ nfa_p2p_cb.listen_tech_mask &= ~( NFA_TECHNOLOGY_MASK_A_ACTIVE|NFA_TECHNOLOGY_MASK_F_ACTIVE); } if (nfa_p2p_cb.dm_disc_handle != NFA_HANDLE_INVALID) { nfa_dm_delete_rf_discover (nfa_p2p_cb.dm_disc_handle); nfa_p2p_cb.dm_disc_handle = NFA_HANDLE_INVALID; } /* collect listen technologies with NFC-DEP protocol */ if (nfa_p2p_cb.listen_tech_mask & NFA_TECHNOLOGY_MASK_A) p2p_listen_mask |= NFA_DM_DISC_MASK_LA_NFC_DEP; if (nfa_p2p_cb.listen_tech_mask & NFA_TECHNOLOGY_MASK_F) p2p_listen_mask |= NFA_DM_DISC_MASK_LF_NFC_DEP; if (nfa_p2p_cb.listen_tech_mask & NFA_TECHNOLOGY_MASK_A_ACTIVE) p2p_listen_mask |= NFA_DM_DISC_MASK_LAA_NFC_DEP; if (nfa_p2p_cb.listen_tech_mask & NFA_TECHNOLOGY_MASK_F_ACTIVE) p2p_listen_mask |= NFA_DM_DISC_MASK_LFA_NFC_DEP; #if(NFC_NXP_NOT_OPEN_INCLUDED == TRUE) /*For P2P mode(Default DTA mode) open Raw channel to bypass LLCP layer. For LLCP DTA mode activate LLCP * Bypassing LLCP is handled in nfa_dm_poll_disc_cback*/ if ((appl_dta_mode_flag == 1) && (nfa_dm_cb.eDtaMode == NFA_DTA_DEFAULT_MODE)) { /* Configure listen technologies and protocols and register callback to NFA DM discovery */ P2P_TRACE_DEBUG0 ("DTA mode1:Registering nfa_dm_poll_disc_cback to avoid LLCP in P2P "); nfa_p2p_cb.dm_disc_handle = nfa_dm_add_rf_discover (p2p_listen_mask, NFA_DM_DISC_HOST_ID_DH, nfa_dm_poll_disc_cback_dta_wrapper); } else #endif { /* Configure listen technologies and protocols and register callback to NFA DM discovery */ nfa_p2p_cb.dm_disc_handle = nfa_dm_add_rf_discover (p2p_listen_mask, NFA_DM_DISC_HOST_ID_DH, nfa_p2p_discovery_cback); } /* restart RF discovery to update RF technologies */ if ((p_msg = (BT_HDR *) GKI_getbuf (sizeof(BT_HDR))) != NULL) { p_msg->event = NFA_P2P_INT_RESTART_RF_DISC_EVT; nfa_sys_sendmsg (p_msg); } }