/*******************************************************************************
################################################################################
#   Copyright (c) [2017-2019] [Radisys]                                        #
#                                                                              #
#   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 file contains all EGTP related functionality */

#include <stdio.h>
#include "du_egtp.h"
#include "du_ue_mgr.h"

/* Global variable declaration */
EgtpGlobalCb egtpCb;

/**************************************************************************
 * @brief Task Initiation callback function. 
 *
 * @details
 *
 *     Function : egtpActvInit 
 *    
 *     Functionality:
 *             This function is supplied as one of parameters during EGTP's 
 *             task registration. SSI will invoke this function once, after
 *             it creates and attaches this TAPA Task to a system task.
 *     
 * @param[in]  Ent entity, the entity ID of this task.     
 * @param[in]  Inst inst, the instance ID of this task.
 * @param[in]  Region region, the region ID registered for memory 
 *              usage of this task.
 * @param[in]  Reason reason.
 * @return ROK     - success
 *         RFAILED - failure
 ***************************************************************************/
S16 egtpActvInit(Ent entity, Inst inst, Region region, Reason reason)
{
  DU_LOG("\n\nEGTP : Initializing");

  cmMemset ((U8 *)&egtpCb, 0, sizeof(EgtpGlobalCb));
  protType = CM_INET_PROTO_UDP;

  return ROK;
}


/**************************************************************************
 * @brief Task Activation callback function. 
 *
 * @details
 *
 *      Function : egtpActvTsk 
 * 
 *      Functionality:
 *           This function handles all EGTP messages received
 *           This API is registered with SSI during the 
 *           Task Registration of DU APP.
 *     
 * @param[in]  Pst     *pst, Post structure of the primitive.     
 * @param[in]  Buffer *mBuf, Packed primitive parameters in the
 *  buffer.
 * @return ROK     - success
 *         RFAILED - failure
 *
 ***************************************************************************/
S16 egtpActvTsk(Pst *pst, Buffer *mBuf)
{
   S16 ret = ROK;

   switch(pst->srcEnt)
   {
      case ENTDUAPP:
      {
         switch(pst->event)
         {
            case EVTCFGREQ:
            {
               ret = unpackEgtpCfgReq(egtpCfgReq, pst, mBuf);
               break;
            }
            case EVTSRVOPENREQ:
            {
               ret = unpackEgtpSrvOpenReq(egtpSrvOpenReq, pst, mBuf);
               break;
            }
            case EVTTNLMGMTREQ:
            {
               ret = unpackEgtpTnlMgmtReq(egtpTnlMgmtReq, pst, mBuf);
               break;
            }
            case EVTSLOTIND:
            {
               ret = unpackEgtpSlotInd(egtpSlotInd, pst, mBuf);
               SPutMsg(mBuf);
               break;
            }
            default:
            {
               DU_LOG("\nEGTP : Invalid event %d", pst->event);
               SPutMsg(mBuf);
               ret = RFAILED;
            }
         }
         break;
      }
      case ENTKW:
      {
         switch(pst->event)
         {
            case EVTDATIND:
            {
               //TODO
               break;
            }
            default:
            {
               DU_LOG("\nEGTP : Invalid event %d", pst->event);
               ret = RFAILED;
            }
         }
         break;
      }
      default:
      {
         DU_LOG("\nEGTP : Invalid source entity %d", pst->srcEnt);
         ret = RFAILED;
      }
   }
   SExitTsk();
   return ret;
}

/**************************************************************************
 * @brief EGTP server configuration 
 *
 * @details
 *
 *      Function : egtpCfgReq
 * 
 *      Functionality:
 *           This function handles EGTP configuration request.
 *     
 * @return ROK     - success
 *         RFAILED - failure
 *
 * ***********************************************************************/
