xref: /system/nfc/src/nfa/p2p/nfa_p2p_act.c

/******************************************************************************
 *
 *  Copyright (C) 2010-2012 Broadcom Corporation
 *
 *  Licensed under the Apache License, Version 2.0 (the "License");
 *  you may not use this file except in compliance with the License.
 *  You may obtain a copy of the License at:
 *
 *  http://www.apache.org/licenses/LICENSE-2.0
 *
 *  Unless required by applicable law or agreed to in writing, software
 *  distributed under the License is distributed on an "AS IS" BASIS,
 *  WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 *  See the License for the specific language governing permissions and
 *  limitations under the License.
 *
 ******************************************************************************/

/******************************************************************************
 *
 *  This is the implementation file for the NFA P2P.
 *
 ******************************************************************************/

#include "string.h"
#include "nfc_api.h"
#include "nfa_sys.h"
#include "nfa_sys_int.h"
#include "nfa_dm_int.h"
#include "llcp_defs.h"
#include "llcp_api.h"
#include "nfa_p2p_api.h"
#include "nfa_p2p_int.h"

/*****************************************************************************
**  Global Variables
*****************************************************************************/

/*****************************************************************************
**  Static Functions
*****************************************************************************/

/*****************************************************************************
**  Constants
*****************************************************************************/

/*******************************************************************************
**
** Function         nfa_p2p_allocate_conn_cb
**
** Description      Allocate data link connection control block
**
**
** Returns          UINT8
**
*******************************************************************************/
static UINT8 nfa_p2p_allocate_conn_cb (UINT8 local_sap)
{
    UINT8 xx;

    for (xx = 0; xx < LLCP_MAX_DATA_LINK; xx++)
    {
        if (nfa_p2p_cb.conn_cb[xx].flags == 0)
        {
            nfa_p2p_cb.conn_cb[xx].flags |= NFA_P2P_CONN_FLAG_IN_USE;
            nfa_p2p_cb.conn_cb[xx].local_sap = local_sap;

            return (xx);
        }
    }

    P2P_TRACE_ERROR0 ("nfa_p2p_allocate_conn_cb (): No resource");

    return LLCP_MAX_DATA_LINK;
}

/*******************************************************************************
**
** Function         nfa_p2p_deallocate_conn_cb
**
** Description      Deallocate data link connection control block
**
**
** Returns          void
**
*******************************************************************************/
static void nfa_p2p_deallocate_conn_cb (UINT8 xx)
{
    if (xx < LLCP_MAX_DATA_LINK)
    {
        nfa_p2p_cb.conn_cb[xx].flags = 0;
    }
    else
    {
        P2P_TRACE_ERROR1 ("nfa_p2p_deallocate_conn_cb (): Invalid index (%d)", xx);
    }
}

/*******************************************************************************
**
** Function         nfa_p2p_find_conn_cb
**
** Description      Find data link connection control block by local/remote SAP
**
**
** Returns          UINT8
**
*******************************************************************************/
static UINT8 nfa_p2p_find_conn_cb (UINT8 local_sap, UINT8 remote_sap)
{
    UINT8 xx;

    for (xx = 0; xx < LLCP_MAX_DATA_LINK; xx++)
    {
        if (  (nfa_p2p_cb.conn_cb[xx].flags & NFA_P2P_CONN_FLAG_IN_USE)
            &&(nfa_p2p_cb.conn_cb[xx].local_sap == local_sap)
            &&(nfa_p2p_cb.conn_cb[xx].remote_sap == remote_sap)  )
        {
            return (xx);
        }
    }

    return (LLCP_MAX_DATA_LINK);
}

/*******************************************************************************
**
** Function         nfa_p2p_llcp_cback
**
** Description      Processing SAP callback events from LLCP
**
**
** Returns          None
**
*******************************************************************************/
static void nfa_p2p_llcp_cback (tLLCP_SAP_CBACK_DATA *p_data)
{
    P2P_TRACE_DEBUG2 ("nfa_p2p_llcp_cback (): event:0x%02X, local_sap:0x%02X", p_data->hdr.event, p_data->hdr.local_sap);

    switch (p_data->hdr.event)
    {
    case LLCP_SAP_EVT_DATA_IND:
         nfa_p2p_proc_llcp_data_ind (p_data);
        break;

    case LLCP_SAP_EVT_CONNECT_IND:
        nfa_p2p_proc_llcp_connect_ind (p_data);
        break;

    case LLCP_SAP_EVT_CONNECT_RESP:
        nfa_p2p_proc_llcp_connect_resp (p_data);
        break;

    case LLCP_SAP_EVT_DISCONNECT_IND:
        nfa_p2p_proc_llcp_disconnect_ind (p_data);
        break;

    case LLCP_SAP_EVT_DISCONNECT_RESP:
        nfa_p2p_proc_llcp_disconnect_resp (p_data);
        break;

    case LLCP_SAP_EVT_CONGEST:
        nfa_p2p_proc_llcp_congestion (p_data);
        break;

    case LLCP_SAP_EVT_LINK_STATUS:
        nfa_p2p_proc_llcp_link_status (p_data);
        break;

    default:
        P2P_TRACE_ERROR1 ("nfa_p2p_llcp_cback (): Unknown event:0x%02X", p_data->hdr.event);
        return;
    }
}

