git-svn-id: svn://svn.savannah.nongnu.org/qemu/trunk@664 c046a42c-6fe2-441c-8c8c-71466251a162
476 lines
14 KiB
C
476 lines
14 KiB
C
/*
|
|
* QEMU NE2000 emulation
|
|
*
|
|
* Copyright (c) 2003-2004 Fabrice Bellard
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
* of this software and associated documentation files (the "Software"), to deal
|
|
* in the Software without restriction, including without limitation the rights
|
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
* copies of the Software, and to permit persons to whom the Software is
|
|
* furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be included in
|
|
* all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
|
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
* THE SOFTWARE.
|
|
*/
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <stdarg.h>
|
|
#include <string.h>
|
|
#include <getopt.h>
|
|
#include <inttypes.h>
|
|
#include <unistd.h>
|
|
#include <sys/mman.h>
|
|
#include <fcntl.h>
|
|
#include <signal.h>
|
|
#include <time.h>
|
|
#include <sys/time.h>
|
|
#include <malloc.h>
|
|
#include <termios.h>
|
|
#include <sys/poll.h>
|
|
#include <errno.h>
|
|
#include <sys/wait.h>
|
|
#include <netinet/in.h>
|
|
|
|
#include "cpu.h"
|
|
#include "vl.h"
|
|
|
|
/* debug NE2000 card */
|
|
//#define DEBUG_NE2000
|
|
|
|
#define MAX_ETH_FRAME_SIZE 1514
|
|
|
|
#define E8390_CMD 0x00 /* The command register (for all pages) */
|
|
/* Page 0 register offsets. */
|
|
#define EN0_CLDALO 0x01 /* Low byte of current local dma addr RD */
|
|
#define EN0_STARTPG 0x01 /* Starting page of ring bfr WR */
|
|
#define EN0_CLDAHI 0x02 /* High byte of current local dma addr RD */
|
|
#define EN0_STOPPG 0x02 /* Ending page +1 of ring bfr WR */
|
|
#define EN0_BOUNDARY 0x03 /* Boundary page of ring bfr RD WR */
|
|
#define EN0_TSR 0x04 /* Transmit status reg RD */
|
|
#define EN0_TPSR 0x04 /* Transmit starting page WR */
|
|
#define EN0_NCR 0x05 /* Number of collision reg RD */
|
|
#define EN0_TCNTLO 0x05 /* Low byte of tx byte count WR */
|
|
#define EN0_FIFO 0x06 /* FIFO RD */
|
|
#define EN0_TCNTHI 0x06 /* High byte of tx byte count WR */
|
|
#define EN0_ISR 0x07 /* Interrupt status reg RD WR */
|
|
#define EN0_CRDALO 0x08 /* low byte of current remote dma address RD */
|
|
#define EN0_RSARLO 0x08 /* Remote start address reg 0 */
|
|
#define EN0_CRDAHI 0x09 /* high byte, current remote dma address RD */
|
|
#define EN0_RSARHI 0x09 /* Remote start address reg 1 */
|
|
#define EN0_RCNTLO 0x0a /* Remote byte count reg WR */
|
|
#define EN0_RCNTHI 0x0b /* Remote byte count reg WR */
|
|
#define EN0_RSR 0x0c /* rx status reg RD */
|
|
#define EN0_RXCR 0x0c /* RX configuration reg WR */
|
|
#define EN0_TXCR 0x0d /* TX configuration reg WR */
|
|
#define EN0_COUNTER0 0x0d /* Rcv alignment error counter RD */
|
|
#define EN0_DCFG 0x0e /* Data configuration reg WR */
|
|
#define EN0_COUNTER1 0x0e /* Rcv CRC error counter RD */
|
|
#define EN0_IMR 0x0f /* Interrupt mask reg WR */
|
|
#define EN0_COUNTER2 0x0f /* Rcv missed frame error counter RD */
|
|
|
|
#define EN1_PHYS 0x11
|
|
#define EN1_CURPAG 0x17
|
|
#define EN1_MULT 0x18
|
|
|
|
/* Register accessed at EN_CMD, the 8390 base addr. */
|
|
#define E8390_STOP 0x01 /* Stop and reset the chip */
|
|
#define E8390_START 0x02 /* Start the chip, clear reset */
|
|
#define E8390_TRANS 0x04 /* Transmit a frame */
|
|
#define E8390_RREAD 0x08 /* Remote read */
|
|
#define E8390_RWRITE 0x10 /* Remote write */
|
|
#define E8390_NODMA 0x20 /* Remote DMA */
|
|
#define E8390_PAGE0 0x00 /* Select page chip registers */
|
|
#define E8390_PAGE1 0x40 /* using the two high-order bits */
|
|
#define E8390_PAGE2 0x80 /* Page 3 is invalid. */
|
|
|
|
/* Bits in EN0_ISR - Interrupt status register */
|
|
#define ENISR_RX 0x01 /* Receiver, no error */
|
|
#define ENISR_TX 0x02 /* Transmitter, no error */
|
|
#define ENISR_RX_ERR 0x04 /* Receiver, with error */
|
|
#define ENISR_TX_ERR 0x08 /* Transmitter, with error */
|
|
#define ENISR_OVER 0x10 /* Receiver overwrote the ring */
|
|
#define ENISR_COUNTERS 0x20 /* Counters need emptying */
|
|
#define ENISR_RDC 0x40 /* remote dma complete */
|
|
#define ENISR_RESET 0x80 /* Reset completed */
|
|
#define ENISR_ALL 0x3f /* Interrupts we will enable */
|
|
|
|
/* Bits in received packet status byte and EN0_RSR*/
|
|
#define ENRSR_RXOK 0x01 /* Received a good packet */
|
|
#define ENRSR_CRC 0x02 /* CRC error */
|
|
#define ENRSR_FAE 0x04 /* frame alignment error */
|
|
#define ENRSR_FO 0x08 /* FIFO overrun */
|
|
#define ENRSR_MPA 0x10 /* missed pkt */
|
|
#define ENRSR_PHY 0x20 /* physical/multicast address */
|
|
#define ENRSR_DIS 0x40 /* receiver disable. set in monitor mode */
|
|
#define ENRSR_DEF 0x80 /* deferring */
|
|
|
|
/* Transmitted packet status, EN0_TSR. */
|
|
#define ENTSR_PTX 0x01 /* Packet transmitted without error */
|
|
#define ENTSR_ND 0x02 /* The transmit wasn't deferred. */
|
|
#define ENTSR_COL 0x04 /* The transmit collided at least once. */
|
|
#define ENTSR_ABT 0x08 /* The transmit collided 16 times, and was deferred. */
|
|
#define ENTSR_CRS 0x10 /* The carrier sense was lost. */
|
|
#define ENTSR_FU 0x20 /* A "FIFO underrun" occurred during transmit. */
|
|
#define ENTSR_CDH 0x40 /* The collision detect "heartbeat" signal was lost. */
|
|
#define ENTSR_OWC 0x80 /* There was an out-of-window collision. */
|
|
|
|
#define NE2000_MEM_SIZE 32768
|
|
|
|
typedef struct NE2000State {
|
|
uint8_t cmd;
|
|
uint32_t start;
|
|
uint32_t stop;
|
|
uint8_t boundary;
|
|
uint8_t tsr;
|
|
uint8_t tpsr;
|
|
uint16_t tcnt;
|
|
uint16_t rcnt;
|
|
uint32_t rsar;
|
|
uint8_t isr;
|
|
uint8_t dcfg;
|
|
uint8_t imr;
|
|
uint8_t phys[6]; /* mac address */
|
|
uint8_t curpag;
|
|
uint8_t mult[8]; /* multicast mask array */
|
|
int irq;
|
|
NetDriverState *nd;
|
|
uint8_t mem[NE2000_MEM_SIZE];
|
|
} NE2000State;
|
|
|
|
static void ne2000_reset(NE2000State *s)
|
|
{
|
|
int i;
|
|
|
|
s->isr = ENISR_RESET;
|
|
memcpy(s->mem, s->nd->macaddr, 6);
|
|
s->mem[14] = 0x57;
|
|
s->mem[15] = 0x57;
|
|
|
|
/* duplicate prom data */
|
|
for(i = 15;i >= 0; i--) {
|
|
s->mem[2 * i] = s->mem[i];
|
|
s->mem[2 * i + 1] = s->mem[i];
|
|
}
|
|
}
|
|
|
|
static void ne2000_update_irq(NE2000State *s)
|
|
{
|
|
int isr;
|
|
isr = s->isr & s->imr;
|
|
if (isr)
|
|
pic_set_irq(s->irq, 1);
|
|
else
|
|
pic_set_irq(s->irq, 0);
|
|
}
|
|
|
|
/* return the max buffer size if the NE2000 can receive more data */
|
|
static int ne2000_can_receive(void *opaque)
|
|
{
|
|
NE2000State *s = opaque;
|
|
int avail, index, boundary;
|
|
|
|
if (s->cmd & E8390_STOP)
|
|
return 0;
|
|
index = s->curpag << 8;
|
|
boundary = s->boundary << 8;
|
|
if (index < boundary)
|
|
avail = boundary - index;
|
|
else
|
|
avail = (s->stop - s->start) - (index - boundary);
|
|
if (avail < (MAX_ETH_FRAME_SIZE + 4))
|
|
return 0;
|
|
return MAX_ETH_FRAME_SIZE;
|
|
}
|
|
|
|
#define MIN_BUF_SIZE 60
|
|
|
|
static void ne2000_receive(void *opaque, const uint8_t *buf, int size)
|
|
{
|
|
NE2000State *s = opaque;
|
|
uint8_t *p;
|
|
int total_len, next, avail, len, index;
|
|
uint8_t buf1[60];
|
|
|
|
#if defined(DEBUG_NE2000)
|
|
printf("NE2000: received len=%d\n", size);
|
|
#endif
|
|
|
|
/* if too small buffer, then expand it */
|
|
if (size < MIN_BUF_SIZE) {
|
|
memcpy(buf1, buf, size);
|
|
memset(buf1 + size, 0, MIN_BUF_SIZE - size);
|
|
buf = buf1;
|
|
size = MIN_BUF_SIZE;
|
|
}
|
|
|
|
index = s->curpag << 8;
|
|
/* 4 bytes for header */
|
|
total_len = size + 4;
|
|
/* address for next packet (4 bytes for CRC) */
|
|
next = index + ((total_len + 4 + 255) & ~0xff);
|
|
if (next >= s->stop)
|
|
next -= (s->stop - s->start);
|
|
/* prepare packet header */
|
|
p = s->mem + index;
|
|
p[0] = ENRSR_RXOK; /* receive status */
|
|
p[1] = next >> 8;
|
|
p[2] = total_len;
|
|
p[3] = total_len >> 8;
|
|
index += 4;
|
|
|
|
/* write packet data */
|
|
while (size > 0) {
|
|
avail = s->stop - index;
|
|
len = size;
|
|
if (len > avail)
|
|
len = avail;
|
|
memcpy(s->mem + index, buf, len);
|
|
buf += len;
|
|
index += len;
|
|
if (index == s->stop)
|
|
index = s->start;
|
|
size -= len;
|
|
}
|
|
s->curpag = next >> 8;
|
|
|
|
/* now we can signal we have receive something */
|
|
s->isr |= ENISR_RX;
|
|
ne2000_update_irq(s);
|
|
}
|
|
|
|
static void ne2000_ioport_write(void *opaque, uint32_t addr, uint32_t val)
|
|
{
|
|
NE2000State *s = opaque;
|
|
int offset, page;
|
|
|
|
addr &= 0xf;
|
|
#ifdef DEBUG_NE2000
|
|
printf("NE2000: write addr=0x%x val=0x%02x\n", addr, val);
|
|
#endif
|
|
if (addr == E8390_CMD) {
|
|
/* control register */
|
|
s->cmd = val;
|
|
if (val & E8390_START) {
|
|
/* test specific case: zero length transfert */
|
|
if ((val & (E8390_RREAD | E8390_RWRITE)) &&
|
|
s->rcnt == 0) {
|
|
s->isr |= ENISR_RDC;
|
|
ne2000_update_irq(s);
|
|
}
|
|
if (val & E8390_TRANS) {
|
|
net_send_packet(s->nd, s->mem + (s->tpsr << 8), s->tcnt);
|
|
/* signal end of transfert */
|
|
s->tsr = ENTSR_PTX;
|
|
s->isr |= ENISR_TX;
|
|
ne2000_update_irq(s);
|
|
}
|
|
}
|
|
} else {
|
|
page = s->cmd >> 6;
|
|
offset = addr | (page << 4);
|
|
switch(offset) {
|
|
case EN0_STARTPG:
|
|
s->start = val << 8;
|
|
break;
|
|
case EN0_STOPPG:
|
|
s->stop = val << 8;
|
|
break;
|
|
case EN0_BOUNDARY:
|
|
s->boundary = val;
|
|
break;
|
|
case EN0_IMR:
|
|
s->imr = val;
|
|
ne2000_update_irq(s);
|
|
break;
|
|
case EN0_TPSR:
|
|
s->tpsr = val;
|
|
break;
|
|
case EN0_TCNTLO:
|
|
s->tcnt = (s->tcnt & 0xff00) | val;
|
|
break;
|
|
case EN0_TCNTHI:
|
|
s->tcnt = (s->tcnt & 0x00ff) | (val << 8);
|
|
break;
|
|
case EN0_RSARLO:
|
|
s->rsar = (s->rsar & 0xff00) | val;
|
|
break;
|
|
case EN0_RSARHI:
|
|
s->rsar = (s->rsar & 0x00ff) | (val << 8);
|
|
break;
|
|
case EN0_RCNTLO:
|
|
s->rcnt = (s->rcnt & 0xff00) | val;
|
|
break;
|
|
case EN0_RCNTHI:
|
|
s->rcnt = (s->rcnt & 0x00ff) | (val << 8);
|
|
break;
|
|
case EN0_DCFG:
|
|
s->dcfg = val;
|
|
break;
|
|
case EN0_ISR:
|
|
s->isr &= ~val;
|
|
ne2000_update_irq(s);
|
|
break;
|
|
case EN1_PHYS ... EN1_PHYS + 5:
|
|
s->phys[offset - EN1_PHYS] = val;
|
|
break;
|
|
case EN1_CURPAG:
|
|
s->curpag = val;
|
|
break;
|
|
case EN1_MULT ... EN1_MULT + 7:
|
|
s->mult[offset - EN1_MULT] = val;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
static uint32_t ne2000_ioport_read(void *opaque, uint32_t addr)
|
|
{
|
|
NE2000State *s = opaque;
|
|
int offset, page, ret;
|
|
|
|
addr &= 0xf;
|
|
if (addr == E8390_CMD) {
|
|
ret = s->cmd;
|
|
} else {
|
|
page = s->cmd >> 6;
|
|
offset = addr | (page << 4);
|
|
switch(offset) {
|
|
case EN0_TSR:
|
|
ret = s->tsr;
|
|
break;
|
|
case EN0_BOUNDARY:
|
|
ret = s->boundary;
|
|
break;
|
|
case EN0_ISR:
|
|
ret = s->isr;
|
|
break;
|
|
case EN1_PHYS ... EN1_PHYS + 5:
|
|
ret = s->phys[offset - EN1_PHYS];
|
|
break;
|
|
case EN1_CURPAG:
|
|
ret = s->curpag;
|
|
break;
|
|
case EN1_MULT ... EN1_MULT + 7:
|
|
ret = s->mult[offset - EN1_MULT];
|
|
break;
|
|
default:
|
|
ret = 0x00;
|
|
break;
|
|
}
|
|
}
|
|
#ifdef DEBUG_NE2000
|
|
printf("NE2000: read addr=0x%x val=%02x\n", addr, ret);
|
|
#endif
|
|
return ret;
|
|
}
|
|
|
|
static void ne2000_asic_ioport_write(void *opaque, uint32_t addr, uint32_t val)
|
|
{
|
|
NE2000State *s = opaque;
|
|
uint8_t *p;
|
|
|
|
#ifdef DEBUG_NE2000
|
|
printf("NE2000: asic write val=0x%04x\n", val);
|
|
#endif
|
|
p = s->mem + s->rsar;
|
|
if (s->dcfg & 0x01) {
|
|
/* 16 bit access */
|
|
p[0] = val;
|
|
p[1] = val >> 8;
|
|
s->rsar += 2;
|
|
s->rcnt -= 2;
|
|
} else {
|
|
/* 8 bit access */
|
|
p[0] = val;
|
|
s->rsar++;
|
|
s->rcnt--;
|
|
}
|
|
/* wrap */
|
|
if (s->rsar == s->stop)
|
|
s->rsar = s->start;
|
|
if (s->rcnt == 0) {
|
|
/* signal end of transfert */
|
|
s->isr |= ENISR_RDC;
|
|
ne2000_update_irq(s);
|
|
}
|
|
}
|
|
|
|
static uint32_t ne2000_asic_ioport_read(void *opaque, uint32_t addr)
|
|
{
|
|
NE2000State *s = opaque;
|
|
uint8_t *p;
|
|
int ret;
|
|
|
|
p = s->mem + s->rsar;
|
|
if (s->dcfg & 0x01) {
|
|
/* 16 bit access */
|
|
ret = p[0] | (p[1] << 8);
|
|
s->rsar += 2;
|
|
s->rcnt -= 2;
|
|
} else {
|
|
/* 8 bit access */
|
|
ret = p[0];
|
|
s->rsar++;
|
|
s->rcnt--;
|
|
}
|
|
/* wrap */
|
|
if (s->rsar == s->stop)
|
|
s->rsar = s->start;
|
|
if (s->rcnt == 0) {
|
|
/* signal end of transfert */
|
|
s->isr |= ENISR_RDC;
|
|
ne2000_update_irq(s);
|
|
}
|
|
#ifdef DEBUG_NE2000
|
|
printf("NE2000: asic read val=0x%04x\n", ret);
|
|
#endif
|
|
return ret;
|
|
}
|
|
|
|
static void ne2000_reset_ioport_write(void *opaque, uint32_t addr, uint32_t val)
|
|
{
|
|
/* nothing to do (end of reset pulse) */
|
|
}
|
|
|
|
static uint32_t ne2000_reset_ioport_read(void *opaque, uint32_t addr)
|
|
{
|
|
NE2000State *s = opaque;
|
|
ne2000_reset(s);
|
|
return 0;
|
|
}
|
|
|
|
void ne2000_init(int base, int irq, NetDriverState *nd)
|
|
{
|
|
NE2000State *s;
|
|
|
|
s = qemu_mallocz(sizeof(NE2000State));
|
|
if (!s)
|
|
return;
|
|
|
|
register_ioport_write(base, 16, 1, ne2000_ioport_write, s);
|
|
register_ioport_read(base, 16, 1, ne2000_ioport_read, s);
|
|
|
|
register_ioport_write(base + 0x10, 1, 1, ne2000_asic_ioport_write, s);
|
|
register_ioport_read(base + 0x10, 1, 1, ne2000_asic_ioport_read, s);
|
|
register_ioport_write(base + 0x10, 2, 2, ne2000_asic_ioport_write, s);
|
|
register_ioport_read(base + 0x10, 2, 2, ne2000_asic_ioport_read, s);
|
|
|
|
register_ioport_write(base + 0x1f, 1, 1, ne2000_reset_ioport_write, s);
|
|
register_ioport_read(base + 0x1f, 1, 1, ne2000_reset_ioport_read, s);
|
|
s->irq = irq;
|
|
s->nd = nd;
|
|
|
|
ne2000_reset(s);
|
|
|
|
add_fd_read_handler(nd->fd, ne2000_can_receive, ne2000_receive, s);
|
|
}
|