URL
https://opencores.org/ocsvn/openrisc_me/openrisc_me/trunk
Subversion Repositories openrisc_me
[/] [openrisc/] [trunk/] [gnu-src/] [gdb-7.2/] [sim/] [cris/] [rvdummy.c] - Rev 438
Go to most recent revision | Compare with Previous | Blame | View Log
/* Test-driver for the remote-virtual-component simulator framework for GDB, the GNU Debugger. Copyright 2006, 2007, 2008, 2009, 2010 Free Software Foundation, Inc. This file is part of GDB. This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 3 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program. If not, see <http://www.gnu.org/licenses/>. */ /* Avoid any problems whatsoever building this program if we're not also building hardware support. */ #if !WITH_HW int main (int argc, char *argv[]) { return 2; } #else #ifdef HAVE_CONFIG_H #include "cconfig.h" #include "tconfig.h" #endif #include "getopt.h" #include "libiberty.h" #define _GNU_SOURCE #include <stdio.h> #ifdef HAVE_UNISTD_H #include <unistd.h> #endif #ifdef HAVE_STDLIB_H #include <stdlib.h> #endif #ifdef HAVE_STRING_H #include <string.h> #endif #ifdef HAVE_SYS_TYPES_H #include <sys/types.h> #endif #ifdef HAVE_SYS_TIME_H #include <sys/time.h> #endif #ifdef HAVE_SYS_SELECT_H #include <sys/select.h> #endif #ifdef HAVE_ERRNO_H #include <errno.h> #endif /* Not guarded in dv-sockser.c, so why here. */ #include <netinet/in.h> #include <arpa/inet.h> #include <netdb.h> #include <sys/socket.h> enum rv_command { RV_READ_CMD = 0, RV_WRITE_CMD = 1, RV_IRQ_CMD = 2, RV_MEM_RD_CMD = 3, RV_MEM_WR_CMD = 4, RV_MBOX_HANDLE_CMD = 5, RV_MBOX_PUT_CMD = 6, RV_WATCHDOG_CMD = 7 }; enum opts { OPT_PORT = 1, OPT_TIMEOUT, OPT_VERBOSE }; struct option longopts[] = { {"port", required_argument, NULL, OPT_PORT}, {"timeout", required_argument, NULL, OPT_TIMEOUT}, {"verbose", no_argument, NULL, OPT_VERBOSE}, {NULL, 0, NULL, 0} }; int port = 10000; time_t timeout = 30000; char *progname = "(unknown)"; int verbose = 0; /* Required forward-declarations. */ static void handle_input_file (int, char *); /* Set up a "server" listening to the port in PORT for a raw TCP connection. Return a file descriptor for the connection or -1 on error. */ int setupsocket (void) { int s; socklen_t len; int reuse = 1; struct sockaddr_in sa_in; struct sockaddr_in from; len = sizeof (from); memset (&from, 0, len); memset (&sa_in, 0, sizeof (sa_in)); s = socket (AF_INET, SOCK_STREAM, 0); if (s == -1) return -1; if (setsockopt (s, SOL_SOCKET, SO_REUSEADDR, &reuse, sizeof reuse) != 0) return -1; sa_in.sin_port = htons (port); sa_in.sin_family = AF_INET; if (bind (s, (struct sockaddr *) & sa_in, sizeof sa_in) < 0) return -1; if (listen (s, 1) < 0) return -1; return accept (s, (struct sockaddr *) &from, &len); } /* Basic host-to-little-endian 32-bit value. Could use the BFD machinery, but let's avoid it for this only dependency. */ static void h2le32 (unsigned char *dest, unsigned int val) { dest[0] = val & 255; dest[1] = (val >> 8) & 255; dest[2] = (val >> 16) & 255; dest[3] = (val >> 24) & 255; } /* Send a blob of data. */ static void send_output (int fd, unsigned char *buf, int nbytes) { while (nbytes > 0) { ssize_t written = write (fd, buf, nbytes); if (written < 0) { fprintf (stderr, "%s: write to socket failed: %s\n", progname, strerror (errno)); exit (2); } nbytes -= written; } } /* Receive a blob of data, NBYTES large. Compare to the first NCOMP bytes of BUF; if not a match, write error message to stderr and exit (2). Else put it in buf. */ static void expect_input (int fd, unsigned char *buf, int nbytes, int ncomp) { unsigned char byt; int i; for (i = 0; i < nbytes; i++) { int r; do { errno = 0; r = read (fd, &byt, 1); } while (r <= 0 && (r == 0 || errno == EAGAIN)); if (r != 1) { fprintf (stderr, "%s: read from socket failed: %s", progname, strerror (errno)); exit (2); } if (i < ncomp && byt != buf[i]) { int j; fprintf (stderr, "%s: unexpected input,\n ", progname); if (i == 0) fprintf (stderr, "nothing,"); else for (j = 0; j < i; j++) fprintf (stderr, "%02x", buf[j]); fprintf (stderr, "\nthen %02x instead of %02x\n", byt, buf[i]); exit (2); } else buf[i] = byt; } } /* Handle everything about a nil-terminated line of input. Call exit (2) on error with error text on stderr. */ static void handle_input (int fd, char *buf, char *fname, int lineno) { int nbytes = 0; int n = -1; char *s = buf + 2; unsigned int data; static unsigned char bytes[1024]; int i; memset (bytes, 0, sizeof bytes); lineno++; if (buf[1] != ',') goto syntax_error; switch (buf[0]) { /* Comment characters and empty lines. */ case 0: case '!': case '#': break; /* Include another file. */ case '@': handle_input_file (fd, s); break; /* Raw input (to be expected). */ case 'i': do { n = -1; sscanf (s, "%02x%n", &data, &n); s += n; if (n > 0) bytes[nbytes++] = data; } while (n > 0); expect_input (fd, bytes, nbytes, nbytes); if (verbose) { printf ("i,"); for (i = 0; i < nbytes; i++) printf ("%02x", bytes[i]); printf ("\n"); } break; /* Raw output (to be written). */ case 'o': do { n = -1; sscanf (s, "%02x%n", &data, &n); if (n > 0) { s += n; bytes[nbytes++] = data; } } while (n > 0); if (*s != 0) goto syntax_error; send_output (fd, bytes, nbytes); if (verbose) { printf ("o,"); for (i = 0; i < nbytes; i++) printf ("%02x", bytes[i]); printf ("\n"); } break; /* Read a register. */ case 'r': { unsigned int addr; sscanf (s, "%x,%x%n", &addr, &data, &n); if (n < 0 || s[n] != 0) goto syntax_error; bytes[0] = 11; bytes[1] = 0; bytes[2] = RV_READ_CMD; h2le32 (bytes + 3, addr); expect_input (fd, bytes, 11, 7); h2le32 (bytes + 7, data); send_output (fd, bytes, 11); if (verbose) printf ("r,%x,%x\n", addr, data); } break; /* Write a register. */ case 'w': { unsigned int addr; sscanf (s, "%x,%x%n", &addr, &data, &n); if (n < 0 || s[n] != 0) goto syntax_error; bytes[0] = 11; bytes[1] = 0; bytes[2] = RV_WRITE_CMD; h2le32 (bytes + 3, addr); h2le32 (bytes + 7, data); expect_input (fd, bytes, 11, 11); send_output (fd, bytes, 11); if (verbose) printf ("w,%x,%x\n", addr, data); } break; /* Wait for some milliseconds. */ case 't': { int del = 0; struct timeval to; sscanf (s, "%d%n", &del, &n); if (n < 0 || s[n] != 0 || del == 0) goto syntax_error; to.tv_sec = del / 1000; to.tv_usec = (del % 1000) * 1000; if (select (0, NULL, NULL, NULL, &to) != 0) { fprintf (stderr, "%s: problem waiting for %d ms:\n %s\n", progname, del, strerror (errno)); exit (2); } if (verbose) printf ("t,%d\n", del); } break; /* Expect a watchdog command. */ case 'W': if (*s != 0) goto syntax_error; bytes[0] = 3; bytes[1] = 0; bytes[2] = RV_WATCHDOG_CMD; expect_input (fd, bytes, 3, 3); if (verbose) printf ("W\n"); break; /* Send an IRQ notification. */ case 'I': sscanf (s, "%x%n", &data, &n); if (n < 0 || s[n] != 0) goto syntax_error; bytes[0] = 7; bytes[1] = 0; bytes[2] = RV_IRQ_CMD; h2le32 (bytes + 3, data); send_output (fd, bytes, 7); if (verbose) printf ("I,%x\n", data); break; /* DMA store (to CPU). */ case 's': { unsigned int addr; sscanf (s, "%x,%n", &addr, &n); if (n < 0 || s[n] == 0) goto syntax_error; s += n; do { n = -1; sscanf (s, "%02x%n", &data, &n); if (n > 0) { s += n; bytes[11 + nbytes++] = data; } } while (n > 0); if (*s != 0) goto syntax_error; h2le32 (bytes, nbytes + 11); bytes[2] = RV_MEM_WR_CMD; h2le32 (bytes + 3, addr); h2le32 (bytes + 7, nbytes); send_output (fd, bytes, nbytes + 11); if (verbose) { printf ("s,%x,", addr); for (i = 0; i < nbytes; i++) printf ("%02x", bytes[i]); printf ("\n"); } } break; /* DMA load (from CPU). */ case 'l': { unsigned int addr; sscanf (s, "%x,%n", &addr, &n); if (n < 0 || s[n] == 0) goto syntax_error; s += n; do { n = -1; sscanf (s, "%02x%n", &data, &n); if (n > 0) { s += n; bytes[11 + nbytes++] = data; } } while (n > 0); if (*s != 0) goto syntax_error; h2le32 (bytes, nbytes + 11); bytes[0] = 11; bytes[1] = 0; bytes[2] = RV_MEM_RD_CMD; h2le32 (bytes + 3, addr); h2le32 (bytes + 7, nbytes); send_output (fd, bytes, 11); bytes[0] = (nbytes + 11) & 255; bytes[1] = ((nbytes + 11) >> 8) & 255; expect_input (fd, bytes, nbytes + 11, nbytes + 11); if (verbose) { printf ("l,%x,", addr); for (i = 0; i < nbytes; i++) printf ("%02x", bytes[i]); printf ("\n"); } } break; syntax_error: default: fprintf (stderr, "%s: invalid command line in %s:%d:\n %s", progname, fname, lineno, strerror (errno)); exit (2); } } /* Loop over the contents of FNAME, using handle_input to parse each line. Errors to stderr, exit (2). */ static void handle_input_file (int fd, char *fname) { static char buf[2048] = {0}; int lineno = 0; FILE *f = fopen (fname, "r"); if (f == NULL) { fprintf (stderr, "%s: problem opening %s: %s\n", progname, fname, strerror (errno)); exit (2); } /* Let's cut the buffer short, so we always get a newline. */ while (fgets (buf, sizeof (buf) - 1, f) != NULL) { buf[strlen (buf) - 1] = 0; lineno++; handle_input (fd, buf, fname, lineno); } fclose (f); } int main (int argc, char *argv[]) { int optc; int fd; FILE *f; int i; progname = argv[0]; while ((optc = getopt_long (argc, argv, "", longopts, NULL)) != -1) switch (optc) { case OPT_PORT: port = atoi (optarg); break; case OPT_TIMEOUT: timeout = (time_t) atoi (optarg); break; case OPT_VERBOSE: verbose = 1; break; } fd = setupsocket (); if (fd == -1) { fprintf (stderr, "%s: problem setting up the connection: %s\n", progname, strerror (errno)); exit (2); } for (i = optind; i < argc; i++) handle_input_file (fd, argv[i]); /* FIXME: option-controlled test for remaining input? */ close (fd); return 1; } #endif
Go to most recent revision | Compare with Previous | Blame | View Log