/*******************************************************************************
**
** Function         nfa_p2p_sdp_cback
**
** Description      Process SDP callback event from LLCP
**
**
** Returns          None
**
*******************************************************************************/
void nfa_p2p_sdp_cback (UINT8 tid, UINT8 remote_sap)
{
    UINT8             local_sap;
    UINT8             xx;
    tNFA_P2P_EVT_DATA evt_data;

    P2P_TRACE_DEBUG2 ("nfa_p2p_sdp_cback (): tid:0x%02X, remote_sap:0x%02X", tid, remote_sap);

    /* search for callback function to process */
    for (xx = 0; xx < LLCP_MAX_SDP_TRANSAC; xx++)
    {
        if (  (nfa_p2p_cb.sdp_cb[xx].local_sap != LLCP_INVALID_SAP)
            &&(nfa_p2p_cb.sdp_cb[xx].tid == tid)  )
        {
            local_sap = nfa_p2p_cb.sdp_cb[xx].local_sap;

            evt_data.sdp.handle     = (NFA_HANDLE_GROUP_P2P | local_sap);
            evt_data.sdp.remote_sap = remote_sap;
            nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_SDP_EVT, &evt_data);

            nfa_p2p_cb.sdp_cb[xx].local_sap = LLCP_INVALID_SAP;
            break;
        }
    }
}

/*******************************************************************************
**
** Function         nfa_p2p_start_sdp
**
** Description      Initiate SDP
**
**
** Returns          TRUE if success
**
*******************************************************************************/
BOOLEAN nfa_p2p_start_sdp (char *p_service_name, UINT8 local_sap)
{
    int xx;

    P2P_TRACE_DEBUG1 ("nfa_p2p_start_sdp (): SN:<%s>", p_service_name);

    /* search for empty slot */
    for (xx = 0; xx < LLCP_MAX_SDP_TRANSAC; xx++)
    {
        if (nfa_p2p_cb.sdp_cb[xx].local_sap == LLCP_INVALID_SAP)
        {
            if (LLCP_DiscoverService (p_service_name,
                                      nfa_p2p_sdp_cback,
                                      &(nfa_p2p_cb.sdp_cb[xx].tid)) == LLCP_STATUS_SUCCESS)
            {
                nfa_p2p_cb.sdp_cb[xx].local_sap    = local_sap;
                return TRUE;
            }
            else
            {
                /* failure of SDP */
                return FALSE;
            }
        }
    }
    return FALSE;
}

/*******************************************************************************
**
** Function         nfa_p2p_proc_llcp_data_ind
**
** Description      Processing incoming data event from LLCP
**
**
** Returns          None
**
*******************************************************************************/
void nfa_p2p_proc_llcp_data_ind (tLLCP_SAP_CBACK_DATA  *p_data)
{
    UINT8             local_sap, xx;
    tNFA_P2P_EVT_DATA evt_data;

    P2P_TRACE_DEBUG0 ("nfa_p2p_proc_llcp_data_ind ()");

    local_sap = p_data->data_ind.local_sap;

    if (nfa_p2p_cb.sap_cb[local_sap].p_cback)
    {
        evt_data.data.handle    = 0;
        /* if connectionless */
        if (p_data->data_ind.link_type == NFA_P2P_LLINK_TYPE)
        {
            evt_data.data.handle = (NFA_HANDLE_GROUP_P2P | local_sap);
        }
        else
        {
            xx = nfa_p2p_find_conn_cb (p_data->data_ind.local_sap,
                                       p_data->data_ind.remote_sap);

            if (xx != LLCP_MAX_DATA_LINK)
            {
                evt_data.data.handle = (NFA_HANDLE_GROUP_P2P | NFA_P2P_HANDLE_FLAG_CONN | xx);
            }
        }

        evt_data.data.remote_sap = p_data->data_ind.remote_sap;
        evt_data.data.link_type  = p_data->data_ind.link_type;

        /* notify upper layer that there are data at LLCP */
        nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_DATA_EVT, &evt_data);
    }
}

/*******************************************************************************
**
** Function         nfa_p2p_proc_llcp_connect_ind
**
** Description      Processing connection request from peer
**
**
** Returns          None
**
*******************************************************************************/
void nfa_p2p_proc_llcp_connect_ind (tLLCP_SAP_CBACK_DATA  *p_data)
{
    UINT8             server_sap, local_sap;
    tNFA_P2P_EVT_DATA evt_data;
    UINT8             xx;

    P2P_TRACE_DEBUG1 ("nfa_p2p_proc_llcp_connect_ind () server_sap:0x%x",
                       p_data->connect_ind.server_sap);

    server_sap = p_data->connect_ind.server_sap;
    local_sap  = p_data->connect_ind.local_sap;

    if (nfa_p2p_cb.sap_cb[server_sap].p_cback)
    {
        xx = nfa_p2p_allocate_conn_cb (server_sap);

        if (xx != LLCP_MAX_DATA_LINK)
        {
            nfa_p2p_cb.conn_cb[xx].remote_sap = p_data->connect_ind.remote_sap;
            nfa_p2p_cb.conn_cb[xx].remote_miu = p_data->connect_ind.miu;

            /* peer will not receive any data */
            if (p_data->connect_ind.rw == 0)
                nfa_p2p_cb.conn_cb[xx].flags |= NFA_P2P_CONN_FLAG_REMOTE_RW_ZERO;

            evt_data.conn_req.server_handle = (NFA_HANDLE_GROUP_P2P | server_sap);
            evt_data.conn_req.conn_handle   = (NFA_HANDLE_GROUP_P2P | NFA_P2P_HANDLE_FLAG_CONN | xx);
            evt_data.conn_req.remote_sap    = p_data->connect_ind.remote_sap;
            evt_data.conn_req.remote_miu    = p_data->connect_ind.miu;
            evt_data.conn_req.remote_rw     = p_data->connect_ind.rw;

            nfa_p2p_cb.sap_cb[server_sap].p_cback (NFA_P2P_CONN_REQ_EVT, &evt_data);
        }
    }
    else
    {
        P2P_TRACE_ERROR0 ("nfa_p2p_proc_llcp_connect_ind (): Not registered");
    }
}