S16 egtpCfgReq(Pst *pst, EgtpConfig egtpCfg)
{
   U8 ret;          /* Return value */
   Pst rspPst;      /* Response Pst structure */
   CmStatus cfgCfm; /* Configuration Confirm */

   cmMemcpy((U8 *)&egtpCb.egtpCfg, (U8 *)&egtpCfg, (PTR)sizeof(EgtpConfig));

   egtpCb.recvTptSrvr.addr.address = CM_INET_NTOH_U32(egtpCb.egtpCfg.localIp.ipV4Addr);
   egtpCb.recvTptSrvr.addr.port = EGTP_DFLT_PORT;

   egtpCb.dstCb.dstIp = CM_INET_NTOH_U32(egtpCb.egtpCfg.destIp.ipV4Addr);
   egtpCb.dstCb.dstPort = egtpCb.egtpCfg.destPort;
   egtpCb.dstCb.sendTptSrvr.addr.address = CM_INET_NTOH_U32(egtpCb.egtpCfg.localIp.ipV4Addr);
   egtpCb.dstCb.sendTptSrvr.addr.port = egtpCb.egtpCfg.localPort;
   egtpCb.dstCb.numTunn = 0;

   ret = cmHashListInit(&(egtpCb.dstCb.teIdLst), 1024, sizeof(EgtpTeIdCb), FALSE, CM_HASH_KEYTYPE_U32MOD, DU_APP_MEM_REGION, DU_POOL);

   if(ret != ROK)
   {
      DU_LOG("\nEGTP : TeId hash list initialization failed");
      cfgCfm.status = LCM_PRIM_NOK;
      cfgCfm.reason = LCM_REASON_HASHING_FAILED;
   }
   else
   {
      DU_LOG("\nEGTP : EGTP configuration successful");
      cfgCfm.status = LCM_PRIM_OK;
      cfgCfm.reason = LCM_REASON_NOT_APPL;
   }

   /* Fill response Pst */
   egtpFillRspPst(pst, &rspPst);
   rspPst.event = EVTCFGCFM;

   packEgtpCfgCfm(&rspPst, cfgCfm);

   return ROK;
}

/**************************************************************************
 * @brief Fills post structure to send response
 *
 * @details
 *
 *      Function : egtpFillRspPst
 * 
 *      Functionality:
 *           Fills post struture to send response
 *     
 * @return ROK     - success
 *         RFAILED - failure
 *
 *
 * ***********************************************************************/
S16 egtpFillRspPst(Pst *pst, Pst *rspPst)
{

   cmMemset((U8 *)rspPst, 0, sizeof(Pst));
   rspPst->srcEnt = pst->dstEnt;
   rspPst->srcInst = pst->dstInst;
   rspPst->srcProcId = pst->dstProcId;
   rspPst->dstEnt = pst->srcEnt;
   rspPst->dstInst = pst->srcInst;
   rspPst->dstProcId = pst->srcProcId;
   rspPst->selector = DU_SELECTOR_LC;
   rspPst->pool= DU_POOL;
    
   return ROK;
}

/**************************************************************************
 * @brief EGTP server open request 
 *
 * @details
 *
 *      Function : egtpSrvOpenReq
 * 
 *      Functionality:
 *           This function handles EGTP open server request.
 *           It opens udp socket to receive/send msgs.
 *     
 * @param[in]  Pst *pst, post structure
 * @return ROK     - success
 *         RFAILED - failure
 *
 ***************************************************************************/

S16 egtpSrvOpenReq(Pst *pst)
{

   U8    ret;       /* Return value */
   Pst   rspPst;    /* Response Pst structure */ 
   CmStatus cfm;    /* Confirmation status */
   U8 sockType;     /* Socket type */

   DU_LOG("\nEGTP : Received EGTP open server request");
 
   sockType = CM_INET_DGRAM;
   ret = egtpSrvOpenPrc(sockType, &(egtpCb.recvTptSrvr));
	/* Opening and Binding receiver socket */
   if(ret != ROK)
   {
      DU_LOG("\nEGTP : Failed while opening receiver transport server");
      return ret;
   }
   /* Opening and Binding sender socket */
	ret = egtpSrvOpenPrc(sockType, &(egtpCb.dstCb.sendTptSrvr));
   if(ret != ROK)
   {
      DU_LOG("\nEGTP : Failed while opening sender transport server");
      return ret;
   }

   DU_LOG("\nEGTP : Receiver socket[%d] and Sender socket[%d] open", egtpCb.recvTptSrvr.sockFd.fd, egtpCb.dstCb.sendTptSrvr.sockFd.fd);

   /* Filling and seing response */
   cfm.status = LCM_PRIM_OK;
   cfm.reason = LCM_REASON_NOT_APPL;

   egtpFillRspPst(pst, &rspPst);
   rspPst.event = EVTSRVOPENCFM;
   packEgtpSrvOpenCfm(&rspPst, cfm);

   return ret;
}

