X-Git-Url: https://gerrit.o-ran-sc.org/r/gitweb?a=blobdiff_plain;f=src%2Fphy_stub%2Fl1_bdy1.c;h=85954293b8f3eb922f910ae2f947058bcab7336a;hb=1bed59663a087c96c3ebb984ee19be92e7f4ecc5;hp=2a1391ee1d02e13cf744c43aa297fb3f330c35d7;hpb=d2d9dcbd92e8f1be15dd5891aaf9ada9bc071e1a;p=o-du%2Fl2.git diff --git a/src/phy_stub/l1_bdy1.c b/src/phy_stub/l1_bdy1.c index 2a1391ee1..85954293b 100644 --- a/src/phy_stub/l1_bdy1.c +++ b/src/phy_stub/l1_bdy1.c @@ -27,26 +27,31 @@ #include "gen.x" #include "ssi.x" -#include "rg_cl_phy.h" #include "lwr_mac.h" +#include "lwr_mac_phy.h" #ifdef FAPI #include "fapi.h" #endif #include "lphy_stub.h" +#include "stdbool.h" +#include "du_log.h" +#include "rg.h" #define MAX_SLOT_VALUE 9 #define MAX_SFN_VALUE 1023 +#define NR_PCI 1 uint16_t sfnValue = 0; uint16_t slotValue = 0; +bool rachIndSent = false; + EXTERN void phyToMac ARGS((uint16_t msgType, uint32_t msgLen,void *msg)); #ifdef FAPI EXTERN void fillTlvs ARGS((fapi_uint16_tlv_t *tlv, uint16_t tag, uint16_t length, uint16_t value, uint32_t *msgLen)); EXTERN void fillMsgHeader ARGS((fapi_msg_t *hdr, uint16_t msgType, uint16_t msgLen)); #endif -EXTERN void sendToLowerMac ARGS((uint16_t msgType, uint32_t msgLen,void *msg)); -EXTERN void handlePhyMessages ARGS((void *msg)); +EXTERN void handlePhyMessages(uint16_t msgType, uint32_t msgSize, void *msg); /******************************************************************* * @@ -69,7 +74,14 @@ S16 l1BldAndSndParamRsp(void *msg) #ifdef FAPI uint8_t index = 0; uint32_t msgLen = 0; - fapi_param_resp_t *fapiParamRsp = (fapi_param_resp_t *)msg; + fapi_param_resp_t *fapiParamRsp; + + MAC_ALLOC(fapiParamRsp, sizeof(fapi_param_resp_t)); + if(!fapiParamRsp) + { + DU_LOG("PHY STUB: Memory allocation failed"); + return RFAILED; + } /* Cell Params */ fillTlvs(&fapiParamRsp->tlvs[index++], FAPI_RELEASE_CAPABILITY_TAG, sizeof(uint16_t), 1, &msgLen); @@ -142,12 +154,13 @@ S16 l1BldAndSndParamRsp(void *msg) fillTlvs(&fapiParamRsp->tlvs[index++], FAPI_RSSI_MEASUREMENT_SUPPORT_TAG, sizeof(uint8_t), 0, &msgLen); fapiParamRsp->number_of_tlvs = index; - msgLen = msgLen + sizeof(fapi_param_resp_t); - + msgLen += sizeof(fapi_param_resp_t) - sizeof(fapi_msg_t); fillMsgHeader(&fapiParamRsp->header, FAPI_PARAM_RESPONSE, msgLen); fapiParamRsp->error_code = MSG_OK; - printf("\nPHY_STUB: Sending Param Request to Lower Mac"); - sendToLowerMac(fapiParamRsp->header.message_type_id, sizeof(fapi_param_resp_t), (void *)fapiParamRsp); + + DU_LOG("\nPHY_STUB: Sending Param Request to Lower Mac"); + handlePhyMessages(fapiParamRsp->header.message_type_id, sizeof(fapi_param_resp_t), (void *)fapiParamRsp); + MAC_FREE(fapiParamRsp, sizeof(fapi_param_resp_t)); #endif return ROK; } @@ -172,25 +185,29 @@ S16 l1BldAndSndParamRsp(void *msg) S16 l1BldAndSndConfigRsp(void *msg) { #ifdef FAPI - uint8_t index = 0; uint32_t msgLen = 0; - fapi_config_resp_t *fapiConfigRsp = (fapi_config_resp_t *)msg; + fapi_config_resp_t *fapiConfigRsp; - if(fapiConfigRsp != NULL) + MAC_ALLOC(fapiConfigRsp, sizeof(fapi_config_resp_t)); + if(!fapiConfigRsp) { - fapiConfigRsp->number_of_invalid_tlvs = NULLP; - fapiConfigRsp->number_of_inv_tlvs_idle_only = NULLP; - fapiConfigRsp->number_of_missing_tlvs = NULLP; - fapiConfigRsp->error_code = MSG_OK; - msgLen += sizeof(fapi_config_resp_t); - fillMsgHeader(&fapiConfigRsp->header, FAPI_CONFIG_RESPONSE, msgLen); - printf("\nPHY_STUB: Sending Config Response to Lower Mac"); - sendToLowerMac(fapiConfigRsp->header.message_type_id, sizeof(fapi_config_resp_t), (void *)fapiConfigRsp); - return ROK; + DU_LOG("PHY STUB: Memory allocation failed"); + return RFAILED; } -#else - return ROK; + + fapiConfigRsp->number_of_invalid_tlvs = NULLP; + fapiConfigRsp->number_of_inv_tlvs_idle_only = NULLP; + fapiConfigRsp->number_of_missing_tlvs = NULLP; + fapiConfigRsp->error_code = MSG_OK; + msgLen += sizeof(fapi_param_resp_t) - sizeof(fapi_msg_t); + fillMsgHeader(&fapiConfigRsp->header, FAPI_CONFIG_RESPONSE, msgLen); + + DU_LOG("\nPHY_STUB: Sending Config Response to Lower Mac"); + handlePhyMessages(fapiConfigRsp->header.message_type_id, \ + sizeof(fapi_config_resp_t), (void *)fapiConfigRsp); + MAC_FREE(fapiConfigRsp, sizeof(fapi_config_resp_t)); #endif + return ROK; } /******************************************************************* * @@ -212,12 +229,16 @@ S16 l1BldAndSndConfigRsp(void *msg) PUBLIC void l1HdlParamReq(uint32_t msgLen, void *msg) { - printf("\nPHY_STUB: Received Param Request in PHY"); - /* Handling PARAM RESPONSE */ +#ifdef FAPI + DU_LOG("\nPHY_STUB: Received Param Request in PHY"); + + /* Build and send PARAM RESPONSE */ if(l1BldAndSndParamRsp(msg)!= ROK) { - printf("\nPHY_STUB: Failed Sending Param Response"); + DU_LOG("\nPHY_STUB: Failed Sending Param Response"); } + MAC_FREE(msg, sizeof(fapi_param_req_t)); +#endif } /******************************************************************* @@ -240,13 +261,82 @@ PUBLIC void l1HdlParamReq(uint32_t msgLen, void *msg) PUBLIC void l1HdlConfigReq(uint32_t msgLen, void *msg) { - printf("\nPHY_STUB: Received Config Request in PHY"); +#ifdef FAPI + fapi_config_req_t *configReq = (fapi_config_req_t *)msg; + + DU_LOG("\nPHY_STUB: Received Config Request in PHY"); /* Handling CONFIG RESPONSE */ if(l1BldAndSndConfigRsp(msg)!= ROK) { printf("\nPHY_STUB: Failed Sending config Response"); } + + MAC_FREE(configReq, msgLen); +#endif + +} + + +/******************************************************************* + * + * @brief Builds and Sends RACH indication to MAC + * + * @details + * + * Function : l1BuildAndSendRachInd + * + * Functionality: + * Builds and Sends RACH indication to MAC + * + * @params[in] SFN value + * slot value + * @return ROK - success + * RFAILED - failure + * + * ****************************************************************/ +uint16_t l1BuildAndSendRachInd(uint16_t slot, uint16_t sfn) +{ +#ifdef FAPI + uint8_t rachPduIdx = 0; + uint8_t preamIdx = 0; + fapi_rach_pdu_t *rachPdu; + fapi_rach_indication_t *rachInd; + + /* Building RACH indication */ + MAC_ALLOC(rachInd, sizeof(fapi_rach_indication_t)); + if(!rachInd) + { + printf("\nPHY_STUB: Memory allocation failed for Rach Indication Message"); + return RFAILED; + } + + rachInd->sfn = sfn; + rachInd->slot = slot; + rachInd->numPdus = 1; + + rachPdu = &rachInd->rachPdu[rachPduIdx]; + rachPdu->physCellId = NR_PCI; + rachPdu->symbolIndex = 0; + rachPdu->slotIndex = slot; + rachPdu->freqIndex = 0; + rachPdu->avgRssi = 0; + rachPdu->avgSnr = 0; + rachPdu->numPreamble = 1; + + rachPdu->preambleInfo[preamIdx].preambleIndex = 3; + rachPdu->preambleInfo[preamIdx].timingAdvance = 0; + rachPdu->preambleInfo[preamIdx].premblePwr = 0; + + fillMsgHeader(&rachInd->header, FAPI_RACH_INDICATION, \ + sizeof(fapi_rach_indication_t)); + + /* Sending RACH indication to MAC */ + DU_LOG("\nPHY STUB: Sending RACH Indication to MAC"); + handlePhyMessages(rachInd->header.message_type_id, sizeof(fapi_rach_indication_t), (void *)rachInd); + MAC_FREE(rachInd, sizeof(fapi_rach_indication_t)); +#endif + return ROK; } /******************************************************************* @@ -255,7 +345,7 @@ PUBLIC void l1HdlConfigReq(uint32_t msgLen, void *msg) * * @details * - * Function : buildAndSendSlotIndication + * Function : l1BuildAndSendSlotIndication * * Functionality: * -Send the Slot indication Message to MAC @@ -266,19 +356,26 @@ PUBLIC void l1HdlConfigReq(uint32_t msgLen, void *msg) * @return void * * ****************************************************************/ -PUBLIC S16 buildAndSendSlotIndication() +PUBLIC uint16_t l1BuildAndSendSlotIndication() { #ifdef FAPI fapi_slot_ind_t *slotIndMsg; - if(SGetSBuf(0, 0, (Data **)&slotIndMsg, sizeof(slotIndMsg)) != ROK) + + MAC_ALLOC(slotIndMsg, sizeof(fapi_slot_ind_t)); + if(!slotIndMsg) { - printf("\nPHY_STUB: Memory allocation failed for slot Indication Message"); + DU_LOG("\nPHY_STUB: Memory allocation failed for slot Indication Message"); return RFAILED; } else { + slotIndMsg->sfn = sfnValue; + slotIndMsg->slot = slotValue; + DU_LOG("\n\nPHY_STUB: SLOT indication [%d:%d]",sfnValue,slotValue); + + /* increment for the next TTI */ slotValue++; - if(sfnValue > MAX_SFN_VALUE && slotValue > MAX_SLOT_VALUE) + if(sfnValue >= MAX_SFN_VALUE && slotValue > MAX_SLOT_VALUE) { sfnValue = 0; slotValue = 0; @@ -288,12 +385,9 @@ PUBLIC S16 buildAndSendSlotIndication() sfnValue++; slotValue = 0; } - slotIndMsg->sfn = sfnValue; - slotIndMsg->slot = slotValue; fillMsgHeader(&slotIndMsg->header, FAPI_SLOT_INDICATION, sizeof(fapi_slot_ind_t)); - printf("\nPHY_STUB [%d:%d] ",sfnValue,slotValue); - handlePhyMessages((void*)slotIndMsg); - SPutSBuf(0, 0, (Data *)slotIndMsg, sizeof(slotIndMsg)); + handlePhyMessages(slotIndMsg->header.message_type_id, sizeof(fapi_slot_ind_t), (void*)slotIndMsg); + MAC_FREE(slotIndMsg, sizeof(fapi_slot_ind_t)); } #endif return ROK; @@ -319,19 +413,21 @@ PUBLIC S16 buildAndSendSlotIndication() PUBLIC S16 l1HdlStartReq(uint32_t msgLen, void *msg) { +#ifdef FAPI + fapi_start_req_t *startReq = (fapi_start_req_t *)msg; + if(clGlobalCp.phyState == PHY_STATE_CONFIGURED) { duStartSlotIndicaion(); -#ifdef FAPI - SPutSBuf(0, 0, (Data *)msg, sizeof(fapi_start_req_t)); -#endif - return ROK; + MAC_FREE(startReq, msgLen); } else { - printf("\n PHY_STUB: Received Start Req in PHY State", clGlobalCp.phyState); + DU_LOG("\nPHY_STUB: Received Start Req in PHY State %d", clGlobalCp.phyState); return RFAILED; } +#endif + return ROK; } /******************************************************************* @@ -357,8 +453,9 @@ PUBLIC S16 l1HdlDlTtiReq(uint16_t msgLen, void *msg) #ifdef FAPI fapi_dl_tti_req_t *dlTtiReq; dlTtiReq = (fapi_dl_tti_req_t *)msg; + + printf("\nPHY STUB: Received DL TTI Request"); #if 0 - printf("\nPHY_STUB: Received DL TTI Request in PHY"); printf("\nPHY_STUB: SFN %d", dlTtiReq->sfn); printf("\nPHY_STUB: SLOT %d", dlTtiReq->slot); printf("\nPHY_STUB: nPdus %d", dlTtiReq->nPdus); @@ -372,34 +469,115 @@ PUBLIC S16 l1HdlDlTtiReq(uint16_t msgLen, void *msg) printf("\nPHY_STUB: bchPayloadFlag %d", dlTtiReq->pdus->u.ssb_pdu.bchPayloadFlag); printf("\nPHY_STUB: bchPayload %x", dlTtiReq->pdus->u.ssb_pdu.bchPayload); #endif - uint8_t numPdus = dlTtiReq->nPdus; + uint8_t pduCount = 0; + if(dlTtiReq->nPdus == 0) + { + DU_LOG("\nPHY_STUB: No PDU in DL TTI Request"); + } + for(pduCount=0; pduCountnPdus; pduCount++) + { + if(dlTtiReq->pdus[pduCount].pduType == 3) //SSB_PDU_TYPE + DU_LOG("\nPHY_STUB: SSB PDU"); + else if(dlTtiReq->pdus[pduCount].pduType == 0) + DU_LOG("\nPHY_STUB: PDCCH PDU"); + else if(dlTtiReq->pdus[pduCount].pduType == 1) + DU_LOG("\nPHY_STUB: PDSCH PDU"); + } + + /* Free FAPI message */ + MAC_FREE(dlTtiReq, msgLen); + +#endif + return ROK; +} + +/******************************************************************* +* +* @brief Handles tx_data request received from MAC +* +* @details +* +* Function : l1HdlTxDataReq +* +* Functionality: +* -Handles tx_data request received from MAC +* +* @params[in] Message length +* tx_data request message pointer +* +* @return void +* +* ****************************************************************/ + +PUBLIC S16 l1HdlTxDataReq(uint16_t msgLen, void *msg) +{ +#ifdef FAPI + fapi_tx_data_req_t *txDataReq; + txDataReq = (fapi_tx_data_req_t *)msg; + + DU_LOG("\nPHY STUB: Received TX DATA Request"); + + MAC_FREE(txDataReq, msgLen); +#endif + return ROK; +} +/******************************************************************* +* +* @brief Handles Ul Tti request received from MAC +* +* @details +* +* Function : l1HdlUlTtiReq +* +* Functionality: +* -Handles Ul Tti request received from MAC +* +* @params[in] Message length +* Ul Tti request message pointer +* +* @return void +* +* ****************************************************************/ + +PUBLIC S16 l1HdlUlTtiReq(uint16_t msgLen, void *msg) +{ +#ifdef FAPI + fapi_ul_tti_req_t *ulTtiReq; + + DU_LOG("\nPHY STUB: Received UL TTI Request"); + + ulTtiReq = (fapi_ul_tti_req_t *)msg; + uint8_t numPdus = ulTtiReq->nPdus; + if(numPdus == 0) { - printf("no PDU \n"); + DU_LOG("\nPHY STUB: No PDU in UL TTI"); } while(numPdus) { - if(dlTtiReq->pdus->pduType == 3) //SSB_PDU_TYPE - printf("SSB PDU\n"); - else if(dlTtiReq->pdus->pduType == 0) - printf("SIB1 PDCCH PDU\n"); - else if(dlTtiReq->pdus->pduType == 1) - printf("SIB1 PDSCH PDU\n"); - + if(ulTtiReq->pdus[numPdus-1].pduType == 0) + DU_LOG("\nPHY STUB: PRACH PDU"); numPdus--; } - SPutSBuf(0, 0, (Data *)dlTtiReq, sizeof(fapi_dl_tti_req_t)); + if(rachIndSent == false && ulTtiReq->sfn == 2 && ulTtiReq->slot == 6) + { + rachIndSent = true; + l1BuildAndSendRachInd(ulTtiReq->slot, ulTtiReq->sfn); + } + + MAC_FREE(ulTtiReq, msgLen); #endif return ROK; } + /******************************************************************* * * @brief Receives message from MAC * * @details * - * Function : processFapiRequest + * Function : l1ProcessFapiRequest * * Functionality: * - Receives message from MAC and calls handler @@ -412,7 +590,7 @@ PUBLIC S16 l1HdlDlTtiReq(uint16_t msgLen, void *msg) * * ****************************************************************/ -void processFapiRequest(uint8_t msgType, uint32_t msgLen, void *msg) +void l1ProcessFapiRequest(uint8_t msgType, uint32_t msgLen, void *msg) { switch(msgType) { @@ -429,8 +607,14 @@ void processFapiRequest(uint8_t msgType, uint32_t msgLen, void *msg) case FAPI_DL_TTI_REQUEST: l1HdlDlTtiReq(msgLen, msg); break; + case FAPI_TX_DATA_REQUEST: + l1HdlTxDataReq(msgLen, msg); + break; + case FAPI_UL_TTI_REQUEST: + l1HdlUlTtiReq(msgLen, msg); + break; default: - printf("\nPHY_STUB: Invalid message type[%x] received at PHY", msgType); + DU_LOG("\nPHY_STUB: Invalid message type[%x] received at PHY", msgType); break; #endif }