2006-04-03 11:01:45 +08:00
|
|
|
/* The remote-virtual-component simulator framework
|
|
|
|
for GDB, the GNU Debugger.
|
|
|
|
|
2017-01-01 14:50:51 +08:00
|
|
|
Copyright 2006-2017 Free Software Foundation, Inc.
|
2006-04-03 11:01:45 +08:00
|
|
|
|
|
|
|
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
|
2007-08-24 22:30:15 +08:00
|
|
|
the Free Software Foundation; either version 3 of the License, or
|
2006-04-03 11:01:45 +08:00
|
|
|
(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
|
2007-08-24 22:30:15 +08:00
|
|
|
along with this program. If not, see <http://www.gnu.org/licenses/>. */
|
2006-04-03 11:01:45 +08:00
|
|
|
|
|
|
|
|
|
|
|
#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. */
|
2010-05-27 06:40:24 +08:00
|
|
|
if (rv->fd == -1)
|
2006-04-03 11:01:45 +08:00
|
|
|
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);
|
|
|
|
|
2010-05-27 06:40:24 +08:00
|
|
|
if (rv->fd == -1)
|
2006-04-03 11:01:45 +08:00
|
|
|
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;
|
|
|
|
|
2010-05-27 06:40:24 +08:00
|
|
|
if (rv->fd == -1)
|
2006-04-03 11:01:45 +08:00
|
|
|
/* 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);
|
|
|
|
|
2010-05-27 06:40:24 +08:00
|
|
|
if (sock == -1)
|
2006-04-03 11:01:45 +08:00
|
|
|
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 }
|
|
|
|
};
|