/*******************************************************************
 *
 * @brief Processing Sever open request
 *
 * @details
 *
 *    Function : egtpSrvOpenPrc
 *
 *    Functionality:
 *      
 *
 * @params[in] 
 * @return ROK     - success
 *         RFAILED - failure
 *
 * ****************************************************************/

S16 egtpSrvOpenPrc(U8 sockType, EgtpTptSrvr *server)
{
   S8 ret=ROK;
   ret = cmInetSocket(sockType, &(server->sockFd), protType); 
	if(ret != ROK)
   {  
      DU_LOG("\nEGTP : Failed to open UDP socket");
      return ret;
   }
   ret = cmInetBind(&(server->sockFd), &(server->addr));  
   if(ret != ROK)
   {  
      DU_LOG("\nEGTP : Failed to bind socket");
      return ret;
   }
   
   return ret;
}

/**************************************************************************
 * @brief EGTP tunnel management request
 *
 * @details
 *
 *      Function : egtpTnlMgmtReq
 * 
 *      Functionality:
 *           This function handles EGTP tunnel managament request
 *     
 * @param[in]  Pst *pst, post structure
 *             Tunnel Eveny structure
 * @return ROK     - success
 *         RFAILED - failure
 *
 
 * ***************************************************************************/
S16 egtpTnlMgmtReq(Pst *pst, EgtpTnlEvt tnlEvt)
{
   S8 ret;
   Pst rspPst;

   DU_LOG("\nEGTP : Received tunnel management request");
   switch(tnlEvt.action)
   {
      case EGTP_TNL_MGMT_ADD:
      {
         ret = egtpTnlAdd(tnlEvt);
         break;
      }
      case EGTP_TNL_MGMT_MOD:
      {
         ret = egtpTnlMod(tnlEvt);
         break;
      }
      case EGTP_TNL_MGMT_DEL:
      {
         ret = egtpTnlDel(tnlEvt);
         break;
      }
      default:
      {
         DU_LOG("\nEGTP : Invalid tunnel management action[%d]", tnlEvt.action);
         ret = LCM_REASON_INVALID_ACTION;
      }
   }

   if(ret == ROK)
   {
      tnlEvt.cfmStatus.status = LCM_PRIM_OK;
      tnlEvt.cfmStatus.reason = LCM_REASON_NOT_APPL;
   }
   else
   {
      tnlEvt.cfmStatus.status = LCM_PRIM_NOK;
      tnlEvt.cfmStatus.reason = ret;
   }

   DU_LOG("\nEGTP : Sending Tunnel management confirmation");
   egtpFillRspPst(pst, &rspPst);
   rspPst.event = EVTTNLMGMTCFM;
   packEgtpTnlMgmtCfm(&rspPst, tnlEvt);

   return ROK;
}

/**************************************************************************
 * @brief EGTP tunnel addition
 *
 * @details
 *
 *      Function : egtpTnlAdd
 * 
 *      Functionality:
 *           This function handles EGTP tunnel addition
 *     
 * @param[in]  Tunnel Event structure
 * @return ROK     - success
 *         RFAILED - failure
 *
 * ***************************************************************************/
S16 egtpTnlAdd(EgtpTnlEvt tnlEvt)
{
   S16   ret;
   EgtpTeIdCb   *teidCb;    /* Tunnel endpoint control block */
   EgtpMsgHdr   preDefHdr; /* pre-define header for this tunnel */

   DU_LOG("\nEGTP : Tunnel addition : LocalTeid[%d] Remote Teid[%d]", tnlEvt.lclTeid, tnlEvt.remTeid);

   ret = SGetSBuf(DU_APP_MEM_REGION, DU_POOL, (Data **)&teidCb, (Size)sizeof(EgtpTeIdCb));
   if(ret != ROK)
   {
      DU_LOG("\nEGTP : Memory allocation failed");
      return LCM_REASON_MEM_NOAVAIL;
   }

   cmMemset((U8 *)teidCb, 0, sizeof(EgtpTeIdCb));
   teidCb->teId = tnlEvt.lclTeid;
   teidCb->remTeId = tnlEvt.remTeid;

   ret = cmHashListInsert(&(egtpCb.dstCb.teIdLst), (PTR)teidCb, (U8 *)&(teidCb->teId), sizeof(U32));
   if(ret != ROK)
   {
      DU_LOG("\nEGTP : Failed to insert in hash list");
      SPutSBuf(DU_APP_MEM_REGION, DU_POOL, (Data *)teidCb, (Size)sizeof(EgtpTeIdCb));
      return LCM_REASON_HASHING_FAILED;
   }
   egtpCb.dstCb.numTunn++;

   /* Encoding pre-defined header */
   cmMemset((U8*)&preDefHdr, 0, sizeof(EgtpMsgHdr));
   preDefHdr.msgType = EGTPU_MSG_GPDU;
   preDefHdr.teId = teidCb->remTeId;
   preDefHdr.extHdr.pdcpNmb.pres = FALSE;
   preDefHdr.extHdr.udpPort.pres = FALSE;
   preDefHdr.nPdu.pres = FALSE;
  
   egtpEncodeHdr((U8 *)teidCb->preEncodedHdr.hdr, &preDefHdr, &(teidCb->preEncodedHdr.cnt));

   return ROK;
} /* egtpTnlAdd */

