yuysh/Formal_NewInstrCalBoard_Zynq
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Add lwip server function

Browse Source
This commit is contained in:
Jeremy Shen
2026-06-17 15:26:10 +08:00
parent d3c9082493
commit 43884afb38
6 changed files with 329 additions and 11 deletions
Download Patch File Download Diff File Expand all files Collapse all files
NewExtInst_Zynq_Net/Debug/NewExtInst_Zynq_Net.elf
BIN
View File
Binary file not shown.
NewExtInst_Zynq_Net/src/lwip_server.c
+194
View File
@@ -0,0 +1,194 @@
#include "lwip_server.h"
int transfer_data() {
return 0;
}
void print_app_header()
{
xil_printf("[I] New ExtInstrument Calibration Board Zynq Controller lwip stack...\r\n");
xil_printf("[I] Net: Hello World!\r\n");
}
int start_application()
{
struct tcp_pcb *pcb;
err_t err;
unsigned port = 200;
/* create new TCP PCB structure */
pcb = tcp_new_ip_type(IPADDR_TYPE_ANY);
if (!pcb) {
xil_printf("[E] Error creating PCB. Out of Memory\n\r");
return -1;
}
/* bind to specified @port */
err = tcp_bind(pcb, IP_ANY_TYPE, port);
if (err != ERR_OK) {
xil_printf("[E] Unable to bind to port %d: err = %d\n\r", port, err);
return -2;
}
/* we do not need any arguments to callback functions */
tcp_arg(pcb, NULL);
/* listen for connections */
pcb = tcp_listen(pcb);
if (!pcb) {
xil_printf("Out of memory while tcp_listen\n\r");
return -3;
}
/* specify callback to use for incoming connections */
tcp_accept(pcb, accept_callback);
xil_printf("[I] NewExtInstCal Zynq server started @ port %d\n\r", port);
return 0;
}
err_t accept_callback(void *arg, struct tcp_pcb *newpcb, err_t err)
{
static int connection = 1;
/* set the receive callback for this connection */
tcp_recv(newpcb, recv_callback);
/* just use an integer number indicating the connection id as the
callback argument */
tcp_arg(newpcb, (void*)(UINTPTR)connection);
/* increment for subsequent accepted connections */
connection++;
return ERR_OK;
}
err_t recv_callback(void *arg, struct tcp_pcb *tpcb,
struct pbuf *p, err_t err)
{
u32 Recv_Len;
char *Recv_Data;
u16 uCRC_Read_Dat;
u8 uCRC_Result[2]={0};
u8 uSend_Data[20] = {0};
u8 uCRC_Flag = 255;
/* do not read the packet if we are not in ESTABLISHED state */
if (!p) {
tcp_close(tpcb);
tcp_recv(tpcb, NULL);
return ERR_OK;
}
/* indicate that the packet has been received */
tcp_recved(tpcb, p->len);
/* Here, we assume that the payload is < TCP_SND_BUF */
if (tcp_sndbuf(tpcb) > p->len) {
Recv_Len = p->len;
Recv_Data = (char*)malloc(sizeof(char)*Recv_Len);
memcpy(Recv_Data,p->payload,Recv_Len);
//Start of CRC Check
uCRC_Read_Dat = do_crc_table(Recv_Data+6, Recv_Len-8);
uCRC_Result[0] = (u8)uCRC_Read_Dat;
uCRC_Result[1] = (u8)(uCRC_Read_Dat>>8);
if (!(Recv_Data[15]==uCRC_Result[1]&&Recv_Data[16]==uCRC_Result[0]))
{
xil_printf("[E] CRC Mismatch! Check communication!\r\n");
uCRC_Flag = 255;
}
else
{
xil_printf("[D] CRC Match!\r\n");
uCRC_Flag = 1;
}
//End of CRC Check
//Start of SendBack Formation
uSend_Data[0] = 0x00;
uSend_Data[1] = Recv_Data[1];
uSend_Data[2] = Recv_Data[2];
uSend_Data[3] = Recv_Data[3];
uSend_Data[4] = Recv_Data[4];
uSend_Data[5] = Recv_Data[5];
uSend_Data[6] = Recv_Data[6];
uSend_Data[7] = Recv_Data[7];
uSend_Data[8] = uCRC_Flag;
uSend_Data[9] = uCRC_Flag;
uSend_Data[10] = Recv_Data[15]; //Shouldn't We Re-calculate CRC? Why send back the old CRC?
uSend_Data[11] = Recv_Data[16]; //Same as above
//End of SendBack Formation
//Matching Zynq Cal Instruction Header
if(Recv_Data[6] == 0x0E)
{
if (Recv_Data[7] == 0xA2) //Cal
{
switch (Recv_Data[14]) //By Judging Equipment to decide cal type
{
case 0x01: //DC Cal
{
u8 uCMD[DC_CMD_LEN] = {0};
uCMD[0] = Recv_Data[8];
if (Recv_Data[9] < 3)
{
xil_printf("[E] DPS Single Force/Sense Not Support!\r\n");
}
else
{
if (Recv_Data[9] == 0x03) //Select DPS
{
uCMD[1] = 0x2;
}
else if (Recv_Data[9] == 0x04)//Select PMU
{
uCMD[1] = 0x1;
}
else
{
xil_printf("[E] Device Not Support!\r\n");
}
}
uCMD[2] = Recv_Data[10];
uCMD[3] = Recv_Data[11];
uCMD[4] = Recv_Data[12] + 1;
uCMD[5] = Recv_Data[13];
DC_Control(uCMD);
break;
}
case 0x02: //Freq Cal
{
u8 uCMD[Freq_CMD_LEN] = {Recv_Data[8],Recv_Data[9],Recv_Data[10],Recv_Data[11],Recv_Data[12],Recv_Data[13],Recv_Data[14]};
sw_config(uCMD);
break;
}
default: //You shouldn't be here
break;
}
}
}
tcp_write(tpcb, uSend_Data, sizeof(uSend_Data), 1);
}
else
{
xil_printf("no space in tcp_sndbuf\n\r");
}
/* free the received pbuf */
pbuf_free(p);
return ERR_OK;
}
NewExtInst_Zynq_Net/src/lwip_server.h
+29
View File
@@ -0,0 +1,29 @@
#ifndef SRC_LWIP_SERVER_H_
#define SRC_LWIP_SERVER_H_
#include <stdio.h>
#include <string.h>
#include "xstatus.h"
#include "xgpiops.h"
#include "lwip/err.h"
#include "lwip/tcp.h"
#if defined (__arm__) || defined (__aarch64__)
#include "xil_printf.h"
#endif
#include "cal_meas.h"
int transfer_data();
void print_app_header();
int start_application();
err_t accept_callback(void *arg, struct tcp_pcb *newpcb, err_t err);
err_t recv_callback(void *arg, struct tcp_pcb *tpcb, struct pbuf *p, err_t err);
err_t accept_callback(void *arg, struct tcp_pcb *newpcb, err_t err);
#endif
NewExtInst_Zynq_Net/src/main.c
+104 -11
View File
@@ -61,7 +61,7 @@ void lwip_init();
#if LWIP_IPV6==0
#if LWIP_DHCP==1
extern volatile int dhcp_timoutcntr;
volatile int dhcp_timoutcntr;
err_t dhcp_start(struct netif *netif);
#endif
#endif
@@ -69,13 +69,91 @@ void lwip_init();
static struct netif server_netif;
struct netif *echo_netif;
void print_ip(char *msg, ip_addr_t *ip)
{
print(msg);
xil_printf("%d.%d.%d.%d\n\r", ip4_addr1(ip), ip4_addr2(ip),
ip4_addr3(ip), ip4_addr4(ip));
}
void print_ip_settings(ip_addr_t *ip, ip_addr_t *mask, ip_addr_t *gw)
{
print_ip("Board IP: ", ip);
print_ip("Netmask : ", mask);
print_ip("Gateway : ", gw);
}
int main()
{
int iMainCom = 1;
ip_addr_t ipaddr, netmask, gw;
unsigned char mac_ethernet_address[] = { 0x00, 0x0a, 0x35, 0x00, 0x01, 0x01 };
echo_netif = &server_netif;
init_platform();
#if LWIP_IPV6==0
#if LWIP_DHCP==1
ipaddr.addr = 0;
gw.addr = 0;
netmask.addr = 0;
#else
/* initialize IP addresses to be used */
IP4_ADDR(&ipaddr, 192, 168, 100, 110);
IP4_ADDR(&netmask, 255, 255, 255, 0);
IP4_ADDR(&gw, 192, 168, 100, 1);
#endif
#endif
//LWIP Related Init Start
lwip_init();
if (!xemac_add(echo_netif, &ipaddr, &netmask,
&gw, mac_ethernet_address,
PLATFORM_EMAC_BASEADDR))
{
xil_printf("Error adding N/W interface\n\r");
return -1;
}
netif_set_default(echo_netif);
/* specify that the network if is up */
netif_set_up(echo_netif);
#if (LWIP_DHCP==1)
/* Create a new DHCP client for this interface.
* Note: you must call dhcp_fine_tmr() and dhcp_coarse_tmr() at
* the predefined regular intervals after starting the client.
*/
dhcp_start(echo_netif);
dhcp_timoutcntr = 24;
while(((echo_netif->ip_addr.addr) == 0) && (dhcp_timoutcntr > 0))
xemacif_input(echo_netif);
if (dhcp_timoutcntr <= 0) {
if ((echo_netif->ip_addr.addr) == 0) {
xil_printf("DHCP Timeout\r\n");
xil_printf("Configuring default IP of 192.168.100.110\r\n");
IP4_ADDR(&(echo_netif->ip_addr), 192, 168, 100, 110);
IP4_ADDR(&(echo_netif->netmask), 255, 255, 255, 0);
IP4_ADDR(&(echo_netif->gw), 192, 168, 100, 1);
}
}
ipaddr.addr = echo_netif->ip_addr.addr;
gw.addr = echo_netif->gw.addr;
netmask.addr = echo_netif->netmask.addr;
#endif
print_ip_settings(&ipaddr, &netmask, &gw);
//LWIP Related Init END
xil_printf("=====================\r\n[I] System Init Done!\r\n");
xil_printf("[D] Start EMIO Config\r\n");
EMIO_config();
@@ -95,20 +173,36 @@ int main()
xil_printf("[I] Board Init Complete!\r\n[I] Waiting for Command...\r\n");
/* start the application (web server, rxtest, txtest, etc..) */
start_application();
/* receive and process Instructions */
while (1)
if (iMainCom == 1)
{
int Status = -255;
Status = UART_RecvInstr(recvbuffer);
if (Status < 0)
{
xil_printf("[E] UART Receive ERROR!!! Check PrintOut Ahead\r\n");
print_app_header();
while (1) {
tcp_tmr();
xemacif_input(echo_netif);
transfer_data();
}
else if (Status > 0)
}
else
{
while (1)
{
Command_Parser(recvbuffer,Status); //Here Status should equal to length
int Status = -255;
Status = UART_RecvInstr(recvbuffer);
if (Status < 0)
{
xil_printf("[E] UART Receive ERROR!!! Check PrintOut Ahead\r\n");
}
else if (Status > 0)
{
Command_Parser(recvbuffer,Status); //Here Status should equal to length
}
}
}
/* never reached */
@@ -116,4 +210,3 @@ int main()
return 0;
}