[mandelfpga.git] / readout.c

#include <string.h>
#include <SDL/SDL.h>

#define WIN_X 800
#define WIN_Y 600

char getone()
{
	unsigned char c;
	static char ring[2048];
	static int prod = 0, cons = 0;
	int oldcons;
	
	if (prod == cons)
	{
		int r;
		/* Try to read some. */
		while ((r = read(0, &(ring[prod]), 2048-prod)) == 0)
			usleep(250000);
		prod = (prod + r) % 2048;
	}
	oldcons = cons;
	cons = (cons + 1) % 2048;
	return ring[oldcons];
}

char *readline()
{
	static char s[2048];
	int i = 0;
	
	while (i < 2048)
	{
		s[i] = getone();
		if (s[i] == '\r' || s[i] == '\n')
		{
			s[i] = '\0';
			return s;
		}
		i++;
	}
	s[2047] = 0;
	return s;
}

struct vars {
	char *vname, *var, *sub;
	int val;
};

int *findvar(char *var, char *sub, struct vars *vars, int n)
{
	int i;
	for (i=0; i<n; i++)
		if (!strcmp(vars[i].var, var) && ((!sub && !vars[i].sub) || !strcmp(vars[i].sub, sub)))
			return &vars[i].val;
	printf("Unknown var: %s %s\n", var, sub);
	abort();
}

void main()
{
	char *s;
	struct vars vars[512];
	int nvars = 0;
	int readingdata = 0;
	SDL_Surface *screen;
	
	if (SDL_Init(SDL_INIT_VIDEO) < 0)
	{
		printf("SDL init failed: %s\n", SDL_GetError());
		return 1;
	}
	atexit(SDL_Quit);
	screen = SDL_SetVideoMode(WIN_X, WIN_Y, 24, SDL_SWSURFACE);
	if (!screen)
	{
		printf("Video init failed: %s\n", SDL_GetError());
	}
	
	while ((s = readline()))
	{
		if (s[0] == '$')
		{
			if (!strcmp(s, "$dumpvars"))
			{
				readingdata = 1;
				printf("Var dump begin on %d vars\n", nvars);
			} else if (!strncmp(s, "$var", 4)) {
				char *t;
				char *vname, *var, *sub;\
				t = strtok(s, " ");
				t = strtok(NULL, " ");
				t = strtok(NULL, " ");
				t = strtok(NULL, " ");
				vname = t;
				t = strtok(NULL, " ");
				var = t;
				t = strtok(NULL, " ");
				if (strcmp(t, "$end"))
					sub = t;
				else
					sub = NULL;
				printf("Found: %s -> %s %s\n", vname, var, sub);
				
				vars[nvars].vname = strdup(vname);
				vars[nvars].var = strdup(var);
				vars[nvars].sub = sub ? strdup(sub) : NULL;
				vars[nvars].val = 0;
				nvars++;
			}
		} else if (s[0] == '#' || !s[0])
			;
		else if (readingdata)
		{
			int val = (s[0] == '1');
			int i;
			int oldclk = *findvar("gclk", NULL, vars, nvars);
			static int pixn = 0;
			for (i=0; i<nvars; i++)
			{
				if (!strcmp(vars[i].vname, s+1))
				{
					vars[i].val = val;
					break;
				}
			}
			if (i == nvars)
				printf("Unknown: %s\n", s);
			if (*findvar("gclk", NULL, vars, nvars) != oldclk && oldclk == 1 && ((pixn++) % 2))
			{
				static int x = 0, y = 0;
				static int lasths;
				unsigned char *pixp;
				static int *r2 = NULL, *r1 = NULL, *r0 = NULL, *g2 = NULL, *g1 = NULL, *g0 = NULL, *b1 = NULL, *b0 = NULL, *vs = NULL, *hs = NULL;
				r2 = r2 ? r2 : findvar("red", "[2]", vars, nvars);
				r1 = r1 ? r1 : findvar("red", "[1]", vars, nvars);
				r0 = r0 ? r0 : findvar("red", "[0]", vars, nvars);
				g2 = g2 ? g2 : findvar("green", "[2]", vars, nvars);
				g1 = g1 ? g1 : findvar("green", "[1]", vars, nvars);
				g0 = g0 ? g0 : findvar("green", "[0]", vars, nvars);
				b1 = b1 ? b1 : findvar("blue", "[1]", vars, nvars);
				b0 = b0 ? b0 : findvar("blue", "[0]", vars, nvars);
				vs = vs ? vs : findvar("vs", NULL, vars, nvars);
				hs = hs ? hs : findvar("hs", NULL, vars, nvars);
				
				
				int r = *r2 << 7 | *r1 << 6 | *r0 << 5;
				int g = *g2 << 7 | *g1 << 6 | *g0 << 5;
				int b = *b1 << 7 | *b0 << 6;
				if (*vs)
					y = 0;
				else {
					if (*hs)
					{
						x = 0;
						if (!lasths)
						{
							y++;
							SDL_Flip(screen);
						}
					} else
						x++;
				}
				lasths = *hs;
				SDL_LockSurface(screen);
				pixp = screen->pixels + ((WIN_X * y + x) * 3);
				pixp[0] = b; pixp[1] = g; pixp[2] = r;
				SDL_UnlockSurface(screen);
				if ((x % 5) == 4)
					SDL_UpdateRect(screen, x/5*5, y, 5, 1);
			}
		}
	}
}
Commit	Line	Data
5930552f JW	1	#include <string.h>
	2	#include <SDL/SDL.h>
	3
