src/5gnrrlc/mac_stub.c

   1 /*******************************************************************************
   2 ################################################################################
   3 #   Copyright (c) [2017-2019] [Radisys]                                        #
   4 #                                                                              #
   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                                    #
   8 #                                                                              #
   9 #       http://www.apache.org/licenses/LICENSE-2.0                             #
  10 #                                                                              #
  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 *******************************************************************************/
  18
  19 #ifdef EGTP_TEST
  20
  21 #include "mac_stub.h"
  22
  23 uint8_t rlcDatSn = 0;
  24 uint64_t ulDatNum = 0;
  25
  26 PUBLIC S16 macStubBOStatus(Pst *pst, SpId spId, RlcMacBOStatus *boSta)
  27 {
  28   Pst rspPst;
  29   RlcMacSchedRep *schRep;
  30
  31   DU_LOG("\nMAC : Received BO status from RLC");
  32
  33 //  SGetSBuf(pst->region, pst->pool, (Data **)&rspPst, sizeof(Pst));
  34
  35   rspPst.selector  = RGU_SEL_TC;
  36   rspPst.srcEnt    = pst->dstEnt;
  37   rspPst.dstEnt    = pst->srcEnt;
  38   rspPst.dstInst   = pst->srcInst;
  39   rspPst.dstProcId = pst->srcProcId;
  40   rspPst.srcProcId = pst->dstProcId;
  41   rspPst.region    = pst->region;
  42   rspPst.pool    = pst->pool;
  43
  44   /* Filling Scheduling Report */
  45   KW_SHRABL_STATIC_BUF_ALLOC(pst->region, pst->pool, schRep, sizeof(RlcMacSchedRep));
  46
  47   schRep->cellId = boSta->cellId;
  48   schRep->rnti   = boSta->rnti;
  49   schRep->nmbLch = 1;
  50   schRep->lchSta[0].commCh = boSta->commCh;
  51   schRep->lchSta[0].lchStaInd.lcId = boSta->lcId;
  52   schRep->lchSta[0].lchStaInd.totBufSize = boSta->bo + 5; /* Extra buffer space including RLC and MAC Header size */
  53
  54   DU_LOG("\nMAC : Sending scheduling report to RLC");
  55
  56   RlcMacProcSchedRep(&rspPst, 1, schRep);
  57
  58   return ROK;
  59
  60 }
  61
  62 PUBLIC S16 macStubSendDlData(Pst *pst, SpId spId, RlcMacData *dlData)
  63 {
  64    U32 availmem;
  65
  66    Pst rspPst;
  67    Buffer *mBuf;
  68    RlcMacData *ulData;
  69
  70    DU_LOG("\nMAC_STUB : Received DL data from RLC to be sent to PHY");
  71
  72    SPutMsg(dlData->pduInfo[0].pduBuf);
  73    dlData->pduInfo[0].pduBuf = NULL;
  74
  75 #if 0
  76    KW_FREE_SHRABL_BUF(pst->region, pst->pool,
  77                         dlData, sizeof(RlcMacData));
  78 {
  79    KW_ALLOC_SHRABL_BUF(pst->region, pst->pool,
  80                           ulData, sizeof(RlcMacData));
  81
  82    SRegInfoShow(2, &availmem);
  83    cmMemcpy((U8 *)ulData, (U8 *)dlData, sizeof(RlcMacData));
  84 #endif
  85
  86    ulData = dlData;
  87    SGetMsg(pst->region, pst->pool, &mBuf);
  88    macStubBuildUlData(mBuf);
  89    ulData->pduInfo[0].pduBuf = mBuf;
  90
  91    /* Fill response post */
  92    rspPst.selector  = RGU_SEL_TC;
  93    rspPst.srcEnt    = pst->dstEnt;
  94    rspPst.dstEnt    = pst->srcEnt;
  95    rspPst.dstInst   = pst->srcInst;
  96    rspPst.dstProcId = pst->srcProcId;
  97    rspPst.srcProcId = pst->dstProcId;
  98    rspPst.region    = pst->region;
  99    rspPst.pool      = pst->pool;
 100
 101    ulDatNum++;
 102    DU_LOG("\nMAC_STUB : UL data number %d", ulDatNum);
 103    RlcMacProcUlData(&rspPst, 1, ulData);
 104    return ROK;
 105 }
 106
 107 void macStubBuildUlData(Buffer *mBuf)
 108 {
 109    char data[30] = "This is EGTP data from DU";
 110    int datSize = 30;
 111    U32 availmem;
 112
 113    SAddPstMsgMult((Data *)data, datSize, mBuf);
 114
 115    /* filling IPv4 header */
 116    CmIpv4Hdr ipv4Hdr;
 117    MsgLen    mLen;
 118    U32 ipv4_du, ipv4_cu;
 119
 120    cmInetAddr((S8*)DU_IP_V4_ADDR, &ipv4_du);
 121    cmInetAddr((S8*)CU_IP_V4_ADDR, &ipv4_cu);
 122
 123    mLen = 0;
 124    SFndLenMsg(mBuf, &mLen);
 125
 126    cmMemset((U8 *)&ipv4Hdr, 0, sizeof(CmIpv4Hdr));
 127    ipv4Hdr.length = CM_IPV4_HDRLEN + mLen;
 128    ipv4Hdr.hdrVer = 0x45;
 129    ipv4Hdr.proto = 1;
 130    ipv4Hdr.srcAddr = CM_INET_NTOH_U32(ipv4_du);
 131    ipv4Hdr.destAddr = CM_INET_NTOH_U32(ipv4_cu);
 132
 133    /* Packing IPv4 header into buffer */
 134    S16          ret, cnt, idx;
 135    Data         revPkArray[CM_IPV4_HDRLEN];
 136    Data         pkArray[CM_IPV4_HDRLEN];
 137
 138    /* initialize locals */
 139    cnt = 0;
 140    cmMemset(revPkArray, 0, CM_IPV4_HDRLEN);
 141    cmMemset(pkArray, 0, CM_IPV4_HDRLEN);
 142
 143    /* Pack Header Version */
 144    pkArray[cnt++] = ipv4Hdr.hdrVer;
 145
 146    /* Pack TOS */
 147    pkArray[cnt++] = ipv4Hdr.tos;
 148
 149    pkArray[cnt++] = (Data)GetHiByte(ipv4Hdr.length);
 150    pkArray[cnt++] = (Data)GetLoByte(ipv4Hdr.length);
 151
 152    /* Pack Id */
 153    pkArray[cnt++] = (Data) GetHiByte(ipv4Hdr.id);
 154    pkArray[cnt++] = (Data) GetLoByte(ipv4Hdr.id);
 155
 156    /* Pack Offset */
 157    pkArray[cnt++] = (Data)GetHiByte(ipv4Hdr.off);
 158    pkArray[cnt++] = (Data)GetLoByte(ipv4Hdr.off);
 159
 160    /* Pack TTL */
 161    pkArray[cnt++] = ipv4Hdr.ttl;
 162
 163    /* Pack Protocol */
 164    pkArray[cnt++] = ipv4Hdr.proto;
 165
 166    /* Pack Checksum */
 167    pkArray[cnt++] = (Data)GetHiByte(ipv4Hdr.chkSum);
 168    pkArray[cnt++] = (Data)GetLoByte(ipv4Hdr.chkSum);
 169
 170    /* Pack Source Address */
 171    pkArray[cnt++] = (Data)GetHiByte(GetHiWord(ipv4Hdr.srcAddr));
 172    pkArray[cnt++] = (Data)GetLoByte(GetHiWord(ipv4Hdr.srcAddr));
 173    pkArray[cnt++] = (Data)GetHiByte(GetLoWord(ipv4Hdr.srcAddr));
 174    pkArray[cnt++] = (Data)GetLoByte(GetLoWord(ipv4Hdr.srcAddr));
 175
 176    /* Pack Destination Address */
 177    pkArray[cnt++] = (Data)GetHiByte(GetHiWord(ipv4Hdr.destAddr));
 178    pkArray[cnt++] = (Data)GetLoByte(GetHiWord(ipv4Hdr.destAddr));
 179    pkArray[cnt++] = (Data)GetHiByte(GetLoWord(ipv4Hdr.destAddr));
 180    pkArray[cnt++] = (Data)GetLoByte(GetLoWord(ipv4Hdr.destAddr));
 181
 182    for (idx = 0;  idx < CM_IPV4_HDRLEN;  idx++)
 183         revPkArray[idx] = pkArray[CM_IPV4_HDRLEN - idx -1];
 184
 185    /* this function automatically reverses revPkArray */
 186    ret = SAddPreMsgMult(revPkArray, (MsgLen)cnt, mBuf);
 187
 188    SAddPreMsgMult((Data *)&rlcDatSn, sizeof(uint8_t), mBuf);
 189 #if 0
 190    SRegInfoShow(0, &availmem);
 191    SRegInfoShow(1, &availmem);
 192    SRegInfoShow(2, &availmem);
 193    SRegInfoShow(3, &availmem);
 194    SRegInfoShow(4, &availmem);
 195 #endif
 196    //rlcDatSn++;
 197    //
 198    if(rlcDatSn++ >15 )
 199       rlcDatSn = 0;
 200
 201 } /* macStubBuildUlData */
 202
 203 #endif /* EGTP_TEST */
 204
 205 /**********************************************************************
 206          End of file
 207 **********************************************************************/