[qemu.git] / hw / mipsnet.c

#include "hw.h"
#include "mips.h"
#include "net.h"
#include "isa.h"

//#define DEBUG_MIPSNET_SEND
//#define DEBUG_MIPSNET_RECEIVE
//#define DEBUG_MIPSNET_DATA
//#define DEBUG_MIPSNET_IRQ

/* MIPSnet register offsets */

#define MIPSNET_DEV_ID		0x00
#define MIPSNET_BUSY		0x08
#define MIPSNET_RX_DATA_COUNT	0x0c
#define MIPSNET_TX_DATA_COUNT	0x10
#define MIPSNET_INT_CTL		0x14
# define MIPSNET_INTCTL_TXDONE		0x00000001
# define MIPSNET_INTCTL_RXDONE		0x00000002
# define MIPSNET_INTCTL_TESTBIT		0x80000000
#define MIPSNET_INTERRUPT_INFO	0x18
#define MIPSNET_RX_DATA_BUFFER	0x1c
#define MIPSNET_TX_DATA_BUFFER	0x20

#define MAX_ETH_FRAME_SIZE	1514

typedef struct MIPSnetState {
    uint32_t busy;
    uint32_t rx_count;
    uint32_t rx_read;
    uint32_t tx_count;
    uint32_t tx_written;
    uint32_t intctl;
    uint8_t rx_buffer[MAX_ETH_FRAME_SIZE];
    uint8_t tx_buffer[MAX_ETH_FRAME_SIZE];
    int io_base;
    qemu_irq irq;
    NICState *nic;
    NICConf conf;
} MIPSnetState;

static void mipsnet_reset(MIPSnetState *s)
{
    s->busy = 1;
    s->rx_count = 0;
    s->rx_read = 0;
    s->tx_count = 0;
    s->tx_written = 0;
    s->intctl = 0;
    memset(s->rx_buffer, 0, MAX_ETH_FRAME_SIZE);
    memset(s->tx_buffer, 0, MAX_ETH_FRAME_SIZE);
}

static void mipsnet_update_irq(MIPSnetState *s)
{
    int isr = !!s->intctl;
#ifdef DEBUG_MIPSNET_IRQ
    printf("mipsnet: Set IRQ to %d (%02x)\n", isr, s->intctl);
#endif
    qemu_set_irq(s->irq, isr);
}

static int mipsnet_buffer_full(MIPSnetState *s)
{
    if (s->rx_count >= MAX_ETH_FRAME_SIZE)
        return 1;
    return 0;
}

static int mipsnet_can_receive(VLANClientState *nc)
{
    MIPSnetState *s = DO_UPCAST(NICState, nc, nc)->opaque;

    if (s->busy)
        return 0;
    return !mipsnet_buffer_full(s);
}

static ssize_t mipsnet_receive(VLANClientState *nc, const uint8_t *buf, size_t size)
{
    MIPSnetState *s = DO_UPCAST(NICState, nc, nc)->opaque;

#ifdef DEBUG_MIPSNET_RECEIVE
    printf("mipsnet: receiving len=%d\n", size);
#endif
    if (!mipsnet_can_receive(nc))
        return -1;

    s->busy = 1;

    /* Just accept everything. */

    /* Write packet data. */
    memcpy(s->rx_buffer, buf, size);

    s->rx_count = size;
    s->rx_read = 0;

    /* Now we can signal we have received something. */
    s->intctl |= MIPSNET_INTCTL_RXDONE;
    mipsnet_update_irq(s);

    return size;
}

