1 1.89 rin /* $NetBSD: if_vge.c,v 1.89 2024/07/05 04:31:51 rin Exp $ */ 2 1.1 jdolecek 3 1.1 jdolecek /*- 4 1.1 jdolecek * Copyright (c) 2004 5 1.1 jdolecek * Bill Paul <wpaul (at) windriver.com>. All rights reserved. 6 1.1 jdolecek * 7 1.1 jdolecek * Redistribution and use in source and binary forms, with or without 8 1.1 jdolecek * modification, are permitted provided that the following conditions 9 1.1 jdolecek * are met: 10 1.1 jdolecek * 1. Redistributions of source code must retain the above copyright 11 1.1 jdolecek * notice, this list of conditions and the following disclaimer. 12 1.1 jdolecek * 2. Redistributions in binary form must reproduce the above copyright 13 1.1 jdolecek * notice, this list of conditions and the following disclaimer in the 14 1.1 jdolecek * documentation and/or other materials provided with the distribution. 15 1.1 jdolecek * 3. All advertising materials mentioning features or use of this software 16 1.1 jdolecek * must display the following acknowledgement: 17 1.1 jdolecek * This product includes software developed by Bill Paul. 18 1.1 jdolecek * 4. Neither the name of the author nor the names of any co-contributors 19 1.1 jdolecek * may be used to endorse or promote products derived from this software 20 1.1 jdolecek * without specific prior written permission. 21 1.1 jdolecek * 22 1.1 jdolecek * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND 23 1.1 jdolecek * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 24 1.1 jdolecek * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 25 1.1 jdolecek * ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD 26 1.1 jdolecek * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 27 1.1 jdolecek * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 28 1.1 jdolecek * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 29 1.1 jdolecek * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 30 1.1 jdolecek * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 31 1.1 jdolecek * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF 32 1.1 jdolecek * THE POSSIBILITY OF SUCH DAMAGE. 33 1.1 jdolecek * 34 1.1 jdolecek * FreeBSD: src/sys/dev/vge/if_vge.c,v 1.5 2005/02/07 19:39:29 glebius Exp 35 1.1 jdolecek */ 36 1.1 jdolecek 37 1.1 jdolecek #include <sys/cdefs.h> 38 1.89 rin __KERNEL_RCSID(0, "$NetBSD: if_vge.c,v 1.89 2024/07/05 04:31:51 rin Exp $"); 39 1.1 jdolecek 40 1.1 jdolecek /* 41 1.1 jdolecek * VIA Networking Technologies VT612x PCI gigabit ethernet NIC driver. 42 1.1 jdolecek * 43 1.1 jdolecek * Written by Bill Paul <wpaul (at) windriver.com> 44 1.1 jdolecek * Senior Networking Software Engineer 45 1.1 jdolecek * Wind River Systems 46 1.1 jdolecek */ 47 1.1 jdolecek 48 1.1 jdolecek /* 49 1.9 lukem * The VIA Networking VT6122 is a 32bit, 33/66 MHz PCI device that 50 1.1 jdolecek * combines a tri-speed ethernet MAC and PHY, with the following 51 1.1 jdolecek * features: 52 1.1 jdolecek * 53 1.1 jdolecek * o Jumbo frame support up to 16K 54 1.1 jdolecek * o Transmit and receive flow control 55 1.1 jdolecek * o IPv4 checksum offload 56 1.1 jdolecek * o VLAN tag insertion and stripping 57 1.1 jdolecek * o TCP large send 58 1.1 jdolecek * o 64-bit multicast hash table filter 59 1.1 jdolecek * o 64 entry CAM filter 60 1.1 jdolecek * o 16K RX FIFO and 48K TX FIFO memory 61 1.1 jdolecek * o Interrupt moderation 62 1.1 jdolecek * 63 1.1 jdolecek * The VT6122 supports up to four transmit DMA queues. The descriptors 64 1.1 jdolecek * in the transmit ring can address up to 7 data fragments; frames which 65 1.1 jdolecek * span more than 7 data buffers must be coalesced, but in general the 66 1.1 jdolecek * BSD TCP/IP stack rarely generates frames more than 2 or 3 fragments 67 1.1 jdolecek * long. The receive descriptors address only a single buffer. 68 1.1 jdolecek * 69 1.1 jdolecek * There are two peculiar design issues with the VT6122. One is that 70 1.1 jdolecek * receive data buffers must be aligned on a 32-bit boundary. This is 71 1.1 jdolecek * not a problem where the VT6122 is used as a LOM device in x86-based 72 1.1 jdolecek * systems, but on architectures that generate unaligned access traps, we 73 1.1 jdolecek * have to do some copying. 74 1.1 jdolecek * 75 1.1 jdolecek * The other issue has to do with the way 64-bit addresses are handled. 76 1.1 jdolecek * The DMA descriptors only allow you to specify 48 bits of addressing 77 1.1 jdolecek * information. The remaining 16 bits are specified using one of the 78 1.80 thorpej * I/O registers (VGE_DATABUF_HIADDR). If you only have a 32-bit system, 79 1.80 thorpej * then this isn't an issue, but if you have a 64-bit system and more than 80 1.80 thorpej * 4GB of memory, you must have to make sure your network data buffers reside 81 1.1 jdolecek * in the same 48-bit 'segment.' 82 1.1 jdolecek * 83 1.80 thorpej * Furthermore, the descriptors must also all reside within the same 32-bit 84 1.80 thorpej * 'segment' (see VGE_TXDESC_HIADDR). 85 1.80 thorpej * 86 1.1 jdolecek * Special thanks to Ryan Fu at VIA Networking for providing documentation 87 1.1 jdolecek * and sample NICs for testing. 88 1.1 jdolecek */ 89 1.1 jdolecek 90 1.1 jdolecek 91 1.1 jdolecek #include <sys/param.h> 92 1.1 jdolecek #include <sys/endian.h> 93 1.1 jdolecek #include <sys/systm.h> 94 1.30 tsutsui #include <sys/device.h> 95 1.1 jdolecek #include <sys/sockio.h> 96 1.1 jdolecek #include <sys/mbuf.h> 97 1.1 jdolecek #include <sys/kernel.h> 98 1.1 jdolecek #include <sys/socket.h> 99 1.1 jdolecek 100 1.1 jdolecek #include <net/if.h> 101 1.1 jdolecek #include <net/if_arp.h> 102 1.1 jdolecek #include <net/if_ether.h> 103 1.1 jdolecek #include <net/if_dl.h> 104 1.1 jdolecek #include <net/if_media.h> 105 1.1 jdolecek 106 1.1 jdolecek #include <net/bpf.h> 107 1.1 jdolecek 108 1.38 ad #include <sys/bus.h> 109 1.1 jdolecek 110 1.1 jdolecek #include <dev/mii/mii.h> 111 1.1 jdolecek #include <dev/mii/miivar.h> 112 1.1 jdolecek 113 1.1 jdolecek #include <dev/pci/pcireg.h> 114 1.1 jdolecek #include <dev/pci/pcivar.h> 115 1.1 jdolecek #include <dev/pci/pcidevs.h> 116 1.1 jdolecek 117 1.1 jdolecek #include <dev/pci/if_vgereg.h> 118 1.21 tsutsui 119 1.21 tsutsui #define VGE_IFQ_MAXLEN 64 120 1.21 tsutsui 121 1.21 tsutsui #define VGE_RING_ALIGN 256 122 1.21 tsutsui 123 1.21 tsutsui #define VGE_NTXDESC 256 124 1.21 tsutsui #define VGE_NTXDESC_MASK (VGE_NTXDESC - 1) 125 1.21 tsutsui #define VGE_NEXT_TXDESC(x) ((x + 1) & VGE_NTXDESC_MASK) 126 1.29 tsutsui #define VGE_PREV_TXDESC(x) ((x - 1) & VGE_NTXDESC_MASK) 127 1.21 tsutsui 128 1.21 tsutsui #define VGE_NRXDESC 256 /* Must be a multiple of 4!! */ 129 1.21 tsutsui #define VGE_NRXDESC_MASK (VGE_NRXDESC - 1) 130 1.21 tsutsui #define VGE_NEXT_RXDESC(x) ((x + 1) & VGE_NRXDESC_MASK) 131 1.21 tsutsui #define VGE_PREV_RXDESC(x) ((x - 1) & VGE_NRXDESC_MASK) 132 1.21 tsutsui 133 1.80 thorpej #define VGE_ADDR_LO(y) BUS_ADDR_LO32(y) 134 1.80 thorpej #define VGE_ADDR_HI(y) BUS_ADDR_HI32(y) 135 1.21 tsutsui #define VGE_BUFLEN(y) ((y) & 0x7FFF) 136 1.21 tsutsui #define ETHER_PAD_LEN (ETHER_MIN_LEN - ETHER_CRC_LEN) 137 1.21 tsutsui 138 1.28 tsutsui #define VGE_POWER_MANAGEMENT 0 /* disabled for now */ 139 1.28 tsutsui 140 1.28 tsutsui /* 141 1.28 tsutsui * Mbuf adjust factor to force 32-bit alignment of IP header. 142 1.28 tsutsui * Drivers should pad ETHER_ALIGN bytes when setting up a 143 1.28 tsutsui * RX mbuf so the upper layers get the IP header properly aligned 144 1.28 tsutsui * past the 14-byte Ethernet header. 145 1.28 tsutsui * 146 1.28 tsutsui * See also comment in vge_encap(). 147 1.28 tsutsui */ 148 1.28 tsutsui 149 1.28 tsutsui #ifdef __NO_STRICT_ALIGNMENT 150 1.28 tsutsui #define VGE_RX_BUFSIZE MCLBYTES 151 1.28 tsutsui #else 152 1.21 tsutsui #define VGE_RX_PAD sizeof(uint32_t) 153 1.28 tsutsui #define VGE_RX_BUFSIZE (MCLBYTES - VGE_RX_PAD) 154 1.21 tsutsui #endif 155 1.21 tsutsui 156 1.21 tsutsui /* 157 1.21 tsutsui * Control structures are DMA'd to the vge chip. We allocate them in 158 1.21 tsutsui * a single clump that maps to a single DMA segment to make several things 159 1.21 tsutsui * easier. 160 1.21 tsutsui */ 161 1.21 tsutsui struct vge_control_data { 162 1.21 tsutsui /* TX descriptors */ 163 1.21 tsutsui struct vge_txdesc vcd_txdescs[VGE_NTXDESC]; 164 1.21 tsutsui /* RX descriptors */ 165 1.21 tsutsui struct vge_rxdesc vcd_rxdescs[VGE_NRXDESC]; 166 1.21 tsutsui /* dummy data for TX padding */ 167 1.21 tsutsui uint8_t vcd_pad[ETHER_PAD_LEN]; 168 1.21 tsutsui }; 169 1.21 tsutsui 170 1.21 tsutsui #define VGE_CDOFF(x) offsetof(struct vge_control_data, x) 171 1.21 tsutsui #define VGE_CDTXOFF(x) VGE_CDOFF(vcd_txdescs[(x)]) 172 1.21 tsutsui #define VGE_CDRXOFF(x) VGE_CDOFF(vcd_rxdescs[(x)]) 173 1.21 tsutsui #define VGE_CDPADOFF() VGE_CDOFF(vcd_pad[0]) 174 1.21 tsutsui 175 1.21 tsutsui /* 176 1.21 tsutsui * Software state for TX jobs. 177 1.21 tsutsui */ 178 1.21 tsutsui struct vge_txsoft { 179 1.21 tsutsui struct mbuf *txs_mbuf; /* head of our mbuf chain */ 180 1.21 tsutsui bus_dmamap_t txs_dmamap; /* our DMA map */ 181 1.21 tsutsui }; 182 1.21 tsutsui 183 1.21 tsutsui /* 184 1.21 tsutsui * Software state for RX jobs. 185 1.21 tsutsui */ 186 1.21 tsutsui struct vge_rxsoft { 187 1.21 tsutsui struct mbuf *rxs_mbuf; /* head of our mbuf chain */ 188 1.21 tsutsui bus_dmamap_t rxs_dmamap; /* our DMA map */ 189 1.21 tsutsui }; 190 1.21 tsutsui 191 1.21 tsutsui 192 1.21 tsutsui struct vge_softc { 193 1.48 tsutsui device_t sc_dev; 194 1.21 tsutsui 195 1.21 tsutsui bus_space_tag_t sc_bst; /* bus space tag */ 196 1.21 tsutsui bus_space_handle_t sc_bsh; /* bus space handle */ 197 1.21 tsutsui bus_dma_tag_t sc_dmat; 198 1.21 tsutsui 199 1.21 tsutsui struct ethercom sc_ethercom; /* interface info */ 200 1.21 tsutsui uint8_t sc_eaddr[ETHER_ADDR_LEN]; 201 1.21 tsutsui 202 1.21 tsutsui void *sc_intrhand; 203 1.21 tsutsui struct mii_data sc_mii; 204 1.21 tsutsui uint8_t sc_type; 205 1.74 msaitoh u_short sc_if_flags; 206 1.21 tsutsui int sc_link; 207 1.21 tsutsui int sc_camidx; 208 1.36 ad callout_t sc_timeout; 209 1.21 tsutsui 210 1.21 tsutsui bus_dmamap_t sc_cddmamap; 211 1.21 tsutsui #define sc_cddma sc_cddmamap->dm_segs[0].ds_addr 212 1.21 tsutsui 213 1.21 tsutsui struct vge_txsoft sc_txsoft[VGE_NTXDESC]; 214 1.21 tsutsui struct vge_rxsoft sc_rxsoft[VGE_NRXDESC]; 215 1.21 tsutsui struct vge_control_data *sc_control_data; 216 1.21 tsutsui #define sc_txdescs sc_control_data->vcd_txdescs 217 1.21 tsutsui #define sc_rxdescs sc_control_data->vcd_rxdescs 218 1.21 tsutsui 219 1.21 tsutsui int sc_tx_prodidx; 220 1.21 tsutsui int sc_tx_considx; 221 1.21 tsutsui int sc_tx_free; 222 1.21 tsutsui 223 1.21 tsutsui struct mbuf *sc_rx_mhead; 224 1.21 tsutsui struct mbuf *sc_rx_mtail; 225 1.21 tsutsui int sc_rx_prodidx; 226 1.21 tsutsui int sc_rx_consumed; 227 1.21 tsutsui 228 1.21 tsutsui int sc_suspended; /* 0 = normal 1 = suspended */ 229 1.21 tsutsui uint32_t sc_saved_maps[5]; /* pci data */ 230 1.21 tsutsui uint32_t sc_saved_biosaddr; 231 1.21 tsutsui uint8_t sc_saved_intline; 232 1.21 tsutsui uint8_t sc_saved_cachelnsz; 233 1.21 tsutsui uint8_t sc_saved_lattimer; 234 1.21 tsutsui }; 235 1.21 tsutsui 236 1.21 tsutsui #define VGE_CDTXADDR(sc, x) ((sc)->sc_cddma + VGE_CDTXOFF(x)) 237 1.21 tsutsui #define VGE_CDRXADDR(sc, x) ((sc)->sc_cddma + VGE_CDRXOFF(x)) 238 1.21 tsutsui #define VGE_CDPADADDR(sc) ((sc)->sc_cddma + VGE_CDPADOFF()) 239 1.21 tsutsui 240 1.21 tsutsui #define VGE_TXDESCSYNC(sc, idx, ops) \ 241 1.21 tsutsui bus_dmamap_sync((sc)->sc_dmat,(sc)->sc_cddmamap, \ 242 1.21 tsutsui VGE_CDTXOFF(idx), \ 243 1.21 tsutsui offsetof(struct vge_txdesc, td_frag[0]), \ 244 1.21 tsutsui (ops)) 245 1.21 tsutsui #define VGE_TXFRAGSYNC(sc, idx, nsegs, ops) \ 246 1.21 tsutsui bus_dmamap_sync((sc)->sc_dmat, (sc)->sc_cddmamap, \ 247 1.21 tsutsui VGE_CDTXOFF(idx) + \ 248 1.21 tsutsui offsetof(struct vge_txdesc, td_frag[0]), \ 249 1.21 tsutsui sizeof(struct vge_txfrag) * (nsegs), \ 250 1.21 tsutsui (ops)) 251 1.21 tsutsui #define VGE_RXDESCSYNC(sc, idx, ops) \ 252 1.21 tsutsui bus_dmamap_sync((sc)->sc_dmat, (sc)->sc_cddmamap, \ 253 1.21 tsutsui VGE_CDRXOFF(idx), \ 254 1.21 tsutsui sizeof(struct vge_rxdesc), \ 255 1.21 tsutsui (ops)) 256 1.21 tsutsui 257 1.21 tsutsui /* 258 1.21 tsutsui * register space access macros 259 1.21 tsutsui */ 260 1.21 tsutsui #define CSR_WRITE_4(sc, reg, val) \ 261 1.21 tsutsui bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val)) 262 1.21 tsutsui #define CSR_WRITE_2(sc, reg, val) \ 263 1.21 tsutsui bus_space_write_2((sc)->sc_bst, (sc)->sc_bsh, (reg), (val)) 264 1.21 tsutsui #define CSR_WRITE_1(sc, reg, val) \ 265 1.21 tsutsui bus_space_write_1((sc)->sc_bst, (sc)->sc_bsh, (reg), (val)) 266 1.21 tsutsui 267 1.21 tsutsui #define CSR_READ_4(sc, reg) \ 268 1.21 tsutsui bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg)) 269 1.21 tsutsui #define CSR_READ_2(sc, reg) \ 270 1.21 tsutsui bus_space_read_2((sc)->sc_bst, (sc)->sc_bsh, (reg)) 271 1.21 tsutsui #define CSR_READ_1(sc, reg) \ 272 1.21 tsutsui bus_space_read_1((sc)->sc_bst, (sc)->sc_bsh, (reg)) 273 1.21 tsutsui 274 1.21 tsutsui #define CSR_SETBIT_1(sc, reg, x) \ 275 1.21 tsutsui CSR_WRITE_1((sc), (reg), CSR_READ_1((sc), (reg)) | (x)) 276 1.21 tsutsui #define CSR_SETBIT_2(sc, reg, x) \ 277 1.21 tsutsui CSR_WRITE_2((sc), (reg), CSR_READ_2((sc), (reg)) | (x)) 278 1.21 tsutsui #define CSR_SETBIT_4(sc, reg, x) \ 279 1.21 tsutsui CSR_WRITE_4((sc), (reg), CSR_READ_4((sc), (reg)) | (x)) 280 1.21 tsutsui 281 1.21 tsutsui #define CSR_CLRBIT_1(sc, reg, x) \ 282 1.21 tsutsui CSR_WRITE_1((sc), (reg), CSR_READ_1((sc), (reg)) & ~(x)) 283 1.21 tsutsui #define CSR_CLRBIT_2(sc, reg, x) \ 284 1.21 tsutsui CSR_WRITE_2((sc), (reg), CSR_READ_2((sc), (reg)) & ~(x)) 285 1.21 tsutsui #define CSR_CLRBIT_4(sc, reg, x) \ 286 1.21 tsutsui CSR_WRITE_4((sc), (reg), CSR_READ_4((sc), (reg)) & ~(x)) 287 1.21 tsutsui 288 1.21 tsutsui #define VGE_TIMEOUT 10000 289 1.21 tsutsui 290 1.71 msaitoh #define VGE_PCI_LOIO 0x10 291 1.71 msaitoh #define VGE_PCI_LOMEM 0x14 292 1.1 jdolecek 293 1.29 tsutsui static inline void vge_set_txaddr(struct vge_txfrag *, bus_addr_t); 294 1.29 tsutsui static inline void vge_set_rxaddr(struct vge_rxdesc *, bus_addr_t); 295 1.29 tsutsui 296 1.42 dyoung static int vge_ifflags_cb(struct ethercom *); 297 1.42 dyoung 298 1.46 cegger static int vge_match(device_t, cfdata_t, void *); 299 1.46 cegger static void vge_attach(device_t, device_t, void *); 300 1.1 jdolecek 301 1.15 tsutsui static int vge_encap(struct vge_softc *, struct mbuf *, int); 302 1.1 jdolecek 303 1.15 tsutsui static int vge_allocmem(struct vge_softc *); 304 1.15 tsutsui static int vge_newbuf(struct vge_softc *, int, struct mbuf *); 305 1.13 tsutsui #ifndef __NO_STRICT_ALIGNMENT 306 1.15 tsutsui static inline void vge_fixup_rx(struct mbuf *); 307 1.1 jdolecek #endif 308 1.15 tsutsui static void vge_rxeof(struct vge_softc *); 309 1.15 tsutsui static void vge_txeof(struct vge_softc *); 310 1.15 tsutsui static int vge_intr(void *); 311 1.15 tsutsui static void vge_tick(void *); 312 1.15 tsutsui static void vge_start(struct ifnet *); 313 1.34 christos static int vge_ioctl(struct ifnet *, u_long, void *); 314 1.15 tsutsui static int vge_init(struct ifnet *); 315 1.43 joerg static void vge_stop(struct ifnet *, int); 316 1.15 tsutsui static void vge_watchdog(struct ifnet *); 317 1.1 jdolecek #if VGE_POWER_MANAGEMENT 318 1.46 cegger static int vge_suspend(device_t); 319 1.46 cegger static int vge_resume(device_t); 320 1.1 jdolecek #endif 321 1.49 tsutsui static bool vge_shutdown(device_t, int); 322 1.15 tsutsui 323 1.15 tsutsui static uint16_t vge_read_eeprom(struct vge_softc *, int); 324 1.15 tsutsui 325 1.15 tsutsui static void vge_miipoll_start(struct vge_softc *); 326 1.15 tsutsui static void vge_miipoll_stop(struct vge_softc *); 327 1.67 msaitoh static int vge_miibus_readreg(device_t, int, int, uint16_t *); 328 1.67 msaitoh static int vge_miibus_writereg(device_t, int, int, uint16_t); 329 1.53 matt static void vge_miibus_statchg(struct ifnet *); 330 1.15 tsutsui 331 1.15 tsutsui static void vge_cam_clear(struct vge_softc *); 332 1.15 tsutsui static int vge_cam_set(struct vge_softc *, uint8_t *); 333 1.75 msaitoh static void vge_clrwol(struct vge_softc *); 334 1.15 tsutsui static void vge_setmulti(struct vge_softc *); 335 1.15 tsutsui static void vge_reset(struct vge_softc *); 336 1.1 jdolecek 337 1.48 tsutsui CFATTACH_DECL_NEW(vge, sizeof(struct vge_softc), 338 1.32 tsutsui vge_match, vge_attach, NULL, NULL); 339 1.1 jdolecek 340 1.29 tsutsui static inline void 341 1.29 tsutsui vge_set_txaddr(struct vge_txfrag *f, bus_addr_t daddr) 342 1.29 tsutsui { 343 1.29 tsutsui 344 1.29 tsutsui f->tf_addrlo = htole32((uint32_t)daddr); 345 1.29 tsutsui if (sizeof(bus_addr_t) == sizeof(uint64_t)) 346 1.29 tsutsui f->tf_addrhi = htole16(((uint64_t)daddr >> 32) & 0xFFFF); 347 1.29 tsutsui else 348 1.29 tsutsui f->tf_addrhi = 0; 349 1.29 tsutsui } 350 1.29 tsutsui 351 1.29 tsutsui static inline void 352 1.29 tsutsui vge_set_rxaddr(struct vge_rxdesc *rxd, bus_addr_t daddr) 353 1.29 tsutsui { 354 1.29 tsutsui 355 1.29 tsutsui rxd->rd_addrlo = htole32((uint32_t)daddr); 356 1.29 tsutsui if (sizeof(bus_addr_t) == sizeof(uint64_t)) 357 1.29 tsutsui rxd->rd_addrhi = htole16(((uint64_t)daddr >> 32) & 0xFFFF); 358 1.29 tsutsui else 359 1.29 tsutsui rxd->rd_addrhi = 0; 360 1.29 tsutsui } 361 1.29 tsutsui 362 1.1 jdolecek /* 363 1.1 jdolecek * Read a word of data stored in the EEPROM at address 'addr.' 364 1.1 jdolecek */ 365 1.11 tsutsui static uint16_t 366 1.11 tsutsui vge_read_eeprom(struct vge_softc *sc, int addr) 367 1.1 jdolecek { 368 1.11 tsutsui int i; 369 1.11 tsutsui uint16_t word = 0; 370 1.1 jdolecek 371 1.1 jdolecek /* 372 1.1 jdolecek * Enter EEPROM embedded programming mode. In order to 373 1.1 jdolecek * access the EEPROM at all, we first have to set the 374 1.1 jdolecek * EELOAD bit in the CHIPCFG2 register. 375 1.1 jdolecek */ 376 1.1 jdolecek CSR_SETBIT_1(sc, VGE_CHIPCFG2, VGE_CHIPCFG2_EELOAD); 377 1.70 msaitoh CSR_SETBIT_1(sc, VGE_EECSR, VGE_EECSR_EMBP/*| VGE_EECSR_ECS*/); 378 1.1 jdolecek 379 1.1 jdolecek /* Select the address of the word we want to read */ 380 1.1 jdolecek CSR_WRITE_1(sc, VGE_EEADDR, addr); 381 1.1 jdolecek 382 1.1 jdolecek /* Issue read command */ 383 1.1 jdolecek CSR_SETBIT_1(sc, VGE_EECMD, VGE_EECMD_ERD); 384 1.1 jdolecek 385 1.1 jdolecek /* Wait for the done bit to be set. */ 386 1.1 jdolecek for (i = 0; i < VGE_TIMEOUT; i++) { 387 1.1 jdolecek if (CSR_READ_1(sc, VGE_EECMD) & VGE_EECMD_EDONE) 388 1.1 jdolecek break; 389 1.1 jdolecek } 390 1.1 jdolecek 391 1.1 jdolecek if (i == VGE_TIMEOUT) { 392 1.48 tsutsui printf("%s: EEPROM read timed out\n", device_xname(sc->sc_dev)); 393 1.11 tsutsui return 0; 394 1.1 jdolecek } 395 1.1 jdolecek 396 1.1 jdolecek /* Read the result */ 397 1.1 jdolecek word = CSR_READ_2(sc, VGE_EERDDAT); 398 1.1 jdolecek 399 1.1 jdolecek /* Turn off EEPROM access mode. */ 400 1.70 msaitoh CSR_CLRBIT_1(sc, VGE_EECSR, VGE_EECSR_EMBP/*| VGE_EECSR_ECS*/); 401 1.1 jdolecek CSR_CLRBIT_1(sc, VGE_CHIPCFG2, VGE_CHIPCFG2_EELOAD); 402 1.1 jdolecek 403 1.11 tsutsui return word; 404 1.1 jdolecek } 405 1.1 jdolecek 406 1.1 jdolecek static void 407 1.15 tsutsui vge_miipoll_stop(struct vge_softc *sc) 408 1.1 jdolecek { 409 1.15 tsutsui int i; 410 1.1 jdolecek 411 1.1 jdolecek CSR_WRITE_1(sc, VGE_MIICMD, 0); 412 1.1 jdolecek 413 1.1 jdolecek for (i = 0; i < VGE_TIMEOUT; i++) { 414 1.1 jdolecek DELAY(1); 415 1.1 jdolecek if (CSR_READ_1(sc, VGE_MIISTS) & VGE_MIISTS_IIDL) 416 1.1 jdolecek break; 417 1.1 jdolecek } 418 1.1 jdolecek 419 1.1 jdolecek if (i == VGE_TIMEOUT) { 420 1.48 tsutsui printf("%s: failed to idle MII autopoll\n", 421 1.48 tsutsui device_xname(sc->sc_dev)); 422 1.1 jdolecek } 423 1.1 jdolecek } 424 1.1 jdolecek 425 1.1 jdolecek static void 426 1.15 tsutsui vge_miipoll_start(struct vge_softc *sc) 427 1.1 jdolecek { 428 1.15 tsutsui int i; 429 1.1 jdolecek 430 1.1 jdolecek /* First, make sure we're idle. */ 431 1.1 jdolecek 432 1.1 jdolecek CSR_WRITE_1(sc, VGE_MIICMD, 0); 433 1.1 jdolecek CSR_WRITE_1(sc, VGE_MIIADDR, VGE_MIIADDR_SWMPL); 434 1.1 jdolecek 435 1.1 jdolecek for (i = 0; i < VGE_TIMEOUT; i++) { 436 1.1 jdolecek DELAY(1); 437 1.1 jdolecek if (CSR_READ_1(sc, VGE_MIISTS) & VGE_MIISTS_IIDL) 438 1.1 jdolecek break; 439 1.1 jdolecek } 440 1.1 jdolecek 441 1.1 jdolecek if (i == VGE_TIMEOUT) { 442 1.48 tsutsui printf("%s: failed to idle MII autopoll\n", 443 1.48 tsutsui device_xname(sc->sc_dev)); 444 1.1 jdolecek return; 445 1.1 jdolecek } 446 1.1 jdolecek 447 1.1 jdolecek /* Now enable auto poll mode. */ 448 1.1 jdolecek 449 1.1 jdolecek CSR_WRITE_1(sc, VGE_MIICMD, VGE_MIICMD_MAUTO); 450 1.1 jdolecek 451 1.1 jdolecek /* And make sure it started. */ 452 1.1 jdolecek 453 1.1 jdolecek for (i = 0; i < VGE_TIMEOUT; i++) { 454 1.1 jdolecek DELAY(1); 455 1.1 jdolecek if ((CSR_READ_1(sc, VGE_MIISTS) & VGE_MIISTS_IIDL) == 0) 456 1.1 jdolecek break; 457 1.1 jdolecek } 458 1.1 jdolecek 459 1.1 jdolecek if (i == VGE_TIMEOUT) { 460 1.48 tsutsui printf("%s: failed to start MII autopoll\n", 461 1.48 tsutsui device_xname(sc->sc_dev)); 462 1.1 jdolecek } 463 1.1 jdolecek } 464 1.1 jdolecek 465 1.1 jdolecek static int 466 1.67 msaitoh vge_miibus_readreg(device_t dev, int phy, int reg, uint16_t *val) 467 1.15 tsutsui { 468 1.15 tsutsui struct vge_softc *sc; 469 1.21 tsutsui int i, s; 470 1.67 msaitoh int rv = 0; 471 1.1 jdolecek 472 1.47 cegger sc = device_private(dev); 473 1.1 jdolecek if (phy != (CSR_READ_1(sc, VGE_MIICFG) & 0x1F)) 474 1.67 msaitoh return -1; 475 1.1 jdolecek 476 1.21 tsutsui s = splnet(); 477 1.1 jdolecek vge_miipoll_stop(sc); 478 1.1 jdolecek 479 1.1 jdolecek /* Specify the register we want to read. */ 480 1.1 jdolecek CSR_WRITE_1(sc, VGE_MIIADDR, reg); 481 1.1 jdolecek 482 1.1 jdolecek /* Issue read command. */ 483 1.1 jdolecek CSR_SETBIT_1(sc, VGE_MIICMD, VGE_MIICMD_RCMD); 484 1.1 jdolecek 485 1.1 jdolecek /* Wait for the read command bit to self-clear. */ 486 1.1 jdolecek for (i = 0; i < VGE_TIMEOUT; i++) { 487 1.1 jdolecek DELAY(1); 488 1.1 jdolecek if ((CSR_READ_1(sc, VGE_MIICMD) & VGE_MIICMD_RCMD) == 0) 489 1.1 jdolecek break; 490 1.1 jdolecek } 491 1.1 jdolecek 492 1.67 msaitoh if (i == VGE_TIMEOUT) { 493 1.48 tsutsui printf("%s: MII read timed out\n", device_xname(sc->sc_dev)); 494 1.67 msaitoh rv = ETIMEDOUT; 495 1.67 msaitoh } else 496 1.67 msaitoh *val = CSR_READ_2(sc, VGE_MIIDATA); 497 1.1 jdolecek 498 1.1 jdolecek vge_miipoll_start(sc); 499 1.21 tsutsui splx(s); 500 1.1 jdolecek 501 1.67 msaitoh return rv; 502 1.1 jdolecek } 503 1.1 jdolecek 504 1.67 msaitoh static int 505 1.67 msaitoh vge_miibus_writereg(device_t dev, int phy, int reg, uint16_t val) 506 1.1 jdolecek { 507 1.15 tsutsui struct vge_softc *sc; 508 1.67 msaitoh int i, s, rv = 0; 509 1.1 jdolecek 510 1.47 cegger sc = device_private(dev); 511 1.1 jdolecek if (phy != (CSR_READ_1(sc, VGE_MIICFG) & 0x1F)) 512 1.67 msaitoh return -1; 513 1.1 jdolecek 514 1.21 tsutsui s = splnet(); 515 1.1 jdolecek vge_miipoll_stop(sc); 516 1.1 jdolecek 517 1.1 jdolecek /* Specify the register we want to write. */ 518 1.1 jdolecek CSR_WRITE_1(sc, VGE_MIIADDR, reg); 519 1.1 jdolecek 520 1.1 jdolecek /* Specify the data we want to write. */ 521 1.67 msaitoh CSR_WRITE_2(sc, VGE_MIIDATA, val); 522 1.1 jdolecek 523 1.1 jdolecek /* Issue write command. */ 524 1.1 jdolecek CSR_SETBIT_1(sc, VGE_MIICMD, VGE_MIICMD_WCMD); 525 1.1 jdolecek 526 1.1 jdolecek /* Wait for the write command bit to self-clear. */ 527 1.1 jdolecek for (i = 0; i < VGE_TIMEOUT; i++) { 528 1.1 jdolecek DELAY(1); 529 1.1 jdolecek if ((CSR_READ_1(sc, VGE_MIICMD) & VGE_MIICMD_WCMD) == 0) 530 1.1 jdolecek break; 531 1.1 jdolecek } 532 1.1 jdolecek 533 1.1 jdolecek if (i == VGE_TIMEOUT) { 534 1.48 tsutsui printf("%s: MII write timed out\n", device_xname(sc->sc_dev)); 535 1.67 msaitoh rv = ETIMEDOUT; 536 1.1 jdolecek } 537 1.1 jdolecek 538 1.1 jdolecek vge_miipoll_start(sc); 539 1.21 tsutsui splx(s); 540 1.67 msaitoh 541 1.67 msaitoh return rv; 542 1.1 jdolecek } 543 1.1 jdolecek 544 1.1 jdolecek static void 545 1.15 tsutsui vge_cam_clear(struct vge_softc *sc) 546 1.1 jdolecek { 547 1.15 tsutsui int i; 548 1.1 jdolecek 549 1.1 jdolecek /* 550 1.1 jdolecek * Turn off all the mask bits. This tells the chip 551 1.1 jdolecek * that none of the entries in the CAM filter are valid. 552 1.1 jdolecek * desired entries will be enabled as we fill the filter in. 553 1.1 jdolecek */ 554 1.1 jdolecek 555 1.1 jdolecek CSR_CLRBIT_1(sc, VGE_CAMCTL, VGE_CAMCTL_PAGESEL); 556 1.1 jdolecek CSR_SETBIT_1(sc, VGE_CAMCTL, VGE_PAGESEL_CAMMASK); 557 1.1 jdolecek CSR_WRITE_1(sc, VGE_CAMADDR, VGE_CAMADDR_ENABLE); 558 1.1 jdolecek for (i = 0; i < 8; i++) 559 1.1 jdolecek CSR_WRITE_1(sc, VGE_CAM0 + i, 0); 560 1.1 jdolecek 561 1.1 jdolecek /* Clear the VLAN filter too. */ 562 1.1 jdolecek 563 1.70 msaitoh CSR_WRITE_1(sc, VGE_CAMADDR, VGE_CAMADDR_ENABLE | VGE_CAMADDR_AVSEL); 564 1.1 jdolecek for (i = 0; i < 8; i++) 565 1.1 jdolecek CSR_WRITE_1(sc, VGE_CAM0 + i, 0); 566 1.1 jdolecek 567 1.1 jdolecek CSR_WRITE_1(sc, VGE_CAMADDR, 0); 568 1.1 jdolecek CSR_CLRBIT_1(sc, VGE_CAMCTL, VGE_CAMCTL_PAGESEL); 569 1.1 jdolecek CSR_SETBIT_1(sc, VGE_CAMCTL, VGE_PAGESEL_MAR); 570 1.1 jdolecek 571 1.21 tsutsui sc->sc_camidx = 0; 572 1.1 jdolecek } 573 1.1 jdolecek 574 1.1 jdolecek static int 575 1.15 tsutsui vge_cam_set(struct vge_softc *sc, uint8_t *addr) 576 1.1 jdolecek { 577 1.15 tsutsui int i, error; 578 1.15 tsutsui 579 1.15 tsutsui error = 0; 580 1.1 jdolecek 581 1.21 tsutsui if (sc->sc_camidx == VGE_CAM_MAXADDRS) 582 1.15 tsutsui return ENOSPC; 583 1.1 jdolecek 584 1.1 jdolecek /* Select the CAM data page. */ 585 1.1 jdolecek CSR_CLRBIT_1(sc, VGE_CAMCTL, VGE_CAMCTL_PAGESEL); 586 1.1 jdolecek CSR_SETBIT_1(sc, VGE_CAMCTL, VGE_PAGESEL_CAMDATA); 587 1.1 jdolecek 588 1.1 jdolecek /* Set the filter entry we want to update and enable writing. */ 589 1.21 tsutsui CSR_WRITE_1(sc, VGE_CAMADDR, VGE_CAMADDR_ENABLE | sc->sc_camidx); 590 1.1 jdolecek 591 1.1 jdolecek /* Write the address to the CAM registers */ 592 1.1 jdolecek for (i = 0; i < ETHER_ADDR_LEN; i++) 593 1.1 jdolecek CSR_WRITE_1(sc, VGE_CAM0 + i, addr[i]); 594 1.1 jdolecek 595 1.1 jdolecek /* Issue a write command. */ 596 1.1 jdolecek CSR_SETBIT_1(sc, VGE_CAMCTL, VGE_CAMCTL_WRITE); 597 1.1 jdolecek 598 1.1 jdolecek /* Wake for it to clear. */ 599 1.1 jdolecek for (i = 0; i < VGE_TIMEOUT; i++) { 600 1.1 jdolecek DELAY(1); 601 1.1 jdolecek if ((CSR_READ_1(sc, VGE_CAMCTL) & VGE_CAMCTL_WRITE) == 0) 602 1.1 jdolecek break; 603 1.1 jdolecek } 604 1.1 jdolecek 605 1.1 jdolecek if (i == VGE_TIMEOUT) { 606 1.48 tsutsui printf("%s: setting CAM filter failed\n", 607 1.48 tsutsui device_xname(sc->sc_dev)); 608 1.1 jdolecek error = EIO; 609 1.1 jdolecek goto fail; 610 1.1 jdolecek } 611 1.1 jdolecek 612 1.1 jdolecek /* Select the CAM mask page. */ 613 1.1 jdolecek CSR_CLRBIT_1(sc, VGE_CAMCTL, VGE_CAMCTL_PAGESEL); 614 1.1 jdolecek CSR_SETBIT_1(sc, VGE_CAMCTL, VGE_PAGESEL_CAMMASK); 615 1.1 jdolecek 616 1.1 jdolecek /* Set the mask bit that enables this filter. */ 617 1.21 tsutsui CSR_SETBIT_1(sc, VGE_CAM0 + (sc->sc_camidx / 8), 618 1.21 tsutsui 1 << (sc->sc_camidx & 7)); 619 1.1 jdolecek 620 1.21 tsutsui sc->sc_camidx++; 621 1.1 jdolecek 622 1.15 tsutsui fail: 623 1.1 jdolecek /* Turn off access to CAM. */ 624 1.1 jdolecek CSR_WRITE_1(sc, VGE_CAMADDR, 0); 625 1.1 jdolecek CSR_CLRBIT_1(sc, VGE_CAMCTL, VGE_CAMCTL_PAGESEL); 626 1.1 jdolecek CSR_SETBIT_1(sc, VGE_CAMCTL, VGE_PAGESEL_MAR); 627 1.1 jdolecek 628 1.15 tsutsui return error; 629 1.1 jdolecek } 630 1.1 jdolecek 631 1.1 jdolecek /* 632 1.1 jdolecek * Program the multicast filter. We use the 64-entry CAM filter 633 1.1 jdolecek * for perfect filtering. If there's more than 64 multicast addresses, 634 1.19 tsutsui * we use the hash filter instead. 635 1.1 jdolecek */ 636 1.1 jdolecek static void 637 1.15 tsutsui vge_setmulti(struct vge_softc *sc) 638 1.1 jdolecek { 639 1.70 msaitoh struct ethercom *ec = &sc->sc_ethercom; 640 1.70 msaitoh struct ifnet *ifp = &ec->ec_if; 641 1.15 tsutsui int error; 642 1.15 tsutsui uint32_t h, hashes[2] = { 0, 0 }; 643 1.1 jdolecek struct ether_multi *enm; 644 1.1 jdolecek struct ether_multistep step; 645 1.1 jdolecek 646 1.15 tsutsui error = 0; 647 1.1 jdolecek 648 1.1 jdolecek /* First, zot all the multicast entries. */ 649 1.1 jdolecek vge_cam_clear(sc); 650 1.1 jdolecek CSR_WRITE_4(sc, VGE_MAR0, 0); 651 1.1 jdolecek CSR_WRITE_4(sc, VGE_MAR1, 0); 652 1.6 christos ifp->if_flags &= ~IFF_ALLMULTI; 653 1.1 jdolecek 654 1.1 jdolecek /* 655 1.1 jdolecek * If the user wants allmulti or promisc mode, enable reception 656 1.1 jdolecek * of all multicast frames. 657 1.1 jdolecek */ 658 1.6 christos if (ifp->if_flags & IFF_PROMISC) { 659 1.15 tsutsui allmulti: 660 1.1 jdolecek CSR_WRITE_4(sc, VGE_MAR0, 0xFFFFFFFF); 661 1.1 jdolecek CSR_WRITE_4(sc, VGE_MAR1, 0xFFFFFFFF); 662 1.6 christos ifp->if_flags |= IFF_ALLMULTI; 663 1.1 jdolecek return; 664 1.1 jdolecek } 665 1.1 jdolecek 666 1.1 jdolecek /* Now program new ones */ 667 1.72 msaitoh ETHER_LOCK(ec); 668 1.70 msaitoh ETHER_FIRST_MULTI(step, ec, enm); 669 1.15 tsutsui while (enm != NULL) { 670 1.1 jdolecek /* 671 1.1 jdolecek * If multicast range, fall back to ALLMULTI. 672 1.1 jdolecek */ 673 1.1 jdolecek if (memcmp(enm->enm_addrlo, enm->enm_addrhi, 674 1.72 msaitoh ETHER_ADDR_LEN) != 0) { 675 1.72 msaitoh ETHER_UNLOCK(ec); 676 1.1 jdolecek goto allmulti; 677 1.72 msaitoh } 678 1.1 jdolecek 679 1.6 christos error = vge_cam_set(sc, enm->enm_addrlo); 680 1.1 jdolecek if (error) 681 1.1 jdolecek break; 682 1.1 jdolecek 683 1.1 jdolecek ETHER_NEXT_MULTI(step, enm); 684 1.1 jdolecek } 685 1.72 msaitoh ETHER_UNLOCK(ec); 686 1.1 jdolecek 687 1.1 jdolecek /* If there were too many addresses, use the hash filter. */ 688 1.1 jdolecek if (error) { 689 1.1 jdolecek vge_cam_clear(sc); 690 1.1 jdolecek 691 1.72 msaitoh ETHER_LOCK(ec); 692 1.70 msaitoh ETHER_FIRST_MULTI(step, ec, enm); 693 1.15 tsutsui while (enm != NULL) { 694 1.6 christos /* 695 1.6 christos * If multicast range, fall back to ALLMULTI. 696 1.6 christos */ 697 1.6 christos if (memcmp(enm->enm_addrlo, enm->enm_addrhi, 698 1.72 msaitoh ETHER_ADDR_LEN) != 0) { 699 1.72 msaitoh ETHER_UNLOCK(ec); 700 1.6 christos goto allmulti; 701 1.72 msaitoh } 702 1.6 christos 703 1.6 christos h = ether_crc32_be(enm->enm_addrlo, 704 1.6 christos ETHER_ADDR_LEN) >> 26; 705 1.6 christos hashes[h >> 5] |= 1 << (h & 0x1f); 706 1.6 christos 707 1.6 christos ETHER_NEXT_MULTI(step, enm); 708 1.1 jdolecek } 709 1.72 msaitoh ETHER_UNLOCK(ec); 710 1.1 jdolecek 711 1.1 jdolecek CSR_WRITE_4(sc, VGE_MAR0, hashes[0]); 712 1.1 jdolecek CSR_WRITE_4(sc, VGE_MAR1, hashes[1]); 713 1.1 jdolecek } 714 1.1 jdolecek } 715 1.1 jdolecek 716 1.1 jdolecek static void 717 1.15 tsutsui vge_reset(struct vge_softc *sc) 718 1.1 jdolecek { 719 1.15 tsutsui int i; 720 1.1 jdolecek 721 1.1 jdolecek CSR_WRITE_1(sc, VGE_CRS1, VGE_CR1_SOFTRESET); 722 1.1 jdolecek 723 1.1 jdolecek for (i = 0; i < VGE_TIMEOUT; i++) { 724 1.1 jdolecek DELAY(5); 725 1.1 jdolecek if ((CSR_READ_1(sc, VGE_CRS1) & VGE_CR1_SOFTRESET) == 0) 726 1.1 jdolecek break; 727 1.1 jdolecek } 728 1.1 jdolecek 729 1.1 jdolecek if (i == VGE_TIMEOUT) { 730 1.48 tsutsui printf("%s: soft reset timed out", device_xname(sc->sc_dev)); 731 1.1 jdolecek CSR_WRITE_1(sc, VGE_CRS3, VGE_CR3_STOP_FORCE); 732 1.1 jdolecek DELAY(2000); 733 1.1 jdolecek } 734 1.1 jdolecek 735 1.1 jdolecek DELAY(5000); 736 1.1 jdolecek 737 1.1 jdolecek CSR_SETBIT_1(sc, VGE_EECSR, VGE_EECSR_RELOAD); 738 1.1 jdolecek 739 1.1 jdolecek for (i = 0; i < VGE_TIMEOUT; i++) { 740 1.1 jdolecek DELAY(5); 741 1.1 jdolecek if ((CSR_READ_1(sc, VGE_EECSR) & VGE_EECSR_RELOAD) == 0) 742 1.1 jdolecek break; 743 1.1 jdolecek } 744 1.1 jdolecek 745 1.1 jdolecek if (i == VGE_TIMEOUT) { 746 1.48 tsutsui printf("%s: EEPROM reload timed out\n", 747 1.48 tsutsui device_xname(sc->sc_dev)); 748 1.1 jdolecek return; 749 1.1 jdolecek } 750 1.1 jdolecek 751 1.16 tsutsui /* 752 1.16 tsutsui * On some machine, the first read data from EEPROM could be 753 1.16 tsutsui * messed up, so read one dummy data here to avoid the mess. 754 1.16 tsutsui */ 755 1.16 tsutsui (void)vge_read_eeprom(sc, 0); 756 1.16 tsutsui 757 1.1 jdolecek CSR_CLRBIT_1(sc, VGE_CHIPCFG0, VGE_CHIPCFG0_PACPI); 758 1.1 jdolecek } 759 1.1 jdolecek 760 1.1 jdolecek /* 761 1.1 jdolecek * Probe for a VIA gigabit chip. Check the PCI vendor and device 762 1.1 jdolecek * IDs against our list and return a device name if we find a match. 763 1.1 jdolecek */ 764 1.1 jdolecek static int 765 1.46 cegger vge_match(device_t parent, cfdata_t match, void *aux) 766 1.1 jdolecek { 767 1.1 jdolecek struct pci_attach_args *pa = aux; 768 1.1 jdolecek 769 1.1 jdolecek if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_VIATECH 770 1.1 jdolecek && PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_VIATECH_VT612X) 771 1.1 jdolecek return 1; 772 1.1 jdolecek 773 1.15 tsutsui return 0; 774 1.1 jdolecek } 775 1.1 jdolecek 776 1.1 jdolecek static int 777 1.15 tsutsui vge_allocmem(struct vge_softc *sc) 778 1.1 jdolecek { 779 1.15 tsutsui int error; 780 1.15 tsutsui int nseg; 781 1.15 tsutsui int i; 782 1.15 tsutsui bus_dma_segment_t seg; 783 1.1 jdolecek 784 1.1 jdolecek /* 785 1.21 tsutsui * Allocate memory for control data. 786 1.80 thorpej * 787 1.80 thorpej * NOTE: This must all fit within the same 4GB segment. The 788 1.80 thorpej * "boundary" argument to bus_dmamem_alloc() will end up as 789 1.80 thorpej * 4GB on 64-bit platforms and 0 ("no boundary constraint") on 790 1.80 thorpej * 32-bit platformds. 791 1.1 jdolecek */ 792 1.21 tsutsui 793 1.21 tsutsui error = bus_dmamem_alloc(sc->sc_dmat, sizeof(struct vge_control_data), 794 1.80 thorpej VGE_RING_ALIGN, 795 1.80 thorpej (bus_size_t)(1ULL << 32), 796 1.80 thorpej &seg, 1, &nseg, BUS_DMA_NOWAIT); 797 1.1 jdolecek if (error) { 798 1.48 tsutsui aprint_error_dev(sc->sc_dev, 799 1.48 tsutsui "could not allocate control data dma memory\n"); 800 1.33 tsutsui goto fail_1; 801 1.1 jdolecek } 802 1.1 jdolecek 803 1.21 tsutsui /* Map the memory to kernel VA space */ 804 1.1 jdolecek 805 1.21 tsutsui error = bus_dmamem_map(sc->sc_dmat, &seg, nseg, 806 1.34 christos sizeof(struct vge_control_data), (void **)&sc->sc_control_data, 807 1.21 tsutsui BUS_DMA_NOWAIT); 808 1.1 jdolecek if (error) { 809 1.48 tsutsui aprint_error_dev(sc->sc_dev, 810 1.48 tsutsui "could not map control data dma memory\n"); 811 1.33 tsutsui goto fail_2; 812 1.1 jdolecek } 813 1.21 tsutsui memset(sc->sc_control_data, 0, sizeof(struct vge_control_data)); 814 1.1 jdolecek 815 1.21 tsutsui /* 816 1.21 tsutsui * Create map for control data. 817 1.21 tsutsui */ 818 1.21 tsutsui error = bus_dmamap_create(sc->sc_dmat, 819 1.21 tsutsui sizeof(struct vge_control_data), 1, 820 1.21 tsutsui sizeof(struct vge_control_data), 0, BUS_DMA_NOWAIT, 821 1.21 tsutsui &sc->sc_cddmamap); 822 1.1 jdolecek if (error) { 823 1.48 tsutsui aprint_error_dev(sc->sc_dev, 824 1.48 tsutsui "could not create control data dmamap\n"); 825 1.33 tsutsui goto fail_3; 826 1.1 jdolecek } 827 1.1 jdolecek 828 1.21 tsutsui /* Load the map for the control data. */ 829 1.21 tsutsui error = bus_dmamap_load(sc->sc_dmat, sc->sc_cddmamap, 830 1.21 tsutsui sc->sc_control_data, sizeof(struct vge_control_data), NULL, 831 1.21 tsutsui BUS_DMA_NOWAIT); 832 1.1 jdolecek if (error) { 833 1.48 tsutsui aprint_error_dev(sc->sc_dev, 834 1.48 tsutsui "could not load control data dma memory\n"); 835 1.33 tsutsui goto fail_4; 836 1.1 jdolecek } 837 1.1 jdolecek 838 1.1 jdolecek /* Create DMA maps for TX buffers */ 839 1.1 jdolecek 840 1.21 tsutsui for (i = 0; i < VGE_NTXDESC; i++) { 841 1.21 tsutsui error = bus_dmamap_create(sc->sc_dmat, VGE_TX_MAXLEN, 842 1.21 tsutsui VGE_TX_FRAGS, VGE_TX_MAXLEN, 0, BUS_DMA_NOWAIT, 843 1.21 tsutsui &sc->sc_txsoft[i].txs_dmamap); 844 1.1 jdolecek if (error) { 845 1.48 tsutsui aprint_error_dev(sc->sc_dev, 846 1.48 tsutsui "can't create DMA map for TX descs\n"); 847 1.33 tsutsui goto fail_5; 848 1.1 jdolecek } 849 1.1 jdolecek } 850 1.1 jdolecek 851 1.1 jdolecek /* Create DMA maps for RX buffers */ 852 1.1 jdolecek 853 1.21 tsutsui for (i = 0; i < VGE_NRXDESC; i++) { 854 1.21 tsutsui error = bus_dmamap_create(sc->sc_dmat, MCLBYTES, 855 1.21 tsutsui 1, MCLBYTES, 0, BUS_DMA_NOWAIT, 856 1.21 tsutsui &sc->sc_rxsoft[i].rxs_dmamap); 857 1.1 jdolecek if (error) { 858 1.48 tsutsui aprint_error_dev(sc->sc_dev, 859 1.48 tsutsui "can't create DMA map for RX descs\n"); 860 1.33 tsutsui goto fail_6; 861 1.1 jdolecek } 862 1.21 tsutsui sc->sc_rxsoft[i].rxs_mbuf = NULL; 863 1.1 jdolecek } 864 1.1 jdolecek 865 1.15 tsutsui return 0; 866 1.33 tsutsui 867 1.33 tsutsui fail_6: 868 1.33 tsutsui for (i = 0; i < VGE_NRXDESC; i++) { 869 1.33 tsutsui if (sc->sc_rxsoft[i].rxs_dmamap != NULL) 870 1.33 tsutsui bus_dmamap_destroy(sc->sc_dmat, 871 1.33 tsutsui sc->sc_rxsoft[i].rxs_dmamap); 872 1.33 tsutsui } 873 1.33 tsutsui fail_5: 874 1.33 tsutsui for (i = 0; i < VGE_NTXDESC; i++) { 875 1.33 tsutsui if (sc->sc_txsoft[i].txs_dmamap != NULL) 876 1.33 tsutsui bus_dmamap_destroy(sc->sc_dmat, 877 1.33 tsutsui sc->sc_txsoft[i].txs_dmamap); 878 1.33 tsutsui } 879 1.33 tsutsui bus_dmamap_unload(sc->sc_dmat, sc->sc_cddmamap); 880 1.33 tsutsui fail_4: 881 1.33 tsutsui bus_dmamap_destroy(sc->sc_dmat, sc->sc_cddmamap); 882 1.33 tsutsui fail_3: 883 1.34 christos bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_control_data, 884 1.33 tsutsui sizeof(struct vge_control_data)); 885 1.33 tsutsui fail_2: 886 1.33 tsutsui bus_dmamem_free(sc->sc_dmat, &seg, nseg); 887 1.33 tsutsui fail_1: 888 1.33 tsutsui return ENOMEM; 889 1.1 jdolecek } 890 1.1 jdolecek 891 1.1 jdolecek /* 892 1.1 jdolecek * Attach the interface. Allocate softc structures, do ifmedia 893 1.1 jdolecek * setup and ethernet/BPF attach. 894 1.1 jdolecek */ 895 1.1 jdolecek static void 896 1.46 cegger vge_attach(device_t parent, device_t self, void *aux) 897 1.1 jdolecek { 898 1.15 tsutsui uint8_t *eaddr; 899 1.47 cegger struct vge_softc *sc = device_private(self); 900 1.15 tsutsui struct ifnet *ifp; 901 1.70 msaitoh struct mii_data * const mii = &sc->sc_mii; 902 1.1 jdolecek struct pci_attach_args *pa = aux; 903 1.1 jdolecek pci_chipset_tag_t pc = pa->pa_pc; 904 1.1 jdolecek const char *intrstr; 905 1.1 jdolecek pci_intr_handle_t ih; 906 1.11 tsutsui uint16_t val; 907 1.56 christos char intrbuf[PCI_INTRSTR_LEN]; 908 1.1 jdolecek 909 1.48 tsutsui sc->sc_dev = self; 910 1.48 tsutsui 911 1.52 drochner pci_aprint_devinfo_fancy(pa, NULL, "VIA VT612X Gigabit Ethernet", 1); 912 1.1 jdolecek 913 1.1 jdolecek /* Make sure bus-mastering is enabled */ 914 1.71 msaitoh pci_conf_write(pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, 915 1.15 tsutsui pci_conf_read(pc, pa->pa_tag, PCI_COMMAND_STATUS_REG) | 916 1.15 tsutsui PCI_COMMAND_MASTER_ENABLE); 917 1.1 jdolecek 918 1.1 jdolecek /* 919 1.1 jdolecek * Map control/status registers. 920 1.1 jdolecek */ 921 1.15 tsutsui if (pci_mapreg_map(pa, VGE_PCI_LOMEM, PCI_MAPREG_TYPE_MEM, 0, 922 1.21 tsutsui &sc->sc_bst, &sc->sc_bsh, NULL, NULL) != 0) { 923 1.48 tsutsui aprint_error_dev(self, "couldn't map memory\n"); 924 1.1 jdolecek return; 925 1.1 jdolecek } 926 1.1 jdolecek 927 1.71 msaitoh /* 928 1.71 msaitoh * Map and establish our interrupt. 929 1.71 msaitoh */ 930 1.1 jdolecek if (pci_intr_map(pa, &ih)) { 931 1.48 tsutsui aprint_error_dev(self, "unable to map interrupt\n"); 932 1.1 jdolecek return; 933 1.1 jdolecek } 934 1.56 christos intrstr = pci_intr_string(pc, ih, intrbuf, sizeof(intrbuf)); 935 1.66 jdolecek sc->sc_intrhand = pci_intr_establish_xname(pc, ih, IPL_NET, vge_intr, 936 1.66 jdolecek sc, device_xname(self)); 937 1.21 tsutsui if (sc->sc_intrhand == NULL) { 938 1.48 tsutsui aprint_error_dev(self, "unable to establish interrupt"); 939 1.1 jdolecek if (intrstr != NULL) 940 1.21 tsutsui aprint_error(" at %s", intrstr); 941 1.21 tsutsui aprint_error("\n"); 942 1.1 jdolecek return; 943 1.1 jdolecek } 944 1.48 tsutsui aprint_normal_dev(self, "interrupting at %s\n", intrstr); 945 1.1 jdolecek 946 1.1 jdolecek /* Reset the adapter. */ 947 1.1 jdolecek vge_reset(sc); 948 1.1 jdolecek 949 1.1 jdolecek /* 950 1.1 jdolecek * Get station address from the EEPROM. 951 1.1 jdolecek */ 952 1.21 tsutsui eaddr = sc->sc_eaddr; 953 1.11 tsutsui val = vge_read_eeprom(sc, VGE_EE_EADDR + 0); 954 1.11 tsutsui eaddr[0] = val & 0xff; 955 1.11 tsutsui eaddr[1] = val >> 8; 956 1.11 tsutsui val = vge_read_eeprom(sc, VGE_EE_EADDR + 1); 957 1.11 tsutsui eaddr[2] = val & 0xff; 958 1.11 tsutsui eaddr[3] = val >> 8; 959 1.11 tsutsui val = vge_read_eeprom(sc, VGE_EE_EADDR + 2); 960 1.11 tsutsui eaddr[4] = val & 0xff; 961 1.11 tsutsui eaddr[5] = val >> 8; 962 1.1 jdolecek 963 1.64 sevan aprint_normal_dev(self, "Ethernet address %s\n", 964 1.1 jdolecek ether_sprintf(eaddr)); 965 1.1 jdolecek 966 1.75 msaitoh /* Clear WOL and take hardware from powerdown. */ 967 1.75 msaitoh vge_clrwol(sc); 968 1.75 msaitoh 969 1.1 jdolecek /* 970 1.80 thorpej * The hardware supports 64-bit DMA addresses, but it's a little 971 1.80 thorpej * complicated (see large comment about the hardware near the top 972 1.80 thorpej * of the file). TL;DR -- restrict ourselves to 48-bit. 973 1.80 thorpej */ 974 1.80 thorpej if (pci_dma64_available(pa)) { 975 1.80 thorpej if (bus_dmatag_subregion(pa->pa_dmat64, 976 1.80 thorpej 0, 977 1.83 martin (bus_addr_t)__MASK(48), 978 1.80 thorpej &sc->sc_dmat, 979 1.80 thorpej BUS_DMA_WAITOK) != 0) { 980 1.80 thorpej aprint_error_dev(self, 981 1.80 thorpej "WARNING: failed to restrict dma range," 982 1.80 thorpej " falling back to parent bus dma range\n"); 983 1.80 thorpej sc->sc_dmat = pa->pa_dmat64; 984 1.80 thorpej } 985 1.80 thorpej } else { 986 1.80 thorpej sc->sc_dmat = pa->pa_dmat; 987 1.80 thorpej } 988 1.1 jdolecek 989 1.32 tsutsui if (vge_allocmem(sc) != 0) 990 1.1 jdolecek return; 991 1.1 jdolecek 992 1.1 jdolecek ifp = &sc->sc_ethercom.ec_if; 993 1.1 jdolecek ifp->if_softc = sc; 994 1.48 tsutsui strlcpy(ifp->if_xname, device_xname(self), IFNAMSIZ); 995 1.1 jdolecek ifp->if_mtu = ETHERMTU; 996 1.1 jdolecek ifp->if_baudrate = IF_Gbps(1); 997 1.1 jdolecek ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 998 1.1 jdolecek ifp->if_ioctl = vge_ioctl; 999 1.1 jdolecek ifp->if_start = vge_start; 1000 1.43 joerg ifp->if_init = vge_init; 1001 1.43 joerg ifp->if_stop = vge_stop; 1002 1.1 jdolecek 1003 1.1 jdolecek /* 1004 1.1 jdolecek * We can support 802.1Q VLAN-sized frames and jumbo 1005 1.1 jdolecek * Ethernet frames. 1006 1.1 jdolecek */ 1007 1.1 jdolecek sc->sc_ethercom.ec_capabilities |= 1008 1.1 jdolecek ETHERCAP_VLAN_MTU | ETHERCAP_JUMBO_MTU | 1009 1.1 jdolecek ETHERCAP_VLAN_HWTAGGING; 1010 1.73 msaitoh sc->sc_ethercom.ec_capenable |= ETHERCAP_VLAN_HWTAGGING; 1011 1.1 jdolecek 1012 1.1 jdolecek /* 1013 1.1 jdolecek * We can do IPv4/TCPv4/UDPv4 checksums in hardware. 1014 1.1 jdolecek */ 1015 1.5 yamt ifp->if_capabilities |= 1016 1.5 yamt IFCAP_CSUM_IPv4_Tx | IFCAP_CSUM_IPv4_Rx | 1017 1.5 yamt IFCAP_CSUM_TCPv4_Tx | IFCAP_CSUM_TCPv4_Rx | 1018 1.5 yamt IFCAP_CSUM_UDPv4_Tx | IFCAP_CSUM_UDPv4_Rx; 1019 1.1 jdolecek 1020 1.1 jdolecek #ifdef DEVICE_POLLING 1021 1.1 jdolecek #ifdef IFCAP_POLLING 1022 1.1 jdolecek ifp->if_capabilities |= IFCAP_POLLING; 1023 1.1 jdolecek #endif 1024 1.1 jdolecek #endif 1025 1.1 jdolecek ifp->if_watchdog = vge_watchdog; 1026 1.65 riastrad IFQ_SET_MAXLEN(&ifp->if_snd, uimax(VGE_IFQ_MAXLEN, IFQ_MAXLEN)); 1027 1.43 joerg IFQ_SET_READY(&ifp->if_snd); 1028 1.1 jdolecek 1029 1.1 jdolecek /* 1030 1.1 jdolecek * Initialize our media structures and probe the MII. 1031 1.1 jdolecek */ 1032 1.70 msaitoh mii->mii_ifp = ifp; 1033 1.70 msaitoh mii->mii_readreg = vge_miibus_readreg; 1034 1.70 msaitoh mii->mii_writereg = vge_miibus_writereg; 1035 1.70 msaitoh mii->mii_statchg = vge_miibus_statchg; 1036 1.70 msaitoh 1037 1.70 msaitoh sc->sc_ethercom.ec_mii = mii; 1038 1.70 msaitoh ifmedia_init(&mii->mii_media, 0, ether_mediachange, ether_mediastatus); 1039 1.70 msaitoh mii_attach(self, mii, 0xffffffff, MII_PHY_ANY, 1040 1.1 jdolecek MII_OFFSET_ANY, MIIF_DOPAUSE); 1041 1.70 msaitoh if (LIST_FIRST(&mii->mii_phys) == NULL) { 1042 1.70 msaitoh ifmedia_add(&mii->mii_media, IFM_ETHER | IFM_NONE, 0, NULL); 1043 1.70 msaitoh ifmedia_set(&mii->mii_media, IFM_ETHER | IFM_NONE); 1044 1.1 jdolecek } else 1045 1.70 msaitoh ifmedia_set(&mii->mii_media, IFM_ETHER | IFM_AUTO); 1046 1.1 jdolecek 1047 1.1 jdolecek /* 1048 1.1 jdolecek * Attach the interface. 1049 1.1 jdolecek */ 1050 1.1 jdolecek if_attach(ifp); 1051 1.59 ozaki if_deferred_start_init(ifp, NULL); 1052 1.1 jdolecek ether_ifattach(ifp, eaddr); 1053 1.42 dyoung ether_set_ifflags_cb(&sc->sc_ethercom, vge_ifflags_cb); 1054 1.1 jdolecek 1055 1.36 ad callout_init(&sc->sc_timeout, 0); 1056 1.21 tsutsui callout_setfunc(&sc->sc_timeout, vge_tick, sc); 1057 1.1 jdolecek 1058 1.1 jdolecek /* 1059 1.1 jdolecek * Make sure the interface is shutdown during reboot. 1060 1.1 jdolecek */ 1061 1.49 tsutsui if (pmf_device_register1(self, NULL, NULL, vge_shutdown)) 1062 1.49 tsutsui pmf_class_network_register(self, ifp); 1063 1.49 tsutsui else 1064 1.49 tsutsui aprint_error_dev(self, "couldn't establish power handler\n"); 1065 1.1 jdolecek } 1066 1.1 jdolecek 1067 1.1 jdolecek static int 1068 1.15 tsutsui vge_newbuf(struct vge_softc *sc, int idx, struct mbuf *m) 1069 1.15 tsutsui { 1070 1.15 tsutsui struct mbuf *m_new; 1071 1.21 tsutsui struct vge_rxdesc *rxd; 1072 1.21 tsutsui struct vge_rxsoft *rxs; 1073 1.15 tsutsui bus_dmamap_t map; 1074 1.15 tsutsui int i; 1075 1.29 tsutsui #ifdef DIAGNOSTIC 1076 1.29 tsutsui uint32_t rd_sts; 1077 1.29 tsutsui #endif 1078 1.1 jdolecek 1079 1.15 tsutsui m_new = NULL; 1080 1.1 jdolecek if (m == NULL) { 1081 1.15 tsutsui MGETHDR(m_new, M_DONTWAIT, MT_DATA); 1082 1.15 tsutsui if (m_new == NULL) 1083 1.15 tsutsui return ENOBUFS; 1084 1.1 jdolecek 1085 1.15 tsutsui MCLGET(m_new, M_DONTWAIT); 1086 1.15 tsutsui if ((m_new->m_flags & M_EXT) == 0) { 1087 1.15 tsutsui m_freem(m_new); 1088 1.15 tsutsui return ENOBUFS; 1089 1.1 jdolecek } 1090 1.1 jdolecek 1091 1.15 tsutsui m = m_new; 1092 1.1 jdolecek } else 1093 1.1 jdolecek m->m_data = m->m_ext.ext_buf; 1094 1.1 jdolecek 1095 1.1 jdolecek 1096 1.1 jdolecek /* 1097 1.1 jdolecek * This is part of an evil trick to deal with non-x86 platforms. 1098 1.1 jdolecek * The VIA chip requires RX buffers to be aligned on 32-bit 1099 1.1 jdolecek * boundaries, but that will hose non-x86 machines. To get around 1100 1.1 jdolecek * this, we leave some empty space at the start of each buffer 1101 1.1 jdolecek * and for non-x86 hosts, we copy the buffer back two bytes 1102 1.1 jdolecek * to achieve word alignment. This is slightly more efficient 1103 1.1 jdolecek * than allocating a new buffer, copying the contents, and 1104 1.1 jdolecek * discarding the old buffer. 1105 1.1 jdolecek */ 1106 1.28 tsutsui m->m_len = m->m_pkthdr.len = VGE_RX_BUFSIZE; 1107 1.28 tsutsui #ifndef __NO_STRICT_ALIGNMENT 1108 1.21 tsutsui m->m_data += VGE_RX_PAD; 1109 1.1 jdolecek #endif 1110 1.21 tsutsui rxs = &sc->sc_rxsoft[idx]; 1111 1.21 tsutsui map = rxs->rxs_dmamap; 1112 1.1 jdolecek 1113 1.21 tsutsui if (bus_dmamap_load_mbuf(sc->sc_dmat, map, m, BUS_DMA_NOWAIT) != 0) 1114 1.14 tsutsui goto out; 1115 1.14 tsutsui 1116 1.21 tsutsui rxd = &sc->sc_rxdescs[idx]; 1117 1.14 tsutsui 1118 1.29 tsutsui #ifdef DIAGNOSTIC 1119 1.14 tsutsui /* If this descriptor is still owned by the chip, bail. */ 1120 1.70 msaitoh VGE_RXDESCSYNC(sc, idx, BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 1121 1.29 tsutsui rd_sts = le32toh(rxd->rd_sts); 1122 1.29 tsutsui VGE_RXDESCSYNC(sc, idx, BUS_DMASYNC_PREREAD); 1123 1.29 tsutsui if (rd_sts & VGE_RDSTS_OWN) { 1124 1.29 tsutsui panic("%s: tried to map busy RX descriptor", 1125 1.48 tsutsui device_xname(sc->sc_dev)); 1126 1.1 jdolecek } 1127 1.29 tsutsui #endif 1128 1.1 jdolecek 1129 1.21 tsutsui rxs->rxs_mbuf = m; 1130 1.21 tsutsui bus_dmamap_sync(sc->sc_dmat, map, 0, map->dm_mapsize, 1131 1.21 tsutsui BUS_DMASYNC_PREREAD); 1132 1.21 tsutsui 1133 1.21 tsutsui rxd->rd_buflen = 1134 1.14 tsutsui htole16(VGE_BUFLEN(map->dm_segs[0].ds_len) | VGE_RXDESC_I); 1135 1.29 tsutsui vge_set_rxaddr(rxd, map->dm_segs[0].ds_addr); 1136 1.21 tsutsui rxd->rd_sts = 0; 1137 1.21 tsutsui rxd->rd_ctl = 0; 1138 1.70 msaitoh VGE_RXDESCSYNC(sc, idx, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 1139 1.14 tsutsui 1140 1.1 jdolecek /* 1141 1.1 jdolecek * Note: the manual fails to document the fact that for 1142 1.78 msaitoh * proper operation, the driver needs to replentish the RX 1143 1.1 jdolecek * DMA ring 4 descriptors at a time (rather than one at a 1144 1.1 jdolecek * time, like most chips). We can allocate the new buffers 1145 1.1 jdolecek * but we should not set the OWN bits until we're ready 1146 1.1 jdolecek * to hand back 4 of them in one shot. 1147 1.1 jdolecek */ 1148 1.1 jdolecek 1149 1.1 jdolecek #define VGE_RXCHUNK 4 1150 1.21 tsutsui sc->sc_rx_consumed++; 1151 1.21 tsutsui if (sc->sc_rx_consumed == VGE_RXCHUNK) { 1152 1.21 tsutsui for (i = idx; i != idx - VGE_RXCHUNK; i--) { 1153 1.21 tsutsui KASSERT(i >= 0); 1154 1.21 tsutsui sc->sc_rxdescs[i].rd_sts |= htole32(VGE_RDSTS_OWN); 1155 1.14 tsutsui VGE_RXDESCSYNC(sc, i, 1156 1.70 msaitoh BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 1157 1.14 tsutsui } 1158 1.21 tsutsui sc->sc_rx_consumed = 0; 1159 1.1 jdolecek } 1160 1.1 jdolecek 1161 1.15 tsutsui return 0; 1162 1.14 tsutsui out: 1163 1.89 rin m_freem(m_new); 1164 1.15 tsutsui return ENOMEM; 1165 1.1 jdolecek } 1166 1.1 jdolecek 1167 1.13 tsutsui #ifndef __NO_STRICT_ALIGNMENT 1168 1.8 perry static inline void 1169 1.15 tsutsui vge_fixup_rx(struct mbuf *m) 1170 1.1 jdolecek { 1171 1.15 tsutsui int i; 1172 1.15 tsutsui uint16_t *src, *dst; 1173 1.1 jdolecek 1174 1.1 jdolecek src = mtod(m, uint16_t *); 1175 1.1 jdolecek dst = src - 1; 1176 1.1 jdolecek 1177 1.1 jdolecek for (i = 0; i < (m->m_len / sizeof(uint16_t) + 1); i++) 1178 1.1 jdolecek *dst++ = *src++; 1179 1.1 jdolecek 1180 1.1 jdolecek m->m_data -= ETHER_ALIGN; 1181 1.1 jdolecek } 1182 1.1 jdolecek #endif 1183 1.1 jdolecek 1184 1.1 jdolecek /* 1185 1.1 jdolecek * RX handler. We support the reception of jumbo frames that have 1186 1.1 jdolecek * been fragmented across multiple 2K mbuf cluster buffers. 1187 1.1 jdolecek */ 1188 1.1 jdolecek static void 1189 1.15 tsutsui vge_rxeof(struct vge_softc *sc) 1190 1.1 jdolecek { 1191 1.15 tsutsui struct mbuf *m; 1192 1.15 tsutsui struct ifnet *ifp; 1193 1.15 tsutsui int idx, total_len, lim; 1194 1.21 tsutsui struct vge_rxdesc *cur_rxd; 1195 1.21 tsutsui struct vge_rxsoft *rxs; 1196 1.15 tsutsui uint32_t rxstat, rxctl; 1197 1.1 jdolecek 1198 1.1 jdolecek ifp = &sc->sc_ethercom.ec_if; 1199 1.15 tsutsui lim = 0; 1200 1.1 jdolecek 1201 1.1 jdolecek /* Invalidate the descriptor memory */ 1202 1.1 jdolecek 1203 1.21 tsutsui for (idx = sc->sc_rx_prodidx;; idx = VGE_NEXT_RXDESC(idx)) { 1204 1.21 tsutsui cur_rxd = &sc->sc_rxdescs[idx]; 1205 1.1 jdolecek 1206 1.14 tsutsui VGE_RXDESCSYNC(sc, idx, 1207 1.70 msaitoh BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 1208 1.21 tsutsui rxstat = le32toh(cur_rxd->rd_sts); 1209 1.14 tsutsui if ((rxstat & VGE_RDSTS_OWN) != 0) { 1210 1.14 tsutsui VGE_RXDESCSYNC(sc, idx, BUS_DMASYNC_PREREAD); 1211 1.14 tsutsui break; 1212 1.14 tsutsui } 1213 1.1 jdolecek 1214 1.21 tsutsui rxctl = le32toh(cur_rxd->rd_ctl); 1215 1.21 tsutsui rxs = &sc->sc_rxsoft[idx]; 1216 1.21 tsutsui m = rxs->rxs_mbuf; 1217 1.14 tsutsui total_len = (rxstat & VGE_RDSTS_BUFSIZ) >> 16; 1218 1.1 jdolecek 1219 1.1 jdolecek /* Invalidate the RX mbuf and unload its map */ 1220 1.1 jdolecek 1221 1.21 tsutsui bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 1222 1.21 tsutsui 0, rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_POSTREAD); 1223 1.21 tsutsui bus_dmamap_unload(sc->sc_dmat, rxs->rxs_dmamap); 1224 1.1 jdolecek 1225 1.1 jdolecek /* 1226 1.1 jdolecek * If the 'start of frame' bit is set, this indicates 1227 1.1 jdolecek * either the first fragment in a multi-fragment receive, 1228 1.1 jdolecek * or an intermediate fragment. Either way, we want to 1229 1.1 jdolecek * accumulate the buffers. 1230 1.1 jdolecek */ 1231 1.1 jdolecek if (rxstat & VGE_RXPKT_SOF) { 1232 1.28 tsutsui m->m_len = VGE_RX_BUFSIZE; 1233 1.21 tsutsui if (sc->sc_rx_mhead == NULL) 1234 1.21 tsutsui sc->sc_rx_mhead = sc->sc_rx_mtail = m; 1235 1.1 jdolecek else { 1236 1.1 jdolecek m->m_flags &= ~M_PKTHDR; 1237 1.21 tsutsui sc->sc_rx_mtail->m_next = m; 1238 1.21 tsutsui sc->sc_rx_mtail = m; 1239 1.1 jdolecek } 1240 1.14 tsutsui vge_newbuf(sc, idx, NULL); 1241 1.1 jdolecek continue; 1242 1.1 jdolecek } 1243 1.1 jdolecek 1244 1.1 jdolecek /* 1245 1.1 jdolecek * Bad/error frames will have the RXOK bit cleared. 1246 1.1 jdolecek * However, there's one error case we want to allow: 1247 1.1 jdolecek * if a VLAN tagged frame arrives and the chip can't 1248 1.1 jdolecek * match it against the CAM filter, it considers this 1249 1.1 jdolecek * a 'VLAN CAM filter miss' and clears the 'RXOK' bit. 1250 1.1 jdolecek * We don't want to drop the frame though: our VLAN 1251 1.1 jdolecek * filtering is done in software. 1252 1.1 jdolecek */ 1253 1.32 tsutsui if ((rxstat & VGE_RDSTS_RXOK) == 0 && 1254 1.32 tsutsui (rxstat & VGE_RDSTS_VIDM) == 0 && 1255 1.32 tsutsui (rxstat & VGE_RDSTS_CSUMERR) == 0) { 1256 1.79 thorpej if_statinc(ifp, if_ierrors); 1257 1.1 jdolecek /* 1258 1.1 jdolecek * If this is part of a multi-fragment packet, 1259 1.1 jdolecek * discard all the pieces. 1260 1.1 jdolecek */ 1261 1.21 tsutsui if (sc->sc_rx_mhead != NULL) { 1262 1.21 tsutsui m_freem(sc->sc_rx_mhead); 1263 1.21 tsutsui sc->sc_rx_mhead = sc->sc_rx_mtail = NULL; 1264 1.1 jdolecek } 1265 1.14 tsutsui vge_newbuf(sc, idx, m); 1266 1.1 jdolecek continue; 1267 1.1 jdolecek } 1268 1.1 jdolecek 1269 1.1 jdolecek /* 1270 1.1 jdolecek * If allocating a replacement mbuf fails, 1271 1.1 jdolecek * reload the current one. 1272 1.1 jdolecek */ 1273 1.1 jdolecek 1274 1.14 tsutsui if (vge_newbuf(sc, idx, NULL)) { 1275 1.79 thorpej if_statinc(ifp, if_ierrors); 1276 1.21 tsutsui if (sc->sc_rx_mhead != NULL) { 1277 1.21 tsutsui m_freem(sc->sc_rx_mhead); 1278 1.21 tsutsui sc->sc_rx_mhead = sc->sc_rx_mtail = NULL; 1279 1.1 jdolecek } 1280 1.14 tsutsui vge_newbuf(sc, idx, m); 1281 1.1 jdolecek continue; 1282 1.1 jdolecek } 1283 1.1 jdolecek 1284 1.21 tsutsui if (sc->sc_rx_mhead != NULL) { 1285 1.28 tsutsui m->m_len = total_len % VGE_RX_BUFSIZE; 1286 1.1 jdolecek /* 1287 1.1 jdolecek * Special case: if there's 4 bytes or less 1288 1.1 jdolecek * in this buffer, the mbuf can be discarded: 1289 1.1 jdolecek * the last 4 bytes is the CRC, which we don't 1290 1.1 jdolecek * care about anyway. 1291 1.1 jdolecek */ 1292 1.1 jdolecek if (m->m_len <= ETHER_CRC_LEN) { 1293 1.21 tsutsui sc->sc_rx_mtail->m_len -= 1294 1.1 jdolecek (ETHER_CRC_LEN - m->m_len); 1295 1.1 jdolecek m_freem(m); 1296 1.1 jdolecek } else { 1297 1.1 jdolecek m->m_len -= ETHER_CRC_LEN; 1298 1.1 jdolecek m->m_flags &= ~M_PKTHDR; 1299 1.21 tsutsui sc->sc_rx_mtail->m_next = m; 1300 1.1 jdolecek } 1301 1.21 tsutsui m = sc->sc_rx_mhead; 1302 1.21 tsutsui sc->sc_rx_mhead = sc->sc_rx_mtail = NULL; 1303 1.1 jdolecek m->m_pkthdr.len = total_len - ETHER_CRC_LEN; 1304 1.1 jdolecek } else 1305 1.21 tsutsui m->m_pkthdr.len = m->m_len = total_len - ETHER_CRC_LEN; 1306 1.1 jdolecek 1307 1.13 tsutsui #ifndef __NO_STRICT_ALIGNMENT 1308 1.1 jdolecek vge_fixup_rx(m); 1309 1.1 jdolecek #endif 1310 1.58 ozaki m_set_rcvif(m, ifp); 1311 1.1 jdolecek 1312 1.1 jdolecek /* Do RX checksumming if enabled */ 1313 1.1 jdolecek if (ifp->if_csum_flags_rx & M_CSUM_IPv4) { 1314 1.1 jdolecek 1315 1.1 jdolecek /* Check IP header checksum */ 1316 1.1 jdolecek if (rxctl & VGE_RDCTL_IPPKT) 1317 1.1 jdolecek m->m_pkthdr.csum_flags |= M_CSUM_IPv4; 1318 1.1 jdolecek if ((rxctl & VGE_RDCTL_IPCSUMOK) == 0) 1319 1.1 jdolecek m->m_pkthdr.csum_flags |= M_CSUM_IPv4_BAD; 1320 1.1 jdolecek } 1321 1.1 jdolecek 1322 1.1 jdolecek if (ifp->if_csum_flags_rx & M_CSUM_TCPv4) { 1323 1.1 jdolecek /* Check UDP checksum */ 1324 1.1 jdolecek if (rxctl & VGE_RDCTL_TCPPKT) 1325 1.1 jdolecek m->m_pkthdr.csum_flags |= M_CSUM_TCPv4; 1326 1.1 jdolecek 1327 1.1 jdolecek if ((rxctl & VGE_RDCTL_PROTOCSUMOK) == 0) 1328 1.1 jdolecek m->m_pkthdr.csum_flags |= M_CSUM_TCP_UDP_BAD; 1329 1.1 jdolecek } 1330 1.1 jdolecek 1331 1.1 jdolecek if (ifp->if_csum_flags_rx & M_CSUM_UDPv4) { 1332 1.1 jdolecek /* Check UDP checksum */ 1333 1.1 jdolecek if (rxctl & VGE_RDCTL_UDPPKT) 1334 1.1 jdolecek m->m_pkthdr.csum_flags |= M_CSUM_UDPv4; 1335 1.1 jdolecek 1336 1.1 jdolecek if ((rxctl & VGE_RDCTL_PROTOCSUMOK) == 0) 1337 1.1 jdolecek m->m_pkthdr.csum_flags |= M_CSUM_TCP_UDP_BAD; 1338 1.1 jdolecek } 1339 1.1 jdolecek 1340 1.20 tsutsui if (rxstat & VGE_RDSTS_VTAG) { 1341 1.20 tsutsui /* 1342 1.20 tsutsui * We use bswap16() here because: 1343 1.20 tsutsui * On LE machines, tag is stored in BE as stream data. 1344 1.20 tsutsui * On BE machines, tag is stored in BE as stream data 1345 1.20 tsutsui * but it was already swapped by le32toh() above. 1346 1.20 tsutsui */ 1347 1.61 knakahar vlan_set_tag(m, bswap16(rxctl & VGE_RDCTL_VLANID)); 1348 1.20 tsutsui } 1349 1.1 jdolecek 1350 1.57 ozaki if_percpuq_enqueue(ifp->if_percpuq, m); 1351 1.1 jdolecek 1352 1.1 jdolecek lim++; 1353 1.21 tsutsui if (lim == VGE_NRXDESC) 1354 1.1 jdolecek break; 1355 1.1 jdolecek } 1356 1.1 jdolecek 1357 1.21 tsutsui sc->sc_rx_prodidx = idx; 1358 1.1 jdolecek CSR_WRITE_2(sc, VGE_RXDESC_RESIDUECNT, lim); 1359 1.1 jdolecek } 1360 1.1 jdolecek 1361 1.1 jdolecek static void 1362 1.15 tsutsui vge_txeof(struct vge_softc *sc) 1363 1.1 jdolecek { 1364 1.15 tsutsui struct ifnet *ifp; 1365 1.21 tsutsui struct vge_txsoft *txs; 1366 1.15 tsutsui uint32_t txstat; 1367 1.15 tsutsui int idx; 1368 1.1 jdolecek 1369 1.1 jdolecek ifp = &sc->sc_ethercom.ec_if; 1370 1.1 jdolecek 1371 1.21 tsutsui for (idx = sc->sc_tx_considx; 1372 1.29 tsutsui sc->sc_tx_free < VGE_NTXDESC; 1373 1.29 tsutsui idx = VGE_NEXT_TXDESC(idx), sc->sc_tx_free++) { 1374 1.14 tsutsui VGE_TXDESCSYNC(sc, idx, 1375 1.70 msaitoh BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 1376 1.21 tsutsui txstat = le32toh(sc->sc_txdescs[idx].td_sts); 1377 1.29 tsutsui VGE_TXDESCSYNC(sc, idx, BUS_DMASYNC_PREREAD); 1378 1.14 tsutsui if (txstat & VGE_TDSTS_OWN) { 1379 1.1 jdolecek break; 1380 1.14 tsutsui } 1381 1.1 jdolecek 1382 1.21 tsutsui txs = &sc->sc_txsoft[idx]; 1383 1.21 tsutsui bus_dmamap_sync(sc->sc_dmat, txs->txs_dmamap, 0, 1384 1.21 tsutsui txs->txs_dmamap->dm_mapsize, BUS_DMASYNC_POSTWRITE); 1385 1.21 tsutsui bus_dmamap_unload(sc->sc_dmat, txs->txs_dmamap); 1386 1.84 rin m_freem(txs->txs_mbuf); 1387 1.84 rin txs->txs_mbuf = NULL; 1388 1.79 thorpej net_stat_ref_t nsr = IF_STAT_GETREF(ifp); 1389 1.70 msaitoh if (txstat & (VGE_TDSTS_EXCESSCOLL | VGE_TDSTS_COLL)) 1390 1.88 riastrad if_statinc_ref(ifp, nsr, if_collisions); 1391 1.1 jdolecek if (txstat & VGE_TDSTS_TXERR) 1392 1.88 riastrad if_statinc_ref(ifp, nsr, if_oerrors); 1393 1.1 jdolecek else 1394 1.88 riastrad if_statinc_ref(ifp, nsr, if_opackets); 1395 1.79 thorpej IF_STAT_PUTREF(ifp); 1396 1.1 jdolecek } 1397 1.1 jdolecek 1398 1.29 tsutsui sc->sc_tx_considx = idx; 1399 1.1 jdolecek 1400 1.1 jdolecek /* 1401 1.1 jdolecek * If not all descriptors have been released reaped yet, 1402 1.1 jdolecek * reload the timer so that we will eventually get another 1403 1.1 jdolecek * interrupt that will cause us to re-enter this routine. 1404 1.1 jdolecek * This is done in case the transmitter has gone idle. 1405 1.1 jdolecek */ 1406 1.29 tsutsui if (sc->sc_tx_free < VGE_NTXDESC) 1407 1.1 jdolecek CSR_WRITE_1(sc, VGE_CRS1, VGE_CR1_TIMER0_ENABLE); 1408 1.21 tsutsui else 1409 1.21 tsutsui ifp->if_timer = 0; 1410 1.1 jdolecek } 1411 1.1 jdolecek 1412 1.1 jdolecek static void 1413 1.48 tsutsui vge_tick(void *arg) 1414 1.1 jdolecek { 1415 1.15 tsutsui struct vge_softc *sc; 1416 1.15 tsutsui struct ifnet *ifp; 1417 1.15 tsutsui struct mii_data *mii; 1418 1.1 jdolecek int s; 1419 1.1 jdolecek 1420 1.48 tsutsui sc = arg; 1421 1.15 tsutsui ifp = &sc->sc_ethercom.ec_if; 1422 1.15 tsutsui mii = &sc->sc_mii; 1423 1.15 tsutsui 1424 1.1 jdolecek s = splnet(); 1425 1.1 jdolecek 1426 1.21 tsutsui callout_schedule(&sc->sc_timeout, hz); 1427 1.1 jdolecek 1428 1.1 jdolecek mii_tick(mii); 1429 1.21 tsutsui if (sc->sc_link) { 1430 1.32 tsutsui if ((mii->mii_media_status & IFM_ACTIVE) == 0) 1431 1.21 tsutsui sc->sc_link = 0; 1432 1.1 jdolecek } else { 1433 1.1 jdolecek if (mii->mii_media_status & IFM_ACTIVE && 1434 1.1 jdolecek IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) { 1435 1.21 tsutsui sc->sc_link = 1; 1436 1.1 jdolecek if (!IFQ_IS_EMPTY(&ifp->if_snd)) 1437 1.1 jdolecek vge_start(ifp); 1438 1.1 jdolecek } 1439 1.1 jdolecek } 1440 1.1 jdolecek 1441 1.1 jdolecek splx(s); 1442 1.1 jdolecek } 1443 1.1 jdolecek 1444 1.1 jdolecek static int 1445 1.15 tsutsui vge_intr(void *arg) 1446 1.1 jdolecek { 1447 1.15 tsutsui struct vge_softc *sc; 1448 1.15 tsutsui struct ifnet *ifp; 1449 1.15 tsutsui uint32_t status; 1450 1.15 tsutsui int claim; 1451 1.1 jdolecek 1452 1.15 tsutsui sc = arg; 1453 1.15 tsutsui claim = 0; 1454 1.21 tsutsui if (sc->sc_suspended) { 1455 1.1 jdolecek return claim; 1456 1.1 jdolecek } 1457 1.1 jdolecek 1458 1.15 tsutsui ifp = &sc->sc_ethercom.ec_if; 1459 1.15 tsutsui 1460 1.32 tsutsui if ((ifp->if_flags & IFF_UP) == 0) { 1461 1.1 jdolecek return claim; 1462 1.1 jdolecek } 1463 1.1 jdolecek 1464 1.1 jdolecek /* Disable interrupts */ 1465 1.1 jdolecek CSR_WRITE_1(sc, VGE_CRC3, VGE_CR3_INT_GMSK); 1466 1.1 jdolecek 1467 1.1 jdolecek for (;;) { 1468 1.1 jdolecek 1469 1.1 jdolecek status = CSR_READ_4(sc, VGE_ISR); 1470 1.44 nonaka /* If the card has gone away the read returns 0xffffffff. */ 1471 1.1 jdolecek if (status == 0xFFFFFFFF) 1472 1.1 jdolecek break; 1473 1.1 jdolecek 1474 1.1 jdolecek if (status) { 1475 1.1 jdolecek claim = 1; 1476 1.1 jdolecek CSR_WRITE_4(sc, VGE_ISR, status); 1477 1.1 jdolecek } 1478 1.1 jdolecek 1479 1.1 jdolecek if ((status & VGE_INTRS) == 0) 1480 1.1 jdolecek break; 1481 1.1 jdolecek 1482 1.70 msaitoh if (status & (VGE_ISR_RXOK | VGE_ISR_RXOK_HIPRIO)) 1483 1.1 jdolecek vge_rxeof(sc); 1484 1.1 jdolecek 1485 1.70 msaitoh if (status & (VGE_ISR_RXOFLOW | VGE_ISR_RXNODESC)) { 1486 1.1 jdolecek vge_rxeof(sc); 1487 1.1 jdolecek CSR_WRITE_1(sc, VGE_RXQCSRS, VGE_RXQCSR_RUN); 1488 1.1 jdolecek CSR_WRITE_1(sc, VGE_RXQCSRS, VGE_RXQCSR_WAK); 1489 1.1 jdolecek } 1490 1.1 jdolecek 1491 1.70 msaitoh if (status & (VGE_ISR_TXOK0 | VGE_ISR_TIMER0)) 1492 1.1 jdolecek vge_txeof(sc); 1493 1.1 jdolecek 1494 1.70 msaitoh if (status & (VGE_ISR_TXDMA_STALL | VGE_ISR_RXDMA_STALL)) 1495 1.1 jdolecek vge_init(ifp); 1496 1.1 jdolecek 1497 1.1 jdolecek if (status & VGE_ISR_LINKSTS) 1498 1.1 jdolecek vge_tick(sc); 1499 1.1 jdolecek } 1500 1.1 jdolecek 1501 1.1 jdolecek /* Re-enable interrupts */ 1502 1.1 jdolecek CSR_WRITE_1(sc, VGE_CRS3, VGE_CR3_INT_GMSK); 1503 1.1 jdolecek 1504 1.59 ozaki if (claim) 1505 1.59 ozaki if_schedule_deferred_start(ifp); 1506 1.1 jdolecek 1507 1.1 jdolecek return claim; 1508 1.1 jdolecek } 1509 1.1 jdolecek 1510 1.1 jdolecek static int 1511 1.15 tsutsui vge_encap(struct vge_softc *sc, struct mbuf *m_head, int idx) 1512 1.15 tsutsui { 1513 1.21 tsutsui struct vge_txsoft *txs; 1514 1.21 tsutsui struct vge_txdesc *txd; 1515 1.21 tsutsui struct vge_txfrag *f; 1516 1.15 tsutsui struct mbuf *m_new; 1517 1.15 tsutsui bus_dmamap_t map; 1518 1.26 tsutsui int m_csumflags, seg, error, flags; 1519 1.15 tsutsui size_t sz; 1520 1.29 tsutsui uint32_t td_sts, td_ctl; 1521 1.14 tsutsui 1522 1.24 tsutsui KASSERT(sc->sc_tx_free > 0); 1523 1.24 tsutsui 1524 1.21 tsutsui txd = &sc->sc_txdescs[idx]; 1525 1.1 jdolecek 1526 1.24 tsutsui #ifdef DIAGNOSTIC 1527 1.3 jdolecek /* If this descriptor is still owned by the chip, bail. */ 1528 1.54 christos VGE_TXDESCSYNC(sc, idx, 1529 1.70 msaitoh BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 1530 1.29 tsutsui td_sts = le32toh(txd->td_sts); 1531 1.29 tsutsui VGE_TXDESCSYNC(sc, idx, BUS_DMASYNC_PREREAD); 1532 1.29 tsutsui if (td_sts & VGE_TDSTS_OWN) { 1533 1.24 tsutsui return ENOBUFS; 1534 1.14 tsutsui } 1535 1.24 tsutsui #endif 1536 1.1 jdolecek 1537 1.26 tsutsui /* 1538 1.26 tsutsui * Preserve m_pkthdr.csum_flags here since m_head might be 1539 1.26 tsutsui * updated by m_defrag() 1540 1.26 tsutsui */ 1541 1.26 tsutsui m_csumflags = m_head->m_pkthdr.csum_flags; 1542 1.26 tsutsui 1543 1.21 tsutsui txs = &sc->sc_txsoft[idx]; 1544 1.21 tsutsui map = txs->txs_dmamap; 1545 1.21 tsutsui error = bus_dmamap_load_mbuf(sc->sc_dmat, map, m_head, BUS_DMA_NOWAIT); 1546 1.1 jdolecek 1547 1.3 jdolecek /* If too many segments to map, coalesce */ 1548 1.21 tsutsui if (error == EFBIG || 1549 1.21 tsutsui (m_head->m_pkthdr.len < ETHER_PAD_LEN && 1550 1.21 tsutsui map->dm_nsegs == VGE_TX_FRAGS)) { 1551 1.1 jdolecek m_new = m_defrag(m_head, M_DONTWAIT); 1552 1.1 jdolecek if (m_new == NULL) 1553 1.25 tsutsui return EFBIG; 1554 1.1 jdolecek 1555 1.21 tsutsui error = bus_dmamap_load_mbuf(sc->sc_dmat, map, 1556 1.3 jdolecek m_new, BUS_DMA_NOWAIT); 1557 1.3 jdolecek if (error) { 1558 1.3 jdolecek m_freem(m_new); 1559 1.15 tsutsui return error; 1560 1.1 jdolecek } 1561 1.3 jdolecek 1562 1.3 jdolecek m_head = m_new; 1563 1.3 jdolecek } else if (error) 1564 1.15 tsutsui return error; 1565 1.3 jdolecek 1566 1.21 tsutsui txs->txs_mbuf = m_head; 1567 1.21 tsutsui 1568 1.21 tsutsui bus_dmamap_sync(sc->sc_dmat, map, 0, map->dm_mapsize, 1569 1.21 tsutsui BUS_DMASYNC_PREWRITE); 1570 1.21 tsutsui 1571 1.21 tsutsui for (seg = 0, f = &txd->td_frag[0]; seg < map->dm_nsegs; seg++, f++) { 1572 1.21 tsutsui f->tf_buflen = htole16(VGE_BUFLEN(map->dm_segs[seg].ds_len)); 1573 1.29 tsutsui vge_set_txaddr(f, map->dm_segs[seg].ds_addr); 1574 1.14 tsutsui } 1575 1.14 tsutsui 1576 1.14 tsutsui /* Argh. This chip does not autopad short frames */ 1577 1.14 tsutsui sz = m_head->m_pkthdr.len; 1578 1.21 tsutsui if (sz < ETHER_PAD_LEN) { 1579 1.21 tsutsui f->tf_buflen = htole16(VGE_BUFLEN(ETHER_PAD_LEN - sz)); 1580 1.29 tsutsui vge_set_txaddr(f, VGE_CDPADADDR(sc)); 1581 1.21 tsutsui sz = ETHER_PAD_LEN; 1582 1.14 tsutsui seg++; 1583 1.14 tsutsui } 1584 1.14 tsutsui VGE_TXFRAGSYNC(sc, idx, seg, BUS_DMASYNC_PREWRITE); 1585 1.14 tsutsui 1586 1.14 tsutsui /* 1587 1.14 tsutsui * When telling the chip how many segments there are, we 1588 1.14 tsutsui * must use nsegs + 1 instead of just nsegs. Darned if I 1589 1.14 tsutsui * know why. 1590 1.14 tsutsui */ 1591 1.14 tsutsui seg++; 1592 1.14 tsutsui 1593 1.14 tsutsui flags = 0; 1594 1.26 tsutsui if (m_csumflags & M_CSUM_IPv4) 1595 1.14 tsutsui flags |= VGE_TDCTL_IPCSUM; 1596 1.26 tsutsui if (m_csumflags & M_CSUM_TCPv4) 1597 1.14 tsutsui flags |= VGE_TDCTL_TCPCSUM; 1598 1.26 tsutsui if (m_csumflags & M_CSUM_UDPv4) 1599 1.14 tsutsui flags |= VGE_TDCTL_UDPCSUM; 1600 1.29 tsutsui td_sts = sz << 16; 1601 1.29 tsutsui td_ctl = flags | (seg << 28) | VGE_TD_LS_NORM; 1602 1.14 tsutsui 1603 1.14 tsutsui if (sz > ETHERMTU + ETHER_HDR_LEN) 1604 1.29 tsutsui td_ctl |= VGE_TDCTL_JUMBO; 1605 1.1 jdolecek 1606 1.1 jdolecek /* 1607 1.1 jdolecek * Set up hardware VLAN tagging. 1608 1.1 jdolecek */ 1609 1.61 knakahar if (vlan_has_tag(m_head)) { 1610 1.54 christos /* 1611 1.20 tsutsui * No need htons() here since vge(4) chip assumes 1612 1.20 tsutsui * that tags are written in little endian and 1613 1.20 tsutsui * we already use htole32() here. 1614 1.20 tsutsui */ 1615 1.61 knakahar td_ctl |= vlan_get_tag(m_head) | VGE_TDCTL_VTAG; 1616 1.20 tsutsui } 1617 1.29 tsutsui txd->td_ctl = htole32(td_ctl); 1618 1.29 tsutsui txd->td_sts = htole32(td_sts); 1619 1.70 msaitoh VGE_TXDESCSYNC(sc, idx, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 1620 1.1 jdolecek 1621 1.29 tsutsui txd->td_sts = htole32(VGE_TDSTS_OWN | td_sts); 1622 1.70 msaitoh VGE_TXDESCSYNC(sc, idx, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 1623 1.14 tsutsui 1624 1.21 tsutsui sc->sc_tx_free--; 1625 1.1 jdolecek 1626 1.15 tsutsui return 0; 1627 1.1 jdolecek } 1628 1.1 jdolecek 1629 1.1 jdolecek /* 1630 1.1 jdolecek * Main transmit routine. 1631 1.1 jdolecek */ 1632 1.1 jdolecek 1633 1.1 jdolecek static void 1634 1.15 tsutsui vge_start(struct ifnet *ifp) 1635 1.1 jdolecek { 1636 1.15 tsutsui struct vge_softc *sc; 1637 1.21 tsutsui struct vge_txsoft *txs; 1638 1.15 tsutsui struct mbuf *m_head; 1639 1.29 tsutsui int idx, pidx, ofree, error; 1640 1.1 jdolecek 1641 1.1 jdolecek sc = ifp->if_softc; 1642 1.1 jdolecek 1643 1.21 tsutsui if (!sc->sc_link || 1644 1.85 thorpej (ifp->if_flags & IFF_RUNNING) == 0) { 1645 1.1 jdolecek return; 1646 1.1 jdolecek } 1647 1.1 jdolecek 1648 1.15 tsutsui m_head = NULL; 1649 1.21 tsutsui idx = sc->sc_tx_prodidx; 1650 1.29 tsutsui pidx = VGE_PREV_TXDESC(idx); 1651 1.29 tsutsui ofree = sc->sc_tx_free; 1652 1.1 jdolecek 1653 1.3 jdolecek /* 1654 1.3 jdolecek * Loop through the send queue, setting up transmit descriptors 1655 1.3 jdolecek * until we drain the queue, or use up all available transmit 1656 1.3 jdolecek * descriptors. 1657 1.3 jdolecek */ 1658 1.85 thorpej while (sc->sc_tx_free != 0) { 1659 1.3 jdolecek /* Grab a packet off the queue. */ 1660 1.3 jdolecek IFQ_POLL(&ifp->if_snd, m_head); 1661 1.1 jdolecek if (m_head == NULL) 1662 1.1 jdolecek break; 1663 1.1 jdolecek 1664 1.29 tsutsui txs = &sc->sc_txsoft[idx]; 1665 1.29 tsutsui KASSERT(txs->txs_mbuf == NULL); 1666 1.29 tsutsui 1667 1.3 jdolecek if ((error = vge_encap(sc, m_head, idx))) { 1668 1.3 jdolecek if (error == EFBIG) { 1669 1.48 tsutsui printf("%s: Tx packet consumes too many " 1670 1.48 tsutsui "DMA segments, dropping...\n", 1671 1.48 tsutsui device_xname(sc->sc_dev)); 1672 1.3 jdolecek IFQ_DEQUEUE(&ifp->if_snd, m_head); 1673 1.3 jdolecek m_freem(m_head); 1674 1.3 jdolecek continue; 1675 1.3 jdolecek } 1676 1.3 jdolecek 1677 1.3 jdolecek /* 1678 1.3 jdolecek * Short on resources, just stop for now. 1679 1.3 jdolecek */ 1680 1.3 jdolecek break; 1681 1.3 jdolecek } 1682 1.3 jdolecek 1683 1.3 jdolecek IFQ_DEQUEUE(&ifp->if_snd, m_head); 1684 1.3 jdolecek 1685 1.3 jdolecek /* 1686 1.3 jdolecek * WE ARE NOW COMMITTED TO TRANSMITTING THE PACKET. 1687 1.3 jdolecek */ 1688 1.3 jdolecek 1689 1.21 tsutsui sc->sc_txdescs[pidx].td_frag[0].tf_buflen |= 1690 1.1 jdolecek htole16(VGE_TXDESC_Q); 1691 1.21 tsutsui VGE_TXFRAGSYNC(sc, pidx, 1, 1692 1.70 msaitoh BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 1693 1.1 jdolecek 1694 1.21 tsutsui if (txs->txs_mbuf != m_head) { 1695 1.3 jdolecek m_freem(m_head); 1696 1.21 tsutsui m_head = txs->txs_mbuf; 1697 1.3 jdolecek } 1698 1.3 jdolecek 1699 1.1 jdolecek pidx = idx; 1700 1.21 tsutsui idx = VGE_NEXT_TXDESC(idx); 1701 1.1 jdolecek 1702 1.1 jdolecek /* 1703 1.1 jdolecek * If there's a BPF listener, bounce a copy of this frame 1704 1.1 jdolecek * to him. 1705 1.1 jdolecek */ 1706 1.63 msaitoh bpf_mtap(ifp, m_head, BPF_D_OUT); 1707 1.1 jdolecek } 1708 1.1 jdolecek 1709 1.29 tsutsui if (sc->sc_tx_free < ofree) { 1710 1.29 tsutsui /* TX packet queued */ 1711 1.1 jdolecek 1712 1.29 tsutsui sc->sc_tx_prodidx = idx; 1713 1.1 jdolecek 1714 1.29 tsutsui /* Issue a transmit command. */ 1715 1.29 tsutsui CSR_WRITE_2(sc, VGE_TXQCSRS, VGE_TXQCSR_WAK0); 1716 1.1 jdolecek 1717 1.29 tsutsui /* 1718 1.29 tsutsui * Use the countdown timer for interrupt moderation. 1719 1.29 tsutsui * 'TX done' interrupts are disabled. Instead, we reset the 1720 1.29 tsutsui * countdown timer, which will begin counting until it hits 1721 1.29 tsutsui * the value in the SSTIMER register, and then trigger an 1722 1.29 tsutsui * interrupt. Each time we set the TIMER0_ENABLE bit, the 1723 1.29 tsutsui * the timer count is reloaded. Only when the transmitter 1724 1.29 tsutsui * is idle will the timer hit 0 and an interrupt fire. 1725 1.29 tsutsui */ 1726 1.29 tsutsui CSR_WRITE_1(sc, VGE_CRS1, VGE_CR1_TIMER0_ENABLE); 1727 1.1 jdolecek 1728 1.29 tsutsui /* 1729 1.29 tsutsui * Set a timeout in case the chip goes out to lunch. 1730 1.29 tsutsui */ 1731 1.29 tsutsui ifp->if_timer = 5; 1732 1.29 tsutsui } 1733 1.1 jdolecek } 1734 1.1 jdolecek 1735 1.1 jdolecek static int 1736 1.15 tsutsui vge_init(struct ifnet *ifp) 1737 1.1 jdolecek { 1738 1.15 tsutsui struct vge_softc *sc; 1739 1.39 dyoung int i, rc = 0; 1740 1.15 tsutsui 1741 1.15 tsutsui sc = ifp->if_softc; 1742 1.1 jdolecek 1743 1.1 jdolecek /* 1744 1.1 jdolecek * Cancel pending I/O and free all RX/TX buffers. 1745 1.1 jdolecek */ 1746 1.43 joerg vge_stop(ifp, 0); 1747 1.1 jdolecek vge_reset(sc); 1748 1.1 jdolecek 1749 1.21 tsutsui /* Initialize the RX descriptors and mbufs. */ 1750 1.21 tsutsui memset(sc->sc_rxdescs, 0, sizeof(sc->sc_rxdescs)); 1751 1.35 tsutsui sc->sc_rx_consumed = 0; 1752 1.21 tsutsui for (i = 0; i < VGE_NRXDESC; i++) { 1753 1.21 tsutsui if (vge_newbuf(sc, i, NULL) == ENOBUFS) { 1754 1.48 tsutsui printf("%s: unable to allocate or map rx buffer\n", 1755 1.48 tsutsui device_xname(sc->sc_dev)); 1756 1.21 tsutsui return 1; /* XXX */ 1757 1.21 tsutsui } 1758 1.21 tsutsui } 1759 1.21 tsutsui sc->sc_rx_prodidx = 0; 1760 1.21 tsutsui sc->sc_rx_mhead = sc->sc_rx_mtail = NULL; 1761 1.21 tsutsui 1762 1.21 tsutsui /* Initialize the TX descriptors and mbufs. */ 1763 1.21 tsutsui memset(sc->sc_txdescs, 0, sizeof(sc->sc_txdescs)); 1764 1.21 tsutsui bus_dmamap_sync(sc->sc_dmat, sc->sc_cddmamap, 1765 1.21 tsutsui VGE_CDTXOFF(0), sizeof(sc->sc_txdescs), 1766 1.70 msaitoh BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 1767 1.21 tsutsui for (i = 0; i < VGE_NTXDESC; i++) 1768 1.21 tsutsui sc->sc_txsoft[i].txs_mbuf = NULL; 1769 1.1 jdolecek 1770 1.21 tsutsui sc->sc_tx_prodidx = 0; 1771 1.21 tsutsui sc->sc_tx_considx = 0; 1772 1.21 tsutsui sc->sc_tx_free = VGE_NTXDESC; 1773 1.1 jdolecek 1774 1.1 jdolecek /* Set our station address */ 1775 1.1 jdolecek for (i = 0; i < ETHER_ADDR_LEN; i++) 1776 1.21 tsutsui CSR_WRITE_1(sc, VGE_PAR0 + i, sc->sc_eaddr[i]); 1777 1.1 jdolecek 1778 1.1 jdolecek /* 1779 1.1 jdolecek * Set receive FIFO threshold. Also allow transmission and 1780 1.1 jdolecek * reception of VLAN tagged frames. 1781 1.1 jdolecek */ 1782 1.70 msaitoh CSR_CLRBIT_1(sc, VGE_RXCFG, VGE_RXCFG_FIFO_THR | VGE_RXCFG_VTAGOPT); 1783 1.70 msaitoh CSR_SETBIT_1(sc, VGE_RXCFG, VGE_RXFIFOTHR_128BYTES | VGE_VTAG_OPT2); 1784 1.1 jdolecek 1785 1.1 jdolecek /* Set DMA burst length */ 1786 1.1 jdolecek CSR_CLRBIT_1(sc, VGE_DMACFG0, VGE_DMACFG0_BURSTLEN); 1787 1.1 jdolecek CSR_SETBIT_1(sc, VGE_DMACFG0, VGE_DMABURST_128); 1788 1.1 jdolecek 1789 1.70 msaitoh CSR_SETBIT_1(sc, VGE_TXCFG, VGE_TXCFG_ARB_PRIO | VGE_TXCFG_NONBLK); 1790 1.1 jdolecek 1791 1.1 jdolecek /* Set collision backoff algorithm */ 1792 1.70 msaitoh CSR_CLRBIT_1(sc, VGE_CHIPCFG1, VGE_CHIPCFG1_CRANDOM | 1793 1.70 msaitoh VGE_CHIPCFG1_CAP | VGE_CHIPCFG1_MBA | VGE_CHIPCFG1_BAKOPT); 1794 1.81 andvar CSR_SETBIT_1(sc, VGE_CHIPCFG1, VGE_CHIPCFG1_OFFSET); 1795 1.1 jdolecek 1796 1.1 jdolecek /* Disable LPSEL field in priority resolution */ 1797 1.1 jdolecek CSR_SETBIT_1(sc, VGE_DIAGCTL, VGE_DIAGCTL_LPSEL_DIS); 1798 1.1 jdolecek 1799 1.1 jdolecek /* 1800 1.1 jdolecek * Load the addresses of the DMA queues into the chip. 1801 1.1 jdolecek * Note that we only use one transmit queue. 1802 1.1 jdolecek */ 1803 1.1 jdolecek 1804 1.80 thorpej CSR_WRITE_4(sc, VGE_TXDESC_HIADDR, VGE_ADDR_HI(VGE_CDTXADDR(sc, 0))); 1805 1.21 tsutsui CSR_WRITE_4(sc, VGE_TXDESC_ADDR_LO0, VGE_ADDR_LO(VGE_CDTXADDR(sc, 0))); 1806 1.21 tsutsui CSR_WRITE_2(sc, VGE_TXDESCNUM, VGE_NTXDESC - 1); 1807 1.21 tsutsui 1808 1.21 tsutsui CSR_WRITE_4(sc, VGE_RXDESC_ADDR_LO, VGE_ADDR_LO(VGE_CDRXADDR(sc, 0))); 1809 1.21 tsutsui CSR_WRITE_2(sc, VGE_RXDESCNUM, VGE_NRXDESC - 1); 1810 1.21 tsutsui CSR_WRITE_2(sc, VGE_RXDESC_RESIDUECNT, VGE_NRXDESC); 1811 1.1 jdolecek 1812 1.1 jdolecek /* Enable and wake up the RX descriptor queue */ 1813 1.1 jdolecek CSR_WRITE_1(sc, VGE_RXQCSRS, VGE_RXQCSR_RUN); 1814 1.1 jdolecek CSR_WRITE_1(sc, VGE_RXQCSRS, VGE_RXQCSR_WAK); 1815 1.1 jdolecek 1816 1.1 jdolecek /* Enable the TX descriptor queue */ 1817 1.1 jdolecek CSR_WRITE_2(sc, VGE_TXQCSRS, VGE_TXQCSR_RUN0); 1818 1.1 jdolecek 1819 1.1 jdolecek /* Set up the receive filter -- allow large frames for VLANs. */ 1820 1.70 msaitoh CSR_WRITE_1(sc, VGE_RXCTL, VGE_RXCTL_RX_UCAST | VGE_RXCTL_RX_GIANT); 1821 1.1 jdolecek 1822 1.1 jdolecek /* If we want promiscuous mode, set the allframes bit. */ 1823 1.1 jdolecek if (ifp->if_flags & IFF_PROMISC) { 1824 1.1 jdolecek CSR_SETBIT_1(sc, VGE_RXCTL, VGE_RXCTL_RX_PROMISC); 1825 1.1 jdolecek } 1826 1.1 jdolecek 1827 1.1 jdolecek /* Set capture broadcast bit to capture broadcast frames. */ 1828 1.1 jdolecek if (ifp->if_flags & IFF_BROADCAST) { 1829 1.1 jdolecek CSR_SETBIT_1(sc, VGE_RXCTL, VGE_RXCTL_RX_BCAST); 1830 1.1 jdolecek } 1831 1.1 jdolecek 1832 1.1 jdolecek /* Set multicast bit to capture multicast frames. */ 1833 1.1 jdolecek if (ifp->if_flags & IFF_MULTICAST) { 1834 1.1 jdolecek CSR_SETBIT_1(sc, VGE_RXCTL, VGE_RXCTL_RX_MCAST); 1835 1.1 jdolecek } 1836 1.1 jdolecek 1837 1.1 jdolecek /* Init the cam filter. */ 1838 1.1 jdolecek vge_cam_clear(sc); 1839 1.1 jdolecek 1840 1.1 jdolecek /* Init the multicast filter. */ 1841 1.1 jdolecek vge_setmulti(sc); 1842 1.1 jdolecek 1843 1.1 jdolecek /* Enable flow control */ 1844 1.1 jdolecek 1845 1.1 jdolecek CSR_WRITE_1(sc, VGE_CRS2, 0x8B); 1846 1.1 jdolecek 1847 1.1 jdolecek /* Enable jumbo frame reception (if desired) */ 1848 1.1 jdolecek 1849 1.1 jdolecek /* Start the MAC. */ 1850 1.1 jdolecek CSR_WRITE_1(sc, VGE_CRC0, VGE_CR0_STOP); 1851 1.1 jdolecek CSR_WRITE_1(sc, VGE_CRS1, VGE_CR1_NOPOLL); 1852 1.1 jdolecek CSR_WRITE_1(sc, VGE_CRS0, 1853 1.70 msaitoh VGE_CR0_TX_ENABLE | VGE_CR0_RX_ENABLE | VGE_CR0_START); 1854 1.1 jdolecek 1855 1.1 jdolecek /* 1856 1.1 jdolecek * Configure one-shot timer for microsecond 1857 1.87 andvar * resolution and load it for 500 usecs. 1858 1.1 jdolecek */ 1859 1.1 jdolecek CSR_SETBIT_1(sc, VGE_DIAGCTL, VGE_DIAGCTL_TIMER0_RES); 1860 1.1 jdolecek CSR_WRITE_2(sc, VGE_SSTIMER, 400); 1861 1.1 jdolecek 1862 1.1 jdolecek /* 1863 1.1 jdolecek * Configure interrupt moderation for receive. Enable 1864 1.1 jdolecek * the holdoff counter and load it, and set the RX 1865 1.1 jdolecek * suppression count to the number of descriptors we 1866 1.1 jdolecek * want to allow before triggering an interrupt. 1867 1.1 jdolecek * The holdoff timer is in units of 20 usecs. 1868 1.1 jdolecek */ 1869 1.1 jdolecek 1870 1.1 jdolecek #ifdef notyet 1871 1.1 jdolecek CSR_WRITE_1(sc, VGE_INTCTL1, VGE_INTCTL_TXINTSUP_DISABLE); 1872 1.1 jdolecek /* Select the interrupt holdoff timer page. */ 1873 1.1 jdolecek CSR_CLRBIT_1(sc, VGE_CAMCTL, VGE_CAMCTL_PAGESEL); 1874 1.1 jdolecek CSR_SETBIT_1(sc, VGE_CAMCTL, VGE_PAGESEL_INTHLDOFF); 1875 1.1 jdolecek CSR_WRITE_1(sc, VGE_INTHOLDOFF, 10); /* ~200 usecs */ 1876 1.1 jdolecek 1877 1.1 jdolecek /* Enable use of the holdoff timer. */ 1878 1.1 jdolecek CSR_WRITE_1(sc, VGE_CRS3, VGE_CR3_INT_HOLDOFF); 1879 1.1 jdolecek CSR_WRITE_1(sc, VGE_INTCTL1, VGE_INTCTL_SC_RELOAD); 1880 1.1 jdolecek 1881 1.1 jdolecek /* Select the RX suppression threshold page. */ 1882 1.1 jdolecek CSR_CLRBIT_1(sc, VGE_CAMCTL, VGE_CAMCTL_PAGESEL); 1883 1.1 jdolecek CSR_SETBIT_1(sc, VGE_CAMCTL, VGE_PAGESEL_RXSUPPTHR); 1884 1.1 jdolecek CSR_WRITE_1(sc, VGE_RXSUPPTHR, 64); /* interrupt after 64 packets */ 1885 1.1 jdolecek 1886 1.1 jdolecek /* Restore the page select bits. */ 1887 1.1 jdolecek CSR_CLRBIT_1(sc, VGE_CAMCTL, VGE_CAMCTL_PAGESEL); 1888 1.1 jdolecek CSR_SETBIT_1(sc, VGE_CAMCTL, VGE_PAGESEL_MAR); 1889 1.1 jdolecek #endif 1890 1.1 jdolecek 1891 1.1 jdolecek #ifdef DEVICE_POLLING 1892 1.1 jdolecek /* 1893 1.1 jdolecek * Disable interrupts if we are polling. 1894 1.1 jdolecek */ 1895 1.1 jdolecek if (ifp->if_flags & IFF_POLLING) { 1896 1.1 jdolecek CSR_WRITE_4(sc, VGE_IMR, 0); 1897 1.1 jdolecek CSR_WRITE_1(sc, VGE_CRC3, VGE_CR3_INT_GMSK); 1898 1.1 jdolecek } else /* otherwise ... */ 1899 1.1 jdolecek #endif /* DEVICE_POLLING */ 1900 1.1 jdolecek { 1901 1.1 jdolecek /* 1902 1.1 jdolecek * Enable interrupts. 1903 1.1 jdolecek */ 1904 1.1 jdolecek CSR_WRITE_4(sc, VGE_IMR, VGE_INTRS); 1905 1.1 jdolecek CSR_WRITE_4(sc, VGE_ISR, 0); 1906 1.1 jdolecek CSR_WRITE_1(sc, VGE_CRS3, VGE_CR3_INT_GMSK); 1907 1.1 jdolecek } 1908 1.1 jdolecek 1909 1.39 dyoung if ((rc = ether_mediachange(ifp)) != 0) 1910 1.39 dyoung goto out; 1911 1.1 jdolecek 1912 1.1 jdolecek ifp->if_flags |= IFF_RUNNING; 1913 1.1 jdolecek 1914 1.21 tsutsui sc->sc_if_flags = 0; 1915 1.21 tsutsui sc->sc_link = 0; 1916 1.1 jdolecek 1917 1.21 tsutsui callout_schedule(&sc->sc_timeout, hz); 1918 1.1 jdolecek 1919 1.39 dyoung out: 1920 1.39 dyoung return rc; 1921 1.1 jdolecek } 1922 1.1 jdolecek 1923 1.1 jdolecek static void 1924 1.53 matt vge_miibus_statchg(struct ifnet *ifp) 1925 1.1 jdolecek { 1926 1.53 matt struct vge_softc *sc = ifp->if_softc; 1927 1.53 matt struct mii_data *mii = &sc->sc_mii; 1928 1.53 matt struct ifmedia_entry *ife = mii->mii_media.ifm_cur; 1929 1.76 msaitoh uint8_t dctl; 1930 1.1 jdolecek 1931 1.1 jdolecek /* 1932 1.1 jdolecek * If the user manually selects a media mode, we need to turn 1933 1.1 jdolecek * on the forced MAC mode bit in the DIAGCTL register. If the 1934 1.1 jdolecek * user happens to choose a full duplex mode, we also need to 1935 1.1 jdolecek * set the 'force full duplex' bit. This applies only to 1936 1.1 jdolecek * 10Mbps and 100Mbps speeds. In autoselect mode, forced MAC 1937 1.1 jdolecek * mode is disabled, and in 1000baseT mode, full duplex is 1938 1.1 jdolecek * always implied, so we turn on the forced mode bit but leave 1939 1.1 jdolecek * the FDX bit cleared. 1940 1.1 jdolecek */ 1941 1.76 msaitoh dctl = CSR_READ_1(sc, VGE_DIAGCTL); 1942 1.76 msaitoh 1943 1.77 msaitoh if (IFM_SUBTYPE(ife->ifm_media) == IFM_AUTO) { 1944 1.76 msaitoh dctl &= ~VGE_DIAGCTL_MACFORCE; 1945 1.76 msaitoh dctl &= ~VGE_DIAGCTL_FDXFORCE; 1946 1.77 msaitoh } else { 1947 1.77 msaitoh u_int ifmword; 1948 1.77 msaitoh 1949 1.77 msaitoh /* If the link is up, use the current active media. */ 1950 1.77 msaitoh if ((mii->mii_media_status & IFM_ACTIVE) != 0) 1951 1.77 msaitoh ifmword = mii->mii_media_active; 1952 1.77 msaitoh else 1953 1.77 msaitoh ifmword = ife->ifm_media; 1954 1.77 msaitoh 1955 1.76 msaitoh dctl |= VGE_DIAGCTL_MACFORCE; 1956 1.77 msaitoh if ((ifmword & IFM_FDX) != 0) 1957 1.76 msaitoh dctl |= VGE_DIAGCTL_FDXFORCE; 1958 1.76 msaitoh else 1959 1.76 msaitoh dctl &= ~VGE_DIAGCTL_FDXFORCE; 1960 1.77 msaitoh 1961 1.77 msaitoh if (IFM_SUBTYPE(ifmword) == IFM_1000_T) { 1962 1.77 msaitoh /* 1963 1.77 msaitoh * It means the user setting is not auto but it's 1964 1.77 msaitoh * 1000baseT-FDX or 1000baseT. 1965 1.77 msaitoh */ 1966 1.77 msaitoh dctl |= VGE_DIAGCTL_GMII; 1967 1.77 msaitoh } else 1968 1.77 msaitoh dctl &= ~VGE_DIAGCTL_GMII; 1969 1.1 jdolecek } 1970 1.76 msaitoh 1971 1.76 msaitoh CSR_WRITE_1(sc, VGE_DIAGCTL, dctl); 1972 1.1 jdolecek } 1973 1.1 jdolecek 1974 1.1 jdolecek static int 1975 1.42 dyoung vge_ifflags_cb(struct ethercom *ec) 1976 1.42 dyoung { 1977 1.42 dyoung struct ifnet *ifp = &ec->ec_if; 1978 1.42 dyoung struct vge_softc *sc = ifp->if_softc; 1979 1.74 msaitoh u_short change = ifp->if_flags ^ sc->sc_if_flags; 1980 1.42 dyoung 1981 1.70 msaitoh if ((change & ~(IFF_CANTCHANGE | IFF_DEBUG)) != 0) 1982 1.42 dyoung return ENETRESET; 1983 1.42 dyoung else if ((change & IFF_PROMISC) == 0) 1984 1.42 dyoung return 0; 1985 1.42 dyoung 1986 1.42 dyoung if ((ifp->if_flags & IFF_PROMISC) == 0) 1987 1.42 dyoung CSR_CLRBIT_1(sc, VGE_RXCTL, VGE_RXCTL_RX_PROMISC); 1988 1.42 dyoung else 1989 1.42 dyoung CSR_SETBIT_1(sc, VGE_RXCTL, VGE_RXCTL_RX_PROMISC); 1990 1.42 dyoung vge_setmulti(sc); 1991 1.42 dyoung return 0; 1992 1.42 dyoung } 1993 1.42 dyoung 1994 1.42 dyoung static int 1995 1.34 christos vge_ioctl(struct ifnet *ifp, u_long command, void *data) 1996 1.15 tsutsui { 1997 1.15 tsutsui struct vge_softc *sc; 1998 1.15 tsutsui int s, error; 1999 1.15 tsutsui 2000 1.15 tsutsui sc = ifp->if_softc; 2001 1.15 tsutsui error = 0; 2002 1.6 christos 2003 1.6 christos s = splnet(); 2004 1.1 jdolecek 2005 1.42 dyoung if ((error = ether_ioctl(ifp, command, data)) == ENETRESET) { 2006 1.40 dyoung error = 0; 2007 1.40 dyoung if (command != SIOCADDMULTI && command != SIOCDELMULTI) 2008 1.40 dyoung ; 2009 1.40 dyoung else if (ifp->if_flags & IFF_RUNNING) { 2010 1.6 christos /* 2011 1.6 christos * Multicast list has changed; set the hardware filter 2012 1.6 christos * accordingly. 2013 1.6 christos */ 2014 1.40 dyoung vge_setmulti(sc); 2015 1.6 christos } 2016 1.1 jdolecek } 2017 1.42 dyoung sc->sc_if_flags = ifp->if_flags; 2018 1.1 jdolecek 2019 1.6 christos splx(s); 2020 1.15 tsutsui return error; 2021 1.1 jdolecek } 2022 1.1 jdolecek 2023 1.1 jdolecek static void 2024 1.15 tsutsui vge_watchdog(struct ifnet *ifp) 2025 1.1 jdolecek { 2026 1.15 tsutsui struct vge_softc *sc; 2027 1.21 tsutsui int s; 2028 1.1 jdolecek 2029 1.1 jdolecek sc = ifp->if_softc; 2030 1.21 tsutsui s = splnet(); 2031 1.48 tsutsui printf("%s: watchdog timeout\n", device_xname(sc->sc_dev)); 2032 1.79 thorpej if_statinc(ifp, if_oerrors); 2033 1.1 jdolecek 2034 1.1 jdolecek vge_txeof(sc); 2035 1.1 jdolecek vge_rxeof(sc); 2036 1.1 jdolecek 2037 1.1 jdolecek vge_init(ifp); 2038 1.1 jdolecek 2039 1.21 tsutsui splx(s); 2040 1.1 jdolecek } 2041 1.1 jdolecek 2042 1.1 jdolecek /* 2043 1.1 jdolecek * Stop the adapter and free any mbufs allocated to the 2044 1.1 jdolecek * RX and TX lists. 2045 1.1 jdolecek */ 2046 1.1 jdolecek static void 2047 1.43 joerg vge_stop(struct ifnet *ifp, int disable) 2048 1.1 jdolecek { 2049 1.43 joerg struct vge_softc *sc = ifp->if_softc; 2050 1.21 tsutsui struct vge_txsoft *txs; 2051 1.21 tsutsui struct vge_rxsoft *rxs; 2052 1.21 tsutsui int i, s; 2053 1.15 tsutsui 2054 1.21 tsutsui s = splnet(); 2055 1.1 jdolecek ifp->if_timer = 0; 2056 1.1 jdolecek 2057 1.85 thorpej ifp->if_flags &= ~IFF_RUNNING; 2058 1.1 jdolecek #ifdef DEVICE_POLLING 2059 1.1 jdolecek ether_poll_deregister(ifp); 2060 1.1 jdolecek #endif /* DEVICE_POLLING */ 2061 1.1 jdolecek 2062 1.1 jdolecek CSR_WRITE_1(sc, VGE_CRC3, VGE_CR3_INT_GMSK); 2063 1.1 jdolecek CSR_WRITE_1(sc, VGE_CRS0, VGE_CR0_STOP); 2064 1.1 jdolecek CSR_WRITE_4(sc, VGE_ISR, 0xFFFFFFFF); 2065 1.1 jdolecek CSR_WRITE_2(sc, VGE_TXQCSRC, 0xFFFF); 2066 1.1 jdolecek CSR_WRITE_1(sc, VGE_RXQCSRC, 0xFF); 2067 1.1 jdolecek CSR_WRITE_4(sc, VGE_RXDESC_ADDR_LO, 0); 2068 1.1 jdolecek 2069 1.21 tsutsui if (sc->sc_rx_mhead != NULL) { 2070 1.21 tsutsui m_freem(sc->sc_rx_mhead); 2071 1.21 tsutsui sc->sc_rx_mhead = sc->sc_rx_mtail = NULL; 2072 1.1 jdolecek } 2073 1.1 jdolecek 2074 1.1 jdolecek /* Free the TX list buffers. */ 2075 1.1 jdolecek 2076 1.21 tsutsui for (i = 0; i < VGE_NTXDESC; i++) { 2077 1.21 tsutsui txs = &sc->sc_txsoft[i]; 2078 1.21 tsutsui if (txs->txs_mbuf != NULL) { 2079 1.21 tsutsui bus_dmamap_unload(sc->sc_dmat, txs->txs_dmamap); 2080 1.21 tsutsui m_freem(txs->txs_mbuf); 2081 1.21 tsutsui txs->txs_mbuf = NULL; 2082 1.1 jdolecek } 2083 1.1 jdolecek } 2084 1.1 jdolecek 2085 1.1 jdolecek /* Free the RX list buffers. */ 2086 1.1 jdolecek 2087 1.21 tsutsui for (i = 0; i < VGE_NRXDESC; i++) { 2088 1.21 tsutsui rxs = &sc->sc_rxsoft[i]; 2089 1.21 tsutsui if (rxs->rxs_mbuf != NULL) { 2090 1.21 tsutsui bus_dmamap_unload(sc->sc_dmat, rxs->rxs_dmamap); 2091 1.21 tsutsui m_freem(rxs->rxs_mbuf); 2092 1.21 tsutsui rxs->rxs_mbuf = NULL; 2093 1.1 jdolecek } 2094 1.1 jdolecek } 2095 1.1 jdolecek 2096 1.21 tsutsui splx(s); 2097 1.1 jdolecek } 2098 1.1 jdolecek 2099 1.1 jdolecek #if VGE_POWER_MANAGEMENT 2100 1.1 jdolecek /* 2101 1.1 jdolecek * Device suspend routine. Stop the interface and save some PCI 2102 1.1 jdolecek * settings in case the BIOS doesn't restore them properly on 2103 1.1 jdolecek * resume. 2104 1.1 jdolecek */ 2105 1.1 jdolecek static int 2106 1.46 cegger vge_suspend(device_t dev) 2107 1.1 jdolecek { 2108 1.15 tsutsui struct vge_softc *sc; 2109 1.15 tsutsui int i; 2110 1.1 jdolecek 2111 1.1 jdolecek sc = device_get_softc(dev); 2112 1.1 jdolecek 2113 1.1 jdolecek vge_stop(sc); 2114 1.1 jdolecek 2115 1.71 msaitoh for (i = 0; i < 5; i++) 2116 1.21 tsutsui sc->sc_saved_maps[i] = 2117 1.21 tsutsui pci_read_config(dev, PCIR_MAPS + i * 4, 4); 2118 1.21 tsutsui sc->sc_saved_biosaddr = pci_read_config(dev, PCIR_BIOS, 4); 2119 1.21 tsutsui sc->sc_saved_intline = pci_read_config(dev, PCIR_INTLINE, 1); 2120 1.21 tsutsui sc->sc_saved_cachelnsz = pci_read_config(dev, PCIR_CACHELNSZ, 1); 2121 1.21 tsutsui sc->sc_saved_lattimer = pci_read_config(dev, PCIR_LATTIMER, 1); 2122 1.1 jdolecek 2123 1.1 jdolecek sc->suspended = 1; 2124 1.1 jdolecek 2125 1.15 tsutsui return 0; 2126 1.1 jdolecek } 2127 1.1 jdolecek 2128 1.1 jdolecek /* 2129 1.1 jdolecek * Device resume routine. Restore some PCI settings in case the BIOS 2130 1.1 jdolecek * doesn't, re-enable busmastering, and restart the interface if 2131 1.1 jdolecek * appropriate. 2132 1.1 jdolecek */ 2133 1.1 jdolecek static int 2134 1.46 cegger vge_resume(device_t dev) 2135 1.1 jdolecek { 2136 1.15 tsutsui struct vge_softc *sc; 2137 1.15 tsutsui struct ifnet *ifp; 2138 1.15 tsutsui int i; 2139 1.15 tsutsui 2140 1.47 cegger sc = device_private(dev); 2141 1.15 tsutsui ifp = &sc->sc_ethercom.ec_if; 2142 1.1 jdolecek 2143 1.71 msaitoh /* better way to do this? */ 2144 1.1 jdolecek for (i = 0; i < 5; i++) 2145 1.21 tsutsui pci_write_config(dev, PCIR_MAPS + i * 4, 2146 1.21 tsutsui sc->sc_saved_maps[i], 4); 2147 1.21 tsutsui pci_write_config(dev, PCIR_BIOS, sc->sc_saved_biosaddr, 4); 2148 1.21 tsutsui pci_write_config(dev, PCIR_INTLINE, sc->sc_saved_intline, 1); 2149 1.21 tsutsui pci_write_config(dev, PCIR_CACHELNSZ, sc->sc_saved_cachelnsz, 1); 2150 1.21 tsutsui pci_write_config(dev, PCIR_LATTIMER, sc->sc_saved_lattimer, 1); 2151 1.1 jdolecek 2152 1.1 jdolecek /* reenable busmastering */ 2153 1.1 jdolecek pci_enable_busmaster(dev); 2154 1.1 jdolecek pci_enable_io(dev, SYS_RES_MEMORY); 2155 1.1 jdolecek 2156 1.1 jdolecek /* reinitialize interface if necessary */ 2157 1.1 jdolecek if (ifp->if_flags & IFF_UP) 2158 1.1 jdolecek vge_init(sc); 2159 1.1 jdolecek 2160 1.1 jdolecek sc->suspended = 0; 2161 1.1 jdolecek 2162 1.15 tsutsui return 0; 2163 1.1 jdolecek } 2164 1.1 jdolecek #endif 2165 1.1 jdolecek 2166 1.1 jdolecek /* 2167 1.1 jdolecek * Stop all chip I/O so that the kernel's probe routines don't 2168 1.1 jdolecek * get confused by errant DMAs when rebooting. 2169 1.1 jdolecek */ 2170 1.49 tsutsui static bool 2171 1.49 tsutsui vge_shutdown(device_t self, int howto) 2172 1.1 jdolecek { 2173 1.15 tsutsui struct vge_softc *sc; 2174 1.1 jdolecek 2175 1.49 tsutsui sc = device_private(self); 2176 1.43 joerg vge_stop(&sc->sc_ethercom.ec_if, 1); 2177 1.49 tsutsui 2178 1.49 tsutsui return true; 2179 1.1 jdolecek } 2180 1.75 msaitoh 2181 1.75 msaitoh static void 2182 1.75 msaitoh vge_clrwol(struct vge_softc *sc) 2183 1.75 msaitoh { 2184 1.75 msaitoh uint8_t val; 2185 1.75 msaitoh 2186 1.75 msaitoh val = CSR_READ_1(sc, VGE_PWRSTAT); 2187 1.75 msaitoh val &= ~VGE_STICKHW_SWPTAG; 2188 1.75 msaitoh CSR_WRITE_1(sc, VGE_PWRSTAT, val); 2189 1.75 msaitoh /* Disable WOL and clear power state indicator. */ 2190 1.75 msaitoh val = CSR_READ_1(sc, VGE_PWRSTAT); 2191 1.75 msaitoh val &= ~(VGE_STICKHW_DS0 | VGE_STICKHW_DS1); 2192 1.75 msaitoh CSR_WRITE_1(sc, VGE_PWRSTAT, val); 2193 1.75 msaitoh 2194 1.75 msaitoh CSR_CLRBIT_1(sc, VGE_DIAGCTL, VGE_DIAGCTL_GMII); 2195 1.75 msaitoh CSR_CLRBIT_1(sc, VGE_DIAGCTL, VGE_DIAGCTL_MACFORCE); 2196 1.75 msaitoh 2197 1.75 msaitoh /* Clear WOL on pattern match. */ 2198 1.75 msaitoh CSR_WRITE_1(sc, VGE_WOLCR0C, VGE_WOLCR0_PATTERN_ALL); 2199 1.75 msaitoh /* Disable WOL on magic/unicast packet. */ 2200 1.75 msaitoh CSR_WRITE_1(sc, VGE_WOLCR1C, 0x0F); 2201 1.75 msaitoh CSR_WRITE_1(sc, VGE_WOLCFGC, VGE_WOLCFG_SAB | VGE_WOLCFG_SAM | 2202 1.75 msaitoh VGE_WOLCFG_PMEOVR); 2203 1.75 msaitoh /* Clear WOL status on pattern match. */ 2204 1.75 msaitoh CSR_WRITE_1(sc, VGE_WOLSR0C, 0xFF); 2205 1.75 msaitoh CSR_WRITE_1(sc, VGE_WOLSR1C, 0xFF); 2206 1.75 msaitoh } 2207