193f1e401SEdgar E. Iglesias /* 293f1e401SEdgar E. Iglesias * QEMU model of Xilinx AXI-Ethernet. 393f1e401SEdgar E. Iglesias * 493f1e401SEdgar E. Iglesias * Copyright (c) 2011 Edgar E. Iglesias. 593f1e401SEdgar E. Iglesias * 693f1e401SEdgar E. Iglesias * Permission is hereby granted, free of charge, to any person obtaining a copy 793f1e401SEdgar E. Iglesias * of this software and associated documentation files (the "Software"), to deal 893f1e401SEdgar E. Iglesias * in the Software without restriction, including without limitation the rights 993f1e401SEdgar E. Iglesias * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 1093f1e401SEdgar E. Iglesias * copies of the Software, and to permit persons to whom the Software is 1193f1e401SEdgar E. Iglesias * furnished to do so, subject to the following conditions: 1293f1e401SEdgar E. Iglesias * 1393f1e401SEdgar E. Iglesias * The above copyright notice and this permission notice shall be included in 1493f1e401SEdgar E. Iglesias * all copies or substantial portions of the Software. 1593f1e401SEdgar E. Iglesias * 1693f1e401SEdgar E. Iglesias * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 1793f1e401SEdgar E. Iglesias * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 1893f1e401SEdgar E. Iglesias * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 1993f1e401SEdgar E. Iglesias * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 2093f1e401SEdgar E. Iglesias * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 2193f1e401SEdgar E. Iglesias * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 2293f1e401SEdgar E. Iglesias * THE SOFTWARE. 2393f1e401SEdgar E. Iglesias */ 2493f1e401SEdgar E. Iglesias 2583c9f4caSPaolo Bonzini #include "hw/sysbus.h" 261de7afc9SPaolo Bonzini #include "qemu/log.h" 271422e32dSPaolo Bonzini #include "net/net.h" 2893f1e401SEdgar E. Iglesias #include "net/checksum.h" 29b4a42f81SPaolo Bonzini #include "qapi/qmp/qerror.h" 3093f1e401SEdgar E. Iglesias 3183c9f4caSPaolo Bonzini #include "hw/stream.h" 3293f1e401SEdgar E. Iglesias 3393f1e401SEdgar E. Iglesias #define DPHY(x) 3493f1e401SEdgar E. Iglesias 35f0e7a81cSPeter Crosthwaite #define TYPE_XILINX_AXI_ENET "xlnx.axi-ethernet" 36*55b3e0c2SPeter Crosthwaite #define TYPE_XILINX_AXI_ENET_DATA_STREAM "xilinx-axienet-data-stream" 37f0e7a81cSPeter Crosthwaite 38f0e7a81cSPeter Crosthwaite #define XILINX_AXI_ENET(obj) \ 39f0e7a81cSPeter Crosthwaite OBJECT_CHECK(XilinxAXIEnet, (obj), TYPE_XILINX_AXI_ENET) 40f0e7a81cSPeter Crosthwaite 41*55b3e0c2SPeter Crosthwaite #define XILINX_AXI_ENET_DATA_STREAM(obj) \ 42*55b3e0c2SPeter Crosthwaite OBJECT_CHECK(XilinxAXIEnetStreamSlave, (obj),\ 43*55b3e0c2SPeter Crosthwaite TYPE_XILINX_AXI_ENET_DATA_STREAM) 44*55b3e0c2SPeter Crosthwaite 4593f1e401SEdgar E. Iglesias /* Advertisement control register. */ 4693f1e401SEdgar E. Iglesias #define ADVERTISE_10HALF 0x0020 /* Try for 10mbps half-duplex */ 4793f1e401SEdgar E. Iglesias #define ADVERTISE_10FULL 0x0040 /* Try for 10mbps full-duplex */ 4893f1e401SEdgar E. Iglesias #define ADVERTISE_100HALF 0x0080 /* Try for 100mbps half-duplex */ 4993f1e401SEdgar E. Iglesias #define ADVERTISE_100FULL 0x0100 /* Try for 100mbps full-duplex */ 5093f1e401SEdgar E. Iglesias 5193f1e401SEdgar E. Iglesias struct PHY { 5293f1e401SEdgar E. Iglesias uint32_t regs[32]; 5393f1e401SEdgar E. Iglesias 5493f1e401SEdgar E. Iglesias int link; 5593f1e401SEdgar E. Iglesias 5693f1e401SEdgar E. Iglesias unsigned int (*read)(struct PHY *phy, unsigned int req); 5793f1e401SEdgar E. Iglesias void (*write)(struct PHY *phy, unsigned int req, 5893f1e401SEdgar E. Iglesias unsigned int data); 5993f1e401SEdgar E. Iglesias }; 6093f1e401SEdgar E. Iglesias 6193f1e401SEdgar E. Iglesias static unsigned int tdk_read(struct PHY *phy, unsigned int req) 6293f1e401SEdgar E. Iglesias { 6393f1e401SEdgar E. Iglesias int regnum; 6493f1e401SEdgar E. Iglesias unsigned r = 0; 6593f1e401SEdgar E. Iglesias 6693f1e401SEdgar E. Iglesias regnum = req & 0x1f; 6793f1e401SEdgar E. Iglesias 6893f1e401SEdgar E. Iglesias switch (regnum) { 6993f1e401SEdgar E. Iglesias case 1: 7093f1e401SEdgar E. Iglesias if (!phy->link) { 7193f1e401SEdgar E. Iglesias break; 7293f1e401SEdgar E. Iglesias } 7393f1e401SEdgar E. Iglesias /* MR1. */ 7493f1e401SEdgar E. Iglesias /* Speeds and modes. */ 7593f1e401SEdgar E. Iglesias r |= (1 << 13) | (1 << 14); 7693f1e401SEdgar E. Iglesias r |= (1 << 11) | (1 << 12); 7793f1e401SEdgar E. Iglesias r |= (1 << 5); /* Autoneg complete. */ 7893f1e401SEdgar E. Iglesias r |= (1 << 3); /* Autoneg able. */ 7993f1e401SEdgar E. Iglesias r |= (1 << 2); /* link. */ 8093f1e401SEdgar E. Iglesias r |= (1 << 1); /* link. */ 8193f1e401SEdgar E. Iglesias break; 8293f1e401SEdgar E. Iglesias case 5: 8393f1e401SEdgar E. Iglesias /* Link partner ability. 8493f1e401SEdgar E. Iglesias We are kind; always agree with whatever best mode 8593f1e401SEdgar E. Iglesias the guest advertises. */ 8693f1e401SEdgar E. Iglesias r = 1 << 14; /* Success. */ 8793f1e401SEdgar E. Iglesias /* Copy advertised modes. */ 8893f1e401SEdgar E. Iglesias r |= phy->regs[4] & (15 << 5); 8993f1e401SEdgar E. Iglesias /* Autoneg support. */ 9093f1e401SEdgar E. Iglesias r |= 1; 9193f1e401SEdgar E. Iglesias break; 9293f1e401SEdgar E. Iglesias case 17: 9393f1e401SEdgar E. Iglesias /* Marvel PHY on many xilinx boards. */ 9493f1e401SEdgar E. Iglesias r = 0x8000; /* 1000Mb */ 9593f1e401SEdgar E. Iglesias break; 9693f1e401SEdgar E. Iglesias case 18: 9793f1e401SEdgar E. Iglesias { 9893f1e401SEdgar E. Iglesias /* Diagnostics reg. */ 9993f1e401SEdgar E. Iglesias int duplex = 0; 10093f1e401SEdgar E. Iglesias int speed_100 = 0; 10193f1e401SEdgar E. Iglesias 10293f1e401SEdgar E. Iglesias if (!phy->link) { 10393f1e401SEdgar E. Iglesias break; 10493f1e401SEdgar E. Iglesias } 10593f1e401SEdgar E. Iglesias 10693f1e401SEdgar E. Iglesias /* Are we advertising 100 half or 100 duplex ? */ 10793f1e401SEdgar E. Iglesias speed_100 = !!(phy->regs[4] & ADVERTISE_100HALF); 10893f1e401SEdgar E. Iglesias speed_100 |= !!(phy->regs[4] & ADVERTISE_100FULL); 10993f1e401SEdgar E. Iglesias 11093f1e401SEdgar E. Iglesias /* Are we advertising 10 duplex or 100 duplex ? */ 11193f1e401SEdgar E. Iglesias duplex = !!(phy->regs[4] & ADVERTISE_100FULL); 11293f1e401SEdgar E. Iglesias duplex |= !!(phy->regs[4] & ADVERTISE_10FULL); 11393f1e401SEdgar E. Iglesias r = (speed_100 << 10) | (duplex << 11); 11493f1e401SEdgar E. Iglesias } 11593f1e401SEdgar E. Iglesias break; 11693f1e401SEdgar E. Iglesias 11793f1e401SEdgar E. Iglesias default: 11893f1e401SEdgar E. Iglesias r = phy->regs[regnum]; 11993f1e401SEdgar E. Iglesias break; 12093f1e401SEdgar E. Iglesias } 12193f1e401SEdgar E. Iglesias DPHY(qemu_log("\n%s %x = reg[%d]\n", __func__, r, regnum)); 12293f1e401SEdgar E. Iglesias return r; 12393f1e401SEdgar E. Iglesias } 12493f1e401SEdgar E. Iglesias 12593f1e401SEdgar E. Iglesias static void 12693f1e401SEdgar E. Iglesias tdk_write(struct PHY *phy, unsigned int req, unsigned int data) 12793f1e401SEdgar E. Iglesias { 12893f1e401SEdgar E. Iglesias int regnum; 12993f1e401SEdgar E. Iglesias 13093f1e401SEdgar E. Iglesias regnum = req & 0x1f; 13193f1e401SEdgar E. Iglesias DPHY(qemu_log("%s reg[%d] = %x\n", __func__, regnum, data)); 13293f1e401SEdgar E. Iglesias switch (regnum) { 13393f1e401SEdgar E. Iglesias default: 13493f1e401SEdgar E. Iglesias phy->regs[regnum] = data; 13593f1e401SEdgar E. Iglesias break; 13693f1e401SEdgar E. Iglesias } 13793f1e401SEdgar E. Iglesias } 13893f1e401SEdgar E. Iglesias 13993f1e401SEdgar E. Iglesias static void 14093f1e401SEdgar E. Iglesias tdk_init(struct PHY *phy) 14193f1e401SEdgar E. Iglesias { 14293f1e401SEdgar E. Iglesias phy->regs[0] = 0x3100; 14393f1e401SEdgar E. Iglesias /* PHY Id. */ 14493f1e401SEdgar E. Iglesias phy->regs[2] = 0x0300; 14593f1e401SEdgar E. Iglesias phy->regs[3] = 0xe400; 14693f1e401SEdgar E. Iglesias /* Autonegotiation advertisement reg. */ 14793f1e401SEdgar E. Iglesias phy->regs[4] = 0x01E1; 14893f1e401SEdgar E. Iglesias phy->link = 1; 14993f1e401SEdgar E. Iglesias 15093f1e401SEdgar E. Iglesias phy->read = tdk_read; 15193f1e401SEdgar E. Iglesias phy->write = tdk_write; 15293f1e401SEdgar E. Iglesias } 15393f1e401SEdgar E. Iglesias 15493f1e401SEdgar E. Iglesias struct MDIOBus { 15593f1e401SEdgar E. Iglesias /* bus. */ 15693f1e401SEdgar E. Iglesias int mdc; 15793f1e401SEdgar E. Iglesias int mdio; 15893f1e401SEdgar E. Iglesias 15993f1e401SEdgar E. Iglesias /* decoder. */ 16093f1e401SEdgar E. Iglesias enum { 16193f1e401SEdgar E. Iglesias PREAMBLE, 16293f1e401SEdgar E. Iglesias SOF, 16393f1e401SEdgar E. Iglesias OPC, 16493f1e401SEdgar E. Iglesias ADDR, 16593f1e401SEdgar E. Iglesias REQ, 16693f1e401SEdgar E. Iglesias TURNAROUND, 16793f1e401SEdgar E. Iglesias DATA 16893f1e401SEdgar E. Iglesias } state; 16993f1e401SEdgar E. Iglesias unsigned int drive; 17093f1e401SEdgar E. Iglesias 17193f1e401SEdgar E. Iglesias unsigned int cnt; 17293f1e401SEdgar E. Iglesias unsigned int addr; 17393f1e401SEdgar E. Iglesias unsigned int opc; 17493f1e401SEdgar E. Iglesias unsigned int req; 17593f1e401SEdgar E. Iglesias unsigned int data; 17693f1e401SEdgar E. Iglesias 17793f1e401SEdgar E. Iglesias struct PHY *devs[32]; 17893f1e401SEdgar E. Iglesias }; 17993f1e401SEdgar E. Iglesias 18093f1e401SEdgar E. Iglesias static void 18193f1e401SEdgar E. Iglesias mdio_attach(struct MDIOBus *bus, struct PHY *phy, unsigned int addr) 18293f1e401SEdgar E. Iglesias { 18393f1e401SEdgar E. Iglesias bus->devs[addr & 0x1f] = phy; 18493f1e401SEdgar E. Iglesias } 18593f1e401SEdgar E. Iglesias 18693f1e401SEdgar E. Iglesias #ifdef USE_THIS_DEAD_CODE 18793f1e401SEdgar E. Iglesias static void 18893f1e401SEdgar E. Iglesias mdio_detach(struct MDIOBus *bus, struct PHY *phy, unsigned int addr) 18993f1e401SEdgar E. Iglesias { 19093f1e401SEdgar E. Iglesias bus->devs[addr & 0x1f] = NULL; 19193f1e401SEdgar E. Iglesias } 19293f1e401SEdgar E. Iglesias #endif 19393f1e401SEdgar E. Iglesias 19493f1e401SEdgar E. Iglesias static uint16_t mdio_read_req(struct MDIOBus *bus, unsigned int addr, 19593f1e401SEdgar E. Iglesias unsigned int reg) 19693f1e401SEdgar E. Iglesias { 19793f1e401SEdgar E. Iglesias struct PHY *phy; 19893f1e401SEdgar E. Iglesias uint16_t data; 19993f1e401SEdgar E. Iglesias 20093f1e401SEdgar E. Iglesias phy = bus->devs[addr]; 20193f1e401SEdgar E. Iglesias if (phy && phy->read) { 20293f1e401SEdgar E. Iglesias data = phy->read(phy, reg); 20393f1e401SEdgar E. Iglesias } else { 20493f1e401SEdgar E. Iglesias data = 0xffff; 20593f1e401SEdgar E. Iglesias } 20693f1e401SEdgar E. Iglesias DPHY(qemu_log("%s addr=%d reg=%d data=%x\n", __func__, addr, reg, data)); 20793f1e401SEdgar E. Iglesias return data; 20893f1e401SEdgar E. Iglesias } 20993f1e401SEdgar E. Iglesias 21093f1e401SEdgar E. Iglesias static void mdio_write_req(struct MDIOBus *bus, unsigned int addr, 21193f1e401SEdgar E. Iglesias unsigned int reg, uint16_t data) 21293f1e401SEdgar E. Iglesias { 21393f1e401SEdgar E. Iglesias struct PHY *phy; 21493f1e401SEdgar E. Iglesias 21593f1e401SEdgar E. Iglesias DPHY(qemu_log("%s addr=%d reg=%d data=%x\n", __func__, addr, reg, data)); 21693f1e401SEdgar E. Iglesias phy = bus->devs[addr]; 21793f1e401SEdgar E. Iglesias if (phy && phy->write) { 21893f1e401SEdgar E. Iglesias phy->write(phy, reg, data); 21993f1e401SEdgar E. Iglesias } 22093f1e401SEdgar E. Iglesias } 22193f1e401SEdgar E. Iglesias 22293f1e401SEdgar E. Iglesias #define DENET(x) 22393f1e401SEdgar E. Iglesias 22493f1e401SEdgar E. Iglesias #define R_RAF (0x000 / 4) 22593f1e401SEdgar E. Iglesias enum { 22693f1e401SEdgar E. Iglesias RAF_MCAST_REJ = (1 << 1), 22793f1e401SEdgar E. Iglesias RAF_BCAST_REJ = (1 << 2), 22893f1e401SEdgar E. Iglesias RAF_EMCF_EN = (1 << 12), 22993f1e401SEdgar E. Iglesias RAF_NEWFUNC_EN = (1 << 11) 23093f1e401SEdgar E. Iglesias }; 23193f1e401SEdgar E. Iglesias 23293f1e401SEdgar E. Iglesias #define R_IS (0x00C / 4) 23393f1e401SEdgar E. Iglesias enum { 23493f1e401SEdgar E. Iglesias IS_HARD_ACCESS_COMPLETE = 1, 23593f1e401SEdgar E. Iglesias IS_AUTONEG = (1 << 1), 23693f1e401SEdgar E. Iglesias IS_RX_COMPLETE = (1 << 2), 23793f1e401SEdgar E. Iglesias IS_RX_REJECT = (1 << 3), 23893f1e401SEdgar E. Iglesias IS_TX_COMPLETE = (1 << 5), 23993f1e401SEdgar E. Iglesias IS_RX_DCM_LOCK = (1 << 6), 24093f1e401SEdgar E. Iglesias IS_MGM_RDY = (1 << 7), 24193f1e401SEdgar E. Iglesias IS_PHY_RST_DONE = (1 << 8), 24293f1e401SEdgar E. Iglesias }; 24393f1e401SEdgar E. Iglesias 24493f1e401SEdgar E. Iglesias #define R_IP (0x010 / 4) 24593f1e401SEdgar E. Iglesias #define R_IE (0x014 / 4) 24693f1e401SEdgar E. Iglesias #define R_UAWL (0x020 / 4) 24793f1e401SEdgar E. Iglesias #define R_UAWU (0x024 / 4) 24893f1e401SEdgar E. Iglesias #define R_PPST (0x030 / 4) 24993f1e401SEdgar E. Iglesias enum { 25093f1e401SEdgar E. Iglesias PPST_LINKSTATUS = (1 << 0), 25193f1e401SEdgar E. Iglesias PPST_PHY_LINKSTATUS = (1 << 7), 25293f1e401SEdgar E. Iglesias }; 25393f1e401SEdgar E. Iglesias 25493f1e401SEdgar E. Iglesias #define R_STATS_RX_BYTESL (0x200 / 4) 25593f1e401SEdgar E. Iglesias #define R_STATS_RX_BYTESH (0x204 / 4) 25693f1e401SEdgar E. Iglesias #define R_STATS_TX_BYTESL (0x208 / 4) 25793f1e401SEdgar E. Iglesias #define R_STATS_TX_BYTESH (0x20C / 4) 25893f1e401SEdgar E. Iglesias #define R_STATS_RXL (0x290 / 4) 25993f1e401SEdgar E. Iglesias #define R_STATS_RXH (0x294 / 4) 26093f1e401SEdgar E. Iglesias #define R_STATS_RX_BCASTL (0x2a0 / 4) 26193f1e401SEdgar E. Iglesias #define R_STATS_RX_BCASTH (0x2a4 / 4) 26293f1e401SEdgar E. Iglesias #define R_STATS_RX_MCASTL (0x2a8 / 4) 26393f1e401SEdgar E. Iglesias #define R_STATS_RX_MCASTH (0x2ac / 4) 26493f1e401SEdgar E. Iglesias 26593f1e401SEdgar E. Iglesias #define R_RCW0 (0x400 / 4) 26693f1e401SEdgar E. Iglesias #define R_RCW1 (0x404 / 4) 26793f1e401SEdgar E. Iglesias enum { 26893f1e401SEdgar E. Iglesias RCW1_VLAN = (1 << 27), 26993f1e401SEdgar E. Iglesias RCW1_RX = (1 << 28), 27093f1e401SEdgar E. Iglesias RCW1_FCS = (1 << 29), 27193f1e401SEdgar E. Iglesias RCW1_JUM = (1 << 30), 27293f1e401SEdgar E. Iglesias RCW1_RST = (1 << 31), 27393f1e401SEdgar E. Iglesias }; 27493f1e401SEdgar E. Iglesias 27593f1e401SEdgar E. Iglesias #define R_TC (0x408 / 4) 27693f1e401SEdgar E. Iglesias enum { 27793f1e401SEdgar E. Iglesias TC_VLAN = (1 << 27), 27893f1e401SEdgar E. Iglesias TC_TX = (1 << 28), 27993f1e401SEdgar E. Iglesias TC_FCS = (1 << 29), 28093f1e401SEdgar E. Iglesias TC_JUM = (1 << 30), 28193f1e401SEdgar E. Iglesias TC_RST = (1 << 31), 28293f1e401SEdgar E. Iglesias }; 28393f1e401SEdgar E. Iglesias 28493f1e401SEdgar E. Iglesias #define R_EMMC (0x410 / 4) 28593f1e401SEdgar E. Iglesias enum { 28693f1e401SEdgar E. Iglesias EMMC_LINKSPEED_10MB = (0 << 30), 28793f1e401SEdgar E. Iglesias EMMC_LINKSPEED_100MB = (1 << 30), 28893f1e401SEdgar E. Iglesias EMMC_LINKSPEED_1000MB = (2 << 30), 28993f1e401SEdgar E. Iglesias }; 29093f1e401SEdgar E. Iglesias 29193f1e401SEdgar E. Iglesias #define R_PHYC (0x414 / 4) 29293f1e401SEdgar E. Iglesias 29393f1e401SEdgar E. Iglesias #define R_MC (0x500 / 4) 29493f1e401SEdgar E. Iglesias #define MC_EN (1 << 6) 29593f1e401SEdgar E. Iglesias 29693f1e401SEdgar E. Iglesias #define R_MCR (0x504 / 4) 29793f1e401SEdgar E. Iglesias #define R_MWD (0x508 / 4) 29893f1e401SEdgar E. Iglesias #define R_MRD (0x50c / 4) 29993f1e401SEdgar E. Iglesias #define R_MIS (0x600 / 4) 30093f1e401SEdgar E. Iglesias #define R_MIP (0x620 / 4) 30193f1e401SEdgar E. Iglesias #define R_MIE (0x640 / 4) 30293f1e401SEdgar E. Iglesias #define R_MIC (0x640 / 4) 30393f1e401SEdgar E. Iglesias 30493f1e401SEdgar E. Iglesias #define R_UAW0 (0x700 / 4) 30593f1e401SEdgar E. Iglesias #define R_UAW1 (0x704 / 4) 30693f1e401SEdgar E. Iglesias #define R_FMI (0x708 / 4) 30793f1e401SEdgar E. Iglesias #define R_AF0 (0x710 / 4) 30893f1e401SEdgar E. Iglesias #define R_AF1 (0x714 / 4) 30993f1e401SEdgar E. Iglesias #define R_MAX (0x34 / 4) 31093f1e401SEdgar E. Iglesias 31193f1e401SEdgar E. Iglesias /* Indirect registers. */ 31293f1e401SEdgar E. Iglesias struct TEMAC { 31393f1e401SEdgar E. Iglesias struct MDIOBus mdio_bus; 31493f1e401SEdgar E. Iglesias struct PHY phy; 31593f1e401SEdgar E. Iglesias 31693f1e401SEdgar E. Iglesias void *parent; 31793f1e401SEdgar E. Iglesias }; 31893f1e401SEdgar E. Iglesias 319*55b3e0c2SPeter Crosthwaite typedef struct XilinxAXIEnetStreamSlave XilinxAXIEnetStreamSlave; 320545129e5SPeter Crosthwaite typedef struct XilinxAXIEnet XilinxAXIEnet; 321545129e5SPeter Crosthwaite 322*55b3e0c2SPeter Crosthwaite struct XilinxAXIEnetStreamSlave { 323*55b3e0c2SPeter Crosthwaite Object parent; 324*55b3e0c2SPeter Crosthwaite 325*55b3e0c2SPeter Crosthwaite struct XilinxAXIEnet *enet; 326*55b3e0c2SPeter Crosthwaite } ; 327*55b3e0c2SPeter Crosthwaite 32893f1e401SEdgar E. Iglesias struct XilinxAXIEnet { 32993f1e401SEdgar E. Iglesias SysBusDevice busdev; 3300dc31f3bSAvi Kivity MemoryRegion iomem; 33193f1e401SEdgar E. Iglesias qemu_irq irq; 332669b4983SPeter A. G. Crosthwaite StreamSlave *tx_dev; 333*55b3e0c2SPeter Crosthwaite XilinxAXIEnetStreamSlave rx_data_dev; 33493f1e401SEdgar E. Iglesias NICState *nic; 33593f1e401SEdgar E. Iglesias NICConf conf; 33693f1e401SEdgar E. Iglesias 33793f1e401SEdgar E. Iglesias 33893f1e401SEdgar E. Iglesias uint32_t c_rxmem; 33993f1e401SEdgar E. Iglesias uint32_t c_txmem; 34093f1e401SEdgar E. Iglesias uint32_t c_phyaddr; 34193f1e401SEdgar E. Iglesias 34293f1e401SEdgar E. Iglesias struct TEMAC TEMAC; 34393f1e401SEdgar E. Iglesias 34493f1e401SEdgar E. Iglesias /* MII regs. */ 34593f1e401SEdgar E. Iglesias union { 34693f1e401SEdgar E. Iglesias uint32_t regs[4]; 34793f1e401SEdgar E. Iglesias struct { 34893f1e401SEdgar E. Iglesias uint32_t mc; 34993f1e401SEdgar E. Iglesias uint32_t mcr; 35093f1e401SEdgar E. Iglesias uint32_t mwd; 35193f1e401SEdgar E. Iglesias uint32_t mrd; 35293f1e401SEdgar E. Iglesias }; 35393f1e401SEdgar E. Iglesias } mii; 35493f1e401SEdgar E. Iglesias 35593f1e401SEdgar E. Iglesias struct { 35693f1e401SEdgar E. Iglesias uint64_t rx_bytes; 35793f1e401SEdgar E. Iglesias uint64_t tx_bytes; 35893f1e401SEdgar E. Iglesias 35993f1e401SEdgar E. Iglesias uint64_t rx; 36093f1e401SEdgar E. Iglesias uint64_t rx_bcast; 36193f1e401SEdgar E. Iglesias uint64_t rx_mcast; 36293f1e401SEdgar E. Iglesias } stats; 36393f1e401SEdgar E. Iglesias 36493f1e401SEdgar E. Iglesias /* Receive configuration words. */ 36593f1e401SEdgar E. Iglesias uint32_t rcw[2]; 36693f1e401SEdgar E. Iglesias /* Transmit config. */ 36793f1e401SEdgar E. Iglesias uint32_t tc; 36893f1e401SEdgar E. Iglesias uint32_t emmc; 36993f1e401SEdgar E. Iglesias uint32_t phyc; 37093f1e401SEdgar E. Iglesias 37193f1e401SEdgar E. Iglesias /* Unicast Address Word. */ 37293f1e401SEdgar E. Iglesias uint32_t uaw[2]; 37393f1e401SEdgar E. Iglesias /* Unicast address filter used with extended mcast. */ 37493f1e401SEdgar E. Iglesias uint32_t ext_uaw[2]; 37593f1e401SEdgar E. Iglesias uint32_t fmi; 37693f1e401SEdgar E. Iglesias 37793f1e401SEdgar E. Iglesias uint32_t regs[R_MAX]; 37893f1e401SEdgar E. Iglesias 37993f1e401SEdgar E. Iglesias /* Multicast filter addrs. */ 38093f1e401SEdgar E. Iglesias uint32_t maddr[4][2]; 38193f1e401SEdgar E. Iglesias /* 32K x 1 lookup filter. */ 38293f1e401SEdgar E. Iglesias uint32_t ext_mtable[1024]; 38393f1e401SEdgar E. Iglesias 38493f1e401SEdgar E. Iglesias 38593f1e401SEdgar E. Iglesias uint8_t *rxmem; 38693f1e401SEdgar E. Iglesias }; 38793f1e401SEdgar E. Iglesias 388545129e5SPeter Crosthwaite static void axienet_rx_reset(XilinxAXIEnet *s) 38993f1e401SEdgar E. Iglesias { 39093f1e401SEdgar E. Iglesias s->rcw[1] = RCW1_JUM | RCW1_FCS | RCW1_RX | RCW1_VLAN; 39193f1e401SEdgar E. Iglesias } 39293f1e401SEdgar E. Iglesias 393545129e5SPeter Crosthwaite static void axienet_tx_reset(XilinxAXIEnet *s) 39493f1e401SEdgar E. Iglesias { 39593f1e401SEdgar E. Iglesias s->tc = TC_JUM | TC_TX | TC_VLAN; 39693f1e401SEdgar E. Iglesias } 39793f1e401SEdgar E. Iglesias 398545129e5SPeter Crosthwaite static inline int axienet_rx_resetting(XilinxAXIEnet *s) 39993f1e401SEdgar E. Iglesias { 40093f1e401SEdgar E. Iglesias return s->rcw[1] & RCW1_RST; 40193f1e401SEdgar E. Iglesias } 40293f1e401SEdgar E. Iglesias 403545129e5SPeter Crosthwaite static inline int axienet_rx_enabled(XilinxAXIEnet *s) 40493f1e401SEdgar E. Iglesias { 40593f1e401SEdgar E. Iglesias return s->rcw[1] & RCW1_RX; 40693f1e401SEdgar E. Iglesias } 40793f1e401SEdgar E. Iglesias 408545129e5SPeter Crosthwaite static inline int axienet_extmcf_enabled(XilinxAXIEnet *s) 40993f1e401SEdgar E. Iglesias { 41093f1e401SEdgar E. Iglesias return !!(s->regs[R_RAF] & RAF_EMCF_EN); 41193f1e401SEdgar E. Iglesias } 41293f1e401SEdgar E. Iglesias 413545129e5SPeter Crosthwaite static inline int axienet_newfunc_enabled(XilinxAXIEnet *s) 41493f1e401SEdgar E. Iglesias { 41593f1e401SEdgar E. Iglesias return !!(s->regs[R_RAF] & RAF_NEWFUNC_EN); 41693f1e401SEdgar E. Iglesias } 41793f1e401SEdgar E. Iglesias 4189ee0ceb7SPeter Crosthwaite static void xilinx_axienet_reset(DeviceState *d) 41993f1e401SEdgar E. Iglesias { 4209ee0ceb7SPeter Crosthwaite XilinxAXIEnet *s = XILINX_AXI_ENET(d); 4219ee0ceb7SPeter Crosthwaite 42293f1e401SEdgar E. Iglesias axienet_rx_reset(s); 42393f1e401SEdgar E. Iglesias axienet_tx_reset(s); 42493f1e401SEdgar E. Iglesias 42593f1e401SEdgar E. Iglesias s->regs[R_PPST] = PPST_LINKSTATUS | PPST_PHY_LINKSTATUS; 42693f1e401SEdgar E. Iglesias s->regs[R_IS] = IS_AUTONEG | IS_RX_DCM_LOCK | IS_MGM_RDY | IS_PHY_RST_DONE; 42793f1e401SEdgar E. Iglesias 42893f1e401SEdgar E. Iglesias s->emmc = EMMC_LINKSPEED_100MB; 42993f1e401SEdgar E. Iglesias } 43093f1e401SEdgar E. Iglesias 431545129e5SPeter Crosthwaite static void enet_update_irq(XilinxAXIEnet *s) 43293f1e401SEdgar E. Iglesias { 43393f1e401SEdgar E. Iglesias s->regs[R_IP] = s->regs[R_IS] & s->regs[R_IE]; 43493f1e401SEdgar E. Iglesias qemu_set_irq(s->irq, !!s->regs[R_IP]); 43593f1e401SEdgar E. Iglesias } 43693f1e401SEdgar E. Iglesias 437a8170e5eSAvi Kivity static uint64_t enet_read(void *opaque, hwaddr addr, unsigned size) 43893f1e401SEdgar E. Iglesias { 439545129e5SPeter Crosthwaite XilinxAXIEnet *s = opaque; 44093f1e401SEdgar E. Iglesias uint32_t r = 0; 44193f1e401SEdgar E. Iglesias addr >>= 2; 44293f1e401SEdgar E. Iglesias 44393f1e401SEdgar E. Iglesias switch (addr) { 44493f1e401SEdgar E. Iglesias case R_RCW0: 44593f1e401SEdgar E. Iglesias case R_RCW1: 44693f1e401SEdgar E. Iglesias r = s->rcw[addr & 1]; 44793f1e401SEdgar E. Iglesias break; 44893f1e401SEdgar E. Iglesias 44993f1e401SEdgar E. Iglesias case R_TC: 45093f1e401SEdgar E. Iglesias r = s->tc; 45193f1e401SEdgar E. Iglesias break; 45293f1e401SEdgar E. Iglesias 45393f1e401SEdgar E. Iglesias case R_EMMC: 45493f1e401SEdgar E. Iglesias r = s->emmc; 45593f1e401SEdgar E. Iglesias break; 45693f1e401SEdgar E. Iglesias 45793f1e401SEdgar E. Iglesias case R_PHYC: 45893f1e401SEdgar E. Iglesias r = s->phyc; 45993f1e401SEdgar E. Iglesias break; 46093f1e401SEdgar E. Iglesias 46193f1e401SEdgar E. Iglesias case R_MCR: 46293f1e401SEdgar E. Iglesias r = s->mii.regs[addr & 3] | (1 << 7); /* Always ready. */ 46393f1e401SEdgar E. Iglesias break; 46493f1e401SEdgar E. Iglesias 46593f1e401SEdgar E. Iglesias case R_STATS_RX_BYTESL: 46693f1e401SEdgar E. Iglesias case R_STATS_RX_BYTESH: 46793f1e401SEdgar E. Iglesias r = s->stats.rx_bytes >> (32 * (addr & 1)); 46893f1e401SEdgar E. Iglesias break; 46993f1e401SEdgar E. Iglesias 47093f1e401SEdgar E. Iglesias case R_STATS_TX_BYTESL: 47193f1e401SEdgar E. Iglesias case R_STATS_TX_BYTESH: 47293f1e401SEdgar E. Iglesias r = s->stats.tx_bytes >> (32 * (addr & 1)); 47393f1e401SEdgar E. Iglesias break; 47493f1e401SEdgar E. Iglesias 47593f1e401SEdgar E. Iglesias case R_STATS_RXL: 47693f1e401SEdgar E. Iglesias case R_STATS_RXH: 47793f1e401SEdgar E. Iglesias r = s->stats.rx >> (32 * (addr & 1)); 47893f1e401SEdgar E. Iglesias break; 47993f1e401SEdgar E. Iglesias case R_STATS_RX_BCASTL: 48093f1e401SEdgar E. Iglesias case R_STATS_RX_BCASTH: 48193f1e401SEdgar E. Iglesias r = s->stats.rx_bcast >> (32 * (addr & 1)); 48293f1e401SEdgar E. Iglesias break; 48393f1e401SEdgar E. Iglesias case R_STATS_RX_MCASTL: 48493f1e401SEdgar E. Iglesias case R_STATS_RX_MCASTH: 48593f1e401SEdgar E. Iglesias r = s->stats.rx_mcast >> (32 * (addr & 1)); 48693f1e401SEdgar E. Iglesias break; 48793f1e401SEdgar E. Iglesias 48893f1e401SEdgar E. Iglesias case R_MC: 48993f1e401SEdgar E. Iglesias case R_MWD: 49093f1e401SEdgar E. Iglesias case R_MRD: 49193f1e401SEdgar E. Iglesias r = s->mii.regs[addr & 3]; 49293f1e401SEdgar E. Iglesias break; 49393f1e401SEdgar E. Iglesias 49493f1e401SEdgar E. Iglesias case R_UAW0: 49593f1e401SEdgar E. Iglesias case R_UAW1: 49693f1e401SEdgar E. Iglesias r = s->uaw[addr & 1]; 49793f1e401SEdgar E. Iglesias break; 49893f1e401SEdgar E. Iglesias 49993f1e401SEdgar E. Iglesias case R_UAWU: 50093f1e401SEdgar E. Iglesias case R_UAWL: 50193f1e401SEdgar E. Iglesias r = s->ext_uaw[addr & 1]; 50293f1e401SEdgar E. Iglesias break; 50393f1e401SEdgar E. Iglesias 50493f1e401SEdgar E. Iglesias case R_FMI: 50593f1e401SEdgar E. Iglesias r = s->fmi; 50693f1e401SEdgar E. Iglesias break; 50793f1e401SEdgar E. Iglesias 50893f1e401SEdgar E. Iglesias case R_AF0: 50993f1e401SEdgar E. Iglesias case R_AF1: 51093f1e401SEdgar E. Iglesias r = s->maddr[s->fmi & 3][addr & 1]; 51193f1e401SEdgar E. Iglesias break; 51293f1e401SEdgar E. Iglesias 51393f1e401SEdgar E. Iglesias case 0x8000 ... 0x83ff: 51493f1e401SEdgar E. Iglesias r = s->ext_mtable[addr - 0x8000]; 51593f1e401SEdgar E. Iglesias break; 51693f1e401SEdgar E. Iglesias 51793f1e401SEdgar E. Iglesias default: 51893f1e401SEdgar E. Iglesias if (addr < ARRAY_SIZE(s->regs)) { 51993f1e401SEdgar E. Iglesias r = s->regs[addr]; 52093f1e401SEdgar E. Iglesias } 52193f1e401SEdgar E. Iglesias DENET(qemu_log("%s addr=" TARGET_FMT_plx " v=%x\n", 52293f1e401SEdgar E. Iglesias __func__, addr * 4, r)); 52393f1e401SEdgar E. Iglesias break; 52493f1e401SEdgar E. Iglesias } 52593f1e401SEdgar E. Iglesias return r; 52693f1e401SEdgar E. Iglesias } 52793f1e401SEdgar E. Iglesias 528a8170e5eSAvi Kivity static void enet_write(void *opaque, hwaddr addr, 5290dc31f3bSAvi Kivity uint64_t value, unsigned size) 53093f1e401SEdgar E. Iglesias { 531545129e5SPeter Crosthwaite XilinxAXIEnet *s = opaque; 53293f1e401SEdgar E. Iglesias struct TEMAC *t = &s->TEMAC; 53393f1e401SEdgar E. Iglesias 53493f1e401SEdgar E. Iglesias addr >>= 2; 53593f1e401SEdgar E. Iglesias switch (addr) { 53693f1e401SEdgar E. Iglesias case R_RCW0: 53793f1e401SEdgar E. Iglesias case R_RCW1: 53893f1e401SEdgar E. Iglesias s->rcw[addr & 1] = value; 53993f1e401SEdgar E. Iglesias if ((addr & 1) && value & RCW1_RST) { 54093f1e401SEdgar E. Iglesias axienet_rx_reset(s); 5414dbb9ed3SPeter Crosthwaite } else { 5424dbb9ed3SPeter Crosthwaite qemu_flush_queued_packets(qemu_get_queue(s->nic)); 54393f1e401SEdgar E. Iglesias } 54493f1e401SEdgar E. Iglesias break; 54593f1e401SEdgar E. Iglesias 54693f1e401SEdgar E. Iglesias case R_TC: 54793f1e401SEdgar E. Iglesias s->tc = value; 54893f1e401SEdgar E. Iglesias if (value & TC_RST) { 54993f1e401SEdgar E. Iglesias axienet_tx_reset(s); 55093f1e401SEdgar E. Iglesias } 55193f1e401SEdgar E. Iglesias break; 55293f1e401SEdgar E. Iglesias 55393f1e401SEdgar E. Iglesias case R_EMMC: 55493f1e401SEdgar E. Iglesias s->emmc = value; 55593f1e401SEdgar E. Iglesias break; 55693f1e401SEdgar E. Iglesias 55793f1e401SEdgar E. Iglesias case R_PHYC: 55893f1e401SEdgar E. Iglesias s->phyc = value; 55993f1e401SEdgar E. Iglesias break; 56093f1e401SEdgar E. Iglesias 56193f1e401SEdgar E. Iglesias case R_MC: 56293f1e401SEdgar E. Iglesias value &= ((1 < 7) - 1); 56393f1e401SEdgar E. Iglesias 56493f1e401SEdgar E. Iglesias /* Enable the MII. */ 56593f1e401SEdgar E. Iglesias if (value & MC_EN) { 56693f1e401SEdgar E. Iglesias unsigned int miiclkdiv = value & ((1 << 6) - 1); 56793f1e401SEdgar E. Iglesias if (!miiclkdiv) { 56893f1e401SEdgar E. Iglesias qemu_log("AXIENET: MDIO enabled but MDIOCLK is zero!\n"); 56993f1e401SEdgar E. Iglesias } 57093f1e401SEdgar E. Iglesias } 57193f1e401SEdgar E. Iglesias s->mii.mc = value; 57293f1e401SEdgar E. Iglesias break; 57393f1e401SEdgar E. Iglesias 57493f1e401SEdgar E. Iglesias case R_MCR: { 57593f1e401SEdgar E. Iglesias unsigned int phyaddr = (value >> 24) & 0x1f; 57693f1e401SEdgar E. Iglesias unsigned int regaddr = (value >> 16) & 0x1f; 57793f1e401SEdgar E. Iglesias unsigned int op = (value >> 14) & 3; 57893f1e401SEdgar E. Iglesias unsigned int initiate = (value >> 11) & 1; 57993f1e401SEdgar E. Iglesias 58093f1e401SEdgar E. Iglesias if (initiate) { 58193f1e401SEdgar E. Iglesias if (op == 1) { 58293f1e401SEdgar E. Iglesias mdio_write_req(&t->mdio_bus, phyaddr, regaddr, s->mii.mwd); 58393f1e401SEdgar E. Iglesias } else if (op == 2) { 58493f1e401SEdgar E. Iglesias s->mii.mrd = mdio_read_req(&t->mdio_bus, phyaddr, regaddr); 58593f1e401SEdgar E. Iglesias } else { 58693f1e401SEdgar E. Iglesias qemu_log("AXIENET: invalid MDIOBus OP=%d\n", op); 58793f1e401SEdgar E. Iglesias } 58893f1e401SEdgar E. Iglesias } 58993f1e401SEdgar E. Iglesias s->mii.mcr = value; 59093f1e401SEdgar E. Iglesias break; 59193f1e401SEdgar E. Iglesias } 59293f1e401SEdgar E. Iglesias 59393f1e401SEdgar E. Iglesias case R_MWD: 59493f1e401SEdgar E. Iglesias case R_MRD: 59593f1e401SEdgar E. Iglesias s->mii.regs[addr & 3] = value; 59693f1e401SEdgar E. Iglesias break; 59793f1e401SEdgar E. Iglesias 59893f1e401SEdgar E. Iglesias 59993f1e401SEdgar E. Iglesias case R_UAW0: 60093f1e401SEdgar E. Iglesias case R_UAW1: 60193f1e401SEdgar E. Iglesias s->uaw[addr & 1] = value; 60293f1e401SEdgar E. Iglesias break; 60393f1e401SEdgar E. Iglesias 60493f1e401SEdgar E. Iglesias case R_UAWL: 60593f1e401SEdgar E. Iglesias case R_UAWU: 60693f1e401SEdgar E. Iglesias s->ext_uaw[addr & 1] = value; 60793f1e401SEdgar E. Iglesias break; 60893f1e401SEdgar E. Iglesias 60993f1e401SEdgar E. Iglesias case R_FMI: 61093f1e401SEdgar E. Iglesias s->fmi = value; 61193f1e401SEdgar E. Iglesias break; 61293f1e401SEdgar E. Iglesias 61393f1e401SEdgar E. Iglesias case R_AF0: 61493f1e401SEdgar E. Iglesias case R_AF1: 61593f1e401SEdgar E. Iglesias s->maddr[s->fmi & 3][addr & 1] = value; 61693f1e401SEdgar E. Iglesias break; 61793f1e401SEdgar E. Iglesias 618d4d230daSPeter Crosthwaite case R_IS: 619d4d230daSPeter Crosthwaite s->regs[addr] &= ~value; 620d4d230daSPeter Crosthwaite break; 621d4d230daSPeter Crosthwaite 62293f1e401SEdgar E. Iglesias case 0x8000 ... 0x83ff: 62393f1e401SEdgar E. Iglesias s->ext_mtable[addr - 0x8000] = value; 62493f1e401SEdgar E. Iglesias break; 62593f1e401SEdgar E. Iglesias 62693f1e401SEdgar E. Iglesias default: 62793f1e401SEdgar E. Iglesias DENET(qemu_log("%s addr=" TARGET_FMT_plx " v=%x\n", 6280dc31f3bSAvi Kivity __func__, addr * 4, (unsigned)value)); 62993f1e401SEdgar E. Iglesias if (addr < ARRAY_SIZE(s->regs)) { 63093f1e401SEdgar E. Iglesias s->regs[addr] = value; 63193f1e401SEdgar E. Iglesias } 63293f1e401SEdgar E. Iglesias break; 63393f1e401SEdgar E. Iglesias } 63493f1e401SEdgar E. Iglesias enet_update_irq(s); 63593f1e401SEdgar E. Iglesias } 63693f1e401SEdgar E. Iglesias 6370dc31f3bSAvi Kivity static const MemoryRegionOps enet_ops = { 6380dc31f3bSAvi Kivity .read = enet_read, 6390dc31f3bSAvi Kivity .write = enet_write, 6400dc31f3bSAvi Kivity .endianness = DEVICE_LITTLE_ENDIAN, 64193f1e401SEdgar E. Iglesias }; 64293f1e401SEdgar E. Iglesias 6434e68f7a0SStefan Hajnoczi static int eth_can_rx(NetClientState *nc) 64493f1e401SEdgar E. Iglesias { 645545129e5SPeter Crosthwaite XilinxAXIEnet *s = qemu_get_nic_opaque(nc); 64693f1e401SEdgar E. Iglesias 64793f1e401SEdgar E. Iglesias /* RX enabled? */ 64893f1e401SEdgar E. Iglesias return !axienet_rx_resetting(s) && axienet_rx_enabled(s); 64993f1e401SEdgar E. Iglesias } 65093f1e401SEdgar E. Iglesias 65193f1e401SEdgar E. Iglesias static int enet_match_addr(const uint8_t *buf, uint32_t f0, uint32_t f1) 65293f1e401SEdgar E. Iglesias { 65393f1e401SEdgar E. Iglesias int match = 1; 65493f1e401SEdgar E. Iglesias 65593f1e401SEdgar E. Iglesias if (memcmp(buf, &f0, 4)) { 65693f1e401SEdgar E. Iglesias match = 0; 65793f1e401SEdgar E. Iglesias } 65893f1e401SEdgar E. Iglesias 65993f1e401SEdgar E. Iglesias if (buf[4] != (f1 & 0xff) || buf[5] != ((f1 >> 8) & 0xff)) { 66093f1e401SEdgar E. Iglesias match = 0; 66193f1e401SEdgar E. Iglesias } 66293f1e401SEdgar E. Iglesias 66393f1e401SEdgar E. Iglesias return match; 66493f1e401SEdgar E. Iglesias } 66593f1e401SEdgar E. Iglesias 6664e68f7a0SStefan Hajnoczi static ssize_t eth_rx(NetClientState *nc, const uint8_t *buf, size_t size) 66793f1e401SEdgar E. Iglesias { 668545129e5SPeter Crosthwaite XilinxAXIEnet *s = qemu_get_nic_opaque(nc); 66993f1e401SEdgar E. Iglesias static const unsigned char sa_bcast[6] = {0xff, 0xff, 0xff, 67093f1e401SEdgar E. Iglesias 0xff, 0xff, 0xff}; 67193f1e401SEdgar E. Iglesias static const unsigned char sa_ipmcast[3] = {0x01, 0x00, 0x52}; 67293f1e401SEdgar E. Iglesias uint32_t app[6] = {0}; 67393f1e401SEdgar E. Iglesias int promisc = s->fmi & (1 << 31); 67493f1e401SEdgar E. Iglesias int unicast, broadcast, multicast, ip_multicast = 0; 67593f1e401SEdgar E. Iglesias uint32_t csum32; 67693f1e401SEdgar E. Iglesias uint16_t csum16; 67793f1e401SEdgar E. Iglesias int i; 67893f1e401SEdgar E. Iglesias 67993f1e401SEdgar E. Iglesias DENET(qemu_log("%s: %zd bytes\n", __func__, size)); 68093f1e401SEdgar E. Iglesias 68193f1e401SEdgar E. Iglesias unicast = ~buf[0] & 0x1; 68293f1e401SEdgar E. Iglesias broadcast = memcmp(buf, sa_bcast, 6) == 0; 68393f1e401SEdgar E. Iglesias multicast = !unicast && !broadcast; 68493f1e401SEdgar E. Iglesias if (multicast && (memcmp(sa_ipmcast, buf, sizeof sa_ipmcast) == 0)) { 68593f1e401SEdgar E. Iglesias ip_multicast = 1; 68693f1e401SEdgar E. Iglesias } 68793f1e401SEdgar E. Iglesias 68893f1e401SEdgar E. Iglesias /* Jumbo or vlan sizes ? */ 68993f1e401SEdgar E. Iglesias if (!(s->rcw[1] & RCW1_JUM)) { 69093f1e401SEdgar E. Iglesias if (size > 1518 && size <= 1522 && !(s->rcw[1] & RCW1_VLAN)) { 69193f1e401SEdgar E. Iglesias return size; 69293f1e401SEdgar E. Iglesias } 69393f1e401SEdgar E. Iglesias } 69493f1e401SEdgar E. Iglesias 69593f1e401SEdgar E. Iglesias /* Basic Address filters. If you want to use the extended filters 69693f1e401SEdgar E. Iglesias you'll generally have to place the ethernet mac into promiscuous mode 69793f1e401SEdgar E. Iglesias to avoid the basic filtering from dropping most frames. */ 69893f1e401SEdgar E. Iglesias if (!promisc) { 69993f1e401SEdgar E. Iglesias if (unicast) { 70093f1e401SEdgar E. Iglesias if (!enet_match_addr(buf, s->uaw[0], s->uaw[1])) { 70193f1e401SEdgar E. Iglesias return size; 70293f1e401SEdgar E. Iglesias } 70393f1e401SEdgar E. Iglesias } else { 70493f1e401SEdgar E. Iglesias if (broadcast) { 70593f1e401SEdgar E. Iglesias /* Broadcast. */ 70693f1e401SEdgar E. Iglesias if (s->regs[R_RAF] & RAF_BCAST_REJ) { 70793f1e401SEdgar E. Iglesias return size; 70893f1e401SEdgar E. Iglesias } 70993f1e401SEdgar E. Iglesias } else { 71093f1e401SEdgar E. Iglesias int drop = 1; 71193f1e401SEdgar E. Iglesias 71293f1e401SEdgar E. Iglesias /* Multicast. */ 71393f1e401SEdgar E. Iglesias if (s->regs[R_RAF] & RAF_MCAST_REJ) { 71493f1e401SEdgar E. Iglesias return size; 71593f1e401SEdgar E. Iglesias } 71693f1e401SEdgar E. Iglesias 71793f1e401SEdgar E. Iglesias for (i = 0; i < 4; i++) { 71893f1e401SEdgar E. Iglesias if (enet_match_addr(buf, s->maddr[i][0], s->maddr[i][1])) { 71993f1e401SEdgar E. Iglesias drop = 0; 72093f1e401SEdgar E. Iglesias break; 72193f1e401SEdgar E. Iglesias } 72293f1e401SEdgar E. Iglesias } 72393f1e401SEdgar E. Iglesias 72493f1e401SEdgar E. Iglesias if (drop) { 72593f1e401SEdgar E. Iglesias return size; 72693f1e401SEdgar E. Iglesias } 72793f1e401SEdgar E. Iglesias } 72893f1e401SEdgar E. Iglesias } 72993f1e401SEdgar E. Iglesias } 73093f1e401SEdgar E. Iglesias 73193f1e401SEdgar E. Iglesias /* Extended mcast filtering enabled? */ 73293f1e401SEdgar E. Iglesias if (axienet_newfunc_enabled(s) && axienet_extmcf_enabled(s)) { 73393f1e401SEdgar E. Iglesias if (unicast) { 73493f1e401SEdgar E. Iglesias if (!enet_match_addr(buf, s->ext_uaw[0], s->ext_uaw[1])) { 73593f1e401SEdgar E. Iglesias return size; 73693f1e401SEdgar E. Iglesias } 73793f1e401SEdgar E. Iglesias } else { 73893f1e401SEdgar E. Iglesias if (broadcast) { 73993f1e401SEdgar E. Iglesias /* Broadcast. ??? */ 74093f1e401SEdgar E. Iglesias if (s->regs[R_RAF] & RAF_BCAST_REJ) { 74193f1e401SEdgar E. Iglesias return size; 74293f1e401SEdgar E. Iglesias } 74393f1e401SEdgar E. Iglesias } else { 74493f1e401SEdgar E. Iglesias int idx, bit; 74593f1e401SEdgar E. Iglesias 74693f1e401SEdgar E. Iglesias /* Multicast. */ 74793f1e401SEdgar E. Iglesias if (!memcmp(buf, sa_ipmcast, 3)) { 74893f1e401SEdgar E. Iglesias return size; 74993f1e401SEdgar E. Iglesias } 75093f1e401SEdgar E. Iglesias 75193f1e401SEdgar E. Iglesias idx = (buf[4] & 0x7f) << 8; 75293f1e401SEdgar E. Iglesias idx |= buf[5]; 75393f1e401SEdgar E. Iglesias 75493f1e401SEdgar E. Iglesias bit = 1 << (idx & 0x1f); 75593f1e401SEdgar E. Iglesias idx >>= 5; 75693f1e401SEdgar E. Iglesias 75793f1e401SEdgar E. Iglesias if (!(s->ext_mtable[idx] & bit)) { 75893f1e401SEdgar E. Iglesias return size; 75993f1e401SEdgar E. Iglesias } 76093f1e401SEdgar E. Iglesias } 76193f1e401SEdgar E. Iglesias } 76293f1e401SEdgar E. Iglesias } 76393f1e401SEdgar E. Iglesias 76493f1e401SEdgar E. Iglesias if (size < 12) { 76593f1e401SEdgar E. Iglesias s->regs[R_IS] |= IS_RX_REJECT; 76693f1e401SEdgar E. Iglesias enet_update_irq(s); 76793f1e401SEdgar E. Iglesias return -1; 76893f1e401SEdgar E. Iglesias } 76993f1e401SEdgar E. Iglesias 77093f1e401SEdgar E. Iglesias if (size > (s->c_rxmem - 4)) { 77193f1e401SEdgar E. Iglesias size = s->c_rxmem - 4; 77293f1e401SEdgar E. Iglesias } 77393f1e401SEdgar E. Iglesias 77493f1e401SEdgar E. Iglesias memcpy(s->rxmem, buf, size); 77593f1e401SEdgar E. Iglesias memset(s->rxmem + size, 0, 4); /* Clear the FCS. */ 77693f1e401SEdgar E. Iglesias 77793f1e401SEdgar E. Iglesias if (s->rcw[1] & RCW1_FCS) { 77893f1e401SEdgar E. Iglesias size += 4; /* fcs is inband. */ 77993f1e401SEdgar E. Iglesias } 78093f1e401SEdgar E. Iglesias 78193f1e401SEdgar E. Iglesias app[0] = 5 << 28; 78293f1e401SEdgar E. Iglesias csum32 = net_checksum_add(size - 14, (uint8_t *)s->rxmem + 14); 78393f1e401SEdgar E. Iglesias /* Fold it once. */ 78493f1e401SEdgar E. Iglesias csum32 = (csum32 & 0xffff) + (csum32 >> 16); 78593f1e401SEdgar E. Iglesias /* And twice to get rid of possible carries. */ 78693f1e401SEdgar E. Iglesias csum16 = (csum32 & 0xffff) + (csum32 >> 16); 78793f1e401SEdgar E. Iglesias app[3] = csum16; 78893f1e401SEdgar E. Iglesias app[4] = size & 0xffff; 78993f1e401SEdgar E. Iglesias 79093f1e401SEdgar E. Iglesias s->stats.rx_bytes += size; 79193f1e401SEdgar E. Iglesias s->stats.rx++; 79293f1e401SEdgar E. Iglesias if (multicast) { 79393f1e401SEdgar E. Iglesias s->stats.rx_mcast++; 79493f1e401SEdgar E. Iglesias app[2] |= 1 | (ip_multicast << 1); 79593f1e401SEdgar E. Iglesias } else if (broadcast) { 79693f1e401SEdgar E. Iglesias s->stats.rx_bcast++; 79793f1e401SEdgar E. Iglesias app[2] |= 1 << 3; 79893f1e401SEdgar E. Iglesias } 79993f1e401SEdgar E. Iglesias 80093f1e401SEdgar E. Iglesias /* Good frame. */ 80193f1e401SEdgar E. Iglesias app[2] |= 1 << 6; 80293f1e401SEdgar E. Iglesias 803669b4983SPeter A. G. Crosthwaite stream_push(s->tx_dev, (void *)s->rxmem, size, app); 80493f1e401SEdgar E. Iglesias 80593f1e401SEdgar E. Iglesias s->regs[R_IS] |= IS_RX_COMPLETE; 80693f1e401SEdgar E. Iglesias enet_update_irq(s); 80793f1e401SEdgar E. Iglesias return size; 80893f1e401SEdgar E. Iglesias } 80993f1e401SEdgar E. Iglesias 8104e68f7a0SStefan Hajnoczi static void eth_cleanup(NetClientState *nc) 81193f1e401SEdgar E. Iglesias { 81293f1e401SEdgar E. Iglesias /* FIXME. */ 813545129e5SPeter Crosthwaite XilinxAXIEnet *s = qemu_get_nic_opaque(nc); 8147267c094SAnthony Liguori g_free(s->rxmem); 8157267c094SAnthony Liguori g_free(s); 81693f1e401SEdgar E. Iglesias } 81793f1e401SEdgar E. Iglesias 81893f1e401SEdgar E. Iglesias static void 819*55b3e0c2SPeter Crosthwaite xilinx_axienet_data_stream_push(StreamSlave *obj, uint8_t *buf, size_t size, 820*55b3e0c2SPeter Crosthwaite uint32_t *hdr) 82193f1e401SEdgar E. Iglesias { 822*55b3e0c2SPeter Crosthwaite XilinxAXIEnetStreamSlave *ds = XILINX_AXI_ENET_DATA_STREAM(obj); 823*55b3e0c2SPeter Crosthwaite XilinxAXIEnet *s = ds->enet; 82493f1e401SEdgar E. Iglesias 82593f1e401SEdgar E. Iglesias /* TX enable ? */ 82693f1e401SEdgar E. Iglesias if (!(s->tc & TC_TX)) { 82793f1e401SEdgar E. Iglesias return; 82893f1e401SEdgar E. Iglesias } 82993f1e401SEdgar E. Iglesias 83093f1e401SEdgar E. Iglesias /* Jumbo or vlan sizes ? */ 83193f1e401SEdgar E. Iglesias if (!(s->tc & TC_JUM)) { 83293f1e401SEdgar E. Iglesias if (size > 1518 && size <= 1522 && !(s->tc & TC_VLAN)) { 83393f1e401SEdgar E. Iglesias return; 83493f1e401SEdgar E. Iglesias } 83593f1e401SEdgar E. Iglesias } 83693f1e401SEdgar E. Iglesias 83793f1e401SEdgar E. Iglesias if (hdr[0] & 1) { 83893f1e401SEdgar E. Iglesias unsigned int start_off = hdr[1] >> 16; 83993f1e401SEdgar E. Iglesias unsigned int write_off = hdr[1] & 0xffff; 84093f1e401SEdgar E. Iglesias uint32_t tmp_csum; 84193f1e401SEdgar E. Iglesias uint16_t csum; 84293f1e401SEdgar E. Iglesias 84393f1e401SEdgar E. Iglesias tmp_csum = net_checksum_add(size - start_off, 84493f1e401SEdgar E. Iglesias (uint8_t *)buf + start_off); 84593f1e401SEdgar E. Iglesias /* Accumulate the seed. */ 84693f1e401SEdgar E. Iglesias tmp_csum += hdr[2] & 0xffff; 84793f1e401SEdgar E. Iglesias 84893f1e401SEdgar E. Iglesias /* Fold the 32bit partial checksum. */ 84993f1e401SEdgar E. Iglesias csum = net_checksum_finish(tmp_csum); 85093f1e401SEdgar E. Iglesias 85193f1e401SEdgar E. Iglesias /* Writeback. */ 85293f1e401SEdgar E. Iglesias buf[write_off] = csum >> 8; 85393f1e401SEdgar E. Iglesias buf[write_off + 1] = csum & 0xff; 85493f1e401SEdgar E. Iglesias } 85593f1e401SEdgar E. Iglesias 856b356f76dSJason Wang qemu_send_packet(qemu_get_queue(s->nic), buf, size); 85793f1e401SEdgar E. Iglesias 85893f1e401SEdgar E. Iglesias s->stats.tx_bytes += size; 85993f1e401SEdgar E. Iglesias s->regs[R_IS] |= IS_TX_COMPLETE; 86093f1e401SEdgar E. Iglesias enet_update_irq(s); 86193f1e401SEdgar E. Iglesias } 86293f1e401SEdgar E. Iglesias 86393f1e401SEdgar E. Iglesias static NetClientInfo net_xilinx_enet_info = { 8642be64a68SLaszlo Ersek .type = NET_CLIENT_OPTIONS_KIND_NIC, 86593f1e401SEdgar E. Iglesias .size = sizeof(NICState), 86693f1e401SEdgar E. Iglesias .can_receive = eth_can_rx, 86793f1e401SEdgar E. Iglesias .receive = eth_rx, 86893f1e401SEdgar E. Iglesias .cleanup = eth_cleanup, 86993f1e401SEdgar E. Iglesias }; 87093f1e401SEdgar E. Iglesias 871b2d9dfe9SPeter Crosthwaite static void xilinx_enet_realize(DeviceState *dev, Error **errp) 87293f1e401SEdgar E. Iglesias { 873f0e7a81cSPeter Crosthwaite XilinxAXIEnet *s = XILINX_AXI_ENET(dev); 874*55b3e0c2SPeter Crosthwaite XilinxAXIEnetStreamSlave *ds = XILINX_AXI_ENET_DATA_STREAM(&s->rx_data_dev); 875*55b3e0c2SPeter Crosthwaite Error *local_errp = NULL; 876*55b3e0c2SPeter Crosthwaite 877*55b3e0c2SPeter Crosthwaite object_property_add_link(OBJECT(ds), "enet", "xlnx.axi-ethernet", 878*55b3e0c2SPeter Crosthwaite (Object **) &ds->enet, &local_errp); 879*55b3e0c2SPeter Crosthwaite if (local_errp) { 880*55b3e0c2SPeter Crosthwaite goto xilinx_enet_realize_fail; 881*55b3e0c2SPeter Crosthwaite } 882*55b3e0c2SPeter Crosthwaite object_property_set_link(OBJECT(ds), OBJECT(s), "enet", &local_errp); 883*55b3e0c2SPeter Crosthwaite if (local_errp) { 884*55b3e0c2SPeter Crosthwaite goto xilinx_enet_realize_fail; 885*55b3e0c2SPeter Crosthwaite } 88693f1e401SEdgar E. Iglesias 88793f1e401SEdgar E. Iglesias qemu_macaddr_default_if_unset(&s->conf.macaddr); 88893f1e401SEdgar E. Iglesias s->nic = qemu_new_nic(&net_xilinx_enet_info, &s->conf, 889b2d9dfe9SPeter Crosthwaite object_get_typename(OBJECT(dev)), dev->id, s); 890b356f76dSJason Wang qemu_format_nic_info_str(qemu_get_queue(s->nic), s->conf.macaddr.a); 89193f1e401SEdgar E. Iglesias 89293f1e401SEdgar E. Iglesias tdk_init(&s->TEMAC.phy); 89393f1e401SEdgar E. Iglesias mdio_attach(&s->TEMAC.mdio_bus, &s->TEMAC.phy, s->c_phyaddr); 89493f1e401SEdgar E. Iglesias 89593f1e401SEdgar E. Iglesias s->TEMAC.parent = s; 89693f1e401SEdgar E. Iglesias 8977267c094SAnthony Liguori s->rxmem = g_malloc(s->c_rxmem); 898*55b3e0c2SPeter Crosthwaite return; 899*55b3e0c2SPeter Crosthwaite 900*55b3e0c2SPeter Crosthwaite xilinx_enet_realize_fail: 901*55b3e0c2SPeter Crosthwaite if (!*errp) { 902*55b3e0c2SPeter Crosthwaite *errp = local_errp; 903*55b3e0c2SPeter Crosthwaite } 90493f1e401SEdgar E. Iglesias } 90593f1e401SEdgar E. Iglesias 906b2d9dfe9SPeter Crosthwaite static void xilinx_enet_init(Object *obj) 907669b4983SPeter A. G. Crosthwaite { 908f0e7a81cSPeter Crosthwaite XilinxAXIEnet *s = XILINX_AXI_ENET(obj); 909b2d9dfe9SPeter Crosthwaite SysBusDevice *sbd = SYS_BUS_DEVICE(obj); 910b15aaca4SPeter Crosthwaite Error *errp = NULL; 911669b4983SPeter A. G. Crosthwaite 912669b4983SPeter A. G. Crosthwaite object_property_add_link(obj, "axistream-connected", TYPE_STREAM_SLAVE, 913b15aaca4SPeter Crosthwaite (Object **) &s->tx_dev, &errp); 914b15aaca4SPeter Crosthwaite assert_no_error(errp); 915b2d9dfe9SPeter Crosthwaite 916*55b3e0c2SPeter Crosthwaite object_initialize(&s->rx_data_dev, TYPE_XILINX_AXI_ENET_DATA_STREAM); 917*55b3e0c2SPeter Crosthwaite object_property_add_child(OBJECT(s), "axistream-connected-target", 918*55b3e0c2SPeter Crosthwaite (Object *)&s->rx_data_dev, &errp); 919*55b3e0c2SPeter Crosthwaite assert_no_error(errp); 920*55b3e0c2SPeter Crosthwaite 921b2d9dfe9SPeter Crosthwaite sysbus_init_irq(sbd, &s->irq); 922b2d9dfe9SPeter Crosthwaite 923b2d9dfe9SPeter Crosthwaite memory_region_init_io(&s->iomem, &enet_ops, s, "enet", 0x40000); 924b2d9dfe9SPeter Crosthwaite sysbus_init_mmio(sbd, &s->iomem); 925669b4983SPeter A. G. Crosthwaite } 926669b4983SPeter A. G. Crosthwaite 927999e12bbSAnthony Liguori static Property xilinx_enet_properties[] = { 928545129e5SPeter Crosthwaite DEFINE_PROP_UINT32("phyaddr", XilinxAXIEnet, c_phyaddr, 7), 929545129e5SPeter Crosthwaite DEFINE_PROP_UINT32("rxmem", XilinxAXIEnet, c_rxmem, 0x1000), 930545129e5SPeter Crosthwaite DEFINE_PROP_UINT32("txmem", XilinxAXIEnet, c_txmem, 0x1000), 931545129e5SPeter Crosthwaite DEFINE_NIC_PROPERTIES(XilinxAXIEnet, conf), 93293f1e401SEdgar E. Iglesias DEFINE_PROP_END_OF_LIST(), 933999e12bbSAnthony Liguori }; 934999e12bbSAnthony Liguori 935999e12bbSAnthony Liguori static void xilinx_enet_class_init(ObjectClass *klass, void *data) 936999e12bbSAnthony Liguori { 93739bffca2SAnthony Liguori DeviceClass *dc = DEVICE_CLASS(klass); 938999e12bbSAnthony Liguori 939b2d9dfe9SPeter Crosthwaite dc->realize = xilinx_enet_realize; 94039bffca2SAnthony Liguori dc->props = xilinx_enet_properties; 9419ee0ceb7SPeter Crosthwaite dc->reset = xilinx_axienet_reset; 942*55b3e0c2SPeter Crosthwaite } 943*55b3e0c2SPeter Crosthwaite 944*55b3e0c2SPeter Crosthwaite static void xilinx_enet_stream_class_init(ObjectClass *klass, void *data) 945*55b3e0c2SPeter Crosthwaite { 946*55b3e0c2SPeter Crosthwaite StreamSlaveClass *ssc = STREAM_SLAVE_CLASS(klass); 947*55b3e0c2SPeter Crosthwaite 948*55b3e0c2SPeter Crosthwaite ssc->push = data; 94993f1e401SEdgar E. Iglesias } 950999e12bbSAnthony Liguori 9518c43a6f0SAndreas Färber static const TypeInfo xilinx_enet_info = { 952f0e7a81cSPeter Crosthwaite .name = TYPE_XILINX_AXI_ENET, 95339bffca2SAnthony Liguori .parent = TYPE_SYS_BUS_DEVICE, 954545129e5SPeter Crosthwaite .instance_size = sizeof(XilinxAXIEnet), 955999e12bbSAnthony Liguori .class_init = xilinx_enet_class_init, 956b2d9dfe9SPeter Crosthwaite .instance_init = xilinx_enet_init, 957*55b3e0c2SPeter Crosthwaite }; 958*55b3e0c2SPeter Crosthwaite 959*55b3e0c2SPeter Crosthwaite static const TypeInfo xilinx_enet_data_stream_info = { 960*55b3e0c2SPeter Crosthwaite .name = TYPE_XILINX_AXI_ENET_DATA_STREAM, 961*55b3e0c2SPeter Crosthwaite .parent = TYPE_OBJECT, 962*55b3e0c2SPeter Crosthwaite .instance_size = sizeof(struct XilinxAXIEnetStreamSlave), 963*55b3e0c2SPeter Crosthwaite .class_init = xilinx_enet_stream_class_init, 964*55b3e0c2SPeter Crosthwaite .class_data = xilinx_axienet_data_stream_push, 965669b4983SPeter A. G. Crosthwaite .interfaces = (InterfaceInfo[]) { 966669b4983SPeter A. G. Crosthwaite { TYPE_STREAM_SLAVE }, 967669b4983SPeter A. G. Crosthwaite { } 968669b4983SPeter A. G. Crosthwaite } 96993f1e401SEdgar E. Iglesias }; 97083f7d43aSAndreas Färber 97183f7d43aSAndreas Färber static void xilinx_enet_register_types(void) 97293f1e401SEdgar E. Iglesias { 97339bffca2SAnthony Liguori type_register_static(&xilinx_enet_info); 974*55b3e0c2SPeter Crosthwaite type_register_static(&xilinx_enet_data_stream_info); 97593f1e401SEdgar E. Iglesias } 97693f1e401SEdgar E. Iglesias 97783f7d43aSAndreas Färber type_init(xilinx_enet_register_types) 978