static uint32_t mipsnet_ioport_read(void *opaque, uint32_t addr)
{
    MIPSnetState *s = opaque;
    int ret = 0;

    addr &= 0x3f;
    switch (addr) {
    case MIPSNET_DEV_ID:
	ret = be32_to_cpu(0x4d495053);		/* MIPS */
        break;
    case MIPSNET_DEV_ID + 4:
	ret = be32_to_cpu(0x4e455430);		/* NET0 */
        break;
    case MIPSNET_BUSY:
	ret = s->busy;
        break;
    case MIPSNET_RX_DATA_COUNT:
	ret = s->rx_count;
        break;
    case MIPSNET_TX_DATA_COUNT:
	ret = s->tx_count;
        break;
    case MIPSNET_INT_CTL:
	ret = s->intctl;
        s->intctl &= ~MIPSNET_INTCTL_TESTBIT;
        break;
    case MIPSNET_INTERRUPT_INFO:
        /* XXX: This seems to be a per-VPE interrupt number. */
	ret = 0;
        break;
    case MIPSNET_RX_DATA_BUFFER:
        if (s->rx_count) {
            s->rx_count--;
            ret = s->rx_buffer[s->rx_read++];
        }
        break;
    /* Reads as zero. */
    case MIPSNET_TX_DATA_BUFFER:
    default:
        break;
    }
#ifdef DEBUG_MIPSNET_DATA
    printf("mipsnet: read addr=0x%02x val=0x%02x\n", addr, ret);
#endif
    return ret;
}

static void mipsnet_ioport_write(void *opaque, uint32_t addr, uint32_t val)
{
    MIPSnetState *s = opaque;

    addr &= 0x3f;
#ifdef DEBUG_MIPSNET_DATA
    printf("mipsnet: write addr=0x%02x val=0x%02x\n", addr, val);
#endif
    switch (addr) {
    case MIPSNET_TX_DATA_COUNT:
	s->tx_count = (val <= MAX_ETH_FRAME_SIZE) ? val : 0;
        s->tx_written = 0;
        break;
    case MIPSNET_INT_CTL:
        if (val & MIPSNET_INTCTL_TXDONE) {
            s->intctl &= ~MIPSNET_INTCTL_TXDONE;
        } else if (val & MIPSNET_INTCTL_RXDONE) {
            s->intctl &= ~MIPSNET_INTCTL_RXDONE;
        } else if (val & MIPSNET_INTCTL_TESTBIT) {
            mipsnet_reset(s);
            s->intctl |= MIPSNET_INTCTL_TESTBIT;
        } else if (!val) {
            /* ACK testbit interrupt, flag was cleared on read. */
        }
        s->busy = !!s->intctl;
        mipsnet_update_irq(s);
        break;
    case MIPSNET_TX_DATA_BUFFER:
        s->tx_buffer[s->tx_written++] = val;
        if (s->tx_written == s->tx_count) {
            /* Send buffer. */
#ifdef DEBUG_MIPSNET_SEND
            printf("mipsnet: sending len=%d\n", s->tx_count);
#endif
            qemu_send_packet(&s->nic->nc, s->tx_buffer, s->tx_count);
            s->tx_count = s->tx_written = 0;
            s->intctl |= MIPSNET_INTCTL_TXDONE;
            s->busy = 1;
            mipsnet_update_irq(s);
        }
        break;
    /* Read-only registers */
    case MIPSNET_DEV_ID:
    case MIPSNET_BUSY:
    case MIPSNET_RX_DATA_COUNT:
    case MIPSNET_INTERRUPT_INFO:
    case MIPSNET_RX_DATA_BUFFER:
    default:
        break;
    }
}

static void mipsnet_save(QEMUFile *f, void *opaque)
{
    MIPSnetState *s = opaque;

    qemu_put_be32s(f, &s->busy);
    qemu_put_be32s(f, &s->rx_count);
    qemu_put_be32s(f, &s->rx_read);
    qemu_put_be32s(f, &s->tx_count);
    qemu_put_be32s(f, &s->tx_written);
    qemu_put_be32s(f, &s->intctl);
    qemu_put_buffer(f, s->rx_buffer, MAX_ETH_FRAME_SIZE);
    qemu_put_buffer(f, s->tx_buffer, MAX_ETH_FRAME_SIZE);
}