/*******************************************************************************
**
** Function         nfa_p2p_proc_llcp_connect_resp
**
** Description      Processing connection response from peer
**
**
** Returns          None
**
*******************************************************************************/
void nfa_p2p_proc_llcp_connect_resp (tLLCP_SAP_CBACK_DATA  *p_data)
{
    UINT8             local_sap, xx;
    tNFA_P2P_EVT_DATA evt_data;

    P2P_TRACE_DEBUG0 ("nfa_p2p_proc_llcp_connect_resp ()");

    local_sap  = p_data->connect_resp.local_sap;

    if (nfa_p2p_cb.sap_cb[local_sap].p_cback)
    {
        xx = nfa_p2p_allocate_conn_cb (local_sap);

        if (xx != LLCP_MAX_DATA_LINK)
        {
            nfa_p2p_cb.conn_cb[xx].remote_sap = p_data->connect_resp.remote_sap;
            nfa_p2p_cb.conn_cb[xx].remote_miu = p_data->connect_resp.miu;

            /* peer will not receive any data */
            if (p_data->connect_resp.rw == 0)
                nfa_p2p_cb.conn_cb[xx].flags |= NFA_P2P_CONN_FLAG_REMOTE_RW_ZERO;

            evt_data.connected.client_handle = (NFA_HANDLE_GROUP_P2P | local_sap);
            evt_data.connected.conn_handle   = (NFA_HANDLE_GROUP_P2P | NFA_P2P_HANDLE_FLAG_CONN | xx);
            evt_data.connected.remote_sap    = p_data->connect_resp.remote_sap;
            evt_data.connected.remote_miu    = p_data->connect_resp.miu;
            evt_data.connected.remote_rw     = p_data->connect_resp.rw;

            nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_CONNECTED_EVT, &evt_data);
        }
    }
}

/*******************************************************************************
**
** Function         nfa_p2p_proc_llcp_disconnect_ind
**
** Description      Processing disconnection request from peer
**
**
** Returns          None
**
*******************************************************************************/
void nfa_p2p_proc_llcp_disconnect_ind (tLLCP_SAP_CBACK_DATA  *p_data)
{
    UINT8             local_sap, xx;
    tNFA_P2P_EVT_DATA evt_data;

    P2P_TRACE_DEBUG0 ("nfa_p2p_proc_llcp_disconnect_ind ()");

    local_sap  = p_data->disconnect_ind.local_sap;

    if (nfa_p2p_cb.sap_cb[local_sap].p_cback)
    {
        xx = nfa_p2p_find_conn_cb (p_data->disconnect_ind.local_sap,
                                   p_data->disconnect_ind.remote_sap);

        if (xx != LLCP_MAX_DATA_LINK)
        {
            evt_data.disc.handle = (NFA_HANDLE_GROUP_P2P | NFA_P2P_HANDLE_FLAG_CONN | xx);
            evt_data.disc.reason = NFA_P2P_DISC_REASON_REMOTE_INITIATE;

            nfa_p2p_deallocate_conn_cb (xx);

            nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_DISC_EVT, &evt_data);
        }
        else
        {
            /*
            ** LLCP link has been deactivated before receiving CC or DM.
            ** Return NFA_P2P_DISC_EVT to indicate failure of creating connection
            */

            evt_data.disc.handle = (NFA_HANDLE_GROUP_P2P | local_sap);
            evt_data.disc.reason = NFA_P2P_DISC_REASON_LLCP_DEACTIVATED;

            nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_DISC_EVT, &evt_data);

            P2P_TRACE_ERROR0 ("nfa_p2p_proc_llcp_disconnect_ind (): Link deactivated");
        }
    }
}

/*******************************************************************************
**
** Function         nfa_p2p_proc_llcp_disconnect_resp
**
** Description      Processing rejected connection from peer
**
**
** Returns          None
**
*******************************************************************************/
void nfa_p2p_proc_llcp_disconnect_resp (tLLCP_SAP_CBACK_DATA  *p_data)
{
    UINT8             local_sap, xx;
    tNFA_P2P_EVT_DATA evt_data;

    P2P_TRACE_DEBUG0 ("nfa_p2p_proc_llcp_disconnect_resp ()");

    local_sap  = p_data->disconnect_resp.local_sap;

    if (nfa_p2p_cb.sap_cb[local_sap].p_cback)
    {
        if (p_data->disconnect_resp.reason == LLCP_SAP_DM_REASON_RESP_DISC)
        {
            evt_data.disc.reason = NFA_P2P_DISC_REASON_LOCAL_INITITATE;
        }
        else if (  (p_data->disconnect_resp.reason == LLCP_SAP_DM_REASON_APP_REJECTED)
                 ||(p_data->disconnect_resp.reason == LLCP_SAP_DM_REASON_PERM_REJECT_THIS)
                 ||(p_data->disconnect_resp.reason == LLCP_SAP_DM_REASON_PERM_REJECT_ANY)
                 ||(p_data->disconnect_resp.reason == LLCP_SAP_DM_REASON_TEMP_REJECT_THIS)
                 ||(p_data->disconnect_resp.reason == LLCP_SAP_DM_REASON_TEMP_REJECT_ANY)  )
        {
            evt_data.disc.reason = NFA_P2P_DISC_REASON_REMOTE_REJECT;
        }
        else if (p_data->disconnect_resp.reason == LLCP_SAP_DM_REASON_NO_SERVICE)
        {
            evt_data.disc.reason = NFA_P2P_DISC_REASON_NO_SERVICE;
        }
        else if (p_data->disconnect_resp.reason == LLCP_SAP_DM_REASON_NO_ACTIVE_CONNECTION)
        {
            evt_data.disc.reason = NFA_P2P_DISC_REASON_LLCP_DEACTIVATED;
        }
        else
        {
            evt_data.disc.reason = NFA_P2P_DISC_REASON_NO_INFORMATION;
        }

        if (evt_data.disc.reason == NFA_P2P_DISC_REASON_LOCAL_INITITATE)
        {
            xx = nfa_p2p_find_conn_cb (p_data->disconnect_resp.local_sap,
                                       p_data->disconnect_resp.remote_sap);

            if (xx != LLCP_MAX_DATA_LINK)
            {
                evt_data.disc.handle = (NFA_HANDLE_GROUP_P2P | NFA_P2P_HANDLE_FLAG_CONN | xx);

                nfa_p2p_deallocate_conn_cb (xx);

                nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_DISC_EVT, &evt_data);
            }
            else
            {
                P2P_TRACE_ERROR0 ("nfa_p2p_proc_llcp_disconnect_resp (): No connection found");
            }
        }
        else
        {
            evt_data.disc.handle = (NFA_HANDLE_GROUP_P2P | local_sap);
            nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_DISC_EVT, &evt_data);
        }
    }
}

