added softpll debug tool (softpll_dbg_proxy)

b9e7a568 · Tomasz Wlostowski · Alessandro Rubini · c8fcda89 · b9e7a568 · b9e7a568
Commit b9e7a568 authored Mar 07, 2012 by Tomasz Wlostowski Committed by Alessandro Rubini Mar 11, 2012
Showing with 517 additions and 0 deletions

Makefile userspace/spll_dbg_proxy/Makefile +30 -0

softpll_regs.h userspace/spll_dbg_proxy/softpll_regs.h +251 -0

spll_dbg_proxy.c userspace/spll_dbg_proxy/spll_dbg_proxy.c +236 -0

No files found.
--- a/userspace/spll_dbg_proxy/Makefile
+++ b/userspace/spll_dbg_proxy/Makefile
+
+CC = $(CROSS_COMPILE)gcc
+
+OBJS = spll_dbg_proxy.o
+
+BINARY = spll_dbg_proxy
+
+# We must include stuff from wr_ipc, which is installed.
+# If this is build under build scripts, it's $WRS_OUTPUT_DIR/images/wr
+WR_INSTALL_ROOT ?= /usr/lib/white-rabbit
+WR_INCLUDE = $(WR_INSTALL_ROOT)/include
+WR_LIB = $(WR_INSTALL_ROOT)/lib
+
+CFLAGS = -g -Wall -DDEBUG \
+	-I. -I../../../ptp-noposix-v3/libwripc -I../include -I../3rdparty/include -I$(WR_INCLUDE)
+
+LDFLAGS = -L$(WR_INSTALL_ROOT)/lib -L../3rdparty/lib -L$(WR_LIB) \
+	-L../../../ptp-noposix-v3 -L../libswitchhw \
+	 -lwripc -llua -lm -ldl -lswitchhw
+
+all: $(BINARY)
+
+$(BINARY): $(OBJS)
+	$(CC) -o $@ $^ $(LDFLAGS)
+
+scp: all
+		scp $(BINARY) root@pts-test03:/tftpboot/192.168.1.2/root
+
+clean:
+		rm -f $(BINARY) $(OBJS)
\ No newline at end of file
--- a/userspace/spll_dbg_proxy/softpll_regs.h
+++ b/userspace/spll_dbg_proxy/softpll_regs.h
--- a/userspace/spll_dbg_proxy/spll_dbg_proxy.c
+++ b/userspace/spll_dbg_proxy/spll_dbg_proxy.c
+/* SoftPLL debug proxy
+
+	 Reads out the debug FIFO datastream from the SoftPLL and proxies it
+	 via TCP connection to the application running on an outside host, where
+	 the can be plotted, analyzed, etc.
+	 
+	 The debug stream contains run-time signals coming in/out the SoftPLL - for example,
+	 the phase/frequency errors on each channel, DAC drive values, phase tags. 
+
+	 Todo: poll the hardware FIFO through a driver with interrupt support
+*/
+	 
+#include <stdio.h>
+#include <stdint.h>
+#include <stdlib.h>
+#include <string.h>
+#include <unistd.h>
+#include <signal.h>
+
+#include <fcntl.h>
+#include <sys/socket.h>
+#include <arpa/inet.h>
+
+#include "hw/fpga_regs.h"
+#include "softpll_regs.h"
+
+/* TCP Port to listen on */
+#define MY_PORT 12345
+
+/* Size of the software FIFO ring buffer */
+#define RING_BUFFER_ENTRIES 1048576
+#define ENTRIES_PER_PACKET 128
+
+__attribute__((packed)) struct fifo_entry {
+	uint32_t value;
+	uint16_t seq_id;
+};
+
+/* 
+
+Simple ring buffer implementation. WARNING: NOT thread-safe 
+
+*/
+struct ring_buffer {
+	void *base;
+	int entry_size, num_entries;
+	int wr_ptr, rd_ptr, count;
+};
+
+
+int rbuf_init(struct ring_buffer *rbuf, int num_entries, int entry_size)
+{
+	rbuf->base = malloc(num_entries * entry_size);
+	if(!rbuf->base)
+		return -1;
+	
+	rbuf->entry_size = entry_size;
+	rbuf->num_entries = num_entries;
+	rbuf->wr_ptr = 0;
+	rbuf->rd_ptr = 0;
+	rbuf->count = 0;
+	return 0;	
+}
+
+void rbuf_push(struct ring_buffer *rbuf, void *what)
+{
+	if(rbuf->count >= rbuf->num_entries-1) /* buffer full */
+		return;
+	
+	rbuf->count++;
+	memcpy(rbuf->base + rbuf->wr_ptr*rbuf->entry_size, what, rbuf->entry_size);
+	rbuf->wr_ptr++;
+}
+
+int rbuf_pop(struct ring_buffer *rbuf, void *dst)
+{
+	if(!rbuf->count) /* buffer empty */
+		return 0;
+	
+	rbuf->count--;
+	memcpy(dst, rbuf->base + rbuf->rd_ptr*rbuf->entry_size, rbuf->entry_size);
+	rbuf->rd_ptr++;
+	return 1;
+}
+
+void rbuf_release(struct ring_buffer *rbuf)
+{
+	free(rbuf->base);
+}
+
+#define SPLL_BASE 0x10100
+
+struct ring_buffer spll_trace;
+static struct SPLL_WB *_spll_regs = (struct SPLL_WB*) SPLL_BASE;
+
+#define REG(x) ((uint32_t)(&_spll_regs->x))
+
+void poll_spll_fifo()
+{
+	
+	while(1) {
+
+/* Move the following lines (and the ring buffering code) to the driver. 
+
+	for the SPLL: IRQ = 3  (asserted when FIFO != empty)
+					base : check DFR_HOST register in softpll_regs.h
+	
+	device: /dev/spfifoX
+	parameters: base_addr, num_regs (r0, r1), irq
+	ioctls: 
+	
+*/
+
+		uint32_t csr =	_fpga_readl(REG(DFR_HOST_CSR));
+		struct fifo_entry ent;
+
+//		fprintf(stderr,"CSR %x\n", csr);
+		
+		if(csr & SPLL_DFR_HOST_CSR_EMPTY) break;
+
+		ent.value = _fpga_readl(REG(DFR_HOST_R0));
+		ent.seq_id = _fpga_readl(REG(DFR_HOST_R1)) & 0xffff;
+
+
+	//	fprintf(stderr, "v: %x\n", ent.value);
+
+		rbuf_push(&spll_trace, (void *)&ent);
+	}
+}
+
+static int proxy_done = 0;
+
+void sighandler(int sig)
+{
+	if(sig == SIGPIPE)
+	{
+		fprintf(stderr,"Connection broken. Killing proxy\n");
+		proxy_done = 1;	
+	}
+}
+
+
+void proxy_stuff(int fd)
+{
+	if(	rbuf_init(&spll_trace, RING_BUFFER_ENTRIES, sizeof(struct fifo_entry)) < 0)
+	{
+		perror("rbuf_init()");
+		return -1;
+	}
+
+	fprintf(stderr,"Connection accepted.\n");
+	proxy_done = 0;
+	signal(SIGPIPE, sighandler);
+
+	for(;;)
+	{
+		poll_spll_fifo();	
+		
+		while(spll_trace.count > ENTRIES_PER_PACKET)
+		{
+			struct fifo_entry tx_buf[ENTRIES_PER_PACKET];
+			int i;
+			
+			for(i=0;i<ENTRIES_PER_PACKET;i++)
+				rbuf_pop(&spll_trace, &tx_buf[i]); /* fixme: make endian-independent */
+
+			if(proxy_done)
+			{
+				rbuf_release(&spll_trace);
+				return;
+			}
+
+			if(send(fd, tx_buf, sizeof(tx_buf), 0) <= 0)
+			{
+				fprintf(stderr,"Connection closed.\n");
+				rbuf_release(&spll_trace);
+				return;
+			}			
+		}
+//		fprintf(stderr,"Count :%d\n", spll_trace.count);
+		usleep(10000);
+	}
+	
+}
+
+extern void shw_fpga_mmap_init();
+
+int main(int argc, char *argv[])
+{
+		int sock_fd;
+		struct sockaddr_in sin;
+
+		shw_fpga_mmap_init();
+
+		if((sock_fd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP)) < 0)
+		{
+			perror("socket()");
+			return -1;
+		}
+
+		int yes = 1;
+		if (setsockopt(sock_fd,SOL_SOCKET,SO_REUSEADDR,&yes,sizeof(yes)) < 0) {
+			perror("setsockopt()");
+			return -1;
+		}
+		
+    sin.sin_family = AF_INET;                /* Internet address family */
+    sin.sin_addr.s_addr = htonl(INADDR_ANY); /* Any incoming interface */
+    sin.sin_port = htons(MY_PORT); 	
+
+    if (bind(sock_fd, (struct sockaddr *) &sin, sizeof(sin)) < 0)
+    {
+    	perror("bind()");
+    	return -1;
+    }
+
+    if (listen(sock_fd, 1) < 0)
+    {
+    	perror("listen()");
+			return -1;
+		}
+
+		
+		for(;;)
+		{
+			struct sockaddr_in client_addr;
+			socklen_t client_len = sizeof(client_addr);
+			int client_fd;
+		
+			if((client_fd = accept(sock_fd, (struct sockaddr *) &client_addr, &client_len)) > 0)
+				proxy_stuff(client_fd);
+				
+		}    	
+
+		return 0;
+}
\ No newline at end of file