1 1.126 riastrad /* $NetBSD: if_tl.c,v 1.126 2024/06/29 12:11:12 riastradh Exp $ */ 2 1.1 bouyer 3 1.1 bouyer /* 4 1.1 bouyer * Copyright (c) 1997 Manuel Bouyer. All rights reserved. 5 1.1 bouyer * 6 1.1 bouyer * Redistribution and use in source and binary forms, with or without 7 1.1 bouyer * modification, are permitted provided that the following conditions 8 1.1 bouyer * are met: 9 1.1 bouyer * 1. Redistributions of source code must retain the above copyright 10 1.1 bouyer * notice, this list of conditions and the following disclaimer. 11 1.1 bouyer * 2. Redistributions in binary form must reproduce the above copyright 12 1.1 bouyer * notice, this list of conditions and the following disclaimer in the 13 1.1 bouyer * documentation and/or other materials provided with the distribution. 14 1.1 bouyer * 15 1.1 bouyer * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 1.1 bouyer * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17 1.1 bouyer * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18 1.1 bouyer * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 19 1.1 bouyer * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 20 1.1 bouyer * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 21 1.1 bouyer * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 22 1.1 bouyer * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 23 1.1 bouyer * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 24 1.1 bouyer * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 25 1.1 bouyer */ 26 1.1 bouyer 27 1.1 bouyer /* 28 1.2 bouyer * Texas Instruments ThunderLAN ethernet controller 29 1.1 bouyer * ThunderLAN Programmer's Guide (TI Literature Number SPWU013A) 30 1.1 bouyer * available from www.ti.com 31 1.1 bouyer */ 32 1.47 lukem 33 1.47 lukem #include <sys/cdefs.h> 34 1.126 riastrad __KERNEL_RCSID(0, "$NetBSD: if_tl.c,v 1.126 2024/06/29 12:11:12 riastradh Exp $"); 35 1.1 bouyer 36 1.1 bouyer #undef TLDEBUG 37 1.1 bouyer #define TL_PRIV_STATS 38 1.1 bouyer #undef TLDEBUG_RX 39 1.1 bouyer #undef TLDEBUG_TX 40 1.1 bouyer #undef TLDEBUG_ADDR 41 1.12 jonathan 42 1.12 jonathan #include "opt_inet.h" 43 1.1 bouyer 44 1.1 bouyer #include <sys/param.h> 45 1.1 bouyer #include <sys/systm.h> 46 1.1 bouyer #include <sys/mbuf.h> 47 1.1 bouyer #include <sys/protosw.h> 48 1.1 bouyer #include <sys/socket.h> 49 1.1 bouyer #include <sys/ioctl.h> 50 1.1 bouyer #include <sys/errno.h> 51 1.1 bouyer #include <sys/malloc.h> 52 1.1 bouyer #include <sys/kernel.h> 53 1.1 bouyer #include <sys/proc.h> /* only for declaration of wakeup() used by vm.h */ 54 1.1 bouyer #include <sys/device.h> 55 1.1 bouyer 56 1.1 bouyer #include <net/if.h> 57 1.1 bouyer #include <net/if_media.h> 58 1.1 bouyer #include <net/if_types.h> 59 1.1 bouyer #include <net/if_dl.h> 60 1.1 bouyer #include <net/route.h> 61 1.1 bouyer #include <net/bpf.h> 62 1.1 bouyer 63 1.102 riastrad #include <sys/rndsource.h> 64 1.67 dan 65 1.1 bouyer #ifdef INET 66 1.1 bouyer #include <netinet/in.h> 67 1.1 bouyer #include <netinet/in_systm.h> 68 1.1 bouyer #include <netinet/in_var.h> 69 1.1 bouyer #include <netinet/ip.h> 70 1.1 bouyer #endif 71 1.1 bouyer 72 1.1 bouyer 73 1.1 bouyer #if defined(__NetBSD__) 74 1.1 bouyer #include <net/if_ether.h> 75 1.1 bouyer #if defined(INET) 76 1.1 bouyer #include <netinet/if_inarp.h> 77 1.1 bouyer #endif 78 1.4 thorpej 79 1.84 ad #include <sys/bus.h> 80 1.84 ad #include <sys/intr.h> 81 1.4 thorpej 82 1.1 bouyer #include <dev/pci/pcireg.h> 83 1.1 bouyer #include <dev/pci/pcivar.h> 84 1.1 bouyer #include <dev/pci/pcidevs.h> 85 1.15 thorpej 86 1.58 thorpej #include <dev/i2c/i2cvar.h> 87 1.58 thorpej #include <dev/i2c/i2c_bitbang.h> 88 1.58 thorpej #include <dev/i2c/at24cxxvar.h> 89 1.15 thorpej 90 1.15 thorpej #include <dev/mii/mii.h> 91 1.15 thorpej #include <dev/mii/miivar.h> 92 1.15 thorpej 93 1.15 thorpej #include <dev/mii/tlphyvar.h> 94 1.15 thorpej 95 1.1 bouyer #include <dev/pci/if_tlregs.h> 96 1.15 thorpej #include <dev/pci/if_tlvar.h> 97 1.1 bouyer #endif /* __NetBSD__ */ 98 1.1 bouyer 99 1.1 bouyer /* number of transmit/receive buffers */ 100 1.59 tsutsui #ifndef TL_NBUF 101 1.62 tsutsui #define TL_NBUF 32 102 1.1 bouyer #endif 103 1.1 bouyer 104 1.89 tsutsui static int tl_pci_match(device_t, cfdata_t, void *); 105 1.89 tsutsui static void tl_pci_attach(device_t, device_t, void *); 106 1.68 perry static int tl_intr(void *); 107 1.68 perry 108 1.82 christos static int tl_ifioctl(struct ifnet *, ioctl_cmd_t, void *); 109 1.68 perry static void tl_ifwatchdog(struct ifnet *); 110 1.92 tsutsui static bool tl_shutdown(device_t, int); 111 1.68 perry 112 1.68 perry static void tl_ifstart(struct ifnet *); 113 1.89 tsutsui static void tl_reset(tl_softc_t *); 114 1.68 perry static int tl_init(struct ifnet *); 115 1.68 perry static void tl_stop(struct ifnet *, int); 116 1.89 tsutsui static void tl_restart(void *); 117 1.89 tsutsui static int tl_add_RxBuff(tl_softc_t *, struct Rx_list *, struct mbuf *); 118 1.89 tsutsui static void tl_read_stats(tl_softc_t *); 119 1.89 tsutsui static void tl_ticks(void *); 120 1.89 tsutsui static int tl_multicast_hash(uint8_t *); 121 1.89 tsutsui static void tl_addr_filter(tl_softc_t *); 122 1.89 tsutsui 123 1.89 tsutsui static uint32_t tl_intreg_read(tl_softc_t *, uint32_t); 124 1.89 tsutsui static void tl_intreg_write(tl_softc_t *, uint32_t, uint32_t); 125 1.89 tsutsui static uint8_t tl_intreg_read_byte(tl_softc_t *, uint32_t); 126 1.89 tsutsui static void tl_intreg_write_byte(tl_softc_t *, uint32_t, uint8_t); 127 1.1 bouyer 128 1.68 perry void tl_mii_sync(struct tl_softc *); 129 1.89 tsutsui void tl_mii_sendbits(struct tl_softc *, uint32_t, int); 130 1.28 tron 131 1.28 tron 132 1.59 tsutsui #if defined(TLDEBUG_RX) 133 1.89 tsutsui static void ether_printheader(struct ether_header *); 134 1.1 bouyer #endif 135 1.1 bouyer 136 1.111 msaitoh int tl_mii_read(device_t, int, int, uint16_t *); 137 1.111 msaitoh int tl_mii_write(device_t, int, int, uint16_t); 138 1.15 thorpej 139 1.98 matt void tl_statchg(struct ifnet *); 140 1.1 bouyer 141 1.58 thorpej /* I2C glue */ 142 1.58 thorpej static int tl_i2c_send_start(void *, int); 143 1.58 thorpej static int tl_i2c_send_stop(void *, int); 144 1.58 thorpej static int tl_i2c_initiate_xfer(void *, i2c_addr_t, int); 145 1.58 thorpej static int tl_i2c_read_byte(void *, uint8_t *, int); 146 1.58 thorpej static int tl_i2c_write_byte(void *, uint8_t, int); 147 1.58 thorpej 148 1.58 thorpej /* I2C bit-bang glue */ 149 1.58 thorpej static void tl_i2cbb_set_bits(void *, uint32_t); 150 1.58 thorpej static void tl_i2cbb_set_dir(void *, uint32_t); 151 1.58 thorpej static uint32_t tl_i2cbb_read(void *); 152 1.58 thorpej static const struct i2c_bitbang_ops tl_i2cbb_ops = { 153 1.58 thorpej tl_i2cbb_set_bits, 154 1.58 thorpej tl_i2cbb_set_dir, 155 1.58 thorpej tl_i2cbb_read, 156 1.58 thorpej { 157 1.58 thorpej TL_NETSIO_EDATA, /* SDA */ 158 1.58 thorpej TL_NETSIO_ECLOCK, /* SCL */ 159 1.58 thorpej TL_NETSIO_ETXEN, /* SDA is output */ 160 1.58 thorpej 0, /* SDA is input */ 161 1.58 thorpej } 162 1.58 thorpej }; 163 1.1 bouyer 164 1.89 tsutsui static inline void netsio_clr(tl_softc_t *, uint8_t); 165 1.89 tsutsui static inline void netsio_set(tl_softc_t *, uint8_t); 166 1.89 tsutsui static inline uint8_t netsio_read(tl_softc_t *, uint8_t); 167 1.89 tsutsui 168 1.89 tsutsui static inline void 169 1.89 tsutsui netsio_clr(tl_softc_t *sc, uint8_t bits) 170 1.1 bouyer { 171 1.89 tsutsui 172 1.1 bouyer tl_intreg_write_byte(sc, TL_INT_NET + TL_INT_NetSio, 173 1.17 bouyer tl_intreg_read_byte(sc, TL_INT_NET + TL_INT_NetSio) & (~bits)); 174 1.1 bouyer } 175 1.89 tsutsui 176 1.89 tsutsui static inline void 177 1.89 tsutsui netsio_set(tl_softc_t *sc, uint8_t bits) 178 1.1 bouyer { 179 1.89 tsutsui 180 1.1 bouyer tl_intreg_write_byte(sc, TL_INT_NET + TL_INT_NetSio, 181 1.17 bouyer tl_intreg_read_byte(sc, TL_INT_NET + TL_INT_NetSio) | bits); 182 1.1 bouyer } 183 1.89 tsutsui 184 1.89 tsutsui static inline uint8_t 185 1.89 tsutsui netsio_read(tl_softc_t *sc, uint8_t bits) 186 1.1 bouyer { 187 1.89 tsutsui 188 1.89 tsutsui return tl_intreg_read_byte(sc, TL_INT_NET + TL_INT_NetSio) & bits; 189 1.1 bouyer } 190 1.1 bouyer 191 1.89 tsutsui CFATTACH_DECL_NEW(tl, sizeof(tl_softc_t), 192 1.56 thorpej tl_pci_match, tl_pci_attach, NULL, NULL); 193 1.1 bouyer 194 1.89 tsutsui static const struct tl_product_desc tl_compaq_products[] = { 195 1.15 thorpej { PCI_PRODUCT_COMPAQ_N100TX, TLPHY_MEDIA_NO_10_T, 196 1.22 tron "Compaq Netelligent 10/100 TX" }, 197 1.65 bouyer { PCI_PRODUCT_COMPAQ_INT100TX, TLPHY_MEDIA_NO_10_T, 198 1.65 bouyer "Integrated Compaq Netelligent 10/100 TX" }, 199 1.15 thorpej { PCI_PRODUCT_COMPAQ_N10T, TLPHY_MEDIA_10_5, 200 1.22 tron "Compaq Netelligent 10 T" }, 201 1.69 bouyer { PCI_PRODUCT_COMPAQ_N10T2, TLPHY_MEDIA_10_2, 202 1.69 bouyer "Compaq Netelligent 10 T/2 UTP/Coax" }, 203 1.15 thorpej { PCI_PRODUCT_COMPAQ_IntNF3P, TLPHY_MEDIA_10_2, 204 1.22 tron "Compaq Integrated NetFlex 3/P" }, 205 1.114 msaitoh { PCI_PRODUCT_COMPAQ_IntPL100TX, TLPHY_MEDIA_10_2 |TLPHY_MEDIA_NO_10_T, 206 1.22 tron "Compaq ProLiant Integrated Netelligent 10/100 TX" }, 207 1.114 msaitoh { PCI_PRODUCT_COMPAQ_DPNet100TX, TLPHY_MEDIA_10_5 |TLPHY_MEDIA_NO_10_T, 208 1.22 tron "Compaq Dual Port Netelligent 10/100 TX" }, 209 1.114 msaitoh { PCI_PRODUCT_COMPAQ_DP4000, TLPHY_MEDIA_10_5 | TLPHY_MEDIA_NO_10_T, 210 1.22 tron "Compaq Deskpro 4000 5233MMX" }, 211 1.15 thorpej { PCI_PRODUCT_COMPAQ_NF3P_BNC, TLPHY_MEDIA_10_2, 212 1.22 tron "Compaq NetFlex 3/P w/ BNC" }, 213 1.15 thorpej { PCI_PRODUCT_COMPAQ_NF3P, TLPHY_MEDIA_10_5, 214 1.22 tron "Compaq NetFlex 3/P" }, 215 1.4 thorpej { 0, 0, NULL }, 216 1.4 thorpej }; 217 1.4 thorpej 218 1.89 tsutsui static const struct tl_product_desc tl_ti_products[] = { 219 1.10 thorpej /* 220 1.10 thorpej * Built-in Ethernet on the TI TravelMate 5000 221 1.10 thorpej * docking station; better product description? 222 1.10 thorpej */ 223 1.15 thorpej { PCI_PRODUCT_TI_TLAN, 0, 224 1.22 tron "Texas Instruments ThunderLAN" }, 225 1.4 thorpej { 0, 0, NULL }, 226 1.4 thorpej }; 227 1.4 thorpej 228 1.4 thorpej struct tl_vendor_desc { 229 1.89 tsutsui uint32_t tv_vendor; 230 1.4 thorpej const struct tl_product_desc *tv_products; 231 1.4 thorpej }; 232 1.4 thorpej 233 1.4 thorpej const struct tl_vendor_desc tl_vendors[] = { 234 1.4 thorpej { PCI_VENDOR_COMPAQ, tl_compaq_products }, 235 1.4 thorpej { PCI_VENDOR_TI, tl_ti_products }, 236 1.4 thorpej { 0, NULL }, 237 1.4 thorpej }; 238 1.4 thorpej 239 1.89 tsutsui static const struct tl_product_desc *tl_lookup_product(uint32_t); 240 1.4 thorpej 241 1.89 tsutsui static const struct tl_product_desc * 242 1.89 tsutsui tl_lookup_product(uint32_t id) 243 1.4 thorpej { 244 1.4 thorpej const struct tl_product_desc *tp; 245 1.4 thorpej const struct tl_vendor_desc *tv; 246 1.4 thorpej 247 1.4 thorpej for (tv = tl_vendors; tv->tv_products != NULL; tv++) 248 1.4 thorpej if (PCI_VENDOR(id) == tv->tv_vendor) 249 1.4 thorpej break; 250 1.4 thorpej 251 1.4 thorpej if ((tp = tv->tv_products) == NULL) 252 1.89 tsutsui return NULL; 253 1.4 thorpej 254 1.4 thorpej for (; tp->tp_desc != NULL; tp++) 255 1.4 thorpej if (PCI_PRODUCT(id) == tp->tp_product) 256 1.4 thorpej break; 257 1.4 thorpej 258 1.4 thorpej if (tp->tp_desc == NULL) 259 1.89 tsutsui return NULL; 260 1.4 thorpej 261 1.89 tsutsui return tp; 262 1.4 thorpej } 263 1.4 thorpej 264 1.1 bouyer static int 265 1.89 tsutsui tl_pci_match(device_t parent, cfdata_t cf, void *aux) 266 1.1 bouyer { 267 1.89 tsutsui struct pci_attach_args *pa = (struct pci_attach_args *)aux; 268 1.1 bouyer 269 1.4 thorpej if (tl_lookup_product(pa->pa_id) != NULL) 270 1.89 tsutsui return 1; 271 1.4 thorpej 272 1.89 tsutsui return 0; 273 1.1 bouyer } 274 1.1 bouyer 275 1.1 bouyer static void 276 1.89 tsutsui tl_pci_attach(device_t parent, device_t self, void *aux) 277 1.1 bouyer { 278 1.89 tsutsui tl_softc_t *sc = device_private(self); 279 1.89 tsutsui struct pci_attach_args * const pa = (struct pci_attach_args *)aux; 280 1.4 thorpej const struct tl_product_desc *tp; 281 1.1 bouyer struct ifnet * const ifp = &sc->tl_if; 282 1.114 msaitoh struct mii_data * const mii = &sc->tl_mii; 283 1.1 bouyer bus_space_tag_t iot, memt; 284 1.1 bouyer bus_space_handle_t ioh, memh; 285 1.1 bouyer pci_intr_handle_t intrhandle; 286 1.4 thorpej const char *intrstr; 287 1.58 thorpej int ioh_valid, memh_valid; 288 1.23 bouyer int reg_io, reg_mem; 289 1.23 bouyer pcireg_t reg10, reg14; 290 1.4 thorpej pcireg_t csr; 291 1.100 christos char intrbuf[PCI_INTRSTR_LEN]; 292 1.4 thorpej 293 1.89 tsutsui sc->sc_dev = self; 294 1.89 tsutsui aprint_normal("\n"); 295 1.4 thorpej 296 1.83 ad callout_init(&sc->tl_tick_ch, 0); 297 1.83 ad callout_init(&sc->tl_restart_ch, 0); 298 1.32 thorpej 299 1.10 thorpej tp = tl_lookup_product(pa->pa_id); 300 1.10 thorpej if (tp == NULL) 301 1.89 tsutsui panic("%s: impossible", __func__); 302 1.15 thorpej sc->tl_product = tp; 303 1.10 thorpej 304 1.23 bouyer /* 305 1.52 wiz * Map the card space. First we have to find the I/O and MEM 306 1.59 tsutsui * registers. I/O is supposed to be at 0x10, MEM at 0x14, 307 1.23 bouyer * but some boards (Compaq Netflex 3/P PCI) seem to have it reversed. 308 1.23 bouyer * The ThunderLAN manual is not consistent about this either (there 309 1.23 bouyer * are both cases in code examples). 310 1.23 bouyer */ 311 1.23 bouyer reg10 = pci_conf_read(pa->pa_pc, pa->pa_tag, 0x10); 312 1.23 bouyer reg14 = pci_conf_read(pa->pa_pc, pa->pa_tag, 0x14); 313 1.23 bouyer if (PCI_MAPREG_TYPE(reg10) == PCI_MAPREG_TYPE_IO) 314 1.23 bouyer reg_io = 0x10; 315 1.23 bouyer else if (PCI_MAPREG_TYPE(reg14) == PCI_MAPREG_TYPE_IO) 316 1.23 bouyer reg_io = 0x14; 317 1.23 bouyer else 318 1.23 bouyer reg_io = 0; 319 1.23 bouyer if (PCI_MAPREG_TYPE(reg10) == PCI_MAPREG_TYPE_MEM) 320 1.23 bouyer reg_mem = 0x10; 321 1.23 bouyer else if (PCI_MAPREG_TYPE(reg14) == PCI_MAPREG_TYPE_MEM) 322 1.23 bouyer reg_mem = 0x14; 323 1.23 bouyer else 324 1.23 bouyer reg_mem = 0; 325 1.23 bouyer 326 1.23 bouyer if (reg_io != 0) 327 1.23 bouyer ioh_valid = (pci_mapreg_map(pa, reg_io, PCI_MAPREG_TYPE_IO, 328 1.23 bouyer 0, &iot, &ioh, NULL, NULL) == 0); 329 1.23 bouyer else 330 1.23 bouyer ioh_valid = 0; 331 1.23 bouyer if (reg_mem != 0) 332 1.23 bouyer memh_valid = (pci_mapreg_map(pa, PCI_CBMA, 333 1.23 bouyer PCI_MAPREG_TYPE_MEM | PCI_MAPREG_MEM_TYPE_32BIT, 334 1.23 bouyer 0, &memt, &memh, NULL, NULL) == 0); 335 1.23 bouyer else 336 1.23 bouyer memh_valid = 0; 337 1.4 thorpej 338 1.22 tron if (ioh_valid) { 339 1.22 tron sc->tl_bustag = iot; 340 1.22 tron sc->tl_bushandle = ioh; 341 1.22 tron } else if (memh_valid) { 342 1.4 thorpej sc->tl_bustag = memt; 343 1.4 thorpej sc->tl_bushandle = memh; 344 1.1 bouyer } else { 345 1.89 tsutsui aprint_error_dev(self, "unable to map device registers\n"); 346 1.4 thorpej return; 347 1.1 bouyer } 348 1.43 bouyer sc->tl_dmatag = pa->pa_dmat; 349 1.1 bouyer 350 1.4 thorpej /* Enable the device. */ 351 1.4 thorpej csr = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG); 352 1.4 thorpej pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, 353 1.4 thorpej csr | PCI_COMMAND_MASTER_ENABLE); 354 1.1 bouyer 355 1.89 tsutsui aprint_normal_dev(self, "%s\n", tp->tp_desc); 356 1.1 bouyer 357 1.1 bouyer tl_reset(sc); 358 1.1 bouyer 359 1.58 thorpej /* fill in the i2c tag */ 360 1.118 thorpej iic_tag_init(&sc->sc_i2c); 361 1.58 thorpej sc->sc_i2c.ic_cookie = sc; 362 1.58 thorpej sc->sc_i2c.ic_send_start = tl_i2c_send_start; 363 1.58 thorpej sc->sc_i2c.ic_send_stop = tl_i2c_send_stop; 364 1.58 thorpej sc->sc_i2c.ic_initiate_xfer = tl_i2c_initiate_xfer; 365 1.58 thorpej sc->sc_i2c.ic_read_byte = tl_i2c_read_byte; 366 1.58 thorpej sc->sc_i2c.ic_write_byte = tl_i2c_write_byte; 367 1.1 bouyer 368 1.1 bouyer #ifdef TLDEBUG 369 1.91 tsutsui aprint_debug_dev(self, "default values of INTreg: 0x%x\n", 370 1.17 bouyer tl_intreg_read(sc, TL_INT_Defaults)); 371 1.1 bouyer #endif 372 1.1 bouyer 373 1.1 bouyer /* read mac addr */ 374 1.88 tsutsui if (seeprom_bootstrap_read(&sc->sc_i2c, 0x50, 0x83, 256 /* 2kbit */, 375 1.89 tsutsui sc->tl_enaddr, ETHER_ADDR_LEN)) { 376 1.89 tsutsui aprint_error_dev(self, "error reading Ethernet address\n"); 377 1.89 tsutsui return; 378 1.1 bouyer } 379 1.89 tsutsui aprint_normal_dev(self, "Ethernet address %s\n", 380 1.17 bouyer ether_sprintf(sc->tl_enaddr)); 381 1.1 bouyer 382 1.4 thorpej /* Map and establish interrupts */ 383 1.39 sommerfe if (pci_intr_map(pa, &intrhandle)) { 384 1.89 tsutsui aprint_error_dev(self, "couldn't map interrupt\n"); 385 1.4 thorpej return; 386 1.4 thorpej } 387 1.105 msaitoh intrstr = pci_intr_string(pa->pa_pc, intrhandle, intrbuf, 388 1.105 msaitoh sizeof(intrbuf)); 389 1.49 christos sc->tl_if.if_softc = sc; 390 1.110 jdolecek sc->tl_ih = pci_intr_establish_xname(pa->pa_pc, intrhandle, IPL_NET, 391 1.110 jdolecek tl_intr, sc, device_xname(self)); 392 1.4 thorpej if (sc->tl_ih == NULL) { 393 1.89 tsutsui aprint_error_dev(self, "couldn't establish interrupt"); 394 1.4 thorpej if (intrstr != NULL) 395 1.89 tsutsui aprint_error(" at %s", intrstr); 396 1.89 tsutsui aprint_error("\n"); 397 1.4 thorpej return; 398 1.4 thorpej } 399 1.89 tsutsui aprint_normal_dev(self, "interrupting at %s\n", intrstr); 400 1.4 thorpej 401 1.43 bouyer /* init these pointers, so that tl_shutdown won't try to read them */ 402 1.43 bouyer sc->Rx_list = NULL; 403 1.43 bouyer sc->Tx_list = NULL; 404 1.43 bouyer 405 1.46 bouyer /* allocate DMA-safe memory for control structs */ 406 1.89 tsutsui if (bus_dmamem_alloc(sc->tl_dmatag, PAGE_SIZE, 0, PAGE_SIZE, 407 1.89 tsutsui &sc->ctrl_segs, 1, &sc->ctrl_nsegs, BUS_DMA_NOWAIT) != 0 || 408 1.46 bouyer bus_dmamem_map(sc->tl_dmatag, &sc->ctrl_segs, 409 1.89 tsutsui sc->ctrl_nsegs, PAGE_SIZE, (void **)&sc->ctrl, 410 1.89 tsutsui BUS_DMA_NOWAIT | BUS_DMA_COHERENT) != 0) { 411 1.89 tsutsui aprint_error_dev(self, "can't allocate DMA memory for lists\n"); 412 1.89 tsutsui return; 413 1.46 bouyer } 414 1.4 thorpej 415 1.15 thorpej /* 416 1.15 thorpej * Initialize our media structures and probe the MII. 417 1.15 thorpej * 418 1.15 thorpej * Note that we don't care about the media instance. We 419 1.15 thorpej * are expecting to have multiple PHYs on the 10/100 cards, 420 1.15 thorpej * and on those cards we exclude the internal PHY from providing 421 1.15 thorpej * 10baseT. By ignoring the instance, it allows us to not have 422 1.15 thorpej * to specify it on the command line when switching media. 423 1.15 thorpej */ 424 1.114 msaitoh mii->mii_ifp = ifp; 425 1.114 msaitoh mii->mii_readreg = tl_mii_read; 426 1.114 msaitoh mii->mii_writereg = tl_mii_write; 427 1.114 msaitoh mii->mii_statchg = tl_statchg; 428 1.114 msaitoh sc->tl_ec.ec_mii = mii; 429 1.120 msaitoh ifmedia_init(&mii->mii_media, IFM_IMASK, ether_mediachange, 430 1.85 dyoung ether_mediastatus); 431 1.114 msaitoh mii_attach(self, mii, 0xffffffff, MII_PHY_ANY, MII_OFFSET_ANY, 0); 432 1.114 msaitoh if (LIST_FIRST(&mii->mii_phys) == NULL) { 433 1.114 msaitoh ifmedia_add(&mii->mii_media, IFM_ETHER | IFM_NONE, 0, NULL); 434 1.114 msaitoh ifmedia_set(&mii->mii_media, IFM_ETHER | IFM_NONE); 435 1.15 thorpej } else 436 1.114 msaitoh ifmedia_set(&mii->mii_media, IFM_ETHER | IFM_AUTO); 437 1.57 bouyer 438 1.59 tsutsui /* 439 1.57 bouyer * We can support 802.1Q VLAN-sized frames. 440 1.57 bouyer */ 441 1.57 bouyer sc->tl_ec.ec_capabilities |= ETHERCAP_VLAN_MTU; 442 1.1 bouyer 443 1.89 tsutsui strlcpy(ifp->if_xname, device_xname(self), IFNAMSIZ); 444 1.112 msaitoh ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 445 1.1 bouyer ifp->if_ioctl = tl_ifioctl; 446 1.1 bouyer ifp->if_start = tl_ifstart; 447 1.1 bouyer ifp->if_watchdog = tl_ifwatchdog; 448 1.46 bouyer ifp->if_init = tl_init; 449 1.46 bouyer ifp->if_stop = tl_stop; 450 1.1 bouyer ifp->if_timer = 0; 451 1.50 itojun IFQ_SET_READY(&ifp->if_snd); 452 1.1 bouyer if_attach(ifp); 453 1.107 ozaki if_deferred_start_init(ifp, NULL); 454 1.1 bouyer ether_ifattach(&(sc)->tl_if, (sc)->tl_enaddr); 455 1.67 dan 456 1.92 tsutsui /* 457 1.92 tsutsui * Add shutdown hook so that DMA is disabled prior to reboot. 458 1.92 tsutsui * Not doing reboot before the driver initializes. 459 1.92 tsutsui */ 460 1.92 tsutsui if (pmf_device_register1(self, NULL, NULL, tl_shutdown)) 461 1.92 tsutsui pmf_class_network_register(self, ifp); 462 1.92 tsutsui else 463 1.92 tsutsui aprint_error_dev(self, "couldn't establish power handler\n"); 464 1.92 tsutsui 465 1.89 tsutsui rnd_attach_source(&sc->rnd_source, device_xname(self), 466 1.101 tls RND_TYPE_NET, RND_FLAG_DEFAULT); 467 1.1 bouyer } 468 1.1 bouyer 469 1.1 bouyer static void 470 1.89 tsutsui tl_reset(tl_softc_t *sc) 471 1.1 bouyer { 472 1.1 bouyer int i; 473 1.1 bouyer 474 1.1 bouyer /* read stats */ 475 1.1 bouyer if (sc->tl_if.if_flags & IFF_RUNNING) { 476 1.32 thorpej callout_stop(&sc->tl_tick_ch); 477 1.1 bouyer tl_read_stats(sc); 478 1.1 bouyer } 479 1.1 bouyer /* Reset adapter */ 480 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_CMD, 481 1.17 bouyer TL_HR_READ(sc, TL_HOST_CMD) | HOST_CMD_Ad_Rst); 482 1.1 bouyer DELAY(100000); 483 1.1 bouyer /* Disable interrupts */ 484 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_CMD, HOST_CMD_IntOff); 485 1.1 bouyer /* setup aregs & hash */ 486 1.1 bouyer for (i = TL_INT_Areg0; i <= TL_INT_HASH2; i = i + 4) 487 1.1 bouyer tl_intreg_write(sc, i, 0); 488 1.1 bouyer #ifdef TLDEBUG_ADDR 489 1.1 bouyer printf("Areg & hash registers: \n"); 490 1.1 bouyer for (i = TL_INT_Areg0; i <= TL_INT_HASH2; i = i + 4) 491 1.1 bouyer printf(" reg %x: %x\n", i, tl_intreg_read(sc, i)); 492 1.1 bouyer #endif 493 1.1 bouyer /* Setup NetConfig */ 494 1.1 bouyer tl_intreg_write(sc, TL_INT_NetConfig, 495 1.17 bouyer TL_NETCONFIG_1F | TL_NETCONFIG_1chn | TL_NETCONFIG_PHY_EN); 496 1.1 bouyer /* Bsize: accept default */ 497 1.1 bouyer /* TX commit in Acommit: accept default */ 498 1.1 bouyer /* Load Ld_tmr and Ld_thr */ 499 1.1 bouyer /* Ld_tmr = 3 */ 500 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_CMD, 0x3 | HOST_CMD_LdTmr); 501 1.1 bouyer /* Ld_thr = 0 */ 502 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_CMD, 0x0 | HOST_CMD_LdThr); 503 1.1 bouyer /* Unreset MII */ 504 1.1 bouyer netsio_set(sc, TL_NETSIO_NMRST); 505 1.1 bouyer DELAY(100000); 506 1.15 thorpej sc->tl_mii.mii_media_status &= ~IFM_ACTIVE; 507 1.1 bouyer } 508 1.1 bouyer 509 1.92 tsutsui static bool 510 1.92 tsutsui tl_shutdown(device_t self, int howto) 511 1.1 bouyer { 512 1.92 tsutsui tl_softc_t *sc = device_private(self); 513 1.92 tsutsui struct ifnet *ifp = &sc->tl_if; 514 1.92 tsutsui 515 1.92 tsutsui tl_stop(ifp, 1); 516 1.89 tsutsui 517 1.92 tsutsui return true; 518 1.46 bouyer } 519 1.46 bouyer 520 1.89 tsutsui static void 521 1.89 tsutsui tl_stop(struct ifnet *ifp, int disable) 522 1.46 bouyer { 523 1.46 bouyer tl_softc_t *sc = ifp->if_softc; 524 1.1 bouyer struct Tx_list *Tx; 525 1.1 bouyer int i; 526 1.59 tsutsui 527 1.46 bouyer if ((ifp->if_flags & IFF_RUNNING) == 0) 528 1.1 bouyer return; 529 1.1 bouyer /* disable interrupts */ 530 1.17 bouyer TL_HR_WRITE(sc, TL_HOST_CMD, HOST_CMD_IntOff); 531 1.1 bouyer /* stop TX and RX channels */ 532 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_CMD, 533 1.17 bouyer HOST_CMD_STOP | HOST_CMD_RT | HOST_CMD_Nes); 534 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_CMD, HOST_CMD_STOP); 535 1.1 bouyer DELAY(100000); 536 1.1 bouyer 537 1.59 tsutsui /* stop statistics reading loop, read stats */ 538 1.32 thorpej callout_stop(&sc->tl_tick_ch); 539 1.1 bouyer tl_read_stats(sc); 540 1.26 thorpej 541 1.26 thorpej /* Down the MII. */ 542 1.26 thorpej mii_down(&sc->tl_mii); 543 1.1 bouyer 544 1.1 bouyer /* deallocate memory allocations */ 545 1.43 bouyer if (sc->Rx_list) { 546 1.89 tsutsui for (i = 0; i< TL_NBUF; i++) { 547 1.43 bouyer if (sc->Rx_list[i].m) { 548 1.43 bouyer bus_dmamap_unload(sc->tl_dmatag, 549 1.43 bouyer sc->Rx_list[i].m_dmamap); 550 1.43 bouyer m_freem(sc->Rx_list[i].m); 551 1.43 bouyer } 552 1.59 tsutsui bus_dmamap_destroy(sc->tl_dmatag, 553 1.44 bouyer sc->Rx_list[i].m_dmamap); 554 1.43 bouyer sc->Rx_list[i].m = NULL; 555 1.43 bouyer } 556 1.43 bouyer free(sc->Rx_list, M_DEVBUF); 557 1.43 bouyer sc->Rx_list = NULL; 558 1.43 bouyer bus_dmamap_unload(sc->tl_dmatag, sc->Rx_dmamap); 559 1.44 bouyer bus_dmamap_destroy(sc->tl_dmatag, sc->Rx_dmamap); 560 1.43 bouyer sc->hw_Rx_list = NULL; 561 1.43 bouyer while ((Tx = sc->active_Tx) != NULL) { 562 1.43 bouyer Tx->hw_list->stat = 0; 563 1.43 bouyer bus_dmamap_unload(sc->tl_dmatag, Tx->m_dmamap); 564 1.44 bouyer bus_dmamap_destroy(sc->tl_dmatag, Tx->m_dmamap); 565 1.43 bouyer m_freem(Tx->m); 566 1.43 bouyer sc->active_Tx = Tx->next; 567 1.43 bouyer Tx->next = sc->Free_Tx; 568 1.43 bouyer sc->Free_Tx = Tx; 569 1.43 bouyer } 570 1.43 bouyer sc->last_Tx = NULL; 571 1.43 bouyer free(sc->Tx_list, M_DEVBUF); 572 1.43 bouyer sc->Tx_list = NULL; 573 1.43 bouyer bus_dmamap_unload(sc->tl_dmatag, sc->Tx_dmamap); 574 1.44 bouyer bus_dmamap_destroy(sc->tl_dmatag, sc->Tx_dmamap); 575 1.43 bouyer sc->hw_Tx_list = NULL; 576 1.1 bouyer } 577 1.46 bouyer ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE); 578 1.46 bouyer ifp->if_timer = 0; 579 1.15 thorpej sc->tl_mii.mii_media_status &= ~IFM_ACTIVE; 580 1.1 bouyer } 581 1.1 bouyer 582 1.89 tsutsui static void 583 1.89 tsutsui tl_restart(void *v) 584 1.1 bouyer { 585 1.89 tsutsui 586 1.1 bouyer tl_init(v); 587 1.1 bouyer } 588 1.1 bouyer 589 1.89 tsutsui static int 590 1.89 tsutsui tl_init(struct ifnet *ifp) 591 1.1 bouyer { 592 1.46 bouyer tl_softc_t *sc = ifp->if_softc; 593 1.43 bouyer int i, s, error; 594 1.79 rumble bus_size_t boundary; 595 1.79 rumble prop_number_t prop_boundary; 596 1.70 christos const char *errstring; 597 1.44 bouyer char *nullbuf; 598 1.1 bouyer 599 1.14 mycroft s = splnet(); 600 1.1 bouyer /* cancel any pending IO */ 601 1.46 bouyer tl_stop(ifp, 1); 602 1.1 bouyer tl_reset(sc); 603 1.1 bouyer if ((sc->tl_if.if_flags & IFF_UP) == 0) { 604 1.1 bouyer splx(s); 605 1.1 bouyer return 0; 606 1.1 bouyer } 607 1.1 bouyer /* Set various register to reasonable value */ 608 1.1 bouyer /* setup NetCmd in promisc mode if needed */ 609 1.1 bouyer i = (ifp->if_flags & IFF_PROMISC) ? TL_NETCOMMAND_CAF : 0; 610 1.1 bouyer tl_intreg_write_byte(sc, TL_INT_NET + TL_INT_NetCmd, 611 1.17 bouyer TL_NETCOMMAND_NRESET | TL_NETCOMMAND_NWRAP | i); 612 1.1 bouyer /* Max receive size : MCLBYTES */ 613 1.1 bouyer tl_intreg_write_byte(sc, TL_INT_MISC + TL_MISC_MaxRxL, MCLBYTES & 0xff); 614 1.1 bouyer tl_intreg_write_byte(sc, TL_INT_MISC + TL_MISC_MaxRxH, 615 1.17 bouyer (MCLBYTES >> 8) & 0xff); 616 1.1 bouyer 617 1.1 bouyer /* init MAC addr */ 618 1.1 bouyer for (i = 0; i < ETHER_ADDR_LEN; i++) 619 1.1 bouyer tl_intreg_write_byte(sc, TL_INT_Areg0 + i , sc->tl_enaddr[i]); 620 1.1 bouyer /* add multicast filters */ 621 1.1 bouyer tl_addr_filter(sc); 622 1.1 bouyer #ifdef TLDEBUG_ADDR 623 1.1 bouyer printf("Wrote Mac addr, Areg & hash registers are now: \n"); 624 1.1 bouyer for (i = TL_INT_Areg0; i <= TL_INT_HASH2; i = i + 4) 625 1.1 bouyer printf(" reg %x: %x\n", i, tl_intreg_read(sc, i)); 626 1.1 bouyer #endif 627 1.1 bouyer 628 1.1 bouyer /* Pre-allocate receivers mbuf, make the lists */ 629 1.17 bouyer sc->Rx_list = malloc(sizeof(struct Rx_list) * TL_NBUF, M_DEVBUF, 630 1.114 msaitoh M_NOWAIT | M_ZERO); 631 1.17 bouyer sc->Tx_list = malloc(sizeof(struct Tx_list) * TL_NBUF, M_DEVBUF, 632 1.114 msaitoh M_NOWAIT | M_ZERO); 633 1.1 bouyer if (sc->Rx_list == NULL || sc->Tx_list == NULL) { 634 1.43 bouyer errstring = "out of memory for lists"; 635 1.43 bouyer error = ENOMEM; 636 1.43 bouyer goto bad; 637 1.43 bouyer } 638 1.79 rumble 639 1.79 rumble /* 640 1.79 rumble * Some boards (Set Engineering GFE) do not permit DMA transfers 641 1.79 rumble * across page boundaries. 642 1.79 rumble */ 643 1.89 tsutsui prop_boundary = prop_dictionary_get(device_properties(sc->sc_dev), 644 1.79 rumble "tl-dma-page-boundary"); 645 1.79 rumble if (prop_boundary != NULL) { 646 1.80 rumble KASSERT(prop_object_type(prop_boundary) == PROP_TYPE_NUMBER); 647 1.122 msaitoh boundary 648 1.122 msaitoh = (bus_size_t)prop_number_unsigned_value(prop_boundary); 649 1.79 rumble } else { 650 1.79 rumble boundary = 0; 651 1.79 rumble } 652 1.79 rumble 653 1.43 bouyer error = bus_dmamap_create(sc->tl_dmatag, 654 1.43 bouyer sizeof(struct tl_Rx_list) * TL_NBUF, 1, 655 1.43 bouyer sizeof(struct tl_Rx_list) * TL_NBUF, 0, BUS_DMA_WAITOK, 656 1.43 bouyer &sc->Rx_dmamap); 657 1.43 bouyer if (error == 0) 658 1.43 bouyer error = bus_dmamap_create(sc->tl_dmatag, 659 1.43 bouyer sizeof(struct tl_Tx_list) * TL_NBUF, 1, 660 1.79 rumble sizeof(struct tl_Tx_list) * TL_NBUF, boundary, 661 1.79 rumble BUS_DMA_WAITOK, &sc->Tx_dmamap); 662 1.59 tsutsui if (error == 0) 663 1.44 bouyer error = bus_dmamap_create(sc->tl_dmatag, ETHER_MIN_TX, 1, 664 1.79 rumble ETHER_MIN_TX, boundary, BUS_DMA_WAITOK, 665 1.44 bouyer &sc->null_dmamap); 666 1.43 bouyer if (error) { 667 1.43 bouyer errstring = "can't allocate DMA maps for lists"; 668 1.43 bouyer goto bad; 669 1.43 bouyer } 670 1.46 bouyer memset(sc->ctrl, 0, PAGE_SIZE); 671 1.46 bouyer sc->hw_Rx_list = (void *)sc->ctrl; 672 1.46 bouyer sc->hw_Tx_list = 673 1.46 bouyer (void *)(sc->ctrl + sizeof(struct tl_Rx_list) * TL_NBUF); 674 1.46 bouyer nullbuf = sc->ctrl + sizeof(struct tl_Rx_list) * TL_NBUF + 675 1.44 bouyer sizeof(struct tl_Tx_list) * TL_NBUF; 676 1.44 bouyer error = bus_dmamap_load(sc->tl_dmatag, sc->Rx_dmamap, 677 1.44 bouyer sc->hw_Rx_list, sizeof(struct tl_Rx_list) * TL_NBUF, NULL, 678 1.44 bouyer BUS_DMA_WAITOK); 679 1.43 bouyer if (error == 0) 680 1.43 bouyer error = bus_dmamap_load(sc->tl_dmatag, sc->Tx_dmamap, 681 1.43 bouyer sc->hw_Tx_list, sizeof(struct tl_Tx_list) * TL_NBUF, NULL, 682 1.43 bouyer BUS_DMA_WAITOK); 683 1.44 bouyer if (error == 0) 684 1.44 bouyer error = bus_dmamap_load(sc->tl_dmatag, sc->null_dmamap, 685 1.44 bouyer nullbuf, ETHER_MIN_TX, NULL, BUS_DMA_WAITOK); 686 1.43 bouyer if (error) { 687 1.44 bouyer errstring = "can't DMA map DMA memory for lists"; 688 1.43 bouyer goto bad; 689 1.1 bouyer } 690 1.89 tsutsui for (i = 0; i < TL_NBUF; i++) { 691 1.43 bouyer error = bus_dmamap_create(sc->tl_dmatag, MCLBYTES, 692 1.79 rumble 1, MCLBYTES, boundary, BUS_DMA_WAITOK | BUS_DMA_ALLOCNOW, 693 1.43 bouyer &sc->Rx_list[i].m_dmamap); 694 1.43 bouyer if (error == 0) { 695 1.43 bouyer error = bus_dmamap_create(sc->tl_dmatag, MCLBYTES, 696 1.79 rumble TL_NSEG, MCLBYTES, boundary, 697 1.43 bouyer BUS_DMA_WAITOK | BUS_DMA_ALLOCNOW, 698 1.43 bouyer &sc->Tx_list[i].m_dmamap); 699 1.43 bouyer } 700 1.43 bouyer if (error) { 701 1.43 bouyer errstring = "can't allocate DMA maps for mbufs"; 702 1.43 bouyer goto bad; 703 1.43 bouyer } 704 1.43 bouyer sc->Rx_list[i].hw_list = &sc->hw_Rx_list[i]; 705 1.43 bouyer sc->Rx_list[i].hw_listaddr = sc->Rx_dmamap->dm_segs[0].ds_addr 706 1.43 bouyer + sizeof(struct tl_Rx_list) * i; 707 1.43 bouyer sc->Tx_list[i].hw_list = &sc->hw_Tx_list[i]; 708 1.43 bouyer sc->Tx_list[i].hw_listaddr = sc->Tx_dmamap->dm_segs[0].ds_addr 709 1.43 bouyer + sizeof(struct tl_Tx_list) * i; 710 1.43 bouyer if (tl_add_RxBuff(sc, &sc->Rx_list[i], NULL) == 0) { 711 1.43 bouyer errstring = "out of mbuf for receive list"; 712 1.43 bouyer error = ENOMEM; 713 1.43 bouyer goto bad; 714 1.1 bouyer } 715 1.1 bouyer if (i > 0) { /* chain the list */ 716 1.59 tsutsui sc->Rx_list[i - 1].next = &sc->Rx_list[i]; 717 1.59 tsutsui sc->hw_Rx_list[i - 1].fwd = 718 1.43 bouyer htole32(sc->Rx_list[i].hw_listaddr); 719 1.59 tsutsui sc->Tx_list[i - 1].next = &sc->Tx_list[i]; 720 1.1 bouyer } 721 1.1 bouyer } 722 1.59 tsutsui sc->hw_Rx_list[TL_NBUF - 1].fwd = 0; 723 1.60 tsutsui sc->Rx_list[TL_NBUF - 1].next = NULL; 724 1.59 tsutsui sc->hw_Tx_list[TL_NBUF - 1].fwd = 0; 725 1.59 tsutsui sc->Tx_list[TL_NBUF - 1].next = NULL; 726 1.1 bouyer 727 1.1 bouyer sc->active_Rx = &sc->Rx_list[0]; 728 1.59 tsutsui sc->last_Rx = &sc->Rx_list[TL_NBUF - 1]; 729 1.1 bouyer sc->active_Tx = sc->last_Tx = NULL; 730 1.1 bouyer sc->Free_Tx = &sc->Tx_list[0]; 731 1.43 bouyer bus_dmamap_sync(sc->tl_dmatag, sc->Rx_dmamap, 0, 732 1.43 bouyer sizeof(struct tl_Rx_list) * TL_NBUF, 733 1.43 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 734 1.43 bouyer bus_dmamap_sync(sc->tl_dmatag, sc->Tx_dmamap, 0, 735 1.43 bouyer sizeof(struct tl_Tx_list) * TL_NBUF, 736 1.43 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 737 1.44 bouyer bus_dmamap_sync(sc->tl_dmatag, sc->null_dmamap, 0, ETHER_MIN_TX, 738 1.43 bouyer BUS_DMASYNC_PREWRITE); 739 1.1 bouyer 740 1.15 thorpej /* set media */ 741 1.85 dyoung if ((error = mii_mediachg(&sc->tl_mii)) == ENXIO) 742 1.85 dyoung error = 0; 743 1.85 dyoung else if (error != 0) { 744 1.85 dyoung errstring = "could not set media"; 745 1.99 christos goto bad; 746 1.85 dyoung } 747 1.1 bouyer 748 1.1 bouyer /* start ticks calls */ 749 1.32 thorpej callout_reset(&sc->tl_tick_ch, hz, tl_ticks, sc); 750 1.64 wiz /* write address of Rx list and enable interrupts */ 751 1.43 bouyer TL_HR_WRITE(sc, TL_HOST_CH_PARM, sc->Rx_list[0].hw_listaddr); 752 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_CMD, 753 1.17 bouyer HOST_CMD_GO | HOST_CMD_RT | HOST_CMD_Nes | HOST_CMD_IntOn); 754 1.1 bouyer sc->tl_if.if_flags |= IFF_RUNNING; 755 1.1 bouyer sc->tl_if.if_flags &= ~IFF_OACTIVE; 756 1.90 bouyer splx(s); 757 1.1 bouyer return 0; 758 1.43 bouyer bad: 759 1.89 tsutsui printf("%s: %s\n", device_xname(sc->sc_dev), errstring); 760 1.43 bouyer splx(s); 761 1.43 bouyer return error; 762 1.1 bouyer } 763 1.1 bouyer 764 1.1 bouyer 765 1.89 tsutsui static uint32_t 766 1.89 tsutsui tl_intreg_read(tl_softc_t *sc, uint32_t reg) 767 1.1 bouyer { 768 1.89 tsutsui 769 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_INTR_DIOADR, reg & TL_HOST_DIOADR_MASK); 770 1.1 bouyer return TL_HR_READ(sc, TL_HOST_DIO_DATA); 771 1.1 bouyer } 772 1.1 bouyer 773 1.89 tsutsui static uint8_t 774 1.89 tsutsui tl_intreg_read_byte(tl_softc_t *sc, uint32_t reg) 775 1.1 bouyer { 776 1.89 tsutsui 777 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_INTR_DIOADR, 778 1.17 bouyer (reg & (~0x07)) & TL_HOST_DIOADR_MASK); 779 1.1 bouyer return TL_HR_READ_BYTE(sc, TL_HOST_DIO_DATA + (reg & 0x07)); 780 1.1 bouyer } 781 1.1 bouyer 782 1.1 bouyer static void 783 1.89 tsutsui tl_intreg_write(tl_softc_t *sc, uint32_t reg, uint32_t val) 784 1.1 bouyer { 785 1.89 tsutsui 786 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_INTR_DIOADR, reg & TL_HOST_DIOADR_MASK); 787 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_DIO_DATA, val); 788 1.1 bouyer } 789 1.1 bouyer 790 1.1 bouyer static void 791 1.89 tsutsui tl_intreg_write_byte(tl_softc_t *sc, uint32_t reg, uint8_t val) 792 1.1 bouyer { 793 1.89 tsutsui 794 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_INTR_DIOADR, 795 1.17 bouyer (reg & (~0x03)) & TL_HOST_DIOADR_MASK); 796 1.1 bouyer TL_HR_WRITE_BYTE(sc, TL_HOST_DIO_DATA + (reg & 0x03), val); 797 1.1 bouyer } 798 1.1 bouyer 799 1.28 tron void 800 1.89 tsutsui tl_mii_sync(struct tl_softc *sc) 801 1.1 bouyer { 802 1.28 tron int i; 803 1.1 bouyer 804 1.28 tron netsio_clr(sc, TL_NETSIO_MTXEN); 805 1.28 tron for (i = 0; i < 32; i++) { 806 1.28 tron netsio_clr(sc, TL_NETSIO_MCLK); 807 1.28 tron netsio_set(sc, TL_NETSIO_MCLK); 808 1.28 tron } 809 1.1 bouyer } 810 1.1 bouyer 811 1.15 thorpej void 812 1.89 tsutsui tl_mii_sendbits(struct tl_softc *sc, uint32_t data, int nbits) 813 1.1 bouyer { 814 1.28 tron int i; 815 1.1 bouyer 816 1.28 tron netsio_set(sc, TL_NETSIO_MTXEN); 817 1.115 msaitoh for (i = 1 << (nbits - 1); i; i = i >> 1) { 818 1.28 tron netsio_clr(sc, TL_NETSIO_MCLK); 819 1.28 tron netsio_read(sc, TL_NETSIO_MCLK); 820 1.28 tron if (data & i) 821 1.28 tron netsio_set(sc, TL_NETSIO_MDATA); 822 1.28 tron else 823 1.28 tron netsio_clr(sc, TL_NETSIO_MDATA); 824 1.28 tron netsio_set(sc, TL_NETSIO_MCLK); 825 1.28 tron netsio_read(sc, TL_NETSIO_MCLK); 826 1.28 tron } 827 1.1 bouyer } 828 1.1 bouyer 829 1.15 thorpej int 830 1.111 msaitoh tl_mii_read(device_t self, int phy, int reg, uint16_t *val) 831 1.1 bouyer { 832 1.89 tsutsui struct tl_softc *sc = device_private(self); 833 1.111 msaitoh uint16_t data = 0; 834 1.111 msaitoh int i, err; 835 1.28 tron 836 1.28 tron /* 837 1.28 tron * Read the PHY register by manually driving the MII control lines. 838 1.28 tron */ 839 1.1 bouyer 840 1.28 tron tl_mii_sync(sc); 841 1.28 tron tl_mii_sendbits(sc, MII_COMMAND_START, 2); 842 1.28 tron tl_mii_sendbits(sc, MII_COMMAND_READ, 2); 843 1.28 tron tl_mii_sendbits(sc, phy, 5); 844 1.28 tron tl_mii_sendbits(sc, reg, 5); 845 1.28 tron 846 1.28 tron netsio_clr(sc, TL_NETSIO_MTXEN); 847 1.28 tron netsio_clr(sc, TL_NETSIO_MCLK); 848 1.28 tron netsio_set(sc, TL_NETSIO_MCLK); 849 1.28 tron netsio_clr(sc, TL_NETSIO_MCLK); 850 1.28 tron 851 1.28 tron err = netsio_read(sc, TL_NETSIO_MDATA); 852 1.28 tron netsio_set(sc, TL_NETSIO_MCLK); 853 1.28 tron 854 1.28 tron /* Even if an error occurs, must still clock out the cycle. */ 855 1.28 tron for (i = 0; i < 16; i++) { 856 1.111 msaitoh data <<= 1; 857 1.28 tron netsio_clr(sc, TL_NETSIO_MCLK); 858 1.28 tron if (err == 0 && netsio_read(sc, TL_NETSIO_MDATA)) 859 1.111 msaitoh data |= 1; 860 1.28 tron netsio_set(sc, TL_NETSIO_MCLK); 861 1.28 tron } 862 1.28 tron netsio_clr(sc, TL_NETSIO_MCLK); 863 1.28 tron netsio_set(sc, TL_NETSIO_MCLK); 864 1.28 tron 865 1.111 msaitoh *val = data; 866 1.111 msaitoh return err; 867 1.15 thorpej } 868 1.15 thorpej 869 1.111 msaitoh int 870 1.111 msaitoh tl_mii_write(device_t self, int phy, int reg, uint16_t val) 871 1.15 thorpej { 872 1.89 tsutsui struct tl_softc *sc = device_private(self); 873 1.28 tron 874 1.28 tron /* 875 1.28 tron * Write the PHY register by manually driving the MII control lines. 876 1.28 tron */ 877 1.28 tron 878 1.28 tron tl_mii_sync(sc); 879 1.28 tron tl_mii_sendbits(sc, MII_COMMAND_START, 2); 880 1.28 tron tl_mii_sendbits(sc, MII_COMMAND_WRITE, 2); 881 1.28 tron tl_mii_sendbits(sc, phy, 5); 882 1.28 tron tl_mii_sendbits(sc, reg, 5); 883 1.28 tron tl_mii_sendbits(sc, MII_COMMAND_ACK, 2); 884 1.28 tron tl_mii_sendbits(sc, val, 16); 885 1.15 thorpej 886 1.28 tron netsio_clr(sc, TL_NETSIO_MCLK); 887 1.28 tron netsio_set(sc, TL_NETSIO_MCLK); 888 1.111 msaitoh 889 1.111 msaitoh return 0; 890 1.15 thorpej } 891 1.15 thorpej 892 1.15 thorpej void 893 1.98 matt tl_statchg(struct ifnet *ifp) 894 1.15 thorpej { 895 1.98 matt tl_softc_t *sc = ifp->if_softc; 896 1.89 tsutsui uint32_t reg; 897 1.15 thorpej 898 1.15 thorpej #ifdef TLDEBUG 899 1.89 tsutsui printf("%s: media %x\n", __func__, sc->tl_mii.mii_media.ifm_media); 900 1.15 thorpej #endif 901 1.15 thorpej 902 1.15 thorpej /* 903 1.15 thorpej * We must keep the ThunderLAN and the PHY in sync as 904 1.15 thorpej * to the status of full-duplex! 905 1.15 thorpej */ 906 1.15 thorpej reg = tl_intreg_read_byte(sc, TL_INT_NET + TL_INT_NetCmd); 907 1.15 thorpej if (sc->tl_mii.mii_media_active & IFM_FDX) 908 1.15 thorpej reg |= TL_NETCOMMAND_DUPLEX; 909 1.15 thorpej else 910 1.15 thorpej reg &= ~TL_NETCOMMAND_DUPLEX; 911 1.15 thorpej tl_intreg_write_byte(sc, TL_INT_NET + TL_INT_NetCmd, reg); 912 1.1 bouyer } 913 1.1 bouyer 914 1.58 thorpej /********** I2C glue **********/ 915 1.58 thorpej 916 1.58 thorpej static int 917 1.58 thorpej tl_i2c_send_start(void *cookie, int flags) 918 1.58 thorpej { 919 1.58 thorpej 920 1.89 tsutsui return i2c_bitbang_send_start(cookie, flags, &tl_i2cbb_ops); 921 1.58 thorpej } 922 1.58 thorpej 923 1.58 thorpej static int 924 1.58 thorpej tl_i2c_send_stop(void *cookie, int flags) 925 1.58 thorpej { 926 1.58 thorpej 927 1.89 tsutsui return i2c_bitbang_send_stop(cookie, flags, &tl_i2cbb_ops); 928 1.58 thorpej } 929 1.58 thorpej 930 1.58 thorpej static int 931 1.58 thorpej tl_i2c_initiate_xfer(void *cookie, i2c_addr_t addr, int flags) 932 1.58 thorpej { 933 1.58 thorpej 934 1.89 tsutsui return i2c_bitbang_initiate_xfer(cookie, addr, flags, &tl_i2cbb_ops); 935 1.58 thorpej } 936 1.58 thorpej 937 1.58 thorpej static int 938 1.58 thorpej tl_i2c_read_byte(void *cookie, uint8_t *valp, int flags) 939 1.58 thorpej { 940 1.58 thorpej 941 1.89 tsutsui return i2c_bitbang_read_byte(cookie, valp, flags, &tl_i2cbb_ops); 942 1.58 thorpej } 943 1.58 thorpej 944 1.58 thorpej static int 945 1.58 thorpej tl_i2c_write_byte(void *cookie, uint8_t val, int flags) 946 1.58 thorpej { 947 1.58 thorpej 948 1.89 tsutsui return i2c_bitbang_write_byte(cookie, val, flags, &tl_i2cbb_ops); 949 1.58 thorpej } 950 1.58 thorpej 951 1.58 thorpej /********** I2C bit-bang glue **********/ 952 1.58 thorpej 953 1.58 thorpej static void 954 1.58 thorpej tl_i2cbb_set_bits(void *cookie, uint32_t bits) 955 1.1 bouyer { 956 1.58 thorpej struct tl_softc *sc = cookie; 957 1.58 thorpej uint8_t reg; 958 1.1 bouyer 959 1.58 thorpej reg = tl_intreg_read_byte(sc, TL_INT_NET + TL_INT_NetSio); 960 1.114 msaitoh reg = (reg & ~(TL_NETSIO_EDATA | TL_NETSIO_ECLOCK)) | bits; 961 1.58 thorpej tl_intreg_write_byte(sc, TL_INT_NET + TL_INT_NetSio, reg); 962 1.1 bouyer } 963 1.1 bouyer 964 1.58 thorpej static void 965 1.58 thorpej tl_i2cbb_set_dir(void *cookie, uint32_t bits) 966 1.1 bouyer { 967 1.58 thorpej struct tl_softc *sc = cookie; 968 1.58 thorpej uint8_t reg; 969 1.1 bouyer 970 1.58 thorpej reg = tl_intreg_read_byte(sc, TL_INT_NET + TL_INT_NetSio); 971 1.58 thorpej reg = (reg & ~TL_NETSIO_ETXEN) | bits; 972 1.58 thorpej tl_intreg_write_byte(sc, TL_INT_NET + TL_INT_NetSio, reg); 973 1.1 bouyer } 974 1.1 bouyer 975 1.58 thorpej static uint32_t 976 1.58 thorpej tl_i2cbb_read(void *cookie) 977 1.1 bouyer { 978 1.1 bouyer 979 1.89 tsutsui return tl_intreg_read_byte(cookie, TL_INT_NET + TL_INT_NetSio); 980 1.1 bouyer } 981 1.58 thorpej 982 1.58 thorpej /********** End of I2C stuff **********/ 983 1.1 bouyer 984 1.1 bouyer static int 985 1.89 tsutsui tl_intr(void *v) 986 1.1 bouyer { 987 1.1 bouyer tl_softc_t *sc = v; 988 1.1 bouyer struct ifnet *ifp = &sc->tl_if; 989 1.1 bouyer struct Rx_list *Rx; 990 1.1 bouyer struct Tx_list *Tx; 991 1.1 bouyer struct mbuf *m; 992 1.89 tsutsui uint32_t int_type, int_reg; 993 1.1 bouyer int ack = 0; 994 1.1 bouyer int size; 995 1.1 bouyer 996 1.59 tsutsui int_reg = TL_HR_READ(sc, TL_HOST_INTR_DIOADR); 997 1.1 bouyer int_type = int_reg & TL_INTR_MASK; 998 1.1 bouyer if (int_type == 0) 999 1.1 bouyer return 0; 1000 1.1 bouyer #if defined(TLDEBUG_RX) || defined(TLDEBUG_TX) 1001 1.105 msaitoh printf("%s: interrupt type %x, intr_reg %x\n", 1002 1.105 msaitoh device_xname(sc->sc_dev), int_type, int_reg); 1003 1.1 bouyer #endif 1004 1.1 bouyer /* disable interrupts */ 1005 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_CMD, HOST_CMD_IntOff); 1006 1.114 msaitoh switch (int_type & TL_INTR_MASK) { 1007 1.1 bouyer case TL_INTR_RxEOF: 1008 1.43 bouyer bus_dmamap_sync(sc->tl_dmatag, sc->Rx_dmamap, 0, 1009 1.43 bouyer sizeof(struct tl_Rx_list) * TL_NBUF, 1010 1.43 bouyer BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 1011 1.114 msaitoh while (le32toh(sc->active_Rx->hw_list->stat) & 1012 1.43 bouyer TL_RX_CSTAT_CPLT) { 1013 1.1 bouyer /* dequeue and requeue at end of list */ 1014 1.1 bouyer ack++; 1015 1.1 bouyer Rx = sc->active_Rx; 1016 1.1 bouyer sc->active_Rx = Rx->next; 1017 1.43 bouyer bus_dmamap_sync(sc->tl_dmatag, Rx->m_dmamap, 0, 1018 1.61 tsutsui Rx->m_dmamap->dm_mapsize, BUS_DMASYNC_POSTREAD); 1019 1.43 bouyer bus_dmamap_unload(sc->tl_dmatag, Rx->m_dmamap); 1020 1.1 bouyer m = Rx->m; 1021 1.43 bouyer size = le32toh(Rx->hw_list->stat) >> 16; 1022 1.1 bouyer #ifdef TLDEBUG_RX 1023 1.89 tsutsui printf("%s: RX list complete, Rx %p, size=%d\n", 1024 1.89 tsutsui __func__, Rx, size); 1025 1.1 bouyer #endif 1026 1.89 tsutsui if (tl_add_RxBuff(sc, Rx, m) == 0) { 1027 1.17 bouyer /* 1028 1.17 bouyer * No new mbuf, reuse the same. This means 1029 1.17 bouyer * that this packet 1030 1.17 bouyer * is lost 1031 1.17 bouyer */ 1032 1.1 bouyer m = NULL; 1033 1.1 bouyer #ifdef TL_PRIV_STATS 1034 1.1 bouyer sc->ierr_nomem++; 1035 1.1 bouyer #endif 1036 1.1 bouyer #ifdef TLDEBUG 1037 1.1 bouyer printf("%s: out of mbuf, lost input packet\n", 1038 1.89 tsutsui device_xname(sc->sc_dev)); 1039 1.1 bouyer #endif 1040 1.1 bouyer } 1041 1.1 bouyer Rx->next = NULL; 1042 1.43 bouyer Rx->hw_list->fwd = 0; 1043 1.43 bouyer sc->last_Rx->hw_list->fwd = htole32(Rx->hw_listaddr); 1044 1.1 bouyer sc->last_Rx->next = Rx; 1045 1.1 bouyer sc->last_Rx = Rx; 1046 1.1 bouyer 1047 1.1 bouyer /* deliver packet */ 1048 1.1 bouyer if (m) { 1049 1.1 bouyer if (size < sizeof(struct ether_header)) { 1050 1.1 bouyer m_freem(m); 1051 1.1 bouyer continue; 1052 1.1 bouyer } 1053 1.104 ozaki m_set_rcvif(m, ifp); 1054 1.24 thorpej m->m_pkthdr.len = m->m_len = size; 1055 1.1 bouyer #ifdef TLDEBUG_RX 1056 1.89 tsutsui { 1057 1.89 tsutsui struct ether_header *eh = 1058 1.89 tsutsui mtod(m, struct ether_header *); 1059 1.89 tsutsui printf("%s: Rx packet:\n", __func__); 1060 1.89 tsutsui ether_printheader(eh); 1061 1.89 tsutsui } 1062 1.1 bouyer #endif 1063 1.103 ozaki if_percpuq_enqueue(ifp->if_percpuq, m); 1064 1.1 bouyer } 1065 1.1 bouyer } 1066 1.43 bouyer bus_dmamap_sync(sc->tl_dmatag, sc->Rx_dmamap, 0, 1067 1.43 bouyer sizeof(struct tl_Rx_list) * TL_NBUF, 1068 1.43 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 1069 1.1 bouyer #ifdef TLDEBUG_RX 1070 1.1 bouyer printf("TL_INTR_RxEOF: ack %d\n", ack); 1071 1.1 bouyer #else 1072 1.1 bouyer if (ack == 0) { 1073 1.1 bouyer printf("%s: EOF intr without anything to read !\n", 1074 1.89 tsutsui device_xname(sc->sc_dev)); 1075 1.1 bouyer tl_reset(sc); 1076 1.81 wiz /* schedule reinit of the board */ 1077 1.74 rumble callout_reset(&sc->tl_restart_ch, 1, tl_restart, ifp); 1078 1.89 tsutsui return 1; 1079 1.1 bouyer } 1080 1.1 bouyer #endif 1081 1.1 bouyer break; 1082 1.1 bouyer case TL_INTR_RxEOC: 1083 1.1 bouyer ack++; 1084 1.43 bouyer bus_dmamap_sync(sc->tl_dmatag, sc->Rx_dmamap, 0, 1085 1.43 bouyer sizeof(struct tl_Rx_list) * TL_NBUF, 1086 1.43 bouyer BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 1087 1.1 bouyer #ifdef TLDEBUG_RX 1088 1.1 bouyer printf("TL_INTR_RxEOC: ack %d\n", ack); 1089 1.1 bouyer #endif 1090 1.1 bouyer #ifdef DIAGNOSTIC 1091 1.43 bouyer if (le32toh(sc->active_Rx->hw_list->stat) & TL_RX_CSTAT_CPLT) { 1092 1.43 bouyer printf("%s: Rx EOC interrupt and active Tx list not " 1093 1.89 tsutsui "cleared\n", device_xname(sc->sc_dev)); 1094 1.1 bouyer return 0; 1095 1.1 bouyer } else 1096 1.59 tsutsui #endif 1097 1.1 bouyer { 1098 1.17 bouyer /* 1099 1.64 wiz * write address of Rx list and send Rx GO command, ack 1100 1.17 bouyer * interrupt and enable interrupts in one command 1101 1.17 bouyer */ 1102 1.43 bouyer TL_HR_WRITE(sc, TL_HOST_CH_PARM, sc->active_Rx->hw_listaddr); 1103 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_CMD, 1104 1.17 bouyer HOST_CMD_GO | HOST_CMD_RT | HOST_CMD_Nes | ack | int_type | 1105 1.17 bouyer HOST_CMD_ACK | HOST_CMD_IntOn); 1106 1.1 bouyer return 1; 1107 1.1 bouyer } 1108 1.1 bouyer case TL_INTR_TxEOF: 1109 1.1 bouyer case TL_INTR_TxEOC: 1110 1.43 bouyer bus_dmamap_sync(sc->tl_dmatag, sc->Tx_dmamap, 0, 1111 1.43 bouyer sizeof(struct tl_Tx_list) * TL_NBUF, 1112 1.43 bouyer BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE); 1113 1.1 bouyer while ((Tx = sc->active_Tx) != NULL) { 1114 1.114 msaitoh if ((le32toh(Tx->hw_list->stat) & TL_TX_CSTAT_CPLT) 1115 1.114 msaitoh == 0) 1116 1.1 bouyer break; 1117 1.1 bouyer ack++; 1118 1.1 bouyer #ifdef TLDEBUG_TX 1119 1.44 bouyer printf("TL_INTR_TxEOC: list 0x%x done\n", 1120 1.44 bouyer (int)Tx->hw_listaddr); 1121 1.1 bouyer #endif 1122 1.43 bouyer Tx->hw_list->stat = 0; 1123 1.43 bouyer bus_dmamap_sync(sc->tl_dmatag, Tx->m_dmamap, 0, 1124 1.61 tsutsui Tx->m_dmamap->dm_mapsize, BUS_DMASYNC_POSTWRITE); 1125 1.43 bouyer bus_dmamap_unload(sc->tl_dmatag, Tx->m_dmamap); 1126 1.1 bouyer m_freem(Tx->m); 1127 1.1 bouyer Tx->m = NULL; 1128 1.1 bouyer sc->active_Tx = Tx->next; 1129 1.1 bouyer if (sc->active_Tx == NULL) 1130 1.1 bouyer sc->last_Tx = NULL; 1131 1.1 bouyer Tx->next = sc->Free_Tx; 1132 1.1 bouyer sc->Free_Tx = Tx; 1133 1.1 bouyer } 1134 1.43 bouyer bus_dmamap_sync(sc->tl_dmatag, sc->Tx_dmamap, 0, 1135 1.43 bouyer sizeof(struct tl_Tx_list) * TL_NBUF, 1136 1.43 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 1137 1.124 andvar /* if this was an EOC, ACK immediately */ 1138 1.45 bouyer if (ack) 1139 1.45 bouyer sc->tl_if.if_flags &= ~IFF_OACTIVE; 1140 1.1 bouyer if (int_type == TL_INTR_TxEOC) { 1141 1.1 bouyer #ifdef TLDEBUG_TX 1142 1.17 bouyer printf("TL_INTR_TxEOC: ack %d (will be set to 1)\n", 1143 1.17 bouyer ack); 1144 1.1 bouyer #endif 1145 1.17 bouyer TL_HR_WRITE(sc, TL_HOST_CMD, 1 | int_type | 1146 1.17 bouyer HOST_CMD_ACK | HOST_CMD_IntOn); 1147 1.89 tsutsui if (sc->active_Tx != NULL) { 1148 1.17 bouyer /* needs a Tx go command */ 1149 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_CH_PARM, 1150 1.43 bouyer sc->active_Tx->hw_listaddr); 1151 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_CMD, HOST_CMD_GO); 1152 1.1 bouyer } 1153 1.1 bouyer sc->tl_if.if_timer = 0; 1154 1.107 ozaki if_schedule_deferred_start(&sc->tl_if); 1155 1.1 bouyer return 1; 1156 1.1 bouyer } 1157 1.1 bouyer #ifdef TLDEBUG 1158 1.1 bouyer else { 1159 1.1 bouyer printf("TL_INTR_TxEOF: ack %d\n", ack); 1160 1.1 bouyer } 1161 1.1 bouyer #endif 1162 1.1 bouyer sc->tl_if.if_timer = 0; 1163 1.107 ozaki if_schedule_deferred_start(&sc->tl_if); 1164 1.1 bouyer break; 1165 1.1 bouyer case TL_INTR_Stat: 1166 1.1 bouyer ack++; 1167 1.1 bouyer #ifdef TLDEBUG 1168 1.1 bouyer printf("TL_INTR_Stat: ack %d\n", ack); 1169 1.1 bouyer #endif 1170 1.1 bouyer tl_read_stats(sc); 1171 1.1 bouyer break; 1172 1.1 bouyer case TL_INTR_Adc: 1173 1.1 bouyer if (int_reg & TL_INTVec_MASK) { 1174 1.1 bouyer /* adapter check conditions */ 1175 1.17 bouyer printf("%s: check condition, intvect=0x%x, " 1176 1.89 tsutsui "ch_param=0x%x\n", device_xname(sc->sc_dev), 1177 1.17 bouyer int_reg & TL_INTVec_MASK, 1178 1.17 bouyer TL_HR_READ(sc, TL_HOST_CH_PARM)); 1179 1.1 bouyer tl_reset(sc); 1180 1.81 wiz /* schedule reinit of the board */ 1181 1.74 rumble callout_reset(&sc->tl_restart_ch, 1, tl_restart, ifp); 1182 1.89 tsutsui return 1; 1183 1.1 bouyer } else { 1184 1.89 tsutsui uint8_t netstat; 1185 1.1 bouyer /* Network status */ 1186 1.17 bouyer netstat = 1187 1.17 bouyer tl_intreg_read_byte(sc, TL_INT_NET+TL_INT_NetSts); 1188 1.1 bouyer printf("%s: network status, NetSts=%x\n", 1189 1.89 tsutsui device_xname(sc->sc_dev), netstat); 1190 1.1 bouyer /* Ack interrupts */ 1191 1.17 bouyer tl_intreg_write_byte(sc, TL_INT_NET+TL_INT_NetSts, 1192 1.59 tsutsui netstat); 1193 1.1 bouyer ack++; 1194 1.1 bouyer } 1195 1.1 bouyer break; 1196 1.1 bouyer default: 1197 1.1 bouyer printf("%s: unhandled interrupt code %x!\n", 1198 1.89 tsutsui device_xname(sc->sc_dev), int_type); 1199 1.1 bouyer ack++; 1200 1.1 bouyer } 1201 1.1 bouyer 1202 1.1 bouyer if (ack) { 1203 1.1 bouyer /* Ack the interrupt and enable interrupts */ 1204 1.59 tsutsui TL_HR_WRITE(sc, TL_HOST_CMD, ack | int_type | HOST_CMD_ACK | 1205 1.17 bouyer HOST_CMD_IntOn); 1206 1.97 tls rnd_add_uint32(&sc->rnd_source, int_reg); 1207 1.1 bouyer return 1; 1208 1.1 bouyer } 1209 1.1 bouyer /* ack = 0 ; interrupt was perhaps not our. Just enable interrupts */ 1210 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_CMD, HOST_CMD_IntOn); 1211 1.1 bouyer return 0; 1212 1.1 bouyer } 1213 1.1 bouyer 1214 1.1 bouyer static int 1215 1.87 dyoung tl_ifioctl(struct ifnet *ifp, unsigned long cmd, void *data) 1216 1.1 bouyer { 1217 1.1 bouyer struct tl_softc *sc = ifp->if_softc; 1218 1.1 bouyer int s, error; 1219 1.59 tsutsui 1220 1.14 mycroft s = splnet(); 1221 1.85 dyoung error = ether_ioctl(ifp, cmd, data); 1222 1.85 dyoung if (error == ENETRESET) { 1223 1.85 dyoung if (ifp->if_flags & IFF_RUNNING) 1224 1.85 dyoung tl_addr_filter(sc); 1225 1.85 dyoung error = 0; 1226 1.1 bouyer } 1227 1.1 bouyer splx(s); 1228 1.1 bouyer return error; 1229 1.1 bouyer } 1230 1.1 bouyer 1231 1.1 bouyer static void 1232 1.89 tsutsui tl_ifstart(struct ifnet *ifp) 1233 1.1 bouyer { 1234 1.1 bouyer tl_softc_t *sc = ifp->if_softc; 1235 1.43 bouyer struct mbuf *mb_head; 1236 1.1 bouyer struct Tx_list *Tx; 1237 1.79 rumble int segment, size; 1238 1.45 bouyer int again, error; 1239 1.59 tsutsui 1240 1.114 msaitoh if ((sc->tl_if.if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING) 1241 1.45 bouyer return; 1242 1.1 bouyer txloop: 1243 1.1 bouyer /* If we don't have more space ... */ 1244 1.1 bouyer if (sc->Free_Tx == NULL) { 1245 1.1 bouyer #ifdef TLDEBUG 1246 1.89 tsutsui printf("%s: No free TX list\n", __func__); 1247 1.1 bouyer #endif 1248 1.45 bouyer sc->tl_if.if_flags |= IFF_OACTIVE; 1249 1.1 bouyer return; 1250 1.1 bouyer } 1251 1.1 bouyer /* Grab a paquet for output */ 1252 1.50 itojun IFQ_DEQUEUE(&ifp->if_snd, mb_head); 1253 1.1 bouyer if (mb_head == NULL) { 1254 1.1 bouyer #ifdef TLDEBUG_TX 1255 1.89 tsutsui printf("%s: nothing to send\n", __func__); 1256 1.1 bouyer #endif 1257 1.1 bouyer return; 1258 1.1 bouyer } 1259 1.1 bouyer Tx = sc->Free_Tx; 1260 1.1 bouyer sc->Free_Tx = Tx->next; 1261 1.43 bouyer Tx->next = NULL; 1262 1.45 bouyer again = 0; 1263 1.1 bouyer /* 1264 1.1 bouyer * Go through each of the mbufs in the chain and initialize 1265 1.1 bouyer * the transmit list descriptors with the physical address 1266 1.1 bouyer * and size of the mbuf. 1267 1.1 bouyer */ 1268 1.1 bouyer tbdinit: 1269 1.43 bouyer memset(Tx->hw_list, 0, sizeof(struct tl_Tx_list)); 1270 1.1 bouyer Tx->m = mb_head; 1271 1.43 bouyer size = mb_head->m_pkthdr.len; 1272 1.43 bouyer if ((error = bus_dmamap_load_mbuf(sc->tl_dmatag, Tx->m_dmamap, mb_head, 1273 1.43 bouyer BUS_DMA_NOWAIT)) || (size < ETHER_MIN_TX && 1274 1.43 bouyer Tx->m_dmamap->dm_nsegs == TL_NSEG)) { 1275 1.43 bouyer struct mbuf *mn; 1276 1.1 bouyer /* 1277 1.17 bouyer * We ran out of segments, or we will. We have to recopy this 1278 1.17 bouyer * mbuf chain first. 1279 1.1 bouyer */ 1280 1.43 bouyer if (error == 0) 1281 1.43 bouyer bus_dmamap_unload(sc->tl_dmatag, Tx->m_dmamap); 1282 1.43 bouyer if (again) { 1283 1.123 andvar /* already copied, can't do much more */ 1284 1.43 bouyer m_freem(mb_head); 1285 1.43 bouyer goto bad; 1286 1.43 bouyer } 1287 1.43 bouyer again = 1; 1288 1.1 bouyer #ifdef TLDEBUG_TX 1289 1.89 tsutsui printf("%s: need to copy mbuf\n", __func__); 1290 1.1 bouyer #endif 1291 1.1 bouyer #ifdef TL_PRIV_STATS 1292 1.1 bouyer sc->oerr_mcopy++; 1293 1.1 bouyer #endif 1294 1.1 bouyer MGETHDR(mn, M_DONTWAIT, MT_DATA); 1295 1.1 bouyer if (mn == NULL) { 1296 1.1 bouyer m_freem(mb_head); 1297 1.1 bouyer goto bad; 1298 1.1 bouyer } 1299 1.1 bouyer if (mb_head->m_pkthdr.len > MHLEN) { 1300 1.1 bouyer MCLGET(mn, M_DONTWAIT); 1301 1.1 bouyer if ((mn->m_flags & M_EXT) == 0) { 1302 1.1 bouyer m_freem(mn); 1303 1.1 bouyer m_freem(mb_head); 1304 1.1 bouyer goto bad; 1305 1.1 bouyer } 1306 1.1 bouyer } 1307 1.1 bouyer m_copydata(mb_head, 0, mb_head->m_pkthdr.len, 1308 1.82 christos mtod(mn, void *)); 1309 1.1 bouyer mn->m_pkthdr.len = mn->m_len = mb_head->m_pkthdr.len; 1310 1.1 bouyer m_freem(mb_head); 1311 1.1 bouyer mb_head = mn; 1312 1.1 bouyer goto tbdinit; 1313 1.1 bouyer } 1314 1.79 rumble for (segment = 0; segment < Tx->m_dmamap->dm_nsegs; segment++) { 1315 1.79 rumble Tx->hw_list->seg[segment].data_addr = 1316 1.79 rumble htole32(Tx->m_dmamap->dm_segs[segment].ds_addr); 1317 1.79 rumble Tx->hw_list->seg[segment].data_count = 1318 1.79 rumble htole32(Tx->m_dmamap->dm_segs[segment].ds_len); 1319 1.43 bouyer } 1320 1.61 tsutsui bus_dmamap_sync(sc->tl_dmatag, Tx->m_dmamap, 0, 1321 1.61 tsutsui Tx->m_dmamap->dm_mapsize, 1322 1.43 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 1323 1.1 bouyer /* We are at end of mbuf chain. check the size and 1324 1.1 bouyer * see if it needs to be extended 1325 1.59 tsutsui */ 1326 1.1 bouyer if (size < ETHER_MIN_TX) { 1327 1.1 bouyer #ifdef DIAGNOSTIC 1328 1.79 rumble if (segment >= TL_NSEG) { 1329 1.123 andvar panic("%s: too much segments (%d)", __func__, segment); 1330 1.1 bouyer } 1331 1.1 bouyer #endif 1332 1.1 bouyer /* 1333 1.115 msaitoh * add the nullbuf in the seg 1334 1.115 msaitoh */ 1335 1.79 rumble Tx->hw_list->seg[segment].data_count = 1336 1.43 bouyer htole32(ETHER_MIN_TX - size); 1337 1.79 rumble Tx->hw_list->seg[segment].data_addr = 1338 1.44 bouyer htole32(sc->null_dmamap->dm_segs[0].ds_addr); 1339 1.1 bouyer size = ETHER_MIN_TX; 1340 1.79 rumble segment++; 1341 1.1 bouyer } 1342 1.1 bouyer /* The list is done, finish the list init */ 1343 1.79 rumble Tx->hw_list->seg[segment - 1].data_count |= 1344 1.43 bouyer htole32(TL_LAST_SEG); 1345 1.43 bouyer Tx->hw_list->stat = htole32((size << 16) | 0x3000); 1346 1.1 bouyer #ifdef TLDEBUG_TX 1347 1.89 tsutsui printf("%s: sending, Tx : stat = 0x%x\n", device_xname(sc->sc_dev), 1348 1.43 bouyer le32toh(Tx->hw_list->stat)); 1349 1.59 tsutsui #if 0 1350 1.89 tsutsui for (segment = 0; segment < TL_NSEG; segment++) { 1351 1.1 bouyer printf(" seg %d addr 0x%x len 0x%x\n", 1352 1.79 rumble segment, 1353 1.79 rumble le32toh(Tx->hw_list->seg[segment].data_addr), 1354 1.79 rumble le32toh(Tx->hw_list->seg[segment].data_count)); 1355 1.1 bouyer } 1356 1.1 bouyer #endif 1357 1.1 bouyer #endif 1358 1.1 bouyer if (sc->active_Tx == NULL) { 1359 1.1 bouyer sc->active_Tx = sc->last_Tx = Tx; 1360 1.1 bouyer #ifdef TLDEBUG_TX 1361 1.89 tsutsui printf("%s: Tx GO, addr=0x%ux\n", device_xname(sc->sc_dev), 1362 1.44 bouyer (int)Tx->hw_listaddr); 1363 1.1 bouyer #endif 1364 1.43 bouyer bus_dmamap_sync(sc->tl_dmatag, sc->Tx_dmamap, 0, 1365 1.43 bouyer sizeof(struct tl_Tx_list) * TL_NBUF, 1366 1.43 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 1367 1.43 bouyer TL_HR_WRITE(sc, TL_HOST_CH_PARM, Tx->hw_listaddr); 1368 1.1 bouyer TL_HR_WRITE(sc, TL_HOST_CMD, HOST_CMD_GO); 1369 1.1 bouyer } else { 1370 1.1 bouyer #ifdef TLDEBUG_TX 1371 1.89 tsutsui printf("%s: Tx addr=0x%ux queued\n", device_xname(sc->sc_dev), 1372 1.44 bouyer (int)Tx->hw_listaddr); 1373 1.1 bouyer #endif 1374 1.43 bouyer sc->last_Tx->hw_list->fwd = htole32(Tx->hw_listaddr); 1375 1.45 bouyer bus_dmamap_sync(sc->tl_dmatag, sc->Tx_dmamap, 0, 1376 1.45 bouyer sizeof(struct tl_Tx_list) * TL_NBUF, 1377 1.45 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE); 1378 1.1 bouyer sc->last_Tx->next = Tx; 1379 1.1 bouyer sc->last_Tx = Tx; 1380 1.1 bouyer #ifdef DIAGNOSTIC 1381 1.43 bouyer if (sc->last_Tx->hw_list->fwd & 0x7) 1382 1.17 bouyer printf("%s: physical addr 0x%x of list not properly " 1383 1.89 tsutsui "aligned\n", 1384 1.89 tsutsui device_xname(sc->sc_dev), 1385 1.89 tsutsui sc->last_Rx->hw_list->fwd); 1386 1.1 bouyer #endif 1387 1.1 bouyer } 1388 1.1 bouyer /* Pass packet to bpf if there is a listener */ 1389 1.109 msaitoh bpf_mtap(ifp, mb_head, BPF_D_OUT); 1390 1.17 bouyer /* 1391 1.17 bouyer * Set a 5 second timer just in case we don't hear from the card again. 1392 1.17 bouyer */ 1393 1.1 bouyer ifp->if_timer = 5; 1394 1.1 bouyer goto txloop; 1395 1.1 bouyer bad: 1396 1.1 bouyer #ifdef TLDEBUG 1397 1.89 tsutsui printf("%s: Out of mbuf, Tx pkt lost\n", __func__); 1398 1.1 bouyer #endif 1399 1.1 bouyer Tx->next = sc->Free_Tx; 1400 1.1 bouyer sc->Free_Tx = Tx; 1401 1.1 bouyer } 1402 1.1 bouyer 1403 1.1 bouyer static void 1404 1.89 tsutsui tl_ifwatchdog(struct ifnet *ifp) 1405 1.1 bouyer { 1406 1.1 bouyer tl_softc_t *sc = ifp->if_softc; 1407 1.1 bouyer 1408 1.1 bouyer if ((ifp->if_flags & IFF_RUNNING) == 0) 1409 1.1 bouyer return; 1410 1.89 tsutsui printf("%s: device timeout\n", device_xname(sc->sc_dev)); 1411 1.119 thorpej if_statinc(ifp, if_oerrors); 1412 1.46 bouyer tl_init(ifp); 1413 1.1 bouyer } 1414 1.1 bouyer 1415 1.1 bouyer static int 1416 1.89 tsutsui tl_add_RxBuff(tl_softc_t *sc, struct Rx_list *Rx, struct mbuf *oldm) 1417 1.1 bouyer { 1418 1.1 bouyer struct mbuf *m; 1419 1.43 bouyer int error; 1420 1.1 bouyer 1421 1.1 bouyer MGETHDR(m, M_DONTWAIT, MT_DATA); 1422 1.1 bouyer if (m != NULL) { 1423 1.1 bouyer MCLGET(m, M_DONTWAIT); 1424 1.1 bouyer if ((m->m_flags & M_EXT) == 0) { 1425 1.1 bouyer m_freem(m); 1426 1.1 bouyer if (oldm == NULL) 1427 1.1 bouyer return 0; 1428 1.1 bouyer m = oldm; 1429 1.1 bouyer m->m_data = m->m_ext.ext_buf; 1430 1.1 bouyer } 1431 1.1 bouyer } else { 1432 1.1 bouyer if (oldm == NULL) 1433 1.1 bouyer return 0; 1434 1.1 bouyer m = oldm; 1435 1.1 bouyer m->m_data = m->m_ext.ext_buf; 1436 1.1 bouyer } 1437 1.43 bouyer 1438 1.43 bouyer /* (re)init the Rx_list struct */ 1439 1.43 bouyer 1440 1.43 bouyer Rx->m = m; 1441 1.43 bouyer if ((error = bus_dmamap_load(sc->tl_dmatag, Rx->m_dmamap, 1442 1.43 bouyer m->m_ext.ext_buf, m->m_ext.ext_size, NULL, BUS_DMA_NOWAIT)) != 0) { 1443 1.89 tsutsui printf("%s: bus_dmamap_load() failed (error %d) for " 1444 1.89 tsutsui "tl_add_RxBuff ", device_xname(sc->sc_dev), error); 1445 1.43 bouyer printf("size %d (%d)\n", m->m_pkthdr.len, MCLBYTES); 1446 1.43 bouyer m_freem(m); 1447 1.43 bouyer Rx->m = NULL; 1448 1.43 bouyer return 0; 1449 1.43 bouyer } 1450 1.43 bouyer bus_dmamap_sync(sc->tl_dmatag, Rx->m_dmamap, 0, 1451 1.61 tsutsui Rx->m_dmamap->dm_mapsize, BUS_DMASYNC_PREREAD); 1452 1.1 bouyer /* 1453 1.1 bouyer * Move the data pointer up so that the incoming data packet 1454 1.1 bouyer * will be 32-bit aligned. 1455 1.1 bouyer */ 1456 1.1 bouyer m->m_data += 2; 1457 1.1 bouyer 1458 1.43 bouyer Rx->hw_list->stat = 1459 1.59 tsutsui htole32(((Rx->m_dmamap->dm_segs[0].ds_len - 2) << 16) | 0x3000); 1460 1.43 bouyer Rx->hw_list->seg.data_count = 1461 1.59 tsutsui htole32(Rx->m_dmamap->dm_segs[0].ds_len - 2); 1462 1.43 bouyer Rx->hw_list->seg.data_addr = 1463 1.43 bouyer htole32(Rx->m_dmamap->dm_segs[0].ds_addr + 2); 1464 1.1 bouyer return (m != oldm); 1465 1.1 bouyer } 1466 1.1 bouyer 1467 1.89 tsutsui static void 1468 1.89 tsutsui tl_ticks(void *v) 1469 1.1 bouyer { 1470 1.1 bouyer tl_softc_t *sc = v; 1471 1.1 bouyer 1472 1.1 bouyer tl_read_stats(sc); 1473 1.19 thorpej 1474 1.19 thorpej /* Tick the MII. */ 1475 1.19 thorpej mii_tick(&sc->tl_mii); 1476 1.19 thorpej 1477 1.17 bouyer /* read statistics every seconds */ 1478 1.32 thorpej callout_reset(&sc->tl_tick_ch, hz, tl_ticks, sc); 1479 1.17 bouyer } 1480 1.17 bouyer 1481 1.17 bouyer static void 1482 1.89 tsutsui tl_read_stats(tl_softc_t *sc) 1483 1.17 bouyer { 1484 1.89 tsutsui uint32_t reg; 1485 1.17 bouyer int ierr_overr; 1486 1.17 bouyer int ierr_code; 1487 1.17 bouyer int ierr_crc; 1488 1.17 bouyer int oerr_underr; 1489 1.63 wiz int oerr_deferred; 1490 1.17 bouyer int oerr_coll; 1491 1.17 bouyer int oerr_multicoll; 1492 1.17 bouyer int oerr_exesscoll; 1493 1.17 bouyer int oerr_latecoll; 1494 1.17 bouyer int oerr_carrloss; 1495 1.17 bouyer struct ifnet *ifp = &sc->tl_if; 1496 1.17 bouyer 1497 1.119 thorpej net_stat_ref_t nsr = IF_STAT_GETREF(ifp); 1498 1.119 thorpej 1499 1.17 bouyer reg = tl_intreg_read(sc, TL_INT_STATS_TX); 1500 1.126 riastrad if_statadd_ref(ifp, nsr, if_opackets, reg & 0x00ffffff); 1501 1.17 bouyer oerr_underr = reg >> 24; 1502 1.17 bouyer 1503 1.17 bouyer reg = tl_intreg_read(sc, TL_INT_STATS_RX); 1504 1.17 bouyer ierr_overr = reg >> 24; 1505 1.17 bouyer 1506 1.17 bouyer reg = tl_intreg_read(sc, TL_INT_STATS_FERR); 1507 1.17 bouyer ierr_crc = (reg & TL_FERR_CRC) >> 16; 1508 1.17 bouyer ierr_code = (reg & TL_FERR_CODE) >> 24; 1509 1.63 wiz oerr_deferred = (reg & TL_FERR_DEF); 1510 1.17 bouyer 1511 1.17 bouyer reg = tl_intreg_read(sc, TL_INT_STATS_COLL); 1512 1.17 bouyer oerr_multicoll = (reg & TL_COL_MULTI); 1513 1.17 bouyer oerr_coll = (reg & TL_COL_SINGLE) >> 16; 1514 1.17 bouyer 1515 1.17 bouyer reg = tl_intreg_read(sc, TL_INT_LERR); 1516 1.17 bouyer oerr_exesscoll = (reg & TL_LERR_ECOLL); 1517 1.17 bouyer oerr_latecoll = (reg & TL_LERR_LCOLL) >> 8; 1518 1.17 bouyer oerr_carrloss = (reg & TL_LERR_CL) >> 16; 1519 1.17 bouyer 1520 1.126 riastrad if_statadd_ref(ifp, nsr, if_oerrors, 1521 1.119 thorpej oerr_underr + oerr_exesscoll + oerr_latecoll + oerr_carrloss); 1522 1.126 riastrad if_statadd_ref(ifp, nsr, if_collisions, oerr_coll + oerr_multicoll); 1523 1.126 riastrad if_statadd_ref(ifp, nsr, if_ierrors, 1524 1.126 riastrad ierr_overr + ierr_code + ierr_crc); 1525 1.119 thorpej IF_STAT_PUTREF(ifp); 1526 1.17 bouyer 1527 1.17 bouyer if (ierr_overr) 1528 1.17 bouyer printf("%s: receiver ring buffer overrun\n", 1529 1.89 tsutsui device_xname(sc->sc_dev)); 1530 1.17 bouyer if (oerr_underr) 1531 1.17 bouyer printf("%s: transmit buffer underrun\n", 1532 1.89 tsutsui device_xname(sc->sc_dev)); 1533 1.17 bouyer #ifdef TL_PRIV_STATS 1534 1.17 bouyer sc->ierr_overr += ierr_overr; 1535 1.17 bouyer sc->ierr_code += ierr_code; 1536 1.17 bouyer sc->ierr_crc += ierr_crc; 1537 1.17 bouyer sc->oerr_underr += oerr_underr; 1538 1.63 wiz sc->oerr_deferred += oerr_deferred; 1539 1.17 bouyer sc->oerr_coll += oerr_coll; 1540 1.17 bouyer sc->oerr_multicoll += oerr_multicoll; 1541 1.17 bouyer sc->oerr_exesscoll += oerr_exesscoll; 1542 1.17 bouyer sc->oerr_latecoll += oerr_latecoll; 1543 1.17 bouyer sc->oerr_carrloss += oerr_carrloss; 1544 1.17 bouyer #endif 1545 1.17 bouyer } 1546 1.1 bouyer 1547 1.89 tsutsui static void 1548 1.89 tsutsui tl_addr_filter(tl_softc_t *sc) 1549 1.17 bouyer { 1550 1.116 msaitoh struct ethercom *ec = &sc->tl_ec; 1551 1.17 bouyer struct ether_multistep step; 1552 1.17 bouyer struct ether_multi *enm; 1553 1.89 tsutsui uint32_t hash[2] = {0, 0}; 1554 1.17 bouyer int i; 1555 1.1 bouyer 1556 1.17 bouyer sc->tl_if.if_flags &= ~IFF_ALLMULTI; 1557 1.116 msaitoh ETHER_LOCK(ec); 1558 1.116 msaitoh ETHER_FIRST_MULTI(step, ec, enm); 1559 1.17 bouyer while (enm != NULL) { 1560 1.17 bouyer #ifdef TLDEBUG 1561 1.89 tsutsui printf("%s: addrs %s %s\n", __func__, 1562 1.17 bouyer ether_sprintf(enm->enm_addrlo), 1563 1.17 bouyer ether_sprintf(enm->enm_addrhi)); 1564 1.17 bouyer #endif 1565 1.17 bouyer if (memcmp(enm->enm_addrlo, enm->enm_addrhi, 6) == 0) { 1566 1.17 bouyer i = tl_multicast_hash(enm->enm_addrlo); 1567 1.89 tsutsui hash[i / 32] |= 1 << (i%32); 1568 1.17 bouyer } else { 1569 1.17 bouyer hash[0] = hash[1] = 0xffffffff; 1570 1.17 bouyer sc->tl_if.if_flags |= IFF_ALLMULTI; 1571 1.17 bouyer break; 1572 1.1 bouyer } 1573 1.17 bouyer ETHER_NEXT_MULTI(step, enm); 1574 1.17 bouyer } 1575 1.116 msaitoh ETHER_UNLOCK(ec); 1576 1.17 bouyer #ifdef TLDEBUG 1577 1.89 tsutsui printf("%s: hash1 %x has2 %x\n", __func__, hash[0], hash[1]); 1578 1.17 bouyer #endif 1579 1.17 bouyer tl_intreg_write(sc, TL_INT_HASH1, hash[0]); 1580 1.17 bouyer tl_intreg_write(sc, TL_INT_HASH2, hash[1]); 1581 1.17 bouyer } 1582 1.1 bouyer 1583 1.89 tsutsui static int 1584 1.89 tsutsui tl_multicast_hash(uint8_t *a) 1585 1.17 bouyer { 1586 1.17 bouyer int hash; 1587 1.17 bouyer 1588 1.114 msaitoh #define DA(addr, bit) (addr[5 - (bit / 8)] & (1 << (bit % 8))) 1589 1.114 msaitoh #define xor8(a, b, c, d, e, f, g, h) \ 1590 1.115 msaitoh (((a != 0) + (b != 0) + (c != 0) + (d != 0) + \ 1591 1.89 tsutsui (e != 0) + (f != 0) + (g != 0) + (h != 0)) & 1) 1592 1.17 bouyer 1593 1.89 tsutsui hash = xor8(DA(a,0), DA(a, 6), DA(a,12), DA(a,18), DA(a,24), DA(a,30), 1594 1.17 bouyer DA(a,36), DA(a,42)); 1595 1.89 tsutsui hash |= xor8(DA(a,1), DA(a, 7), DA(a,13), DA(a,19), DA(a,25), DA(a,31), 1596 1.17 bouyer DA(a,37), DA(a,43)) << 1; 1597 1.89 tsutsui hash |= xor8(DA(a,2), DA(a, 8), DA(a,14), DA(a,20), DA(a,26), DA(a,32), 1598 1.17 bouyer DA(a,38), DA(a,44)) << 2; 1599 1.89 tsutsui hash |= xor8(DA(a,3), DA(a, 9), DA(a,15), DA(a,21), DA(a,27), DA(a,33), 1600 1.17 bouyer DA(a,39), DA(a,45)) << 3; 1601 1.89 tsutsui hash |= xor8(DA(a,4), DA(a,10), DA(a,16), DA(a,22), DA(a,28), DA(a,34), 1602 1.17 bouyer DA(a,40), DA(a,46)) << 4; 1603 1.89 tsutsui hash |= xor8(DA(a,5), DA(a,11), DA(a,17), DA(a,23), DA(a,29), DA(a,35), 1604 1.17 bouyer DA(a,41), DA(a,47)) << 5; 1605 1.1 bouyer 1606 1.17 bouyer return hash; 1607 1.17 bouyer } 1608 1.1 bouyer 1609 1.59 tsutsui #if defined(TLDEBUG_RX) 1610 1.17 bouyer void 1611 1.89 tsutsui ether_printheader(struct ether_header *eh) 1612 1.17 bouyer { 1613 1.89 tsutsui uint8_t *c = (uint8_t *)eh; 1614 1.17 bouyer int i; 1615 1.89 tsutsui 1616 1.89 tsutsui for (i = 0; i < sizeof(struct ether_header); i++) 1617 1.89 tsutsui printf("%02x ", (u_int)c[i]); 1618 1.89 tsutsui printf("\n"); 1619 1.17 bouyer } 1620 1.1 bouyer #endif 1621