if_mvgbe.c revision 1.2.2.2
1 1.2.2.2 yamt /* $NetBSD: if_mvgbe.c,v 1.2.2.2 2010/08/11 22:53:38 yamt Exp $ */ 2 1.2.2.2 yamt /* 3 1.2.2.2 yamt * Copyright (c) 2007, 2008 KIYOHARA Takashi 4 1.2.2.2 yamt * All rights reserved. 5 1.2.2.2 yamt * 6 1.2.2.2 yamt * Redistribution and use in source and binary forms, with or without 7 1.2.2.2 yamt * modification, are permitted provided that the following conditions 8 1.2.2.2 yamt * are met: 9 1.2.2.2 yamt * 1. Redistributions of source code must retain the above copyright 10 1.2.2.2 yamt * notice, this list of conditions and the following disclaimer. 11 1.2.2.2 yamt * 2. Redistributions in binary form must reproduce the above copyright 12 1.2.2.2 yamt * notice, this list of conditions and the following disclaimer in the 13 1.2.2.2 yamt * documentation and/or other materials provided with the distribution. 14 1.2.2.2 yamt * 15 1.2.2.2 yamt * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 1.2.2.2 yamt * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 17 1.2.2.2 yamt * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 18 1.2.2.2 yamt * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, 19 1.2.2.2 yamt * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 20 1.2.2.2 yamt * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 21 1.2.2.2 yamt * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22 1.2.2.2 yamt * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 23 1.2.2.2 yamt * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 24 1.2.2.2 yamt * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 25 1.2.2.2 yamt * POSSIBILITY OF SUCH DAMAGE. 26 1.2.2.2 yamt */ 27 1.2.2.2 yamt #include <sys/cdefs.h> 28 1.2.2.2 yamt __KERNEL_RCSID(0, "$NetBSD: if_mvgbe.c,v 1.2.2.2 2010/08/11 22:53:38 yamt Exp $"); 29 1.2.2.2 yamt 30 1.2.2.2 yamt #include "rnd.h" 31 1.2.2.2 yamt 32 1.2.2.2 yamt #include <sys/param.h> 33 1.2.2.2 yamt #include <sys/bus.h> 34 1.2.2.2 yamt #include <sys/device.h> 35 1.2.2.2 yamt #include <sys/endian.h> 36 1.2.2.2 yamt #include <sys/errno.h> 37 1.2.2.2 yamt #include <sys/kmem.h> 38 1.2.2.2 yamt #include <sys/mutex.h> 39 1.2.2.2 yamt #include <sys/sockio.h> 40 1.2.2.2 yamt 41 1.2.2.2 yamt #include <dev/marvell/marvellreg.h> 42 1.2.2.2 yamt #include <dev/marvell/marvellvar.h> 43 1.2.2.2 yamt #include <dev/marvell/mvgbereg.h> 44 1.2.2.2 yamt 45 1.2.2.2 yamt #include <net/if.h> 46 1.2.2.2 yamt #include <net/if_ether.h> 47 1.2.2.2 yamt #include <net/if_media.h> 48 1.2.2.2 yamt 49 1.2.2.2 yamt #include <netinet/in.h> 50 1.2.2.2 yamt #include <netinet/in_systm.h> 51 1.2.2.2 yamt #include <netinet/ip.h> 52 1.2.2.2 yamt 53 1.2.2.2 yamt #include <net/bpf.h> 54 1.2.2.2 yamt #if NRND > 0 55 1.2.2.2 yamt #include <sys/rnd.h> 56 1.2.2.2 yamt #endif 57 1.2.2.2 yamt 58 1.2.2.2 yamt #include <dev/mii/mii.h> 59 1.2.2.2 yamt #include <dev/mii/miivar.h> 60 1.2.2.2 yamt 61 1.2.2.2 yamt #include "locators.h" 62 1.2.2.2 yamt 63 1.2.2.2 yamt /* #define MVGBE_DEBUG 3 */ 64 1.2.2.2 yamt #ifdef MVGBE_DEBUG 65 1.2.2.2 yamt #define DPRINTF(x) if (mvgbe_debug) printf x 66 1.2.2.2 yamt #define DPRINTFN(n,x) if (mvgbe_debug >= (n)) printf x 67 1.2.2.2 yamt int mvgbe_debug = MVGBE_DEBUG; 68 1.2.2.2 yamt #else 69 1.2.2.2 yamt #define DPRINTF(x) 70 1.2.2.2 yamt #define DPRINTFN(n,x) 71 1.2.2.2 yamt #endif 72 1.2.2.2 yamt 73 1.2.2.2 yamt 74 1.2.2.2 yamt #define MVGBE_READ(sc, reg) \ 75 1.2.2.2 yamt bus_space_read_4((sc)->sc_iot, (sc)->sc_ioh, (reg)) 76 1.2.2.2 yamt #define MVGBE_WRITE(sc, reg, val) \ 77 1.2.2.2 yamt bus_space_write_4((sc)->sc_iot, (sc)->sc_ioh, (reg), (val)) 78 1.2.2.2 yamt #define MVGBE_READ_FILTER(sc, reg) \ 79 1.2.2.2 yamt bus_space_read_4((sc)->sc_iot, (sc)->sc_dafh, (reg)) 80 1.2.2.2 yamt #define MVGBE_WRITE_FILTER(sc, reg, val, c) \ 81 1.2.2.2 yamt bus_space_set_region_4((sc)->sc_iot, (sc)->sc_dafh, (reg), (val), (c)) 82 1.2.2.2 yamt 83 1.2.2.2 yamt #define MVGBE_TX_RING_CNT 256 84 1.2.2.2 yamt #define MVGBE_RX_RING_CNT 256 85 1.2.2.2 yamt 86 1.2.2.2 yamt #define MVGBE_JSLOTS 384 /* XXXX */ 87 1.2.2.2 yamt #define MVGBE_JLEN (MVGBE_MRU + MVGBE_BUF_ALIGN) 88 1.2.2.2 yamt #define MVGBE_NTXSEG 30 89 1.2.2.2 yamt #define MVGBE_JPAGESZ PAGE_SIZE 90 1.2.2.2 yamt #define MVGBE_RESID \ 91 1.2.2.2 yamt (MVGBE_JPAGESZ - (MVGBE_JLEN * MVGBE_JSLOTS) % MVGBE_JPAGESZ) 92 1.2.2.2 yamt #define MVGBE_JMEM \ 93 1.2.2.2 yamt ((MVGBE_JLEN * MVGBE_JSLOTS) + MVGBE_RESID) 94 1.2.2.2 yamt 95 1.2.2.2 yamt #define MVGBE_TX_RING_ADDR(sc, i) \ 96 1.2.2.2 yamt ((sc)->sc_ring_map->dm_segs[0].ds_addr + \ 97 1.2.2.2 yamt offsetof(struct mvgbe_ring_data, mvgbe_tx_ring[(i)])) 98 1.2.2.2 yamt 99 1.2.2.2 yamt #define MVGBE_RX_RING_ADDR(sc, i) \ 100 1.2.2.2 yamt ((sc)->sc_ring_map->dm_segs[0].ds_addr + \ 101 1.2.2.2 yamt offsetof(struct mvgbe_ring_data, mvgbe_rx_ring[(i)])) 102 1.2.2.2 yamt 103 1.2.2.2 yamt #define MVGBE_CDOFF(x) offsetof(struct mvgbe_ring_data, x) 104 1.2.2.2 yamt #define MVGBE_CDTXOFF(x) MVGBE_CDOFF(mvgbe_tx_ring[(x)]) 105 1.2.2.2 yamt #define MVGBE_CDRXOFF(x) MVGBE_CDOFF(mvgbe_rx_ring[(x)]) 106 1.2.2.2 yamt 107 1.2.2.2 yamt #define MVGBE_CDTXSYNC(sc, x, n, ops) \ 108 1.2.2.2 yamt do { \ 109 1.2.2.2 yamt int __x, __n; \ 110 1.2.2.2 yamt const int __descsize = sizeof(struct mvgbe_tx_desc); \ 111 1.2.2.2 yamt \ 112 1.2.2.2 yamt __x = (x); \ 113 1.2.2.2 yamt __n = (n); \ 114 1.2.2.2 yamt \ 115 1.2.2.2 yamt /* If it will wrap around, sync to the end of the ring. */ \ 116 1.2.2.2 yamt if ((__x + __n) > MVGBE_TX_RING_CNT) { \ 117 1.2.2.2 yamt bus_dmamap_sync((sc)->sc_dmat, \ 118 1.2.2.2 yamt (sc)->sc_ring_map, MVGBE_CDTXOFF(__x), \ 119 1.2.2.2 yamt __descsize * (MVGBE_TX_RING_CNT - __x), (ops)); \ 120 1.2.2.2 yamt __n -= (MVGBE_TX_RING_CNT - __x); \ 121 1.2.2.2 yamt __x = 0; \ 122 1.2.2.2 yamt } \ 123 1.2.2.2 yamt \ 124 1.2.2.2 yamt /* Now sync whatever is left. */ \ 125 1.2.2.2 yamt bus_dmamap_sync((sc)->sc_dmat, (sc)->sc_ring_map, \ 126 1.2.2.2 yamt MVGBE_CDTXOFF((__x)), __descsize * __n, (ops)); \ 127 1.2.2.2 yamt } while (0 /*CONSTCOND*/) 128 1.2.2.2 yamt 129 1.2.2.2 yamt #define MVGBE_CDRXSYNC(sc, x, ops) \ 130 1.2.2.2 yamt do { \ 131 1.2.2.2 yamt bus_dmamap_sync((sc)->sc_dmat, (sc)->sc_ring_map, \ 132 1.2.2.2 yamt MVGBE_CDRXOFF((x)), sizeof(struct mvgbe_rx_desc), (ops)); \ 133 1.2.2.2 yamt } while (/*CONSTCOND*/0) 134 1.2.2.2 yamt 135 1.2.2.2 yamt 136 1.2.2.2 yamt struct mvgbe_jpool_entry { 137 1.2.2.2 yamt int slot; 138 1.2.2.2 yamt LIST_ENTRY(mvgbe_jpool_entry) jpool_entries; 139 1.2.2.2 yamt }; 140 1.2.2.2 yamt 141 1.2.2.2 yamt struct mvgbe_chain { 142 1.2.2.2 yamt void *mvgbe_desc; 143 1.2.2.2 yamt struct mbuf *mvgbe_mbuf; 144 1.2.2.2 yamt struct mvgbe_chain *mvgbe_next; 145 1.2.2.2 yamt }; 146 1.2.2.2 yamt 147 1.2.2.2 yamt struct mvgbe_txmap_entry { 148 1.2.2.2 yamt bus_dmamap_t dmamap; 149 1.2.2.2 yamt SIMPLEQ_ENTRY(mvgbe_txmap_entry) link; 150 1.2.2.2 yamt }; 151 1.2.2.2 yamt 152 1.2.2.2 yamt struct mvgbe_chain_data { 153 1.2.2.2 yamt struct mvgbe_chain mvgbe_tx_chain[MVGBE_TX_RING_CNT]; 154 1.2.2.2 yamt struct mvgbe_txmap_entry *mvgbe_tx_map[MVGBE_TX_RING_CNT]; 155 1.2.2.2 yamt int mvgbe_tx_prod; 156 1.2.2.2 yamt int mvgbe_tx_cons; 157 1.2.2.2 yamt int mvgbe_tx_cnt; 158 1.2.2.2 yamt 159 1.2.2.2 yamt struct mvgbe_chain mvgbe_rx_chain[MVGBE_RX_RING_CNT]; 160 1.2.2.2 yamt bus_dmamap_t mvgbe_rx_map[MVGBE_RX_RING_CNT]; 161 1.2.2.2 yamt bus_dmamap_t mvgbe_rx_jumbo_map; 162 1.2.2.2 yamt int mvgbe_rx_prod; 163 1.2.2.2 yamt int mvgbe_rx_cons; 164 1.2.2.2 yamt int mvgbe_rx_cnt; 165 1.2.2.2 yamt 166 1.2.2.2 yamt /* Stick the jumbo mem management stuff here too. */ 167 1.2.2.2 yamt void *mvgbe_jslots[MVGBE_JSLOTS]; 168 1.2.2.2 yamt void *mvgbe_jumbo_buf; 169 1.2.2.2 yamt }; 170 1.2.2.2 yamt 171 1.2.2.2 yamt struct mvgbe_ring_data { 172 1.2.2.2 yamt struct mvgbe_tx_desc mvgbe_tx_ring[MVGBE_TX_RING_CNT]; 173 1.2.2.2 yamt struct mvgbe_rx_desc mvgbe_rx_ring[MVGBE_RX_RING_CNT]; 174 1.2.2.2 yamt }; 175 1.2.2.2 yamt 176 1.2.2.2 yamt struct mvgbec_softc { 177 1.2.2.2 yamt device_t sc_dev; 178 1.2.2.2 yamt 179 1.2.2.2 yamt bus_space_tag_t sc_iot; 180 1.2.2.2 yamt bus_space_handle_t sc_ioh; 181 1.2.2.2 yamt 182 1.2.2.2 yamt kmutex_t sc_mtx; 183 1.2.2.2 yamt }; 184 1.2.2.2 yamt 185 1.2.2.2 yamt struct mvgbe_softc { 186 1.2.2.2 yamt device_t sc_dev; 187 1.2.2.2 yamt int sc_port; /* port num (0 or 1) */ 188 1.2.2.2 yamt 189 1.2.2.2 yamt bus_space_tag_t sc_iot; 190 1.2.2.2 yamt bus_space_handle_t sc_ioh; 191 1.2.2.2 yamt bus_space_handle_t sc_dafh; /* dest address filter handle */ 192 1.2.2.2 yamt bus_dma_tag_t sc_dmat; 193 1.2.2.2 yamt 194 1.2.2.2 yamt struct ethercom sc_ethercom; 195 1.2.2.2 yamt struct mii_data sc_mii; 196 1.2.2.2 yamt u_int8_t sc_enaddr[ETHER_ADDR_LEN]; /* station addr */ 197 1.2.2.2 yamt 198 1.2.2.2 yamt struct mvgbe_chain_data sc_cdata; 199 1.2.2.2 yamt struct mvgbe_ring_data *sc_rdata; 200 1.2.2.2 yamt bus_dmamap_t sc_ring_map; 201 1.2.2.2 yamt int sc_if_flags; 202 1.2.2.2 yamt 203 1.2.2.2 yamt LIST_HEAD(__mvgbe_jfreehead, mvgbe_jpool_entry) sc_jfree_listhead; 204 1.2.2.2 yamt LIST_HEAD(__mvgbe_jinusehead, mvgbe_jpool_entry) sc_jinuse_listhead; 205 1.2.2.2 yamt SIMPLEQ_HEAD(__mvgbe_txmaphead, mvgbe_txmap_entry) sc_txmap_head; 206 1.2.2.2 yamt 207 1.2.2.2 yamt #if NRND > 0 208 1.2.2.2 yamt rndsource_element_t sc_rnd_source; 209 1.2.2.2 yamt #endif 210 1.2.2.2 yamt }; 211 1.2.2.2 yamt 212 1.2.2.2 yamt 213 1.2.2.2 yamt /* Gigabit Ethernet Unit Global part functions */ 214 1.2.2.2 yamt 215 1.2.2.2 yamt static int mvgbec_match(device_t, struct cfdata *, void *); 216 1.2.2.2 yamt static void mvgbec_attach(device_t, device_t, void *); 217 1.2.2.2 yamt 218 1.2.2.2 yamt static int mvgbec_print(void *, const char *); 219 1.2.2.2 yamt static int mvgbec_search(device_t, cfdata_t, const int *, void *); 220 1.2.2.2 yamt 221 1.2.2.2 yamt /* MII funcstions */ 222 1.2.2.2 yamt static int mvgbec_miibus_readreg(device_t, int, int); 223 1.2.2.2 yamt static void mvgbec_miibus_writereg(device_t, int, int, int); 224 1.2.2.2 yamt static void mvgbec_miibus_statchg(device_t); 225 1.2.2.2 yamt 226 1.2.2.2 yamt static void mvgbec_wininit(struct mvgbec_softc *); 227 1.2.2.2 yamt 228 1.2.2.2 yamt /* Gigabit Ethernet Port part functions */ 229 1.2.2.2 yamt 230 1.2.2.2 yamt static int mvgbe_match(device_t, struct cfdata *, void *); 231 1.2.2.2 yamt static void mvgbe_attach(device_t, device_t, void *); 232 1.2.2.2 yamt 233 1.2.2.2 yamt static int mvgbe_intr(void *); 234 1.2.2.2 yamt 235 1.2.2.2 yamt static void mvgbe_start(struct ifnet *); 236 1.2.2.2 yamt static int mvgbe_ioctl(struct ifnet *, u_long, void *); 237 1.2.2.2 yamt static int mvgbe_init(struct ifnet *); 238 1.2.2.2 yamt static void mvgbe_stop(struct ifnet *, int); 239 1.2.2.2 yamt static void mvgbe_watchdog(struct ifnet *); 240 1.2.2.2 yamt 241 1.2.2.2 yamt /* MII funcstions */ 242 1.2.2.2 yamt static int mvgbe_ifmedia_upd(struct ifnet *); 243 1.2.2.2 yamt static void mvgbe_ifmedia_sts(struct ifnet *, struct ifmediareq *); 244 1.2.2.2 yamt 245 1.2.2.2 yamt static int mvgbe_init_rx_ring(struct mvgbe_softc *); 246 1.2.2.2 yamt static int mvgbe_init_tx_ring(struct mvgbe_softc *); 247 1.2.2.2 yamt static int mvgbe_newbuf(struct mvgbe_softc *, int, struct mbuf *, bus_dmamap_t); 248 1.2.2.2 yamt static int mvgbe_alloc_jumbo_mem(struct mvgbe_softc *); 249 1.2.2.2 yamt static void *mvgbe_jalloc(struct mvgbe_softc *); 250 1.2.2.2 yamt static void mvgbe_jfree(struct mbuf *, void *, size_t, void *); 251 1.2.2.2 yamt static int mvgbe_encap(struct mvgbe_softc *, struct mbuf *, uint32_t *); 252 1.2.2.2 yamt static void mvgbe_rxeof(struct mvgbe_softc *); 253 1.2.2.2 yamt static void mvgbe_txeof(struct mvgbe_softc *); 254 1.2.2.2 yamt static void mvgbe_setmulti(struct mvgbe_softc *); 255 1.2.2.2 yamt #ifdef MVGBE_DEBUG 256 1.2.2.2 yamt static void mvgbe_dump_txdesc(struct mvgbe_tx_desc *, int); 257 1.2.2.2 yamt #endif 258 1.2.2.2 yamt 259 1.2.2.2 yamt CFATTACH_DECL_NEW(mvgbec_gt, sizeof(struct mvgbec_softc), 260 1.2.2.2 yamt mvgbec_match, mvgbec_attach, NULL, NULL); 261 1.2.2.2 yamt CFATTACH_DECL_NEW(mvgbec_mbus, sizeof(struct mvgbec_softc), 262 1.2.2.2 yamt mvgbec_match, mvgbec_attach, NULL, NULL); 263 1.2.2.2 yamt 264 1.2.2.2 yamt CFATTACH_DECL_NEW(mvgbe, sizeof(struct mvgbe_softc), 265 1.2.2.2 yamt mvgbe_match, mvgbe_attach, NULL, NULL); 266 1.2.2.2 yamt 267 1.2.2.2 yamt 268 1.2.2.2 yamt struct mvgbe_port { 269 1.2.2.2 yamt int model; 270 1.2.2.2 yamt int ports; 271 1.2.2.2 yamt int irqs[4]; 272 1.2.2.2 yamt } mvgbe_ports[] = { 273 1.2.2.2 yamt { MARVELL_DISCOVERY_II, 3, { 32, 33, 34 } }, 274 1.2.2.2 yamt { MARVELL_DISCOVERY_III, 3, { 32, 33, 34 } }, 275 1.2.2.2 yamt #if 0 276 1.2.2.2 yamt { MARVELL_DISCOVERY_LT, ?, { } }, 277 1.2.2.2 yamt { MARVELL_DISCOVERY_V, ?, { } }, 278 1.2.2.2 yamt { MARVELL_DISCOVERY_VI, ?, { } }, 279 1.2.2.2 yamt #endif 280 1.2.2.2 yamt { MARVELL_ORION_1_88F5082, 1, { 21 } }, 281 1.2.2.2 yamt { MARVELL_ORION_1_88F5180N, 1, { 21 } }, 282 1.2.2.2 yamt { MARVELL_ORION_1_88F5181, 1, { 21 } }, 283 1.2.2.2 yamt { MARVELL_ORION_1_88F5182, 1, { 21 } }, 284 1.2.2.2 yamt { MARVELL_ORION_2_88F5281, 1, { 21 } }, 285 1.2.2.2 yamt { MARVELL_ORION_1_88F6082, 1, { 21 } }, 286 1.2.2.2 yamt { MARVELL_ORION_1_88W8660, 1, { 21 } }, 287 1.2.2.2 yamt }; 288 1.2.2.2 yamt 289 1.2.2.2 yamt 290 1.2.2.2 yamt /* ARGSUSED */ 291 1.2.2.2 yamt static int 292 1.2.2.2 yamt mvgbec_match(device_t parent, struct cfdata *match, void *aux) 293 1.2.2.2 yamt { 294 1.2.2.2 yamt struct marvell_attach_args *mva = aux; 295 1.2.2.2 yamt int i; 296 1.2.2.2 yamt 297 1.2.2.2 yamt if (strcmp(mva->mva_name, match->cf_name) != 0) 298 1.2.2.2 yamt return 0; 299 1.2.2.2 yamt 300 1.2.2.2 yamt if (mva->mva_offset == MVA_OFFSET_DEFAULT) 301 1.2.2.2 yamt return 0; 302 1.2.2.2 yamt 303 1.2.2.2 yamt for (i = 0; i < __arraycount(mvgbe_ports); i++) 304 1.2.2.2 yamt if (mva->mva_model == mvgbe_ports[i].model) { 305 1.2.2.2 yamt mva->mva_size = MVGBE_SIZE; 306 1.2.2.2 yamt return 1; 307 1.2.2.2 yamt } 308 1.2.2.2 yamt return 0; 309 1.2.2.2 yamt } 310 1.2.2.2 yamt 311 1.2.2.2 yamt /* ARGSUSED */ 312 1.2.2.2 yamt static void 313 1.2.2.2 yamt mvgbec_attach(device_t parent, device_t self, void *aux) 314 1.2.2.2 yamt { 315 1.2.2.2 yamt struct mvgbec_softc *sc = device_private(self); 316 1.2.2.2 yamt struct marvell_attach_args *mva = aux, gbea; 317 1.2.2.2 yamt struct mvgbe_softc *port; 318 1.2.2.2 yamt struct mii_softc *mii; 319 1.2.2.2 yamt device_t child; 320 1.2.2.2 yamt uint32_t phyaddr; 321 1.2.2.2 yamt int i, j; 322 1.2.2.2 yamt 323 1.2.2.2 yamt aprint_naive("\n"); 324 1.2.2.2 yamt aprint_normal(": Marvell Gigabit Ethernet Controller\n"); 325 1.2.2.2 yamt 326 1.2.2.2 yamt sc->sc_dev = self; 327 1.2.2.2 yamt sc->sc_iot = mva->mva_iot; 328 1.2.2.2 yamt if (bus_space_subregion(mva->mva_iot, mva->mva_ioh, mva->mva_offset, 329 1.2.2.2 yamt mva->mva_size, &sc->sc_ioh)) { 330 1.2.2.2 yamt aprint_error_dev(self, "Cannot map registers\n"); 331 1.2.2.2 yamt return; 332 1.2.2.2 yamt } 333 1.2.2.2 yamt phyaddr = 0; 334 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_PHYADDR, phyaddr); 335 1.2.2.2 yamt 336 1.2.2.2 yamt mutex_init(&sc->sc_mtx, MUTEX_DEFAULT, IPL_NET); 337 1.2.2.2 yamt 338 1.2.2.2 yamt /* Disable and clear Gigabit Ethernet Unit interrupts */ 339 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_EUIM, 0); 340 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_EUIC, 0); 341 1.2.2.2 yamt 342 1.2.2.2 yamt mvgbec_wininit(sc); 343 1.2.2.2 yamt 344 1.2.2.2 yamt memset(&gbea, 0, sizeof(gbea)); 345 1.2.2.2 yamt for (i = 0; i < __arraycount(mvgbe_ports); i++) { 346 1.2.2.2 yamt if (mvgbe_ports[i].model != mva->mva_model) 347 1.2.2.2 yamt continue; 348 1.2.2.2 yamt 349 1.2.2.2 yamt for (j = 0; j < mvgbe_ports[i].ports; j++) { 350 1.2.2.2 yamt gbea.mva_name = "mvgbe"; 351 1.2.2.2 yamt gbea.mva_model = mva->mva_model; 352 1.2.2.2 yamt gbea.mva_iot = sc->sc_iot; 353 1.2.2.2 yamt gbea.mva_ioh = sc->sc_ioh; 354 1.2.2.2 yamt gbea.mva_unit = j; 355 1.2.2.2 yamt gbea.mva_dmat = mva->mva_dmat; 356 1.2.2.2 yamt gbea.mva_irq = mvgbe_ports[i].irqs[j]; 357 1.2.2.2 yamt child = config_found_sm_loc(sc->sc_dev, "mvgbec", NULL, 358 1.2.2.2 yamt &gbea, mvgbec_print, mvgbec_search); 359 1.2.2.2 yamt if (child) { 360 1.2.2.2 yamt port = device_private(child); 361 1.2.2.2 yamt mii = LIST_FIRST(&port->sc_mii.mii_phys); 362 1.2.2.2 yamt phyaddr |= MVGBE_PHYADDR_PHYAD(j, mii->mii_phy); 363 1.2.2.2 yamt } 364 1.2.2.2 yamt } 365 1.2.2.2 yamt } 366 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_PHYADDR, phyaddr); 367 1.2.2.2 yamt } 368 1.2.2.2 yamt 369 1.2.2.2 yamt static int 370 1.2.2.2 yamt mvgbec_print(void *aux, const char *pnp) 371 1.2.2.2 yamt { 372 1.2.2.2 yamt struct marvell_attach_args *gbea = aux; 373 1.2.2.2 yamt 374 1.2.2.2 yamt if (pnp) 375 1.2.2.2 yamt aprint_normal("%s at %s port %d", 376 1.2.2.2 yamt gbea->mva_name, pnp, gbea->mva_unit); 377 1.2.2.2 yamt else { 378 1.2.2.2 yamt if (gbea->mva_unit != MVGBECCF_PORT_DEFAULT) 379 1.2.2.2 yamt aprint_normal(" port %d", gbea->mva_unit); 380 1.2.2.2 yamt if (gbea->mva_irq != MVGBECCF_IRQ_DEFAULT) 381 1.2.2.2 yamt aprint_normal(" irq %d", gbea->mva_irq); 382 1.2.2.2 yamt } 383 1.2.2.2 yamt return UNCONF; 384 1.2.2.2 yamt } 385 1.2.2.2 yamt 386 1.2.2.2 yamt /* ARGSUSED */ 387 1.2.2.2 yamt static int 388 1.2.2.2 yamt mvgbec_search(device_t parent, cfdata_t cf, const int *ldesc, void *aux) 389 1.2.2.2 yamt { 390 1.2.2.2 yamt struct marvell_attach_args *gbea = aux; 391 1.2.2.2 yamt 392 1.2.2.2 yamt if (cf->cf_loc[MVGBECCF_PORT] == gbea->mva_unit && 393 1.2.2.2 yamt cf->cf_loc[MVGBECCF_IRQ] != MVGBECCF_IRQ_DEFAULT) 394 1.2.2.2 yamt gbea->mva_irq = cf->cf_loc[MVGBECCF_IRQ]; 395 1.2.2.2 yamt 396 1.2.2.2 yamt return config_match(parent, cf, aux); 397 1.2.2.2 yamt } 398 1.2.2.2 yamt 399 1.2.2.2 yamt static int 400 1.2.2.2 yamt mvgbec_miibus_readreg(device_t dev, int phy, int reg) 401 1.2.2.2 yamt { 402 1.2.2.2 yamt struct mvgbe_softc *sc = device_private(dev); 403 1.2.2.2 yamt struct mvgbec_softc *csc = device_private(device_parent(dev)); 404 1.2.2.2 yamt struct ifnet *ifp = &sc->sc_ethercom.ec_if; 405 1.2.2.2 yamt uint32_t smi, val; 406 1.2.2.2 yamt int i; 407 1.2.2.2 yamt 408 1.2.2.2 yamt mutex_enter(&csc->sc_mtx); 409 1.2.2.2 yamt 410 1.2.2.2 yamt for (i = 0; i < MVGBE_PHY_TIMEOUT; i++) { 411 1.2.2.2 yamt DELAY(1); 412 1.2.2.2 yamt if (!(MVGBE_READ(csc, MVGBE_SMI) & MVGBE_SMI_BUSY)) 413 1.2.2.2 yamt break; 414 1.2.2.2 yamt } 415 1.2.2.2 yamt if (i == MVGBE_PHY_TIMEOUT) { 416 1.2.2.2 yamt aprint_error_ifnet(ifp, "SMI busy timeout\n"); 417 1.2.2.2 yamt mutex_exit(&csc->sc_mtx); 418 1.2.2.2 yamt return -1; 419 1.2.2.2 yamt } 420 1.2.2.2 yamt 421 1.2.2.2 yamt smi = 422 1.2.2.2 yamt MVGBE_SMI_PHYAD(phy) | MVGBE_SMI_REGAD(reg) | MVGBE_SMI_OPCODE_READ; 423 1.2.2.2 yamt MVGBE_WRITE(csc, MVGBE_SMI, smi); 424 1.2.2.2 yamt 425 1.2.2.2 yamt for (i = 0; i < MVGBE_PHY_TIMEOUT; i++) { 426 1.2.2.2 yamt DELAY(1); 427 1.2.2.2 yamt smi = MVGBE_READ(csc, MVGBE_SMI); 428 1.2.2.2 yamt if (smi & MVGBE_SMI_READVALID) 429 1.2.2.2 yamt break; 430 1.2.2.2 yamt } 431 1.2.2.2 yamt 432 1.2.2.2 yamt mutex_exit(&csc->sc_mtx); 433 1.2.2.2 yamt 434 1.2.2.2 yamt DPRINTFN(9, ("mvgbec_miibus_readreg: i=%d, timeout=%d\n", 435 1.2.2.2 yamt i, MVGBE_PHY_TIMEOUT)); 436 1.2.2.2 yamt 437 1.2.2.2 yamt val = smi & MVGBE_SMI_DATA_MASK; 438 1.2.2.2 yamt 439 1.2.2.2 yamt DPRINTFN(9, ("mvgbec_miibus_readreg phy=%d, reg=%#x, val=%#x\n", 440 1.2.2.2 yamt phy, reg, val)); 441 1.2.2.2 yamt 442 1.2.2.2 yamt return val; 443 1.2.2.2 yamt } 444 1.2.2.2 yamt 445 1.2.2.2 yamt static void 446 1.2.2.2 yamt mvgbec_miibus_writereg(device_t dev, int phy, int reg, int val) 447 1.2.2.2 yamt { 448 1.2.2.2 yamt struct mvgbe_softc *sc = device_private(dev); 449 1.2.2.2 yamt struct mvgbec_softc *csc = device_private(device_parent(dev)); 450 1.2.2.2 yamt struct ifnet *ifp = &sc->sc_ethercom.ec_if; 451 1.2.2.2 yamt uint32_t smi; 452 1.2.2.2 yamt int i; 453 1.2.2.2 yamt 454 1.2.2.2 yamt DPRINTFN(9, ("mvgbec_miibus_writereg phy=%d reg=%#x val=%#x\n", 455 1.2.2.2 yamt phy, reg, val)); 456 1.2.2.2 yamt 457 1.2.2.2 yamt mutex_enter(&csc->sc_mtx); 458 1.2.2.2 yamt 459 1.2.2.2 yamt for (i = 0; i < MVGBE_PHY_TIMEOUT; i++) { 460 1.2.2.2 yamt DELAY(1); 461 1.2.2.2 yamt if (!(MVGBE_READ(csc, MVGBE_SMI) & MVGBE_SMI_BUSY)) 462 1.2.2.2 yamt break; 463 1.2.2.2 yamt } 464 1.2.2.2 yamt if (i == MVGBE_PHY_TIMEOUT) { 465 1.2.2.2 yamt aprint_error_ifnet(ifp, "SMI busy timeout\n"); 466 1.2.2.2 yamt mutex_exit(&csc->sc_mtx); 467 1.2.2.2 yamt return; 468 1.2.2.2 yamt } 469 1.2.2.2 yamt 470 1.2.2.2 yamt smi = MVGBE_SMI_PHYAD(phy) | MVGBE_SMI_REGAD(reg) | 471 1.2.2.2 yamt MVGBE_SMI_OPCODE_WRITE | (val & MVGBE_SMI_DATA_MASK); 472 1.2.2.2 yamt MVGBE_WRITE(csc, MVGBE_SMI, smi); 473 1.2.2.2 yamt 474 1.2.2.2 yamt for (i = 0; i < MVGBE_PHY_TIMEOUT; i++) { 475 1.2.2.2 yamt DELAY(1); 476 1.2.2.2 yamt if (!(MVGBE_READ(csc, MVGBE_SMI) & MVGBE_SMI_BUSY)) 477 1.2.2.2 yamt break; 478 1.2.2.2 yamt } 479 1.2.2.2 yamt 480 1.2.2.2 yamt mutex_exit(&csc->sc_mtx); 481 1.2.2.2 yamt 482 1.2.2.2 yamt if (i == MVGBE_PHY_TIMEOUT) 483 1.2.2.2 yamt aprint_error_ifnet(ifp, "phy write timed out\n"); 484 1.2.2.2 yamt } 485 1.2.2.2 yamt 486 1.2.2.2 yamt static void 487 1.2.2.2 yamt mvgbec_miibus_statchg(device_t dev) 488 1.2.2.2 yamt { 489 1.2.2.2 yamt 490 1.2.2.2 yamt /* nothing to do */ 491 1.2.2.2 yamt } 492 1.2.2.2 yamt 493 1.2.2.2 yamt 494 1.2.2.2 yamt static void 495 1.2.2.2 yamt mvgbec_wininit(struct mvgbec_softc *sc) 496 1.2.2.2 yamt { 497 1.2.2.2 yamt device_t pdev = device_parent(sc->sc_dev); 498 1.2.2.2 yamt uint64_t base; 499 1.2.2.2 yamt uint32_t en, ac, size; 500 1.2.2.2 yamt int window, target, attr, rv, i; 501 1.2.2.2 yamt static int tags[] = { 502 1.2.2.2 yamt MARVELL_TAG_SDRAM_CS0, 503 1.2.2.2 yamt MARVELL_TAG_SDRAM_CS1, 504 1.2.2.2 yamt MARVELL_TAG_SDRAM_CS2, 505 1.2.2.2 yamt MARVELL_TAG_SDRAM_CS3, 506 1.2.2.2 yamt 507 1.2.2.2 yamt MARVELL_TAG_UNDEFINED, 508 1.2.2.2 yamt }; 509 1.2.2.2 yamt 510 1.2.2.2 yamt /* First disable all address decode windows */ 511 1.2.2.2 yamt en = MVGBE_BARE_EN_MASK; 512 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_BARE, en); 513 1.2.2.2 yamt 514 1.2.2.2 yamt ac = 0; 515 1.2.2.2 yamt for (window = 0, i = 0; 516 1.2.2.2 yamt tags[i] != MARVELL_TAG_UNDEFINED && window < MVGBE_NWINDOW; i++) { 517 1.2.2.2 yamt rv = marvell_winparams_by_tag(pdev, tags[i], 518 1.2.2.2 yamt &target, &attr, &base, &size); 519 1.2.2.2 yamt if (rv != 0 || size == 0) 520 1.2.2.2 yamt continue; 521 1.2.2.2 yamt 522 1.2.2.2 yamt if (base > 0xffffffffULL) { 523 1.2.2.2 yamt if (window >= MVGBE_NREMAP) { 524 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 525 1.2.2.2 yamt "can't remap window %d\n", window); 526 1.2.2.2 yamt continue; 527 1.2.2.2 yamt } 528 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_HA(window), 529 1.2.2.2 yamt (base >> 32) & 0xffffffff); 530 1.2.2.2 yamt } 531 1.2.2.2 yamt 532 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_BASEADDR(window), 533 1.2.2.2 yamt MVGBE_BASEADDR_TARGET(target) | 534 1.2.2.2 yamt MVGBE_BASEADDR_ATTR(attr) | 535 1.2.2.2 yamt MVGBE_BASEADDR_BASE(base)); 536 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_S(window), MVGBE_S_SIZE(size)); 537 1.2.2.2 yamt 538 1.2.2.2 yamt en &= ~(1 << window); 539 1.2.2.2 yamt /* set full access (r/w) */ 540 1.2.2.2 yamt ac |= MVGBE_EPAP_EPAR(window, MVGBE_EPAP_AC_FA); 541 1.2.2.2 yamt window++; 542 1.2.2.2 yamt } 543 1.2.2.2 yamt /* allow to access decode window */ 544 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_EPAP, ac); 545 1.2.2.2 yamt 546 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_BARE, en); 547 1.2.2.2 yamt } 548 1.2.2.2 yamt 549 1.2.2.2 yamt 550 1.2.2.2 yamt /* ARGSUSED */ 551 1.2.2.2 yamt static int 552 1.2.2.2 yamt mvgbe_match(device_t parent, struct cfdata *match, void *aux) 553 1.2.2.2 yamt { 554 1.2.2.2 yamt struct marvell_attach_args *mva = aux; 555 1.2.2.2 yamt uint32_t pbase, maddrh, maddrl; 556 1.2.2.2 yamt 557 1.2.2.2 yamt pbase = MVGBE_PORTR_BASE + mva->mva_unit * MVGBE_PORTR_SIZE; 558 1.2.2.2 yamt maddrh = 559 1.2.2.2 yamt bus_space_read_4(mva->mva_iot, mva->mva_ioh, pbase + MVGBE_MACAH); 560 1.2.2.2 yamt maddrl = 561 1.2.2.2 yamt bus_space_read_4(mva->mva_iot, mva->mva_ioh, pbase + MVGBE_MACAL); 562 1.2.2.2 yamt if ((maddrh | maddrl) == 0) 563 1.2.2.2 yamt return 0; 564 1.2.2.2 yamt 565 1.2.2.2 yamt return 1; 566 1.2.2.2 yamt } 567 1.2.2.2 yamt 568 1.2.2.2 yamt /* ARGSUSED */ 569 1.2.2.2 yamt static void 570 1.2.2.2 yamt mvgbe_attach(device_t parent, device_t self, void *aux) 571 1.2.2.2 yamt { 572 1.2.2.2 yamt struct mvgbe_softc *sc = device_private(self); 573 1.2.2.2 yamt struct marvell_attach_args *mva = aux; 574 1.2.2.2 yamt struct mvgbe_txmap_entry *entry; 575 1.2.2.2 yamt struct ifnet *ifp; 576 1.2.2.2 yamt bus_dma_segment_t seg; 577 1.2.2.2 yamt bus_dmamap_t dmamap; 578 1.2.2.2 yamt int rseg, i; 579 1.2.2.2 yamt uint32_t maddrh, maddrl; 580 1.2.2.2 yamt void *kva; 581 1.2.2.2 yamt 582 1.2.2.2 yamt aprint_naive("\n"); 583 1.2.2.2 yamt aprint_normal("\n"); 584 1.2.2.2 yamt 585 1.2.2.2 yamt sc->sc_dev = self; 586 1.2.2.2 yamt sc->sc_port = mva->mva_unit; 587 1.2.2.2 yamt sc->sc_iot = mva->mva_iot; 588 1.2.2.2 yamt if (bus_space_subregion(mva->mva_iot, mva->mva_ioh, 589 1.2.2.2 yamt MVGBE_PORTR_BASE + mva->mva_unit * MVGBE_PORTR_SIZE, 590 1.2.2.2 yamt MVGBE_PORTR_SIZE, &sc->sc_ioh)) { 591 1.2.2.2 yamt aprint_error_dev(self, "Cannot map registers\n"); 592 1.2.2.2 yamt return; 593 1.2.2.2 yamt } 594 1.2.2.2 yamt if (bus_space_subregion(mva->mva_iot, mva->mva_ioh, 595 1.2.2.2 yamt MVGBE_PORTDAFR_BASE + mva->mva_unit * MVGBE_PORTDAFR_SIZE, 596 1.2.2.2 yamt MVGBE_PORTDAFR_SIZE, &sc->sc_dafh)) { 597 1.2.2.2 yamt aprint_error_dev(self, 598 1.2.2.2 yamt "Cannot map destination address filter registers\n"); 599 1.2.2.2 yamt return; 600 1.2.2.2 yamt } 601 1.2.2.2 yamt sc->sc_dmat = mva->mva_dmat; 602 1.2.2.2 yamt 603 1.2.2.2 yamt maddrh = MVGBE_READ(sc, MVGBE_MACAH); 604 1.2.2.2 yamt maddrl = MVGBE_READ(sc, MVGBE_MACAL); 605 1.2.2.2 yamt sc->sc_enaddr[0] = maddrh >> 24; 606 1.2.2.2 yamt sc->sc_enaddr[1] = maddrh >> 16; 607 1.2.2.2 yamt sc->sc_enaddr[2] = maddrh >> 8; 608 1.2.2.2 yamt sc->sc_enaddr[3] = maddrh >> 0; 609 1.2.2.2 yamt sc->sc_enaddr[4] = maddrl >> 8; 610 1.2.2.2 yamt sc->sc_enaddr[5] = maddrl >> 0; 611 1.2.2.2 yamt aprint_normal_dev(self, "Ethernet address %s\n", 612 1.2.2.2 yamt ether_sprintf(sc->sc_enaddr)); 613 1.2.2.2 yamt 614 1.2.2.2 yamt /* clear all ethernet port interrupts */ 615 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_IC, 0); 616 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_ICE, 0); 617 1.2.2.2 yamt 618 1.2.2.2 yamt marvell_intr_establish(mva->mva_irq, IPL_NET, mvgbe_intr, sc); 619 1.2.2.2 yamt 620 1.2.2.2 yamt /* Allocate the descriptor queues. */ 621 1.2.2.2 yamt if (bus_dmamem_alloc(sc->sc_dmat, sizeof(struct mvgbe_ring_data), 622 1.2.2.2 yamt PAGE_SIZE, 0, &seg, 1, &rseg, BUS_DMA_NOWAIT)) { 623 1.2.2.2 yamt aprint_error_dev(self, "can't alloc rx buffers\n"); 624 1.2.2.2 yamt return; 625 1.2.2.2 yamt } 626 1.2.2.2 yamt if (bus_dmamem_map(sc->sc_dmat, &seg, rseg, 627 1.2.2.2 yamt sizeof(struct mvgbe_ring_data), &kva, BUS_DMA_NOWAIT)) { 628 1.2.2.2 yamt aprint_error_dev(self, "can't map dma buffers (%lu bytes)\n", 629 1.2.2.2 yamt (u_long)sizeof(struct mvgbe_ring_data)); 630 1.2.2.2 yamt goto fail1; 631 1.2.2.2 yamt } 632 1.2.2.2 yamt if (bus_dmamap_create(sc->sc_dmat, sizeof(struct mvgbe_ring_data), 1, 633 1.2.2.2 yamt sizeof(struct mvgbe_ring_data), 0, BUS_DMA_NOWAIT, 634 1.2.2.2 yamt &sc->sc_ring_map)) { 635 1.2.2.2 yamt aprint_error_dev(self, "can't create dma map\n"); 636 1.2.2.2 yamt goto fail2; 637 1.2.2.2 yamt } 638 1.2.2.2 yamt if (bus_dmamap_load(sc->sc_dmat, sc->sc_ring_map, kva, 639 1.2.2.2 yamt sizeof(struct mvgbe_ring_data), NULL, BUS_DMA_NOWAIT)) { 640 1.2.2.2 yamt aprint_error_dev(self, "can't load dma map\n"); 641 1.2.2.2 yamt goto fail3; 642 1.2.2.2 yamt } 643 1.2.2.2 yamt for (i = 0; i < MVGBE_RX_RING_CNT; i++) 644 1.2.2.2 yamt sc->sc_cdata.mvgbe_rx_chain[i].mvgbe_mbuf = NULL; 645 1.2.2.2 yamt 646 1.2.2.2 yamt SIMPLEQ_INIT(&sc->sc_txmap_head); 647 1.2.2.2 yamt for (i = 0; i < MVGBE_TX_RING_CNT; i++) { 648 1.2.2.2 yamt sc->sc_cdata.mvgbe_tx_chain[i].mvgbe_mbuf = NULL; 649 1.2.2.2 yamt 650 1.2.2.2 yamt if (bus_dmamap_create(sc->sc_dmat, 651 1.2.2.2 yamt MVGBE_JLEN, MVGBE_NTXSEG, MVGBE_JLEN, 0, 652 1.2.2.2 yamt BUS_DMA_NOWAIT, &dmamap)) { 653 1.2.2.2 yamt aprint_error_dev(self, "Can't create TX dmamap\n"); 654 1.2.2.2 yamt goto fail4; 655 1.2.2.2 yamt } 656 1.2.2.2 yamt 657 1.2.2.2 yamt entry = kmem_alloc(sizeof(*entry), KM_SLEEP); 658 1.2.2.2 yamt if (!entry) { 659 1.2.2.2 yamt aprint_error_dev(self, "Can't alloc txmap entry\n"); 660 1.2.2.2 yamt bus_dmamap_destroy(sc->sc_dmat, dmamap); 661 1.2.2.2 yamt goto fail4; 662 1.2.2.2 yamt } 663 1.2.2.2 yamt entry->dmamap = dmamap; 664 1.2.2.2 yamt SIMPLEQ_INSERT_HEAD(&sc->sc_txmap_head, entry, link); 665 1.2.2.2 yamt } 666 1.2.2.2 yamt 667 1.2.2.2 yamt sc->sc_rdata = (struct mvgbe_ring_data *)kva; 668 1.2.2.2 yamt memset(sc->sc_rdata, 0, sizeof(struct mvgbe_ring_data)); 669 1.2.2.2 yamt 670 1.2.2.2 yamt #if 0 671 1.2.2.2 yamt /* 672 1.2.2.2 yamt * We can support 802.1Q VLAN-sized frames and jumbo 673 1.2.2.2 yamt * Ethernet frames. 674 1.2.2.2 yamt */ 675 1.2.2.2 yamt sc->sc_ethercom.ec_capabilities |= 676 1.2.2.2 yamt ETHERCAP_VLAN_MTU | ETHERCAP_VLAN_HWTAGGING | ETHERCAP_JUMBO_MTU; 677 1.2.2.2 yamt #else 678 1.2.2.2 yamt /* XXXX: We don't know the usage of VLAN. */ 679 1.2.2.2 yamt sc->sc_ethercom.ec_capabilities |= ETHERCAP_JUMBO_MTU; 680 1.2.2.2 yamt #endif 681 1.2.2.2 yamt 682 1.2.2.2 yamt /* Try to allocate memory for jumbo buffers. */ 683 1.2.2.2 yamt if (mvgbe_alloc_jumbo_mem(sc)) { 684 1.2.2.2 yamt aprint_error_dev(self, "jumbo buffer allocation failed\n"); 685 1.2.2.2 yamt goto fail4; 686 1.2.2.2 yamt } 687 1.2.2.2 yamt 688 1.2.2.2 yamt ifp = &sc->sc_ethercom.ec_if; 689 1.2.2.2 yamt ifp->if_softc = sc; 690 1.2.2.2 yamt ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 691 1.2.2.2 yamt ifp->if_start = mvgbe_start; 692 1.2.2.2 yamt ifp->if_ioctl = mvgbe_ioctl; 693 1.2.2.2 yamt ifp->if_init = mvgbe_init; 694 1.2.2.2 yamt ifp->if_stop = mvgbe_stop; 695 1.2.2.2 yamt ifp->if_watchdog = mvgbe_watchdog; 696 1.2.2.2 yamt /* 697 1.2.2.2 yamt * We can do IPv4/TCPv4/UDPv4 checksums in hardware. 698 1.2.2.2 yamt */ 699 1.2.2.2 yamt sc->sc_ethercom.ec_if.if_capabilities |= 700 1.2.2.2 yamt IFCAP_CSUM_IPv4_Tx | IFCAP_CSUM_IPv4_Rx | 701 1.2.2.2 yamt IFCAP_CSUM_TCPv4_Tx | IFCAP_CSUM_TCPv4_Rx | 702 1.2.2.2 yamt IFCAP_CSUM_UDPv4_Tx | IFCAP_CSUM_UDPv4_Rx; 703 1.2.2.2 yamt IFQ_SET_MAXLEN(&ifp->if_snd, max(MVGBE_TX_RING_CNT - 1, IFQ_MAXLEN)); 704 1.2.2.2 yamt IFQ_SET_READY(&ifp->if_snd); 705 1.2.2.2 yamt strcpy(ifp->if_xname, device_xname(sc->sc_dev)); 706 1.2.2.2 yamt 707 1.2.2.2 yamt mvgbe_stop(ifp, 0); 708 1.2.2.2 yamt 709 1.2.2.2 yamt /* 710 1.2.2.2 yamt * Do MII setup. 711 1.2.2.2 yamt */ 712 1.2.2.2 yamt sc->sc_mii.mii_ifp = ifp; 713 1.2.2.2 yamt sc->sc_mii.mii_readreg = mvgbec_miibus_readreg; 714 1.2.2.2 yamt sc->sc_mii.mii_writereg = mvgbec_miibus_writereg; 715 1.2.2.2 yamt sc->sc_mii.mii_statchg = mvgbec_miibus_statchg; 716 1.2.2.2 yamt 717 1.2.2.2 yamt sc->sc_ethercom.ec_mii = &sc->sc_mii; 718 1.2.2.2 yamt ifmedia_init(&sc->sc_mii.mii_media, 0, 719 1.2.2.2 yamt mvgbe_ifmedia_upd, mvgbe_ifmedia_sts); 720 1.2.2.2 yamt mii_attach(self, &sc->sc_mii, 0xffffffff, 721 1.2.2.2 yamt MII_PHY_ANY, MII_OFFSET_ANY, 0); 722 1.2.2.2 yamt if (LIST_FIRST(&sc->sc_mii.mii_phys) == NULL) { 723 1.2.2.2 yamt aprint_error_dev(self, "no PHY found!\n"); 724 1.2.2.2 yamt ifmedia_add(&sc->sc_mii.mii_media, 725 1.2.2.2 yamt IFM_ETHER|IFM_MANUAL, 0, NULL); 726 1.2.2.2 yamt ifmedia_set(&sc->sc_mii.mii_media, IFM_ETHER|IFM_MANUAL); 727 1.2.2.2 yamt } else 728 1.2.2.2 yamt ifmedia_set(&sc->sc_mii.mii_media, IFM_ETHER|IFM_AUTO); 729 1.2.2.2 yamt 730 1.2.2.2 yamt /* 731 1.2.2.2 yamt * Call MI attach routines. 732 1.2.2.2 yamt */ 733 1.2.2.2 yamt if_attach(ifp); 734 1.2.2.2 yamt 735 1.2.2.2 yamt ether_ifattach(ifp, sc->sc_enaddr); 736 1.2.2.2 yamt 737 1.2.2.2 yamt #if NRND > 0 738 1.2.2.2 yamt rnd_attach_source(&sc->sc_rnd_source, device_xname(sc->sc_dev), 739 1.2.2.2 yamt RND_TYPE_NET, 0); 740 1.2.2.2 yamt #endif 741 1.2.2.2 yamt 742 1.2.2.2 yamt return; 743 1.2.2.2 yamt 744 1.2.2.2 yamt fail4: 745 1.2.2.2 yamt while ((entry = SIMPLEQ_FIRST(&sc->sc_txmap_head)) != NULL) { 746 1.2.2.2 yamt SIMPLEQ_REMOVE_HEAD(&sc->sc_txmap_head, link); 747 1.2.2.2 yamt bus_dmamap_destroy(sc->sc_dmat, entry->dmamap); 748 1.2.2.2 yamt } 749 1.2.2.2 yamt bus_dmamap_unload(sc->sc_dmat, sc->sc_ring_map); 750 1.2.2.2 yamt fail3: 751 1.2.2.2 yamt bus_dmamap_destroy(sc->sc_dmat, sc->sc_ring_map); 752 1.2.2.2 yamt fail2: 753 1.2.2.2 yamt bus_dmamem_unmap(sc->sc_dmat, kva, sizeof(struct mvgbe_ring_data)); 754 1.2.2.2 yamt fail1: 755 1.2.2.2 yamt bus_dmamem_free(sc->sc_dmat, &seg, rseg); 756 1.2.2.2 yamt return; 757 1.2.2.2 yamt } 758 1.2.2.2 yamt 759 1.2.2.2 yamt 760 1.2.2.2 yamt static int 761 1.2.2.2 yamt mvgbe_intr(void *arg) 762 1.2.2.2 yamt { 763 1.2.2.2 yamt struct mvgbe_softc *sc = arg; 764 1.2.2.2 yamt struct ifnet *ifp = &sc->sc_ethercom.ec_if; 765 1.2.2.2 yamt uint32_t ic, ice, datum = 0; 766 1.2.2.2 yamt int claimed = 0; 767 1.2.2.2 yamt 768 1.2.2.2 yamt for (;;) { 769 1.2.2.2 yamt ice = MVGBE_READ(sc, MVGBE_ICE); 770 1.2.2.2 yamt ic = MVGBE_READ(sc, MVGBE_IC); 771 1.2.2.2 yamt 772 1.2.2.2 yamt DPRINTFN(3, ("mvgbe_intr: ic=%#x, ice=%#x\n", ic, ice)); 773 1.2.2.2 yamt if (ic == 0 && ice == 0) 774 1.2.2.2 yamt break; 775 1.2.2.2 yamt 776 1.2.2.2 yamt datum = datum ^ ic ^ ice; 777 1.2.2.2 yamt 778 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_IC, ~ic); 779 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_ICE, ~ice); 780 1.2.2.2 yamt 781 1.2.2.2 yamt claimed = 1; 782 1.2.2.2 yamt 783 1.2.2.2 yamt if (ice & MVGBE_ICE_LINKCHG) { 784 1.2.2.2 yamt if (MVGBE_READ(sc, MVGBE_PS) & MVGBE_PS_LINKUP) { 785 1.2.2.2 yamt /* Enable port RX and TX. */ 786 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_RQC, MVGBE_RQC_ENQ(0)); 787 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_TQC, MVGBE_TQC_ENQ); 788 1.2.2.2 yamt } else { 789 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_RQC, MVGBE_RQC_DISQ(0)); 790 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_TQC, MVGBE_TQC_DISQ); 791 1.2.2.2 yamt } 792 1.2.2.2 yamt } 793 1.2.2.2 yamt 794 1.2.2.2 yamt if (ic & (MVGBE_IC_RXBUF | MVGBE_IC_RXERROR)) 795 1.2.2.2 yamt mvgbe_rxeof(sc); 796 1.2.2.2 yamt 797 1.2.2.2 yamt if (ice & (MVGBE_ICE_TXBUF | MVGBE_ICE_TXERR)) 798 1.2.2.2 yamt mvgbe_txeof(sc); 799 1.2.2.2 yamt } 800 1.2.2.2 yamt 801 1.2.2.2 yamt if (!IFQ_IS_EMPTY(&ifp->if_snd)) 802 1.2.2.2 yamt mvgbe_start(ifp); 803 1.2.2.2 yamt 804 1.2.2.2 yamt #if NRND > 0 805 1.2.2.2 yamt if (RND_ENABLED(&sc->sc_rnd_source)) 806 1.2.2.2 yamt rnd_add_uint32(&sc->sc_rnd_source, datum); 807 1.2.2.2 yamt #endif 808 1.2.2.2 yamt 809 1.2.2.2 yamt return claimed; 810 1.2.2.2 yamt } 811 1.2.2.2 yamt 812 1.2.2.2 yamt static void 813 1.2.2.2 yamt mvgbe_start(struct ifnet *ifp) 814 1.2.2.2 yamt { 815 1.2.2.2 yamt struct mvgbe_softc *sc = ifp->if_softc; 816 1.2.2.2 yamt struct mbuf *m_head = NULL; 817 1.2.2.2 yamt uint32_t idx = sc->sc_cdata.mvgbe_tx_prod; 818 1.2.2.2 yamt int pkts = 0; 819 1.2.2.2 yamt 820 1.2.2.2 yamt DPRINTFN(3, ("mvgbe_start (idx %d, tx_chain[idx] %p)\n", idx, 821 1.2.2.2 yamt sc->sc_cdata.mvgbe_tx_chain[idx].mvgbe_mbuf)); 822 1.2.2.2 yamt 823 1.2.2.2 yamt if ((ifp->if_flags & (IFF_RUNNING|IFF_OACTIVE)) != IFF_RUNNING) 824 1.2.2.2 yamt return; 825 1.2.2.2 yamt /* If Link is DOWN, can't start TX */ 826 1.2.2.2 yamt if (!(MVGBE_READ(sc, MVGBE_PS) & MVGBE_PS_LINKUP)) 827 1.2.2.2 yamt return; 828 1.2.2.2 yamt 829 1.2.2.2 yamt while (sc->sc_cdata.mvgbe_tx_chain[idx].mvgbe_mbuf == NULL) { 830 1.2.2.2 yamt IFQ_POLL(&ifp->if_snd, m_head); 831 1.2.2.2 yamt if (m_head == NULL) 832 1.2.2.2 yamt break; 833 1.2.2.2 yamt 834 1.2.2.2 yamt /* 835 1.2.2.2 yamt * Pack the data into the transmit ring. If we 836 1.2.2.2 yamt * don't have room, set the OACTIVE flag and wait 837 1.2.2.2 yamt * for the NIC to drain the ring. 838 1.2.2.2 yamt */ 839 1.2.2.2 yamt if (mvgbe_encap(sc, m_head, &idx)) { 840 1.2.2.2 yamt ifp->if_flags |= IFF_OACTIVE; 841 1.2.2.2 yamt break; 842 1.2.2.2 yamt } 843 1.2.2.2 yamt 844 1.2.2.2 yamt /* now we are committed to transmit the packet */ 845 1.2.2.2 yamt IFQ_DEQUEUE(&ifp->if_snd, m_head); 846 1.2.2.2 yamt pkts++; 847 1.2.2.2 yamt 848 1.2.2.2 yamt /* 849 1.2.2.2 yamt * If there's a BPF listener, bounce a copy of this frame 850 1.2.2.2 yamt * to him. 851 1.2.2.2 yamt */ 852 1.2.2.2 yamt if (ifp->if_bpf) 853 1.2.2.2 yamt bpf_ops->bpf_mtap(ifp->if_bpf, m_head); 854 1.2.2.2 yamt } 855 1.2.2.2 yamt if (pkts == 0) 856 1.2.2.2 yamt return; 857 1.2.2.2 yamt 858 1.2.2.2 yamt /* Transmit at Queue 0 */ 859 1.2.2.2 yamt if (idx != sc->sc_cdata.mvgbe_tx_prod) { 860 1.2.2.2 yamt sc->sc_cdata.mvgbe_tx_prod = idx; 861 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_TQC, MVGBE_TQC_ENQ); 862 1.2.2.2 yamt 863 1.2.2.2 yamt /* 864 1.2.2.2 yamt * Set a timeout in case the chip goes out to lunch. 865 1.2.2.2 yamt */ 866 1.2.2.2 yamt ifp->if_timer = 5; 867 1.2.2.2 yamt } 868 1.2.2.2 yamt } 869 1.2.2.2 yamt 870 1.2.2.2 yamt static int 871 1.2.2.2 yamt mvgbe_ioctl(struct ifnet *ifp, u_long command, void *data) 872 1.2.2.2 yamt { 873 1.2.2.2 yamt struct mvgbe_softc *sc = ifp->if_softc; 874 1.2.2.2 yamt struct ifreq *ifr = data; 875 1.2.2.2 yamt struct mii_data *mii; 876 1.2.2.2 yamt int s, error = 0; 877 1.2.2.2 yamt 878 1.2.2.2 yamt s = splnet(); 879 1.2.2.2 yamt 880 1.2.2.2 yamt switch (command) { 881 1.2.2.2 yamt case SIOCSIFFLAGS: 882 1.2.2.2 yamt DPRINTFN(2, ("mvgbe_ioctl IFFLAGS\n")); 883 1.2.2.2 yamt if (ifp->if_flags & IFF_UP) 884 1.2.2.2 yamt mvgbe_init(ifp); 885 1.2.2.2 yamt else 886 1.2.2.2 yamt if (ifp->if_flags & IFF_RUNNING) 887 1.2.2.2 yamt mvgbe_stop(ifp, 0); 888 1.2.2.2 yamt sc->sc_if_flags = ifp->if_flags; 889 1.2.2.2 yamt error = 0; 890 1.2.2.2 yamt break; 891 1.2.2.2 yamt 892 1.2.2.2 yamt case SIOCGIFMEDIA: 893 1.2.2.2 yamt case SIOCSIFMEDIA: 894 1.2.2.2 yamt DPRINTFN(2, ("mvgbe_ioctl MEDIA\n")); 895 1.2.2.2 yamt mii = &sc->sc_mii; 896 1.2.2.2 yamt error = ifmedia_ioctl(ifp, ifr, &mii->mii_media, command); 897 1.2.2.2 yamt break; 898 1.2.2.2 yamt 899 1.2.2.2 yamt default: 900 1.2.2.2 yamt DPRINTFN(2, ("mvgbe_ioctl ETHER\n")); 901 1.2.2.2 yamt error = ether_ioctl(ifp, command, data); 902 1.2.2.2 yamt if (error == ENETRESET) { 903 1.2.2.2 yamt if (ifp->if_flags & IFF_RUNNING) { 904 1.2.2.2 yamt mvgbe_setmulti(sc); 905 1.2.2.2 yamt DPRINTFN(2, 906 1.2.2.2 yamt ("mvgbe_ioctl setmulti called\n")); 907 1.2.2.2 yamt } 908 1.2.2.2 yamt error = 0; 909 1.2.2.2 yamt } 910 1.2.2.2 yamt break; 911 1.2.2.2 yamt } 912 1.2.2.2 yamt 913 1.2.2.2 yamt splx(s); 914 1.2.2.2 yamt 915 1.2.2.2 yamt return error; 916 1.2.2.2 yamt } 917 1.2.2.2 yamt 918 1.2.2.2 yamt static int 919 1.2.2.2 yamt mvgbe_init(struct ifnet *ifp) 920 1.2.2.2 yamt { 921 1.2.2.2 yamt struct mvgbe_softc *sc = ifp->if_softc; 922 1.2.2.2 yamt struct mii_data *mii = &sc->sc_mii; 923 1.2.2.2 yamt uint32_t reg, val; 924 1.2.2.2 yamt int i, s; 925 1.2.2.2 yamt 926 1.2.2.2 yamt DPRINTFN(2, ("mvgbe_init\n")); 927 1.2.2.2 yamt 928 1.2.2.2 yamt s = splnet(); 929 1.2.2.2 yamt 930 1.2.2.2 yamt if (ifp->if_flags & IFF_RUNNING) { 931 1.2.2.2 yamt splx(s); 932 1.2.2.2 yamt return 0; 933 1.2.2.2 yamt } 934 1.2.2.2 yamt 935 1.2.2.2 yamt /* Cancel pending I/O and free all RX/TX buffers. */ 936 1.2.2.2 yamt mvgbe_stop(ifp, 0); 937 1.2.2.2 yamt 938 1.2.2.2 yamt /* clear all ethernet port interrupts */ 939 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_IC, 0); 940 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_ICE, 0); 941 1.2.2.2 yamt 942 1.2.2.2 yamt /* Init TX/RX descriptors */ 943 1.2.2.2 yamt if (mvgbe_init_tx_ring(sc) == ENOBUFS) { 944 1.2.2.2 yamt aprint_error_ifnet(ifp, 945 1.2.2.2 yamt "initialization failed: no memory for tx buffers\n"); 946 1.2.2.2 yamt splx(s); 947 1.2.2.2 yamt return ENOBUFS; 948 1.2.2.2 yamt } 949 1.2.2.2 yamt if (mvgbe_init_rx_ring(sc) == ENOBUFS) { 950 1.2.2.2 yamt aprint_error_ifnet(ifp, 951 1.2.2.2 yamt "initialization failed: no memory for rx buffers\n"); 952 1.2.2.2 yamt splx(s); 953 1.2.2.2 yamt return ENOBUFS; 954 1.2.2.2 yamt } 955 1.2.2.2 yamt 956 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_PSC, 957 1.2.2.2 yamt MVGBE_PSC_ANFC | /* Enable Auto-Neg Flow Ctrl */ 958 1.2.2.2 yamt MVGBE_PSC_RESERVED | /* Must be set to 1 */ 959 1.2.2.2 yamt MVGBE_PSC_FLFAIL | /* Do NOT Force Link Fail */ 960 1.2.2.2 yamt MVGBE_PSC_MRU(MVGBE_PSC_MRU_9700) | /* Always 9700 OK */ 961 1.2.2.2 yamt MVGBE_PSC_SETFULLDX); /* Set_FullDx */ 962 1.2.2.2 yamt 963 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_CRDP(0), MVGBE_RX_RING_ADDR(sc, 0)); 964 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_TCQDP, MVGBE_TX_RING_ADDR(sc, 0)); 965 1.2.2.2 yamt 966 1.2.2.2 yamt val = 0x3fffffff; 967 1.2.2.2 yamt for (i = 0; i < 8; i++) { 968 1.2.2.2 yamt /* 969 1.2.2.2 yamt * Queue 0 must be programmed to 0x3fffffff. Queue 1 through 7 970 1.2.2.2 yamt * must be programmed to 0x00000000. 971 1.2.2.2 yamt */ 972 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_TQTBCOUNT(i), val); 973 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_TQTBCONFIG(i), val); 974 1.2.2.2 yamt val = 0x00000000; 975 1.2.2.2 yamt } 976 1.2.2.2 yamt 977 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_PXC, MVGBE_PXC_RXCS); 978 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_PXCX, 0); 979 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_SDC, 980 1.2.2.2 yamt MVGBE_SDC_RXBSZ_16_64BITWORDS | 981 1.2.2.2 yamt #if BYTE_ORDER == LITTLE_ENDIAN 982 1.2.2.2 yamt MVGBE_SDC_BLMR | /* Big/Litlle Endian Receive Mode: No swap */ 983 1.2.2.2 yamt MVGBE_SDC_BLMT | /* Big/Litlle Endian Transmit Mode: No swap */ 984 1.2.2.2 yamt #endif 985 1.2.2.2 yamt MVGBE_SDC_TXBSZ_16_64BITWORDS); 986 1.2.2.2 yamt 987 1.2.2.2 yamt mii_mediachg(mii); 988 1.2.2.2 yamt 989 1.2.2.2 yamt /* Enable port */ 990 1.2.2.2 yamt reg = MVGBE_READ(sc, MVGBE_PSC); 991 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_PSC, reg | MVGBE_PSC_PORTEN); 992 1.2.2.2 yamt 993 1.2.2.2 yamt /* If Link is UP, Start RX and TX traffic */ 994 1.2.2.2 yamt if (MVGBE_READ(sc, MVGBE_PS) & MVGBE_PS_LINKUP) { 995 1.2.2.2 yamt /* Enable port RX/TX. */ 996 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_RQC, MVGBE_RQC_ENQ(0)); 997 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_TQC, MVGBE_TQC_ENQ); 998 1.2.2.2 yamt } 999 1.2.2.2 yamt 1000 1.2.2.2 yamt /* Enable interrupt masks */ 1001 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_PIM, 1002 1.2.2.2 yamt MVGBE_IC_RXBUF | 1003 1.2.2.2 yamt MVGBE_IC_EXTEND | 1004 1.2.2.2 yamt MVGBE_IC_RXBUFQ_MASK | 1005 1.2.2.2 yamt MVGBE_IC_RXERROR | 1006 1.2.2.2 yamt MVGBE_IC_RXERRQ_MASK); 1007 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_PEIM, 1008 1.2.2.2 yamt MVGBE_ICE_TXBUF | 1009 1.2.2.2 yamt MVGBE_ICE_TXERR | 1010 1.2.2.2 yamt MVGBE_ICE_LINKCHG); 1011 1.2.2.2 yamt 1012 1.2.2.2 yamt ifp->if_flags |= IFF_RUNNING; 1013 1.2.2.2 yamt ifp->if_flags &= ~IFF_OACTIVE; 1014 1.2.2.2 yamt 1015 1.2.2.2 yamt splx(s); 1016 1.2.2.2 yamt 1017 1.2.2.2 yamt return 0; 1018 1.2.2.2 yamt } 1019 1.2.2.2 yamt 1020 1.2.2.2 yamt /* ARGSUSED */ 1021 1.2.2.2 yamt static void 1022 1.2.2.2 yamt mvgbe_stop(struct ifnet *ifp, int disable) 1023 1.2.2.2 yamt { 1024 1.2.2.2 yamt struct mvgbe_softc *sc = ifp->if_softc; 1025 1.2.2.2 yamt struct mvgbe_chain_data *cdata = &sc->sc_cdata; 1026 1.2.2.2 yamt uint32_t reg; 1027 1.2.2.2 yamt int i, cnt; 1028 1.2.2.2 yamt 1029 1.2.2.2 yamt DPRINTFN(2, ("mvgbe_stop\n")); 1030 1.2.2.2 yamt 1031 1.2.2.2 yamt /* Stop Rx port activity. Check port Rx activity. */ 1032 1.2.2.2 yamt reg = MVGBE_READ(sc, MVGBE_RQC); 1033 1.2.2.2 yamt if (reg & MVGBE_RQC_ENQ_MASK) 1034 1.2.2.2 yamt /* Issue stop command for active channels only */ 1035 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_RQC, MVGBE_RQC_DISQ_DISABLE(reg)); 1036 1.2.2.2 yamt 1037 1.2.2.2 yamt /* Stop Tx port activity. Check port Tx activity. */ 1038 1.2.2.2 yamt if (MVGBE_READ(sc, MVGBE_TQC) & MVGBE_TQC_ENQ) 1039 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_TQC, MVGBE_TQC_DISQ); 1040 1.2.2.2 yamt 1041 1.2.2.2 yamt /* Force link down */ 1042 1.2.2.2 yamt reg = MVGBE_READ(sc, MVGBE_PSC); 1043 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_PSC, reg & ~MVGBE_PSC_FLFAIL); 1044 1.2.2.2 yamt 1045 1.2.2.2 yamt #define RX_DISABLE_TIMEOUT 0x1000000 1046 1.2.2.2 yamt #define TX_FIFO_EMPTY_TIMEOUT 0x1000000 1047 1.2.2.2 yamt /* Wait for all Rx activity to terminate. */ 1048 1.2.2.2 yamt cnt = 0; 1049 1.2.2.2 yamt do { 1050 1.2.2.2 yamt if (cnt >= RX_DISABLE_TIMEOUT) { 1051 1.2.2.2 yamt aprint_error_ifnet(ifp, 1052 1.2.2.2 yamt "timeout for RX stopped. rqc 0x%x\n", reg); 1053 1.2.2.2 yamt break; 1054 1.2.2.2 yamt } 1055 1.2.2.2 yamt cnt++; 1056 1.2.2.2 yamt 1057 1.2.2.2 yamt /* 1058 1.2.2.2 yamt * Check Receive Queue Command register that all Rx queues 1059 1.2.2.2 yamt * are stopped 1060 1.2.2.2 yamt */ 1061 1.2.2.2 yamt reg = MVGBE_READ(sc, MVGBE_RQC); 1062 1.2.2.2 yamt } while (reg & 0xff); 1063 1.2.2.2 yamt 1064 1.2.2.2 yamt /* Double check to verify that TX FIFO is empty */ 1065 1.2.2.2 yamt cnt = 0; 1066 1.2.2.2 yamt while (1) { 1067 1.2.2.2 yamt do { 1068 1.2.2.2 yamt if (cnt >= TX_FIFO_EMPTY_TIMEOUT) { 1069 1.2.2.2 yamt aprint_error_ifnet(ifp, 1070 1.2.2.2 yamt "timeout for TX FIFO empty. status 0x%x\n", 1071 1.2.2.2 yamt reg); 1072 1.2.2.2 yamt break; 1073 1.2.2.2 yamt } 1074 1.2.2.2 yamt cnt++; 1075 1.2.2.2 yamt 1076 1.2.2.2 yamt reg = MVGBE_READ(sc, MVGBE_PS); 1077 1.2.2.2 yamt } while 1078 1.2.2.2 yamt (!(reg & MVGBE_PS_TXFIFOEMP) || reg & MVGBE_PS_TXINPROG); 1079 1.2.2.2 yamt 1080 1.2.2.2 yamt if (cnt >= TX_FIFO_EMPTY_TIMEOUT) 1081 1.2.2.2 yamt break; 1082 1.2.2.2 yamt 1083 1.2.2.2 yamt /* Double check */ 1084 1.2.2.2 yamt reg = MVGBE_READ(sc, MVGBE_PS); 1085 1.2.2.2 yamt if (reg & MVGBE_PS_TXFIFOEMP && !(reg & MVGBE_PS_TXINPROG)) 1086 1.2.2.2 yamt break; 1087 1.2.2.2 yamt else 1088 1.2.2.2 yamt aprint_error_ifnet(ifp, 1089 1.2.2.2 yamt "TX FIFO empty double check failed." 1090 1.2.2.2 yamt " %d loops, status 0x%x\n", cnt, reg); 1091 1.2.2.2 yamt } 1092 1.2.2.2 yamt 1093 1.2.2.2 yamt /* Reset the Enable bit in the Port Serial Control Register */ 1094 1.2.2.2 yamt reg = MVGBE_READ(sc, MVGBE_PSC); 1095 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_PSC, reg & ~MVGBE_PSC_PORTEN); 1096 1.2.2.2 yamt 1097 1.2.2.2 yamt /* Disable interrupts */ 1098 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_PIM, 0); 1099 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_PEIM, 0); 1100 1.2.2.2 yamt 1101 1.2.2.2 yamt /* Free RX and TX mbufs still in the queues. */ 1102 1.2.2.2 yamt for (i = 0; i < MVGBE_RX_RING_CNT; i++) { 1103 1.2.2.2 yamt if (cdata->mvgbe_rx_chain[i].mvgbe_mbuf != NULL) { 1104 1.2.2.2 yamt m_freem(cdata->mvgbe_rx_chain[i].mvgbe_mbuf); 1105 1.2.2.2 yamt cdata->mvgbe_rx_chain[i].mvgbe_mbuf = NULL; 1106 1.2.2.2 yamt } 1107 1.2.2.2 yamt } 1108 1.2.2.2 yamt for (i = 0; i < MVGBE_TX_RING_CNT; i++) { 1109 1.2.2.2 yamt if (cdata->mvgbe_tx_chain[i].mvgbe_mbuf != NULL) { 1110 1.2.2.2 yamt m_freem(cdata->mvgbe_tx_chain[i].mvgbe_mbuf); 1111 1.2.2.2 yamt cdata->mvgbe_tx_chain[i].mvgbe_mbuf = NULL; 1112 1.2.2.2 yamt } 1113 1.2.2.2 yamt } 1114 1.2.2.2 yamt 1115 1.2.2.2 yamt ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE); 1116 1.2.2.2 yamt } 1117 1.2.2.2 yamt 1118 1.2.2.2 yamt static void 1119 1.2.2.2 yamt mvgbe_watchdog(struct ifnet *ifp) 1120 1.2.2.2 yamt { 1121 1.2.2.2 yamt struct mvgbe_softc *sc = ifp->if_softc; 1122 1.2.2.2 yamt 1123 1.2.2.2 yamt /* 1124 1.2.2.2 yamt * Reclaim first as there is a possibility of losing Tx completion 1125 1.2.2.2 yamt * interrupts. 1126 1.2.2.2 yamt */ 1127 1.2.2.2 yamt mvgbe_txeof(sc); 1128 1.2.2.2 yamt if (sc->sc_cdata.mvgbe_tx_cnt != 0) { 1129 1.2.2.2 yamt aprint_error_ifnet(ifp, "watchdog timeout\n"); 1130 1.2.2.2 yamt 1131 1.2.2.2 yamt ifp->if_oerrors++; 1132 1.2.2.2 yamt 1133 1.2.2.2 yamt mvgbe_init(ifp); 1134 1.2.2.2 yamt } 1135 1.2.2.2 yamt } 1136 1.2.2.2 yamt 1137 1.2.2.2 yamt 1138 1.2.2.2 yamt /* 1139 1.2.2.2 yamt * Set media options. 1140 1.2.2.2 yamt */ 1141 1.2.2.2 yamt static int 1142 1.2.2.2 yamt mvgbe_ifmedia_upd(struct ifnet *ifp) 1143 1.2.2.2 yamt { 1144 1.2.2.2 yamt struct mvgbe_softc *sc = ifp->if_softc; 1145 1.2.2.2 yamt 1146 1.2.2.2 yamt mii_mediachg(&sc->sc_mii); 1147 1.2.2.2 yamt return 0; 1148 1.2.2.2 yamt } 1149 1.2.2.2 yamt 1150 1.2.2.2 yamt /* 1151 1.2.2.2 yamt * Report current media status. 1152 1.2.2.2 yamt */ 1153 1.2.2.2 yamt static void 1154 1.2.2.2 yamt mvgbe_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr) 1155 1.2.2.2 yamt { 1156 1.2.2.2 yamt struct mvgbe_softc *sc = ifp->if_softc; 1157 1.2.2.2 yamt 1158 1.2.2.2 yamt mii_pollstat(&sc->sc_mii); 1159 1.2.2.2 yamt ifmr->ifm_active = sc->sc_mii.mii_media_active; 1160 1.2.2.2 yamt ifmr->ifm_status = sc->sc_mii.mii_media_status; 1161 1.2.2.2 yamt } 1162 1.2.2.2 yamt 1163 1.2.2.2 yamt 1164 1.2.2.2 yamt static int 1165 1.2.2.2 yamt mvgbe_init_rx_ring(struct mvgbe_softc *sc) 1166 1.2.2.2 yamt { 1167 1.2.2.2 yamt struct mvgbe_chain_data *cd = &sc->sc_cdata; 1168 1.2.2.2 yamt struct mvgbe_ring_data *rd = sc->sc_rdata; 1169 1.2.2.2 yamt int i; 1170 1.2.2.2 yamt 1171 1.2.2.2 yamt bzero((char *)rd->mvgbe_rx_ring, 1172 1.2.2.2 yamt sizeof(struct mvgbe_rx_desc) * MVGBE_RX_RING_CNT); 1173 1.2.2.2 yamt 1174 1.2.2.2 yamt for (i = 0; i < MVGBE_RX_RING_CNT; i++) { 1175 1.2.2.2 yamt cd->mvgbe_rx_chain[i].mvgbe_desc = 1176 1.2.2.2 yamt &rd->mvgbe_rx_ring[i]; 1177 1.2.2.2 yamt if (i == MVGBE_RX_RING_CNT - 1) { 1178 1.2.2.2 yamt cd->mvgbe_rx_chain[i].mvgbe_next = 1179 1.2.2.2 yamt &cd->mvgbe_rx_chain[0]; 1180 1.2.2.2 yamt rd->mvgbe_rx_ring[i].nextdescptr = 1181 1.2.2.2 yamt MVGBE_RX_RING_ADDR(sc, 0); 1182 1.2.2.2 yamt } else { 1183 1.2.2.2 yamt cd->mvgbe_rx_chain[i].mvgbe_next = 1184 1.2.2.2 yamt &cd->mvgbe_rx_chain[i + 1]; 1185 1.2.2.2 yamt rd->mvgbe_rx_ring[i].nextdescptr = 1186 1.2.2.2 yamt MVGBE_RX_RING_ADDR(sc, i + 1); 1187 1.2.2.2 yamt } 1188 1.2.2.2 yamt } 1189 1.2.2.2 yamt 1190 1.2.2.2 yamt for (i = 0; i < MVGBE_RX_RING_CNT; i++) { 1191 1.2.2.2 yamt if (mvgbe_newbuf(sc, i, NULL, 1192 1.2.2.2 yamt sc->sc_cdata.mvgbe_rx_jumbo_map) == ENOBUFS) { 1193 1.2.2.2 yamt aprint_error_ifnet(&sc->sc_ethercom.ec_if, 1194 1.2.2.2 yamt "failed alloc of %dth mbuf\n", i); 1195 1.2.2.2 yamt return ENOBUFS; 1196 1.2.2.2 yamt } 1197 1.2.2.2 yamt } 1198 1.2.2.2 yamt sc->sc_cdata.mvgbe_rx_prod = 0; 1199 1.2.2.2 yamt sc->sc_cdata.mvgbe_rx_cons = 0; 1200 1.2.2.2 yamt 1201 1.2.2.2 yamt return 0; 1202 1.2.2.2 yamt } 1203 1.2.2.2 yamt 1204 1.2.2.2 yamt static int 1205 1.2.2.2 yamt mvgbe_init_tx_ring(struct mvgbe_softc *sc) 1206 1.2.2.2 yamt { 1207 1.2.2.2 yamt struct mvgbe_chain_data *cd = &sc->sc_cdata; 1208 1.2.2.2 yamt struct mvgbe_ring_data *rd = sc->sc_rdata; 1209 1.2.2.2 yamt int i; 1210 1.2.2.2 yamt 1211 1.2.2.2 yamt bzero((char *)sc->sc_rdata->mvgbe_tx_ring, 1212 1.2.2.2 yamt sizeof(struct mvgbe_tx_desc) * MVGBE_TX_RING_CNT); 1213 1.2.2.2 yamt 1214 1.2.2.2 yamt for (i = 0; i < MVGBE_TX_RING_CNT; i++) { 1215 1.2.2.2 yamt cd->mvgbe_tx_chain[i].mvgbe_desc = 1216 1.2.2.2 yamt &rd->mvgbe_tx_ring[i]; 1217 1.2.2.2 yamt if (i == MVGBE_TX_RING_CNT - 1) { 1218 1.2.2.2 yamt cd->mvgbe_tx_chain[i].mvgbe_next = 1219 1.2.2.2 yamt &cd->mvgbe_tx_chain[0]; 1220 1.2.2.2 yamt rd->mvgbe_tx_ring[i].nextdescptr = 1221 1.2.2.2 yamt MVGBE_TX_RING_ADDR(sc, 0); 1222 1.2.2.2 yamt } else { 1223 1.2.2.2 yamt cd->mvgbe_tx_chain[i].mvgbe_next = 1224 1.2.2.2 yamt &cd->mvgbe_tx_chain[i + 1]; 1225 1.2.2.2 yamt rd->mvgbe_tx_ring[i].nextdescptr = 1226 1.2.2.2 yamt MVGBE_TX_RING_ADDR(sc, i + 1); 1227 1.2.2.2 yamt } 1228 1.2.2.2 yamt rd->mvgbe_tx_ring[i].cmdsts = MVGBE_BUFFER_OWNED_BY_HOST; 1229 1.2.2.2 yamt } 1230 1.2.2.2 yamt 1231 1.2.2.2 yamt sc->sc_cdata.mvgbe_tx_prod = 0; 1232 1.2.2.2 yamt sc->sc_cdata.mvgbe_tx_cons = 0; 1233 1.2.2.2 yamt sc->sc_cdata.mvgbe_tx_cnt = 0; 1234 1.2.2.2 yamt 1235 1.2.2.2 yamt MVGBE_CDTXSYNC(sc, 0, MVGBE_TX_RING_CNT, 1236 1.2.2.2 yamt BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 1237 1.2.2.2 yamt 1238 1.2.2.2 yamt return 0; 1239 1.2.2.2 yamt } 1240 1.2.2.2 yamt 1241 1.2.2.2 yamt static int 1242 1.2.2.2 yamt mvgbe_newbuf(struct mvgbe_softc *sc, int i, struct mbuf *m, 1243 1.2.2.2 yamt bus_dmamap_t dmamap) 1244 1.2.2.2 yamt { 1245 1.2.2.2 yamt struct mbuf *m_new = NULL; 1246 1.2.2.2 yamt struct mvgbe_chain *c; 1247 1.2.2.2 yamt struct mvgbe_rx_desc *r; 1248 1.2.2.2 yamt int align; 1249 1.2.2.2 yamt 1250 1.2.2.2 yamt if (m == NULL) { 1251 1.2.2.2 yamt void *buf = NULL; 1252 1.2.2.2 yamt 1253 1.2.2.2 yamt MGETHDR(m_new, M_DONTWAIT, MT_DATA); 1254 1.2.2.2 yamt if (m_new == NULL) { 1255 1.2.2.2 yamt aprint_error_ifnet(&sc->sc_ethercom.ec_if, 1256 1.2.2.2 yamt "no memory for rx list -- packet dropped!\n"); 1257 1.2.2.2 yamt return ENOBUFS; 1258 1.2.2.2 yamt } 1259 1.2.2.2 yamt 1260 1.2.2.2 yamt /* Allocate the jumbo buffer */ 1261 1.2.2.2 yamt buf = mvgbe_jalloc(sc); 1262 1.2.2.2 yamt if (buf == NULL) { 1263 1.2.2.2 yamt m_freem(m_new); 1264 1.2.2.2 yamt DPRINTFN(1, ("%s jumbo allocation failed -- packet " 1265 1.2.2.2 yamt "dropped!\n", sc->sc_ethercom.ec_if.if_xname)); 1266 1.2.2.2 yamt return ENOBUFS; 1267 1.2.2.2 yamt } 1268 1.2.2.2 yamt 1269 1.2.2.2 yamt /* Attach the buffer to the mbuf */ 1270 1.2.2.2 yamt m_new->m_len = m_new->m_pkthdr.len = MVGBE_JLEN; 1271 1.2.2.2 yamt MEXTADD(m_new, buf, MVGBE_JLEN, 0, mvgbe_jfree, sc); 1272 1.2.2.2 yamt } else { 1273 1.2.2.2 yamt /* 1274 1.2.2.2 yamt * We're re-using a previously allocated mbuf; 1275 1.2.2.2 yamt * be sure to re-init pointers and lengths to 1276 1.2.2.2 yamt * default values. 1277 1.2.2.2 yamt */ 1278 1.2.2.2 yamt m_new = m; 1279 1.2.2.2 yamt m_new->m_len = m_new->m_pkthdr.len = MVGBE_JLEN; 1280 1.2.2.2 yamt m_new->m_data = m_new->m_ext.ext_buf; 1281 1.2.2.2 yamt } 1282 1.2.2.2 yamt align = (u_long)m_new->m_data & MVGBE_BUF_MASK; 1283 1.2.2.2 yamt if (align != 0) 1284 1.2.2.2 yamt m_adj(m_new, MVGBE_BUF_ALIGN - align); 1285 1.2.2.2 yamt 1286 1.2.2.2 yamt c = &sc->sc_cdata.mvgbe_rx_chain[i]; 1287 1.2.2.2 yamt r = c->mvgbe_desc; 1288 1.2.2.2 yamt c->mvgbe_mbuf = m_new; 1289 1.2.2.2 yamt r->bufptr = dmamap->dm_segs[0].ds_addr + 1290 1.2.2.2 yamt (((vaddr_t)m_new->m_data - (vaddr_t)sc->sc_cdata.mvgbe_jumbo_buf)); 1291 1.2.2.2 yamt r->bufsize = MVGBE_JLEN & ~MVGBE_BUF_MASK; 1292 1.2.2.2 yamt r->cmdsts = MVGBE_BUFFER_OWNED_BY_DMA | MVGBE_RX_ENABLE_INTERRUPT; 1293 1.2.2.2 yamt 1294 1.2.2.2 yamt MVGBE_CDRXSYNC(sc, i, BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD); 1295 1.2.2.2 yamt 1296 1.2.2.2 yamt return 0; 1297 1.2.2.2 yamt } 1298 1.2.2.2 yamt 1299 1.2.2.2 yamt /* 1300 1.2.2.2 yamt * Memory management for jumbo frames. 1301 1.2.2.2 yamt */ 1302 1.2.2.2 yamt 1303 1.2.2.2 yamt static int 1304 1.2.2.2 yamt mvgbe_alloc_jumbo_mem(struct mvgbe_softc *sc) 1305 1.2.2.2 yamt { 1306 1.2.2.2 yamt char *ptr, *kva; 1307 1.2.2.2 yamt bus_dma_segment_t seg; 1308 1.2.2.2 yamt int i, rseg, state, error; 1309 1.2.2.2 yamt struct mvgbe_jpool_entry *entry; 1310 1.2.2.2 yamt 1311 1.2.2.2 yamt state = error = 0; 1312 1.2.2.2 yamt 1313 1.2.2.2 yamt /* Grab a big chunk o' storage. */ 1314 1.2.2.2 yamt if (bus_dmamem_alloc(sc->sc_dmat, MVGBE_JMEM, PAGE_SIZE, 0, 1315 1.2.2.2 yamt &seg, 1, &rseg, BUS_DMA_NOWAIT)) { 1316 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "can't alloc rx buffers\n"); 1317 1.2.2.2 yamt return ENOBUFS; 1318 1.2.2.2 yamt } 1319 1.2.2.2 yamt 1320 1.2.2.2 yamt state = 1; 1321 1.2.2.2 yamt if (bus_dmamem_map(sc->sc_dmat, &seg, rseg, MVGBE_JMEM, 1322 1.2.2.2 yamt (void **)&kva, BUS_DMA_NOWAIT)) { 1323 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 1324 1.2.2.2 yamt "can't map dma buffers (%d bytes)\n", MVGBE_JMEM); 1325 1.2.2.2 yamt error = ENOBUFS; 1326 1.2.2.2 yamt goto out; 1327 1.2.2.2 yamt } 1328 1.2.2.2 yamt 1329 1.2.2.2 yamt state = 2; 1330 1.2.2.2 yamt if (bus_dmamap_create(sc->sc_dmat, MVGBE_JMEM, 1, MVGBE_JMEM, 0, 1331 1.2.2.2 yamt BUS_DMA_NOWAIT, &sc->sc_cdata.mvgbe_rx_jumbo_map)) { 1332 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "can't create dma map\n"); 1333 1.2.2.2 yamt error = ENOBUFS; 1334 1.2.2.2 yamt goto out; 1335 1.2.2.2 yamt } 1336 1.2.2.2 yamt 1337 1.2.2.2 yamt state = 3; 1338 1.2.2.2 yamt if (bus_dmamap_load(sc->sc_dmat, sc->sc_cdata.mvgbe_rx_jumbo_map, 1339 1.2.2.2 yamt kva, MVGBE_JMEM, NULL, BUS_DMA_NOWAIT)) { 1340 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "can't load dma map\n"); 1341 1.2.2.2 yamt error = ENOBUFS; 1342 1.2.2.2 yamt goto out; 1343 1.2.2.2 yamt } 1344 1.2.2.2 yamt 1345 1.2.2.2 yamt state = 4; 1346 1.2.2.2 yamt sc->sc_cdata.mvgbe_jumbo_buf = (void *)kva; 1347 1.2.2.2 yamt DPRINTFN(1,("mvgbe_jumbo_buf = 0x%p\n", sc->sc_cdata.mvgbe_jumbo_buf)); 1348 1.2.2.2 yamt 1349 1.2.2.2 yamt LIST_INIT(&sc->sc_jfree_listhead); 1350 1.2.2.2 yamt LIST_INIT(&sc->sc_jinuse_listhead); 1351 1.2.2.2 yamt 1352 1.2.2.2 yamt /* 1353 1.2.2.2 yamt * Now divide it up into 9K pieces and save the addresses 1354 1.2.2.2 yamt * in an array. 1355 1.2.2.2 yamt */ 1356 1.2.2.2 yamt ptr = sc->sc_cdata.mvgbe_jumbo_buf; 1357 1.2.2.2 yamt for (i = 0; i < MVGBE_JSLOTS; i++) { 1358 1.2.2.2 yamt sc->sc_cdata.mvgbe_jslots[i] = ptr; 1359 1.2.2.2 yamt ptr += MVGBE_JLEN; 1360 1.2.2.2 yamt entry = kmem_alloc(sizeof(struct mvgbe_jpool_entry), KM_SLEEP); 1361 1.2.2.2 yamt if (entry == NULL) { 1362 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 1363 1.2.2.2 yamt "no memory for jumbo buffer queue!\n"); 1364 1.2.2.2 yamt error = ENOBUFS; 1365 1.2.2.2 yamt goto out; 1366 1.2.2.2 yamt } 1367 1.2.2.2 yamt entry->slot = i; 1368 1.2.2.2 yamt if (i) 1369 1.2.2.2 yamt LIST_INSERT_HEAD(&sc->sc_jfree_listhead, entry, 1370 1.2.2.2 yamt jpool_entries); 1371 1.2.2.2 yamt else 1372 1.2.2.2 yamt LIST_INSERT_HEAD(&sc->sc_jinuse_listhead, entry, 1373 1.2.2.2 yamt jpool_entries); 1374 1.2.2.2 yamt } 1375 1.2.2.2 yamt out: 1376 1.2.2.2 yamt if (error != 0) { 1377 1.2.2.2 yamt switch (state) { 1378 1.2.2.2 yamt case 4: 1379 1.2.2.2 yamt bus_dmamap_unload(sc->sc_dmat, 1380 1.2.2.2 yamt sc->sc_cdata.mvgbe_rx_jumbo_map); 1381 1.2.2.2 yamt case 3: 1382 1.2.2.2 yamt bus_dmamap_destroy(sc->sc_dmat, 1383 1.2.2.2 yamt sc->sc_cdata.mvgbe_rx_jumbo_map); 1384 1.2.2.2 yamt case 2: 1385 1.2.2.2 yamt bus_dmamem_unmap(sc->sc_dmat, kva, MVGBE_JMEM); 1386 1.2.2.2 yamt case 1: 1387 1.2.2.2 yamt bus_dmamem_free(sc->sc_dmat, &seg, rseg); 1388 1.2.2.2 yamt break; 1389 1.2.2.2 yamt default: 1390 1.2.2.2 yamt break; 1391 1.2.2.2 yamt } 1392 1.2.2.2 yamt } 1393 1.2.2.2 yamt 1394 1.2.2.2 yamt return error; 1395 1.2.2.2 yamt } 1396 1.2.2.2 yamt 1397 1.2.2.2 yamt /* 1398 1.2.2.2 yamt * Allocate a jumbo buffer. 1399 1.2.2.2 yamt */ 1400 1.2.2.2 yamt static void * 1401 1.2.2.2 yamt mvgbe_jalloc(struct mvgbe_softc *sc) 1402 1.2.2.2 yamt { 1403 1.2.2.2 yamt struct mvgbe_jpool_entry *entry; 1404 1.2.2.2 yamt 1405 1.2.2.2 yamt entry = LIST_FIRST(&sc->sc_jfree_listhead); 1406 1.2.2.2 yamt 1407 1.2.2.2 yamt if (entry == NULL) 1408 1.2.2.2 yamt return NULL; 1409 1.2.2.2 yamt 1410 1.2.2.2 yamt LIST_REMOVE(entry, jpool_entries); 1411 1.2.2.2 yamt LIST_INSERT_HEAD(&sc->sc_jinuse_listhead, entry, jpool_entries); 1412 1.2.2.2 yamt return sc->sc_cdata.mvgbe_jslots[entry->slot]; 1413 1.2.2.2 yamt } 1414 1.2.2.2 yamt 1415 1.2.2.2 yamt /* 1416 1.2.2.2 yamt * Release a jumbo buffer. 1417 1.2.2.2 yamt */ 1418 1.2.2.2 yamt static void 1419 1.2.2.2 yamt mvgbe_jfree(struct mbuf *m, void *buf, size_t size, void *arg) 1420 1.2.2.2 yamt { 1421 1.2.2.2 yamt struct mvgbe_jpool_entry *entry; 1422 1.2.2.2 yamt struct mvgbe_softc *sc; 1423 1.2.2.2 yamt int i, s; 1424 1.2.2.2 yamt 1425 1.2.2.2 yamt /* Extract the softc struct pointer. */ 1426 1.2.2.2 yamt sc = (struct mvgbe_softc *)arg; 1427 1.2.2.2 yamt 1428 1.2.2.2 yamt if (sc == NULL) 1429 1.2.2.2 yamt panic("%s: can't find softc pointer!", __func__); 1430 1.2.2.2 yamt 1431 1.2.2.2 yamt /* calculate the slot this buffer belongs to */ 1432 1.2.2.2 yamt 1433 1.2.2.2 yamt i = ((vaddr_t)buf - (vaddr_t)sc->sc_cdata.mvgbe_jumbo_buf) / MVGBE_JLEN; 1434 1.2.2.2 yamt 1435 1.2.2.2 yamt if ((i < 0) || (i >= MVGBE_JSLOTS)) 1436 1.2.2.2 yamt panic("%s: asked to free buffer that we don't manage!", 1437 1.2.2.2 yamt __func__); 1438 1.2.2.2 yamt 1439 1.2.2.2 yamt s = splvm(); 1440 1.2.2.2 yamt entry = LIST_FIRST(&sc->sc_jinuse_listhead); 1441 1.2.2.2 yamt if (entry == NULL) 1442 1.2.2.2 yamt panic("%s: buffer not in use!", __func__); 1443 1.2.2.2 yamt entry->slot = i; 1444 1.2.2.2 yamt LIST_REMOVE(entry, jpool_entries); 1445 1.2.2.2 yamt LIST_INSERT_HEAD(&sc->sc_jfree_listhead, entry, jpool_entries); 1446 1.2.2.2 yamt 1447 1.2.2.2 yamt if (__predict_true(m != NULL)) 1448 1.2.2.2 yamt pool_cache_put(mb_cache, m); 1449 1.2.2.2 yamt splx(s); 1450 1.2.2.2 yamt } 1451 1.2.2.2 yamt 1452 1.2.2.2 yamt static int 1453 1.2.2.2 yamt mvgbe_encap(struct mvgbe_softc *sc, struct mbuf *m_head, 1454 1.2.2.2 yamt uint32_t *txidx) 1455 1.2.2.2 yamt { 1456 1.2.2.2 yamt struct mvgbe_tx_desc *f = NULL; 1457 1.2.2.2 yamt struct mvgbe_txmap_entry *entry; 1458 1.2.2.2 yamt bus_dma_segment_t *txseg; 1459 1.2.2.2 yamt bus_dmamap_t txmap; 1460 1.2.2.2 yamt uint32_t first, current, last, cmdsts = 0; 1461 1.2.2.2 yamt int m_csumflags, i; 1462 1.2.2.2 yamt 1463 1.2.2.2 yamt DPRINTFN(3, ("mvgbe_encap\n")); 1464 1.2.2.2 yamt 1465 1.2.2.2 yamt entry = SIMPLEQ_FIRST(&sc->sc_txmap_head); 1466 1.2.2.2 yamt if (entry == NULL) { 1467 1.2.2.2 yamt DPRINTFN(2, ("mvgbe_encap: no txmap available\n")); 1468 1.2.2.2 yamt return ENOBUFS; 1469 1.2.2.2 yamt } 1470 1.2.2.2 yamt txmap = entry->dmamap; 1471 1.2.2.2 yamt 1472 1.2.2.2 yamt first = current = last = *txidx; 1473 1.2.2.2 yamt 1474 1.2.2.2 yamt /* 1475 1.2.2.2 yamt * Preserve m_pkthdr.csum_flags here since m_head might be 1476 1.2.2.2 yamt * updated by m_defrag() 1477 1.2.2.2 yamt */ 1478 1.2.2.2 yamt m_csumflags = m_head->m_pkthdr.csum_flags; 1479 1.2.2.2 yamt 1480 1.2.2.2 yamt /* 1481 1.2.2.2 yamt * Start packing the mbufs in this chain into 1482 1.2.2.2 yamt * the fragment pointers. Stop when we run out 1483 1.2.2.2 yamt * of fragments or hit the end of the mbuf chain. 1484 1.2.2.2 yamt */ 1485 1.2.2.2 yamt if (bus_dmamap_load_mbuf(sc->sc_dmat, txmap, m_head, BUS_DMA_NOWAIT)) { 1486 1.2.2.2 yamt DPRINTFN(1, ("mvgbe_encap: dmamap failed\n")); 1487 1.2.2.2 yamt return ENOBUFS; 1488 1.2.2.2 yamt } 1489 1.2.2.2 yamt 1490 1.2.2.2 yamt /* Sync the DMA map. */ 1491 1.2.2.2 yamt bus_dmamap_sync(sc->sc_dmat, txmap, 0, txmap->dm_mapsize, 1492 1.2.2.2 yamt BUS_DMASYNC_PREWRITE); 1493 1.2.2.2 yamt 1494 1.2.2.2 yamt if (sc->sc_cdata.mvgbe_tx_cnt + txmap->dm_nsegs >= 1495 1.2.2.2 yamt MVGBE_TX_RING_CNT) { 1496 1.2.2.2 yamt DPRINTFN(2, ("mvgbe_encap: too few descriptors free\n")); 1497 1.2.2.2 yamt bus_dmamap_unload(sc->sc_dmat, txmap); 1498 1.2.2.2 yamt return ENOBUFS; 1499 1.2.2.2 yamt } 1500 1.2.2.2 yamt 1501 1.2.2.2 yamt txseg = txmap->dm_segs; 1502 1.2.2.2 yamt 1503 1.2.2.2 yamt DPRINTFN(2, ("mvgbe_encap: dm_nsegs=%d\n", txmap->dm_nsegs)); 1504 1.2.2.2 yamt 1505 1.2.2.2 yamt for (i = 0; i < txmap->dm_nsegs; i++) { 1506 1.2.2.2 yamt f = &sc->sc_rdata->mvgbe_tx_ring[current]; 1507 1.2.2.2 yamt f->bufptr = txseg[i].ds_addr; 1508 1.2.2.2 yamt f->bytecnt = txseg[i].ds_len; 1509 1.2.2.2 yamt f->cmdsts = MVGBE_BUFFER_OWNED_BY_DMA; 1510 1.2.2.2 yamt last = current; 1511 1.2.2.2 yamt current = (current + 1) % MVGBE_TX_RING_CNT; 1512 1.2.2.2 yamt } 1513 1.2.2.2 yamt 1514 1.2.2.2 yamt if (m_csumflags & M_CSUM_IPv4) 1515 1.2.2.2 yamt cmdsts |= MVGBE_TX_GENERATE_IP_CHKSUM; 1516 1.2.2.2 yamt if (m_csumflags & M_CSUM_TCPv4) 1517 1.2.2.2 yamt cmdsts |= 1518 1.2.2.2 yamt MVGBE_TX_GENERATE_L4_CHKSUM | MVGBE_TX_L4_TYPE_TCP; 1519 1.2.2.2 yamt if (m_csumflags & M_CSUM_UDPv4) 1520 1.2.2.2 yamt cmdsts |= 1521 1.2.2.2 yamt MVGBE_TX_GENERATE_L4_CHKSUM | MVGBE_TX_L4_TYPE_UDP; 1522 1.2.2.2 yamt if (m_csumflags & (M_CSUM_IPv4 | M_CSUM_TCPv4 | M_CSUM_UDPv4)) { 1523 1.2.2.2 yamt const int iphdr_unitlen = sizeof(struct ip) / sizeof(uint32_t); 1524 1.2.2.2 yamt 1525 1.2.2.2 yamt cmdsts |= MVGBE_TX_IP_NO_FRAG | 1526 1.2.2.2 yamt MVGBE_TX_IP_HEADER_LEN(iphdr_unitlen); /* unit is 4B */ 1527 1.2.2.2 yamt } 1528 1.2.2.2 yamt if (txmap->dm_nsegs == 1) 1529 1.2.2.2 yamt f->cmdsts = cmdsts | 1530 1.2.2.2 yamt MVGBE_BUFFER_OWNED_BY_DMA | 1531 1.2.2.2 yamt MVGBE_TX_GENERATE_CRC | 1532 1.2.2.2 yamt MVGBE_TX_ENABLE_INTERRUPT | 1533 1.2.2.2 yamt MVGBE_TX_ZERO_PADDING | 1534 1.2.2.2 yamt MVGBE_TX_FIRST_DESC | 1535 1.2.2.2 yamt MVGBE_TX_LAST_DESC; 1536 1.2.2.2 yamt else { 1537 1.2.2.2 yamt f = &sc->sc_rdata->mvgbe_tx_ring[first]; 1538 1.2.2.2 yamt f->cmdsts = cmdsts | 1539 1.2.2.2 yamt MVGBE_BUFFER_OWNED_BY_DMA | 1540 1.2.2.2 yamt MVGBE_TX_GENERATE_CRC | 1541 1.2.2.2 yamt MVGBE_TX_FIRST_DESC; 1542 1.2.2.2 yamt 1543 1.2.2.2 yamt f = &sc->sc_rdata->mvgbe_tx_ring[last]; 1544 1.2.2.2 yamt f->cmdsts = 1545 1.2.2.2 yamt MVGBE_BUFFER_OWNED_BY_DMA | 1546 1.2.2.2 yamt MVGBE_TX_ENABLE_INTERRUPT | 1547 1.2.2.2 yamt MVGBE_TX_ZERO_PADDING | 1548 1.2.2.2 yamt MVGBE_TX_LAST_DESC; 1549 1.2.2.2 yamt } 1550 1.2.2.2 yamt 1551 1.2.2.2 yamt sc->sc_cdata.mvgbe_tx_chain[last].mvgbe_mbuf = m_head; 1552 1.2.2.2 yamt SIMPLEQ_REMOVE_HEAD(&sc->sc_txmap_head, link); 1553 1.2.2.2 yamt sc->sc_cdata.mvgbe_tx_map[last] = entry; 1554 1.2.2.2 yamt 1555 1.2.2.2 yamt /* Sync descriptors before handing to chip */ 1556 1.2.2.2 yamt MVGBE_CDTXSYNC(sc, *txidx, txmap->dm_nsegs, 1557 1.2.2.2 yamt BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE); 1558 1.2.2.2 yamt 1559 1.2.2.2 yamt sc->sc_cdata.mvgbe_tx_cnt += i; 1560 1.2.2.2 yamt *txidx = current; 1561 1.2.2.2 yamt 1562 1.2.2.2 yamt DPRINTFN(3, ("mvgbe_encap: completed successfully\n")); 1563 1.2.2.2 yamt 1564 1.2.2.2 yamt return 0; 1565 1.2.2.2 yamt } 1566 1.2.2.2 yamt 1567 1.2.2.2 yamt static void 1568 1.2.2.2 yamt mvgbe_rxeof(struct mvgbe_softc *sc) 1569 1.2.2.2 yamt { 1570 1.2.2.2 yamt struct mvgbe_chain_data *cdata = &sc->sc_cdata; 1571 1.2.2.2 yamt struct mvgbe_rx_desc *cur_rx; 1572 1.2.2.2 yamt struct ifnet *ifp = &sc->sc_ethercom.ec_if; 1573 1.2.2.2 yamt struct mbuf *m; 1574 1.2.2.2 yamt bus_dmamap_t dmamap; 1575 1.2.2.2 yamt uint32_t rxstat; 1576 1.2.2.2 yamt int idx, cur, total_len; 1577 1.2.2.2 yamt 1578 1.2.2.2 yamt idx = sc->sc_cdata.mvgbe_rx_prod; 1579 1.2.2.2 yamt 1580 1.2.2.2 yamt DPRINTFN(3, ("mvgbe_rxeof %d\n", idx)); 1581 1.2.2.2 yamt 1582 1.2.2.2 yamt for (;;) { 1583 1.2.2.2 yamt cur = idx; 1584 1.2.2.2 yamt 1585 1.2.2.2 yamt /* Sync the descriptor */ 1586 1.2.2.2 yamt MVGBE_CDRXSYNC(sc, idx, 1587 1.2.2.2 yamt BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 1588 1.2.2.2 yamt 1589 1.2.2.2 yamt cur_rx = &sc->sc_rdata->mvgbe_rx_ring[idx]; 1590 1.2.2.2 yamt 1591 1.2.2.2 yamt if ((cur_rx->cmdsts & MVGBE_BUFFER_OWNED_MASK) == 1592 1.2.2.2 yamt MVGBE_BUFFER_OWNED_BY_DMA) { 1593 1.2.2.2 yamt /* Invalidate the descriptor -- it's not ready yet */ 1594 1.2.2.2 yamt MVGBE_CDRXSYNC(sc, idx, BUS_DMASYNC_PREREAD); 1595 1.2.2.2 yamt sc->sc_cdata.mvgbe_rx_prod = idx; 1596 1.2.2.2 yamt break; 1597 1.2.2.2 yamt } 1598 1.2.2.2 yamt #ifdef DIAGNOSTIC 1599 1.2.2.2 yamt if ((cur_rx->cmdsts & 1600 1.2.2.2 yamt (MVGBE_RX_LAST_DESC | MVGBE_RX_FIRST_DESC)) != 1601 1.2.2.2 yamt (MVGBE_RX_LAST_DESC | MVGBE_RX_FIRST_DESC)) 1602 1.2.2.2 yamt panic( 1603 1.2.2.2 yamt "mvgbe_rxeof: buffer size is smaller than packet"); 1604 1.2.2.2 yamt #endif 1605 1.2.2.2 yamt 1606 1.2.2.2 yamt dmamap = sc->sc_cdata.mvgbe_rx_jumbo_map; 1607 1.2.2.2 yamt 1608 1.2.2.2 yamt bus_dmamap_sync(sc->sc_dmat, dmamap, 0, dmamap->dm_mapsize, 1609 1.2.2.2 yamt BUS_DMASYNC_POSTREAD); 1610 1.2.2.2 yamt 1611 1.2.2.2 yamt m = cdata->mvgbe_rx_chain[idx].mvgbe_mbuf; 1612 1.2.2.2 yamt cdata->mvgbe_rx_chain[idx].mvgbe_mbuf = NULL; 1613 1.2.2.2 yamt total_len = cur_rx->bytecnt; 1614 1.2.2.2 yamt rxstat = cur_rx->cmdsts; 1615 1.2.2.2 yamt 1616 1.2.2.2 yamt cdata->mvgbe_rx_map[idx] = NULL; 1617 1.2.2.2 yamt 1618 1.2.2.2 yamt idx = (idx + 1) % MVGBE_RX_RING_CNT; 1619 1.2.2.2 yamt 1620 1.2.2.2 yamt if (rxstat & MVGBE_ERROR_SUMMARY) { 1621 1.2.2.2 yamt #if 0 1622 1.2.2.2 yamt int err = rxstat & MVGBE_RX_ERROR_CODE_MASK; 1623 1.2.2.2 yamt 1624 1.2.2.2 yamt if (err == MVGBE_RX_CRC_ERROR) 1625 1.2.2.2 yamt ifp->if_ierrors++; 1626 1.2.2.2 yamt if (err == MVGBE_RX_OVERRUN_ERROR) 1627 1.2.2.2 yamt ifp->if_ierrors++; 1628 1.2.2.2 yamt if (err == MVGBE_RX_MAX_FRAME_LEN_ERROR) 1629 1.2.2.2 yamt ifp->if_ierrors++; 1630 1.2.2.2 yamt if (err == MVGBE_RX_RESOURCE_ERROR) 1631 1.2.2.2 yamt ifp->if_ierrors++; 1632 1.2.2.2 yamt #else 1633 1.2.2.2 yamt ifp->if_ierrors++; 1634 1.2.2.2 yamt #endif 1635 1.2.2.2 yamt mvgbe_newbuf(sc, cur, m, dmamap); 1636 1.2.2.2 yamt continue; 1637 1.2.2.2 yamt } 1638 1.2.2.2 yamt 1639 1.2.2.2 yamt if (total_len > MVGBE_RX_CSUM_MIN_BYTE) { 1640 1.2.2.2 yamt /* Check IP header checksum */ 1641 1.2.2.2 yamt if (rxstat & MVGBE_RX_IP_FRAME_TYPE) { 1642 1.2.2.2 yamt m->m_pkthdr.csum_flags |= M_CSUM_IPv4; 1643 1.2.2.2 yamt if (!(rxstat & MVGBE_RX_IP_HEADER_OK)) 1644 1.2.2.2 yamt m->m_pkthdr.csum_flags |= 1645 1.2.2.2 yamt M_CSUM_IPv4_BAD; 1646 1.2.2.2 yamt } 1647 1.2.2.2 yamt /* Check TCP/UDP checksum */ 1648 1.2.2.2 yamt if (rxstat & MVGBE_RX_L4_TYPE_TCP) 1649 1.2.2.2 yamt m->m_pkthdr.csum_flags |= M_CSUM_TCPv4; 1650 1.2.2.2 yamt else if (rxstat & MVGBE_RX_L4_TYPE_UDP) 1651 1.2.2.2 yamt m->m_pkthdr.csum_flags |= M_CSUM_UDPv4; 1652 1.2.2.2 yamt if (!(rxstat & MVGBE_RX_L4_CHECKSUM)) 1653 1.2.2.2 yamt m->m_pkthdr.csum_flags |= M_CSUM_TCP_UDP_BAD; 1654 1.2.2.2 yamt } 1655 1.2.2.2 yamt 1656 1.2.2.2 yamt /* 1657 1.2.2.2 yamt * Try to allocate a new jumbo buffer. If that 1658 1.2.2.2 yamt * fails, copy the packet to mbufs and put the 1659 1.2.2.2 yamt * jumbo buffer back in the ring so it can be 1660 1.2.2.2 yamt * re-used. If allocating mbufs fails, then we 1661 1.2.2.2 yamt * have to drop the packet. 1662 1.2.2.2 yamt */ 1663 1.2.2.2 yamt if (mvgbe_newbuf(sc, cur, NULL, dmamap) == ENOBUFS) { 1664 1.2.2.2 yamt struct mbuf *m0; 1665 1.2.2.2 yamt 1666 1.2.2.2 yamt m0 = m_devget(mtod(m, char *), total_len, 0, ifp, NULL); 1667 1.2.2.2 yamt mvgbe_newbuf(sc, cur, m, dmamap); 1668 1.2.2.2 yamt if (m0 == NULL) { 1669 1.2.2.2 yamt aprint_error_ifnet(ifp, 1670 1.2.2.2 yamt "no receive buffers available --" 1671 1.2.2.2 yamt " packet dropped!\n"); 1672 1.2.2.2 yamt ifp->if_ierrors++; 1673 1.2.2.2 yamt continue; 1674 1.2.2.2 yamt } 1675 1.2.2.2 yamt m = m0; 1676 1.2.2.2 yamt } else { 1677 1.2.2.2 yamt m->m_pkthdr.rcvif = ifp; 1678 1.2.2.2 yamt m->m_pkthdr.len = m->m_len = total_len; 1679 1.2.2.2 yamt } 1680 1.2.2.2 yamt 1681 1.2.2.2 yamt /* Skip on first 2byte (HW header) */ 1682 1.2.2.2 yamt m_adj(m, MVGBE_HWHEADER_SIZE); 1683 1.2.2.2 yamt m->m_flags |= M_HASFCS; 1684 1.2.2.2 yamt 1685 1.2.2.2 yamt ifp->if_ipackets++; 1686 1.2.2.2 yamt 1687 1.2.2.2 yamt if (ifp->if_bpf) 1688 1.2.2.2 yamt bpf_ops->bpf_mtap(ifp->if_bpf, m); 1689 1.2.2.2 yamt 1690 1.2.2.2 yamt /* pass it on. */ 1691 1.2.2.2 yamt (*ifp->if_input)(ifp, m); 1692 1.2.2.2 yamt } 1693 1.2.2.2 yamt } 1694 1.2.2.2 yamt 1695 1.2.2.2 yamt static void 1696 1.2.2.2 yamt mvgbe_txeof(struct mvgbe_softc *sc) 1697 1.2.2.2 yamt { 1698 1.2.2.2 yamt struct mvgbe_chain_data *cdata = &sc->sc_cdata; 1699 1.2.2.2 yamt struct mvgbe_tx_desc *cur_tx; 1700 1.2.2.2 yamt struct ifnet *ifp = &sc->sc_ethercom.ec_if; 1701 1.2.2.2 yamt struct mvgbe_txmap_entry *entry; 1702 1.2.2.2 yamt int idx; 1703 1.2.2.2 yamt 1704 1.2.2.2 yamt DPRINTFN(3, ("mvgbe_txeof\n")); 1705 1.2.2.2 yamt 1706 1.2.2.2 yamt /* 1707 1.2.2.2 yamt * Go through our tx ring and free mbufs for those 1708 1.2.2.2 yamt * frames that have been sent. 1709 1.2.2.2 yamt */ 1710 1.2.2.2 yamt idx = cdata->mvgbe_tx_cons; 1711 1.2.2.2 yamt while (idx != cdata->mvgbe_tx_prod) { 1712 1.2.2.2 yamt MVGBE_CDTXSYNC(sc, idx, 1, 1713 1.2.2.2 yamt BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 1714 1.2.2.2 yamt 1715 1.2.2.2 yamt cur_tx = &sc->sc_rdata->mvgbe_tx_ring[idx]; 1716 1.2.2.2 yamt #ifdef MVGBE_DEBUG 1717 1.2.2.2 yamt if (mvgbe_debug >= 3) 1718 1.2.2.2 yamt mvgbe_dump_txdesc(cur_tx, idx); 1719 1.2.2.2 yamt #endif 1720 1.2.2.2 yamt if ((cur_tx->cmdsts & MVGBE_BUFFER_OWNED_MASK) == 1721 1.2.2.2 yamt MVGBE_BUFFER_OWNED_BY_DMA) { 1722 1.2.2.2 yamt MVGBE_CDTXSYNC(sc, idx, 1, BUS_DMASYNC_PREREAD); 1723 1.2.2.2 yamt break; 1724 1.2.2.2 yamt } 1725 1.2.2.2 yamt if (cur_tx->cmdsts & MVGBE_TX_LAST_DESC) 1726 1.2.2.2 yamt ifp->if_opackets++; 1727 1.2.2.2 yamt if (cur_tx->cmdsts & MVGBE_ERROR_SUMMARY) { 1728 1.2.2.2 yamt int err = cur_tx->cmdsts & MVGBE_TX_ERROR_CODE_MASK; 1729 1.2.2.2 yamt 1730 1.2.2.2 yamt if (err == MVGBE_TX_LATE_COLLISION_ERROR) 1731 1.2.2.2 yamt ifp->if_collisions++; 1732 1.2.2.2 yamt if (err == MVGBE_TX_UNDERRUN_ERROR) 1733 1.2.2.2 yamt ifp->if_oerrors++; 1734 1.2.2.2 yamt if (err == MVGBE_TX_EXCESSIVE_COLLISION_ERRO) 1735 1.2.2.2 yamt ifp->if_collisions++; 1736 1.2.2.2 yamt } 1737 1.2.2.2 yamt if (cdata->mvgbe_tx_chain[idx].mvgbe_mbuf != NULL) { 1738 1.2.2.2 yamt entry = cdata->mvgbe_tx_map[idx]; 1739 1.2.2.2 yamt 1740 1.2.2.2 yamt m_freem(cdata->mvgbe_tx_chain[idx].mvgbe_mbuf); 1741 1.2.2.2 yamt cdata->mvgbe_tx_chain[idx].mvgbe_mbuf = NULL; 1742 1.2.2.2 yamt 1743 1.2.2.2 yamt bus_dmamap_sync(sc->sc_dmat, entry->dmamap, 0, 1744 1.2.2.2 yamt entry->dmamap->dm_mapsize, BUS_DMASYNC_POSTWRITE); 1745 1.2.2.2 yamt 1746 1.2.2.2 yamt bus_dmamap_unload(sc->sc_dmat, entry->dmamap); 1747 1.2.2.2 yamt SIMPLEQ_INSERT_TAIL(&sc->sc_txmap_head, entry, link); 1748 1.2.2.2 yamt cdata->mvgbe_tx_map[idx] = NULL; 1749 1.2.2.2 yamt } 1750 1.2.2.2 yamt cdata->mvgbe_tx_cnt--; 1751 1.2.2.2 yamt idx = (idx + 1) % MVGBE_TX_RING_CNT; 1752 1.2.2.2 yamt } 1753 1.2.2.2 yamt if (cdata->mvgbe_tx_cnt == 0) 1754 1.2.2.2 yamt ifp->if_timer = 0; 1755 1.2.2.2 yamt 1756 1.2.2.2 yamt if (cdata->mvgbe_tx_cnt < MVGBE_TX_RING_CNT - 2) 1757 1.2.2.2 yamt ifp->if_flags &= ~IFF_OACTIVE; 1758 1.2.2.2 yamt 1759 1.2.2.2 yamt cdata->mvgbe_tx_cons = idx; 1760 1.2.2.2 yamt } 1761 1.2.2.2 yamt 1762 1.2.2.2 yamt static void 1763 1.2.2.2 yamt mvgbe_setmulti(struct mvgbe_softc *sc) 1764 1.2.2.2 yamt { 1765 1.2.2.2 yamt struct ifnet *ifp= &sc->sc_ethercom.ec_if; 1766 1.2.2.2 yamt uint32_t pxc, dfut, upm = 0, filter = 0; 1767 1.2.2.2 yamt uint8_t ln = sc->sc_enaddr[5] & 0xf; /* last nibble */ 1768 1.2.2.2 yamt 1769 1.2.2.2 yamt if (ifp->if_flags & IFF_PROMISC) { 1770 1.2.2.2 yamt upm = MVGBE_PXC_UPM; 1771 1.2.2.2 yamt filter = 1772 1.2.2.2 yamt MVGBE_DF(0, MVGBE_DF_QUEUE(0) | MVGBE_DF_PASS) | 1773 1.2.2.2 yamt MVGBE_DF(1, MVGBE_DF_QUEUE(0) | MVGBE_DF_PASS) | 1774 1.2.2.2 yamt MVGBE_DF(2, MVGBE_DF_QUEUE(0) | MVGBE_DF_PASS) | 1775 1.2.2.2 yamt MVGBE_DF(3, MVGBE_DF_QUEUE(0) | MVGBE_DF_PASS); 1776 1.2.2.2 yamt } else if (ifp->if_flags & IFF_ALLMULTI) { 1777 1.2.2.2 yamt filter = 1778 1.2.2.2 yamt MVGBE_DF(0, MVGBE_DF_QUEUE(0) | MVGBE_DF_PASS) | 1779 1.2.2.2 yamt MVGBE_DF(1, MVGBE_DF_QUEUE(0) | MVGBE_DF_PASS) | 1780 1.2.2.2 yamt MVGBE_DF(2, MVGBE_DF_QUEUE(0) | MVGBE_DF_PASS) | 1781 1.2.2.2 yamt MVGBE_DF(3, MVGBE_DF_QUEUE(0) | MVGBE_DF_PASS); 1782 1.2.2.2 yamt } 1783 1.2.2.2 yamt 1784 1.2.2.2 yamt /* Set Unicast Promiscuous mode */ 1785 1.2.2.2 yamt pxc = MVGBE_READ(sc, MVGBE_PXC); 1786 1.2.2.2 yamt pxc &= ~MVGBE_PXC_UPM; 1787 1.2.2.2 yamt pxc |= upm; 1788 1.2.2.2 yamt MVGBE_WRITE(sc, MVGBE_PXC, pxc); 1789 1.2.2.2 yamt 1790 1.2.2.2 yamt /* Set Destination Address Filter Multicast Tables */ 1791 1.2.2.2 yamt MVGBE_WRITE_FILTER(sc, MVGBE_DFSMT, filter, MVGBE_NDFSMT); 1792 1.2.2.2 yamt MVGBE_WRITE_FILTER(sc, MVGBE_DFOMT, filter, MVGBE_NDFOMT); 1793 1.2.2.2 yamt 1794 1.2.2.2 yamt if (ifp->if_flags & IFF_PROMISC) { 1795 1.2.2.2 yamt /* necessary ? */ 1796 1.2.2.2 yamt MVGBE_WRITE_FILTER(sc, MVGBE_DFUT, filter, MVGBE_NDFUT); 1797 1.2.2.2 yamt return; 1798 1.2.2.2 yamt } 1799 1.2.2.2 yamt 1800 1.2.2.2 yamt /* Set Destination Address Filter Unicast Table */ 1801 1.2.2.2 yamt dfut = MVGBE_READ_FILTER(sc, MVGBE_DFUT + (ln & 0x0c)); 1802 1.2.2.2 yamt dfut &= ~MVGBE_DF(ln & 0x03, MVGBE_DF_QUEUE_MASK);; 1803 1.2.2.2 yamt dfut |= MVGBE_DF(ln & 0x03, MVGBE_DF_QUEUE(0) | MVGBE_DF_PASS); 1804 1.2.2.2 yamt MVGBE_WRITE_FILTER(sc, MVGBE_DFUT + (ln & 0x0c), dfut, 1); 1805 1.2.2.2 yamt } 1806 1.2.2.2 yamt 1807 1.2.2.2 yamt #ifdef MVGBE_DEBUG 1808 1.2.2.2 yamt static void 1809 1.2.2.2 yamt mvgbe_dump_txdesc(struct mvgbe_tx_desc *desc, int idx) 1810 1.2.2.2 yamt { 1811 1.2.2.2 yamt #define DESC_PRINT(X) \ 1812 1.2.2.2 yamt if (X) \ 1813 1.2.2.2 yamt printf("txdesc[%d]." #X "=%#x\n", idx, X); 1814 1.2.2.2 yamt 1815 1.2.2.2 yamt #if BYTE_ORDER == BIG_ENDIAN 1816 1.2.2.2 yamt DESC_PRINT(desc->bytecnt); 1817 1.2.2.2 yamt DESC_PRINT(desc->l4ichk); 1818 1.2.2.2 yamt DESC_PRINT(desc->cmdsts); 1819 1.2.2.2 yamt DESC_PRINT(desc->nextdescptr); 1820 1.2.2.2 yamt DESC_PRINT(desc->bufptr); 1821 1.2.2.2 yamt #else /* LITTLE_ENDIAN */ 1822 1.2.2.2 yamt DESC_PRINT(desc->cmdsts); 1823 1.2.2.2 yamt DESC_PRINT(desc->l4ichk); 1824 1.2.2.2 yamt DESC_PRINT(desc->bytecnt); 1825 1.2.2.2 yamt DESC_PRINT(desc->bufptr); 1826 1.2.2.2 yamt DESC_PRINT(desc->nextdescptr); 1827 1.2.2.2 yamt #endif 1828 1.2.2.2 yamt #undef DESC_PRINT 1829 1.2.2.2 yamt printf("txdesc[%d].desc->returninfo=%#lx\n", idx, desc->returninfo); 1830 1.2.2.2 yamt printf("txdesc[%d].desc->alignbufptr=%p\n", idx, desc->alignbufptr); 1831 1.2.2.2 yamt } 1832 1.2.2.2 yamt #endif 1833
Indexes created Sun Oct 26 20:09:54 GMT 2025