|  | /* | 
|  | * SMSC 91C111 Ethernet interface emulation | 
|  | * | 
|  | * Copyright (c) 2005 CodeSourcery, LLC. | 
|  | * Written by Paul Brook | 
|  | * | 
|  | * This code is licensed under the GPL | 
|  | */ | 
|  |  | 
|  | #include "qemu/osdep.h" | 
|  | #include "hw/sysbus.h" | 
|  | #include "migration/vmstate.h" | 
|  | #include "net/net.h" | 
|  | #include "hw/irq.h" | 
|  | #include "hw/net/smc91c111.h" | 
|  | #include "hw/qdev-properties.h" | 
|  | #include "qapi/error.h" | 
|  | #include "qemu/log.h" | 
|  | #include "qemu/module.h" | 
|  | /* For crc32 */ | 
|  | #include <zlib.h> | 
|  | #include "qom/object.h" | 
|  |  | 
|  | /* Number of 2k memory pages available.  */ | 
|  | #define NUM_PACKETS 4 | 
|  |  | 
|  | #define TYPE_SMC91C111 "smc91c111" | 
|  | OBJECT_DECLARE_SIMPLE_TYPE(smc91c111_state, SMC91C111) | 
|  |  | 
|  | struct smc91c111_state { | 
|  | SysBusDevice parent_obj; | 
|  |  | 
|  | NICState *nic; | 
|  | NICConf conf; | 
|  | uint16_t tcr; | 
|  | uint16_t rcr; | 
|  | uint16_t cr; | 
|  | uint16_t ctr; | 
|  | uint16_t gpr; | 
|  | uint16_t ptr; | 
|  | uint16_t ercv; | 
|  | qemu_irq irq; | 
|  | int bank; | 
|  | int packet_num; | 
|  | int tx_alloc; | 
|  | /* Bitmask of allocated packets.  */ | 
|  | int allocated; | 
|  | int tx_fifo_len; | 
|  | int tx_fifo[NUM_PACKETS]; | 
|  | int rx_fifo_len; | 
|  | int rx_fifo[NUM_PACKETS]; | 
|  | int tx_fifo_done_len; | 
|  | int tx_fifo_done[NUM_PACKETS]; | 
|  | /* Packet buffer memory.  */ | 
|  | uint8_t data[NUM_PACKETS][2048]; | 
|  | uint8_t int_level; | 
|  | uint8_t int_mask; | 
|  | MemoryRegion mmio; | 
|  | }; | 
|  |  | 
|  | static const VMStateDescription vmstate_smc91c111 = { | 
|  | .name = "smc91c111", | 
|  | .version_id = 1, | 
|  | .minimum_version_id = 1, | 
|  | .fields = (VMStateField[]) { | 
|  | VMSTATE_UINT16(tcr, smc91c111_state), | 
|  | VMSTATE_UINT16(rcr, smc91c111_state), | 
|  | VMSTATE_UINT16(cr, smc91c111_state), | 
|  | VMSTATE_UINT16(ctr, smc91c111_state), | 
|  | VMSTATE_UINT16(gpr, smc91c111_state), | 
|  | VMSTATE_UINT16(ptr, smc91c111_state), | 
|  | VMSTATE_UINT16(ercv, smc91c111_state), | 
|  | VMSTATE_INT32(bank, smc91c111_state), | 
|  | VMSTATE_INT32(packet_num, smc91c111_state), | 
|  | VMSTATE_INT32(tx_alloc, smc91c111_state), | 
|  | VMSTATE_INT32(allocated, smc91c111_state), | 
|  | VMSTATE_INT32(tx_fifo_len, smc91c111_state), | 
|  | VMSTATE_INT32_ARRAY(tx_fifo, smc91c111_state, NUM_PACKETS), | 
|  | VMSTATE_INT32(rx_fifo_len, smc91c111_state), | 
|  | VMSTATE_INT32_ARRAY(rx_fifo, smc91c111_state, NUM_PACKETS), | 
|  | VMSTATE_INT32(tx_fifo_done_len, smc91c111_state), | 
|  | VMSTATE_INT32_ARRAY(tx_fifo_done, smc91c111_state, NUM_PACKETS), | 
|  | VMSTATE_BUFFER_UNSAFE(data, smc91c111_state, 0, NUM_PACKETS * 2048), | 
|  | VMSTATE_UINT8(int_level, smc91c111_state), | 
|  | VMSTATE_UINT8(int_mask, smc91c111_state), | 
|  | VMSTATE_END_OF_LIST() | 
|  | } | 
|  | }; | 
|  |  | 
|  | #define RCR_SOFT_RST  0x8000 | 
|  | #define RCR_STRIP_CRC 0x0200 | 
|  | #define RCR_RXEN      0x0100 | 
|  |  | 
|  | #define TCR_EPH_LOOP  0x2000 | 
|  | #define TCR_NOCRC     0x0100 | 
|  | #define TCR_PAD_EN    0x0080 | 
|  | #define TCR_FORCOL    0x0004 | 
|  | #define TCR_LOOP      0x0002 | 
|  | #define TCR_TXEN      0x0001 | 
|  |  | 
|  | #define INT_MD        0x80 | 
|  | #define INT_ERCV      0x40 | 
|  | #define INT_EPH       0x20 | 
|  | #define INT_RX_OVRN   0x10 | 
|  | #define INT_ALLOC     0x08 | 
|  | #define INT_TX_EMPTY  0x04 | 
|  | #define INT_TX        0x02 | 
|  | #define INT_RCV       0x01 | 
|  |  | 
|  | #define CTR_AUTO_RELEASE  0x0800 | 
|  | #define CTR_RELOAD        0x0002 | 
|  | #define CTR_STORE         0x0001 | 
|  |  | 
|  | #define RS_ALGNERR      0x8000 | 
|  | #define RS_BRODCAST     0x4000 | 
|  | #define RS_BADCRC       0x2000 | 
|  | #define RS_ODDFRAME     0x1000 | 
|  | #define RS_TOOLONG      0x0800 | 
|  | #define RS_TOOSHORT     0x0400 | 
|  | #define RS_MULTICAST    0x0001 | 
|  |  | 
|  | /* Update interrupt status.  */ | 
|  | static void smc91c111_update(smc91c111_state *s) | 
|  | { | 
|  | int level; | 
|  |  | 
|  | if (s->tx_fifo_len == 0) | 
|  | s->int_level |= INT_TX_EMPTY; | 
|  | if (s->tx_fifo_done_len != 0) | 
|  | s->int_level |= INT_TX; | 
|  | level = (s->int_level & s->int_mask) != 0; | 
|  | qemu_set_irq(s->irq, level); | 
|  | } | 
|  |  | 
|  | static bool smc91c111_can_receive(smc91c111_state *s) | 
|  | { | 
|  | if ((s->rcr & RCR_RXEN) == 0 || (s->rcr & RCR_SOFT_RST)) { | 
|  | return true; | 
|  | } | 
|  | if (s->allocated == (1 << NUM_PACKETS) - 1 || | 
|  | s->rx_fifo_len == NUM_PACKETS) { | 
|  | return false; | 
|  | } | 
|  | return true; | 
|  | } | 
|  |  | 
|  | static inline void smc91c111_flush_queued_packets(smc91c111_state *s) | 
|  | { | 
|  | if (smc91c111_can_receive(s)) { | 
|  | qemu_flush_queued_packets(qemu_get_queue(s->nic)); | 
|  | } | 
|  | } | 
|  |  | 
|  | /* Try to allocate a packet.  Returns 0x80 on failure.  */ | 
|  | static int smc91c111_allocate_packet(smc91c111_state *s) | 
|  | { | 
|  | int i; | 
|  | if (s->allocated == (1 << NUM_PACKETS) - 1) { | 
|  | return 0x80; | 
|  | } | 
|  |  | 
|  | for (i = 0; i < NUM_PACKETS; i++) { | 
|  | if ((s->allocated & (1 << i)) == 0) | 
|  | break; | 
|  | } | 
|  | s->allocated |= 1 << i; | 
|  | return i; | 
|  | } | 
|  |  | 
|  |  | 
|  | /* Process a pending TX allocate.  */ | 
|  | static void smc91c111_tx_alloc(smc91c111_state *s) | 
|  | { | 
|  | s->tx_alloc = smc91c111_allocate_packet(s); | 
|  | if (s->tx_alloc == 0x80) | 
|  | return; | 
|  | s->int_level |= INT_ALLOC; | 
|  | smc91c111_update(s); | 
|  | } | 
|  |  | 
|  | /* Remove and item from the RX FIFO.  */ | 
|  | static void smc91c111_pop_rx_fifo(smc91c111_state *s) | 
|  | { | 
|  | int i; | 
|  |  | 
|  | s->rx_fifo_len--; | 
|  | if (s->rx_fifo_len) { | 
|  | for (i = 0; i < s->rx_fifo_len; i++) | 
|  | s->rx_fifo[i] = s->rx_fifo[i + 1]; | 
|  | s->int_level |= INT_RCV; | 
|  | } else { | 
|  | s->int_level &= ~INT_RCV; | 
|  | } | 
|  | smc91c111_flush_queued_packets(s); | 
|  | smc91c111_update(s); | 
|  | } | 
|  |  | 
|  | /* Remove an item from the TX completion FIFO.  */ | 
|  | static void smc91c111_pop_tx_fifo_done(smc91c111_state *s) | 
|  | { | 
|  | int i; | 
|  |  | 
|  | if (s->tx_fifo_done_len == 0) | 
|  | return; | 
|  | s->tx_fifo_done_len--; | 
|  | for (i = 0; i < s->tx_fifo_done_len; i++) | 
|  | s->tx_fifo_done[i] = s->tx_fifo_done[i + 1]; | 
|  | } | 
|  |  | 
|  | /* Release the memory allocated to a packet.  */ | 
|  | static void smc91c111_release_packet(smc91c111_state *s, int packet) | 
|  | { | 
|  | s->allocated &= ~(1 << packet); | 
|  | if (s->tx_alloc == 0x80) | 
|  | smc91c111_tx_alloc(s); | 
|  | smc91c111_flush_queued_packets(s); | 
|  | } | 
|  |  | 
|  | /* Flush the TX FIFO.  */ | 
|  | static void smc91c111_do_tx(smc91c111_state *s) | 
|  | { | 
|  | int i; | 
|  | int len; | 
|  | int control; | 
|  | int packetnum; | 
|  | uint8_t *p; | 
|  |  | 
|  | if ((s->tcr & TCR_TXEN) == 0) | 
|  | return; | 
|  | if (s->tx_fifo_len == 0) | 
|  | return; | 
|  | for (i = 0; i < s->tx_fifo_len; i++) { | 
|  | packetnum = s->tx_fifo[i]; | 
|  | p = &s->data[packetnum][0]; | 
|  | /* Set status word.  */ | 
|  | *(p++) = 0x01; | 
|  | *(p++) = 0x40; | 
|  | len = *(p++); | 
|  | len |= ((int)*(p++)) << 8; | 
|  | len -= 6; | 
|  | control = p[len + 1]; | 
|  | if (control & 0x20) | 
|  | len++; | 
|  | /* ??? This overwrites the data following the buffer. | 
|  | Don't know what real hardware does.  */ | 
|  | if (len < 64 && (s->tcr & TCR_PAD_EN)) { | 
|  | memset(p + len, 0, 64 - len); | 
|  | len = 64; | 
|  | } | 
|  | #if 0 | 
|  | { | 
|  | int add_crc; | 
|  |  | 
|  | /* The card is supposed to append the CRC to the frame. | 
|  | However none of the other network traffic has the CRC | 
|  | appended.  Suspect this is low level ethernet detail we | 
|  | don't need to worry about.  */ | 
|  | add_crc = (control & 0x10) || (s->tcr & TCR_NOCRC) == 0; | 
|  | if (add_crc) { | 
|  | uint32_t crc; | 
|  |  | 
|  | crc = crc32(~0, p, len); | 
|  | memcpy(p + len, &crc, 4); | 
|  | len += 4; | 
|  | } | 
|  | } | 
|  | #endif | 
|  | if (s->ctr & CTR_AUTO_RELEASE) | 
|  | /* Race?  */ | 
|  | smc91c111_release_packet(s, packetnum); | 
|  | else if (s->tx_fifo_done_len < NUM_PACKETS) | 
|  | s->tx_fifo_done[s->tx_fifo_done_len++] = packetnum; | 
|  | qemu_send_packet(qemu_get_queue(s->nic), p, len); | 
|  | } | 
|  | s->tx_fifo_len = 0; | 
|  | smc91c111_update(s); | 
|  | } | 
|  |  | 
|  | /* Add a packet to the TX FIFO.  */ | 
|  | static void smc91c111_queue_tx(smc91c111_state *s, int packet) | 
|  | { | 
|  | if (s->tx_fifo_len == NUM_PACKETS) | 
|  | return; | 
|  | s->tx_fifo[s->tx_fifo_len++] = packet; | 
|  | smc91c111_do_tx(s); | 
|  | } | 
|  |  | 
|  | static void smc91c111_reset(DeviceState *dev) | 
|  | { | 
|  | smc91c111_state *s = SMC91C111(dev); | 
|  |  | 
|  | s->bank = 0; | 
|  | s->tx_fifo_len = 0; | 
|  | s->tx_fifo_done_len = 0; | 
|  | s->rx_fifo_len = 0; | 
|  | s->allocated = 0; | 
|  | s->packet_num = 0; | 
|  | s->tx_alloc = 0; | 
|  | s->tcr = 0; | 
|  | s->rcr = 0; | 
|  | s->cr = 0xa0b1; | 
|  | s->ctr = 0x1210; | 
|  | s->ptr = 0; | 
|  | s->ercv = 0x1f; | 
|  | s->int_level = INT_TX_EMPTY; | 
|  | s->int_mask = 0; | 
|  | smc91c111_update(s); | 
|  | } | 
|  |  | 
|  | #define SET_LOW(name, val) s->name = (s->name & 0xff00) | val | 
|  | #define SET_HIGH(name, val) s->name = (s->name & 0xff) | (val << 8) | 
|  |  | 
|  | static void smc91c111_writeb(void *opaque, hwaddr offset, | 
|  | uint32_t value) | 
|  | { | 
|  | smc91c111_state *s = (smc91c111_state *)opaque; | 
|  |  | 
|  | offset = offset & 0xf; | 
|  | if (offset == 14) { | 
|  | s->bank = value; | 
|  | return; | 
|  | } | 
|  | if (offset == 15) | 
|  | return; | 
|  | switch (s->bank) { | 
|  | case 0: | 
|  | switch (offset) { | 
|  | case 0: /* TCR */ | 
|  | SET_LOW(tcr, value); | 
|  | return; | 
|  | case 1: | 
|  | SET_HIGH(tcr, value); | 
|  | return; | 
|  | case 4: /* RCR */ | 
|  | SET_LOW(rcr, value); | 
|  | return; | 
|  | case 5: | 
|  | SET_HIGH(rcr, value); | 
|  | if (s->rcr & RCR_SOFT_RST) { | 
|  | smc91c111_reset(DEVICE(s)); | 
|  | } | 
|  | smc91c111_flush_queued_packets(s); | 
|  | return; | 
|  | case 10: case 11: /* RPCR */ | 
|  | /* Ignored */ | 
|  | return; | 
|  | case 12: case 13: /* Reserved */ | 
|  | return; | 
|  | } | 
|  | break; | 
|  |  | 
|  | case 1: | 
|  | switch (offset) { | 
|  | case 0: /* CONFIG */ | 
|  | SET_LOW(cr, value); | 
|  | return; | 
|  | case 1: | 
|  | SET_HIGH(cr,value); | 
|  | return; | 
|  | case 2: case 3: /* BASE */ | 
|  | case 4: case 5: case 6: case 7: case 8: case 9: /* IA */ | 
|  | /* Not implemented.  */ | 
|  | return; | 
|  | case 10: /* Genral Purpose */ | 
|  | SET_LOW(gpr, value); | 
|  | return; | 
|  | case 11: | 
|  | SET_HIGH(gpr, value); | 
|  | return; | 
|  | case 12: /* Control */ | 
|  | if (value & 1) { | 
|  | qemu_log_mask(LOG_UNIMP, | 
|  | "smc91c111: EEPROM store not implemented\n"); | 
|  | } | 
|  | if (value & 2) { | 
|  | qemu_log_mask(LOG_UNIMP, | 
|  | "smc91c111: EEPROM reload not implemented\n"); | 
|  | } | 
|  | value &= ~3; | 
|  | SET_LOW(ctr, value); | 
|  | return; | 
|  | case 13: | 
|  | SET_HIGH(ctr, value); | 
|  | return; | 
|  | } | 
|  | break; | 
|  |  | 
|  | case 2: | 
|  | switch (offset) { | 
|  | case 0: /* MMU Command */ | 
|  | switch (value >> 5) { | 
|  | case 0: /* no-op */ | 
|  | break; | 
|  | case 1: /* Allocate for TX.  */ | 
|  | s->tx_alloc = 0x80; | 
|  | s->int_level &= ~INT_ALLOC; | 
|  | smc91c111_update(s); | 
|  | smc91c111_tx_alloc(s); | 
|  | break; | 
|  | case 2: /* Reset MMU.  */ | 
|  | s->allocated = 0; | 
|  | s->tx_fifo_len = 0; | 
|  | s->tx_fifo_done_len = 0; | 
|  | s->rx_fifo_len = 0; | 
|  | s->tx_alloc = 0; | 
|  | break; | 
|  | case 3: /* Remove from RX FIFO.  */ | 
|  | smc91c111_pop_rx_fifo(s); | 
|  | break; | 
|  | case 4: /* Remove from RX FIFO and release.  */ | 
|  | if (s->rx_fifo_len > 0) { | 
|  | smc91c111_release_packet(s, s->rx_fifo[0]); | 
|  | } | 
|  | smc91c111_pop_rx_fifo(s); | 
|  | break; | 
|  | case 5: /* Release.  */ | 
|  | smc91c111_release_packet(s, s->packet_num); | 
|  | break; | 
|  | case 6: /* Add to TX FIFO.  */ | 
|  | smc91c111_queue_tx(s, s->packet_num); | 
|  | break; | 
|  | case 7: /* Reset TX FIFO.  */ | 
|  | s->tx_fifo_len = 0; | 
|  | s->tx_fifo_done_len = 0; | 
|  | break; | 
|  | } | 
|  | return; | 
|  | case 1: | 
|  | /* Ignore.  */ | 
|  | return; | 
|  | case 2: /* Packet Number Register */ | 
|  | s->packet_num = value; | 
|  | return; | 
|  | case 3: case 4: case 5: | 
|  | /* Should be readonly, but linux writes to them anyway. Ignore.  */ | 
|  | return; | 
|  | case 6: /* Pointer */ | 
|  | SET_LOW(ptr, value); | 
|  | return; | 
|  | case 7: | 
|  | SET_HIGH(ptr, value); | 
|  | return; | 
|  | case 8: case 9: case 10: case 11: /* Data */ | 
|  | { | 
|  | int p; | 
|  | int n; | 
|  |  | 
|  | if (s->ptr & 0x8000) | 
|  | n = s->rx_fifo[0]; | 
|  | else | 
|  | n = s->packet_num; | 
|  | p = s->ptr & 0x07ff; | 
|  | if (s->ptr & 0x4000) { | 
|  | s->ptr = (s->ptr & 0xf800) | ((s->ptr + 1) & 0x7ff); | 
|  | } else { | 
|  | p += (offset & 3); | 
|  | } | 
|  | s->data[n][p] = value; | 
|  | } | 
|  | return; | 
|  | case 12: /* Interrupt ACK.  */ | 
|  | s->int_level &= ~(value & 0xd6); | 
|  | if (value & INT_TX) | 
|  | smc91c111_pop_tx_fifo_done(s); | 
|  | smc91c111_update(s); | 
|  | return; | 
|  | case 13: /* Interrupt mask.  */ | 
|  | s->int_mask = value; | 
|  | smc91c111_update(s); | 
|  | return; | 
|  | } | 
|  | break; | 
|  |  | 
|  | case 3: | 
|  | switch (offset) { | 
|  | case 0: case 1: case 2: case 3: case 4: case 5: case 6: case 7: | 
|  | /* Multicast table.  */ | 
|  | /* Not implemented.  */ | 
|  | return; | 
|  | case 8: case 9: /* Management Interface.  */ | 
|  | /* Not implemented.  */ | 
|  | return; | 
|  | case 12: /* Early receive.  */ | 
|  | s->ercv = value & 0x1f; | 
|  | return; | 
|  | case 13: | 
|  | /* Ignore.  */ | 
|  | return; | 
|  | } | 
|  | break; | 
|  | } | 
|  | qemu_log_mask(LOG_GUEST_ERROR, "smc91c111_write(bank:%d) Illegal register" | 
|  | " 0x%" HWADDR_PRIx " = 0x%x\n", | 
|  | s->bank, offset, value); | 
|  | } | 
|  |  | 
|  | static uint32_t smc91c111_readb(void *opaque, hwaddr offset) | 
|  | { | 
|  | smc91c111_state *s = (smc91c111_state *)opaque; | 
|  |  | 
|  | offset = offset & 0xf; | 
|  | if (offset == 14) { | 
|  | return s->bank; | 
|  | } | 
|  | if (offset == 15) | 
|  | return 0x33; | 
|  | switch (s->bank) { | 
|  | case 0: | 
|  | switch (offset) { | 
|  | case 0: /* TCR */ | 
|  | return s->tcr & 0xff; | 
|  | case 1: | 
|  | return s->tcr >> 8; | 
|  | case 2: /* EPH Status */ | 
|  | return 0; | 
|  | case 3: | 
|  | return 0x40; | 
|  | case 4: /* RCR */ | 
|  | return s->rcr & 0xff; | 
|  | case 5: | 
|  | return s->rcr >> 8; | 
|  | case 6: /* Counter */ | 
|  | case 7: | 
|  | /* Not implemented.  */ | 
|  | return 0; | 
|  | case 8: /* Memory size.  */ | 
|  | return NUM_PACKETS; | 
|  | case 9: /* Free memory available.  */ | 
|  | { | 
|  | int i; | 
|  | int n; | 
|  | n = 0; | 
|  | for (i = 0; i < NUM_PACKETS; i++) { | 
|  | if (s->allocated & (1 << i)) | 
|  | n++; | 
|  | } | 
|  | return n; | 
|  | } | 
|  | case 10: case 11: /* RPCR */ | 
|  | /* Not implemented.  */ | 
|  | return 0; | 
|  | case 12: case 13: /* Reserved */ | 
|  | return 0; | 
|  | } | 
|  | break; | 
|  |  | 
|  | case 1: | 
|  | switch (offset) { | 
|  | case 0: /* CONFIG */ | 
|  | return s->cr & 0xff; | 
|  | case 1: | 
|  | return s->cr >> 8; | 
|  | case 2: case 3: /* BASE */ | 
|  | /* Not implemented.  */ | 
|  | return 0; | 
|  | case 4: case 5: case 6: case 7: case 8: case 9: /* IA */ | 
|  | return s->conf.macaddr.a[offset - 4]; | 
|  | case 10: /* General Purpose */ | 
|  | return s->gpr & 0xff; | 
|  | case 11: | 
|  | return s->gpr >> 8; | 
|  | case 12: /* Control */ | 
|  | return s->ctr & 0xff; | 
|  | case 13: | 
|  | return s->ctr >> 8; | 
|  | } | 
|  | break; | 
|  |  | 
|  | case 2: | 
|  | switch (offset) { | 
|  | case 0: case 1: /* MMUCR Busy bit.  */ | 
|  | return 0; | 
|  | case 2: /* Packet Number.  */ | 
|  | return s->packet_num; | 
|  | case 3: /* Allocation Result.  */ | 
|  | return s->tx_alloc; | 
|  | case 4: /* TX FIFO */ | 
|  | if (s->tx_fifo_done_len == 0) | 
|  | return 0x80; | 
|  | else | 
|  | return s->tx_fifo_done[0]; | 
|  | case 5: /* RX FIFO */ | 
|  | if (s->rx_fifo_len == 0) | 
|  | return 0x80; | 
|  | else | 
|  | return s->rx_fifo[0]; | 
|  | case 6: /* Pointer */ | 
|  | return s->ptr & 0xff; | 
|  | case 7: | 
|  | return (s->ptr >> 8) & 0xf7; | 
|  | case 8: case 9: case 10: case 11: /* Data */ | 
|  | { | 
|  | int p; | 
|  | int n; | 
|  |  | 
|  | if (s->ptr & 0x8000) | 
|  | n = s->rx_fifo[0]; | 
|  | else | 
|  | n = s->packet_num; | 
|  | p = s->ptr & 0x07ff; | 
|  | if (s->ptr & 0x4000) { | 
|  | s->ptr = (s->ptr & 0xf800) | ((s->ptr + 1) & 0x07ff); | 
|  | } else { | 
|  | p += (offset & 3); | 
|  | } | 
|  | return s->data[n][p]; | 
|  | } | 
|  | case 12: /* Interrupt status.  */ | 
|  | return s->int_level; | 
|  | case 13: /* Interrupt mask.  */ | 
|  | return s->int_mask; | 
|  | } | 
|  | break; | 
|  |  | 
|  | case 3: | 
|  | switch (offset) { | 
|  | case 0: case 1: case 2: case 3: case 4: case 5: case 6: case 7: | 
|  | /* Multicast table.  */ | 
|  | /* Not implemented.  */ | 
|  | return 0; | 
|  | case 8: /* Management Interface.  */ | 
|  | /* Not implemented.  */ | 
|  | return 0x30; | 
|  | case 9: | 
|  | return 0x33; | 
|  | case 10: /* Revision.  */ | 
|  | return 0x91; | 
|  | case 11: | 
|  | return 0x33; | 
|  | case 12: | 
|  | return s->ercv; | 
|  | case 13: | 
|  | return 0; | 
|  | } | 
|  | break; | 
|  | } | 
|  | qemu_log_mask(LOG_GUEST_ERROR, "smc91c111_read(bank:%d) Illegal register" | 
|  | " 0x%" HWADDR_PRIx "\n", | 
|  | s->bank, offset); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static uint64_t smc91c111_readfn(void *opaque, hwaddr addr, unsigned size) | 
|  | { | 
|  | int i; | 
|  | uint32_t val = 0; | 
|  |  | 
|  | for (i = 0; i < size; i++) { | 
|  | val |= smc91c111_readb(opaque, addr + i) << (i * 8); | 
|  | } | 
|  | return val; | 
|  | } | 
|  |  | 
|  | static void smc91c111_writefn(void *opaque, hwaddr addr, | 
|  | uint64_t value, unsigned size) | 
|  | { | 
|  | int i = 0; | 
|  |  | 
|  | /* 32-bit writes to offset 0xc only actually write to the bank select | 
|  | * register (offset 0xe), so skip the first two bytes we would write. | 
|  | */ | 
|  | if (addr == 0xc && size == 4) { | 
|  | i += 2; | 
|  | } | 
|  |  | 
|  | for (; i < size; i++) { | 
|  | smc91c111_writeb(opaque, addr + i, | 
|  | extract32(value, i * 8, 8)); | 
|  | } | 
|  | } | 
|  |  | 
|  | static bool smc91c111_can_receive_nc(NetClientState *nc) | 
|  | { | 
|  | smc91c111_state *s = qemu_get_nic_opaque(nc); | 
|  |  | 
|  | return smc91c111_can_receive(s); | 
|  | } | 
|  |  | 
|  | static ssize_t smc91c111_receive(NetClientState *nc, const uint8_t *buf, size_t size) | 
|  | { | 
|  | smc91c111_state *s = qemu_get_nic_opaque(nc); | 
|  | int status; | 
|  | int packetsize; | 
|  | uint32_t crc; | 
|  | int packetnum; | 
|  | uint8_t *p; | 
|  |  | 
|  | if ((s->rcr & RCR_RXEN) == 0 || (s->rcr & RCR_SOFT_RST)) | 
|  | return -1; | 
|  | /* Short packets are padded with zeros.  Receiving a packet | 
|  | < 64 bytes long is considered an error condition.  */ | 
|  | if (size < 64) | 
|  | packetsize = 64; | 
|  | else | 
|  | packetsize = (size & ~1); | 
|  | packetsize += 6; | 
|  | crc = (s->rcr & RCR_STRIP_CRC) == 0; | 
|  | if (crc) | 
|  | packetsize += 4; | 
|  | /* TODO: Flag overrun and receive errors.  */ | 
|  | if (packetsize > 2048) | 
|  | return -1; | 
|  | packetnum = smc91c111_allocate_packet(s); | 
|  | if (packetnum == 0x80) | 
|  | return -1; | 
|  | s->rx_fifo[s->rx_fifo_len++] = packetnum; | 
|  |  | 
|  | p = &s->data[packetnum][0]; | 
|  | /* ??? Multicast packets?  */ | 
|  | status = 0; | 
|  | if (size > 1518) | 
|  | status |= RS_TOOLONG; | 
|  | if (size & 1) | 
|  | status |= RS_ODDFRAME; | 
|  | *(p++) = status & 0xff; | 
|  | *(p++) = status >> 8; | 
|  | *(p++) = packetsize & 0xff; | 
|  | *(p++) = packetsize >> 8; | 
|  | memcpy(p, buf, size & ~1); | 
|  | p += (size & ~1); | 
|  | /* Pad short packets.  */ | 
|  | if (size < 64) { | 
|  | int pad; | 
|  |  | 
|  | if (size & 1) | 
|  | *(p++) = buf[size - 1]; | 
|  | pad = 64 - size; | 
|  | memset(p, 0, pad); | 
|  | p += pad; | 
|  | size = 64; | 
|  | } | 
|  | /* It's not clear if the CRC should go before or after the last byte in | 
|  | odd sized packets.  Linux disables the CRC, so that's no help. | 
|  | The pictures in the documentation show the CRC aligned on a 16-bit | 
|  | boundary before the last odd byte, so that's what we do.  */ | 
|  | if (crc) { | 
|  | crc = crc32(~0, buf, size); | 
|  | *(p++) = crc & 0xff; crc >>= 8; | 
|  | *(p++) = crc & 0xff; crc >>= 8; | 
|  | *(p++) = crc & 0xff; crc >>= 8; | 
|  | *(p++) = crc & 0xff; | 
|  | } | 
|  | if (size & 1) { | 
|  | *(p++) = buf[size - 1]; | 
|  | *p = 0x60; | 
|  | } else { | 
|  | *(p++) = 0; | 
|  | *p = 0x40; | 
|  | } | 
|  | /* TODO: Raise early RX interrupt?  */ | 
|  | s->int_level |= INT_RCV; | 
|  | smc91c111_update(s); | 
|  |  | 
|  | return size; | 
|  | } | 
|  |  | 
|  | static const MemoryRegionOps smc91c111_mem_ops = { | 
|  | /* The special case for 32 bit writes to 0xc means we can't just | 
|  | * set .impl.min/max_access_size to 1, unfortunately | 
|  | */ | 
|  | .read = smc91c111_readfn, | 
|  | .write = smc91c111_writefn, | 
|  | .valid.min_access_size = 1, | 
|  | .valid.max_access_size = 4, | 
|  | .endianness = DEVICE_NATIVE_ENDIAN, | 
|  | }; | 
|  |  | 
|  | static NetClientInfo net_smc91c111_info = { | 
|  | .type = NET_CLIENT_DRIVER_NIC, | 
|  | .size = sizeof(NICState), | 
|  | .can_receive = smc91c111_can_receive_nc, | 
|  | .receive = smc91c111_receive, | 
|  | }; | 
|  |  | 
|  | static void smc91c111_realize(DeviceState *dev, Error **errp) | 
|  | { | 
|  | SysBusDevice *sbd = SYS_BUS_DEVICE(dev); | 
|  | smc91c111_state *s = SMC91C111(dev); | 
|  |  | 
|  | memory_region_init_io(&s->mmio, OBJECT(s), &smc91c111_mem_ops, s, | 
|  | "smc91c111-mmio", 16); | 
|  | sysbus_init_mmio(sbd, &s->mmio); | 
|  | sysbus_init_irq(sbd, &s->irq); | 
|  | qemu_macaddr_default_if_unset(&s->conf.macaddr); | 
|  | s->nic = qemu_new_nic(&net_smc91c111_info, &s->conf, | 
|  | object_get_typename(OBJECT(dev)), dev->id, s); | 
|  | qemu_format_nic_info_str(qemu_get_queue(s->nic), s->conf.macaddr.a); | 
|  | /* ??? Save/restore.  */ | 
|  | } | 
|  |  | 
|  | static Property smc91c111_properties[] = { | 
|  | DEFINE_NIC_PROPERTIES(smc91c111_state, conf), | 
|  | DEFINE_PROP_END_OF_LIST(), | 
|  | }; | 
|  |  | 
|  | static void smc91c111_class_init(ObjectClass *klass, void *data) | 
|  | { | 
|  | DeviceClass *dc = DEVICE_CLASS(klass); | 
|  |  | 
|  | dc->realize = smc91c111_realize; | 
|  | dc->reset = smc91c111_reset; | 
|  | dc->vmsd = &vmstate_smc91c111; | 
|  | device_class_set_props(dc, smc91c111_properties); | 
|  | } | 
|  |  | 
|  | static const TypeInfo smc91c111_info = { | 
|  | .name          = TYPE_SMC91C111, | 
|  | .parent        = TYPE_SYS_BUS_DEVICE, | 
|  | .instance_size = sizeof(smc91c111_state), | 
|  | .class_init    = smc91c111_class_init, | 
|  | }; | 
|  |  | 
|  | static void smc91c111_register_types(void) | 
|  | { | 
|  | type_register_static(&smc91c111_info); | 
|  | } | 
|  |  | 
|  | /* Legacy helper function.  Should go away when machine config files are | 
|  | implemented.  */ | 
|  | void smc91c111_init(NICInfo *nd, uint32_t base, qemu_irq irq) | 
|  | { | 
|  | DeviceState *dev; | 
|  | SysBusDevice *s; | 
|  |  | 
|  | qemu_check_nic_model(nd, "smc91c111"); | 
|  | dev = qdev_new(TYPE_SMC91C111); | 
|  | qdev_set_nic_properties(dev, nd); | 
|  | s = SYS_BUS_DEVICE(dev); | 
|  | sysbus_realize_and_unref(s, &error_fatal); | 
|  | sysbus_mmio_map(s, 0, base); | 
|  | sysbus_connect_irq(s, 0, irq); | 
|  | } | 
|  |  | 
|  | type_init(smc91c111_register_types) |