/*******************************************************************************
**
** Function         nfa_p2p_proc_llcp_congest
**
** Description      Processing LLCP congestion event
**
**
** Returns          None
**
*******************************************************************************/
void nfa_p2p_proc_llcp_congestion (tLLCP_SAP_CBACK_DATA  *p_data)
{
    UINT8             local_sap, remote_sap, xx;
    tNFA_P2P_EVT_DATA evt_data;

    local_sap  = p_data->congest.local_sap;
    remote_sap = p_data->congest.remote_sap;

    evt_data.congest.link_type    = p_data->congest.link_type;
    evt_data.congest.is_congested = p_data->congest.is_congested;

    if (p_data->congest.is_congested)
    {
        P2P_TRACE_DEBUG2 ("nfa_p2p_proc_llcp_congestion () START SAP=(0x%x,0x%x)",
                          local_sap, remote_sap);

    }
    else
    {
        P2P_TRACE_DEBUG2 ("nfa_p2p_proc_llcp_congestion () END SAP=(0x%x,0x%x)",
                          local_sap, remote_sap);
    }

    if (nfa_p2p_cb.sap_cb[local_sap].p_cback)
    {
        if (evt_data.congest.link_type == NFA_P2P_LLINK_TYPE)
        {
            evt_data.congest.handle = (NFA_HANDLE_GROUP_P2P | local_sap);

            if (  (evt_data.congest.is_congested == FALSE)
                &&(nfa_p2p_cb.sap_cb[local_sap].flags & NFA_P2P_SAP_FLAG_LLINK_CONGESTED)  )
            {
                nfa_p2p_cb.sap_cb[local_sap].flags &= ~NFA_P2P_SAP_FLAG_LLINK_CONGESTED;
                nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_CONGEST_EVT, &evt_data);
            }
            else if (  (evt_data.congest.is_congested == TRUE)
                     &&(!(nfa_p2p_cb.sap_cb[local_sap].flags & NFA_P2P_SAP_FLAG_LLINK_CONGESTED))  )
            {
                /* this is overall congestion due to high usage of buffer pool */
                nfa_p2p_cb.sap_cb[local_sap].flags |= NFA_P2P_SAP_FLAG_LLINK_CONGESTED;
                nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_CONGEST_EVT, &evt_data);
            }
        }
        else
        {
            xx = nfa_p2p_find_conn_cb (local_sap, remote_sap);

            if (xx != LLCP_MAX_DATA_LINK)
            {
                evt_data.congest.handle = (NFA_HANDLE_GROUP_P2P | NFA_P2P_HANDLE_FLAG_CONN | xx);

                if (  (evt_data.congest.is_congested == FALSE)
                    &&(nfa_p2p_cb.conn_cb[xx].flags & NFA_P2P_CONN_FLAG_CONGESTED)  )
                {
                    nfa_p2p_cb.conn_cb[xx].flags &= ~NFA_P2P_CONN_FLAG_CONGESTED;
                    nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_CONGEST_EVT, &evt_data);
                }
                else if (  (evt_data.congest.is_congested == TRUE)
                         &&(!(nfa_p2p_cb.conn_cb[xx].flags & NFA_P2P_CONN_FLAG_CONGESTED))  )
                {
                    /* this is overall congestion due to high usage of buffer pool */
                    nfa_p2p_cb.conn_cb[xx].flags |= NFA_P2P_CONN_FLAG_CONGESTED;
                    nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_CONGEST_EVT, &evt_data);
                }
            }
            else
            {
                P2P_TRACE_ERROR0 ("nfa_p2p_proc_llcp_congestion (): No connection found");
            }
        }
    }
}

