if_gm.c revision 1.9.2.3
1 1.9.2.3 bouyer /* $NetBSD: if_gm.c,v 1.9.2.3 2000/11/22 16:00:37 bouyer Exp $ */ 2 1.9.2.2 bouyer 3 1.9.2.2 bouyer /*- 4 1.9.2.2 bouyer * Copyright (c) 2000 Tsubai Masanari. All rights reserved. 5 1.9.2.2 bouyer * 6 1.9.2.2 bouyer * Redistribution and use in source and binary forms, with or without 7 1.9.2.2 bouyer * modification, are permitted provided that the following conditions 8 1.9.2.2 bouyer * are met: 9 1.9.2.2 bouyer * 1. Redistributions of source code must retain the above copyright 10 1.9.2.2 bouyer * notice, this list of conditions and the following disclaimer. 11 1.9.2.2 bouyer * 2. Redistributions in binary form must reproduce the above copyright 12 1.9.2.2 bouyer * notice, this list of conditions and the following disclaimer in the 13 1.9.2.2 bouyer * documentation and/or other materials provided with the distribution. 14 1.9.2.2 bouyer * 3. The name of the author may not be used to endorse or promote products 15 1.9.2.2 bouyer * derived from this software without specific prior written permission. 16 1.9.2.2 bouyer * 17 1.9.2.2 bouyer * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 18 1.9.2.2 bouyer * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 19 1.9.2.2 bouyer * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 20 1.9.2.2 bouyer * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 21 1.9.2.2 bouyer * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 22 1.9.2.2 bouyer * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 23 1.9.2.2 bouyer * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 24 1.9.2.2 bouyer * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 25 1.9.2.2 bouyer * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 26 1.9.2.2 bouyer * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 27 1.9.2.2 bouyer */ 28 1.9.2.2 bouyer 29 1.9.2.2 bouyer #include "opt_inet.h" 30 1.9.2.2 bouyer #include "opt_ns.h" 31 1.9.2.2 bouyer #include "bpfilter.h" 32 1.9.2.2 bouyer 33 1.9.2.2 bouyer #include <sys/param.h> 34 1.9.2.2 bouyer #include <sys/device.h> 35 1.9.2.2 bouyer #include <sys/ioctl.h> 36 1.9.2.2 bouyer #include <sys/kernel.h> 37 1.9.2.2 bouyer #include <sys/mbuf.h> 38 1.9.2.2 bouyer #include <sys/socket.h> 39 1.9.2.2 bouyer #include <sys/systm.h> 40 1.9.2.2 bouyer #include <sys/callout.h> 41 1.9.2.2 bouyer 42 1.9.2.2 bouyer #include <uvm/uvm_extern.h> 43 1.9.2.2 bouyer 44 1.9.2.2 bouyer #include <net/if.h> 45 1.9.2.2 bouyer #include <net/if_ether.h> 46 1.9.2.2 bouyer #include <net/if_media.h> 47 1.9.2.2 bouyer 48 1.9.2.2 bouyer #if NBPFILTER > 0 49 1.9.2.2 bouyer #include <net/bpf.h> 50 1.9.2.2 bouyer #endif 51 1.9.2.2 bouyer 52 1.9.2.2 bouyer #ifdef INET 53 1.9.2.2 bouyer #include <netinet/in.h> 54 1.9.2.2 bouyer #include <netinet/if_inarp.h> 55 1.9.2.2 bouyer #endif 56 1.9.2.2 bouyer 57 1.9.2.2 bouyer #include <dev/mii/mii.h> 58 1.9.2.2 bouyer #include <dev/mii/miivar.h> 59 1.9.2.2 bouyer 60 1.9.2.2 bouyer #include <dev/pci/pcivar.h> 61 1.9.2.2 bouyer #include <dev/pci/pcireg.h> 62 1.9.2.2 bouyer #include <dev/pci/pcidevs.h> 63 1.9.2.2 bouyer 64 1.9.2.2 bouyer #include <dev/ofw/openfirm.h> 65 1.9.2.2 bouyer #include <macppc/dev/if_gmreg.h> 66 1.9.2.2 bouyer #include <machine/pio.h> 67 1.9.2.2 bouyer 68 1.9.2.2 bouyer #define NTXBUF 4 69 1.9.2.2 bouyer #define NRXBUF 32 70 1.9.2.2 bouyer 71 1.9.2.2 bouyer struct gmac_softc { 72 1.9.2.2 bouyer struct device sc_dev; 73 1.9.2.2 bouyer struct ethercom sc_ethercom; 74 1.9.2.2 bouyer vaddr_t sc_reg; 75 1.9.2.2 bouyer struct gmac_dma *sc_txlist; 76 1.9.2.2 bouyer struct gmac_dma *sc_rxlist; 77 1.9.2.2 bouyer int sc_txnext; 78 1.9.2.2 bouyer int sc_rxlast; 79 1.9.2.2 bouyer caddr_t sc_txbuf[NTXBUF]; 80 1.9.2.2 bouyer caddr_t sc_rxbuf[NRXBUF]; 81 1.9.2.2 bouyer struct mii_data sc_mii; 82 1.9.2.2 bouyer struct callout sc_tick_ch; 83 1.9.2.2 bouyer char sc_laddr[6]; 84 1.9.2.2 bouyer }; 85 1.9.2.2 bouyer 86 1.9.2.2 bouyer #define sc_if sc_ethercom.ec_if 87 1.9.2.2 bouyer 88 1.9.2.2 bouyer int gmac_match __P((struct device *, struct cfdata *, void *)); 89 1.9.2.2 bouyer void gmac_attach __P((struct device *, struct device *, void *)); 90 1.9.2.2 bouyer 91 1.9.2.2 bouyer static __inline u_int gmac_read_reg __P((struct gmac_softc *, int)); 92 1.9.2.2 bouyer static __inline void gmac_write_reg __P((struct gmac_softc *, int, u_int)); 93 1.9.2.2 bouyer 94 1.9.2.2 bouyer static __inline void gmac_start_txdma __P((struct gmac_softc *)); 95 1.9.2.2 bouyer static __inline void gmac_start_rxdma __P((struct gmac_softc *)); 96 1.9.2.2 bouyer static __inline void gmac_stop_txdma __P((struct gmac_softc *)); 97 1.9.2.2 bouyer static __inline void gmac_stop_rxdma __P((struct gmac_softc *)); 98 1.9.2.2 bouyer 99 1.9.2.2 bouyer int gmac_intr __P((void *)); 100 1.9.2.2 bouyer void gmac_tint __P((struct gmac_softc *)); 101 1.9.2.2 bouyer void gmac_rint __P((struct gmac_softc *)); 102 1.9.2.2 bouyer struct mbuf * gmac_get __P((struct gmac_softc *, caddr_t, int)); 103 1.9.2.2 bouyer void gmac_start __P((struct ifnet *)); 104 1.9.2.2 bouyer int gmac_put __P((struct gmac_softc *, caddr_t, struct mbuf *)); 105 1.9.2.2 bouyer 106 1.9.2.2 bouyer void gmac_stop __P((struct gmac_softc *)); 107 1.9.2.2 bouyer void gmac_reset __P((struct gmac_softc *)); 108 1.9.2.2 bouyer void gmac_init __P((struct gmac_softc *)); 109 1.9.2.2 bouyer void gmac_init_mac __P((struct gmac_softc *)); 110 1.9.2.2 bouyer void gmac_setladrf __P((struct gmac_softc *)); 111 1.9.2.2 bouyer 112 1.9.2.2 bouyer int gmac_ioctl __P((struct ifnet *, u_long, caddr_t)); 113 1.9.2.2 bouyer void gmac_watchdog __P((struct ifnet *)); 114 1.9.2.2 bouyer 115 1.9.2.2 bouyer int gmac_mediachange __P((struct ifnet *)); 116 1.9.2.2 bouyer void gmac_mediastatus __P((struct ifnet *, struct ifmediareq *)); 117 1.9.2.2 bouyer int gmac_mii_readreg __P((struct device *, int, int)); 118 1.9.2.2 bouyer void gmac_mii_writereg __P((struct device *, int, int, int)); 119 1.9.2.2 bouyer void gmac_mii_statchg __P((struct device *)); 120 1.9.2.2 bouyer void gmac_mii_tick __P((void *)); 121 1.9.2.2 bouyer 122 1.9.2.2 bouyer struct cfattach gm_ca = { 123 1.9.2.2 bouyer sizeof(struct gmac_softc), gmac_match, gmac_attach 124 1.9.2.2 bouyer }; 125 1.9.2.2 bouyer 126 1.9.2.2 bouyer int 127 1.9.2.2 bouyer gmac_match(parent, match, aux) 128 1.9.2.2 bouyer struct device *parent; 129 1.9.2.2 bouyer struct cfdata *match; 130 1.9.2.2 bouyer void *aux; 131 1.9.2.2 bouyer { 132 1.9.2.2 bouyer struct pci_attach_args *pa = aux; 133 1.9.2.2 bouyer 134 1.9.2.2 bouyer if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_APPLE && 135 1.9.2.2 bouyer PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_APPLE_GMAC) 136 1.9.2.2 bouyer return 1; 137 1.9.2.2 bouyer 138 1.9.2.2 bouyer return 0; 139 1.9.2.2 bouyer } 140 1.9.2.2 bouyer 141 1.9.2.2 bouyer void 142 1.9.2.2 bouyer gmac_attach(parent, self, aux) 143 1.9.2.2 bouyer struct device *parent, *self; 144 1.9.2.2 bouyer void *aux; 145 1.9.2.2 bouyer { 146 1.9.2.2 bouyer struct gmac_softc *sc = (void *)self; 147 1.9.2.2 bouyer struct pci_attach_args *pa = aux; 148 1.9.2.2 bouyer struct ifnet *ifp = &sc->sc_if; 149 1.9.2.2 bouyer struct mii_data *mii = &sc->sc_mii; 150 1.9.2.2 bouyer pci_intr_handle_t ih; 151 1.9.2.2 bouyer const char *intrstr = NULL; 152 1.9.2.2 bouyer int node, i; 153 1.9.2.2 bouyer char *p; 154 1.9.2.2 bouyer struct gmac_dma *dp; 155 1.9.2.2 bouyer u_int32_t reg[10]; 156 1.9.2.2 bouyer u_char laddr[6]; 157 1.9.2.2 bouyer 158 1.9.2.2 bouyer node = pcidev_to_ofdev(pa->pa_pc, pa->pa_tag); 159 1.9.2.2 bouyer if (node == 0) { 160 1.9.2.2 bouyer printf(": cannot find gmac node\n"); 161 1.9.2.2 bouyer return; 162 1.9.2.2 bouyer } 163 1.9.2.2 bouyer 164 1.9.2.2 bouyer OF_getprop(node, "local-mac-address", laddr, sizeof laddr); 165 1.9.2.2 bouyer OF_getprop(node, "assigned-addresses", reg, sizeof reg); 166 1.9.2.2 bouyer 167 1.9.2.2 bouyer bcopy(laddr, sc->sc_laddr, sizeof laddr); 168 1.9.2.2 bouyer sc->sc_reg = reg[2]; 169 1.9.2.2 bouyer 170 1.9.2.2 bouyer if (pci_intr_map(pa->pa_pc, pa->pa_intrtag, pa->pa_intrpin, 171 1.9.2.2 bouyer pa->pa_intrline, &ih)) { 172 1.9.2.2 bouyer printf(": unable to map interrupt\n"); 173 1.9.2.2 bouyer return; 174 1.9.2.2 bouyer } 175 1.9.2.2 bouyer intrstr = pci_intr_string(pa->pa_pc, ih); 176 1.9.2.2 bouyer 177 1.9.2.2 bouyer if (pci_intr_establish(pa->pa_pc, ih, IPL_NET, gmac_intr, sc) == NULL) { 178 1.9.2.2 bouyer printf(": unable to establish interrupt"); 179 1.9.2.2 bouyer if (intrstr) 180 1.9.2.2 bouyer printf(" at %s", intrstr); 181 1.9.2.2 bouyer printf("\n"); 182 1.9.2.2 bouyer return; 183 1.9.2.2 bouyer } 184 1.9.2.2 bouyer 185 1.9.2.2 bouyer /* Setup packet buffers and dma descriptors. */ 186 1.9.2.2 bouyer p = malloc((NRXBUF + NTXBUF) * 2048 + 3 * 0x800, M_DEVBUF, M_NOWAIT); 187 1.9.2.2 bouyer if (p == NULL) { 188 1.9.2.2 bouyer printf(": cannot malloc buffers\n"); 189 1.9.2.2 bouyer return; 190 1.9.2.2 bouyer } 191 1.9.2.2 bouyer p = (void *)roundup((vaddr_t)p, 0x800); 192 1.9.2.2 bouyer bzero(p, 2048 * (NRXBUF + NTXBUF) + 2 * 0x800); 193 1.9.2.2 bouyer 194 1.9.2.2 bouyer sc->sc_rxlist = (void *)p; 195 1.9.2.2 bouyer p += 0x800; 196 1.9.2.2 bouyer sc->sc_txlist = (void *)p; 197 1.9.2.2 bouyer p += 0x800; 198 1.9.2.2 bouyer 199 1.9.2.2 bouyer dp = sc->sc_rxlist; 200 1.9.2.2 bouyer for (i = 0; i < NRXBUF; i++) { 201 1.9.2.2 bouyer sc->sc_rxbuf[i] = p; 202 1.9.2.2 bouyer dp->address = htole32(vtophys((vaddr_t)p)); 203 1.9.2.2 bouyer dp->cmd = htole32(GMAC_OWN); 204 1.9.2.2 bouyer dp++; 205 1.9.2.2 bouyer p += 2048; 206 1.9.2.2 bouyer } 207 1.9.2.2 bouyer 208 1.9.2.2 bouyer dp = sc->sc_txlist; 209 1.9.2.2 bouyer for (i = 0; i < NTXBUF; i++) { 210 1.9.2.2 bouyer sc->sc_txbuf[i] = p; 211 1.9.2.2 bouyer dp->address = htole32(vtophys((vaddr_t)p)); 212 1.9.2.2 bouyer dp++; 213 1.9.2.2 bouyer p += 2048; 214 1.9.2.2 bouyer } 215 1.9.2.2 bouyer 216 1.9.2.2 bouyer printf(": Ethernet address %s\n", ether_sprintf(laddr)); 217 1.9.2.2 bouyer printf("%s: interrupting at %s\n", sc->sc_dev.dv_xname, intrstr); 218 1.9.2.2 bouyer 219 1.9.2.2 bouyer callout_init(&sc->sc_tick_ch); 220 1.9.2.2 bouyer 221 1.9.2.2 bouyer gmac_reset(sc); 222 1.9.2.2 bouyer gmac_init_mac(sc); 223 1.9.2.2 bouyer 224 1.9.2.2 bouyer bcopy(sc->sc_dev.dv_xname, ifp->if_xname, IFNAMSIZ); 225 1.9.2.2 bouyer ifp->if_softc = sc; 226 1.9.2.2 bouyer ifp->if_ioctl = gmac_ioctl; 227 1.9.2.2 bouyer ifp->if_start = gmac_start; 228 1.9.2.2 bouyer ifp->if_watchdog = gmac_watchdog; 229 1.9.2.2 bouyer ifp->if_flags = 230 1.9.2.2 bouyer IFF_BROADCAST | IFF_SIMPLEX | IFF_NOTRAILERS | IFF_MULTICAST; 231 1.9.2.2 bouyer 232 1.9.2.2 bouyer mii->mii_ifp = ifp; 233 1.9.2.2 bouyer mii->mii_readreg = gmac_mii_readreg; 234 1.9.2.2 bouyer mii->mii_writereg = gmac_mii_writereg; 235 1.9.2.2 bouyer mii->mii_statchg = gmac_mii_statchg; 236 1.9.2.2 bouyer 237 1.9.2.2 bouyer ifmedia_init(&mii->mii_media, 0, gmac_mediachange, gmac_mediastatus); 238 1.9.2.2 bouyer mii_attach(self, mii, 0xffffffff, MII_PHY_ANY, MII_OFFSET_ANY, 0); 239 1.9.2.2 bouyer 240 1.9.2.2 bouyer /* Choose a default media. */ 241 1.9.2.2 bouyer if (LIST_FIRST(&mii->mii_phys) == NULL) { 242 1.9.2.2 bouyer ifmedia_add(&mii->mii_media, IFM_ETHER|IFM_NONE, 0, NULL); 243 1.9.2.2 bouyer ifmedia_set(&mii->mii_media, IFM_ETHER|IFM_NONE); 244 1.9.2.2 bouyer } else 245 1.9.2.2 bouyer ifmedia_set(&mii->mii_media, IFM_ETHER|IFM_AUTO); 246 1.9.2.2 bouyer 247 1.9.2.2 bouyer if_attach(ifp); 248 1.9.2.2 bouyer ether_ifattach(ifp, laddr); 249 1.9.2.2 bouyer } 250 1.9.2.2 bouyer 251 1.9.2.2 bouyer u_int 252 1.9.2.2 bouyer gmac_read_reg(sc, reg) 253 1.9.2.2 bouyer struct gmac_softc *sc; 254 1.9.2.2 bouyer int reg; 255 1.9.2.2 bouyer { 256 1.9.2.2 bouyer return in32rb(sc->sc_reg + reg); 257 1.9.2.2 bouyer } 258 1.9.2.2 bouyer 259 1.9.2.2 bouyer void 260 1.9.2.2 bouyer gmac_write_reg(sc, reg, val) 261 1.9.2.2 bouyer struct gmac_softc *sc; 262 1.9.2.2 bouyer int reg; 263 1.9.2.2 bouyer u_int val; 264 1.9.2.2 bouyer { 265 1.9.2.2 bouyer out32rb(sc->sc_reg + reg, val); 266 1.9.2.2 bouyer } 267 1.9.2.2 bouyer 268 1.9.2.2 bouyer void 269 1.9.2.2 bouyer gmac_start_txdma(sc) 270 1.9.2.2 bouyer struct gmac_softc *sc; 271 1.9.2.2 bouyer { 272 1.9.2.2 bouyer u_int x; 273 1.9.2.2 bouyer 274 1.9.2.2 bouyer x = gmac_read_reg(sc, GMAC_TXDMACONFIG); 275 1.9.2.2 bouyer x |= 1; 276 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_TXDMACONFIG, x); 277 1.9.2.2 bouyer x = gmac_read_reg(sc, GMAC_TXMACCONFIG); 278 1.9.2.2 bouyer x |= 1; 279 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_TXMACCONFIG, x); 280 1.9.2.2 bouyer } 281 1.9.2.2 bouyer 282 1.9.2.2 bouyer void 283 1.9.2.2 bouyer gmac_start_rxdma(sc) 284 1.9.2.2 bouyer struct gmac_softc *sc; 285 1.9.2.2 bouyer { 286 1.9.2.2 bouyer u_int x; 287 1.9.2.2 bouyer 288 1.9.2.2 bouyer x = gmac_read_reg(sc, GMAC_RXDMACONFIG); 289 1.9.2.2 bouyer x |= 1; 290 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_RXDMACONFIG, x); 291 1.9.2.2 bouyer x = gmac_read_reg(sc, GMAC_RXMACCONFIG); 292 1.9.2.2 bouyer x |= 1; 293 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_RXMACCONFIG, x); 294 1.9.2.2 bouyer } 295 1.9.2.2 bouyer 296 1.9.2.2 bouyer void 297 1.9.2.2 bouyer gmac_stop_txdma(sc) 298 1.9.2.2 bouyer struct gmac_softc *sc; 299 1.9.2.2 bouyer { 300 1.9.2.2 bouyer u_int x; 301 1.9.2.2 bouyer 302 1.9.2.2 bouyer x = gmac_read_reg(sc, GMAC_TXDMACONFIG); 303 1.9.2.2 bouyer x &= ~1; 304 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_TXDMACONFIG, x); 305 1.9.2.2 bouyer x = gmac_read_reg(sc, GMAC_TXMACCONFIG); 306 1.9.2.2 bouyer x &= ~1; 307 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_TXMACCONFIG, x); 308 1.9.2.2 bouyer } 309 1.9.2.2 bouyer 310 1.9.2.2 bouyer void 311 1.9.2.2 bouyer gmac_stop_rxdma(sc) 312 1.9.2.2 bouyer struct gmac_softc *sc; 313 1.9.2.2 bouyer { 314 1.9.2.2 bouyer u_int x; 315 1.9.2.2 bouyer 316 1.9.2.2 bouyer x = gmac_read_reg(sc, GMAC_RXDMACONFIG); 317 1.9.2.2 bouyer x &= ~1; 318 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_RXDMACONFIG, x); 319 1.9.2.2 bouyer x = gmac_read_reg(sc, GMAC_RXMACCONFIG); 320 1.9.2.2 bouyer x &= ~1; 321 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_RXMACCONFIG, x); 322 1.9.2.2 bouyer } 323 1.9.2.2 bouyer 324 1.9.2.2 bouyer int 325 1.9.2.2 bouyer gmac_intr(v) 326 1.9.2.2 bouyer void *v; 327 1.9.2.2 bouyer { 328 1.9.2.2 bouyer struct gmac_softc *sc = v; 329 1.9.2.2 bouyer u_int status; 330 1.9.2.2 bouyer 331 1.9.2.2 bouyer status = gmac_read_reg(sc, GMAC_STATUS) & 0xff; 332 1.9.2.2 bouyer if (status == 0) 333 1.9.2.2 bouyer return 0; 334 1.9.2.2 bouyer 335 1.9.2.2 bouyer if (status & GMAC_INT_RXDONE) 336 1.9.2.2 bouyer gmac_rint(sc); 337 1.9.2.2 bouyer 338 1.9.2.2 bouyer if (status & GMAC_INT_TXEMPTY) 339 1.9.2.2 bouyer gmac_tint(sc); 340 1.9.2.2 bouyer 341 1.9.2.2 bouyer return 1; 342 1.9.2.2 bouyer } 343 1.9.2.2 bouyer 344 1.9.2.2 bouyer void 345 1.9.2.2 bouyer gmac_tint(sc) 346 1.9.2.2 bouyer struct gmac_softc *sc; 347 1.9.2.2 bouyer { 348 1.9.2.2 bouyer struct ifnet *ifp = &sc->sc_if; 349 1.9.2.2 bouyer 350 1.9.2.2 bouyer ifp->if_flags &= ~IFF_OACTIVE; 351 1.9.2.2 bouyer ifp->if_timer = 0; 352 1.9.2.2 bouyer gmac_start(ifp); 353 1.9.2.2 bouyer } 354 1.9.2.2 bouyer 355 1.9.2.2 bouyer void 356 1.9.2.2 bouyer gmac_rint(sc) 357 1.9.2.2 bouyer struct gmac_softc *sc; 358 1.9.2.2 bouyer { 359 1.9.2.2 bouyer struct ifnet *ifp = &sc->sc_if; 360 1.9.2.2 bouyer volatile struct gmac_dma *dp; 361 1.9.2.2 bouyer struct mbuf *m; 362 1.9.2.2 bouyer int i, len; 363 1.9.2.2 bouyer u_int cmd; 364 1.9.2.2 bouyer 365 1.9.2.2 bouyer for (i = sc->sc_rxlast;; i++) { 366 1.9.2.2 bouyer if (i == NRXBUF) 367 1.9.2.2 bouyer i = 0; 368 1.9.2.2 bouyer 369 1.9.2.2 bouyer dp = &sc->sc_rxlist[i]; 370 1.9.2.2 bouyer cmd = le32toh(dp->cmd); 371 1.9.2.2 bouyer if (cmd & GMAC_OWN) 372 1.9.2.2 bouyer break; 373 1.9.2.2 bouyer len = (cmd >> 16) & GMAC_LEN_MASK; 374 1.9.2.2 bouyer len -= 4; /* CRC */ 375 1.9.2.2 bouyer 376 1.9.2.2 bouyer if (le32toh(dp->cmd_hi) & 0x40000000) { 377 1.9.2.2 bouyer ifp->if_ierrors++; 378 1.9.2.2 bouyer goto next; 379 1.9.2.2 bouyer } 380 1.9.2.2 bouyer 381 1.9.2.2 bouyer m = gmac_get(sc, sc->sc_rxbuf[i], len); 382 1.9.2.2 bouyer if (m == NULL) { 383 1.9.2.2 bouyer ifp->if_ierrors++; 384 1.9.2.2 bouyer goto next; 385 1.9.2.2 bouyer } 386 1.9.2.2 bouyer 387 1.9.2.2 bouyer #if NBPFILTER > 0 388 1.9.2.2 bouyer /* 389 1.9.2.2 bouyer * Check if there's a BPF listener on this interface. 390 1.9.2.2 bouyer * If so, hand off the raw packet to BPF. 391 1.9.2.2 bouyer */ 392 1.9.2.2 bouyer if (ifp->if_bpf) 393 1.9.2.2 bouyer bpf_tap(ifp->if_bpf, sc->sc_rxbuf[i], len); 394 1.9.2.2 bouyer #endif 395 1.9.2.2 bouyer (*ifp->if_input)(ifp, m); 396 1.9.2.2 bouyer ifp->if_ipackets++; 397 1.9.2.2 bouyer 398 1.9.2.2 bouyer next: 399 1.9.2.2 bouyer dp->cmd_hi = 0; 400 1.9.2.2 bouyer __asm __volatile ("sync"); 401 1.9.2.2 bouyer dp->cmd = htole32(GMAC_OWN); 402 1.9.2.2 bouyer } 403 1.9.2.2 bouyer sc->sc_rxlast = i; 404 1.9.2.2 bouyer } 405 1.9.2.2 bouyer 406 1.9.2.2 bouyer struct mbuf * 407 1.9.2.2 bouyer gmac_get(sc, pkt, totlen) 408 1.9.2.2 bouyer struct gmac_softc *sc; 409 1.9.2.2 bouyer caddr_t pkt; 410 1.9.2.2 bouyer int totlen; 411 1.9.2.2 bouyer { 412 1.9.2.2 bouyer struct mbuf *m; 413 1.9.2.2 bouyer struct mbuf *top, **mp; 414 1.9.2.2 bouyer int len; 415 1.9.2.2 bouyer 416 1.9.2.2 bouyer MGETHDR(m, M_DONTWAIT, MT_DATA); 417 1.9.2.2 bouyer if (m == 0) 418 1.9.2.2 bouyer return 0; 419 1.9.2.2 bouyer m->m_pkthdr.rcvif = &sc->sc_if; 420 1.9.2.2 bouyer m->m_pkthdr.len = totlen; 421 1.9.2.2 bouyer len = MHLEN; 422 1.9.2.2 bouyer top = 0; 423 1.9.2.2 bouyer mp = ⊤ 424 1.9.2.2 bouyer 425 1.9.2.2 bouyer while (totlen > 0) { 426 1.9.2.2 bouyer if (top) { 427 1.9.2.2 bouyer MGET(m, M_DONTWAIT, MT_DATA); 428 1.9.2.2 bouyer if (m == 0) { 429 1.9.2.2 bouyer m_freem(top); 430 1.9.2.2 bouyer return 0; 431 1.9.2.2 bouyer } 432 1.9.2.2 bouyer len = MLEN; 433 1.9.2.2 bouyer } 434 1.9.2.2 bouyer if (totlen >= MINCLSIZE) { 435 1.9.2.2 bouyer MCLGET(m, M_DONTWAIT); 436 1.9.2.2 bouyer if ((m->m_flags & M_EXT) == 0) { 437 1.9.2.2 bouyer m_free(m); 438 1.9.2.2 bouyer m_freem(top); 439 1.9.2.2 bouyer return 0; 440 1.9.2.2 bouyer } 441 1.9.2.2 bouyer len = MCLBYTES; 442 1.9.2.2 bouyer } 443 1.9.2.2 bouyer m->m_len = len = min(totlen, len); 444 1.9.2.2 bouyer bcopy(pkt, mtod(m, caddr_t), len); 445 1.9.2.2 bouyer pkt += len; 446 1.9.2.2 bouyer totlen -= len; 447 1.9.2.2 bouyer *mp = m; 448 1.9.2.2 bouyer mp = &m->m_next; 449 1.9.2.2 bouyer } 450 1.9.2.2 bouyer 451 1.9.2.2 bouyer return top; 452 1.9.2.2 bouyer } 453 1.9.2.2 bouyer 454 1.9.2.2 bouyer void 455 1.9.2.2 bouyer gmac_start(ifp) 456 1.9.2.2 bouyer struct ifnet *ifp; 457 1.9.2.2 bouyer { 458 1.9.2.2 bouyer struct gmac_softc *sc = ifp->if_softc; 459 1.9.2.2 bouyer struct mbuf *m; 460 1.9.2.2 bouyer caddr_t buff; 461 1.9.2.2 bouyer int i, tlen; 462 1.9.2.2 bouyer volatile struct gmac_dma *dp; 463 1.9.2.2 bouyer 464 1.9.2.2 bouyer if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING) 465 1.9.2.2 bouyer return; 466 1.9.2.2 bouyer 467 1.9.2.2 bouyer for (;;) { 468 1.9.2.2 bouyer if (ifp->if_flags & IFF_OACTIVE) 469 1.9.2.2 bouyer break; 470 1.9.2.2 bouyer 471 1.9.2.2 bouyer IF_DEQUEUE(&ifp->if_snd, m); 472 1.9.2.2 bouyer if (m == 0) 473 1.9.2.2 bouyer break; 474 1.9.2.2 bouyer 475 1.9.2.2 bouyer /* 5 seconds to watch for failing to transmit */ 476 1.9.2.2 bouyer ifp->if_timer = 5; 477 1.9.2.2 bouyer ifp->if_opackets++; /* # of pkts */ 478 1.9.2.2 bouyer 479 1.9.2.2 bouyer i = sc->sc_txnext; 480 1.9.2.2 bouyer buff = sc->sc_txbuf[i]; 481 1.9.2.2 bouyer tlen = gmac_put(sc, buff, m); 482 1.9.2.2 bouyer 483 1.9.2.2 bouyer dp = &sc->sc_txlist[i]; 484 1.9.2.2 bouyer dp->cmd_hi = 0; 485 1.9.2.2 bouyer dp->address_hi = 0; 486 1.9.2.2 bouyer dp->cmd = htole32(tlen | GMAC_OWN | GMAC_SOP); 487 1.9.2.2 bouyer 488 1.9.2.2 bouyer i++; 489 1.9.2.2 bouyer if (i == NTXBUF) 490 1.9.2.2 bouyer i = 0; 491 1.9.2.2 bouyer __asm __volatile ("sync"); 492 1.9.2.2 bouyer 493 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_TXDMAKICK, i); 494 1.9.2.2 bouyer sc->sc_txnext = i; 495 1.9.2.2 bouyer 496 1.9.2.2 bouyer #if NBPFILTER > 0 497 1.9.2.2 bouyer /* 498 1.9.2.2 bouyer * If BPF is listening on this interface, let it see the 499 1.9.2.2 bouyer * packet before we commit it to the wire. 500 1.9.2.2 bouyer */ 501 1.9.2.2 bouyer if (ifp->if_bpf) 502 1.9.2.2 bouyer bpf_tap(ifp->if_bpf, buff, tlen); 503 1.9.2.2 bouyer #endif 504 1.9.2.2 bouyer 505 1.9.2.2 bouyer i++; 506 1.9.2.2 bouyer if (i == NTXBUF) 507 1.9.2.2 bouyer i = 0; 508 1.9.2.2 bouyer if (i == gmac_read_reg(sc, GMAC_TXDMACOMPLETE)) { 509 1.9.2.2 bouyer ifp->if_flags |= IFF_OACTIVE; 510 1.9.2.2 bouyer break; 511 1.9.2.2 bouyer } 512 1.9.2.2 bouyer } 513 1.9.2.2 bouyer } 514 1.9.2.2 bouyer 515 1.9.2.2 bouyer int 516 1.9.2.2 bouyer gmac_put(sc, buff, m) 517 1.9.2.2 bouyer struct gmac_softc *sc; 518 1.9.2.2 bouyer caddr_t buff; 519 1.9.2.2 bouyer struct mbuf *m; 520 1.9.2.2 bouyer { 521 1.9.2.2 bouyer struct mbuf *n; 522 1.9.2.2 bouyer int len, tlen = 0; 523 1.9.2.2 bouyer 524 1.9.2.2 bouyer for (; m; m = n) { 525 1.9.2.2 bouyer len = m->m_len; 526 1.9.2.2 bouyer if (len == 0) { 527 1.9.2.2 bouyer MFREE(m, n); 528 1.9.2.2 bouyer continue; 529 1.9.2.2 bouyer } 530 1.9.2.2 bouyer bcopy(mtod(m, caddr_t), buff, len); 531 1.9.2.2 bouyer buff += len; 532 1.9.2.2 bouyer tlen += len; 533 1.9.2.2 bouyer MFREE(m, n); 534 1.9.2.2 bouyer } 535 1.9.2.2 bouyer if (tlen > 2048) 536 1.9.2.2 bouyer panic("%s: gmac_put packet overflow", sc->sc_dev.dv_xname); 537 1.9.2.2 bouyer 538 1.9.2.2 bouyer return tlen; 539 1.9.2.2 bouyer } 540 1.9.2.2 bouyer 541 1.9.2.2 bouyer void 542 1.9.2.2 bouyer gmac_reset(sc) 543 1.9.2.2 bouyer struct gmac_softc *sc; 544 1.9.2.2 bouyer { 545 1.9.2.2 bouyer int i, s; 546 1.9.2.2 bouyer 547 1.9.2.2 bouyer s = splnet(); 548 1.9.2.2 bouyer 549 1.9.2.2 bouyer gmac_stop_txdma(sc); 550 1.9.2.2 bouyer gmac_stop_rxdma(sc); 551 1.9.2.2 bouyer 552 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_SOFTWARERESET, 3); 553 1.9.2.2 bouyer for (i = 10; i > 0; i--) { 554 1.9.2.2 bouyer delay(300000); /* XXX long delay */ 555 1.9.2.2 bouyer if ((gmac_read_reg(sc, GMAC_SOFTWARERESET) & 3) == 0) 556 1.9.2.2 bouyer break; 557 1.9.2.2 bouyer } 558 1.9.2.2 bouyer if (i == 0) 559 1.9.2.2 bouyer printf("%s: reset timeout\n", sc->sc_dev.dv_xname); 560 1.9.2.2 bouyer 561 1.9.2.2 bouyer sc->sc_txnext = 0; 562 1.9.2.2 bouyer sc->sc_rxlast = 0; 563 1.9.2.2 bouyer for (i = 0; i < NRXBUF; i++) 564 1.9.2.2 bouyer sc->sc_rxlist[i].cmd = htole32(GMAC_OWN); 565 1.9.2.2 bouyer __asm __volatile ("sync"); 566 1.9.2.2 bouyer 567 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_TXDMADESCBASEHI, 0); 568 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_TXDMADESCBASELO, 569 1.9.2.2 bouyer vtophys((vaddr_t)sc->sc_txlist)); 570 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_RXDMADESCBASEHI, 0); 571 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_RXDMADESCBASELO, 572 1.9.2.2 bouyer vtophys((vaddr_t)sc->sc_rxlist)); 573 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_RXDMAKICK, NRXBUF); 574 1.9.2.2 bouyer 575 1.9.2.2 bouyer splx(s); 576 1.9.2.2 bouyer } 577 1.9.2.2 bouyer 578 1.9.2.2 bouyer void 579 1.9.2.2 bouyer gmac_stop(sc) 580 1.9.2.2 bouyer struct gmac_softc *sc; 581 1.9.2.2 bouyer { 582 1.9.2.2 bouyer struct ifnet *ifp = &sc->sc_if; 583 1.9.2.2 bouyer int s; 584 1.9.2.2 bouyer 585 1.9.2.2 bouyer s = splnet(); 586 1.9.2.2 bouyer 587 1.9.2.2 bouyer callout_stop(&sc->sc_tick_ch); 588 1.9.2.2 bouyer mii_down(&sc->sc_mii); 589 1.9.2.2 bouyer 590 1.9.2.2 bouyer gmac_stop_txdma(sc); 591 1.9.2.2 bouyer gmac_stop_rxdma(sc); 592 1.9.2.2 bouyer 593 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_INTMASK, 0xffffffff); 594 1.9.2.2 bouyer 595 1.9.2.2 bouyer ifp->if_flags &= ~(IFF_UP | IFF_RUNNING); 596 1.9.2.2 bouyer ifp->if_timer = 0; 597 1.9.2.2 bouyer 598 1.9.2.2 bouyer splx(s); 599 1.9.2.2 bouyer } 600 1.9.2.2 bouyer 601 1.9.2.2 bouyer void 602 1.9.2.2 bouyer gmac_init_mac(sc) 603 1.9.2.2 bouyer struct gmac_softc *sc; 604 1.9.2.2 bouyer { 605 1.9.2.2 bouyer int i, tb; 606 1.9.2.2 bouyer char *laddr = sc->sc_laddr; 607 1.9.2.2 bouyer 608 1.9.2.2 bouyer __asm ("mftb %0" : "=r"(tb)); 609 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_RANDOMSEED, tb); 610 1.9.2.2 bouyer 611 1.9.2.2 bouyer /* init-mii */ 612 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_DATAPATHMODE, 4); 613 1.9.2.2 bouyer gmac_mii_writereg(&sc->sc_dev, 0, 0, 0x1000); 614 1.9.2.2 bouyer 615 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_TXDMACONFIG, 0xffc00); 616 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_RXDMACONFIG, 0); 617 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACPAUSE, 0x1bf0); 618 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_INTERPACKETGAP0, 0); 619 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_INTERPACKETGAP1, 8); 620 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_INTERPACKETGAP2, 4); 621 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MINFRAMESIZE, ETHER_MIN_LEN); 622 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MAXFRAMESIZE, ETHER_MAX_LEN); 623 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_PASIZE, 7); 624 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_JAMSIZE, 4); 625 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_ATTEMPTLIMIT,0x10); 626 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACCNTLTYPE, 0x8808); 627 1.9.2.2 bouyer 628 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACADDRESS0, (laddr[4] << 8) | laddr[5]); 629 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACADDRESS1, (laddr[2] << 8) | laddr[3]); 630 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACADDRESS2, (laddr[0] << 8) | laddr[1]); 631 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACADDRESS3, 0); 632 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACADDRESS4, 0); 633 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACADDRESS5, 0); 634 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACADDRESS6, 1); 635 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACADDRESS7, 0xc200); 636 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACADDRESS8, 0x0180); 637 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACADDRFILT0, 0); 638 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACADDRFILT1, 0); 639 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACADDRFILT2, 0); 640 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACADDRFILT2_1MASK, 0); 641 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACADDRFILT0MASK, 0); 642 1.9.2.2 bouyer 643 1.9.2.2 bouyer for (i = 0; i < 0x6c; i += 4) 644 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_HASHTABLE0 + i, 0); 645 1.9.2.2 bouyer 646 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_SLOTTIME, 0x40); 647 1.9.2.2 bouyer 648 1.9.2.2 bouyer if (IFM_OPTIONS(sc->sc_mii.mii_media_active) & IFM_FDX) { 649 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_TXMACCONFIG, 6); 650 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_XIFCONFIG, 1); 651 1.9.2.2 bouyer } else { 652 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_TXMACCONFIG, 0); 653 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_XIFCONFIG, 5); 654 1.9.2.2 bouyer } 655 1.9.2.2 bouyer 656 1.9.2.2 bouyer if (0) /* g-bit? */ 657 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACCTRLCONFIG, 3); 658 1.9.2.2 bouyer else 659 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACCTRLCONFIG, 0); 660 1.9.2.2 bouyer } 661 1.9.2.2 bouyer 662 1.9.2.2 bouyer void 663 1.9.2.2 bouyer gmac_setladrf(sc) 664 1.9.2.2 bouyer struct gmac_softc *sc; 665 1.9.2.2 bouyer { 666 1.9.2.2 bouyer struct ifnet *ifp = &sc->sc_if; 667 1.9.2.2 bouyer struct ether_multi *enm; 668 1.9.2.2 bouyer struct ether_multistep step; 669 1.9.2.2 bouyer struct ethercom *ec = &sc->sc_ethercom; 670 1.9.2.2 bouyer u_int32_t crc; 671 1.9.2.2 bouyer u_int32_t hash[16]; 672 1.9.2.2 bouyer u_int v; 673 1.9.2.2 bouyer int i; 674 1.9.2.2 bouyer 675 1.9.2.2 bouyer /* Clear hash table */ 676 1.9.2.2 bouyer for (i = 0; i < 16; i++) 677 1.9.2.2 bouyer hash[i] = 0; 678 1.9.2.2 bouyer 679 1.9.2.2 bouyer /* Get current RX configuration */ 680 1.9.2.2 bouyer v = gmac_read_reg(sc, GMAC_RXMACCONFIG); 681 1.9.2.2 bouyer 682 1.9.2.2 bouyer if ((ifp->if_flags & IFF_PROMISC) != 0) { 683 1.9.2.2 bouyer /* Turn on promiscuous mode; turn off the hash filter */ 684 1.9.2.2 bouyer v |= GMAC_RXMAC_PR; 685 1.9.2.2 bouyer v &= ~GMAC_RXMAC_HEN; 686 1.9.2.2 bouyer ifp->if_flags |= IFF_ALLMULTI; 687 1.9.2.2 bouyer goto chipit; 688 1.9.2.2 bouyer } 689 1.9.2.2 bouyer 690 1.9.2.2 bouyer /* Turn off promiscuous mode; turn on the hash filter */ 691 1.9.2.2 bouyer v &= ~GMAC_RXMAC_PR; 692 1.9.2.2 bouyer v |= GMAC_RXMAC_HEN; 693 1.9.2.2 bouyer 694 1.9.2.2 bouyer /* 695 1.9.2.2 bouyer * Set up multicast address filter by passing all multicast addresses 696 1.9.2.2 bouyer * through a crc generator, and then using the high order 8 bits as an 697 1.9.2.2 bouyer * index into the 256 bit logical address filter. The high order bit 698 1.9.2.2 bouyer * selects the word, while the rest of the bits select the bit within 699 1.9.2.2 bouyer * the word. 700 1.9.2.2 bouyer */ 701 1.9.2.2 bouyer 702 1.9.2.2 bouyer ETHER_FIRST_MULTI(step, ec, enm); 703 1.9.2.2 bouyer while (enm != NULL) { 704 1.9.2.2 bouyer if (bcmp(enm->enm_addrlo, enm->enm_addrhi, 6)) { 705 1.9.2.2 bouyer /* 706 1.9.2.2 bouyer * We must listen to a range of multicast addresses. 707 1.9.2.2 bouyer * For now, just accept all multicasts, rather than 708 1.9.2.2 bouyer * trying to set only those filter bits needed to match 709 1.9.2.2 bouyer * the range. (At this time, the only use of address 710 1.9.2.2 bouyer * ranges is for IP multicast routing, for which the 711 1.9.2.2 bouyer * range is big enough to require all bits set.) 712 1.9.2.2 bouyer */ 713 1.9.2.2 bouyer for (i = 0; i < 16; i++) 714 1.9.2.2 bouyer hash[i] = 0xffff; 715 1.9.2.2 bouyer ifp->if_flags |= IFF_ALLMULTI; 716 1.9.2.2 bouyer goto chipit; 717 1.9.2.2 bouyer } 718 1.9.2.2 bouyer 719 1.9.2.2 bouyer crc = ether_crc32_le(enm->enm_addrlo, ETHER_ADDR_LEN); 720 1.9.2.2 bouyer 721 1.9.2.2 bouyer /* Just want the 8 most significant bits. */ 722 1.9.2.2 bouyer crc >>= 24; 723 1.9.2.2 bouyer 724 1.9.2.2 bouyer /* Set the corresponding bit in the filter. */ 725 1.9.2.2 bouyer hash[crc >> 4] |= 1 << (crc & 0xf); 726 1.9.2.2 bouyer 727 1.9.2.2 bouyer ETHER_NEXT_MULTI(step, enm); 728 1.9.2.2 bouyer } 729 1.9.2.2 bouyer 730 1.9.2.2 bouyer ifp->if_flags &= ~IFF_ALLMULTI; 731 1.9.2.2 bouyer 732 1.9.2.2 bouyer chipit: 733 1.9.2.2 bouyer /* Now load the hash table into the chip */ 734 1.9.2.2 bouyer for (i = 0; i < 16; i++) 735 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_HASHTABLE0 + i * 4, hash[i]); 736 1.9.2.2 bouyer 737 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_RXMACCONFIG, v); 738 1.9.2.2 bouyer } 739 1.9.2.2 bouyer 740 1.9.2.2 bouyer void 741 1.9.2.2 bouyer gmac_init(sc) 742 1.9.2.2 bouyer struct gmac_softc *sc; 743 1.9.2.2 bouyer { 744 1.9.2.2 bouyer struct ifnet *ifp = &sc->sc_if; 745 1.9.2.2 bouyer 746 1.9.2.2 bouyer gmac_stop_txdma(sc); 747 1.9.2.2 bouyer gmac_stop_rxdma(sc); 748 1.9.2.2 bouyer 749 1.9.2.2 bouyer gmac_init_mac(sc); 750 1.9.2.2 bouyer gmac_setladrf(sc); 751 1.9.2.2 bouyer 752 1.9.2.2 bouyer gmac_start_txdma(sc); 753 1.9.2.2 bouyer gmac_start_rxdma(sc); 754 1.9.2.2 bouyer 755 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_INTMASK, ~(GMAC_INT_TXEMPTY | GMAC_INT_RXDONE)); 756 1.9.2.2 bouyer 757 1.9.2.2 bouyer ifp->if_flags |= IFF_RUNNING; 758 1.9.2.2 bouyer ifp->if_flags &= ~IFF_OACTIVE; 759 1.9.2.2 bouyer ifp->if_timer = 0; 760 1.9.2.2 bouyer 761 1.9.2.2 bouyer callout_reset(&sc->sc_tick_ch, 1, gmac_mii_tick, sc); 762 1.9.2.2 bouyer 763 1.9.2.2 bouyer gmac_start(ifp); 764 1.9.2.2 bouyer } 765 1.9.2.2 bouyer 766 1.9.2.2 bouyer int 767 1.9.2.2 bouyer gmac_ioctl(ifp, cmd, data) 768 1.9.2.2 bouyer struct ifnet *ifp; 769 1.9.2.2 bouyer u_long cmd; 770 1.9.2.2 bouyer caddr_t data; 771 1.9.2.2 bouyer { 772 1.9.2.2 bouyer struct gmac_softc *sc = ifp->if_softc; 773 1.9.2.2 bouyer struct ifaddr *ifa = (struct ifaddr *)data; 774 1.9.2.2 bouyer struct ifreq *ifr = (struct ifreq *)data; 775 1.9.2.2 bouyer int s, error = 0; 776 1.9.2.2 bouyer 777 1.9.2.2 bouyer s = splnet(); 778 1.9.2.2 bouyer 779 1.9.2.2 bouyer switch (cmd) { 780 1.9.2.2 bouyer 781 1.9.2.2 bouyer case SIOCSIFADDR: 782 1.9.2.2 bouyer ifp->if_flags |= IFF_UP; 783 1.9.2.2 bouyer 784 1.9.2.2 bouyer switch (ifa->ifa_addr->sa_family) { 785 1.9.2.2 bouyer #ifdef INET 786 1.9.2.2 bouyer case AF_INET: 787 1.9.2.2 bouyer gmac_init(sc); 788 1.9.2.2 bouyer arp_ifinit(ifp, ifa); 789 1.9.2.2 bouyer break; 790 1.9.2.2 bouyer #endif 791 1.9.2.2 bouyer #ifdef NS 792 1.9.2.2 bouyer case AF_NS: 793 1.9.2.2 bouyer { 794 1.9.2.2 bouyer struct ns_addr *ina = &IA_SNS(ifa)->sns_addr; 795 1.9.2.2 bouyer 796 1.9.2.2 bouyer if (ns_nullhost(*ina)) 797 1.9.2.2 bouyer ina->x_host = 798 1.9.2.2 bouyer *(union ns_host *)LLADDR(ifp->if_sadl); 799 1.9.2.2 bouyer else { 800 1.9.2.2 bouyer bcopy(ina->x_host.c_host, 801 1.9.2.2 bouyer LLADDR(ifp->if_sadl), 802 1.9.2.2 bouyer sizeof(sc->sc_enaddr)); 803 1.9.2.2 bouyer } 804 1.9.2.2 bouyer /* Set new address. */ 805 1.9.2.2 bouyer gmac_init(sc); 806 1.9.2.2 bouyer break; 807 1.9.2.2 bouyer } 808 1.9.2.2 bouyer #endif 809 1.9.2.2 bouyer default: 810 1.9.2.2 bouyer gmac_init(sc); 811 1.9.2.2 bouyer break; 812 1.9.2.2 bouyer } 813 1.9.2.2 bouyer break; 814 1.9.2.2 bouyer 815 1.9.2.2 bouyer case SIOCSIFFLAGS: 816 1.9.2.2 bouyer if ((ifp->if_flags & IFF_UP) == 0 && 817 1.9.2.2 bouyer (ifp->if_flags & IFF_RUNNING) != 0) { 818 1.9.2.2 bouyer /* 819 1.9.2.2 bouyer * If interface is marked down and it is running, then 820 1.9.2.2 bouyer * stop it. 821 1.9.2.2 bouyer */ 822 1.9.2.2 bouyer gmac_stop(sc); 823 1.9.2.2 bouyer ifp->if_flags &= ~IFF_RUNNING; 824 1.9.2.2 bouyer } else if ((ifp->if_flags & IFF_UP) != 0 && 825 1.9.2.2 bouyer (ifp->if_flags & IFF_RUNNING) == 0) { 826 1.9.2.2 bouyer /* 827 1.9.2.2 bouyer * If interface is marked up and it is stopped, then 828 1.9.2.2 bouyer * start it. 829 1.9.2.2 bouyer */ 830 1.9.2.2 bouyer gmac_init(sc); 831 1.9.2.2 bouyer } else { 832 1.9.2.2 bouyer /* 833 1.9.2.2 bouyer * Reset the interface to pick up changes in any other 834 1.9.2.2 bouyer * flags that affect hardware registers. 835 1.9.2.2 bouyer */ 836 1.9.2.2 bouyer gmac_reset(sc); 837 1.9.2.2 bouyer gmac_init(sc); 838 1.9.2.2 bouyer } 839 1.9.2.2 bouyer #ifdef GMAC_DEBUG 840 1.9.2.2 bouyer if (ifp->if_flags & IFF_DEBUG) 841 1.9.2.2 bouyer sc->sc_flags |= GMAC_DEBUGFLAG; 842 1.9.2.2 bouyer #endif 843 1.9.2.2 bouyer break; 844 1.9.2.2 bouyer 845 1.9.2.2 bouyer case SIOCADDMULTI: 846 1.9.2.2 bouyer case SIOCDELMULTI: 847 1.9.2.2 bouyer error = (cmd == SIOCADDMULTI) ? 848 1.9.2.2 bouyer ether_addmulti(ifr, &sc->sc_ethercom) : 849 1.9.2.2 bouyer ether_delmulti(ifr, &sc->sc_ethercom); 850 1.9.2.2 bouyer 851 1.9.2.2 bouyer if (error == ENETRESET) { 852 1.9.2.2 bouyer /* 853 1.9.2.2 bouyer * Multicast list has changed; set the hardware filter 854 1.9.2.2 bouyer * accordingly. 855 1.9.2.2 bouyer */ 856 1.9.2.2 bouyer gmac_init(sc); 857 1.9.2.2 bouyer /* gmac_setladrf(sc); */ 858 1.9.2.2 bouyer error = 0; 859 1.9.2.2 bouyer } 860 1.9.2.2 bouyer break; 861 1.9.2.2 bouyer 862 1.9.2.2 bouyer case SIOCGIFMEDIA: 863 1.9.2.2 bouyer case SIOCSIFMEDIA: 864 1.9.2.2 bouyer error = ifmedia_ioctl(ifp, ifr, &sc->sc_mii.mii_media, cmd); 865 1.9.2.2 bouyer break; 866 1.9.2.2 bouyer 867 1.9.2.2 bouyer default: 868 1.9.2.2 bouyer error = EINVAL; 869 1.9.2.2 bouyer } 870 1.9.2.2 bouyer 871 1.9.2.2 bouyer splx(s); 872 1.9.2.2 bouyer return error; 873 1.9.2.2 bouyer } 874 1.9.2.2 bouyer 875 1.9.2.2 bouyer void 876 1.9.2.2 bouyer gmac_watchdog(ifp) 877 1.9.2.2 bouyer struct ifnet *ifp; 878 1.9.2.2 bouyer { 879 1.9.2.2 bouyer struct gmac_softc *sc = ifp->if_softc; 880 1.9.2.2 bouyer 881 1.9.2.2 bouyer printf("%s: device timeout\n", ifp->if_xname); 882 1.9.2.2 bouyer ifp->if_oerrors++; 883 1.9.2.2 bouyer 884 1.9.2.2 bouyer gmac_reset(sc); 885 1.9.2.2 bouyer gmac_init(sc); 886 1.9.2.2 bouyer } 887 1.9.2.2 bouyer 888 1.9.2.2 bouyer int 889 1.9.2.2 bouyer gmac_mediachange(ifp) 890 1.9.2.2 bouyer struct ifnet *ifp; 891 1.9.2.2 bouyer { 892 1.9.2.2 bouyer struct gmac_softc *sc = ifp->if_softc; 893 1.9.2.2 bouyer 894 1.9.2.2 bouyer return mii_mediachg(&sc->sc_mii); 895 1.9.2.2 bouyer } 896 1.9.2.2 bouyer 897 1.9.2.2 bouyer void 898 1.9.2.2 bouyer gmac_mediastatus(ifp, ifmr) 899 1.9.2.2 bouyer struct ifnet *ifp; 900 1.9.2.2 bouyer struct ifmediareq *ifmr; 901 1.9.2.2 bouyer { 902 1.9.2.2 bouyer struct gmac_softc *sc = ifp->if_softc; 903 1.9.2.2 bouyer 904 1.9.2.2 bouyer mii_pollstat(&sc->sc_mii); 905 1.9.2.2 bouyer 906 1.9.2.2 bouyer ifmr->ifm_status = sc->sc_mii.mii_media_status; 907 1.9.2.2 bouyer ifmr->ifm_active = sc->sc_mii.mii_media_active; 908 1.9.2.2 bouyer } 909 1.9.2.2 bouyer 910 1.9.2.2 bouyer int 911 1.9.2.2 bouyer gmac_mii_readreg(dev, phy, reg) 912 1.9.2.2 bouyer struct device *dev; 913 1.9.2.2 bouyer int phy, reg; 914 1.9.2.2 bouyer { 915 1.9.2.2 bouyer struct gmac_softc *sc = (void *)dev; 916 1.9.2.2 bouyer int i; 917 1.9.2.2 bouyer 918 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MIFFRAMEOUTPUT, 919 1.9.2.2 bouyer 0x60020000 | (phy << 23) | (reg << 18)); 920 1.9.2.2 bouyer 921 1.9.2.2 bouyer for (i = 1000; i >= 0; i -= 10) { 922 1.9.2.2 bouyer if (gmac_read_reg(sc, GMAC_MIFFRAMEOUTPUT) & 0x10000) 923 1.9.2.2 bouyer break; 924 1.9.2.2 bouyer delay(10); 925 1.9.2.2 bouyer } 926 1.9.2.2 bouyer if (i < 0) { 927 1.9.2.2 bouyer printf("%s: gmac_mii_readreg: timeout\n", sc->sc_dev.dv_xname); 928 1.9.2.2 bouyer return 0; 929 1.9.2.2 bouyer } 930 1.9.2.2 bouyer 931 1.9.2.2 bouyer return gmac_read_reg(sc, GMAC_MIFFRAMEOUTPUT) & 0xffff; 932 1.9.2.2 bouyer } 933 1.9.2.2 bouyer 934 1.9.2.2 bouyer void 935 1.9.2.2 bouyer gmac_mii_writereg(dev, phy, reg, val) 936 1.9.2.2 bouyer struct device *dev; 937 1.9.2.2 bouyer int phy, reg, val; 938 1.9.2.2 bouyer { 939 1.9.2.2 bouyer struct gmac_softc *sc = (void *)dev; 940 1.9.2.2 bouyer int i; 941 1.9.2.2 bouyer 942 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MIFFRAMEOUTPUT, 943 1.9.2.2 bouyer 0x50020000 | (phy << 23) | (reg << 18) | (val & 0xffff)); 944 1.9.2.2 bouyer 945 1.9.2.2 bouyer for (i = 1000; i >= 0; i -= 10) { 946 1.9.2.2 bouyer if (gmac_read_reg(sc, GMAC_MIFFRAMEOUTPUT) & 0x10000) 947 1.9.2.2 bouyer break; 948 1.9.2.2 bouyer delay(10); 949 1.9.2.2 bouyer } 950 1.9.2.2 bouyer if (i < 0) 951 1.9.2.2 bouyer printf("%s: gmac_mii_writereg: timeout\n", sc->sc_dev.dv_xname); 952 1.9.2.2 bouyer } 953 1.9.2.2 bouyer 954 1.9.2.2 bouyer void 955 1.9.2.2 bouyer gmac_mii_statchg(dev) 956 1.9.2.2 bouyer struct device *dev; 957 1.9.2.2 bouyer { 958 1.9.2.2 bouyer struct gmac_softc *sc = (void *)dev; 959 1.9.2.2 bouyer 960 1.9.2.2 bouyer gmac_stop_txdma(sc); 961 1.9.2.2 bouyer gmac_stop_rxdma(sc); 962 1.9.2.2 bouyer 963 1.9.2.2 bouyer if (IFM_OPTIONS(sc->sc_mii.mii_media_active) & IFM_FDX) { 964 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_TXMACCONFIG, 6); 965 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_XIFCONFIG, 1); 966 1.9.2.2 bouyer } else { 967 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_TXMACCONFIG, 0); 968 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_XIFCONFIG, 5); 969 1.9.2.2 bouyer } 970 1.9.2.2 bouyer 971 1.9.2.2 bouyer if (0) /* g-bit? */ 972 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACCTRLCONFIG, 3); 973 1.9.2.2 bouyer else 974 1.9.2.2 bouyer gmac_write_reg(sc, GMAC_MACCTRLCONFIG, 0); 975 1.9.2.2 bouyer 976 1.9.2.2 bouyer gmac_start_txdma(sc); 977 1.9.2.2 bouyer gmac_start_rxdma(sc); 978 1.9.2.2 bouyer } 979 1.9.2.2 bouyer 980 1.9.2.2 bouyer void 981 1.9.2.2 bouyer gmac_mii_tick(v) 982 1.9.2.2 bouyer void *v; 983 1.9.2.2 bouyer { 984 1.9.2.2 bouyer struct gmac_softc *sc = v; 985 1.9.2.2 bouyer int s; 986 1.9.2.2 bouyer 987 1.9.2.2 bouyer s = splnet(); 988 1.9.2.2 bouyer mii_tick(&sc->sc_mii); 989 1.9.2.2 bouyer splx(s); 990 1.9.2.2 bouyer 991 1.9.2.2 bouyer callout_reset(&sc->sc_tick_ch, hz, gmac_mii_tick, sc); 992 1.9.2.2 bouyer } 993
Indexes created Thu Oct 23 22:10:10 GMT 2025