static int mipsnet_load(QEMUFile *f, void *opaque, int version_id)
{
    MIPSnetState *s = opaque;

    if (version_id > 0)
        return -EINVAL;

    qemu_get_be32s(f, &s->busy);
    qemu_get_be32s(f, &s->rx_count);
    qemu_get_be32s(f, &s->rx_read);
    qemu_get_be32s(f, &s->tx_count);
    qemu_get_be32s(f, &s->tx_written);
    qemu_get_be32s(f, &s->intctl);
    qemu_get_buffer(f, s->rx_buffer, MAX_ETH_FRAME_SIZE);
    qemu_get_buffer(f, s->tx_buffer, MAX_ETH_FRAME_SIZE);

    return 0;
}

static void mipsnet_cleanup(VLANClientState *nc)
{
    MIPSnetState *s = DO_UPCAST(NICState, nc, nc)->opaque;

    unregister_savevm("mipsnet", s);

    isa_unassign_ioport(s->io_base, 36);

    qemu_free(s);
}

static NetClientInfo net_mipsnet_info = {
    .type = NET_CLIENT_TYPE_NIC,
    .size = sizeof(NICState),
    .can_receive = mipsnet_can_receive,
    .receive = mipsnet_receive,
    .cleanup = mipsnet_cleanup,
};

void mipsnet_init (int base, qemu_irq irq, NICInfo *nd)
{
    MIPSnetState *s;

    qemu_check_nic_model(nd, "mipsnet");

    s = qemu_mallocz(sizeof(MIPSnetState));

    register_ioport_write(base, 36, 1, mipsnet_ioport_write, s);
    register_ioport_read(base, 36, 1, mipsnet_ioport_read, s);
    register_ioport_write(base, 36, 2, mipsnet_ioport_write, s);
    register_ioport_read(base, 36, 2, mipsnet_ioport_read, s);
    register_ioport_write(base, 36, 4, mipsnet_ioport_write, s);
    register_ioport_read(base, 36, 4, mipsnet_ioport_read, s);

    s->io_base = base;
    s->irq = irq;

    if (nd) {
        memcpy(s->conf.macaddr.a, nd->macaddr, sizeof(nd->macaddr));
        s->conf.vlan = nd->vlan;
        s->conf.peer = nd->netdev;

        s->nic = qemu_new_nic(&net_mipsnet_info, &s->conf,
                              nd->model, nd->name, s);

        qemu_format_nic_info_str(&s->nic->nc, s->conf.macaddr.a);
    }

    mipsnet_reset(s);
    register_savevm("mipsnet", 0, 0, mipsnet_save, mipsnet_load, s);
}
Commit	Line	Data
87ecb68b PB	1	#include "hw.h"
	2	#include "mips.h"
	3	#include "net.h"
	4	#include "isa.h"
f0fc6f8f	5
57ba97de TS	6	//#define DEBUG_MIPSNET_SEND
57ba97de TS	7	//#define DEBUG_MIPSNET_RECEIVE
f0fc6f8f	8	//#define DEBUG_MIPSNET_DATA
57ba97de	9	//#define DEBUG_MIPSNET_IRQ
f0fc6f8f TS	10
	11	/* MIPSnet register offsets */
	12
	13	#define MIPSNET_DEV_ID 0x00