/*******************************************************************************
**
** Function         nfa_p2p_proc_llcp_link_status
**
** Description      Processing LLCP link status
**
**
** Returns          next state after processing this event
**
*******************************************************************************/
void nfa_p2p_proc_llcp_link_status (tLLCP_SAP_CBACK_DATA  *p_data)
{
    UINT8             local_sap, xx;
    tNFA_P2P_EVT_DATA evt_data;

    P2P_TRACE_DEBUG1 ("nfa_p2p_proc_llcp_link_status () is_activated:%d",
                       p_data->link_status.is_activated);

    local_sap  = p_data->link_status.local_sap;

    if (nfa_p2p_cb.sap_cb[local_sap].p_cback)
    {
        if (p_data->link_status.is_activated)
        {
            /* only for server */
            evt_data.activated.handle           = (NFA_HANDLE_GROUP_P2P | local_sap);
            evt_data.activated.local_link_miu   = nfa_p2p_cb.local_link_miu;
            evt_data.activated.remote_link_miu  = nfa_p2p_cb.remote_link_miu;

            nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_ACTIVATED_EVT, &evt_data);
        }
        else /* if LLCP link is deactivated */
        {
            for (xx = 0; xx < LLCP_MAX_DATA_LINK; xx++)
            {
                if (  (nfa_p2p_cb.conn_cb[xx].flags & NFA_P2P_CONN_FLAG_IN_USE)
                    &&(nfa_p2p_cb.conn_cb[xx].local_sap == local_sap))
                {
                    evt_data.disc.handle = (NFA_HANDLE_GROUP_P2P | NFA_P2P_HANDLE_FLAG_CONN | xx);
                    evt_data.disc.reason = NFA_P2P_DISC_REASON_LLCP_DEACTIVATED;

                    nfa_p2p_deallocate_conn_cb (xx);
                    nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_DISC_EVT, &evt_data);
                }
            }

            /* notify deactivation and clear flags */
            if (nfa_p2p_cb.sap_cb[local_sap].flags & NFA_P2P_SAP_FLAG_SERVER)
            {
                evt_data.deactivated.handle = (NFA_HANDLE_GROUP_P2P | local_sap);
                nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_DEACTIVATED_EVT, &evt_data);

                nfa_p2p_cb.sap_cb[local_sap].flags = NFA_P2P_SAP_FLAG_SERVER;
            }
            else if (nfa_p2p_cb.sap_cb[local_sap].flags & NFA_P2P_SAP_FLAG_CLIENT)
            {
                evt_data.deactivated.handle = (NFA_HANDLE_GROUP_P2P | local_sap);
                nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_DEACTIVATED_EVT, &evt_data);

                nfa_p2p_cb.sap_cb[local_sap].flags = NFA_P2P_SAP_FLAG_CLIENT;
            }
            else /* if this is not registered service */
            {
                nfa_p2p_cb.sap_cb[local_sap].p_cback = NULL;
            }
        }
    }
}

/*******************************************************************************
**
** Function         nfa_p2p_reg_server
**
** Description      Allocate a service as server and register to LLCP
**
**
** Returns          FALSE if need to keep buffer
**
*******************************************************************************/
BOOLEAN nfa_p2p_reg_server (tNFA_P2P_MSG *p_msg)
{
    tNFA_P2P_EVT_DATA  evt_data;
    UINT8              server_sap;

    P2P_TRACE_DEBUG0 ("nfa_p2p_reg_server ()");

    server_sap = LLCP_RegisterServer (p_msg->api_reg_server.server_sap,
                                      p_msg->api_reg_server.link_type,
                                      p_msg->api_reg_server.service_name,
                                      nfa_p2p_llcp_cback);

    if (server_sap == LLCP_INVALID_SAP)
    {
        evt_data.reg_server.server_handle = NFA_HANDLE_INVALID;
        evt_data.reg_server.server_sap    = NFA_P2P_INVALID_SAP;
        BCM_STRNCPY_S (evt_data.reg_server.service_name, sizeof (evt_data.reg_server.service_name),
                       p_msg->api_reg_server.service_name, LLCP_MAX_SN_LEN);
        evt_data.reg_server.service_name[LLCP_MAX_SN_LEN] = 0;

        p_msg->api_reg_server.p_cback (NFA_P2P_REG_SERVER_EVT, &evt_data);

        return TRUE;
    }

    /* if need to update WKS in LLCP Gen bytes */
    if (server_sap <= LLCP_UPPER_BOUND_WK_SAP)
    {
        nfa_p2p_enable_listening (NFA_ID_P2P, TRUE);
    }
    else if (!nfa_p2p_cb.is_p2p_listening)
    {
        nfa_p2p_enable_listening (NFA_ID_P2P, FALSE);
    }

    nfa_p2p_cb.sap_cb[server_sap].p_cback    = p_msg->api_reg_server.p_cback;
    nfa_p2p_cb.sap_cb[server_sap].flags      = NFA_P2P_SAP_FLAG_SERVER;

    evt_data.reg_server.server_handle = (NFA_HANDLE_GROUP_P2P | server_sap);
    evt_data.reg_server.server_sap    = server_sap;
    BCM_STRNCPY_S (evt_data.reg_server.service_name, sizeof (evt_data.reg_server.service_name),
                   p_msg->api_reg_server.service_name, LLCP_MAX_SN_LEN);
    evt_data.reg_server.service_name[LLCP_MAX_SN_LEN] = 0;

    /* notify NFA_P2P_REG_SERVER_EVT to server */
    nfa_p2p_cb.sap_cb[server_sap].p_cback (NFA_P2P_REG_SERVER_EVT, &evt_data);

    /* if LLCP is already activated */
    if (nfa_p2p_cb.llcp_state == NFA_P2P_LLCP_STATE_ACTIVATED)
    {
        evt_data.activated.handle          = (NFA_HANDLE_GROUP_P2P | server_sap);
        evt_data.activated.local_link_miu  = nfa_p2p_cb.local_link_miu;
        evt_data.activated.remote_link_miu = nfa_p2p_cb.remote_link_miu;

        /* notify NFA_P2P_ACTIVATED_EVT to server */
        nfa_p2p_cb.sap_cb[server_sap].p_cback (NFA_P2P_ACTIVATED_EVT, &evt_data);
    }

    return TRUE;
}

