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