f0fc6f8f TS	14	#define MIPSNET_BUSY 0x08
	15	#define MIPSNET_RX_DATA_COUNT 0x0c
	16	#define MIPSNET_TX_DATA_COUNT 0x10
	17	#define MIPSNET_INT_CTL 0x14
	18	# define MIPSNET_INTCTL_TXDONE 0x00000001
	19	# define MIPSNET_INTCTL_RXDONE 0x00000002
	20	# define MIPSNET_INTCTL_TESTBIT 0x80000000
	21	#define MIPSNET_INTERRUPT_INFO 0x18
	22	#define MIPSNET_RX_DATA_BUFFER 0x1c
	23	#define MIPSNET_TX_DATA_BUFFER 0x20
	24
	25	#define MAX_ETH_FRAME_SIZE 1514
	26
	27	typedef struct MIPSnetState {
	28	uint32_t busy;
	29	uint32_t rx_count;
	30	uint32_t rx_read;
	31	uint32_t tx_count;
	32	uint32_t tx_written;
	33	uint32_t intctl;
	34	uint8_t rx_buffer[MAX_ETH_FRAME_SIZE];
	35	uint8_t tx_buffer[MAX_ETH_FRAME_SIZE];
b946a153	36	int io_base;
f0fc6f8f	37	qemu_irq irq;
1f30d10a MM	38	NICState *nic;
1f30d10a MM	39	NICConf conf;
f0fc6f8f TS	40	} MIPSnetState;
	41
	42	static void mipsnet_reset(MIPSnetState *s)
	43	{
	44	s->busy = 1;
	45	s->rx_count = 0;
	46	s->rx_read = 0;
	47	s->tx_count = 0;
	48	s->tx_written = 0;
	49	s->intctl = 0;
	50	memset(s->rx_buffer, 0, MAX_ETH_FRAME_SIZE);
	51	memset(s->tx_buffer, 0, MAX_ETH_FRAME_SIZE);
	52	}
	53
	54	static void mipsnet_update_irq(MIPSnetState *s)
	55	{
	56	int isr = !!s->intctl;
	57	#ifdef DEBUG_MIPSNET_IRQ
	58	printf("mipsnet: Set IRQ to %d (%02x)\n", isr, s->intctl);
	59	#endif
	60	qemu_set_irq(s->irq, isr);
	61	}
	62
	63	static int mipsnet_buffer_full(MIPSnetState *s)
	64	{
	65	if (s->rx_count >= MAX_ETH_FRAME_SIZE)
	66	return 1;
	67	return 0;
	68	}
	69
1f30d10a	70	static int mipsnet_can_receive(VLANClientState *nc)
f0fc6f8f	71	{
1f30d10a	72	MIPSnetState *s = DO_UPCAST(NICState, nc, nc)->opaque;
f0fc6f8f TS	73
	74	if (s->busy)
	75	return 0;
	76	return !mipsnet_buffer_full(s);
	77	}
	78
