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