diff options
Diffstat (limited to 'sim/cris/dv-rv.c')
| -rw-r--r-- | sim/cris/dv-rv.c | 1221 |
1 files changed, 0 insertions, 1221 deletions
diff --git a/sim/cris/dv-rv.c b/sim/cris/dv-rv.c deleted file mode 100644 index 30845e3..0000000 --- a/sim/cris/dv-rv.c +++ /dev/null @@ -1,1221 +0,0 @@ -/* The remote-virtual-component simulator framework - for GDB, the GNU Debugger. - - Copyright 2006 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 2 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, write to the Free Software - Foundation, Inc., 59 Temple Place - Suite 330, - Boston, MA 02111-1307, USA. */ - - -#include "sim-main.h" -#include "hw-main.h" - -#include "hw-tree.h" - -#include <ctype.h> - -#ifdef HAVE_ERRNO_H -#include <errno.h> -#endif - -#ifdef HAVE_STRING_H -#include <string.h> -#else -#ifdef HAVE_STRINGS_H -#include <strings.h> -#endif -#endif - -#ifdef HAVE_UNISTD_H -#include <unistd.h> -#endif -#ifdef HAVE_STDLIB_H -#include <stdlib.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 - -/* Not guarded in dv-sockser.c, so why here. */ -#include <netinet/in.h> -#include <arpa/inet.h> -#include <netdb.h> -#include <sys/socket.h> - - -/* DEVICE - - - rv - Remote Virtual component - - - DESCRIPTION - - - Socket connection to a remote simulator component, for example one - for testing a verilog construction. Protocol defined below. - - There is a set of 32-bit I/O ports, with a mapping from local to - remote addresses. There is a set of interrupts expressed as a - bit-mask, with a mapping from remote to local. There is a set of - memory ranges (actual memory defined elsewhere), also with a - mapping from remote to local addresses, that is expected to be - accessible to the remote simulator in 32-byte chunks (simulating - DMA). There is a mapping from remote cycles (or an appropriate - elsewhere defined time-slice) to local cycles. - - PROPERTIES - - reg = <address> <size> - The address (within the parent bus) that this device is to - be located. - - remote-reg = <remote-address> - The address of reg on the remote side. Defaults to 0. - - mem = <address> <size> - Specify an address-range (within the parent bus) that the remote - device can access. The memory is assumed to be already defined. - If there's no memory defined but the remote side asks for a memory - access, the simulation is aborted. - - remote-mem = <remote-address> - The address of mem on the remote side. Defaults to 0. - - mbox = <address> - Address of the mailbox interface. Writes to this address with the - local address of a mailbox command, a complete packet with length - and command; (4 or 6)) invokes the mailbox interface. Reads are - invalid. Replies are written to the same address. Address space - from <address> up-to-and-including <address>+3 is allocated. - - max-poll-ticks = <local-count> - Sets the maximum interval between polling the external component, - expressed in internal cycles. Defaults to 10000. - - watchdog-interval = <seconds> - Sets the wallclock seconds between watchdog packets sent to the - remote side (may be larger if there's no rv activity in that time). - Defaults to 30. If set to 0, no watchdog packets are sent. - - intnum = <local-int-0> <local-int-1> ... <local-int-31> - Defines a map from remote bit numbers to local values to be emitted - on the "int" port, with the external bit number as the ordinal - 1 - of the local translation. E.g. 43 121 would mean map external - (1<<0) to internal 43 and external (1<<1) to internal 121. The - default is unity; no translation. If more than one bit is set in - the remote interrupt word, the intmultiple property can be used to - control the translation. - - intmultiple = <intvalue> - When more than one bit is set in the remote interrupt word, you may - want to map this situation to a separate interrupt value. If this - property is non-zero, it is used as that value. If it is zero, the - local value for the "int" port is the bitwise-or of the translated - local values. - - host = <hostid> - The hostname or address where the simulator to be used listens. - Defaults to "127.0.0.1" - - port = <portnumber> - The hostname or address where the simulator to be used listens. - Defaults to 10000. - - dummy = <value> - or - dummy = <filename> - Don't connect to a remote side; use initial dummy contents from - <filename> (which has to be at least as big as the <size> argument - of reg above) or filled with byte-value <value>. Mailboxes are not - supported (can be defined but can not be used) and remote-memory - accesses don't apply. The main purpose for this property is to - simplify use of configuration and simulated hardware that is - e.g. only trivially initialized but not actually used. - - - PORTS - - int (output) - Driven as a result of a remote interrupt request. The value is a - 32-bit bitset of active interrupts. - - - BUGS - - All and none. - - - PROTOCOL - - This is version 1.0 of this protocol, defining packet format and - actions in a supposedly upward-compatible manner where client and - servers of different versions are expected to interoperate; the - format and the definitions below are hopefully generic enough to - allow this. - - Each connection has a server and a client (this code); the roles - are known beforehand. The client usually corresponds to a CPU and - memory system and the server corresponds to a memory-mapped - register hardware interface and/or a DMA controller. They - communicate using packets with specific commands, of which some - require replies from the other side; most are intiated by the - client with one exception. A reply uses the same format as the - command. - - Packets are at least three bytes long, where the first two bytes - form a header, a 16-bit little-endian number that is the total - length of the packet including the header. There is also a - one-byte command. The payload is optional, depending on the - command. - - [[16-bit-low-byte-of-length] [16-bit-high-byte-of-length] - [command/reply] [payload byte 0] [payload byte 1] - ... [payload byte (length-of-packet - 3)]] - - Commands: - - A client or server that reads an undocumented command may exit with - a hard error. Payload not defined or disallowed below is ignored. - - It is expected that future client versions find out the version of - the server side by polling with base commands, assuming earlier - versions if a certain reply isn't seen, with newly defined payload - parts where earlier versions left it undefined. New commands and - formats are sent only to the other side after the client and server - has found out each others version. Not all servers support all - commands; the type of server and supported set of commands is - expected to be known beforehand. - - RV_READ_CMD = 0 - Initiated by the client, requires a reply from the server. The - payload from the client is at least 4 bytes, forming a 4-byte - little-endian address, the rest being undefined. The reply from - the server is at least 8 bytes, forming the same address data as in - the request and the second 4-byte data being the little-endian - contents. - - RV_WRITE_CMD = 1 - Initiated by the client, requires a reply from the server. Payload - from the client is at least 8 bytes, forming a 4-byte little-endian - word being the address, the rest being the little-endian contents - to write. The reply from the server is 8 bytes unless elsewhere - agreed otherwise, forming the same address and data as in the - request. The data sent back may have been altered to correspond to - defined parts but can safely be discarded. - - RV_IRQ_CMD = 2 - Initiated by the server, no reply. The payload is 4 bytes, forming - a little-endian word with bits numbers corresponding to currently - active interrupt sources; value (1<<N) indicating interrupt source - N being active. - - RV_MEM_RD_CMD = 3 - Initiated by the server, requires a reply. A client must know - beforehand when (in command sequence or constant) the server can - send this command and if so must then not send any commands of its - own (including watchdog commands); the server is allowed to assume - that incoming data is only replies to this command. The format is - 8 bytes of data; 4 bytes of little-endian address followed by a - 32-bit little endian word with the number of bytes to read. The - reply is the same address and number of bytes, followed by the data - that had been read. - - RV_MEM_WR_CMD = 4 - Initiated by the server, no reply. The format is the same as a - reply to RV_MEM_RD_CMD; a 32-bit little-endian address, followed by - the 32-bit little-endian number of bytes to write (redundant - information but must be consistent with the packet header). - - RV_MBOX_HANDLE_CMD = 5 - Initiated by the client, requires a reply. The payload is 4 - undefined bytes followed by an binary blob, the size of the - blob given by the packet header. The reply is a 32-bit little - endian number at the same index as the undefined bytes. Actual - semantics are application-specific. - - RV_MBOX_PUT_CMD = 6 - Initiated by the client, requires a reply, with the reply using the - RV_MBOX_HANDLE_CMD reply format (i.e. *both* that command and - 32-bit little-endian number). The payload is a 32-bit little - endian number followed by an undefined payload, at most 20 bytes - long. The reply is a 32-bit little endian number. Actual - semantics are application-specific. - - RV_WATCHDOG_CMD = 7 - Initiated by the client, no reply. A version 1.0 client sends no - payload; a version 1.0 server should ignore any such payload. A - version 1.0 server must not send a reply. - - - Possible future enhancements: - - Synchronization; server and client reports the number of elapsed - cycles (unit to-be-defined) at each request or notification. - Pretty much the top-of-the-todo-list item. - - Large addresses; 1.0 being restricted to 32-bit addresses. - - Variable-size data; currently restricted to 32-bit register - accesses. - - Specified data endianness (not the packet header) perhaps as part - of an initial format request; currently little-endian only. - - - Usage notes: - When used with servers sending RV_MEM_RD_CMD but being - narrow-minded about indata, set watchdog-interval to 0. Use - multiple rv instances when there are e.g. separate register and - memory servers. Alway log, setting "/rv/trace? true", at the - development phase. Borrow from the test-suite. - */ - -#define RV_FAMILY_NAME "rv" - -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 -}; - - -typedef struct _hw_rv_device -{ - /* Mapping of remote interrupt bit-numbers to local ones. */ - unsigned32 remote_to_local_int[32]; - - /* When multiple bits are set, a non-zero value here indicates that - this value should be used instead. */ - unsigned32 intmultiple; - - /* Local address of registers. */ - unsigned32 reg_address; - - /* Size of register bank in bytes. */ - unsigned32 reg_size; - - /* Remote address of registers. */ - unsigned32 remote_reg_address; - - /* Local address of DMA:able memory. */ - unsigned32 mem_address; - - /* Size of DMA:able memory in bytes. */ - unsigned32 mem_size; - - /* Bitmask for valid DMA request size. */ - unsigned32 mem_burst_mask; - - /* Remote address of DMA:able memory. */ - unsigned32 remote_mem_address; - - /* (Local) address of mbox; where to put a pointer to the mbox to be - sent. */ - unsigned32 mbox_address; - - /* Probably not 127.0.0.1:10000. */ - const char *host; - int port; - - /* If non-NULL, points to memory to use instead of connection. */ - unsigned8 *dummy; - - /* File descriptor for the socket. Set to -1 when error. Only one - of dummy and this is active. */ - int fd; - - /* Stashed errno, as we don't emit an error right away. */ - int saved_errno; - - /* This, plus latency because the CPU might not be checking until a - CTI insn (usually a branch or a jump) is the interval in cycles - between the rv is polled for e.g. DMA requests. */ - unsigned32 max_tick_poll_interval; - - /* Running counter for exponential backoff up to - max_tick_poll_interval to avoid polling the connection - unnecessarily often. Set to 1 when rv activity (read/write - register, DMA request) is detected. */ - unsigned32 next_period; - - /* This is the interval in wall-clock seconds between watchdog - packets are sent to the remote side. Zero means no watchdog - packets. */ - unsigned32 watchdog_interval; - - /* Last time we sent a watchdog packet. */ - struct timeval last_wdog_time; - - /* Mostly used as a kludge for knowing which rv:s have poll events - active. */ - struct hw_event *poll_callback; -} hw_rv_device; - - -/* We might add ports in the future, so keep this an enumeration. */ -enum - { - INT_PORT - }; - -/* Our ports. */ -static const struct hw_port_descriptor hw_rv_ports[] = { - { "int", INT_PORT, 0, output_port }, - { NULL } -}; - -/* Send LEN bytes of data from BUF to the socket. Abort on - errors. */ - -static void -hw_rv_write (struct hw *me, - void *buf, - unsigned int len) -{ - hw_rv_device *rv = (hw_rv_device *) hw_data (me); - unsigned8 *bufp = buf; - - /* If we don't have a valid fd here, it's because we got an error - initially, and we suppressed that error. */ - if (rv->fd < 0) - hw_abort (me, "couldn't open a connection to %s:%d because: %s", - rv->host, rv->port, strerror (rv->saved_errno)); - - while (len > 0) - { - ssize_t ret = write (rv->fd, bufp, len); - if (ret < 0) - /* FIXME: More graceful exit. */ - hw_abort (me, "write to %s:%d failed: %s\n", rv->host, rv->port, - strerror (errno)); - - len -= ret; - bufp += ret; - } -} - -/* Read LEN bytes of data into BUF from the socket. Set the file - descriptor to -1 if there's an error. */ - -static void -hw_rv_read (struct hw *me, - void *buf, - unsigned int len) -{ - hw_rv_device *rv = (hw_rv_device *) hw_data (me); - unsigned8 *bufp = buf; - - while (len > 0) - { - ssize_t ret = read (rv->fd, bufp, len); - - /* We get all zero if the remote end quits, but no error - indication; even select says there's data active. */ - if (ret <= 0) - { - if (close (rv->fd) != 0) - /* FIXME: More graceful exit. */ - hw_abort (me, "read from %s:%d failed: %d\n", rv->host, rv->port, errno); - rv->fd = -1; - return; - } - - len -= ret; - bufp += ret; - } -} - -/* Construct and send a packet of data of type CMD and len - LEN_NOHEADER (not counting the header...). */ - -static void -hw_rv_send (struct hw *me, - unsigned int cmd, - void *msg, - unsigned int len_noheader) -{ - hw_rv_device *rv = (hw_rv_device *) hw_data (me); - unsigned8 buf[32+3]; - unsigned8 *bufp; - unsigned int len = len_noheader + 3; - int ret; - - buf[0] = len & 255; - buf[1] = (len >> 8) & 255; - buf[2] = cmd; - - if (len > sizeof (buf)) - { - hw_rv_write (me, buf, 3); - len = len_noheader; - bufp = msg; - } - else - { - memcpy (buf + 3, msg, len_noheader); - bufp = buf; - } - - hw_rv_write (me, bufp, len); -} - -/* Handle incoming DMA requests as per the RV_MEM_RD_CMD packet. - Abort on errors. */ - -static void -hw_rv_read_mem (struct hw *me, unsigned int len) -{ - hw_rv_device *rv = (hw_rv_device *) hw_data (me); - /* If you change this size, please adjust the mem2 testcase. */ - unsigned8 buf[32+8]; - unsigned8 *bufp = buf; - unsigned32 leaddr; - unsigned32 addr; - unsigned32 lelen; - unsigned32 i; - - if (len != 8) - hw_abort (me, "expected DMA read request len 8+3, got %d+3", len); - - hw_rv_read (me, &leaddr, 4); - hw_rv_read (me, &lelen, 4); - len = LE2H_4 (lelen); - addr = LE2H_4 (leaddr); - - if (addr < rv->remote_mem_address - || addr >= rv->remote_mem_address + rv->mem_size) - hw_abort (me, "DMA read at remote 0x%x; outside [0x%x..0x%x-1]", - (unsigned) addr, (unsigned) rv->remote_mem_address, - (unsigned) (rv->remote_mem_address + rv->mem_size)); - addr = addr - rv->remote_mem_address + rv->mem_address; - - if (len == 0) - hw_abort (me, "DMA read request for 0 bytes isn't supported"); - - if (len & ~rv->mem_burst_mask) - hw_abort (me, "DMA trying to read %d bytes; not matching mask of 0x%x", - len, rv->mem_burst_mask); - if (len + 8 > sizeof (buf)) - bufp = hw_malloc (me, len + 8); - - HW_TRACE ((me, "DMA R 0x%x..0x%x", addr, addr + len -1)); - hw_dma_read_buffer (me, bufp + 8, 0, addr, len); - if (hw_trace_p (me)) - for (i = 0; i < len; i += 4) - HW_TRACE ((me, "0x%x: %02x %02x %02x %02x", - addr + i, - bufp[i+8], bufp[i+9], bufp[i+10], bufp[i+11])); - - memcpy (bufp, &leaddr, 4); - memcpy (bufp + 4, &lelen, 4); - hw_rv_send (me, RV_MEM_RD_CMD, bufp, len + 8); - if (bufp != buf) - hw_free (me, bufp); -} - -/* Handle incoming DMA requests as per the RV_MEM_WR_CMD packet. - Abort on errors. */ - -static void -hw_rv_write_mem (struct hw *me, unsigned int plen) -{ - hw_rv_device *rv = (hw_rv_device *) hw_data (me); - /* If you change this size, please adjust the mem2 testcase. */ - unsigned8 buf[32+8]; - unsigned8 *bufp = buf; - unsigned32 leaddr; - unsigned32 addr; - unsigned32 lelen; - unsigned32 len; - unsigned32 i; - - hw_rv_read (me, &leaddr, 4); - hw_rv_read (me, &lelen, 4); - len = LE2H_4 (lelen); - addr = LE2H_4 (leaddr); - - if (len != plen - 8) - hw_abort (me, - "inconsistency in DMA write request packet: " - "envelope %d+3, inner %d bytes", plen, len); - - if (addr < rv->remote_mem_address - || addr >= rv->remote_mem_address + rv->mem_size) - hw_abort (me, "DMA write at remote 0x%x; outside [0x%x..0x%x-1]", - (unsigned) addr, (unsigned) rv->remote_mem_address, - (unsigned) (rv->remote_mem_address + rv->mem_size)); - - addr = addr - rv->remote_mem_address + rv->mem_address; - if (len == 0) - hw_abort (me, "DMA write request for 0 bytes isn't supported"); - - if (len & ~rv->mem_burst_mask) - hw_abort (me, "DMA trying to write %d bytes; not matching mask of 0x%x", - len, rv->mem_burst_mask); - if (len + 8 > sizeof (buf)) - bufp = hw_malloc (me, len + 8); - - hw_rv_read (me, bufp + 8, len); - HW_TRACE ((me, "DMA W 0x%x..0x%x", addr, addr + len - 1)); - hw_dma_write_buffer (me, bufp + 8, 0, addr, len, 0); - if (hw_trace_p (me)) - for (i = 0; i < len; i += 4) - HW_TRACE ((me, "0x%x: %02x %02x %02x %02x", - addr + i, - bufp[i+8], bufp[i+9], bufp[i+10], bufp[i+11])); - if (bufp != buf) - hw_free (me, bufp); -} - -static void -hw_rv_irq (struct hw *me, unsigned int len) -{ - hw_rv_device *rv = (hw_rv_device *) hw_data (me); - unsigned32 intbitsle; - unsigned32 intbits_ext; - unsigned32 intval = 0; - int i; - - if (len != 4) - hw_abort (me, "IRQ with %d data not supported", len); - - hw_rv_read (me, &intbitsle, 4); - intbits_ext = LE2H_4 (intbitsle); - for (i = 0; i < 32; i++) - if ((intbits_ext & (1 << i)) != 0) - intval |= rv->remote_to_local_int[i]; - if ((intbits_ext & ~(intbits_ext - 1)) != intbits_ext - && rv->intmultiple != 0) - intval = rv->intmultiple; - - HW_TRACE ((me, "IRQ 0x%x", intval)); - hw_port_event (me, INT_PORT, intval); -} - -/* Handle incoming interrupt notifications as per the RV_IRQ_CMD - packet. Abort on errors. */ - -static void -hw_rv_handle_incoming (struct hw *me, - int expected_type, - unsigned8 *buf, - unsigned int *return_len) -{ - hw_rv_device *rv = (hw_rv_device *) hw_data (me); - unsigned8 cbuf[32]; - unsigned int len; - unsigned int cmd; - - while (1) - { - hw_rv_read (me, cbuf, 3); - - if (rv->fd < 0) - return; - - len = cbuf[0] + cbuf[1] * 256 - 3; - cmd = cbuf[2]; - - /* These come in "asynchronously"; not as a reply. */ - switch (cmd) - { - case RV_IRQ_CMD: - hw_rv_irq (me, len); - break; - - case RV_MEM_RD_CMD: - hw_rv_read_mem (me, len); - break; - - case RV_MEM_WR_CMD: - hw_rv_write_mem (me, len); - break; - } - - /* Something is incoming from the other side, so tighten up all - slack at the next wait. */ - rv->next_period = 1; - - switch (cmd) - { - case RV_MEM_RD_CMD: - case RV_MEM_WR_CMD: - case RV_IRQ_CMD: - /* Don't try to handle more than one of these if we were'nt - expecting a reply. */ - if (expected_type == -1) - return; - continue; - } - - /* Require a match between this supposed-reply and the command - for the rest. */ - if (cmd != expected_type) - hw_abort (me, "unexpected reply, expected command %d, got %d", - expected_type, cmd); - - switch (cmd) - { - case RV_MBOX_PUT_CMD: - case RV_MBOX_HANDLE_CMD: - case RV_WRITE_CMD: - case RV_READ_CMD: - hw_rv_read (me, buf, len <= *return_len ? len : *return_len); - *return_len = len; - break; - } - break; - } -} - -/* Send a watchdog packet. Make a note of wallclock time. */ - -static void -hw_rv_send_wdog (struct hw *me) -{ - hw_rv_device *rv = (hw_rv_device *) hw_data (me); - HW_TRACE ((me, "WD")); - gettimeofday (&rv->last_wdog_time, NULL); - hw_rv_send (me, RV_WATCHDOG_CMD, "", 0); -} - -/* Poll the remote side: see if there's any incoming traffic; handle a - packet if so. Send a watchdog packet if it's time to do so. - Beware that the Linux select call indicates traffic for a socket - that the remote side has closed (which may be because it was - finished; don't hork until we need to write something just because - we're polling). */ - -static void -hw_rv_poll_once (struct hw *me) -{ - hw_rv_device *rv = (hw_rv_device *) hw_data (me); - fd_set rfds; - fd_set efds; - struct timeval now; - int ret; - struct timeval tv; - - if (rv->fd < 0) - /* Connection has died or was never initiated. */ - return; - - FD_ZERO (&rfds); - FD_SET (rv->fd, &rfds); - FD_ZERO (&efds); - FD_SET (rv->fd, &efds); - tv.tv_sec = 0; - tv.tv_usec = 0; - - ret = select (rv->fd + 1, &rfds, NULL, &efds, &tv); - gettimeofday (&now, NULL); - - if (ret < 0) - hw_abort (me, "select failed: %d\n", errno); - - if (rv->watchdog_interval != 0 - && now.tv_sec - rv->last_wdog_time.tv_sec >= rv->watchdog_interval) - hw_rv_send_wdog (me); - - if (FD_ISSET (rv->fd, &rfds)) - hw_rv_handle_incoming (me, -1, NULL, NULL); -} - -/* Initialize mapping of remote-to-local interrupt data. */ - -static void -hw_rv_map_ints (struct hw *me) -{ - hw_rv_device *rv = (hw_rv_device *) hw_data (me); - int i; - - for (i = 0; i < 32; i++) - rv->remote_to_local_int[i] = 1 << i; - - if (hw_find_property (me, "intnum") != NULL) - for (i = 0; i < 32; i++) - { - signed_cell val = -1; - if (hw_find_integer_array_property (me, "intnum", i, &val) > 0) - { - if (val > 0) - rv->remote_to_local_int[i] = val; - else - hw_abort (me, "property \"intnum@%d\" must be > 0; is %d", - i, (int) val); - } - } -} - -/* Handle the after-N-ticks "poll event", calling the poll-the-fd - method. Update the period. */ - -static void -do_poll_event (struct hw *me, void *data) -{ - hw_rv_device *rv = (hw_rv_device *) hw_data (me); - unsigned32 new_period; - - if (rv->dummy != NULL) - return; - - hw_rv_poll_once (me); - if (rv->fd >= 0) - rv->poll_callback - = hw_event_queue_schedule (me, rv->next_period, do_poll_event, NULL); - - new_period = rv->next_period * 2; - if (new_period <= rv->max_tick_poll_interval) - rv->next_period = new_period; -} - -/* HW tree traverse function for hw_rv_add_init. */ - -static void -hw_rv_add_poller (struct hw *me, void *data) -{ - hw_rv_device *rv; - - if (hw_family (me) == NULL - || strcmp (hw_family (me), RV_FAMILY_NAME) != 0) - return; - - rv = (hw_rv_device *) hw_data (me); - if (rv->poll_callback != NULL) - return; - - rv->poll_callback - = hw_event_queue_schedule (me, 1, do_poll_event, NULL); -} - -/* Simulator module init function for hw_rv_add_init. */ - -/* FIXME: For the call so hw_tree_traverse, we need to know that the - first member of struct sim_hw is the struct hw *root, but there's - no accessor method and struct sim_hw is defined in sim-hw.c only. - Hence this hack, until an accessor is added, or there's a traverse - function that takes a SIM_DESC argument. */ -struct sim_hw { struct hw *tree; }; - -static SIM_RC -hw_rv_add_rv_pollers (SIM_DESC sd) -{ - hw_tree_traverse (STATE_HW (sd)->tree, hw_rv_add_poller, NULL, NULL); - return SIM_RC_OK; -} - -/* We need to add events for polling, but we can't add one from the - finish-function, and there are no other call points, at least for - instances without "reg" (when there are just DMA requests from the - remote end; no locally initiated activity). Therefore we add a - simulator module init function, but those don't have private - payload arguments; just a SD argument. We cope by parsing the HW - root and making sure *all* "rv":s have poll callbacks installed. - Luckily, this is just an initialization step, and not many - simultaneous instances of rv are expected: we get a N**2 complexity - for visits to each rv node by this method. */ - -static void -hw_rv_add_init (struct hw *me) -{ - sim_module_add_init_fn (hw_system (me), hw_rv_add_rv_pollers); -} - -/* Open up a connection to the other side. Abort on errors. */ - -static void -hw_rv_init_socket (struct hw *me) -{ - hw_rv_device *rv = (hw_rv_device *) hw_data (me); - int sock; - struct sockaddr_in server; - - rv->fd = -1; - - if (rv->dummy != NULL) - return; - - memset (&server, 0, sizeof (server)); - server.sin_family = AF_INET; - server.sin_addr.s_addr = inet_addr (rv->host); - - /* Solaris 2.7 lacks this macro. */ -#ifndef INADDR_NONE -#define INADDR_NONE -1 -#endif - - if (server.sin_addr.s_addr == INADDR_NONE) - { - struct hostent *h; - h = gethostbyname (rv->host); - if (h != NULL) - { - memcpy (&server.sin_addr, h->h_addr, h->h_length); - server.sin_family = h->h_addrtype; - } - else - hw_abort (me, "can't resolve host %s", rv->host); - } - - server.sin_port = htons (rv->port); - sock = socket (AF_INET, SOCK_STREAM, 0); - - if (sock < 0) - hw_abort (me, "can't get a socket for %s:%d connection", - rv->host, rv->port); - - if (connect (sock, (struct sockaddr *) &server, sizeof server) >= 0) - { - rv->fd = sock; - - /* FIXME: init packet here. Maybe start packet too. */ - if (rv->watchdog_interval != 0) - hw_rv_send_wdog (me); - } - else - /* Stash the errno for later display, if some connection activity - is requested. Don't emit an error here; we might have been - called just for test purposes. */ - rv->saved_errno = errno; -} - -/* Local rv register reads end up here. */ - -static unsigned int -hw_rv_reg_read (struct hw *me, - void *dest, - int space, - unsigned_word addr, - unsigned int nr_bytes) -{ - hw_rv_device *rv = (hw_rv_device *) hw_data (me); - unsigned8 addr_data[8] = ""; - unsigned32 a_l = H2LE_4 (addr - rv->reg_address + rv->remote_reg_address); - unsigned int len = 8; - - if (nr_bytes != 4) - hw_abort (me, "must be four byte read"); - - if (addr == rv->mbox_address) - hw_abort (me, "invalid read of mbox address 0x%x", - (unsigned) rv->mbox_address); - - memcpy (addr_data, &a_l, 4); - HW_TRACE ((me, "REG R 0x%x", addr)); - if (rv->dummy != NULL) - { - len = 8; - memcpy (addr_data + 4, rv->dummy + addr - rv->reg_address, 4); - } - else - { - hw_rv_send (me, RV_READ_CMD, addr_data, len); - hw_rv_handle_incoming (me, RV_READ_CMD, addr_data, &len); - } - - if (len != 8) - hw_abort (me, "read %d != 8 bytes returned", len); - HW_TRACE ((me, ":= 0x%02x%02x%02x%02x", - addr_data[7], addr_data[6], addr_data[5], addr_data[4])); - memcpy (dest, addr_data + 4, 4); - return nr_bytes; -} - -/* Local rv mbox requests (handle or put) end up here. */ - -static void -hw_rv_mbox (struct hw *me, unsigned_word address) -{ - unsigned8 buf[256+3]; - unsigned int cmd; - unsigned int rlen; - unsigned32 i; - unsigned int len - = hw_dma_read_buffer (me, buf, 0, address, 3); - - if (len != 3) - hw_abort (me, "mbox read %d != 3 bytes returned", len); - - cmd = buf[2]; - if (cmd != RV_MBOX_HANDLE_CMD && cmd != RV_MBOX_PUT_CMD) - hw_abort (me, "unsupported mbox command %d", cmd); - - len = buf[0] + buf[1]*256; - - if (len > sizeof (buf)) - hw_abort (me, "mbox cmd %d send size %d unsupported", cmd, len); - - rlen = hw_dma_read_buffer (me, buf + 3, 0, address + 3, len - 3); - if (rlen != len - 3) - hw_abort (me, "mbox read %d != %d bytes returned", rlen, len - 3); - - HW_TRACE ((me, "MBOX %s 0x%x..0x%x", - cmd == RV_MBOX_HANDLE_CMD ? "H" : "P", - address, address + len - 1)); - for (i = 0; i < rlen; i += 8) - HW_TRACE ((me, "0x%x: %02x %02x %02x %02x %02x %02x %02x %02x", - address + 3 + i, - buf[3+i], buf[4+i], buf[5+i], buf[6+i], buf[7+i], buf[8+i], - buf[9+i], buf[10+i])); - - len -= 3; - hw_rv_send (me, cmd, buf + 3, len); - - /* Note: both ..._PUT and ..._HANDLE get the ..._HANDLE reply. */ - hw_rv_handle_incoming (me, RV_MBOX_HANDLE_CMD, buf + 3, &len); - if (len > sizeof (buf)) - hw_abort (me, "mbox cmd %d receive size %d unsupported", cmd, len); - HW_TRACE ((me, "-> 0x%x..0x%x", address, address + len + 3 - 1)); - for (i = 0; i < len; i += 8) - HW_TRACE ((me, "0x%x: %02x %02x %02x %02x %02x %02x %02x %02x", - address + 3 + i, - buf[3+i], buf[4+i], buf[5+i], buf[6+i], buf[7+i], buf[8+i], - buf[9+i], buf[10+i])); - - len += 3; - buf[0] = len & 255; - buf[1] = len / 256; - rlen = hw_dma_write_buffer (me, buf, 0, address, len, 0); - if (rlen != len) - hw_abort (me, "mbox write %d != %d bytes", rlen, len); -} - -/* Local rv register writes end up here. */ - -static unsigned int -hw_rv_reg_write (struct hw *me, - const void *source, - int space, - unsigned_word addr, - unsigned int nr_bytes) -{ - hw_rv_device *rv = (hw_rv_device *) hw_data (me); - - unsigned8 addr_data[8] = ""; - unsigned32 a_l = H2LE_4 (addr - rv->reg_address + rv->remote_reg_address); - unsigned int len = 8; - - if (nr_bytes != 4) - hw_abort (me, "must be four byte write"); - - memcpy (addr_data, &a_l, 4); - memcpy (addr_data + 4, source, 4); - - if (addr == rv->mbox_address) - { - unsigned32 mbox_addr_le; - if (rv->dummy != NULL) - hw_abort (me, "mbox not supported for a dummy instance"); - memcpy (&mbox_addr_le, source, 4); - hw_rv_mbox (me, LE2H_4 (mbox_addr_le)); - return nr_bytes; - } - - HW_TRACE ((me, "REG W 0x%x := 0x%02x%02x%02x%02x", addr, - addr_data[7], addr_data[6], addr_data[5], addr_data[4])); - if (rv->dummy != NULL) - { - len = 8; - memcpy (rv->dummy + addr - rv->reg_address, addr_data + 4, 4); - } - else - { - hw_rv_send (me, RV_WRITE_CMD, addr_data, len); - hw_rv_handle_incoming (me, RV_WRITE_CMD, addr_data, &len); - } - - if (len != 8) - hw_abort (me, "read %d != 8 bytes returned", len); - - /* We had an access: tighten up all slack. */ - rv->next_period = 1; - - return nr_bytes; -} - -/* Instance initializer function. */ - -static void -hw_rv_finish (struct hw *me) -{ - hw_rv_device *rv = HW_ZALLOC (me, hw_rv_device); - int i; - const struct hw_property *mem_prop; - const struct hw_property *dummy_prop; - const struct hw_property *mbox_prop; - - set_hw_data (me, rv); - -#undef RV_GET_IPROP -#undef RV_GET_PROP -#define RV_GET_PROP(T, N, M, D) \ - do \ - { \ - if (hw_find_property (me, N) != NULL) \ - rv->M = hw_find_ ## T ## _property (me, N); \ - else \ - rv->M = (D); \ - } \ - while (0) -#define RV_GET_IPROP(N, M, D) RV_GET_PROP (integer, N, M, D) - - RV_GET_PROP (string, "host", host, "127.0.0.1"); - RV_GET_IPROP ("port", port, 10000); - RV_GET_IPROP ("remote-reg", remote_reg_address, 0); - RV_GET_IPROP ("max-poll-ticks", max_tick_poll_interval, 10000); - RV_GET_IPROP ("watchdog-interval", watchdog_interval, 30); - RV_GET_IPROP ("remote-mem", remote_mem_address, 0); - RV_GET_IPROP ("mem-burst-mask", mem_burst_mask, 0xffff); - RV_GET_IPROP ("intmultiple", intmultiple, 0); - - set_hw_io_read_buffer (me, hw_rv_reg_read); - set_hw_io_write_buffer (me, hw_rv_reg_write); - set_hw_ports (me, hw_rv_ports); - rv->next_period = 1; - - /* FIXME: We only support zero or one reg and zero or one mem area. */ - if (hw_find_property (me, "reg") != NULL) - { - reg_property_spec reg; - if (hw_find_reg_array_property (me, "reg", 0, ®)) - { - unsigned_word attach_address; - int attach_space; - unsigned int attach_size; - - hw_unit_address_to_attach_address (hw_parent (me), - ®.address, - &attach_space, - &attach_address, - me); - rv->reg_address = attach_address; - hw_unit_size_to_attach_size (hw_parent (me), - ®.size, - &attach_size, me); - rv->reg_size = attach_size; - if ((attach_address & 3) != 0) - hw_abort (me, "register block must be 4 byte aligned"); - hw_attach_address (hw_parent (me), - 0, - attach_space, attach_address, attach_size, - me); - } - else - hw_abort (me, "property \"reg\" has the wrong type"); - } - - dummy_prop = hw_find_property (me, "dummy"); - if (dummy_prop != NULL) - { - if (rv->reg_size == 0) - hw_abort (me, "dummy argument requires a \"reg\" property"); - - if (hw_property_type (dummy_prop) == integer_property) - { - unsigned32 dummyfill = hw_find_integer_property (me, "dummy"); - unsigned8 *dummymem = hw_malloc (me, rv->reg_size); - memset (dummymem, dummyfill, rv->reg_size); - rv->dummy = dummymem; - } - else - { - const char *dummyarg = hw_find_string_property (me, "dummy"); - unsigned8 *dummymem = hw_malloc (me, rv->reg_size); - FILE *f = fopen (dummyarg, "rb"); - - if (f == NULL) - hw_abort (me, "opening dummy-file \"%s\": %s", - dummyarg, strerror (errno)); - if (fread (dummymem, 1, rv->reg_size, f) != rv->reg_size) - hw_abort (me, "reading dummy-file \"%s\": %s", - dummyarg, strerror (errno)); - fclose (f); - rv->dummy = dummymem; - } - } - - mbox_prop = hw_find_property (me, "mbox"); - if (mbox_prop != NULL) - { - if (hw_property_type (mbox_prop) == integer_property) - { - signed_cell attach_address_sc - = hw_find_integer_property (me, "mbox"); - - rv->mbox_address = (unsigned32) attach_address_sc; - hw_attach_address (hw_parent (me), - 0, - 0, (unsigned32) attach_address_sc, 4, me); - } - else - hw_abort (me, "property \"mbox\" has the wrong type"); - } - - mem_prop = hw_find_property (me, "mem"); - if (mem_prop != NULL) - { - signed_cell attach_address_sc; - signed_cell attach_size_sc; - - /* Only specific names are reg_array_properties, the rest are - array_properties. */ - if (hw_property_type (mem_prop) == array_property - && hw_property_sizeof_array (mem_prop) == 2 * sizeof (attach_address_sc) - && hw_find_integer_array_property (me, "mem", 0, &attach_address_sc) - && hw_find_integer_array_property (me, "mem", 1, &attach_size_sc)) - { - /* Unfortunate choice of types forces us to dance around a bit. */ - rv->mem_address = (unsigned32) attach_address_sc; - rv->mem_size = (unsigned32) attach_size_sc; - if ((attach_address_sc & 3) != 0) - hw_abort (me, "memory block must be 4 byte aligned"); - } - else - hw_abort (me, "property \"mem\" has the wrong type"); - } - - hw_rv_map_ints (me); - - hw_rv_init_socket (me); - - /* We need an extra initialization pass, after all others currently - scheduled (mostly, after the simulation events machinery has been - initialized so the events we want don't get thrown out). */ - hw_rv_add_init (me); -} - -/* Our root structure; see dv-* build machinery for usage. */ - -const struct hw_descriptor dv_rv_descriptor[] = { - { RV_FAMILY_NAME, hw_rv_finish }, - { NULL } -}; |