fapi_5g/source/framework/workers/nr5g_fapi_urllc_thread.c

   1 /******************************************************************************
   2 *
   3 *   Copyright (c) 2021 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_std.h"
  19 #include "nr5g_fapi_framework.h"
  20 #include "nr5g_fapi_urllc_thread.h"
  21 #include "nr5g_fapi_phy2mac_thread.h"
  22 #include "nr5g_fapi_mac2phy_thread.h"
  23 #include "nr5g_fapi_fapi2mac_api.h"
  24 #include "nr5g_fapi_fapi2phy_api.h"
  25
  26 static nr5g_fapi_urllc_msg_dir_t urllc_msg_dir = NR5G_FAPI_URLLC_MSG_DIR_LAST;
  27 static void *p_urllc_list_elem = NULL;
  28 static pthread_mutex_t lock = PTHREAD_MUTEX_INITIALIZER;
  29
  30 void nr5g_fapi_urllc_thread_callback(
  31     nr5g_fapi_urllc_msg_dir_t msg_dir,
  32     void *p_list_elem)
  33 {
  34     p_nr5g_fapi_phy_ctx_t p_phy_ctx = nr5g_fapi_get_nr5g_fapi_phy_ctx();
  35     if(0u != p_phy_ctx->urllc_tid)
  36     {
  37     sem_wait(&p_phy_ctx->urllc_sem_done);
  38     pthread_mutex_lock(&lock);
  39     p_urllc_list_elem = p_list_elem;
  40     urllc_msg_dir = msg_dir;
  41     pthread_mutex_unlock(&lock);
  42     sem_post(&p_phy_ctx->urllc_sem_process);
  43 }
  44     else
  45     {
  46             NR5G_FAPI_LOG(ERROR_LOG, ("[URLLC] Thread is not running"));
  47     }
  48 }
  49
  50 void *nr5g_fapi_urllc_thread_func(
  51     void *config)
  52 {
  53     cpu_set_t cpuset;
  54     pthread_t thread;
  55     p_nr5g_fapi_phy_ctx_t p_phy_ctx = (p_nr5g_fapi_phy_ctx_t) config;
  56     uint64_t start_tick;
  57
  58     NR5G_FAPI_LOG(INFO_LOG, ("[URLLC] Thread %s launched LWP:%ld on "
  59             "Core: %d\n", __func__, pthread_self(),
  60             p_phy_ctx->urllc_worker_core_id));
  61
  62     thread = p_phy_ctx->urllc_tid = pthread_self();
  63
  64     CPU_ZERO(&cpuset);
  65     CPU_SET(p_phy_ctx->urllc_worker_core_id, &cpuset);
  66     pthread_setaffinity_np(thread, sizeof(cpu_set_t), &cpuset);
  67
  68     usleep(1000);
  69     while (!p_phy_ctx->process_exit) {
  70         sem_wait(&p_phy_ctx->urllc_sem_process);
  71         pthread_mutex_lock(&lock);
  72         if (p_urllc_list_elem)
  73         {
  74             switch (urllc_msg_dir) {
  75                 case NR5G_FAPI_URLLC_MSG_DIR_MAC2PHY:
  76                     nr5g_fapi_mac2phy_api_recv_handler(true, config,
  77                                 (p_fapi_api_queue_elem_t) p_urllc_list_elem);
  78                     start_tick = __rdtsc();
  79                     NR5G_FAPI_LOG(TRACE_LOG,
  80                                           ("[MAC2PHY] Send to PHY urllc.."));
  81                     nr5g_fapi_fapi2phy_send_api_list(true);
  82                     tick_total_wls_send_per_tti_dl += __rdtsc() - start_tick;
  83                     break;
  84                 case NR5G_FAPI_URLLC_MSG_DIR_PHY2MAC:
  85                     nr5g_fapi_phy2mac_api_recv_handler(true, config,
  86                                     (PMAC2PHY_QUEUE_EL) p_urllc_list_elem);
  87                     nr5g_fapi_fapi2mac_send_api_list(true);
  88                     break;
  89                 default:
  90                     NR5G_FAPI_LOG(ERROR_LOG,
  91                             ("[URLLC]: Invalid URLLC message direction.\n"));
  92                     break;
  93             }
  94
  95             p_urllc_list_elem = NULL;
  96             urllc_msg_dir = NR5G_FAPI_URLLC_MSG_DIR_LAST;
  97         }
  98         pthread_mutex_unlock(&lock);
  99         sem_post(&p_phy_ctx->urllc_sem_done);
 100     }
 101
 102     pthread_exit(NULL);
 103 }