X-Git-Url: https://gerrit.o-ran-sc.org/r/gitweb?a=blobdiff_plain;f=src%2Fphy_stub%2Fl1_bdy1.c;h=a9183c71c2ee7c15ea172e21efed018256663873;hb=528b3d3a09d7486a0c549820bac601db60fde18e;hp=4b1792b1c85f04fd9b2db29691b70e05e719c4f0;hpb=6b44407d464a5a4e060999255233a7cfe78bb0fa;p=o-du%2Fl2.git diff --git a/src/phy_stub/l1_bdy1.c b/src/phy_stub/l1_bdy1.c index 4b1792b1c..a9183c71c 100644 --- a/src/phy_stub/l1_bdy1.c +++ b/src/phy_stub/l1_bdy1.c @@ -27,6 +27,7 @@ #include "lwr_mac_phy.h" #ifdef INTEL_FAPI #include "fapi.h" +#include "fapi_vendor_extension.h" #endif #include "lphy_stub.h" #include "lwr_mac_upr_inf.h" @@ -183,6 +184,7 @@ S16 l1BldAndSndConfigRsp(void *msg) fillMsgHeader(&fapiConfigRsp->header, FAPI_CONFIG_RESPONSE, msgLen); DU_LOG("\nPHY_STUB: Sending Config Response to Lower Mac"); + procPhyMessages(fapiConfigRsp->header.msg_id, \ sizeof(fapi_config_resp_t), (void *)fapiConfigRsp); MAC_FREE(fapiConfigRsp, sizeof(fapi_config_resp_t)); @@ -207,7 +209,7 @@ S16 l1BldAndSndConfigRsp(void *msg) * * ****************************************************************/ -PUBLIC void l1HdlParamReq(uint32_t msgLen, void *msg) +void l1HdlParamReq(uint32_t msgLen, void *msg) { #ifdef INTEL_FAPI DU_LOG("\nPHY_STUB: Received Param Request in PHY"); @@ -239,20 +241,21 @@ PUBLIC void l1HdlParamReq(uint32_t msgLen, void *msg) * * ****************************************************************/ -PUBLIC void l1HdlConfigReq(uint32_t msgLen, void *msg) +void l1HdlConfigReq(uint32_t msgLen, void *msg) { #ifdef INTEL_FAPI - fapi_config_req_t *configReq = (fapi_config_req_t *)msg; + p_fapi_api_queue_elem_t configReqElem = (p_fapi_api_queue_elem_t)msg; + fapi_config_req_t *configReq = (fapi_config_req_t *)(configReqElem +1); DU_LOG("\nPHY_STUB: Received Config Request in PHY"); /* Handling CONFIG RESPONSE */ - if(l1BldAndSndConfigRsp(msg)!= ROK) + if(l1BldAndSndConfigRsp(configReq)!= ROK) { printf("\nPHY_STUB: Failed Sending config Response"); } - MAC_FREE(configReq, msgLen); + MAC_FREE(msg, msgLen); #endif } @@ -337,7 +340,7 @@ uint16_t l1BuildAndSendRxDataInd(uint16_t slot, uint16_t sfn, fapi_ul_pusch_pdu_ uint8_t idx = 0; fapi_rx_data_indication_t *rxDataInd; fapi_pdu_ind_info_t *pduInfo; - uint8_t *pdu; + uint8_t *pdu = NULLP; uint16_t byteIdx = 0; uint32_t msgLen = 0; MsgType type; @@ -357,7 +360,13 @@ uint16_t l1BuildAndSendRxDataInd(uint16_t slot, uint16_t sfn, fapi_ul_pusch_pdu_ msg5Sent = true; type = MSG_TYPE_MSG5; } - + else if(!msgSecurityModeComp) + { + msgSecurityModeComp = true; + type = MSG_TYPE_SECURITY_MODE_COMPLETE; + } + else + return RFAILED; MAC_ALLOC(rxDataInd, sizeof(fapi_rx_data_indication_t)); if(!rxDataInd) @@ -367,7 +376,6 @@ uint16_t l1BuildAndSendRxDataInd(uint16_t slot, uint16_t sfn, fapi_ul_pusch_pdu_ } memset(rxDataInd, 0, sizeof(fapi_rx_data_indication_t)); - /* TODO: Fill the required values */ msgLen = sizeof(fapi_rx_data_indication_t) - sizeof(fapi_msg_t); rxDataInd->sfn = sfn; rxDataInd->slot = slot; @@ -398,6 +406,7 @@ uint16_t l1BuildAndSendRxDataInd(uint16_t slot, uint16_t sfn, fapi_ul_pusch_pdu_ { case MSG_TYPE_MSG3: { + DU_LOG("\nPHY_STUB: Forming MSG3 PDU "); /* For Initial RRC setup Request, MAC subheader format is R/R/LCId (1byte) LCId is CCCH(0) @@ -405,21 +414,22 @@ uint16_t l1BuildAndSendRxDataInd(uint16_t slot, uint16_t sfn, fapi_ul_pusch_pdu_ */ pdu[byteIdx++] = 0; /* Hardcoding MAC PDU */ - pdu[byteIdx++] = 181; - pdu[byteIdx++] = 99; - pdu[byteIdx++] = 20; - pdu[byteIdx++] = 170; - pdu[byteIdx++] = 132; - pdu[byteIdx++] = 96; + pdu[byteIdx++] = 16; + pdu[byteIdx++] = 00; + pdu[byteIdx++] = 00; + pdu[byteIdx++] = 00; + pdu[byteIdx++] = 00; + pdu[byteIdx++] = 103; break; } case MSG_TYPE_SHORT_BSR: { + DU_LOG("\nPHY_STUB: Forming SHORT BSR PDU "); uint8_t lcgId = 0; uint8_t bufferSizeIdx = 6; - + /* For Short BSR MAC subheader format is R/R/LcId (1Byte) LCId is 61 @@ -433,6 +443,7 @@ uint16_t l1BuildAndSendRxDataInd(uint16_t slot, uint16_t sfn, fapi_ul_pusch_pdu_ case MSG_TYPE_MSG5: { + DU_LOG("\nPHY_STUB: Forming MSG5 PDU"); uint8_t msg5PduLen = 33; /* For RRC setup complete MAC subheader format is R/F/LCId/L (2/3 bytes) @@ -447,8 +458,28 @@ uint16_t l1BuildAndSendRxDataInd(uint16_t slot, uint16_t sfn, fapi_ul_pusch_pdu_ msg5PduLen += 2; /* 2bytes of header */ memcpy(pdu, &msg5, msg5PduLen); byteIdx += msg5PduLen; /* 2 bytes of header */ + break; } + case MSG_TYPE_SECURITY_MODE_COMPLETE: + { + DU_LOG("\nPHY_STUB: Forming SECURITY MODE COMPLETE PDU"); + uint8_t pduLen = 33; + /* For security mode complete + MAC subheader format is R/F/LCId/L (2/3 bytes) + LCId is 1 for SRB1 + L is length of PDU i.e 6bytes here + From 38.321 section 6.1.1 + */ + uint8_t msg[] = {1, pduLen, 0, 0, 16, 0, 5, 223, 128, 16, 94, \ + 64, 3, 64, 89, 61, 138, 64, 0, 0, 0, 4, 0, 0, 4, 68, 11, 128, \ + 184, 56, 0, 0, 0, 0, 0}; + + pduLen += 2; /* 2bytes of header */ + memcpy(pdu, &msg, pduLen); + byteIdx += pduLen; /* 2 bytes of header */ + break; + } default: break; } /* End of switch(type) */ @@ -558,7 +589,7 @@ uint16_t l1BuildAndSendRachInd(uint16_t slot, uint16_t sfn) * @return void * * ****************************************************************/ -PUBLIC uint16_t l1BuildAndSendSlotIndication() +uint16_t l1BuildAndSendSlotIndication() { #ifdef INTEL_FAPI fapi_slot_ind_t *slotIndMsg; @@ -574,8 +605,10 @@ PUBLIC uint16_t l1BuildAndSendSlotIndication() memset(slotIndMsg, 0, sizeof(fapi_slot_ind_t)); slotIndMsg->sfn = sfnValue; slotIndMsg->slot = slotValue; - DU_LOG("\n\nPHY_STUB: SLOT indication [%d:%d]",sfnValue,slotValue); +#ifdef ODU_SLOT_IND_DEBUG_LOG + DU_LOG("\n\nPHY_STUB: SLOT indication [%d:%d]",sfnValue,slotValue); +#endif /* increment for the next TTI */ slotValue++; if(sfnValue >= MAX_SFN_VALUE && slotValue > MAX_SLOT_VALUE) @@ -615,19 +648,18 @@ PUBLIC uint16_t l1BuildAndSendSlotIndication() * * ****************************************************************/ -PUBLIC S16 l1HdlStartReq(uint32_t msgLen, void *msg) +S16 l1HdlStartReq(uint32_t msgLen, void *msg) { #ifdef INTEL_FAPI - fapi_start_req_t *startReq = (fapi_start_req_t *)msg; - if(lwrMacCb.phyState == PHY_STATE_CONFIGURED) { l1HdlSlotIndicaion(FALSE); - MAC_FREE(startReq, sizeof(fapi_start_req_t)); + MAC_FREE(msg, msgLen); } else { DU_LOG("\nPHY_STUB: Received Start Req in PHY State %d", lwrMacCb.phyState); + MAC_FREE(msg, msgLen); return RFAILED; } #endif @@ -652,45 +684,48 @@ PUBLIC S16 l1HdlStartReq(uint32_t msgLen, void *msg) * * ****************************************************************/ -PUBLIC S16 l1HdlDlTtiReq(uint16_t msgLen, void *msg) +S16 l1HdlDlTtiReq(uint16_t msgLen, void *msg) { #ifdef INTEL_FAPI - fapi_dl_tti_req_t *dlTtiReq; - dlTtiReq = (fapi_dl_tti_req_t *)msg; - - printf("\nPHY STUB: DL TTI Request at sfn=%d slot=%d",dlTtiReq->sfn,dlTtiReq->slot); -#if 0 - printf("\nPHY_STUB: SFN %d", dlTtiReq->sfn); - printf("\nPHY_STUB: SLOT %d", dlTtiReq->slot); - printf("\nPHY_STUB: nPdus %d", dlTtiReq->nPdus); - printf("\nPHY_STUB: nGroup %d", dlTtiReq->nGroup); - /* Printing SSB CONFIGURED VALUES */ - printf("\nPHY_STUB: physCellId %d", dlTtiReq->pdus->u.ssb_pdu.physCellId); - printf("\nPHY_STUB: betaPss %d", dlTtiReq->pdus->u.ssb_pdu.betaPss); - printf("\nPHY_STUB: ssbBlockIndex %d", dlTtiReq->pdus->u.ssb_pdu.ssbBlockIndex); - printf("\nPHY_STUB: ssbSubCarrierOffset %d", dlTtiReq->pdus->u.ssb_pdu.ssbSubCarrierOffset); - printf("\nPHY_STUB: ssbOffsetPointA %d", dlTtiReq->pdus->u.ssb_pdu.ssbOffsetPointA); - printf("\nPHY_STUB: bchPayloadFlag %d", dlTtiReq->pdus->u.ssb_pdu.bchPayloadFlag); - printf("\nPHY_STUB: bchPayload %x", dlTtiReq->pdus->u.ssb_pdu.bchPayload); -#endif + p_fapi_api_queue_elem_t dlTtiElem = (p_fapi_api_queue_elem_t)msg; + fapi_dl_tti_req_t *dlTtiReq = (fapi_dl_tti_req_t *)(dlTtiElem +1); + uint8_t pduCount = 0; + +#ifdef ODU_SLOT_IND_DEBUG_LOG if(dlTtiReq->nPdus == 0) { DU_LOG("\nPHY_STUB: No PDU in DL TTI Request"); } + else + { + DU_LOG("\nPHY STUB: DL TTI Request at sfn=%d slot=%d",dlTtiReq->sfn,dlTtiReq->slot); + } +#endif + for(pduCount=0; pduCountnPdus; pduCount++) { if(dlTtiReq->pdus[pduCount].pduType == 3) //SSB_PDU_TYPE - DU_LOG("\nPHY_STUB: SSB PDU"); + { + DU_LOG("\nPHY_STUB: SSB PDU"); + } else if(dlTtiReq->pdus[pduCount].pduType == 0) + { DU_LOG("\nPHY_STUB: PDCCH PDU"); + if(dlTtiReq->pdus[pduCount].pdu.pdcch_pdu.\ + coreSetType == 1) + { + dlDedMsg = true; + } + } else if(dlTtiReq->pdus[pduCount].pduType == 1) - DU_LOG("\nPHY_STUB: PDSCH PDU"); + { + DU_LOG("\nPHY_STUB: PDSCH PDU"); + } } /* Free FAPI message */ - MAC_FREE(dlTtiReq, msgLen); - + MAC_FREE(msg, msgLen); #endif return ROK; } @@ -713,15 +748,19 @@ PUBLIC S16 l1HdlDlTtiReq(uint16_t msgLen, void *msg) * * ****************************************************************/ -PUBLIC S16 l1HdlTxDataReq(uint16_t msgLen, void *msg) +S16 l1HdlTxDataReq(uint16_t msgLen, void *msg) { #ifdef INTEL_FAPI - fapi_tx_data_req_t *txDataReq; - txDataReq = (fapi_tx_data_req_t *)msg; + p_fapi_api_queue_elem_t txDataElem = (p_fapi_api_queue_elem_t)msg; + fapi_tx_data_req_t *txDataReq = (fapi_tx_data_req_t *)(txDataElem +1); DU_LOG("\nPHY STUB: TX DATA Request at sfn=%d slot=%d",txDataReq->sfn,txDataReq->slot); - - MAC_FREE(txDataReq, msgLen); + if(dlDedMsg) + { + DU_LOG("\nPHY_STUB: TxDataPdu for DED MSG sent"); + dlDedMsg = false; + } + MAC_FREE(msg, msgLen); #endif return ROK; } @@ -755,7 +794,6 @@ uint8_t fillPucchF0F1PduInfo(fapi_uci_o_pucch_f0f1_t *pduInfo, fapi_ul_pucch_pdu pduInfo->rnti = pucchPdu.rnti; pduInfo->timingAdvance = 0; pduInfo->rssi = 0; - pduInfo->uciBits[idx] = 0; //TODO: FAPI spec ver. 222.10.01 has no info about UCI Bits if(pduInfo->pduBitmap & SR_PDU_BITMASK) { pduInfo->srInfo.srIndication = SR_DETECTED; @@ -893,20 +931,24 @@ uint8_t l1BuildAndSendUciInd(uint16_t slot, uint16_t sfn, fapi_ul_pucch_pdu_t pu * * ****************************************************************/ -PUBLIC S16 l1HdlUlTtiReq(uint16_t msgLen, void *msg) +S16 l1HdlUlTtiReq(uint16_t msgLen, void *msg) { #ifdef INTEL_FAPI - fapi_ul_tti_req_t *ulTtiReq = NULLP; - - DU_LOG("\nPHY STUB: Received UL TTI Request"); - - ulTtiReq = (fapi_ul_tti_req_t *)msg; + p_fapi_api_queue_elem_t ulTtiElem = (p_fapi_api_queue_elem_t)msg; + fapi_ul_tti_req_t *ulTtiReq = (fapi_ul_tti_req_t *)(ulTtiElem +1); uint8_t numPdus = ulTtiReq->nPdus; +#ifdef ODU_SLOT_IND_DEBUG_LOG if(numPdus == 0) { - DU_LOG("\nPHY STUB: No PDU in UL TTI"); + DU_LOG("\nPHY STUB: No PDU received in UL TTI Req"); } + else + { + DU_LOG("\nPHY STUB: Received UL TTI Request"); + } +#endif + while(numPdus) { if(ulTtiReq->pdus[numPdus-1].pduType == 0) @@ -916,14 +958,19 @@ PUBLIC S16 l1HdlUlTtiReq(uint16_t msgLen, void *msg) if(ulTtiReq->pdus[numPdus-1].pduType == 1) { DU_LOG("\nPHY STUB: PUSCH PDU"); - l1BuildAndSendRxDataInd(ulTtiReq->slot, ulTtiReq->sfn, \ + l1BuildAndSendRxDataInd(ulTtiReq->slot, ulTtiReq->sfn, \ ulTtiReq->pdus[numPdus-1].pdu.pusch_pdu); } if(ulTtiReq->pdus[numPdus-1].pduType == 2) { DU_LOG("\nPHY STUB: PUCCH PDU"); - l1BuildAndSendUciInd((ulTtiReq->slot + SLOT_DELAY), ulTtiReq->sfn, \ - ulTtiReq->pdus[numPdus-1].pdu.pucch_pdu); + fapi_ul_tti_req_t ulTtiSlotInd; + memset(&ulTtiSlotInd, 0, sizeof(fapi_ul_tti_req_t)); + ulTtiSlotInd.slot = ulTtiReq->slot; + ulTtiSlotInd.sfn = ulTtiReq->sfn; + ADD_DELTA_TO_TIME(ulTtiSlotInd, ulTtiSlotInd, SLOT_DELAY); + l1BuildAndSendUciInd(ulTtiSlotInd.slot, ulTtiSlotInd.sfn, \ + ulTtiReq->pdus[numPdus-1].pdu.pucch_pdu); } numPdus--; } @@ -934,7 +981,7 @@ PUBLIC S16 l1HdlUlTtiReq(uint16_t msgLen, void *msg) l1BuildAndSendRachInd(ulTtiReq->slot, ulTtiReq->sfn); } - MAC_FREE(ulTtiReq, msgLen); + MAC_FREE(msg, msgLen); #endif return ROK; } @@ -954,7 +1001,7 @@ PUBLIC S16 l1HdlUlTtiReq(uint16_t msgLen, void *msg) * @return void * * ****************************************************************/ -PUBLIC uint16_t l1BuildAndSendStopInd() +uint16_t l1BuildAndSendStopInd() { #ifdef INTEL_FAPI fapi_stop_ind_t *stopIndMsg = NULLP; @@ -996,21 +1043,20 @@ PUBLIC uint16_t l1BuildAndSendStopInd() * * ****************************************************************/ -PUBLIC S16 l1HdlStopReq(uint32_t msgLen, void *msg) +S16 l1HdlStopReq(uint32_t msgLen, void *msg) { #ifdef INTEL_FAPI - fapi_stop_req_t *stopReq = (fapi_stop_req_t *)msg; - if(lwrMacCb.phyState == PHY_STATE_RUNNING) { l1HdlSlotIndicaion(TRUE); DU_LOG("\nPHY_STUB: Slot Indication is stopped successfully"); l1BuildAndSendStopInd(); - MAC_FREE(stopReq, msgLen); + MAC_FREE(msg, msgLen); } else { DU_LOG("\nPHY_STUB: Received Stop Req in PHY State %d", lwrMacCb.phyState); + MAC_FREE(msg, msgLen); return RFAILED; } #endif @@ -1139,12 +1185,11 @@ uint8_t l1BuildAndSendMsg5(uint16_t sfn, uint16_t slot) * * ****************************************************************/ -PUBLIC S16 l1HdlUlDciReq(uint16_t msgLen, void *msg) +S16 l1HdlUlDciReq(uint16_t msgLen, void *msg) { #ifdef INTEL_FAPI - fapi_ul_dci_req_t *ulDciReq = NULLP; - - ulDciReq = (fapi_ul_dci_req_t *)msg; + p_fapi_api_queue_elem_t ulDciElem = (p_fapi_api_queue_elem_t)msg; + fapi_ul_dci_req_t *ulDciReq = (fapi_ul_dci_req_t *)(ulDciElem +1); uint8_t numPdus = ulDciReq->numPdus; while(numPdus) @@ -1158,7 +1203,7 @@ PUBLIC S16 l1HdlUlDciReq(uint16_t msgLen, void *msg) numPdus--; } - MAC_FREE(ulDciReq, msgLen); + MAC_FREE(msg, msgLen); #endif return ROK; }