FreeCalypso > hg > freecalypso-sw
view lcdemu/process.c @ 992:a7b0b426f9ca
target-utils: boot ROM UART autodetection revamped
The new implementation should work with both the familiar Calypso C035
boot ROM version found in our regular targets as well as the older
Calypso F741979B version found on the vintage D-Sample board.
author | Mychaela Falconia <falcon@ivan.Harhan.ORG> |
---|---|
date | Wed, 30 Dec 2015 21:28:41 +0000 |
parents | 7a189b7bbd67 |
children |
line wrap: on
line source
/* * Processing of LCD output (input to us) */ #include <stdio.h> #include <stdint.h> #include <stdlib.h> #include <ctype.h> #include <string.h> #include <strings.h> #include <X11/Xlib.h> #include <X11/Xresource.h> #include <X11/Xutil.h> #include "globals.h" #define MAX_WIDTH 176 static unsigned hexdecode(str) char *str; { unsigned accum = 0; int i, c, n; for (i = 0; i < 4; i++) { c = str[i]; if (isdigit(c)) n = c - '0'; else if (isupper(c)) n = c - 'A' + 10; else n = c - 'a' + 10; accum <<= 4; accum |= n; } return(accum); } process_input_line(line) char *line; { int blitrow, blitcol, npix; uint16_t pix16[MAX_WIDTH]; char *cp; XImage *xi; for (cp = line; isspace(*cp); cp++) ; if (!isdigit(*cp)) { inv: fprintf(stderr, "fc-lcdemu: invalid input line\n"); exit(1); } blitrow = atoi(cp); while (isdigit(*cp)) cp++; if (!isspace(*cp)) goto inv; while (isspace(*cp)) cp++; if (!isdigit(*cp)) goto inv; blitcol = atoi(cp); while (isdigit(*cp)) cp++; if (!isspace(*cp)) goto inv; while (isspace(*cp)) cp++; if (!isxdigit(*cp)) goto inv; for (npix = 0; *cp; ) { if (!isxdigit(cp[0]) || !isxdigit(cp[1]) || !isxdigit(cp[2]) || !isxdigit(cp[3])) goto inv; if (npix >= MAX_WIDTH) { fprintf(stderr, "fc-lcdemu error: input line exceeds MAX_WIDTH of %d pixels\n", MAX_WIDTH); exit(1); } pix16[npix++] = hexdecode(cp); cp += 4; } xi = convert_function(pix16, npix); XPutImage(mydisplay, mainwindow, mainwingc, xi, 0, 0, blitcol, blitrow, npix, 1); XDestroyImage(xi); } input_on_stdin(inbuf, incount) char *inbuf; { char *input_end = inbuf + incount; static char linebuf[1024]; static int linesz; char *cp; for (cp = inbuf; cp < input_end; cp++) { if (*cp == '\n') { linebuf[linesz] = '\0'; process_input_line(linebuf); linesz = 0; continue; } if (linesz < sizeof(linebuf) - 1) linebuf[linesz++] = *cp; } }