834de336 JW	4	#define WIN_X 800
	5	#define WIN_Y 600
	6
	7	char getone()
	8	{
	9	unsigned char c;
	10	static char ring[2048];
	11	static int prod = 0, cons = 0;
	12	int oldcons;
	13
	14	if (prod == cons)
	15	{
	16	int r;
	17	/* Try to read some. */
	18	while ((r = read(0, &(ring[prod]), 2048-prod)) == 0)
	19	usleep(250000);
	20	prod = (prod + r) % 2048;
	21	}
	22	oldcons = cons;
	23	cons = (cons + 1) % 2048;
	24	return ring[oldcons];
	25	}
5930552f JW	26
	27	char *readline()
	28	{
	29	static char s[2048];
834de336 JW	30	int i = 0;
	31
	32	while (i < 2048)
	33	{
	34	s[i] = getone();
	35	if (s[i] == '\r' \|\| s[i] == '\n')
	36	{
	37	s[i] = '\0';
	38	return s;
	39	}
	40	i++;
	41	}
	42	s[2047] = 0;
	43	return s;
5930552f JW	44	}
	45
	46	struct vars {
	47	char vname, var, *sub;
	48	int val;
	49	};
	50
	51	int findvar(char var, char sub, struct vars vars, int n)
	52	{
	53	int i;
	54	for (i=0; i<n; i++)
	55	if (!strcmp(vars[i].var, var) && ((!sub && !vars[i].sub) \|\| !strcmp(vars[i].sub, sub)))
	56	return &vars[i].val;
	57	printf("Unknown var: %s %s\n", var, sub);
834de336	58	abort();
5930552f JW	59	}
	60
	61	void main()
	62	{
	63	char *s;
	64	struct vars vars[512];
	65	int nvars = 0;
	66	int readingdata = 0;
	67	SDL_Surface *screen;
	68
	69	if (SDL_Init(SDL_INIT_VIDEO) < 0)
	70	{
	71	printf("SDL init failed: %s\n", SDL_GetError());
	72	return 1;
	73	}
	74	atexit(SDL_Quit);
	75	screen = SDL_SetVideoMode(WIN_X, WIN_Y, 24, SDL_SWSURFACE);
	76	if (!screen)
	77	{
	78	printf("Video init failed: %s\n", SDL_GetError());
	79	}
	80
	81	while ((s = readline()))
	82	{
	83	if (s[0] == '$')
	84	{
	85	if (!strcmp(s, "$dumpvars"))
	86	{
	87	readingdata = 1;
	88	printf("Var dump begin on %d vars\n", nvars);
	89	} else if (!strncmp(s, "$var", 4)) {
	90	char *t;
	91	char vname, var, *sub;\
	92	t = strtok(s, " ");
	93	t = strtok(NULL, " ");
	94	t = strtok(NULL, " ");
	95	t = strtok(NULL, " ");
	96	vname = t;
	97	t = strtok(NULL, " ");
	98	var = t;
	99	t = strtok(NULL, " ");
	100	if (strcmp(t, "$end"))
	101	sub = t;
	102	else
	103	sub = NULL;
	104	printf("Found: %s -> %s %s\n", vname, var, sub);
	105
	106	vars[nvars].vname = strdup(vname);
	107	vars[nvars].var = strdup(var);
	108	vars[nvars].sub = sub ? strdup(sub) : NULL;
	109	vars[nvars].val = 0;
	110	nvars++;
	111	}
834de336	112	} else if (s[0] == '#' \|\| !s[0])
5930552f	113	;
834de336	114	else if (readingdata)
5930552f JW	115	{
	116	int val = (s[0] == '1');
	117	int i;
	118	int oldclk = *findvar("gclk", NULL, vars, nvars);
	119	static int pixn = 0;
	120	for (i=0; i<nvars; i++)
	121	{
	122	if (!strcmp(vars[i].vname, s+1))
	123	{
	124	vars[i].val = val;
	125	break;
	126	}
	127	}
	128	if (i == nvars)
	129	printf("Unknown: %s\n", s);
	130	if (*findvar("gclk", NULL, vars, nvars) != oldclk && oldclk == 1 && ((pixn++) % 2))
	131	{
	132	static int x = 0, y = 0;
	133	static int lasths;
	134	unsigned char *pixp;
	135	static int r2 = NULL, r1 = NULL, r0 = NULL, g2 = NULL, g1 = NULL, g0 = NULL, b1 = NULL, b0 = NULL, vs = NULL, hs = NULL;
	136	r2 = r2 ? r2 : findvar("red", "[2]", vars, nvars);
	137	r1 = r1 ? r1 : findvar("red", "[1]", vars, nvars);
	138	r0 = r0 ? r0 : findvar("red", "[0]", vars, nvars);
	139	g2 = g2 ? g2 : findvar("green", "[2]", vars, nvars);
	140	g1 = g1 ? g1 : findvar("green", "[1]", vars, nvars);
	141	g0 = g0 ? g0 : findvar("green", "[0]", vars, nvars);
	142	b1 = b1 ? b1 : findvar("blue", "[1]", vars, nvars);
	143	b0 = b0 ? b0 : findvar("blue", "[0]", vars, nvars);
	144	vs = vs ? vs : findvar("vs", NULL, vars, nvars);
	145	hs = hs ? hs : findvar("hs", NULL, vars, nvars);
	146
	147
	148	int r = r2 << 7 \| r1 << 6 \| *r0 << 5;
	149	int g = g2 << 7 \| g1 << 6 \| *g0 << 5;
	150	int b = b1 << 7 \| b0 << 6;
	151	if (*vs)
	152	y = 0;
	153	else {
	154	if (*hs)
	155	{
	156	x = 0;
	157	if (!lasths)
834de336	158	{
5930552f	159	y++;
834de336 JW	160	SDL_Flip(screen);
834de336 JW	161	}
5930552f JW	162	} else
	163	x++;
	164	}
	165	lasths = *hs;
	166	SDL_LockSurface(screen);
	167	pixp = screen->pixels + ((WIN_X * y + x) * 3);
	168	pixp[0] = b; pixp[1] = g; pixp[2] = r;
	169	SDL_UnlockSurface(screen);
	170	if ((x % 5) == 4)
	171	SDL_UpdateRect(screen, x/5*5, y, 5, 1);
	172	}
	173	}
	174	}
	175	}