1e9f186e5SPeter A. G. Crosthwaite /* 2e9f186e5SPeter A. G. Crosthwaite * QEMU Xilinx GEM emulation 3e9f186e5SPeter A. G. Crosthwaite * 4e9f186e5SPeter A. G. Crosthwaite * Copyright (c) 2011 Xilinx, Inc. 5e9f186e5SPeter A. G. Crosthwaite * 6e9f186e5SPeter A. G. Crosthwaite * Permission is hereby granted, free of charge, to any person obtaining a copy 7e9f186e5SPeter A. G. Crosthwaite * of this software and associated documentation files (the "Software"), to deal 8e9f186e5SPeter A. G. Crosthwaite * in the Software without restriction, including without limitation the rights 9e9f186e5SPeter A. G. Crosthwaite * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 10e9f186e5SPeter A. G. Crosthwaite * copies of the Software, and to permit persons to whom the Software is 11e9f186e5SPeter A. G. Crosthwaite * furnished to do so, subject to the following conditions: 12e9f186e5SPeter A. G. Crosthwaite * 13e9f186e5SPeter A. G. Crosthwaite * The above copyright notice and this permission notice shall be included in 14e9f186e5SPeter A. G. Crosthwaite * all copies or substantial portions of the Software. 15e9f186e5SPeter A. G. Crosthwaite * 16e9f186e5SPeter A. G. Crosthwaite * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 17e9f186e5SPeter A. G. Crosthwaite * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 18e9f186e5SPeter A. G. Crosthwaite * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 19e9f186e5SPeter A. G. Crosthwaite * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 20e9f186e5SPeter A. G. Crosthwaite * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 21e9f186e5SPeter A. G. Crosthwaite * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 22e9f186e5SPeter A. G. Crosthwaite * THE SOFTWARE. 23e9f186e5SPeter A. G. Crosthwaite */ 24e9f186e5SPeter A. G. Crosthwaite 25e9f186e5SPeter A. G. Crosthwaite #include <zlib.h> /* For crc32 */ 26e9f186e5SPeter A. G. Crosthwaite 2783c9f4caSPaolo Bonzini #include "hw/sysbus.h" 281422e32dSPaolo Bonzini #include "net/net.h" 29e9f186e5SPeter A. G. Crosthwaite #include "net/checksum.h" 30e9f186e5SPeter A. G. Crosthwaite 31e9f186e5SPeter A. G. Crosthwaite #ifdef CADENCE_GEM_ERR_DEBUG 32e9f186e5SPeter A. G. Crosthwaite #define DB_PRINT(...) do { \ 33e9f186e5SPeter A. G. Crosthwaite fprintf(stderr, ": %s: ", __func__); \ 34e9f186e5SPeter A. G. Crosthwaite fprintf(stderr, ## __VA_ARGS__); \ 35e9f186e5SPeter A. G. Crosthwaite } while (0); 36e9f186e5SPeter A. G. Crosthwaite #else 37e9f186e5SPeter A. G. Crosthwaite #define DB_PRINT(...) 38e9f186e5SPeter A. G. Crosthwaite #endif 39e9f186e5SPeter A. G. Crosthwaite 40e9f186e5SPeter A. G. Crosthwaite #define GEM_NWCTRL (0x00000000/4) /* Network Control reg */ 41e9f186e5SPeter A. G. Crosthwaite #define GEM_NWCFG (0x00000004/4) /* Network Config reg */ 42e9f186e5SPeter A. G. Crosthwaite #define GEM_NWSTATUS (0x00000008/4) /* Network Status reg */ 43e9f186e5SPeter A. G. Crosthwaite #define GEM_USERIO (0x0000000C/4) /* User IO reg */ 44e9f186e5SPeter A. G. Crosthwaite #define GEM_DMACFG (0x00000010/4) /* DMA Control reg */ 45e9f186e5SPeter A. G. Crosthwaite #define GEM_TXSTATUS (0x00000014/4) /* TX Status reg */ 46e9f186e5SPeter A. G. Crosthwaite #define GEM_RXQBASE (0x00000018/4) /* RX Q Base address reg */ 47e9f186e5SPeter A. G. Crosthwaite #define GEM_TXQBASE (0x0000001C/4) /* TX Q Base address reg */ 48e9f186e5SPeter A. G. Crosthwaite #define GEM_RXSTATUS (0x00000020/4) /* RX Status reg */ 49e9f186e5SPeter A. G. Crosthwaite #define GEM_ISR (0x00000024/4) /* Interrupt Status reg */ 50e9f186e5SPeter A. G. Crosthwaite #define GEM_IER (0x00000028/4) /* Interrupt Enable reg */ 51e9f186e5SPeter A. G. Crosthwaite #define GEM_IDR (0x0000002C/4) /* Interrupt Disable reg */ 52e9f186e5SPeter A. G. Crosthwaite #define GEM_IMR (0x00000030/4) /* Interrupt Mask reg */ 53e9f186e5SPeter A. G. Crosthwaite #define GEM_PHYMNTNC (0x00000034/4) /* Phy Maintaince reg */ 54e9f186e5SPeter A. G. Crosthwaite #define GEM_RXPAUSE (0x00000038/4) /* RX Pause Time reg */ 55e9f186e5SPeter A. G. Crosthwaite #define GEM_TXPAUSE (0x0000003C/4) /* TX Pause Time reg */ 56e9f186e5SPeter A. G. Crosthwaite #define GEM_TXPARTIALSF (0x00000040/4) /* TX Partial Store and Forward */ 57e9f186e5SPeter A. G. Crosthwaite #define GEM_RXPARTIALSF (0x00000044/4) /* RX Partial Store and Forward */ 58e9f186e5SPeter A. G. Crosthwaite #define GEM_HASHLO (0x00000080/4) /* Hash Low address reg */ 59e9f186e5SPeter A. G. Crosthwaite #define GEM_HASHHI (0x00000084/4) /* Hash High address reg */ 60e9f186e5SPeter A. G. Crosthwaite #define GEM_SPADDR1LO (0x00000088/4) /* Specific addr 1 low reg */ 61e9f186e5SPeter A. G. Crosthwaite #define GEM_SPADDR1HI (0x0000008C/4) /* Specific addr 1 high reg */ 62e9f186e5SPeter A. G. Crosthwaite #define GEM_SPADDR2LO (0x00000090/4) /* Specific addr 2 low reg */ 63e9f186e5SPeter A. G. Crosthwaite #define GEM_SPADDR2HI (0x00000094/4) /* Specific addr 2 high reg */ 64e9f186e5SPeter A. G. Crosthwaite #define GEM_SPADDR3LO (0x00000098/4) /* Specific addr 3 low reg */ 65e9f186e5SPeter A. G. Crosthwaite #define GEM_SPADDR3HI (0x0000009C/4) /* Specific addr 3 high reg */ 66e9f186e5SPeter A. G. Crosthwaite #define GEM_SPADDR4LO (0x000000A0/4) /* Specific addr 4 low reg */ 67e9f186e5SPeter A. G. Crosthwaite #define GEM_SPADDR4HI (0x000000A4/4) /* Specific addr 4 high reg */ 68e9f186e5SPeter A. G. Crosthwaite #define GEM_TIDMATCH1 (0x000000A8/4) /* Type ID1 Match reg */ 69e9f186e5SPeter A. G. Crosthwaite #define GEM_TIDMATCH2 (0x000000AC/4) /* Type ID2 Match reg */ 70e9f186e5SPeter A. G. Crosthwaite #define GEM_TIDMATCH3 (0x000000B0/4) /* Type ID3 Match reg */ 71e9f186e5SPeter A. G. Crosthwaite #define GEM_TIDMATCH4 (0x000000B4/4) /* Type ID4 Match reg */ 72e9f186e5SPeter A. G. Crosthwaite #define GEM_WOLAN (0x000000B8/4) /* Wake on LAN reg */ 73e9f186e5SPeter A. G. Crosthwaite #define GEM_IPGSTRETCH (0x000000BC/4) /* IPG Stretch reg */ 74e9f186e5SPeter A. G. Crosthwaite #define GEM_SVLAN (0x000000C0/4) /* Stacked VLAN reg */ 75e9f186e5SPeter A. G. Crosthwaite #define GEM_MODID (0x000000FC/4) /* Module ID reg */ 76e9f186e5SPeter A. G. Crosthwaite #define GEM_OCTTXLO (0x00000100/4) /* Octects transmitted Low reg */ 77e9f186e5SPeter A. G. Crosthwaite #define GEM_OCTTXHI (0x00000104/4) /* Octects transmitted High reg */ 78e9f186e5SPeter A. G. Crosthwaite #define GEM_TXCNT (0x00000108/4) /* Error-free Frames transmitted */ 79e9f186e5SPeter A. G. Crosthwaite #define GEM_TXBCNT (0x0000010C/4) /* Error-free Broadcast Frames */ 80e9f186e5SPeter A. G. Crosthwaite #define GEM_TXMCNT (0x00000110/4) /* Error-free Multicast Frame */ 81e9f186e5SPeter A. G. Crosthwaite #define GEM_TXPAUSECNT (0x00000114/4) /* Pause Frames Transmitted */ 82e9f186e5SPeter A. G. Crosthwaite #define GEM_TX64CNT (0x00000118/4) /* Error-free 64 TX */ 83e9f186e5SPeter A. G. Crosthwaite #define GEM_TX65CNT (0x0000011C/4) /* Error-free 65-127 TX */ 84e9f186e5SPeter A. G. Crosthwaite #define GEM_TX128CNT (0x00000120/4) /* Error-free 128-255 TX */ 85e9f186e5SPeter A. G. Crosthwaite #define GEM_TX256CNT (0x00000124/4) /* Error-free 256-511 */ 86e9f186e5SPeter A. G. Crosthwaite #define GEM_TX512CNT (0x00000128/4) /* Error-free 512-1023 TX */ 87e9f186e5SPeter A. G. Crosthwaite #define GEM_TX1024CNT (0x0000012C/4) /* Error-free 1024-1518 TX */ 88e9f186e5SPeter A. G. Crosthwaite #define GEM_TX1519CNT (0x00000130/4) /* Error-free larger than 1519 TX */ 89e9f186e5SPeter A. G. Crosthwaite #define GEM_TXURUNCNT (0x00000134/4) /* TX under run error counter */ 90e9f186e5SPeter A. G. Crosthwaite #define GEM_SINGLECOLLCNT (0x00000138/4) /* Single Collision Frames */ 91e9f186e5SPeter A. G. Crosthwaite #define GEM_MULTCOLLCNT (0x0000013C/4) /* Multiple Collision Frames */ 92e9f186e5SPeter A. G. Crosthwaite #define GEM_EXCESSCOLLCNT (0x00000140/4) /* Excessive Collision Frames */ 93e9f186e5SPeter A. G. Crosthwaite #define GEM_LATECOLLCNT (0x00000144/4) /* Late Collision Frames */ 94e9f186e5SPeter A. G. Crosthwaite #define GEM_DEFERTXCNT (0x00000148/4) /* Deferred Transmission Frames */ 95e9f186e5SPeter A. G. Crosthwaite #define GEM_CSENSECNT (0x0000014C/4) /* Carrier Sense Error Counter */ 96e9f186e5SPeter A. G. Crosthwaite #define GEM_OCTRXLO (0x00000150/4) /* Octects Received register Low */ 97e9f186e5SPeter A. G. Crosthwaite #define GEM_OCTRXHI (0x00000154/4) /* Octects Received register High */ 98e9f186e5SPeter A. G. Crosthwaite #define GEM_RXCNT (0x00000158/4) /* Error-free Frames Received */ 99e9f186e5SPeter A. G. Crosthwaite #define GEM_RXBROADCNT (0x0000015C/4) /* Error-free Broadcast Frames RX */ 100e9f186e5SPeter A. G. Crosthwaite #define GEM_RXMULTICNT (0x00000160/4) /* Error-free Multicast Frames RX */ 101e9f186e5SPeter A. G. Crosthwaite #define GEM_RXPAUSECNT (0x00000164/4) /* Pause Frames Received Counter */ 102e9f186e5SPeter A. G. Crosthwaite #define GEM_RX64CNT (0x00000168/4) /* Error-free 64 byte Frames RX */ 103e9f186e5SPeter A. G. Crosthwaite #define GEM_RX65CNT (0x0000016C/4) /* Error-free 65-127B Frames RX */ 104e9f186e5SPeter A. G. Crosthwaite #define GEM_RX128CNT (0x00000170/4) /* Error-free 128-255B Frames RX */ 105e9f186e5SPeter A. G. Crosthwaite #define GEM_RX256CNT (0x00000174/4) /* Error-free 256-512B Frames RX */ 106e9f186e5SPeter A. G. Crosthwaite #define GEM_RX512CNT (0x00000178/4) /* Error-free 512-1023B Frames RX */ 107e9f186e5SPeter A. G. Crosthwaite #define GEM_RX1024CNT (0x0000017C/4) /* Error-free 1024-1518B Frames RX */ 108e9f186e5SPeter A. G. Crosthwaite #define GEM_RX1519CNT (0x00000180/4) /* Error-free 1519-max Frames RX */ 109e9f186e5SPeter A. G. Crosthwaite #define GEM_RXUNDERCNT (0x00000184/4) /* Undersize Frames Received */ 110e9f186e5SPeter A. G. Crosthwaite #define GEM_RXOVERCNT (0x00000188/4) /* Oversize Frames Received */ 111e9f186e5SPeter A. G. Crosthwaite #define GEM_RXJABCNT (0x0000018C/4) /* Jabbers Received Counter */ 112e9f186e5SPeter A. G. Crosthwaite #define GEM_RXFCSCNT (0x00000190/4) /* Frame Check seq. Error Counter */ 113e9f186e5SPeter A. G. Crosthwaite #define GEM_RXLENERRCNT (0x00000194/4) /* Length Field Error Counter */ 114e9f186e5SPeter A. G. Crosthwaite #define GEM_RXSYMERRCNT (0x00000198/4) /* Symbol Error Counter */ 115e9f186e5SPeter A. G. Crosthwaite #define GEM_RXALIGNERRCNT (0x0000019C/4) /* Alignment Error Counter */ 116e9f186e5SPeter A. G. Crosthwaite #define GEM_RXRSCERRCNT (0x000001A0/4) /* Receive Resource Error Counter */ 117e9f186e5SPeter A. G. Crosthwaite #define GEM_RXORUNCNT (0x000001A4/4) /* Receive Overrun Counter */ 118e9f186e5SPeter A. G. Crosthwaite #define GEM_RXIPCSERRCNT (0x000001A8/4) /* IP header Checksum Error Counter */ 119e9f186e5SPeter A. G. Crosthwaite #define GEM_RXTCPCCNT (0x000001AC/4) /* TCP Checksum Error Counter */ 120e9f186e5SPeter A. G. Crosthwaite #define GEM_RXUDPCCNT (0x000001B0/4) /* UDP Checksum Error Counter */ 121e9f186e5SPeter A. G. Crosthwaite 122e9f186e5SPeter A. G. Crosthwaite #define GEM_1588S (0x000001D0/4) /* 1588 Timer Seconds */ 123e9f186e5SPeter A. G. Crosthwaite #define GEM_1588NS (0x000001D4/4) /* 1588 Timer Nanoseconds */ 124e9f186e5SPeter A. G. Crosthwaite #define GEM_1588ADJ (0x000001D8/4) /* 1588 Timer Adjust */ 125e9f186e5SPeter A. G. Crosthwaite #define GEM_1588INC (0x000001DC/4) /* 1588 Timer Increment */ 126e9f186e5SPeter A. G. Crosthwaite #define GEM_PTPETXS (0x000001E0/4) /* PTP Event Frame Transmitted (s) */ 127e9f186e5SPeter A. G. Crosthwaite #define GEM_PTPETXNS (0x000001E4/4) /* PTP Event Frame Transmitted (ns) */ 128e9f186e5SPeter A. G. Crosthwaite #define GEM_PTPERXS (0x000001E8/4) /* PTP Event Frame Received (s) */ 129e9f186e5SPeter A. G. Crosthwaite #define GEM_PTPERXNS (0x000001EC/4) /* PTP Event Frame Received (ns) */ 130e9f186e5SPeter A. G. Crosthwaite #define GEM_PTPPTXS (0x000001E0/4) /* PTP Peer Frame Transmitted (s) */ 131e9f186e5SPeter A. G. Crosthwaite #define GEM_PTPPTXNS (0x000001E4/4) /* PTP Peer Frame Transmitted (ns) */ 132e9f186e5SPeter A. G. Crosthwaite #define GEM_PTPPRXS (0x000001E8/4) /* PTP Peer Frame Received (s) */ 133e9f186e5SPeter A. G. Crosthwaite #define GEM_PTPPRXNS (0x000001EC/4) /* PTP Peer Frame Received (ns) */ 134e9f186e5SPeter A. G. Crosthwaite 135e9f186e5SPeter A. G. Crosthwaite /* Design Configuration Registers */ 136e9f186e5SPeter A. G. Crosthwaite #define GEM_DESCONF (0x00000280/4) 137e9f186e5SPeter A. G. Crosthwaite #define GEM_DESCONF2 (0x00000284/4) 138e9f186e5SPeter A. G. Crosthwaite #define GEM_DESCONF3 (0x00000288/4) 139e9f186e5SPeter A. G. Crosthwaite #define GEM_DESCONF4 (0x0000028C/4) 140e9f186e5SPeter A. G. Crosthwaite #define GEM_DESCONF5 (0x00000290/4) 141e9f186e5SPeter A. G. Crosthwaite #define GEM_DESCONF6 (0x00000294/4) 142e9f186e5SPeter A. G. Crosthwaite #define GEM_DESCONF7 (0x00000298/4) 143e9f186e5SPeter A. G. Crosthwaite 144e9f186e5SPeter A. G. Crosthwaite #define GEM_MAXREG (0x00000640/4) /* Last valid GEM address */ 145e9f186e5SPeter A. G. Crosthwaite 146e9f186e5SPeter A. G. Crosthwaite /*****************************************/ 147e9f186e5SPeter A. G. Crosthwaite #define GEM_NWCTRL_TXSTART 0x00000200 /* Transmit Enable */ 148e9f186e5SPeter A. G. Crosthwaite #define GEM_NWCTRL_TXENA 0x00000008 /* Transmit Enable */ 149e9f186e5SPeter A. G. Crosthwaite #define GEM_NWCTRL_RXENA 0x00000004 /* Receive Enable */ 150e9f186e5SPeter A. G. Crosthwaite #define GEM_NWCTRL_LOCALLOOP 0x00000002 /* Local Loopback */ 151e9f186e5SPeter A. G. Crosthwaite 152e9f186e5SPeter A. G. Crosthwaite #define GEM_NWCFG_STRIP_FCS 0x00020000 /* Strip FCS field */ 153e9f186e5SPeter A. G. Crosthwaite #define GEM_NWCFG_LERR_DISC 0x00010000 /* Discard RX frames with lenth err */ 154e9f186e5SPeter A. G. Crosthwaite #define GEM_NWCFG_BUFF_OFST_M 0x0000C000 /* Receive buffer offset mask */ 155e9f186e5SPeter A. G. Crosthwaite #define GEM_NWCFG_BUFF_OFST_S 14 /* Receive buffer offset shift */ 156e9f186e5SPeter A. G. Crosthwaite #define GEM_NWCFG_UCAST_HASH 0x00000080 /* accept unicast if hash match */ 157e9f186e5SPeter A. G. Crosthwaite #define GEM_NWCFG_MCAST_HASH 0x00000040 /* accept multicast if hash match */ 158e9f186e5SPeter A. G. Crosthwaite #define GEM_NWCFG_BCAST_REJ 0x00000020 /* Reject broadcast packets */ 159e9f186e5SPeter A. G. Crosthwaite #define GEM_NWCFG_PROMISC 0x00000010 /* Accept all packets */ 160e9f186e5SPeter A. G. Crosthwaite 161e9f186e5SPeter A. G. Crosthwaite #define GEM_DMACFG_RBUFSZ_M 0x007F0000 /* DMA RX Buffer Size mask */ 162e9f186e5SPeter A. G. Crosthwaite #define GEM_DMACFG_RBUFSZ_S 16 /* DMA RX Buffer Size shift */ 163e9f186e5SPeter A. G. Crosthwaite #define GEM_DMACFG_RBUFSZ_MUL 64 /* DMA RX Buffer Size multiplier */ 164e9f186e5SPeter A. G. Crosthwaite #define GEM_DMACFG_TXCSUM_OFFL 0x00000800 /* Transmit checksum offload */ 165e9f186e5SPeter A. G. Crosthwaite 166e9f186e5SPeter A. G. Crosthwaite #define GEM_TXSTATUS_TXCMPL 0x00000020 /* Transmit Complete */ 167e9f186e5SPeter A. G. Crosthwaite #define GEM_TXSTATUS_USED 0x00000001 /* sw owned descriptor encountered */ 168e9f186e5SPeter A. G. Crosthwaite 169e9f186e5SPeter A. G. Crosthwaite #define GEM_RXSTATUS_FRMRCVD 0x00000002 /* Frame received */ 170e9f186e5SPeter A. G. Crosthwaite #define GEM_RXSTATUS_NOBUF 0x00000001 /* Buffer unavailable */ 171e9f186e5SPeter A. G. Crosthwaite 172e9f186e5SPeter A. G. Crosthwaite /* GEM_ISR GEM_IER GEM_IDR GEM_IMR */ 173e9f186e5SPeter A. G. Crosthwaite #define GEM_INT_TXCMPL 0x00000080 /* Transmit Complete */ 174e9f186e5SPeter A. G. Crosthwaite #define GEM_INT_TXUSED 0x00000008 175e9f186e5SPeter A. G. Crosthwaite #define GEM_INT_RXUSED 0x00000004 176e9f186e5SPeter A. G. Crosthwaite #define GEM_INT_RXCMPL 0x00000002 177e9f186e5SPeter A. G. Crosthwaite 178e9f186e5SPeter A. G. Crosthwaite #define GEM_PHYMNTNC_OP_R 0x20000000 /* read operation */ 179e9f186e5SPeter A. G. Crosthwaite #define GEM_PHYMNTNC_OP_W 0x10000000 /* write operation */ 180e9f186e5SPeter A. G. Crosthwaite #define GEM_PHYMNTNC_ADDR 0x0F800000 /* Address bits */ 181e9f186e5SPeter A. G. Crosthwaite #define GEM_PHYMNTNC_ADDR_SHFT 23 182e9f186e5SPeter A. G. Crosthwaite #define GEM_PHYMNTNC_REG 0x007C0000 /* register bits */ 183e9f186e5SPeter A. G. Crosthwaite #define GEM_PHYMNTNC_REG_SHIFT 18 184e9f186e5SPeter A. G. Crosthwaite 185e9f186e5SPeter A. G. Crosthwaite /* Marvell PHY definitions */ 186e9f186e5SPeter A. G. Crosthwaite #define BOARD_PHY_ADDRESS 23 /* PHY address we will emulate a device at */ 187e9f186e5SPeter A. G. Crosthwaite 188e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_CONTROL 0 189e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_STATUS 1 190e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_PHYID1 2 191e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_PHYID2 3 192e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_ANEGADV 4 193e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_LINKPABIL 5 194e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_ANEGEXP 6 195e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_NEXTP 7 196e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_LINKPNEXTP 8 197e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_100BTCTRL 9 198e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_1000BTSTAT 10 199e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_EXTSTAT 15 200e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_PHYSPCFC_CTL 16 201e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_PHYSPCFC_ST 17 202e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_INT_EN 18 203e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_INT_ST 19 204e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_EXT_PHYSPCFC_CTL 20 205e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_RXERR 21 206e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_EACD 22 207e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_LED 24 208e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_LED_OVRD 25 209e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_EXT_PHYSPCFC_CTL2 26 210e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_EXT_PHYSPCFC_ST 27 211e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_CABLE_DIAG 28 212e9f186e5SPeter A. G. Crosthwaite 213e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_CONTROL_RST 0x8000 214e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_CONTROL_LOOP 0x4000 215e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_CONTROL_ANEG 0x1000 216e9f186e5SPeter A. G. Crosthwaite 217e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_STATUS_LINK 0x0004 218e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_STATUS_ANEGCMPL 0x0020 219e9f186e5SPeter A. G. Crosthwaite 220e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_INT_ST_ANEGCMPL 0x0800 221e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_INT_ST_LINKC 0x0400 222e9f186e5SPeter A. G. Crosthwaite #define PHY_REG_INT_ST_ENERGY 0x0010 223e9f186e5SPeter A. G. Crosthwaite 224e9f186e5SPeter A. G. Crosthwaite /***********************************************************************/ 225*63af1e0cSPeter Crosthwaite #define GEM_RX_REJECT (-1) 226*63af1e0cSPeter Crosthwaite #define GEM_RX_PROMISCUOUS_ACCEPT (-2) 227*63af1e0cSPeter Crosthwaite #define GEM_RX_BROADCAST_ACCEPT (-3) 228*63af1e0cSPeter Crosthwaite #define GEM_RX_MULTICAST_HASH_ACCEPT (-4) 229*63af1e0cSPeter Crosthwaite #define GEM_RX_UNICAST_HASH_ACCEPT (-5) 230*63af1e0cSPeter Crosthwaite 231*63af1e0cSPeter Crosthwaite #define GEM_RX_SAR_ACCEPT 0 232e9f186e5SPeter A. G. Crosthwaite 233e9f186e5SPeter A. G. Crosthwaite /***********************************************************************/ 234e9f186e5SPeter A. G. Crosthwaite 235e9f186e5SPeter A. G. Crosthwaite #define DESC_1_USED 0x80000000 236e9f186e5SPeter A. G. Crosthwaite #define DESC_1_LENGTH 0x00001FFF 237e9f186e5SPeter A. G. Crosthwaite 238e9f186e5SPeter A. G. Crosthwaite #define DESC_1_TX_WRAP 0x40000000 239e9f186e5SPeter A. G. Crosthwaite #define DESC_1_TX_LAST 0x00008000 240e9f186e5SPeter A. G. Crosthwaite 241e9f186e5SPeter A. G. Crosthwaite #define DESC_0_RX_WRAP 0x00000002 242e9f186e5SPeter A. G. Crosthwaite #define DESC_0_RX_OWNERSHIP 0x00000001 243e9f186e5SPeter A. G. Crosthwaite 244*63af1e0cSPeter Crosthwaite #define R_DESC_1_RX_SAR_SHIFT 25 245*63af1e0cSPeter Crosthwaite #define R_DESC_1_RX_SAR_LENGTH 2 246*63af1e0cSPeter Crosthwaite #define R_DESC_1_RX_UNICAST_HASH (1 << 29) 247*63af1e0cSPeter Crosthwaite #define R_DESC_1_RX_MULTICAST_HASH (1 << 30) 248*63af1e0cSPeter Crosthwaite #define R_DESC_1_RX_BROADCAST (1 << 31) 249*63af1e0cSPeter Crosthwaite 250e9f186e5SPeter A. G. Crosthwaite #define DESC_1_RX_SOF 0x00004000 251e9f186e5SPeter A. G. Crosthwaite #define DESC_1_RX_EOF 0x00008000 252e9f186e5SPeter A. G. Crosthwaite 253e9f186e5SPeter A. G. Crosthwaite static inline unsigned tx_desc_get_buffer(unsigned *desc) 254e9f186e5SPeter A. G. Crosthwaite { 255e9f186e5SPeter A. G. Crosthwaite return desc[0]; 256e9f186e5SPeter A. G. Crosthwaite } 257e9f186e5SPeter A. G. Crosthwaite 258e9f186e5SPeter A. G. Crosthwaite static inline unsigned tx_desc_get_used(unsigned *desc) 259e9f186e5SPeter A. G. Crosthwaite { 260e9f186e5SPeter A. G. Crosthwaite return (desc[1] & DESC_1_USED) ? 1 : 0; 261e9f186e5SPeter A. G. Crosthwaite } 262e9f186e5SPeter A. G. Crosthwaite 263e9f186e5SPeter A. G. Crosthwaite static inline void tx_desc_set_used(unsigned *desc) 264e9f186e5SPeter A. G. Crosthwaite { 265e9f186e5SPeter A. G. Crosthwaite desc[1] |= DESC_1_USED; 266e9f186e5SPeter A. G. Crosthwaite } 267e9f186e5SPeter A. G. Crosthwaite 268e9f186e5SPeter A. G. Crosthwaite static inline unsigned tx_desc_get_wrap(unsigned *desc) 269e9f186e5SPeter A. G. Crosthwaite { 270e9f186e5SPeter A. G. Crosthwaite return (desc[1] & DESC_1_TX_WRAP) ? 1 : 0; 271e9f186e5SPeter A. G. Crosthwaite } 272e9f186e5SPeter A. G. Crosthwaite 273e9f186e5SPeter A. G. Crosthwaite static inline unsigned tx_desc_get_last(unsigned *desc) 274e9f186e5SPeter A. G. Crosthwaite { 275e9f186e5SPeter A. G. Crosthwaite return (desc[1] & DESC_1_TX_LAST) ? 1 : 0; 276e9f186e5SPeter A. G. Crosthwaite } 277e9f186e5SPeter A. G. Crosthwaite 278e9f186e5SPeter A. G. Crosthwaite static inline unsigned tx_desc_get_length(unsigned *desc) 279e9f186e5SPeter A. G. Crosthwaite { 280e9f186e5SPeter A. G. Crosthwaite return desc[1] & DESC_1_LENGTH; 281e9f186e5SPeter A. G. Crosthwaite } 282e9f186e5SPeter A. G. Crosthwaite 283e9f186e5SPeter A. G. Crosthwaite static inline void print_gem_tx_desc(unsigned *desc) 284e9f186e5SPeter A. G. Crosthwaite { 285e9f186e5SPeter A. G. Crosthwaite DB_PRINT("TXDESC:\n"); 286e9f186e5SPeter A. G. Crosthwaite DB_PRINT("bufaddr: 0x%08x\n", *desc); 287e9f186e5SPeter A. G. Crosthwaite DB_PRINT("used_hw: %d\n", tx_desc_get_used(desc)); 288e9f186e5SPeter A. G. Crosthwaite DB_PRINT("wrap: %d\n", tx_desc_get_wrap(desc)); 289e9f186e5SPeter A. G. Crosthwaite DB_PRINT("last: %d\n", tx_desc_get_last(desc)); 290e9f186e5SPeter A. G. Crosthwaite DB_PRINT("length: %d\n", tx_desc_get_length(desc)); 291e9f186e5SPeter A. G. Crosthwaite } 292e9f186e5SPeter A. G. Crosthwaite 293e9f186e5SPeter A. G. Crosthwaite static inline unsigned rx_desc_get_buffer(unsigned *desc) 294e9f186e5SPeter A. G. Crosthwaite { 295e9f186e5SPeter A. G. Crosthwaite return desc[0] & ~0x3UL; 296e9f186e5SPeter A. G. Crosthwaite } 297e9f186e5SPeter A. G. Crosthwaite 298e9f186e5SPeter A. G. Crosthwaite static inline unsigned rx_desc_get_wrap(unsigned *desc) 299e9f186e5SPeter A. G. Crosthwaite { 300e9f186e5SPeter A. G. Crosthwaite return desc[0] & DESC_0_RX_WRAP ? 1 : 0; 301e9f186e5SPeter A. G. Crosthwaite } 302e9f186e5SPeter A. G. Crosthwaite 303e9f186e5SPeter A. G. Crosthwaite static inline unsigned rx_desc_get_ownership(unsigned *desc) 304e9f186e5SPeter A. G. Crosthwaite { 305e9f186e5SPeter A. G. Crosthwaite return desc[0] & DESC_0_RX_OWNERSHIP ? 1 : 0; 306e9f186e5SPeter A. G. Crosthwaite } 307e9f186e5SPeter A. G. Crosthwaite 308e9f186e5SPeter A. G. Crosthwaite static inline void rx_desc_set_ownership(unsigned *desc) 309e9f186e5SPeter A. G. Crosthwaite { 310e9f186e5SPeter A. G. Crosthwaite desc[0] |= DESC_0_RX_OWNERSHIP; 311e9f186e5SPeter A. G. Crosthwaite } 312e9f186e5SPeter A. G. Crosthwaite 313e9f186e5SPeter A. G. Crosthwaite static inline void rx_desc_set_sof(unsigned *desc) 314e9f186e5SPeter A. G. Crosthwaite { 315e9f186e5SPeter A. G. Crosthwaite desc[1] |= DESC_1_RX_SOF; 316e9f186e5SPeter A. G. Crosthwaite } 317e9f186e5SPeter A. G. Crosthwaite 318e9f186e5SPeter A. G. Crosthwaite static inline void rx_desc_set_eof(unsigned *desc) 319e9f186e5SPeter A. G. Crosthwaite { 320e9f186e5SPeter A. G. Crosthwaite desc[1] |= DESC_1_RX_EOF; 321e9f186e5SPeter A. G. Crosthwaite } 322e9f186e5SPeter A. G. Crosthwaite 323e9f186e5SPeter A. G. Crosthwaite static inline void rx_desc_set_length(unsigned *desc, unsigned len) 324e9f186e5SPeter A. G. Crosthwaite { 325e9f186e5SPeter A. G. Crosthwaite desc[1] &= ~DESC_1_LENGTH; 326e9f186e5SPeter A. G. Crosthwaite desc[1] |= len; 327e9f186e5SPeter A. G. Crosthwaite } 328e9f186e5SPeter A. G. Crosthwaite 329*63af1e0cSPeter Crosthwaite static inline void rx_desc_set_broadcast(unsigned *desc) 330*63af1e0cSPeter Crosthwaite { 331*63af1e0cSPeter Crosthwaite desc[1] |= R_DESC_1_RX_BROADCAST; 332*63af1e0cSPeter Crosthwaite } 333*63af1e0cSPeter Crosthwaite 334*63af1e0cSPeter Crosthwaite static inline void rx_desc_set_unicast_hash(unsigned *desc) 335*63af1e0cSPeter Crosthwaite { 336*63af1e0cSPeter Crosthwaite desc[1] |= R_DESC_1_RX_UNICAST_HASH; 337*63af1e0cSPeter Crosthwaite } 338*63af1e0cSPeter Crosthwaite 339*63af1e0cSPeter Crosthwaite static inline void rx_desc_set_multicast_hash(unsigned *desc) 340*63af1e0cSPeter Crosthwaite { 341*63af1e0cSPeter Crosthwaite desc[1] |= R_DESC_1_RX_MULTICAST_HASH; 342*63af1e0cSPeter Crosthwaite } 343*63af1e0cSPeter Crosthwaite 344*63af1e0cSPeter Crosthwaite static inline void rx_desc_set_sar(unsigned *desc, int sar_idx) 345*63af1e0cSPeter Crosthwaite { 346*63af1e0cSPeter Crosthwaite desc[1] = deposit32(desc[1], R_DESC_1_RX_SAR_SHIFT, R_DESC_1_RX_SAR_LENGTH, 347*63af1e0cSPeter Crosthwaite sar_idx); 348*63af1e0cSPeter Crosthwaite } 349*63af1e0cSPeter Crosthwaite 350318643beSAndreas Färber #define TYPE_CADENCE_GEM "cadence_gem" 351318643beSAndreas Färber #define GEM(obj) OBJECT_CHECK(GemState, (obj), TYPE_CADENCE_GEM) 352318643beSAndreas Färber 353318643beSAndreas Färber typedef struct GemState { 354318643beSAndreas Färber SysBusDevice parent_obj; 355318643beSAndreas Färber 356e9f186e5SPeter A. G. Crosthwaite MemoryRegion iomem; 357e9f186e5SPeter A. G. Crosthwaite NICState *nic; 358e9f186e5SPeter A. G. Crosthwaite NICConf conf; 359e9f186e5SPeter A. G. Crosthwaite qemu_irq irq; 360e9f186e5SPeter A. G. Crosthwaite 361e9f186e5SPeter A. G. Crosthwaite /* GEM registers backing store */ 362e9f186e5SPeter A. G. Crosthwaite uint32_t regs[GEM_MAXREG]; 363e9f186e5SPeter A. G. Crosthwaite /* Mask of register bits which are write only */ 364e9f186e5SPeter A. G. Crosthwaite uint32_t regs_wo[GEM_MAXREG]; 365e9f186e5SPeter A. G. Crosthwaite /* Mask of register bits which are read only */ 366e9f186e5SPeter A. G. Crosthwaite uint32_t regs_ro[GEM_MAXREG]; 367e9f186e5SPeter A. G. Crosthwaite /* Mask of register bits which are clear on read */ 368e9f186e5SPeter A. G. Crosthwaite uint32_t regs_rtc[GEM_MAXREG]; 369e9f186e5SPeter A. G. Crosthwaite /* Mask of register bits which are write 1 to clear */ 370e9f186e5SPeter A. G. Crosthwaite uint32_t regs_w1c[GEM_MAXREG]; 371e9f186e5SPeter A. G. Crosthwaite 372e9f186e5SPeter A. G. Crosthwaite /* PHY registers backing store */ 373e9f186e5SPeter A. G. Crosthwaite uint16_t phy_regs[32]; 374e9f186e5SPeter A. G. Crosthwaite 375e9f186e5SPeter A. G. Crosthwaite uint8_t phy_loop; /* Are we in phy loopback? */ 376e9f186e5SPeter A. G. Crosthwaite 377e9f186e5SPeter A. G. Crosthwaite /* The current DMA descriptor pointers */ 3788279e042SPeter Maydell uint32_t rx_desc_addr; 3798279e042SPeter Maydell uint32_t tx_desc_addr; 380e9f186e5SPeter A. G. Crosthwaite 38106c2fe95SPeter Crosthwaite unsigned rx_desc[2]; 38206c2fe95SPeter Crosthwaite 383e9f186e5SPeter A. G. Crosthwaite } GemState; 384e9f186e5SPeter A. G. Crosthwaite 385e9f186e5SPeter A. G. Crosthwaite /* The broadcast MAC address: 0xFFFFFFFFFFFF */ 386e9f186e5SPeter A. G. Crosthwaite const uint8_t broadcast_addr[] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF }; 387e9f186e5SPeter A. G. Crosthwaite 388e9f186e5SPeter A. G. Crosthwaite /* 389e9f186e5SPeter A. G. Crosthwaite * gem_init_register_masks: 390e9f186e5SPeter A. G. Crosthwaite * One time initialization. 391e9f186e5SPeter A. G. Crosthwaite * Set masks to identify which register bits have magical clear properties 392e9f186e5SPeter A. G. Crosthwaite */ 393e9f186e5SPeter A. G. Crosthwaite static void gem_init_register_masks(GemState *s) 394e9f186e5SPeter A. G. Crosthwaite { 395e9f186e5SPeter A. G. Crosthwaite /* Mask of register bits which are read only*/ 396e9f186e5SPeter A. G. Crosthwaite memset(&s->regs_ro[0], 0, sizeof(s->regs_ro)); 397e9f186e5SPeter A. G. Crosthwaite s->regs_ro[GEM_NWCTRL] = 0xFFF80000; 398e9f186e5SPeter A. G. Crosthwaite s->regs_ro[GEM_NWSTATUS] = 0xFFFFFFFF; 399e9f186e5SPeter A. G. Crosthwaite s->regs_ro[GEM_DMACFG] = 0xFE00F000; 400e9f186e5SPeter A. G. Crosthwaite s->regs_ro[GEM_TXSTATUS] = 0xFFFFFE08; 401e9f186e5SPeter A. G. Crosthwaite s->regs_ro[GEM_RXQBASE] = 0x00000003; 402e9f186e5SPeter A. G. Crosthwaite s->regs_ro[GEM_TXQBASE] = 0x00000003; 403e9f186e5SPeter A. G. Crosthwaite s->regs_ro[GEM_RXSTATUS] = 0xFFFFFFF0; 404e9f186e5SPeter A. G. Crosthwaite s->regs_ro[GEM_ISR] = 0xFFFFFFFF; 405e9f186e5SPeter A. G. Crosthwaite s->regs_ro[GEM_IMR] = 0xFFFFFFFF; 406e9f186e5SPeter A. G. Crosthwaite s->regs_ro[GEM_MODID] = 0xFFFFFFFF; 407e9f186e5SPeter A. G. Crosthwaite 408e9f186e5SPeter A. G. Crosthwaite /* Mask of register bits which are clear on read */ 409e9f186e5SPeter A. G. Crosthwaite memset(&s->regs_rtc[0], 0, sizeof(s->regs_rtc)); 410e9f186e5SPeter A. G. Crosthwaite s->regs_rtc[GEM_ISR] = 0xFFFFFFFF; 411e9f186e5SPeter A. G. Crosthwaite 412e9f186e5SPeter A. G. Crosthwaite /* Mask of register bits which are write 1 to clear */ 413e9f186e5SPeter A. G. Crosthwaite memset(&s->regs_w1c[0], 0, sizeof(s->regs_w1c)); 414e9f186e5SPeter A. G. Crosthwaite s->regs_w1c[GEM_TXSTATUS] = 0x000001F7; 415e9f186e5SPeter A. G. Crosthwaite s->regs_w1c[GEM_RXSTATUS] = 0x0000000F; 416e9f186e5SPeter A. G. Crosthwaite 417e9f186e5SPeter A. G. Crosthwaite /* Mask of register bits which are write only */ 418e9f186e5SPeter A. G. Crosthwaite memset(&s->regs_wo[0], 0, sizeof(s->regs_wo)); 419e9f186e5SPeter A. G. Crosthwaite s->regs_wo[GEM_NWCTRL] = 0x00073E60; 420e9f186e5SPeter A. G. Crosthwaite s->regs_wo[GEM_IER] = 0x07FFFFFF; 421e9f186e5SPeter A. G. Crosthwaite s->regs_wo[GEM_IDR] = 0x07FFFFFF; 422e9f186e5SPeter A. G. Crosthwaite } 423e9f186e5SPeter A. G. Crosthwaite 424e9f186e5SPeter A. G. Crosthwaite /* 425e9f186e5SPeter A. G. Crosthwaite * phy_update_link: 426e9f186e5SPeter A. G. Crosthwaite * Make the emulated PHY link state match the QEMU "interface" state. 427e9f186e5SPeter A. G. Crosthwaite */ 428e9f186e5SPeter A. G. Crosthwaite static void phy_update_link(GemState *s) 429e9f186e5SPeter A. G. Crosthwaite { 430b356f76dSJason Wang DB_PRINT("down %d\n", qemu_get_queue(s->nic)->link_down); 431e9f186e5SPeter A. G. Crosthwaite 432e9f186e5SPeter A. G. Crosthwaite /* Autonegotiation status mirrors link status. */ 433b356f76dSJason Wang if (qemu_get_queue(s->nic)->link_down) { 434e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_STATUS] &= ~(PHY_REG_STATUS_ANEGCMPL | 435e9f186e5SPeter A. G. Crosthwaite PHY_REG_STATUS_LINK); 436e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_INT_ST] |= PHY_REG_INT_ST_LINKC; 437e9f186e5SPeter A. G. Crosthwaite } else { 438e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_STATUS] |= (PHY_REG_STATUS_ANEGCMPL | 439e9f186e5SPeter A. G. Crosthwaite PHY_REG_STATUS_LINK); 440e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_INT_ST] |= (PHY_REG_INT_ST_LINKC | 441e9f186e5SPeter A. G. Crosthwaite PHY_REG_INT_ST_ANEGCMPL | 442e9f186e5SPeter A. G. Crosthwaite PHY_REG_INT_ST_ENERGY); 443e9f186e5SPeter A. G. Crosthwaite } 444e9f186e5SPeter A. G. Crosthwaite } 445e9f186e5SPeter A. G. Crosthwaite 4464e68f7a0SStefan Hajnoczi static int gem_can_receive(NetClientState *nc) 447e9f186e5SPeter A. G. Crosthwaite { 448e9f186e5SPeter A. G. Crosthwaite GemState *s; 449e9f186e5SPeter A. G. Crosthwaite 450cc1f0f45SJason Wang s = qemu_get_nic_opaque(nc); 451e9f186e5SPeter A. G. Crosthwaite 452e9f186e5SPeter A. G. Crosthwaite DB_PRINT("\n"); 453e9f186e5SPeter A. G. Crosthwaite 454e9f186e5SPeter A. G. Crosthwaite /* Do nothing if receive is not enabled. */ 455e9f186e5SPeter A. G. Crosthwaite if (!(s->regs[GEM_NWCTRL] & GEM_NWCTRL_RXENA)) { 456e9f186e5SPeter A. G. Crosthwaite return 0; 457e9f186e5SPeter A. G. Crosthwaite } 458e9f186e5SPeter A. G. Crosthwaite 459e9f186e5SPeter A. G. Crosthwaite return 1; 460e9f186e5SPeter A. G. Crosthwaite } 461e9f186e5SPeter A. G. Crosthwaite 462e9f186e5SPeter A. G. Crosthwaite /* 463e9f186e5SPeter A. G. Crosthwaite * gem_update_int_status: 464e9f186e5SPeter A. G. Crosthwaite * Raise or lower interrupt based on current status. 465e9f186e5SPeter A. G. Crosthwaite */ 466e9f186e5SPeter A. G. Crosthwaite static void gem_update_int_status(GemState *s) 467e9f186e5SPeter A. G. Crosthwaite { 468e9f186e5SPeter A. G. Crosthwaite if (s->regs[GEM_ISR]) { 469e9f186e5SPeter A. G. Crosthwaite DB_PRINT("asserting int. (0x%08x)\n", s->regs[GEM_ISR]); 470e9f186e5SPeter A. G. Crosthwaite qemu_set_irq(s->irq, 1); 471e9f186e5SPeter A. G. Crosthwaite } 472e9f186e5SPeter A. G. Crosthwaite } 473e9f186e5SPeter A. G. Crosthwaite 474e9f186e5SPeter A. G. Crosthwaite /* 475e9f186e5SPeter A. G. Crosthwaite * gem_receive_updatestats: 476e9f186e5SPeter A. G. Crosthwaite * Increment receive statistics. 477e9f186e5SPeter A. G. Crosthwaite */ 478e9f186e5SPeter A. G. Crosthwaite static void gem_receive_updatestats(GemState *s, const uint8_t *packet, 479e9f186e5SPeter A. G. Crosthwaite unsigned bytes) 480e9f186e5SPeter A. G. Crosthwaite { 481e9f186e5SPeter A. G. Crosthwaite uint64_t octets; 482e9f186e5SPeter A. G. Crosthwaite 483e9f186e5SPeter A. G. Crosthwaite /* Total octets (bytes) received */ 484e9f186e5SPeter A. G. Crosthwaite octets = ((uint64_t)(s->regs[GEM_OCTRXLO]) << 32) | 485e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_OCTRXHI]; 486e9f186e5SPeter A. G. Crosthwaite octets += bytes; 487e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_OCTRXLO] = octets >> 32; 488e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_OCTRXHI] = octets; 489e9f186e5SPeter A. G. Crosthwaite 490e9f186e5SPeter A. G. Crosthwaite /* Error-free Frames received */ 491e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_RXCNT]++; 492e9f186e5SPeter A. G. Crosthwaite 493e9f186e5SPeter A. G. Crosthwaite /* Error-free Broadcast Frames counter */ 494e9f186e5SPeter A. G. Crosthwaite if (!memcmp(packet, broadcast_addr, 6)) { 495e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_RXBROADCNT]++; 496e9f186e5SPeter A. G. Crosthwaite } 497e9f186e5SPeter A. G. Crosthwaite 498e9f186e5SPeter A. G. Crosthwaite /* Error-free Multicast Frames counter */ 499e9f186e5SPeter A. G. Crosthwaite if (packet[0] == 0x01) { 500e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_RXMULTICNT]++; 501e9f186e5SPeter A. G. Crosthwaite } 502e9f186e5SPeter A. G. Crosthwaite 503e9f186e5SPeter A. G. Crosthwaite if (bytes <= 64) { 504e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_RX64CNT]++; 505e9f186e5SPeter A. G. Crosthwaite } else if (bytes <= 127) { 506e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_RX65CNT]++; 507e9f186e5SPeter A. G. Crosthwaite } else if (bytes <= 255) { 508e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_RX128CNT]++; 509e9f186e5SPeter A. G. Crosthwaite } else if (bytes <= 511) { 510e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_RX256CNT]++; 511e9f186e5SPeter A. G. Crosthwaite } else if (bytes <= 1023) { 512e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_RX512CNT]++; 513e9f186e5SPeter A. G. Crosthwaite } else if (bytes <= 1518) { 514e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_RX1024CNT]++; 515e9f186e5SPeter A. G. Crosthwaite } else { 516e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_RX1519CNT]++; 517e9f186e5SPeter A. G. Crosthwaite } 518e9f186e5SPeter A. G. Crosthwaite } 519e9f186e5SPeter A. G. Crosthwaite 520e9f186e5SPeter A. G. Crosthwaite /* 521e9f186e5SPeter A. G. Crosthwaite * Get the MAC Address bit from the specified position 522e9f186e5SPeter A. G. Crosthwaite */ 523e9f186e5SPeter A. G. Crosthwaite static unsigned get_bit(const uint8_t *mac, unsigned bit) 524e9f186e5SPeter A. G. Crosthwaite { 525e9f186e5SPeter A. G. Crosthwaite unsigned byte; 526e9f186e5SPeter A. G. Crosthwaite 527e9f186e5SPeter A. G. Crosthwaite byte = mac[bit / 8]; 528e9f186e5SPeter A. G. Crosthwaite byte >>= (bit & 0x7); 529e9f186e5SPeter A. G. Crosthwaite byte &= 1; 530e9f186e5SPeter A. G. Crosthwaite 531e9f186e5SPeter A. G. Crosthwaite return byte; 532e9f186e5SPeter A. G. Crosthwaite } 533e9f186e5SPeter A. G. Crosthwaite 534e9f186e5SPeter A. G. Crosthwaite /* 535e9f186e5SPeter A. G. Crosthwaite * Calculate a GEM MAC Address hash index 536e9f186e5SPeter A. G. Crosthwaite */ 537e9f186e5SPeter A. G. Crosthwaite static unsigned calc_mac_hash(const uint8_t *mac) 538e9f186e5SPeter A. G. Crosthwaite { 539e9f186e5SPeter A. G. Crosthwaite int index_bit, mac_bit; 540e9f186e5SPeter A. G. Crosthwaite unsigned hash_index; 541e9f186e5SPeter A. G. Crosthwaite 542e9f186e5SPeter A. G. Crosthwaite hash_index = 0; 543e9f186e5SPeter A. G. Crosthwaite mac_bit = 5; 544e9f186e5SPeter A. G. Crosthwaite for (index_bit = 5; index_bit >= 0; index_bit--) { 545e9f186e5SPeter A. G. Crosthwaite hash_index |= (get_bit(mac, mac_bit) ^ 546e9f186e5SPeter A. G. Crosthwaite get_bit(mac, mac_bit + 6) ^ 547e9f186e5SPeter A. G. Crosthwaite get_bit(mac, mac_bit + 12) ^ 548e9f186e5SPeter A. G. Crosthwaite get_bit(mac, mac_bit + 18) ^ 549e9f186e5SPeter A. G. Crosthwaite get_bit(mac, mac_bit + 24) ^ 550e9f186e5SPeter A. G. Crosthwaite get_bit(mac, mac_bit + 30) ^ 551e9f186e5SPeter A. G. Crosthwaite get_bit(mac, mac_bit + 36) ^ 552e9f186e5SPeter A. G. Crosthwaite get_bit(mac, mac_bit + 42)) << index_bit; 553e9f186e5SPeter A. G. Crosthwaite mac_bit--; 554e9f186e5SPeter A. G. Crosthwaite } 555e9f186e5SPeter A. G. Crosthwaite 556e9f186e5SPeter A. G. Crosthwaite return hash_index; 557e9f186e5SPeter A. G. Crosthwaite } 558e9f186e5SPeter A. G. Crosthwaite 559e9f186e5SPeter A. G. Crosthwaite /* 560e9f186e5SPeter A. G. Crosthwaite * gem_mac_address_filter: 561e9f186e5SPeter A. G. Crosthwaite * Accept or reject this destination address? 562e9f186e5SPeter A. G. Crosthwaite * Returns: 563e9f186e5SPeter A. G. Crosthwaite * GEM_RX_REJECT: reject 564*63af1e0cSPeter Crosthwaite * >= 0: Specific address accept (which matched SAR is returned) 565*63af1e0cSPeter Crosthwaite * others for various other modes of accept: 566*63af1e0cSPeter Crosthwaite * GEM_RM_PROMISCUOUS_ACCEPT, GEM_RX_BROADCAST_ACCEPT, 567*63af1e0cSPeter Crosthwaite * GEM_RX_MULTICAST_HASH_ACCEPT or GEM_RX_UNICAST_HASH_ACCEPT 568e9f186e5SPeter A. G. Crosthwaite */ 569e9f186e5SPeter A. G. Crosthwaite static int gem_mac_address_filter(GemState *s, const uint8_t *packet) 570e9f186e5SPeter A. G. Crosthwaite { 571e9f186e5SPeter A. G. Crosthwaite uint8_t *gem_spaddr; 572e9f186e5SPeter A. G. Crosthwaite int i; 573e9f186e5SPeter A. G. Crosthwaite 574e9f186e5SPeter A. G. Crosthwaite /* Promiscuous mode? */ 575e9f186e5SPeter A. G. Crosthwaite if (s->regs[GEM_NWCFG] & GEM_NWCFG_PROMISC) { 576*63af1e0cSPeter Crosthwaite return GEM_RX_PROMISCUOUS_ACCEPT; 577e9f186e5SPeter A. G. Crosthwaite } 578e9f186e5SPeter A. G. Crosthwaite 579e9f186e5SPeter A. G. Crosthwaite if (!memcmp(packet, broadcast_addr, 6)) { 580e9f186e5SPeter A. G. Crosthwaite /* Reject broadcast packets? */ 581e9f186e5SPeter A. G. Crosthwaite if (s->regs[GEM_NWCFG] & GEM_NWCFG_BCAST_REJ) { 582e9f186e5SPeter A. G. Crosthwaite return GEM_RX_REJECT; 583e9f186e5SPeter A. G. Crosthwaite } 584*63af1e0cSPeter Crosthwaite return GEM_RX_BROADCAST_ACCEPT; 585e9f186e5SPeter A. G. Crosthwaite } 586e9f186e5SPeter A. G. Crosthwaite 587e9f186e5SPeter A. G. Crosthwaite /* Accept packets -w- hash match? */ 588e9f186e5SPeter A. G. Crosthwaite if ((packet[0] == 0x01 && (s->regs[GEM_NWCFG] & GEM_NWCFG_MCAST_HASH)) || 589e9f186e5SPeter A. G. Crosthwaite (packet[0] != 0x01 && (s->regs[GEM_NWCFG] & GEM_NWCFG_UCAST_HASH))) { 590e9f186e5SPeter A. G. Crosthwaite unsigned hash_index; 591e9f186e5SPeter A. G. Crosthwaite 592e9f186e5SPeter A. G. Crosthwaite hash_index = calc_mac_hash(packet); 593e9f186e5SPeter A. G. Crosthwaite if (hash_index < 32) { 594e9f186e5SPeter A. G. Crosthwaite if (s->regs[GEM_HASHLO] & (1<<hash_index)) { 595*63af1e0cSPeter Crosthwaite return packet[0] == 0x01 ? GEM_RX_MULTICAST_HASH_ACCEPT : 596*63af1e0cSPeter Crosthwaite GEM_RX_UNICAST_HASH_ACCEPT; 597e9f186e5SPeter A. G. Crosthwaite } 598e9f186e5SPeter A. G. Crosthwaite } else { 599e9f186e5SPeter A. G. Crosthwaite hash_index -= 32; 600e9f186e5SPeter A. G. Crosthwaite if (s->regs[GEM_HASHHI] & (1<<hash_index)) { 601*63af1e0cSPeter Crosthwaite return packet[0] == 0x01 ? GEM_RX_MULTICAST_HASH_ACCEPT : 602*63af1e0cSPeter Crosthwaite GEM_RX_UNICAST_HASH_ACCEPT; 603e9f186e5SPeter A. G. Crosthwaite } 604e9f186e5SPeter A. G. Crosthwaite } 605e9f186e5SPeter A. G. Crosthwaite } 606e9f186e5SPeter A. G. Crosthwaite 607e9f186e5SPeter A. G. Crosthwaite /* Check all 4 specific addresses */ 608e9f186e5SPeter A. G. Crosthwaite gem_spaddr = (uint8_t *)&(s->regs[GEM_SPADDR1LO]); 609*63af1e0cSPeter Crosthwaite for (i = 3; i >= 0; i--) { 610*63af1e0cSPeter Crosthwaite if (!memcmp(packet, gem_spaddr + 8 * i, 6)) { 611*63af1e0cSPeter Crosthwaite return GEM_RX_SAR_ACCEPT + i; 612e9f186e5SPeter A. G. Crosthwaite } 613e9f186e5SPeter A. G. Crosthwaite } 614e9f186e5SPeter A. G. Crosthwaite 615e9f186e5SPeter A. G. Crosthwaite /* No address match; reject the packet */ 616e9f186e5SPeter A. G. Crosthwaite return GEM_RX_REJECT; 617e9f186e5SPeter A. G. Crosthwaite } 618e9f186e5SPeter A. G. Crosthwaite 61906c2fe95SPeter Crosthwaite static void gem_get_rx_desc(GemState *s) 62006c2fe95SPeter Crosthwaite { 62106c2fe95SPeter Crosthwaite DB_PRINT("read descriptor 0x%x\n", (unsigned)s->rx_desc_addr); 62206c2fe95SPeter Crosthwaite /* read current descriptor */ 62306c2fe95SPeter Crosthwaite cpu_physical_memory_read(s->rx_desc_addr, 62406c2fe95SPeter Crosthwaite (uint8_t *)s->rx_desc, sizeof(s->rx_desc)); 62506c2fe95SPeter Crosthwaite 62606c2fe95SPeter Crosthwaite /* Descriptor owned by software ? */ 62706c2fe95SPeter Crosthwaite if (rx_desc_get_ownership(s->rx_desc) == 1) { 62806c2fe95SPeter Crosthwaite DB_PRINT("descriptor 0x%x owned by sw.\n", 62906c2fe95SPeter Crosthwaite (unsigned)s->rx_desc_addr); 63006c2fe95SPeter Crosthwaite s->regs[GEM_RXSTATUS] |= GEM_RXSTATUS_NOBUF; 63106c2fe95SPeter Crosthwaite s->regs[GEM_ISR] |= GEM_INT_RXUSED & ~(s->regs[GEM_IMR]); 63206c2fe95SPeter Crosthwaite /* Handle interrupt consequences */ 63306c2fe95SPeter Crosthwaite gem_update_int_status(s); 63406c2fe95SPeter Crosthwaite } 63506c2fe95SPeter Crosthwaite } 63606c2fe95SPeter Crosthwaite 637e9f186e5SPeter A. G. Crosthwaite /* 638e9f186e5SPeter A. G. Crosthwaite * gem_receive: 639e9f186e5SPeter A. G. Crosthwaite * Fit a packet handed to us by QEMU into the receive descriptor ring. 640e9f186e5SPeter A. G. Crosthwaite */ 6414e68f7a0SStefan Hajnoczi static ssize_t gem_receive(NetClientState *nc, const uint8_t *buf, size_t size) 642e9f186e5SPeter A. G. Crosthwaite { 643e9f186e5SPeter A. G. Crosthwaite GemState *s; 644e9f186e5SPeter A. G. Crosthwaite unsigned rxbufsize, bytes_to_copy; 645e9f186e5SPeter A. G. Crosthwaite unsigned rxbuf_offset; 646e9f186e5SPeter A. G. Crosthwaite uint8_t rxbuf[2048]; 647e9f186e5SPeter A. G. Crosthwaite uint8_t *rxbuf_ptr; 6483b2c97f9SEdgar E. Iglesias bool first_desc = true; 649*63af1e0cSPeter Crosthwaite int maf; 650e9f186e5SPeter A. G. Crosthwaite 651cc1f0f45SJason Wang s = qemu_get_nic_opaque(nc); 652e9f186e5SPeter A. G. Crosthwaite 653e9f186e5SPeter A. G. Crosthwaite /* Is this destination MAC address "for us" ? */ 654*63af1e0cSPeter Crosthwaite maf = gem_mac_address_filter(s, buf); 655*63af1e0cSPeter Crosthwaite if (maf == GEM_RX_REJECT) { 656e9f186e5SPeter A. G. Crosthwaite return -1; 657e9f186e5SPeter A. G. Crosthwaite } 658e9f186e5SPeter A. G. Crosthwaite 659e9f186e5SPeter A. G. Crosthwaite /* Discard packets with receive length error enabled ? */ 660e9f186e5SPeter A. G. Crosthwaite if (s->regs[GEM_NWCFG] & GEM_NWCFG_LERR_DISC) { 661e9f186e5SPeter A. G. Crosthwaite unsigned type_len; 662e9f186e5SPeter A. G. Crosthwaite 663e9f186e5SPeter A. G. Crosthwaite /* Fish the ethertype / length field out of the RX packet */ 664e9f186e5SPeter A. G. Crosthwaite type_len = buf[12] << 8 | buf[13]; 665e9f186e5SPeter A. G. Crosthwaite /* It is a length field, not an ethertype */ 666e9f186e5SPeter A. G. Crosthwaite if (type_len < 0x600) { 667e9f186e5SPeter A. G. Crosthwaite if (size < type_len) { 668e9f186e5SPeter A. G. Crosthwaite /* discard */ 669e9f186e5SPeter A. G. Crosthwaite return -1; 670e9f186e5SPeter A. G. Crosthwaite } 671e9f186e5SPeter A. G. Crosthwaite } 672e9f186e5SPeter A. G. Crosthwaite } 673e9f186e5SPeter A. G. Crosthwaite 674e9f186e5SPeter A. G. Crosthwaite /* 675e9f186e5SPeter A. G. Crosthwaite * Determine configured receive buffer offset (probably 0) 676e9f186e5SPeter A. G. Crosthwaite */ 677e9f186e5SPeter A. G. Crosthwaite rxbuf_offset = (s->regs[GEM_NWCFG] & GEM_NWCFG_BUFF_OFST_M) >> 678e9f186e5SPeter A. G. Crosthwaite GEM_NWCFG_BUFF_OFST_S; 679e9f186e5SPeter A. G. Crosthwaite 680e9f186e5SPeter A. G. Crosthwaite /* The configure size of each receive buffer. Determines how many 681e9f186e5SPeter A. G. Crosthwaite * buffers needed to hold this packet. 682e9f186e5SPeter A. G. Crosthwaite */ 683e9f186e5SPeter A. G. Crosthwaite rxbufsize = ((s->regs[GEM_DMACFG] & GEM_DMACFG_RBUFSZ_M) >> 684e9f186e5SPeter A. G. Crosthwaite GEM_DMACFG_RBUFSZ_S) * GEM_DMACFG_RBUFSZ_MUL; 685e9f186e5SPeter A. G. Crosthwaite bytes_to_copy = size; 686e9f186e5SPeter A. G. Crosthwaite 687e9f186e5SPeter A. G. Crosthwaite /* Strip of FCS field ? (usually yes) */ 688e9f186e5SPeter A. G. Crosthwaite if (s->regs[GEM_NWCFG] & GEM_NWCFG_STRIP_FCS) { 689e9f186e5SPeter A. G. Crosthwaite rxbuf_ptr = (void *)buf; 690e9f186e5SPeter A. G. Crosthwaite } else { 691e9f186e5SPeter A. G. Crosthwaite unsigned crc_val; 692e9f186e5SPeter A. G. Crosthwaite int crc_offset; 693e9f186e5SPeter A. G. Crosthwaite 694e9f186e5SPeter A. G. Crosthwaite /* The application wants the FCS field, which QEMU does not provide. 695e9f186e5SPeter A. G. Crosthwaite * We must try and caclculate one. 696e9f186e5SPeter A. G. Crosthwaite */ 697e9f186e5SPeter A. G. Crosthwaite 698e9f186e5SPeter A. G. Crosthwaite memcpy(rxbuf, buf, size); 6995fbe02e8SJim Meyering memset(rxbuf + size, 0, sizeof(rxbuf) - size); 700e9f186e5SPeter A. G. Crosthwaite rxbuf_ptr = rxbuf; 701e9f186e5SPeter A. G. Crosthwaite crc_val = cpu_to_le32(crc32(0, rxbuf, MAX(size, 60))); 702e9f186e5SPeter A. G. Crosthwaite if (size < 60) { 703e9f186e5SPeter A. G. Crosthwaite crc_offset = 60; 704e9f186e5SPeter A. G. Crosthwaite } else { 705e9f186e5SPeter A. G. Crosthwaite crc_offset = size; 706e9f186e5SPeter A. G. Crosthwaite } 707e9f186e5SPeter A. G. Crosthwaite memcpy(rxbuf + crc_offset, &crc_val, sizeof(crc_val)); 708e9f186e5SPeter A. G. Crosthwaite 709e9f186e5SPeter A. G. Crosthwaite bytes_to_copy += 4; 710e9f186e5SPeter A. G. Crosthwaite size += 4; 711e9f186e5SPeter A. G. Crosthwaite } 712e9f186e5SPeter A. G. Crosthwaite 713e9f186e5SPeter A. G. Crosthwaite /* Pad to minimum length */ 714e9f186e5SPeter A. G. Crosthwaite if (size < 64) { 715e9f186e5SPeter A. G. Crosthwaite size = 64; 716e9f186e5SPeter A. G. Crosthwaite } 717e9f186e5SPeter A. G. Crosthwaite 718e9f186e5SPeter A. G. Crosthwaite DB_PRINT("config bufsize: %d packet size: %ld\n", rxbufsize, size); 719e9f186e5SPeter A. G. Crosthwaite 7207cfd65e4SPeter Crosthwaite while (bytes_to_copy) { 72106c2fe95SPeter Crosthwaite /* Do nothing if receive is not enabled. */ 72206c2fe95SPeter Crosthwaite if (!gem_can_receive(nc)) { 72306c2fe95SPeter Crosthwaite assert(!first_desc); 724e9f186e5SPeter A. G. Crosthwaite return -1; 725e9f186e5SPeter A. G. Crosthwaite } 726e9f186e5SPeter A. G. Crosthwaite 727e9f186e5SPeter A. G. Crosthwaite DB_PRINT("copy %d bytes to 0x%x\n", MIN(bytes_to_copy, rxbufsize), 72806c2fe95SPeter Crosthwaite rx_desc_get_buffer(s->rx_desc)); 729e9f186e5SPeter A. G. Crosthwaite 730e9f186e5SPeter A. G. Crosthwaite /* Copy packet data to emulated DMA buffer */ 73106c2fe95SPeter Crosthwaite cpu_physical_memory_write(rx_desc_get_buffer(s->rx_desc) + rxbuf_offset, 732e9f186e5SPeter A. G. Crosthwaite rxbuf_ptr, MIN(bytes_to_copy, rxbufsize)); 733e9f186e5SPeter A. G. Crosthwaite bytes_to_copy -= MIN(bytes_to_copy, rxbufsize); 734e9f186e5SPeter A. G. Crosthwaite rxbuf_ptr += MIN(bytes_to_copy, rxbufsize); 7353b2c97f9SEdgar E. Iglesias 7363b2c97f9SEdgar E. Iglesias /* Update the descriptor. */ 7373b2c97f9SEdgar E. Iglesias if (first_desc) { 73806c2fe95SPeter Crosthwaite rx_desc_set_sof(s->rx_desc); 7393b2c97f9SEdgar E. Iglesias first_desc = false; 7403b2c97f9SEdgar E. Iglesias } 7413b2c97f9SEdgar E. Iglesias if (bytes_to_copy == 0) { 74206c2fe95SPeter Crosthwaite rx_desc_set_eof(s->rx_desc); 74306c2fe95SPeter Crosthwaite rx_desc_set_length(s->rx_desc, size); 7443b2c97f9SEdgar E. Iglesias } 74506c2fe95SPeter Crosthwaite rx_desc_set_ownership(s->rx_desc); 746*63af1e0cSPeter Crosthwaite 747*63af1e0cSPeter Crosthwaite switch (maf) { 748*63af1e0cSPeter Crosthwaite case GEM_RX_PROMISCUOUS_ACCEPT: 749*63af1e0cSPeter Crosthwaite break; 750*63af1e0cSPeter Crosthwaite case GEM_RX_BROADCAST_ACCEPT: 751*63af1e0cSPeter Crosthwaite rx_desc_set_broadcast(s->rx_desc); 752*63af1e0cSPeter Crosthwaite break; 753*63af1e0cSPeter Crosthwaite case GEM_RX_UNICAST_HASH_ACCEPT: 754*63af1e0cSPeter Crosthwaite rx_desc_set_unicast_hash(s->rx_desc); 755*63af1e0cSPeter Crosthwaite break; 756*63af1e0cSPeter Crosthwaite case GEM_RX_MULTICAST_HASH_ACCEPT: 757*63af1e0cSPeter Crosthwaite rx_desc_set_multicast_hash(s->rx_desc); 758*63af1e0cSPeter Crosthwaite break; 759*63af1e0cSPeter Crosthwaite case GEM_RX_REJECT: 760*63af1e0cSPeter Crosthwaite abort(); 761*63af1e0cSPeter Crosthwaite default: /* SAR */ 762*63af1e0cSPeter Crosthwaite rx_desc_set_sar(s->rx_desc, maf); 763*63af1e0cSPeter Crosthwaite } 764*63af1e0cSPeter Crosthwaite 7653b2c97f9SEdgar E. Iglesias /* Descriptor write-back. */ 7667cfd65e4SPeter Crosthwaite cpu_physical_memory_write(s->rx_desc_addr, 76706c2fe95SPeter Crosthwaite (uint8_t *)s->rx_desc, sizeof(s->rx_desc)); 7683b2c97f9SEdgar E. Iglesias 769e9f186e5SPeter A. G. Crosthwaite /* Next descriptor */ 77006c2fe95SPeter Crosthwaite if (rx_desc_get_wrap(s->rx_desc)) { 771288f1e3fSPeter Crosthwaite DB_PRINT("wrapping RX descriptor list\n"); 7727cfd65e4SPeter Crosthwaite s->rx_desc_addr = s->regs[GEM_RXQBASE]; 773e9f186e5SPeter A. G. Crosthwaite } else { 774288f1e3fSPeter Crosthwaite DB_PRINT("incrementing RX descriptor list\n"); 775e9f186e5SPeter A. G. Crosthwaite s->rx_desc_addr += 8; 776e9f186e5SPeter A. G. Crosthwaite } 77706c2fe95SPeter Crosthwaite gem_get_rx_desc(s); 7787cfd65e4SPeter Crosthwaite } 779e9f186e5SPeter A. G. Crosthwaite 780e9f186e5SPeter A. G. Crosthwaite /* Count it */ 781e9f186e5SPeter A. G. Crosthwaite gem_receive_updatestats(s, buf, size); 782e9f186e5SPeter A. G. Crosthwaite 783e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_RXSTATUS] |= GEM_RXSTATUS_FRMRCVD; 784ae80a354SPeter Crosthwaite s->regs[GEM_ISR] |= GEM_INT_RXCMPL & ~(s->regs[GEM_IMR]); 785e9f186e5SPeter A. G. Crosthwaite 786e9f186e5SPeter A. G. Crosthwaite /* Handle interrupt consequences */ 787e9f186e5SPeter A. G. Crosthwaite gem_update_int_status(s); 788e9f186e5SPeter A. G. Crosthwaite 789e9f186e5SPeter A. G. Crosthwaite return size; 790e9f186e5SPeter A. G. Crosthwaite } 791e9f186e5SPeter A. G. Crosthwaite 792e9f186e5SPeter A. G. Crosthwaite /* 793e9f186e5SPeter A. G. Crosthwaite * gem_transmit_updatestats: 794e9f186e5SPeter A. G. Crosthwaite * Increment transmit statistics. 795e9f186e5SPeter A. G. Crosthwaite */ 796e9f186e5SPeter A. G. Crosthwaite static void gem_transmit_updatestats(GemState *s, const uint8_t *packet, 797e9f186e5SPeter A. G. Crosthwaite unsigned bytes) 798e9f186e5SPeter A. G. Crosthwaite { 799e9f186e5SPeter A. G. Crosthwaite uint64_t octets; 800e9f186e5SPeter A. G. Crosthwaite 801e9f186e5SPeter A. G. Crosthwaite /* Total octets (bytes) transmitted */ 802e9f186e5SPeter A. G. Crosthwaite octets = ((uint64_t)(s->regs[GEM_OCTTXLO]) << 32) | 803e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_OCTTXHI]; 804e9f186e5SPeter A. G. Crosthwaite octets += bytes; 805e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_OCTTXLO] = octets >> 32; 806e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_OCTTXHI] = octets; 807e9f186e5SPeter A. G. Crosthwaite 808e9f186e5SPeter A. G. Crosthwaite /* Error-free Frames transmitted */ 809e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_TXCNT]++; 810e9f186e5SPeter A. G. Crosthwaite 811e9f186e5SPeter A. G. Crosthwaite /* Error-free Broadcast Frames counter */ 812e9f186e5SPeter A. G. Crosthwaite if (!memcmp(packet, broadcast_addr, 6)) { 813e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_TXBCNT]++; 814e9f186e5SPeter A. G. Crosthwaite } 815e9f186e5SPeter A. G. Crosthwaite 816e9f186e5SPeter A. G. Crosthwaite /* Error-free Multicast Frames counter */ 817e9f186e5SPeter A. G. Crosthwaite if (packet[0] == 0x01) { 818e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_TXMCNT]++; 819e9f186e5SPeter A. G. Crosthwaite } 820e9f186e5SPeter A. G. Crosthwaite 821e9f186e5SPeter A. G. Crosthwaite if (bytes <= 64) { 822e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_TX64CNT]++; 823e9f186e5SPeter A. G. Crosthwaite } else if (bytes <= 127) { 824e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_TX65CNT]++; 825e9f186e5SPeter A. G. Crosthwaite } else if (bytes <= 255) { 826e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_TX128CNT]++; 827e9f186e5SPeter A. G. Crosthwaite } else if (bytes <= 511) { 828e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_TX256CNT]++; 829e9f186e5SPeter A. G. Crosthwaite } else if (bytes <= 1023) { 830e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_TX512CNT]++; 831e9f186e5SPeter A. G. Crosthwaite } else if (bytes <= 1518) { 832e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_TX1024CNT]++; 833e9f186e5SPeter A. G. Crosthwaite } else { 834e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_TX1519CNT]++; 835e9f186e5SPeter A. G. Crosthwaite } 836e9f186e5SPeter A. G. Crosthwaite } 837e9f186e5SPeter A. G. Crosthwaite 838e9f186e5SPeter A. G. Crosthwaite /* 839e9f186e5SPeter A. G. Crosthwaite * gem_transmit: 840e9f186e5SPeter A. G. Crosthwaite * Fish packets out of the descriptor ring and feed them to QEMU 841e9f186e5SPeter A. G. Crosthwaite */ 842e9f186e5SPeter A. G. Crosthwaite static void gem_transmit(GemState *s) 843e9f186e5SPeter A. G. Crosthwaite { 844e9f186e5SPeter A. G. Crosthwaite unsigned desc[2]; 845a8170e5eSAvi Kivity hwaddr packet_desc_addr; 846e9f186e5SPeter A. G. Crosthwaite uint8_t tx_packet[2048]; 847e9f186e5SPeter A. G. Crosthwaite uint8_t *p; 848e9f186e5SPeter A. G. Crosthwaite unsigned total_bytes; 849e9f186e5SPeter A. G. Crosthwaite 850e9f186e5SPeter A. G. Crosthwaite /* Do nothing if transmit is not enabled. */ 851e9f186e5SPeter A. G. Crosthwaite if (!(s->regs[GEM_NWCTRL] & GEM_NWCTRL_TXENA)) { 852e9f186e5SPeter A. G. Crosthwaite return; 853e9f186e5SPeter A. G. Crosthwaite } 854e9f186e5SPeter A. G. Crosthwaite 855e9f186e5SPeter A. G. Crosthwaite DB_PRINT("\n"); 856e9f186e5SPeter A. G. Crosthwaite 857e9f186e5SPeter A. G. Crosthwaite /* The packet we will hand off to qemu. 858e9f186e5SPeter A. G. Crosthwaite * Packets scattered across multiple descriptors are gathered to this 859e9f186e5SPeter A. G. Crosthwaite * one contiguous buffer first. 860e9f186e5SPeter A. G. Crosthwaite */ 861e9f186e5SPeter A. G. Crosthwaite p = tx_packet; 862e9f186e5SPeter A. G. Crosthwaite total_bytes = 0; 863e9f186e5SPeter A. G. Crosthwaite 864e9f186e5SPeter A. G. Crosthwaite /* read current descriptor */ 865e9f186e5SPeter A. G. Crosthwaite packet_desc_addr = s->tx_desc_addr; 866e9f186e5SPeter A. G. Crosthwaite cpu_physical_memory_read(packet_desc_addr, 867e9f186e5SPeter A. G. Crosthwaite (uint8_t *)&desc[0], sizeof(desc)); 868e9f186e5SPeter A. G. Crosthwaite /* Handle all descriptors owned by hardware */ 869e9f186e5SPeter A. G. Crosthwaite while (tx_desc_get_used(desc) == 0) { 870e9f186e5SPeter A. G. Crosthwaite 871e9f186e5SPeter A. G. Crosthwaite /* Do nothing if transmit is not enabled. */ 872e9f186e5SPeter A. G. Crosthwaite if (!(s->regs[GEM_NWCTRL] & GEM_NWCTRL_TXENA)) { 873e9f186e5SPeter A. G. Crosthwaite return; 874e9f186e5SPeter A. G. Crosthwaite } 875e9f186e5SPeter A. G. Crosthwaite print_gem_tx_desc(desc); 876e9f186e5SPeter A. G. Crosthwaite 877e9f186e5SPeter A. G. Crosthwaite /* The real hardware would eat this (and possibly crash). 878e9f186e5SPeter A. G. Crosthwaite * For QEMU let's lend a helping hand. 879e9f186e5SPeter A. G. Crosthwaite */ 880e9f186e5SPeter A. G. Crosthwaite if ((tx_desc_get_buffer(desc) == 0) || 881e9f186e5SPeter A. G. Crosthwaite (tx_desc_get_length(desc) == 0)) { 882080251a4SPeter Crosthwaite DB_PRINT("Invalid TX descriptor @ 0x%x\n", 883080251a4SPeter Crosthwaite (unsigned)packet_desc_addr); 884e9f186e5SPeter A. G. Crosthwaite break; 885e9f186e5SPeter A. G. Crosthwaite } 886e9f186e5SPeter A. G. Crosthwaite 887e9f186e5SPeter A. G. Crosthwaite /* Gather this fragment of the packet from "dma memory" to our contig. 888e9f186e5SPeter A. G. Crosthwaite * buffer. 889e9f186e5SPeter A. G. Crosthwaite */ 890e9f186e5SPeter A. G. Crosthwaite cpu_physical_memory_read(tx_desc_get_buffer(desc), p, 891e9f186e5SPeter A. G. Crosthwaite tx_desc_get_length(desc)); 892e9f186e5SPeter A. G. Crosthwaite p += tx_desc_get_length(desc); 893e9f186e5SPeter A. G. Crosthwaite total_bytes += tx_desc_get_length(desc); 894e9f186e5SPeter A. G. Crosthwaite 895e9f186e5SPeter A. G. Crosthwaite /* Last descriptor for this packet; hand the whole thing off */ 896e9f186e5SPeter A. G. Crosthwaite if (tx_desc_get_last(desc)) { 897e9f186e5SPeter A. G. Crosthwaite /* Modify the 1st descriptor of this packet to be owned by 898e9f186e5SPeter A. G. Crosthwaite * the processor. 899e9f186e5SPeter A. G. Crosthwaite */ 900e9f186e5SPeter A. G. Crosthwaite cpu_physical_memory_read(s->tx_desc_addr, 901e9f186e5SPeter A. G. Crosthwaite (uint8_t *)&desc[0], sizeof(desc)); 902e9f186e5SPeter A. G. Crosthwaite tx_desc_set_used(desc); 903e9f186e5SPeter A. G. Crosthwaite cpu_physical_memory_write(s->tx_desc_addr, 904e9f186e5SPeter A. G. Crosthwaite (uint8_t *)&desc[0], sizeof(desc)); 905e9f186e5SPeter A. G. Crosthwaite /* Advance the hardare current descriptor past this packet */ 906e9f186e5SPeter A. G. Crosthwaite if (tx_desc_get_wrap(desc)) { 907e9f186e5SPeter A. G. Crosthwaite s->tx_desc_addr = s->regs[GEM_TXQBASE]; 908e9f186e5SPeter A. G. Crosthwaite } else { 909e9f186e5SPeter A. G. Crosthwaite s->tx_desc_addr = packet_desc_addr + 8; 910e9f186e5SPeter A. G. Crosthwaite } 911e9f186e5SPeter A. G. Crosthwaite DB_PRINT("TX descriptor next: 0x%08x\n", s->tx_desc_addr); 912e9f186e5SPeter A. G. Crosthwaite 913e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_TXSTATUS] |= GEM_TXSTATUS_TXCMPL; 914ae80a354SPeter Crosthwaite s->regs[GEM_ISR] |= GEM_INT_TXCMPL & ~(s->regs[GEM_IMR]); 915e9f186e5SPeter A. G. Crosthwaite 916e9f186e5SPeter A. G. Crosthwaite /* Handle interrupt consequences */ 917e9f186e5SPeter A. G. Crosthwaite gem_update_int_status(s); 918e9f186e5SPeter A. G. Crosthwaite 919e9f186e5SPeter A. G. Crosthwaite /* Is checksum offload enabled? */ 920e9f186e5SPeter A. G. Crosthwaite if (s->regs[GEM_DMACFG] & GEM_DMACFG_TXCSUM_OFFL) { 921e9f186e5SPeter A. G. Crosthwaite net_checksum_calculate(tx_packet, total_bytes); 922e9f186e5SPeter A. G. Crosthwaite } 923e9f186e5SPeter A. G. Crosthwaite 924e9f186e5SPeter A. G. Crosthwaite /* Update MAC statistics */ 925e9f186e5SPeter A. G. Crosthwaite gem_transmit_updatestats(s, tx_packet, total_bytes); 926e9f186e5SPeter A. G. Crosthwaite 927e9f186e5SPeter A. G. Crosthwaite /* Send the packet somewhere */ 92824e822eaSPeter Crosthwaite if (s->phy_loop || (s->regs[GEM_NWCTRL] & GEM_NWCTRL_LOCALLOOP)) { 929b356f76dSJason Wang gem_receive(qemu_get_queue(s->nic), tx_packet, total_bytes); 930e9f186e5SPeter A. G. Crosthwaite } else { 931b356f76dSJason Wang qemu_send_packet(qemu_get_queue(s->nic), tx_packet, 932b356f76dSJason Wang total_bytes); 933e9f186e5SPeter A. G. Crosthwaite } 934e9f186e5SPeter A. G. Crosthwaite 935e9f186e5SPeter A. G. Crosthwaite /* Prepare for next packet */ 936e9f186e5SPeter A. G. Crosthwaite p = tx_packet; 937e9f186e5SPeter A. G. Crosthwaite total_bytes = 0; 938e9f186e5SPeter A. G. Crosthwaite } 939e9f186e5SPeter A. G. Crosthwaite 940e9f186e5SPeter A. G. Crosthwaite /* read next descriptor */ 941e9f186e5SPeter A. G. Crosthwaite if (tx_desc_get_wrap(desc)) { 942e9f186e5SPeter A. G. Crosthwaite packet_desc_addr = s->regs[GEM_TXQBASE]; 943e9f186e5SPeter A. G. Crosthwaite } else { 944e9f186e5SPeter A. G. Crosthwaite packet_desc_addr += 8; 945e9f186e5SPeter A. G. Crosthwaite } 946e9f186e5SPeter A. G. Crosthwaite cpu_physical_memory_read(packet_desc_addr, 947e9f186e5SPeter A. G. Crosthwaite (uint8_t *)&desc[0], sizeof(desc)); 948e9f186e5SPeter A. G. Crosthwaite } 949e9f186e5SPeter A. G. Crosthwaite 950e9f186e5SPeter A. G. Crosthwaite if (tx_desc_get_used(desc)) { 951e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_TXSTATUS] |= GEM_TXSTATUS_USED; 952ae80a354SPeter Crosthwaite s->regs[GEM_ISR] |= GEM_INT_TXUSED & ~(s->regs[GEM_IMR]); 953e9f186e5SPeter A. G. Crosthwaite gem_update_int_status(s); 954e9f186e5SPeter A. G. Crosthwaite } 955e9f186e5SPeter A. G. Crosthwaite } 956e9f186e5SPeter A. G. Crosthwaite 957e9f186e5SPeter A. G. Crosthwaite static void gem_phy_reset(GemState *s) 958e9f186e5SPeter A. G. Crosthwaite { 959e9f186e5SPeter A. G. Crosthwaite memset(&s->phy_regs[0], 0, sizeof(s->phy_regs)); 960e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_CONTROL] = 0x1140; 961e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_STATUS] = 0x7969; 962e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_PHYID1] = 0x0141; 963e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_PHYID2] = 0x0CC2; 964e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_ANEGADV] = 0x01E1; 965e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_LINKPABIL] = 0xCDE1; 966e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_ANEGEXP] = 0x000F; 967e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_NEXTP] = 0x2001; 968e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_LINKPNEXTP] = 0x40E6; 969e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_100BTCTRL] = 0x0300; 970e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_1000BTSTAT] = 0x7C00; 971e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_EXTSTAT] = 0x3000; 972e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_PHYSPCFC_CTL] = 0x0078; 973e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_PHYSPCFC_ST] = 0xBC00; 974e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_EXT_PHYSPCFC_CTL] = 0x0C60; 975e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_LED] = 0x4100; 976e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_EXT_PHYSPCFC_CTL2] = 0x000A; 977e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_EXT_PHYSPCFC_ST] = 0x848B; 978e9f186e5SPeter A. G. Crosthwaite 979e9f186e5SPeter A. G. Crosthwaite phy_update_link(s); 980e9f186e5SPeter A. G. Crosthwaite } 981e9f186e5SPeter A. G. Crosthwaite 982e9f186e5SPeter A. G. Crosthwaite static void gem_reset(DeviceState *d) 983e9f186e5SPeter A. G. Crosthwaite { 984318643beSAndreas Färber GemState *s = GEM(d); 985e9f186e5SPeter A. G. Crosthwaite 986e9f186e5SPeter A. G. Crosthwaite DB_PRINT("\n"); 987e9f186e5SPeter A. G. Crosthwaite 988e9f186e5SPeter A. G. Crosthwaite /* Set post reset register values */ 989e9f186e5SPeter A. G. Crosthwaite memset(&s->regs[0], 0, sizeof(s->regs)); 990e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_NWCFG] = 0x00080000; 991e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_NWSTATUS] = 0x00000006; 992e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_DMACFG] = 0x00020784; 993e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_IMR] = 0x07ffffff; 994e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_TXPAUSE] = 0x0000ffff; 995e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_TXPARTIALSF] = 0x000003ff; 996e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_RXPARTIALSF] = 0x000003ff; 997e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_MODID] = 0x00020118; 998e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_DESCONF] = 0x02500111; 999e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_DESCONF2] = 0x2ab13fff; 1000e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_DESCONF5] = 0x002f2145; 1001e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_DESCONF6] = 0x00000200; 1002e9f186e5SPeter A. G. Crosthwaite 1003e9f186e5SPeter A. G. Crosthwaite gem_phy_reset(s); 1004e9f186e5SPeter A. G. Crosthwaite 1005e9f186e5SPeter A. G. Crosthwaite gem_update_int_status(s); 1006e9f186e5SPeter A. G. Crosthwaite } 1007e9f186e5SPeter A. G. Crosthwaite 1008e9f186e5SPeter A. G. Crosthwaite static uint16_t gem_phy_read(GemState *s, unsigned reg_num) 1009e9f186e5SPeter A. G. Crosthwaite { 1010e9f186e5SPeter A. G. Crosthwaite DB_PRINT("reg: %d value: 0x%04x\n", reg_num, s->phy_regs[reg_num]); 1011e9f186e5SPeter A. G. Crosthwaite return s->phy_regs[reg_num]; 1012e9f186e5SPeter A. G. Crosthwaite } 1013e9f186e5SPeter A. G. Crosthwaite 1014e9f186e5SPeter A. G. Crosthwaite static void gem_phy_write(GemState *s, unsigned reg_num, uint16_t val) 1015e9f186e5SPeter A. G. Crosthwaite { 1016e9f186e5SPeter A. G. Crosthwaite DB_PRINT("reg: %d value: 0x%04x\n", reg_num, val); 1017e9f186e5SPeter A. G. Crosthwaite 1018e9f186e5SPeter A. G. Crosthwaite switch (reg_num) { 1019e9f186e5SPeter A. G. Crosthwaite case PHY_REG_CONTROL: 1020e9f186e5SPeter A. G. Crosthwaite if (val & PHY_REG_CONTROL_RST) { 1021e9f186e5SPeter A. G. Crosthwaite /* Phy reset */ 1022e9f186e5SPeter A. G. Crosthwaite gem_phy_reset(s); 1023e9f186e5SPeter A. G. Crosthwaite val &= ~(PHY_REG_CONTROL_RST | PHY_REG_CONTROL_LOOP); 1024e9f186e5SPeter A. G. Crosthwaite s->phy_loop = 0; 1025e9f186e5SPeter A. G. Crosthwaite } 1026e9f186e5SPeter A. G. Crosthwaite if (val & PHY_REG_CONTROL_ANEG) { 1027e9f186e5SPeter A. G. Crosthwaite /* Complete autonegotiation immediately */ 1028e9f186e5SPeter A. G. Crosthwaite val &= ~PHY_REG_CONTROL_ANEG; 1029e9f186e5SPeter A. G. Crosthwaite s->phy_regs[PHY_REG_STATUS] |= PHY_REG_STATUS_ANEGCMPL; 1030e9f186e5SPeter A. G. Crosthwaite } 1031e9f186e5SPeter A. G. Crosthwaite if (val & PHY_REG_CONTROL_LOOP) { 1032e9f186e5SPeter A. G. Crosthwaite DB_PRINT("PHY placed in loopback\n"); 1033e9f186e5SPeter A. G. Crosthwaite s->phy_loop = 1; 1034e9f186e5SPeter A. G. Crosthwaite } else { 1035e9f186e5SPeter A. G. Crosthwaite s->phy_loop = 0; 1036e9f186e5SPeter A. G. Crosthwaite } 1037e9f186e5SPeter A. G. Crosthwaite break; 1038e9f186e5SPeter A. G. Crosthwaite } 1039e9f186e5SPeter A. G. Crosthwaite s->phy_regs[reg_num] = val; 1040e9f186e5SPeter A. G. Crosthwaite } 1041e9f186e5SPeter A. G. Crosthwaite 1042e9f186e5SPeter A. G. Crosthwaite /* 1043e9f186e5SPeter A. G. Crosthwaite * gem_read32: 1044e9f186e5SPeter A. G. Crosthwaite * Read a GEM register. 1045e9f186e5SPeter A. G. Crosthwaite */ 1046a8170e5eSAvi Kivity static uint64_t gem_read(void *opaque, hwaddr offset, unsigned size) 1047e9f186e5SPeter A. G. Crosthwaite { 1048e9f186e5SPeter A. G. Crosthwaite GemState *s; 1049e9f186e5SPeter A. G. Crosthwaite uint32_t retval; 1050e9f186e5SPeter A. G. Crosthwaite 1051e9f186e5SPeter A. G. Crosthwaite s = (GemState *)opaque; 1052e9f186e5SPeter A. G. Crosthwaite 1053e9f186e5SPeter A. G. Crosthwaite offset >>= 2; 1054e9f186e5SPeter A. G. Crosthwaite retval = s->regs[offset]; 1055e9f186e5SPeter A. G. Crosthwaite 1056080251a4SPeter Crosthwaite DB_PRINT("offset: 0x%04x read: 0x%08x\n", (unsigned)offset*4, retval); 1057e9f186e5SPeter A. G. Crosthwaite 1058e9f186e5SPeter A. G. Crosthwaite switch (offset) { 1059e9f186e5SPeter A. G. Crosthwaite case GEM_ISR: 1060080251a4SPeter Crosthwaite DB_PRINT("lowering irq on ISR read\n"); 1061e9f186e5SPeter A. G. Crosthwaite qemu_set_irq(s->irq, 0); 1062e9f186e5SPeter A. G. Crosthwaite break; 1063e9f186e5SPeter A. G. Crosthwaite case GEM_PHYMNTNC: 1064e9f186e5SPeter A. G. Crosthwaite if (retval & GEM_PHYMNTNC_OP_R) { 1065e9f186e5SPeter A. G. Crosthwaite uint32_t phy_addr, reg_num; 1066e9f186e5SPeter A. G. Crosthwaite 1067e9f186e5SPeter A. G. Crosthwaite phy_addr = (retval & GEM_PHYMNTNC_ADDR) >> GEM_PHYMNTNC_ADDR_SHFT; 1068e9f186e5SPeter A. G. Crosthwaite if (phy_addr == BOARD_PHY_ADDRESS) { 1069e9f186e5SPeter A. G. Crosthwaite reg_num = (retval & GEM_PHYMNTNC_REG) >> GEM_PHYMNTNC_REG_SHIFT; 1070e9f186e5SPeter A. G. Crosthwaite retval &= 0xFFFF0000; 1071e9f186e5SPeter A. G. Crosthwaite retval |= gem_phy_read(s, reg_num); 1072e9f186e5SPeter A. G. Crosthwaite } else { 1073e9f186e5SPeter A. G. Crosthwaite retval |= 0xFFFF; /* No device at this address */ 1074e9f186e5SPeter A. G. Crosthwaite } 1075e9f186e5SPeter A. G. Crosthwaite } 1076e9f186e5SPeter A. G. Crosthwaite break; 1077e9f186e5SPeter A. G. Crosthwaite } 1078e9f186e5SPeter A. G. Crosthwaite 1079e9f186e5SPeter A. G. Crosthwaite /* Squash read to clear bits */ 1080e9f186e5SPeter A. G. Crosthwaite s->regs[offset] &= ~(s->regs_rtc[offset]); 1081e9f186e5SPeter A. G. Crosthwaite 1082e9f186e5SPeter A. G. Crosthwaite /* Do not provide write only bits */ 1083e9f186e5SPeter A. G. Crosthwaite retval &= ~(s->regs_wo[offset]); 1084e9f186e5SPeter A. G. Crosthwaite 1085e9f186e5SPeter A. G. Crosthwaite DB_PRINT("0x%08x\n", retval); 1086e9f186e5SPeter A. G. Crosthwaite return retval; 1087e9f186e5SPeter A. G. Crosthwaite } 1088e9f186e5SPeter A. G. Crosthwaite 1089e9f186e5SPeter A. G. Crosthwaite /* 1090e9f186e5SPeter A. G. Crosthwaite * gem_write32: 1091e9f186e5SPeter A. G. Crosthwaite * Write a GEM register. 1092e9f186e5SPeter A. G. Crosthwaite */ 1093a8170e5eSAvi Kivity static void gem_write(void *opaque, hwaddr offset, uint64_t val, 1094e9f186e5SPeter A. G. Crosthwaite unsigned size) 1095e9f186e5SPeter A. G. Crosthwaite { 1096e9f186e5SPeter A. G. Crosthwaite GemState *s = (GemState *)opaque; 1097e9f186e5SPeter A. G. Crosthwaite uint32_t readonly; 1098e9f186e5SPeter A. G. Crosthwaite 1099080251a4SPeter Crosthwaite DB_PRINT("offset: 0x%04x write: 0x%08x ", (unsigned)offset, (unsigned)val); 1100e9f186e5SPeter A. G. Crosthwaite offset >>= 2; 1101e9f186e5SPeter A. G. Crosthwaite 1102e9f186e5SPeter A. G. Crosthwaite /* Squash bits which are read only in write value */ 1103e9f186e5SPeter A. G. Crosthwaite val &= ~(s->regs_ro[offset]); 1104e9f186e5SPeter A. G. Crosthwaite /* Preserve (only) bits which are read only in register */ 1105e9f186e5SPeter A. G. Crosthwaite readonly = s->regs[offset]; 1106e9f186e5SPeter A. G. Crosthwaite readonly &= s->regs_ro[offset]; 1107e9f186e5SPeter A. G. Crosthwaite 1108e9f186e5SPeter A. G. Crosthwaite /* Squash bits which are write 1 to clear */ 1109e9f186e5SPeter A. G. Crosthwaite val &= ~(s->regs_w1c[offset] & val); 1110e9f186e5SPeter A. G. Crosthwaite 1111e9f186e5SPeter A. G. Crosthwaite /* Copy register write to backing store */ 1112e9f186e5SPeter A. G. Crosthwaite s->regs[offset] = val | readonly; 1113e9f186e5SPeter A. G. Crosthwaite 1114e9f186e5SPeter A. G. Crosthwaite /* Handle register write side effects */ 1115e9f186e5SPeter A. G. Crosthwaite switch (offset) { 1116e9f186e5SPeter A. G. Crosthwaite case GEM_NWCTRL: 111706c2fe95SPeter Crosthwaite if (val & GEM_NWCTRL_RXENA) { 111806c2fe95SPeter Crosthwaite gem_get_rx_desc(s); 111906c2fe95SPeter Crosthwaite } 1120e9f186e5SPeter A. G. Crosthwaite if (val & GEM_NWCTRL_TXSTART) { 1121e9f186e5SPeter A. G. Crosthwaite gem_transmit(s); 1122e9f186e5SPeter A. G. Crosthwaite } 1123e9f186e5SPeter A. G. Crosthwaite if (!(val & GEM_NWCTRL_TXENA)) { 1124e9f186e5SPeter A. G. Crosthwaite /* Reset to start of Q when transmit disabled. */ 1125e9f186e5SPeter A. G. Crosthwaite s->tx_desc_addr = s->regs[GEM_TXQBASE]; 1126e9f186e5SPeter A. G. Crosthwaite } 1127e3f9d31cSPeter Crosthwaite if (val & GEM_NWCTRL_RXENA) { 1128e3f9d31cSPeter Crosthwaite qemu_flush_queued_packets(qemu_get_queue(s->nic)); 1129e3f9d31cSPeter Crosthwaite } 1130e9f186e5SPeter A. G. Crosthwaite break; 1131e9f186e5SPeter A. G. Crosthwaite 1132e9f186e5SPeter A. G. Crosthwaite case GEM_TXSTATUS: 1133e9f186e5SPeter A. G. Crosthwaite gem_update_int_status(s); 1134e9f186e5SPeter A. G. Crosthwaite break; 1135e9f186e5SPeter A. G. Crosthwaite case GEM_RXQBASE: 1136e9f186e5SPeter A. G. Crosthwaite s->rx_desc_addr = val; 1137e9f186e5SPeter A. G. Crosthwaite break; 1138e9f186e5SPeter A. G. Crosthwaite case GEM_TXQBASE: 1139e9f186e5SPeter A. G. Crosthwaite s->tx_desc_addr = val; 1140e9f186e5SPeter A. G. Crosthwaite break; 1141e9f186e5SPeter A. G. Crosthwaite case GEM_RXSTATUS: 1142e9f186e5SPeter A. G. Crosthwaite gem_update_int_status(s); 1143e9f186e5SPeter A. G. Crosthwaite break; 1144e9f186e5SPeter A. G. Crosthwaite case GEM_IER: 1145e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_IMR] &= ~val; 1146e9f186e5SPeter A. G. Crosthwaite gem_update_int_status(s); 1147e9f186e5SPeter A. G. Crosthwaite break; 1148e9f186e5SPeter A. G. Crosthwaite case GEM_IDR: 1149e9f186e5SPeter A. G. Crosthwaite s->regs[GEM_IMR] |= val; 1150e9f186e5SPeter A. G. Crosthwaite gem_update_int_status(s); 1151e9f186e5SPeter A. G. Crosthwaite break; 1152e9f186e5SPeter A. G. Crosthwaite case GEM_PHYMNTNC: 1153e9f186e5SPeter A. G. Crosthwaite if (val & GEM_PHYMNTNC_OP_W) { 1154e9f186e5SPeter A. G. Crosthwaite uint32_t phy_addr, reg_num; 1155e9f186e5SPeter A. G. Crosthwaite 1156e9f186e5SPeter A. G. Crosthwaite phy_addr = (val & GEM_PHYMNTNC_ADDR) >> GEM_PHYMNTNC_ADDR_SHFT; 1157e9f186e5SPeter A. G. Crosthwaite if (phy_addr == BOARD_PHY_ADDRESS) { 1158e9f186e5SPeter A. G. Crosthwaite reg_num = (val & GEM_PHYMNTNC_REG) >> GEM_PHYMNTNC_REG_SHIFT; 1159e9f186e5SPeter A. G. Crosthwaite gem_phy_write(s, reg_num, val); 1160e9f186e5SPeter A. G. Crosthwaite } 1161e9f186e5SPeter A. G. Crosthwaite } 1162e9f186e5SPeter A. G. Crosthwaite break; 1163e9f186e5SPeter A. G. Crosthwaite } 1164e9f186e5SPeter A. G. Crosthwaite 1165e9f186e5SPeter A. G. Crosthwaite DB_PRINT("newval: 0x%08x\n", s->regs[offset]); 1166e9f186e5SPeter A. G. Crosthwaite } 1167e9f186e5SPeter A. G. Crosthwaite 1168e9f186e5SPeter A. G. Crosthwaite static const MemoryRegionOps gem_ops = { 1169e9f186e5SPeter A. G. Crosthwaite .read = gem_read, 1170e9f186e5SPeter A. G. Crosthwaite .write = gem_write, 1171e9f186e5SPeter A. G. Crosthwaite .endianness = DEVICE_LITTLE_ENDIAN, 1172e9f186e5SPeter A. G. Crosthwaite }; 1173e9f186e5SPeter A. G. Crosthwaite 11744e68f7a0SStefan Hajnoczi static void gem_cleanup(NetClientState *nc) 1175e9f186e5SPeter A. G. Crosthwaite { 1176cc1f0f45SJason Wang GemState *s = qemu_get_nic_opaque(nc); 1177e9f186e5SPeter A. G. Crosthwaite 1178e9f186e5SPeter A. G. Crosthwaite DB_PRINT("\n"); 1179e9f186e5SPeter A. G. Crosthwaite s->nic = NULL; 1180e9f186e5SPeter A. G. Crosthwaite } 1181e9f186e5SPeter A. G. Crosthwaite 11824e68f7a0SStefan Hajnoczi static void gem_set_link(NetClientState *nc) 1183e9f186e5SPeter A. G. Crosthwaite { 1184e9f186e5SPeter A. G. Crosthwaite DB_PRINT("\n"); 1185cc1f0f45SJason Wang phy_update_link(qemu_get_nic_opaque(nc)); 1186e9f186e5SPeter A. G. Crosthwaite } 1187e9f186e5SPeter A. G. Crosthwaite 1188e9f186e5SPeter A. G. Crosthwaite static NetClientInfo net_gem_info = { 11892be64a68SLaszlo Ersek .type = NET_CLIENT_OPTIONS_KIND_NIC, 1190e9f186e5SPeter A. G. Crosthwaite .size = sizeof(NICState), 1191e9f186e5SPeter A. G. Crosthwaite .can_receive = gem_can_receive, 1192e9f186e5SPeter A. G. Crosthwaite .receive = gem_receive, 1193e9f186e5SPeter A. G. Crosthwaite .cleanup = gem_cleanup, 1194e9f186e5SPeter A. G. Crosthwaite .link_status_changed = gem_set_link, 1195e9f186e5SPeter A. G. Crosthwaite }; 1196e9f186e5SPeter A. G. Crosthwaite 1197318643beSAndreas Färber static int gem_init(SysBusDevice *sbd) 1198e9f186e5SPeter A. G. Crosthwaite { 1199318643beSAndreas Färber DeviceState *dev = DEVICE(sbd); 1200318643beSAndreas Färber GemState *s = GEM(dev); 1201e9f186e5SPeter A. G. Crosthwaite 1202e9f186e5SPeter A. G. Crosthwaite DB_PRINT("\n"); 1203e9f186e5SPeter A. G. Crosthwaite 1204e9f186e5SPeter A. G. Crosthwaite gem_init_register_masks(s); 1205eedfac6fSPaolo Bonzini memory_region_init_io(&s->iomem, OBJECT(s), &gem_ops, s, 1206eedfac6fSPaolo Bonzini "enet", sizeof(s->regs)); 1207318643beSAndreas Färber sysbus_init_mmio(sbd, &s->iomem); 1208318643beSAndreas Färber sysbus_init_irq(sbd, &s->irq); 1209e9f186e5SPeter A. G. Crosthwaite qemu_macaddr_default_if_unset(&s->conf.macaddr); 1210e9f186e5SPeter A. G. Crosthwaite 1211e9f186e5SPeter A. G. Crosthwaite s->nic = qemu_new_nic(&net_gem_info, &s->conf, 1212318643beSAndreas Färber object_get_typename(OBJECT(dev)), dev->id, s); 1213e9f186e5SPeter A. G. Crosthwaite 1214e9f186e5SPeter A. G. Crosthwaite return 0; 1215e9f186e5SPeter A. G. Crosthwaite } 1216e9f186e5SPeter A. G. Crosthwaite 1217e9f186e5SPeter A. G. Crosthwaite static const VMStateDescription vmstate_cadence_gem = { 1218e9f186e5SPeter A. G. Crosthwaite .name = "cadence_gem", 1219e9f186e5SPeter A. G. Crosthwaite .version_id = 1, 1220e9f186e5SPeter A. G. Crosthwaite .minimum_version_id = 1, 1221e9f186e5SPeter A. G. Crosthwaite .minimum_version_id_old = 1, 1222e9f186e5SPeter A. G. Crosthwaite .fields = (VMStateField[]) { 1223e9f186e5SPeter A. G. Crosthwaite VMSTATE_UINT32_ARRAY(regs, GemState, GEM_MAXREG), 1224e9f186e5SPeter A. G. Crosthwaite VMSTATE_UINT16_ARRAY(phy_regs, GemState, 32), 1225e9f186e5SPeter A. G. Crosthwaite VMSTATE_UINT8(phy_loop, GemState), 1226e9f186e5SPeter A. G. Crosthwaite VMSTATE_UINT32(rx_desc_addr, GemState), 1227e9f186e5SPeter A. G. Crosthwaite VMSTATE_UINT32(tx_desc_addr, GemState), 1228e9f186e5SPeter A. G. Crosthwaite } 1229e9f186e5SPeter A. G. Crosthwaite }; 1230e9f186e5SPeter A. G. Crosthwaite 1231e9f186e5SPeter A. G. Crosthwaite static Property gem_properties[] = { 1232e9f186e5SPeter A. G. Crosthwaite DEFINE_NIC_PROPERTIES(GemState, conf), 1233e9f186e5SPeter A. G. Crosthwaite DEFINE_PROP_END_OF_LIST(), 1234e9f186e5SPeter A. G. Crosthwaite }; 1235e9f186e5SPeter A. G. Crosthwaite 1236e9f186e5SPeter A. G. Crosthwaite static void gem_class_init(ObjectClass *klass, void *data) 1237e9f186e5SPeter A. G. Crosthwaite { 1238e9f186e5SPeter A. G. Crosthwaite DeviceClass *dc = DEVICE_CLASS(klass); 1239e9f186e5SPeter A. G. Crosthwaite SysBusDeviceClass *sdc = SYS_BUS_DEVICE_CLASS(klass); 1240e9f186e5SPeter A. G. Crosthwaite 1241e9f186e5SPeter A. G. Crosthwaite sdc->init = gem_init; 1242e9f186e5SPeter A. G. Crosthwaite dc->props = gem_properties; 1243e9f186e5SPeter A. G. Crosthwaite dc->vmsd = &vmstate_cadence_gem; 1244e9f186e5SPeter A. G. Crosthwaite dc->reset = gem_reset; 1245e9f186e5SPeter A. G. Crosthwaite } 1246e9f186e5SPeter A. G. Crosthwaite 12478c43a6f0SAndreas Färber static const TypeInfo gem_info = { 1248318643beSAndreas Färber .name = TYPE_CADENCE_GEM, 1249e9f186e5SPeter A. G. Crosthwaite .parent = TYPE_SYS_BUS_DEVICE, 1250e9f186e5SPeter A. G. Crosthwaite .instance_size = sizeof(GemState), 1251318643beSAndreas Färber .class_init = gem_class_init, 1252e9f186e5SPeter A. G. Crosthwaite }; 1253e9f186e5SPeter A. G. Crosthwaite 1254e9f186e5SPeter A. G. Crosthwaite static void gem_register_types(void) 1255e9f186e5SPeter A. G. Crosthwaite { 1256e9f186e5SPeter A. G. Crosthwaite type_register_static(&gem_info); 1257e9f186e5SPeter A. G. Crosthwaite } 1258e9f186e5SPeter A. G. Crosthwaite 1259e9f186e5SPeter A. G. Crosthwaite type_init(gem_register_types) 1260