1f30d10a	79	static ssize_t mipsnet_receive(VLANClientState nc, const uint8_t buf, size_t size)
f0fc6f8f	80	{
1f30d10a	81	MIPSnetState *s = DO_UPCAST(NICState, nc, nc)->opaque;
f0fc6f8f TS	82
	83	#ifdef DEBUG_MIPSNET_RECEIVE
	84	printf("mipsnet: receiving len=%d\n", size);
	85	#endif
1f30d10a	86	if (!mipsnet_can_receive(nc))
4f1c942b	87	return -1;
f0fc6f8f TS	88
	89	s->busy = 1;
	90
	91	/* Just accept everything. */
	92
	93	/* Write packet data. */
	94	memcpy(s->rx_buffer, buf, size);
	95
	96	s->rx_count = size;
	97	s->rx_read = 0;
	98
	99	/* Now we can signal we have received something. */
	100	s->intctl \|= MIPSNET_INTCTL_RXDONE;
	101	mipsnet_update_irq(s);
4f1c942b MM	102
4f1c942b MM	103	return size;
f0fc6f8f TS	104	}
	105
	106	static uint32_t mipsnet_ioport_read(void *opaque, uint32_t addr)
	107	{
	108	MIPSnetState *s = opaque;
	109	int ret = 0;
f0fc6f8f TS	110
	111	addr &= 0x3f;
	112	switch (addr) {
	113	case MIPSNET_DEV_ID:
9b595395	114	ret = be32_to_cpu(0x4d495053); /* MIPS */
f0fc6f8f TS	115	break;
f0fc6f8f TS	116	case MIPSNET_DEV_ID + 4:
9b595395	117	ret = be32_to_cpu(0x4e455430); /* NET0 */
f0fc6f8f TS	118	break;
	119	case MIPSNET_BUSY:
	120	ret = s->busy;
	121	break;
	122	case MIPSNET_RX_DATA_COUNT:
	123	ret = s->rx_count;
	124	break;
	125	case MIPSNET_TX_DATA_COUNT:
	126	ret = s->tx_count;
	127	break;
	128	case MIPSNET_INT_CTL:
	129	ret = s->intctl;
	130	s->intctl &= ~MIPSNET_INTCTL_TESTBIT;
	131	break;
	132	case MIPSNET_INTERRUPT_INFO:
	133	/* XXX: This seems to be a per-VPE interrupt number. */
	134	ret = 0;
	135	break;
	136	case MIPSNET_RX_DATA_BUFFER:
	137	if (s->rx_count) {
	138	s->rx_count--;
	139	ret = s->rx_buffer[s->rx_read++];
	140	}
	141	break;
	142	/* Reads as zero. */
	143	case MIPSNET_TX_DATA_BUFFER:
	144	default:
	145	break;
	146	}
	147	#ifdef DEBUG_MIPSNET_DATA
	148	printf("mipsnet: read addr=0x%02x val=0x%02x\n", addr, ret);
	149	#endif
	150	return ret;
	151	}
	152
	153	static void mipsnet_ioport_write(void *opaque, uint32_t addr, uint32_t val)
	154	{
	155	MIPSnetState *s = opaque;
	156
	157	addr &= 0x3f;
	158	#ifdef DEBUG_MIPSNET_DATA
	159	printf("mipsnet: write addr=0x%02x val=0x%02x\n", addr, val);
	160	#endif
	161	switch (addr) {
	162	case MIPSNET_TX_DATA_COUNT:
	163	s->tx_count = (val <= MAX_ETH_FRAME_SIZE) ? val : 0;
	164	s->tx_written = 0;
	165	break;
	166	case MIPSNET_INT_CTL:
	167	if (val & MIPSNET_INTCTL_TXDONE) {
	168	s->intctl &= ~MIPSNET_INTCTL_TXDONE;
	169	} else if (val & MIPSNET_INTCTL_RXDONE) {
	170	s->intctl &= ~MIPSNET_INTCTL_RXDONE;
	171	} else if (val & MIPSNET_INTCTL_TESTBIT) {
	172	mipsnet_reset(s);
	173	s->intctl \|= MIPSNET_INTCTL_TESTBIT;
	174	} else if (!val) {
	175	/* ACK testbit interrupt, flag was cleared on read. */
	176	}
	177	s->busy = !!s->intctl;
	178	mipsnet_update_irq(s);
	179	break;
	180	case MIPSNET_TX_DATA_BUFFER:
	181	s->tx_buffer[s->tx_written++] = val;
182	if (s->tx_written == s->tx_count) {
183	/* Send buffer. */
184	#ifdef DEBUG_MIPSNET_SEND
185	printf("mipsnet: sending len=%d\n", s->tx_count);
186	#endif
1f30d10a	187	qemu_send_packet(&s->nic->nc, s->tx_buffer, s->tx_count);
f0fc6f8f TS	188	s->tx_count = s->tx_written = 0;
	189	s->intctl \|= MIPSNET_INTCTL_TXDONE;
	190	s->busy = 1;
	191	mipsnet_update_irq(s);
	192	}
	193	break;
	194	/* Read-only registers */
	195	case MIPSNET_DEV_ID:
	196	case MIPSNET_BUSY:
	197	case MIPSNET_RX_DATA_COUNT:
	198	case MIPSNET_INTERRUPT_INFO:
	199	case MIPSNET_RX_DATA_BUFFER:
	200	default:
	201	break;
	202	}
	203	}
	204
	205	static void mipsnet_save(QEMUFile f, void opaque)
	206	{
	207	MIPSnetState *s = opaque;
	208
	209	qemu_put_be32s(f, &s->busy);
	210	qemu_put_be32s(f, &s->rx_count);
	211	qemu_put_be32s(f, &s->rx_read);
	212	qemu_put_be32s(f, &s->tx_count);
	213	qemu_put_be32s(f, &s->tx_written);
	214	qemu_put_be32s(f, &s->intctl);
	215	qemu_put_buffer(f, s->rx_buffer, MAX_ETH_FRAME_SIZE);
	216	qemu_put_buffer(f, s->tx_buffer, MAX_ETH_FRAME_SIZE);
	217	}
	218
	219	static int mipsnet_load(QEMUFile f, void opaque, int version_id)
	220	{
	221	MIPSnetState *s = opaque;
	222
	223	if (version_id > 0)
	224	return -EINVAL;
	225
	226	qemu_get_be32s(f, &s->busy);
	227	qemu_get_be32s(f, &s->rx_count);
	228	qemu_get_be32s(f, &s->rx_read);
	229	qemu_get_be32s(f, &s->tx_count);
	230	qemu_get_be32s(f, &s->tx_written);
	231	qemu_get_be32s(f, &s->intctl);
	232	qemu_get_buffer(f, s->rx_buffer, MAX_ETH_FRAME_SIZE);
	233	qemu_get_buffer(f, s->tx_buffer, MAX_ETH_FRAME_SIZE);
	234
	235	return 0;
	236	}
	237
