Log with GUEST_ERROR what the guest is doing wrong. Signed-off-by: Philippe Mathieu-Daudé <f4bug@amsat.org> Signed-off-by: Jason Wang <jasowang@redhat.com>
1048 lines
27 KiB
C
1048 lines
27 KiB
C
/*
|
|
* QEMU TULIP Emulation
|
|
*
|
|
* Copyright (c) 2019 Sven Schnelle <svens@stackframe.org>
|
|
*
|
|
* This work is licensed under the GNU GPL license version 2 or later.
|
|
*/
|
|
|
|
#include "qemu/osdep.h"
|
|
#include "qemu/log.h"
|
|
#include "hw/irq.h"
|
|
#include "hw/pci/pci.h"
|
|
#include "hw/qdev-properties.h"
|
|
#include "hw/nvram/eeprom93xx.h"
|
|
#include "migration/vmstate.h"
|
|
#include "sysemu/sysemu.h"
|
|
#include "tulip.h"
|
|
#include "trace.h"
|
|
#include "net/eth.h"
|
|
|
|
typedef struct TULIPState {
|
|
PCIDevice dev;
|
|
MemoryRegion io;
|
|
MemoryRegion memory;
|
|
NICConf c;
|
|
qemu_irq irq;
|
|
NICState *nic;
|
|
eeprom_t *eeprom;
|
|
uint32_t csr[16];
|
|
|
|
/* state for MII */
|
|
uint32_t old_csr9;
|
|
uint32_t mii_word;
|
|
uint32_t mii_bitcnt;
|
|
|
|
hwaddr current_rx_desc;
|
|
hwaddr current_tx_desc;
|
|
|
|
uint8_t rx_frame[2048];
|
|
uint8_t tx_frame[2048];
|
|
uint16_t tx_frame_len;
|
|
uint16_t rx_frame_len;
|
|
uint16_t rx_frame_size;
|
|
|
|
uint32_t rx_status;
|
|
uint8_t filter[16][6];
|
|
} TULIPState;
|
|
|
|
static const VMStateDescription vmstate_pci_tulip = {
|
|
.name = "tulip",
|
|
.fields = (VMStateField[]) {
|
|
VMSTATE_PCI_DEVICE(dev, TULIPState),
|
|
VMSTATE_UINT32_ARRAY(csr, TULIPState, 16),
|
|
VMSTATE_UINT32(old_csr9, TULIPState),
|
|
VMSTATE_UINT32(mii_word, TULIPState),
|
|
VMSTATE_UINT32(mii_bitcnt, TULIPState),
|
|
VMSTATE_UINT64(current_rx_desc, TULIPState),
|
|
VMSTATE_UINT64(current_tx_desc, TULIPState),
|
|
VMSTATE_BUFFER(rx_frame, TULIPState),
|
|
VMSTATE_BUFFER(tx_frame, TULIPState),
|
|
VMSTATE_UINT16(rx_frame_len, TULIPState),
|
|
VMSTATE_UINT16(tx_frame_len, TULIPState),
|
|
VMSTATE_UINT16(rx_frame_size, TULIPState),
|
|
VMSTATE_UINT32(rx_status, TULIPState),
|
|
VMSTATE_UINT8_2DARRAY(filter, TULIPState, 16, 6),
|
|
VMSTATE_END_OF_LIST()
|
|
}
|
|
};
|
|
|
|
static void tulip_desc_read(TULIPState *s, hwaddr p,
|
|
struct tulip_descriptor *desc)
|
|
{
|
|
if (s->csr[0] & CSR0_DBO) {
|
|
desc->status = ldl_be_pci_dma(&s->dev, p);
|
|
desc->control = ldl_be_pci_dma(&s->dev, p + 4);
|
|
desc->buf_addr1 = ldl_be_pci_dma(&s->dev, p + 8);
|
|
desc->buf_addr2 = ldl_be_pci_dma(&s->dev, p + 12);
|
|
} else {
|
|
desc->status = ldl_le_pci_dma(&s->dev, p);
|
|
desc->control = ldl_le_pci_dma(&s->dev, p + 4);
|
|
desc->buf_addr1 = ldl_le_pci_dma(&s->dev, p + 8);
|
|
desc->buf_addr2 = ldl_le_pci_dma(&s->dev, p + 12);
|
|
}
|
|
}
|
|
|
|
static void tulip_desc_write(TULIPState *s, hwaddr p,
|
|
struct tulip_descriptor *desc)
|
|
{
|
|
if (s->csr[0] & CSR0_DBO) {
|
|
stl_be_pci_dma(&s->dev, p, desc->status);
|
|
stl_be_pci_dma(&s->dev, p + 4, desc->control);
|
|
stl_be_pci_dma(&s->dev, p + 8, desc->buf_addr1);
|
|
stl_be_pci_dma(&s->dev, p + 12, desc->buf_addr2);
|
|
} else {
|
|
stl_le_pci_dma(&s->dev, p, desc->status);
|
|
stl_le_pci_dma(&s->dev, p + 4, desc->control);
|
|
stl_le_pci_dma(&s->dev, p + 8, desc->buf_addr1);
|
|
stl_le_pci_dma(&s->dev, p + 12, desc->buf_addr2);
|
|
}
|
|
}
|
|
|
|
static void tulip_update_int(TULIPState *s)
|
|
{
|
|
uint32_t ie = s->csr[5] & s->csr[7];
|
|
bool assert = false;
|
|
|
|
s->csr[5] &= ~(CSR5_AIS | CSR5_NIS);
|
|
|
|
if (ie & (CSR5_TI | CSR5_TU | CSR5_RI | CSR5_GTE | CSR5_ERI)) {
|
|
s->csr[5] |= CSR5_NIS;
|
|
}
|
|
|
|
if (ie & (CSR5_LC | CSR5_GPI | CSR5_FBE | CSR5_LNF | CSR5_ETI | CSR5_RWT |
|
|
CSR5_RPS | CSR5_RU | CSR5_UNF | CSR5_LNP_ANC | CSR5_TJT |
|
|
CSR5_TPS)) {
|
|
s->csr[5] |= CSR5_AIS;
|
|
}
|
|
|
|
assert = s->csr[5] & s->csr[7] & (CSR5_AIS | CSR5_NIS);
|
|
trace_tulip_irq(s->csr[5], s->csr[7], assert ? "assert" : "deassert");
|
|
qemu_set_irq(s->irq, assert);
|
|
}
|
|
|
|
static bool tulip_rx_stopped(TULIPState *s)
|
|
{
|
|
return ((s->csr[5] >> CSR5_RS_SHIFT) & CSR5_RS_MASK) == CSR5_RS_STOPPED;
|
|
}
|
|
|
|
static void tulip_dump_tx_descriptor(TULIPState *s,
|
|
struct tulip_descriptor *desc)
|
|
{
|
|
trace_tulip_descriptor("TX ", s->current_tx_desc,
|
|
desc->status, desc->control >> 22,
|
|
desc->control & 0x7ff, (desc->control >> 11) & 0x7ff,
|
|
desc->buf_addr1, desc->buf_addr2);
|
|
}
|
|
|
|
static void tulip_dump_rx_descriptor(TULIPState *s,
|
|
struct tulip_descriptor *desc)
|
|
{
|
|
trace_tulip_descriptor("RX ", s->current_rx_desc,
|
|
desc->status, desc->control >> 22,
|
|
desc->control & 0x7ff, (desc->control >> 11) & 0x7ff,
|
|
desc->buf_addr1, desc->buf_addr2);
|
|
}
|
|
|
|
static void tulip_next_rx_descriptor(TULIPState *s,
|
|
struct tulip_descriptor *desc)
|
|
{
|
|
if (desc->control & RDES1_RER) {
|
|
s->current_rx_desc = s->csr[3];
|
|
} else if (desc->control & RDES1_RCH) {
|
|
s->current_rx_desc = desc->buf_addr2;
|
|
} else {
|
|
s->current_rx_desc += sizeof(struct tulip_descriptor) +
|
|
(((s->csr[0] >> CSR0_DSL_SHIFT) & CSR0_DSL_MASK) << 2);
|
|
}
|
|
s->current_rx_desc &= ~3ULL;
|
|
}
|
|
|
|
static void tulip_copy_rx_bytes(TULIPState *s, struct tulip_descriptor *desc)
|
|
{
|
|
int len1 = (desc->control >> RDES1_BUF1_SIZE_SHIFT) & RDES1_BUF1_SIZE_MASK;
|
|
int len2 = (desc->control >> RDES1_BUF2_SIZE_SHIFT) & RDES1_BUF2_SIZE_MASK;
|
|
int len;
|
|
|
|
if (s->rx_frame_len && len1) {
|
|
if (s->rx_frame_len > len1) {
|
|
len = len1;
|
|
} else {
|
|
len = s->rx_frame_len;
|
|
}
|
|
|
|
pci_dma_write(&s->dev, desc->buf_addr1, s->rx_frame +
|
|
(s->rx_frame_size - s->rx_frame_len), len);
|
|
s->rx_frame_len -= len;
|
|
}
|
|
|
|
if (s->rx_frame_len && len2) {
|
|
if (s->rx_frame_len > len2) {
|
|
len = len2;
|
|
} else {
|
|
len = s->rx_frame_len;
|
|
}
|
|
|
|
pci_dma_write(&s->dev, desc->buf_addr2, s->rx_frame +
|
|
(s->rx_frame_size - s->rx_frame_len), len);
|
|
s->rx_frame_len -= len;
|
|
}
|
|
}
|
|
|
|
static bool tulip_filter_address(TULIPState *s, const uint8_t *addr)
|
|
{
|
|
static const char broadcast[] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
|
|
bool ret = false;
|
|
int i;
|
|
|
|
for (i = 0; i < 16 && ret == false; i++) {
|
|
if (!memcmp(&s->filter[i], addr, ETH_ALEN)) {
|
|
ret = true;
|
|
}
|
|
}
|
|
|
|
if (!memcmp(addr, broadcast, ETH_ALEN)) {
|
|
return true;
|
|
}
|
|
|
|
if (s->csr[6] & (CSR6_PR | CSR6_RA)) {
|
|
/* Promiscuous mode enabled */
|
|
s->rx_status |= RDES0_FF;
|
|
return true;
|
|
}
|
|
|
|
if ((s->csr[6] & CSR6_PM) && (addr[0] & 1)) {
|
|
/* Pass all Multicast enabled */
|
|
s->rx_status |= RDES0_MF;
|
|
return true;
|
|
}
|
|
|
|
if (s->csr[6] & CSR6_IF) {
|
|
ret ^= true;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
static ssize_t tulip_receive(TULIPState *s, const uint8_t *buf, size_t size)
|
|
{
|
|
struct tulip_descriptor desc;
|
|
|
|
trace_tulip_receive(buf, size);
|
|
|
|
if (size < 14 || size > sizeof(s->rx_frame) - 4
|
|
|| s->rx_frame_len || tulip_rx_stopped(s)) {
|
|
return 0;
|
|
}
|
|
|
|
if (!tulip_filter_address(s, buf)) {
|
|
return size;
|
|
}
|
|
|
|
do {
|
|
tulip_desc_read(s, s->current_rx_desc, &desc);
|
|
tulip_dump_rx_descriptor(s, &desc);
|
|
|
|
if (!(desc.status & RDES0_OWN)) {
|
|
s->csr[5] |= CSR5_RU;
|
|
tulip_update_int(s);
|
|
return s->rx_frame_size - s->rx_frame_len;
|
|
}
|
|
desc.status = 0;
|
|
|
|
if (!s->rx_frame_len) {
|
|
s->rx_frame_size = size + 4;
|
|
s->rx_status = RDES0_LS |
|
|
((s->rx_frame_size & RDES0_FL_MASK) << RDES0_FL_SHIFT);
|
|
desc.status |= RDES0_FS;
|
|
memcpy(s->rx_frame, buf, size);
|
|
s->rx_frame_len = s->rx_frame_size;
|
|
}
|
|
|
|
tulip_copy_rx_bytes(s, &desc);
|
|
|
|
if (!s->rx_frame_len) {
|
|
desc.status |= s->rx_status;
|
|
s->csr[5] |= CSR5_RI;
|
|
tulip_update_int(s);
|
|
}
|
|
tulip_dump_rx_descriptor(s, &desc);
|
|
tulip_desc_write(s, s->current_rx_desc, &desc);
|
|
tulip_next_rx_descriptor(s, &desc);
|
|
} while (s->rx_frame_len);
|
|
return size;
|
|
}
|
|
|
|
static ssize_t tulip_receive_nc(NetClientState *nc,
|
|
const uint8_t *buf, size_t size)
|
|
{
|
|
return tulip_receive(qemu_get_nic_opaque(nc), buf, size);
|
|
}
|
|
|
|
static NetClientInfo net_tulip_info = {
|
|
.type = NET_CLIENT_DRIVER_NIC,
|
|
.size = sizeof(NICState),
|
|
.receive = tulip_receive_nc,
|
|
};
|
|
|
|
static const char *tulip_reg_name(const hwaddr addr)
|
|
{
|
|
switch (addr) {
|
|
case CSR(0):
|
|
return "CSR0";
|
|
|
|
case CSR(1):
|
|
return "CSR1";
|
|
|
|
case CSR(2):
|
|
return "CSR2";
|
|
|
|
case CSR(3):
|
|
return "CSR3";
|
|
|
|
case CSR(4):
|
|
return "CSR4";
|
|
|
|
case CSR(5):
|
|
return "CSR5";
|
|
|
|
case CSR(6):
|
|
return "CSR6";
|
|
|
|
case CSR(7):
|
|
return "CSR7";
|
|
|
|
case CSR(8):
|
|
return "CSR8";
|
|
|
|
case CSR(9):
|
|
return "CSR9";
|
|
|
|
case CSR(10):
|
|
return "CSR10";
|
|
|
|
case CSR(11):
|
|
return "CSR11";
|
|
|
|
case CSR(12):
|
|
return "CSR12";
|
|
|
|
case CSR(13):
|
|
return "CSR13";
|
|
|
|
case CSR(14):
|
|
return "CSR14";
|
|
|
|
case CSR(15):
|
|
return "CSR15";
|
|
|
|
default:
|
|
break;
|
|
}
|
|
return "";
|
|
}
|
|
|
|
static const char *tulip_rx_state_name(int state)
|
|
{
|
|
switch (state) {
|
|
case CSR5_RS_STOPPED:
|
|
return "STOPPED";
|
|
|
|
case CSR5_RS_RUNNING_FETCH:
|
|
return "RUNNING/FETCH";
|
|
|
|
case CSR5_RS_RUNNING_CHECK_EOR:
|
|
return "RUNNING/CHECK EOR";
|
|
|
|
case CSR5_RS_RUNNING_WAIT_RECEIVE:
|
|
return "WAIT RECEIVE";
|
|
|
|
case CSR5_RS_SUSPENDED:
|
|
return "SUSPENDED";
|
|
|
|
case CSR5_RS_RUNNING_CLOSE:
|
|
return "RUNNING/CLOSE";
|
|
|
|
case CSR5_RS_RUNNING_FLUSH:
|
|
return "RUNNING/FLUSH";
|
|
|
|
case CSR5_RS_RUNNING_QUEUE:
|
|
return "RUNNING/QUEUE";
|
|
|
|
default:
|
|
break;
|
|
}
|
|
return "";
|
|
}
|
|
|
|
static const char *tulip_tx_state_name(int state)
|
|
{
|
|
switch (state) {
|
|
case CSR5_TS_STOPPED:
|
|
return "STOPPED";
|
|
|
|
case CSR5_TS_RUNNING_FETCH:
|
|
return "RUNNING/FETCH";
|
|
|
|
case CSR5_TS_RUNNING_WAIT_EOT:
|
|
return "RUNNING/WAIT EOT";
|
|
|
|
case CSR5_TS_RUNNING_READ_BUF:
|
|
return "RUNNING/READ BUF";
|
|
|
|
case CSR5_TS_RUNNING_SETUP:
|
|
return "RUNNING/SETUP";
|
|
|
|
case CSR5_TS_SUSPENDED:
|
|
return "SUSPENDED";
|
|
|
|
case CSR5_TS_RUNNING_CLOSE:
|
|
return "RUNNING/CLOSE";
|
|
|
|
default:
|
|
break;
|
|
}
|
|
return "";
|
|
}
|
|
|
|
static void tulip_update_rs(TULIPState *s, int state)
|
|
{
|
|
s->csr[5] &= ~(CSR5_RS_MASK << CSR5_RS_SHIFT);
|
|
s->csr[5] |= (state & CSR5_RS_MASK) << CSR5_RS_SHIFT;
|
|
trace_tulip_rx_state(tulip_rx_state_name(state));
|
|
}
|
|
|
|
static uint16_t tulip_mdi_default[] = {
|
|
/* MDI Registers 0 - 6, 7 */
|
|
0x3100, 0xf02c, 0x7810, 0x0000, 0x0501, 0x4181, 0x0000, 0x0000,
|
|
/* MDI Registers 8 - 15 */
|
|
0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
/* MDI Registers 16 - 31 */
|
|
0x0003, 0x0000, 0x0001, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
};
|
|
|
|
/* Readonly mask for MDI (PHY) registers */
|
|
static const uint16_t tulip_mdi_mask[] = {
|
|
0x0000, 0xffff, 0xffff, 0xffff, 0xc01f, 0xffff, 0xffff, 0x0000,
|
|
0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
0x0fff, 0x0000, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
|
|
0xffff, 0xffff, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
|
|
};
|
|
|
|
static uint16_t tulip_mii_read(TULIPState *s, int phy, int reg)
|
|
{
|
|
uint16_t ret = 0;
|
|
if (phy == 1) {
|
|
ret = tulip_mdi_default[reg];
|
|
}
|
|
trace_tulip_mii_read(phy, reg, ret);
|
|
return ret;
|
|
}
|
|
|
|
static void tulip_mii_write(TULIPState *s, int phy, int reg, uint16_t data)
|
|
{
|
|
trace_tulip_mii_write(phy, reg, data);
|
|
|
|
if (phy != 1) {
|
|
return;
|
|
}
|
|
|
|
tulip_mdi_default[reg] &= ~tulip_mdi_mask[reg];
|
|
tulip_mdi_default[reg] |= (data & tulip_mdi_mask[reg]);
|
|
}
|
|
|
|
static void tulip_mii(TULIPState *s)
|
|
{
|
|
uint32_t changed = s->old_csr9 ^ s->csr[9];
|
|
uint16_t data;
|
|
int op, phy, reg;
|
|
|
|
if (!(changed & CSR9_MDC)) {
|
|
return;
|
|
}
|
|
|
|
if (!(s->csr[9] & CSR9_MDC)) {
|
|
return;
|
|
}
|
|
|
|
s->mii_bitcnt++;
|
|
s->mii_word <<= 1;
|
|
|
|
if (s->csr[9] & CSR9_MDO && (s->mii_bitcnt < 16 ||
|
|
!(s->csr[9] & CSR9_MII))) {
|
|
/* write op or address bits */
|
|
s->mii_word |= 1;
|
|
}
|
|
|
|
if (s->mii_bitcnt >= 16 && (s->csr[9] & CSR9_MII)) {
|
|
if (s->mii_word & 0x8000) {
|
|
s->csr[9] |= CSR9_MDI;
|
|
} else {
|
|
s->csr[9] &= ~CSR9_MDI;
|
|
}
|
|
}
|
|
|
|
if (s->mii_word == 0xffffffff) {
|
|
s->mii_bitcnt = 0;
|
|
} else if (s->mii_bitcnt == 16) {
|
|
op = (s->mii_word >> 12) & 0x0f;
|
|
phy = (s->mii_word >> 7) & 0x1f;
|
|
reg = (s->mii_word >> 2) & 0x1f;
|
|
|
|
if (op == 6) {
|
|
s->mii_word = tulip_mii_read(s, phy, reg);
|
|
}
|
|
} else if (s->mii_bitcnt == 32) {
|
|
op = (s->mii_word >> 28) & 0x0f;
|
|
phy = (s->mii_word >> 23) & 0x1f;
|
|
reg = (s->mii_word >> 18) & 0x1f;
|
|
data = s->mii_word & 0xffff;
|
|
|
|
if (op == 5) {
|
|
tulip_mii_write(s, phy, reg, data);
|
|
}
|
|
}
|
|
}
|
|
|
|
static uint32_t tulip_csr9_read(TULIPState *s)
|
|
{
|
|
if (s->csr[9] & CSR9_SR) {
|
|
if (eeprom93xx_read(s->eeprom)) {
|
|
s->csr[9] |= CSR9_SR_DO;
|
|
} else {
|
|
s->csr[9] &= ~CSR9_SR_DO;
|
|
}
|
|
}
|
|
|
|
tulip_mii(s);
|
|
return s->csr[9];
|
|
}
|
|
|
|
static void tulip_update_ts(TULIPState *s, int state)
|
|
{
|
|
s->csr[5] &= ~(CSR5_TS_MASK << CSR5_TS_SHIFT);
|
|
s->csr[5] |= (state & CSR5_TS_MASK) << CSR5_TS_SHIFT;
|
|
trace_tulip_tx_state(tulip_tx_state_name(state));
|
|
}
|
|
|
|
static uint64_t tulip_read(void *opaque, hwaddr addr,
|
|
unsigned size)
|
|
{
|
|
TULIPState *s = opaque;
|
|
uint64_t data = 0;
|
|
|
|
switch (addr) {
|
|
case CSR(9):
|
|
data = tulip_csr9_read(s);
|
|
break;
|
|
|
|
case CSR(12):
|
|
/* Fake autocompletion complete until we have PHY emulation */
|
|
data = 5 << CSR12_ANS_SHIFT;
|
|
break;
|
|
|
|
default:
|
|
if (addr & 7) {
|
|
qemu_log_mask(LOG_GUEST_ERROR, "%s: read access at unknown address"
|
|
" 0x%"PRIx64"\n", __func__, addr);
|
|
} else {
|
|
data = s->csr[addr >> 3];
|
|
}
|
|
break;
|
|
}
|
|
trace_tulip_reg_read(addr, tulip_reg_name(addr), size, data);
|
|
return data;
|
|
}
|
|
|
|
static void tulip_tx(TULIPState *s, struct tulip_descriptor *desc)
|
|
{
|
|
if (s->tx_frame_len) {
|
|
if ((s->csr[6] >> CSR6_OM_SHIFT) & CSR6_OM_MASK) {
|
|
/* Internal or external Loopback */
|
|
tulip_receive(s, s->tx_frame, s->tx_frame_len);
|
|
} else if (s->tx_frame_len <= sizeof(s->tx_frame)) {
|
|
qemu_send_packet(qemu_get_queue(s->nic),
|
|
s->tx_frame, s->tx_frame_len);
|
|
}
|
|
}
|
|
|
|
if (desc->control & TDES1_IC) {
|
|
s->csr[5] |= CSR5_TI;
|
|
tulip_update_int(s);
|
|
}
|
|
}
|
|
|
|
static int tulip_copy_tx_buffers(TULIPState *s, struct tulip_descriptor *desc)
|
|
{
|
|
int len1 = (desc->control >> TDES1_BUF1_SIZE_SHIFT) & TDES1_BUF1_SIZE_MASK;
|
|
int len2 = (desc->control >> TDES1_BUF2_SIZE_SHIFT) & TDES1_BUF2_SIZE_MASK;
|
|
|
|
if (s->tx_frame_len + len1 > sizeof(s->tx_frame)) {
|
|
qemu_log_mask(LOG_GUEST_ERROR,
|
|
"%s: descriptor overflow (ofs: %u, len:%d, size:%zu)\n",
|
|
__func__, s->tx_frame_len, len1, sizeof(s->tx_frame));
|
|
return -1;
|
|
}
|
|
if (len1) {
|
|
pci_dma_read(&s->dev, desc->buf_addr1,
|
|
s->tx_frame + s->tx_frame_len, len1);
|
|
s->tx_frame_len += len1;
|
|
}
|
|
|
|
if (s->tx_frame_len + len2 > sizeof(s->tx_frame)) {
|
|
qemu_log_mask(LOG_GUEST_ERROR,
|
|
"%s: descriptor overflow (ofs: %u, len:%d, size:%zu)\n",
|
|
__func__, s->tx_frame_len, len2, sizeof(s->tx_frame));
|
|
return -1;
|
|
}
|
|
if (len2) {
|
|
pci_dma_read(&s->dev, desc->buf_addr2,
|
|
s->tx_frame + s->tx_frame_len, len2);
|
|
s->tx_frame_len += len2;
|
|
}
|
|
desc->status = (len1 + len2) ? 0 : 0x7fffffff;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void tulip_setup_filter_addr(TULIPState *s, uint8_t *buf, int n)
|
|
{
|
|
int offset = n * 12;
|
|
|
|
s->filter[n][0] = buf[offset];
|
|
s->filter[n][1] = buf[offset + 1];
|
|
|
|
s->filter[n][2] = buf[offset + 4];
|
|
s->filter[n][3] = buf[offset + 5];
|
|
|
|
s->filter[n][4] = buf[offset + 8];
|
|
s->filter[n][5] = buf[offset + 9];
|
|
|
|
trace_tulip_setup_filter(n, s->filter[n][5], s->filter[n][4],
|
|
s->filter[n][3], s->filter[n][2], s->filter[n][1], s->filter[n][0]);
|
|
}
|
|
|
|
static void tulip_setup_frame(TULIPState *s,
|
|
struct tulip_descriptor *desc)
|
|
{
|
|
uint8_t buf[4096];
|
|
int len = (desc->control >> TDES1_BUF1_SIZE_SHIFT) & TDES1_BUF1_SIZE_MASK;
|
|
int i;
|
|
|
|
trace_tulip_setup_frame();
|
|
|
|
if (len == 192) {
|
|
pci_dma_read(&s->dev, desc->buf_addr1, buf, len);
|
|
for (i = 0; i < 16; i++) {
|
|
tulip_setup_filter_addr(s, buf, i);
|
|
}
|
|
}
|
|
|
|
desc->status = 0x7fffffff;
|
|
|
|
if (desc->control & TDES1_IC) {
|
|
s->csr[5] |= CSR5_TI;
|
|
tulip_update_int(s);
|
|
}
|
|
}
|
|
|
|
static void tulip_next_tx_descriptor(TULIPState *s,
|
|
struct tulip_descriptor *desc)
|
|
{
|
|
if (desc->control & TDES1_TER) {
|
|
s->current_tx_desc = s->csr[4];
|
|
} else if (desc->control & TDES1_TCH) {
|
|
s->current_tx_desc = desc->buf_addr2;
|
|
} else {
|
|
s->current_tx_desc += sizeof(struct tulip_descriptor) +
|
|
(((s->csr[0] >> CSR0_DSL_SHIFT) & CSR0_DSL_MASK) << 2);
|
|
}
|
|
s->current_tx_desc &= ~3ULL;
|
|
}
|
|
|
|
static uint32_t tulip_ts(TULIPState *s)
|
|
{
|
|
return (s->csr[5] >> CSR5_TS_SHIFT) & CSR5_TS_MASK;
|
|
}
|
|
|
|
static void tulip_xmit_list_update(TULIPState *s)
|
|
{
|
|
#define TULIP_DESC_MAX 128
|
|
uint8_t i = 0;
|
|
struct tulip_descriptor desc;
|
|
|
|
if (tulip_ts(s) != CSR5_TS_SUSPENDED) {
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < TULIP_DESC_MAX; i++) {
|
|
tulip_desc_read(s, s->current_tx_desc, &desc);
|
|
tulip_dump_tx_descriptor(s, &desc);
|
|
|
|
if (!(desc.status & TDES0_OWN)) {
|
|
tulip_update_ts(s, CSR5_TS_SUSPENDED);
|
|
s->csr[5] |= CSR5_TU;
|
|
tulip_update_int(s);
|
|
return;
|
|
}
|
|
|
|
if (desc.control & TDES1_SET) {
|
|
tulip_setup_frame(s, &desc);
|
|
} else {
|
|
if (desc.control & TDES1_FS) {
|
|
s->tx_frame_len = 0;
|
|
}
|
|
|
|
if (!tulip_copy_tx_buffers(s, &desc)) {
|
|
if (desc.control & TDES1_LS) {
|
|
tulip_tx(s, &desc);
|
|
}
|
|
}
|
|
}
|
|
tulip_desc_write(s, s->current_tx_desc, &desc);
|
|
tulip_next_tx_descriptor(s, &desc);
|
|
}
|
|
}
|
|
|
|
static void tulip_csr9_write(TULIPState *s, uint32_t old_val,
|
|
uint32_t new_val)
|
|
{
|
|
if (new_val & CSR9_SR) {
|
|
eeprom93xx_write(s->eeprom,
|
|
!!(new_val & CSR9_SR_CS),
|
|
!!(new_val & CSR9_SR_SK),
|
|
!!(new_val & CSR9_SR_DI));
|
|
}
|
|
}
|
|
|
|
static void tulip_reset(TULIPState *s)
|
|
{
|
|
trace_tulip_reset();
|
|
|
|
s->csr[0] = 0xfe000000;
|
|
s->csr[1] = 0xffffffff;
|
|
s->csr[2] = 0xffffffff;
|
|
s->csr[5] = 0xf0000000;
|
|
s->csr[6] = 0x32000040;
|
|
s->csr[7] = 0xf3fe0000;
|
|
s->csr[8] = 0xe0000000;
|
|
s->csr[9] = 0xfff483ff;
|
|
s->csr[11] = 0xfffe0000;
|
|
s->csr[12] = 0x000000c6;
|
|
s->csr[13] = 0xffff0000;
|
|
s->csr[14] = 0xffffffff;
|
|
s->csr[15] = 0x8ff00000;
|
|
}
|
|
|
|
static void tulip_qdev_reset(DeviceState *dev)
|
|
{
|
|
PCIDevice *d = PCI_DEVICE(dev);
|
|
TULIPState *s = TULIP(d);
|
|
|
|
tulip_reset(s);
|
|
}
|
|
|
|
static void tulip_write(void *opaque, hwaddr addr,
|
|
uint64_t data, unsigned size)
|
|
{
|
|
TULIPState *s = opaque;
|
|
trace_tulip_reg_write(addr, tulip_reg_name(addr), size, data);
|
|
|
|
switch (addr) {
|
|
case CSR(0):
|
|
s->csr[0] = data;
|
|
if (data & CSR0_SWR) {
|
|
tulip_reset(s);
|
|
tulip_update_int(s);
|
|
}
|
|
break;
|
|
|
|
case CSR(1):
|
|
tulip_xmit_list_update(s);
|
|
break;
|
|
|
|
case CSR(2):
|
|
qemu_flush_queued_packets(qemu_get_queue(s->nic));
|
|
break;
|
|
|
|
case CSR(3):
|
|
s->csr[3] = data & ~3ULL;
|
|
s->current_rx_desc = s->csr[3];
|
|
qemu_flush_queued_packets(qemu_get_queue(s->nic));
|
|
break;
|
|
|
|
case CSR(4):
|
|
s->csr[4] = data & ~3ULL;
|
|
s->current_tx_desc = s->csr[4];
|
|
tulip_xmit_list_update(s);
|
|
break;
|
|
|
|
case CSR(5):
|
|
/* Status register, write clears bit */
|
|
s->csr[5] &= ~(data & (CSR5_TI | CSR5_TPS | CSR5_TU | CSR5_TJT |
|
|
CSR5_LNP_ANC | CSR5_UNF | CSR5_RI | CSR5_RU |
|
|
CSR5_RPS | CSR5_RWT | CSR5_ETI | CSR5_GTE |
|
|
CSR5_LNF | CSR5_FBE | CSR5_ERI | CSR5_AIS |
|
|
CSR5_NIS | CSR5_GPI | CSR5_LC));
|
|
tulip_update_int(s);
|
|
break;
|
|
|
|
case CSR(6):
|
|
s->csr[6] = data;
|
|
if (s->csr[6] & CSR6_SR) {
|
|
tulip_update_rs(s, CSR5_RS_RUNNING_WAIT_RECEIVE);
|
|
qemu_flush_queued_packets(qemu_get_queue(s->nic));
|
|
} else {
|
|
tulip_update_rs(s, CSR5_RS_STOPPED);
|
|
}
|
|
|
|
if (s->csr[6] & CSR6_ST) {
|
|
tulip_update_ts(s, CSR5_TS_SUSPENDED);
|
|
tulip_xmit_list_update(s);
|
|
} else {
|
|
tulip_update_ts(s, CSR5_TS_STOPPED);
|
|
}
|
|
break;
|
|
|
|
case CSR(7):
|
|
s->csr[7] = data;
|
|
tulip_update_int(s);
|
|
break;
|
|
|
|
case CSR(8):
|
|
s->csr[9] = data;
|
|
break;
|
|
|
|
case CSR(9):
|
|
tulip_csr9_write(s, s->csr[9], data);
|
|
/* don't clear MII read data */
|
|
s->csr[9] &= CSR9_MDI;
|
|
s->csr[9] |= (data & ~CSR9_MDI);
|
|
tulip_mii(s);
|
|
s->old_csr9 = s->csr[9];
|
|
break;
|
|
|
|
case CSR(10):
|
|
s->csr[10] = data;
|
|
break;
|
|
|
|
case CSR(11):
|
|
s->csr[11] = data;
|
|
break;
|
|
|
|
case CSR(12):
|
|
/* SIA Status register, some bits are cleared by writing 1 */
|
|
s->csr[12] &= ~(data & (CSR12_MRA | CSR12_TRA | CSR12_ARA));
|
|
break;
|
|
|
|
case CSR(13):
|
|
s->csr[13] = data;
|
|
break;
|
|
|
|
case CSR(14):
|
|
s->csr[14] = data;
|
|
break;
|
|
|
|
case CSR(15):
|
|
s->csr[15] = data;
|
|
break;
|
|
|
|
default:
|
|
qemu_log_mask(LOG_GUEST_ERROR, "%s: write to CSR at unknown address "
|
|
"0x%"PRIx64"\n", __func__, addr);
|
|
break;
|
|
}
|
|
}
|
|
|
|
static const MemoryRegionOps tulip_ops = {
|
|
.read = tulip_read,
|
|
.write = tulip_write,
|
|
.endianness = DEVICE_LITTLE_ENDIAN,
|
|
.impl = {
|
|
.min_access_size = 4,
|
|
.max_access_size = 4,
|
|
},
|
|
};
|
|
|
|
static void tulip_idblock_crc(TULIPState *s, uint16_t *srom)
|
|
{
|
|
int word, n;
|
|
int bit;
|
|
unsigned char bitval, crc;
|
|
const int len = 9;
|
|
n = 0;
|
|
crc = -1;
|
|
|
|
for (word = 0; word < len; word++) {
|
|
for (bit = 15; bit >= 0; bit--) {
|
|
if ((word == (len - 1)) && (bit == 7)) {
|
|
/*
|
|
* Insert the correct CRC result into input data stream
|
|
* in place.
|
|
*/
|
|
srom[len - 1] = (srom[len - 1] & 0xff00) | (unsigned short)crc;
|
|
break;
|
|
}
|
|
n++;
|
|
bitval = ((srom[word] >> bit) & 1) ^ ((crc >> 7) & 1);
|
|
crc = crc << 1;
|
|
if (bitval == 1) {
|
|
crc ^= 6;
|
|
crc |= 0x01;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
static uint16_t tulip_srom_crc(TULIPState *s, uint8_t *eeprom, size_t len)
|
|
{
|
|
unsigned long crc = 0xffffffff;
|
|
unsigned long flippedcrc = 0;
|
|
unsigned char currentbyte;
|
|
unsigned int msb, bit, i;
|
|
|
|
for (i = 0; i < len; i++) {
|
|
currentbyte = eeprom[i];
|
|
for (bit = 0; bit < 8; bit++) {
|
|
msb = (crc >> 31) & 1;
|
|
crc <<= 1;
|
|
if (msb ^ (currentbyte & 1)) {
|
|
crc ^= 0x04c11db6;
|
|
crc |= 0x00000001;
|
|
}
|
|
currentbyte >>= 1;
|
|
}
|
|
}
|
|
|
|
for (i = 0; i < 32; i++) {
|
|
flippedcrc <<= 1;
|
|
bit = crc & 1;
|
|
crc >>= 1;
|
|
flippedcrc += bit;
|
|
}
|
|
return (flippedcrc ^ 0xffffffff) & 0xffff;
|
|
}
|
|
|
|
static const uint8_t eeprom_default[128] = {
|
|
0x3c, 0x10, 0x4f, 0x10, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x56, 0x08, 0x04, 0x01, 0x00, 0x80, 0x48, 0xb3,
|
|
0x0e, 0xa7, 0x00, 0x1e, 0x00, 0x00, 0x00, 0x08,
|
|
0x01, 0x8d, 0x03, 0x00, 0x00, 0x00, 0x00, 0x78,
|
|
0xe0, 0x01, 0x00, 0x50, 0x00, 0x18, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xe8, 0x6b,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80,
|
|
0x48, 0xb3, 0x0e, 0xa7, 0x40, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
};
|
|
|
|
static void tulip_fill_eeprom(TULIPState *s)
|
|
{
|
|
uint16_t *eeprom = eeprom93xx_data(s->eeprom);
|
|
memcpy(eeprom, eeprom_default, 128);
|
|
|
|
/* patch in our mac address */
|
|
eeprom[10] = cpu_to_le16(s->c.macaddr.a[0] | (s->c.macaddr.a[1] << 8));
|
|
eeprom[11] = cpu_to_le16(s->c.macaddr.a[2] | (s->c.macaddr.a[3] << 8));
|
|
eeprom[12] = cpu_to_le16(s->c.macaddr.a[4] | (s->c.macaddr.a[5] << 8));
|
|
tulip_idblock_crc(s, eeprom);
|
|
eeprom[63] = cpu_to_le16(tulip_srom_crc(s, (uint8_t *)eeprom, 126));
|
|
}
|
|
|
|
static void pci_tulip_realize(PCIDevice *pci_dev, Error **errp)
|
|
{
|
|
TULIPState *s = DO_UPCAST(TULIPState, dev, pci_dev);
|
|
uint8_t *pci_conf;
|
|
|
|
pci_conf = s->dev.config;
|
|
pci_conf[PCI_INTERRUPT_PIN] = 1; /* interrupt pin A */
|
|
|
|
s->eeprom = eeprom93xx_new(&pci_dev->qdev, 64);
|
|
tulip_fill_eeprom(s);
|
|
|
|
memory_region_init_io(&s->io, OBJECT(&s->dev), &tulip_ops, s,
|
|
"tulip-io", 128);
|
|
|
|
memory_region_init_io(&s->memory, OBJECT(&s->dev), &tulip_ops, s,
|
|
"tulip-mem", 128);
|
|
|
|
pci_register_bar(&s->dev, 0, PCI_BASE_ADDRESS_SPACE_IO, &s->io);
|
|
pci_register_bar(&s->dev, 1, PCI_BASE_ADDRESS_SPACE_MEMORY, &s->memory);
|
|
|
|
s->irq = pci_allocate_irq(&s->dev);
|
|
|
|
qemu_macaddr_default_if_unset(&s->c.macaddr);
|
|
|
|
s->nic = qemu_new_nic(&net_tulip_info, &s->c,
|
|
object_get_typename(OBJECT(pci_dev)),
|
|
pci_dev->qdev.id, s);
|
|
qemu_format_nic_info_str(qemu_get_queue(s->nic), s->c.macaddr.a);
|
|
}
|
|
|
|
static void pci_tulip_exit(PCIDevice *pci_dev)
|
|
{
|
|
TULIPState *s = DO_UPCAST(TULIPState, dev, pci_dev);
|
|
|
|
qemu_del_nic(s->nic);
|
|
qemu_free_irq(s->irq);
|
|
eeprom93xx_free(&pci_dev->qdev, s->eeprom);
|
|
}
|
|
|
|
static void tulip_instance_init(Object *obj)
|
|
{
|
|
PCIDevice *pci_dev = PCI_DEVICE(obj);
|
|
TULIPState *d = DO_UPCAST(TULIPState, dev, pci_dev);
|
|
|
|
device_add_bootindex_property(obj, &d->c.bootindex,
|
|
"bootindex", "/ethernet-phy@0",
|
|
&pci_dev->qdev);
|
|
}
|
|
|
|
static Property tulip_properties[] = {
|
|
DEFINE_NIC_PROPERTIES(TULIPState, c),
|
|
DEFINE_PROP_END_OF_LIST(),
|
|
};
|
|
|
|
static void tulip_class_init(ObjectClass *klass, void *data)
|
|
{
|
|
DeviceClass *dc = DEVICE_CLASS(klass);
|
|
PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);
|
|
|
|
k->realize = pci_tulip_realize;
|
|
k->exit = pci_tulip_exit;
|
|
k->vendor_id = PCI_VENDOR_ID_DEC;
|
|
k->device_id = PCI_DEVICE_ID_DEC_21143;
|
|
k->subsystem_vendor_id = 0x103c;
|
|
k->subsystem_id = 0x104f;
|
|
k->class_id = PCI_CLASS_NETWORK_ETHERNET;
|
|
dc->vmsd = &vmstate_pci_tulip;
|
|
device_class_set_props(dc, tulip_properties);
|
|
dc->reset = tulip_qdev_reset;
|
|
set_bit(DEVICE_CATEGORY_NETWORK, dc->categories);
|
|
}
|
|
|
|
static const TypeInfo tulip_info = {
|
|
.name = TYPE_TULIP,
|
|
.parent = TYPE_PCI_DEVICE,
|
|
.instance_size = sizeof(TULIPState),
|
|
.class_init = tulip_class_init,
|
|
.instance_init = tulip_instance_init,
|
|
.interfaces = (InterfaceInfo[]) {
|
|
{ INTERFACE_CONVENTIONAL_PCI_DEVICE },
|
|
{ },
|
|
},
|
|
};
|
|
|
|
static void tulip_register_types(void)
|
|
{
|
|
type_register_static(&tulip_info);
|
|
}
|
|
|
|
type_init(tulip_register_types)
|