/**************************************************************************
 * @brief EGTP tunnel modification
 *
 * @details
 *
 *      Function : egtpTnlMod
 * 
 *      Functionality:
 *           This function handles EGTP tunnel modification
 *     
 * @param[in]  Tunnel Event structure
 * @return ROK     - success
 *         RFAILED - failure
 * 
 * ***************************************************************************/
S16 egtpTnlMod(EgtpTnlEvt tnlEvt)
{
#if 0
   S16   ret;
   EgtpTeIdCb     *teidCb = NULLP;

   printf("\nTunnel modification : LocalTeid[%d] Remote Teid[%d]", tnlEvt.lclTeid, tnlEvt.remTeid);

   cmHashListFind(&(egtpCb.dstCb.teIdLst), (U8 *)&(tnlEvt.teId), sizeof(U32), 0, (PTR *)&teidCb);
   if(teidCb == NULLP)
   {
      printf("\nTunnel id not found");
      RETVALUE(RFAILED);
   }  
   
   teidCb->teId = tnlEvt.lclTeid;
   teidCb->remTeId = tnlEvt.remTeid;
#endif
   return ROK;
}

/**************************************************************************
 * @brief EGTP tunnel deletion
 *
 * @details
 *
 *     Function : egtpTnlDel
 * 
 *     Functionality:
 *         This function handles EGTP tunnel deletion
 *    
 * @param[in]  Tunnel Event structure
 * @return ROK     - success
 *         RFAILED - failure
 * 
 * ***************************************************************************/
S16 egtpTnlDel(EgtpTnlEvt tnlEvt)
{
   EgtpTeIdCb     *teidCb = NULLP;

   DU_LOG("\nEGTP : Tunnel deletion : Local Teid[%d] Remote Teid[%d]", tnlEvt.lclTeid, tnlEvt.remTeid);
   
   cmHashListFind(&(egtpCb.dstCb.teIdLst), (U8 *)&(tnlEvt.lclTeid), sizeof(U32), 0, (PTR *)&teidCb);
   if(teidCb == NULLP)
   {
      DU_LOG("\nEGTP : Tunnel id[%d] not configured", tnlEvt.lclTeid);
      return LCM_REASON_INVALID_PAR_VAL;
   } 

   cmHashListDelete(&(egtpCb.dstCb.teIdLst), (PTR)teidCb);
   SPutSBuf(DU_APP_MEM_REGION, DU_POOL, (Data *)teidCb, (Size)sizeof(EgtpTeIdCb));
   egtpCb.dstCb.numTunn--;

   return ROK;
}

/*******************************************************************
 *
 * @brief Handles data indication
 *
 * @details
 *
 *    Function : EgtpHdlDatInd
 *
 *    Functionality:
 *      Handles incoming data from peer to be passed 
 *      on from DU to CU
 *
 * @params[in] 
 * @return ROK     - success
 *         RFAILED - failure
 *
 * ****************************************************************/
