/* * Copyright (C) 2010 NXP Semiconductors * * 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. */ /** * \file phFriNfc_LlcpTransport_Connectionless.c * \brief * * Project: NFC-FRI * */ /*include files*/ #include <phOsalNfc.h> #include <phLibNfcStatus.h> #include <phLibNfc.h> #include <phNfcLlcpTypes.h> #include <phFriNfc_LlcpTransport.h> #include <phFriNfc_Llcp.h> static void phFriNfc_LlcpTransport_Connectionless_SendTo_CB(void* pContext, uint8_t socketIndex, NFCSTATUS status); NFCSTATUS phFriNfc_LlcpTransport_Connectionless_HandlePendingOperations(phFriNfc_LlcpTransport_Socket_t *pSocket) { NFCSTATUS status = NFCSTATUS_FAILED; /* Check if something is pending and if transport layer is ready to send */ if ((pSocket->pfSocketSend_Cb != NULL) && (pSocket->psTransport->bSendPending == FALSE)) { /* Fill the psLlcpHeader stuture with the DSAP,PTYPE and the SSAP */ pSocket->sLlcpHeader.dsap = pSocket->socket_dSap; pSocket->sLlcpHeader.ptype = PHFRINFC_LLCP_PTYPE_UI; pSocket->sLlcpHeader.ssap = pSocket->socket_sSap; /* Send to data to the approiate socket */ status = phFriNfc_LlcpTransport_LinkSend(pSocket->psTransport, &pSocket->sLlcpHeader, NULL, &pSocket->sSocketSendBuffer, phFriNfc_LlcpTransport_Connectionless_SendTo_CB, pSocket->index, pSocket); } else { /* Cannot send now, retry later */ } return status; } /* TODO: comment function Handle_Connectionless_IncommingFrame */ void Handle_Connectionless_IncommingFrame(phFriNfc_LlcpTransport_t *pLlcpTransport, phNfc_sData_t *psData, uint8_t dsap, uint8_t ssap) { phFriNfc_LlcpTransport_Socket_t * pSocket = NULL; uint8_t i = 0; uint8_t writeIndex; /* Look through the socket table for a match */ for(i=0;i<PHFRINFC_LLCP_NB_SOCKET_MAX;i++) { if(pLlcpTransport->pSocketTable[i].socket_sSap == dsap) { /* Socket found ! */ pSocket = &pLlcpTransport->pSocketTable[i]; /* Forward directly to application if a read is pending */ if (pSocket->bSocketRecvPending == TRUE) { /* Reset the RecvPending variable */ pSocket->bSocketRecvPending = FALSE; /* Copy the received buffer into the receive buffer */ memcpy(pSocket->sSocketRecvBuffer->buffer, psData->buffer, psData->length); /* Update the received length */ *pSocket->receivedLength = psData->length; /* call the recv callback */ pSocket->pfSocketRecvFrom_Cb(pSocket->pRecvContext, ssap, NFCSTATUS_SUCCESS); pSocket->pfSocketRecvFrom_Cb = NULL; } /* If no read is pending, try to bufferize for later reading */ else { if((pSocket->indexRwWrite - pSocket->indexRwRead) < pSocket->localRW) { writeIndex = pSocket->indexRwWrite % pSocket->localRW; /* Save SSAP */ pSocket->sSocketRwBufferTable[writeIndex].buffer[0] = ssap; /* Save UI frame payload */ memcpy(pSocket->sSocketRwBufferTable[writeIndex].buffer + 1, psData->buffer, psData->length); pSocket->sSocketRwBufferTable[writeIndex].length = psData->length; /* Update the RW write index */ pSocket->indexRwWrite++; } else { /* Unable to bufferize the packet, drop it */ } } break; } } } /* TODO: comment function phFriNfc_LlcpTransport_Connectionless_SendTo_CB */ static void phFriNfc_LlcpTransport_Connectionless_SendTo_CB(void* pContext, uint8_t socketIndex, NFCSTATUS status) { phFriNfc_LlcpTransport_Socket_t * pLlcpSocket = (phFriNfc_LlcpTransport_Socket_t*)pContext; pphFriNfc_LlcpTransportSocketSendCb_t pfSavedCallback; void * pSavedContext; /* Call the send callback */ pfSavedCallback = pLlcpSocket->pfSocketSend_Cb; if (pfSavedCallback != NULL) { pLlcpSocket->pfSocketSend_Cb = NULL; pfSavedCallback(pLlcpSocket->pSendContext, status); } } static void phFriNfc_LlcpTransport_Connectionless_Abort(phFriNfc_LlcpTransport_Socket_t* pLlcpSocket) { if (pLlcpSocket->pfSocketSend_Cb != NULL) { pLlcpSocket->pfSocketSend_Cb(pLlcpSocket->pSendContext, NFCSTATUS_ABORTED); pLlcpSocket->pSendContext = NULL; pLlcpSocket->pfSocketSend_Cb = NULL; } if (pLlcpSocket->pfSocketRecvFrom_Cb != NULL) { pLlcpSocket->pfSocketRecvFrom_Cb(pLlcpSocket->pRecvContext, 0, NFCSTATUS_ABORTED); pLlcpSocket->pRecvContext = NULL; pLlcpSocket->pfSocketRecvFrom_Cb = NULL; pLlcpSocket->pfSocketRecv_Cb = NULL; } pLlcpSocket->pAcceptContext = NULL; pLlcpSocket->pfSocketAccept_Cb = NULL; pLlcpSocket->pListenContext = NULL; pLlcpSocket->pfSocketListen_Cb = NULL; pLlcpSocket->pConnectContext = NULL; pLlcpSocket->pfSocketConnect_Cb = NULL; pLlcpSocket->pDisconnectContext = NULL; pLlcpSocket->pfSocketDisconnect_Cb = NULL; } /** * \ingroup grp_fri_nfc * \brief <b>Close a socket on a LLCP-connectionless device</b>. * * This function closes a LLCP socket previously created using phFriNfc_LlcpTransport_Socket. * * \param[in] pLlcpSocket A pointer to a phFriNfc_LlcpTransport_Socket_t. * \retval NFCSTATUS_SUCCESS Operation successful. * \retval NFCSTATUS_INVALID_PARAMETER One or more of the supplied parameters * could not be properly interpreted. * \retval NFCSTATUS_FAILED Operation failed. */ NFCSTATUS phFriNfc_LlcpTransport_Connectionless_Close(phFriNfc_LlcpTransport_Socket_t* pLlcpSocket) { /* Reset the pointer to the socket closed */ pLlcpSocket->eSocket_State = phFriNfc_LlcpTransportSocket_eSocketDefault; pLlcpSocket->eSocket_Type = phFriNfc_LlcpTransport_eDefaultType; pLlcpSocket->pContext = NULL; pLlcpSocket->pSocketErrCb = NULL; pLlcpSocket->socket_sSap = PHFRINFC_LLCP_SAP_DEFAULT; pLlcpSocket->socket_dSap = PHFRINFC_LLCP_SAP_DEFAULT; pLlcpSocket->bSocketRecvPending = FALSE; pLlcpSocket->bSocketSendPending = FALSE; pLlcpSocket->bSocketListenPending = FALSE; pLlcpSocket->bSocketDiscPending = FALSE; pLlcpSocket->RemoteBusyConditionInfo = FALSE; pLlcpSocket->ReceiverBusyCondition = FALSE; pLlcpSocket->socket_VS = 0; pLlcpSocket->socket_VSA = 0; pLlcpSocket->socket_VR = 0; pLlcpSocket->socket_VRA = 0; phFriNfc_LlcpTransport_Connectionless_Abort(pLlcpSocket); memset(&pLlcpSocket->sSocketOption, 0x00, sizeof(phFriNfc_LlcpTransport_sSocketOptions_t)); if (pLlcpSocket->sServiceName.buffer != NULL) { phOsalNfc_FreeMemory(pLlcpSocket->sServiceName.buffer); } pLlcpSocket->sServiceName.buffer = NULL; pLlcpSocket->sServiceName.length = 0; return NFCSTATUS_SUCCESS; } /** * \ingroup grp_fri_nfc * \brief <b>Send data on a socket to a given destination SAP</b>. * * This function is used to write data on a socket to a given destination SAP. * This function can only be called on a connectionless socket. * * * \param[in] pLlcpSocket A pointer to a LlcpSocket created. * \param[in] nSap The destination SAP. * \param[in] psBuffer The buffer containing the data to send. * \param[in] pSend_RspCb The callback to be called when the * operation is completed. * \param[in] pContext Upper layer context to be returned in * the callback. * * \retval NFCSTATUS_SUCCESS Operation successful. * \retval NFCSTATUS_INVALID_PARAMETER One or more of the supplied parameters * could not be properly interpreted. * \retval NFCSTATUS_PENDING Reception operation is in progress, * pSend_RspCb will be called upon completion. * \retval NFCSTATUS_INVALID_STATE The socket is not in a valid state, or not of * a valid type to perform the requsted operation. * \retval NFCSTATUS_NOT_INITIALISED Indicates stack is not yet initialized. * \retval NFCSTATUS_SHUTDOWN Shutdown in progress. * \retval NFCSTATUS_FAILED Operation failed. */ NFCSTATUS phFriNfc_LlcpTransport_Connectionless_SendTo(phFriNfc_LlcpTransport_Socket_t *pLlcpSocket, uint8_t nSap, phNfc_sData_t* psBuffer, pphFriNfc_LlcpTransportSocketSendCb_t pSend_RspCb, void* pContext) { NFCSTATUS status = NFCSTATUS_FAILED; /* Store send callback and context*/ pLlcpSocket->pfSocketSend_Cb = pSend_RspCb; pLlcpSocket->pSendContext = pContext; /* Test if a send is already pending at transport level */ if(pLlcpSocket->psTransport->bSendPending == TRUE) { /* Save the request so it can be handled in phFriNfc_LlcpTransport_Connectionless_HandlePendingOperations() */ pLlcpSocket->sSocketSendBuffer = *psBuffer; pLlcpSocket->socket_dSap = nSap; status = NFCSTATUS_PENDING; } else { /* Fill the psLlcpHeader stuture with the DSAP,PTYPE and the SSAP */ pLlcpSocket->sLlcpHeader.dsap = nSap; pLlcpSocket->sLlcpHeader.ptype = PHFRINFC_LLCP_PTYPE_UI; pLlcpSocket->sLlcpHeader.ssap = pLlcpSocket->socket_sSap; /* Send to data to the approiate socket */ status = phFriNfc_LlcpTransport_LinkSend(pLlcpSocket->psTransport, &pLlcpSocket->sLlcpHeader, NULL, psBuffer, phFriNfc_LlcpTransport_Connectionless_SendTo_CB, pLlcpSocket->index, pLlcpSocket); } return status; } /** * \ingroup grp_lib_nfc * \brief <b>Read data on a socket and get the source SAP</b>. * * This function is the same as phLibNfc_Llcp_Recv, except that the callback includes * the source SAP. This functions can only be called on a connectionless socket. * * * \param[in] pLlcpSocket A pointer to a LlcpSocket created. * \param[in] psBuffer The buffer receiving the data. * \param[in] pRecv_RspCb The callback to be called when the * operation is completed. * \param[in] pContext Upper layer context to be returned in * the callback. * * \retval NFCSTATUS_SUCCESS Operation successful. * \retval NFCSTATUS_INVALID_PARAMETER One or more of the supplied parameters * could not be properly interpreted. * \retval NFCSTATUS_PENDING Reception operation is in progress, * pRecv_RspCb will be called upon completion. * \retval NFCSTATUS_INVALID_STATE The socket is not in a valid state, or not of * a valid type to perform the requsted operation. * \retval NFCSTATUS_NOT_INITIALISED Indicates stack is not yet initialized. * \retval NFCSTATUS_SHUTDOWN Shutdown in progress. * \retval NFCSTATUS_FAILED Operation failed. */ NFCSTATUS phLibNfc_LlcpTransport_Connectionless_RecvFrom(phFriNfc_LlcpTransport_Socket_t *pLlcpSocket, phNfc_sData_t* psBuffer, pphFriNfc_LlcpTransportSocketRecvFromCb_t pRecv_Cb, void *pContext) { NFCSTATUS status = NFCSTATUS_PENDING; uint8_t readIndex; uint8_t ssap; if(pLlcpSocket->bSocketRecvPending) { status = PHNFCSTVAL(CID_FRI_NFC_LLCP_TRANSPORT, NFCSTATUS_REJECTED); } else { /* Check if pending packets in RW */ if(pLlcpSocket->indexRwRead != pLlcpSocket->indexRwWrite) { readIndex = pLlcpSocket->indexRwRead % pLlcpSocket->localRW; /* Extract ssap and buffer from RW buffer */ ssap = pLlcpSocket->sSocketRwBufferTable[readIndex].buffer[0]; memcpy(psBuffer->buffer, pLlcpSocket->sSocketRwBufferTable[readIndex].buffer + 1, pLlcpSocket->sSocketRwBufferTable[readIndex].length); psBuffer->length = pLlcpSocket->sSocketRwBufferTable[readIndex].length; /* Reset RW buffer length */ pLlcpSocket->sSocketRwBufferTable[readIndex].length = 0; /* Update Value Rw Read Index */ pLlcpSocket->indexRwRead++; /* call the recv callback */ pRecv_Cb(pContext, ssap, NFCSTATUS_SUCCESS); status = NFCSTATUS_SUCCESS; } /* Otherwise, wait for a packet to come */ else { /* Store the callback and context*/ pLlcpSocket->pfSocketRecvFrom_Cb = pRecv_Cb; pLlcpSocket->pRecvContext = pContext; /* Store the pointer to the receive buffer */ pLlcpSocket->sSocketRecvBuffer = psBuffer; pLlcpSocket->receivedLength = &psBuffer->length; /* Set RecvPending to TRUE */ pLlcpSocket->bSocketRecvPending = TRUE; } } return status; }