sbmac.c revision 1.35 1 1.35 matt /* $NetBSD: sbmac.c,v 1.35 2009/12/14 00:46:08 matt Exp $ */
2 1.1 simonb
3 1.1 simonb /*
4 1.19 cgd * Copyright 2000, 2001, 2004
5 1.1 simonb * Broadcom Corporation. All rights reserved.
6 1.1 simonb *
7 1.1 simonb * This software is furnished under license and may be used and copied only
8 1.1 simonb * in accordance with the following terms and conditions. Subject to these
9 1.1 simonb * conditions, you may download, copy, install, use, modify and distribute
10 1.1 simonb * modified or unmodified copies of this software in source and/or binary
11 1.1 simonb * form. No title or ownership is transferred hereby.
12 1.1 simonb *
13 1.1 simonb * 1) Any source code used, modified or distributed must reproduce and
14 1.1 simonb * retain this copyright notice and list of conditions as they appear in
15 1.1 simonb * the source file.
16 1.1 simonb *
17 1.1 simonb * 2) No right is granted to use any trade name, trademark, or logo of
18 1.9 cgd * Broadcom Corporation. The "Broadcom Corporation" name may not be
19 1.9 cgd * used to endorse or promote products derived from this software
20 1.9 cgd * without the prior written permission of Broadcom Corporation.
21 1.1 simonb *
22 1.1 simonb * 3) THIS SOFTWARE IS PROVIDED "AS-IS" AND ANY EXPRESS OR IMPLIED
23 1.1 simonb * WARRANTIES, INCLUDING BUT NOT LIMITED TO, ANY IMPLIED WARRANTIES OF
24 1.1 simonb * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE, OR
25 1.1 simonb * NON-INFRINGEMENT ARE DISCLAIMED. IN NO EVENT SHALL BROADCOM BE LIABLE
26 1.1 simonb * FOR ANY DAMAGES WHATSOEVER, AND IN PARTICULAR, BROADCOM SHALL NOT BE
27 1.1 simonb * LIABLE FOR DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
28 1.1 simonb * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
29 1.1 simonb * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
30 1.1 simonb * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
31 1.1 simonb * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
32 1.1 simonb * OR OTHERWISE), EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33 1.1 simonb */
34 1.10 lukem
35 1.10 lukem #include <sys/cdefs.h>
36 1.35 matt __KERNEL_RCSID(0, "$NetBSD: sbmac.c,v 1.35 2009/12/14 00:46:08 matt Exp $");
37 1.1 simonb
38 1.1 simonb #include "bpfilter.h"
39 1.1 simonb #include "opt_inet.h"
40 1.1 simonb #include "opt_ns.h"
41 1.1 simonb
42 1.1 simonb #include <sys/param.h>
43 1.1 simonb #include <sys/systm.h>
44 1.1 simonb #include <sys/sockio.h>
45 1.1 simonb #include <sys/mbuf.h>
46 1.1 simonb #include <sys/malloc.h>
47 1.1 simonb #include <sys/kernel.h>
48 1.1 simonb #include <sys/socket.h>
49 1.1 simonb #include <sys/queue.h>
50 1.1 simonb #include <sys/device.h>
51 1.1 simonb
52 1.1 simonb #include <net/if.h>
53 1.1 simonb #include <net/if_arp.h>
54 1.1 simonb #include <net/if_ether.h>
55 1.1 simonb #include <net/if_dl.h>
56 1.1 simonb #include <net/if_media.h>
57 1.1 simonb
58 1.1 simonb #if NBPFILTER > 0
59 1.1 simonb #include <net/bpf.h>
60 1.1 simonb #endif
61 1.1 simonb
62 1.1 simonb #ifdef INET
63 1.1 simonb #include <netinet/in.h>
64 1.1 simonb #include <netinet/if_inarp.h>
65 1.1 simonb #endif
66 1.1 simonb
67 1.1 simonb #ifdef NS
68 1.1 simonb #include <netns/ns.h>
69 1.1 simonb #include <netns/ns_if.h>
70 1.1 simonb #endif
71 1.1 simonb
72 1.1 simonb #include <machine/locore.h>
73 1.1 simonb
74 1.1 simonb #include "sbobiovar.h"
75 1.1 simonb
76 1.1 simonb #include <dev/mii/mii.h>
77 1.1 simonb #include <dev/mii/miivar.h>
78 1.1 simonb #include <dev/mii/mii_bitbang.h>
79 1.1 simonb
80 1.1 simonb #include <mips/sibyte/include/sb1250_defs.h>
81 1.1 simonb #include <mips/sibyte/include/sb1250_regs.h>
82 1.1 simonb #include <mips/sibyte/include/sb1250_mac.h>
83 1.1 simonb #include <mips/sibyte/include/sb1250_dma.h>
84 1.8 cgd #include <mips/sibyte/include/sb1250_scd.h>
85 1.1 simonb
86 1.3 simonb /* Simple types */
87 1.1 simonb
88 1.1 simonb typedef u_long sbmac_port_t;
89 1.1 simonb typedef uint64_t sbmac_physaddr_t;
90 1.1 simonb typedef uint64_t sbmac_enetaddr_t;
91 1.1 simonb
92 1.1 simonb typedef enum { sbmac_speed_auto, sbmac_speed_10,
93 1.1 simonb sbmac_speed_100, sbmac_speed_1000 } sbmac_speed_t;
94 1.1 simonb
95 1.1 simonb typedef enum { sbmac_duplex_auto, sbmac_duplex_half,
96 1.1 simonb sbmac_duplex_full } sbmac_duplex_t;
97 1.1 simonb
98 1.1 simonb typedef enum { sbmac_fc_auto, sbmac_fc_disabled, sbmac_fc_frame,
99 1.1 simonb sbmac_fc_collision, sbmac_fc_carrier } sbmac_fc_t;
100 1.1 simonb
101 1.1 simonb typedef enum { sbmac_state_uninit, sbmac_state_off, sbmac_state_on,
102 1.1 simonb sbmac_state_broken } sbmac_state_t;
103 1.1 simonb
104 1.1 simonb
105 1.3 simonb /* Macros */
106 1.1 simonb
107 1.15 simonb #define SBMAC_EVENT_COUNTERS /* Include counters for various events */
108 1.15 simonb
109 1.19 cgd #define SBDMA_NEXTBUF(d, f) ((f + 1) & (d)->sbdma_dscr_mask)
110 1.1 simonb
111 1.1 simonb #define CACHELINESIZE 32
112 1.1 simonb #define NUMCACHEBLKS(x) (((x)+CACHELINESIZE-1)/CACHELINESIZE)
113 1.1 simonb #define KMALLOC(x) malloc((x), M_DEVBUF, M_DONTWAIT)
114 1.1 simonb #define KVTOPHYS(x) kvtophys((vaddr_t)(x))
115 1.1 simonb
116 1.1 simonb #ifdef SBMACDEBUG
117 1.1 simonb #define dprintf(x) printf x
118 1.1 simonb #else
119 1.1 simonb #define dprintf(x)
120 1.1 simonb #endif
121 1.1 simonb
122 1.35 matt #define SBMAC_READCSR(t) mips3_ld((volatile uint64_t *) (t))
123 1.35 matt #define SBMAC_WRITECSR(t, v) mips3_sd((volatile uint64_t *) (t), (v))
124 1.1 simonb
125 1.1 simonb #define PKSEG1(x) ((sbmac_port_t) MIPS_PHYS_TO_KSEG1(x))
126 1.1 simonb
127 1.19 cgd /* These are limited to fit within one virtual page, and must be 2**N. */
128 1.17 cgd #define SBMAC_MAX_TXDESCR 256 /* should be 1024 */
129 1.17 cgd #define SBMAC_MAX_RXDESCR 256 /* should be 512 */
130 1.1 simonb
131 1.1 simonb #define ETHER_ALIGN 2
132 1.1 simonb
133 1.3 simonb /* DMA Descriptor structure */
134 1.1 simonb
135 1.1 simonb typedef struct sbdmadscr_s {
136 1.1 simonb uint64_t dscr_a;
137 1.1 simonb uint64_t dscr_b;
138 1.1 simonb } sbdmadscr_t;
139 1.1 simonb
140 1.3 simonb
141 1.3 simonb /* DMA Controller structure */
142 1.1 simonb
143 1.1 simonb typedef struct sbmacdma_s {
144 1.1 simonb
145 1.1 simonb /*
146 1.1 simonb * This stuff is used to identify the channel and the registers
147 1.1 simonb * associated with it.
148 1.1 simonb */
149 1.1 simonb
150 1.1 simonb struct sbmac_softc *sbdma_eth; /* back pointer to associated MAC */
151 1.1 simonb int sbdma_channel; /* channel number */
152 1.1 simonb int sbdma_txdir; /* direction (1=transmit) */
153 1.1 simonb int sbdma_maxdescr; /* total # of descriptors in ring */
154 1.1 simonb sbmac_port_t sbdma_config0; /* DMA config register 0 */
155 1.1 simonb sbmac_port_t sbdma_config1; /* DMA config register 1 */
156 1.1 simonb sbmac_port_t sbdma_dscrbase; /* Descriptor base address */
157 1.1 simonb sbmac_port_t sbdma_dscrcnt; /* Descriptor count register */
158 1.1 simonb sbmac_port_t sbdma_curdscr; /* current descriptor address */
159 1.1 simonb
160 1.1 simonb /*
161 1.1 simonb * This stuff is for maintenance of the ring
162 1.1 simonb */
163 1.1 simonb sbdmadscr_t *sbdma_dscrtable; /* base of descriptor table */
164 1.1 simonb struct mbuf **sbdma_ctxtable; /* context table, one per descr */
165 1.19 cgd unsigned int sbdma_dscr_mask; /* sbdma_maxdescr - 1 */
166 1.1 simonb paddr_t sbdma_dscrtable_phys; /* and also the phys addr */
167 1.19 cgd unsigned int sbdma_add_index; /* next dscr for sw to add */
168 1.19 cgd unsigned int sbdma_rem_index; /* next dscr for sw to remove */
169 1.1 simonb } sbmacdma_t;
170 1.1 simonb
171 1.1 simonb
172 1.3 simonb /* Ethernet softc structure */
173 1.1 simonb
174 1.1 simonb struct sbmac_softc {
175 1.1 simonb
176 1.1 simonb /*
177 1.1 simonb * NetBSD-specific things
178 1.1 simonb */
179 1.1 simonb struct device sc_dev; /* base device (must be first) */
180 1.1 simonb struct ethercom sc_ethercom; /* Ethernet common part */
181 1.1 simonb struct mii_data sc_mii;
182 1.1 simonb struct callout sc_tick_ch;
183 1.1 simonb
184 1.1 simonb int sbm_if_flags;
185 1.1 simonb void *sbm_intrhand;
186 1.1 simonb
187 1.1 simonb /*
188 1.1 simonb * Controller-specific things
189 1.1 simonb */
190 1.1 simonb
191 1.1 simonb sbmac_port_t sbm_base; /* MAC's base address */
192 1.1 simonb sbmac_state_t sbm_state; /* current state */
193 1.1 simonb
194 1.1 simonb sbmac_port_t sbm_macenable; /* MAC Enable Register */
195 1.1 simonb sbmac_port_t sbm_maccfg; /* MAC Configuration Register */
196 1.1 simonb sbmac_port_t sbm_fifocfg; /* FIFO configuration register */
197 1.1 simonb sbmac_port_t sbm_framecfg; /* Frame configuration register */
198 1.1 simonb sbmac_port_t sbm_rxfilter; /* receive filter register */
199 1.1 simonb sbmac_port_t sbm_isr; /* Interrupt status register */
200 1.1 simonb sbmac_port_t sbm_imr; /* Interrupt mask register */
201 1.1 simonb
202 1.1 simonb sbmac_speed_t sbm_speed; /* current speed */
203 1.1 simonb sbmac_duplex_t sbm_duplex; /* current duplex */
204 1.1 simonb sbmac_fc_t sbm_fc; /* current flow control setting */
205 1.1 simonb int sbm_rxflags; /* received packet flags */
206 1.1 simonb
207 1.1 simonb u_char sbm_hwaddr[ETHER_ADDR_LEN];
208 1.1 simonb
209 1.1 simonb sbmacdma_t sbm_txdma; /* for now, only use channel 0 */
210 1.1 simonb sbmacdma_t sbm_rxdma;
211 1.8 cgd
212 1.8 cgd int sbm_pass3_dma; /* chip has pass3 SOC DMA features */
213 1.15 simonb
214 1.15 simonb #ifdef SBMAC_EVENT_COUNTERS
215 1.15 simonb struct evcnt sbm_ev_rxintr; /* Rx interrupts */
216 1.15 simonb struct evcnt sbm_ev_txintr; /* Tx interrupts */
217 1.15 simonb struct evcnt sbm_ev_txdrop; /* Tx dropped due to no mbuf alloc failed */
218 1.15 simonb struct evcnt sbm_ev_txstall; /* Tx stalled due to no descriptors free */
219 1.15 simonb
220 1.15 simonb struct evcnt sbm_ev_txsplit; /* pass3 Tx split mbuf */
221 1.15 simonb struct evcnt sbm_ev_txkeep; /* pass3 Tx didn't split mbuf */
222 1.15 simonb #endif
223 1.1 simonb };
224 1.1 simonb
225 1.1 simonb
226 1.15 simonb #ifdef SBMAC_EVENT_COUNTERS
227 1.15 simonb #define SBMAC_EVCNT_INCR(ev) (ev).ev_count++
228 1.15 simonb #else
229 1.15 simonb #define SBMAC_EVCNT_INCR(ev) do { /* nothing */ } while (0)
230 1.15 simonb #endif
231 1.15 simonb
232 1.3 simonb /* Externs */
233 1.1 simonb
234 1.1 simonb extern paddr_t kvtophys(vaddr_t);
235 1.1 simonb
236 1.3 simonb /* Prototypes */
237 1.1 simonb
238 1.1 simonb static void sbdma_initctx(sbmacdma_t *d, struct sbmac_softc *s, int chan,
239 1.1 simonb int txrx, int maxdescr);
240 1.1 simonb static void sbdma_channel_start(sbmacdma_t *d);
241 1.1 simonb static int sbdma_add_rcvbuffer(sbmacdma_t *d, struct mbuf *m);
242 1.1 simonb static int sbdma_add_txbuffer(sbmacdma_t *d, struct mbuf *m);
243 1.1 simonb static void sbdma_emptyring(sbmacdma_t *d);
244 1.1 simonb static void sbdma_fillring(sbmacdma_t *d);
245 1.1 simonb static void sbdma_rx_process(struct sbmac_softc *sc, sbmacdma_t *d);
246 1.1 simonb static void sbdma_tx_process(struct sbmac_softc *sc, sbmacdma_t *d);
247 1.1 simonb static void sbmac_initctx(struct sbmac_softc *s);
248 1.1 simonb static void sbmac_channel_start(struct sbmac_softc *s);
249 1.1 simonb static void sbmac_channel_stop(struct sbmac_softc *s);
250 1.1 simonb static sbmac_state_t sbmac_set_channel_state(struct sbmac_softc *,
251 1.1 simonb sbmac_state_t);
252 1.1 simonb static void sbmac_promiscuous_mode(struct sbmac_softc *sc, int onoff);
253 1.1 simonb static void sbmac_init_and_start(struct sbmac_softc *sc);
254 1.1 simonb static uint64_t sbmac_addr2reg(u_char *ptr);
255 1.35 matt static void sbmac_intr(void *xsc, uint32_t status, vaddr_t pc);
256 1.1 simonb static void sbmac_start(struct ifnet *ifp);
257 1.1 simonb static void sbmac_setmulti(struct sbmac_softc *sc);
258 1.22 christos static int sbmac_ether_ioctl(struct ifnet *ifp, u_long cmd, void *data);
259 1.30 dyoung static int sbmac_ioctl(struct ifnet *, u_long, void *);
260 1.1 simonb static void sbmac_watchdog(struct ifnet *ifp);
261 1.1 simonb static int sbmac_match(struct device *parent, struct cfdata *match, void *aux);
262 1.1 simonb static void sbmac_attach(struct device *parent, struct device *self, void *aux);
263 1.1 simonb static int sbmac_set_speed(struct sbmac_softc *s, sbmac_speed_t speed);
264 1.1 simonb static int sbmac_set_duplex(struct sbmac_softc *s, sbmac_duplex_t duplex,
265 1.1 simonb sbmac_fc_t fc);
266 1.1 simonb static void sbmac_tick(void *arg);
267 1.1 simonb
268 1.1 simonb
269 1.3 simonb /* Globals */
270 1.1 simonb
271 1.5 thorpej CFATTACH_DECL(sbmac, sizeof(struct sbmac_softc),
272 1.6 thorpej sbmac_match, sbmac_attach, NULL, NULL);
273 1.1 simonb
274 1.3 simonb static uint32_t sbmac_mii_bitbang_read(struct device *self);
275 1.3 simonb static void sbmac_mii_bitbang_write(struct device *self, uint32_t val);
276 1.1 simonb
277 1.1 simonb static const struct mii_bitbang_ops sbmac_mii_bitbang_ops = {
278 1.1 simonb sbmac_mii_bitbang_read,
279 1.1 simonb sbmac_mii_bitbang_write,
280 1.1 simonb {
281 1.1 simonb (uint32_t)M_MAC_MDIO_OUT, /* MII_BIT_MDO */
282 1.1 simonb (uint32_t)M_MAC_MDIO_IN, /* MII_BIT_MDI */
283 1.1 simonb (uint32_t)M_MAC_MDC, /* MII_BIT_MDC */
284 1.1 simonb 0, /* MII_BIT_DIR_HOST_PHY */
285 1.1 simonb (uint32_t)M_MAC_MDIO_DIR /* MII_BIT_DIR_PHY_HOST */
286 1.1 simonb }
287 1.1 simonb };
288 1.1 simonb
289 1.3 simonb static uint32_t
290 1.1 simonb sbmac_mii_bitbang_read(struct device *self)
291 1.1 simonb {
292 1.1 simonb struct sbmac_softc *sc = (void *) self;
293 1.1 simonb sbmac_port_t reg;
294 1.1 simonb
295 1.1 simonb reg = PKSEG1(sc->sbm_base + R_MAC_MDIO);
296 1.1 simonb return (uint32_t) SBMAC_READCSR(reg);
297 1.1 simonb }
298 1.1 simonb
299 1.3 simonb static void
300 1.1 simonb sbmac_mii_bitbang_write(struct device *self, uint32_t val)
301 1.1 simonb {
302 1.1 simonb struct sbmac_softc *sc = (void *) self;
303 1.1 simonb sbmac_port_t reg;
304 1.1 simonb
305 1.1 simonb reg = PKSEG1(sc->sbm_base + R_MAC_MDIO);
306 1.1 simonb
307 1.1 simonb SBMAC_WRITECSR(reg, (val &
308 1.1 simonb (M_MAC_MDC|M_MAC_MDIO_DIR|M_MAC_MDIO_OUT|M_MAC_MDIO_IN)));
309 1.1 simonb }
310 1.1 simonb
311 1.1 simonb /*
312 1.1 simonb * Read an PHY register through the MII.
313 1.1 simonb */
314 1.1 simonb static int
315 1.1 simonb sbmac_mii_readreg(struct device *self, int phy, int reg)
316 1.1 simonb {
317 1.1 simonb
318 1.1 simonb return (mii_bitbang_readreg(self, &sbmac_mii_bitbang_ops, phy, reg));
319 1.1 simonb }
320 1.1 simonb
321 1.1 simonb /*
322 1.1 simonb * Write to a PHY register through the MII.
323 1.1 simonb */
324 1.1 simonb static void
325 1.1 simonb sbmac_mii_writereg(struct device *self, int phy, int reg, int val)
326 1.1 simonb {
327 1.1 simonb
328 1.1 simonb mii_bitbang_writereg(self, &sbmac_mii_bitbang_ops, phy, reg, val);
329 1.1 simonb }
330 1.1 simonb
331 1.1 simonb static void
332 1.1 simonb sbmac_mii_statchg(struct device *self)
333 1.1 simonb {
334 1.1 simonb struct sbmac_softc *sc = (struct sbmac_softc *)self;
335 1.1 simonb sbmac_state_t oldstate;
336 1.1 simonb
337 1.1 simonb /* Stop the MAC in preparation for changing all of the parameters. */
338 1.1 simonb oldstate = sbmac_set_channel_state(sc, sbmac_state_off);
339 1.1 simonb
340 1.1 simonb switch (sc->sc_ethercom.ec_if.if_baudrate) {
341 1.1 simonb default: /* if autonegotiation fails, assume 10Mbit */
342 1.1 simonb case IF_Mbps(10):
343 1.1 simonb sbmac_set_speed(sc, sbmac_speed_10);
344 1.1 simonb break;
345 1.1 simonb
346 1.1 simonb case IF_Mbps(100):
347 1.1 simonb sbmac_set_speed(sc, sbmac_speed_100);
348 1.1 simonb break;
349 1.1 simonb
350 1.1 simonb case IF_Mbps(1000):
351 1.1 simonb sbmac_set_speed(sc, sbmac_speed_1000);
352 1.1 simonb break;
353 1.1 simonb }
354 1.1 simonb
355 1.1 simonb if (sc->sc_mii.mii_media_active & IFM_FDX) {
356 1.1 simonb /* Configure for full-duplex */
357 1.1 simonb /* XXX: is flow control right for 10, 100? */
358 1.1 simonb sbmac_set_duplex(sc, sbmac_duplex_full, sbmac_fc_frame);
359 1.1 simonb } else {
360 1.1 simonb /* Configure for half-duplex */
361 1.1 simonb /* XXX: is flow control right? */
362 1.1 simonb sbmac_set_duplex(sc, sbmac_duplex_half, sbmac_fc_disabled);
363 1.1 simonb }
364 1.1 simonb
365 1.1 simonb /* And put it back into its former state. */
366 1.1 simonb sbmac_set_channel_state(sc, oldstate);
367 1.1 simonb }
368 1.1 simonb
369 1.3 simonb /*
370 1.3 simonb * SBDMA_INITCTX(d, s, chan, txrx, maxdescr)
371 1.3 simonb *
372 1.3 simonb * Initialize a DMA channel context. Since there are potentially
373 1.3 simonb * eight DMA channels per MAC, it's nice to do this in a standard
374 1.3 simonb * way.
375 1.3 simonb *
376 1.3 simonb * Input parameters:
377 1.3 simonb * d - sbmacdma_t structure (DMA channel context)
378 1.3 simonb * s - sbmac_softc structure (pointer to a MAC)
379 1.3 simonb * chan - channel number (0..1 right now)
380 1.3 simonb * txrx - Identifies DMA_TX or DMA_RX for channel direction
381 1.3 simonb * maxdescr - number of descriptors
382 1.3 simonb *
383 1.3 simonb * Return value:
384 1.3 simonb * nothing
385 1.3 simonb */
386 1.1 simonb
387 1.1 simonb static void
388 1.1 simonb sbdma_initctx(sbmacdma_t *d, struct sbmac_softc *s, int chan, int txrx,
389 1.1 simonb int maxdescr)
390 1.1 simonb {
391 1.1 simonb /*
392 1.1 simonb * Save away interesting stuff in the structure
393 1.1 simonb */
394 1.1 simonb
395 1.3 simonb d->sbdma_eth = s;
396 1.3 simonb d->sbdma_channel = chan;
397 1.3 simonb d->sbdma_txdir = txrx;
398 1.1 simonb
399 1.1 simonb /*
400 1.1 simonb * initialize register pointers
401 1.1 simonb */
402 1.1 simonb
403 1.1 simonb d->sbdma_config0 = PKSEG1(s->sbm_base +
404 1.1 simonb R_MAC_DMA_REGISTER(txrx, chan, R_MAC_DMA_CONFIG0));
405 1.1 simonb d->sbdma_config1 = PKSEG1(s->sbm_base +
406 1.7 cgd R_MAC_DMA_REGISTER(txrx, chan, R_MAC_DMA_CONFIG1));
407 1.1 simonb d->sbdma_dscrbase = PKSEG1(s->sbm_base +
408 1.1 simonb R_MAC_DMA_REGISTER(txrx, chan, R_MAC_DMA_DSCR_BASE));
409 1.1 simonb d->sbdma_dscrcnt = PKSEG1(s->sbm_base +
410 1.1 simonb R_MAC_DMA_REGISTER(txrx, chan, R_MAC_DMA_DSCR_CNT));
411 1.1 simonb d->sbdma_curdscr = PKSEG1(s->sbm_base +
412 1.1 simonb R_MAC_DMA_REGISTER(txrx, chan, R_MAC_DMA_CUR_DSCRADDR));
413 1.1 simonb
414 1.1 simonb /*
415 1.1 simonb * Allocate memory for the ring
416 1.1 simonb */
417 1.1 simonb
418 1.1 simonb d->sbdma_maxdescr = maxdescr;
419 1.19 cgd d->sbdma_dscr_mask = d->sbdma_maxdescr - 1;
420 1.1 simonb
421 1.1 simonb d->sbdma_dscrtable = (sbdmadscr_t *)
422 1.19 cgd KMALLOC(d->sbdma_maxdescr * sizeof(sbdmadscr_t));
423 1.1 simonb
424 1.31 cegger memset(d->sbdma_dscrtable, 0, d->sbdma_maxdescr*sizeof(sbdmadscr_t));
425 1.1 simonb
426 1.1 simonb d->sbdma_dscrtable_phys = KVTOPHYS(d->sbdma_dscrtable);
427 1.1 simonb
428 1.1 simonb /*
429 1.1 simonb * And context table
430 1.1 simonb */
431 1.1 simonb
432 1.1 simonb d->sbdma_ctxtable = (struct mbuf **)
433 1.1 simonb KMALLOC(d->sbdma_maxdescr*sizeof(struct mbuf *));
434 1.1 simonb
435 1.31 cegger memset(d->sbdma_ctxtable, 0, d->sbdma_maxdescr*sizeof(struct mbuf *));
436 1.1 simonb }
437 1.1 simonb
438 1.3 simonb /*
439 1.3 simonb * SBDMA_CHANNEL_START(d)
440 1.3 simonb *
441 1.3 simonb * Initialize the hardware registers for a DMA channel.
442 1.3 simonb *
443 1.3 simonb * Input parameters:
444 1.3 simonb * d - DMA channel to init (context must be previously init'd
445 1.3 simonb *
446 1.3 simonb * Return value:
447 1.3 simonb * nothing
448 1.3 simonb */
449 1.1 simonb
450 1.1 simonb static void
451 1.1 simonb sbdma_channel_start(sbmacdma_t *d)
452 1.1 simonb {
453 1.1 simonb /*
454 1.1 simonb * Turn on the DMA channel
455 1.1 simonb */
456 1.1 simonb
457 1.1 simonb SBMAC_WRITECSR(d->sbdma_config1, 0);
458 1.1 simonb
459 1.1 simonb SBMAC_WRITECSR(d->sbdma_dscrbase, d->sbdma_dscrtable_phys);
460 1.1 simonb
461 1.1 simonb SBMAC_WRITECSR(d->sbdma_config0, V_DMA_RINGSZ(d->sbdma_maxdescr) | 0);
462 1.1 simonb
463 1.1 simonb /*
464 1.1 simonb * Initialize ring pointers
465 1.1 simonb */
466 1.1 simonb
467 1.19 cgd d->sbdma_add_index = 0;
468 1.19 cgd d->sbdma_rem_index = 0;
469 1.1 simonb }
470 1.1 simonb
471 1.3 simonb /*
472 1.3 simonb * SBDMA_ADD_RCVBUFFER(d, m)
473 1.3 simonb *
474 1.3 simonb * Add a buffer to the specified DMA channel. For receive channels,
475 1.3 simonb * this queues a buffer for inbound packets.
476 1.3 simonb *
477 1.3 simonb * Input parameters:
478 1.3 simonb * d - DMA channel descriptor
479 1.3 simonb * m - mbuf to add, or NULL if we should allocate one.
480 1.3 simonb *
481 1.3 simonb * Return value:
482 1.3 simonb * 0 if buffer could not be added (ring is full)
483 1.3 simonb * 1 if buffer added successfully
484 1.3 simonb */
485 1.1 simonb
486 1.1 simonb static int
487 1.1 simonb sbdma_add_rcvbuffer(sbmacdma_t *d, struct mbuf *m)
488 1.1 simonb {
489 1.19 cgd unsigned int dsc, nextdsc;
490 1.1 simonb struct mbuf *m_new = NULL;
491 1.1 simonb
492 1.1 simonb /* get pointer to our current place in the ring */
493 1.1 simonb
494 1.19 cgd dsc = d->sbdma_add_index;
495 1.19 cgd nextdsc = SBDMA_NEXTBUF(d, d->sbdma_add_index);
496 1.1 simonb
497 1.1 simonb /*
498 1.1 simonb * figure out if the ring is full - if the next descriptor
499 1.1 simonb * is the same as the one that we're going to remove from
500 1.1 simonb * the ring, the ring is full
501 1.1 simonb */
502 1.1 simonb
503 1.19 cgd if (nextdsc == d->sbdma_rem_index)
504 1.1 simonb return ENOSPC;
505 1.1 simonb
506 1.1 simonb /*
507 1.1 simonb * Allocate an mbuf if we don't already have one.
508 1.1 simonb * If we do have an mbuf, reset it so that it's empty.
509 1.1 simonb */
510 1.1 simonb
511 1.1 simonb if (m == NULL) {
512 1.1 simonb MGETHDR(m_new, M_DONTWAIT, MT_DATA);
513 1.1 simonb if (m_new == NULL) {
514 1.1 simonb printf("%s: mbuf allocation failed\n",
515 1.1 simonb d->sbdma_eth->sc_dev.dv_xname);
516 1.1 simonb return ENOBUFS;
517 1.1 simonb }
518 1.1 simonb
519 1.1 simonb MCLGET(m_new, M_DONTWAIT);
520 1.1 simonb if (!(m_new->m_flags & M_EXT)) {
521 1.1 simonb printf("%s: mbuf cluster allocation failed\n",
522 1.1 simonb d->sbdma_eth->sc_dev.dv_xname);
523 1.1 simonb m_freem(m_new);
524 1.1 simonb return ENOBUFS;
525 1.1 simonb }
526 1.1 simonb
527 1.1 simonb m_new->m_len = m_new->m_pkthdr.len= MCLBYTES;
528 1.1 simonb m_adj(m_new, ETHER_ALIGN);
529 1.1 simonb } else {
530 1.1 simonb m_new = m;
531 1.1 simonb m_new->m_len = m_new->m_pkthdr.len = MCLBYTES;
532 1.1 simonb m_new->m_data = m_new->m_ext.ext_buf;
533 1.1 simonb m_adj(m_new, ETHER_ALIGN);
534 1.1 simonb }
535 1.1 simonb
536 1.1 simonb /*
537 1.1 simonb * fill in the descriptor
538 1.1 simonb */
539 1.1 simonb
540 1.22 christos d->sbdma_dscrtable[dsc].dscr_a = KVTOPHYS(mtod(m_new, void *)) |
541 1.1 simonb V_DMA_DSCRA_A_SIZE(NUMCACHEBLKS(ETHER_ALIGN + m_new->m_len)) |
542 1.1 simonb M_DMA_DSCRA_INTERRUPT;
543 1.1 simonb
544 1.1 simonb /* receiving: no options */
545 1.19 cgd d->sbdma_dscrtable[dsc].dscr_b = 0;
546 1.1 simonb
547 1.1 simonb /*
548 1.1 simonb * fill in the context
549 1.1 simonb */
550 1.1 simonb
551 1.19 cgd d->sbdma_ctxtable[dsc] = m_new;
552 1.1 simonb
553 1.1 simonb /*
554 1.1 simonb * point at next packet
555 1.1 simonb */
556 1.1 simonb
557 1.19 cgd d->sbdma_add_index = nextdsc;
558 1.1 simonb
559 1.1 simonb /*
560 1.1 simonb * Give the buffer to the DMA engine.
561 1.1 simonb */
562 1.1 simonb
563 1.1 simonb SBMAC_WRITECSR(d->sbdma_dscrcnt, 1);
564 1.1 simonb
565 1.1 simonb return 0; /* we did it */
566 1.1 simonb }
567 1.1 simonb
568 1.3 simonb /*
569 1.3 simonb * SBDMA_ADD_TXBUFFER(d, m)
570 1.3 simonb *
571 1.3 simonb * Add a transmit buffer to the specified DMA channel, causing a
572 1.3 simonb * transmit to start.
573 1.3 simonb *
574 1.3 simonb * Input parameters:
575 1.3 simonb * d - DMA channel descriptor
576 1.3 simonb * m - mbuf to add
577 1.3 simonb *
578 1.3 simonb * Return value:
579 1.3 simonb * 0 transmit queued successfully
580 1.3 simonb * otherwise error code
581 1.3 simonb */
582 1.1 simonb
583 1.1 simonb static int
584 1.1 simonb sbdma_add_txbuffer(sbmacdma_t *d, struct mbuf *m)
585 1.1 simonb {
586 1.19 cgd unsigned int dsc, nextdsc, prevdsc, origdesc;
587 1.1 simonb int length;
588 1.8 cgd int num_mbufs = 0;
589 1.8 cgd struct sbmac_softc *sc = d->sbdma_eth;
590 1.1 simonb
591 1.1 simonb /* get pointer to our current place in the ring */
592 1.1 simonb
593 1.19 cgd dsc = d->sbdma_add_index;
594 1.19 cgd nextdsc = SBDMA_NEXTBUF(d, d->sbdma_add_index);
595 1.1 simonb
596 1.1 simonb /*
597 1.1 simonb * figure out if the ring is full - if the next descriptor
598 1.1 simonb * is the same as the one that we're going to remove from
599 1.1 simonb * the ring, the ring is full
600 1.1 simonb */
601 1.1 simonb
602 1.19 cgd if (nextdsc == d->sbdma_rem_index) {
603 1.15 simonb SBMAC_EVCNT_INCR(sc->sbm_ev_txstall);
604 1.1 simonb return ENOSPC;
605 1.15 simonb }
606 1.1 simonb
607 1.1 simonb /*
608 1.8 cgd * PASS3 parts do not have buffer alignment restriction.
609 1.8 cgd * No need to copy/coalesce to new mbuf. Also has different
610 1.8 cgd * descriptor format
611 1.1 simonb */
612 1.8 cgd if (sc->sbm_pass3_dma) {
613 1.8 cgd struct mbuf *m_temp = NULL;
614 1.8 cgd
615 1.8 cgd /*
616 1.8 cgd * Loop thru this mbuf record.
617 1.8 cgd * The head mbuf will have SOP set.
618 1.8 cgd */
619 1.22 christos d->sbdma_dscrtable[dsc].dscr_a = KVTOPHYS(mtod(m,void *)) |
620 1.8 cgd M_DMA_ETHTX_SOP;
621 1.8 cgd
622 1.8 cgd /*
623 1.8 cgd * transmitting: set outbound options,buffer A size(+ low 5
624 1.8 cgd * bits of start addr),and packet length.
625 1.8 cgd */
626 1.19 cgd d->sbdma_dscrtable[dsc].dscr_b =
627 1.8 cgd V_DMA_DSCRB_OPTIONS(K_DMA_ETHTX_APPENDCRC_APPENDPAD) |
628 1.15 simonb V_DMA_DSCRB_A_SIZE((m->m_len +
629 1.35 matt (mtod(m,uintptr_t) & 0x0000001F))) |
630 1.16 cgd V_DMA_DSCRB_PKT_SIZE_MSB((m->m_pkthdr.len & 0xc000) >> 14) |
631 1.16 cgd V_DMA_DSCRB_PKT_SIZE(m->m_pkthdr.len & 0x3fff);
632 1.8 cgd
633 1.19 cgd d->sbdma_add_index = nextdsc;
634 1.8 cgd origdesc = prevdsc = dsc;
635 1.19 cgd dsc = d->sbdma_add_index;
636 1.8 cgd num_mbufs++;
637 1.8 cgd
638 1.8 cgd /* Start with first non-head mbuf */
639 1.8 cgd for(m_temp = m->m_next; m_temp != 0; m_temp = m_temp->m_next) {
640 1.15 simonb int len, next_len;
641 1.15 simonb uint64_t addr;
642 1.8 cgd
643 1.8 cgd if (m_temp->m_len == 0)
644 1.8 cgd continue; /* Skip 0-length mbufs */
645 1.1 simonb
646 1.15 simonb len = m_temp->m_len;
647 1.22 christos addr = KVTOPHYS(mtod(m_temp, void *));
648 1.15 simonb
649 1.15 simonb /*
650 1.15 simonb * Check to see if the mbuf spans a page boundary. If
651 1.15 simonb * it does, and the physical pages behind the virtual
652 1.15 simonb * pages are not contiguous, split it so that each
653 1.15 simonb * virtual page uses it's own Tx descriptor.
654 1.15 simonb */
655 1.15 simonb if (trunc_page(addr) != trunc_page(addr + len - 1)) {
656 1.15 simonb next_len = (addr + len) - trunc_page(addr + len);
657 1.15 simonb
658 1.15 simonb len -= next_len;
659 1.15 simonb
660 1.15 simonb if (addr + len ==
661 1.23 simonb KVTOPHYS(mtod(m_temp, char *) + len)) {
662 1.15 simonb SBMAC_EVCNT_INCR(sc->sbm_ev_txkeep);
663 1.15 simonb len += next_len;
664 1.15 simonb next_len = 0;
665 1.15 simonb } else {
666 1.15 simonb SBMAC_EVCNT_INCR(sc->sbm_ev_txsplit);
667 1.15 simonb }
668 1.15 simonb } else {
669 1.15 simonb next_len = 0;
670 1.15 simonb }
671 1.15 simonb
672 1.15 simonb again:
673 1.8 cgd /*
674 1.8 cgd * fill in the descriptor
675 1.8 cgd */
676 1.19 cgd d->sbdma_dscrtable[dsc].dscr_a = addr;
677 1.8 cgd
678 1.13 simonb /*
679 1.13 simonb * transmitting: set outbound options,buffer A
680 1.13 simonb * size(+ low 5 bits of start addr)
681 1.13 simonb */
682 1.19 cgd d->sbdma_dscrtable[dsc].dscr_b = V_DMA_DSCRB_OPTIONS(K_DMA_ETHTX_NOTSOP) |
683 1.15 simonb V_DMA_DSCRB_A_SIZE((len + (addr & 0x0000001F)));
684 1.8 cgd
685 1.19 cgd d->sbdma_ctxtable[dsc] = NULL;
686 1.8 cgd
687 1.8 cgd /*
688 1.8 cgd * point at next descriptor
689 1.8 cgd */
690 1.19 cgd nextdsc = SBDMA_NEXTBUF(d, d->sbdma_add_index);
691 1.19 cgd if (nextdsc == d->sbdma_rem_index) {
692 1.19 cgd d->sbdma_add_index = origdesc;
693 1.15 simonb SBMAC_EVCNT_INCR(sc->sbm_ev_txstall);
694 1.8 cgd return ENOSPC;
695 1.8 cgd }
696 1.19 cgd d->sbdma_add_index = nextdsc;
697 1.8 cgd
698 1.8 cgd prevdsc = dsc;
699 1.19 cgd dsc = d->sbdma_add_index;
700 1.8 cgd num_mbufs++;
701 1.15 simonb
702 1.15 simonb if (next_len != 0) {
703 1.23 simonb addr = KVTOPHYS(mtod(m_temp, char *) + len);
704 1.15 simonb len = next_len;
705 1.15 simonb
706 1.15 simonb next_len = 0;
707 1.15 simonb goto again;
708 1.15 simonb }
709 1.15 simonb
710 1.8 cgd }
711 1.16 cgd /* Set head mbuf to last context index */
712 1.19 cgd d->sbdma_ctxtable[prevdsc] = m;
713 1.16 cgd
714 1.16 cgd /* Interrupt on last dscr of packet. */
715 1.19 cgd d->sbdma_dscrtable[prevdsc].dscr_a |= M_DMA_DSCRA_INTERRUPT;
716 1.8 cgd } else {
717 1.8 cgd struct mbuf *m_new = NULL;
718 1.8 cgd /*
719 1.8 cgd * [BEGIN XXX]
720 1.13 simonb * XXX Copy/coalesce the mbufs into a single mbuf cluster (we
721 1.13 simonb * assume it will fit). This is a temporary hack to get us
722 1.13 simonb * going.
723 1.8 cgd */
724 1.1 simonb
725 1.8 cgd MGETHDR(m_new,M_DONTWAIT,MT_DATA);
726 1.8 cgd if (m_new == NULL) {
727 1.8 cgd printf("%s: mbuf allocation failed\n",
728 1.8 cgd d->sbdma_eth->sc_dev.dv_xname);
729 1.15 simonb SBMAC_EVCNT_INCR(sc->sbm_ev_txdrop);
730 1.8 cgd return ENOBUFS;
731 1.8 cgd }
732 1.1 simonb
733 1.8 cgd MCLGET(m_new,M_DONTWAIT);
734 1.8 cgd if (!(m_new->m_flags & M_EXT)) {
735 1.8 cgd printf("%s: mbuf cluster allocation failed\n",
736 1.8 cgd d->sbdma_eth->sc_dev.dv_xname);
737 1.8 cgd m_freem(m_new);
738 1.15 simonb SBMAC_EVCNT_INCR(sc->sbm_ev_txdrop);
739 1.8 cgd return ENOBUFS;
740 1.8 cgd }
741 1.1 simonb
742 1.8 cgd m_new->m_len = m_new->m_pkthdr.len= MCLBYTES;
743 1.8 cgd /*m_adj(m_new,ETHER_ALIGN);*/
744 1.1 simonb
745 1.8 cgd /*
746 1.8 cgd * XXX Don't forget to include the offset portion in the
747 1.8 cgd * XXX cache block calculation when this code is rewritten!
748 1.8 cgd */
749 1.1 simonb
750 1.8 cgd /*
751 1.8 cgd * Copy data
752 1.8 cgd */
753 1.1 simonb
754 1.22 christos m_copydata(m,0,m->m_pkthdr.len,mtod(m_new,void *));
755 1.8 cgd m_new->m_len = m_new->m_pkthdr.len = m->m_pkthdr.len;
756 1.1 simonb
757 1.8 cgd /* Free old mbuf 'm', actual mbuf is now 'm_new' */
758 1.1 simonb
759 1.8 cgd // XXX: CALLERS WILL FREE, they might have to bpf_mtap() if this
760 1.8 cgd // XXX: function succeeds.
761 1.8 cgd // m_freem(m);
762 1.8 cgd length = m_new->m_len;
763 1.1 simonb
764 1.8 cgd /* [END XXX] */
765 1.8 cgd /*
766 1.8 cgd * fill in the descriptor
767 1.8 cgd */
768 1.1 simonb
769 1.22 christos d->sbdma_dscrtable[dsc].dscr_a = KVTOPHYS(mtod(m_new,void *)) |
770 1.8 cgd V_DMA_DSCRA_A_SIZE(NUMCACHEBLKS(m_new->m_len)) |
771 1.8 cgd M_DMA_DSCRA_INTERRUPT |
772 1.8 cgd M_DMA_ETHTX_SOP;
773 1.8 cgd
774 1.8 cgd /* transmitting: set outbound options and length */
775 1.19 cgd d->sbdma_dscrtable[dsc].dscr_b =
776 1.13 simonb V_DMA_DSCRB_OPTIONS(K_DMA_ETHTX_APPENDCRC_APPENDPAD) |
777 1.8 cgd V_DMA_DSCRB_PKT_SIZE(length);
778 1.1 simonb
779 1.8 cgd num_mbufs++;
780 1.1 simonb
781 1.8 cgd /*
782 1.8 cgd * fill in the context
783 1.8 cgd */
784 1.1 simonb
785 1.19 cgd d->sbdma_ctxtable[dsc] = m_new;
786 1.1 simonb
787 1.8 cgd /*
788 1.8 cgd * point at next packet
789 1.8 cgd */
790 1.19 cgd d->sbdma_add_index = nextdsc;
791 1.8 cgd }
792 1.1 simonb
793 1.1 simonb /*
794 1.1 simonb * Give the buffer to the DMA engine.
795 1.1 simonb */
796 1.1 simonb
797 1.8 cgd SBMAC_WRITECSR(d->sbdma_dscrcnt, num_mbufs);
798 1.1 simonb
799 1.1 simonb return 0; /* we did it */
800 1.1 simonb }
801 1.1 simonb
802 1.3 simonb /*
803 1.3 simonb * SBDMA_EMPTYRING(d)
804 1.3 simonb *
805 1.3 simonb * Free all allocated mbufs on the specified DMA channel;
806 1.3 simonb *
807 1.3 simonb * Input parameters:
808 1.3 simonb * d - DMA channel
809 1.3 simonb *
810 1.3 simonb * Return value:
811 1.3 simonb * nothing
812 1.3 simonb */
813 1.1 simonb
814 1.1 simonb static void
815 1.1 simonb sbdma_emptyring(sbmacdma_t *d)
816 1.1 simonb {
817 1.1 simonb int idx;
818 1.1 simonb struct mbuf *m;
819 1.1 simonb
820 1.1 simonb for (idx = 0; idx < d->sbdma_maxdescr; idx++) {
821 1.1 simonb m = d->sbdma_ctxtable[idx];
822 1.1 simonb if (m) {
823 1.1 simonb m_freem(m);
824 1.1 simonb d->sbdma_ctxtable[idx] = NULL;
825 1.1 simonb }
826 1.1 simonb }
827 1.1 simonb }
828 1.1 simonb
829 1.3 simonb /*
830 1.3 simonb * SBDMA_FILLRING(d)
831 1.3 simonb *
832 1.3 simonb * Fill the specified DMA channel (must be receive channel)
833 1.3 simonb * with mbufs
834 1.3 simonb *
835 1.3 simonb * Input parameters:
836 1.3 simonb * d - DMA channel
837 1.3 simonb *
838 1.3 simonb * Return value:
839 1.3 simonb * nothing
840 1.3 simonb */
841 1.1 simonb
842 1.1 simonb static void
843 1.1 simonb sbdma_fillring(sbmacdma_t *d)
844 1.1 simonb {
845 1.1 simonb int idx;
846 1.1 simonb
847 1.1 simonb for (idx = 0; idx < SBMAC_MAX_RXDESCR-1; idx++)
848 1.1 simonb if (sbdma_add_rcvbuffer(d, NULL) != 0)
849 1.1 simonb break;
850 1.1 simonb }
851 1.1 simonb
852 1.3 simonb /*
853 1.3 simonb * SBDMA_RX_PROCESS(sc, d)
854 1.3 simonb *
855 1.3 simonb * Process "completed" receive buffers on the specified DMA channel.
856 1.3 simonb * Note that this isn't really ideal for priority channels, since
857 1.3 simonb * it processes all of the packets on a given channel before
858 1.3 simonb * returning.
859 1.3 simonb *
860 1.3 simonb * Input parameters:
861 1.3 simonb * sc - softc structure
862 1.3 simonb * d - DMA channel context
863 1.3 simonb *
864 1.3 simonb * Return value:
865 1.3 simonb * nothing
866 1.3 simonb */
867 1.1 simonb
868 1.1 simonb static void
869 1.1 simonb sbdma_rx_process(struct sbmac_softc *sc, sbmacdma_t *d)
870 1.1 simonb {
871 1.1 simonb int curidx;
872 1.1 simonb int hwidx;
873 1.19 cgd sbdmadscr_t *dscp;
874 1.1 simonb struct mbuf *m;
875 1.1 simonb int len;
876 1.1 simonb
877 1.1 simonb struct ifnet *ifp = &(sc->sc_ethercom.ec_if);
878 1.1 simonb
879 1.1 simonb for (;;) {
880 1.1 simonb /*
881 1.1 simonb * figure out where we are (as an index) and where
882 1.1 simonb * the hardware is (also as an index)
883 1.1 simonb *
884 1.1 simonb * This could be done faster if (for example) the
885 1.1 simonb * descriptor table was page-aligned and contiguous in
886 1.1 simonb * both virtual and physical memory -- you could then
887 1.1 simonb * just compare the low-order bits of the virtual address
888 1.19 cgd * (sbdma_rem_index) and the physical address
889 1.19 cgd * (sbdma_curdscr CSR).
890 1.1 simonb */
891 1.1 simonb
892 1.19 cgd curidx = d->sbdma_rem_index;
893 1.1 simonb hwidx = (int)
894 1.1 simonb (((SBMAC_READCSR(d->sbdma_curdscr) & M_DMA_CURDSCR_ADDR) -
895 1.1 simonb d->sbdma_dscrtable_phys) / sizeof(sbdmadscr_t));
896 1.1 simonb
897 1.1 simonb /*
898 1.1 simonb * If they're the same, that means we've processed all
899 1.1 simonb * of the descriptors up to (but not including) the one that
900 1.1 simonb * the hardware is working on right now.
901 1.1 simonb */
902 1.1 simonb
903 1.1 simonb if (curidx == hwidx)
904 1.1 simonb break;
905 1.1 simonb
906 1.1 simonb /*
907 1.1 simonb * Otherwise, get the packet's mbuf ptr back
908 1.1 simonb */
909 1.1 simonb
910 1.19 cgd dscp = &(d->sbdma_dscrtable[curidx]);
911 1.1 simonb m = d->sbdma_ctxtable[curidx];
912 1.1 simonb d->sbdma_ctxtable[curidx] = NULL;
913 1.1 simonb
914 1.19 cgd len = (int)G_DMA_DSCRB_PKT_SIZE(dscp->dscr_b) - 4;
915 1.1 simonb
916 1.1 simonb /*
917 1.1 simonb * Check packet status. If good, process it.
918 1.1 simonb * If not, silently drop it and put it back on the
919 1.1 simonb * receive ring.
920 1.1 simonb */
921 1.1 simonb
922 1.19 cgd if (! (dscp->dscr_a & M_DMA_ETHRX_BAD)) {
923 1.1 simonb
924 1.1 simonb /*
925 1.1 simonb * Set length into the packet
926 1.1 simonb * XXX do we remove the CRC here?
927 1.1 simonb */
928 1.1 simonb m->m_pkthdr.len = m->m_len = len;
929 1.1 simonb
930 1.1 simonb ifp->if_ipackets++;
931 1.1 simonb m->m_pkthdr.rcvif = ifp;
932 1.1 simonb
933 1.1 simonb
934 1.1 simonb /*
935 1.1 simonb * Add a new buffer to replace the old one.
936 1.1 simonb */
937 1.1 simonb sbdma_add_rcvbuffer(d, NULL);
938 1.1 simonb
939 1.1 simonb #if (NBPFILTER > 0)
940 1.1 simonb /*
941 1.1 simonb * Handle BPF listeners. Let the BPF user see the
942 1.1 simonb * packet, but don't pass it up to the ether_input()
943 1.1 simonb * layer unless it's a broadcast packet, multicast
944 1.1 simonb * packet, matches our ethernet address or the
945 1.1 simonb * interface is in promiscuous mode.
946 1.1 simonb */
947 1.1 simonb
948 1.1 simonb if (ifp->if_bpf)
949 1.1 simonb bpf_mtap(ifp->if_bpf, m);
950 1.1 simonb #endif
951 1.1 simonb /*
952 1.1 simonb * Pass the buffer to the kernel
953 1.1 simonb */
954 1.1 simonb (*ifp->if_input)(ifp, m);
955 1.1 simonb } else {
956 1.1 simonb /*
957 1.1 simonb * Packet was mangled somehow. Just drop it and
958 1.1 simonb * put it back on the receive ring.
959 1.1 simonb */
960 1.1 simonb sbdma_add_rcvbuffer(d, m);
961 1.1 simonb }
962 1.1 simonb
963 1.1 simonb /*
964 1.1 simonb * .. and advance to the next buffer.
965 1.1 simonb */
966 1.1 simonb
967 1.19 cgd d->sbdma_rem_index = SBDMA_NEXTBUF(d, d->sbdma_rem_index);
968 1.1 simonb }
969 1.1 simonb }
970 1.1 simonb
971 1.3 simonb /*
972 1.3 simonb * SBDMA_TX_PROCESS(sc, d)
973 1.3 simonb *
974 1.3 simonb * Process "completed" transmit buffers on the specified DMA channel.
975 1.3 simonb * This is normally called within the interrupt service routine.
976 1.3 simonb * Note that this isn't really ideal for priority channels, since
977 1.3 simonb * it processes all of the packets on a given channel before
978 1.3 simonb * returning.
979 1.3 simonb *
980 1.3 simonb * Input parameters:
981 1.3 simonb * sc - softc structure
982 1.3 simonb * d - DMA channel context
983 1.3 simonb *
984 1.3 simonb * Return value:
985 1.3 simonb * nothing
986 1.3 simonb */
987 1.1 simonb
988 1.1 simonb static void
989 1.1 simonb sbdma_tx_process(struct sbmac_softc *sc, sbmacdma_t *d)
990 1.1 simonb {
991 1.1 simonb int curidx;
992 1.1 simonb int hwidx;
993 1.1 simonb struct mbuf *m;
994 1.1 simonb
995 1.1 simonb struct ifnet *ifp = &(sc->sc_ethercom.ec_if);
996 1.1 simonb
997 1.1 simonb for (;;) {
998 1.1 simonb /*
999 1.1 simonb * figure out where we are (as an index) and where
1000 1.1 simonb * the hardware is (also as an index)
1001 1.1 simonb *
1002 1.1 simonb * This could be done faster if (for example) the
1003 1.1 simonb * descriptor table was page-aligned and contiguous in
1004 1.1 simonb * both virtual and physical memory -- you could then
1005 1.1 simonb * just compare the low-order bits of the virtual address
1006 1.19 cgd * (sbdma_rem_index) and the physical address
1007 1.19 cgd * (sbdma_curdscr CSR).
1008 1.1 simonb */
1009 1.1 simonb
1010 1.19 cgd curidx = d->sbdma_rem_index;
1011 1.1 simonb hwidx = (int)
1012 1.1 simonb (((SBMAC_READCSR(d->sbdma_curdscr) & M_DMA_CURDSCR_ADDR) -
1013 1.1 simonb d->sbdma_dscrtable_phys) / sizeof(sbdmadscr_t));
1014 1.1 simonb
1015 1.1 simonb /*
1016 1.1 simonb * If they're the same, that means we've processed all
1017 1.1 simonb * of the descriptors up to (but not including) the one that
1018 1.1 simonb * the hardware is working on right now.
1019 1.1 simonb */
1020 1.1 simonb
1021 1.1 simonb if (curidx == hwidx)
1022 1.1 simonb break;
1023 1.1 simonb
1024 1.1 simonb /*
1025 1.1 simonb * Otherwise, get the packet's mbuf ptr back
1026 1.1 simonb */
1027 1.1 simonb
1028 1.1 simonb m = d->sbdma_ctxtable[curidx];
1029 1.1 simonb d->sbdma_ctxtable[curidx] = NULL;
1030 1.1 simonb
1031 1.1 simonb /*
1032 1.24 christos * for transmits we just free buffers and count packets.
1033 1.1 simonb */
1034 1.24 christos ifp->if_opackets++;
1035 1.1 simonb m_freem(m);
1036 1.1 simonb
1037 1.1 simonb /*
1038 1.1 simonb * .. and advance to the next buffer.
1039 1.1 simonb */
1040 1.1 simonb
1041 1.19 cgd d->sbdma_rem_index = SBDMA_NEXTBUF(d, d->sbdma_rem_index);
1042 1.1 simonb }
1043 1.1 simonb
1044 1.1 simonb /*
1045 1.1 simonb * Decide what to set the IFF_OACTIVE bit in the interface to.
1046 1.1 simonb * It's supposed to reflect if the interface is actively
1047 1.1 simonb * transmitting, but that's really hard to do quickly.
1048 1.1 simonb */
1049 1.1 simonb
1050 1.1 simonb ifp->if_flags &= ~IFF_OACTIVE;
1051 1.1 simonb }
1052 1.1 simonb
1053 1.3 simonb /*
1054 1.3 simonb * SBMAC_INITCTX(s)
1055 1.3 simonb *
1056 1.3 simonb * Initialize an Ethernet context structure - this is called
1057 1.3 simonb * once per MAC on the 1250. Memory is allocated here, so don't
1058 1.3 simonb * call it again from inside the ioctl routines that bring the
1059 1.3 simonb * interface up/down
1060 1.3 simonb *
1061 1.3 simonb * Input parameters:
1062 1.3 simonb * s - sbmac context structure
1063 1.3 simonb *
1064 1.3 simonb * Return value:
1065 1.3 simonb * 0
1066 1.3 simonb */
1067 1.1 simonb
1068 1.1 simonb static void
1069 1.1 simonb sbmac_initctx(struct sbmac_softc *s)
1070 1.1 simonb {
1071 1.8 cgd uint64_t sysrev;
1072 1.1 simonb
1073 1.1 simonb /*
1074 1.1 simonb * figure out the addresses of some ports
1075 1.1 simonb */
1076 1.1 simonb
1077 1.1 simonb s->sbm_macenable = PKSEG1(s->sbm_base + R_MAC_ENABLE);
1078 1.1 simonb s->sbm_maccfg = PKSEG1(s->sbm_base + R_MAC_CFG);
1079 1.1 simonb s->sbm_fifocfg = PKSEG1(s->sbm_base + R_MAC_THRSH_CFG);
1080 1.1 simonb s->sbm_framecfg = PKSEG1(s->sbm_base + R_MAC_FRAMECFG);
1081 1.1 simonb s->sbm_rxfilter = PKSEG1(s->sbm_base + R_MAC_ADFILTER_CFG);
1082 1.1 simonb s->sbm_isr = PKSEG1(s->sbm_base + R_MAC_STATUS);
1083 1.1 simonb s->sbm_imr = PKSEG1(s->sbm_base + R_MAC_INT_MASK);
1084 1.1 simonb
1085 1.1 simonb /*
1086 1.1 simonb * Initialize the DMA channels. Right now, only one per MAC is used
1087 1.1 simonb * Note: Only do this _once_, as it allocates memory from the kernel!
1088 1.1 simonb */
1089 1.1 simonb
1090 1.1 simonb sbdma_initctx(&(s->sbm_txdma), s, 0, DMA_TX, SBMAC_MAX_TXDESCR);
1091 1.1 simonb sbdma_initctx(&(s->sbm_rxdma), s, 0, DMA_RX, SBMAC_MAX_RXDESCR);
1092 1.1 simonb
1093 1.1 simonb /*
1094 1.1 simonb * initial state is OFF
1095 1.1 simonb */
1096 1.1 simonb
1097 1.1 simonb s->sbm_state = sbmac_state_off;
1098 1.1 simonb
1099 1.1 simonb /*
1100 1.1 simonb * Initial speed is (XXX TEMP) 10MBit/s HDX no FC
1101 1.1 simonb */
1102 1.1 simonb
1103 1.1 simonb s->sbm_speed = sbmac_speed_10;
1104 1.1 simonb s->sbm_duplex = sbmac_duplex_half;
1105 1.1 simonb s->sbm_fc = sbmac_fc_disabled;
1106 1.8 cgd
1107 1.8 cgd /*
1108 1.8 cgd * Determine SOC type. 112x has Pass3 SOC features.
1109 1.8 cgd */
1110 1.8 cgd sysrev = SBMAC_READCSR( PKSEG1(A_SCD_SYSTEM_REVISION) );
1111 1.8 cgd s->sbm_pass3_dma = (SYS_SOC_TYPE(sysrev) == K_SYS_SOC_TYPE_BCM1120 ||
1112 1.8 cgd SYS_SOC_TYPE(sysrev) == K_SYS_SOC_TYPE_BCM1125 ||
1113 1.8 cgd SYS_SOC_TYPE(sysrev) == K_SYS_SOC_TYPE_BCM1125H ||
1114 1.8 cgd (SYS_SOC_TYPE(sysrev) == K_SYS_SOC_TYPE_BCM1250 &&
1115 1.18 cgd G_SYS_REVISION(sysrev) >= K_SYS_REVISION_BCM1250_PASS3));
1116 1.15 simonb #ifdef SBMAC_EVENT_COUNTERS
1117 1.15 simonb evcnt_attach_dynamic(&s->sbm_ev_rxintr, EVCNT_TYPE_INTR,
1118 1.15 simonb NULL, s->sc_dev.dv_xname, "rxintr");
1119 1.15 simonb evcnt_attach_dynamic(&s->sbm_ev_txintr, EVCNT_TYPE_INTR,
1120 1.15 simonb NULL, s->sc_dev.dv_xname, "txintr");
1121 1.15 simonb evcnt_attach_dynamic(&s->sbm_ev_txdrop, EVCNT_TYPE_MISC,
1122 1.15 simonb NULL, s->sc_dev.dv_xname, "txdrop");
1123 1.15 simonb evcnt_attach_dynamic(&s->sbm_ev_txstall, EVCNT_TYPE_MISC,
1124 1.15 simonb NULL, s->sc_dev.dv_xname, "txstall");
1125 1.11 simonb if (s->sbm_pass3_dma) {
1126 1.15 simonb evcnt_attach_dynamic(&s->sbm_ev_txsplit, EVCNT_TYPE_MISC,
1127 1.15 simonb NULL, s->sc_dev.dv_xname, "pass3tx-split");
1128 1.15 simonb evcnt_attach_dynamic(&s->sbm_ev_txkeep, EVCNT_TYPE_MISC,
1129 1.15 simonb NULL, s->sc_dev.dv_xname, "pass3tx-keep");
1130 1.11 simonb }
1131 1.15 simonb #endif
1132 1.1 simonb }
1133 1.1 simonb
1134 1.3 simonb /*
1135 1.3 simonb * SBMAC_CHANNEL_START(s)
1136 1.3 simonb *
1137 1.3 simonb * Start packet processing on this MAC.
1138 1.3 simonb *
1139 1.3 simonb * Input parameters:
1140 1.3 simonb * s - sbmac structure
1141 1.3 simonb *
1142 1.3 simonb * Return value:
1143 1.3 simonb * nothing
1144 1.3 simonb */
1145 1.1 simonb
1146 1.1 simonb static void
1147 1.1 simonb sbmac_channel_start(struct sbmac_softc *s)
1148 1.1 simonb {
1149 1.1 simonb uint64_t reg;
1150 1.1 simonb sbmac_port_t port;
1151 1.1 simonb uint64_t cfg, fifo, framecfg;
1152 1.1 simonb int idx;
1153 1.8 cgd uint64_t dma_cfg0, fifo_cfg;
1154 1.8 cgd sbmacdma_t *txdma;
1155 1.1 simonb
1156 1.1 simonb /*
1157 1.1 simonb * Don't do this if running
1158 1.1 simonb */
1159 1.1 simonb
1160 1.1 simonb if (s->sbm_state == sbmac_state_on)
1161 1.1 simonb return;
1162 1.1 simonb
1163 1.1 simonb /*
1164 1.1 simonb * Bring the controller out of reset, but leave it off.
1165 1.1 simonb */
1166 1.1 simonb
1167 1.1 simonb SBMAC_WRITECSR(s->sbm_macenable, 0);
1168 1.1 simonb
1169 1.1 simonb /*
1170 1.1 simonb * Ignore all received packets
1171 1.1 simonb */
1172 1.1 simonb
1173 1.1 simonb SBMAC_WRITECSR(s->sbm_rxfilter, 0);
1174 1.1 simonb
1175 1.1 simonb /*
1176 1.1 simonb * Calculate values for various control registers.
1177 1.1 simonb */
1178 1.1 simonb
1179 1.1 simonb cfg = M_MAC_RETRY_EN |
1180 1.1 simonb M_MAC_TX_HOLD_SOP_EN |
1181 1.1 simonb V_MAC_TX_PAUSE_CNT_16K |
1182 1.1 simonb M_MAC_AP_STAT_EN |
1183 1.1 simonb M_MAC_SS_EN |
1184 1.1 simonb 0;
1185 1.1 simonb
1186 1.1 simonb fifo = V_MAC_TX_WR_THRSH(4) | /* Must be '4' or '8' */
1187 1.1 simonb V_MAC_TX_RD_THRSH(4) |
1188 1.1 simonb V_MAC_TX_RL_THRSH(4) |
1189 1.1 simonb V_MAC_RX_PL_THRSH(4) |
1190 1.1 simonb V_MAC_RX_RD_THRSH(4) | /* Must be '4' */
1191 1.1 simonb V_MAC_RX_PL_THRSH(4) |
1192 1.1 simonb V_MAC_RX_RL_THRSH(8) |
1193 1.1 simonb 0;
1194 1.1 simonb
1195 1.1 simonb framecfg = V_MAC_MIN_FRAMESZ_DEFAULT |
1196 1.1 simonb V_MAC_MAX_FRAMESZ_DEFAULT |
1197 1.1 simonb V_MAC_BACKOFF_SEL(1);
1198 1.1 simonb
1199 1.1 simonb /*
1200 1.1 simonb * Clear out the hash address map
1201 1.1 simonb */
1202 1.1 simonb
1203 1.1 simonb port = PKSEG1(s->sbm_base + R_MAC_HASH_BASE);
1204 1.1 simonb for (idx = 0; idx < MAC_HASH_COUNT; idx++) {
1205 1.1 simonb SBMAC_WRITECSR(port, 0);
1206 1.1 simonb port += sizeof(uint64_t);
1207 1.1 simonb }
1208 1.1 simonb
1209 1.1 simonb /*
1210 1.1 simonb * Clear out the exact-match table
1211 1.1 simonb */
1212 1.1 simonb
1213 1.1 simonb port = PKSEG1(s->sbm_base + R_MAC_ADDR_BASE);
1214 1.1 simonb for (idx = 0; idx < MAC_ADDR_COUNT; idx++) {
1215 1.1 simonb SBMAC_WRITECSR(port, 0);
1216 1.1 simonb port += sizeof(uint64_t);
1217 1.1 simonb }
1218 1.1 simonb
1219 1.1 simonb /*
1220 1.1 simonb * Clear out the DMA Channel mapping table registers
1221 1.1 simonb */
1222 1.1 simonb
1223 1.1 simonb port = PKSEG1(s->sbm_base + R_MAC_CHUP0_BASE);
1224 1.1 simonb for (idx = 0; idx < MAC_CHMAP_COUNT; idx++) {
1225 1.1 simonb SBMAC_WRITECSR(port, 0);
1226 1.1 simonb port += sizeof(uint64_t);
1227 1.1 simonb }
1228 1.1 simonb
1229 1.1 simonb port = PKSEG1(s->sbm_base + R_MAC_CHLO0_BASE);
1230 1.1 simonb for (idx = 0; idx < MAC_CHMAP_COUNT; idx++) {
1231 1.1 simonb SBMAC_WRITECSR(port, 0);
1232 1.1 simonb port += sizeof(uint64_t);
1233 1.1 simonb }
1234 1.1 simonb
1235 1.1 simonb /*
1236 1.1 simonb * Program the hardware address. It goes into the hardware-address
1237 1.1 simonb * register as well as the first filter register.
1238 1.1 simonb */
1239 1.1 simonb
1240 1.1 simonb reg = sbmac_addr2reg(s->sbm_hwaddr);
1241 1.1 simonb
1242 1.1 simonb port = PKSEG1(s->sbm_base + R_MAC_ADDR_BASE);
1243 1.1 simonb SBMAC_WRITECSR(port, reg);
1244 1.1 simonb port = PKSEG1(s->sbm_base + R_MAC_ETHERNET_ADDR);
1245 1.1 simonb SBMAC_WRITECSR(port, 0); // pass1 workaround
1246 1.1 simonb
1247 1.1 simonb /*
1248 1.1 simonb * Set the receive filter for no packets, and write values
1249 1.1 simonb * to the various config registers
1250 1.1 simonb */
1251 1.1 simonb
1252 1.1 simonb SBMAC_WRITECSR(s->sbm_rxfilter, 0);
1253 1.1 simonb SBMAC_WRITECSR(s->sbm_imr, 0);
1254 1.1 simonb SBMAC_WRITECSR(s->sbm_framecfg, framecfg);
1255 1.1 simonb SBMAC_WRITECSR(s->sbm_fifocfg, fifo);
1256 1.1 simonb SBMAC_WRITECSR(s->sbm_maccfg, cfg);
1257 1.1 simonb
1258 1.1 simonb /*
1259 1.1 simonb * Initialize DMA channels (rings should be ok now)
1260 1.1 simonb */
1261 1.1 simonb
1262 1.1 simonb sbdma_channel_start(&(s->sbm_rxdma));
1263 1.1 simonb sbdma_channel_start(&(s->sbm_txdma));
1264 1.1 simonb
1265 1.1 simonb /*
1266 1.1 simonb * Configure the speed, duplex, and flow control
1267 1.1 simonb */
1268 1.1 simonb
1269 1.1 simonb sbmac_set_speed(s, s->sbm_speed);
1270 1.1 simonb sbmac_set_duplex(s, s->sbm_duplex, s->sbm_fc);
1271 1.1 simonb
1272 1.1 simonb /*
1273 1.1 simonb * Fill the receive ring
1274 1.1 simonb */
1275 1.1 simonb
1276 1.1 simonb sbdma_fillring(&(s->sbm_rxdma));
1277 1.1 simonb
1278 1.1 simonb /*
1279 1.1 simonb * Turn on the rest of the bits in the enable register
1280 1.1 simonb */
1281 1.1 simonb
1282 1.1 simonb SBMAC_WRITECSR(s->sbm_macenable, M_MAC_RXDMA_EN0 | M_MAC_TXDMA_EN0 |
1283 1.1 simonb M_MAC_RX_ENABLE | M_MAC_TX_ENABLE);
1284 1.1 simonb
1285 1.1 simonb
1286 1.1 simonb /*
1287 1.1 simonb * Accept any kind of interrupt on TX and RX DMA channel 0
1288 1.1 simonb */
1289 1.1 simonb SBMAC_WRITECSR(s->sbm_imr,
1290 1.1 simonb (M_MAC_INT_CHANNEL << S_MAC_TX_CH0) |
1291 1.1 simonb (M_MAC_INT_CHANNEL << S_MAC_RX_CH0));
1292 1.1 simonb
1293 1.1 simonb /*
1294 1.1 simonb * Enable receiving unicasts and broadcasts
1295 1.1 simonb */
1296 1.1 simonb
1297 1.1 simonb SBMAC_WRITECSR(s->sbm_rxfilter, M_MAC_UCAST_EN | M_MAC_BCAST_EN);
1298 1.1 simonb
1299 1.1 simonb /*
1300 1.8 cgd * On chips which support unaligned DMA features, set the descriptor
1301 1.8 cgd * ring for transmit channels to use the unaligned buffer format.
1302 1.8 cgd */
1303 1.8 cgd txdma = &(s->sbm_txdma);
1304 1.8 cgd
1305 1.8 cgd if (s->sbm_pass3_dma) {
1306 1.8 cgd dma_cfg0 = SBMAC_READCSR(txdma->sbdma_config0);
1307 1.8 cgd dma_cfg0 |= V_DMA_DESC_TYPE(K_DMA_DESC_TYPE_RING_UAL_RMW) |
1308 1.8 cgd M_DMA_TBX_EN | M_DMA_TDX_EN;
1309 1.8 cgd SBMAC_WRITECSR(txdma->sbdma_config0,dma_cfg0);
1310 1.8 cgd
1311 1.8 cgd fifo_cfg = SBMAC_READCSR(s->sbm_fifocfg);
1312 1.8 cgd fifo_cfg |= V_MAC_TX_WR_THRSH(8) |
1313 1.8 cgd V_MAC_TX_RD_THRSH(8) | V_MAC_TX_RL_THRSH(8);
1314 1.8 cgd SBMAC_WRITECSR(s->sbm_fifocfg,fifo_cfg);
1315 1.8 cgd }
1316 1.8 cgd
1317 1.8 cgd /*
1318 1.1 simonb * we're running now.
1319 1.1 simonb */
1320 1.1 simonb
1321 1.1 simonb s->sbm_state = sbmac_state_on;
1322 1.1 simonb s->sc_ethercom.ec_if.if_flags |= IFF_RUNNING;
1323 1.1 simonb
1324 1.1 simonb /*
1325 1.1 simonb * Program multicast addresses
1326 1.1 simonb */
1327 1.1 simonb
1328 1.1 simonb sbmac_setmulti(s);
1329 1.1 simonb
1330 1.1 simonb /*
1331 1.1 simonb * If channel was in promiscuous mode before, turn that on
1332 1.1 simonb */
1333 1.1 simonb
1334 1.1 simonb if (s->sc_ethercom.ec_if.if_flags & IFF_PROMISC)
1335 1.1 simonb sbmac_promiscuous_mode(s, 1);
1336 1.1 simonb
1337 1.1 simonb /*
1338 1.1 simonb * Turn on the once-per-second timer
1339 1.1 simonb */
1340 1.1 simonb
1341 1.1 simonb callout_reset(&(s->sc_tick_ch), hz, sbmac_tick, s);
1342 1.1 simonb }
1343 1.1 simonb
1344 1.3 simonb /*
1345 1.3 simonb * SBMAC_CHANNEL_STOP(s)
1346 1.3 simonb *
1347 1.3 simonb * Stop packet processing on this MAC.
1348 1.3 simonb *
1349 1.3 simonb * Input parameters:
1350 1.3 simonb * s - sbmac structure
1351 1.3 simonb *
1352 1.3 simonb * Return value:
1353 1.3 simonb * nothing
1354 1.3 simonb */
1355 1.1 simonb
1356 1.3 simonb static void
1357 1.3 simonb sbmac_channel_stop(struct sbmac_softc *s)
1358 1.1 simonb {
1359 1.3 simonb uint64_t ctl;
1360 1.1 simonb
1361 1.3 simonb /* don't do this if already stopped */
1362 1.1 simonb
1363 1.3 simonb if (s->sbm_state == sbmac_state_off)
1364 1.3 simonb return;
1365 1.1 simonb
1366 1.3 simonb /* don't accept any packets, disable all interrupts */
1367 1.1 simonb
1368 1.3 simonb SBMAC_WRITECSR(s->sbm_rxfilter, 0);
1369 1.3 simonb SBMAC_WRITECSR(s->sbm_imr, 0);
1370 1.1 simonb
1371 1.3 simonb /* Turn off ticker */
1372 1.1 simonb
1373 1.3 simonb callout_stop(&(s->sc_tick_ch));
1374 1.1 simonb
1375 1.3 simonb /* turn off receiver and transmitter */
1376 1.1 simonb
1377 1.3 simonb ctl = SBMAC_READCSR(s->sbm_macenable);
1378 1.3 simonb ctl &= ~(M_MAC_RXDMA_EN0 | M_MAC_TXDMA_EN0);
1379 1.3 simonb SBMAC_WRITECSR(s->sbm_macenable, ctl);
1380 1.1 simonb
1381 1.3 simonb /* We're stopped now. */
1382 1.1 simonb
1383 1.3 simonb s->sbm_state = sbmac_state_off;
1384 1.3 simonb s->sc_ethercom.ec_if.if_flags &= ~IFF_RUNNING;
1385 1.1 simonb
1386 1.3 simonb /* Empty the receive and transmit rings */
1387 1.1 simonb
1388 1.3 simonb sbdma_emptyring(&(s->sbm_rxdma));
1389 1.3 simonb sbdma_emptyring(&(s->sbm_txdma));
1390 1.3 simonb }
1391 1.3 simonb
1392 1.3 simonb /*
1393 1.3 simonb * SBMAC_SET_CHANNEL_STATE(state)
1394 1.3 simonb *
1395 1.3 simonb * Set the channel's state ON or OFF
1396 1.3 simonb *
1397 1.3 simonb * Input parameters:
1398 1.3 simonb * state - new state
1399 1.3 simonb *
1400 1.3 simonb * Return value:
1401 1.3 simonb * old state
1402 1.3 simonb */
1403 1.1 simonb
1404 1.3 simonb static sbmac_state_t
1405 1.3 simonb sbmac_set_channel_state(struct sbmac_softc *sc, sbmac_state_t state)
1406 1.3 simonb {
1407 1.3 simonb sbmac_state_t oldstate = sc->sbm_state;
1408 1.3 simonb
1409 1.3 simonb /*
1410 1.3 simonb * If same as previous state, return
1411 1.3 simonb */
1412 1.3 simonb
1413 1.3 simonb if (state == oldstate)
1414 1.3 simonb return oldstate;
1415 1.3 simonb
1416 1.3 simonb /*
1417 1.3 simonb * If new state is ON, turn channel on
1418 1.3 simonb */
1419 1.3 simonb
1420 1.3 simonb if (state == sbmac_state_on)
1421 1.3 simonb sbmac_channel_start(sc);
1422 1.3 simonb else
1423 1.3 simonb sbmac_channel_stop(sc);
1424 1.3 simonb
1425 1.3 simonb /*
1426 1.3 simonb * Return previous state
1427 1.3 simonb */
1428 1.3 simonb
1429 1.3 simonb return oldstate;
1430 1.1 simonb }
1431 1.1 simonb
1432 1.3 simonb /*
1433 1.3 simonb * SBMAC_PROMISCUOUS_MODE(sc, onoff)
1434 1.3 simonb *
1435 1.3 simonb * Turn on or off promiscuous mode
1436 1.3 simonb *
1437 1.3 simonb * Input parameters:
1438 1.3 simonb * sc - softc
1439 1.3 simonb * onoff - 1 to turn on, 0 to turn off
1440 1.3 simonb *
1441 1.3 simonb * Return value:
1442 1.3 simonb * nothing
1443 1.3 simonb */
1444 1.3 simonb
1445 1.3 simonb static void
1446 1.3 simonb sbmac_promiscuous_mode(struct sbmac_softc *sc, int onoff)
1447 1.1 simonb {
1448 1.3 simonb uint64_t reg;
1449 1.1 simonb
1450 1.3 simonb if (sc->sbm_state != sbmac_state_on)
1451 1.3 simonb return;
1452 1.1 simonb
1453 1.3 simonb if (onoff) {
1454 1.3 simonb reg = SBMAC_READCSR(sc->sbm_rxfilter);
1455 1.3 simonb reg |= M_MAC_ALLPKT_EN;
1456 1.3 simonb SBMAC_WRITECSR(sc->sbm_rxfilter, reg);
1457 1.3 simonb } else {
1458 1.3 simonb reg = SBMAC_READCSR(sc->sbm_rxfilter);
1459 1.3 simonb reg &= ~M_MAC_ALLPKT_EN;
1460 1.3 simonb SBMAC_WRITECSR(sc->sbm_rxfilter, reg);
1461 1.1 simonb }
1462 1.3 simonb }
1463 1.1 simonb
1464 1.3 simonb /*
1465 1.3 simonb * SBMAC_INIT_AND_START(sc)
1466 1.3 simonb *
1467 1.3 simonb * Stop the channel and restart it. This is generally used
1468 1.3 simonb * when we have to do something to the channel that requires
1469 1.3 simonb * a swift kick.
1470 1.3 simonb *
1471 1.3 simonb * Input parameters:
1472 1.3 simonb * sc - softc
1473 1.3 simonb */
1474 1.1 simonb
1475 1.3 simonb static void
1476 1.3 simonb sbmac_init_and_start(struct sbmac_softc *sc)
1477 1.3 simonb {
1478 1.3 simonb int s;
1479 1.3 simonb
1480 1.3 simonb s = splnet();
1481 1.1 simonb
1482 1.13 simonb mii_pollstat(&sc->sc_mii); /* poll phy for current speed */
1483 1.13 simonb sbmac_mii_statchg((struct device *) sc); /* set state to new speed */
1484 1.3 simonb sbmac_set_channel_state(sc, sbmac_state_on);
1485 1.1 simonb
1486 1.3 simonb splx(s);
1487 1.1 simonb }
1488 1.1 simonb
1489 1.3 simonb /*
1490 1.3 simonb * SBMAC_ADDR2REG(ptr)
1491 1.3 simonb *
1492 1.3 simonb * Convert six bytes into the 64-bit register value that
1493 1.3 simonb * we typically write into the SBMAC's address/mcast registers
1494 1.3 simonb *
1495 1.3 simonb * Input parameters:
1496 1.3 simonb * ptr - pointer to 6 bytes
1497 1.3 simonb *
1498 1.3 simonb * Return value:
1499 1.3 simonb * register value
1500 1.3 simonb */
1501 1.3 simonb
1502 1.3 simonb static uint64_t
1503 1.3 simonb sbmac_addr2reg(u_char *ptr)
1504 1.3 simonb {
1505 1.3 simonb uint64_t reg = 0;
1506 1.1 simonb
1507 1.3 simonb ptr += 6;
1508 1.3 simonb
1509 1.3 simonb reg |= (uint64_t) *(--ptr);
1510 1.3 simonb reg <<= 8;
1511 1.3 simonb reg |= (uint64_t) *(--ptr);
1512 1.3 simonb reg <<= 8;
1513 1.3 simonb reg |= (uint64_t) *(--ptr);
1514 1.3 simonb reg <<= 8;
1515 1.3 simonb reg |= (uint64_t) *(--ptr);
1516 1.3 simonb reg <<= 8;
1517 1.3 simonb reg |= (uint64_t) *(--ptr);
1518 1.3 simonb reg <<= 8;
1519 1.3 simonb reg |= (uint64_t) *(--ptr);
1520 1.3 simonb
1521 1.3 simonb return reg;
1522 1.3 simonb }
1523 1.3 simonb
1524 1.3 simonb /*
1525 1.3 simonb * SBMAC_SET_SPEED(s, speed)
1526 1.3 simonb *
1527 1.3 simonb * Configure LAN speed for the specified MAC.
1528 1.3 simonb * Warning: must be called when MAC is off!
1529 1.3 simonb *
1530 1.3 simonb * Input parameters:
1531 1.3 simonb * s - sbmac structure
1532 1.3 simonb * speed - speed to set MAC to (see sbmac_speed_t enum)
1533 1.3 simonb *
1534 1.3 simonb * Return value:
1535 1.3 simonb * 1 if successful
1536 1.3 simonb * 0 indicates invalid parameters
1537 1.3 simonb */
1538 1.1 simonb
1539 1.3 simonb static int
1540 1.3 simonb sbmac_set_speed(struct sbmac_softc *s, sbmac_speed_t speed)
1541 1.1 simonb {
1542 1.3 simonb uint64_t cfg;
1543 1.3 simonb uint64_t framecfg;
1544 1.3 simonb
1545 1.3 simonb /*
1546 1.3 simonb * Save new current values
1547 1.3 simonb */
1548 1.1 simonb
1549 1.3 simonb s->sbm_speed = speed;
1550 1.1 simonb
1551 1.3 simonb if (s->sbm_state != sbmac_state_off)
1552 1.3 simonb panic("sbmac_set_speed while MAC not off");
1553 1.3 simonb
1554 1.3 simonb /*
1555 1.3 simonb * Read current register values
1556 1.3 simonb */
1557 1.3 simonb
1558 1.3 simonb cfg = SBMAC_READCSR(s->sbm_maccfg);
1559 1.3 simonb framecfg = SBMAC_READCSR(s->sbm_framecfg);
1560 1.1 simonb
1561 1.3 simonb /*
1562 1.3 simonb * Mask out the stuff we want to change
1563 1.3 simonb */
1564 1.1 simonb
1565 1.3 simonb cfg &= ~(M_MAC_BURST_EN | M_MAC_SPEED_SEL);
1566 1.3 simonb framecfg &= ~(M_MAC_IFG_RX | M_MAC_IFG_TX | M_MAC_IFG_THRSH |
1567 1.3 simonb M_MAC_SLOT_SIZE);
1568 1.1 simonb
1569 1.3 simonb /*
1570 1.3 simonb * Now add in the new bits
1571 1.3 simonb */
1572 1.1 simonb
1573 1.3 simonb switch (speed) {
1574 1.1 simonb case sbmac_speed_10:
1575 1.3 simonb framecfg |= V_MAC_IFG_RX_10 |
1576 1.3 simonb V_MAC_IFG_TX_10 |
1577 1.3 simonb K_MAC_IFG_THRSH_10 |
1578 1.3 simonb V_MAC_SLOT_SIZE_10;
1579 1.3 simonb cfg |= V_MAC_SPEED_SEL_10MBPS;
1580 1.3 simonb break;
1581 1.1 simonb
1582 1.1 simonb case sbmac_speed_100:
1583 1.3 simonb framecfg |= V_MAC_IFG_RX_100 |
1584 1.3 simonb V_MAC_IFG_TX_100 |
1585 1.3 simonb V_MAC_IFG_THRSH_100 |
1586 1.3 simonb V_MAC_SLOT_SIZE_100;
1587 1.3 simonb cfg |= V_MAC_SPEED_SEL_100MBPS ;
1588 1.3 simonb break;
1589 1.1 simonb
1590 1.1 simonb case sbmac_speed_1000:
1591 1.3 simonb framecfg |= V_MAC_IFG_RX_1000 |
1592 1.3 simonb V_MAC_IFG_TX_1000 |
1593 1.3 simonb V_MAC_IFG_THRSH_1000 |
1594 1.3 simonb V_MAC_SLOT_SIZE_1000;
1595 1.3 simonb cfg |= V_MAC_SPEED_SEL_1000MBPS | M_MAC_BURST_EN;
1596 1.3 simonb break;
1597 1.1 simonb
1598 1.1 simonb case sbmac_speed_auto: /* XXX not implemented */
1599 1.3 simonb /* fall through */
1600 1.1 simonb default:
1601 1.3 simonb return 0;
1602 1.1 simonb }
1603 1.1 simonb
1604 1.3 simonb /*
1605 1.3 simonb * Send the bits back to the hardware
1606 1.3 simonb */
1607 1.1 simonb
1608 1.3 simonb SBMAC_WRITECSR(s->sbm_framecfg, framecfg);
1609 1.3 simonb SBMAC_WRITECSR(s->sbm_maccfg, cfg);
1610 1.1 simonb
1611 1.3 simonb return 1;
1612 1.1 simonb }
1613 1.1 simonb
1614 1.3 simonb /*
1615 1.3 simonb * SBMAC_SET_DUPLEX(s, duplex, fc)
1616 1.3 simonb *
1617 1.3 simonb * Set Ethernet duplex and flow control options for this MAC
1618 1.3 simonb * Warning: must be called when MAC is off!
1619 1.3 simonb *
1620 1.3 simonb * Input parameters:
1621 1.3 simonb * s - sbmac structure
1622 1.3 simonb * duplex - duplex setting (see sbmac_duplex_t)
1623 1.3 simonb * fc - flow control setting (see sbmac_fc_t)
1624 1.3 simonb *
1625 1.3 simonb * Return value:
1626 1.3 simonb * 1 if ok
1627 1.3 simonb * 0 if an invalid parameter combination was specified
1628 1.3 simonb */
1629 1.1 simonb
1630 1.3 simonb static int
1631 1.3 simonb sbmac_set_duplex(struct sbmac_softc *s, sbmac_duplex_t duplex, sbmac_fc_t fc)
1632 1.1 simonb {
1633 1.3 simonb uint64_t cfg;
1634 1.1 simonb
1635 1.3 simonb /*
1636 1.3 simonb * Save new current values
1637 1.3 simonb */
1638 1.1 simonb
1639 1.3 simonb s->sbm_duplex = duplex;
1640 1.3 simonb s->sbm_fc = fc;
1641 1.1 simonb
1642 1.3 simonb if (s->sbm_state != sbmac_state_off)
1643 1.3 simonb panic("sbmac_set_duplex while MAC not off");
1644 1.1 simonb
1645 1.3 simonb /*
1646 1.3 simonb * Read current register values
1647 1.3 simonb */
1648 1.1 simonb
1649 1.3 simonb cfg = SBMAC_READCSR(s->sbm_maccfg);
1650 1.1 simonb
1651 1.3 simonb /*
1652 1.3 simonb * Mask off the stuff we're about to change
1653 1.3 simonb */
1654 1.1 simonb
1655 1.3 simonb cfg &= ~(M_MAC_FC_SEL | M_MAC_FC_CMD | M_MAC_HDX_EN);
1656 1.1 simonb
1657 1.3 simonb switch (duplex) {
1658 1.1 simonb case sbmac_duplex_half:
1659 1.3 simonb switch (fc) {
1660 1.1 simonb case sbmac_fc_disabled:
1661 1.3 simonb cfg |= M_MAC_HDX_EN | V_MAC_FC_CMD_DISABLED;
1662 1.3 simonb break;
1663 1.1 simonb
1664 1.1 simonb case sbmac_fc_collision:
1665 1.3 simonb cfg |= M_MAC_HDX_EN | V_MAC_FC_CMD_ENABLED;
1666 1.3 simonb break;
1667 1.1 simonb
1668 1.1 simonb case sbmac_fc_carrier:
1669 1.3 simonb cfg |= M_MAC_HDX_EN | V_MAC_FC_CMD_ENAB_FALSECARR;
1670 1.3 simonb break;
1671 1.1 simonb
1672 1.1 simonb case sbmac_fc_auto: /* XXX not implemented */
1673 1.3 simonb /* fall through */
1674 1.1 simonb case sbmac_fc_frame: /* not valid in half duplex */
1675 1.1 simonb default: /* invalid selection */
1676 1.4 provos panic("%s: invalid half duplex fc selection %d",
1677 1.3 simonb s->sc_dev.dv_xname, fc);
1678 1.3 simonb return 0;
1679 1.1 simonb }
1680 1.3 simonb break;
1681 1.1 simonb
1682 1.1 simonb case sbmac_duplex_full:
1683 1.3 simonb switch (fc) {
1684 1.1 simonb case sbmac_fc_disabled:
1685 1.3 simonb cfg |= V_MAC_FC_CMD_DISABLED;
1686 1.3 simonb break;
1687 1.1 simonb
1688 1.1 simonb case sbmac_fc_frame:
1689 1.3 simonb cfg |= V_MAC_FC_CMD_ENABLED;
1690 1.3 simonb break;
1691 1.1 simonb
1692 1.1 simonb case sbmac_fc_collision: /* not valid in full duplex */
1693 1.1 simonb case sbmac_fc_carrier: /* not valid in full duplex */
1694 1.1 simonb case sbmac_fc_auto: /* XXX not implemented */
1695 1.3 simonb /* fall through */
1696 1.1 simonb default:
1697 1.4 provos panic("%s: invalid full duplex fc selection %d",
1698 1.3 simonb s->sc_dev.dv_xname, fc);
1699 1.3 simonb return 0;
1700 1.1 simonb }
1701 1.3 simonb break;
1702 1.1 simonb
1703 1.1 simonb default:
1704 1.3 simonb /* fall through */
1705 1.1 simonb case sbmac_duplex_auto:
1706 1.4 provos panic("%s: bad duplex %d", s->sc_dev.dv_xname, duplex);
1707 1.3 simonb /* XXX not implemented */
1708 1.3 simonb break;
1709 1.1 simonb }
1710 1.1 simonb
1711 1.3 simonb /*
1712 1.3 simonb * Send the bits back to the hardware
1713 1.3 simonb */
1714 1.1 simonb
1715 1.3 simonb SBMAC_WRITECSR(s->sbm_maccfg, cfg);
1716 1.1 simonb
1717 1.3 simonb return 1;
1718 1.1 simonb }
1719 1.1 simonb
1720 1.3 simonb /*
1721 1.3 simonb * SBMAC_INTR()
1722 1.3 simonb *
1723 1.3 simonb * Interrupt handler for MAC interrupts
1724 1.3 simonb *
1725 1.3 simonb * Input parameters:
1726 1.3 simonb * MAC structure
1727 1.3 simonb *
1728 1.3 simonb * Return value:
1729 1.3 simonb * nothing
1730 1.3 simonb */
1731 1.1 simonb
1732 1.1 simonb /* ARGSUSED */
1733 1.1 simonb static void
1734 1.35 matt sbmac_intr(void *xsc, uint32_t status, vaddr_t pc)
1735 1.1 simonb {
1736 1.1 simonb struct sbmac_softc *sc = (struct sbmac_softc *) xsc;
1737 1.14 simonb struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1738 1.1 simonb uint64_t isr;
1739 1.1 simonb
1740 1.1 simonb for (;;) {
1741 1.1 simonb
1742 1.1 simonb /*
1743 1.1 simonb * Read the ISR (this clears the bits in the real register)
1744 1.1 simonb */
1745 1.1 simonb
1746 1.1 simonb isr = SBMAC_READCSR(sc->sbm_isr);
1747 1.1 simonb
1748 1.1 simonb if (isr == 0)
1749 1.1 simonb break;
1750 1.1 simonb
1751 1.1 simonb /*
1752 1.1 simonb * Transmits on channel 0
1753 1.1 simonb */
1754 1.1 simonb
1755 1.15 simonb if (isr & (M_MAC_INT_CHANNEL << S_MAC_TX_CH0)) {
1756 1.1 simonb sbdma_tx_process(sc, &(sc->sbm_txdma));
1757 1.15 simonb SBMAC_EVCNT_INCR(sc->sbm_ev_txintr);
1758 1.15 simonb }
1759 1.1 simonb
1760 1.1 simonb /*
1761 1.1 simonb * Receives on channel 0
1762 1.1 simonb */
1763 1.1 simonb
1764 1.15 simonb if (isr & (M_MAC_INT_CHANNEL << S_MAC_RX_CH0)) {
1765 1.1 simonb sbdma_rx_process(sc, &(sc->sbm_rxdma));
1766 1.15 simonb SBMAC_EVCNT_INCR(sc->sbm_ev_rxintr);
1767 1.15 simonb }
1768 1.1 simonb }
1769 1.14 simonb
1770 1.14 simonb /* try to get more packets going */
1771 1.14 simonb sbmac_start(ifp);
1772 1.1 simonb }
1773 1.1 simonb
1774 1.1 simonb
1775 1.3 simonb /*
1776 1.3 simonb * SBMAC_START(ifp)
1777 1.3 simonb *
1778 1.3 simonb * Start output on the specified interface. Basically, we
1779 1.3 simonb * queue as many buffers as we can until the ring fills up, or
1780 1.3 simonb * we run off the end of the queue, whichever comes first.
1781 1.3 simonb *
1782 1.3 simonb * Input parameters:
1783 1.3 simonb * ifp - interface
1784 1.3 simonb *
1785 1.3 simonb * Return value:
1786 1.3 simonb * nothing
1787 1.3 simonb */
1788 1.3 simonb
1789 1.3 simonb static void
1790 1.3 simonb sbmac_start(struct ifnet *ifp)
1791 1.1 simonb {
1792 1.3 simonb struct sbmac_softc *sc;
1793 1.3 simonb struct mbuf *m_head = NULL;
1794 1.3 simonb int rv;
1795 1.1 simonb
1796 1.3 simonb if ((ifp->if_flags & (IFF_RUNNING|IFF_OACTIVE)) != IFF_RUNNING)
1797 1.3 simonb return;
1798 1.3 simonb
1799 1.3 simonb sc = ifp->if_softc;
1800 1.1 simonb
1801 1.3 simonb for (;;) {
1802 1.1 simonb
1803 1.3 simonb IF_DEQUEUE(&ifp->if_snd, m_head);
1804 1.3 simonb if (m_head == NULL)
1805 1.3 simonb break;
1806 1.1 simonb
1807 1.3 simonb /*
1808 1.3 simonb * Put the buffer on the transmit ring. If we
1809 1.3 simonb * don't have room, set the OACTIVE flag and wait
1810 1.3 simonb * for the NIC to drain the ring.
1811 1.3 simonb */
1812 1.3 simonb
1813 1.3 simonb rv = sbdma_add_txbuffer(&(sc->sbm_txdma), m_head);
1814 1.3 simonb
1815 1.3 simonb if (rv == 0) {
1816 1.3 simonb /*
1817 1.13 simonb * If there's a BPF listener, bounce a copy of this
1818 1.13 simonb * frame to it.
1819 1.3 simonb */
1820 1.3 simonb #if (NBPFILTER > 0)
1821 1.3 simonb if (ifp->if_bpf)
1822 1.3 simonb bpf_mtap(ifp->if_bpf, m_head);
1823 1.3 simonb #endif
1824 1.8 cgd if (!sc->sbm_pass3_dma) {
1825 1.8 cgd /*
1826 1.13 simonb * Don't free mbuf if we're not copying to new
1827 1.13 simonb * mbuf in sbdma_add_txbuffer. It will be
1828 1.13 simonb * freed in sbdma_tx_process.
1829 1.8 cgd */
1830 1.8 cgd m_freem(m_head);
1831 1.8 cgd }
1832 1.3 simonb } else {
1833 1.3 simonb IF_PREPEND(&ifp->if_snd, m_head);
1834 1.3 simonb ifp->if_flags |= IFF_OACTIVE;
1835 1.3 simonb break;
1836 1.3 simonb }
1837 1.3 simonb }
1838 1.3 simonb }
1839 1.3 simonb
1840 1.3 simonb /*
1841 1.3 simonb * SBMAC_SETMULTI(sc)
1842 1.3 simonb *
1843 1.3 simonb * Reprogram the multicast table into the hardware, given
1844 1.3 simonb * the list of multicasts associated with the interface
1845 1.3 simonb * structure.
1846 1.3 simonb *
1847 1.3 simonb * Input parameters:
1848 1.3 simonb * sc - softc
1849 1.3 simonb *
1850 1.3 simonb * Return value:
1851 1.3 simonb * nothing
1852 1.3 simonb */
1853 1.3 simonb
1854 1.3 simonb static void
1855 1.3 simonb sbmac_setmulti(struct sbmac_softc *sc)
1856 1.3 simonb {
1857 1.3 simonb struct ifnet *ifp;
1858 1.3 simonb uint64_t reg;
1859 1.3 simonb sbmac_port_t port;
1860 1.3 simonb int idx;
1861 1.3 simonb struct ether_multi *enm;
1862 1.3 simonb struct ether_multistep step;
1863 1.3 simonb
1864 1.3 simonb ifp = &sc->sc_ethercom.ec_if;
1865 1.1 simonb
1866 1.1 simonb /*
1867 1.3 simonb * Clear out entire multicast table. We do this by nuking
1868 1.3 simonb * the entire hash table and all the direct matches except
1869 1.3 simonb * the first one, which is used for our station address
1870 1.1 simonb */
1871 1.1 simonb
1872 1.3 simonb for (idx = 1; idx < MAC_ADDR_COUNT; idx++) {
1873 1.13 simonb port = PKSEG1(sc->sbm_base +
1874 1.13 simonb R_MAC_ADDR_BASE+(idx*sizeof(uint64_t)));
1875 1.3 simonb SBMAC_WRITECSR(port, 0);
1876 1.3 simonb }
1877 1.1 simonb
1878 1.3 simonb for (idx = 0; idx < MAC_HASH_COUNT; idx++) {
1879 1.13 simonb port = PKSEG1(sc->sbm_base +
1880 1.13 simonb R_MAC_HASH_BASE+(idx*sizeof(uint64_t)));
1881 1.3 simonb SBMAC_WRITECSR(port, 0);
1882 1.3 simonb }
1883 1.1 simonb
1884 1.1 simonb /*
1885 1.3 simonb * Clear the filter to say we don't want any multicasts.
1886 1.1 simonb */
1887 1.3 simonb
1888 1.1 simonb reg = SBMAC_READCSR(sc->sbm_rxfilter);
1889 1.3 simonb reg &= ~(M_MAC_MCAST_INV | M_MAC_MCAST_EN);
1890 1.1 simonb SBMAC_WRITECSR(sc->sbm_rxfilter, reg);
1891 1.3 simonb
1892 1.3 simonb if (ifp->if_flags & IFF_ALLMULTI) {
1893 1.3 simonb /*
1894 1.3 simonb * Enable ALL multicasts. Do this by inverting the
1895 1.3 simonb * multicast enable bit.
1896 1.3 simonb */
1897 1.3 simonb reg = SBMAC_READCSR(sc->sbm_rxfilter);
1898 1.3 simonb reg |= (M_MAC_MCAST_INV | M_MAC_MCAST_EN);
1899 1.3 simonb SBMAC_WRITECSR(sc->sbm_rxfilter, reg);
1900 1.3 simonb return;
1901 1.1 simonb }
1902 1.1 simonb
1903 1.3 simonb /*
1904 1.3 simonb * Progam new multicast entries. For now, only use the
1905 1.3 simonb * perfect filter. In the future we'll need to use the
1906 1.3 simonb * hash filter if the perfect filter overflows
1907 1.3 simonb */
1908 1.3 simonb
1909 1.3 simonb /*
1910 1.3 simonb * XXX only using perfect filter for now, need to use hash
1911 1.3 simonb * XXX if the table overflows
1912 1.3 simonb */
1913 1.3 simonb
1914 1.3 simonb idx = 1; /* skip station address */
1915 1.3 simonb ETHER_FIRST_MULTI(step, &sc->sc_ethercom, enm);
1916 1.3 simonb while ((enm != NULL) && (idx < MAC_ADDR_COUNT)) {
1917 1.3 simonb reg = sbmac_addr2reg(enm->enm_addrlo);
1918 1.3 simonb port = PKSEG1(sc->sbm_base +
1919 1.3 simonb R_MAC_ADDR_BASE+(idx*sizeof(uint64_t)));
1920 1.3 simonb SBMAC_WRITECSR(port, reg);
1921 1.3 simonb idx++;
1922 1.3 simonb ETHER_NEXT_MULTI(step, enm);
1923 1.1 simonb }
1924 1.1 simonb
1925 1.3 simonb /*
1926 1.3 simonb * Enable the "accept multicast bits" if we programmed at least one
1927 1.3 simonb * multicast.
1928 1.3 simonb */
1929 1.1 simonb
1930 1.3 simonb if (idx > 1) {
1931 1.3 simonb reg = SBMAC_READCSR(sc->sbm_rxfilter);
1932 1.3 simonb reg |= M_MAC_MCAST_EN;
1933 1.3 simonb SBMAC_WRITECSR(sc->sbm_rxfilter, reg);
1934 1.1 simonb }
1935 1.1 simonb }
1936 1.1 simonb
1937 1.3 simonb /*
1938 1.3 simonb * SBMAC_ETHER_IOCTL(ifp, cmd, data)
1939 1.3 simonb *
1940 1.3 simonb * Generic IOCTL requests for this interface. The basic
1941 1.3 simonb * stuff is handled here for bringing the interface up,
1942 1.3 simonb * handling multicasts, etc.
1943 1.3 simonb *
1944 1.3 simonb * Input parameters:
1945 1.3 simonb * ifp - interface structure
1946 1.3 simonb * cmd - command code
1947 1.3 simonb * data - pointer to data
1948 1.3 simonb *
1949 1.3 simonb * Return value:
1950 1.3 simonb * return value (0 is success)
1951 1.3 simonb */
1952 1.1 simonb
1953 1.3 simonb static int
1954 1.22 christos sbmac_ether_ioctl(struct ifnet *ifp, u_long cmd, void *data)
1955 1.1 simonb {
1956 1.3 simonb struct ifaddr *ifa = (struct ifaddr *) data;
1957 1.3 simonb struct sbmac_softc *sc = ifp->if_softc;
1958 1.1 simonb
1959 1.3 simonb switch (cmd) {
1960 1.29 dyoung case SIOCINITIFADDR:
1961 1.3 simonb ifp->if_flags |= IFF_UP;
1962 1.1 simonb
1963 1.3 simonb switch (ifa->ifa_addr->sa_family) {
1964 1.1 simonb #ifdef INET
1965 1.1 simonb case AF_INET:
1966 1.3 simonb sbmac_init_and_start(sc);
1967 1.3 simonb arp_ifinit(ifp, ifa);
1968 1.3 simonb break;
1969 1.1 simonb #endif
1970 1.1 simonb #ifdef NS
1971 1.1 simonb case AF_NS:
1972 1.1 simonb {
1973 1.3 simonb struct ns_addr *ina = &IA_SNS(ifa)->sns_addr;
1974 1.1 simonb
1975 1.3 simonb if (ns_nullhost(*ina))
1976 1.13 simonb ina->x_host =
1977 1.13 simonb *(union ns_host *)LLADDR(ifp->if_sadl);
1978 1.3 simonb else
1979 1.34 cegger memcpy(LLADDR(ifp->if_sadl), ina->x_host.c_host,
1980 1.3 simonb ifp->if_addrlen);
1981 1.3 simonb /* Set new address. */
1982 1.3 simonb sbmac_init_and_start(sc);
1983 1.3 simonb break;
1984 1.3 simonb }
1985 1.1 simonb #endif
1986 1.1 simonb default:
1987 1.3 simonb sbmac_init_and_start(sc);
1988 1.3 simonb break;
1989 1.1 simonb }
1990 1.3 simonb break;
1991 1.1 simonb
1992 1.1 simonb default:
1993 1.29 dyoung return ENOTTY;
1994 1.1 simonb }
1995 1.1 simonb
1996 1.3 simonb return (0);
1997 1.1 simonb }
1998 1.1 simonb
1999 1.3 simonb /*
2000 1.30 dyoung * SBMAC_IOCTL(ifp, cmd, data)
2001 1.3 simonb *
2002 1.3 simonb * Main IOCTL handler - dispatches to other IOCTLs for various
2003 1.3 simonb * types of requests.
2004 1.3 simonb *
2005 1.3 simonb * Input parameters:
2006 1.3 simonb * ifp - interface pointer
2007 1.30 dyoung * cmd - command code
2008 1.3 simonb * data - pointer to argument data
2009 1.3 simonb *
2010 1.3 simonb * Return value:
2011 1.3 simonb * 0 if ok
2012 1.3 simonb * else error code
2013 1.3 simonb */
2014 1.1 simonb
2015 1.3 simonb static int
2016 1.30 dyoung sbmac_ioctl(struct ifnet *ifp, u_long cmd, void *data)
2017 1.1 simonb {
2018 1.3 simonb struct sbmac_softc *sc = ifp->if_softc;
2019 1.3 simonb struct ifreq *ifr = (struct ifreq *) data;
2020 1.3 simonb int s, error = 0;
2021 1.1 simonb
2022 1.3 simonb s = splnet();
2023 1.1 simonb
2024 1.30 dyoung switch (cmd) {
2025 1.29 dyoung case SIOCINITIFADDR:
2026 1.30 dyoung error = sbmac_ether_ioctl(ifp, cmd, data);
2027 1.3 simonb break;
2028 1.1 simonb case SIOCSIFMTU:
2029 1.28 dyoung if (ifr->ifr_mtu < ETHERMIN || ifr->ifr_mtu > ETHERMTU)
2030 1.3 simonb error = EINVAL;
2031 1.30 dyoung else if ((error = ifioctl_common(ifp, cmd, data)) == ENETRESET)
2032 1.3 simonb /* XXX Program new MTU here */
2033 1.28 dyoung error = 0;
2034 1.3 simonb break;
2035 1.1 simonb case SIOCSIFFLAGS:
2036 1.29 dyoung if ((error = ifioctl_common(ifp, cmd, data)) != 0)
2037 1.29 dyoung break;
2038 1.3 simonb if (ifp->if_flags & IFF_UP) {
2039 1.3 simonb /*
2040 1.3 simonb * If only the state of the PROMISC flag changed,
2041 1.3 simonb * just tweak the hardware registers.
2042 1.3 simonb */
2043 1.3 simonb if ((ifp->if_flags & IFF_RUNNING) &&
2044 1.3 simonb (ifp->if_flags & IFF_PROMISC)) {
2045 1.3 simonb /* turn on promiscuous mode */
2046 1.3 simonb sbmac_promiscuous_mode(sc, 1);
2047 1.3 simonb } else if (ifp->if_flags & IFF_RUNNING &&
2048 1.3 simonb !(ifp->if_flags & IFF_PROMISC)) {
2049 1.3 simonb /* turn off promiscuous mode */
2050 1.3 simonb sbmac_promiscuous_mode(sc, 0);
2051 1.3 simonb } else
2052 1.3 simonb sbmac_set_channel_state(sc, sbmac_state_on);
2053 1.3 simonb } else {
2054 1.3 simonb if (ifp->if_flags & IFF_RUNNING)
2055 1.3 simonb sbmac_set_channel_state(sc, sbmac_state_off);
2056 1.1 simonb }
2057 1.1 simonb
2058 1.3 simonb sc->sbm_if_flags = ifp->if_flags;
2059 1.3 simonb error = 0;
2060 1.3 simonb break;
2061 1.1 simonb
2062 1.1 simonb case SIOCADDMULTI:
2063 1.1 simonb case SIOCDELMULTI:
2064 1.27 dyoung case SIOCSIFMEDIA:
2065 1.27 dyoung case SIOCGIFMEDIA:
2066 1.30 dyoung if ((error = ether_ioctl(ifp, cmd, data)) == ENETRESET) {
2067 1.3 simonb error = 0;
2068 1.27 dyoung if (ifp->if_flags & IFF_RUNNING)
2069 1.27 dyoung sbmac_setmulti(sc);
2070 1.1 simonb }
2071 1.3 simonb break;
2072 1.1 simonb default:
2073 1.30 dyoung error = ether_ioctl(ifp, cmd, data);
2074 1.3 simonb break;
2075 1.1 simonb }
2076 1.1 simonb
2077 1.3 simonb (void)splx(s);
2078 1.1 simonb
2079 1.3 simonb return(error);
2080 1.1 simonb }
2081 1.1 simonb
2082 1.3 simonb /*
2083 1.3 simonb * SBMAC_IFMEDIA_UPD(ifp)
2084 1.3 simonb *
2085 1.3 simonb * Configure an appropriate media type for this interface,
2086 1.3 simonb * given the data in the interface structure
2087 1.3 simonb *
2088 1.3 simonb * Input parameters:
2089 1.3 simonb * ifp - interface
2090 1.3 simonb *
2091 1.3 simonb * Return value:
2092 1.3 simonb * 0 if ok
2093 1.3 simonb * else error code
2094 1.3 simonb */
2095 1.1 simonb
2096 1.3 simonb /*
2097 1.3 simonb * SBMAC_IFMEDIA_STS(ifp, ifmr)
2098 1.3 simonb *
2099 1.3 simonb * Report current media status (used by ifconfig, for example)
2100 1.3 simonb *
2101 1.3 simonb * Input parameters:
2102 1.3 simonb * ifp - interface structure
2103 1.3 simonb * ifmr - media request structure
2104 1.3 simonb *
2105 1.3 simonb * Return value:
2106 1.3 simonb * nothing
2107 1.3 simonb */
2108 1.1 simonb
2109 1.3 simonb /*
2110 1.3 simonb * SBMAC_WATCHDOG(ifp)
2111 1.3 simonb *
2112 1.3 simonb * Called periodically to make sure we're still happy.
2113 1.3 simonb *
2114 1.3 simonb * Input parameters:
2115 1.3 simonb * ifp - interface structure
2116 1.3 simonb *
2117 1.3 simonb * Return value:
2118 1.3 simonb * nothing
2119 1.3 simonb */
2120 1.1 simonb
2121 1.3 simonb static void
2122 1.3 simonb sbmac_watchdog(struct ifnet *ifp)
2123 1.3 simonb {
2124 1.1 simonb
2125 1.3 simonb /* XXX do something */
2126 1.1 simonb }
2127 1.1 simonb
2128 1.1 simonb /*
2129 1.1 simonb * One second timer, used to tick MII.
2130 1.1 simonb */
2131 1.3 simonb static void
2132 1.3 simonb sbmac_tick(void *arg)
2133 1.1 simonb {
2134 1.3 simonb struct sbmac_softc *sc = arg;
2135 1.3 simonb int s;
2136 1.1 simonb
2137 1.3 simonb s = splnet();
2138 1.3 simonb mii_tick(&sc->sc_mii);
2139 1.3 simonb splx(s);
2140 1.1 simonb
2141 1.3 simonb callout_reset(&sc->sc_tick_ch, hz, sbmac_tick, sc);
2142 1.1 simonb }
2143 1.1 simonb
2144 1.1 simonb
2145 1.3 simonb /*
2146 1.3 simonb * SBMAC_MATCH(parent, match, aux)
2147 1.3 simonb *
2148 1.3 simonb * Part of the config process - see if this device matches the
2149 1.3 simonb * info about what we expect to find on the bus.
2150 1.3 simonb *
2151 1.3 simonb * Input parameters:
2152 1.3 simonb * parent - parent bus structure
2153 1.3 simonb * match -
2154 1.3 simonb * aux - bus-specific args
2155 1.3 simonb *
2156 1.3 simonb * Return value:
2157 1.3 simonb * 1 if we match
2158 1.3 simonb * 0 if we don't match
2159 1.3 simonb */
2160 1.1 simonb
2161 1.3 simonb static int
2162 1.3 simonb sbmac_match(struct device *parent, struct cfdata *match, void *aux)
2163 1.1 simonb {
2164 1.3 simonb struct sbobio_attach_args *sap = aux;
2165 1.3 simonb
2166 1.3 simonb /*
2167 1.3 simonb * Make sure it's a MAC
2168 1.3 simonb */
2169 1.3 simonb
2170 1.3 simonb if (sap->sa_locs.sa_type != SBOBIO_DEVTYPE_MAC)
2171 1.3 simonb return 0;
2172 1.1 simonb
2173 1.3 simonb /*
2174 1.3 simonb * Yup, it is.
2175 1.3 simonb */
2176 1.3 simonb
2177 1.3 simonb return 1;
2178 1.3 simonb }
2179 1.3 simonb
2180 1.3 simonb /*
2181 1.3 simonb * SBMAC_PARSE_XDIGIT(str)
2182 1.3 simonb *
2183 1.3 simonb * Parse a hex digit, returning its value
2184 1.3 simonb *
2185 1.3 simonb * Input parameters:
2186 1.3 simonb * str - character
2187 1.3 simonb *
2188 1.3 simonb * Return value:
2189 1.3 simonb * hex value, or -1 if invalid
2190 1.3 simonb */
2191 1.3 simonb
2192 1.3 simonb static int
2193 1.3 simonb sbmac_parse_xdigit(char str)
2194 1.3 simonb {
2195 1.3 simonb int digit;
2196 1.3 simonb
2197 1.3 simonb if ((str >= '0') && (str <= '9'))
2198 1.3 simonb digit = str - '0';
2199 1.3 simonb else if ((str >= 'a') && (str <= 'f'))
2200 1.3 simonb digit = str - 'a' + 10;
2201 1.3 simonb else if ((str >= 'A') && (str <= 'F'))
2202 1.3 simonb digit = str - 'A' + 10;
2203 1.3 simonb else
2204 1.3 simonb digit = -1;
2205 1.3 simonb
2206 1.3 simonb return digit;
2207 1.3 simonb }
2208 1.3 simonb
2209 1.3 simonb /*
2210 1.3 simonb * SBMAC_PARSE_HWADDR(str, hwaddr)
2211 1.3 simonb *
2212 1.3 simonb * Convert a string in the form xx:xx:xx:xx:xx:xx into a 6-byte
2213 1.3 simonb * Ethernet address.
2214 1.3 simonb *
2215 1.3 simonb * Input parameters:
2216 1.3 simonb * str - string
2217 1.3 simonb * hwaddr - pointer to hardware address
2218 1.3 simonb *
2219 1.3 simonb * Return value:
2220 1.3 simonb * 0 if ok, else -1
2221 1.3 simonb */
2222 1.3 simonb
2223 1.3 simonb static int
2224 1.20 jmc sbmac_parse_hwaddr(const char *str, u_char *hwaddr)
2225 1.3 simonb {
2226 1.3 simonb int digit1, digit2;
2227 1.3 simonb int idx = 6;
2228 1.1 simonb
2229 1.3 simonb while (*str && (idx > 0)) {
2230 1.3 simonb digit1 = sbmac_parse_xdigit(*str);
2231 1.3 simonb if (digit1 < 0)
2232 1.3 simonb return -1;
2233 1.3 simonb str++;
2234 1.3 simonb if (!*str)
2235 1.3 simonb return -1;
2236 1.3 simonb
2237 1.3 simonb if ((*str == ':') || (*str == '-')) {
2238 1.3 simonb digit2 = digit1;
2239 1.3 simonb digit1 = 0;
2240 1.3 simonb } else {
2241 1.3 simonb digit2 = sbmac_parse_xdigit(*str);
2242 1.3 simonb if (digit2 < 0)
2243 1.3 simonb return -1;
2244 1.3 simonb str++;
2245 1.3 simonb }
2246 1.3 simonb
2247 1.3 simonb *hwaddr++ = (digit1 << 4) | digit2;
2248 1.3 simonb idx--;
2249 1.3 simonb
2250 1.3 simonb if (*str == '-')
2251 1.3 simonb str++;
2252 1.3 simonb if (*str == ':')
2253 1.3 simonb str++;
2254 1.3 simonb }
2255 1.1 simonb return 0;
2256 1.3 simonb }
2257 1.3 simonb
2258 1.3 simonb /*
2259 1.3 simonb * SBMAC_ATTACH(parent, self, aux)
2260 1.3 simonb *
2261 1.3 simonb * Attach routine - init hardware and hook ourselves into NetBSD.
2262 1.3 simonb *
2263 1.3 simonb * Input parameters:
2264 1.3 simonb * parent - parent bus device
2265 1.3 simonb * self - our softc
2266 1.3 simonb * aux - attach data
2267 1.3 simonb *
2268 1.3 simonb * Return value:
2269 1.3 simonb * nothing
2270 1.3 simonb */
2271 1.3 simonb
2272 1.3 simonb static void
2273 1.3 simonb sbmac_attach(struct device *parent, struct device *self, void *aux)
2274 1.3 simonb {
2275 1.3 simonb struct ifnet *ifp;
2276 1.3 simonb struct sbmac_softc *sc;
2277 1.3 simonb struct sbobio_attach_args *sap = aux;
2278 1.3 simonb u_char *eaddr;
2279 1.3 simonb static int unit = 0; /* XXX */
2280 1.3 simonb uint64_t ea_reg;
2281 1.3 simonb int idx;
2282 1.3 simonb
2283 1.3 simonb sc = (struct sbmac_softc *)self;
2284 1.3 simonb
2285 1.3 simonb /* Determine controller base address */
2286 1.3 simonb
2287 1.33 simonb sc->sbm_base = sap->sa_locs.sa_addr;
2288 1.3 simonb
2289 1.3 simonb eaddr = sc->sbm_hwaddr;
2290 1.3 simonb
2291 1.3 simonb /*
2292 1.3 simonb * Initialize context (get pointers to registers and stuff), then
2293 1.3 simonb * allocate the memory for the descriptor tables.
2294 1.3 simonb */
2295 1.3 simonb
2296 1.3 simonb sbmac_initctx(sc);
2297 1.3 simonb
2298 1.25 ad callout_init(&(sc->sc_tick_ch), 0);
2299 1.3 simonb
2300 1.3 simonb /*
2301 1.3 simonb * Read the ethernet address. The firwmare left this programmed
2302 1.3 simonb * for us in the ethernet address register for each mac.
2303 1.3 simonb */
2304 1.1 simonb
2305 1.3 simonb ea_reg = SBMAC_READCSR(PKSEG1(sc->sbm_base + R_MAC_ETHERNET_ADDR));
2306 1.3 simonb for (idx = 0; idx < 6; idx++) {
2307 1.3 simonb eaddr[idx] = (uint8_t) (ea_reg & 0xFF);
2308 1.3 simonb ea_reg >>= 8;
2309 1.1 simonb }
2310 1.1 simonb
2311 1.1 simonb #define SBMAC_DEFAULT_HWADDR "40:00:00:00:01:00"
2312 1.3 simonb if (eaddr[0] == 0 && eaddr[1] == 0 && eaddr[2] == 0 &&
2313 1.3 simonb eaddr[3] == 0 && eaddr[4] == 0 && eaddr[5] == 0) {
2314 1.3 simonb sbmac_parse_hwaddr(SBMAC_DEFAULT_HWADDR, eaddr);
2315 1.3 simonb eaddr[5] = unit;
2316 1.1 simonb }
2317 1.1 simonb
2318 1.1 simonb #ifdef SBMAC_ETH0_HWADDR
2319 1.3 simonb if (unit == 0)
2320 1.3 simonb sbmac_parse_hwaddr(SBMAC_ETH0_HWADDR, eaddr);
2321 1.1 simonb #endif
2322 1.1 simonb #ifdef SBMAC_ETH1_HWADDR
2323 1.3 simonb if (unit == 1)
2324 1.3 simonb sbmac_parse_hwaddr(SBMAC_ETH1_HWADDR, eaddr);
2325 1.1 simonb #endif
2326 1.1 simonb #ifdef SBMAC_ETH2_HWADDR
2327 1.3 simonb if (unit == 2)
2328 1.3 simonb sbmac_parse_hwaddr(SBMAC_ETH2_HWADDR, eaddr);
2329 1.1 simonb #endif
2330 1.3 simonb unit++;
2331 1.3 simonb
2332 1.3 simonb /*
2333 1.3 simonb * Display Ethernet address (this is called during the config process
2334 1.3 simonb * so we need to finish off the config message that was being displayed)
2335 1.3 simonb */
2336 1.8 cgd printf(": Ethernet%s\n",
2337 1.8 cgd sc->sbm_pass3_dma ? ", using unaligned tx DMA" : "");
2338 1.8 cgd printf("%s: Ethernet address: %s\n", self->dv_xname,
2339 1.3 simonb ether_sprintf(eaddr));
2340 1.1 simonb
2341 1.3 simonb
2342 1.3 simonb /*
2343 1.3 simonb * Set up ifnet structure
2344 1.3 simonb */
2345 1.3 simonb
2346 1.3 simonb ifp = &sc->sc_ethercom.ec_if;
2347 1.3 simonb ifp->if_softc = sc;
2348 1.34 cegger memcpy(ifp->if_xname, sc->sc_dev.dv_xname, IFNAMSIZ);
2349 1.13 simonb ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST |
2350 1.13 simonb IFF_NOTRAILERS;
2351 1.3 simonb ifp->if_ioctl = sbmac_ioctl;
2352 1.3 simonb ifp->if_start = sbmac_start;
2353 1.3 simonb ifp->if_watchdog = sbmac_watchdog;
2354 1.3 simonb ifp->if_snd.ifq_maxlen = SBMAC_MAX_TXDESCR - 1;
2355 1.3 simonb
2356 1.3 simonb /*
2357 1.3 simonb * Set up ifmedia support.
2358 1.3 simonb */
2359 1.3 simonb
2360 1.3 simonb /*
2361 1.3 simonb * Initialize MII/media info.
2362 1.3 simonb */
2363 1.3 simonb sc->sc_mii.mii_ifp = ifp;
2364 1.3 simonb sc->sc_mii.mii_readreg = sbmac_mii_readreg;
2365 1.3 simonb sc->sc_mii.mii_writereg = sbmac_mii_writereg;
2366 1.3 simonb sc->sc_mii.mii_statchg = sbmac_mii_statchg;
2367 1.27 dyoung sc->sc_ethercom.ec_mii = &sc->sc_mii;
2368 1.27 dyoung ifmedia_init(&sc->sc_mii.mii_media, 0, ether_mediachange,
2369 1.27 dyoung ether_mediastatus);
2370 1.3 simonb mii_attach(&sc->sc_dev, &sc->sc_mii, 0xffffffff, MII_PHY_ANY,
2371 1.3 simonb MII_OFFSET_ANY, 0);
2372 1.3 simonb
2373 1.3 simonb if (LIST_FIRST(&sc->sc_mii.mii_phys) == NULL) {
2374 1.3 simonb ifmedia_add(&sc->sc_mii.mii_media, IFM_ETHER|IFM_NONE, 0, NULL);
2375 1.3 simonb ifmedia_set(&sc->sc_mii.mii_media, IFM_ETHER|IFM_NONE);
2376 1.3 simonb } else {
2377 1.3 simonb ifmedia_set(&sc->sc_mii.mii_media, IFM_ETHER|IFM_AUTO);
2378 1.1 simonb }
2379 1.1 simonb
2380 1.1 simonb
2381 1.3 simonb /*
2382 1.3 simonb * map/route interrupt
2383 1.3 simonb */
2384 1.3 simonb
2385 1.3 simonb sc->sbm_intrhand = cpu_intr_establish(sap->sa_locs.sa_intr[0], IPL_NET,
2386 1.3 simonb sbmac_intr, sc);
2387 1.3 simonb
2388 1.3 simonb /*
2389 1.3 simonb * Call MI attach routines.
2390 1.3 simonb */
2391 1.3 simonb if_attach(ifp);
2392 1.3 simonb ether_ifattach(ifp, eaddr);
2393 1.1 simonb }
2394