S16 egtpHdlDatInd(EgtpMsg egtpMsg)
{
   EgtpTeIdCb   *teidCb = NULLP;
   MsgLen tPduSize;
   U8     hdrLen;
   U32    msgLen;
   EgtpMsgHdr   *msgHdr;

   DU_LOG("\nEGTP : Received Data Indication");

   cmHashListFind(&(egtpCb.dstCb.teIdLst), (U8 *)&(egtpMsg.msgHdr.teId), sizeof(U32), 0, (PTR *)&teidCb);
   if(teidCb == NULLP)
   {
      DU_LOG("\nEGTP : Tunnel id[%d] not configured", egtpMsg.msgHdr.teId);
      return LCM_REASON_INVALID_PAR_VAL;
   }
   
   msgHdr = &(egtpMsg.msgHdr);

   hdrLen = teidCb->preEncodedHdr.cnt;

   if(msgHdr->extHdr.pdcpNmb.pres)
   {
      teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 1] |= EGTP_MASK_BIT3;
      teidCb->preEncodedHdr.hdr[hdrLen] = EGTP_EXT_HDR_PDCP_TYPE;
      teidCb->preEncodedHdr.hdr[--hdrLen] = 1;
      teidCb->preEncodedHdr.hdr[--hdrLen] = GetHiByte(msgHdr->extHdr.pdcpNmb.val);
      teidCb->preEncodedHdr.hdr[--hdrLen] = GetLoByte(msgHdr->extHdr.pdcpNmb.val);
      teidCb->preEncodedHdr.hdr[--hdrLen] = 0;
   }
   else
   {
      teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 1] &= ~(EGTP_MASK_BIT3);
   }

   SFndLenMsg(egtpMsg.msg, &tPduSize);

   /*Adjust the header to fill the correct length*/
   msgLen = tPduSize +  (EGTP_MAX_HDR_LEN - hdrLen) - 0x08;

   /***********************************************
    * Fill the length field of the message header *
    ***********************************************/
   teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 3] = (U8)GetHiByte(msgLen);
   teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 4] = (U8)GetLoByte(msgLen);

   /*Update the sequence number*/
   if(egtpMsg.msgHdr.seqNum.pres)
   {
      teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 1] |= (EGTP_MASK_BIT2);
      teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 9] = (U8)GetHiByte(egtpMsg.msgHdr.seqNum.val);
      teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 10] = (U8)GetLoByte(egtpMsg.msgHdr.seqNum.val);
   }
   else
   {
      teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 1] &= ~(EGTP_MASK_BIT2);
   }

   DU_LOG("\nEGTP : UL Data buffer before encoding header");
   SPrntMsg(egtpMsg.msg, 0, 0);

   SAddPreMsgMult(&teidCb->preEncodedHdr.hdr[hdrLen], (EGTP_MAX_HDR_LEN - hdrLen), egtpMsg.msg);


   DU_LOG("\nEGTP : UL Data buffer after encoding header");
   SPrntMsg(egtpMsg.msg, 0, 0);

   /* Send over UDP */
   egtpSendMsg(egtpMsg.msg);
   SPutMsg(egtpMsg.msg);

   return ROK;
}/* EgtpHdlDatInd */

/*******************************************************************
 *
 * @brief Encodes outgoing message
 *
 * @details
 *
 *    Function : egtpEncodeMsg
 *
 *    Functionality:
 *       Encodes EGTP message to be sent
 *
 * @params[in] EGTP message
 *             Message Buffer 
 * @return ROK     - success
 *         RFAILED - failure
 *
 * ****************************************************************/
