udp_pack.zip_NIOS II DMA_NIOS 以太网_nios ii 以太网_nios udp_ram dma

#include "system.h" #include <stdio.h> #include <string.h> #include <ctype.h> #include "includes.h" #include "simple_socket_server.h" #include "alt_error_handler.h" #include "alt_lwip_dev.h" #include "lwip/sys.h" #include "lwip/netif.h" #include "lwip/sockets.h" #include "sys/alt_dma.h" #include <io.h> #define IOWR_ALTERA_AVALON_RECV_INDI_DATA(base,data) IOWR(base, 0, data)//#include "altera_avalon_recv_indi_regs.h" //config #define LOCAL_PORT 8088 const char *LOCAL_IP_ADDR = "192.168.123.88"; int ss; struct sockaddr_in remote_addr; int nLen = sizeof(remote_addr); void UdpServerTask() { ss = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP); if (ss < 0) { printf("Failed socket()\n"); OSTaskDel(OS_PRIO_SELF); } struct sockaddr_in ssin; ssin.sin_family = AF_INET; ssin.sin_port = htons(LOCAL_PORT); ssin.sin_addr.s_addr = inet_addr(LOCAL_IP_ADDR);//INADDR_ANY; if (bind(ss, (struct sockaddr *)&ssin, sizeof(ssin)) < 0) { printf("Failed bind()\n"); OSTaskDel(OS_PRIO_SELF); } printf("--------------- Server -----------------\n"); char rx_buf[256]; while (1) { int nRecv = recvfrom(ss, rx_buf, 255, 0, (struct sockaddr *)&remote_addr, &nLen); if (nRecv > 0) { /* rx_buf[nRecv] = '\0'; printf("接收到数据：%s \n", rx_buf); sendto(ss, rx_buf, nRecv, 0, (struct sockaddr *)&remote_addr, nLen); */ int index; for (index=0; index<nRecv; index++) { char cmd = toupper(rx_buf[index]); if (cmd == 'S') { IOWR_ALTERA_AVALON_RECV_INDI_DATA(RECV_INDI_BASE, 3); break; } } } } return ; } #define MAX_INDEX 192 #define BUF_LEN 512 typedef struct ST_RXB { alt_u16 buf[MAX_INDEX][BUF_LEN]; alt_u8 rd_index, wr_index; alt_u16 len[MAX_INDEX]; } RXB; RXB rxb; OS_EVENT *recv_sem; alt_dma_txchan txchan; alt_dma_rxchan rxchan; void* tx_buf;; void* rx_buf; static void dma_done(void* handle, void* data) { alt_u16 frame_end; IOWR_ALTERA_AVALON_RECV_INDI_DATA(RECV_INDI_BASE, 2); rxb.len[rxb.wr_index] = (rxb.buf[rxb.wr_index][0] & 0x7fff)<<1; frame_end = rxb.buf[rxb.wr_index][0] & 0x8000; rxb.wr_index = (++rxb.wr_index) % MAX_INDEX; rx_buf = (void*)rxb.buf[rxb.wr_index]; //OSSemPost(recv_sem); if (frame_end) { OSSemPost(recv_sem); } } void isr_recv(void *context, alt_u32 id) { alt_irq_context irq_context = alt_irq_disable_all(); IOWR_ALTERA_AVALON_RECV_INDI_DATA(RECV_INDI_BASE, 0); alt_dma_txchan_send(txchan, tx_buf, 1024, NULL, NULL); alt_dma_rxchan_prepare(rxchan, rx_buf, 1024, dma_done, NULL); alt_irq_enable_all(irq_context); } void recv_init() { IOWR_ALTERA_AVALON_RECV_INDI_DATA(RECV_INDI_BASE, 0);//disable receive rxb.rd_index = 0; rxb.wr_index = 0; recv_sem = OSSemCreate(0); if (recv_sem == NULL) { printf("The TCB is not enough!\n"); } alt_irq_register(DMA_SRC_IRQ, NULL, isr_recv); tx_buf = (void*)DMA_SRC_BASE; rx_buf = (void*)rxb.buf[rxb.wr_index]; if ((txchan = alt_dma_txchan_open("/dev/dma")) == NULL) { printf ("Failed to open transmit channel\n"); } if ((rxchan = alt_dma_rxchan_open("/dev/dma")) == NULL) { printf ("Failed to open receive channel\n"); } } //alt_u8 zero[6] = {0}; void UdpPackTask() { INT8U err; while (1) { OSSemPend(recv_sem, 0, &err); while (rxb.rd_index != rxb.wr_index) { if (rxb.len[rxb.rd_index]==0) { printf("Zero!!!\n"); //sendto(ss, zero, 6, 0, (struct sockaddr *)&remote_addr, nLen); } sendto(ss, (alt_u8 *)rxb.buf[rxb.rd_index], rxb.len[rxb.rd_index], 0, (struct sockaddr *)&remote_addr, nLen); rxb.rd_index = (++rxb.rd_index) % MAX_INDEX; } //printf("\nOSEventCnt=%d, rd_index=%d, wr_index=%d\n", recv_sem->OSEventCnt, rxb.rd_index, rxb.wr_index); } }