2025-05-20 00:30:33 +08:00
|
|
|
|
// +FHDR------------------------------------------------------------
|
|
|
|
|
// Copyright (c) 2022 SmartLogic.
|
|
|
|
|
// ALL RIGHTS RESERVED
|
|
|
|
|
// -----------------------------------------------------------------
|
|
|
|
|
// Filename : test.c
|
|
|
|
|
// Author : xianfeng.du
|
|
|
|
|
// Created On : 2024-12-14
|
|
|
|
|
// Last Modified :
|
|
|
|
|
// -----------------------------------------------------------------
|
|
|
|
|
// Description:
|
2025-05-20 00:39:51 +08:00
|
|
|
|
// (Aut@qieYuan_2025.05.04) 新增数据接收与发送 收发聚合无多线程
|
|
|
|
|
// -----------------------------------------------------------------
|
2025-05-20 20:27:26 +08:00
|
|
|
|
#define _GNU_SOURCE
|
2025-05-20 00:30:33 +08:00
|
|
|
|
#include <stddef.h>
|
|
|
|
|
#include <string.h>
|
|
|
|
|
#include <sys/time.h>
|
|
|
|
|
#include <unistd.h>
|
|
|
|
|
#include <stdio.h>
|
|
|
|
|
#include <stdlib.h>
|
|
|
|
|
#include <string.h>
|
|
|
|
|
#include <termios.h>
|
|
|
|
|
#include <ctype.h>
|
|
|
|
|
|
|
|
|
|
#include "typedef.h"
|
|
|
|
|
#include "ucp_printf.h"
|
|
|
|
|
#include "msg_transfer_mem.h"
|
|
|
|
|
#include "pet_sm_mgt.h"
|
|
|
|
|
#include "ucp_handshake.h"
|
|
|
|
|
#include "ospShell.h"
|
|
|
|
|
#include "ospLog.h"
|
|
|
|
|
#include "ospCfgToBin.h"
|
|
|
|
|
#include "ospTask.h"
|
|
|
|
|
#include "drv_init.h"
|
|
|
|
|
#include "ospSwTimer.h"
|
|
|
|
|
#include "stc_drv_api.h"
|
|
|
|
|
|
2025-05-20 00:39:51 +08:00
|
|
|
|
//----------------------------------------------------
|
|
|
|
|
// Last modified time: 2025.05.03
|
|
|
|
|
// Last Version: V1.0
|
|
|
|
|
//----------------------------------------------------
|
2025-05-20 20:27:26 +08:00
|
|
|
|
|
2025-05-20 00:39:51 +08:00
|
|
|
|
#include <arpa/inet.h> // udp
|
2025-05-20 20:05:52 +08:00
|
|
|
|
#include <sched.h> // 绑定CPU
|
2025-05-20 00:39:51 +08:00
|
|
|
|
#include <pthread.h> // thread
|
|
|
|
|
#include <unistd.h> // POSIX api
|
|
|
|
|
#include <fcntl.h> // open()
|
|
|
|
|
#include <sys/mman.h> // MMAP
|
2025-05-27 02:40:48 +08:00
|
|
|
|
#include <errno.h>
|
2025-05-20 00:39:51 +08:00
|
|
|
|
//----------------------------------------------------
|
2025-05-20 20:17:18 +08:00
|
|
|
|
|
2025-05-20 20:05:52 +08:00
|
|
|
|
|
2025-05-20 00:39:51 +08:00
|
|
|
|
#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 MAP_ADDR_TX_BASE_CASE52 0x84C00000 // TX 数据位起始
|
|
|
|
|
#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 *map_base_rx_case52; // RX映射地址 8块
|
|
|
|
|
void *map_base_rxf_case52; // wr 计数映射地址
|
|
|
|
|
uint8_t w_idx, r_idx; // RX 信号
|
2025-05-26 23:22:17 +08:00
|
|
|
|
|
2025-05-20 00:39:51 +08:00
|
|
|
|
//----------------------------------------------------
|
|
|
|
|
|
2025-05-27 22:36:44 +08:00
|
|
|
|
volatile uint32_t slot_ind_flag = 0;
|
2025-05-20 00:30:33 +08:00
|
|
|
|
uint32_t slot_ind_time_flag = 0;
|
2025-05-20 00:39:51 +08:00
|
|
|
|
uint32_t g_slot_time = 0;
|
2025-05-20 00:30:33 +08:00
|
|
|
|
uint32_t gu32_value = 0;
|
|
|
|
|
uint32_t gu32_tick_receive_ctrl = 0;
|
|
|
|
|
uint32_t gu32_tick_from_tx_ctrl = 0;
|
2025-05-20 00:39:51 +08:00
|
|
|
|
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转换
|
2025-05-27 02:37:52 +08:00
|
|
|
|
int flags = fcntl(sockfd_case52, F_GETFL, 0);
|
|
|
|
|
fcntl(sockfd_case52, F_SETFL, flags | O_NONBLOCK);
|
2025-05-20 00:39:51 +08:00
|
|
|
|
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");
|
|
|
|
|
// 初始化消费者索引
|
|
|
|
|
/************************************************************************************** */
|
|
|
|
|
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);
|
|
|
|
|
}
|
2025-05-26 23:22:17 +08:00
|
|
|
|
uint16_t txt_buffer[65535] = {0};
|
2025-05-20 00:39:51 +08:00
|
|
|
|
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;
|
|
|
|
|
uint16_t udp_data_buffer[8008];
|
|
|
|
|
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
|
2025-05-27 02:37:52 +08:00
|
|
|
|
memcpy((char*)map_base_tx_case52 + tx_data_offset, &txt_buffer[data_index], 2);//65536
|
2025-05-20 00:39:51 +08:00
|
|
|
|
// 更新数据索引
|
|
|
|
|
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");
|
2025-05-27 18:41:45 +08:00
|
|
|
|
size_t current_pos = 0;
|
|
|
|
|
uint16_t value_mem = 0;
|
|
|
|
|
uint8_t block_n = 0;
|
|
|
|
|
uint8_t cut_i = 0;
|
2025-05-20 00:39:51 +08:00
|
|
|
|
while (1)
|
2025-05-27 22:36:44 +08:00
|
|
|
|
{
|
|
|
|
|
// usleep(10);
|
2025-05-20 00:39:51 +08:00
|
|
|
|
if (1 == slot_ind_flag)
|
|
|
|
|
{
|
2025-05-27 02:37:52 +08:00
|
|
|
|
|
2025-05-20 00:39:51 +08:00
|
|
|
|
slot_ind_flag = 0;
|
|
|
|
|
/************************************************************************************** */
|
2025-05-27 02:37:52 +08:00
|
|
|
|
// wr 16016*20(byte),一次while循环会写入 1/20 的数据,触发条件为slot_ind_flag
|
2025-05-27 18:41:45 +08:00
|
|
|
|
current_pos = wr_cunt * 16016;
|
2025-05-27 02:37:52 +08:00
|
|
|
|
|
|
|
|
|
for (int i = 0; i < 8008; ++i) {
|
2025-05-27 18:41:45 +08:00
|
|
|
|
value_mem = txt_buffer[(data_index + i) % 65535];
|
|
|
|
|
memcpy((char*)map_base_tx_case52 + current_pos + i*2, &value_mem, 2);
|
2025-05-20 00:39:51 +08:00
|
|
|
|
}
|
|
|
|
|
data_index = (data_index + 8008) % 65535;
|
|
|
|
|
wr_cunt = (wr_cunt + 1) % 20;
|
|
|
|
|
/************************************************************************************** */
|
|
|
|
|
// 更新生产者计数
|
2025-05-27 18:41:45 +08:00
|
|
|
|
w_idx = __atomic_load_n(
|
2025-05-26 22:23:49 +08:00
|
|
|
|
(volatile uint8_t *)(map_base_rxf_case52 + 0),
|
|
|
|
|
__ATOMIC_ACQUIRE
|
|
|
|
|
);
|
2025-05-27 18:41:45 +08:00
|
|
|
|
// w_idx = *((volatile uint8_t *)map_base_rxf_case52);
|
2025-05-20 00:39:51 +08:00
|
|
|
|
/************************************************************************************** */
|
|
|
|
|
// 尝试读取
|
2025-05-27 18:41:45 +08:00
|
|
|
|
block_n = 0;
|
2025-05-20 00:39:51 +08:00
|
|
|
|
if (w_idx == r_idx){
|
|
|
|
|
printf("[while(1)]: w_idx = %hhu, r_idx = %hhu\n", w_idx, r_idx);
|
2025-05-27 03:29:42 +08:00
|
|
|
|
printf("[while(1)]: pass\n");
|
2025-05-20 00:39:51 +08:00
|
|
|
|
} else {
|
|
|
|
|
if (r_idx < w_idx) {
|
|
|
|
|
printf("[while(1)]: w_idx = %hhu, r_idx = %hhu\n", w_idx, r_idx);
|
|
|
|
|
printf("[while(1)]: r_idx < w_idx\n");
|
|
|
|
|
block_n = w_idx - r_idx;
|
2025-05-27 18:41:45 +08:00
|
|
|
|
for (cut_i = 0; cut_i < block_n; cut_i++)
|
2025-05-20 00:39:51 +08:00
|
|
|
|
{
|
|
|
|
|
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,
|
|
|
|
|
(const struct sockaddr*)&server_addr_case52,
|
|
|
|
|
sizeof(server_addr_case52)
|
|
|
|
|
);
|
2025-05-27 02:37:52 +08:00
|
|
|
|
if (send_len == -1) {
|
|
|
|
|
if (errno == EAGAIN || errno == EWOULDBLOCK) {
|
|
|
|
|
printf("[UDP] UDP发送缓冲区满\n");
|
|
|
|
|
continue;
|
|
|
|
|
}else{
|
|
|
|
|
perror("sendto error");
|
|
|
|
|
continue;
|
|
|
|
|
}
|
|
|
|
|
}
|
2025-05-20 00:39:51 +08:00
|
|
|
|
r_idx ++ ;
|
|
|
|
|
}
|
|
|
|
|
// 更新r_idx,如果到头
|
|
|
|
|
r_idx = r_idx % 8;
|
2025-05-24 18:05:14 +08:00
|
|
|
|
} else { //r_idx > w_idx
|
2025-05-20 00:39:51 +08:00
|
|
|
|
printf("[while(1)]: w_idx < r_idx\n");
|
|
|
|
|
printf("[while(1)]: w_idx = %hhu, r_idx = %hhu\n", w_idx, r_idx);
|
|
|
|
|
// 取完末尾
|
2025-05-27 18:41:45 +08:00
|
|
|
|
for (cut_i = 0; cut_i < (8-r_idx); cut_i++)
|
2025-05-20 00:39:51 +08:00
|
|
|
|
{
|
|
|
|
|
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,
|
|
|
|
|
(const struct sockaddr*)&server_addr_case52,
|
|
|
|
|
sizeof(server_addr_case52)
|
|
|
|
|
);
|
2025-05-27 02:37:52 +08:00
|
|
|
|
if (send_len == -1) {
|
|
|
|
|
if (errno == EAGAIN || errno == EWOULDBLOCK) {
|
|
|
|
|
printf("[UDP] UDP发送缓冲区满\n");
|
|
|
|
|
continue;
|
|
|
|
|
}else{
|
|
|
|
|
perror("sendto error");
|
|
|
|
|
continue;
|
|
|
|
|
}
|
|
|
|
|
}
|
2025-05-20 00:39:51 +08:00
|
|
|
|
r_idx ++ ;
|
|
|
|
|
}
|
|
|
|
|
r_idx = r_idx % 8;
|
|
|
|
|
// 取从头开始
|
2025-05-27 18:41:45 +08:00
|
|
|
|
for (cut_i = 0; cut_i < w_idx; cut_i++)
|
2025-05-20 00:39:51 +08:00
|
|
|
|
{
|
|
|
|
|
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,
|
|
|
|
|
(const struct sockaddr*)&server_addr_case52,
|
|
|
|
|
sizeof(server_addr_case52)
|
|
|
|
|
);
|
2025-05-27 02:37:52 +08:00
|
|
|
|
if (send_len == -1) {
|
|
|
|
|
if (errno == EAGAIN || errno == EWOULDBLOCK) {
|
|
|
|
|
printf("[UDP] UDP发送缓冲区满\n");
|
|
|
|
|
continue;
|
|
|
|
|
}else{
|
|
|
|
|
perror("sendto error");
|
|
|
|
|
continue;
|
|
|
|
|
}
|
|
|
|
|
}
|
2025-05-20 00:39:51 +08:00
|
|
|
|
r_idx ++;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
return NULL;
|
|
|
|
|
}
|
2025-05-20 00:30:33 +08:00
|
|
|
|
|
|
|
|
|
uint32_t rx_callback_data(const char* buf,uint32_t payloadSize)
|
|
|
|
|
{
|
|
|
|
|
uint32_t stc_cnt = read_stc_local_timer();
|
|
|
|
|
uint32_t value = *(uint32_t *)buf;
|
|
|
|
|
uint16_t sfn = value >> 16;
|
|
|
|
|
uint16_t slot = value & 0xffff;
|
|
|
|
|
|
|
|
|
|
uint32_t tick_from_tx_ctrl = *(uint32_t *)(buf+4);
|
|
|
|
|
|
2025-05-26 22:23:49 +08:00
|
|
|
|
// printf("[rx_callback_data]:slot_ind_flag == 1 \n");
|
2025-05-20 00:30:33 +08:00
|
|
|
|
slot_ind_flag = 1;
|
|
|
|
|
gu32_value = value;
|
|
|
|
|
gu32_tick_receive_ctrl = stc_cnt;
|
|
|
|
|
gu32_tick_from_tx_ctrl = tick_from_tx_ctrl;
|
|
|
|
|
uint32_t diff = stc_cnt - tick_from_tx_ctrl;
|
|
|
|
|
|
|
|
|
|
if(0 == slot_ind_time_flag)
|
|
|
|
|
{
|
|
|
|
|
slot_ind_time_flag = 1;
|
|
|
|
|
diff = 500000;
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
diff = stc_cnt - g_slot_time;
|
|
|
|
|
}
|
|
|
|
|
g_slot_time = stc_cnt;
|
|
|
|
|
|
|
|
|
|
if ((diff > 520000) || (diff < 480000))
|
|
|
|
|
{
|
2025-05-20 00:39:51 +08:00
|
|
|
|
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);
|
|
|
|
|
}
|
2025-05-20 00:30:33 +08:00
|
|
|
|
}
|
|
|
|
|
return payloadSize;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
uint32_t rx1_callback_data(const char* buf,uint32_t payloadSize)
|
|
|
|
|
{
|
|
|
|
|
return payloadSize;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
uint32_t rx_callback_ctrl(const char* buf,uint32_t payloadSize)
|
|
|
|
|
{
|
|
|
|
|
return payloadSize;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static inline void get_msg_transfer_info(uint16_t port_index, uint16_t inst_id, uint16_t transfer_type, transfer_type_info_s* transfer_type_info_ptr)
|
|
|
|
|
{
|
|
|
|
|
queue_info_s c_plane,u_plane;
|
|
|
|
|
|
|
|
|
|
switch (transfer_type) {
|
|
|
|
|
case CU_SPLIT:
|
|
|
|
|
c_plane.rx_block_size = 0x25800;
|
|
|
|
|
c_plane.rx_block_num = 32;
|
|
|
|
|
c_plane.rx_callback = rx_callback_ctrl;
|
|
|
|
|
c_plane.tx_block_size = 0x8000;
|
|
|
|
|
c_plane.tx_block_num = 8;
|
|
|
|
|
c_plane.tx_callback = NULL;
|
|
|
|
|
|
|
|
|
|
u_plane.rx_block_size = 0x28000;
|
|
|
|
|
u_plane.rx_block_num = 8;
|
|
|
|
|
//u_plane.rx_callback = rx_callback_data;
|
|
|
|
|
if (0 == inst_id)
|
|
|
|
|
{
|
|
|
|
|
u_plane.rx_callback = rx_callback_data;
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
u_plane.rx_callback = rx1_callback_data;
|
|
|
|
|
}
|
|
|
|
|
u_plane.tx_block_size = 0x28000;
|
|
|
|
|
u_plane.tx_block_num = 8;
|
|
|
|
|
u_plane.tx_callback = NULL;
|
|
|
|
|
|
|
|
|
|
transfer_type_info_ptr->queue_cplane_info = c_plane;
|
|
|
|
|
transfer_type_info_ptr->queue_uplane_info = u_plane;
|
|
|
|
|
break;
|
|
|
|
|
case OAM:
|
|
|
|
|
c_plane.rx_block_size = 0x100000;
|
|
|
|
|
c_plane.rx_block_num = 16;
|
|
|
|
|
c_plane.rx_callback = rx_callback_oam;
|
|
|
|
|
c_plane.tx_block_size = 0x8000;
|
|
|
|
|
c_plane.tx_block_num = 4;
|
|
|
|
|
c_plane.tx_callback = NULL;
|
|
|
|
|
|
|
|
|
|
transfer_type_info_ptr->queue_cplane_info = c_plane;
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
UCP_PRINT_ERROR("get_msg_queue_cfg doesn't support transfer_type[%d] .",transfer_type);
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static inline void msg_transfer_cfg(void)
|
|
|
|
|
{
|
|
|
|
|
uint8_t port_id = 0;
|
|
|
|
|
uint16_t inst_id = 0;
|
|
|
|
|
uint16_t transfer_type = 0;
|
|
|
|
|
int32_t handle_id = 0;
|
|
|
|
|
transfer_type_info_s transfer_type_info;
|
|
|
|
|
|
|
|
|
|
#ifdef PCIE_WITH_JESD
|
|
|
|
|
for (inst_id = 0; inst_id < (MAX_INSTANCE_NUM / 2); inst_id++)
|
|
|
|
|
#else
|
|
|
|
|
for (inst_id = 0; inst_id < MAX_INSTANCE_NUM; inst_id++)
|
|
|
|
|
#endif
|
|
|
|
|
{
|
|
|
|
|
/*********************************transfer_type = CU_SPLIT**********************************/
|
|
|
|
|
transfer_type = CU_SPLIT;
|
|
|
|
|
get_msg_transfer_info(port_id,inst_id,transfer_type, &transfer_type_info);
|
|
|
|
|
handle_id = msg_transfer_init(port_id, transfer_type, inst_id, &transfer_type_info);
|
|
|
|
|
if (handle_id < 0) {
|
|
|
|
|
UCP_PRINT_ERROR("phy_cfg_init transfer_type:CU_SPLIT, handle_id[0x%08x] error.",handle_id);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*********************************transfer_type = OAM**********************************/
|
|
|
|
|
transfer_type = OAM;
|
|
|
|
|
get_msg_transfer_info(port_id,inst_id,transfer_type, &transfer_type_info);
|
|
|
|
|
handle_id = msg_transfer_init(port_id, transfer_type, inst_id, &transfer_type_info);
|
|
|
|
|
if (handle_id < 0) {
|
|
|
|
|
UCP_PRINT_ERROR("phy_cfg_init transfer_type:OAM, handle_id[0x%08x] error.",handle_id);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
PetSmLocalMgt_t* pPetSmLocalMgt = get_pet_sm_local_mgt();
|
|
|
|
|
MsgQueueLocalMgt_t* pMsgQueueLocalMgt = get_msg_queue_local_mgt();
|
|
|
|
|
pPetSmLocalMgt->pSyncInfo->queueCfgFlag = ++pMsgQueueLocalMgt->localSyncInfo.queueCfgFlag;
|
|
|
|
|
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static inline void msg_transfer_queue_polling(void)
|
|
|
|
|
{
|
|
|
|
|
uint8_t port_id = 0;
|
|
|
|
|
HandleId_t handler;
|
|
|
|
|
uint16_t cu_flag;
|
|
|
|
|
uint32_t offset = 0;
|
|
|
|
|
uint32_t len = 0;
|
|
|
|
|
uint8_t* msg_ptr;
|
|
|
|
|
|
|
|
|
|
#ifdef PCIE_WITH_JESD
|
|
|
|
|
for (uint32_t i = 0; i < (MAX_INSTANCE_NUM / 2); i++)
|
|
|
|
|
#else
|
|
|
|
|
for (uint32_t i = 0; i < MAX_INSTANCE_NUM; i++)
|
|
|
|
|
#endif
|
|
|
|
|
{
|
|
|
|
|
handler.port_id = port_id;
|
|
|
|
|
handler.inst_id = i;
|
|
|
|
|
handler.type_id = CU_SPLIT;
|
|
|
|
|
cu_flag = C_PLANE;
|
|
|
|
|
msg_transfer_receive(handler.value, cu_flag, offset, len, &msg_ptr);
|
|
|
|
|
|
|
|
|
|
cu_flag = U_PLANE;
|
|
|
|
|
msg_transfer_receive(handler.value, cu_flag, offset, len, &msg_ptr);
|
|
|
|
|
|
|
|
|
|
handler.type_id = OAM;
|
|
|
|
|
msg_transfer_receive(handler.value, cu_flag, offset, len, &msg_ptr);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
#define CELL_SETUP_TYPE_SIMULATION (0x5a6b7c8d)
|
|
|
|
|
|
|
|
|
|
void cell_setup_simulation(uint8_t scs_id, uint8_t cell_id, uint32_t run_core, uint8_t frame_type)
|
|
|
|
|
{
|
|
|
|
|
uint32_t size = 32;
|
|
|
|
|
char* buf;
|
|
|
|
|
uint32_t availableSize,offset;
|
|
|
|
|
|
|
|
|
|
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 = msg_transfer_send_start(handler.value,cu_flag);
|
|
|
|
|
|
|
|
|
|
/************C_PLANE***************/
|
|
|
|
|
ret = msg_transfer_alloc_msg(handler.value, cu_flag, size, &buf, &availableSize, &offset);
|
|
|
|
|
if ( SUCCESS != ret) {
|
|
|
|
|
UCP_PRINT_ERROR("cell_setup_simulation call msg_transfer_alloc_msg err.");
|
|
|
|
|
return ;
|
|
|
|
|
//continue;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
*(uint32_t*)(buf + 0) = CELL_SETUP_TYPE_SIMULATION;
|
|
|
|
|
*(uint32_t*)(buf + 4) = read_stc_local_timer();
|
|
|
|
|
*(uint32_t*)(buf + 12) = 0; // build cell
|
|
|
|
|
*(uint32_t*)(buf + 16) = scs_id;
|
|
|
|
|
*(uint32_t*)(buf + 20) = cell_id;
|
|
|
|
|
*(uint32_t*)(buf + 24) = run_core;
|
|
|
|
|
*(uint32_t*)(buf + 28) = frame_type;
|
|
|
|
|
|
|
|
|
|
ret = msg_transfer_send_msg(handler.value, cu_flag, (uint8_t *)buf, offset, size);
|
|
|
|
|
ret = msg_transfer_send_end(handler.value,cu_flag);
|
|
|
|
|
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
#define ORX_MSG_TYPE_SIMULATION (0xaabb7788)
|
|
|
|
|
|
|
|
|
|
void orx_msg_send(void)
|
|
|
|
|
{
|
|
|
|
|
uint32_t size = 16;
|
|
|
|
|
char* buf = NULL;
|
|
|
|
|
uint32_t availableSize,offset;
|
|
|
|
|
|
|
|
|
|
uint16_t cu_flag = C_PLANE;
|
|
|
|
|
HandleId_t handler;
|
|
|
|
|
handler.port_id = 0;
|
|
|
|
|
handler.inst_id = 0;
|
|
|
|
|
handler.type_id = CU_SPLIT;
|
|
|
|
|
|
|
|
|
|
//usleep(10000);
|
|
|
|
|
//sleep(1);
|
|
|
|
|
|
|
|
|
|
int32_t ret = msg_transfer_send_start(handler.value,cu_flag);
|
|
|
|
|
|
|
|
|
|
/************C_PLANE***************/
|
|
|
|
|
ret = msg_transfer_alloc_msg(handler.value, cu_flag, size, &buf, &availableSize, &offset);
|
|
|
|
|
if ( SUCCESS != ret) {
|
|
|
|
|
UCP_PRINT_ERROR("cell_setup_simulation call msg_transfer_alloc_msg err.");
|
|
|
|
|
return ;
|
|
|
|
|
//continue;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
*(uint32_t*)(buf + 0) = ORX_MSG_TYPE_SIMULATION;
|
|
|
|
|
*(uint32_t*)(buf + 4) = read_stc_local_timer();
|
|
|
|
|
|
|
|
|
|
ret = msg_transfer_send_msg(handler.value, cu_flag, (uint8_t *)buf, offset, size);
|
|
|
|
|
ret = msg_transfer_send_end(handler.value,cu_flag);
|
|
|
|
|
|
|
|
|
|
UCP_PRINT_DEBUG("start send orx message.");
|
|
|
|
|
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
uint64_t osp_orx_msg_proc_task(void)
|
|
|
|
|
{
|
|
|
|
|
sleep(1);
|
|
|
|
|
|
|
|
|
|
orx_msg_send();
|
|
|
|
|
|
|
|
|
|
return OSP_OK;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int32_t osp_set_task_orx(uint8_t cpu, uint8_t pri)
|
|
|
|
|
{
|
|
|
|
|
OSP_TASKMSG_REG task_reg_tabl;
|
|
|
|
|
OSP_STATUS ret = OSP_OK;
|
|
|
|
|
|
|
|
|
|
if (cpu > 7)
|
|
|
|
|
{
|
|
|
|
|
UCP_PRINT_DEBUG("coreid %d beyond 7\n", cpu);
|
|
|
|
|
return OSP_ERROR;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
memset(&task_reg_tabl, 0, sizeof(OSP_TASKMSG_REG));
|
|
|
|
|
task_reg_tabl.TaskId = OspDbgLog+3;
|
|
|
|
|
strcpy((void *)&task_reg_tabl.TaskName, "OspDbgOrx");
|
|
|
|
|
task_reg_tabl.TaskPri = RT_NOMSG_PRI(pri);
|
|
|
|
|
task_reg_tabl.Init = NULL;
|
|
|
|
|
task_reg_tabl.MainLoop = (OSP_FUNCPTR)osp_orx_msg_proc_task;
|
|
|
|
|
task_reg_tabl.Cpu = cpu;
|
|
|
|
|
task_reg_tabl.MsgType = OSP_PROCESS_MSG;
|
|
|
|
|
|
|
|
|
|
ret = osp_regtask(&task_reg_tabl);
|
|
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int32_t test_case(uint32_t argc, int32_t* argvp)
|
|
|
|
|
{
|
|
|
|
|
UCP_PRINT_DEBUG("start running testcase 46.");
|
|
|
|
|
|
|
|
|
|
osp_read_spe_cfg_file("/ramfs/cfgDat");
|
|
|
|
|
|
|
|
|
|
msg_transfer_mem_init();
|
|
|
|
|
msg_transfer_cfg();
|
|
|
|
|
ucp_handshake();
|
|
|
|
|
|
|
|
|
|
UCP_PRINT_DEBUG("start transfering message.");
|
|
|
|
|
|
2025-05-20 20:17:18 +08:00
|
|
|
|
// uint32_t size = 100;
|
|
|
|
|
// char* buf;
|
|
|
|
|
// uint32_t availableSize,offset;
|
|
|
|
|
// uint8_t* ptr;
|
2025-05-20 00:30:33 +08:00
|
|
|
|
|
2025-05-20 20:17:18 +08:00
|
|
|
|
// uint16_t cu_flag = C_PLANE;
|
2025-05-20 20:30:16 +08:00
|
|
|
|
// HandleId_t handler;
|
|
|
|
|
// handler.port_id = 0;
|
|
|
|
|
// handler.inst_id = 0;
|
|
|
|
|
// handler.type_id = CU_SPLIT;
|
2025-05-20 00:30:33 +08:00
|
|
|
|
|
2025-05-20 20:17:18 +08:00
|
|
|
|
// int32_t ret;
|
2025-05-20 00:30:33 +08:00
|
|
|
|
uint8_t scs_id = 1; // NR 30K // 0; // NR 15K
|
|
|
|
|
uint8_t cell_id = 0; //0xFF;
|
2025-05-24 18:05:14 +08:00
|
|
|
|
uint32_t run_ape = 0x11; //0x11
|
2025-05-20 00:39:51 +08:00
|
|
|
|
// uint32_t run_ape = 0x1; // 0;
|
2025-05-20 00:30:33 +08:00
|
|
|
|
uint8_t frame_type = 0; // fdd
|
|
|
|
|
cell_setup_simulation(scs_id, cell_id, run_ape, frame_type);
|
|
|
|
|
//osp_set_task_orx(6, 95);
|
|
|
|
|
|
2025-05-20 00:39:51 +08:00
|
|
|
|
/********************************************************* */
|
2025-05-20 20:05:52 +08:00
|
|
|
|
pthread_attr_t udp_attr; // 定义线程包
|
|
|
|
|
pthread_attr_init(&udp_attr); // 包初始化
|
|
|
|
|
|
|
|
|
|
cpu_set_t udp_cpuset; // CPU集合
|
|
|
|
|
CPU_ZERO(&udp_cpuset); // 集合初始化
|
2025-05-26 23:22:17 +08:00
|
|
|
|
CPU_SET(2, &udp_cpuset); // 选择核心2
|
2025-05-20 20:05:52 +08:00
|
|
|
|
pthread_attr_setaffinity_np(&udp_attr, sizeof(udp_cpuset), &udp_cpuset); // 绑定
|
|
|
|
|
|
|
|
|
|
|
2025-05-20 00:39:51 +08:00
|
|
|
|
pthread_t thread_udp;
|
2025-05-20 20:05:52 +08:00
|
|
|
|
if (pthread_create(&thread_udp, &udp_attr, handleUdpTransmission, NULL) != 0)
|
2025-05-20 00:39:51 +08:00
|
|
|
|
{
|
|
|
|
|
printf("[SOCKET]:thread error!\n");
|
|
|
|
|
perror("pthread_create");
|
2025-05-20 20:05:52 +08:00
|
|
|
|
pthread_attr_destroy(&udp_attr);
|
2025-05-20 00:39:51 +08:00
|
|
|
|
exit(EXIT_FAILURE);
|
|
|
|
|
}
|
2025-05-20 20:05:52 +08:00
|
|
|
|
pthread_attr_destroy(&udp_attr); // 销毁
|
2025-05-20 00:39:51 +08:00
|
|
|
|
/********************************************************* */
|
|
|
|
|
|
|
|
|
|
// 进入循环
|
2025-05-20 00:30:33 +08:00
|
|
|
|
while(1) {
|
|
|
|
|
msg_transfer_queue_polling();
|
|
|
|
|
|
2025-05-20 20:05:52 +08:00
|
|
|
|
// if(1 == slot_ind_flag)
|
|
|
|
|
// {
|
|
|
|
|
// handler.inst_id = 0;
|
|
|
|
|
// cu_flag = C_PLANE;
|
|
|
|
|
// ret = msg_transfer_send_start(handler.value,cu_flag);
|
|
|
|
|
|
|
|
|
|
// 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;
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
// 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,c_plane send error\r\n");
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
// ret = msg_transfer_send_end(handler.value,cu_flag);
|
|
|
|
|
|
|
|
|
|
// /************U_PLANE***************/
|
|
|
|
|
// cu_flag = U_PLANE;
|
|
|
|
|
// ret = msg_transfer_send_start(handler.value,cu_flag);
|
|
|
|
|
|
|
|
|
|
// 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;
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
// 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);
|
|
|
|
|
// }
|
2025-05-20 00:30:33 +08:00
|
|
|
|
}
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|