#include "gnb_l1_l2_api.h"
#include "nr5g_fapi_fapi2mac_wls.h"
#include "nr5g_fapi_log.h"
+#include "nr5g_fapi_urllc_thread.h"
+
+static p_fapi_api_queue_elem_t p_fapi2mac_buffers;
//------------------------------------------------------------------------------
/** @ingroup nr5g_fapi_source_framework_wls_fapi2mac_group
p_nr5g_fapi_wls_context_t p_wls_ctx = nr5g_fapi_wls_context();
WLS_HANDLE h_wls = nr5g_fapi_fapi2mac_wls_instance();
- if (pthread_mutex_lock((pthread_mutex_t *) & p_wls_ctx->
- fapi2mac_lock_alloc)) {
+ if (pthread_mutex_lock((pthread_mutex_t *) &
+ p_wls_ctx->fapi2mac_lock_alloc)) {
NR5G_FAPI_LOG(ERROR_LOG, ("unable to lock alloc pthread mutex"));
return NULL;
}
- pa_block = (uint64_t) WLS_DequeueBlock((void *)h_wls);
- if (pthread_mutex_unlock((pthread_mutex_t *) & p_wls_ctx->
- fapi2mac_lock_alloc)) {
+ if (p_fapi2mac_buffers) {
+ p_va_block = (void *)p_fapi2mac_buffers;
+ p_fapi2mac_buffers = p_fapi2mac_buffers->p_next;
+ } else {
+ pa_block = (uint64_t) WLS_DequeueBlock((void *)h_wls);
+ if (!pa_block) {
+ if (pthread_mutex_unlock((pthread_mutex_t *) &
+ p_wls_ctx->fapi2mac_lock_alloc)) {
+ NR5G_FAPI_LOG(ERROR_LOG,
+ ("unable to unlock alloc pthread mutex"));
+ return NULL;
+ }
+ //NR5G_FAPI_LOG(ERROR_LOG, ("nr5g_fapi_fapi2phy_wls_alloc_buffer alloc error\n"));
+ return NULL;
+ }
+ p_va_block = (void *)nr5g_fapi_wls_pa_to_va(h_wls, pa_block);
+ }
+ if (pthread_mutex_unlock((pthread_mutex_t *) &
+ p_wls_ctx->fapi2mac_lock_alloc)) {
NR5G_FAPI_LOG(ERROR_LOG, ("unable to unlock alloc pthread mutex"));
return NULL;
}
+ return p_va_block;
+}
- if (!pa_block) {
- //NR5G_FAPI_LOG(ERROR_LOG, ("nr5g_fapi_fapi2phy_wls_alloc_buffer alloc error\n"));
- return NULL;
+//------------------------------------------------------------------------------
+/** @ingroup nr5g_fapi_source_framework_wls_fapi2phy_group
+ *
+ * @param void
+ *
+ * @return Pointer to the memory block
+ *
+ * @description
+ * This function allocates a block of memory from the pool
+ *
+**/
+//------------------------------------------------------------------------------
+void nr5g_fapi_fapi2mac_wls_free_buffer(
+ void *buffers)
+{
+ p_nr5g_fapi_wls_context_t p_wls_ctx = nr5g_fapi_wls_context();
+
+ if (pthread_mutex_lock((pthread_mutex_t *) &
+ p_wls_ctx->fapi2mac_lock_alloc)) {
+ NR5G_FAPI_LOG(ERROR_LOG, ("unable to lock alloc pthread mutex"));
+ return;
+ }
+ if (p_fapi2mac_buffers) {
+ ((p_fapi_api_queue_elem_t) buffers)->p_next = p_fapi2mac_buffers;
+ p_fapi2mac_buffers = (p_fapi_api_queue_elem_t) buffers;
+ } else {
+ p_fapi2mac_buffers = (p_fapi_api_queue_elem_t) buffers;
+ p_fapi2mac_buffers->p_next = NULL;
+ }
+
+ if (pthread_mutex_unlock((pthread_mutex_t *) &
+ p_wls_ctx->fapi2mac_lock_alloc)) {
+ NR5G_FAPI_LOG(ERROR_LOG, ("unable to unlock alloc pthread mutex"));
+ return;
}
- p_va_block = (void *)nr5g_fapi_wls_pa_to_va(h_wls, pa_block);
- return p_va_block;
}
//------------------------------------------------------------------------------
*
**/
//------------------------------------------------------------------------------
-uint8_t nr5g_fapi_fapi2mac_wls_wait(
+uint32_t nr5g_fapi_fapi2mac_wls_wait(
)
{
int ret = SUCCESS;
h_wls = nr5g_fapi_fapi2mac_wls_instance();
data = (uint64_t *) WLS_Get1(h_wls, &ms, &mt, &f);
*msg_size = ms, *msg_type = mt, *flags = f;
- NR5G_FAPI_LOG(TRACE_LOG, ("[NR5G_FAPI][FAPI2MAC WLS][GET] %p size: %d "
+ NR5G_FAPI_LOG(TRACE_LOG, ("[FAPI2MAC WLS][GET] %p size: %d "
"type: %x flags: %x", data, *msg_size, *msg_type, *flags));
return data;
WLS_HANDLE h_mac_wls = nr5g_fapi_fapi2mac_wls_instance();
uint64_t pa = nr5g_fapi_wls_va_to_pa(h_mac_wls, (void *)p_msg);
- NR5G_FAPI_LOG(TRACE_LOG, ("[NR5G_FAPI][FAPI2MAC WLS][PUT] %ld size: %d "
+ NR5G_FAPI_LOG(TRACE_LOG, ("[FAPI2MAC WLS][PUT] %ld size: %d "
"type: %x flags: %x", pa, msg_size, msg_type, flags));
ret = WLS_Put1(h_mac_wls, (uint64_t) pa, msg_size, msg_type, flags);
**/
//------------------------------------------------------------------------------
uint8_t nr5g_fapi_fapi2mac_wls_send(
- p_fapi_api_queue_elem_t p_list_elem)
+ p_fapi_api_queue_elem_t p_list_elem,
+ bool is_urllc)
{
uint8_t ret = SUCCESS;
p_fapi_api_queue_elem_t p_curr_msg = NULL;
fapi_msg_t *p_msg_header = NULL;
uint16_t flags = 0;
+ uint16_t flags_urllc = (is_urllc ? WLS_TF_URLLC : 0);
p_nr5g_fapi_wls_context_t p_wls_ctx = nr5g_fapi_wls_context();
+ uint64_t start_tick = __rdtsc();
p_curr_msg = p_list_elem;
}
if (p_curr_msg && p_curr_msg->p_next) {
- flags = WLS_SG_FIRST;
- if (p_curr_msg->msg_type == FAPI_MSG_HEADER_IND) {
+ flags = WLS_SG_FIRST | flags_urllc;
+ if (p_curr_msg->msg_type == FAPI_VENDOR_MSG_HEADER_IND) {
if (SUCCESS != nr5g_fapi_fapi2mac_wls_put(p_curr_msg,
p_curr_msg->msg_len + sizeof(fapi_api_queue_elem_t),
- FAPI_MSG_HEADER_IND, flags)) {
+ FAPI_VENDOR_MSG_HEADER_IND, flags)) {
printf("Error\n");
- if (pthread_mutex_unlock((pthread_mutex_t *) & p_wls_ctx->
- fapi2mac_lock_send)) {
+ if (pthread_mutex_unlock((pthread_mutex_t *) &
+ p_wls_ctx->fapi2mac_lock_send)) {
NR5G_FAPI_LOG(ERROR_LOG,
("unable to unlock send pthread mutex"));
}
return FAILURE;
}
p_curr_msg = p_curr_msg->p_next;
- flags = WLS_SG_NEXT;
+ flags = WLS_SG_NEXT | flags_urllc;
}
while (p_curr_msg) {
p_curr_msg->msg_len + sizeof(fapi_api_queue_elem_t),
p_msg_header->msg_id, flags)) {
printf("Error\n");
- if (pthread_mutex_unlock((pthread_mutex_t *) & p_wls_ctx->
- fapi2mac_lock_send)) {
+ if (pthread_mutex_unlock((pthread_mutex_t *) &
+ p_wls_ctx->fapi2mac_lock_send)) {
NR5G_FAPI_LOG(ERROR_LOG,
("unable to unlock send pthread mutex"));
}
}
p_curr_msg = p_curr_msg->p_next;
} else { // LAST
- flags = WLS_SG_LAST;
+ flags = WLS_SG_LAST | flags_urllc;
if (SUCCESS != nr5g_fapi_fapi2mac_wls_put(p_curr_msg,
p_curr_msg->msg_len + sizeof(fapi_api_queue_elem_t),
p_msg_header->msg_id, flags)) {
printf("Error\n");
- if (pthread_mutex_unlock((pthread_mutex_t *) & p_wls_ctx->
- fapi2mac_lock_send)) {
+ if (pthread_mutex_unlock((pthread_mutex_t *) &
+ p_wls_ctx->fapi2mac_lock_send)) {
NR5G_FAPI_LOG(ERROR_LOG,
("unable to unlock send pthread mutex"));
}
}
p_curr_msg = NULL;
}
- flags = WLS_SG_NEXT;
+ flags = WLS_SG_NEXT | flags_urllc;
}
}
- if (pthread_mutex_unlock((pthread_mutex_t *) & p_wls_ctx->
- fapi2mac_lock_send)) {
+ if (pthread_mutex_unlock((pthread_mutex_t *) &
+ p_wls_ctx->fapi2mac_lock_send)) {
NR5G_FAPI_LOG(ERROR_LOG, ("unable to unlock send pthread mutex"));
return FAILURE;
}
+ tick_total_wls_send_per_tti_ul += __rdtsc() - start_tick;
+
return ret;
}
uint32_t msg_size = 0;
uint32_t num_elms = 0;
uint64_t *p_msg = NULL;
- p_fapi_api_queue_elem_t p_qelm_list = NULL;
+ p_fapi_api_queue_elem_t p_qelm_list = NULL, p_urllc_qelm_list = NULL;
p_fapi_api_queue_elem_t p_qelm = NULL;
- p_fapi_api_queue_elem_t p_tail_qelm = NULL;
+ p_fapi_api_queue_elem_t p_tail_qelm = NULL, p_urllc_tail_qelm = NULL;
WLS_HANDLE h_wls = nr5g_fapi_fapi2mac_wls_instance();
+ uint64_t start_tick = 0;
num_elms = nr5g_fapi_fapi2mac_wls_wait();
if (!num_elms)
return p_qelm_list;
+ start_tick = __rdtsc();
do {
p_msg = nr5g_fapi_fapi2mac_wls_get(&msg_size, &msg_type, &flags);
if (p_msg) {
continue;
}
p_qelm->p_next = NULL;
+
+ if (flags & WLS_TF_URLLC)
+ {
+ if (p_urllc_qelm_list) {
+ p_urllc_tail_qelm = p_urllc_qelm_list;
+ while (NULL != p_urllc_tail_qelm->p_next) {
+ p_urllc_tail_qelm = p_urllc_tail_qelm->p_next;
+ }
+ p_urllc_tail_qelm->p_next = p_qelm;
+ } else {
+ p_urllc_qelm_list = p_qelm;
+ }
+ } else {
if (p_qelm_list) {
p_tail_qelm = p_qelm_list;
while (NULL != p_tail_qelm->p_next) {
p_qelm_list = p_qelm;
}
}
+ }
num_elms--;
} while (num_elms && is_msg_present(flags));
+ if (p_urllc_qelm_list) {
+ nr5g_fapi_urllc_thread_callback(NR5G_FAPI_URLLC_MSG_DIR_MAC2PHY, (void *) p_urllc_qelm_list);
+ }
+
+ tick_total_wls_get_per_tti_dl += __rdtsc() - start_tick;
+
return p_qelm_list;
}
Code Review / o-du / phy.git / blobdiff