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