- /* filling IPv4 header */
- CmIpv4Hdr ipv4Hdr;
- MsgLen mLen;
-
- mLen = 0;
- SFndLenMsg(mBuf, &mLen);
-
- cmMemset((U8 *)&ipv4Hdr, 0, sizeof(CmIpv4Hdr));
- ipv4Hdr.length = CM_IPV4_HDRLEN + mLen;
- ipv4Hdr.hdrVer = 0x45;
- ipv4Hdr.proto = 1;
- ipv4Hdr.srcAddr = CM_INET_NTOH_U32(duCfgParam.egtpParams.localIp.ipV4Addr);
- ipv4Hdr.destAddr = CM_INET_NTOH_U32(duCfgParam.egtpParams.destIp.ipV4Addr);
-
- /* Packing IPv4 header into buffer */
- S16 ret, cnt, idx;
- Data revPkArray[CM_IPV4_HDRLEN];
- Data pkArray[CM_IPV4_HDRLEN];
-
- /* initialize locals */
- cnt = 0;
- cmMemset(revPkArray, 0, CM_IPV4_HDRLEN);
- cmMemset(pkArray, 0, CM_IPV4_HDRLEN);
-
- /* Pack Header Version */
- pkArray[cnt++] = ipv4Hdr.hdrVer;
-
- /* Pack TOS */
- pkArray[cnt++] = ipv4Hdr.tos;
-
- pkArray[cnt++] = (Data)GetHiByte(ipv4Hdr.length);
- pkArray[cnt++] = (Data)GetLoByte(ipv4Hdr.length);
-
- /* Pack Id */
- pkArray[cnt++] = (Data) GetHiByte(ipv4Hdr.id);
- pkArray[cnt++] = (Data) GetLoByte(ipv4Hdr.id);
-
- /* Pack Offset */
- pkArray[cnt++] = (Data)GetHiByte(ipv4Hdr.off);
- pkArray[cnt++] = (Data)GetLoByte(ipv4Hdr.off);
-
- /* Pack TTL */
- pkArray[cnt++] = ipv4Hdr.ttl;
-
- /* Pack Protocol */
- pkArray[cnt++] = ipv4Hdr.proto;
-
- /* Pack Checksum */
- pkArray[cnt++] = (Data)GetHiByte(ipv4Hdr.chkSum);
- pkArray[cnt++] = (Data)GetLoByte(ipv4Hdr.chkSum);
-
- /* Pack Source Address */
- pkArray[cnt++] = (Data)GetHiByte(GetHiWord(ipv4Hdr.srcAddr));
- pkArray[cnt++] = (Data)GetLoByte(GetHiWord(ipv4Hdr.srcAddr));
- pkArray[cnt++] = (Data)GetHiByte(GetLoWord(ipv4Hdr.srcAddr));
- pkArray[cnt++] = (Data)GetLoByte(GetLoWord(ipv4Hdr.srcAddr));
-
- /* Pack Destination Address */
- pkArray[cnt++] = (Data)GetHiByte(GetHiWord(ipv4Hdr.destAddr));
- pkArray[cnt++] = (Data)GetLoByte(GetHiWord(ipv4Hdr.destAddr));
- pkArray[cnt++] = (Data)GetHiByte(GetLoWord(ipv4Hdr.destAddr));
- pkArray[cnt++] = (Data)GetLoByte(GetLoWord(ipv4Hdr.destAddr));
-
- for (idx = 0; idx < CM_IPV4_HDRLEN; idx++)
- revPkArray[idx] = pkArray[CM_IPV4_HDRLEN - idx -1];
-
- /* this function automatically reverses revPkArray */
- ret = SAddPreMsgMult(revPkArray, (MsgLen)cnt, mBuf);
-
- duSendEgtpDatInd(mBuf);
-
- RETVALUE(ROK);
-}
-#endif /* EGTP_TEST */