/*******************************************************************************
**
** Function llcp_sdp_proc_deactivation
**
** Description Report SDP failure for any pending request because of deactivation
**
**
** Returns void
**
*******************************************************************************/
void llcp_sdp_proc_deactivation (void)
{
UINT8 i;
LLCP_TRACE_DEBUG0 ("llcp_sdp_proc_deactivation ()");
for (i = 0; i < LLCP_MAX_SDP_TRANSAC; i++)
{
if (llcp_cb.sdp_cb.transac[i].p_cback)
{
(*llcp_cb.sdp_cb.transac[i].p_cback) (llcp_cb.sdp_cb.transac[i].tid, 0x00);
llcp_cb.sdp_cb.transac[i].p_cback = NULL;
}
}
/* free any pending SNL PDU */
if (llcp_cb.sdp_cb.p_snl)
{
GKI_freebuf (llcp_cb.sdp_cb.p_snl);
llcp_cb.sdp_cb.p_snl = NULL;
}
llcp_cb.sdp_cb.next_tid = 0;
#if(NFC_NXP_NOT_OPEN_INCLUDED == TRUE)
llcp_cb.dta_snl_resp = FALSE;
#endif
}
/*******************************************************************************
**
** Function llcp_sdp_check_send_snl
**
** Description Enqueue Service Name Lookup PDU into sig_xmit_q for transmitting
**
**
** Returns void
**
*******************************************************************************/
void llcp_sdp_check_send_snl (void)
{
UINT8 *p;
if (llcp_cb.sdp_cb.p_snl)
{
LLCP_TRACE_DEBUG0 ("SDP: llcp_sdp_check_send_snl ()");
llcp_cb.sdp_cb.p_snl->len += LLCP_PDU_HEADER_SIZE;
llcp_cb.sdp_cb.p_snl->offset -= LLCP_PDU_HEADER_SIZE;
p = (UINT8 *) (llcp_cb.sdp_cb.p_snl + 1) + llcp_cb.sdp_cb.p_snl->offset;
UINT16_TO_BE_STREAM (p, LLCP_GET_PDU_HEADER (LLCP_SAP_SDP, LLCP_PDU_SNL_TYPE, LLCP_SAP_SDP ));
GKI_enqueue (&llcp_cb.lcb.sig_xmit_q, llcp_cb.sdp_cb.p_snl);
llcp_cb.sdp_cb.p_snl = NULL;
}
#if(NFC_NXP_NOT_OPEN_INCLUDED == TRUE)
else
{
/* Notify DTA after sending out SNL with SDRES not to send SNLs in AGF PDU */
if ((llcp_cb.p_dta_cback) && (llcp_cb.dta_snl_resp))
{
llcp_cb.dta_snl_resp = FALSE;
(*llcp_cb.p_dta_cback) ();
}
}
#endif
}
/*******************************************************************************
**
** Function llcp_sdp_proc_deactivation
**
** Description Report SDP failure for any pending request because of deactivation
**
**
** Returns void
**
*******************************************************************************/
void llcp_sdp_proc_deactivation (void)
{
UINT8 i;
LLCP_TRACE_DEBUG0 ("llcp_sdp_proc_deactivation ()");
for (i = 0; i < LLCP_MAX_SDP_TRANSAC; i++)
{
if (llcp_cb.sdp_cb.transac[i].p_cback)
{
(*llcp_cb.sdp_cb.transac[i].p_cback) (llcp_cb.sdp_cb.transac[i].tid, 0x00);
llcp_cb.sdp_cb.transac[i].p_cback = NULL;
}
}
/* free any pending SNL PDU */
if (llcp_cb.sdp_cb.p_snl)
{
GKI_freebuf (llcp_cb.sdp_cb.p_snl);
llcp_cb.sdp_cb.p_snl = NULL;
}
llcp_cb.sdp_cb.next_tid = 0;
}
/*******************************************************************************
**
** Function llcp_init
**
** Description This function is called once at startup to initialize
** all the LLCP structures
**
** Returns void
**
*******************************************************************************/
void llcp_init (void)
{
UINT32 pool_count;
memset (&llcp_cb, 0, sizeof (tLLCP_CB));
llcp_cb.trace_level = LLCP_INITIAL_TRACE_LEVEL;
LLCP_TRACE_DEBUG0 ("LLCP - llcp_init ()");
llcp_cb.lcb.local_link_miu = (LLCP_MIU <= LLCP_MAX_MIU ? LLCP_MIU : LLCP_MAX_MIU);
llcp_cb.lcb.local_opt = LLCP_OPT_VALUE;
llcp_cb.lcb.local_wt = LLCP_WAITING_TIME;
llcp_cb.lcb.local_lto = LLCP_LTO_VALUE;
llcp_cb.lcb.inact_timeout_init = LLCP_INIT_INACTIVITY_TIMEOUT;
llcp_cb.lcb.inact_timeout_target = LLCP_TARGET_INACTIVITY_TIMEOUT;
llcp_cb.lcb.symm_delay = LLCP_DELAY_RESP_TIME;
llcp_cb.lcb.data_link_timeout = LLCP_DATA_LINK_CONNECTION_TOUT;
llcp_cb.lcb.delay_first_pdu_timeout = LLCP_DELAY_TIME_TO_SEND_FIRST_PDU;
llcp_cb.lcb.wks = LLCP_WKS_MASK_LM;
/* total number of buffers for LLCP */
pool_count = GKI_poolcount (LLCP_POOL_ID);
/* number of buffers for receiving data */
llcp_cb.num_rx_buff = (pool_count * LLCP_RX_BUFF_RATIO) / 100;
/* rx congestion start/end threshold */
llcp_cb.overall_rx_congest_start = (UINT8) ((llcp_cb.num_rx_buff * LLCP_RX_CONGEST_START) / 100);
llcp_cb.overall_rx_congest_end = (UINT8) ((llcp_cb.num_rx_buff * LLCP_RX_CONGEST_END) / 100);
/* max number of buffers for receiving data on logical data link */
llcp_cb.max_num_ll_rx_buff = (UINT8) ((llcp_cb.num_rx_buff * LLCP_LL_RX_BUFF_LIMIT) / 100);
LLCP_TRACE_DEBUG4 ("num_rx_buff = %d, rx_congest_start = %d, rx_congest_end = %d, max_num_ll_rx_buff = %d",
llcp_cb.num_rx_buff, llcp_cb.overall_rx_congest_start,
llcp_cb.overall_rx_congest_end, llcp_cb.max_num_ll_rx_buff);
/* max number of buffers for transmitting data */
llcp_cb.max_num_tx_buff = (UINT8) (pool_count - llcp_cb.num_rx_buff);
/* max number of buffers for transmitting data on logical data link */
llcp_cb.max_num_ll_tx_buff = (UINT8) ((llcp_cb.max_num_tx_buff * LLCP_LL_TX_BUFF_LIMIT) / 100);
LLCP_TRACE_DEBUG2 ("max_num_tx_buff = %d, max_num_ll_tx_buff = %d",
llcp_cb.max_num_tx_buff, llcp_cb.max_num_ll_tx_buff);
llcp_cb.ll_tx_uncongest_ntf_start_sap = LLCP_SAP_SDP + 1;
LLCP_RegisterServer (LLCP_SAP_SDP, LLCP_LINK_TYPE_DATA_LINK_CONNECTION, "urn:nfc:sn:sdp", llcp_sdp_proc_data);
}
/*******************************************************************************
**
** Function llcp_sdp_check_send_snl
**
** Description Enqueue Service Name Lookup PDU into sig_xmit_q for transmitting
**
**
** Returns void
**
*******************************************************************************/
void llcp_sdp_check_send_snl (void)
{
UINT8 *p;
if (llcp_cb.sdp_cb.p_snl)
{
LLCP_TRACE_DEBUG0 ("SDP: llcp_sdp_check_send_snl ()");
llcp_cb.sdp_cb.p_snl->len += LLCP_PDU_HEADER_SIZE;
llcp_cb.sdp_cb.p_snl->offset -= LLCP_PDU_HEADER_SIZE;
p = (UINT8 *) (llcp_cb.sdp_cb.p_snl + 1) + llcp_cb.sdp_cb.p_snl->offset;
UINT16_TO_BE_STREAM (p, LLCP_GET_PDU_HEADER (LLCP_SAP_SDP, LLCP_PDU_SNL_TYPE, LLCP_SAP_SDP ));
GKI_enqueue (&llcp_cb.lcb.sig_xmit_q, llcp_cb.sdp_cb.p_snl);
llcp_cb.sdp_cb.p_snl = NULL;
}
}
/*******************************************************************************
**
** Function llcp_cleanup
**
** Description This function is called once at closing to clean up
**
** Returns void
**
*******************************************************************************/
void llcp_cleanup (void)
{
UINT8 sap;
tLLCP_APP_CB *p_app_cb;
LLCP_TRACE_DEBUG0 ("LLCP - llcp_cleanup ()");
for (sap = LLCP_SAP_SDP; sap < LLCP_NUM_SAPS; sap++)
{
p_app_cb = llcp_util_get_app_cb (sap);
if ( (p_app_cb)
&&(p_app_cb->p_app_cback) )
{
LLCP_Deregister (sap);
}
}
nfc_stop_quick_timer (&llcp_cb.lcb.inact_timer);
nfc_stop_quick_timer (&llcp_cb.lcb.timer);
}
/*******************************************************************************
**
** Function llcp_sdp_proc_snl
**
** Description Process SDREQ and SDRES in SNL
**
**
** Returns LLCP_STATUS
**
*******************************************************************************/
tLLCP_STATUS llcp_sdp_proc_snl (UINT16 sdu_length, UINT8 *p)
{
UINT8 type, length, tid, sap, *p_value;
LLCP_TRACE_DEBUG0 ("llcp_sdp_proc_snl ()");
if ((llcp_cb.lcb.agreed_major_version < LLCP_MIN_SNL_MAJOR_VERSION)||
((llcp_cb.lcb.agreed_major_version == LLCP_MIN_SNL_MAJOR_VERSION)&&(llcp_cb.lcb.agreed_minor_version < LLCP_MIN_SNL_MINOR_VERSION)))
{
LLCP_TRACE_DEBUG0 ("llcp_sdp_proc_snl(): version number less than 1.1, SNL not supported.");
return LLCP_STATUS_FAIL;
}
while (sdu_length >= 2) /* at least type and length */
{
BE_STREAM_TO_UINT8 (type, p);
BE_STREAM_TO_UINT8 (length, p);
switch (type)
{
case LLCP_SDREQ_TYPE:
if ( (length > 1) /* TID and sevice name */
&&(sdu_length >= 2 + length) ) /* type, length, TID and service name */
{
p_value = p;
BE_STREAM_TO_UINT8 (tid, p_value);
sap = llcp_sdp_get_sap_by_name ((char*) p_value, (UINT8) (length - 1));
llcp_sdp_send_sdres (tid, sap);
}
else
{
LLCP_TRACE_ERROR1 ("llcp_sdp_proc_snl (): bad length (%d) in LLCP_SDREQ_TYPE", length);
}
break;
case LLCP_SDRES_TYPE:
if ( (length == LLCP_SDRES_LEN) /* TID and SAP */
&&(sdu_length >= 2 + length) ) /* type, length, TID and SAP */
{
p_value = p;
BE_STREAM_TO_UINT8 (tid, p_value);
BE_STREAM_TO_UINT8 (sap, p_value);
llcp_sdp_return_sap (tid, sap);
}
else
{
LLCP_TRACE_ERROR1 ("llcp_sdp_proc_snl (): bad length (%d) in LLCP_SDRES_TYPE", length);
}
break;
default:
LLCP_TRACE_WARNING1 ("llcp_sdp_proc_snl (): Unknown type (0x%x) is ignored", type);
break;
}
if (sdu_length >= 2 + length) /* type, length, value */
{
sdu_length -= 2 + length;
p += length;
}
else
{
break;
}
}
if (sdu_length)
{
LLCP_TRACE_ERROR0 ("llcp_sdp_proc_snl (): Bad format of SNL");
return LLCP_STATUS_FAIL;
}
else
{
return LLCP_STATUS_SUCCESS;
}
}