S16 egtpEncodeHdr(U8 *preEncodedHdr, EgtpMsgHdr *preDefHdr, U8 *hdrIdx)
{
   U8         tmpByte = 0;                 /* Stores one byte of data for enc */
   U8         cnt     = EGTP_MAX_HDR_LEN;  /* Stores the position */
   Bool       extPres = FALSE;             /* Flag for indication of S, E or P presense flag */
   U16        nwWord = 0;
   
   /* Encoding header */
   tmpByte |= EGTP_MASK_BIT6;   /* Setting 6th LSB of 1st byte as version */
   tmpByte |= EGTP_MASK_BIT5;   /* Setting 5th LSB of 1st byte as protocol type */

   if(preDefHdr->extHdr.udpPort.pres || preDefHdr->extHdr.pdcpNmb.pres)
   {
      tmpByte |= EGTP_MASK_BIT3;  /* Setting 3rd LSB of 1st byte if Extension heaeder is present */
   }

   if(preDefHdr->seqNum.pres)
   {
      tmpByte |= EGTP_MASK_BIT2;
   }

   if(preDefHdr->nPdu.pres)
   {
      tmpByte |= EGTP_MASK_BIT1;
   }

   if((tmpByte & EGTP_MASK_BIT1) || (tmpByte & EGTP_MASK_BIT2)||(tmpByte & EGTP_MASK_BIT3))
   {
      extPres = TRUE;
   }

   preEncodedHdr[--cnt] = tmpByte;
   preEncodedHdr[--cnt] = preDefHdr->msgType;

   /* Encode Tunnel endpoint */
   preEncodedHdr[--cnt] = 0;
   preEncodedHdr[--cnt] = 0;
   nwWord = (U16)(GetHiWord(preDefHdr->teId));
   preEncodedHdr[--cnt] = (U8)(GetHiByte(nwWord));
   preEncodedHdr[--cnt] = (U8)(GetLoByte(nwWord));
   nwWord = (U16)(GetLoWord(preDefHdr->teId));
   preEncodedHdr[--cnt] = (U8)(GetHiByte(nwWord));
   preEncodedHdr[--cnt] = (U8)(GetLoByte(nwWord));

   /* Encode sequence number */
   if(preDefHdr->seqNum.pres)
   {
      preEncodedHdr[--cnt] = GetHiByte(preDefHdr->seqNum.val);
      preEncodedHdr[--cnt] = GetLoByte(preDefHdr->seqNum.val);
   }
   else if(extPres)
   {
      preEncodedHdr[--cnt] = 0;
      preEncodedHdr[--cnt] = 0;
   }

   /* Encode nPdu number */
   if(preDefHdr->nPdu.pres)
   {
      preEncodedHdr[--cnt] = preDefHdr->nPdu.val;
   }
   else if(extPres)
   {
      preEncodedHdr[--cnt] = 0;
   }

   if(preDefHdr->extHdr.udpPort.pres)
   {
      preEncodedHdr[--cnt] = EGTP_EXT_HDR_UDP_TYPE;
      preEncodedHdr[--cnt] = 1;
      preEncodedHdr[--cnt] = GetHiByte(preDefHdr->extHdr.udpPort.val);
      preEncodedHdr[--cnt] = GetLoByte(preDefHdr->extHdr.udpPort.val);
   }
 
   if(preDefHdr->extHdr.pdcpNmb.pres)
   {
      preEncodedHdr[--cnt] = EGTP_EXT_HDR_PDCP_TYPE;
      preEncodedHdr[--cnt] = 1;
      preEncodedHdr[--cnt] = GetHiByte(preDefHdr->extHdr.pdcpNmb.val);
      preEncodedHdr[--cnt] = GetLoByte(preDefHdr->extHdr.pdcpNmb.val);
   }
 
   if(tmpByte & EGTP_MASK_BIT3)
   {
      preEncodedHdr[--cnt] = 0;
   }
   else if(extPres)
   {
      preEncodedHdr[--cnt] = 0;
   }

   *hdrIdx = cnt;
   return ROK;
} /* egtpEncodeHdr */

/*******************************************************************
 *
 * @brief Sends message over UDP
 *
 * @details
 *
 *    Function : egtpSendMsg
 *
 *    Functionality:
 *           Sends message over UDP
 *
 * @params[in] Message Buffer 
 * @return ROK     - success
 *         RFAILED - failure
 *
 * ****************************************************************/
S16 egtpSendMsg(Buffer *mBuf)
{
   S16            ret;
   MsgLen         txLen;
   CmInetMemInfo  info;
   CmInetAddr     dstAddr;

   info.region = DU_APP_MEM_REGION;
   info.pool = DU_POOL;

   dstAddr.port = EGTP_DFLT_PORT;
   dstAddr.address = egtpCb.dstCb.dstIp;

   ret = cmInetSendMsg(&(egtpCb.dstCb.sendTptSrvr.sockFd), &dstAddr, &info, mBuf, &txLen, CM_INET_NO_FLAG);
   if(ret != ROK && ret != RWOULDBLOCK)
   {
      DU_LOG("\nEGTP : Failed sending the message");
      return RFAILED;
   }

   DU_LOG("\nEGTP : Message Sent");

   return ROK;
}

/*******************************************************************
 *
 * @brief Handles Slot Indication from PHY
 *
 * @details
 *
 *    Function : egtpSlotInd
 *
 *    Functionality:
 *       Handles TTI Indication from PHY
 *
 * @params[in] 
 * @return ROK     - success
 *         RFAILED - failure
 *
 * ****************************************************************/
S16 egtpSlotInd()
{
   egtpRecvMsg();
   return ROK;
}

/*******************************************************************
 *
 * @brief Receives EGTP message from UDP socket 
 *
 * @details
 *
 *    Function : egtpRecvMsg
 *
 *    Functionality:
 *      Receive incoming messages from UDP socket
 *
 * @params[in] 
 * @return ROK     - success
 *         RFAILED - failure
 *
 * ****************************************************************/

