diff --git a/test/case46/src/testcase46.c b/test/case46/src/testcase46.c index 1ffcb2d..bd891d6 100644 --- a/test/case46/src/testcase46.c +++ b/test/case46/src/testcase46.c @@ -330,7 +330,7 @@ int32_t test_case(uint32_t argc, int32_t* argvp) int32_t ret; uint8_t scs_id = 1; // NR 30K // 0; // NR 15K uint8_t cell_id = 0; //0xFF; - uint32_t run_ape = 0x1; // 0; + uint32_t run_ape = 0x11; // 0; uint8_t frame_type = 0; // fdd cell_setup_simulation(scs_id, cell_id, run_ape, frame_type); diff --git a/test/case52/src/testcase52.c b/test/case52/src/testcase52.c index 7741435..dbf6c8d 100755 --- a/test/case52/src/testcase52.c +++ b/test/case52/src/testcase52.c @@ -8,9 +8,10 @@ // Last Modified : // ----------------------------------------------------------------- // Description: -// (Aut@qieYuan_2025.05.04) 新增数据接收与发送 收发聚合无多线程 -// ----------------------------------------------------------------- -#define _GNU_SOURCE +// +// +// -FHDR------------------------------------------------------------ + #include #include #include @@ -34,340 +35,12 @@ #include "ospSwTimer.h" #include "stc_drv_api.h" -//---------------------------------------------------- -// Last modified time: 2025.05.03 -// Last Version: V1.0 -//---------------------------------------------------- - -#include // udp -#include // 绑定CPU -#include // thread -#include // POSIX api -#include // open() -#include // MMAP -#include -//---------------------------------------------------- - - -#define SERVER_IP_CASE52 "172.29.118.76" // IP -#define SERVER_PORT_CASE52 28864 // 端口 -#define BUFFER_SIZE_CASE52 16016 // 用户缓冲区 -int sockfd_case52; // 句柄 -struct sockaddr_in server_addr_case52; // 套接字 - -#define MAP_SIZE_CASE52 1028096 // -#define MAP_SIZE_ST_CASE52 4096 // 4096 -#define CTRL_BUFFER_SIZE 1024 -// #define MAP_ADDR_TX_BASE_CASE52 0x84C00000 // TX 数据位起始 -#define UCP4008_CTRL_PHYSADDR 0x82000000 // 接收开关 -#define MAP_ADDR_RX_BASE_CASE52 0x85001000 // RX 数据位起始 -#define MAP_ADDR_RXFLAG_DATA_CASE52 0x85000000 // wr 计数起始位 - -int mem_fd_case52; // 统一文件描述符 -ssize_t send_len; -// void *map_base_tx_case52; // TX映射地址 20块 -void *ucp4008_ctrl_mmap_base; // 接受开关映射地址 -void *map_base_rx_case52; // RX映射地址 8块 -void *map_base_rxf_case52; // wr 计数映射地址 -uint8_t w_idx, r_idx; // RX 信号 -uint16_t udp_data_buffer[8008]; -volatile uint32_t *mapped_addr; -//---------------------------------------------------- - -volatile uint32_t slot_ind_flag = 0; +uint32_t slot_ind_flag = 0; uint32_t slot_ind_time_flag = 0; -uint32_t g_slot_time = 0; +uint32_t g_slot_time = 0; uint32_t gu32_value = 0; uint32_t gu32_tick_receive_ctrl = 0; uint32_t gu32_tick_from_tx_ctrl = 0; -uint8_t ucp_print_err_f = 0; - -// Description: -// 初始化 → 读文件发送 → APE → 接受数据 → 发送上位机 -void *handleUdpTransmission(void *arg) -{ - (void)arg; - printf("[socket]:/************ linux_UDP ***************/\n"); - if ((sockfd_case52 = socket(AF_INET, SOCK_DGRAM, 0)) < 0) - { - printf("[socket]:socket error!\n"); - perror("socket creation failed\n"); - exit(EXIT_FAILURE); - } - server_addr_case52.sin_family = AF_INET; // IPv4 - server_addr_case52.sin_port = htons(SERVER_PORT_CASE52); // 端口转换 - server_addr_case52.sin_addr.s_addr = inet_addr(SERVER_IP_CASE52); // IP转换 - // int flags = fcntl(sockfd_case52, F_GETFL, 0); - // fcntl(sockfd_case52, F_SETFL, flags | O_NONBLOCK); - // char *message = "test"; - // sendto(sockfd_case52, message, strlen(message), 0, - // (struct sockaddr *)&server_addr_case52, sizeof(server_addr_case52)); - // printf("[sendto]:%s\n", message); - - printf("[socket]:UDP ready\n"); - // mmap - /************************************************************************************** */ - printf("[socket]: Opening /dev/mem for all mappings\n"); - mem_fd_case52 = open("/dev/mem", O_RDWR | O_SYNC); - if (mem_fd_case52 == -1) { - printf("[mmap]: Failed to open /dev/mem !!!!\n"); - perror("open /dev/mem"); - exit(EXIT_FAILURE); - } - - // TX - // printf("[mmap]:/*************** mmap_tx ***************/\n"); - // map_base_tx_case52 = mmap(NULL, MAP_SIZE_CASE52, PROT_READ | PROT_WRITE, MAP_SHARED, mem_fd_case52, MAP_ADDR_TX_BASE_CASE52); - // if (map_base_tx_case52 == MAP_FAILED) { - // printf("[mmap]: tx mapping failed!\n"); - // perror("mmap tx error"); - // close(mem_fd_case52); - // exit(EXIT_FAILURE); - // } - // printf("[mmap]: tx ready\n"); - - // RX - printf("[mmap]:/*************** mmap_rx ***************/\n"); - map_base_rx_case52 = mmap(NULL, MAP_SIZE_CASE52, PROT_READ | PROT_WRITE, MAP_SHARED, mem_fd_case52, MAP_ADDR_RX_BASE_CASE52); - if (map_base_rx_case52 == MAP_FAILED) { - printf("[mmap]: rx mapping failed!\n"); - perror("mmap rx error"); - // munmap(map_base_tx_case52, MAP_SIZE_CASE52); // clean TX - close(mem_fd_case52); - exit(EXIT_FAILURE); - } - printf("[mmap]: rx ready\n"); - - // RX_FLAG - printf("[mmap]:/************** rx_flag ***************/\n"); - map_base_rxf_case52 = mmap(NULL, MAP_SIZE_ST_CASE52, PROT_READ | PROT_WRITE, MAP_SHARED, mem_fd_case52, MAP_ADDR_RXFLAG_DATA_CASE52); - if (map_base_rxf_case52 == MAP_FAILED) { - printf("[mmap]: RX_FLAG mapping failed!\n"); - perror("mmap RX_FLAG error"); - // munmap(map_base_tx_case52, MAP_SIZE_CASE52); // clean TX - munmap(map_base_rx_case52, MAP_SIZE_CASE52); // clean RX - close(mem_fd_case52); - exit(EXIT_FAILURE); - } - printf("[mmap]: wr_idx ready\n"); - - // ucp4008_ctrl - ucp4008_ctrl_mmap_base = mmap( - NULL, - MAP_SIZE_ST_CASE52, - PROT_READ | PROT_WRITE, - MAP_SHARED, - mem_fd_case52, - UCP4008_CTRL_PHYSADDR - ); - if (ucp4008_ctrl_mmap_base == MAP_FAILED) { - printf("[mmap]: ucp4008_ctrl mapping failed!\n"); - perror("ucp4008_ctrl error"); - close(mem_fd_case52); - exit(EXIT_FAILURE); - } - // udp_ctrl - char *ctrl_message = "ready"; - sendto(sockfd_case52, ctrl_message, strlen(ctrl_message), 0, - (struct sockaddr *)&server_addr_case52, sizeof(server_addr_case52)); - printf("[sendto]:%s\n", ctrl_message); - - char ctrl_buffer[CTRL_BUFFER_SIZE]; - struct sockaddr_in from_addr; - socklen_t from_addr_len = sizeof(from_addr); - int recv_len; - int strcmp_flag = 1; - - while (strcmp_flag) - { - recv_len = recvfrom(sockfd_case52, ctrl_buffer, CTRL_BUFFER_SIZE, 0, - (struct sockaddr *)&from_addr, &from_addr_len); - if (recv_len < 0) { - printf("[recv_len]:recv_len < 0\n"); - } - - ctrl_buffer[recv_len] = '\0'; - printf("[recvfrom]:%s\n", ctrl_buffer); - if (strcmp(ctrl_buffer, "ok") == 0) { - //usleep(1000000); - printf("[mmap]:wr...\n"); - mapped_addr = (volatile uint32_t *)ucp4008_ctrl_mmap_base; - *mapped_addr = 0xA5A55A5A; - printf("[mmap]: wr 0xA5A55A5A done :) \n"); - strcmp_flag = 0; - } else { - printf("[recvfrom]:strcmp no ok!\n"); - } - } - - // 初始化消费者索引 - /************************************************************************************** */ - r_idx = 0; - printf("[store]: r_idx ready == 0\n"); - // rd txt - /************************************************************************************** */ - // printf("[rd txt]:/************** FILE ***************/\n"); - // FILE *data_txt_fd; - // //const char *path = "/path/to/data.txt"; - // data_txt_fd = fopen("/opt/data.txt","r"); // 此处应为绝对路径 - // if (data_txt_fd == NULL) - // { - // printf("[txt_fd]:data_txt_fd error! :(\n"); - // perror("open txt error!"); - // exit(EXIT_FAILURE); - // } - // uint16_t txt_buffer[65535] = {0}; - // for (int txt_num = 0; txt_num < 65535; txt_num++) - // { - // if (fscanf(data_txt_fd, "%hu", &txt_buffer[txt_num]) != 1) - // { - // fprintf(stderr, "[Error] Failed to read number at position %d :(\n", txt_num); - // fclose(data_txt_fd); - // exit(EXIT_FAILURE); - // } - // } - // fclose(data_txt_fd); - // printf("[rd txt]: txt_buffer ready\n"); - /************************************************************************************** */ - // printf("[tx]:wr...\n"); - // size_t wr_cunt = 0; - - // printf("[tx]:先写入10块数据...\n"); - // size_t data_index = 0; - // for (int ready_num = 0; ready_num < 10; ready_num++) - // { - // for (int arr_cunt = 0; arr_cunt < 8008; ++arr_cunt) { - // // 偏移 - // size_t tx_data_offset = wr_cunt * 16016 + arr_cunt * 2; - // // cpy - // memcpy((char*)map_base_tx_case52 + tx_data_offset, &txt_buffer[data_index], 2);//65536 - // // 更新数据索引 - // data_index = (data_index + 1) % 65535; - // } - // // 更新地址块索引 - // wr_cunt = (wr_cunt + 1) % 20; - // } - // printf("[tx]:初始10块写入完成，当前地址块=%zu，数据索引=%zu\n", wr_cunt, data_index); - // printf("[while(1)]:/*************************************/\n"); - // size_t current_pos = 0; - // uint16_t value_mem = 0; - - - - - - - uint8_t block_n = 0; - uint8_t cut_i = 0; - while (1) - { - // usleep(10); - if (1 == slot_ind_flag) - { - - slot_ind_flag = 0; - /************************************************************************************** */ - // wr 16016*20(byte),一次while循环会写入 1/20 的数据，触发条件为slot_ind_flag - // current_pos = wr_cunt * 16016; - - // for (int i = 0; i < 8008; ++i) { - // value_mem = txt_buffer[(data_index + i) % 65535]; - // memcpy((char*)map_base_tx_case52 + current_pos + i*2, &value_mem, 2); - // } - // data_index = (data_index + 8008) % 65535; - // wr_cunt = (wr_cunt + 1) % 20; - /************************************************************************************** */ - // 更新生产者计数 - w_idx = __atomic_load_n( - (volatile uint8_t *)(map_base_rxf_case52 + 0), - __ATOMIC_ACQUIRE - ); - // w_idx = *((volatile uint8_t *)map_base_rxf_case52); - /************************************************************************************** */ - // 尝试读取 - block_n = 0; - if (w_idx == r_idx){ - printf("[while(p)]: w_idx = %hhu, r_idx = %hhu\n", w_idx, r_idx); - printf("[while(p)]: pass\n"); - } else { - if (r_idx < w_idx) { - printf("[while(r)]: w_idx = %hhu, r_idx = %hhu\n", w_idx, r_idx); - printf("[while(r)]: r_idx < w_idx\n"); - block_n = w_idx - r_idx; - for (cut_i = 0; cut_i < block_n; cut_i++) - { - memcpy(udp_data_buffer, - (char*)map_base_rx_case52 + r_idx * 16016, - 16016); - // 发送数据到上位机 - send_len = sendto( - sockfd_case52, - udp_data_buffer, - sizeof(udp_data_buffer), - 0, - (struct sockaddr*)&server_addr_case52, - sizeof(server_addr_case52) - ); - if (send_len == -1) { - perror("sendto error"); - continue; - } - r_idx ++ ; - } - // 更新r_idx,如果到头 - r_idx = r_idx % 8; - } else { //r_idx > w_idx - printf("[while(w)]: w_idx = %hhu, r_idx = %hhu\n", w_idx, r_idx); - printf("[while(w)]: w_idx < r_idx\n"); - // 取完末尾 - for (cut_i = 0; cut_i < (8-r_idx); cut_i++) - { - memcpy(udp_data_buffer, - (char*)map_base_rx_case52 + (r_idx+cut_i) * 16016, - 16016); - // 发送数据到上位机 - send_len = sendto( - sockfd_case52, - udp_data_buffer, - sizeof(udp_data_buffer), - 0, - (struct sockaddr*)&server_addr_case52, - sizeof(server_addr_case52) - ); - if (send_len == -1) { - perror("sendto error"); - continue; - } - } - r_idx = 0; - // 取从头开始 - for (cut_i = 0; cut_i < w_idx; cut_i++) - { - memcpy(udp_data_buffer, - (char*)map_base_rx_case52 + cut_i * 16016, - 16016); - // 发送数据到上位机 - send_len = sendto( - sockfd_case52, - udp_data_buffer, - sizeof(udp_data_buffer), - 0, - (struct sockaddr*)&server_addr_case52, - sizeof(server_addr_case52) - ); - if (send_len == -1) { - perror("sendto error"); - continue; - } - r_idx ++; - } - r_idx = r_idx % 8; - } - } - } - } - return NULL; -} uint32_t rx_callback_data(const char* buf,uint32_t payloadSize) { @@ -378,7 +51,6 @@ uint32_t rx_callback_data(const char* buf,uint32_t payloadSize) uint32_t tick_from_tx_ctrl = *(uint32_t *)(buf+4); - // printf("[rx_callback_data]:slot_ind_flag == 1 \n"); slot_ind_flag = 1; gu32_value = value; gu32_tick_receive_ctrl = stc_cnt; @@ -398,10 +70,9 @@ uint32_t rx_callback_data(const char* buf,uint32_t payloadSize) if ((diff > 520000) || (diff < 480000)) { - if(ucp_print_err_f == 1){ - UCP_PRINT_ERROR("qNO[%d],sfn[%d],slot[%d],diff[%d]",UCP4008_TRAFFIC_NR_eMBB_DATA,sfn,slot,diff); - } + UCP_PRINT_ERROR("qNO[%d],sfn[%d],slot[%d],diff[%d]",UCP4008_TRAFFIC_NR_eMBB_DATA,sfn,slot,diff); } + return payloadSize; } @@ -655,99 +326,81 @@ int32_t test_case(uint32_t argc, int32_t* argvp) UCP_PRINT_DEBUG("start transfering message."); - // uint32_t size = 100; - // char* buf; - // uint32_t availableSize,offset; - // uint8_t* ptr; + uint32_t size = 100; + char* buf; + uint32_t availableSize,offset; + uint8_t* ptr; - // uint16_t cu_flag = C_PLANE; - // HandleId_t handler; - // handler.port_id = 0; - // handler.inst_id = 0; - // handler.type_id = CU_SPLIT; + uint16_t cu_flag = C_PLANE; + HandleId_t handler; + handler.port_id = 0; + handler.inst_id = 0; + handler.type_id = CU_SPLIT; - // int32_t ret; + int32_t ret; uint8_t scs_id = 1; // NR 30K // 0; // NR 15K uint8_t cell_id = 0; //0xFF; - uint32_t run_ape = 0x11; //0x11 - // uint32_t run_ape = 0x1; // 0; + uint32_t run_ape = 0x11; // 0; uint8_t frame_type = 0; // fdd cell_setup_simulation(scs_id, cell_id, run_ape, frame_type); + //osp_set_task_orx(6, 95); - /********************************************************* */ - pthread_attr_t udp_attr; // 定义线程包 - pthread_attr_init(&udp_attr); // 包初始化 - - cpu_set_t udp_cpuset; // CPU集合 - CPU_ZERO(&udp_cpuset); // 集合初始化 - CPU_SET(2, &udp_cpuset); // 选择核心2 - pthread_attr_setaffinity_np(&udp_attr, sizeof(udp_cpuset), &udp_cpuset); // 绑定 - - - pthread_t thread_udp; - if (pthread_create(&thread_udp, &udp_attr, handleUdpTransmission, NULL) != 0) - { - printf("[SOCKET]:thread error!\n"); - perror("pthread_create"); - pthread_attr_destroy(&udp_attr); - exit(EXIT_FAILURE); - } - pthread_attr_destroy(&udp_attr); // 销毁 - /********************************************************* */ - - // 进入循环 while(1) { msg_transfer_queue_polling(); - // if(1 == slot_ind_flag) - // { - // handler.inst_id = 0; - // cu_flag = C_PLANE; - // ret = msg_transfer_send_start(handler.value,cu_flag); + if(1 == slot_ind_flag) + { + slot_ind_flag = 0; - // ret = msg_transfer_alloc_msg(handler.value, cu_flag, size, &buf, &availableSize, &offset); - // if ( SUCCESS != ret) { - // UCP_PRINT_ERROR("0,c_plane alloc error\r\n"); - // continue; - // } + handler.inst_id = 0; - // ptr = (uint8_t *)buf; - // *(uint32_t*)(ptr + 0) = gu32_value; - // *(uint32_t*)(ptr + 4) = gu32_tick_from_tx_ctrl; - // *(uint32_t*)(ptr + 8) = gu32_tick_receive_ctrl; - // *(uint32_t*)(ptr + 12) = read_stc_local_timer(); + /************C_PLANE***************/ + cu_flag = C_PLANE; + ret = msg_transfer_send_start(handler.value,cu_flag); - // ret = msg_transfer_send_msg(handler.value, cu_flag, (uint8_t *)buf, offset, size); - // if ( SUCCESS != ret) { - // UCP_PRINT_ERROR("0,c_plane send error\r\n"); - // } + ret = msg_transfer_alloc_msg(handler.value, cu_flag, size, &buf, &availableSize, &offset); + if ( SUCCESS != ret) { + UCP_PRINT_ERROR("0,c_plane alloc error\r\n"); + continue; + } - // ret = msg_transfer_send_end(handler.value,cu_flag); + ptr = (uint8_t *)buf; + *(uint32_t*)(ptr + 0) = gu32_value; + *(uint32_t*)(ptr + 4) = gu32_tick_from_tx_ctrl; + *(uint32_t*)(ptr + 8) = gu32_tick_receive_ctrl; + *(uint32_t*)(ptr + 12) = read_stc_local_timer(); - // /************U_PLANE***************/ - // cu_flag = U_PLANE; - // ret = msg_transfer_send_start(handler.value,cu_flag); + ret = msg_transfer_send_msg(handler.value, cu_flag, (uint8_t *)buf, offset, size); + if ( SUCCESS != ret) { + UCP_PRINT_ERROR("0,c_plane send error\r\n"); + } - // ret = msg_transfer_alloc_msg(handler.value, cu_flag, size, &buf, &availableSize, &offset); - // if ( SUCCESS != ret) { - // UCP_PRINT_ERROR("0,u_plane alloc error\r\n"); - // continue; - // } + ret = msg_transfer_send_end(handler.value,cu_flag); - // ptr = (uint8_t *)buf; - // *(uint32_t*)(ptr + 0) = gu32_value; - // *(uint32_t*)(ptr + 4) = gu32_tick_from_tx_ctrl; - // *(uint32_t*)(ptr + 8) = gu32_tick_receive_ctrl; - // *(uint32_t*)(ptr + 12) = read_stc_local_timer(); + /************U_PLANE***************/ + cu_flag = U_PLANE; + ret = msg_transfer_send_start(handler.value,cu_flag); - // ret = msg_transfer_send_msg(handler.value, cu_flag, (uint8_t *)buf, offset, size); - // if ( SUCCESS != ret) { - // UCP_PRINT_ERROR("0,u_plane send error\r\n"); - // } + ret = msg_transfer_alloc_msg(handler.value, cu_flag, size, &buf, &availableSize, &offset); + if ( SUCCESS != ret) { + UCP_PRINT_ERROR("0,u_plane alloc error\r\n"); + continue; + } - // ret = msg_transfer_send_end(handler.value,cu_flag); - // } + ptr = (uint8_t *)buf; + *(uint32_t*)(ptr + 0) = gu32_value; + *(uint32_t*)(ptr + 4) = gu32_tick_from_tx_ctrl; + *(uint32_t*)(ptr + 8) = gu32_tick_receive_ctrl; + *(uint32_t*)(ptr + 12) = read_stc_local_timer(); + + ret = msg_transfer_send_msg(handler.value, cu_flag, (uint8_t *)buf, offset, size); + if ( SUCCESS != ret) { + UCP_PRINT_ERROR("0,u_plane send error\r\n"); + } + + ret = msg_transfer_send_end(handler.value,cu_flag); + } } return 0; }