/*******************************************************************************
**
** Function         nfa_p2p_reg_client
**
** Description      Allocate a service as client and register to LLCP
**
**
** Returns          TRUE to deallocate buffer
**
*******************************************************************************/
BOOLEAN nfa_p2p_reg_client (tNFA_P2P_MSG *p_msg)
{
    tNFA_P2P_EVT_DATA  evt_data;
    UINT8              local_sap;

    P2P_TRACE_DEBUG0 ("nfa_p2p_reg_client ()");

    local_sap = LLCP_RegisterClient (p_msg->api_reg_client.link_type,
                                     nfa_p2p_llcp_cback);

    if (local_sap == LLCP_INVALID_SAP)
    {
        evt_data.reg_client.client_handle = NFA_HANDLE_INVALID;
        p_msg->api_reg_client.p_cback (NFA_P2P_REG_CLIENT_EVT, &evt_data);
        return TRUE;
    }

    nfa_p2p_cb.sap_cb[local_sap].p_cback = p_msg->api_reg_client.p_cback;
    nfa_p2p_cb.sap_cb[local_sap].flags   = NFA_P2P_SAP_FLAG_CLIENT;

    evt_data.reg_client.client_handle = (NFA_HANDLE_GROUP_P2P | local_sap);
    nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_REG_CLIENT_EVT, &evt_data);

    /* if LLCP is already activated */
    if (nfa_p2p_cb.llcp_state == NFA_P2P_LLCP_STATE_ACTIVATED)
    {
        evt_data.activated.handle           = (NFA_HANDLE_GROUP_P2P | local_sap);
        evt_data.activated.local_link_miu   = nfa_p2p_cb.local_link_miu;
        evt_data.activated.remote_link_miu  = nfa_p2p_cb.remote_link_miu;

        /* notify NFA_P2P_ACTIVATED_EVT to client */
        nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_ACTIVATED_EVT, &evt_data);
    }

    return TRUE;
}

/*******************************************************************************
**
** Function         nfa_p2p_dereg
**
** Description      Deallocate a service as server or client and deregister to LLCP
**                  LLCP will deallocate data link connection created by this server
**
** Returns          TRUE to deallocate buffer
**
*******************************************************************************/
BOOLEAN nfa_p2p_dereg (tNFA_P2P_MSG *p_msg)
{
    UINT8 local_sap, xx;

    P2P_TRACE_DEBUG0 ("nfa_p2p_dereg ()");

    local_sap = (UINT8) (p_msg->api_dereg.handle & NFA_HANDLE_MASK);

    if (nfa_p2p_cb.sap_cb[local_sap].p_cback)
    {
        for (xx = 0; xx < LLCP_MAX_DATA_LINK; xx++)
        {
            if (  (nfa_p2p_cb.conn_cb[xx].flags & NFA_P2P_CONN_FLAG_IN_USE)
                &&(nfa_p2p_cb.conn_cb[xx].local_sap == local_sap)  )
            {
                nfa_p2p_deallocate_conn_cb (xx);
            }
        }
    }

    LLCP_Deregister (local_sap);
    nfa_p2p_cb.sap_cb[local_sap].p_cback = NULL;

    if (nfa_p2p_cb.is_p2p_listening)
    {
        /* check if this is the last server on NFA P2P */
        for (xx = 0; xx < NFA_P2P_NUM_SAP; xx++)
        {
            if (  (nfa_p2p_cb.sap_cb[xx].p_cback)
                &&(nfa_p2p_cb.sap_cb[xx].flags & NFA_P2P_SAP_FLAG_SERVER)  )
            {
                break;
            }
        }

        if (xx >= NFA_P2P_NUM_SAP)
        {
            /* if need to update WKS in LLCP Gen bytes */
            if (local_sap <= LLCP_UPPER_BOUND_WK_SAP)
                nfa_p2p_disable_listening (NFA_ID_P2P, TRUE);
            else
                nfa_p2p_disable_listening (NFA_ID_P2P, FALSE);
        }
        /* if need to update WKS in LLCP Gen bytes */
        else if (local_sap <= LLCP_UPPER_BOUND_WK_SAP)
        {
            nfa_p2p_enable_listening (NFA_ID_P2P, TRUE);
        }
    }

    return TRUE;
}

/*******************************************************************************
**
** Function         nfa_p2p_accept_connection
**
** Description      Connection Confirm from local application
**
**
** Returns          TRUE to deallocate buffer
**
*******************************************************************************/
BOOLEAN nfa_p2p_accept_connection (tNFA_P2P_MSG *p_msg)
{
    UINT8                   xx;
    tLLCP_CONNECTION_PARAMS params;

    P2P_TRACE_DEBUG0 ("nfa_p2p_accept_connection ()");

    xx  = (UINT8) (p_msg->api_accept.conn_handle & NFA_HANDLE_MASK);
    xx &= ~NFA_P2P_HANDLE_FLAG_CONN;

    params.miu   = p_msg->api_accept.miu;
    params.rw    = p_msg->api_accept.rw;
    params.sn[0] = 0;

    LLCP_ConnectCfm (nfa_p2p_cb.conn_cb[xx].local_sap, nfa_p2p_cb.conn_cb[xx].remote_sap, &params);

    return TRUE;
}

/*******************************************************************************
**
** Function         nfa_p2p_reject_connection
**
** Description      Reject connection by local application
**
**
** Returns          TRUE to deallocate buffer
**
*******************************************************************************/
BOOLEAN nfa_p2p_reject_connection (tNFA_P2P_MSG *p_msg)
{
    UINT8 xx;

    P2P_TRACE_DEBUG0 ("nfa_p2p_reject_connection ()");

    xx  = (UINT8) (p_msg->api_reject.conn_handle & NFA_HANDLE_MASK);
    xx &= ~NFA_P2P_HANDLE_FLAG_CONN;

    LLCP_ConnectReject (nfa_p2p_cb.conn_cb[xx].local_sap, nfa_p2p_cb.conn_cb[xx].remote_sap,
                        LLCP_SAP_DM_REASON_APP_REJECTED);

    /* no need to deregister service on LLCP */
    nfa_p2p_deallocate_conn_cb (xx);

    return TRUE;
}

