X-Git-Url: https://gerrit.o-ran-sc.org/r/gitweb?a=blobdiff_plain;f=fhi_lib%2Flib%2Fsrc%2Fxran_up_api.c;h=397853a8dd23db5f0ea3d482c1f603d154feb358;hb=2de97529a4c5a1922214ba0e6f0fb84cacbd0bc7;hp=a8c71f28986e97ba330994213ad5a81432968939;hpb=4745e5c88ba931c6d71cb6d8c681f76cf364eac5;p=o-du%2Fphy.git diff --git a/fhi_lib/lib/src/xran_up_api.c b/fhi_lib/lib/src/xran_up_api.c index a8c71f2..397853a 100644 --- a/fhi_lib/lib/src/xran_up_api.c +++ b/fhi_lib/lib/src/xran_up_api.c @@ -1,6 +1,6 @@ /****************************************************************************** * -* Copyright (c) 2019 Intel. +* Copyright (c) 2020 Intel. * * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. @@ -24,20 +24,16 @@ * @author Intel Corporation * **/ - -#include #include -#include "xran_fh_lls_cu.h" +#include +#include + +#include "xran_fh_o_du.h" #include "xran_transport.h" #include "xran_up_api.h" -#ifndef MLOG_ENABLED -#include "mlog_lnx_xRAN.h" -#else -#include "mlog_lnx.h" -#endif - -extern uint32_t xran_lib_ota_tti; - +#include "xran_printf.h" +#include "xran_mlog_lnx.h" +#include "xran_common.h" /** * @brief Builds eCPRI header in xRAN packet @@ -63,28 +59,30 @@ static int build_ecpri_hdr(struct rte_mbuf *mbuf, if (NULL == ecpri_hdr) return 1; - ecpri_hdr->ecpri_ver = XRAN_ECPRI_VER; - ecpri_hdr->ecpri_resv = 0; - ecpri_hdr->ecpri_concat = 0; - ecpri_hdr->ecpri_mesg_type = ECPRI_IQ_DATA; + ecpri_hdr->cmnhdr.data.data_num_1 = 0x0; + ecpri_hdr->cmnhdr.bits.ecpri_ver = XRAN_ECPRI_VER; + //ecpri_hdr->cmnhdr.bits.ecpri_resv = 0; + //ecpri_hdr->cmnhdr.bits.ecpri_concat = 0; + ecpri_hdr->cmnhdr.bits.ecpri_mesg_type = ECPRI_IQ_DATA; if (iq_data_offset + iq_samples_bytes_in_mbuf > iq_data_num_bytes) { - ecpri_hdr->ecpri_payl_size = + ecpri_hdr->cmnhdr.bits.ecpri_payl_size = rte_cpu_to_be_16(sizeof(struct radio_app_common_hdr) + sizeof(struct data_section_hdr) + - (iq_data_num_bytes - iq_data_offset)); - ecpri_hdr->ecpri_seq_id.e_bit = 1; /* last segment */ + (iq_data_num_bytes - iq_data_offset) + + XRAN_ECPRI_HDR_SZ); //xran_get_ecpri_hdr_size()); + ecpri_hdr->ecpri_seq_id.bits.e_bit = 1; /* last segment */ } else { - ecpri_hdr->ecpri_payl_size = + ecpri_hdr->cmnhdr.bits.ecpri_payl_size = rte_cpu_to_be_16(sizeof(struct radio_app_common_hdr) + sizeof(struct data_section_hdr) + - iq_samples_bytes_in_mbuf); - ecpri_hdr->ecpri_seq_id.e_bit = 0; + iq_samples_bytes_in_mbuf + + XRAN_ECPRI_HDR_SZ); //xran_get_ecpri_hdr_size()); + ecpri_hdr->ecpri_seq_id.bits.e_bit = 0; } -// ecpri_hdr->ecpri_xtc_id = 0; /* currently not used */ - ecpri_hdr->ecpri_seq_id.seq_id = 0; - ecpri_hdr->ecpri_seq_id.sub_seq_id = iq_data_offset / + ecpri_hdr->ecpri_xtc_id = 0; /* currently not used */ + ecpri_hdr->ecpri_seq_id.bits.sub_seq_id = iq_data_offset / iq_samples_bytes_in_mbuf; return 0; @@ -99,36 +97,46 @@ static int build_ecpri_hdr(struct rte_mbuf *mbuf, * @param CC_ID Component Carrier ID for ecpriRtcid/ecpriPcid * @param Ant_ID Antenna ID for ecpriRtcid/ecpriPcid * @param seq_id Message identifier for eCPRI message + * @param comp_meth Compression method * @return int int 0 on success, non zero on failure */ -static int xran_build_ecpri_hdr_ex(struct rte_mbuf *mbuf, +static inline int xran_build_ecpri_hdr_ex(struct rte_mbuf *mbuf, uint8_t ecpri_mesg_type, int payl_size, uint8_t CC_ID, uint8_t Ant_ID, - uint8_t seq_id) + uint8_t seq_id, + uint8_t comp_meth, + enum xran_comp_hdr_type staticEn) { - struct xran_ecpri_hdr *ecpri_hdr = (struct xran_ecpri_hdr *) - rte_pktmbuf_append(mbuf, sizeof(struct xran_ecpri_hdr)); - + char *pChar = rte_pktmbuf_mtod(mbuf, char*); + struct xran_ecpri_hdr *ecpri_hdr = (struct xran_ecpri_hdr *)(pChar + sizeof(struct rte_ether_hdr)); + uint16_t ecpri_payl_size = payl_size + + sizeof(struct data_section_hdr) + + sizeof(struct radio_app_common_hdr) + + XRAN_ECPRI_HDR_SZ; //xran_get_ecpri_hdr_size(); + if ((comp_meth != XRAN_COMPMETHOD_NONE)&&(staticEn == XRAN_COMP_HDR_TYPE_DYNAMIC)) + ecpri_payl_size += sizeof(struct data_section_compression_hdr); if (NULL == ecpri_hdr) return 1; - ecpri_hdr->ecpri_ver = XRAN_ECPRI_VER; - ecpri_hdr->ecpri_resv = 0; // should be zero - ecpri_hdr->ecpri_concat = 0; - ecpri_hdr->ecpri_mesg_type = ecpri_mesg_type; - ecpri_hdr->ecpri_payl_size = rte_cpu_to_be_16(payl_size - + sizeof(struct data_section_hdr)+sizeof(struct radio_app_common_hdr)); + ecpri_hdr->cmnhdr.data.data_num_1 = 0x0; + ecpri_hdr->cmnhdr.bits.ecpri_ver = XRAN_ECPRI_VER; + //ecpri_hdr->cmnhdr.bits.ecpri_resv = 0; // should be zero + //ecpri_hdr->cmnhdr.bits.ecpri_concat = 0; + ecpri_hdr->cmnhdr.bits.ecpri_mesg_type = ecpri_mesg_type; + ecpri_hdr->cmnhdr.bits.ecpri_payl_size = rte_cpu_to_be_16(ecpri_payl_size); /* one to one lls-CU to RU only and band sector is the same */ ecpri_hdr->ecpri_xtc_id = xran_compose_cid(0, 0, CC_ID, Ant_ID); - ecpri_hdr->ecpri_seq_id.seq_id = seq_id; + /* no transport layer fragmentation supported */ + ecpri_hdr->ecpri_seq_id.data.data_num_1 = 0x8000; + ecpri_hdr->ecpri_seq_id.bits.seq_id = seq_id; /* no transport layer fragmentation supported */ - ecpri_hdr->ecpri_seq_id.sub_seq_id = 0; - ecpri_hdr->ecpri_seq_id.e_bit = 1; + //ecpri_hdr->ecpri_seq_id.sub_seq_id = 0; + //ecpri_hdr->ecpri_seq_id.e_bit = 1; return 0; } @@ -142,17 +150,18 @@ static int xran_build_ecpri_hdr_ex(struct rte_mbuf *mbuf, * packet. * @return int 0 on success, non zero on failure */ -static int build_application_layer( +static inline int build_application_layer( struct rte_mbuf *mbuf, const struct radio_app_common_hdr *app_hdr_input) { - struct radio_app_common_hdr *app_hdr = (struct radio_app_common_hdr *) - rte_pktmbuf_append(mbuf, sizeof(struct radio_app_common_hdr)); + char *pChar = rte_pktmbuf_mtod(mbuf, char*); + struct radio_app_common_hdr *app_hdr = (struct radio_app_common_hdr *)(pChar + sizeof(struct rte_ether_hdr) + + sizeof (struct xran_ecpri_hdr)); if (NULL == app_hdr) return 1; - rte_memcpy(app_hdr, app_hdr_input, sizeof(struct radio_app_common_hdr)); + memcpy(app_hdr, app_hdr_input, sizeof(struct radio_app_common_hdr)); return 0; } @@ -164,17 +173,18 @@ static int build_application_layer( * @param sec_hdr Section header structure to be set in mbuf packet * @return int 0 on success, non zero on failure */ -static int build_section_hdr( +static inline int build_section_hdr( struct rte_mbuf *mbuf, const struct data_section_hdr *sec_hdr) { + char *pChar = rte_pktmbuf_mtod(mbuf, char*); struct data_section_hdr *section_hdr = (struct data_section_hdr *) - rte_pktmbuf_append(mbuf, sizeof(struct data_section_hdr)); + (pChar + sizeof(struct rte_ether_hdr) + sizeof (struct xran_ecpri_hdr) + sizeof(struct radio_app_common_hdr)); if (NULL == section_hdr) return 1; - rte_memcpy(section_hdr, sec_hdr, sizeof(struct data_section_hdr)); + memcpy(section_hdr, sec_hdr, sizeof(struct data_section_hdr)); return 0; } @@ -187,40 +197,41 @@ static int build_section_hdr( * @param iq_data_offset IQ data btyes already sent. * @return uint16_t Bytes that have been appended to the packet. */ -static uint16_t append_iq_samples_ex( +static inline uint16_t append_iq_samples_ex( struct rte_mbuf *mbuf, + int iq_sam_offset, const void *iq_data_start, - const uint32_t iq_data_num_bytes) + const uint32_t iq_data_num_bytes, + enum xran_input_byte_order iq_buf_byte_order, + uint32_t do_copy) { - uint16_t free_space_in_pkt = rte_pktmbuf_tailroom(mbuf); - - if(free_space_in_pkt >= iq_data_num_bytes){ + char *pChar = rte_pktmbuf_mtod(mbuf, char*); + void *iq_sam_buf; - void *iq_sam_buf = (void *)rte_pktmbuf_append(mbuf, iq_data_num_bytes); - if (iq_sam_buf == NULL) - return 0; -#ifdef XRAN_BYTE_ORDER_SWAP + iq_sam_buf = (pChar + iq_sam_offset); + if (iq_sam_buf == NULL){ + print_err("iq_sam_buf == NULL\n"); + return 0; + } + if(iq_buf_byte_order == XRAN_CPU_LE_BYTE_ORDER){ int idx = 0; - uint16_t *restrict psrc = (uint16_t *)iq_data_start; - uint16_t *restrict pdst = (uint16_t *)iq_sam_buf; + uint16_t *psrc = (uint16_t *)iq_data_start; + uint16_t *pdst = (uint16_t *)iq_sam_buf; /* CPU byte order (le) of IQ to network byte order (be) */ for (idx = 0; idx < iq_data_num_bytes/sizeof(int16_t); idx++){ pdst[idx] = (psrc[idx]>>8) | (psrc[idx]<<8); //rte_cpu_to_be_16(psrc[idx]); } -#else -#error xran spec is network byte order - /* for debug */ - rte_memcpy(iq_sam_buf, (uint8_t *)iq_data_start, iq_data_num_bytes); - -#endif + } - return iq_data_num_bytes; + else if(iq_buf_byte_order == XRAN_NE_BE_BYTE_ORDER){ + if(do_copy) { + memcpy(iq_sam_buf, (uint8_t *)iq_data_start, iq_data_num_bytes); + } } - return 0; + return iq_data_num_bytes; } - /** * @brief Function for appending IQ samples data to the mbuf. * @@ -250,7 +261,7 @@ static uint16_t append_iq_samples( void *iq_sam_buf = (void *)rte_pktmbuf_append(mbuf, iq_bytes_to_send); - rte_memcpy(iq_sam_buf, (uint8_t *)iq_data_start + iq_data_offset, + memcpy(iq_sam_buf, (uint8_t *)iq_data_start + iq_data_offset, iq_bytes_to_send); return iq_bytes_to_send; @@ -264,18 +275,19 @@ static uint16_t append_iq_samples( * to be set in mbuf packet * @return int 0 on success, non zero on failure */ -static int build_compression_hdr( +static inline int build_compression_hdr( struct rte_mbuf *mbuf, const struct data_section_compression_hdr *compr_hdr) { - struct data_section_compression_hdr *compression_hdr = - (struct data_section_compression_hdr *) - rte_pktmbuf_append(mbuf, sizeof(*compression_hdr)); + char *pChar = rte_pktmbuf_mtod(mbuf, char*); + struct data_section_compression_hdr *compression_hdr = (struct data_section_compression_hdr *) + (pChar + sizeof(struct rte_ether_hdr) + sizeof (struct xran_ecpri_hdr) + sizeof(struct radio_app_common_hdr) + + sizeof(struct data_section_hdr)); if (NULL == compression_hdr) return 1; - rte_memcpy(compression_hdr, compr_hdr, sizeof(*compression_hdr)); + memcpy(compression_hdr, compr_hdr, sizeof(*compression_hdr)); return 0; } @@ -295,57 +307,11 @@ static int append_comp_param(struct rte_mbuf *mbuf, union compression_params *ud if (NULL == compr_param) return 1; - rte_memcpy(compr_param, ud_comp_param, sizeof(union compression_params)); + memcpy(compr_param, ud_comp_param, sizeof(union compression_params)); return 0; } -/** - * @brief Function for starting preparion of IQ samples portions - * to be sent in xRAN packet - * - * @param mbuf Initialized rte_mbuf packet. - * @param iq_data_start Address of the first element in IQ data array. - * @param iq_data_num_bytes Size of the IQ data array. - * @param iq_data_offset IQ data bytes already sent. - * @param alignment Size of IQ data alignment. - * @param pkt_gen_params Struct with parameters used for building packet - * @return int Number of bytes that have been appended - to the packet within a single data section appended. - */ -int xran_prepare_iq_symbol_portion( - struct rte_mbuf *mbuf, - const void *iq_data_start, - const uint32_t iq_data_num_bytes, - uint32_t *iq_data_offset, - uint8_t alignment, - struct xran_up_pkt_gen_params *params, - int sub_seq_id) -{ - uint8_t i = 0; - uint16_t iq_sam_bytes_sent = 0; - - if (build_ecpri_hdr(mbuf, iq_data_num_bytes, *iq_data_offset, alignment)) - return 0; - - if (build_application_layer(mbuf, &(params->app_params)) != 0) - return 0; - - if (build_section_hdr(mbuf, &(params->sec_hdr)) != 0) - return 0; - - if(params->compr_hdr_param.ud_comp_hdr.ud_comp_meth != XRAN_COMPMETHOD_NONE) { - if (build_compression_hdr(mbuf, &(params->compr_hdr_param)) !=0) - return 0; - - if(append_comp_param(mbuf, &(params->compr_param)) !=0) - return 0; - } - - return append_iq_samples(mbuf, iq_data_start, iq_data_num_bytes, - (*iq_data_offset), alignment); -} - /** * @brief Function for extracting all IQ samples from xRAN packet * holding a single data section @@ -355,7 +321,7 @@ int xran_prepare_iq_symbol_portion( * @return int Size of remaining mbuf filled with IQ samples zero on failure */ -int xran_extract_iq_samples(struct rte_mbuf *mbuf, +int32_t xran_extract_iq_samples(struct rte_mbuf *mbuf, void **iq_data_start, uint8_t *CC_ID, uint8_t *Ant_ID, @@ -363,10 +329,21 @@ int xran_extract_iq_samples(struct rte_mbuf *mbuf, uint8_t *subframe_id, uint8_t *slot_id, uint8_t *symb_id, - struct ecpri_seq_id *seq_id) + union ecpri_seq_id *seq_id, + uint16_t *num_prbu, + uint16_t *start_prbu, + uint16_t *sym_inc, + uint16_t *rb, + uint16_t *sect_id, + int8_t expect_comp, + enum xran_comp_hdr_type staticComp, + uint8_t *compMeth, + uint8_t *iqWidth) { +#if XRAN_MLOG_VAR uint32_t mlogVar[10]; uint32_t mlogVarCnt = 0; +#endif struct xran_eaxc_info result; if (NULL == mbuf) @@ -382,10 +359,13 @@ int xran_extract_iq_samples(struct rte_mbuf *mbuf, if (seq_id) *seq_id = ecpri_hdr->ecpri_seq_id; + if(*CC_ID == 0xFF && *Ant_ID == 0xFF) { + /* if not classified vi HW Queue parse packet */ xran_decompose_cid((uint16_t)ecpri_hdr->ecpri_xtc_id, &result); *CC_ID = result.ccId; *Ant_ID = result.ruPortId; + } /* Process radio header. */ struct radio_app_common_hdr *radio_hdr = @@ -402,40 +382,68 @@ int xran_extract_iq_samples(struct rte_mbuf *mbuf, *subframe_id = radio_hdr->sf_slot_sym.subframe_id; if (slot_id) - *slot_id = radio_hdr->sf_slot_sym.slot_id; + *slot_id = xran_slotid_convert(radio_hdr->sf_slot_sym.slot_id, 1); if (symb_id) *symb_id = radio_hdr->sf_slot_sym.symb_id; /* Process data section hdr */ - const struct data_section_hdr *data_hdr = + struct data_section_hdr *data_hdr = (void *)rte_pktmbuf_adj(mbuf, sizeof(*radio_hdr)); if (data_hdr == NULL) return 0; /* packet too short */ -#ifdef COMPRESSION - const struct data_section_compression_hdr *data_compr_hdr = - (void *) rte_pktmbuf_adj(mbuf, sizeof(*data_hdr)); + /* cpu byte order */ + data_hdr->fields.all_bits = rte_be_to_cpu_32(data_hdr->fields.all_bits); - const uint8_t *compr_param = - (void *)rte_pktmbuf_adj(mbuf, sizeof(*data_compr_hdr)); + *num_prbu = data_hdr->fields.num_prbu; + *start_prbu = data_hdr->fields.start_prbu; + *sym_inc = data_hdr->fields.sym_inc; + *rb = data_hdr->fields.rb; + *sect_id = data_hdr->fields.sect_id; - *iq_data_start = rte_pktmbuf_adj(mbuf, sizeof(*compr_param)); + if(expect_comp) { + const struct data_section_compression_hdr *data_compr_hdr; + if (staticComp != XRAN_COMP_HDR_TYPE_STATIC) + { + data_compr_hdr = + (void *) rte_pktmbuf_adj(mbuf, sizeof(*data_hdr)); + + if (data_compr_hdr == NULL) + return 0; + + *compMeth = data_compr_hdr->ud_comp_hdr.ud_comp_meth; + *iqWidth = data_compr_hdr->ud_comp_hdr.ud_iq_width; + const uint8_t *compr_param = + (void *)rte_pktmbuf_adj(mbuf, sizeof(*data_compr_hdr)); + + *iq_data_start = (void *)compr_param; /*rte_pktmbuf_adj(mbuf, sizeof(*compr_param))*/; + } + else + { + *iq_data_start = rte_pktmbuf_adj(mbuf, sizeof(*data_hdr)); + } + + + } else { + *iq_data_start = rte_pktmbuf_adj(mbuf, sizeof(*data_hdr)); + } -#else - *iq_data_start = rte_pktmbuf_adj(mbuf, sizeof(*data_hdr)); -#endif if (*iq_data_start == NULL) return 0; - mlogVar[mlogVarCnt++] = 0xBBBBBBB; - mlogVar[mlogVarCnt++] = xran_lib_ota_tti; +#if XRAN_MLOG_VAR + mlogVar[mlogVarCnt++] = 0xBBBBBBBB; mlogVar[mlogVarCnt++] = radio_hdr->frame_id; mlogVar[mlogVarCnt++] = radio_hdr->sf_slot_sym.subframe_id; mlogVar[mlogVarCnt++] = radio_hdr->sf_slot_sym.slot_id; mlogVar[mlogVarCnt++] = radio_hdr->sf_slot_sym.symb_id; + mlogVar[mlogVarCnt++] = data_hdr->fields.sect_id; + mlogVar[mlogVarCnt++] = data_hdr->fields.start_prbu; + mlogVar[mlogVarCnt++] = data_hdr->fields.num_prbu; mlogVar[mlogVarCnt++] = rte_pktmbuf_pkt_len(mbuf); MLogAddVariables(mlogVarCnt, mlogVar, MLogTick()); +#endif return rte_pktmbuf_pkt_len(mbuf); } @@ -453,29 +461,51 @@ int xran_extract_iq_samples(struct rte_mbuf *mbuf, * @return int Number of bytes that have been appended to the packet within all appended sections. */ -int xran_prepare_iq_symbol_portion_no_comp( +int32_t xran_prepare_iq_symbol_portion( struct rte_mbuf *mbuf, const void *iq_data_start, + const enum xran_input_byte_order iq_buf_byte_order, const uint32_t iq_data_num_bytes, - struct xran_up_pkt_gen_no_compression_params *params, + struct xran_up_pkt_gen_params *params, uint8_t CC_ID, uint8_t Ant_ID, - uint8_t seq_id) + uint8_t seq_id, + enum xran_comp_hdr_type staticEn, + uint32_t do_copy) { + int offset; + if(xran_build_ecpri_hdr_ex(mbuf, ECPRI_IQ_DATA, iq_data_num_bytes, CC_ID, Ant_ID, - seq_id)) + seq_id, + params->compr_hdr_param.ud_comp_hdr.ud_comp_meth, + staticEn)){ + print_err("xran_build_ecpri_hdr_ex return 0\n"); return 0; + } - if (build_application_layer(mbuf, &(params->app_params)) != 0) + if (build_application_layer(mbuf, &(params->app_params)) != 0){ + print_err("build_application_layer return != 0\n"); return 0; + } - if (build_section_hdr(mbuf, &(params->sec_hdr)) != 0) + if (build_section_hdr(mbuf, &(params->sec_hdr)) != 0){ + print_err("build_section_hdr return != 0\n"); return 0; + } - return append_iq_samples_ex(mbuf, iq_data_start, iq_data_num_bytes); + offset = sizeof(struct rte_ether_hdr) + + sizeof(struct xran_ecpri_hdr) + + sizeof(struct radio_app_common_hdr) + + sizeof(struct data_section_hdr); + if ((params->compr_hdr_param.ud_comp_hdr.ud_comp_meth != XRAN_COMPMETHOD_NONE)&&(staticEn == XRAN_COMP_HDR_TYPE_DYNAMIC)) { + if (build_compression_hdr(mbuf, &(params->compr_hdr_param)) !=0) + return 0; + offset += sizeof(struct data_section_compression_hdr); + } + return (do_copy ? append_iq_samples_ex(mbuf, offset, iq_data_start, iq_data_num_bytes, iq_buf_byte_order, do_copy) : iq_data_num_bytes); }