fapi_5g/source/framework/nr5g_fapi_framework.c

   1 /******************************************************************************
   2 *
   3 *   Copyright (c) 2019 Intel.
   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 #include "nr5g_fapi_framework.h"
  19 #include "nr5g_fapi_wls.h"
  20 #include "nr5g_fapi_fapi2mac_wls.h"
  21 #include "nr5g_fapi_fapi2phy_wls.h"
  22 #include "nr5g_fapi_fapi2phy_api.h"
  23 #include "gnb_l1_l2_api.h"
  24 #include "rte_memzone.h"
  25 #include "nr5g_fapi_memory.h"
  26
  27 static nr5g_fapi_phy_ctx_t nr5g_fapi_phy_ctx;
  28
  29 inline p_nr5g_fapi_phy_ctx_t nr5g_fapi_get_nr5g_fapi_phy_ctx(
  30     )
  31 {
  32     return &nr5g_fapi_phy_ctx;
  33 }
  34
  35 uint8_t nr5g_fapi_dpdk_init(
  36     p_nr5g_fapi_cfg_t p_cfg)
  37 {
  38     printf("init dev name: %s\n", p_cfg->wls.device_name);
  39     char *const file_prefix = basename(p_cfg->wls.device_name);
  40     printf("init basename: %s\n", file_prefix);
  41     char whitelist[32], iova_mode[64];
  42     uint8_t i;
  43
  44     char *argv[] = { p_cfg->prgname, "--proc-type=secondary",
  45         "--file-prefix", file_prefix, whitelist, iova_mode
  46     };
  47 #if 0
  48     char coremask[32];
  49     char *argv[] = { p_cfg->prgname, coremask, "--proc-type=secondary",
  50         "--file-prefix", file_prefix, whitelist
  51     };
  52     snprintf(coremask, 32, "-l %d,%d", p_cfg->mac2phy_worker.core_id,
  53         p_cfg->phy2mac_worker.core_id);
  54 #endif
  55     int argc = RTE_DIM(argv);
  56
  57     /* initialize EAL first */
  58     snprintf(whitelist, 32, "-w %s", "0000:00:06.0");
  59
  60     if (p_cfg->dpdk.iova_mode == 0)
  61         snprintf(iova_mode, 64, "%s", "--iova-mode=pa");
  62     else
  63         snprintf(iova_mode, 64, "%s", "--iova-mode=va");
  64
  65     printf("Calling rte_eal_init: ");
  66     for (i = 0; i < RTE_DIM(argv); i++) {
  67         printf("%s ", argv[i]);
  68     }
  69     printf("\n");
  70
  71     if (rte_eal_init(argc, argv) < 0)
  72         rte_panic("Cannot init EAL\n");
  73
  74     return SUCCESS;
  75 }
  76
  77 uint8_t nr5g_fapi_dpdk_wait(
  78     p_nr5g_fapi_cfg_t p_cfg)
  79 {
  80 #if 0
  81     uint32_t worker_core;
  82     /* wait per-lcore */
  83     RTE_LCORE_FOREACH_SLAVE(worker_core) {
  84         if (rte_eal_wait_lcore(worker_core) < 0) {
  85             return FAILURE;
  86         }
  87     }
  88 #else
  89     pthread_join(p_cfg->mac2phy_thread_info.thread_id, NULL);
  90     pthread_join(p_cfg->phy2mac_thread_info.thread_id, NULL);
  91 #endif
  92     return SUCCESS;
  93 }
  94
  95 void nr5g_fapi_set_ul_slot_info(
  96     uint16_t frame_no,
  97     uint8_t slot_no,
  98     nr5g_fapi_ul_slot_info_t * p_ul_slot_info)
  99 {
 100     NR5G_FAPI_MEMSET(p_ul_slot_info, sizeof(nr5g_fapi_ul_slot_info_t), 0,
 101         sizeof(nr5g_fapi_ul_slot_info_t));
 102     p_ul_slot_info->cookie = frame_no;
 103     p_ul_slot_info->slot_no = slot_no;
 104 }
 105
 106 nr5g_fapi_ul_slot_info_t *nr5g_fapi_get_ul_slot_info(
 107     uint16_t frame_no,
 108     uint8_t slot_no,
 109     p_nr5g_fapi_phy_instance_t p_phy_instance)
 110 {
 111     uint8_t i;
 112     nr5g_fapi_ul_slot_info_t *p_ul_slot_info;
 113
 114     for (i = 0; i < MAX_UL_SLOT_INFO_COUNT; i++) {
 115         p_ul_slot_info = &p_phy_instance->ul_slot_info[i];
 116         if ((slot_no == p_ul_slot_info->slot_no) &&
 117             (frame_no == p_ul_slot_info->cookie)) {
 118             return p_ul_slot_info;
 119         }
 120     }
 121     return NULL;
 122 }
 123
 124 uint8_t nr5g_fapi_framework_init(
 125     p_nr5g_fapi_cfg_t p_cfg)
 126 {
 127     p_nr5g_fapi_phy_ctx_t p_phy_ctx = nr5g_fapi_get_nr5g_fapi_phy_ctx();
 128     pthread_attr_t *p_mac2phy_attr, *p_phy2mac_attr;
 129     struct sched_param param;
 130
 131     nr5g_fapi_set_log_level(p_cfg->logger.level);
 132     // Set up WLS
 133     if (FAILURE == nr5g_fapi_wls_init(p_cfg)) {
 134         NR5G_FAPI_LOG(ERROR_LOG, ("[FAPI_INT] WLS init Failed"));
 135         return FAILURE;
 136     }
 137     NR5G_FAPI_LOG(INFO_LOG, ("[FAPI_INT] WLS init Successful"));
 138
 139     p_phy_ctx->phy2mac_worker_core_id = p_cfg->phy2mac_worker.core_id;
 140     p_phy_ctx->mac2phy_worker_core_id = p_cfg->mac2phy_worker.core_id;
 141     p_phy2mac_attr = &p_cfg->phy2mac_thread_info.thread_attr;
 142     pthread_attr_init(p_phy2mac_attr);
 143     if (!pthread_attr_getschedparam(p_phy2mac_attr, &param)) {
 144         param.sched_priority = p_cfg->phy2mac_worker.thread_priority;
 145         pthread_attr_setschedparam(p_phy2mac_attr, &param);
 146         pthread_attr_setschedpolicy(p_phy2mac_attr, SCHED_FIFO);
 147     }
 148
 149     if (0 != pthread_create(&p_cfg->phy2mac_thread_info.thread_id,
 150             p_phy2mac_attr, nr5g_fapi_phy2mac_thread_func, (void *)
 151             p_phy_ctx)) {
 152         printf("Error: Unable to create threads\n");
 153         if (p_phy2mac_attr)
 154             pthread_attr_destroy(p_phy2mac_attr);
 155         return FAILURE;
 156     }
 157     pthread_setname_np(p_cfg->phy2mac_thread_info.thread_id,
 158         "nr5g_fapi_phy2mac_thread");
 159
 160     p_mac2phy_attr = &p_cfg->mac2phy_thread_info.thread_attr;
 161     pthread_attr_init(p_mac2phy_attr);
 162     if (!pthread_attr_getschedparam(p_mac2phy_attr, &param)) {
 163         param.sched_priority = p_cfg->mac2phy_worker.thread_priority;
 164         pthread_attr_setschedparam(p_mac2phy_attr, &param);
 165         pthread_attr_setschedpolicy(p_mac2phy_attr, SCHED_FIFO);
 166     }
 167
 168     if (0 != pthread_create(&p_cfg->mac2phy_thread_info.thread_id,
 169             p_mac2phy_attr, nr5g_fapi_mac2phy_thread_func, (void *)
 170             p_phy_ctx)) {
 171         printf("Error: Unable to create threads\n");
 172         if (p_mac2phy_attr)
 173             pthread_attr_destroy(p_mac2phy_attr);
 174         return FAILURE;
 175     }
 176     pthread_setname_np(p_cfg->mac2phy_thread_info.thread_id,
 177         "nr5g_fapi_mac2phy_thread");
 178
 179     return SUCCESS;
 180 }