-/******************************************************************************
-*
-* Copyright (c) 2019 Intel.
-*
-* Licensed under the Apache License, Version 2.0 (the "License");
-* you may not use this file except in compliance with the License.
-* You may obtain a copy of the License at
-*
-* http://www.apache.org/licenses/LICENSE-2.0
-*
-* Unless required by applicable law or agreed to in writing, software
-* distributed under the License is distributed on an "AS IS" BASIS,
-* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
-* See the License for the specific language governing permissions and
-* limitations under the License.
-*
-*******************************************************************************/
-
-/**
- * @brief XRAN layer common functionality for both lls-CU and RU as well as C-plane and
- * U-plane
- * @file xran_common.c
- * @ingroup group_source_xran
- * @author Intel Corporation
- **/
-
-#include <assert.h>
-#include <err.h>
-#include <arpa/inet.h>
-#include <sys/time.h>
-#include <time.h>
-
-#include "xran_common.h"
-#include "ethdi.h"
-#include "xran_pkt.h"
-#include "xran_pkt_up.h"
-#include "xran_up_api.h"
-#include "xran_lib_mlog_tasks_id.h"
-
-#include "../src/xran_printf.h"
-#include <rte_mbuf.h>
-#include "xran_mlog_lnx.h"
-
-#define MBUFS_CNT 16
-
-extern long interval_us;
-
-extern int xran_process_rx_sym(void *arg,
- struct rte_mbuf *mbuf,
- void *iq_data_start,
- uint16_t size,
- uint8_t CC_ID,
- uint8_t Ant_ID,
- uint8_t frame_id,
- uint8_t subframe_id,
- uint8_t slot_id,
- uint8_t symb_id,
- uint16_t num_prbu,
- uint16_t start_prbu,
- uint16_t sym_inc,
- uint16_t rb,
- uint16_t sect_id,
- uint32_t *mb_free);
-
-
-extern int xran_process_prach_sym(void *arg,
- struct rte_mbuf *mbuf,
- void *iq_data_start,
- uint16_t size,
- uint8_t CC_ID,
- uint8_t Ant_ID,
- uint8_t frame_id,
- uint8_t subframe_id,
- uint8_t slot_id,
- uint8_t symb_id,
- uint16_t num_prbu,
- uint16_t start_prbu,
- uint16_t sym_inc,
- uint16_t rb,
- uint16_t sect_id);
-
-extern int32_t xran_pkt_validate(void *arg,
- struct rte_mbuf *mbuf,
- void *iq_data_start,
- uint16_t size,
- uint8_t CC_ID,
- uint8_t Ant_ID,
- uint8_t frame_id,
- uint8_t subframe_id,
- uint8_t slot_id,
- uint8_t symb_id,
- struct ecpri_seq_id *seq_id,
- uint16_t num_prbu,
- uint16_t start_prbu,
- uint16_t sym_inc,
- uint16_t rb,
- uint16_t sect_id);
-
-long rx_counter = 0;
-long tx_counter = 0;
-
-int process_mbuf(struct rte_mbuf *pkt)
-{
- void *iq_samp_buf;
- struct ecpri_seq_id seq;
- static int symbol_total_bytes = 0;
- int num_bytes = 0;
- struct xran_device_ctx * p_x_ctx = xran_dev_get_ctx();
-
- uint8_t CC_ID = 0;
- uint8_t Ant_ID = 0;
- uint8_t frame_id = 0;
- uint8_t subframe_id = 0;
- uint8_t slot_id = 0;
- uint8_t symb_id = 0;
-
- uint16_t num_prbu;
- uint16_t start_prbu;
- uint16_t sym_inc;
- uint16_t rb;
- uint16_t sect_id;
- void *pHandle = NULL;
- uint8_t num_eAxc = xran_get_num_eAxc(pHandle);
- int ret = MBUF_FREE;
- uint32_t mb_free = 0;
- int32_t valid_res = 0;
-
-
- if(p_x_ctx->xran2phy_mem_ready == 0)
- return MBUF_FREE;
-
- num_bytes = xran_extract_iq_samples(pkt,
- &iq_samp_buf,
- &CC_ID,
- &Ant_ID,
- &frame_id,
- &subframe_id,
- &slot_id,
- &symb_id,
- &seq,
- &num_prbu,
- &start_prbu,
- &sym_inc,
- &rb,
- §_id);
-
- if (num_bytes <= 0){
- print_err("num_bytes is wrong [%d]\n", num_bytes);
- return MBUF_FREE;
- }
-
- valid_res = xran_pkt_validate(NULL,
- pkt,
- iq_samp_buf,
- num_bytes,
- CC_ID,
- Ant_ID,
- frame_id,
- subframe_id,
- slot_id,
- symb_id,
- &seq,
- num_prbu,
- start_prbu,
- sym_inc,
- rb,
- sect_id);
-
- if(valid_res != 0) {
- print_err("valid_res is wrong [%d] ant %u (%u : %u : %u : %u) seq %u num_bytes %d\n", valid_res, Ant_ID, frame_id, subframe_id, slot_id, symb_id, seq.seq_id, num_bytes);
- return MBUF_FREE;
- }
-
- if (Ant_ID >= num_eAxc && p_x_ctx->fh_init.prachEnable) // PRACH packet has ruportid = num_eAxc + ant_id
- {
- Ant_ID -= num_eAxc;
- if (seq.e_bit == 1) {
-
- print_dbg("Completed receiving PRACH symbol %d, size=%d bytes\n",
- symb_id, num_bytes);
-
- xran_process_prach_sym(NULL,
- pkt,
- iq_samp_buf,
- num_bytes,
- CC_ID,
- Ant_ID,
- frame_id,
- subframe_id,
- slot_id,
- symb_id,
- num_prbu,
- start_prbu,
- sym_inc,
- rb,
- sect_id);
- }
- else {
- print_dbg("Transport layer fragmentation (eCPRI) is not supported\n");
- }
- } else {
- symbol_total_bytes += num_bytes;
-
- if (seq.e_bit == 1) {
- print_dbg("Completed receiving symbol %d, size=%d bytes\n",
- symb_id, symbol_total_bytes);
-
- if (symbol_total_bytes){
- int res = xran_process_rx_sym(NULL,
- pkt,
- iq_samp_buf,
- symbol_total_bytes,
- CC_ID,
- Ant_ID,
- frame_id,
- subframe_id,
- slot_id,
- symb_id,
- num_prbu,
- start_prbu,
- sym_inc,
- rb,
- sect_id,
- &mb_free);
- if(res == symbol_total_bytes)
- ret = mb_free;
- else
- print_err("res != symbol_total_bytes\n");
- }
- symbol_total_bytes = 0;
- }
- else {
- print_dbg("Transport layer fragmentation (eCPRI) is not supported\n");
- }
- }
-
- return ret;
-}
-
-static int set_iq_bit_width(uint8_t iq_bit_width, struct data_section_compression_hdr *compr_hdr)
-{
- if (iq_bit_width == MAX_IQ_BIT_WIDTH)
- compr_hdr->ud_comp_hdr.ud_iq_width = (uint8_t) 0;
- else
- compr_hdr->ud_comp_hdr.ud_iq_width = iq_bit_width;
-
- return 0;
-
-}
-
-/* Send a single 5G symbol over multiple packets */
-int32_t prepare_symbol_ex(enum xran_pkt_dir direction,
- uint16_t section_id,
- struct rte_mbuf *mb,
- struct rb_map *data,
- const enum xran_input_byte_order iq_buf_byte_order,
- uint8_t frame_id,
- uint8_t subframe_id,
- uint8_t slot_id,
- uint8_t symbol_no,
- int prb_start,
- int prb_num,
- uint8_t CC_ID,
- uint8_t RU_Port_ID,
- uint8_t seq_id,
- uint32_t do_copy)
-{
- int32_t n_bytes = ((prb_num == 0) ? MAX_N_FULLBAND_SC : prb_num) * N_SC_PER_PRB * sizeof(struct rb_map);
-
- int32_t prep_bytes;
-
- int16_t nPktSize = sizeof(struct ether_hdr) + sizeof(struct xran_ecpri_hdr) +
- sizeof(struct radio_app_common_hdr)+ sizeof(struct data_section_hdr) + n_bytes;
- uint32_t off;
- struct xran_up_pkt_gen_no_compression_params xp = { 0 };
-
- n_bytes = RTE_MIN(n_bytes, XRAN_MAX_MBUF_LEN);
-
- /* radio app header */
- xp.app_params.data_direction = direction;
- xp.app_params.payl_ver = 1;
- xp.app_params.filter_id = 0;
- xp.app_params.frame_id = frame_id;
- xp.app_params.sf_slot_sym.subframe_id = subframe_id;
- xp.app_params.sf_slot_sym.slot_id = slot_id;
- xp.app_params.sf_slot_sym.symb_id = symbol_no;
-
- /* convert to network byte order */
- xp.app_params.sf_slot_sym.value = rte_cpu_to_be_16(xp.app_params.sf_slot_sym.value);
-
- xp.sec_hdr.fields.sect_id = section_id;
- xp.sec_hdr.fields.num_prbu = (uint8_t)prb_num;
- xp.sec_hdr.fields.start_prbu = (uint8_t)prb_start;
- xp.sec_hdr.fields.sym_inc = 0;
- xp.sec_hdr.fields.rb = 0;
-
- /* network byte order */
- xp.sec_hdr.fields.all_bits = rte_cpu_to_be_32(xp.sec_hdr.fields.all_bits);
-
- if (mb == NULL){
- MLogPrint(NULL);
- errx(1, "out of mbufs after %d packets", 1);
- }
-
- prep_bytes = xran_prepare_iq_symbol_portion_no_comp(mb,
- data,
- iq_buf_byte_order,
- n_bytes,
- &xp,
- CC_ID,
- RU_Port_ID,
- seq_id,
- do_copy);
- if (prep_bytes <= 0)
- errx(1, "failed preparing symbol");
-
- rte_pktmbuf_pkt_len(mb) = nPktSize;
- rte_pktmbuf_data_len(mb) = nPktSize;
-
-#ifdef DEBUG
- printf("Symbol %2d prep_bytes (%d packets, %d bytes)\n", symbol_no, i, n_bytes);
-#endif
-
- return prep_bytes;
-}
-
-/* Send a single 5G symbol over multiple packets */
-int send_symbol_ex(enum xran_pkt_dir direction,
- uint16_t section_id,
- struct rte_mbuf *mb,
- struct rb_map *data,
- const enum xran_input_byte_order iq_buf_byte_order,
- uint8_t frame_id,
- uint8_t subframe_id,
- uint8_t slot_id,
- uint8_t symbol_no,
- int prb_start,
- int prb_num,
- uint8_t CC_ID,
- uint8_t RU_Port_ID,
- uint8_t seq_id)
-{
- uint32_t do_copy = 0;
- int32_t n_bytes = ((prb_num == 0) ? MAX_N_FULLBAND_SC : prb_num) * N_SC_PER_PRB * sizeof(struct rb_map);
-
- if (mb == NULL){
- char * pChar = NULL;
- mb = xran_ethdi_mbuf_alloc(); /* will be freede by ETH */
- if(mb == NULL){
- MLogPrint(NULL);
- errx(1, "out of mbufs after %d packets", 1);
- }
- pChar = rte_pktmbuf_append(mb, sizeof(struct xran_ecpri_hdr)+ sizeof(struct radio_app_common_hdr)+ sizeof(struct data_section_hdr) + n_bytes);
- if(pChar == NULL){
- MLogPrint(NULL);
- errx(1, "incorrect mbuf size %d packets", 1);
- }
- pChar = rte_pktmbuf_prepend(mb, sizeof(struct ether_hdr));
- if(pChar == NULL){
- MLogPrint(NULL);
- errx(1, "incorrect mbuf size %d packets", 1);
- }
- do_copy = 1; /* new mbuf hence copy of IQs */
- }else {
- rte_pktmbuf_refcnt_update(mb, 1); /* make sure eth won't free our mbuf */
- }
-
- int32_t sent = prepare_symbol_ex(direction,
- section_id,
- mb,
- data,
- iq_buf_byte_order,
- frame_id,
- subframe_id,
- slot_id,
- symbol_no,
- prb_start,
- prb_num,
- CC_ID,
- RU_Port_ID,
- seq_id,
- do_copy);
-
- if(sent){
- tx_counter++;
- xran_ethdi_mbuf_send(mb, ETHER_TYPE_ECPRI);
- } else {
-
- }
-
-
-
-#ifdef DEBUG
- printf("Symbol %2d sent (%d packets, %d bytes)\n", symbol_no, i, n_bytes);
-#endif
-
- return sent;
-}
-
-int send_cpmsg(void *pHandle, struct rte_mbuf *mbuf,struct xran_cp_gen_params *params,
- struct xran_section_gen_info *sect_geninfo, uint8_t cc_id, uint8_t ru_port_id, uint8_t seq_id)
-{
- int ret = 0, nsection, i;
- uint8_t frame_id = params->hdr.frameId;
- uint8_t subframe_id = params->hdr.subframeId;
- uint8_t slot_id = params->hdr.slotId;
- uint8_t dir = params->dir;
-
- nsection = params->numSections;
-
- /* add in the ethernet header */
- struct ether_hdr *const h = (void *)rte_pktmbuf_prepend(mbuf, sizeof(*h));
- xran_ethdi_mbuf_send_cp(mbuf, ETHER_TYPE_ECPRI);
- tx_counter++;
- for(i=0; i<nsection; i++)
- xran_cp_add_section_info(pHandle, dir, cc_id, ru_port_id,
- (slot_id + subframe_id*SLOTNUM_PER_SUBFRAME)%XRAN_MAX_SECTIONDB_CTX,
- §_geninfo[i].info);
-
- return (ret);
-}
-
-int generate_cpmsg_dlul(void *pHandle, struct xran_cp_gen_params *params, struct xran_section_gen_info *sect_geninfo, struct rte_mbuf *mbuf,
- enum xran_pkt_dir dir, uint8_t frame_id, uint8_t subframe_id, uint8_t slot_id,
- uint8_t startsym, uint8_t numsym, uint16_t prb_start, uint16_t prb_num,
- uint16_t beam_id, uint8_t cc_id, uint8_t ru_port_id, uint8_t comp_method, uint8_t seq_id, uint8_t symInc)
-{
- int ret = 0, nsection, i;
-
-
- params->dir = dir;
- params->sectionType = XRAN_CP_SECTIONTYPE_1; // Most DL/UL Radio Channels
- params->hdr.filterIdx = XRAN_FILTERINDEX_STANDARD;
- params->hdr.frameId = frame_id;
- params->hdr.subframeId = subframe_id;
- params->hdr.slotId = slot_id;
- params->hdr.startSymId = startsym; // start Symbol ID
- params->hdr.iqWidth = xran_get_conf_iqwidth(pHandle);
- params->hdr.compMeth = comp_method;
-
- nsection = 0;
- sect_geninfo[nsection].info.type = params->sectionType; // for database
- sect_geninfo[nsection].info.startSymId = params->hdr.startSymId; // for database
- sect_geninfo[nsection].info.iqWidth = params->hdr.iqWidth; // for database
- sect_geninfo[nsection].info.compMeth = params->hdr.compMeth; // for database
- sect_geninfo[nsection].info.id = xran_alloc_sectionid(pHandle, dir, cc_id, ru_port_id, slot_id);
- sect_geninfo[nsection].info.rb = XRAN_RBIND_EVERY;
- sect_geninfo[nsection].info.symInc = symInc;
- sect_geninfo[nsection].info.startPrbc = prb_start;
- sect_geninfo[nsection].info.numPrbc = prb_num;
- sect_geninfo[nsection].info.numSymbol = numsym;
- sect_geninfo[nsection].info.reMask = 0xfff;
- sect_geninfo[nsection].info.beamId = beam_id;
-
- sect_geninfo[nsection].info.ef = 0;
- sect_geninfo[nsection].exDataSize = 0;
-// sect_geninfo[nsection].exData = NULL;
- nsection++;
-
- params->numSections = nsection;
- params->sections = sect_geninfo;
-
- if(unlikely(mbuf == NULL)) {
- print_err("Alloc fail!\n");
- return (-1);
- }
-
- ret = xran_prepare_ctrl_pkt(mbuf, params, cc_id, ru_port_id, seq_id);
- if(ret < 0){
- print_err("Fail to build control plane packet - [%d:%d:%d] dir=%d\n",
- frame_id, subframe_id, slot_id, dir);
- rte_pktmbuf_free(mbuf);
- }
-
- return (ret);
-}
-
-int generate_cpmsg_prach(void *pHandle, struct xran_cp_gen_params *params, struct xran_section_gen_info *sect_geninfo, struct rte_mbuf *mbuf, struct xran_device_ctx *pxran_lib_ctx,
- uint8_t frame_id, uint8_t subframe_id, uint8_t slot_id,
- uint16_t beam_id, uint8_t cc_id, uint8_t prach_port_id, uint8_t seq_id)
-{
- int i, nsection, ret;
- xRANPrachCPConfigStruct *pPrachCPConfig = &(pxran_lib_ctx->PrachCPConfig);
- uint16_t timeOffset;
- uint16_t nNumerology = pxran_lib_ctx->fh_cfg.frame_conf.nNumerology;
-
- if(unlikely(mbuf == NULL)) {
- print_err("Alloc fail!\n");
- return (-1);
- }
-#if 0
- printf("%d:%d:%d:%d - filter=%d, startSym=%d[%d:%d], numSym=%d, occasions=%d, freqOff=%d\n",
- frame_id, subframe_id, slot_id, prach_port_id,
- pPrachCPConfig->filterIdx,
- pPrachCPConfig->startSymId,
- pPrachCPConfig->startPrbc,
- pPrachCPConfig->numPrbc,
- pPrachCPConfig->numSymbol,
- pPrachCPConfig->occassionsInPrachSlot,
- pPrachCPConfig->freqOffset);
-#endif
- timeOffset = pPrachCPConfig->timeOffset; //this is the CP value per 38.211 tab 6.3.3.1-1&2
- timeOffset = timeOffset >> nNumerology; //original number is Tc, convert to Ts based on mu
- if (pPrachCPConfig->startSymId > 0)
- {
- timeOffset += (pPrachCPConfig->startSymId * 2048) >> nNumerology;
- if ((slot_id == 0) || (slot_id == (SLOTNUM_PER_SUBFRAME >> 1)))
- timeOffset += 16;
- }
- params->dir = XRAN_DIR_UL;
- params->sectionType = XRAN_CP_SECTIONTYPE_3;
- params->hdr.filterIdx = pPrachCPConfig->filterIdx;
- params->hdr.frameId = frame_id;
- params->hdr.subframeId = subframe_id;
- params->hdr.slotId = slot_id;
- params->hdr.startSymId = pPrachCPConfig->startSymId;
- params->hdr.iqWidth = xran_get_conf_iqwidth(pHandle);
- params->hdr.compMeth = xran_get_conf_compmethod(pHandle);
- /* use timeOffset field for the CP length value for prach sequence */
- params->hdr.timeOffset = timeOffset;
- params->hdr.fftSize = xran_get_conf_fftsize(pHandle);
- params->hdr.scs = xran_get_conf_prach_scs(pHandle);
- params->hdr.cpLength = 0;
-
- nsection = 0;
- sect_geninfo[nsection].info.type = params->sectionType; // for database
- sect_geninfo[nsection].info.startSymId = params->hdr.startSymId; // for database
- sect_geninfo[nsection].info.iqWidth = params->hdr.iqWidth; // for database
- sect_geninfo[nsection].info.compMeth = params->hdr.compMeth; // for database
- sect_geninfo[nsection].info.id = xran_alloc_sectionid(pHandle, XRAN_DIR_UL, cc_id, prach_port_id, slot_id);
- sect_geninfo[nsection].info.rb = XRAN_RBIND_EVERY;
- sect_geninfo[nsection].info.symInc = XRAN_SYMBOLNUMBER_NOTINC;
- sect_geninfo[nsection].info.startPrbc = pPrachCPConfig->startPrbc;
- sect_geninfo[nsection].info.numPrbc = pPrachCPConfig->numPrbc,
- sect_geninfo[nsection].info.numSymbol = pPrachCPConfig->numSymbol*pPrachCPConfig->occassionsInPrachSlot;
- sect_geninfo[nsection].info.reMask = 0xfff;
- sect_geninfo[nsection].info.beamId = beam_id;
- sect_geninfo[nsection].info.freqOffset = pPrachCPConfig->freqOffset;
-
- pxran_lib_ctx->prach_last_symbol[cc_id] = sect_geninfo[nsection].info.startSymId + sect_geninfo[nsection].info.numSymbol - 1;
-
- sect_geninfo[nsection].info.ef = 0;
- sect_geninfo[nsection].exDataSize = 0;
-// sect_geninfo[nsection].exData = NULL;
- nsection++;
-
- params->numSections = nsection;
- params->sections = sect_geninfo;
-
- ret = xran_prepare_ctrl_pkt(mbuf, params, cc_id, prach_port_id, seq_id);
- if(ret < 0){
- print_err("Fail to build prach control packet - [%d:%d:%d]\n", frame_id, subframe_id, slot_id);
- rte_pktmbuf_free(mbuf);
- }
- return ret;
-}
-
-
-int process_ring(struct rte_ring *r)
-{
- assert(r);
-
- struct rte_mbuf *mbufs[MBUFS_CNT];
- int i;
- uint32_t remaining;
- uint64_t t1;
- const uint16_t dequeued = rte_ring_dequeue_burst(r, (void **)mbufs,
- RTE_DIM(mbufs), &remaining);
-
- if (!dequeued)
- return 0;
-
- t1 = MLogTick();
- for (i = 0; i < dequeued; ++i) {
- if (xran_ethdi_filter_packet(mbufs[i], 0) == MBUF_FREE)
- rte_pktmbuf_free(mbufs[i]);
- }
- MLogTask(PID_PROCESS_UP_PKT, t1, MLogTick());
-
- return remaining;
-}
-
-int32_t ring_processing_func(void)
-{
- struct xran_ethdi_ctx *const ctx = xran_ethdi_get_ctx();
- struct xran_device_ctx *const pxran_lib_ctx = xran_dev_get_ctx();
-
- rte_timer_manage();
-
- /* UP first */
- if (process_ring(ctx->rx_ring[ETHDI_UP_VF]))
- return 0;
- /* CP next */
- if (process_ring(ctx->rx_ring[ETHDI_CP_VF]))
- return 0;
-
- if (pxran_lib_ctx->bbdev_dec)
- pxran_lib_ctx->bbdev_dec();
-
- if (pxran_lib_ctx->bbdev_enc)
- pxran_lib_ctx->bbdev_enc();
-
- if (XRAN_STOPPED == xran_if_current_state)
- return -1;
-
- return 0;
-}
-
-int ring_processing_thread(void *args)
-{
- struct sched_param sched_param;
- int res = 0;
-
- printf("%s [CPU %2d] [PID: %6d]\n", __FUNCTION__, rte_lcore_id(), getpid());
- sched_param.sched_priority = XRAN_THREAD_DEFAULT_PRIO;
- if ((res = pthread_setschedparam(pthread_self(), SCHED_FIFO, &sched_param))){
- printf("priority is not changed: coreId = %d, result1 = %d\n",rte_lcore_id(), res);
- }
-
- for (;;)
- if(ring_processing_func() != 0)
- break;
-
- puts("Pkt processing thread finished.");
- return 0;
-}
-
+/******************************************************************************\r
+*\r
+* Copyright (c) 2019 Intel.\r
+*\r
+* Licensed under the Apache License, Version 2.0 (the "License");\r
+* you may not use this file except in compliance with the License.\r
+* You may obtain a copy of the License at\r
+*\r
+* http://www.apache.org/licenses/LICENSE-2.0\r
+*\r
+* Unless required by applicable law or agreed to in writing, software\r
+* distributed under the License is distributed on an "AS IS" BASIS,\r
+* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.\r
+* See the License for the specific language governing permissions and\r
+* limitations under the License.\r
+*\r
+*******************************************************************************/\r
+\r
+/**\r
+ * @brief XRAN layer common functionality for both O-DU and O-RU as well as C-plane and\r
+ * U-plane\r
+ * @file xran_common.c\r
+ * @ingroup group_source_xran\r
+ * @author Intel Corporation\r
+ **/\r
+\r
+#include <assert.h>\r
+#include <err.h>\r
+#include <arpa/inet.h>\r
+#include <sys/time.h>\r
+#include <time.h>\r
+\r
+#include "xran_common.h"\r
+#include "ethdi.h"\r
+#include "xran_pkt.h"\r
+#include "xran_pkt_up.h"\r
+#include "xran_up_api.h"\r
+#include "xran_lib_mlog_tasks_id.h"\r
+\r
+#include "../src/xran_printf.h"\r
+#include <rte_mbuf.h>\r
+#include "xran_mlog_lnx.h"\r
+\r
+#define MBUFS_CNT 16\r
+\r
+extern long interval_us;\r
+\r
+extern int xran_process_rx_sym(void *arg,\r
+ struct rte_mbuf *mbuf,\r
+ void *iq_data_start,\r
+ uint16_t size,\r
+ uint8_t CC_ID,\r
+ uint8_t Ant_ID,\r
+ uint8_t frame_id,\r
+ uint8_t subframe_id,\r
+ uint8_t slot_id,\r
+ uint8_t symb_id,\r
+ uint16_t num_prbu,\r
+ uint16_t start_prbu,\r
+ uint16_t sym_inc,\r
+ uint16_t rb,\r
+ uint16_t sect_id,\r
+ uint32_t *mb_free);\r
+\r
+\r
+extern int xran_process_prach_sym(void *arg,\r
+ struct rte_mbuf *mbuf,\r
+ void *iq_data_start,\r
+ uint16_t size,\r
+ uint8_t CC_ID,\r
+ uint8_t Ant_ID,\r
+ uint8_t frame_id,\r
+ uint8_t subframe_id,\r
+ uint8_t slot_id,\r
+ uint8_t symb_id,\r
+ uint16_t num_prbu,\r
+ uint16_t start_prbu,\r
+ uint16_t sym_inc,\r
+ uint16_t rb,\r
+ uint16_t sect_id,\r
+ uint32_t *mb_free);\r
+\r
+extern int32_t xran_process_srs_sym(void *arg,\r
+ struct rte_mbuf *mbuf,\r
+ void *iq_data_start,\r
+ uint16_t size,\r
+ uint8_t CC_ID,\r
+ uint8_t Ant_ID,\r
+ uint8_t frame_id,\r
+ uint8_t subframe_id,\r
+ uint8_t slot_id,\r
+ uint8_t symb_id,\r
+ uint16_t num_prbu,\r
+ uint16_t start_prbu,\r
+ uint16_t sym_inc,\r
+ uint16_t rb,\r
+ uint16_t sect_id,\r
+ uint32_t *mb_free);\r
+\r
+extern int32_t xran_pkt_validate(void *arg,\r
+ struct rte_mbuf *mbuf,\r
+ void *iq_data_start,\r
+ uint16_t size,\r
+ uint8_t CC_ID,\r
+ uint8_t Ant_ID,\r
+ uint8_t frame_id,\r
+ uint8_t subframe_id,\r
+ uint8_t slot_id,\r
+ uint8_t symb_id,\r
+ struct ecpri_seq_id *seq_id,\r
+ uint16_t num_prbu,\r
+ uint16_t start_prbu,\r
+ uint16_t sym_inc,\r
+ uint16_t rb,\r
+ uint16_t sect_id);\r
+\r
+long rx_counter = 0;\r
+long tx_counter = 0;\r
+long tx_bytes_counter = 0;\r
+long rx_bytes_counter = 0;\r
+long tx_bytes_per_sec = 0;\r
+long rx_bytes_per_sec = 0;\r
+\r
+\r
+struct cb_elem_entry *xran_create_cb(XranSymCallbackFn cb_fn, void *cb_data)\r
+{\r
+ struct cb_elem_entry * cb_elm = (struct cb_elem_entry *)malloc(sizeof(struct cb_elem_entry));\r
+ if(cb_elm){\r
+ cb_elm->pSymCallback = cb_fn;\r
+ cb_elm->pSymCallbackTag = cb_data;\r
+ }\r
+\r
+ return cb_elm;\r
+}\r
+\r
+int xran_destroy_cb(struct cb_elem_entry * cb_elm)\r
+{\r
+ if(cb_elm)\r
+ free(cb_elm);\r
+ return 0;\r
+}\r
+\r
+int process_mbuf(struct rte_mbuf *pkt)\r
+{\r
+ void *iq_samp_buf;\r
+ struct ecpri_seq_id seq;\r
+ static int symbol_total_bytes = 0;\r
+ int num_bytes = 0;\r
+ struct xran_device_ctx * p_x_ctx = xran_dev_get_ctx();\r
+\r
+ uint8_t CC_ID = 0;\r
+ uint8_t Ant_ID = 0;\r
+ uint8_t frame_id = 0;\r
+ uint8_t subframe_id = 0;\r
+ uint8_t slot_id = 0;\r
+ uint8_t symb_id = 0;\r
+\r
+ uint16_t num_prbu;\r
+ uint16_t start_prbu;\r
+ uint16_t sym_inc;\r
+ uint16_t rb;\r
+ uint16_t sect_id;\r
+\r
+ uint8_t compMeth = 0;\r
+ uint8_t iqWidth = 0;\r
+\r
+ void *pHandle = NULL;\r
+ uint8_t num_eAxc = xran_get_num_eAxc(pHandle);\r
+ int ret = MBUF_FREE;\r
+ uint32_t mb_free = 0;\r
+ int32_t valid_res = 0;\r
+ int expect_comp = (p_x_ctx->fh_cfg.ru_conf.compMeth != XRAN_COMPMETHOD_NONE);\r
+\r
+\r
+ if(p_x_ctx->xran2phy_mem_ready == 0)\r
+ return MBUF_FREE;\r
+\r
+ num_bytes = xran_extract_iq_samples(pkt,\r
+ &iq_samp_buf,\r
+ &CC_ID,\r
+ &Ant_ID,\r
+ &frame_id,\r
+ &subframe_id,\r
+ &slot_id,\r
+ &symb_id,\r
+ &seq,\r
+ &num_prbu,\r
+ &start_prbu,\r
+ &sym_inc,\r
+ &rb,\r
+ §_id,\r
+ expect_comp,\r
+ &compMeth,\r
+ &iqWidth);\r
+ if (num_bytes <= 0){\r
+ print_err("num_bytes is wrong [%d]\n", num_bytes);\r
+ return MBUF_FREE;\r
+ }\r
+\r
+ valid_res = xran_pkt_validate(NULL,\r
+ pkt,\r
+ iq_samp_buf,\r
+ num_bytes,\r
+ CC_ID,\r
+ Ant_ID,\r
+ frame_id,\r
+ subframe_id,\r
+ slot_id,\r
+ symb_id,\r
+ &seq,\r
+ num_prbu,\r
+ start_prbu,\r
+ sym_inc,\r
+ rb,\r
+ sect_id);\r
+\r
+ if(valid_res != 0) {\r
+ print_err("valid_res is wrong [%d] ant %u (%u : %u : %u : %u) seq %u num_bytes %d\n", valid_res, Ant_ID, frame_id, subframe_id, slot_id, symb_id, seq.seq_id, num_bytes);\r
+ return MBUF_FREE;\r
+ }\r
+\r
+ if (Ant_ID >= p_x_ctx->srs_cfg.eAxC_offset && p_x_ctx->fh_init.srsEnable) {\r
+ /* SRS packet has ruportid = 2*num_eAxc + ant_id */\r
+ Ant_ID -= p_x_ctx->srs_cfg.eAxC_offset;\r
+ symbol_total_bytes += num_bytes;\r
+\r
+ if (seq.e_bit == 1) {\r
+ print_dbg("Completed receiving symbol %d, size=%d bytes\n",\r
+ symb_id, symbol_total_bytes);\r
+\r
+ if (symbol_total_bytes) {\r
+ int16_t res = xran_process_srs_sym(NULL,\r
+ pkt,\r
+ iq_samp_buf,\r
+ num_bytes,\r
+ CC_ID,\r
+ Ant_ID,\r
+ frame_id,\r
+ subframe_id,\r
+ slot_id,\r
+ symb_id,\r
+ num_prbu,\r
+ start_prbu,\r
+ sym_inc,\r
+ rb,\r
+ sect_id,\r
+ &mb_free);\r
+\r
+ if(res == symbol_total_bytes) {\r
+ ret = mb_free;\r
+ } else {\r
+ print_err("res != symbol_total_bytes\n");\r
+ }\r
+ }\r
+ symbol_total_bytes = 0;\r
+ }\r
+ else {\r
+ print_dbg("Transport layer fragmentation (eCPRI) is not supported\n");\r
+ }\r
+\r
+ } else if (Ant_ID >= p_x_ctx->PrachCPConfig.eAxC_offset && p_x_ctx->fh_init.prachEnable) {\r
+ /* PRACH packet has ruportid = num_eAxc + ant_id */\r
+ Ant_ID -= p_x_ctx->PrachCPConfig.eAxC_offset;\r
+ symbol_total_bytes += num_bytes;\r
+ if (seq.e_bit == 1) {\r
+ print_dbg("Completed receiving PRACH symbol %d, size=%d bytes\n",\r
+ symb_id, num_bytes);\r
+\r
+ if (symbol_total_bytes) {\r
+ int16_t res = xran_process_prach_sym(NULL,\r
+ pkt,\r
+ iq_samp_buf,\r
+ num_bytes,\r
+ CC_ID,\r
+ Ant_ID,\r
+ frame_id,\r
+ subframe_id,\r
+ slot_id,\r
+ symb_id,\r
+ num_prbu,\r
+ start_prbu,\r
+ sym_inc,\r
+ rb,\r
+ sect_id,\r
+ &mb_free);\r
+ if(res == symbol_total_bytes) {\r
+ ret = mb_free;\r
+ } else {\r
+ print_err("res != symbol_total_bytes\n");\r
+ }\r
+ }\r
+ symbol_total_bytes = 0;\r
+ } else {\r
+ print_dbg("Transport layer fragmentation (eCPRI) is not supported\n");\r
+ }\r
+\r
+ } else { /* PUSCH */\r
+ symbol_total_bytes += num_bytes;\r
+\r
+ if (seq.e_bit == 1) {\r
+ print_dbg("Completed receiving symbol %d, size=%d bytes\n",\r
+ symb_id, symbol_total_bytes);\r
+\r
+ if (symbol_total_bytes) {\r
+ int res = xran_process_rx_sym(NULL,\r
+ pkt,\r
+ iq_samp_buf,\r
+ symbol_total_bytes,\r
+ CC_ID,\r
+ Ant_ID,\r
+ frame_id,\r
+ subframe_id,\r
+ slot_id,\r
+ symb_id,\r
+ num_prbu,\r
+ start_prbu,\r
+ sym_inc,\r
+ rb,\r
+ sect_id,\r
+ &mb_free);\r
+ if(res == symbol_total_bytes) {\r
+ ret = mb_free;\r
+ } else {\r
+ print_err("res != symbol_total_bytes\n");\r
+ }\r
+ }\r
+ symbol_total_bytes = 0;\r
+ } else {\r
+ print_dbg("Transport layer fragmentation (eCPRI) is not supported\n");\r
+ }\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+static int set_iq_bit_width(uint8_t iq_bit_width, struct data_section_compression_hdr *compr_hdr)\r
+{\r
+ if (iq_bit_width == MAX_IQ_BIT_WIDTH)\r
+ compr_hdr->ud_comp_hdr.ud_iq_width = (uint8_t) 0;\r
+ else\r
+ compr_hdr->ud_comp_hdr.ud_iq_width = iq_bit_width;\r
+\r
+ return 0;\r
+\r
+}\r
+\r
+/* Send a single 5G symbol over multiple packets */\r
+int32_t prepare_symbol_ex(enum xran_pkt_dir direction,\r
+ uint16_t section_id,\r
+ struct rte_mbuf *mb,\r
+ struct rb_map *data,\r
+ uint8_t compMeth,\r
+ uint8_t iqWidth,\r
+ const enum xran_input_byte_order iq_buf_byte_order,\r
+ uint8_t frame_id,\r
+ uint8_t subframe_id,\r
+ uint8_t slot_id,\r
+ uint8_t symbol_no,\r
+ int prb_start,\r
+ int prb_num,\r
+ uint8_t CC_ID,\r
+ uint8_t RU_Port_ID,\r
+ uint8_t seq_id,\r
+ uint32_t do_copy)\r
+{\r
+ int32_t n_bytes = ((prb_num == 0) ? MAX_N_FULLBAND_SC : prb_num) * N_SC_PER_PRB * sizeof(struct rb_map);\r
+\r
+ n_bytes = ((iqWidth == 0) || (iqWidth == 16)) ? n_bytes : ((3 * iqWidth + 1 ) * prb_num);\r
+\r
+ int32_t prep_bytes;\r
+\r
+ int16_t nPktSize = sizeof(struct ether_hdr) + sizeof(struct xran_ecpri_hdr) +\r
+ sizeof(struct radio_app_common_hdr)+ sizeof(struct data_section_hdr) + n_bytes;\r
+ uint32_t off;\r
+ struct xran_up_pkt_gen_params xp = { 0 };\r
+\r
+ if(compMeth != XRAN_COMPMETHOD_NONE)\r
+ nPktSize += sizeof(struct data_section_compression_hdr);\r
+\r
+ n_bytes = RTE_MIN(n_bytes, XRAN_MAX_MBUF_LEN);\r
+\r
+ /* radio app header */\r
+ xp.app_params.data_direction = direction;\r
+ xp.app_params.payl_ver = 1;\r
+ xp.app_params.filter_id = 0;\r
+ xp.app_params.frame_id = frame_id;\r
+ xp.app_params.sf_slot_sym.subframe_id = subframe_id;\r
+ xp.app_params.sf_slot_sym.slot_id = slot_id;\r
+ xp.app_params.sf_slot_sym.symb_id = symbol_no;\r
+\r
+ /* convert to network byte order */\r
+ xp.app_params.sf_slot_sym.value = rte_cpu_to_be_16(xp.app_params.sf_slot_sym.value);\r
+\r
+ xp.sec_hdr.fields.sect_id = section_id;\r
+ xp.sec_hdr.fields.num_prbu = (uint8_t)prb_num;\r
+ xp.sec_hdr.fields.start_prbu = (uint8_t)prb_start;\r
+ xp.sec_hdr.fields.sym_inc = 0;\r
+ xp.sec_hdr.fields.rb = 0;\r
+\r
+ /* compression */\r
+ xp.compr_hdr_param.ud_comp_hdr.ud_comp_meth = compMeth;\r
+ xp.compr_hdr_param.ud_comp_hdr.ud_iq_width = iqWidth;\r
+ xp.compr_hdr_param.rsrvd = 0;\r
+\r
+ /* network byte order */\r
+ xp.sec_hdr.fields.all_bits = rte_cpu_to_be_32(xp.sec_hdr.fields.all_bits);\r
+\r
+ if (mb == NULL){\r
+ MLogPrint(NULL);\r
+ errx(1, "out of mbufs after %d packets", 1);\r
+ }\r
+\r
+ prep_bytes = xran_prepare_iq_symbol_portion(mb,\r
+ data,\r
+ iq_buf_byte_order,\r
+ n_bytes,\r
+ &xp,\r
+ CC_ID,\r
+ RU_Port_ID,\r
+ seq_id,\r
+ do_copy);\r
+ if (prep_bytes <= 0)\r
+ errx(1, "failed preparing symbol");\r
+\r
+ rte_pktmbuf_pkt_len(mb) = nPktSize;\r
+ rte_pktmbuf_data_len(mb) = nPktSize;\r
+\r
+#ifdef DEBUG\r
+ printf("Symbol %2d prep_bytes (%d packets, %d bytes)\n", symbol_no, i, n_bytes);\r
+#endif\r
+\r
+ return prep_bytes;\r
+}\r
+\r
+/* Send a single 5G symbol over multiple packets */\r
+int send_symbol_ex(enum xran_pkt_dir direction,\r
+ uint16_t section_id,\r
+ struct rte_mbuf *mb,\r
+ struct rb_map *data,\r
+ const enum xran_input_byte_order iq_buf_byte_order,\r
+ uint8_t frame_id,\r
+ uint8_t subframe_id,\r
+ uint8_t slot_id,\r
+ uint8_t symbol_no,\r
+ int prb_start,\r
+ int prb_num,\r
+ uint8_t CC_ID,\r
+ uint8_t RU_Port_ID,\r
+ uint8_t seq_id)\r
+{\r
+ uint32_t do_copy = 0;\r
+ int32_t n_bytes = ((prb_num == 0) ? MAX_N_FULLBAND_SC : prb_num) * N_SC_PER_PRB * sizeof(struct rb_map);\r
+ struct xran_device_ctx *p_x_ctx = xran_dev_get_ctx();\r
+\r
+ if (mb == NULL){\r
+ char * pChar = NULL;\r
+ mb = xran_ethdi_mbuf_alloc(); /* will be freede by ETH */\r
+ if(mb == NULL){\r
+ MLogPrint(NULL);\r
+ errx(1, "out of mbufs after %d packets", 1);\r
+ }\r
+ pChar = rte_pktmbuf_append(mb, sizeof(struct xran_ecpri_hdr)+ sizeof(struct radio_app_common_hdr)+ sizeof(struct data_section_hdr) + n_bytes);\r
+ if(pChar == NULL){\r
+ MLogPrint(NULL);\r
+ errx(1, "incorrect mbuf size %d packets", 1);\r
+ }\r
+ pChar = rte_pktmbuf_prepend(mb, sizeof(struct ether_hdr));\r
+ if(pChar == NULL){\r
+ MLogPrint(NULL);\r
+ errx(1, "incorrect mbuf size %d packets", 1);\r
+ }\r
+ do_copy = 1; /* new mbuf hence copy of IQs */\r
+ }else {\r
+ rte_pktmbuf_refcnt_update(mb, 1); /* make sure eth won't free our mbuf */\r
+ }\r
+\r
+ int32_t sent = prepare_symbol_ex(direction,\r
+ section_id,\r
+ mb,\r
+ data,\r
+ 0,\r
+ 16,\r
+ iq_buf_byte_order,\r
+ frame_id,\r
+ subframe_id,\r
+ slot_id,\r
+ symbol_no,\r
+ prb_start,\r
+ prb_num,\r
+ CC_ID,\r
+ RU_Port_ID,\r
+ seq_id,\r
+ do_copy);\r
+\r
+ if(sent){\r
+ tx_counter++;\r
+ tx_bytes_counter += rte_pktmbuf_pkt_len(mb);\r
+ p_x_ctx->send_upmbuf2ring(mb, ETHER_TYPE_ECPRI);\r
+ } else {\r
+\r
+ }\r
+\r
+#ifdef DEBUG\r
+ printf("Symbol %2d sent (%d packets, %d bytes)\n", symbol_no, i, n_bytes);\r
+#endif\r
+\r
+ return sent;\r
+}\r
+\r
+int send_cpmsg(void *pHandle, struct rte_mbuf *mbuf,struct xran_cp_gen_params *params,\r
+ struct xran_section_gen_info *sect_geninfo, uint8_t cc_id, uint8_t ru_port_id, uint8_t seq_id)\r
+{\r
+ int ret = 0, nsection, i;\r
+ uint8_t frame_id = params->hdr.frameId;\r
+ uint8_t subframe_id = params->hdr.subframeId;\r
+ uint8_t slot_id = params->hdr.slotId;\r
+ uint8_t dir = params->dir;\r
+ struct xran_device_ctx *p_x_ctx = xran_dev_get_ctx();\r
+\r
+ nsection = params->numSections;\r
+\r
+ /* add in the ethernet header */\r
+ struct ether_hdr *const h = (void *)rte_pktmbuf_prepend(mbuf, sizeof(*h));\r
+ tx_counter++;\r
+ tx_bytes_counter += rte_pktmbuf_pkt_len(mbuf);\r
+ p_x_ctx->send_cpmbuf2ring(mbuf, ETHER_TYPE_ECPRI);\r
+ for(i=0; i<nsection; i++)\r
+ xran_cp_add_section_info(pHandle, dir, cc_id, ru_port_id,\r
+ (slot_id + subframe_id*SLOTNUM_PER_SUBFRAME)%XRAN_MAX_SECTIONDB_CTX,\r
+ §_geninfo[i].info);\r
+\r
+ return (ret);\r
+}\r
+\r
+int generate_cpmsg_dlul(void *pHandle, struct xran_cp_gen_params *params, struct xran_section_gen_info *sect_geninfo, struct rte_mbuf *mbuf,\r
+ enum xran_pkt_dir dir, uint8_t frame_id, uint8_t subframe_id, uint8_t slot_id,\r
+ uint8_t startsym, uint8_t numsym, uint16_t prb_start, uint16_t prb_num,int16_t iq_buffer_offset, int16_t iq_buffer_len,\r
+ uint16_t beam_id, uint8_t cc_id, uint8_t ru_port_id, uint8_t comp_method, uint8_t iqWidth, uint8_t seq_id, uint8_t symInc)\r
+{\r
+ int ret = 0, nsection, i, loc_sym;\r
+\r
+\r
+ params->dir = dir;\r
+ params->sectionType = XRAN_CP_SECTIONTYPE_1; // Most DL/UL Radio Channels\r
+ params->hdr.filterIdx = XRAN_FILTERINDEX_STANDARD;\r
+ params->hdr.frameId = frame_id;\r
+ params->hdr.subframeId = subframe_id;\r
+ params->hdr.slotId = slot_id;\r
+ params->hdr.startSymId = startsym; // start Symbol ID\r
+ params->hdr.iqWidth = iqWidth;\r
+ params->hdr.compMeth = comp_method;\r
+\r
+ nsection = 0;\r
+ sect_geninfo[nsection].info.type = params->sectionType; // for database\r
+ sect_geninfo[nsection].info.startSymId = params->hdr.startSymId; // for database\r
+ sect_geninfo[nsection].info.iqWidth = params->hdr.iqWidth; // for database\r
+ sect_geninfo[nsection].info.compMeth = params->hdr.compMeth; // for database\r
+ sect_geninfo[nsection].info.id = xran_alloc_sectionid(pHandle, dir, cc_id, ru_port_id, slot_id);\r
+ sect_geninfo[nsection].info.rb = XRAN_RBIND_EVERY;\r
+ sect_geninfo[nsection].info.symInc = symInc;\r
+ sect_geninfo[nsection].info.startPrbc = prb_start;\r
+ sect_geninfo[nsection].info.numPrbc = prb_num;\r
+ sect_geninfo[nsection].info.numSymbol = numsym;\r
+ sect_geninfo[nsection].info.reMask = 0xfff;\r
+ sect_geninfo[nsection].info.beamId = beam_id;\r
+\r
+ for (loc_sym = 0; loc_sym < XRAN_NUM_OF_SYMBOL_PER_SLOT; loc_sym++) {\r
+ sect_geninfo[0].info.sec_desc[loc_sym].iq_buffer_offset = iq_buffer_offset;\r
+ sect_geninfo[0].info.sec_desc[loc_sym].iq_buffer_len = iq_buffer_len;\r
+ }\r
+\r
+ sect_geninfo[nsection].info.ef = 0;\r
+ sect_geninfo[nsection].exDataSize = 0;\r
+// sect_geninfo[nsection].exData = NULL;\r
+ nsection++;\r
+\r
+ params->numSections = nsection;\r
+ params->sections = sect_geninfo;\r
+\r
+ if(unlikely(mbuf == NULL)) {\r
+ print_err("Alloc fail!\n");\r
+ return (-1);\r
+ }\r
+\r
+ ret = xran_prepare_ctrl_pkt(mbuf, params, cc_id, ru_port_id, seq_id);\r
+ if(ret < 0){\r
+ print_err("Fail to build control plane packet - [%d:%d:%d] dir=%d\n",\r
+ frame_id, subframe_id, slot_id, dir);\r
+ rte_pktmbuf_free(mbuf);\r
+ }\r
+\r
+ return (ret);\r
+}\r
+\r
+int generate_cpmsg_prach(void *pHandle, struct xran_cp_gen_params *params, struct xran_section_gen_info *sect_geninfo, struct rte_mbuf *mbuf, struct xran_device_ctx *pxran_lib_ctx,\r
+ uint8_t frame_id, uint8_t subframe_id, uint8_t slot_id,\r
+ uint16_t beam_id, uint8_t cc_id, uint8_t prach_port_id, uint8_t seq_id)\r
+{\r
+ int i, nsection, ret;\r
+ struct xran_prach_cp_config *pPrachCPConfig = &(pxran_lib_ctx->PrachCPConfig);\r
+ uint16_t timeOffset;\r
+ uint16_t nNumerology = pxran_lib_ctx->fh_cfg.frame_conf.nNumerology;\r
+\r
+ if(unlikely(mbuf == NULL)) {\r
+ print_err("Alloc fail!\n");\r
+ return (-1);\r
+ }\r
+#if 0\r
+ printf("%d:%d:%d:%d - filter=%d, startSym=%d[%d:%d], numSym=%d, occasions=%d, freqOff=%d\n",\r
+ frame_id, subframe_id, slot_id, prach_port_id,\r
+ pPrachCPConfig->filterIdx,\r
+ pPrachCPConfig->startSymId,\r
+ pPrachCPConfig->startPrbc,\r
+ pPrachCPConfig->numPrbc,\r
+ pPrachCPConfig->numSymbol,\r
+ pPrachCPConfig->occassionsInPrachSlot,\r
+ pPrachCPConfig->freqOffset);\r
+#endif\r
+ timeOffset = pPrachCPConfig->timeOffset; //this is the CP value per 38.211 tab 6.3.3.1-1&2\r
+ timeOffset = timeOffset >> nNumerology; //original number is Tc, convert to Ts based on mu\r
+ if (pPrachCPConfig->startSymId > 0)\r
+ {\r
+ timeOffset += (pPrachCPConfig->startSymId * 2048) >> nNumerology;\r
+ if ((slot_id == 0) || (slot_id == (SLOTNUM_PER_SUBFRAME >> 1)))\r
+ timeOffset += 16;\r
+ }\r
+ params->dir = XRAN_DIR_UL;\r
+ params->sectionType = XRAN_CP_SECTIONTYPE_3;\r
+ params->hdr.filterIdx = pPrachCPConfig->filterIdx;\r
+ params->hdr.frameId = frame_id;\r
+ params->hdr.subframeId = subframe_id;\r
+ params->hdr.slotId = slot_id;\r
+ params->hdr.startSymId = pPrachCPConfig->startSymId;\r
+ params->hdr.iqWidth = xran_get_conf_iqwidth(pHandle);\r
+ params->hdr.compMeth = xran_get_conf_compmethod(pHandle);\r
+ /* use timeOffset field for the CP length value for prach sequence */\r
+ params->hdr.timeOffset = timeOffset;\r
+ params->hdr.fftSize = xran_get_conf_fftsize(pHandle);\r
+ params->hdr.scs = xran_get_conf_prach_scs(pHandle);\r
+ params->hdr.cpLength = 0;\r
+\r
+ nsection = 0;\r
+ sect_geninfo[nsection].info.type = params->sectionType; // for database\r
+ sect_geninfo[nsection].info.startSymId = params->hdr.startSymId; // for database\r
+ sect_geninfo[nsection].info.iqWidth = params->hdr.iqWidth; // for database\r
+ sect_geninfo[nsection].info.compMeth = params->hdr.compMeth; // for database\r
+ sect_geninfo[nsection].info.id = xran_alloc_sectionid(pHandle, XRAN_DIR_UL, cc_id, prach_port_id, slot_id);\r
+ sect_geninfo[nsection].info.rb = XRAN_RBIND_EVERY;\r
+ sect_geninfo[nsection].info.symInc = XRAN_SYMBOLNUMBER_NOTINC;\r
+ sect_geninfo[nsection].info.startPrbc = pPrachCPConfig->startPrbc;\r
+ sect_geninfo[nsection].info.numPrbc = pPrachCPConfig->numPrbc,\r
+ sect_geninfo[nsection].info.numSymbol = pPrachCPConfig->numSymbol*pPrachCPConfig->occassionsInPrachSlot;\r
+ sect_geninfo[nsection].info.reMask = 0xfff;\r
+ sect_geninfo[nsection].info.beamId = beam_id;\r
+ sect_geninfo[nsection].info.freqOffset = pPrachCPConfig->freqOffset;\r
+\r
+ pxran_lib_ctx->prach_last_symbol[cc_id] = sect_geninfo[nsection].info.startSymId + sect_geninfo[nsection].info.numSymbol - 1;\r
+\r
+ sect_geninfo[nsection].info.ef = 0;\r
+ sect_geninfo[nsection].exDataSize = 0;\r
+// sect_geninfo[nsection].exData = NULL;\r
+ nsection++;\r
+\r
+ params->numSections = nsection;\r
+ params->sections = sect_geninfo;\r
+\r
+ ret = xran_prepare_ctrl_pkt(mbuf, params, cc_id, prach_port_id, seq_id);\r
+ if(ret < 0){\r
+ print_err("Fail to build prach control packet - [%d:%d:%d]\n", frame_id, subframe_id, slot_id);\r
+ rte_pktmbuf_free(mbuf);\r
+ }\r
+ return ret;\r
+}\r
+\r
+\r
+int process_ring(struct rte_ring *r)\r
+{\r
+ assert(r);\r
+\r
+ struct rte_mbuf *mbufs[MBUFS_CNT];\r
+ int i;\r
+ uint32_t remaining;\r
+ uint64_t t1;\r
+ const uint16_t dequeued = rte_ring_dequeue_burst(r, (void **)mbufs,\r
+ RTE_DIM(mbufs), &remaining);\r
+\r
+ if (!dequeued)\r
+ return 0;\r
+\r
+ t1 = MLogTick();\r
+ for (i = 0; i < dequeued; ++i) {\r
+ if (xran_ethdi_filter_packet(mbufs[i], 0) == MBUF_FREE)\r
+ rte_pktmbuf_free(mbufs[i]);\r
+ }\r
+ MLogTask(PID_PROCESS_UP_PKT, t1, MLogTick());\r
+\r
+ return remaining;\r
+}\r
+\r
+int32_t ring_processing_func(void)\r
+{\r
+ struct xran_ethdi_ctx *const ctx = xran_ethdi_get_ctx();\r
+ struct xran_device_ctx *const pxran_lib_ctx = xran_dev_get_ctx();\r
+ int16_t retPoll = 0;\r
+ uint64_t t1, t2;\r
+\r
+ rte_timer_manage();\r
+\r
+ /* UP first */\r
+ if (process_ring(ctx->rx_ring[ETHDI_UP_VF]))\r
+ return 0;\r
+ /* CP next */\r
+ if (process_ring(ctx->rx_ring[ETHDI_CP_VF]))\r
+ return 0;\r
+\r
+ if (pxran_lib_ctx->bbdev_dec) {\r
+ t1 = MLogTick();\r
+ retPoll = pxran_lib_ctx->bbdev_dec();\r
+ if (retPoll != -1)\r
+ {\r
+ t2 = MLogTick();\r
+ MLogTask(PID_XRAN_BBDEV_UL_POLL + retPoll, t1, t2);\r
+ }\r
+ }\r
+\r
+ if (pxran_lib_ctx->bbdev_enc) {\r
+ t1 = MLogTick();\r
+ retPoll = pxran_lib_ctx->bbdev_enc();\r
+ if (retPoll != -1)\r
+ {\r
+ t2 = MLogTick();\r
+ MLogTask(PID_XRAN_BBDEV_DL_POLL + retPoll, t1, t2);\r
+ }\r
+ }\r
+\r
+ if (XRAN_STOPPED == xran_if_current_state)\r
+ return -1;\r
+\r
+ return 0;\r
+}\r
+\r
+int ring_processing_thread(void *args)\r
+{\r
+ struct sched_param sched_param;\r
+ int res = 0;\r
+\r
+ printf("%s [CPU %2d] [PID: %6d]\n", __FUNCTION__, rte_lcore_id(), getpid());\r
+ sched_param.sched_priority = XRAN_THREAD_DEFAULT_PRIO;\r
+ if ((res = pthread_setschedparam(pthread_self(), SCHED_FIFO, &sched_param))){\r
+ printf("priority is not changed: coreId = %d, result1 = %d\n",rte_lcore_id(), res);\r
+ }\r
+\r
+ for (;;)\r
+ if(ring_processing_func() != 0)\r
+ break;\r
+\r
+ puts("Pkt processing thread finished.");\r
+ return 0;\r
+}\r
+\r
Code Review / o-du / phy.git / blobdiff