123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983 |
- /*
- * QEMU Sun Happy Meal Ethernet emulation
- *
- * Copyright (c) 2017 Mark Cave-Ayland
- *
- * 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 "qemu/osdep.h"
- #include "hw/pci/pci_device.h"
- #include "hw/qdev-properties.h"
- #include "migration/vmstate.h"
- #include "hw/net/mii.h"
- #include "net/net.h"
- #include "qemu/module.h"
- #include "net/checksum.h"
- #include "net/eth.h"
- #include "sysemu/sysemu.h"
- #include "trace.h"
- #include "qom/object.h"
- #define HME_REG_SIZE 0x8000
- #define HME_SEB_REG_SIZE 0x2000
- #define HME_SEBI_RESET 0x0
- #define HME_SEB_RESET_ETX 0x1
- #define HME_SEB_RESET_ERX 0x2
- #define HME_SEBI_STAT 0x100
- #define HME_SEBI_STAT_LINUXBUG 0x108
- #define HME_SEB_STAT_RXTOHOST 0x10000
- #define HME_SEB_STAT_NORXD 0x20000
- #define HME_SEB_STAT_MIFIRQ 0x800000
- #define HME_SEB_STAT_HOSTTOTX 0x1000000
- #define HME_SEB_STAT_TXALL 0x2000000
- #define HME_SEBI_IMASK 0x104
- #define HME_SEBI_IMASK_LINUXBUG 0x10c
- #define HME_ETX_REG_SIZE 0x2000
- #define HME_ETXI_PENDING 0x0
- #define HME_ETXI_RING 0x8
- #define HME_ETXI_RING_ADDR 0xffffff00
- #define HME_ETXI_RING_OFFSET 0xff
- #define HME_ETXI_RSIZE 0x2c
- #define HME_ERX_REG_SIZE 0x2000
- #define HME_ERXI_CFG 0x0
- #define HME_ERX_CFG_RINGSIZE 0x600
- #define HME_ERX_CFG_RINGSIZE_SHIFT 9
- #define HME_ERX_CFG_BYTEOFFSET 0x38
- #define HME_ERX_CFG_BYTEOFFSET_SHIFT 3
- #define HME_ERX_CFG_CSUMSTART 0x7f0000
- #define HME_ERX_CFG_CSUMSHIFT 16
- #define HME_ERXI_RING 0x4
- #define HME_ERXI_RING_ADDR 0xffffff00
- #define HME_ERXI_RING_OFFSET 0xff
- #define HME_MAC_REG_SIZE 0x1000
- #define HME_MACI_TXCFG 0x20c
- #define HME_MAC_TXCFG_ENABLE 0x1
- #define HME_MACI_RXCFG 0x30c
- #define HME_MAC_RXCFG_ENABLE 0x1
- #define HME_MAC_RXCFG_PMISC 0x40
- #define HME_MAC_RXCFG_HENABLE 0x800
- #define HME_MACI_MACADDR2 0x318
- #define HME_MACI_MACADDR1 0x31c
- #define HME_MACI_MACADDR0 0x320
- #define HME_MACI_HASHTAB3 0x340
- #define HME_MACI_HASHTAB2 0x344
- #define HME_MACI_HASHTAB1 0x348
- #define HME_MACI_HASHTAB0 0x34c
- #define HME_MIF_REG_SIZE 0x20
- #define HME_MIFI_FO 0xc
- #define HME_MIF_FO_ST 0xc0000000
- #define HME_MIF_FO_ST_SHIFT 30
- #define HME_MIF_FO_OPC 0x30000000
- #define HME_MIF_FO_OPC_SHIFT 28
- #define HME_MIF_FO_PHYAD 0x0f800000
- #define HME_MIF_FO_PHYAD_SHIFT 23
- #define HME_MIF_FO_REGAD 0x007c0000
- #define HME_MIF_FO_REGAD_SHIFT 18
- #define HME_MIF_FO_TAMSB 0x20000
- #define HME_MIF_FO_TALSB 0x10000
- #define HME_MIF_FO_DATA 0xffff
- #define HME_MIFI_CFG 0x10
- #define HME_MIF_CFG_MDI0 0x100
- #define HME_MIF_CFG_MDI1 0x200
- #define HME_MIFI_IMASK 0x14
- #define HME_MIFI_STAT 0x18
- /* Wired HME PHY addresses */
- #define HME_PHYAD_INTERNAL 1
- #define HME_PHYAD_EXTERNAL 0
- #define MII_COMMAND_START 0x1
- #define MII_COMMAND_READ 0x2
- #define MII_COMMAND_WRITE 0x1
- #define TYPE_SUNHME "sunhme"
- OBJECT_DECLARE_SIMPLE_TYPE(SunHMEState, SUNHME)
- /* Maximum size of buffer */
- #define HME_FIFO_SIZE 0x800
- /* Size of TX/RX descriptor */
- #define HME_DESC_SIZE 0x8
- #define HME_XD_OWN 0x80000000
- #define HME_XD_OFL 0x40000000
- #define HME_XD_SOP 0x40000000
- #define HME_XD_EOP 0x20000000
- #define HME_XD_RXLENMSK 0x3fff0000
- #define HME_XD_RXLENSHIFT 16
- #define HME_XD_RXCKSUM 0xffff
- #define HME_XD_TXLENMSK 0x00001fff
- #define HME_XD_TXCKSUM 0x10000000
- #define HME_XD_TXCSSTUFF 0xff00000
- #define HME_XD_TXCSSTUFFSHIFT 20
- #define HME_XD_TXCSSTART 0xfc000
- #define HME_XD_TXCSSTARTSHIFT 14
- #define HME_MII_REGS_SIZE 0x20
- struct SunHMEState {
- /*< private >*/
- PCIDevice parent_obj;
- NICState *nic;
- NICConf conf;
- MemoryRegion hme;
- MemoryRegion sebreg;
- MemoryRegion etxreg;
- MemoryRegion erxreg;
- MemoryRegion macreg;
- MemoryRegion mifreg;
- uint32_t sebregs[HME_SEB_REG_SIZE >> 2];
- uint32_t etxregs[HME_ETX_REG_SIZE >> 2];
- uint32_t erxregs[HME_ERX_REG_SIZE >> 2];
- uint32_t macregs[HME_MAC_REG_SIZE >> 2];
- uint32_t mifregs[HME_MIF_REG_SIZE >> 2];
- uint16_t miiregs[HME_MII_REGS_SIZE];
- };
- static Property sunhme_properties[] = {
- DEFINE_NIC_PROPERTIES(SunHMEState, conf),
- DEFINE_PROP_END_OF_LIST(),
- };
- static void sunhme_reset_tx(SunHMEState *s)
- {
- /* Indicate TX reset complete */
- s->sebregs[HME_SEBI_RESET] &= ~HME_SEB_RESET_ETX;
- }
- static void sunhme_reset_rx(SunHMEState *s)
- {
- /* Indicate RX reset complete */
- s->sebregs[HME_SEBI_RESET] &= ~HME_SEB_RESET_ERX;
- }
- static void sunhme_update_irq(SunHMEState *s)
- {
- PCIDevice *d = PCI_DEVICE(s);
- int level;
- /* MIF interrupt mask (16-bit) */
- uint32_t mifmask = ~(s->mifregs[HME_MIFI_IMASK >> 2]) & 0xffff;
- uint32_t mif = s->mifregs[HME_MIFI_STAT >> 2] & mifmask;
- /* Main SEB interrupt mask (include MIF status from above) */
- uint32_t sebmask = ~(s->sebregs[HME_SEBI_IMASK >> 2]) &
- ~HME_SEB_STAT_MIFIRQ;
- uint32_t seb = s->sebregs[HME_SEBI_STAT >> 2] & sebmask;
- if (mif) {
- seb |= HME_SEB_STAT_MIFIRQ;
- }
- level = (seb ? 1 : 0);
- trace_sunhme_update_irq(mifmask, mif, sebmask, seb, level);
- pci_set_irq(d, level);
- }
- static void sunhme_seb_write(void *opaque, hwaddr addr,
- uint64_t val, unsigned size)
- {
- SunHMEState *s = SUNHME(opaque);
- trace_sunhme_seb_write(addr, val);
- /* Handly buggy Linux drivers before 4.13 which have
- the wrong offsets for HME_SEBI_STAT and HME_SEBI_IMASK */
- switch (addr) {
- case HME_SEBI_STAT_LINUXBUG:
- addr = HME_SEBI_STAT;
- break;
- case HME_SEBI_IMASK_LINUXBUG:
- addr = HME_SEBI_IMASK;
- break;
- default:
- break;
- }
- switch (addr) {
- case HME_SEBI_RESET:
- if (val & HME_SEB_RESET_ETX) {
- sunhme_reset_tx(s);
- }
- if (val & HME_SEB_RESET_ERX) {
- sunhme_reset_rx(s);
- }
- val = s->sebregs[HME_SEBI_RESET >> 2];
- break;
- }
- s->sebregs[addr >> 2] = val;
- }
- static uint64_t sunhme_seb_read(void *opaque, hwaddr addr,
- unsigned size)
- {
- SunHMEState *s = SUNHME(opaque);
- uint64_t val;
- /* Handly buggy Linux drivers before 4.13 which have
- the wrong offsets for HME_SEBI_STAT and HME_SEBI_IMASK */
- switch (addr) {
- case HME_SEBI_STAT_LINUXBUG:
- addr = HME_SEBI_STAT;
- break;
- case HME_SEBI_IMASK_LINUXBUG:
- addr = HME_SEBI_IMASK;
- break;
- default:
- break;
- }
- val = s->sebregs[addr >> 2];
- switch (addr) {
- case HME_SEBI_STAT:
- /* Autoclear status (except MIF) */
- s->sebregs[HME_SEBI_STAT >> 2] &= HME_SEB_STAT_MIFIRQ;
- sunhme_update_irq(s);
- break;
- }
- trace_sunhme_seb_read(addr, val);
- return val;
- }
- static const MemoryRegionOps sunhme_seb_ops = {
- .read = sunhme_seb_read,
- .write = sunhme_seb_write,
- .endianness = DEVICE_LITTLE_ENDIAN,
- .valid = {
- .min_access_size = 4,
- .max_access_size = 4,
- },
- };
- static void sunhme_transmit(SunHMEState *s);
- static void sunhme_etx_write(void *opaque, hwaddr addr,
- uint64_t val, unsigned size)
- {
- SunHMEState *s = SUNHME(opaque);
- trace_sunhme_etx_write(addr, val);
- switch (addr) {
- case HME_ETXI_PENDING:
- if (val) {
- sunhme_transmit(s);
- }
- break;
- }
- s->etxregs[addr >> 2] = val;
- }
- static uint64_t sunhme_etx_read(void *opaque, hwaddr addr,
- unsigned size)
- {
- SunHMEState *s = SUNHME(opaque);
- uint64_t val;
- val = s->etxregs[addr >> 2];
- trace_sunhme_etx_read(addr, val);
- return val;
- }
- static const MemoryRegionOps sunhme_etx_ops = {
- .read = sunhme_etx_read,
- .write = sunhme_etx_write,
- .endianness = DEVICE_LITTLE_ENDIAN,
- .valid = {
- .min_access_size = 4,
- .max_access_size = 4,
- },
- };
- static void sunhme_erx_write(void *opaque, hwaddr addr,
- uint64_t val, unsigned size)
- {
- SunHMEState *s = SUNHME(opaque);
- trace_sunhme_erx_write(addr, val);
- s->erxregs[addr >> 2] = val;
- }
- static uint64_t sunhme_erx_read(void *opaque, hwaddr addr,
- unsigned size)
- {
- SunHMEState *s = SUNHME(opaque);
- uint64_t val;
- val = s->erxregs[addr >> 2];
- trace_sunhme_erx_read(addr, val);
- return val;
- }
- static const MemoryRegionOps sunhme_erx_ops = {
- .read = sunhme_erx_read,
- .write = sunhme_erx_write,
- .endianness = DEVICE_LITTLE_ENDIAN,
- .valid = {
- .min_access_size = 4,
- .max_access_size = 4,
- },
- };
- static void sunhme_mac_write(void *opaque, hwaddr addr,
- uint64_t val, unsigned size)
- {
- SunHMEState *s = SUNHME(opaque);
- uint64_t oldval = s->macregs[addr >> 2];
- trace_sunhme_mac_write(addr, val);
- s->macregs[addr >> 2] = val;
- switch (addr) {
- case HME_MACI_RXCFG:
- if (!(oldval & HME_MAC_RXCFG_ENABLE) &&
- (val & HME_MAC_RXCFG_ENABLE)) {
- qemu_flush_queued_packets(qemu_get_queue(s->nic));
- }
- break;
- }
- }
- static uint64_t sunhme_mac_read(void *opaque, hwaddr addr,
- unsigned size)
- {
- SunHMEState *s = SUNHME(opaque);
- uint64_t val;
- val = s->macregs[addr >> 2];
- trace_sunhme_mac_read(addr, val);
- return val;
- }
- static const MemoryRegionOps sunhme_mac_ops = {
- .read = sunhme_mac_read,
- .write = sunhme_mac_write,
- .endianness = DEVICE_LITTLE_ENDIAN,
- .valid = {
- .min_access_size = 4,
- .max_access_size = 4,
- },
- };
- static void sunhme_mii_write(SunHMEState *s, uint8_t reg, uint16_t data)
- {
- trace_sunhme_mii_write(reg, data);
- switch (reg) {
- case MII_BMCR:
- if (data & MII_BMCR_RESET) {
- /* Autoclear reset bit, enable auto negotiation */
- data &= ~MII_BMCR_RESET;
- data |= MII_BMCR_AUTOEN;
- }
- if (data & MII_BMCR_ANRESTART) {
- /* Autoclear auto negotiation restart */
- data &= ~MII_BMCR_ANRESTART;
- /* Indicate negotiation complete */
- s->miiregs[MII_BMSR] |= MII_BMSR_AN_COMP;
- if (!qemu_get_queue(s->nic)->link_down) {
- s->miiregs[MII_ANLPAR] |= MII_ANLPAR_TXFD;
- s->miiregs[MII_BMSR] |= MII_BMSR_LINK_ST;
- }
- }
- break;
- }
- s->miiregs[reg] = data;
- }
- static uint16_t sunhme_mii_read(SunHMEState *s, uint8_t reg)
- {
- uint16_t data = s->miiregs[reg];
- trace_sunhme_mii_read(reg, data);
- return data;
- }
- static void sunhme_mif_write(void *opaque, hwaddr addr,
- uint64_t val, unsigned size)
- {
- SunHMEState *s = SUNHME(opaque);
- uint8_t cmd, reg;
- uint16_t data;
- trace_sunhme_mif_write(addr, val);
- switch (addr) {
- case HME_MIFI_CFG:
- /* Mask the read-only bits */
- val &= ~(HME_MIF_CFG_MDI0 | HME_MIF_CFG_MDI1);
- val |= s->mifregs[HME_MIFI_CFG >> 2] &
- (HME_MIF_CFG_MDI0 | HME_MIF_CFG_MDI1);
- break;
- case HME_MIFI_FO:
- /* Detect start of MII command */
- if ((val & HME_MIF_FO_ST) >> HME_MIF_FO_ST_SHIFT
- != MII_COMMAND_START) {
- val |= HME_MIF_FO_TALSB;
- break;
- }
- /* Internal phy only */
- if ((val & HME_MIF_FO_PHYAD) >> HME_MIF_FO_PHYAD_SHIFT
- != HME_PHYAD_INTERNAL) {
- val |= HME_MIF_FO_TALSB;
- break;
- }
- cmd = (val & HME_MIF_FO_OPC) >> HME_MIF_FO_OPC_SHIFT;
- reg = (val & HME_MIF_FO_REGAD) >> HME_MIF_FO_REGAD_SHIFT;
- data = (val & HME_MIF_FO_DATA);
- switch (cmd) {
- case MII_COMMAND_WRITE:
- sunhme_mii_write(s, reg, data);
- break;
- case MII_COMMAND_READ:
- val &= ~HME_MIF_FO_DATA;
- val |= sunhme_mii_read(s, reg);
- break;
- }
- val |= HME_MIF_FO_TALSB;
- break;
- }
- s->mifregs[addr >> 2] = val;
- }
- static uint64_t sunhme_mif_read(void *opaque, hwaddr addr,
- unsigned size)
- {
- SunHMEState *s = SUNHME(opaque);
- uint64_t val;
- val = s->mifregs[addr >> 2];
- switch (addr) {
- case HME_MIFI_STAT:
- /* Autoclear MIF interrupt status */
- s->mifregs[HME_MIFI_STAT >> 2] = 0;
- sunhme_update_irq(s);
- break;
- }
- trace_sunhme_mif_read(addr, val);
- return val;
- }
- static const MemoryRegionOps sunhme_mif_ops = {
- .read = sunhme_mif_read,
- .write = sunhme_mif_write,
- .endianness = DEVICE_LITTLE_ENDIAN,
- .valid = {
- .min_access_size = 4,
- .max_access_size = 4,
- },
- };
- static void sunhme_transmit_frame(SunHMEState *s, uint8_t *buf, int size)
- {
- qemu_send_packet(qemu_get_queue(s->nic), buf, size);
- }
- static inline int sunhme_get_tx_ring_count(SunHMEState *s)
- {
- return (s->etxregs[HME_ETXI_RSIZE >> 2] + 1) << 4;
- }
- static inline int sunhme_get_tx_ring_nr(SunHMEState *s)
- {
- return s->etxregs[HME_ETXI_RING >> 2] & HME_ETXI_RING_OFFSET;
- }
- static inline void sunhme_set_tx_ring_nr(SunHMEState *s, int i)
- {
- uint32_t ring = s->etxregs[HME_ETXI_RING >> 2] & ~HME_ETXI_RING_OFFSET;
- ring |= i & HME_ETXI_RING_OFFSET;
- s->etxregs[HME_ETXI_RING >> 2] = ring;
- }
- static void sunhme_transmit(SunHMEState *s)
- {
- PCIDevice *d = PCI_DEVICE(s);
- dma_addr_t tb, addr;
- uint32_t intstatus, status, buffer, sum = 0;
- int cr, nr, len, xmit_pos, csum_offset = 0, csum_stuff_offset = 0;
- uint16_t csum = 0;
- uint8_t xmit_buffer[HME_FIFO_SIZE];
- tb = s->etxregs[HME_ETXI_RING >> 2] & HME_ETXI_RING_ADDR;
- nr = sunhme_get_tx_ring_count(s);
- cr = sunhme_get_tx_ring_nr(s);
- pci_dma_read(d, tb + cr * HME_DESC_SIZE, &status, 4);
- pci_dma_read(d, tb + cr * HME_DESC_SIZE + 4, &buffer, 4);
- xmit_pos = 0;
- while (status & HME_XD_OWN) {
- trace_sunhme_tx_desc(buffer, status, cr, nr);
- /* Copy data into transmit buffer */
- addr = buffer;
- len = status & HME_XD_TXLENMSK;
- if (xmit_pos + len > HME_FIFO_SIZE) {
- len = HME_FIFO_SIZE - xmit_pos;
- }
- pci_dma_read(d, addr, &xmit_buffer[xmit_pos], len);
- xmit_pos += len;
- /* Detect start of packet for TX checksum */
- if (status & HME_XD_SOP) {
- sum = 0;
- csum_offset = (status & HME_XD_TXCSSTART) >> HME_XD_TXCSSTARTSHIFT;
- csum_stuff_offset = (status & HME_XD_TXCSSTUFF) >>
- HME_XD_TXCSSTUFFSHIFT;
- }
- if (status & HME_XD_TXCKSUM) {
- /* Only start calculation from csum_offset */
- if (xmit_pos - len <= csum_offset && xmit_pos > csum_offset) {
- sum += net_checksum_add(xmit_pos - csum_offset,
- xmit_buffer + csum_offset);
- trace_sunhme_tx_xsum_add(csum_offset, xmit_pos - csum_offset);
- } else {
- sum += net_checksum_add(len, xmit_buffer + xmit_pos - len);
- trace_sunhme_tx_xsum_add(xmit_pos - len, len);
- }
- }
- /* Detect end of packet for TX checksum */
- if (status & HME_XD_EOP) {
- /* Stuff the checksum if required */
- if (status & HME_XD_TXCKSUM) {
- csum = net_checksum_finish(sum);
- stw_be_p(xmit_buffer + csum_stuff_offset, csum);
- trace_sunhme_tx_xsum_stuff(csum, csum_stuff_offset);
- }
- if (s->macregs[HME_MACI_TXCFG >> 2] & HME_MAC_TXCFG_ENABLE) {
- sunhme_transmit_frame(s, xmit_buffer, xmit_pos);
- trace_sunhme_tx_done(xmit_pos);
- }
- }
- /* Update status */
- status &= ~HME_XD_OWN;
- pci_dma_write(d, tb + cr * HME_DESC_SIZE, &status, 4);
- /* Move onto next descriptor */
- cr++;
- if (cr >= nr) {
- cr = 0;
- }
- sunhme_set_tx_ring_nr(s, cr);
- pci_dma_read(d, tb + cr * HME_DESC_SIZE, &status, 4);
- pci_dma_read(d, tb + cr * HME_DESC_SIZE + 4, &buffer, 4);
- /* Indicate TX complete */
- intstatus = s->sebregs[HME_SEBI_STAT >> 2];
- intstatus |= HME_SEB_STAT_HOSTTOTX;
- s->sebregs[HME_SEBI_STAT >> 2] = intstatus;
- /* Autoclear TX pending */
- s->etxregs[HME_ETXI_PENDING >> 2] = 0;
- sunhme_update_irq(s);
- }
- /* TX FIFO now clear */
- intstatus = s->sebregs[HME_SEBI_STAT >> 2];
- intstatus |= HME_SEB_STAT_TXALL;
- s->sebregs[HME_SEBI_STAT >> 2] = intstatus;
- sunhme_update_irq(s);
- }
- static bool sunhme_can_receive(NetClientState *nc)
- {
- SunHMEState *s = qemu_get_nic_opaque(nc);
- return !!(s->macregs[HME_MACI_RXCFG >> 2] & HME_MAC_RXCFG_ENABLE);
- }
- static void sunhme_link_status_changed(NetClientState *nc)
- {
- SunHMEState *s = qemu_get_nic_opaque(nc);
- if (nc->link_down) {
- s->miiregs[MII_ANLPAR] &= ~MII_ANLPAR_TXFD;
- s->miiregs[MII_BMSR] &= ~MII_BMSR_LINK_ST;
- } else {
- s->miiregs[MII_ANLPAR] |= MII_ANLPAR_TXFD;
- s->miiregs[MII_BMSR] |= MII_BMSR_LINK_ST;
- }
- /* Exact bits unknown */
- s->mifregs[HME_MIFI_STAT >> 2] = 0xffff;
- sunhme_update_irq(s);
- }
- static inline int sunhme_get_rx_ring_count(SunHMEState *s)
- {
- uint32_t rings = (s->erxregs[HME_ERXI_CFG >> 2] & HME_ERX_CFG_RINGSIZE)
- >> HME_ERX_CFG_RINGSIZE_SHIFT;
- switch (rings) {
- case 0:
- return 32;
- case 1:
- return 64;
- case 2:
- return 128;
- case 3:
- return 256;
- }
- return 0;
- }
- static inline int sunhme_get_rx_ring_nr(SunHMEState *s)
- {
- return s->erxregs[HME_ERXI_RING >> 2] & HME_ERXI_RING_OFFSET;
- }
- static inline void sunhme_set_rx_ring_nr(SunHMEState *s, int i)
- {
- uint32_t ring = s->erxregs[HME_ERXI_RING >> 2] & ~HME_ERXI_RING_OFFSET;
- ring |= i & HME_ERXI_RING_OFFSET;
- s->erxregs[HME_ERXI_RING >> 2] = ring;
- }
- #define MIN_BUF_SIZE 60
- static ssize_t sunhme_receive(NetClientState *nc, const uint8_t *buf,
- size_t size)
- {
- SunHMEState *s = qemu_get_nic_opaque(nc);
- PCIDevice *d = PCI_DEVICE(s);
- dma_addr_t rb, addr;
- uint32_t intstatus, status, buffer, buffersize, sum;
- uint16_t csum;
- uint8_t buf1[60];
- int nr, cr, len, rxoffset, csum_offset;
- trace_sunhme_rx_incoming(size);
- /* Do nothing if MAC RX disabled */
- if (!(s->macregs[HME_MACI_RXCFG >> 2] & HME_MAC_RXCFG_ENABLE)) {
- return 0;
- }
- trace_sunhme_rx_filter_destmac(buf[0], buf[1], buf[2],
- buf[3], buf[4], buf[5]);
- /* Check destination MAC address */
- if (!(s->macregs[HME_MACI_RXCFG >> 2] & HME_MAC_RXCFG_PMISC)) {
- /* Try and match local MAC address */
- if (((s->macregs[HME_MACI_MACADDR0 >> 2] & 0xff00) >> 8) == buf[0] &&
- (s->macregs[HME_MACI_MACADDR0 >> 2] & 0xff) == buf[1] &&
- ((s->macregs[HME_MACI_MACADDR1 >> 2] & 0xff00) >> 8) == buf[2] &&
- (s->macregs[HME_MACI_MACADDR1 >> 2] & 0xff) == buf[3] &&
- ((s->macregs[HME_MACI_MACADDR2 >> 2] & 0xff00) >> 8) == buf[4] &&
- (s->macregs[HME_MACI_MACADDR2 >> 2] & 0xff) == buf[5]) {
- /* Matched local MAC address */
- trace_sunhme_rx_filter_local_match();
- } else if (buf[0] == 0xff && buf[1] == 0xff && buf[2] == 0xff &&
- buf[3] == 0xff && buf[4] == 0xff && buf[5] == 0xff) {
- /* Matched broadcast address */
- trace_sunhme_rx_filter_bcast_match();
- } else if (s->macregs[HME_MACI_RXCFG >> 2] & HME_MAC_RXCFG_HENABLE) {
- /* Didn't match local address, check hash filter */
- int mcast_idx = net_crc32_le(buf, ETH_ALEN) >> 26;
- if (!(s->macregs[(HME_MACI_HASHTAB0 >> 2) - (mcast_idx >> 4)] &
- (1 << (mcast_idx & 0xf)))) {
- /* Didn't match hash filter */
- trace_sunhme_rx_filter_hash_nomatch();
- trace_sunhme_rx_filter_reject();
- return -1;
- } else {
- trace_sunhme_rx_filter_hash_match();
- }
- } else {
- /* Not for us */
- trace_sunhme_rx_filter_reject();
- return -1;
- }
- } else {
- trace_sunhme_rx_filter_promisc_match();
- }
- trace_sunhme_rx_filter_accept();
- /* 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;
- }
- rb = s->erxregs[HME_ERXI_RING >> 2] & HME_ERXI_RING_ADDR;
- nr = sunhme_get_rx_ring_count(s);
- cr = sunhme_get_rx_ring_nr(s);
- pci_dma_read(d, rb + cr * HME_DESC_SIZE, &status, 4);
- pci_dma_read(d, rb + cr * HME_DESC_SIZE + 4, &buffer, 4);
- /* If we don't own the current descriptor then indicate overflow error */
- if (!(status & HME_XD_OWN)) {
- s->sebregs[HME_SEBI_STAT >> 2] |= HME_SEB_STAT_NORXD;
- sunhme_update_irq(s);
- trace_sunhme_rx_norxd();
- return -1;
- }
- rxoffset = (s->erxregs[HME_ERXI_CFG >> 2] & HME_ERX_CFG_BYTEOFFSET) >>
- HME_ERX_CFG_BYTEOFFSET_SHIFT;
- addr = buffer + rxoffset;
- buffersize = (status & HME_XD_RXLENMSK) >> HME_XD_RXLENSHIFT;
- /* Detect receive overflow */
- len = size;
- if (size > buffersize) {
- status |= HME_XD_OFL;
- len = buffersize;
- }
- pci_dma_write(d, addr, buf, len);
- trace_sunhme_rx_desc(buffer, rxoffset, status, len, cr, nr);
- /* Calculate the receive checksum */
- csum_offset = (s->erxregs[HME_ERXI_CFG >> 2] & HME_ERX_CFG_CSUMSTART) >>
- HME_ERX_CFG_CSUMSHIFT << 1;
- sum = 0;
- sum += net_checksum_add(len - csum_offset, (uint8_t *)buf + csum_offset);
- csum = net_checksum_finish(sum);
- trace_sunhme_rx_xsum_calc(csum);
- /* Update status */
- status &= ~HME_XD_OWN;
- status &= ~HME_XD_RXLENMSK;
- status |= len << HME_XD_RXLENSHIFT;
- status &= ~HME_XD_RXCKSUM;
- status |= csum;
- pci_dma_write(d, rb + cr * HME_DESC_SIZE, &status, 4);
- cr++;
- if (cr >= nr) {
- cr = 0;
- }
- sunhme_set_rx_ring_nr(s, cr);
- /* Indicate RX complete */
- intstatus = s->sebregs[HME_SEBI_STAT >> 2];
- intstatus |= HME_SEB_STAT_RXTOHOST;
- s->sebregs[HME_SEBI_STAT >> 2] = intstatus;
- sunhme_update_irq(s);
- return len;
- }
- static NetClientInfo net_sunhme_info = {
- .type = NET_CLIENT_DRIVER_NIC,
- .size = sizeof(NICState),
- .can_receive = sunhme_can_receive,
- .receive = sunhme_receive,
- .link_status_changed = sunhme_link_status_changed,
- };
- static void sunhme_realize(PCIDevice *pci_dev, Error **errp)
- {
- SunHMEState *s = SUNHME(pci_dev);
- DeviceState *d = DEVICE(pci_dev);
- uint8_t *pci_conf;
- pci_conf = pci_dev->config;
- pci_conf[PCI_INTERRUPT_PIN] = 1; /* interrupt pin A */
- memory_region_init(&s->hme, OBJECT(pci_dev), "sunhme", HME_REG_SIZE);
- pci_register_bar(pci_dev, 0, PCI_BASE_ADDRESS_SPACE_MEMORY, &s->hme);
- memory_region_init_io(&s->sebreg, OBJECT(pci_dev), &sunhme_seb_ops, s,
- "sunhme.seb", HME_SEB_REG_SIZE);
- memory_region_add_subregion(&s->hme, 0, &s->sebreg);
- memory_region_init_io(&s->etxreg, OBJECT(pci_dev), &sunhme_etx_ops, s,
- "sunhme.etx", HME_ETX_REG_SIZE);
- memory_region_add_subregion(&s->hme, 0x2000, &s->etxreg);
- memory_region_init_io(&s->erxreg, OBJECT(pci_dev), &sunhme_erx_ops, s,
- "sunhme.erx", HME_ERX_REG_SIZE);
- memory_region_add_subregion(&s->hme, 0x4000, &s->erxreg);
- memory_region_init_io(&s->macreg, OBJECT(pci_dev), &sunhme_mac_ops, s,
- "sunhme.mac", HME_MAC_REG_SIZE);
- memory_region_add_subregion(&s->hme, 0x6000, &s->macreg);
- memory_region_init_io(&s->mifreg, OBJECT(pci_dev), &sunhme_mif_ops, s,
- "sunhme.mif", HME_MIF_REG_SIZE);
- memory_region_add_subregion(&s->hme, 0x7000, &s->mifreg);
- qemu_macaddr_default_if_unset(&s->conf.macaddr);
- s->nic = qemu_new_nic(&net_sunhme_info, &s->conf,
- object_get_typename(OBJECT(d)), d->id, s);
- qemu_format_nic_info_str(qemu_get_queue(s->nic), s->conf.macaddr.a);
- }
- static void sunhme_instance_init(Object *obj)
- {
- SunHMEState *s = SUNHME(obj);
- device_add_bootindex_property(obj, &s->conf.bootindex,
- "bootindex", "/ethernet-phy@0",
- DEVICE(obj));
- }
- static void sunhme_reset(DeviceState *ds)
- {
- SunHMEState *s = SUNHME(ds);
- /* Configure internal transceiver */
- s->mifregs[HME_MIFI_CFG >> 2] |= HME_MIF_CFG_MDI0;
- /* Advetise auto, 100Mbps FD */
- s->miiregs[MII_ANAR] = MII_ANAR_TXFD;
- s->miiregs[MII_BMSR] = MII_BMSR_AUTONEG | MII_BMSR_100TX_FD |
- MII_BMSR_AN_COMP;
- if (!qemu_get_queue(s->nic)->link_down) {
- s->miiregs[MII_ANLPAR] |= MII_ANLPAR_TXFD;
- s->miiregs[MII_BMSR] |= MII_BMSR_LINK_ST;
- }
- /* Set manufacturer */
- s->miiregs[MII_PHYID1] = DP83840_PHYID1;
- s->miiregs[MII_PHYID2] = DP83840_PHYID2;
- /* Configure default interrupt mask */
- s->mifregs[HME_MIFI_IMASK >> 2] = 0xffff;
- s->sebregs[HME_SEBI_IMASK >> 2] = 0xff7fffff;
- }
- static const VMStateDescription vmstate_hme = {
- .name = "sunhme",
- .version_id = 0,
- .minimum_version_id = 0,
- .fields = (VMStateField[]) {
- VMSTATE_PCI_DEVICE(parent_obj, SunHMEState),
- VMSTATE_MACADDR(conf.macaddr, SunHMEState),
- VMSTATE_UINT32_ARRAY(sebregs, SunHMEState, (HME_SEB_REG_SIZE >> 2)),
- VMSTATE_UINT32_ARRAY(etxregs, SunHMEState, (HME_ETX_REG_SIZE >> 2)),
- VMSTATE_UINT32_ARRAY(erxregs, SunHMEState, (HME_ERX_REG_SIZE >> 2)),
- VMSTATE_UINT32_ARRAY(macregs, SunHMEState, (HME_MAC_REG_SIZE >> 2)),
- VMSTATE_UINT32_ARRAY(mifregs, SunHMEState, (HME_MIF_REG_SIZE >> 2)),
- VMSTATE_UINT16_ARRAY(miiregs, SunHMEState, HME_MII_REGS_SIZE),
- VMSTATE_END_OF_LIST()
- }
- };
- static void sunhme_class_init(ObjectClass *klass, void *data)
- {
- DeviceClass *dc = DEVICE_CLASS(klass);
- PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);
- k->realize = sunhme_realize;
- k->vendor_id = PCI_VENDOR_ID_SUN;
- k->device_id = PCI_DEVICE_ID_SUN_HME;
- k->class_id = PCI_CLASS_NETWORK_ETHERNET;
- dc->vmsd = &vmstate_hme;
- dc->reset = sunhme_reset;
- device_class_set_props(dc, sunhme_properties);
- set_bit(DEVICE_CATEGORY_NETWORK, dc->categories);
- }
- static const TypeInfo sunhme_info = {
- .name = TYPE_SUNHME,
- .parent = TYPE_PCI_DEVICE,
- .class_init = sunhme_class_init,
- .instance_size = sizeof(SunHMEState),
- .instance_init = sunhme_instance_init,
- .interfaces = (InterfaceInfo[]) {
- { INTERFACE_CONVENTIONAL_PCI_DEVICE },
- { }
- }
- };
- static void sunhme_register_types(void)
- {
- type_register_static(&sunhme_info);
- }
- type_init(sunhme_register_types)
|