/*******************************************************************************
**
** Function         nfa_p2p_disconnect
**
** Description      Disconnect data link connection by local application
**
**
** Returns          TRUE to deallocate buffer
**
*******************************************************************************/
BOOLEAN nfa_p2p_disconnect (tNFA_P2P_MSG *p_msg)
{
    UINT8             local_sap, xx;
    tLLCP_STATUS      status;
    tNFA_P2P_EVT_DATA evt_data;

    P2P_TRACE_DEBUG0 ("nfa_p2p_disconnect ()");

    xx = (UINT8) (p_msg->api_disconnect.conn_handle & NFA_HANDLE_MASK);

    /* if this is for data link connection */
    if (xx & NFA_P2P_HANDLE_FLAG_CONN)
    {
        xx &= ~NFA_P2P_HANDLE_FLAG_CONN;

        status = LLCP_DisconnectReq (nfa_p2p_cb.conn_cb[xx].local_sap, nfa_p2p_cb.conn_cb[xx].remote_sap,
                                     p_msg->api_disconnect.flush);

        if (status == LLCP_STATUS_SUCCESS)
        {
            /* wait for disconnect response if successful */
            return TRUE;
        }
        else
        {
            /*
            ** while we are waiting for connect confirm,
            ** we cannot sent DISC because we don't know DSAP yet
            */
            local_sap = nfa_p2p_cb.conn_cb[xx].local_sap;

            if (nfa_p2p_cb.sap_cb[local_sap].p_cback)
            {
                evt_data.disc.handle = (NFA_HANDLE_GROUP_P2P | NFA_P2P_HANDLE_FLAG_CONN | xx);
                evt_data.disc.reason = NFA_P2P_DISC_REASON_LOCAL_INITITATE;

                nfa_p2p_deallocate_conn_cb (xx);
                nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_DISC_EVT, &evt_data);
            }
        }
    }
    else
    {
        P2P_TRACE_ERROR0 ("Handle is not for Data link connection");
    }

    return TRUE;
}

/*******************************************************************************
**
** Function         nfa_p2p_create_data_link_connection
**
** Description      Create data link connection
**
**
** Returns          TRUE to deallocate buffer
**
*******************************************************************************/
BOOLEAN nfa_p2p_create_data_link_connection (tNFA_P2P_MSG *p_msg)
{
    UINT8                   local_sap;
    tNFA_P2P_EVT_DATA       evt_data;
    tLLCP_CONNECTION_PARAMS conn_params;
    tLLCP_STATUS            status;

    P2P_TRACE_DEBUG0 ("nfa_p2p_create_data_link_connection ()");

    local_sap = (UINT8) (p_msg->api_connect.client_handle & NFA_HANDLE_MASK);

    conn_params.miu = p_msg->api_connect.miu;
    conn_params.rw  = p_msg->api_connect.rw;

    /* NFA_P2pConnectBySap () */
    if (p_msg->api_connect.dsap != LLCP_INVALID_SAP)
    {
        conn_params.sn[0] = 0;
        status = LLCP_ConnectReq (local_sap, p_msg->api_connect.dsap, &conn_params);
    }
    /* NFA_P2pConnectByName () */
    else
    {
        BCM_STRNCPY_S (conn_params.sn, sizeof (conn_params.sn),
                       p_msg->api_connect.service_name, LLCP_MAX_SN_LEN);
        conn_params.sn[LLCP_MAX_SN_LEN] = 0;

        status = LLCP_ConnectReq (local_sap, LLCP_SAP_SDP, &conn_params);
    }

    if (status != LLCP_STATUS_SUCCESS)
    {
        evt_data.disc.handle = (NFA_HANDLE_GROUP_P2P | local_sap);
        evt_data.disc.reason = NFA_P2P_DISC_REASON_NO_INFORMATION;

        nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_DISC_EVT, &evt_data);
    }

    return TRUE;
}

/*******************************************************************************
**
** Function         nfa_p2p_send_ui
**
** Description      Send UI PDU
**
**
** Returns          TRUE to deallocate buffer
**
*******************************************************************************/
BOOLEAN nfa_p2p_send_ui (tNFA_P2P_MSG *p_msg)
{
    UINT8             local_sap;
    tLLCP_STATUS      status;
    tNFA_P2P_EVT_DATA evt_data;

    P2P_TRACE_DEBUG0 ("nfa_p2p_send_ui ()");

    local_sap = (UINT8) (p_msg->api_send_ui.handle & NFA_HANDLE_MASK);

    /* decrease number of tx UI PDU which is not processed by NFA for congestion control */
    if (nfa_p2p_cb.sap_cb[local_sap].num_pending_ui_pdu)
        nfa_p2p_cb.sap_cb[local_sap].num_pending_ui_pdu--;

    if (nfa_p2p_cb.total_pending_ui_pdu)
        nfa_p2p_cb.total_pending_ui_pdu--;

    status = LLCP_SendUI (local_sap,
                          p_msg->api_send_ui.dsap,
                          p_msg->api_send_ui.p_msg);

    if (status == LLCP_STATUS_CONGESTED)
    {
        if (!(nfa_p2p_cb.sap_cb[local_sap].flags & NFA_P2P_SAP_FLAG_LLINK_CONGESTED))
        {
            nfa_p2p_cb.sap_cb[local_sap].flags |= NFA_P2P_SAP_FLAG_LLINK_CONGESTED;

            /* notify that this logical link is congested */
            evt_data.congest.link_type    = NFA_P2P_LLINK_TYPE;
            evt_data.congest.handle       = (NFA_HANDLE_GROUP_P2P | local_sap);
            evt_data.congest.is_congested = TRUE;

            nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_CONGEST_EVT, &evt_data);
        }
    }

    return TRUE;
}

