X-Git-Url: https://gerrit.o-ran-sc.org/r/gitweb?a=blobdiff_plain;f=src%2F5gnrsch%2Fsch_ue_mgr.c;h=bb76ede8ca2812bf0acee55bd87e17bc8c37f50f;hb=791615463ef2fcc0d6e0697d7860e6e6a56bd9a6;hp=ee6cdb1e8e7c41166bf7fa3e4505be5c85e049b4;hpb=a5530e70a9d414952dadd1688aa9b4280c0dbb5a;p=o-du%2Fl2.git diff --git a/src/5gnrsch/sch_ue_mgr.c b/src/5gnrsch/sch_ue_mgr.c index ee6cdb1e8..bb76ede8c 100644 --- a/src/5gnrsch/sch_ue_mgr.c +++ b/src/5gnrsch/sch_ue_mgr.c @@ -53,13 +53,11 @@ SchUeCfgRspFunc SchUeCfgRspOpts[] = * RFAILED - failure * * ****************************************************************/ -void SchSendUeCfgRspToMac(SchUeCfg *ueCfg, Inst inst,\ +void SchSendUeCfgRspToMac(uint16_t event, SchUeCfg *ueCfg, Inst inst,\ SchMacRsp result, SchUeCfgRsp *cfgRsp) { Pst rspPst; - DU_LOG("\nSCH: Sending UE Create response to MAC"); - cfgRsp->cellId = ueCfg->cellId; cfgRsp->crnti = ueCfg->crnti; GET_UE_IDX(ueCfg->crnti, cfgRsp->ueIdx); @@ -68,44 +66,206 @@ void SchSendUeCfgRspToMac(SchUeCfg *ueCfg, Inst inst,\ /* Filling response post */ memset(&rspPst, 0, sizeof(Pst)); FILL_PST_SCH_TO_MAC(rspPst, inst); - rspPst.event = EVENT_UE_CREATE_RSP_TO_MAC; - + if(event == EVENT_ADD_UE_CONFIG_REQ_TO_SCH) + { + rspPst.event = EVENT_UE_CONFIG_RSP_TO_MAC; + DU_LOG("\nSCH: Sending UE Config response to MAC"); + } + else if(event == EVENT_MODIFY_UE_CONFIG_REQ_TO_SCH) + { + rspPst.event = EVENT_UE_RECONFIG_RSP_TO_MAC; + DU_LOG("\nSCH: Sending UE Reconfig response to MAC"); + } SchUeCfgRspOpts[rspPst.selector](&rspPst, cfgRsp); } /******************************************************************* + * - * @brief Hanles Ue create request from MAC + * @brief Function to fill Dl Lc Context in SCH Ue Cb * * @details * - * Function : macSchUeCreateReq + * Function : fillSchDlLcCtxt * - * Functionality: Hanles Ue create request from MAC + * Functionality: Function to fill Dl Lc Context in SCH Ue Cb * - * @params[in] - * @return ROK - success - * RFAILED - failure + * @params[in] SchDlLcCtxt pointer, + * SchLcCfg pointer + * @return void * * ****************************************************************/ -uint8_t macSchUeCreateReq(Pst *pst, SchUeCfg *ueCfg) + +void fillSchDlLcCtxt(SchDlLcCtxt *ueCbLcCfg, SchLcCfg *lcCfg) { - uint8_t idx; - uint16_t ueIdx; - SchCellCb *cellCb; - SchUeCb *ueCb; - SchUeCfgRsp cfgRsp; - Inst inst = pst->dstInst - 1; + ueCbLcCfg->lcId = lcCfg->lcId; + ueCbLcCfg->lcp = lcCfg->dlLcCfg.lcp; + ueCbLcCfg->lcState = SCH_LC_STATE_ACTIVE; + ueCbLcCfg->bo = 0; +} - DU_LOG("\nSCH : UE Create Request for CRNTI[%d]", ueCfg->crnti); +/******************************************************************* + * + * @brief Function to fill Ul Lc Context in SCH Ue Cb + * + * @details + * + * Function : fillSchUlLcCtxt + * + * Functionality: Function to fill Ul Lc Context in SCH Ue Cb + * + * @params[in] SchUlLcCtxt pointer, + * SchLcCfg pointer + * @return void + * + * ****************************************************************/ - memset(&cfgRsp, 0, sizeof(SchUeCfgRsp)); +void fillSchUlLcCtxt(SchUlLcCtxt *ueCbLcCfg, SchLcCfg *lcCfg) +{ + ueCbLcCfg->lcId = lcCfg->lcId; + ueCbLcCfg->lcState = SCH_LC_STATE_ACTIVE; + ueCbLcCfg->priority = lcCfg->ulLcCfg.priority; + ueCbLcCfg->lcGroup = lcCfg->ulLcCfg.lcGroup; + ueCbLcCfg->schReqId = lcCfg->ulLcCfg.schReqId; + ueCbLcCfg->pbr = lcCfg->ulLcCfg.pbr; + ueCbLcCfg->bsd = lcCfg->ulLcCfg.bsd; - if(!ueCfg) +} + +/******************************************************************* + * + * @brief Function to update Sch Ul Lc Cb + * + * @details + * + * Function : updateSchUlCb + * + * Functionality: Function to update SCH Ul Lc Cb + * + * @returns void + * + * ****************************************************************/ + +void updateSchUlCb(uint8_t delIdx, SchUlCb *ulInfo) +{ + uint8_t lcIdx = 0; + + for(lcIdx = delIdx; lcIdx < ulInfo->numUlLc; lcIdx++) { - DU_LOG("\nSCH : UE create request failed"); - return RFAILED; + memcpy(&ulInfo->ulLcCtxt[lcIdx], &ulInfo->ulLcCtxt[lcIdx+1], sizeof(SchUlLcCtxt)); + memset(&ulInfo->ulLcCtxt[lcIdx+1], 0, sizeof(SchUlLcCtxt)); + } +} + +/******************************************************************* + * + * @brief Function to update SCH Dl Lc Cb + * + * @details + * + * Function : updateSchDlCb + * + * Functionality: Function to update SCH DL Lc Cb + * + * @returns void + * + * ****************************************************************/ + +void updateSchDlCb(uint8_t delIdx, SchDlCb *dlInfo) +{ + uint8_t lcIdx = 0; + + for(lcIdx = delIdx; lcIdx < dlInfo->numDlLc; lcIdx++) + { + memcpy(&dlInfo->dlLcCtxt[lcIdx], &dlInfo->dlLcCtxt[lcIdx+1], sizeof(SchDlLcCtxt)); + memset(&dlInfo->dlLcCtxt[lcIdx+1], 0, sizeof(SchDlLcCtxt)); } +} + +/******************************************************************* + * + * @brief Function to fill SchUeCb + * + * @details + * + * Function : fillSchUeCb + * + * Functionality: Function to fill SchUeCb + * + * @params[in] SchUeCb pointer, + * SchUeCfg pointer + * @return ROK/RFAILED + * + * ****************************************************************/ + +uint8_t fillSchUeCb(SchUeCb *ueCb, SchUeCfg *ueCfg) +{ + uint8_t lcIdx, ueLcIdx; + + memset(&ueCb->ueCfg, 0, sizeof(SchUeCfg)); + memcpy(&ueCb->ueCfg, ueCfg, sizeof(SchUeCfg)); + ueCb->state = SCH_UE_STATE_ACTIVE; + + for(lcIdx = 0; lcIdx < ueCfg->numLcs; lcIdx++) + { + if(ueCfg->schLcCfg[lcIdx].configType == CONFIG_ADD) + { + fillSchUlLcCtxt(&ueCb->ulInfo.ulLcCtxt[ueCb->ulInfo.numUlLc], &ueCfg->schLcCfg[lcIdx]); + ueCb->ulInfo.numUlLc++; + fillSchDlLcCtxt(&ueCb->dlInfo.dlLcCtxt[ueCb->dlInfo.numDlLc], &ueCfg->schLcCfg[lcIdx]); + ueCb->dlInfo.numDlLc++; + } + else + { + for(ueLcIdx = 0; ueLcIdx < ueCb->ulInfo.numUlLc; ueLcIdx++) //searching for Lc to be Mod + { + if(ueCb->ulInfo.ulLcCtxt[ueLcIdx].lcId == ueCfg->schLcCfg[lcIdx].lcId) + { + if(ueCfg->schLcCfg[lcIdx].configType == CONFIG_MOD) + { + fillSchUlLcCtxt(&ueCb->ulInfo.ulLcCtxt[ueLcIdx], &ueCfg->schLcCfg[lcIdx]); + fillSchDlLcCtxt(&ueCb->dlInfo.dlLcCtxt[ueLcIdx], &ueCfg->schLcCfg[lcIdx]); + break; + } + if(ueCfg->schLcCfg[ueLcIdx].configType == CONFIG_DEL) + { + memset(&ueCb->ulInfo.ulLcCtxt[ueLcIdx], 0, sizeof(SchUlLcCtxt)); + ueCb->ulInfo.numUlLc--; + updateSchUlCb(ueLcIdx, &ueCb->ulInfo); //moving arr elements one idx ahead + memset(&ueCb->dlInfo.dlLcCtxt[ueLcIdx], 0, sizeof(SchDlLcCtxt)); + ueCb->dlInfo.numDlLc--; + updateSchDlCb(ueLcIdx, &ueCb->dlInfo); //moving arr elements one idx ahead + break; + } + } + }/*End of inner for loop */ + } + }/* End of outer for loop */ + return ROK; +} + +/******************************************************************* + * + * @brief Function to get SCH Cell Cb + * + * @details + * + * Function : getSchCellCb + * + * Functionality: Function to get SCH Cell Cb + * + * @params[in] event, SchUeCfg pointer + * @return schUeCb pointer - success + * NULLP - failure + * + * ****************************************************************/ + +SchCellCb *getSchCellCb(uint16_t srcEvent, Inst inst, SchUeCfg *ueCfg) +{ + uint8_t idx; + SchCellCb *cellCb = NULLP; + SchUeCfgRsp cfgRsp; + memset(&cfgRsp, 0, sizeof(SchUeCfgRsp)); /* Search of cell cb */ for(idx = 0; idx < MAX_NUM_CELL; idx++) @@ -117,44 +277,308 @@ uint8_t macSchUeCreateReq(Pst *pst, SchUeCfg *ueCfg) if(idx == MAX_NUM_CELL) { DU_LOG("\nSCH : Ue create request failed. Invalid cell id %d", ueCfg->cellId); - SchSendUeCfgRspToMac(ueCfg, inst, RSP_NOK, &cfgRsp); - return ROK; + SchSendUeCfgRspToMac(srcEvent, ueCfg, inst, RSP_NOK, &cfgRsp); + return NULLP; } /* Check if max number of UE configured */ if(cellCb->numActvUe > MAX_NUM_UE) { DU_LOG("SCH : Max number of UE [%d] already configured", MAX_NUM_UE); - SchSendUeCfgRspToMac(ueCfg, inst, RSP_NOK, &cfgRsp); - return ROK; + SchSendUeCfgRspToMac(srcEvent, ueCfg, inst, RSP_NOK, &cfgRsp); + return NULLP; } + return cellCb; +} + + +/******************************************************************* + * + * @brief Function to Add Ue Config Request from MAC + * + * @details + * + * Function : MacSchAddUeConfigReq + * + * Functionality: Function to Add Ue config request from MAC + * + * @params[in] + * @return ROK - success + * RFAILED - failure + * + * ****************************************************************/ +uint8_t MacSchAddUeConfigReq(Pst *pst, SchUeCfg *ueCfg) +{ + uint8_t ueIdx, lcIdx, ret = ROK; + SchCellCb *cellCb = NULLP; + SchUeCb *ueCb = NULLP; + SchUeCfgRsp cfgRsp; + Inst inst = pst->dstInst - 1; + memset(&cfgRsp, 0, sizeof(SchUeCfgRsp)); + + if(!ueCfg) + { + DU_LOG("\nSCH : Adding UE Config Request failed at MacSchAddUeConfigReq()"); + return RFAILED; + } + DU_LOG("\nSCH : Adding UE Config Request for CRNTI[%d]", ueCfg->crnti); + cellCb = getSchCellCb(pst->event, inst, ueCfg); /* Search if UE already configured */ GET_UE_IDX(ueCfg->crnti, ueIdx); - ueCb = &cellCb->ueCb[ueIdx]; + ueCb = &cellCb->ueCb[ueIdx -1]; if(ueCb) { if((ueCb->crnti == ueCfg->crnti) && (ueCb->state == SCH_UE_STATE_ACTIVE)) { DU_LOG("\n SCH : CRNTI %d already configured ", ueCfg->crnti); - SchSendUeCfgRspToMac(ueCfg, inst, RSP_OK, &cfgRsp); + SchSendUeCfgRspToMac(pst->event, ueCfg, inst, RSP_OK, &cfgRsp); return ROK; } } + else + { + DU_LOG("\n SCH : SchUeCb not found at MacSchAddUeConfigReq() "); + SchSendUeCfgRspToMac(pst->event, ueCfg, inst, RSP_NOK, &cfgRsp); + return RFAILED; + } /* Fill received Ue Configuration in UeCb */ memset(ueCb, 0, sizeof(SchUeCb)); - - GET_UE_IDX(ueCfg->crnti, ueCb->ueIdx); + GET_UE_IDX(ueCfg->crnti, ueIdx); + ueCb->ueIdx = ueIdx; ueCb->crnti = ueCfg->crnti; - memcpy(&ueCb->ueCfg, ueCfg, sizeof(SchUeCfg)); ueCb->state = SCH_UE_STATE_ACTIVE; - cellCb->numActvUe++; + ret = fillSchUeCb(ueCb, ueCfg); + if(ret == ROK) + { + cellCb->numActvUe++; + SET_ONE_BIT(ueCb->ueIdx, cellCb->actvUeBitMap); + ueCb->cellCb = cellCb; + ueCb->srRcvd = false; + for(lcIdx=0; lcIdxbsrInfo[lcIdx].dataVol = 0; + + SchSendUeCfgRspToMac(pst->event, ueCfg, inst, RSP_OK, &cfgRsp); + } + return ret; +} + +/******************************************************************* +* +* @brief Fills PUSCH UL allocation +* +* @details +* +* Function : schFillPuschAlloc +* +* Functionality: fills PUSCH info +* +* @params[in] +* @return ROK - success +* RFAILED - failure +* +* ****************************************************************/ +uint8_t schFillPuschAlloc(SchUeCb *ueCb, uint16_t pdcchSlot, uint32_t dataVol, SchPuschInfo *puschInfo) +{ + uint16_t puschSlot = 0; + uint16_t startRb = 0; + uint8_t numRb = 0; + uint8_t mcs = 4; + uint8_t numPdschSymbols= 14; + uint16_t tbSize = 0; + uint8_t buffer = 5; + uint8_t idx = 0; + SchCellCb *cellCb = ueCb->cellCb; + SchUlSlotInfo *schUlSlotInfo = NULLP; + uint8_t k2 = ueCb->ueCfg.spCellCfg.servCellCfg.initUlBwp.puschCfg.timeDomRsrcAllocList[0].k2; + uint8_t startSymb = ueCb->ueCfg.spCellCfg.servCellCfg.initUlBwp.puschCfg.timeDomRsrcAllocList[0].startSymbol; + uint8_t symbLen = ueCb->ueCfg.spCellCfg.servCellCfg.initUlBwp.puschCfg.timeDomRsrcAllocList[0].symbolLength; + + puschSlot = (pdcchSlot + k2) % SCH_NUM_SLOTS; + + startRb = cellCb->schUlSlotInfo[puschSlot]->puschCurrentPrb; + tbSize = schCalcTbSize(dataVol + buffer); /* 2 bytes header + some buffer */ + numRb = schCalcNumPrb(tbSize, mcs, numPdschSymbols); + /* increment PUSCH PRB */ + + cellCb->schUlSlotInfo[puschSlot]->puschCurrentPrb += numRb; + + puschInfo->crnti = ueCb->crnti; + puschInfo->harqProcId = SCH_HARQ_PROC_ID; + puschInfo->resAllocType = SCH_ALLOC_TYPE_1; + puschInfo->fdAlloc.startPrb = startRb; + puschInfo->fdAlloc.numPrb = numRb; + puschInfo->tdAlloc.startSymb = startSymb; + puschInfo->tdAlloc.numSymb = symbLen; + puschInfo->tbInfo.mcs = mcs; + puschInfo->tbInfo.ndi = 1; /* new transmission */ + puschInfo->tbInfo.rv = 0; + puschInfo->tbInfo.tbSize = tbSize; + puschInfo->dmrsMappingType = DMRS_MAP_TYPE_A; /* Setting Type-A */ + puschInfo->nrOfDmrsSymbols = NUM_DMRS_SYMBOLS; + puschInfo->dmrsAddPos = DMRS_ADDITIONAL_POS; + + /* Update pusch in cell */ + for(idx=startSymb; idxschUlSlotInfo[puschSlot]->assignedPrb[idx] = startRb + numRb; + } + + schUlSlotInfo = cellCb->schUlSlotInfo[puschSlot]; + + SCH_ALLOC(schUlSlotInfo->schPuschInfo, sizeof(SchPuschInfo)); + if(!schUlSlotInfo->schPuschInfo) + { + DU_LOG("SCH: Memory allocation failed in schAllocMsg3Pusch"); + return RFAILED; + } + memcpy(schUlSlotInfo->schPuschInfo, puschInfo, sizeof(SchPuschInfo)); + + return ROK; +} + +/******************************************************************* + * + * @brief Fills DCI for UL grant + * + * @details + * + * Function : schFillUlDci + * + * Functionality: fills DCI for UL grant in response to BSR + * + * @params[in] + * @return ROK - success + * RFAILED - failure + * + * ****************************************************************/ +uint8_t schFillUlDci(SchUeCb *ueCb, SchPuschInfo puschInfo, DciInfo *dciInfo) +{ + SchCellCb *cellCb = ueCb->cellCb; + SchControlRsrcSet coreset1 = ueCb->ueCfg.spCellCfg.servCellCfg.initDlBwp.pdcchCfg.cRSetToAddModList[0]; + + dciInfo->cellId = cellCb->cellId; + dciInfo->crnti = ueCb->crnti; + + /* fill bwp cfg */ + dciInfo->bwpCfg.subcarrierSpacing = cellCb->cellCfg.sib1SchCfg.bwp.subcarrierSpacing; + dciInfo->bwpCfg.cyclicPrefix = cellCb->cellCfg.sib1SchCfg.bwp.cyclicPrefix; + dciInfo->bwpCfg.freqAlloc.startPrb = 0; + dciInfo->bwpCfg.freqAlloc.numPrb = MAX_NUM_RB; /* whole of BW */ + + /*fill coreset cfg */ + //Considering number of RBs in coreset1 is same as coreset0 + dciInfo->coresetCfg.coreSetSize = coresetIdxTable[0][1]; + //Considering coreset1 also starts from same symbol as coreset0 + dciInfo->coresetCfg.startSymbolIndex = searchSpaceIdxTable[0][3]; + dciInfo->coresetCfg.durationSymbols = coreset1.duration; + memcpy(dciInfo->coresetCfg.freqDomainResource, coreset1.freqDomainRsrc, FREQ_DOM_RSRC_SIZE); + + dciInfo->coresetCfg.cceRegMappingType = coreset1.cceRegMappingType; /* non-interleaved */ + dciInfo->coresetCfg.regBundleSize = 6; /* must be 6 for non-interleaved */ + dciInfo->coresetCfg.interleaverSize = 0; /* NA for non-interleaved */ + dciInfo->coresetCfg.coreSetType = 1; /* non PBCH coreset */ + dciInfo->coresetCfg.shiftIndex = cellCb->cellCfg.phyCellId; + dciInfo->coresetCfg.precoderGranularity = coreset1.precoderGranularity; + dciInfo->coresetCfg.cceIndex = 0; /* 0-3 for UL and 4-7 for DL */ + dciInfo->coresetCfg.aggregationLevel = 4; /* same as for sib1 */ + + dciInfo->formatType = FORMAT0_0; + + /* fill UL grant */ + dciInfo->format.format0_0.resourceAllocType = puschInfo.resAllocType; + dciInfo->format.format0_0.freqAlloc.startPrb = puschInfo.fdAlloc.startPrb; + dciInfo->format.format0_0.freqAlloc.numPrb = puschInfo.fdAlloc.numPrb; + dciInfo->format.format0_0.timeAlloc.startSymb = puschInfo.tdAlloc.startSymb; + dciInfo->format.format0_0.timeAlloc.numSymb = puschInfo.tdAlloc.numSymb; + dciInfo->format.format0_0.rowIndex = 0; /* row Index */ + dciInfo->format.format0_0.mcs = puschInfo.tbInfo.mcs; + dciInfo->format.format0_0.harqProcId = puschInfo.harqProcId; + dciInfo->format.format0_0.puschHopFlag = FALSE; /* disabled */ + dciInfo->format.format0_0.freqHopFlag = FALSE; /* disabled */ + dciInfo->format.format0_0.ndi = puschInfo.tbInfo.ndi; /* new transmission */ + dciInfo->format.format0_0.rv = puschInfo.tbInfo.rv; + dciInfo->format.format0_0.tpcCmd = 0; //Sphoorthi TODO: check + dciInfo->format.format0_0.sUlCfgd = FALSE; /* SUL not configured */ + + /* Fill DCI Structure */ + dciInfo->dciInfo.rnti = ueCb->crnti; + dciInfo->dciInfo.scramblingId = cellCb->cellCfg.phyCellId; + dciInfo->dciInfo.scramblingRnti = 0; + dciInfo->dciInfo.cceIndex = 0; /* 0-3 for UL and 4-7 for DL */ + dciInfo->dciInfo.aggregLevel = 4; + dciInfo->dciInfo.beamPdcchInfo.numPrgs = 1; + dciInfo->dciInfo.beamPdcchInfo.prgSize = 1; + dciInfo->dciInfo.beamPdcchInfo.digBfInterfaces = 0; + dciInfo->dciInfo.beamPdcchInfo.prg[0].pmIdx = 0; + dciInfo->dciInfo.beamPdcchInfo.prg[0].beamIdx[0] = 0; + dciInfo->dciInfo.txPdcchPower.powerValue = 0; + dciInfo->dciInfo.txPdcchPower.powerControlOffsetSS = 0; + dciInfo->dciInfo.pdschCfg = NULLP; /* No DL data being sent */ - SchSendUeCfgRspToMac(ueCfg, inst, RSP_OK, &cfgRsp); return ROK; } +/******************************************************************* + * + * @brief Function to Modify Ue Config request from MAC + * + * @details + * + * Function : MacSchModUeConfigReq + * + * Functionality: Function to modify Ue Config request from MAC + * + * @params[in] + * @return ROK - success + * RFAILED - failure + * + * ****************************************************************/ +uint8_t MacSchModUeConfigReq(Pst *pst, SchUeCfg *ueCfg) +{ + uint8_t ueIdx, lcIdx, ret = ROK; + SchCellCb *cellCb = NULLP; + SchUeCb *ueCb = NULLP; + SchUeCfgRsp cfgRsp; + Inst inst = pst->dstInst - 1; + memset(&cfgRsp, 0, sizeof(SchUeCfgRsp)); + + if(!ueCfg) + { + DU_LOG("\nSCH : Modifying Ue Config request failed at MacSchModUeConfigReq()"); + return RFAILED; + } + DU_LOG("\nSCH : Modifying Ue Config Request for CRNTI[%d]", ueCfg->crnti); + cellCb = getSchCellCb(pst->event, inst, ueCfg); + + /* Search if UE already configured */ + GET_UE_IDX(ueCfg->crnti, ueIdx); + ueCb = &cellCb->ueCb[ueIdx -1]; + + if(!ueCb) + { + DU_LOG("\n SCH : SchUeCb not found at MacSchModUeConfigReq() "); + SchSendUeCfgRspToMac(pst->event, ueCfg, inst, RSP_NOK, &cfgRsp); + return RFAILED; + } + if((ueCb->crnti == ueCfg->crnti) && (ueCb->state == SCH_UE_STATE_ACTIVE)) + { + /* Found the UeCb to Reconfig */ + ret = fillSchUeCb(ueCb, ueCfg); + if(ret == ROK) + { + ueCb->cellCb = cellCb; + ueCb->srRcvd = false; + for(lcIdx=0; lcIdxbsrInfo[lcIdx].dataVol = 0; + + SchSendUeCfgRspToMac(pst->event, ueCfg, inst, RSP_OK, &cfgRsp); + } + } + return ret; +} + /********************************************************************** End of file **********************************************************************/