WLS and FAPI message length fix
[o-du/l2.git] / src / phy_stub / l1_bdy1.c
index 64c5a04..8595429 100644 (file)
 #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,36 +356,41 @@ PUBLIC void l1HdlConfigReq(uint32_t msgLen, void *msg)
  * @return void
  *
  * ****************************************************************/
-PUBLIC void 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;
       }
-      else if(slotValue >= MAX_SLOT_VALUE)
+      else if(slotValue > MAX_SLOT_VALUE)
       {
          sfnValue++;
          slotValue = 0;
       }
-      slotIndMsg->sfn = sfnValue;
-      slotIndMsg->slot = slotValue;
       fillMsgHeader(&slotIndMsg->header, FAPI_SLOT_INDICATION, sizeof(fapi_slot_ind_t));
-      printf("\nPHY_STUB: Sending Slot Indication Msg to Lower Mac");
-      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;
 }
 
 /*******************************************************************
@@ -316,21 +411,23 @@ PUBLIC void buildAndSendSlotIndication()
  *
  * ****************************************************************/
 
-PUBLIC void l1HdlStartReq(uint32_t msgLen, void *msg)
+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;
 }
 
 /*******************************************************************
@@ -351,12 +448,14 @@ PUBLIC void l1HdlStartReq(uint32_t msgLen, void *msg)
 *
 * ****************************************************************/
 
-PUBLIC void l1HdlDlTtiReq(uint16_t msgLen, void *msg)
+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 in PHY");
+
+   printf("\nPHY STUB: Received DL TTI Request");
+#if 0
    printf("\nPHY_STUB:  SFN     %d", dlTtiReq->sfn);
    printf("\nPHY_STUB:  SLOT    %d", dlTtiReq->slot);
    printf("\nPHY_STUB:  nPdus   %d", dlTtiReq->nPdus);
@@ -369,18 +468,116 @@ PUBLIC void l1HdlDlTtiReq(uint16_t msgLen, void *msg)
    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
+       uint8_t pduCount = 0;
+       if(dlTtiReq->nPdus == 0)
+       {
+               DU_LOG("\nPHY_STUB: No PDU in DL TTI Request");
+   }
+       for(pduCount=0; pduCount<dlTtiReq->nPdus; 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");
 
-   SPutSBuf(0, 0, (Data *)dlTtiReq, sizeof(fapi_dl_tti_req_t));
+   ulTtiReq = (fapi_ul_tti_req_t *)msg;
+   uint8_t numPdus = ulTtiReq->nPdus;
+    
+       if(numPdus == 0)
+       {
+               DU_LOG("\nPHY STUB: No PDU in UL TTI");
+   }
+       while(numPdus)
+       {
+               if(ulTtiReq->pdus[numPdus-1].pduType == 0)
+                       DU_LOG("\nPHY STUB: PRACH PDU");
+               numPdus--;
+       }
+
+   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
@@ -393,7 +590,7 @@ PUBLIC void 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)
    {
@@ -410,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
    }