/*******************************************************************************
**
** Function         nfa_p2p_send_data
**
** Description      Send I PDU
**
**
** Returns          TRUE to deallocate buffer
**
*******************************************************************************/
BOOLEAN nfa_p2p_send_data (tNFA_P2P_MSG *p_msg)
{
    tNFA_P2P_EVT_DATA evt_data;
    tLLCP_STATUS      status;
    UINT8             xx;

    P2P_TRACE_DEBUG0 ("nfa_p2p_send_data ()");

    xx = (UINT8) (p_msg->api_send_data.conn_handle & NFA_HANDLE_MASK);
    xx &= ~NFA_P2P_HANDLE_FLAG_CONN;

    /* decrease number of tx I PDU which is not processed by NFA for congestion control */
    if (nfa_p2p_cb.conn_cb[xx].num_pending_i_pdu)
        nfa_p2p_cb.conn_cb[xx].num_pending_i_pdu--;

    if (nfa_p2p_cb.total_pending_i_pdu)
        nfa_p2p_cb.total_pending_i_pdu--;

    status = LLCP_SendData (nfa_p2p_cb.conn_cb[xx].local_sap,
                            nfa_p2p_cb.conn_cb[xx].remote_sap,
                            p_msg->api_send_data.p_msg);

    if (status == LLCP_STATUS_CONGESTED)
    {
        if (!(nfa_p2p_cb.conn_cb[xx].flags & NFA_P2P_CONN_FLAG_CONGESTED))
        {
            nfa_p2p_cb.conn_cb[xx].flags |= NFA_P2P_CONN_FLAG_CONGESTED;

            /* notify that this data link is congested */
            evt_data.congest.link_type    = NFA_P2P_DLINK_TYPE;
            evt_data.congest.handle       = (NFA_HANDLE_GROUP_P2P | NFA_P2P_HANDLE_FLAG_CONN | xx);
            evt_data.congest.is_congested = TRUE;

            nfa_p2p_cb.sap_cb[nfa_p2p_cb.conn_cb[xx].local_sap].p_cback (NFA_P2P_CONGEST_EVT, &evt_data);
        }
    }

    return TRUE;
}

/*******************************************************************************
**
** Function         nfa_p2p_set_local_busy
**
** Description      Set or reset local busy
**
**
** Returns          TRUE to deallocate buffer
**
*******************************************************************************/
BOOLEAN nfa_p2p_set_local_busy (tNFA_P2P_MSG *p_msg)
{
    UINT8 xx;

    P2P_TRACE_DEBUG0 ("nfa_p2p_set_local_busy ()");

    xx = (UINT8) (p_msg->api_local_busy.conn_handle & NFA_HANDLE_MASK);
    xx &= ~NFA_P2P_HANDLE_FLAG_CONN;

    LLCP_SetLocalBusyStatus (nfa_p2p_cb.conn_cb[xx].local_sap,
                             nfa_p2p_cb.conn_cb[xx].remote_sap,
                             p_msg->api_local_busy.is_busy);

    return TRUE;
}

/*******************************************************************************
**
** Function         nfa_p2p_get_link_info
**
** Description      Get WKS of remote and link MIU
**
**
** Returns          TRUE to deallocate buffer
**
*******************************************************************************/
BOOLEAN nfa_p2p_get_link_info (tNFA_P2P_MSG *p_msg)
{
    tNFA_P2P_EVT_DATA evt_data;
    UINT8             local_sap;

    P2P_TRACE_DEBUG0 ("nfa_p2p_get_link_info ()");

    evt_data.link_info.handle          = p_msg->api_link_info.handle;
    evt_data.link_info.wks             = LLCP_GetRemoteWKS ();
    evt_data.link_info.local_link_miu  = nfa_p2p_cb.local_link_miu;
    evt_data.link_info.remote_link_miu = nfa_p2p_cb.remote_link_miu;

    local_sap =  (UINT8) (p_msg->api_link_info.handle & NFA_HANDLE_MASK);
    nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_LINK_INFO_EVT, &evt_data);

    return TRUE;
}

/*******************************************************************************
**
** Function         nfa_p2p_get_remote_sap
**
** Description      Get remote SAP
**
**
** Returns          TRUE to deallocate buffer
**
*******************************************************************************/
BOOLEAN nfa_p2p_get_remote_sap (tNFA_P2P_MSG *p_msg)
{
    tNFA_P2P_EVT_DATA evt_data;
    UINT8             local_sap;

    P2P_TRACE_DEBUG0 ("nfa_p2p_get_remote_sap ()");

    local_sap =  (UINT8) (p_msg->api_remote_sap.handle & NFA_HANDLE_MASK);

    if (!nfa_p2p_start_sdp (p_msg->api_remote_sap.service_name,
                            local_sap))
    {
        evt_data.sdp.handle     = p_msg->api_remote_sap.handle;
        evt_data.sdp.remote_sap = 0x00;
        nfa_p2p_cb.sap_cb[local_sap].p_cback (NFA_P2P_SDP_EVT, &evt_data);
    }

    return TRUE;
}

/*******************************************************************************
**
** Function         nfa_p2p_set_llcp_cfg
**
** Description      Set LLCP configuration
**
**
** Returns          TRUE to deallocate buffer
**
*******************************************************************************/
BOOLEAN nfa_p2p_set_llcp_cfg (tNFA_P2P_MSG *p_msg)
{
    LLCP_SetConfig (p_msg->api_set_llcp_cfg.link_miu,
                    p_msg->api_set_llcp_cfg.opt,
                    p_msg->api_set_llcp_cfg.wt,
                    p_msg->api_set_llcp_cfg.link_timeout,
                    p_msg->api_set_llcp_cfg.inact_timeout_init,
                    p_msg->api_set_llcp_cfg.inact_timeout_target,
                    p_msg->api_set_llcp_cfg.symm_delay,
                    p_msg->api_set_llcp_cfg.data_link_timeout,
                    p_msg->api_set_llcp_cfg.delay_first_pdu_timeout);

    return TRUE;
}