1342407fdSMax Filippov /* 2342407fdSMax Filippov * OpenCores Ethernet MAC 10/100 + subset of 3342407fdSMax Filippov * National Semiconductors DP83848C 10/100 PHY 4342407fdSMax Filippov * 5342407fdSMax Filippov * http://opencores.org/svnget,ethmac?file=%2Ftrunk%2F%2Fdoc%2Feth_speci.pdf 6342407fdSMax Filippov * http://cache.national.com/ds/DP/DP83848C.pdf 7342407fdSMax Filippov * 8342407fdSMax Filippov * Copyright (c) 2011, Max Filippov, Open Source and Linux Lab. 9342407fdSMax Filippov * All rights reserved. 10342407fdSMax Filippov * 11342407fdSMax Filippov * Redistribution and use in source and binary forms, with or without 12342407fdSMax Filippov * modification, are permitted provided that the following conditions are met: 13342407fdSMax Filippov * * Redistributions of source code must retain the above copyright 14342407fdSMax Filippov * notice, this list of conditions and the following disclaimer. 15342407fdSMax Filippov * * Redistributions in binary form must reproduce the above copyright 16342407fdSMax Filippov * notice, this list of conditions and the following disclaimer in the 17342407fdSMax Filippov * documentation and/or other materials provided with the distribution. 18342407fdSMax Filippov * * Neither the name of the Open Source and Linux Lab nor the 19342407fdSMax Filippov * names of its contributors may be used to endorse or promote products 20342407fdSMax Filippov * derived from this software without specific prior written permission. 21342407fdSMax Filippov * 22342407fdSMax Filippov * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 23342407fdSMax Filippov * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 24342407fdSMax Filippov * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 25342407fdSMax Filippov * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY 26342407fdSMax Filippov * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 27342407fdSMax Filippov * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 28342407fdSMax Filippov * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 29342407fdSMax Filippov * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 30342407fdSMax Filippov * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 31342407fdSMax Filippov * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 32342407fdSMax Filippov */ 33342407fdSMax Filippov 3483c9f4caSPaolo Bonzini #include "hw/hw.h" 3583c9f4caSPaolo Bonzini #include "hw/sysbus.h" 361422e32dSPaolo Bonzini #include "net/net.h" 379c17d615SPaolo Bonzini #include "sysemu/sysemu.h" 38342407fdSMax Filippov #include "trace.h" 39342407fdSMax Filippov 40342407fdSMax Filippov /* RECSMALL is not used because it breaks tap networking in linux: 41342407fdSMax Filippov * incoming ARP responses are too short 42342407fdSMax Filippov */ 43342407fdSMax Filippov #undef USE_RECSMALL 44342407fdSMax Filippov 45342407fdSMax Filippov #define GET_FIELD(v, field) (((v) & (field)) >> (field ## _LBN)) 46342407fdSMax Filippov #define GET_REGBIT(s, reg, field) ((s)->regs[reg] & (reg ## _ ## field)) 47342407fdSMax Filippov #define GET_REGFIELD(s, reg, field) \ 48342407fdSMax Filippov GET_FIELD((s)->regs[reg], reg ## _ ## field) 49342407fdSMax Filippov 50342407fdSMax Filippov #define SET_FIELD(v, field, data) \ 51342407fdSMax Filippov ((v) = (((v) & ~(field)) | (((data) << (field ## _LBN)) & (field)))) 52342407fdSMax Filippov #define SET_REGFIELD(s, reg, field, data) \ 53342407fdSMax Filippov SET_FIELD((s)->regs[reg], reg ## _ ## field, data) 54342407fdSMax Filippov 55342407fdSMax Filippov /* PHY MII registers */ 56342407fdSMax Filippov enum { 57342407fdSMax Filippov MII_BMCR, 58342407fdSMax Filippov MII_BMSR, 59342407fdSMax Filippov MII_PHYIDR1, 60342407fdSMax Filippov MII_PHYIDR2, 61342407fdSMax Filippov MII_ANAR, 62342407fdSMax Filippov MII_ANLPAR, 63342407fdSMax Filippov MII_REG_MAX = 16, 64342407fdSMax Filippov }; 65342407fdSMax Filippov 66342407fdSMax Filippov typedef struct Mii { 67342407fdSMax Filippov uint16_t regs[MII_REG_MAX]; 68342407fdSMax Filippov bool link_ok; 69342407fdSMax Filippov } Mii; 70342407fdSMax Filippov 71342407fdSMax Filippov static void mii_set_link(Mii *s, bool link_ok) 72342407fdSMax Filippov { 73342407fdSMax Filippov if (link_ok) { 74342407fdSMax Filippov s->regs[MII_BMSR] |= 0x4; 75342407fdSMax Filippov s->regs[MII_ANLPAR] |= 0x01e1; 76342407fdSMax Filippov } else { 77342407fdSMax Filippov s->regs[MII_BMSR] &= ~0x4; 78342407fdSMax Filippov s->regs[MII_ANLPAR] &= 0x01ff; 79342407fdSMax Filippov } 80342407fdSMax Filippov s->link_ok = link_ok; 81342407fdSMax Filippov } 82342407fdSMax Filippov 83342407fdSMax Filippov static void mii_reset(Mii *s) 84342407fdSMax Filippov { 85342407fdSMax Filippov memset(s->regs, 0, sizeof(s->regs)); 86342407fdSMax Filippov s->regs[MII_BMCR] = 0x1000; 87342407fdSMax Filippov s->regs[MII_BMSR] = 0x7848; /* no ext regs */ 88342407fdSMax Filippov s->regs[MII_PHYIDR1] = 0x2000; 89342407fdSMax Filippov s->regs[MII_PHYIDR2] = 0x5c90; 90342407fdSMax Filippov s->regs[MII_ANAR] = 0x01e1; 91342407fdSMax Filippov mii_set_link(s, s->link_ok); 92342407fdSMax Filippov } 93342407fdSMax Filippov 94342407fdSMax Filippov static void mii_ro(Mii *s, uint16_t v) 95342407fdSMax Filippov { 96342407fdSMax Filippov } 97342407fdSMax Filippov 98342407fdSMax Filippov static void mii_write_bmcr(Mii *s, uint16_t v) 99342407fdSMax Filippov { 100342407fdSMax Filippov if (v & 0x8000) { 101342407fdSMax Filippov mii_reset(s); 102342407fdSMax Filippov } else { 103342407fdSMax Filippov s->regs[MII_BMCR] = v; 104342407fdSMax Filippov } 105342407fdSMax Filippov } 106342407fdSMax Filippov 107342407fdSMax Filippov static void mii_write_host(Mii *s, unsigned idx, uint16_t v) 108342407fdSMax Filippov { 109342407fdSMax Filippov static void (*reg_write[MII_REG_MAX])(Mii *s, uint16_t v) = { 110342407fdSMax Filippov [MII_BMCR] = mii_write_bmcr, 111342407fdSMax Filippov [MII_BMSR] = mii_ro, 112342407fdSMax Filippov [MII_PHYIDR1] = mii_ro, 113342407fdSMax Filippov [MII_PHYIDR2] = mii_ro, 114342407fdSMax Filippov }; 115342407fdSMax Filippov 116342407fdSMax Filippov if (idx < MII_REG_MAX) { 117342407fdSMax Filippov trace_open_eth_mii_write(idx, v); 118342407fdSMax Filippov if (reg_write[idx]) { 119342407fdSMax Filippov reg_write[idx](s, v); 120342407fdSMax Filippov } else { 121342407fdSMax Filippov s->regs[idx] = v; 122342407fdSMax Filippov } 123342407fdSMax Filippov } 124342407fdSMax Filippov } 125342407fdSMax Filippov 126342407fdSMax Filippov static uint16_t mii_read_host(Mii *s, unsigned idx) 127342407fdSMax Filippov { 128342407fdSMax Filippov trace_open_eth_mii_read(idx, s->regs[idx]); 129342407fdSMax Filippov return s->regs[idx]; 130342407fdSMax Filippov } 131342407fdSMax Filippov 132342407fdSMax Filippov /* OpenCores Ethernet registers */ 133342407fdSMax Filippov enum { 134342407fdSMax Filippov MODER, 135342407fdSMax Filippov INT_SOURCE, 136342407fdSMax Filippov INT_MASK, 137342407fdSMax Filippov IPGT, 138342407fdSMax Filippov IPGR1, 139342407fdSMax Filippov IPGR2, 140342407fdSMax Filippov PACKETLEN, 141342407fdSMax Filippov COLLCONF, 142342407fdSMax Filippov TX_BD_NUM, 143342407fdSMax Filippov CTRLMODER, 144342407fdSMax Filippov MIIMODER, 145342407fdSMax Filippov MIICOMMAND, 146342407fdSMax Filippov MIIADDRESS, 147342407fdSMax Filippov MIITX_DATA, 148342407fdSMax Filippov MIIRX_DATA, 149342407fdSMax Filippov MIISTATUS, 150342407fdSMax Filippov MAC_ADDR0, 151342407fdSMax Filippov MAC_ADDR1, 152342407fdSMax Filippov HASH0, 153342407fdSMax Filippov HASH1, 154342407fdSMax Filippov TXCTRL, 155342407fdSMax Filippov REG_MAX, 156342407fdSMax Filippov }; 157342407fdSMax Filippov 158342407fdSMax Filippov enum { 159342407fdSMax Filippov MODER_RECSMALL = 0x10000, 160342407fdSMax Filippov MODER_PAD = 0x8000, 161342407fdSMax Filippov MODER_HUGEN = 0x4000, 162342407fdSMax Filippov MODER_RST = 0x800, 163342407fdSMax Filippov MODER_LOOPBCK = 0x80, 164342407fdSMax Filippov MODER_PRO = 0x20, 165342407fdSMax Filippov MODER_IAM = 0x10, 166342407fdSMax Filippov MODER_BRO = 0x8, 167342407fdSMax Filippov MODER_TXEN = 0x2, 168342407fdSMax Filippov MODER_RXEN = 0x1, 169342407fdSMax Filippov }; 170342407fdSMax Filippov 171342407fdSMax Filippov enum { 172342407fdSMax Filippov INT_SOURCE_RXB = 0x4, 173342407fdSMax Filippov INT_SOURCE_TXB = 0x1, 174342407fdSMax Filippov }; 175342407fdSMax Filippov 176342407fdSMax Filippov enum { 177342407fdSMax Filippov PACKETLEN_MINFL = 0xffff0000, 178342407fdSMax Filippov PACKETLEN_MINFL_LBN = 16, 179342407fdSMax Filippov PACKETLEN_MAXFL = 0xffff, 180342407fdSMax Filippov PACKETLEN_MAXFL_LBN = 0, 181342407fdSMax Filippov }; 182342407fdSMax Filippov 183342407fdSMax Filippov enum { 184342407fdSMax Filippov MIICOMMAND_WCTRLDATA = 0x4, 185342407fdSMax Filippov MIICOMMAND_RSTAT = 0x2, 186342407fdSMax Filippov MIICOMMAND_SCANSTAT = 0x1, 187342407fdSMax Filippov }; 188342407fdSMax Filippov 189342407fdSMax Filippov enum { 190342407fdSMax Filippov MIIADDRESS_RGAD = 0x1f00, 191342407fdSMax Filippov MIIADDRESS_RGAD_LBN = 8, 192342407fdSMax Filippov MIIADDRESS_FIAD = 0x1f, 193342407fdSMax Filippov MIIADDRESS_FIAD_LBN = 0, 194342407fdSMax Filippov }; 195342407fdSMax Filippov 196342407fdSMax Filippov enum { 197342407fdSMax Filippov MIITX_DATA_CTRLDATA = 0xffff, 198342407fdSMax Filippov MIITX_DATA_CTRLDATA_LBN = 0, 199342407fdSMax Filippov }; 200342407fdSMax Filippov 201342407fdSMax Filippov enum { 202342407fdSMax Filippov MIIRX_DATA_PRSD = 0xffff, 203342407fdSMax Filippov MIIRX_DATA_PRSD_LBN = 0, 204342407fdSMax Filippov }; 205342407fdSMax Filippov 206342407fdSMax Filippov enum { 207342407fdSMax Filippov MIISTATUS_LINKFAIL = 0x1, 208342407fdSMax Filippov MIISTATUS_LINKFAIL_LBN = 0, 209342407fdSMax Filippov }; 210342407fdSMax Filippov 211342407fdSMax Filippov enum { 212342407fdSMax Filippov MAC_ADDR0_BYTE2 = 0xff000000, 213342407fdSMax Filippov MAC_ADDR0_BYTE2_LBN = 24, 214342407fdSMax Filippov MAC_ADDR0_BYTE3 = 0xff0000, 215342407fdSMax Filippov MAC_ADDR0_BYTE3_LBN = 16, 216342407fdSMax Filippov MAC_ADDR0_BYTE4 = 0xff00, 217342407fdSMax Filippov MAC_ADDR0_BYTE4_LBN = 8, 218342407fdSMax Filippov MAC_ADDR0_BYTE5 = 0xff, 219342407fdSMax Filippov MAC_ADDR0_BYTE5_LBN = 0, 220342407fdSMax Filippov }; 221342407fdSMax Filippov 222342407fdSMax Filippov enum { 223342407fdSMax Filippov MAC_ADDR1_BYTE0 = 0xff00, 224342407fdSMax Filippov MAC_ADDR1_BYTE0_LBN = 8, 225342407fdSMax Filippov MAC_ADDR1_BYTE1 = 0xff, 226342407fdSMax Filippov MAC_ADDR1_BYTE1_LBN = 0, 227342407fdSMax Filippov }; 228342407fdSMax Filippov 229342407fdSMax Filippov enum { 230342407fdSMax Filippov TXD_LEN = 0xffff0000, 231342407fdSMax Filippov TXD_LEN_LBN = 16, 232342407fdSMax Filippov TXD_RD = 0x8000, 233342407fdSMax Filippov TXD_IRQ = 0x4000, 234342407fdSMax Filippov TXD_WR = 0x2000, 235342407fdSMax Filippov TXD_PAD = 0x1000, 236342407fdSMax Filippov TXD_CRC = 0x800, 237342407fdSMax Filippov TXD_UR = 0x100, 238342407fdSMax Filippov TXD_RTRY = 0xf0, 239342407fdSMax Filippov TXD_RTRY_LBN = 4, 240342407fdSMax Filippov TXD_RL = 0x8, 241342407fdSMax Filippov TXD_LC = 0x4, 242342407fdSMax Filippov TXD_DF = 0x2, 243342407fdSMax Filippov TXD_CS = 0x1, 244342407fdSMax Filippov }; 245342407fdSMax Filippov 246342407fdSMax Filippov enum { 247342407fdSMax Filippov RXD_LEN = 0xffff0000, 248342407fdSMax Filippov RXD_LEN_LBN = 16, 249342407fdSMax Filippov RXD_E = 0x8000, 250342407fdSMax Filippov RXD_IRQ = 0x4000, 251342407fdSMax Filippov RXD_WRAP = 0x2000, 252342407fdSMax Filippov RXD_CF = 0x100, 253342407fdSMax Filippov RXD_M = 0x80, 254342407fdSMax Filippov RXD_OR = 0x40, 255342407fdSMax Filippov RXD_IS = 0x20, 256342407fdSMax Filippov RXD_DN = 0x10, 257342407fdSMax Filippov RXD_TL = 0x8, 258342407fdSMax Filippov RXD_SF = 0x4, 259342407fdSMax Filippov RXD_CRC = 0x2, 260342407fdSMax Filippov RXD_LC = 0x1, 261342407fdSMax Filippov }; 262342407fdSMax Filippov 263342407fdSMax Filippov typedef struct desc { 264342407fdSMax Filippov uint32_t len_flags; 265342407fdSMax Filippov uint32_t buf_ptr; 266342407fdSMax Filippov } desc; 267342407fdSMax Filippov 268342407fdSMax Filippov #define DEFAULT_PHY 1 269342407fdSMax Filippov 270*4632cf2dSAndreas Färber #define TYPE_OPEN_ETH "open_eth" 271*4632cf2dSAndreas Färber #define OPEN_ETH(obj) OBJECT_CHECK(OpenEthState, (obj), TYPE_OPEN_ETH) 272*4632cf2dSAndreas Färber 273342407fdSMax Filippov typedef struct OpenEthState { 274*4632cf2dSAndreas Färber SysBusDevice parent_obj; 275*4632cf2dSAndreas Färber 276342407fdSMax Filippov NICState *nic; 277342407fdSMax Filippov NICConf conf; 278342407fdSMax Filippov MemoryRegion reg_io; 279342407fdSMax Filippov MemoryRegion desc_io; 280342407fdSMax Filippov qemu_irq irq; 281342407fdSMax Filippov 282342407fdSMax Filippov Mii mii; 283342407fdSMax Filippov uint32_t regs[REG_MAX]; 284342407fdSMax Filippov unsigned tx_desc; 285342407fdSMax Filippov unsigned rx_desc; 286342407fdSMax Filippov desc desc[128]; 287342407fdSMax Filippov } OpenEthState; 288342407fdSMax Filippov 289342407fdSMax Filippov static desc *rx_desc(OpenEthState *s) 290342407fdSMax Filippov { 291342407fdSMax Filippov return s->desc + s->rx_desc; 292342407fdSMax Filippov } 293342407fdSMax Filippov 294342407fdSMax Filippov static desc *tx_desc(OpenEthState *s) 295342407fdSMax Filippov { 296342407fdSMax Filippov return s->desc + s->tx_desc; 297342407fdSMax Filippov } 298342407fdSMax Filippov 299342407fdSMax Filippov static void open_eth_update_irq(OpenEthState *s, 300342407fdSMax Filippov uint32_t old, uint32_t new) 301342407fdSMax Filippov { 302342407fdSMax Filippov if (!old != !new) { 303342407fdSMax Filippov trace_open_eth_update_irq(new); 304342407fdSMax Filippov qemu_set_irq(s->irq, new); 305342407fdSMax Filippov } 306342407fdSMax Filippov } 307342407fdSMax Filippov 308342407fdSMax Filippov static void open_eth_int_source_write(OpenEthState *s, 309342407fdSMax Filippov uint32_t val) 310342407fdSMax Filippov { 311342407fdSMax Filippov uint32_t old_val = s->regs[INT_SOURCE]; 312342407fdSMax Filippov 313342407fdSMax Filippov s->regs[INT_SOURCE] = val; 314342407fdSMax Filippov open_eth_update_irq(s, old_val & s->regs[INT_MASK], 315342407fdSMax Filippov s->regs[INT_SOURCE] & s->regs[INT_MASK]); 316342407fdSMax Filippov } 317342407fdSMax Filippov 3184e68f7a0SStefan Hajnoczi static void open_eth_set_link_status(NetClientState *nc) 319342407fdSMax Filippov { 320cc1f0f45SJason Wang OpenEthState *s = qemu_get_nic_opaque(nc); 321342407fdSMax Filippov 322342407fdSMax Filippov if (GET_REGBIT(s, MIICOMMAND, SCANSTAT)) { 323342407fdSMax Filippov SET_REGFIELD(s, MIISTATUS, LINKFAIL, nc->link_down); 324342407fdSMax Filippov } 325342407fdSMax Filippov mii_set_link(&s->mii, !nc->link_down); 326342407fdSMax Filippov } 327342407fdSMax Filippov 328342407fdSMax Filippov static void open_eth_reset(void *opaque) 329342407fdSMax Filippov { 330342407fdSMax Filippov OpenEthState *s = opaque; 331342407fdSMax Filippov 332342407fdSMax Filippov memset(s->regs, 0, sizeof(s->regs)); 333342407fdSMax Filippov s->regs[MODER] = 0xa000; 334342407fdSMax Filippov s->regs[IPGT] = 0x12; 335342407fdSMax Filippov s->regs[IPGR1] = 0xc; 336342407fdSMax Filippov s->regs[IPGR2] = 0x12; 337342407fdSMax Filippov s->regs[PACKETLEN] = 0x400600; 338342407fdSMax Filippov s->regs[COLLCONF] = 0xf003f; 339342407fdSMax Filippov s->regs[TX_BD_NUM] = 0x40; 340342407fdSMax Filippov s->regs[MIIMODER] = 0x64; 341342407fdSMax Filippov 342342407fdSMax Filippov s->tx_desc = 0; 343342407fdSMax Filippov s->rx_desc = 0x40; 344342407fdSMax Filippov 345342407fdSMax Filippov mii_reset(&s->mii); 346b356f76dSJason Wang open_eth_set_link_status(qemu_get_queue(s->nic)); 347342407fdSMax Filippov } 348342407fdSMax Filippov 3494e68f7a0SStefan Hajnoczi static int open_eth_can_receive(NetClientState *nc) 350342407fdSMax Filippov { 351cc1f0f45SJason Wang OpenEthState *s = qemu_get_nic_opaque(nc); 352342407fdSMax Filippov 353342407fdSMax Filippov return GET_REGBIT(s, MODER, RXEN) && 354342407fdSMax Filippov (s->regs[TX_BD_NUM] < 0x80) && 355342407fdSMax Filippov (rx_desc(s)->len_flags & RXD_E); 356342407fdSMax Filippov } 357342407fdSMax Filippov 3584e68f7a0SStefan Hajnoczi static ssize_t open_eth_receive(NetClientState *nc, 359342407fdSMax Filippov const uint8_t *buf, size_t size) 360342407fdSMax Filippov { 361cc1f0f45SJason Wang OpenEthState *s = qemu_get_nic_opaque(nc); 362342407fdSMax Filippov size_t maxfl = GET_REGFIELD(s, PACKETLEN, MAXFL); 363342407fdSMax Filippov size_t minfl = GET_REGFIELD(s, PACKETLEN, MINFL); 36490ea59feSMax Filippov size_t fcsl = 4; 365342407fdSMax Filippov bool miss = true; 366342407fdSMax Filippov 367342407fdSMax Filippov trace_open_eth_receive((unsigned)size); 368342407fdSMax Filippov 369342407fdSMax Filippov if (size >= 6) { 370342407fdSMax Filippov static const uint8_t bcast_addr[] = { 371342407fdSMax Filippov 0xff, 0xff, 0xff, 0xff, 0xff, 0xff 372342407fdSMax Filippov }; 373342407fdSMax Filippov if (memcmp(buf, bcast_addr, sizeof(bcast_addr)) == 0) { 374342407fdSMax Filippov miss = GET_REGBIT(s, MODER, BRO); 375342407fdSMax Filippov } else if ((buf[0] & 0x1) || GET_REGBIT(s, MODER, IAM)) { 376342407fdSMax Filippov unsigned mcast_idx = compute_mcast_idx(buf); 377342407fdSMax Filippov miss = !(s->regs[HASH0 + mcast_idx / 32] & 378342407fdSMax Filippov (1 << (mcast_idx % 32))); 379342407fdSMax Filippov trace_open_eth_receive_mcast( 380342407fdSMax Filippov mcast_idx, s->regs[HASH0], s->regs[HASH1]); 381342407fdSMax Filippov } else { 382342407fdSMax Filippov miss = GET_REGFIELD(s, MAC_ADDR1, BYTE0) != buf[0] || 383342407fdSMax Filippov GET_REGFIELD(s, MAC_ADDR1, BYTE1) != buf[1] || 384342407fdSMax Filippov GET_REGFIELD(s, MAC_ADDR0, BYTE2) != buf[2] || 385342407fdSMax Filippov GET_REGFIELD(s, MAC_ADDR0, BYTE3) != buf[3] || 386342407fdSMax Filippov GET_REGFIELD(s, MAC_ADDR0, BYTE4) != buf[4] || 387342407fdSMax Filippov GET_REGFIELD(s, MAC_ADDR0, BYTE5) != buf[5]; 388342407fdSMax Filippov } 389342407fdSMax Filippov } 390342407fdSMax Filippov 391342407fdSMax Filippov if (miss && !GET_REGBIT(s, MODER, PRO)) { 392342407fdSMax Filippov trace_open_eth_receive_reject(); 393342407fdSMax Filippov return size; 394342407fdSMax Filippov } 395342407fdSMax Filippov 396342407fdSMax Filippov #ifdef USE_RECSMALL 397342407fdSMax Filippov if (GET_REGBIT(s, MODER, RECSMALL) || size >= minfl) { 398342407fdSMax Filippov #else 399342407fdSMax Filippov { 400342407fdSMax Filippov #endif 40190ea59feSMax Filippov static const uint8_t zero[64] = {0}; 402342407fdSMax Filippov desc *desc = rx_desc(s); 403342407fdSMax Filippov size_t copy_size = GET_REGBIT(s, MODER, HUGEN) ? 65536 : maxfl; 404342407fdSMax Filippov 405342407fdSMax Filippov desc->len_flags &= ~(RXD_CF | RXD_M | RXD_OR | 406342407fdSMax Filippov RXD_IS | RXD_DN | RXD_TL | RXD_SF | RXD_CRC | RXD_LC); 407342407fdSMax Filippov 408342407fdSMax Filippov if (copy_size > size) { 409342407fdSMax Filippov copy_size = size; 41090ea59feSMax Filippov } else { 41190ea59feSMax Filippov fcsl = 0; 412342407fdSMax Filippov } 413342407fdSMax Filippov if (miss) { 414342407fdSMax Filippov desc->len_flags |= RXD_M; 415342407fdSMax Filippov } 41690ea59feSMax Filippov if (GET_REGBIT(s, MODER, HUGEN) && size > maxfl) { 417342407fdSMax Filippov desc->len_flags |= RXD_TL; 418342407fdSMax Filippov } 419342407fdSMax Filippov #ifdef USE_RECSMALL 420342407fdSMax Filippov if (size < minfl) { 421342407fdSMax Filippov desc->len_flags |= RXD_SF; 422342407fdSMax Filippov } 423342407fdSMax Filippov #endif 424342407fdSMax Filippov 425342407fdSMax Filippov cpu_physical_memory_write(desc->buf_ptr, buf, copy_size); 426342407fdSMax Filippov 427342407fdSMax Filippov if (GET_REGBIT(s, MODER, PAD) && copy_size < minfl) { 42890ea59feSMax Filippov if (minfl - copy_size > fcsl) { 42990ea59feSMax Filippov fcsl = 0; 43090ea59feSMax Filippov } else { 43190ea59feSMax Filippov fcsl -= minfl - copy_size; 43290ea59feSMax Filippov } 43390ea59feSMax Filippov while (copy_size < minfl) { 43490ea59feSMax Filippov size_t zero_sz = minfl - copy_size < sizeof(zero) ? 43590ea59feSMax Filippov minfl - copy_size : sizeof(zero); 436342407fdSMax Filippov 437342407fdSMax Filippov cpu_physical_memory_write(desc->buf_ptr + copy_size, 43890ea59feSMax Filippov zero, zero_sz); 43990ea59feSMax Filippov copy_size += zero_sz; 440342407fdSMax Filippov } 44190ea59feSMax Filippov } 44290ea59feSMax Filippov 44390ea59feSMax Filippov /* There's no FCS in the frames handed to us by the QEMU, zero fill it. 44490ea59feSMax Filippov * Don't do it if the frame is cut at the MAXFL or padded with 4 or 44590ea59feSMax Filippov * more bytes to the MINFL. 44690ea59feSMax Filippov */ 44790ea59feSMax Filippov cpu_physical_memory_write(desc->buf_ptr + copy_size, zero, fcsl); 44890ea59feSMax Filippov copy_size += fcsl; 449342407fdSMax Filippov 450342407fdSMax Filippov SET_FIELD(desc->len_flags, RXD_LEN, copy_size); 451342407fdSMax Filippov 452342407fdSMax Filippov if ((desc->len_flags & RXD_WRAP) || s->rx_desc == 0x7f) { 453342407fdSMax Filippov s->rx_desc = s->regs[TX_BD_NUM]; 454342407fdSMax Filippov } else { 455342407fdSMax Filippov ++s->rx_desc; 456342407fdSMax Filippov } 457342407fdSMax Filippov desc->len_flags &= ~RXD_E; 458342407fdSMax Filippov 459342407fdSMax Filippov trace_open_eth_receive_desc(desc->buf_ptr, desc->len_flags); 460342407fdSMax Filippov 461342407fdSMax Filippov if (desc->len_flags & RXD_IRQ) { 462342407fdSMax Filippov open_eth_int_source_write(s, 463342407fdSMax Filippov s->regs[INT_SOURCE] | INT_SOURCE_RXB); 464342407fdSMax Filippov } 465342407fdSMax Filippov } 466342407fdSMax Filippov return size; 467342407fdSMax Filippov } 468342407fdSMax Filippov 4694e68f7a0SStefan Hajnoczi static void open_eth_cleanup(NetClientState *nc) 470342407fdSMax Filippov { 471342407fdSMax Filippov } 472342407fdSMax Filippov 473342407fdSMax Filippov static NetClientInfo net_open_eth_info = { 4742be64a68SLaszlo Ersek .type = NET_CLIENT_OPTIONS_KIND_NIC, 475342407fdSMax Filippov .size = sizeof(NICState), 476342407fdSMax Filippov .can_receive = open_eth_can_receive, 477342407fdSMax Filippov .receive = open_eth_receive, 478342407fdSMax Filippov .cleanup = open_eth_cleanup, 479342407fdSMax Filippov .link_status_changed = open_eth_set_link_status, 480342407fdSMax Filippov }; 481342407fdSMax Filippov 482342407fdSMax Filippov static void open_eth_start_xmit(OpenEthState *s, desc *tx) 483342407fdSMax Filippov { 484342407fdSMax Filippov uint8_t buf[65536]; 485342407fdSMax Filippov unsigned len = GET_FIELD(tx->len_flags, TXD_LEN); 486342407fdSMax Filippov unsigned tx_len = len; 487342407fdSMax Filippov 488342407fdSMax Filippov if ((tx->len_flags & TXD_PAD) && 489342407fdSMax Filippov tx_len < GET_REGFIELD(s, PACKETLEN, MINFL)) { 490342407fdSMax Filippov tx_len = GET_REGFIELD(s, PACKETLEN, MINFL); 491342407fdSMax Filippov } 492342407fdSMax Filippov if (!GET_REGBIT(s, MODER, HUGEN) && 493342407fdSMax Filippov tx_len > GET_REGFIELD(s, PACKETLEN, MAXFL)) { 494342407fdSMax Filippov tx_len = GET_REGFIELD(s, PACKETLEN, MAXFL); 495342407fdSMax Filippov } 496342407fdSMax Filippov 497342407fdSMax Filippov trace_open_eth_start_xmit(tx->buf_ptr, len, tx_len); 498342407fdSMax Filippov 499342407fdSMax Filippov if (len > tx_len) { 500342407fdSMax Filippov len = tx_len; 501342407fdSMax Filippov } 502342407fdSMax Filippov cpu_physical_memory_read(tx->buf_ptr, buf, len); 503342407fdSMax Filippov if (tx_len > len) { 504342407fdSMax Filippov memset(buf + len, 0, tx_len - len); 505342407fdSMax Filippov } 506b356f76dSJason Wang qemu_send_packet(qemu_get_queue(s->nic), buf, tx_len); 507342407fdSMax Filippov 508342407fdSMax Filippov if (tx->len_flags & TXD_WR) { 509342407fdSMax Filippov s->tx_desc = 0; 510342407fdSMax Filippov } else { 511342407fdSMax Filippov ++s->tx_desc; 512342407fdSMax Filippov if (s->tx_desc >= s->regs[TX_BD_NUM]) { 513342407fdSMax Filippov s->tx_desc = 0; 514342407fdSMax Filippov } 515342407fdSMax Filippov } 516342407fdSMax Filippov tx->len_flags &= ~(TXD_RD | TXD_UR | 517342407fdSMax Filippov TXD_RTRY | TXD_RL | TXD_LC | TXD_DF | TXD_CS); 518342407fdSMax Filippov if (tx->len_flags & TXD_IRQ) { 519342407fdSMax Filippov open_eth_int_source_write(s, s->regs[INT_SOURCE] | INT_SOURCE_TXB); 520342407fdSMax Filippov } 521342407fdSMax Filippov 522342407fdSMax Filippov } 523342407fdSMax Filippov 524342407fdSMax Filippov static void open_eth_check_start_xmit(OpenEthState *s) 525342407fdSMax Filippov { 526342407fdSMax Filippov desc *tx = tx_desc(s); 527342407fdSMax Filippov if (GET_REGBIT(s, MODER, TXEN) && s->regs[TX_BD_NUM] > 0 && 528342407fdSMax Filippov (tx->len_flags & TXD_RD) && 529342407fdSMax Filippov GET_FIELD(tx->len_flags, TXD_LEN) > 4) { 530342407fdSMax Filippov open_eth_start_xmit(s, tx); 531342407fdSMax Filippov } 532342407fdSMax Filippov } 533342407fdSMax Filippov 534342407fdSMax Filippov static uint64_t open_eth_reg_read(void *opaque, 535a8170e5eSAvi Kivity hwaddr addr, unsigned int size) 536342407fdSMax Filippov { 537342407fdSMax Filippov static uint32_t (*reg_read[REG_MAX])(OpenEthState *s) = { 538342407fdSMax Filippov }; 539342407fdSMax Filippov OpenEthState *s = opaque; 540342407fdSMax Filippov unsigned idx = addr / 4; 541342407fdSMax Filippov uint64_t v = 0; 542342407fdSMax Filippov 543342407fdSMax Filippov if (idx < REG_MAX) { 544342407fdSMax Filippov if (reg_read[idx]) { 545342407fdSMax Filippov v = reg_read[idx](s); 546342407fdSMax Filippov } else { 547342407fdSMax Filippov v = s->regs[idx]; 548342407fdSMax Filippov } 549342407fdSMax Filippov } 550342407fdSMax Filippov trace_open_eth_reg_read((uint32_t)addr, (uint32_t)v); 551342407fdSMax Filippov return v; 552342407fdSMax Filippov } 553342407fdSMax Filippov 554342407fdSMax Filippov static void open_eth_ro(OpenEthState *s, uint32_t val) 555342407fdSMax Filippov { 556342407fdSMax Filippov } 557342407fdSMax Filippov 558342407fdSMax Filippov static void open_eth_moder_host_write(OpenEthState *s, uint32_t val) 559342407fdSMax Filippov { 560342407fdSMax Filippov uint32_t set = val & ~s->regs[MODER]; 561342407fdSMax Filippov 562342407fdSMax Filippov if (set & MODER_RST) { 563342407fdSMax Filippov open_eth_reset(s); 564342407fdSMax Filippov } 565342407fdSMax Filippov 566342407fdSMax Filippov s->regs[MODER] = val; 567342407fdSMax Filippov 568342407fdSMax Filippov if (set & MODER_RXEN) { 569342407fdSMax Filippov s->rx_desc = s->regs[TX_BD_NUM]; 570342407fdSMax Filippov } 571342407fdSMax Filippov if (set & MODER_TXEN) { 572342407fdSMax Filippov s->tx_desc = 0; 573342407fdSMax Filippov open_eth_check_start_xmit(s); 574342407fdSMax Filippov } 575342407fdSMax Filippov } 576342407fdSMax Filippov 577342407fdSMax Filippov static void open_eth_int_source_host_write(OpenEthState *s, uint32_t val) 578342407fdSMax Filippov { 579342407fdSMax Filippov uint32_t old = s->regs[INT_SOURCE]; 580342407fdSMax Filippov 581342407fdSMax Filippov s->regs[INT_SOURCE] &= ~val; 582342407fdSMax Filippov open_eth_update_irq(s, old & s->regs[INT_MASK], 583342407fdSMax Filippov s->regs[INT_SOURCE] & s->regs[INT_MASK]); 584342407fdSMax Filippov } 585342407fdSMax Filippov 586342407fdSMax Filippov static void open_eth_int_mask_host_write(OpenEthState *s, uint32_t val) 587342407fdSMax Filippov { 588342407fdSMax Filippov uint32_t old = s->regs[INT_MASK]; 589342407fdSMax Filippov 590342407fdSMax Filippov s->regs[INT_MASK] = val; 591342407fdSMax Filippov open_eth_update_irq(s, s->regs[INT_SOURCE] & old, 592342407fdSMax Filippov s->regs[INT_SOURCE] & s->regs[INT_MASK]); 593342407fdSMax Filippov } 594342407fdSMax Filippov 595342407fdSMax Filippov static void open_eth_mii_command_host_write(OpenEthState *s, uint32_t val) 596342407fdSMax Filippov { 597342407fdSMax Filippov unsigned fiad = GET_REGFIELD(s, MIIADDRESS, FIAD); 598342407fdSMax Filippov unsigned rgad = GET_REGFIELD(s, MIIADDRESS, RGAD); 599342407fdSMax Filippov 600342407fdSMax Filippov if (val & MIICOMMAND_WCTRLDATA) { 601342407fdSMax Filippov if (fiad == DEFAULT_PHY) { 602342407fdSMax Filippov mii_write_host(&s->mii, rgad, 603342407fdSMax Filippov GET_REGFIELD(s, MIITX_DATA, CTRLDATA)); 604342407fdSMax Filippov } 605342407fdSMax Filippov } 606342407fdSMax Filippov if (val & MIICOMMAND_RSTAT) { 607342407fdSMax Filippov if (fiad == DEFAULT_PHY) { 608342407fdSMax Filippov SET_REGFIELD(s, MIIRX_DATA, PRSD, 609342407fdSMax Filippov mii_read_host(&s->mii, rgad)); 610342407fdSMax Filippov } else { 611342407fdSMax Filippov s->regs[MIIRX_DATA] = 0xffff; 612342407fdSMax Filippov } 613b356f76dSJason Wang SET_REGFIELD(s, MIISTATUS, LINKFAIL, qemu_get_queue(s->nic)->link_down); 614342407fdSMax Filippov } 615342407fdSMax Filippov } 616342407fdSMax Filippov 617342407fdSMax Filippov static void open_eth_mii_tx_host_write(OpenEthState *s, uint32_t val) 618342407fdSMax Filippov { 619342407fdSMax Filippov SET_REGFIELD(s, MIITX_DATA, CTRLDATA, val); 620342407fdSMax Filippov if (GET_REGFIELD(s, MIIADDRESS, FIAD) == DEFAULT_PHY) { 621342407fdSMax Filippov mii_write_host(&s->mii, GET_REGFIELD(s, MIIADDRESS, RGAD), 622342407fdSMax Filippov GET_REGFIELD(s, MIITX_DATA, CTRLDATA)); 623342407fdSMax Filippov } 624342407fdSMax Filippov } 625342407fdSMax Filippov 626342407fdSMax Filippov static void open_eth_reg_write(void *opaque, 627a8170e5eSAvi Kivity hwaddr addr, uint64_t val, unsigned int size) 628342407fdSMax Filippov { 629342407fdSMax Filippov static void (*reg_write[REG_MAX])(OpenEthState *s, uint32_t val) = { 630342407fdSMax Filippov [MODER] = open_eth_moder_host_write, 631342407fdSMax Filippov [INT_SOURCE] = open_eth_int_source_host_write, 632342407fdSMax Filippov [INT_MASK] = open_eth_int_mask_host_write, 633342407fdSMax Filippov [MIICOMMAND] = open_eth_mii_command_host_write, 634342407fdSMax Filippov [MIITX_DATA] = open_eth_mii_tx_host_write, 635342407fdSMax Filippov [MIISTATUS] = open_eth_ro, 636342407fdSMax Filippov }; 637342407fdSMax Filippov OpenEthState *s = opaque; 638342407fdSMax Filippov unsigned idx = addr / 4; 639342407fdSMax Filippov 640342407fdSMax Filippov if (idx < REG_MAX) { 641342407fdSMax Filippov trace_open_eth_reg_write((uint32_t)addr, (uint32_t)val); 642342407fdSMax Filippov if (reg_write[idx]) { 643342407fdSMax Filippov reg_write[idx](s, val); 644342407fdSMax Filippov } else { 645342407fdSMax Filippov s->regs[idx] = val; 646342407fdSMax Filippov } 647342407fdSMax Filippov } 648342407fdSMax Filippov } 649342407fdSMax Filippov 650342407fdSMax Filippov static uint64_t open_eth_desc_read(void *opaque, 651a8170e5eSAvi Kivity hwaddr addr, unsigned int size) 652342407fdSMax Filippov { 653342407fdSMax Filippov OpenEthState *s = opaque; 654342407fdSMax Filippov uint64_t v = 0; 655342407fdSMax Filippov 656342407fdSMax Filippov addr &= 0x3ff; 657342407fdSMax Filippov memcpy(&v, (uint8_t *)s->desc + addr, size); 658342407fdSMax Filippov trace_open_eth_desc_read((uint32_t)addr, (uint32_t)v); 659342407fdSMax Filippov return v; 660342407fdSMax Filippov } 661342407fdSMax Filippov 662342407fdSMax Filippov static void open_eth_desc_write(void *opaque, 663a8170e5eSAvi Kivity hwaddr addr, uint64_t val, unsigned int size) 664342407fdSMax Filippov { 665342407fdSMax Filippov OpenEthState *s = opaque; 666342407fdSMax Filippov 667342407fdSMax Filippov addr &= 0x3ff; 668342407fdSMax Filippov trace_open_eth_desc_write((uint32_t)addr, (uint32_t)val); 669342407fdSMax Filippov memcpy((uint8_t *)s->desc + addr, &val, size); 670342407fdSMax Filippov open_eth_check_start_xmit(s); 671342407fdSMax Filippov } 672342407fdSMax Filippov 673342407fdSMax Filippov 674a348f108SStefan Weil static const MemoryRegionOps open_eth_reg_ops = { 675342407fdSMax Filippov .read = open_eth_reg_read, 676342407fdSMax Filippov .write = open_eth_reg_write, 677342407fdSMax Filippov }; 678342407fdSMax Filippov 679a348f108SStefan Weil static const MemoryRegionOps open_eth_desc_ops = { 680342407fdSMax Filippov .read = open_eth_desc_read, 681342407fdSMax Filippov .write = open_eth_desc_write, 682342407fdSMax Filippov }; 683342407fdSMax Filippov 684*4632cf2dSAndreas Färber static int sysbus_open_eth_init(SysBusDevice *sbd) 685342407fdSMax Filippov { 686*4632cf2dSAndreas Färber DeviceState *dev = DEVICE(sbd); 687*4632cf2dSAndreas Färber OpenEthState *s = OPEN_ETH(dev); 688342407fdSMax Filippov 689eedfac6fSPaolo Bonzini memory_region_init_io(&s->reg_io, OBJECT(dev), &open_eth_reg_ops, s, 690342407fdSMax Filippov "open_eth.regs", 0x54); 691*4632cf2dSAndreas Färber sysbus_init_mmio(sbd, &s->reg_io); 692342407fdSMax Filippov 693eedfac6fSPaolo Bonzini memory_region_init_io(&s->desc_io, OBJECT(dev), &open_eth_desc_ops, s, 694342407fdSMax Filippov "open_eth.desc", 0x400); 695*4632cf2dSAndreas Färber sysbus_init_mmio(sbd, &s->desc_io); 696342407fdSMax Filippov 697*4632cf2dSAndreas Färber sysbus_init_irq(sbd, &s->irq); 698342407fdSMax Filippov 699342407fdSMax Filippov s->nic = qemu_new_nic(&net_open_eth_info, &s->conf, 700*4632cf2dSAndreas Färber object_get_typename(OBJECT(s)), dev->id, s); 701342407fdSMax Filippov return 0; 702342407fdSMax Filippov } 703342407fdSMax Filippov 704342407fdSMax Filippov static void qdev_open_eth_reset(DeviceState *dev) 705342407fdSMax Filippov { 706*4632cf2dSAndreas Färber OpenEthState *d = OPEN_ETH(dev); 707*4632cf2dSAndreas Färber 708342407fdSMax Filippov open_eth_reset(d); 709342407fdSMax Filippov } 710342407fdSMax Filippov 711999e12bbSAnthony Liguori static Property open_eth_properties[] = { 712342407fdSMax Filippov DEFINE_NIC_PROPERTIES(OpenEthState, conf), 713342407fdSMax Filippov DEFINE_PROP_END_OF_LIST(), 714999e12bbSAnthony Liguori }; 715999e12bbSAnthony Liguori 716999e12bbSAnthony Liguori static void open_eth_class_init(ObjectClass *klass, void *data) 717999e12bbSAnthony Liguori { 71839bffca2SAnthony Liguori DeviceClass *dc = DEVICE_CLASS(klass); 719999e12bbSAnthony Liguori SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass); 720999e12bbSAnthony Liguori 721999e12bbSAnthony Liguori k->init = sysbus_open_eth_init; 722125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_NETWORK, dc->categories); 72339bffca2SAnthony Liguori dc->desc = "Opencores 10/100 Mbit Ethernet"; 72439bffca2SAnthony Liguori dc->reset = qdev_open_eth_reset; 72539bffca2SAnthony Liguori dc->props = open_eth_properties; 726342407fdSMax Filippov } 727999e12bbSAnthony Liguori 7288c43a6f0SAndreas Färber static const TypeInfo open_eth_info = { 729*4632cf2dSAndreas Färber .name = TYPE_OPEN_ETH, 73039bffca2SAnthony Liguori .parent = TYPE_SYS_BUS_DEVICE, 73139bffca2SAnthony Liguori .instance_size = sizeof(OpenEthState), 732999e12bbSAnthony Liguori .class_init = open_eth_class_init, 733342407fdSMax Filippov }; 734342407fdSMax Filippov 73583f7d43aSAndreas Färber static void open_eth_register_types(void) 736342407fdSMax Filippov { 73739bffca2SAnthony Liguori type_register_static(&open_eth_info); 738342407fdSMax Filippov } 739342407fdSMax Filippov 74083f7d43aSAndreas Färber type_init(open_eth_register_types) 741