S16 egtpRecvMsg()
{
   U8             ret;           /* Return value */
   U8             nMsg;          /* Number of messages to read from UDP socked */
   MsgLen         bufLen;        /* Length of received buffer */
   Buffer         *recvBuf;      /* Received buffer */
   CmInetAddr     fromAddr;      /* Egtp data sender address */
   CmInetMemInfo  memInfo;       /* Buffer allocation info */


   DU_LOG("\nEGTP : Received Slot Indication");

   nMsg = 0;
   memInfo.region = DU_APP_MEM_REGION;
   memInfo.pool   = DU_POOL;
    
   fromAddr.port = egtpCb.dstCb.dstPort;
   fromAddr.address = egtpCb.dstCb.dstIp;

   while(nMsg < EGTP_MAX_MSG_RECV)
   {
      bufLen = -1;
      ret = cmInetRecvMsg(&(egtpCb.recvTptSrvr.sockFd), &fromAddr, &memInfo, &recvBuf, &bufLen, CM_INET_NO_FLAG);
      if(ret == ROK && recvBuf != NULLP)
      {  
         DU_LOG("\nEGTP : Received DL Message[%d]\n", nMsg+1);
         SPrntMsg(recvBuf, 0 ,0);
         egtpHdlRecvData(recvBuf);
      }
      nMsg++;
   }
   
   return ROK;
}

S16 egtpHdlRecvData(Buffer *mBuf)
{
   EgtpMsg  egtpMsg;

   /* Decode EGTP header */
   egtpDecodeHdr(mBuf, &egtpMsg);

   /* TODO : Send received message to RLC */
   duHdlEgtpDlData(&egtpMsg);

   return ROK;
}