1f30d10a	238	static void mipsnet_cleanup(VLANClientState *nc)
b946a153	239	{
1f30d10a	240	MIPSnetState *s = DO_UPCAST(NICState, nc, nc)->opaque;
b946a153 AL	241
	242	unregister_savevm("mipsnet", s);
	243
	244	isa_unassign_ioport(s->io_base, 36);
	245
	246	qemu_free(s);
	247	}
	248
1f30d10a MM	249	static NetClientInfo net_mipsnet_info = {
	250	.type = NET_CLIENT_TYPE_NIC,
	251	.size = sizeof(NICState),
	252	.can_receive = mipsnet_can_receive,
	253	.receive = mipsnet_receive,
	254	.cleanup = mipsnet_cleanup,
	255	};
	256
f0fc6f8f TS	257	void mipsnet_init (int base, qemu_irq irq, NICInfo *nd)
	258	{
	259	MIPSnetState *s;
	260
0ae18cee AL	261	qemu_check_nic_model(nd, "mipsnet");
0ae18cee AL	262
f0fc6f8f	263	s = qemu_mallocz(sizeof(MIPSnetState));
f0fc6f8f TS	264
	265	register_ioport_write(base, 36, 1, mipsnet_ioport_write, s);
	266	register_ioport_read(base, 36, 1, mipsnet_ioport_read, s);
	267	register_ioport_write(base, 36, 2, mipsnet_ioport_write, s);
	268	register_ioport_read(base, 36, 2, mipsnet_ioport_read, s);
	269	register_ioport_write(base, 36, 4, mipsnet_ioport_write, s);
	270	register_ioport_read(base, 36, 4, mipsnet_ioport_read, s);
	271
b946a153	272	s->io_base = base;
f0fc6f8f	273	s->irq = irq;
1f30d10a	274
283c7c63	275	if (nd) {
1f30d10a MM	276	memcpy(s->conf.macaddr.a, nd->macaddr, sizeof(nd->macaddr));
	277	s->conf.vlan = nd->vlan;
	278	s->conf.peer = nd->netdev;
f0fc6f8f	279
1f30d10a MM	280	s->nic = qemu_new_nic(&net_mipsnet_info, &s->conf,
	281	nd->model, nd->name, s);
	282
	283	qemu_format_nic_info_str(&s->nic->nc, s->conf.macaddr.a);
	284	}
f0fc6f8f TS	285
	286	mipsnet_reset(s);
	287	register_savevm("mipsnet", 0, 0, mipsnet_save, mipsnet_load, s);
	288	}