1 /*******************************************************************************
2 ################################################################################
3 # Copyright (c) [2017-2019] [Radisys] #
5 # Licensed under the Apache License, Version 2.0 (the "License"); #
6 # you may not use this file except in compliance with the License. #
7 # You may obtain a copy of the License at #
9 # http://www.apache.org/licenses/LICENSE-2.0 #
11 # Unless required by applicable law or agreed to in writing, software #
12 # distributed under the License is distributed on an "AS IS" BASIS, #
13 # WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. #
14 # See the License for the specific language governing permissions and #
15 # limitations under the License. #
16 ################################################################################
17 *******************************************************************************/
19 /* This file contains all EGTP related functionality */
21 #include "common_def.h"
22 #include "OCTET_STRING.h"
23 #include "cu_stub_sctp.h"
24 #include "cu_f1ap_msg_hdl.h"
25 #include "cu_stub_egtp.h"
33 /**************************************************************************
34 * @brief Task Initiation callback function.
38 * Function : egtpActvInit
41 * This function is supplied as one of parameters during EGTP's
42 * task registration. SSI will invoke this function once, after
43 * it creates and attaches this TAPA Task to a system task.
45 * @param[in] Ent entity, the entity ID of this task.
46 * @param[in] Inst inst, the instance ID of this task.
47 * @param[in] Region region, the region ID registered for memory
49 * @param[in] Reason reason.
50 * @return ROK - success
52 ***************************************************************************/
55 DU_LOG("\n\nDEBUG --> EGTP : Initializing");
56 memset (&egtpCb, 0, sizeof(EgtpGlobalCb));
58 //Initializing with INVALID value
59 memset(egtpCb.gCntPdu, 0xFF , sizeof(uint8_t)*(MAX_TEID+1));
60 protType = CM_INET_PROTO_UDP;
65 /**************************************************************************
66 * @brief Task Activation callback function.
70 * Function : egtpActvTsk
73 * This function handles all EGTP messages received
74 * This API is registered with SSI during the
75 * Task Registration of DU APP.
77 * @param[in] Pst *pst, Post structure of the primitive.
78 * @param[in] Buffer *mBuf, Packed primitive parameters in the
80 * @return ROK - success
83 ***************************************************************************/
91 DU_LOG("\nERROR --> EGTP : Configuration failed");
95 ret = cuEgtpSrvOpenReq();
98 DU_LOG("\nERROR --> EGTP : Transport server open request failed");
105 /**************************************************************************
106 * @brief EGTP server configuration
110 * Function : egtpCfgReq
113 * This function handles EGTP configuration request.
115 * @return ROK - success
118 * ***********************************************************************/
123 memcpy(&egtpCb.egtpCfg, &cuCb.cuCfgParams.egtpParams, sizeof(EgtpParams));
125 egtpCb.recvTptSrvr.addr.address = CM_INET_NTOH_UINT32(egtpCb.egtpCfg.localIp.ipV4Addr);
126 egtpCb.recvTptSrvr.addr.port = EGTP_DFLT_PORT;
128 egtpCb.dstCb.dstIp = CM_INET_NTOH_UINT32(egtpCb.egtpCfg.destIp.ipV4Addr);
129 egtpCb.dstCb.dstPort = egtpCb.egtpCfg.destPort;
130 egtpCb.dstCb.sendTptSrvr.addr.address = CM_INET_NTOH_UINT32(egtpCb.egtpCfg.localIp.ipV4Addr);
131 egtpCb.dstCb.sendTptSrvr.addr.port = egtpCb.egtpCfg.localPort;
132 egtpCb.dstCb.numTunn = 0;
134 ret = cmHashListInit(&(egtpCb.dstCb.teIdLst), 1024, sizeof(EgtpTeIdCb), FALSE, CM_HASH_KEYTYPE_UINT32_MOD, CU_APP_MEM_REG, CU_POOL);
138 DU_LOG("\nERROR --> EGTP : TeId hash list initialization failed");
143 DU_LOG("\nINFO --> EGTP : Configuration successful");
149 /**************************************************************************
150 * @brief EGTP server open request
154 * Function : egtpSrvOpenReq
157 * This function handles EGTP open server request.
158 * It opens udp socket to receive/send msgs.
160 * @param[in] Pst *pst, post structure
161 * @return ROK - success
164 ***************************************************************************/
166 S16 cuEgtpSrvOpenReq(Pst *pst)
171 DU_LOG("\nINFO --> EGTP : Received open server request");
173 sockType = CM_INET_DGRAM;
174 if((ret = (cmInetSocket(sockType, &(egtpCb.recvTptSrvr.sockFd), protType))) != ROK)
176 DU_LOG("\nERROR --> EGTP : Failed to open UDP socket");
180 ret = cmInetBind(&(egtpCb.recvTptSrvr.sockFd), &(egtpCb.recvTptSrvr.addr));
183 DU_LOG("\nERROR --> EGTP : Failed to bind socket");
187 if(ret = (cmInetSocket(sockType, &(egtpCb.dstCb.sendTptSrvr.sockFd), protType)) != ROK)
189 DU_LOG("\nERROR --> EGTP : Failed to open UDP socket");
193 ret = cmInetBind(&(egtpCb.dstCb.sendTptSrvr.sockFd), &(egtpCb.dstCb.sendTptSrvr.addr));
196 DU_LOG("\nERROR --> EGTP : Failed to bind socket");
200 /* TODO: set socket options */
202 DU_LOG("\nINFO --> EGTP : Receiver socket[%d] and Sender socket[%d] open", egtpCb.recvTptSrvr.sockFd.fd,\
203 egtpCb.dstCb.sendTptSrvr.sockFd.fd);
205 } /* cuEgtpSrvOpenReq */
208 /**************************************************************************
209 * @brief EGTP tunnel management request
213 * Function : cuEgtpTnlMgmtReq
216 * This function handles EGTP tunnel managament request
218 * @param[in] Pst *pst, post structure
219 * Tunnel Eveny structure
220 * @return ROK - success
224 * ***************************************************************************/
225 S16 cuEgtpTnlMgmtReq(EgtpTnlEvt tnlEvt)
229 DU_LOG("\nINFO --> EGTP : Received tunnel management request");
230 switch(tnlEvt.action)
232 case EGTP_TNL_MGMT_ADD:
234 ret = cuEgtpTnlAdd(tnlEvt);
237 case EGTP_TNL_MGMT_MOD:
239 ret = cuEgtpTnlMod(tnlEvt);
242 case EGTP_TNL_MGMT_DEL:
244 ret = cuEgtpTnlDel(tnlEvt);
249 DU_LOG("\nERROR --> EGTP : Invalid tunnel management action[%d]", tnlEvt.action);
257 /**************************************************************************
258 * @brief EGTP tunnel addition
262 * Function : cuEgtpTnlAdd
265 * This function handles EGTP tunnel addition
267 * @param[in] Tunnel Event structure
268 * @return ROK - success
271 * ***************************************************************************/
272 S16 cuEgtpTnlAdd(EgtpTnlEvt tnlEvt)
276 EgtpMsgHdr preDefHdr; /* pre-define header for this tunnel */
279 DU_LOG("\nINFO --> EGTP : Tunnel addition : LocalTeid[%d] Remote Teid[%d]", tnlEvt.lclTeid, tnlEvt.remTeid);
281 CU_ALLOC(teidCb, (Size)sizeof(EgtpTeIdCb));
285 DU_LOG("\nERROR --> EGTP : Memory allocation failed");
290 memset(teidCb, 0, sizeof(EgtpTeIdCb));
291 teidCb->teId = tnlEvt.lclTeid;
292 teidCb->remTeId = tnlEvt.remTeid;
294 ret = cmHashListInsert(&(egtpCb.dstCb.teIdLst), (PTR)teidCb, (uint8_t *)&(teidCb->teId), sizeof(uint32_t));
297 DU_LOG("\nERROR --> EGTP : Failed to insert in hash list");
298 CU_FREE(teidCb, (Size)sizeof(EgtpTeIdCb));
301 egtpCb.dstCb.numTunn++;
303 /* Encoding pre-defined header */
304 memset(&preDefHdr, 0, sizeof(EgtpMsgHdr));
305 preDefHdr.msgType = EGTPU_MSG_GPDU;
306 preDefHdr.teId = teidCb->remTeId;
307 preDefHdr.extHdr.pdcpNmb.pres = FALSE;
308 preDefHdr.extHdr.udpPort.pres = FALSE;
309 preDefHdr.nPdu.pres = TRUE; //Including nPdu when sending data
310 preDefHdr.nPdu.val = 0;
312 cuEgtpEncodeHdr((uint8_t *)teidCb->preEncodedHdr.hdr, &preDefHdr, &(teidCb->preEncodedHdr.cnt));
313 egtpCb.gCntPdu[teidCb->remTeId] = 0;//Resetting the Cnt Value for this DRB which indicates its creation
315 /* SPutSBuf(CU_APP_MEM_REG, CU_POOL, (Data *)teidCb, (Size)sizeof(EgtpTeIdCb));*/
320 /**************************************************************************
321 * @brief EGTP tunnel modification
325 * Function : cuEgtpTnlMod
328 * This function handles EGTP tunnel modification
330 * @param[in] Tunnel Event structure
331 * @return ROK - success
334 * ***************************************************************************/
335 S16 cuEgtpTnlMod(EgtpTnlEvt tnlEvt)
339 EgtpTeIdCb *teidCb = NULLP;
341 DU_LOG("\nDEBUG --> CU_STUB : Tunnel modification : LocalTeid[%d] Remote Teid[%d]", tnlEvt.lclTeid, tnlEvt.remTeid);
343 cmHashListFind(&(egtpCb.dstCb.teIdLst), (uint8_t *)&(tnlEvt.teId), sizeof(uint32_t), 0, (PTR *)&teidCb);
346 DU_LOG("\nDEBUG --> CU_STUBTunnel id not found");
350 teidCb->teId = tnlEvt.lclTeid;
351 teidCb->remTeId = tnlEvt.remTeid;
356 /**************************************************************************
357 * @brief EGTP tunnel deletion
361 * Function : cuEgtpTnlDel
364 * This function handles EGTP tunnel deletion
366 * @param[in] Tunnel Event structure
367 * @return ROK - success
370 * ***************************************************************************/
371 S16 cuEgtpTnlDel(EgtpTnlEvt tnlEvt)
373 EgtpTeIdCb *teidCb = NULLP;
375 DU_LOG("\nDEBUG --> EGTP : Tunnel deletion : Local Teid[%d] Remote Teid[%d]", tnlEvt.lclTeid, tnlEvt.remTeid);
377 cmHashListFind(&(egtpCb.dstCb.teIdLst), (uint8_t *)&(tnlEvt.lclTeid), sizeof(uint32_t), 0, (PTR *)&teidCb);
380 DU_LOG("\nERROR --> EGTP : Tunnel id[%d] not configured", tnlEvt.lclTeid);
384 cmHashListDelete(&(egtpCb.dstCb.teIdLst), (PTR)teidCb);
385 CU_FREE(teidCb, (Size)sizeof(EgtpTeIdCb));
386 egtpCb.dstCb.numTunn--;
391 /*******************************************************************
393 * @brief Encodes message header
397 * Function : cuEgtpEncodeHdr
400 * Encodes EGTP message haeder
402 * @params[in] EGTP message
404 * @return ROK - success
407 * ****************************************************************/
408 S16 cuEgtpEncodeHdr(uint8_t *preEncodedHdr, EgtpMsgHdr *preDefHdr, uint8_t *hdrIdx)
410 uint8_t tmpByte = 0; /* Stores one byte of data for enc */
411 uint8_t cnt = EGTP_MAX_HDR_LEN; /* Stores the position */
412 Bool extPres = FALSE; /* Flag for indication of S, E or P presense flag */
415 /* Encoding header */
416 tmpByte |= EGTP_MASK_BIT6; /* Setting 6th LSB of 1st byte as version */
417 tmpByte |= EGTP_MASK_BIT5; /* Setting 5th LSB of 1st byte as protocol type */
419 if(preDefHdr->extHdr.udpPort.pres || preDefHdr->extHdr.pdcpNmb.pres)
421 tmpByte |= EGTP_MASK_BIT3; /* Setting 3rd LSB of 1st byte if Extension heaeder is present */
424 if(preDefHdr->seqNum.pres)
426 tmpByte |= EGTP_MASK_BIT2;
429 if(preDefHdr->nPdu.pres)
431 tmpByte |= EGTP_MASK_BIT1;
434 if((tmpByte & EGTP_MASK_BIT1) || (tmpByte & EGTP_MASK_BIT2)||(tmpByte & EGTP_MASK_BIT3))
438 preEncodedHdr[--cnt] = tmpByte;
439 preEncodedHdr[--cnt] = preDefHdr->msgType;
441 /* Encode Tunnel endpoint */
442 preEncodedHdr[--cnt] = 0;
443 preEncodedHdr[--cnt] = 0;
444 nwWord = (uint16_t)(GetHiWord(preDefHdr->teId));
445 preEncodedHdr[--cnt] = (uint8_t)(GetHiByte(nwWord));
446 preEncodedHdr[--cnt] = (uint8_t)(GetLoByte(nwWord));
447 nwWord = (uint16_t)(GetLoWord(preDefHdr->teId));
448 preEncodedHdr[--cnt] = (uint8_t)(GetHiByte(nwWord));
449 preEncodedHdr[--cnt] = (uint8_t)(GetLoByte(nwWord));
451 /* Encode sequence number */
452 if(preDefHdr->seqNum.pres)
454 preEncodedHdr[--cnt] = GetHiByte(preDefHdr->seqNum.val);
455 preEncodedHdr[--cnt] = GetLoByte(preDefHdr->seqNum.val);
459 preEncodedHdr[--cnt] = 0;
460 preEncodedHdr[--cnt] = 0;
463 if(preDefHdr->nPdu.pres)
465 preEncodedHdr[--cnt] = preDefHdr->nPdu.val;
469 preEncodedHdr[--cnt] = 0;
472 if(preDefHdr->extHdr.udpPort.pres)
474 preEncodedHdr[--cnt] = EGTP_EXT_HDR_UDP_TYPE;
475 preEncodedHdr[--cnt] = 1;
476 preEncodedHdr[--cnt] = GetHiByte(preDefHdr->extHdr.udpPort.val);
477 preEncodedHdr[--cnt] = GetLoByte(preDefHdr->extHdr.udpPort.val);
480 if(preDefHdr->extHdr.pdcpNmb.pres)
482 preEncodedHdr[--cnt] = EGTP_EXT_HDR_PDCP_TYPE;
483 preEncodedHdr[--cnt] = 1;
484 preEncodedHdr[--cnt] = GetHiByte(preDefHdr->extHdr.pdcpNmb.val);
485 preEncodedHdr[--cnt] = GetLoByte(preDefHdr->extHdr.pdcpNmb.val);
488 if(tmpByte & EGTP_MASK_BIT3)
490 preEncodedHdr[--cnt] = 0;
494 preEncodedHdr[--cnt] = 0;
500 } /* egtpEncodeHdr */
502 S16 cuEgtpHdlRecvMsg(Buffer *mBuf)
504 /*Decoding of EGTP message header */
506 cuEgtpDecodeHdr(mBuf);
508 /* Start Pumping data from CU to DU */
509 //return (cuEgtpDatReq());
513 S16 cuEgtpDecodeHdr(Buffer *mBuf)
516 uint8_t tmpByte[5]; /* Holds one byte of data after Dec */
517 uint8_t version = 0; /* Holds the version type, decoded */
518 MsgLen msgLen = 0; /* Holds the msgLen from the Hdr */
519 MsgLen bufLen = 0; /* Holds the total buffer length */
520 uint8_t extHdrType = 0; /* Holds the Extension hdr type */
521 uint8_t extHdrLen = 0; /* Extension hdr length */
522 Bool extPres = FALSE; /* Flag for indication of S, E or P presense flag */
524 ODU_GET_MSG_LEN(mBuf, &bufLen);
527 ODU_REM_PRE_MSG(&tmpByte[0], mBuf);
528 version = tmpByte[0] >> 5;
530 /* Decode message type */
531 ODU_REM_PRE_MSG((Data*)&(egtpMsg.msgHdr.msgType), mBuf);
533 /* Decode message length */
534 ODU_REM_PRE_MSG(&tmpByte[1], mBuf);
535 ODU_REM_PRE_MSG(&tmpByte[2], mBuf);
536 msgLen = (tmpByte[1] << 8) | tmpByte[2];
538 /* Decode tunnel id */
539 ODU_REM_PRE_MSG(&tmpByte[1], mBuf);
540 ODU_REM_PRE_MSG(&tmpByte[2], mBuf);
541 ODU_REM_PRE_MSG(&tmpByte[3], mBuf);
542 ODU_REM_PRE_MSG(&tmpByte[4], mBuf);
543 egtpMsg.msgHdr.teId = (tmpByte[1] << 24) | (tmpByte[2] << 16) | (tmpByte[3] << 8) | tmpByte[4];
545 if((tmpByte[0] & EGTP_MASK_BIT1) || (tmpByte[0] & EGTP_MASK_BIT2)||(tmpByte[0] & EGTP_MASK_BIT3))
550 /* Decode sequence number */
551 if ( tmpByte[0] & EGTP_MASK_BIT2 )
553 egtpMsg.msgHdr.seqNum.pres = TRUE;
554 ODU_REM_PRE_MSG(&tmpByte[1], mBuf);
555 ODU_REM_PRE_MSG(&tmpByte[2], mBuf);
556 egtpMsg.msgHdr.seqNum.val = (tmpByte[1] << 8) | tmpByte[2];
560 egtpMsg.msgHdr.seqNum.pres = 0;
561 ODU_REM_PRE_MSG(&tmpByte[1], mBuf);
562 ODU_REM_PRE_MSG(&tmpByte[2], mBuf);
563 egtpMsg.msgHdr.seqNum.val = (tmpByte[1] << 8) | tmpByte[2];
566 /* Decode N-PDU number */
567 if ( tmpByte[0] & EGTP_MASK_BIT1 )
569 egtpMsg.msgHdr.nPdu.pres = TRUE;
570 ODU_REM_PRE_MSG(&(egtpMsg.msgHdr.nPdu.val), mBuf);
574 egtpMsg.msgHdr.nPdu.pres = TRUE;
575 ODU_REM_PRE_MSG(&(egtpMsg.msgHdr.nPdu.val), mBuf);
578 if(extPres & EGTP_MASK_BIT1)
580 ODU_REM_PRE_MSG(&extHdrType, mBuf);
581 while( 0 != extHdrType)
585 case EGTP_EXT_HDR_UDP_TYPE:
587 ODU_REM_PRE_MSG(&extHdrLen, mBuf);
588 if(extHdrLen == 0x01)
590 egtpMsg.msgHdr.extHdr.udpPort.pres = TRUE;
591 ODU_REM_PRE_MSG(&tmpByte[1], mBuf);
592 ODU_REM_PRE_MSG(&tmpByte[2], mBuf);
593 egtpMsg.msgHdr.extHdr.udpPort.val = (tmpByte[1] << 8) | tmpByte[2];
598 case EGTP_EXT_HDR_PDCP_TYPE:
600 ODU_REM_PRE_MSG(&extHdrLen, mBuf);
601 if(extHdrLen == 0x01)
603 egtpMsg.msgHdr.extHdr.pdcpNmb.pres = TRUE;
604 ODU_REM_PRE_MSG(&tmpByte[1], mBuf);
605 ODU_REM_PRE_MSG(&tmpByte[2], mBuf);
606 egtpMsg.msgHdr.extHdr.pdcpNmb.val = (tmpByte[1] << 8) | tmpByte[2];
610 } /* End of switch */
612 ODU_REM_PRE_MSG(&extHdrType, mBuf);
615 } /* End of if(extPres & EGTP_MASK_BIT1) */
618 ODU_REM_PRE_MSG(&extHdrType, mBuf);
621 DU_LOG("\nDEBUG --> EGTP : Message Buffer after decoding header [TEID:%d]",egtpMsg.msgHdr.teId);
622 ODU_PRINT_MSG(mBuf, 0, 0);
628 } /* End of cuEgtpDecodeHdr */
630 uint16_t cuEgtpDatReq(uint8_t teId)
632 uint8_t ret = ROK, cnt = 0;
635 egtpMsg.msgHdr.teId = teId;
637 if(egtpCb.gCntPdu[teId] == 0xFF) //DRB not created
639 DU_LOG("\nERROR --> EGTP : DRB not created");
642 /* Build Application message that is supposed to come from app to egtp */
643 ret = BuildAppMsg(&egtpMsg);
646 DU_LOG("\nERROR --> EGTP : Failed to build App Msg");
650 /* Encode EGTP header to build final EGTP message */
651 ret = BuildEgtpMsg(&egtpMsg);
654 DU_LOG("\nERROR --> EGTP : Failed to build EGTP Msg");
657 cuEgtpSendMsg(egtpMsg.msg);
658 ODU_PUT_MSG_BUF(egtpMsg.msg);
664 S16 BuildAppMsg(EgtpMsg *egtpMsg)
666 char data[1215] = "In telecommunications, 5G is the fifth generation technology standard for broadband cellular"
667 " networks, which cellular phone companies began deploying worldwide in 2019, and is the planned successor to the 4G "
668 " networks which provide connectivity to most current cellphones. 5G networks are predicted to have more than 1.7"
669 " billion subscribers worldwide by 2025, according to the GSM Association.Like its predecessors, 5G networks are"
670 " cellular networks,in which the service area is divided into small geographical areas called cells.All 5G wireless"
671 " devices in a cell are connected to the Internet and telephone network by radio waves through local antenna in the"
672 " cell. The main advantage of the new networks is that they will have greater bandwidth, giving higher download"
673 " speeds, eventually up to 10 gigabits per second(Gbit/s). Due to the increased bandwidth, it is expected the"
674 " networks will not exclusively serve cellphones like existing cellular networks, but also be used as general"
675 " internet service providers for laptops and desktop computers, competing with existing ISPs such as cable"
676 " internet, and also will make possible new applications in internet of things (IoT) and machine to machine areas.";
682 if(ODU_GET_MSG_BUF(CU_APP_MEM_REG, CU_POOL, &mBuf) == ROK)
684 if(ODU_ADD_POST_MSG_MULT((Data *)data, datSize, mBuf) != ROK)
686 DU_LOG("\nERROR --> EGTP : ODU_ADD_POST_MSG_MULT failed");
687 ODU_PUT_MSG_BUF(mBuf);
693 DU_LOG("\nERROR --> EGTP : Failed to allocate memory");
697 /* filling IPv4 header */
702 ODU_GET_MSG_LEN(mBuf, &mLen);
704 memset(&ipv4Hdr, 0, sizeof(CmIpv4Hdr));
705 ipv4Hdr.length = CM_IPV4_HDRLEN + mLen;
706 ipv4Hdr.hdrVer = 0x45;
708 ipv4Hdr.srcAddr = CM_INET_NTOH_UINT32(egtpCb.egtpCfg.localIp.ipV4Addr);
709 ipv4Hdr.destAddr = CM_INET_NTOH_UINT32(egtpCb.egtpCfg.destIp.ipV4Addr);
711 /* Packing IPv4 header into buffer */
713 Data revPkArray[CM_IPV4_HDRLEN];
714 Data pkArray[CM_IPV4_HDRLEN];
716 /* initialize locals */
718 memset(revPkArray, 0, CM_IPV4_HDRLEN);
719 memset(pkArray, 0, CM_IPV4_HDRLEN);
721 /* Pack Header Version */
722 pkArray[cnt++] = ipv4Hdr.hdrVer;
725 pkArray[cnt++] = ipv4Hdr.tos;
727 pkArray[cnt++] = (Data)GetHiByte(ipv4Hdr.length);
728 pkArray[cnt++] = (Data)GetLoByte(ipv4Hdr.length);
731 pkArray[cnt++] = (Data) GetHiByte(ipv4Hdr.id);
732 pkArray[cnt++] = (Data) GetLoByte(ipv4Hdr.id);
735 pkArray[cnt++] = (Data)GetHiByte(ipv4Hdr.off);
736 pkArray[cnt++] = (Data)GetLoByte(ipv4Hdr.off);
739 pkArray[cnt++] = ipv4Hdr.ttl;
742 pkArray[cnt++] = ipv4Hdr.proto;
745 pkArray[cnt++] = (Data)GetHiByte(ipv4Hdr.chkSum);
746 pkArray[cnt++] = (Data)GetLoByte(ipv4Hdr.chkSum);
748 /* Pack Source Address */
749 pkArray[cnt++] = (Data)GetHiByte(GetHiWord(ipv4Hdr.srcAddr));
750 pkArray[cnt++] = (Data)GetLoByte(GetHiWord(ipv4Hdr.srcAddr));
751 pkArray[cnt++] = (Data)GetHiByte(GetLoWord(ipv4Hdr.srcAddr));
752 pkArray[cnt++] = (Data)GetLoByte(GetLoWord(ipv4Hdr.srcAddr));
754 /* Pack Destination Address */
755 pkArray[cnt++] = (Data)GetHiByte(GetHiWord(ipv4Hdr.destAddr));
756 pkArray[cnt++] = (Data)GetLoByte(GetHiWord(ipv4Hdr.destAddr));
757 pkArray[cnt++] = (Data)GetHiByte(GetLoWord(ipv4Hdr.destAddr));
758 pkArray[cnt++] = (Data)GetLoByte(GetLoWord(ipv4Hdr.destAddr));
760 for (idx = 0; idx < CM_IPV4_HDRLEN; idx++)
761 revPkArray[idx] = pkArray[CM_IPV4_HDRLEN - idx -1];
763 /* this function automatically reverses revPkArray */
764 ret = ODU_ADD_PRE_MSG_MULT(revPkArray, (MsgLen)cnt, mBuf);
766 egtpMsg->msgHdr.msgType = EGTPU_MSG_GPDU;
767 egtpMsg->msgHdr.nPdu.pres = TRUE;
769 if(egtpCb.gCntPdu[egtpMsg->msgHdr.teId] != NUM_DL_PACKETS)
770 egtpCb.gCntPdu[egtpMsg->msgHdr.teId]++;
772 egtpCb.gCntPdu[egtpMsg->msgHdr.teId] = 1;
774 egtpMsg->msgHdr.nPdu.val = egtpCb.gCntPdu[egtpMsg->msgHdr.teId];
775 egtpMsg->msgHdr.seqNum.pres = FALSE;
776 egtpMsg->msgHdr.extHdr.udpPort.pres = FALSE;
777 egtpMsg->msgHdr.extHdr.pdcpNmb.pres = FALSE;
783 S16 BuildEgtpMsg(EgtpMsg *egtpMsg)
785 EgtpTeIdCb *teidCb = NULLP;
791 cmHashListFind(&(egtpCb.dstCb.teIdLst), (uint8_t *)&(egtpMsg->msgHdr.teId), sizeof(uint32_t), 0, (PTR *)&teidCb);
794 DU_LOG("\nERROR --> EGTP : Tunnel id[%d] not configured", egtpMsg->msgHdr.teId);
795 return (LCM_REASON_INVALID_PAR_VAL);
798 msgHdr = &(egtpMsg->msgHdr);
800 hdrLen = teidCb->preEncodedHdr.cnt;
802 if(msgHdr->extHdr.pdcpNmb.pres)
804 teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 1] |= EGTP_MASK_BIT3;
805 teidCb->preEncodedHdr.hdr[hdrLen] = EGTP_EXT_HDR_PDCP_TYPE;
806 teidCb->preEncodedHdr.hdr[--hdrLen] = 1;
807 teidCb->preEncodedHdr.hdr[--hdrLen] = GetHiByte(msgHdr->extHdr.pdcpNmb.val);
808 teidCb->preEncodedHdr.hdr[--hdrLen] = GetLoByte(msgHdr->extHdr.pdcpNmb.val);
809 teidCb->preEncodedHdr.hdr[--hdrLen] = 0;
813 teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 1] &= ~(EGTP_MASK_BIT3);
816 ODU_GET_MSG_LEN(egtpMsg->msg, &tPduSize);
818 /*Adjust the header to fill the correct length*/
819 msgLen = tPduSize + (EGTP_MAX_HDR_LEN - hdrLen) - 0x08;
821 /***********************************************
822 * Fill the length field of the message header *
823 ***********************************************/
824 teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 3] = (uint8_t)GetHiByte(msgLen);
825 teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 4] = (uint8_t)GetLoByte(msgLen);
827 /*Update the sequence number*/
828 if(egtpMsg->msgHdr.seqNum.pres)
830 teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 1] |= (EGTP_MASK_BIT2);
831 teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 9] = (uint8_t)GetHiByte(egtpMsg->msgHdr.seqNum.val);
832 teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 10] = (uint8_t)GetLoByte(egtpMsg->msgHdr.seqNum.val);
836 teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 1] &= ~(EGTP_MASK_BIT2);
839 /*Update the nPdU number*/
840 if(egtpMsg->msgHdr.nPdu.pres)
842 teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 1] |= (EGTP_MASK_BIT1);
843 teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 11] = egtpMsg->msgHdr.nPdu.val;
847 teidCb->preEncodedHdr.hdr[EGTP_MAX_HDR_LEN - 1] &= ~(EGTP_MASK_BIT1);
850 ODU_ADD_PRE_MSG_MULT(&teidCb->preEncodedHdr.hdr[hdrLen], (EGTP_MAX_HDR_LEN - hdrLen), egtpMsg->msg);
854 S16 cuEgtpSendMsg(Buffer *mBuf)
861 info.region = CU_APP_MEM_REG;
864 dstAddr.port = EGTP_DFLT_PORT;
865 dstAddr.address = egtpCb.dstCb.dstIp;
867 ret = cmInetSendMsg(&(egtpCb.dstCb.sendTptSrvr.sockFd), &dstAddr, &info, mBuf, &txLen, CM_INET_NO_FLAG);
868 if(ret != ROK && ret != RWOULDBLOCK)
870 DU_LOG("\nERROR --> EGTP : Message send failure");
874 DU_LOG("\nDEBUG --> EGTP : Message Sent");