S16 egtpDecodeHdr(Buffer *mBuf, EgtpMsg  *egtpMsg)
{
   U8       tmpByte[5];         /* Holds 5 byte of data after Decoding */
   U8       version = 0;         /* Holds the version type, decoded */
   MsgLen   msgLen  = 0;         /* Holds the msgLen from the Hdr */
   MsgLen   bufLen  = 0;         /* Holds the total buffer length */
   U8       extHdrType = 0;       /* Holds the Extension hdr type */
   U8       extHdrLen = 0;        /* Extension hdr length */
   Bool     extPres = FALSE;      /* Flag for indication of S, E or P presense flag */
 
   SFndLenMsg(mBuf, &bufLen);
 
   /* Decode first byte and storing in temporary variable */
   SRemPreMsg(&tmpByte[0], mBuf);

   /* Extracting version fro 1st byte */
   version = tmpByte[0] >> 5;
   
   DU_LOG("\nEGTP : Version %d", version);
 
   /* Decode message type */
   SRemPreMsg((Data*)&(egtpMsg->msgHdr.msgType), mBuf);
   DU_LOG("\nEGTP : msgType %d", egtpMsg->msgHdr.msgType);

   /****************************************************************************
    * Message length param is 2 bytes. So decode next 2 bytes from msg hdr and
    * performing OR operation on these two bytes to calculate message length 
    ***************************************************************************/
   SRemPreMsg(&tmpByte[1], mBuf);
   SRemPreMsg(&tmpByte[2], mBuf);
   msgLen = (tmpByte[1] << 8) | tmpByte[2];
   DU_LOG("\nEGTP : msgLen %d", msgLen);


   /****************************************************************************
    * Tunnel id param is 4 bytes. So decode next 4 bytes from msg hdr and 
    * perform OR operation on these 4 bytes to calculate tunnel id
    ***************************************************************************/
   SRemPreMsg(&tmpByte[1], mBuf);
   SRemPreMsg(&tmpByte[2], mBuf);
   SRemPreMsg(&tmpByte[3], mBuf);
   SRemPreMsg(&tmpByte[4], mBuf);
   egtpMsg->msgHdr.teId = (tmpByte[1] << 24) | (tmpByte[2] << 16) | (tmpByte[3] << 8) | tmpByte[4];
   DU_LOG("\nEGTP : teId %d",egtpMsg->msgHdr.teId);


   /* If any one of S, E or PN flag is set, set extension present as true. */
   if((tmpByte[0] & EGTP_MASK_BIT1) || (tmpByte[0] & EGTP_MASK_BIT2)||(tmpByte[0] & EGTP_MASK_BIT3))
   {
      extPres = TRUE;
   }

   /* Decode sequence number, if S flag is set in first byte */
   if (tmpByte[0] & EGTP_MASK_BIT2)
   {
      /************************************************************************
       * Sequence num is 2 bytes. So decode next 2 bytes from msg hdr and 
       * perform OR operation on them 
       ************************************************************************/
      egtpMsg->msgHdr.seqNum.pres = TRUE;
      SRemPreMsg(&tmpByte[1], mBuf);
      SRemPreMsg(&tmpByte[2], mBuf);
      egtpMsg->msgHdr.seqNum.val = (tmpByte[1] << 8) | tmpByte[2];
   }
   /**************************************************************************** 
    * If extPres is true, but S bit is not set, implies, either of PN or E bit 
    * was set during Encode so accordingly extract Byte fields for seqNum anyway 
    ***************************************************************************/
   else if(extPres)
   {
      /*************************************************************************
       * Sequence num is 2 bytes. So decode next 2 bytes from msg hdr and 
       * perform OR operation on them 
       ************************************************************************/
      egtpMsg->msgHdr.seqNum.pres = 0;
      SRemPreMsg(&tmpByte[1], mBuf);
      SRemPreMsg(&tmpByte[2], mBuf);
      egtpMsg->msgHdr.seqNum.val = (tmpByte[1] << 8) | tmpByte[2];
   }

   /* Decode N-PDU number if present flag is set */
   if (tmpByte[0] & EGTP_MASK_BIT1)
   {
      egtpMsg->msgHdr.nPdu.pres = TRUE;
      SRemPreMsg(&(egtpMsg->msgHdr.nPdu.val), mBuf);
   }
   /****************************************************************************
    * If extPres is true, but PN bit is not set, implies, either of S or E bit 
    * was set during Encode. Aaccordingly extract Byte fields of N-PDU num anyway 
    ***************************************************************************/
   else if(extPres)
   {
      egtpMsg->msgHdr.nPdu.pres = TRUE;
      SRemPreMsg(&(egtpMsg->msgHdr.nPdu.val), mBuf);
   }

   /* If E flag is set in first byte, decode extension header */ 
   if(tmpByte[0] & EGTP_MASK_BIT3)
   {
      SRemPreMsg(&extHdrType, mBuf);
      while( 0 != extHdrType)
      {
         switch (extHdrType)
         {
            case EGTP_EXT_HDR_UDP_TYPE:
            {
               SRemPreMsg(&extHdrLen, mBuf);
               if(extHdrLen == 0x01)
               {
                  /************************************************************
                   * UDP Port is 2 bytes. So decode next 2 bytes from msg hdr
                  * and perform OR operation on them 
                  *************************************************************/
                  egtpMsg->msgHdr.extHdr.udpPort.pres = TRUE;
                  SRemPreMsg(&tmpByte[1], mBuf);
                  SRemPreMsg(&tmpByte[2], mBuf);
                  egtpMsg->msgHdr.extHdr.udpPort.val = (tmpByte[1] << 8) | tmpByte[2];
               }
               break;
            }

            case EGTP_EXT_HDR_PDCP_TYPE:
            {
               SRemPreMsg(&extHdrLen, mBuf);
               if(extHdrLen == 0x01)
               {
                  /*************************************************************
                   * PDCP num is 2 bytes. So decode next 2 bytes from msg hdr
                   * and perform OR operation on them 
                   ************************************************************/
                  egtpMsg->msgHdr.extHdr.pdcpNmb.pres = TRUE;
                  SRemPreMsg(&tmpByte[1], mBuf);
                  SRemPreMsg(&tmpByte[2], mBuf);
                  egtpMsg->msgHdr.extHdr.pdcpNmb.val = (tmpByte[1] << 8) | tmpByte[2];
               }
               break;
            }
         } /* End of switch */
 
         SRemPreMsg(&extHdrType, mBuf);
 
      } /* End of while */
   }  
   /****************************************************************************
    * If extPres is true, but E bit is not set, implies, either of PN or S bit 
    * was set during Encode so accordingly extract Byte fields for extension
    * header anyway 
    ***************************************************************************/
   else if(extPres)
   {
      SRemPreMsg(&extHdrType, mBuf);
   }

   egtpMsg->msg = mBuf;

   DU_LOG("\nEGTP : DL Data Buffer after decoding header ");
   SPrntMsg(mBuf, 0, 0);

   /* Forward the data to duApp/RLC */
 
   return ROK;

}