if_msk.c revision 1.96 1 1.96 maxv /* $NetBSD: if_msk.c,v 1.96 2019/12/01 12:47:10 maxv Exp $ */
2 1.68 jdolecek /* $OpenBSD: if_msk.c,v 1.79 2009/10/15 17:54:56 deraadt Exp $ */
3 1.1 riz
4 1.1 riz /*
5 1.1 riz * Copyright (c) 1997, 1998, 1999, 2000
6 1.1 riz * Bill Paul <wpaul (at) ctr.columbia.edu>. All rights reserved.
7 1.1 riz *
8 1.1 riz * Redistribution and use in source and binary forms, with or without
9 1.1 riz * modification, are permitted provided that the following conditions
10 1.1 riz * are met:
11 1.1 riz * 1. Redistributions of source code must retain the above copyright
12 1.1 riz * notice, this list of conditions and the following disclaimer.
13 1.1 riz * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 riz * notice, this list of conditions and the following disclaimer in the
15 1.1 riz * documentation and/or other materials provided with the distribution.
16 1.1 riz * 3. All advertising materials mentioning features or use of this software
17 1.1 riz * must display the following acknowledgement:
18 1.1 riz * This product includes software developed by Bill Paul.
19 1.1 riz * 4. Neither the name of the author nor the names of any co-contributors
20 1.1 riz * may be used to endorse or promote products derived from this software
21 1.1 riz * without specific prior written permission.
22 1.1 riz *
23 1.1 riz * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
24 1.1 riz * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
25 1.1 riz * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
26 1.1 riz * ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
27 1.1 riz * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
28 1.1 riz * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
29 1.1 riz * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
30 1.1 riz * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
31 1.1 riz * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
32 1.1 riz * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
33 1.1 riz * THE POSSIBILITY OF SUCH DAMAGE.
34 1.1 riz *
35 1.1 riz * $FreeBSD: /c/ncvs/src/sys/pci/if_sk.c,v 1.20 2000/04/22 02:16:37 wpaul Exp $
36 1.1 riz */
37 1.1 riz
38 1.1 riz /*
39 1.1 riz * Copyright (c) 2003 Nathan L. Binkert <binkertn (at) umich.edu>
40 1.1 riz *
41 1.1 riz * Permission to use, copy, modify, and distribute this software for any
42 1.1 riz * purpose with or without fee is hereby granted, provided that the above
43 1.1 riz * copyright notice and this permission notice appear in all copies.
44 1.1 riz *
45 1.1 riz * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
46 1.1 riz * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
47 1.1 riz * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
48 1.1 riz * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
49 1.1 riz * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
50 1.1 riz * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
51 1.1 riz * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
52 1.1 riz */
53 1.1 riz
54 1.10 dsl #include <sys/cdefs.h>
55 1.96 maxv __KERNEL_RCSID(0, "$NetBSD: if_msk.c,v 1.96 2019/12/01 12:47:10 maxv Exp $");
56 1.1 riz
57 1.1 riz #include <sys/param.h>
58 1.1 riz #include <sys/systm.h>
59 1.1 riz #include <sys/sockio.h>
60 1.1 riz #include <sys/mbuf.h>
61 1.1 riz #include <sys/malloc.h>
62 1.21 cube #include <sys/mutex.h>
63 1.1 riz #include <sys/kernel.h>
64 1.1 riz #include <sys/socket.h>
65 1.1 riz #include <sys/device.h>
66 1.1 riz #include <sys/queue.h>
67 1.1 riz #include <sys/callout.h>
68 1.1 riz #include <sys/sysctl.h>
69 1.1 riz #include <sys/endian.h>
70 1.1 riz #ifdef __NetBSD__
71 1.1 riz #define letoh16 htole16
72 1.1 riz #define letoh32 htole32
73 1.1 riz #endif
74 1.1 riz
75 1.1 riz #include <net/if.h>
76 1.1 riz #include <net/if_dl.h>
77 1.1 riz #include <net/if_types.h>
78 1.1 riz
79 1.1 riz #include <net/if_media.h>
80 1.1 riz
81 1.1 riz #include <net/bpf.h>
82 1.48 riastrad #include <sys/rndsource.h>
83 1.1 riz
84 1.1 riz #include <dev/mii/mii.h>
85 1.1 riz #include <dev/mii/miivar.h>
86 1.1 riz #include <dev/mii/brgphyreg.h>
87 1.1 riz
88 1.1 riz #include <dev/pci/pcireg.h>
89 1.1 riz #include <dev/pci/pcivar.h>
90 1.1 riz #include <dev/pci/pcidevs.h>
91 1.1 riz
92 1.1 riz #include <dev/pci/if_skreg.h>
93 1.1 riz #include <dev/pci/if_mskvar.h>
94 1.1 riz
95 1.95 maxv static int mskc_probe(device_t, cfdata_t, void *);
96 1.95 maxv static void mskc_attach(device_t, device_t, void *);
97 1.95 maxv static int mskc_detach(device_t, int);
98 1.95 maxv static void mskc_reset(struct sk_softc *);
99 1.33 dyoung static bool mskc_suspend(device_t, const pmf_qual_t *);
100 1.33 dyoung static bool mskc_resume(device_t, const pmf_qual_t *);
101 1.95 maxv static int msk_probe(device_t, cfdata_t, void *);
102 1.95 maxv static void msk_attach(device_t, device_t, void *);
103 1.95 maxv static int msk_detach(device_t, int);
104 1.95 maxv static void msk_reset(struct sk_if_softc *);
105 1.95 maxv static int mskcprint(void *, const char *);
106 1.95 maxv static int msk_intr(void *);
107 1.95 maxv static void msk_intr_yukon(struct sk_if_softc *);
108 1.95 maxv static void msk_rxeof(struct sk_if_softc *, uint16_t, uint32_t);
109 1.95 maxv static void msk_txeof(struct sk_if_softc *);
110 1.95 maxv static int msk_encap(struct sk_if_softc *, struct mbuf *, uint32_t *);
111 1.95 maxv static void msk_start(struct ifnet *);
112 1.95 maxv static int msk_ioctl(struct ifnet *, u_long, void *);
113 1.95 maxv static int msk_init(struct ifnet *);
114 1.95 maxv static void msk_init_yukon(struct sk_if_softc *);
115 1.95 maxv static void msk_stop(struct ifnet *, int);
116 1.95 maxv static void msk_watchdog(struct ifnet *);
117 1.95 maxv static int msk_newbuf(struct sk_if_softc *, bus_dmamap_t);
118 1.95 maxv static int msk_alloc_jumbo_mem(struct sk_if_softc *);
119 1.95 maxv static void *msk_jalloc(struct sk_if_softc *);
120 1.95 maxv static void msk_jfree(struct mbuf *, void *, size_t, void *);
121 1.95 maxv static int msk_init_rx_ring(struct sk_if_softc *);
122 1.95 maxv static int msk_init_tx_ring(struct sk_if_softc *);
123 1.95 maxv static void msk_fill_rx_ring(struct sk_if_softc *);
124 1.95 maxv
125 1.95 maxv static void msk_update_int_mod(struct sk_softc *, int);
126 1.95 maxv
127 1.95 maxv static int msk_miibus_readreg(device_t, int, int, uint16_t *);
128 1.95 maxv static int msk_miibus_writereg(device_t, int, int, uint16_t);
129 1.95 maxv static void msk_miibus_statchg(struct ifnet *);
130 1.95 maxv
131 1.95 maxv static void msk_setmulti(struct sk_if_softc *);
132 1.95 maxv static void msk_setpromisc(struct sk_if_softc *);
133 1.95 maxv static void msk_tick(void *);
134 1.72 jdolecek static void msk_fill_rx_tick(void *);
135 1.1 riz
136 1.1 riz /* #define MSK_DEBUG 1 */
137 1.1 riz #ifdef MSK_DEBUG
138 1.1 riz #define DPRINTF(x) if (mskdebug) printf x
139 1.88 msaitoh #define DPRINTFN(n, x) if (mskdebug >= (n)) printf x
140 1.1 riz int mskdebug = MSK_DEBUG;
141 1.1 riz
142 1.96 maxv static void msk_dump_txdesc(struct msk_tx_desc *, int);
143 1.96 maxv static void msk_dump_mbuf(struct mbuf *);
144 1.96 maxv static void msk_dump_bytes(const char *, int);
145 1.1 riz #else
146 1.1 riz #define DPRINTF(x)
147 1.88 msaitoh #define DPRINTFN(n, x)
148 1.1 riz #endif
149 1.1 riz
150 1.1 riz static int msk_sysctl_handler(SYSCTLFN_PROTO);
151 1.1 riz static int msk_root_num;
152 1.1 riz
153 1.89 msaitoh #define MSK_ADDR_LO(x) ((uint64_t) (x) & 0xffffffffUL)
154 1.89 msaitoh #define MSK_ADDR_HI(x) ((uint64_t) (x) >> 32)
155 1.78 jakllsch
156 1.1 riz /* supported device vendors */
157 1.1 riz static const struct msk_product {
158 1.89 msaitoh pci_vendor_id_t msk_vendor;
159 1.89 msaitoh pci_product_id_t msk_product;
160 1.1 riz } msk_products[] = {
161 1.5 msaitoh { PCI_VENDOR_DLINK, PCI_PRODUCT_DLINK_DGE550SX },
162 1.60 jdolecek { PCI_VENDOR_DLINK, PCI_PRODUCT_DLINK_DGE550T_B1 },
163 1.5 msaitoh { PCI_VENDOR_DLINK, PCI_PRODUCT_DLINK_DGE560SX },
164 1.5 msaitoh { PCI_VENDOR_DLINK, PCI_PRODUCT_DLINK_DGE560T },
165 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKONII_8021CU },
166 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKONII_8021X },
167 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKONII_8022CU },
168 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKONII_8022X },
169 1.1 riz { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8035 },
170 1.1 riz { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8036 },
171 1.1 riz { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8038 },
172 1.5 msaitoh { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8039 },
173 1.47 christos { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8040 },
174 1.60 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8040T },
175 1.60 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8042 },
176 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8048 },
177 1.5 msaitoh { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8050 },
178 1.1 riz { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8052 },
179 1.1 riz { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8053 },
180 1.5 msaitoh { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8055 },
181 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8055_2 },
182 1.5 msaitoh { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8056 },
183 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8057 },
184 1.55 christos { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8058 },
185 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8059 },
186 1.1 riz { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKONII_8061CU },
187 1.5 msaitoh { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKONII_8061X },
188 1.1 riz { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKONII_8062CU },
189 1.1 riz { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKONII_8062X },
190 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8070 },
191 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8071 },
192 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8072 },
193 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8075 },
194 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_8079 },
195 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_C032 },
196 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_C033 },
197 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_C034 },
198 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_C036 },
199 1.56 jdolecek { PCI_VENDOR_MARVELL, PCI_PRODUCT_MARVELL_YUKON_C042 },
200 1.1 riz { PCI_VENDOR_SCHNEIDERKOCH, PCI_PRODUCT_SCHNEIDERKOCH_SK_9SXX },
201 1.76 maxv { PCI_VENDOR_SCHNEIDERKOCH, PCI_PRODUCT_SCHNEIDERKOCH_SK_9E21 },
202 1.76 maxv { 0, 0 }
203 1.1 riz };
204 1.1 riz
205 1.83 msaitoh static inline uint32_t
206 1.83 msaitoh sk_win_read_4(struct sk_softc *sc, uint32_t reg)
207 1.1 riz {
208 1.1 riz return CSR_READ_4(sc, reg);
209 1.1 riz }
210 1.1 riz
211 1.83 msaitoh static inline uint16_t
212 1.83 msaitoh sk_win_read_2(struct sk_softc *sc, uint32_t reg)
213 1.1 riz {
214 1.1 riz return CSR_READ_2(sc, reg);
215 1.1 riz }
216 1.1 riz
217 1.83 msaitoh static inline uint8_t
218 1.83 msaitoh sk_win_read_1(struct sk_softc *sc, uint32_t reg)
219 1.1 riz {
220 1.1 riz return CSR_READ_1(sc, reg);
221 1.1 riz }
222 1.1 riz
223 1.1 riz static inline void
224 1.83 msaitoh sk_win_write_4(struct sk_softc *sc, uint32_t reg, uint32_t x)
225 1.1 riz {
226 1.1 riz CSR_WRITE_4(sc, reg, x);
227 1.1 riz }
228 1.1 riz
229 1.1 riz static inline void
230 1.83 msaitoh sk_win_write_2(struct sk_softc *sc, uint32_t reg, uint16_t x)
231 1.1 riz {
232 1.1 riz CSR_WRITE_2(sc, reg, x);
233 1.1 riz }
234 1.1 riz
235 1.1 riz static inline void
236 1.83 msaitoh sk_win_write_1(struct sk_softc *sc, uint32_t reg, uint8_t x)
237 1.1 riz {
238 1.1 riz CSR_WRITE_1(sc, reg, x);
239 1.1 riz }
240 1.1 riz
241 1.95 maxv static int
242 1.84 msaitoh msk_miibus_readreg(device_t dev, int phy, int reg, uint16_t *val)
243 1.1 riz {
244 1.27 cegger struct sk_if_softc *sc_if = device_private(dev);
245 1.84 msaitoh uint16_t data;
246 1.1 riz int i;
247 1.1 riz
248 1.59 jdolecek SK_YU_WRITE_2(sc_if, YUKON_SMICR, YU_SMICR_PHYAD(phy) |
249 1.1 riz YU_SMICR_REGAD(reg) | YU_SMICR_OP_READ);
250 1.65 msaitoh
251 1.1 riz for (i = 0; i < SK_TIMEOUT; i++) {
252 1.1 riz DELAY(1);
253 1.84 msaitoh data = SK_YU_READ_2(sc_if, YUKON_SMICR);
254 1.84 msaitoh if (data & YU_SMICR_READ_VALID)
255 1.1 riz break;
256 1.1 riz }
257 1.1 riz
258 1.1 riz if (i == SK_TIMEOUT) {
259 1.30 christos aprint_error_dev(sc_if->sk_dev, "phy failed to come ready\n");
260 1.84 msaitoh return ETIMEDOUT;
261 1.1 riz }
262 1.65 msaitoh
263 1.89 msaitoh DPRINTFN(9, ("msk_miibus_readreg: i=%d, timeout=%d\n", i, SK_TIMEOUT));
264 1.1 riz
265 1.84 msaitoh *val = SK_YU_READ_2(sc_if, YUKON_SMIDR);
266 1.1 riz
267 1.84 msaitoh DPRINTFN(9, ("msk_miibus_readreg phy=%d, reg=%#x, val=%#hx\n",
268 1.84 msaitoh phy, reg, *val));
269 1.1 riz
270 1.84 msaitoh return 0;
271 1.1 riz }
272 1.1 riz
273 1.95 maxv static int
274 1.84 msaitoh msk_miibus_writereg(device_t dev, int phy, int reg, uint16_t val)
275 1.1 riz {
276 1.27 cegger struct sk_if_softc *sc_if = device_private(dev);
277 1.1 riz int i;
278 1.1 riz
279 1.84 msaitoh DPRINTFN(9, ("msk_miibus_writereg phy=%d reg=%#x val=%#hx\n",
280 1.1 riz phy, reg, val));
281 1.1 riz
282 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_SMIDR, val);
283 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_SMICR, YU_SMICR_PHYAD(phy) |
284 1.1 riz YU_SMICR_REGAD(reg) | YU_SMICR_OP_WRITE);
285 1.1 riz
286 1.1 riz for (i = 0; i < SK_TIMEOUT; i++) {
287 1.1 riz DELAY(1);
288 1.4 msaitoh if (!(SK_YU_READ_2(sc_if, YUKON_SMICR) & YU_SMICR_BUSY))
289 1.1 riz break;
290 1.1 riz }
291 1.1 riz
292 1.84 msaitoh if (i == SK_TIMEOUT) {
293 1.30 christos aprint_error_dev(sc_if->sk_dev, "phy write timed out\n");
294 1.84 msaitoh return ETIMEDOUT;
295 1.84 msaitoh }
296 1.84 msaitoh
297 1.84 msaitoh return 0;
298 1.1 riz }
299 1.1 riz
300 1.95 maxv static void
301 1.41 matt msk_miibus_statchg(struct ifnet *ifp)
302 1.1 riz {
303 1.41 matt struct sk_if_softc *sc_if = ifp->if_softc;
304 1.5 msaitoh struct mii_data *mii = &sc_if->sk_mii;
305 1.5 msaitoh struct ifmedia_entry *ife = mii->mii_media.ifm_cur;
306 1.5 msaitoh int gpcr;
307 1.5 msaitoh
308 1.5 msaitoh gpcr = SK_YU_READ_2(sc_if, YUKON_GPCR);
309 1.5 msaitoh gpcr &= (YU_GPCR_TXEN | YU_GPCR_RXEN);
310 1.5 msaitoh
311 1.60 jdolecek if (IFM_SUBTYPE(ife->ifm_media) != IFM_AUTO ||
312 1.60 jdolecek sc_if->sk_softc->sk_type == SK_YUKON_FE_P) {
313 1.5 msaitoh /* Set speed. */
314 1.5 msaitoh gpcr |= YU_GPCR_SPEED_DIS;
315 1.5 msaitoh switch (IFM_SUBTYPE(mii->mii_media_active)) {
316 1.5 msaitoh case IFM_1000_SX:
317 1.5 msaitoh case IFM_1000_LX:
318 1.5 msaitoh case IFM_1000_CX:
319 1.5 msaitoh case IFM_1000_T:
320 1.5 msaitoh gpcr |= (YU_GPCR_GIG | YU_GPCR_SPEED);
321 1.5 msaitoh break;
322 1.5 msaitoh case IFM_100_TX:
323 1.5 msaitoh gpcr |= YU_GPCR_SPEED;
324 1.5 msaitoh break;
325 1.5 msaitoh }
326 1.5 msaitoh
327 1.5 msaitoh /* Set duplex. */
328 1.5 msaitoh gpcr |= YU_GPCR_DPLX_DIS;
329 1.87 msaitoh if ((mii->mii_media_active & IFM_FDX) != 0)
330 1.5 msaitoh gpcr |= YU_GPCR_DUPLEX;
331 1.5 msaitoh
332 1.5 msaitoh /* Disable flow control. */
333 1.5 msaitoh gpcr |= YU_GPCR_FCTL_DIS;
334 1.5 msaitoh gpcr |= (YU_GPCR_FCTL_TX_DIS | YU_GPCR_FCTL_RX_DIS);
335 1.5 msaitoh }
336 1.5 msaitoh
337 1.5 msaitoh SK_YU_WRITE_2(sc_if, YUKON_GPCR, gpcr);
338 1.5 msaitoh
339 1.5 msaitoh DPRINTFN(9, ("msk_miibus_statchg: gpcr=%x\n",
340 1.41 matt SK_YU_READ_2(sc_if, YUKON_GPCR)));
341 1.1 riz }
342 1.1 riz
343 1.95 maxv static void
344 1.1 riz msk_setmulti(struct sk_if_softc *sc_if)
345 1.1 riz {
346 1.1 riz struct ifnet *ifp= &sc_if->sk_ethercom.ec_if;
347 1.83 msaitoh uint32_t hashes[2] = { 0, 0 };
348 1.1 riz int h;
349 1.1 riz struct ethercom *ec = &sc_if->sk_ethercom;
350 1.1 riz struct ether_multi *enm;
351 1.1 riz struct ether_multistep step;
352 1.83 msaitoh uint16_t reg;
353 1.1 riz
354 1.1 riz /* First, zot all the existing filters. */
355 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_MCAH1, 0);
356 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_MCAH2, 0);
357 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_MCAH3, 0);
358 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_MCAH4, 0);
359 1.1 riz
360 1.1 riz
361 1.1 riz /* Now program new ones. */
362 1.6 msaitoh reg = SK_YU_READ_2(sc_if, YUKON_RCR);
363 1.6 msaitoh reg |= YU_RCR_UFLEN;
364 1.1 riz allmulti:
365 1.1 riz if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) {
366 1.6 msaitoh if ((ifp->if_flags & IFF_PROMISC) != 0)
367 1.6 msaitoh reg &= ~(YU_RCR_UFLEN | YU_RCR_MUFLEN);
368 1.6 msaitoh else if ((ifp->if_flags & IFF_ALLMULTI) != 0) {
369 1.6 msaitoh hashes[0] = 0xFFFFFFFF;
370 1.6 msaitoh hashes[1] = 0xFFFFFFFF;
371 1.6 msaitoh }
372 1.1 riz } else {
373 1.1 riz /* First find the tail of the list. */
374 1.90 msaitoh ETHER_LOCK(ec);
375 1.1 riz ETHER_FIRST_MULTI(step, ec, enm);
376 1.1 riz while (enm != NULL) {
377 1.23 cegger if (memcmp(enm->enm_addrlo, enm->enm_addrhi,
378 1.1 riz ETHER_ADDR_LEN)) {
379 1.1 riz ifp->if_flags |= IFF_ALLMULTI;
380 1.90 msaitoh ETHER_UNLOCK(ec);
381 1.1 riz goto allmulti;
382 1.1 riz }
383 1.5 msaitoh h = ether_crc32_be(enm->enm_addrlo, ETHER_ADDR_LEN) &
384 1.61 jdolecek ((1 << SK_HASH_BITS) - 1);
385 1.1 riz if (h < 32)
386 1.1 riz hashes[0] |= (1 << h);
387 1.1 riz else
388 1.1 riz hashes[1] |= (1 << (h - 32));
389 1.1 riz
390 1.1 riz ETHER_NEXT_MULTI(step, enm);
391 1.1 riz }
392 1.90 msaitoh ETHER_UNLOCK(ec);
393 1.6 msaitoh reg |= YU_RCR_MUFLEN;
394 1.1 riz }
395 1.1 riz
396 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_MCAH1, hashes[0] & 0xffff);
397 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_MCAH2, (hashes[0] >> 16) & 0xffff);
398 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_MCAH3, hashes[1] & 0xffff);
399 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_MCAH4, (hashes[1] >> 16) & 0xffff);
400 1.6 msaitoh SK_YU_WRITE_2(sc_if, YUKON_RCR, reg);
401 1.1 riz }
402 1.1 riz
403 1.95 maxv static void
404 1.1 riz msk_setpromisc(struct sk_if_softc *sc_if)
405 1.1 riz {
406 1.1 riz struct ifnet *ifp = &sc_if->sk_ethercom.ec_if;
407 1.1 riz
408 1.1 riz if (ifp->if_flags & IFF_PROMISC)
409 1.1 riz SK_YU_CLRBIT_2(sc_if, YUKON_RCR,
410 1.1 riz YU_RCR_UFLEN | YU_RCR_MUFLEN);
411 1.1 riz else
412 1.1 riz SK_YU_SETBIT_2(sc_if, YUKON_RCR,
413 1.1 riz YU_RCR_UFLEN | YU_RCR_MUFLEN);
414 1.1 riz }
415 1.1 riz
416 1.95 maxv static int
417 1.1 riz msk_init_rx_ring(struct sk_if_softc *sc_if)
418 1.1 riz {
419 1.1 riz struct msk_chain_data *cd = &sc_if->sk_cdata;
420 1.1 riz struct msk_ring_data *rd = sc_if->sk_rdata;
421 1.78 jakllsch struct msk_rx_desc *r;
422 1.1 riz int i, nexti;
423 1.1 riz
424 1.30 christos memset(rd->sk_rx_ring, 0, sizeof(struct msk_rx_desc) * MSK_RX_RING_CNT);
425 1.1 riz
426 1.1 riz for (i = 0; i < MSK_RX_RING_CNT; i++) {
427 1.1 riz cd->sk_rx_chain[i].sk_le = &rd->sk_rx_ring[i];
428 1.1 riz if (i == (MSK_RX_RING_CNT - 1))
429 1.1 riz nexti = 0;
430 1.1 riz else
431 1.1 riz nexti = i + 1;
432 1.1 riz cd->sk_rx_chain[i].sk_next = &cd->sk_rx_chain[nexti];
433 1.1 riz }
434 1.1 riz
435 1.68 jdolecek sc_if->sk_cdata.sk_rx_prod = 0;
436 1.1 riz sc_if->sk_cdata.sk_rx_cons = 0;
437 1.68 jdolecek sc_if->sk_cdata.sk_rx_cnt = 0;
438 1.82 mrg sc_if->sk_cdata.sk_rx_hiaddr = 0;
439 1.1 riz
440 1.78 jakllsch /* Mark the first ring element to initialize the high address. */
441 1.78 jakllsch sc_if->sk_cdata.sk_rx_hiaddr = 0;
442 1.78 jakllsch r = &rd->sk_rx_ring[cd->sk_rx_prod];
443 1.78 jakllsch r->sk_addr = htole32(cd->sk_rx_hiaddr);
444 1.78 jakllsch r->sk_len = 0;
445 1.78 jakllsch r->sk_ctl = 0;
446 1.78 jakllsch r->sk_opcode = SK_Y2_BMUOPC_ADDR64 | SK_Y2_RXOPC_OWN;
447 1.78 jakllsch MSK_CDRXSYNC(sc_if, cd->sk_rx_prod,
448 1.88 msaitoh BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
449 1.78 jakllsch SK_INC(sc_if->sk_cdata.sk_rx_prod, MSK_RX_RING_CNT);
450 1.78 jakllsch sc_if->sk_cdata.sk_rx_cnt++;
451 1.78 jakllsch
452 1.68 jdolecek msk_fill_rx_ring(sc_if);
453 1.88 msaitoh return 0;
454 1.1 riz }
455 1.1 riz
456 1.95 maxv static int
457 1.1 riz msk_init_tx_ring(struct sk_if_softc *sc_if)
458 1.1 riz {
459 1.1 riz struct sk_softc *sc = sc_if->sk_softc;
460 1.1 riz struct msk_chain_data *cd = &sc_if->sk_cdata;
461 1.1 riz struct msk_ring_data *rd = sc_if->sk_rdata;
462 1.78 jakllsch struct msk_tx_desc *t;
463 1.1 riz bus_dmamap_t dmamap;
464 1.1 riz struct sk_txmap_entry *entry;
465 1.1 riz int i, nexti;
466 1.1 riz
467 1.66 msaitoh memset(rd->sk_tx_ring, 0, sizeof(struct msk_tx_desc) * MSK_TX_RING_CNT);
468 1.1 riz
469 1.1 riz SIMPLEQ_INIT(&sc_if->sk_txmap_head);
470 1.1 riz for (i = 0; i < MSK_TX_RING_CNT; i++) {
471 1.1 riz cd->sk_tx_chain[i].sk_le = &rd->sk_tx_ring[i];
472 1.1 riz if (i == (MSK_TX_RING_CNT - 1))
473 1.1 riz nexti = 0;
474 1.1 riz else
475 1.1 riz nexti = i + 1;
476 1.1 riz cd->sk_tx_chain[i].sk_next = &cd->sk_tx_chain[nexti];
477 1.1 riz
478 1.1 riz if (bus_dmamap_create(sc->sc_dmatag, SK_JLEN, SK_NTXSEG,
479 1.1 riz SK_JLEN, 0, BUS_DMA_NOWAIT, &dmamap))
480 1.88 msaitoh return ENOBUFS;
481 1.1 riz
482 1.1 riz entry = malloc(sizeof(*entry), M_DEVBUF, M_NOWAIT);
483 1.1 riz if (!entry) {
484 1.1 riz bus_dmamap_destroy(sc->sc_dmatag, dmamap);
485 1.88 msaitoh return ENOBUFS;
486 1.1 riz }
487 1.1 riz entry->dmamap = dmamap;
488 1.1 riz SIMPLEQ_INSERT_HEAD(&sc_if->sk_txmap_head, entry, link);
489 1.1 riz }
490 1.1 riz
491 1.1 riz sc_if->sk_cdata.sk_tx_prod = 0;
492 1.1 riz sc_if->sk_cdata.sk_tx_cons = 0;
493 1.1 riz sc_if->sk_cdata.sk_tx_cnt = 0;
494 1.82 mrg sc_if->sk_cdata.sk_tx_hiaddr = 0;
495 1.1 riz
496 1.78 jakllsch /* Mark the first ring element to initialize the high address. */
497 1.78 jakllsch sc_if->sk_cdata.sk_tx_hiaddr = 0;
498 1.78 jakllsch t = &rd->sk_tx_ring[cd->sk_tx_prod];
499 1.78 jakllsch t->sk_addr = htole32(cd->sk_tx_hiaddr);
500 1.78 jakllsch t->sk_len = 0;
501 1.78 jakllsch t->sk_ctl = 0;
502 1.78 jakllsch t->sk_opcode = SK_Y2_BMUOPC_ADDR64 | SK_Y2_TXOPC_OWN;
503 1.1 riz MSK_CDTXSYNC(sc_if, 0, MSK_TX_RING_CNT,
504 1.88 msaitoh BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
505 1.78 jakllsch SK_INC(sc_if->sk_cdata.sk_tx_prod, MSK_TX_RING_CNT);
506 1.78 jakllsch sc_if->sk_cdata.sk_tx_cnt++;
507 1.1 riz
508 1.88 msaitoh return 0;
509 1.1 riz }
510 1.1 riz
511 1.95 maxv static int
512 1.72 jdolecek msk_newbuf(struct sk_if_softc *sc_if, bus_dmamap_t dmamap)
513 1.1 riz {
514 1.1 riz struct mbuf *m_new = NULL;
515 1.1 riz struct sk_chain *c;
516 1.1 riz struct msk_rx_desc *r;
517 1.78 jakllsch void *buf = NULL;
518 1.78 jakllsch bus_addr_t addr;
519 1.1 riz
520 1.72 jdolecek MGETHDR(m_new, M_DONTWAIT, MT_DATA);
521 1.72 jdolecek if (m_new == NULL)
522 1.88 msaitoh return ENOBUFS;
523 1.1 riz
524 1.72 jdolecek /* Allocate the jumbo buffer */
525 1.72 jdolecek buf = msk_jalloc(sc_if);
526 1.72 jdolecek if (buf == NULL) {
527 1.72 jdolecek m_freem(m_new);
528 1.72 jdolecek DPRINTFN(1, ("%s jumbo allocation failed -- packet "
529 1.72 jdolecek "dropped!\n", sc_if->sk_ethercom.ec_if.if_xname));
530 1.88 msaitoh return ENOBUFS;
531 1.72 jdolecek }
532 1.65 msaitoh
533 1.72 jdolecek /* Attach the buffer to the mbuf */
534 1.72 jdolecek m_new->m_len = m_new->m_pkthdr.len = SK_JLEN;
535 1.72 jdolecek MEXTADD(m_new, buf, SK_JLEN, 0, msk_jfree, sc_if);
536 1.1 riz
537 1.1 riz m_adj(m_new, ETHER_ALIGN);
538 1.1 riz
539 1.78 jakllsch addr = dmamap->dm_segs[0].ds_addr +
540 1.78 jakllsch ((vaddr_t)m_new->m_data -
541 1.78 jakllsch (vaddr_t)sc_if->sk_cdata.sk_jumbo_buf);
542 1.78 jakllsch
543 1.78 jakllsch if (sc_if->sk_cdata.sk_rx_hiaddr != MSK_ADDR_HI(addr)) {
544 1.78 jakllsch c = &sc_if->sk_cdata.sk_rx_chain[sc_if->sk_cdata.sk_rx_prod];
545 1.78 jakllsch r = c->sk_le;
546 1.78 jakllsch c->sk_mbuf = NULL;
547 1.78 jakllsch r->sk_addr = htole32(MSK_ADDR_HI(addr));
548 1.78 jakllsch r->sk_len = 0;
549 1.78 jakllsch r->sk_ctl = 0;
550 1.78 jakllsch r->sk_opcode = SK_Y2_BMUOPC_ADDR64 | SK_Y2_RXOPC_OWN;
551 1.78 jakllsch sc_if->sk_cdata.sk_rx_hiaddr = MSK_ADDR_HI(addr);
552 1.78 jakllsch
553 1.78 jakllsch MSK_CDRXSYNC(sc_if, sc_if->sk_cdata.sk_rx_prod,
554 1.88 msaitoh BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
555 1.78 jakllsch
556 1.78 jakllsch SK_INC(sc_if->sk_cdata.sk_rx_prod, MSK_RX_RING_CNT);
557 1.78 jakllsch sc_if->sk_cdata.sk_rx_cnt++;
558 1.78 jakllsch
559 1.78 jakllsch DPRINTFN(10, ("%s: rx ADDR64: %#x\n",
560 1.83 msaitoh sc_if->sk_ethercom.ec_if.if_xname,
561 1.83 msaitoh (unsigned)MSK_ADDR_HI(addr)));
562 1.78 jakllsch }
563 1.78 jakllsch
564 1.68 jdolecek c = &sc_if->sk_cdata.sk_rx_chain[sc_if->sk_cdata.sk_rx_prod];
565 1.1 riz r = c->sk_le;
566 1.1 riz c->sk_mbuf = m_new;
567 1.78 jakllsch r->sk_addr = htole32(MSK_ADDR_LO(addr));
568 1.1 riz r->sk_len = htole16(SK_JLEN);
569 1.1 riz r->sk_ctl = 0;
570 1.1 riz r->sk_opcode = SK_Y2_RXOPC_PACKET | SK_Y2_RXOPC_OWN;
571 1.1 riz
572 1.68 jdolecek MSK_CDRXSYNC(sc_if, sc_if->sk_cdata.sk_rx_prod,
573 1.88 msaitoh BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
574 1.68 jdolecek
575 1.68 jdolecek SK_INC(sc_if->sk_cdata.sk_rx_prod, MSK_RX_RING_CNT);
576 1.68 jdolecek sc_if->sk_cdata.sk_rx_cnt++;
577 1.1 riz
578 1.88 msaitoh return 0;
579 1.1 riz }
580 1.1 riz
581 1.1 riz /*
582 1.1 riz * Memory management for jumbo frames.
583 1.1 riz */
584 1.1 riz
585 1.95 maxv static int
586 1.1 riz msk_alloc_jumbo_mem(struct sk_if_softc *sc_if)
587 1.1 riz {
588 1.1 riz struct sk_softc *sc = sc_if->sk_softc;
589 1.8 christos char *ptr, *kva;
590 1.70 jdolecek int i, state, error;
591 1.89 msaitoh struct sk_jpool_entry *entry;
592 1.1 riz
593 1.1 riz state = error = 0;
594 1.1 riz
595 1.1 riz /* Grab a big chunk o' storage. */
596 1.1 riz if (bus_dmamem_alloc(sc->sc_dmatag, MSK_JMEM, PAGE_SIZE, 0,
597 1.70 jdolecek &sc_if->sk_cdata.sk_jumbo_seg, 1, &sc_if->sk_cdata.sk_jumbo_nseg,
598 1.70 jdolecek BUS_DMA_NOWAIT)) {
599 1.1 riz aprint_error(": can't alloc rx buffers");
600 1.88 msaitoh return ENOBUFS;
601 1.1 riz }
602 1.1 riz
603 1.1 riz state = 1;
604 1.70 jdolecek if (bus_dmamem_map(sc->sc_dmatag, &sc_if->sk_cdata.sk_jumbo_seg,
605 1.70 jdolecek sc_if->sk_cdata.sk_jumbo_nseg, MSK_JMEM, (void **)&kva,
606 1.70 jdolecek BUS_DMA_NOWAIT)) {
607 1.1 riz aprint_error(": can't map dma buffers (%d bytes)", MSK_JMEM);
608 1.1 riz error = ENOBUFS;
609 1.1 riz goto out;
610 1.1 riz }
611 1.1 riz
612 1.1 riz state = 2;
613 1.1 riz if (bus_dmamap_create(sc->sc_dmatag, MSK_JMEM, 1, MSK_JMEM, 0,
614 1.1 riz BUS_DMA_NOWAIT, &sc_if->sk_cdata.sk_rx_jumbo_map)) {
615 1.1 riz aprint_error(": can't create dma map");
616 1.1 riz error = ENOBUFS;
617 1.1 riz goto out;
618 1.1 riz }
619 1.1 riz
620 1.1 riz state = 3;
621 1.1 riz if (bus_dmamap_load(sc->sc_dmatag, sc_if->sk_cdata.sk_rx_jumbo_map,
622 1.1 riz kva, MSK_JMEM, NULL, BUS_DMA_NOWAIT)) {
623 1.1 riz aprint_error(": can't load dma map");
624 1.1 riz error = ENOBUFS;
625 1.1 riz goto out;
626 1.1 riz }
627 1.1 riz
628 1.1 riz state = 4;
629 1.8 christos sc_if->sk_cdata.sk_jumbo_buf = (void *)kva;
630 1.83 msaitoh DPRINTFN(1,("msk_jumbo_buf = %p\n",
631 1.83 msaitoh (void *)sc_if->sk_cdata.sk_jumbo_buf));
632 1.1 riz
633 1.1 riz LIST_INIT(&sc_if->sk_jfree_listhead);
634 1.1 riz LIST_INIT(&sc_if->sk_jinuse_listhead);
635 1.21 cube mutex_init(&sc_if->sk_jpool_mtx, MUTEX_DEFAULT, IPL_NET);
636 1.1 riz
637 1.1 riz /*
638 1.1 riz * Now divide it up into 9K pieces and save the addresses
639 1.1 riz * in an array.
640 1.1 riz */
641 1.1 riz ptr = sc_if->sk_cdata.sk_jumbo_buf;
642 1.1 riz for (i = 0; i < MSK_JSLOTS; i++) {
643 1.1 riz sc_if->sk_cdata.sk_jslots[i] = ptr;
644 1.1 riz ptr += SK_JLEN;
645 1.1 riz entry = malloc(sizeof(struct sk_jpool_entry),
646 1.93 chs M_DEVBUF, M_WAITOK);
647 1.1 riz entry->slot = i;
648 1.5 msaitoh LIST_INSERT_HEAD(&sc_if->sk_jfree_listhead,
649 1.1 riz entry, jpool_entries);
650 1.1 riz }
651 1.1 riz out:
652 1.1 riz if (error != 0) {
653 1.1 riz switch (state) {
654 1.1 riz case 4:
655 1.1 riz bus_dmamap_unload(sc->sc_dmatag,
656 1.1 riz sc_if->sk_cdata.sk_rx_jumbo_map);
657 1.86 mrg /* FALLTHROUGH */
658 1.1 riz case 3:
659 1.1 riz bus_dmamap_destroy(sc->sc_dmatag,
660 1.1 riz sc_if->sk_cdata.sk_rx_jumbo_map);
661 1.86 mrg /* FALLTHROUGH */
662 1.1 riz case 2:
663 1.1 riz bus_dmamem_unmap(sc->sc_dmatag, kva, MSK_JMEM);
664 1.86 mrg /* FALLTHROUGH */
665 1.1 riz case 1:
666 1.70 jdolecek bus_dmamem_free(sc->sc_dmatag,
667 1.70 jdolecek &sc_if->sk_cdata.sk_jumbo_seg,
668 1.70 jdolecek sc_if->sk_cdata.sk_jumbo_nseg);
669 1.1 riz break;
670 1.1 riz default:
671 1.1 riz break;
672 1.1 riz }
673 1.1 riz }
674 1.1 riz
675 1.52 christos return error;
676 1.1 riz }
677 1.1 riz
678 1.70 jdolecek static void
679 1.70 jdolecek msk_free_jumbo_mem(struct sk_if_softc *sc_if)
680 1.70 jdolecek {
681 1.70 jdolecek struct sk_softc *sc = sc_if->sk_softc;
682 1.70 jdolecek
683 1.70 jdolecek bus_dmamap_unload(sc->sc_dmatag, sc_if->sk_cdata.sk_rx_jumbo_map);
684 1.70 jdolecek bus_dmamap_destroy(sc->sc_dmatag, sc_if->sk_cdata.sk_rx_jumbo_map);
685 1.70 jdolecek bus_dmamem_unmap(sc->sc_dmatag, sc_if->sk_cdata.sk_jumbo_buf, MSK_JMEM);
686 1.70 jdolecek bus_dmamem_free(sc->sc_dmatag, &sc_if->sk_cdata.sk_jumbo_seg,
687 1.70 jdolecek sc_if->sk_cdata.sk_jumbo_nseg);
688 1.70 jdolecek }
689 1.70 jdolecek
690 1.1 riz /*
691 1.1 riz * Allocate a jumbo buffer.
692 1.1 riz */
693 1.95 maxv static void *
694 1.1 riz msk_jalloc(struct sk_if_softc *sc_if)
695 1.1 riz {
696 1.89 msaitoh struct sk_jpool_entry *entry;
697 1.1 riz
698 1.21 cube mutex_enter(&sc_if->sk_jpool_mtx);
699 1.1 riz entry = LIST_FIRST(&sc_if->sk_jfree_listhead);
700 1.1 riz
701 1.21 cube if (entry == NULL) {
702 1.21 cube mutex_exit(&sc_if->sk_jpool_mtx);
703 1.21 cube return NULL;
704 1.21 cube }
705 1.1 riz
706 1.1 riz LIST_REMOVE(entry, jpool_entries);
707 1.1 riz LIST_INSERT_HEAD(&sc_if->sk_jinuse_listhead, entry, jpool_entries);
708 1.21 cube mutex_exit(&sc_if->sk_jpool_mtx);
709 1.88 msaitoh return sc_if->sk_cdata.sk_jslots[entry->slot];
710 1.1 riz }
711 1.1 riz
712 1.1 riz /*
713 1.1 riz * Release a jumbo buffer.
714 1.1 riz */
715 1.95 maxv static void
716 1.8 christos msk_jfree(struct mbuf *m, void *buf, size_t size, void *arg)
717 1.1 riz {
718 1.1 riz struct sk_jpool_entry *entry;
719 1.1 riz struct sk_if_softc *sc;
720 1.21 cube int i;
721 1.1 riz
722 1.1 riz /* Extract the softc struct pointer. */
723 1.1 riz sc = (struct sk_if_softc *)arg;
724 1.1 riz
725 1.1 riz if (sc == NULL)
726 1.1 riz panic("msk_jfree: can't find softc pointer!");
727 1.1 riz
728 1.1 riz /* calculate the slot this buffer belongs to */
729 1.1 riz i = ((vaddr_t)buf
730 1.1 riz - (vaddr_t)sc->sk_cdata.sk_jumbo_buf) / SK_JLEN;
731 1.1 riz
732 1.1 riz if ((i < 0) || (i >= MSK_JSLOTS))
733 1.6 msaitoh panic("msk_jfree: asked to free buffer that we don't manage!");
734 1.1 riz
735 1.21 cube mutex_enter(&sc->sk_jpool_mtx);
736 1.1 riz entry = LIST_FIRST(&sc->sk_jinuse_listhead);
737 1.1 riz if (entry == NULL)
738 1.1 riz panic("msk_jfree: buffer not in use!");
739 1.1 riz entry->slot = i;
740 1.1 riz LIST_REMOVE(entry, jpool_entries);
741 1.1 riz LIST_INSERT_HEAD(&sc->sk_jfree_listhead, entry, jpool_entries);
742 1.21 cube mutex_exit(&sc->sk_jpool_mtx);
743 1.1 riz
744 1.1 riz if (__predict_true(m != NULL))
745 1.12 ad pool_cache_put(mb_cache, m);
746 1.72 jdolecek
747 1.72 jdolecek /* Now that we know we have a free RX buffer, refill if running out */
748 1.72 jdolecek if ((sc->sk_ethercom.ec_if.if_flags & IFF_RUNNING) != 0
749 1.72 jdolecek && sc->sk_cdata.sk_rx_cnt < (MSK_RX_RING_CNT/3))
750 1.72 jdolecek callout_schedule(&sc->sk_tick_rx, 0);
751 1.1 riz }
752 1.1 riz
753 1.95 maxv static int
754 1.19 dyoung msk_ioctl(struct ifnet *ifp, u_long cmd, void *data)
755 1.1 riz {
756 1.52 christos struct sk_if_softc *sc = ifp->if_softc;
757 1.52 christos int s, error;
758 1.1 riz
759 1.1 riz s = splnet();
760 1.1 riz
761 1.78 jakllsch DPRINTFN(2, ("msk_ioctl ETHER cmd %lx\n", cmd));
762 1.52 christos switch (cmd) {
763 1.52 christos case SIOCSIFFLAGS:
764 1.52 christos if ((error = ifioctl_common(ifp, cmd, data)) != 0)
765 1.52 christos break;
766 1.1 riz
767 1.52 christos switch (ifp->if_flags & (IFF_UP | IFF_RUNNING)) {
768 1.52 christos case IFF_RUNNING:
769 1.52 christos msk_stop(ifp, 1);
770 1.52 christos break;
771 1.52 christos case IFF_UP:
772 1.52 christos msk_init(ifp);
773 1.52 christos break;
774 1.52 christos case IFF_UP | IFF_RUNNING:
775 1.52 christos if ((ifp->if_flags ^ sc->sk_if_flags) == IFF_PROMISC) {
776 1.52 christos msk_setpromisc(sc);
777 1.52 christos msk_setmulti(sc);
778 1.52 christos } else
779 1.52 christos msk_init(ifp);
780 1.52 christos break;
781 1.1 riz }
782 1.52 christos sc->sk_if_flags = ifp->if_flags;
783 1.52 christos break;
784 1.52 christos default:
785 1.52 christos error = ether_ioctl(ifp, cmd, data);
786 1.52 christos if (error == ENETRESET) {
787 1.52 christos error = 0;
788 1.52 christos if (cmd != SIOCADDMULTI && cmd != SIOCDELMULTI)
789 1.52 christos ;
790 1.52 christos else if (ifp->if_flags & IFF_RUNNING) {
791 1.52 christos /*
792 1.52 christos * Multicast list has changed; set the hardware
793 1.52 christos * filter accordingly.
794 1.52 christos */
795 1.52 christos msk_setmulti(sc);
796 1.52 christos }
797 1.52 christos }
798 1.52 christos break;
799 1.1 riz }
800 1.1 riz
801 1.1 riz splx(s);
802 1.52 christos return error;
803 1.1 riz }
804 1.1 riz
805 1.95 maxv static void
806 1.30 christos msk_update_int_mod(struct sk_softc *sc, int verbose)
807 1.1 riz {
808 1.83 msaitoh uint32_t imtimer_ticks;
809 1.1 riz
810 1.1 riz /*
811 1.1 riz * Configure interrupt moderation. The moderation timer
812 1.1 riz * defers interrupts specified in the interrupt moderation
813 1.1 riz * timer mask based on the timeout specified in the interrupt
814 1.1 riz * moderation timer init register. Each bit in the timer
815 1.1 riz * register represents one tick, so to specify a timeout in
816 1.1 riz * microseconds, we have to multiply by the correct number of
817 1.1 riz * ticks-per-microsecond.
818 1.1 riz */
819 1.1 riz switch (sc->sk_type) {
820 1.1 riz case SK_YUKON_EC:
821 1.6 msaitoh case SK_YUKON_EC_U:
822 1.56 jdolecek case SK_YUKON_EX:
823 1.56 jdolecek case SK_YUKON_SUPR:
824 1.56 jdolecek case SK_YUKON_ULTRA2:
825 1.56 jdolecek case SK_YUKON_OPTIMA:
826 1.56 jdolecek case SK_YUKON_PRM:
827 1.56 jdolecek case SK_YUKON_OPTIMA2:
828 1.5 msaitoh imtimer_ticks = SK_IMTIMER_TICKS_YUKON_EC;
829 1.1 riz break;
830 1.6 msaitoh case SK_YUKON_FE:
831 1.6 msaitoh imtimer_ticks = SK_IMTIMER_TICKS_YUKON_FE;
832 1.6 msaitoh break;
833 1.68 jdolecek case SK_YUKON_FE_P:
834 1.68 jdolecek imtimer_ticks = SK_IMTIMER_TICKS_YUKON_FE_P;
835 1.68 jdolecek break;
836 1.6 msaitoh case SK_YUKON_XL:
837 1.6 msaitoh imtimer_ticks = SK_IMTIMER_TICKS_YUKON_XL;
838 1.6 msaitoh break;
839 1.1 riz default:
840 1.5 msaitoh imtimer_ticks = SK_IMTIMER_TICKS_YUKON;
841 1.1 riz }
842 1.30 christos if (verbose)
843 1.30 christos aprint_verbose_dev(sc->sk_dev,
844 1.30 christos "interrupt moderation is %d us\n", sc->sk_int_mod);
845 1.59 jdolecek sk_win_write_4(sc, SK_IMTIMERINIT, SK_IM_USECS(sc->sk_int_mod));
846 1.88 msaitoh sk_win_write_4(sc, SK_IMMR, SK_ISR_TX1_S_EOF | SK_ISR_TX2_S_EOF |
847 1.88 msaitoh SK_ISR_RX1_EOF | SK_ISR_RX2_EOF);
848 1.59 jdolecek sk_win_write_1(sc, SK_IMTIMERCTL, SK_IMCTL_START);
849 1.1 riz sc->sk_int_mod_pending = 0;
850 1.1 riz }
851 1.1 riz
852 1.1 riz static int
853 1.1 riz msk_lookup(const struct pci_attach_args *pa)
854 1.1 riz {
855 1.1 riz const struct msk_product *pmsk;
856 1.1 riz
857 1.1 riz for ( pmsk = &msk_products[0]; pmsk->msk_vendor != 0; pmsk++) {
858 1.1 riz if (PCI_VENDOR(pa->pa_id) == pmsk->msk_vendor &&
859 1.1 riz PCI_PRODUCT(pa->pa_id) == pmsk->msk_product)
860 1.1 riz return 1;
861 1.1 riz }
862 1.1 riz return 0;
863 1.1 riz }
864 1.1 riz
865 1.1 riz /*
866 1.1 riz * Probe for a SysKonnect GEnesis chip. Check the PCI vendor and device
867 1.1 riz * IDs against our list and return a device name if we find a match.
868 1.1 riz */
869 1.95 maxv static int
870 1.26 cegger mskc_probe(device_t parent, cfdata_t match, void *aux)
871 1.1 riz {
872 1.1 riz struct pci_attach_args *pa = (struct pci_attach_args *)aux;
873 1.1 riz
874 1.1 riz return msk_lookup(pa);
875 1.1 riz }
876 1.1 riz
877 1.1 riz /*
878 1.1 riz * Force the GEnesis into reset, then bring it out of reset.
879 1.1 riz */
880 1.95 maxv static void
881 1.63 jdolecek mskc_reset(struct sk_softc *sc)
882 1.1 riz {
883 1.83 msaitoh uint32_t imtimer_ticks, reg1;
884 1.94 msaitoh uint16_t status;
885 1.1 riz int reg;
886 1.1 riz
887 1.63 jdolecek DPRINTFN(2, ("mskc_reset\n"));
888 1.1 riz
889 1.94 msaitoh /* Disable ASF */
890 1.94 msaitoh if ((sc->sk_type == SK_YUKON_EX) || (sc->sk_type == SK_YUKON_SUPR)) {
891 1.94 msaitoh CSR_WRITE_4(sc, SK_Y2_CPU_WDOG, 0);
892 1.94 msaitoh status = CSR_READ_2(sc, SK_Y2_ASF_HCU_CCSR);
893 1.94 msaitoh /* Clear AHB bridge & microcontroller reset. */
894 1.94 msaitoh status &= ~(SK_Y2_ASF_HCU_CSSR_ARB_RST |
895 1.94 msaitoh SK_Y2_ASF_HCU_CSSR_CPU_RST_MODE);
896 1.94 msaitoh /* Clear ASF microcontroller state. */
897 1.94 msaitoh status &= ~SK_Y2_ASF_HCU_CSSR_UC_STATE_MSK;
898 1.94 msaitoh status &= ~SK_Y2_ASF_HCU_CSSR_CPU_CLK_DIVIDE_MSK;
899 1.94 msaitoh CSR_WRITE_2(sc, SK_Y2_ASF_HCU_CCSR, status);
900 1.94 msaitoh CSR_WRITE_4(sc, SK_Y2_CPU_WDOG, 0);
901 1.94 msaitoh } else
902 1.94 msaitoh CSR_WRITE_1(sc, SK_Y2_ASF_CSR, SK_Y2_ASF_RESET);
903 1.94 msaitoh CSR_WRITE_2(sc, SK_CSR, SK_CSR_ASF_OFF);
904 1.94 msaitoh
905 1.1 riz CSR_WRITE_1(sc, SK_CSR, SK_CSR_SW_RESET);
906 1.1 riz CSR_WRITE_1(sc, SK_CSR, SK_CSR_MASTER_RESET);
907 1.1 riz
908 1.1 riz DELAY(1000);
909 1.1 riz CSR_WRITE_1(sc, SK_CSR, SK_CSR_SW_UNRESET);
910 1.1 riz DELAY(2);
911 1.1 riz CSR_WRITE_1(sc, SK_CSR, SK_CSR_MASTER_UNRESET);
912 1.5 msaitoh sk_win_write_1(sc, SK_TESTCTL1, 2);
913 1.5 msaitoh
914 1.56 jdolecek if (sc->sk_type == SK_YUKON_EC_U || sc->sk_type == SK_YUKON_EX ||
915 1.56 jdolecek sc->sk_type >= SK_YUKON_FE_P) {
916 1.22 chris uint32_t our;
917 1.22 chris
918 1.22 chris CSR_WRITE_2(sc, SK_CSR, SK_CSR_WOL_ON);
919 1.65 msaitoh
920 1.22 chris /* enable all clocks. */
921 1.22 chris sk_win_write_4(sc, SK_Y2_PCI_REG(SK_PCI_OURREG3), 0);
922 1.22 chris our = sk_win_read_4(sc, SK_Y2_PCI_REG(SK_PCI_OURREG4));
923 1.88 msaitoh our &= (SK_Y2_REG4_FORCE_ASPM_REQUEST |
924 1.88 msaitoh SK_Y2_REG4_ASPM_GPHY_LINK_DOWN |
925 1.88 msaitoh SK_Y2_REG4_ASPM_INT_FIFO_EMPTY |
926 1.22 chris SK_Y2_REG4_ASPM_CLKRUN_REQUEST);
927 1.43 christos /* Set all bits to 0 except bits 15..12 */
928 1.22 chris sk_win_write_4(sc, SK_Y2_PCI_REG(SK_PCI_OURREG4), our);
929 1.22 chris /* Set to default value */
930 1.22 chris sk_win_write_4(sc, SK_Y2_PCI_REG(SK_PCI_OURREG5), 0);
931 1.74 jdolecek
932 1.74 jdolecek /*
933 1.74 jdolecek * Disable status race, workaround for Yukon EC Ultra &
934 1.74 jdolecek * Yukon EX.
935 1.74 jdolecek */
936 1.74 jdolecek reg1 = sk_win_read_4(sc, SK_GPIO);
937 1.74 jdolecek reg1 |= SK_Y2_GPIO_STAT_RACE_DIS;
938 1.74 jdolecek sk_win_write_4(sc, SK_GPIO, reg1);
939 1.74 jdolecek sk_win_read_4(sc, SK_GPIO);
940 1.22 chris }
941 1.22 chris
942 1.22 chris /* release PHY from PowerDown/Coma mode. */
943 1.60 jdolecek reg1 = sk_win_read_4(sc, SK_Y2_PCI_REG(SK_PCI_OURREG1));
944 1.60 jdolecek if (sc->sk_type == SK_YUKON_XL && sc->sk_rev > SK_YUKON_XL_REV_A1)
945 1.60 jdolecek reg1 |= (SK_Y2_REG1_PHY1_COMA | SK_Y2_REG1_PHY2_COMA);
946 1.60 jdolecek else
947 1.60 jdolecek reg1 &= ~(SK_Y2_REG1_PHY1_COMA | SK_Y2_REG1_PHY2_COMA);
948 1.5 msaitoh sk_win_write_4(sc, SK_Y2_PCI_REG(SK_PCI_OURREG1), reg1);
949 1.43 christos
950 1.5 msaitoh if (sc->sk_type == SK_YUKON_XL && sc->sk_rev > SK_YUKON_XL_REV_A1)
951 1.5 msaitoh sk_win_write_1(sc, SK_Y2_CLKGATE,
952 1.5 msaitoh SK_Y2_CLKGATE_LINK1_GATE_DIS |
953 1.5 msaitoh SK_Y2_CLKGATE_LINK2_GATE_DIS |
954 1.5 msaitoh SK_Y2_CLKGATE_LINK1_CORE_DIS |
955 1.5 msaitoh SK_Y2_CLKGATE_LINK2_CORE_DIS |
956 1.5 msaitoh SK_Y2_CLKGATE_LINK1_PCI_DIS | SK_Y2_CLKGATE_LINK2_PCI_DIS);
957 1.5 msaitoh else
958 1.5 msaitoh sk_win_write_1(sc, SK_Y2_CLKGATE, 0);
959 1.43 christos
960 1.5 msaitoh CSR_WRITE_2(sc, SK_LINK_CTRL, SK_LINK_RESET_SET);
961 1.5 msaitoh CSR_WRITE_2(sc, SK_LINK_CTRL + SK_WIN_LEN, SK_LINK_RESET_SET);
962 1.5 msaitoh DELAY(1000);
963 1.1 riz CSR_WRITE_2(sc, SK_LINK_CTRL, SK_LINK_RESET_CLEAR);
964 1.5 msaitoh CSR_WRITE_2(sc, SK_LINK_CTRL + SK_WIN_LEN, SK_LINK_RESET_CLEAR);
965 1.5 msaitoh
966 1.56 jdolecek if (sc->sk_type == SK_YUKON_EX || sc->sk_type == SK_YUKON_SUPR) {
967 1.56 jdolecek CSR_WRITE_2(sc, SK_GMAC_CTRL, SK_GMAC_BYP_MACSECRX |
968 1.56 jdolecek SK_GMAC_BYP_MACSECTX | SK_GMAC_BYP_RETR_FIFO);
969 1.59 jdolecek }
970 1.56 jdolecek
971 1.5 msaitoh sk_win_write_1(sc, SK_TESTCTL1, 1);
972 1.1 riz
973 1.63 jdolecek DPRINTFN(2, ("mskc_reset: sk_csr=%x\n", CSR_READ_1(sc, SK_CSR)));
974 1.63 jdolecek DPRINTFN(2, ("mskc_reset: sk_link_ctrl=%x\n",
975 1.1 riz CSR_READ_2(sc, SK_LINK_CTRL)));
976 1.1 riz
977 1.1 riz /* Clear I2C IRQ noise */
978 1.1 riz CSR_WRITE_4(sc, SK_I2CHWIRQ, 1);
979 1.1 riz
980 1.1 riz /* Disable hardware timer */
981 1.1 riz CSR_WRITE_1(sc, SK_TIMERCTL, SK_IMCTL_STOP);
982 1.1 riz CSR_WRITE_1(sc, SK_TIMERCTL, SK_IMCTL_IRQ_CLEAR);
983 1.1 riz
984 1.1 riz /* Disable descriptor polling */
985 1.1 riz CSR_WRITE_4(sc, SK_DPT_TIMER_CTRL, SK_DPT_TCTL_STOP);
986 1.1 riz
987 1.1 riz /* Disable time stamps */
988 1.1 riz CSR_WRITE_1(sc, SK_TSTAMP_CTL, SK_TSTAMP_STOP);
989 1.1 riz CSR_WRITE_1(sc, SK_TSTAMP_CTL, SK_TSTAMP_IRQ_CLEAR);
990 1.1 riz
991 1.1 riz /* Enable RAM interface */
992 1.1 riz sk_win_write_1(sc, SK_RAMCTL, SK_RAMCTL_UNRESET);
993 1.1 riz for (reg = SK_TO0;reg <= SK_TO11; reg++)
994 1.1 riz sk_win_write_1(sc, reg, 36);
995 1.5 msaitoh sk_win_write_1(sc, SK_RAMCTL + (SK_WIN_LEN / 2), SK_RAMCTL_UNRESET);
996 1.5 msaitoh for (reg = SK_TO0;reg <= SK_TO11; reg++)
997 1.5 msaitoh sk_win_write_1(sc, reg + (SK_WIN_LEN / 2), 36);
998 1.1 riz
999 1.1 riz /*
1000 1.1 riz * Configure interrupt moderation. The moderation timer
1001 1.1 riz * defers interrupts specified in the interrupt moderation
1002 1.1 riz * timer mask based on the timeout specified in the interrupt
1003 1.1 riz * moderation timer init register. Each bit in the timer
1004 1.1 riz * register represents one tick, so to specify a timeout in
1005 1.1 riz * microseconds, we have to multiply by the correct number of
1006 1.1 riz * ticks-per-microsecond.
1007 1.1 riz */
1008 1.1 riz switch (sc->sk_type) {
1009 1.1 riz case SK_YUKON_EC:
1010 1.6 msaitoh case SK_YUKON_EC_U:
1011 1.60 jdolecek case SK_YUKON_EX:
1012 1.60 jdolecek case SK_YUKON_SUPR:
1013 1.60 jdolecek case SK_YUKON_ULTRA2:
1014 1.60 jdolecek case SK_YUKON_OPTIMA:
1015 1.60 jdolecek case SK_YUKON_PRM:
1016 1.60 jdolecek case SK_YUKON_OPTIMA2:
1017 1.6 msaitoh imtimer_ticks = SK_IMTIMER_TICKS_YUKON_EC;
1018 1.6 msaitoh break;
1019 1.6 msaitoh case SK_YUKON_FE:
1020 1.6 msaitoh imtimer_ticks = SK_IMTIMER_TICKS_YUKON_FE;
1021 1.6 msaitoh break;
1022 1.60 jdolecek case SK_YUKON_FE_P:
1023 1.60 jdolecek imtimer_ticks = SK_IMTIMER_TICKS_YUKON_FE_P;
1024 1.60 jdolecek break;
1025 1.1 riz case SK_YUKON_XL:
1026 1.6 msaitoh imtimer_ticks = SK_IMTIMER_TICKS_YUKON_XL;
1027 1.1 riz break;
1028 1.1 riz default:
1029 1.5 msaitoh imtimer_ticks = SK_IMTIMER_TICKS_YUKON;
1030 1.60 jdolecek break;
1031 1.1 riz }
1032 1.1 riz
1033 1.1 riz /* Reset status ring. */
1034 1.30 christos memset(sc->sk_status_ring, 0,
1035 1.1 riz MSK_STATUS_RING_CNT * sizeof(struct msk_status_desc));
1036 1.17 kiyohara bus_dmamap_sync(sc->sc_dmatag, sc->sk_status_map, 0,
1037 1.17 kiyohara sc->sk_status_map->dm_mapsize, BUS_DMASYNC_PREREAD);
1038 1.1 riz sc->sk_status_idx = 0;
1039 1.1 riz
1040 1.1 riz sk_win_write_4(sc, SK_STAT_BMU_CSR, SK_STAT_BMU_RESET);
1041 1.1 riz sk_win_write_4(sc, SK_STAT_BMU_CSR, SK_STAT_BMU_UNRESET);
1042 1.1 riz
1043 1.1 riz sk_win_write_2(sc, SK_STAT_BMU_LIDX, MSK_STATUS_RING_CNT - 1);
1044 1.1 riz sk_win_write_4(sc, SK_STAT_BMU_ADDRLO,
1045 1.82 mrg MSK_ADDR_LO(sc->sk_status_map->dm_segs[0].ds_addr));
1046 1.1 riz sk_win_write_4(sc, SK_STAT_BMU_ADDRHI,
1047 1.82 mrg MSK_ADDR_HI(sc->sk_status_map->dm_segs[0].ds_addr));
1048 1.75 jdolecek if (sc->sk_type == SK_YUKON_EC &&
1049 1.75 jdolecek sc->sk_rev == SK_YUKON_EC_REV_A1) {
1050 1.75 jdolecek /* WA for dev. #4.3 */
1051 1.83 msaitoh sk_win_write_2(sc, SK_STAT_BMU_TX_THRESH,
1052 1.83 msaitoh SK_STAT_BMU_TXTHIDX_MSK);
1053 1.75 jdolecek /* WA for dev. #4.18 */
1054 1.6 msaitoh sk_win_write_1(sc, SK_STAT_BMU_FIFOWM, 0x21);
1055 1.6 msaitoh sk_win_write_1(sc, SK_STAT_BMU_FIFOIWM, 0x07);
1056 1.6 msaitoh } else {
1057 1.6 msaitoh sk_win_write_2(sc, SK_STAT_BMU_TX_THRESH, 0x000a);
1058 1.6 msaitoh sk_win_write_1(sc, SK_STAT_BMU_FIFOWM, 0x10);
1059 1.75 jdolecek if (sc->sk_type == SK_YUKON_XL)
1060 1.75 jdolecek sk_win_write_1(sc, SK_STAT_BMU_FIFOIWM, 0x04);
1061 1.75 jdolecek else
1062 1.75 jdolecek sk_win_write_1(sc, SK_STAT_BMU_FIFOIWM, 0x10);
1063 1.6 msaitoh sk_win_write_4(sc, SK_Y2_ISR_ITIMERINIT, 0x0190); /* 3.2us on Yukon-EC */
1064 1.6 msaitoh }
1065 1.1 riz
1066 1.1 riz #if 0
1067 1.1 riz sk_win_write_4(sc, SK_Y2_LEV_ITIMERINIT, SK_IM_USECS(100));
1068 1.6 msaitoh #endif
1069 1.1 riz sk_win_write_4(sc, SK_Y2_TX_ITIMERINIT, SK_IM_USECS(1000));
1070 1.1 riz
1071 1.75 jdolecek /* Enable status unit. */
1072 1.1 riz sk_win_write_4(sc, SK_STAT_BMU_CSR, SK_STAT_BMU_ON);
1073 1.1 riz
1074 1.1 riz sk_win_write_1(sc, SK_Y2_LEV_ITIMERCTL, SK_IMCTL_START);
1075 1.1 riz sk_win_write_1(sc, SK_Y2_TX_ITIMERCTL, SK_IMCTL_START);
1076 1.1 riz sk_win_write_1(sc, SK_Y2_ISR_ITIMERCTL, SK_IMCTL_START);
1077 1.1 riz
1078 1.30 christos msk_update_int_mod(sc, 0);
1079 1.1 riz }
1080 1.1 riz
1081 1.95 maxv static int
1082 1.26 cegger msk_probe(device_t parent, cfdata_t match, void *aux)
1083 1.1 riz {
1084 1.1 riz struct skc_attach_args *sa = aux;
1085 1.1 riz
1086 1.1 riz if (sa->skc_port != SK_PORT_A && sa->skc_port != SK_PORT_B)
1087 1.88 msaitoh return 0;
1088 1.1 riz
1089 1.1 riz switch (sa->skc_type) {
1090 1.1 riz case SK_YUKON_XL:
1091 1.1 riz case SK_YUKON_EC_U:
1092 1.56 jdolecek case SK_YUKON_EX:
1093 1.1 riz case SK_YUKON_EC:
1094 1.1 riz case SK_YUKON_FE:
1095 1.47 christos case SK_YUKON_FE_P:
1096 1.56 jdolecek case SK_YUKON_SUPR:
1097 1.56 jdolecek case SK_YUKON_ULTRA2:
1098 1.56 jdolecek case SK_YUKON_OPTIMA:
1099 1.56 jdolecek case SK_YUKON_PRM:
1100 1.56 jdolecek case SK_YUKON_OPTIMA2:
1101 1.88 msaitoh return 1;
1102 1.1 riz }
1103 1.1 riz
1104 1.88 msaitoh return 0;
1105 1.1 riz }
1106 1.1 riz
1107 1.95 maxv static void
1108 1.63 jdolecek msk_reset(struct sk_if_softc *sc_if)
1109 1.63 jdolecek {
1110 1.63 jdolecek /* GMAC and GPHY Reset */
1111 1.63 jdolecek SK_IF_WRITE_4(sc_if, 0, SK_GMAC_CTRL, SK_GMAC_RESET_SET);
1112 1.94 msaitoh SK_IF_WRITE_1(sc_if, 0, SK_GPHY_CTRL, SK_GPHY_RESET_SET);
1113 1.63 jdolecek DELAY(1000);
1114 1.94 msaitoh SK_IF_WRITE_1(sc_if, 0, SK_GPHY_CTRL, SK_GPHY_RESET_CLEAR);
1115 1.63 jdolecek SK_IF_WRITE_4(sc_if, 0, SK_GMAC_CTRL, SK_GMAC_LOOP_OFF |
1116 1.63 jdolecek SK_GMAC_PAUSE_ON | SK_GMAC_RESET_CLEAR);
1117 1.63 jdolecek }
1118 1.63 jdolecek
1119 1.20 joerg static bool
1120 1.33 dyoung msk_resume(device_t dv, const pmf_qual_t *qual)
1121 1.20 joerg {
1122 1.20 joerg struct sk_if_softc *sc_if = device_private(dv);
1123 1.43 christos
1124 1.20 joerg msk_init_yukon(sc_if);
1125 1.20 joerg return true;
1126 1.20 joerg }
1127 1.20 joerg
1128 1.1 riz /*
1129 1.1 riz * Each XMAC chip is attached as a separate logical IP interface.
1130 1.1 riz * Single port cards will have only one logical interface of course.
1131 1.1 riz */
1132 1.95 maxv static void
1133 1.26 cegger msk_attach(device_t parent, device_t self, void *aux)
1134 1.1 riz {
1135 1.27 cegger struct sk_if_softc *sc_if = device_private(self);
1136 1.27 cegger struct sk_softc *sc = device_private(parent);
1137 1.1 riz struct skc_attach_args *sa = aux;
1138 1.1 riz struct ifnet *ifp;
1139 1.88 msaitoh struct mii_data * const mii = &sc_if->sk_mii;
1140 1.8 christos void *kva;
1141 1.63 jdolecek int i;
1142 1.83 msaitoh uint32_t chunk;
1143 1.63 jdolecek int mii_flags;
1144 1.1 riz
1145 1.30 christos sc_if->sk_dev = self;
1146 1.1 riz sc_if->sk_port = sa->skc_port;
1147 1.1 riz sc_if->sk_softc = sc;
1148 1.1 riz sc->sk_if[sa->skc_port] = sc_if;
1149 1.1 riz
1150 1.1 riz DPRINTFN(2, ("begin msk_attach: port=%d\n", sc_if->sk_port));
1151 1.1 riz
1152 1.1 riz /*
1153 1.1 riz * Get station address for this interface. Note that
1154 1.1 riz * dual port cards actually come with three station
1155 1.1 riz * addresses: one for each port, plus an extra. The
1156 1.1 riz * extra one is used by the SysKonnect driver software
1157 1.1 riz * as a 'virtual' station address for when both ports
1158 1.1 riz * are operating in failover mode. Currently we don't
1159 1.1 riz * use this extra address.
1160 1.1 riz */
1161 1.1 riz for (i = 0; i < ETHER_ADDR_LEN; i++)
1162 1.1 riz sc_if->sk_enaddr[i] =
1163 1.1 riz sk_win_read_1(sc, SK_MAC0_0 + (sa->skc_port * 8) + i);
1164 1.1 riz
1165 1.1 riz aprint_normal(": Ethernet address %s\n",
1166 1.1 riz ether_sprintf(sc_if->sk_enaddr));
1167 1.1 riz
1168 1.1 riz /*
1169 1.57 jdolecek * Set up RAM buffer addresses. The Yukon2 has a small amount
1170 1.57 jdolecek * of SRAM on it, somewhere between 4K and 48K. We need to
1171 1.57 jdolecek * divide this up between the transmitter and receiver. We
1172 1.57 jdolecek * give the receiver 2/3 of the memory (rounded down), and the
1173 1.57 jdolecek * transmitter whatever remains.
1174 1.1 riz */
1175 1.78 jakllsch if (sc->sk_ramsize) {
1176 1.83 msaitoh chunk = (2 * (sc->sk_ramsize / sizeof(uint64_t)) / 3) & ~0xff;
1177 1.78 jakllsch sc_if->sk_rx_ramstart = 0;
1178 1.78 jakllsch sc_if->sk_rx_ramend = sc_if->sk_rx_ramstart + chunk - 1;
1179 1.83 msaitoh chunk = (sc->sk_ramsize / sizeof(uint64_t)) - chunk;
1180 1.78 jakllsch sc_if->sk_tx_ramstart = sc_if->sk_rx_ramend + 1;
1181 1.78 jakllsch sc_if->sk_tx_ramend = sc_if->sk_tx_ramstart + chunk - 1;
1182 1.78 jakllsch
1183 1.78 jakllsch DPRINTFN(2, ("msk_attach: rx_ramstart=%#x rx_ramend=%#x\n"
1184 1.78 jakllsch " tx_ramstart=%#x tx_ramend=%#x\n",
1185 1.78 jakllsch sc_if->sk_rx_ramstart, sc_if->sk_rx_ramend,
1186 1.78 jakllsch sc_if->sk_tx_ramstart, sc_if->sk_tx_ramend));
1187 1.78 jakllsch }
1188 1.1 riz
1189 1.1 riz /* Allocate the descriptor queues. */
1190 1.1 riz if (bus_dmamem_alloc(sc->sc_dmatag, sizeof(struct msk_ring_data),
1191 1.63 jdolecek PAGE_SIZE, 0, &sc_if->sk_ring_seg, 1, &sc_if->sk_ring_nseg,
1192 1.63 jdolecek BUS_DMA_NOWAIT)) {
1193 1.1 riz aprint_error(": can't alloc rx buffers\n");
1194 1.1 riz goto fail;
1195 1.1 riz }
1196 1.63 jdolecek if (bus_dmamem_map(sc->sc_dmatag, &sc_if->sk_ring_seg,
1197 1.63 jdolecek sc_if->sk_ring_nseg,
1198 1.1 riz sizeof(struct msk_ring_data), &kva, BUS_DMA_NOWAIT)) {
1199 1.1 riz aprint_error(": can't map dma buffers (%zu bytes)\n",
1200 1.1 riz sizeof(struct msk_ring_data));
1201 1.1 riz goto fail_1;
1202 1.1 riz }
1203 1.1 riz if (bus_dmamap_create(sc->sc_dmatag, sizeof(struct msk_ring_data), 1,
1204 1.1 riz sizeof(struct msk_ring_data), 0, BUS_DMA_NOWAIT,
1205 1.59 jdolecek &sc_if->sk_ring_map)) {
1206 1.1 riz aprint_error(": can't create dma map\n");
1207 1.1 riz goto fail_2;
1208 1.1 riz }
1209 1.1 riz if (bus_dmamap_load(sc->sc_dmatag, sc_if->sk_ring_map, kva,
1210 1.1 riz sizeof(struct msk_ring_data), NULL, BUS_DMA_NOWAIT)) {
1211 1.1 riz aprint_error(": can't load dma map\n");
1212 1.1 riz goto fail_3;
1213 1.1 riz }
1214 1.59 jdolecek sc_if->sk_rdata = (struct msk_ring_data *)kva;
1215 1.24 cegger memset(sc_if->sk_rdata, 0, sizeof(struct msk_ring_data));
1216 1.1 riz
1217 1.68 jdolecek if (sc->sk_type != SK_YUKON_FE &&
1218 1.68 jdolecek sc->sk_type != SK_YUKON_FE_P)
1219 1.68 jdolecek sc_if->sk_pktlen = SK_JLEN;
1220 1.68 jdolecek else
1221 1.68 jdolecek sc_if->sk_pktlen = MCLBYTES;
1222 1.68 jdolecek
1223 1.1 riz /* Try to allocate memory for jumbo buffers. */
1224 1.1 riz if (msk_alloc_jumbo_mem(sc_if)) {
1225 1.1 riz aprint_error(": jumbo buffer allocation failed\n");
1226 1.1 riz goto fail_3;
1227 1.1 riz }
1228 1.68 jdolecek
1229 1.19 dyoung sc_if->sk_ethercom.ec_capabilities = ETHERCAP_VLAN_MTU;
1230 1.68 jdolecek if (sc->sk_type != SK_YUKON_FE &&
1231 1.68 jdolecek sc->sk_type != SK_YUKON_FE_P)
1232 1.19 dyoung sc_if->sk_ethercom.ec_capabilities |= ETHERCAP_JUMBO_MTU;
1233 1.1 riz
1234 1.68 jdolecek ifp = &sc_if->sk_ethercom.ec_if;
1235 1.1 riz ifp->if_softc = sc_if;
1236 1.1 riz ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
1237 1.1 riz ifp->if_ioctl = msk_ioctl;
1238 1.1 riz ifp->if_start = msk_start;
1239 1.1 riz ifp->if_stop = msk_stop;
1240 1.1 riz ifp->if_init = msk_init;
1241 1.1 riz ifp->if_watchdog = msk_watchdog;
1242 1.1 riz ifp->if_baudrate = 1000000000;
1243 1.1 riz IFQ_SET_MAXLEN(&ifp->if_snd, MSK_TX_RING_CNT - 1);
1244 1.1 riz IFQ_SET_READY(&ifp->if_snd);
1245 1.30 christos strlcpy(ifp->if_xname, device_xname(sc_if->sk_dev), IFNAMSIZ);
1246 1.1 riz
1247 1.63 jdolecek msk_reset(sc_if);
1248 1.63 jdolecek
1249 1.1 riz /*
1250 1.1 riz * Do miibus setup.
1251 1.1 riz */
1252 1.89 msaitoh DPRINTFN(2, ("msk_attach: 1\n"));
1253 1.1 riz
1254 1.88 msaitoh mii->mii_ifp = ifp;
1255 1.88 msaitoh mii->mii_readreg = msk_miibus_readreg;
1256 1.88 msaitoh mii->mii_writereg = msk_miibus_writereg;
1257 1.88 msaitoh mii->mii_statchg = msk_miibus_statchg;
1258 1.88 msaitoh
1259 1.88 msaitoh sc_if->sk_ethercom.ec_mii = mii;
1260 1.88 msaitoh ifmedia_init(&mii->mii_media, 0, ether_mediachange, ether_mediastatus);
1261 1.63 jdolecek mii_flags = MIIF_DOPAUSE;
1262 1.63 jdolecek if (sc->sk_fibertype)
1263 1.63 jdolecek mii_flags |= MIIF_HAVEFIBER;
1264 1.88 msaitoh mii_attach(self, mii, 0xffffffff, 0, MII_OFFSET_ANY, mii_flags);
1265 1.88 msaitoh if (LIST_FIRST(&mii->mii_phys) == NULL) {
1266 1.30 christos aprint_error_dev(sc_if->sk_dev, "no PHY found!\n");
1267 1.88 msaitoh ifmedia_add(&mii->mii_media, IFM_ETHER | IFM_MANUAL,
1268 1.1 riz 0, NULL);
1269 1.88 msaitoh ifmedia_set(&mii->mii_media, IFM_ETHER | IFM_MANUAL);
1270 1.1 riz } else
1271 1.88 msaitoh ifmedia_set(&mii->mii_media, IFM_ETHER | IFM_AUTO);
1272 1.1 riz
1273 1.9 ad callout_init(&sc_if->sk_tick_ch, 0);
1274 1.5 msaitoh callout_setfunc(&sc_if->sk_tick_ch, msk_tick, sc_if);
1275 1.1 riz callout_schedule(&sc_if->sk_tick_ch, hz);
1276 1.1 riz
1277 1.72 jdolecek callout_init(&sc_if->sk_tick_rx, 0);
1278 1.72 jdolecek callout_setfunc(&sc_if->sk_tick_rx, msk_fill_rx_tick, sc_if);
1279 1.72 jdolecek
1280 1.1 riz /*
1281 1.1 riz * Call MI attach routines.
1282 1.1 riz */
1283 1.1 riz if_attach(ifp);
1284 1.53 ozaki if_deferred_start_init(ifp, NULL);
1285 1.1 riz ether_ifattach(ifp, sc_if->sk_enaddr);
1286 1.1 riz
1287 1.28 tsutsui if (pmf_device_register(self, NULL, msk_resume))
1288 1.28 tsutsui pmf_class_network_register(self, ifp);
1289 1.28 tsutsui else
1290 1.20 joerg aprint_error_dev(self, "couldn't establish power handler\n");
1291 1.1 riz
1292 1.69 jdolecek if (sc->rnd_attached++ == 0) {
1293 1.69 jdolecek rnd_attach_source(&sc->rnd_source, device_xname(sc->sk_dev),
1294 1.69 jdolecek RND_TYPE_NET, RND_FLAG_DEFAULT);
1295 1.69 jdolecek }
1296 1.1 riz
1297 1.1 riz DPRINTFN(2, ("msk_attach: end\n"));
1298 1.1 riz return;
1299 1.1 riz
1300 1.1 riz fail_3:
1301 1.1 riz bus_dmamap_destroy(sc->sc_dmatag, sc_if->sk_ring_map);
1302 1.1 riz fail_2:
1303 1.1 riz bus_dmamem_unmap(sc->sc_dmatag, kva, sizeof(struct msk_ring_data));
1304 1.1 riz fail_1:
1305 1.63 jdolecek bus_dmamem_free(sc->sc_dmatag, &sc_if->sk_ring_seg, sc_if->sk_ring_nseg);
1306 1.1 riz fail:
1307 1.1 riz sc->sk_if[sa->skc_port] = NULL;
1308 1.1 riz }
1309 1.1 riz
1310 1.95 maxv static int
1311 1.63 jdolecek msk_detach(device_t self, int flags)
1312 1.63 jdolecek {
1313 1.70 jdolecek struct sk_if_softc *sc_if = device_private(self);
1314 1.63 jdolecek struct sk_softc *sc = sc_if->sk_softc;
1315 1.63 jdolecek struct ifnet *ifp = &sc_if->sk_ethercom.ec_if;
1316 1.63 jdolecek
1317 1.63 jdolecek if (sc->sk_if[sc_if->sk_port] == NULL)
1318 1.88 msaitoh return 0;
1319 1.63 jdolecek
1320 1.81 bouyer msk_stop(ifp, 1);
1321 1.68 jdolecek
1322 1.69 jdolecek if (--sc->rnd_attached == 0)
1323 1.69 jdolecek rnd_detach_source(&sc->rnd_source);
1324 1.63 jdolecek
1325 1.63 jdolecek callout_halt(&sc_if->sk_tick_ch, NULL);
1326 1.63 jdolecek callout_destroy(&sc_if->sk_tick_ch);
1327 1.63 jdolecek
1328 1.72 jdolecek callout_halt(&sc_if->sk_tick_rx, NULL);
1329 1.72 jdolecek callout_destroy(&sc_if->sk_tick_rx);
1330 1.72 jdolecek
1331 1.63 jdolecek /* Detach any PHYs we might have. */
1332 1.63 jdolecek if (LIST_FIRST(&sc_if->sk_mii.mii_phys) != NULL)
1333 1.63 jdolecek mii_detach(&sc_if->sk_mii, MII_PHY_ANY, MII_OFFSET_ANY);
1334 1.63 jdolecek
1335 1.63 jdolecek /* Delete any remaining media. */
1336 1.63 jdolecek ifmedia_delete_instance(&sc_if->sk_mii.mii_media, IFM_INST_ANY);
1337 1.63 jdolecek
1338 1.63 jdolecek pmf_device_deregister(self);
1339 1.63 jdolecek
1340 1.63 jdolecek ether_ifdetach(ifp);
1341 1.63 jdolecek if_detach(ifp);
1342 1.63 jdolecek
1343 1.70 jdolecek msk_free_jumbo_mem(sc_if);
1344 1.70 jdolecek
1345 1.63 jdolecek bus_dmamem_unmap(sc->sc_dmatag, sc_if->sk_rdata,
1346 1.63 jdolecek sizeof(struct msk_ring_data));
1347 1.63 jdolecek bus_dmamem_free(sc->sc_dmatag,
1348 1.63 jdolecek &sc_if->sk_ring_seg, sc_if->sk_ring_nseg);
1349 1.68 jdolecek bus_dmamap_destroy(sc->sc_dmatag, sc_if->sk_ring_map);
1350 1.63 jdolecek sc->sk_if[sc_if->sk_port] = NULL;
1351 1.63 jdolecek
1352 1.88 msaitoh return 0;
1353 1.63 jdolecek }
1354 1.63 jdolecek
1355 1.95 maxv static int
1356 1.1 riz mskcprint(void *aux, const char *pnp)
1357 1.1 riz {
1358 1.1 riz struct skc_attach_args *sa = aux;
1359 1.1 riz
1360 1.1 riz if (pnp)
1361 1.64 jdolecek aprint_normal("msk port %c at %s",
1362 1.1 riz (sa->skc_port == SK_PORT_A) ? 'A' : 'B', pnp);
1363 1.1 riz else
1364 1.83 msaitoh aprint_normal(" port %c",
1365 1.83 msaitoh (sa->skc_port == SK_PORT_A) ? 'A' : 'B');
1366 1.88 msaitoh return UNCONF;
1367 1.1 riz }
1368 1.1 riz
1369 1.1 riz /*
1370 1.1 riz * Attach the interface. Allocate softc structures, do ifmedia
1371 1.1 riz * setup and ethernet/BPF attach.
1372 1.1 riz */
1373 1.95 maxv static void
1374 1.26 cegger mskc_attach(device_t parent, device_t self, void *aux)
1375 1.1 riz {
1376 1.27 cegger struct sk_softc *sc = device_private(self);
1377 1.1 riz struct pci_attach_args *pa = aux;
1378 1.1 riz struct skc_attach_args skca;
1379 1.1 riz pci_chipset_tag_t pc = pa->pa_pc;
1380 1.1 riz pcireg_t command, memtype;
1381 1.1 riz const char *intrstr = NULL;
1382 1.1 riz int rc, sk_nodenum;
1383 1.83 msaitoh uint8_t hw, pmd;
1384 1.1 riz const char *revstr = NULL;
1385 1.1 riz const struct sysctlnode *node;
1386 1.8 christos void *kva;
1387 1.45 christos char intrbuf[PCI_INTRSTR_LEN];
1388 1.1 riz
1389 1.1 riz DPRINTFN(2, ("begin mskc_attach\n"));
1390 1.1 riz
1391 1.30 christos sc->sk_dev = self;
1392 1.1 riz /*
1393 1.1 riz * Handle power management nonsense.
1394 1.1 riz */
1395 1.1 riz command = pci_conf_read(pc, pa->pa_tag, SK_PCI_CAPID) & 0x000000FF;
1396 1.1 riz
1397 1.1 riz if (command == 0x01) {
1398 1.1 riz command = pci_conf_read(pc, pa->pa_tag, SK_PCI_PWRMGMTCTRL);
1399 1.1 riz if (command & SK_PSTATE_MASK) {
1400 1.83 msaitoh uint32_t iobase, membase, irq;
1401 1.1 riz
1402 1.1 riz /* Save important PCI config data. */
1403 1.1 riz iobase = pci_conf_read(pc, pa->pa_tag, SK_PCI_LOIO);
1404 1.1 riz membase = pci_conf_read(pc, pa->pa_tag, SK_PCI_LOMEM);
1405 1.1 riz irq = pci_conf_read(pc, pa->pa_tag, SK_PCI_INTLINE);
1406 1.1 riz
1407 1.1 riz /* Reset the power state. */
1408 1.30 christos aprint_normal_dev(sc->sk_dev, "chip is in D%d power "
1409 1.30 christos "mode -- setting to D0\n",
1410 1.1 riz command & SK_PSTATE_MASK);
1411 1.1 riz command &= 0xFFFFFFFC;
1412 1.1 riz pci_conf_write(pc, pa->pa_tag,
1413 1.1 riz SK_PCI_PWRMGMTCTRL, command);
1414 1.1 riz
1415 1.1 riz /* Restore PCI config data. */
1416 1.1 riz pci_conf_write(pc, pa->pa_tag, SK_PCI_LOIO, iobase);
1417 1.1 riz pci_conf_write(pc, pa->pa_tag, SK_PCI_LOMEM, membase);
1418 1.1 riz pci_conf_write(pc, pa->pa_tag, SK_PCI_INTLINE, irq);
1419 1.1 riz }
1420 1.1 riz }
1421 1.1 riz
1422 1.1 riz /*
1423 1.1 riz * Map control/status registers.
1424 1.1 riz */
1425 1.1 riz memtype = pci_mapreg_type(pc, pa->pa_tag, SK_PCI_LOMEM);
1426 1.63 jdolecek if (pci_mapreg_map(pa, SK_PCI_LOMEM, memtype, 0, &sc->sk_btag,
1427 1.77 jakllsch &sc->sk_bhandle, NULL, &sc->sk_bsize)) {
1428 1.1 riz aprint_error(": can't map mem space\n");
1429 1.1 riz return;
1430 1.1 riz }
1431 1.1 riz
1432 1.78 jakllsch if (pci_dma64_available(pa))
1433 1.78 jakllsch sc->sc_dmatag = pa->pa_dmat64;
1434 1.78 jakllsch else
1435 1.78 jakllsch sc->sc_dmatag = pa->pa_dmat;
1436 1.1 riz
1437 1.36 jakllsch command = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
1438 1.37 jakllsch command |= PCI_COMMAND_MASTER_ENABLE;
1439 1.36 jakllsch pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, command);
1440 1.36 jakllsch
1441 1.1 riz sc->sk_type = sk_win_read_1(sc, SK_CHIPVER);
1442 1.1 riz sc->sk_rev = (sk_win_read_1(sc, SK_CONFIG) >> 4);
1443 1.1 riz
1444 1.1 riz /* bail out here if chip is not recognized */
1445 1.5 msaitoh if (!(SK_IS_YUKON2(sc))) {
1446 1.1 riz aprint_error(": unknown chip type: %d\n", sc->sk_type);
1447 1.1 riz goto fail_1;
1448 1.1 riz }
1449 1.1 riz DPRINTFN(2, ("mskc_attach: allocate interrupt\n"));
1450 1.1 riz
1451 1.1 riz /* Allocate interrupt */
1452 1.79 jmcneill if (pci_intr_alloc(pa, &sc->sk_pihp, NULL, 0)) {
1453 1.1 riz aprint_error(": couldn't map interrupt\n");
1454 1.1 riz goto fail_1;
1455 1.1 riz }
1456 1.1 riz
1457 1.79 jmcneill intrstr = pci_intr_string(pc, sc->sk_pihp[0], intrbuf, sizeof(intrbuf));
1458 1.80 jdolecek sc->sk_intrhand = pci_intr_establish_xname(pc, sc->sk_pihp[0], IPL_NET,
1459 1.80 jdolecek msk_intr, sc, device_xname(sc->sk_dev));
1460 1.1 riz if (sc->sk_intrhand == NULL) {
1461 1.1 riz aprint_error(": couldn't establish interrupt");
1462 1.1 riz if (intrstr != NULL)
1463 1.1 riz aprint_error(" at %s", intrstr);
1464 1.1 riz aprint_error("\n");
1465 1.1 riz goto fail_1;
1466 1.1 riz }
1467 1.63 jdolecek sc->sk_pc = pc;
1468 1.1 riz
1469 1.1 riz if (bus_dmamem_alloc(sc->sc_dmatag,
1470 1.68 jdolecek MSK_STATUS_RING_CNT * sizeof(struct msk_status_desc),
1471 1.68 jdolecek MSK_STATUS_RING_CNT * sizeof(struct msk_status_desc),
1472 1.63 jdolecek 0, &sc->sk_status_seg, 1, &sc->sk_status_nseg, BUS_DMA_NOWAIT)) {
1473 1.1 riz aprint_error(": can't alloc status buffers\n");
1474 1.1 riz goto fail_2;
1475 1.1 riz }
1476 1.1 riz
1477 1.63 jdolecek if (bus_dmamem_map(sc->sc_dmatag,
1478 1.63 jdolecek &sc->sk_status_seg, sc->sk_status_nseg,
1479 1.1 riz MSK_STATUS_RING_CNT * sizeof(struct msk_status_desc),
1480 1.1 riz &kva, BUS_DMA_NOWAIT)) {
1481 1.1 riz aprint_error(": can't map dma buffers (%zu bytes)\n",
1482 1.1 riz MSK_STATUS_RING_CNT * sizeof(struct msk_status_desc));
1483 1.1 riz goto fail_3;
1484 1.1 riz }
1485 1.1 riz if (bus_dmamap_create(sc->sc_dmatag,
1486 1.1 riz MSK_STATUS_RING_CNT * sizeof(struct msk_status_desc), 1,
1487 1.1 riz MSK_STATUS_RING_CNT * sizeof(struct msk_status_desc), 0,
1488 1.1 riz BUS_DMA_NOWAIT, &sc->sk_status_map)) {
1489 1.1 riz aprint_error(": can't create dma map\n");
1490 1.1 riz goto fail_4;
1491 1.1 riz }
1492 1.1 riz if (bus_dmamap_load(sc->sc_dmatag, sc->sk_status_map, kva,
1493 1.1 riz MSK_STATUS_RING_CNT * sizeof(struct msk_status_desc),
1494 1.1 riz NULL, BUS_DMA_NOWAIT)) {
1495 1.1 riz aprint_error(": can't load dma map\n");
1496 1.1 riz goto fail_5;
1497 1.1 riz }
1498 1.1 riz sc->sk_status_ring = (struct msk_status_desc *)kva;
1499 1.1 riz
1500 1.30 christos sc->sk_int_mod = SK_IM_DEFAULT;
1501 1.30 christos sc->sk_int_mod_pending = 0;
1502 1.30 christos
1503 1.1 riz /* Reset the adapter. */
1504 1.63 jdolecek mskc_reset(sc);
1505 1.1 riz
1506 1.57 jdolecek sc->sk_ramsize = sk_win_read_1(sc, SK_EPROM0) * 4096;
1507 1.57 jdolecek DPRINTFN(2, ("mskc_attach: ramsize=%dK\n", sc->sk_ramsize / 1024));
1508 1.1 riz
1509 1.63 jdolecek pmd = sk_win_read_1(sc, SK_PMDTYPE);
1510 1.63 jdolecek if (pmd == 'L' || pmd == 'S' || pmd == 'P')
1511 1.63 jdolecek sc->sk_fibertype = 1;
1512 1.63 jdolecek
1513 1.1 riz switch (sc->sk_type) {
1514 1.1 riz case SK_YUKON_XL:
1515 1.5 msaitoh sc->sk_name = "Yukon-2 XL";
1516 1.1 riz break;
1517 1.1 riz case SK_YUKON_EC_U:
1518 1.5 msaitoh sc->sk_name = "Yukon-2 EC Ultra";
1519 1.1 riz break;
1520 1.56 jdolecek case SK_YUKON_EX:
1521 1.56 jdolecek sc->sk_name = "Yukon-2 Extreme";
1522 1.56 jdolecek break;
1523 1.1 riz case SK_YUKON_EC:
1524 1.5 msaitoh sc->sk_name = "Yukon-2 EC";
1525 1.1 riz break;
1526 1.1 riz case SK_YUKON_FE:
1527 1.5 msaitoh sc->sk_name = "Yukon-2 FE";
1528 1.1 riz break;
1529 1.56 jdolecek case SK_YUKON_FE_P:
1530 1.56 jdolecek sc->sk_name = "Yukon-2 FE+";
1531 1.56 jdolecek break;
1532 1.56 jdolecek case SK_YUKON_SUPR:
1533 1.56 jdolecek sc->sk_name = "Yukon-2 Supreme";
1534 1.56 jdolecek break;
1535 1.56 jdolecek case SK_YUKON_ULTRA2:
1536 1.56 jdolecek sc->sk_name = "Yukon-2 Ultra 2";
1537 1.56 jdolecek break;
1538 1.56 jdolecek case SK_YUKON_OPTIMA:
1539 1.56 jdolecek sc->sk_name = "Yukon-2 Optima";
1540 1.56 jdolecek break;
1541 1.56 jdolecek case SK_YUKON_PRM:
1542 1.56 jdolecek sc->sk_name = "Yukon-2 Optima Prime";
1543 1.56 jdolecek break;
1544 1.56 jdolecek case SK_YUKON_OPTIMA2:
1545 1.56 jdolecek sc->sk_name = "Yukon-2 Optima 2";
1546 1.56 jdolecek break;
1547 1.1 riz default:
1548 1.5 msaitoh sc->sk_name = "Yukon (Unknown)";
1549 1.1 riz }
1550 1.1 riz
1551 1.1 riz if (sc->sk_type == SK_YUKON_XL) {
1552 1.1 riz switch (sc->sk_rev) {
1553 1.1 riz case SK_YUKON_XL_REV_A0:
1554 1.1 riz revstr = "A0";
1555 1.1 riz break;
1556 1.1 riz case SK_YUKON_XL_REV_A1:
1557 1.1 riz revstr = "A1";
1558 1.1 riz break;
1559 1.1 riz case SK_YUKON_XL_REV_A2:
1560 1.1 riz revstr = "A2";
1561 1.1 riz break;
1562 1.1 riz case SK_YUKON_XL_REV_A3:
1563 1.1 riz revstr = "A3";
1564 1.1 riz break;
1565 1.1 riz default:
1566 1.6 msaitoh break;
1567 1.1 riz }
1568 1.1 riz }
1569 1.1 riz
1570 1.1 riz if (sc->sk_type == SK_YUKON_EC) {
1571 1.1 riz switch (sc->sk_rev) {
1572 1.1 riz case SK_YUKON_EC_REV_A1:
1573 1.1 riz revstr = "A1";
1574 1.1 riz break;
1575 1.1 riz case SK_YUKON_EC_REV_A2:
1576 1.1 riz revstr = "A2";
1577 1.1 riz break;
1578 1.1 riz case SK_YUKON_EC_REV_A3:
1579 1.1 riz revstr = "A3";
1580 1.1 riz break;
1581 1.1 riz default:
1582 1.6 msaitoh break;
1583 1.6 msaitoh }
1584 1.6 msaitoh }
1585 1.6 msaitoh
1586 1.6 msaitoh if (sc->sk_type == SK_YUKON_FE) {
1587 1.6 msaitoh switch (sc->sk_rev) {
1588 1.6 msaitoh case SK_YUKON_FE_REV_A1:
1589 1.6 msaitoh revstr = "A1";
1590 1.6 msaitoh break;
1591 1.6 msaitoh case SK_YUKON_FE_REV_A2:
1592 1.6 msaitoh revstr = "A2";
1593 1.6 msaitoh break;
1594 1.6 msaitoh default:
1595 1.6 msaitoh break;
1596 1.1 riz }
1597 1.1 riz }
1598 1.1 riz
1599 1.1 riz if (sc->sk_type == SK_YUKON_EC_U) {
1600 1.1 riz switch (sc->sk_rev) {
1601 1.1 riz case SK_YUKON_EC_U_REV_A0:
1602 1.1 riz revstr = "A0";
1603 1.1 riz break;
1604 1.1 riz case SK_YUKON_EC_U_REV_A1:
1605 1.1 riz revstr = "A1";
1606 1.1 riz break;
1607 1.6 msaitoh case SK_YUKON_EC_U_REV_B0:
1608 1.6 msaitoh revstr = "B0";
1609 1.6 msaitoh break;
1610 1.56 jdolecek case SK_YUKON_EC_U_REV_B1:
1611 1.56 jdolecek revstr = "B1";
1612 1.56 jdolecek break;
1613 1.1 riz default:
1614 1.6 msaitoh break;
1615 1.1 riz }
1616 1.1 riz }
1617 1.1 riz
1618 1.56 jdolecek if (sc->sk_type == SK_YUKON_FE) {
1619 1.56 jdolecek switch (sc->sk_rev) {
1620 1.56 jdolecek case SK_YUKON_FE_REV_A1:
1621 1.56 jdolecek revstr = "A1";
1622 1.56 jdolecek break;
1623 1.56 jdolecek case SK_YUKON_FE_REV_A2:
1624 1.56 jdolecek revstr = "A2";
1625 1.56 jdolecek break;
1626 1.56 jdolecek default:
1627 1.56 jdolecek ;
1628 1.56 jdolecek }
1629 1.56 jdolecek }
1630 1.56 jdolecek
1631 1.56 jdolecek if (sc->sk_type == SK_YUKON_FE_P && sc->sk_rev == SK_YUKON_FE_P_REV_A0)
1632 1.56 jdolecek revstr = "A0";
1633 1.56 jdolecek
1634 1.56 jdolecek if (sc->sk_type == SK_YUKON_EX) {
1635 1.56 jdolecek switch (sc->sk_rev) {
1636 1.56 jdolecek case SK_YUKON_EX_REV_A0:
1637 1.56 jdolecek revstr = "A0";
1638 1.56 jdolecek break;
1639 1.56 jdolecek case SK_YUKON_EX_REV_B0:
1640 1.56 jdolecek revstr = "B0";
1641 1.56 jdolecek break;
1642 1.56 jdolecek default:
1643 1.56 jdolecek ;
1644 1.56 jdolecek }
1645 1.56 jdolecek }
1646 1.56 jdolecek
1647 1.56 jdolecek if (sc->sk_type == SK_YUKON_SUPR) {
1648 1.56 jdolecek switch (sc->sk_rev) {
1649 1.56 jdolecek case SK_YUKON_SUPR_REV_A0:
1650 1.56 jdolecek revstr = "A0";
1651 1.56 jdolecek break;
1652 1.56 jdolecek case SK_YUKON_SUPR_REV_B0:
1653 1.56 jdolecek revstr = "B0";
1654 1.56 jdolecek break;
1655 1.56 jdolecek case SK_YUKON_SUPR_REV_B1:
1656 1.56 jdolecek revstr = "B1";
1657 1.56 jdolecek break;
1658 1.56 jdolecek default:
1659 1.56 jdolecek ;
1660 1.56 jdolecek }
1661 1.56 jdolecek }
1662 1.56 jdolecek
1663 1.56 jdolecek if (sc->sk_type == SK_YUKON_PRM) {
1664 1.56 jdolecek switch (sc->sk_rev) {
1665 1.56 jdolecek case SK_YUKON_PRM_REV_Z1:
1666 1.56 jdolecek revstr = "Z1";
1667 1.56 jdolecek break;
1668 1.56 jdolecek case SK_YUKON_PRM_REV_A0:
1669 1.56 jdolecek revstr = "A0";
1670 1.56 jdolecek break;
1671 1.56 jdolecek default:
1672 1.56 jdolecek ;
1673 1.56 jdolecek }
1674 1.56 jdolecek }
1675 1.56 jdolecek
1676 1.1 riz /* Announce the product name. */
1677 1.1 riz aprint_normal(", %s", sc->sk_name);
1678 1.1 riz if (revstr != NULL)
1679 1.1 riz aprint_normal(" rev. %s", revstr);
1680 1.1 riz aprint_normal(" (0x%x): %s\n", sc->sk_rev, intrstr);
1681 1.1 riz
1682 1.1 riz sc->sk_macs = 1;
1683 1.1 riz
1684 1.1 riz hw = sk_win_read_1(sc, SK_Y2_HWRES);
1685 1.1 riz if ((hw & SK_Y2_HWRES_LINK_MASK) == SK_Y2_HWRES_LINK_DUAL) {
1686 1.1 riz if ((sk_win_read_1(sc, SK_Y2_CLKGATE) &
1687 1.1 riz SK_Y2_CLKGATE_LINK2_INACTIVE) == 0)
1688 1.1 riz sc->sk_macs++;
1689 1.1 riz }
1690 1.1 riz
1691 1.1 riz skca.skc_port = SK_PORT_A;
1692 1.1 riz skca.skc_type = sc->sk_type;
1693 1.1 riz skca.skc_rev = sc->sk_rev;
1694 1.30 christos (void)config_found(sc->sk_dev, &skca, mskcprint);
1695 1.1 riz
1696 1.1 riz if (sc->sk_macs > 1) {
1697 1.1 riz skca.skc_port = SK_PORT_B;
1698 1.1 riz skca.skc_type = sc->sk_type;
1699 1.1 riz skca.skc_rev = sc->sk_rev;
1700 1.30 christos (void)config_found(sc->sk_dev, &skca, mskcprint);
1701 1.1 riz }
1702 1.1 riz
1703 1.1 riz /* Turn on the 'driver is loaded' LED. */
1704 1.1 riz CSR_WRITE_2(sc, SK_LED, SK_LED_GREEN_ON);
1705 1.1 riz
1706 1.1 riz /* skc sysctl setup */
1707 1.1 riz
1708 1.1 riz if ((rc = sysctl_createv(&sc->sk_clog, 0, NULL, &node,
1709 1.30 christos 0, CTLTYPE_NODE, device_xname(sc->sk_dev),
1710 1.1 riz SYSCTL_DESCR("mskc per-controller controls"),
1711 1.1 riz NULL, 0, NULL, 0, CTL_HW, msk_root_num, CTL_CREATE,
1712 1.1 riz CTL_EOL)) != 0) {
1713 1.30 christos aprint_normal_dev(sc->sk_dev, "couldn't create sysctl node\n");
1714 1.1 riz goto fail_6;
1715 1.1 riz }
1716 1.1 riz
1717 1.1 riz sk_nodenum = node->sysctl_num;
1718 1.1 riz
1719 1.1 riz /* interrupt moderation time in usecs */
1720 1.1 riz if ((rc = sysctl_createv(&sc->sk_clog, 0, NULL, &node,
1721 1.1 riz CTLFLAG_READWRITE,
1722 1.1 riz CTLTYPE_INT, "int_mod",
1723 1.1 riz SYSCTL_DESCR("msk interrupt moderation timer"),
1724 1.40 dsl msk_sysctl_handler, 0, (void *)sc,
1725 1.1 riz 0, CTL_HW, msk_root_num, sk_nodenum, CTL_CREATE,
1726 1.1 riz CTL_EOL)) != 0) {
1727 1.83 msaitoh aprint_normal_dev(sc->sk_dev,
1728 1.83 msaitoh "couldn't create int_mod sysctl node\n");
1729 1.1 riz goto fail_6;
1730 1.1 riz }
1731 1.1 riz
1732 1.20 joerg if (!pmf_device_register(self, mskc_suspend, mskc_resume))
1733 1.20 joerg aprint_error_dev(self, "couldn't establish power handler\n");
1734 1.20 joerg
1735 1.1 riz return;
1736 1.1 riz
1737 1.68 jdolecek fail_6:
1738 1.1 riz bus_dmamap_unload(sc->sc_dmatag, sc->sk_status_map);
1739 1.1 riz fail_4:
1740 1.43 christos bus_dmamem_unmap(sc->sc_dmatag, kva,
1741 1.1 riz MSK_STATUS_RING_CNT * sizeof(struct msk_status_desc));
1742 1.1 riz fail_3:
1743 1.63 jdolecek bus_dmamem_free(sc->sc_dmatag,
1744 1.63 jdolecek &sc->sk_status_seg, sc->sk_status_nseg);
1745 1.63 jdolecek sc->sk_status_nseg = 0;
1746 1.68 jdolecek fail_5:
1747 1.68 jdolecek bus_dmamap_destroy(sc->sc_dmatag, sc->sk_status_map);
1748 1.1 riz fail_2:
1749 1.1 riz pci_intr_disestablish(pc, sc->sk_intrhand);
1750 1.63 jdolecek sc->sk_intrhand = NULL;
1751 1.1 riz fail_1:
1752 1.77 jakllsch bus_space_unmap(sc->sk_btag, sc->sk_bhandle, sc->sk_bsize);
1753 1.63 jdolecek sc->sk_bsize = 0;
1754 1.63 jdolecek }
1755 1.63 jdolecek
1756 1.95 maxv static int
1757 1.63 jdolecek mskc_detach(device_t self, int flags)
1758 1.63 jdolecek {
1759 1.70 jdolecek struct sk_softc *sc = device_private(self);
1760 1.63 jdolecek int rv;
1761 1.63 jdolecek
1762 1.77 jakllsch if (sc->sk_intrhand) {
1763 1.68 jdolecek pci_intr_disestablish(sc->sk_pc, sc->sk_intrhand);
1764 1.77 jakllsch sc->sk_intrhand = NULL;
1765 1.77 jakllsch }
1766 1.68 jdolecek
1767 1.79 jmcneill if (sc->sk_pihp != NULL) {
1768 1.79 jmcneill pci_intr_release(sc->sk_pc, sc->sk_pihp, 1);
1769 1.79 jmcneill sc->sk_pihp = NULL;
1770 1.79 jmcneill }
1771 1.79 jmcneill
1772 1.63 jdolecek rv = config_detach_children(self, flags);
1773 1.63 jdolecek if (rv != 0)
1774 1.88 msaitoh return rv;
1775 1.63 jdolecek
1776 1.63 jdolecek if (sc->sk_status_nseg > 0) {
1777 1.63 jdolecek bus_dmamap_destroy(sc->sc_dmatag, sc->sk_status_map);
1778 1.63 jdolecek bus_dmamem_unmap(sc->sc_dmatag, sc->sk_status_ring,
1779 1.63 jdolecek MSK_STATUS_RING_CNT * sizeof(struct msk_status_desc));
1780 1.63 jdolecek bus_dmamem_free(sc->sc_dmatag,
1781 1.63 jdolecek &sc->sk_status_seg, sc->sk_status_nseg);
1782 1.63 jdolecek }
1783 1.63 jdolecek
1784 1.63 jdolecek if (sc->sk_bsize > 0)
1785 1.63 jdolecek bus_space_unmap(sc->sk_btag, sc->sk_bhandle, sc->sk_bsize);
1786 1.63 jdolecek
1787 1.88 msaitoh return 0;
1788 1.1 riz }
1789 1.1 riz
1790 1.95 maxv static int
1791 1.83 msaitoh msk_encap(struct sk_if_softc *sc_if, struct mbuf *m_head, uint32_t *txidx)
1792 1.1 riz {
1793 1.1 riz struct sk_softc *sc = sc_if->sk_softc;
1794 1.1 riz struct msk_tx_desc *f = NULL;
1795 1.83 msaitoh uint32_t frag, cur, hiaddr, old_hiaddr, total;
1796 1.83 msaitoh uint32_t entries = 0;
1797 1.78 jakllsch size_t i;
1798 1.1 riz struct sk_txmap_entry *entry;
1799 1.1 riz bus_dmamap_t txmap;
1800 1.78 jakllsch bus_addr_t addr;
1801 1.1 riz
1802 1.1 riz DPRINTFN(2, ("msk_encap\n"));
1803 1.1 riz
1804 1.1 riz entry = SIMPLEQ_FIRST(&sc_if->sk_txmap_head);
1805 1.1 riz if (entry == NULL) {
1806 1.1 riz DPRINTFN(2, ("msk_encap: no txmap available\n"));
1807 1.88 msaitoh return ENOBUFS;
1808 1.1 riz }
1809 1.1 riz txmap = entry->dmamap;
1810 1.1 riz
1811 1.1 riz cur = frag = *txidx;
1812 1.1 riz
1813 1.1 riz #ifdef MSK_DEBUG
1814 1.1 riz if (mskdebug >= 2)
1815 1.1 riz msk_dump_mbuf(m_head);
1816 1.1 riz #endif
1817 1.1 riz
1818 1.1 riz /*
1819 1.1 riz * Start packing the mbufs in this chain into
1820 1.1 riz * the fragment pointers. Stop when we run out
1821 1.1 riz * of fragments or hit the end of the mbuf chain.
1822 1.1 riz */
1823 1.1 riz if (bus_dmamap_load_mbuf(sc->sc_dmatag, txmap, m_head,
1824 1.1 riz BUS_DMA_NOWAIT)) {
1825 1.1 riz DPRINTFN(2, ("msk_encap: dmamap failed\n"));
1826 1.88 msaitoh return ENOBUFS;
1827 1.1 riz }
1828 1.1 riz
1829 1.78 jakllsch /* Count how many tx descriptors needed. */
1830 1.78 jakllsch hiaddr = sc_if->sk_cdata.sk_tx_hiaddr;
1831 1.78 jakllsch for (total = i = 0; i < txmap->dm_nsegs; i++) {
1832 1.78 jakllsch if (hiaddr != MSK_ADDR_HI(txmap->dm_segs[i].ds_addr)) {
1833 1.78 jakllsch hiaddr = MSK_ADDR_HI(txmap->dm_segs[i].ds_addr);
1834 1.78 jakllsch total++;
1835 1.78 jakllsch }
1836 1.78 jakllsch total++;
1837 1.78 jakllsch }
1838 1.78 jakllsch
1839 1.78 jakllsch if (total > MSK_TX_RING_CNT - sc_if->sk_cdata.sk_tx_cnt - 2) {
1840 1.5 msaitoh DPRINTFN(2, ("msk_encap: too few descriptors free\n"));
1841 1.5 msaitoh bus_dmamap_unload(sc->sc_dmatag, txmap);
1842 1.88 msaitoh return ENOBUFS;
1843 1.5 msaitoh }
1844 1.5 msaitoh
1845 1.78 jakllsch DPRINTFN(2, ("msk_encap: dm_nsegs=%d total desc=%u\n",
1846 1.78 jakllsch txmap->dm_nsegs, total));
1847 1.1 riz
1848 1.1 riz /* Sync the DMA map. */
1849 1.1 riz bus_dmamap_sync(sc->sc_dmatag, txmap, 0, txmap->dm_mapsize,
1850 1.1 riz BUS_DMASYNC_PREWRITE);
1851 1.1 riz
1852 1.78 jakllsch old_hiaddr = sc_if->sk_cdata.sk_tx_hiaddr;
1853 1.1 riz for (i = 0; i < txmap->dm_nsegs; i++) {
1854 1.78 jakllsch addr = txmap->dm_segs[i].ds_addr;
1855 1.78 jakllsch DPRINTFN(2, ("msk_encap: addr %llx\n",
1856 1.78 jakllsch (unsigned long long)addr));
1857 1.78 jakllsch hiaddr = MSK_ADDR_HI(addr);
1858 1.78 jakllsch
1859 1.78 jakllsch if (sc_if->sk_cdata.sk_tx_hiaddr != hiaddr) {
1860 1.78 jakllsch f = &sc_if->sk_rdata->sk_tx_ring[frag];
1861 1.78 jakllsch f->sk_addr = htole32(hiaddr);
1862 1.78 jakllsch f->sk_len = 0;
1863 1.78 jakllsch f->sk_ctl = 0;
1864 1.78 jakllsch if (i == 0)
1865 1.78 jakllsch f->sk_opcode = SK_Y2_BMUOPC_ADDR64;
1866 1.78 jakllsch else
1867 1.78 jakllsch f->sk_opcode = SK_Y2_BMUOPC_ADDR64 | SK_Y2_TXOPC_OWN;
1868 1.78 jakllsch sc_if->sk_cdata.sk_tx_hiaddr = hiaddr;
1869 1.78 jakllsch SK_INC(frag, MSK_TX_RING_CNT);
1870 1.78 jakllsch entries++;
1871 1.78 jakllsch DPRINTFN(10, ("%s: tx ADDR64: %#x\n",
1872 1.78 jakllsch sc_if->sk_ethercom.ec_if.if_xname, hiaddr));
1873 1.78 jakllsch }
1874 1.78 jakllsch
1875 1.1 riz f = &sc_if->sk_rdata->sk_tx_ring[frag];
1876 1.78 jakllsch f->sk_addr = htole32(MSK_ADDR_LO(addr));
1877 1.1 riz f->sk_len = htole16(txmap->dm_segs[i].ds_len);
1878 1.1 riz f->sk_ctl = 0;
1879 1.78 jakllsch if (i == 0) {
1880 1.78 jakllsch if (hiaddr != old_hiaddr)
1881 1.78 jakllsch f->sk_opcode = SK_Y2_TXOPC_PACKET | SK_Y2_TXOPC_OWN;
1882 1.78 jakllsch else
1883 1.78 jakllsch f->sk_opcode = SK_Y2_TXOPC_PACKET;
1884 1.78 jakllsch } else
1885 1.1 riz f->sk_opcode = SK_Y2_TXOPC_BUFFER | SK_Y2_TXOPC_OWN;
1886 1.1 riz cur = frag;
1887 1.1 riz SK_INC(frag, MSK_TX_RING_CNT);
1888 1.78 jakllsch entries++;
1889 1.1 riz }
1890 1.78 jakllsch KASSERTMSG(entries == total, "entries %u total %u", entries, total);
1891 1.1 riz
1892 1.1 riz sc_if->sk_cdata.sk_tx_chain[cur].sk_mbuf = m_head;
1893 1.1 riz SIMPLEQ_REMOVE_HEAD(&sc_if->sk_txmap_head, link);
1894 1.1 riz
1895 1.1 riz sc_if->sk_cdata.sk_tx_map[cur] = entry;
1896 1.1 riz sc_if->sk_rdata->sk_tx_ring[cur].sk_ctl |= SK_Y2_TXCTL_LASTFRAG;
1897 1.1 riz
1898 1.1 riz /* Sync descriptors before handing to chip */
1899 1.78 jakllsch MSK_CDTXSYNC(sc_if, *txidx, entries,
1900 1.88 msaitoh BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1901 1.1 riz
1902 1.1 riz sc_if->sk_rdata->sk_tx_ring[*txidx].sk_opcode |= SK_Y2_TXOPC_OWN;
1903 1.1 riz
1904 1.1 riz /* Sync first descriptor to hand it off */
1905 1.1 riz MSK_CDTXSYNC(sc_if, *txidx, 1,
1906 1.88 msaitoh BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1907 1.1 riz
1908 1.78 jakllsch sc_if->sk_cdata.sk_tx_cnt += entries;
1909 1.1 riz
1910 1.1 riz #ifdef MSK_DEBUG
1911 1.1 riz if (mskdebug >= 2) {
1912 1.1 riz struct msk_tx_desc *le;
1913 1.83 msaitoh uint32_t idx;
1914 1.1 riz for (idx = *txidx; idx != frag; SK_INC(idx, MSK_TX_RING_CNT)) {
1915 1.1 riz le = &sc_if->sk_rdata->sk_tx_ring[idx];
1916 1.1 riz msk_dump_txdesc(le, idx);
1917 1.1 riz }
1918 1.1 riz }
1919 1.1 riz #endif
1920 1.1 riz
1921 1.1 riz *txidx = frag;
1922 1.1 riz
1923 1.82 mrg DPRINTFN(2, ("msk_encap: successful: %u entries\n", entries));
1924 1.1 riz
1925 1.88 msaitoh return 0;
1926 1.1 riz }
1927 1.1 riz
1928 1.95 maxv static void
1929 1.1 riz msk_start(struct ifnet *ifp)
1930 1.1 riz {
1931 1.59 jdolecek struct sk_if_softc *sc_if = ifp->if_softc;
1932 1.59 jdolecek struct mbuf *m_head = NULL;
1933 1.83 msaitoh uint32_t idx = sc_if->sk_cdata.sk_tx_prod;
1934 1.1 riz int pkts = 0;
1935 1.1 riz
1936 1.1 riz DPRINTFN(2, ("msk_start\n"));
1937 1.1 riz
1938 1.1 riz while (sc_if->sk_cdata.sk_tx_chain[idx].sk_mbuf == NULL) {
1939 1.1 riz IFQ_POLL(&ifp->if_snd, m_head);
1940 1.1 riz if (m_head == NULL)
1941 1.1 riz break;
1942 1.1 riz
1943 1.1 riz /*
1944 1.1 riz * Pack the data into the transmit ring. If we
1945 1.1 riz * don't have room, set the OACTIVE flag and wait
1946 1.1 riz * for the NIC to drain the ring.
1947 1.1 riz */
1948 1.1 riz if (msk_encap(sc_if, m_head, &idx)) {
1949 1.1 riz ifp->if_flags |= IFF_OACTIVE;
1950 1.1 riz break;
1951 1.1 riz }
1952 1.1 riz
1953 1.1 riz /* now we are committed to transmit the packet */
1954 1.1 riz IFQ_DEQUEUE(&ifp->if_snd, m_head);
1955 1.1 riz pkts++;
1956 1.1 riz
1957 1.1 riz /*
1958 1.1 riz * If there's a BPF listener, bounce a copy of this frame
1959 1.1 riz * to him.
1960 1.1 riz */
1961 1.67 msaitoh bpf_mtap(ifp, m_head, BPF_D_OUT);
1962 1.1 riz }
1963 1.1 riz if (pkts == 0)
1964 1.1 riz return;
1965 1.1 riz
1966 1.1 riz /* Transmit */
1967 1.1 riz if (idx != sc_if->sk_cdata.sk_tx_prod) {
1968 1.1 riz sc_if->sk_cdata.sk_tx_prod = idx;
1969 1.1 riz SK_IF_WRITE_2(sc_if, 1, SK_TXQA1_Y2_PREF_PUTIDX, idx);
1970 1.1 riz
1971 1.1 riz /* Set a timeout in case the chip goes out to lunch. */
1972 1.1 riz ifp->if_timer = 5;
1973 1.1 riz }
1974 1.1 riz }
1975 1.1 riz
1976 1.95 maxv static void
1977 1.1 riz msk_watchdog(struct ifnet *ifp)
1978 1.1 riz {
1979 1.1 riz struct sk_if_softc *sc_if = ifp->if_softc;
1980 1.1 riz
1981 1.1 riz /*
1982 1.1 riz * Reclaim first as there is a possibility of losing Tx completion
1983 1.1 riz * interrupts.
1984 1.1 riz */
1985 1.68 jdolecek msk_txeof(sc_if);
1986 1.68 jdolecek if (sc_if->sk_cdata.sk_tx_cnt != 0) {
1987 1.68 jdolecek aprint_error_dev(sc_if->sk_dev, "watchdog timeout\n");
1988 1.68 jdolecek
1989 1.68 jdolecek ifp->if_oerrors++;
1990 1.68 jdolecek
1991 1.68 jdolecek /* XXX Resets both ports; we shouldn't do that. */
1992 1.68 jdolecek mskc_reset(sc_if->sk_softc);
1993 1.68 jdolecek msk_reset(sc_if);
1994 1.68 jdolecek msk_init(ifp);
1995 1.1 riz }
1996 1.1 riz }
1997 1.1 riz
1998 1.20 joerg static bool
1999 1.33 dyoung mskc_suspend(device_t dv, const pmf_qual_t *qual)
2000 1.1 riz {
2001 1.20 joerg struct sk_softc *sc = device_private(dv);
2002 1.1 riz
2003 1.20 joerg DPRINTFN(2, ("mskc_suspend\n"));
2004 1.1 riz
2005 1.1 riz /* Turn off the 'driver is loaded' LED. */
2006 1.1 riz CSR_WRITE_2(sc, SK_LED, SK_LED_GREEN_OFF);
2007 1.1 riz
2008 1.20 joerg return true;
2009 1.20 joerg }
2010 1.20 joerg
2011 1.20 joerg static bool
2012 1.33 dyoung mskc_resume(device_t dv, const pmf_qual_t *qual)
2013 1.20 joerg {
2014 1.20 joerg struct sk_softc *sc = device_private(dv);
2015 1.20 joerg
2016 1.20 joerg DPRINTFN(2, ("mskc_resume\n"));
2017 1.20 joerg
2018 1.63 jdolecek mskc_reset(sc);
2019 1.20 joerg CSR_WRITE_2(sc, SK_LED, SK_LED_GREEN_ON);
2020 1.20 joerg
2021 1.20 joerg return true;
2022 1.1 riz }
2023 1.1 riz
2024 1.38 plunky static __inline int
2025 1.83 msaitoh msk_rxvalid(struct sk_softc *sc, uint32_t stat, uint32_t len)
2026 1.1 riz {
2027 1.1 riz if ((stat & (YU_RXSTAT_CRCERR | YU_RXSTAT_LONGERR |
2028 1.1 riz YU_RXSTAT_MIIERR | YU_RXSTAT_BADFC | YU_RXSTAT_GOODFC |
2029 1.1 riz YU_RXSTAT_JABBER)) != 0 ||
2030 1.1 riz (stat & YU_RXSTAT_RXOK) != YU_RXSTAT_RXOK ||
2031 1.1 riz YU_RXSTAT_BYTES(stat) != len)
2032 1.88 msaitoh return 0;
2033 1.1 riz
2034 1.88 msaitoh return 1;
2035 1.1 riz }
2036 1.1 riz
2037 1.95 maxv static void
2038 1.83 msaitoh msk_rxeof(struct sk_if_softc *sc_if, uint16_t len, uint32_t rxstat)
2039 1.1 riz {
2040 1.1 riz struct sk_softc *sc = sc_if->sk_softc;
2041 1.1 riz struct ifnet *ifp = &sc_if->sk_ethercom.ec_if;
2042 1.1 riz struct mbuf *m;
2043 1.78 jakllsch unsigned cur, prod, tail, total_len = len;
2044 1.1 riz bus_dmamap_t dmamap;
2045 1.1 riz
2046 1.1 riz cur = sc_if->sk_cdata.sk_rx_cons;
2047 1.78 jakllsch prod = sc_if->sk_cdata.sk_rx_prod;
2048 1.1 riz
2049 1.1 riz /* Sync the descriptor */
2050 1.88 msaitoh MSK_CDRXSYNC(sc_if, cur, BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
2051 1.1 riz
2052 1.83 msaitoh DPRINTFN(2, ("msk_rxeof: cur %u prod %u rx_cnt %u\n", cur, prod,
2053 1.83 msaitoh sc_if->sk_cdata.sk_rx_cnt));
2054 1.78 jakllsch
2055 1.78 jakllsch while (prod != cur) {
2056 1.78 jakllsch tail = cur;
2057 1.78 jakllsch SK_INC(cur, MSK_RX_RING_CNT);
2058 1.78 jakllsch
2059 1.78 jakllsch sc_if->sk_cdata.sk_rx_cnt--;
2060 1.78 jakllsch m = sc_if->sk_cdata.sk_rx_chain[tail].sk_mbuf;
2061 1.78 jakllsch sc_if->sk_cdata.sk_rx_chain[tail].sk_mbuf = NULL;
2062 1.78 jakllsch if (m != NULL)
2063 1.78 jakllsch break; /* found it */
2064 1.78 jakllsch }
2065 1.78 jakllsch sc_if->sk_cdata.sk_rx_cons = cur;
2066 1.83 msaitoh DPRINTFN(2, ("msk_rxeof: cur %u rx_cnt %u m %p\n", cur,
2067 1.83 msaitoh sc_if->sk_cdata.sk_rx_cnt, m));
2068 1.78 jakllsch
2069 1.78 jakllsch if (m == NULL)
2070 1.42 riastrad return;
2071 1.42 riastrad
2072 1.1 riz dmamap = sc_if->sk_cdata.sk_rx_jumbo_map;
2073 1.68 jdolecek
2074 1.1 riz bus_dmamap_sync(sc_if->sk_softc->sc_dmatag, dmamap, 0,
2075 1.1 riz dmamap->dm_mapsize, BUS_DMASYNC_POSTREAD);
2076 1.1 riz
2077 1.1 riz if (total_len < SK_MIN_FRAMELEN ||
2078 1.19 dyoung total_len > ETHER_MAX_LEN_JUMBO ||
2079 1.1 riz msk_rxvalid(sc, rxstat, total_len) == 0) {
2080 1.1 riz ifp->if_ierrors++;
2081 1.72 jdolecek m_freem(m);
2082 1.1 riz return;
2083 1.1 riz }
2084 1.1 riz
2085 1.72 jdolecek m_set_rcvif(m, ifp);
2086 1.72 jdolecek m->m_pkthdr.len = m->m_len = total_len;
2087 1.1 riz
2088 1.1 riz /* pass it on. */
2089 1.49 ozaki if_percpuq_enqueue(ifp->if_percpuq, m);
2090 1.1 riz }
2091 1.1 riz
2092 1.95 maxv static void
2093 1.68 jdolecek msk_txeof(struct sk_if_softc *sc_if)
2094 1.1 riz {
2095 1.1 riz struct sk_softc *sc = sc_if->sk_softc;
2096 1.1 riz struct msk_tx_desc *cur_tx;
2097 1.1 riz struct ifnet *ifp = &sc_if->sk_ethercom.ec_if;
2098 1.83 msaitoh uint32_t idx, reg, sk_ctl;
2099 1.1 riz struct sk_txmap_entry *entry;
2100 1.1 riz
2101 1.1 riz DPRINTFN(2, ("msk_txeof\n"));
2102 1.1 riz
2103 1.68 jdolecek if (sc_if->sk_port == SK_PORT_A)
2104 1.68 jdolecek reg = SK_STAT_BMU_TXA1_RIDX;
2105 1.68 jdolecek else
2106 1.68 jdolecek reg = SK_STAT_BMU_TXA2_RIDX;
2107 1.68 jdolecek
2108 1.1 riz /*
2109 1.1 riz * Go through our tx ring and free mbufs for those
2110 1.1 riz * frames that have been sent.
2111 1.1 riz */
2112 1.68 jdolecek idx = sc_if->sk_cdata.sk_tx_cons;
2113 1.68 jdolecek while (idx != sk_win_read_2(sc, reg)) {
2114 1.68 jdolecek MSK_CDTXSYNC(sc_if, idx, 1,
2115 1.88 msaitoh BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
2116 1.17 kiyohara
2117 1.68 jdolecek cur_tx = &sc_if->sk_rdata->sk_tx_ring[idx];
2118 1.5 msaitoh sk_ctl = cur_tx->sk_ctl;
2119 1.1 riz #ifdef MSK_DEBUG
2120 1.1 riz if (mskdebug >= 2)
2121 1.68 jdolecek msk_dump_txdesc(cur_tx, idx);
2122 1.1 riz #endif
2123 1.5 msaitoh if (sk_ctl & SK_Y2_TXCTL_LASTFRAG)
2124 1.1 riz ifp->if_opackets++;
2125 1.68 jdolecek if (sc_if->sk_cdata.sk_tx_chain[idx].sk_mbuf != NULL) {
2126 1.68 jdolecek entry = sc_if->sk_cdata.sk_tx_map[idx];
2127 1.68 jdolecek
2128 1.1 riz bus_dmamap_sync(sc->sc_dmatag, entry->dmamap, 0,
2129 1.1 riz entry->dmamap->dm_mapsize, BUS_DMASYNC_POSTWRITE);
2130 1.1 riz
2131 1.1 riz bus_dmamap_unload(sc->sc_dmatag, entry->dmamap);
2132 1.1 riz SIMPLEQ_INSERT_TAIL(&sc_if->sk_txmap_head, entry,
2133 1.1 riz link);
2134 1.68 jdolecek sc_if->sk_cdata.sk_tx_map[idx] = NULL;
2135 1.92 msaitoh m_freem(sc_if->sk_cdata.sk_tx_chain[idx].sk_mbuf);
2136 1.92 msaitoh sc_if->sk_cdata.sk_tx_chain[idx].sk_mbuf = NULL;
2137 1.1 riz }
2138 1.1 riz sc_if->sk_cdata.sk_tx_cnt--;
2139 1.68 jdolecek SK_INC(idx, MSK_TX_RING_CNT);
2140 1.1 riz }
2141 1.78 jakllsch if (idx == sc_if->sk_cdata.sk_tx_cons)
2142 1.78 jakllsch return;
2143 1.78 jakllsch
2144 1.1 riz ifp->if_timer = sc_if->sk_cdata.sk_tx_cnt > 0 ? 5 : 0;
2145 1.1 riz
2146 1.1 riz if (sc_if->sk_cdata.sk_tx_cnt < MSK_TX_RING_CNT - 2)
2147 1.1 riz ifp->if_flags &= ~IFF_OACTIVE;
2148 1.1 riz
2149 1.68 jdolecek sc_if->sk_cdata.sk_tx_cons = idx;
2150 1.68 jdolecek }
2151 1.68 jdolecek
2152 1.95 maxv static void
2153 1.68 jdolecek msk_fill_rx_ring(struct sk_if_softc *sc_if)
2154 1.68 jdolecek {
2155 1.68 jdolecek /* Make sure to not completely wrap around */
2156 1.68 jdolecek while (sc_if->sk_cdata.sk_rx_cnt < (MSK_RX_RING_CNT - 1)) {
2157 1.72 jdolecek if (msk_newbuf(sc_if,
2158 1.68 jdolecek sc_if->sk_cdata.sk_rx_jumbo_map) == ENOBUFS) {
2159 1.72 jdolecek goto schedretry;
2160 1.68 jdolecek }
2161 1.68 jdolecek }
2162 1.72 jdolecek
2163 1.72 jdolecek return;
2164 1.72 jdolecek
2165 1.72 jdolecek schedretry:
2166 1.72 jdolecek /* Try later */
2167 1.72 jdolecek callout_schedule(&sc_if->sk_tick_rx, hz/2);
2168 1.72 jdolecek }
2169 1.72 jdolecek
2170 1.72 jdolecek static void
2171 1.72 jdolecek msk_fill_rx_tick(void *xsc_if)
2172 1.72 jdolecek {
2173 1.72 jdolecek struct sk_if_softc *sc_if = xsc_if;
2174 1.72 jdolecek int s, rx_prod;
2175 1.72 jdolecek
2176 1.89 msaitoh KASSERT(KERNEL_LOCKED_P()); /* XXXSMP */
2177 1.72 jdolecek
2178 1.72 jdolecek s = splnet();
2179 1.72 jdolecek rx_prod = sc_if->sk_cdata.sk_rx_prod;
2180 1.72 jdolecek msk_fill_rx_ring(sc_if);
2181 1.72 jdolecek if (rx_prod != sc_if->sk_cdata.sk_rx_prod) {
2182 1.72 jdolecek SK_IF_WRITE_2(sc_if, 0, SK_RXQ1_Y2_PREF_PUTIDX,
2183 1.72 jdolecek sc_if->sk_cdata.sk_rx_prod);
2184 1.72 jdolecek }
2185 1.72 jdolecek splx(s);
2186 1.1 riz }
2187 1.1 riz
2188 1.95 maxv static void
2189 1.5 msaitoh msk_tick(void *xsc_if)
2190 1.1 riz {
2191 1.59 jdolecek struct sk_if_softc *sc_if = xsc_if;
2192 1.1 riz struct mii_data *mii = &sc_if->sk_mii;
2193 1.22 chris int s;
2194 1.1 riz
2195 1.22 chris s = splnet();
2196 1.62 jdolecek mii_tick(mii);
2197 1.22 chris splx(s);
2198 1.22 chris
2199 1.1 riz callout_schedule(&sc_if->sk_tick_ch, hz);
2200 1.1 riz }
2201 1.1 riz
2202 1.95 maxv static void
2203 1.1 riz msk_intr_yukon(struct sk_if_softc *sc_if)
2204 1.1 riz {
2205 1.83 msaitoh uint8_t status;
2206 1.1 riz
2207 1.1 riz status = SK_IF_READ_1(sc_if, 0, SK_GMAC_ISR);
2208 1.1 riz /* RX overrun */
2209 1.1 riz if ((status & SK_GMAC_INT_RX_OVER) != 0) {
2210 1.1 riz SK_IF_WRITE_1(sc_if, 0, SK_RXMF1_CTRL_TEST,
2211 1.1 riz SK_RFCTL_RX_FIFO_OVER);
2212 1.1 riz }
2213 1.1 riz /* TX underrun */
2214 1.1 riz if ((status & SK_GMAC_INT_TX_UNDER) != 0) {
2215 1.6 msaitoh SK_IF_WRITE_1(sc_if, 0, SK_TXMF1_CTRL_TEST,
2216 1.1 riz SK_TFCTL_TX_FIFO_UNDER);
2217 1.1 riz }
2218 1.1 riz
2219 1.1 riz DPRINTFN(2, ("msk_intr_yukon status=%#x\n", status));
2220 1.1 riz }
2221 1.1 riz
2222 1.95 maxv static int
2223 1.1 riz msk_intr(void *xsc)
2224 1.1 riz {
2225 1.1 riz struct sk_softc *sc = xsc;
2226 1.68 jdolecek struct sk_if_softc *sc_if;
2227 1.1 riz struct sk_if_softc *sc_if0 = sc->sk_if[SK_PORT_A];
2228 1.1 riz struct sk_if_softc *sc_if1 = sc->sk_if[SK_PORT_B];
2229 1.1 riz struct ifnet *ifp0 = NULL, *ifp1 = NULL;
2230 1.1 riz int claimed = 0;
2231 1.83 msaitoh uint32_t status;
2232 1.1 riz struct msk_status_desc *cur_st;
2233 1.1 riz
2234 1.1 riz status = CSR_READ_4(sc, SK_Y2_ISSR2);
2235 1.68 jdolecek if (status == 0xffffffff)
2236 1.88 msaitoh return 0;
2237 1.1 riz if (status == 0) {
2238 1.1 riz CSR_WRITE_4(sc, SK_Y2_ICR, 2);
2239 1.88 msaitoh return 0;
2240 1.1 riz }
2241 1.1 riz
2242 1.1 riz status = CSR_READ_4(sc, SK_ISR);
2243 1.1 riz
2244 1.1 riz if (sc_if0 != NULL)
2245 1.1 riz ifp0 = &sc_if0->sk_ethercom.ec_if;
2246 1.1 riz if (sc_if1 != NULL)
2247 1.1 riz ifp1 = &sc_if1->sk_ethercom.ec_if;
2248 1.1 riz
2249 1.1 riz if (sc_if0 && (status & SK_Y2_IMR_MAC1) &&
2250 1.1 riz (ifp0->if_flags & IFF_RUNNING)) {
2251 1.1 riz msk_intr_yukon(sc_if0);
2252 1.1 riz }
2253 1.1 riz
2254 1.1 riz if (sc_if1 && (status & SK_Y2_IMR_MAC2) &&
2255 1.1 riz (ifp1->if_flags & IFF_RUNNING)) {
2256 1.1 riz msk_intr_yukon(sc_if1);
2257 1.1 riz }
2258 1.1 riz
2259 1.68 jdolecek MSK_CDSTSYNC(sc, sc->sk_status_idx,
2260 1.88 msaitoh BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
2261 1.68 jdolecek cur_st = &sc->sk_status_ring[sc->sk_status_idx];
2262 1.5 msaitoh
2263 1.68 jdolecek while (cur_st->sk_opcode & SK_Y2_STOPC_OWN) {
2264 1.68 jdolecek cur_st->sk_opcode &= ~SK_Y2_STOPC_OWN;
2265 1.68 jdolecek switch (cur_st->sk_opcode) {
2266 1.1 riz case SK_Y2_STOPC_RXSTAT:
2267 1.68 jdolecek sc_if = sc->sk_if[cur_st->sk_link & 0x01];
2268 1.81 bouyer if (sc_if) {
2269 1.81 bouyer msk_rxeof(sc_if, letoh16(cur_st->sk_len),
2270 1.81 bouyer letoh32(cur_st->sk_status));
2271 1.81 bouyer if (sc_if->sk_cdata.sk_rx_cnt < (MSK_RX_RING_CNT/3))
2272 1.81 bouyer msk_fill_rx_tick(sc_if);
2273 1.81 bouyer }
2274 1.1 riz break;
2275 1.1 riz case SK_Y2_STOPC_TXSTAT:
2276 1.5 msaitoh if (sc_if0)
2277 1.68 jdolecek msk_txeof(sc_if0);
2278 1.5 msaitoh if (sc_if1)
2279 1.68 jdolecek msk_txeof(sc_if1);
2280 1.1 riz break;
2281 1.1 riz default:
2282 1.68 jdolecek aprint_error("opcode=0x%x\n", cur_st->sk_opcode);
2283 1.1 riz break;
2284 1.1 riz }
2285 1.1 riz SK_INC(sc->sk_status_idx, MSK_STATUS_RING_CNT);
2286 1.5 msaitoh
2287 1.68 jdolecek MSK_CDSTSYNC(sc, sc->sk_status_idx,
2288 1.88 msaitoh BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
2289 1.68 jdolecek cur_st = &sc->sk_status_ring[sc->sk_status_idx];
2290 1.1 riz }
2291 1.1 riz
2292 1.1 riz if (status & SK_Y2_IMR_BMU) {
2293 1.1 riz CSR_WRITE_4(sc, SK_STAT_BMU_CSR, SK_STAT_BMU_IRQ_CLEAR);
2294 1.1 riz claimed = 1;
2295 1.1 riz }
2296 1.1 riz
2297 1.1 riz CSR_WRITE_4(sc, SK_Y2_ICR, 2);
2298 1.1 riz
2299 1.68 jdolecek if (ifp0 != NULL && !IFQ_IS_EMPTY(&ifp0->if_snd))
2300 1.53 ozaki if_schedule_deferred_start(ifp0);
2301 1.68 jdolecek if (ifp1 != NULL && !IFQ_IS_EMPTY(&ifp1->if_snd))
2302 1.53 ozaki if_schedule_deferred_start(ifp1);
2303 1.1 riz
2304 1.69 jdolecek KASSERT(sc->rnd_attached > 0);
2305 1.39 tls rnd_add_uint32(&sc->rnd_source, status);
2306 1.1 riz
2307 1.1 riz if (sc->sk_int_mod_pending)
2308 1.30 christos msk_update_int_mod(sc, 1);
2309 1.1 riz
2310 1.1 riz return claimed;
2311 1.1 riz }
2312 1.1 riz
2313 1.95 maxv static void
2314 1.1 riz msk_init_yukon(struct sk_if_softc *sc_if)
2315 1.1 riz {
2316 1.83 msaitoh uint32_t v;
2317 1.83 msaitoh uint16_t reg;
2318 1.1 riz struct sk_softc *sc;
2319 1.1 riz int i;
2320 1.1 riz
2321 1.1 riz sc = sc_if->sk_softc;
2322 1.1 riz
2323 1.1 riz DPRINTFN(2, ("msk_init_yukon: start: sk_csr=%#x\n",
2324 1.1 riz CSR_READ_4(sc_if->sk_softc, SK_CSR)));
2325 1.1 riz
2326 1.1 riz DPRINTFN(6, ("msk_init_yukon: 1\n"));
2327 1.1 riz
2328 1.1 riz DPRINTFN(3, ("msk_init_yukon: gmac_ctrl=%#x\n",
2329 1.1 riz SK_IF_READ_4(sc_if, 0, SK_GMAC_CTRL)));
2330 1.1 riz
2331 1.1 riz DPRINTFN(6, ("msk_init_yukon: 3\n"));
2332 1.1 riz
2333 1.1 riz /* unused read of the interrupt source register */
2334 1.1 riz DPRINTFN(6, ("msk_init_yukon: 4\n"));
2335 1.1 riz SK_IF_READ_2(sc_if, 0, SK_GMAC_ISR);
2336 1.1 riz
2337 1.1 riz DPRINTFN(6, ("msk_init_yukon: 4a\n"));
2338 1.1 riz reg = SK_YU_READ_2(sc_if, YUKON_PAR);
2339 1.1 riz DPRINTFN(6, ("msk_init_yukon: YUKON_PAR=%#x\n", reg));
2340 1.1 riz
2341 1.1 riz /* MIB Counter Clear Mode set */
2342 1.59 jdolecek reg |= YU_PAR_MIB_CLR;
2343 1.1 riz DPRINTFN(6, ("msk_init_yukon: YUKON_PAR=%#x\n", reg));
2344 1.1 riz DPRINTFN(6, ("msk_init_yukon: 4b\n"));
2345 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_PAR, reg);
2346 1.1 riz
2347 1.1 riz /* MIB Counter Clear Mode clear */
2348 1.1 riz DPRINTFN(6, ("msk_init_yukon: 5\n"));
2349 1.59 jdolecek reg &= ~YU_PAR_MIB_CLR;
2350 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_PAR, reg);
2351 1.1 riz
2352 1.1 riz /* receive control reg */
2353 1.1 riz DPRINTFN(6, ("msk_init_yukon: 7\n"));
2354 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_RCR, YU_RCR_CRCR);
2355 1.1 riz
2356 1.6 msaitoh /* transmit control register */
2357 1.6 msaitoh SK_YU_WRITE_2(sc_if, YUKON_TCR, (0x04 << 10));
2358 1.6 msaitoh
2359 1.6 msaitoh /* transmit flow control register */
2360 1.6 msaitoh SK_YU_WRITE_2(sc_if, YUKON_TFCR, 0xffff);
2361 1.6 msaitoh
2362 1.1 riz /* transmit parameter register */
2363 1.1 riz DPRINTFN(6, ("msk_init_yukon: 8\n"));
2364 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_TPR, YU_TPR_JAM_LEN(0x3) |
2365 1.6 msaitoh YU_TPR_JAM_IPG(0xb) | YU_TPR_JAM2DATA_IPG(0x1c) | 0x04);
2366 1.1 riz
2367 1.1 riz /* serial mode register */
2368 1.1 riz DPRINTFN(6, ("msk_init_yukon: 9\n"));
2369 1.5 msaitoh reg = YU_SMR_DATA_BLIND(0x1c) |
2370 1.5 msaitoh YU_SMR_MFL_VLAN |
2371 1.5 msaitoh YU_SMR_IPG_DATA(0x1e);
2372 1.5 msaitoh
2373 1.56 jdolecek if (sc->sk_type != SK_YUKON_FE &&
2374 1.60 jdolecek sc->sk_type != SK_YUKON_FE_P)
2375 1.5 msaitoh reg |= YU_SMR_MFL_JUMBO;
2376 1.5 msaitoh
2377 1.5 msaitoh SK_YU_WRITE_2(sc_if, YUKON_SMR, reg);
2378 1.1 riz
2379 1.1 riz DPRINTFN(6, ("msk_init_yukon: 10\n"));
2380 1.50 pgoyette struct ifnet *ifp = &sc_if->sk_ethercom.ec_if;
2381 1.50 pgoyette /* msk_attach calls me before ether_ifattach so check null */
2382 1.50 pgoyette if (ifp != NULL && ifp->if_sadl != NULL)
2383 1.50 pgoyette memcpy(sc_if->sk_enaddr, CLLADDR(ifp->if_sadl),
2384 1.50 pgoyette sizeof(sc_if->sk_enaddr));
2385 1.1 riz /* Setup Yukon's address */
2386 1.1 riz for (i = 0; i < 3; i++) {
2387 1.1 riz /* Write Source Address 1 (unicast filter) */
2388 1.43 christos SK_YU_WRITE_2(sc_if, YUKON_SAL1 + i * 4,
2389 1.1 riz sc_if->sk_enaddr[i * 2] |
2390 1.1 riz sc_if->sk_enaddr[i * 2 + 1] << 8);
2391 1.1 riz }
2392 1.1 riz
2393 1.1 riz for (i = 0; i < 3; i++) {
2394 1.1 riz reg = sk_win_read_2(sc_if->sk_softc,
2395 1.1 riz SK_MAC1_0 + i * 2 + sc_if->sk_port * 8);
2396 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_SAL2 + i * 4, reg);
2397 1.1 riz }
2398 1.1 riz
2399 1.1 riz /* Set promiscuous mode */
2400 1.1 riz msk_setpromisc(sc_if);
2401 1.1 riz
2402 1.1 riz /* Set multicast filter */
2403 1.1 riz DPRINTFN(6, ("msk_init_yukon: 11\n"));
2404 1.1 riz msk_setmulti(sc_if);
2405 1.1 riz
2406 1.1 riz /* enable interrupt mask for counter overflows */
2407 1.1 riz DPRINTFN(6, ("msk_init_yukon: 12\n"));
2408 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_TIMR, 0);
2409 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_RIMR, 0);
2410 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_TRIMR, 0);
2411 1.1 riz
2412 1.1 riz /* Configure RX MAC FIFO Flush Mask */
2413 1.1 riz v = YU_RXSTAT_FOFL | YU_RXSTAT_CRCERR | YU_RXSTAT_MIIERR |
2414 1.1 riz YU_RXSTAT_BADFC | YU_RXSTAT_GOODFC | YU_RXSTAT_RUNT |
2415 1.1 riz YU_RXSTAT_JABBER;
2416 1.1 riz SK_IF_WRITE_2(sc_if, 0, SK_RXMF1_FLUSH_MASK, v);
2417 1.1 riz
2418 1.1 riz /* Configure RX MAC FIFO */
2419 1.1 riz SK_IF_WRITE_1(sc_if, 0, SK_RXMF1_CTRL_TEST, SK_RFCTL_RESET_CLEAR);
2420 1.94 msaitoh v = SK_RFCTL_OPERATION_ON | SK_RFCTL_FIFO_FLUSH_ON;
2421 1.94 msaitoh if ((sc->sk_type == SK_YUKON_EX) || (sc->sk_type == SK_YUKON_FE_P))
2422 1.94 msaitoh v |= SK_RFCTL_RX_OVER_ON;
2423 1.94 msaitoh SK_IF_WRITE_2(sc_if, 0, SK_RXMF1_CTRL_TEST, v);
2424 1.94 msaitoh
2425 1.94 msaitoh if ((sc->sk_type == SK_YUKON_FE_P) &&
2426 1.94 msaitoh (sc->sk_rev == SK_YUKON_FE_P_REV_A0))
2427 1.94 msaitoh v = 0x178; /* Magic value */
2428 1.94 msaitoh else {
2429 1.94 msaitoh /* Increase flush threshold to 64 bytes */
2430 1.94 msaitoh v = SK_RFCTL_FIFO_THRESHOLD + 1;
2431 1.94 msaitoh }
2432 1.94 msaitoh SK_IF_WRITE_2(sc_if, 0, SK_RXMF1_FLUSH_THRESHOLD, v);
2433 1.1 riz
2434 1.1 riz /* Configure TX MAC FIFO */
2435 1.1 riz SK_IF_WRITE_1(sc_if, 0, SK_TXMF1_CTRL_TEST, SK_TFCTL_RESET_CLEAR);
2436 1.1 riz SK_IF_WRITE_2(sc_if, 0, SK_TXMF1_CTRL_TEST, SK_TFCTL_OPERATION_ON);
2437 1.1 riz
2438 1.94 msaitoh if ((sc->sk_type == SK_YUKON_FE_P) &&
2439 1.94 msaitoh (sc->sk_rev == SK_YUKON_FE_P_REV_A0)) {
2440 1.94 msaitoh v = SK_IF_READ_2(sc_if, 0, SK_TXMF1_END);
2441 1.94 msaitoh v &= ~SK_TXEND_WM_ON;
2442 1.94 msaitoh SK_IF_WRITE_2(sc_if, 0, SK_TXMF1_END, v);
2443 1.94 msaitoh }
2444 1.94 msaitoh
2445 1.1 riz #if 1
2446 1.1 riz SK_YU_WRITE_2(sc_if, YUKON_GPCR, YU_GPCR_TXEN | YU_GPCR_RXEN);
2447 1.1 riz #endif
2448 1.1 riz DPRINTFN(6, ("msk_init_yukon: end\n"));
2449 1.1 riz }
2450 1.1 riz
2451 1.1 riz /*
2452 1.1 riz * Note that to properly initialize any part of the GEnesis chip,
2453 1.1 riz * you first have to take it out of reset mode.
2454 1.1 riz */
2455 1.95 maxv static int
2456 1.1 riz msk_init(struct ifnet *ifp)
2457 1.1 riz {
2458 1.1 riz struct sk_if_softc *sc_if = ifp->if_softc;
2459 1.1 riz struct sk_softc *sc = sc_if->sk_softc;
2460 1.15 dyoung int rc = 0, s;
2461 1.5 msaitoh uint32_t imr, imtimer_ticks;
2462 1.1 riz
2463 1.1 riz
2464 1.1 riz DPRINTFN(2, ("msk_init\n"));
2465 1.1 riz
2466 1.1 riz s = splnet();
2467 1.1 riz
2468 1.1 riz /* Cancel pending I/O and free all RX/TX buffers. */
2469 1.68 jdolecek msk_stop(ifp, 1);
2470 1.1 riz
2471 1.1 riz /* Configure I2C registers */
2472 1.1 riz
2473 1.1 riz /* Configure XMAC(s) */
2474 1.1 riz msk_init_yukon(sc_if);
2475 1.15 dyoung if ((rc = ether_mediachange(ifp)) != 0)
2476 1.15 dyoung goto out;
2477 1.1 riz
2478 1.1 riz /* Configure transmit arbiter(s) */
2479 1.1 riz SK_IF_WRITE_1(sc_if, 0, SK_TXAR1_COUNTERCTL, SK_TXARCTL_ON);
2480 1.1 riz #if 0
2481 1.94 msaitoh /* SK_TXARCTL_ON | SK_TXARCTL_FSYNC_ON); */
2482 1.1 riz #endif
2483 1.1 riz
2484 1.78 jakllsch if (sc->sk_ramsize) {
2485 1.78 jakllsch /* Configure RAMbuffers */
2486 1.78 jakllsch SK_IF_WRITE_4(sc_if, 0, SK_RXRB1_CTLTST, SK_RBCTL_UNRESET);
2487 1.78 jakllsch SK_IF_WRITE_4(sc_if, 0, SK_RXRB1_START, sc_if->sk_rx_ramstart);
2488 1.78 jakllsch SK_IF_WRITE_4(sc_if, 0, SK_RXRB1_WR_PTR, sc_if->sk_rx_ramstart);
2489 1.78 jakllsch SK_IF_WRITE_4(sc_if, 0, SK_RXRB1_RD_PTR, sc_if->sk_rx_ramstart);
2490 1.78 jakllsch SK_IF_WRITE_4(sc_if, 0, SK_RXRB1_END, sc_if->sk_rx_ramend);
2491 1.78 jakllsch SK_IF_WRITE_4(sc_if, 0, SK_RXRB1_CTLTST, SK_RBCTL_ON);
2492 1.78 jakllsch
2493 1.78 jakllsch SK_IF_WRITE_4(sc_if, 1, SK_TXRBA1_CTLTST, SK_RBCTL_UNRESET);
2494 1.78 jakllsch SK_IF_WRITE_4(sc_if, 1, SK_TXRBA1_CTLTST, SK_RBCTL_STORENFWD_ON);
2495 1.78 jakllsch SK_IF_WRITE_4(sc_if, 1, SK_TXRBA1_START, sc_if->sk_tx_ramstart);
2496 1.78 jakllsch SK_IF_WRITE_4(sc_if, 1, SK_TXRBA1_WR_PTR, sc_if->sk_tx_ramstart);
2497 1.78 jakllsch SK_IF_WRITE_4(sc_if, 1, SK_TXRBA1_RD_PTR, sc_if->sk_tx_ramstart);
2498 1.78 jakllsch SK_IF_WRITE_4(sc_if, 1, SK_TXRBA1_END, sc_if->sk_tx_ramend);
2499 1.78 jakllsch SK_IF_WRITE_4(sc_if, 1, SK_TXRBA1_CTLTST, SK_RBCTL_ON);
2500 1.78 jakllsch }
2501 1.1 riz
2502 1.1 riz /* Configure BMUs */
2503 1.1 riz SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_BMU_CSR, 0x00000016);
2504 1.1 riz SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_BMU_CSR, 0x00000d28);
2505 1.1 riz SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_BMU_CSR, 0x00000080);
2506 1.6 msaitoh SK_IF_WRITE_2(sc_if, 0, SK_RXQ1_Y2_WM, 0x0600); /* XXX ??? */
2507 1.1 riz
2508 1.1 riz SK_IF_WRITE_4(sc_if, 1, SK_TXQA1_BMU_CSR, 0x00000016);
2509 1.1 riz SK_IF_WRITE_4(sc_if, 1, SK_TXQA1_BMU_CSR, 0x00000d28);
2510 1.1 riz SK_IF_WRITE_4(sc_if, 1, SK_TXQA1_BMU_CSR, 0x00000080);
2511 1.6 msaitoh SK_IF_WRITE_2(sc_if, 1, SK_TXQA1_Y2_WM, 0x0600); /* XXX ??? */
2512 1.1 riz
2513 1.1 riz /* Make sure the sync transmit queue is disabled. */
2514 1.1 riz SK_IF_WRITE_4(sc_if, 1, SK_TXRBS1_CTLTST, SK_RBCTL_RESET);
2515 1.1 riz
2516 1.1 riz /* Init descriptors */
2517 1.1 riz if (msk_init_rx_ring(sc_if) == ENOBUFS) {
2518 1.30 christos aprint_error_dev(sc_if->sk_dev, "initialization failed: no "
2519 1.18 cegger "memory for rx buffers\n");
2520 1.68 jdolecek msk_stop(ifp, 1);
2521 1.1 riz splx(s);
2522 1.1 riz return ENOBUFS;
2523 1.1 riz }
2524 1.1 riz
2525 1.1 riz if (msk_init_tx_ring(sc_if) == ENOBUFS) {
2526 1.30 christos aprint_error_dev(sc_if->sk_dev, "initialization failed: no "
2527 1.18 cegger "memory for tx buffers\n");
2528 1.68 jdolecek msk_stop(ifp, 1);
2529 1.1 riz splx(s);
2530 1.1 riz return ENOBUFS;
2531 1.1 riz }
2532 1.1 riz
2533 1.1 riz /* Set interrupt moderation if changed via sysctl. */
2534 1.1 riz switch (sc->sk_type) {
2535 1.1 riz case SK_YUKON_EC:
2536 1.6 msaitoh case SK_YUKON_EC_U:
2537 1.56 jdolecek case SK_YUKON_EX:
2538 1.56 jdolecek case SK_YUKON_SUPR:
2539 1.56 jdolecek case SK_YUKON_ULTRA2:
2540 1.56 jdolecek case SK_YUKON_OPTIMA:
2541 1.56 jdolecek case SK_YUKON_PRM:
2542 1.56 jdolecek case SK_YUKON_OPTIMA2:
2543 1.5 msaitoh imtimer_ticks = SK_IMTIMER_TICKS_YUKON_EC;
2544 1.1 riz break;
2545 1.6 msaitoh case SK_YUKON_FE:
2546 1.6 msaitoh imtimer_ticks = SK_IMTIMER_TICKS_YUKON_FE;
2547 1.6 msaitoh break;
2548 1.60 jdolecek case SK_YUKON_FE_P:
2549 1.60 jdolecek imtimer_ticks = SK_IMTIMER_TICKS_YUKON_FE_P;
2550 1.60 jdolecek break;
2551 1.6 msaitoh case SK_YUKON_XL:
2552 1.6 msaitoh imtimer_ticks = SK_IMTIMER_TICKS_YUKON_XL;
2553 1.6 msaitoh break;
2554 1.1 riz default:
2555 1.5 msaitoh imtimer_ticks = SK_IMTIMER_TICKS_YUKON;
2556 1.1 riz }
2557 1.1 riz imr = sk_win_read_4(sc, SK_IMTIMERINIT);
2558 1.1 riz if (imr != SK_IM_USECS(sc->sk_int_mod)) {
2559 1.1 riz sk_win_write_4(sc, SK_IMTIMERINIT,
2560 1.1 riz SK_IM_USECS(sc->sk_int_mod));
2561 1.30 christos aprint_verbose_dev(sc->sk_dev,
2562 1.34 tnn "interrupt moderation is %d us\n", sc->sk_int_mod);
2563 1.1 riz }
2564 1.1 riz
2565 1.1 riz /* Initialize prefetch engine. */
2566 1.1 riz SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_Y2_PREF_CSR, 0x00000001);
2567 1.1 riz SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_Y2_PREF_CSR, 0x00000002);
2568 1.1 riz SK_IF_WRITE_2(sc_if, 0, SK_RXQ1_Y2_PREF_LIDX, MSK_RX_RING_CNT - 1);
2569 1.1 riz SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_Y2_PREF_ADDRLO,
2570 1.1 riz MSK_RX_RING_ADDR(sc_if, 0));
2571 1.1 riz SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_Y2_PREF_ADDRHI,
2572 1.83 msaitoh (uint64_t)MSK_RX_RING_ADDR(sc_if, 0) >> 32);
2573 1.1 riz SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_Y2_PREF_CSR, 0x00000008);
2574 1.1 riz SK_IF_READ_4(sc_if, 0, SK_RXQ1_Y2_PREF_CSR);
2575 1.1 riz
2576 1.1 riz SK_IF_WRITE_4(sc_if, 1, SK_TXQA1_Y2_PREF_CSR, 0x00000001);
2577 1.1 riz SK_IF_WRITE_4(sc_if, 1, SK_TXQA1_Y2_PREF_CSR, 0x00000002);
2578 1.1 riz SK_IF_WRITE_2(sc_if, 1, SK_TXQA1_Y2_PREF_LIDX, MSK_TX_RING_CNT - 1);
2579 1.1 riz SK_IF_WRITE_4(sc_if, 1, SK_TXQA1_Y2_PREF_ADDRLO,
2580 1.1 riz MSK_TX_RING_ADDR(sc_if, 0));
2581 1.1 riz SK_IF_WRITE_4(sc_if, 1, SK_TXQA1_Y2_PREF_ADDRHI,
2582 1.83 msaitoh (uint64_t)MSK_TX_RING_ADDR(sc_if, 0) >> 32);
2583 1.1 riz SK_IF_WRITE_4(sc_if, 1, SK_TXQA1_Y2_PREF_CSR, 0x00000008);
2584 1.1 riz SK_IF_READ_4(sc_if, 1, SK_TXQA1_Y2_PREF_CSR);
2585 1.1 riz
2586 1.1 riz SK_IF_WRITE_2(sc_if, 0, SK_RXQ1_Y2_PREF_PUTIDX,
2587 1.1 riz sc_if->sk_cdata.sk_rx_prod);
2588 1.1 riz
2589 1.94 msaitoh
2590 1.94 msaitoh if ((sc->sk_type == SK_YUKON_EX) || (sc->sk_type == SK_YUKON_SUPR)) {
2591 1.94 msaitoh /* Disable flushing of non-ASF packets. */
2592 1.94 msaitoh SK_IF_WRITE_4(sc_if, 0, SK_RXMF1_CTRL_TEST,
2593 1.94 msaitoh SK_RFCTL_RX_MACSEC_FLUSH_OFF);
2594 1.94 msaitoh }
2595 1.94 msaitoh
2596 1.1 riz /* Configure interrupt handling */
2597 1.1 riz if (sc_if->sk_port == SK_PORT_A)
2598 1.1 riz sc->sk_intrmask |= SK_Y2_INTRS1;
2599 1.1 riz else
2600 1.1 riz sc->sk_intrmask |= SK_Y2_INTRS2;
2601 1.1 riz sc->sk_intrmask |= SK_Y2_IMR_BMU;
2602 1.1 riz CSR_WRITE_4(sc, SK_IMR, sc->sk_intrmask);
2603 1.1 riz
2604 1.1 riz ifp->if_flags |= IFF_RUNNING;
2605 1.1 riz ifp->if_flags &= ~IFF_OACTIVE;
2606 1.1 riz
2607 1.1 riz callout_schedule(&sc_if->sk_tick_ch, hz);
2608 1.1 riz
2609 1.15 dyoung out:
2610 1.1 riz splx(s);
2611 1.15 dyoung return rc;
2612 1.1 riz }
2613 1.1 riz
2614 1.68 jdolecek /*
2615 1.68 jdolecek * Note: the logic of second parameter is inverted compared to OpenBSD
2616 1.68 jdolecek * code, since this code uses the function as if_stop hook too.
2617 1.68 jdolecek */
2618 1.95 maxv static void
2619 1.3 christos msk_stop(struct ifnet *ifp, int disable)
2620 1.1 riz {
2621 1.1 riz struct sk_if_softc *sc_if = ifp->if_softc;
2622 1.1 riz struct sk_softc *sc = sc_if->sk_softc;
2623 1.1 riz struct sk_txmap_entry *dma;
2624 1.1 riz int i;
2625 1.1 riz
2626 1.1 riz DPRINTFN(2, ("msk_stop\n"));
2627 1.1 riz
2628 1.1 riz callout_stop(&sc_if->sk_tick_ch);
2629 1.72 jdolecek callout_stop(&sc_if->sk_tick_rx);
2630 1.1 riz
2631 1.88 msaitoh ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
2632 1.1 riz
2633 1.1 riz /* Stop transfer of Tx descriptors */
2634 1.1 riz
2635 1.1 riz /* Stop transfer of Rx descriptors */
2636 1.1 riz
2637 1.68 jdolecek if (disable) {
2638 1.68 jdolecek /* Turn off various components of this interface. */
2639 1.68 jdolecek SK_IF_WRITE_1(sc_if, 0, SK_RXMF1_CTRL_TEST, SK_RFCTL_RESET_SET);
2640 1.68 jdolecek SK_IF_WRITE_1(sc_if, 0, SK_TXMF1_CTRL_TEST, SK_TFCTL_RESET_SET);
2641 1.68 jdolecek SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_BMU_CSR, SK_RXBMU_OFFLINE);
2642 1.88 msaitoh SK_IF_WRITE_4(sc_if, 0, SK_RXRB1_CTLTST, SK_RBCTL_RESET | SK_RBCTL_OFF);
2643 1.68 jdolecek SK_IF_WRITE_4(sc_if, 1, SK_TXQA1_BMU_CSR, SK_TXBMU_OFFLINE);
2644 1.88 msaitoh SK_IF_WRITE_4(sc_if, 1, SK_TXRBA1_CTLTST, SK_RBCTL_RESET | SK_RBCTL_OFF);
2645 1.68 jdolecek SK_IF_WRITE_1(sc_if, 0, SK_TXAR1_COUNTERCTL, SK_TXARCTL_OFF);
2646 1.68 jdolecek SK_IF_WRITE_1(sc_if, 0, SK_RXLED1_CTL, SK_RXLEDCTL_COUNTER_STOP);
2647 1.68 jdolecek SK_IF_WRITE_1(sc_if, 0, SK_TXLED1_CTL, SK_TXLEDCTL_COUNTER_STOP);
2648 1.68 jdolecek SK_IF_WRITE_1(sc_if, 0, SK_LINKLED1_CTL, SK_LINKLED_OFF);
2649 1.68 jdolecek SK_IF_WRITE_1(sc_if, 0, SK_LINKLED1_CTL, SK_LINKLED_LINKSYNC_OFF);
2650 1.68 jdolecek
2651 1.68 jdolecek SK_IF_WRITE_4(sc_if, 0, SK_RXQ1_Y2_PREF_CSR, 0x00000001);
2652 1.68 jdolecek SK_IF_WRITE_4(sc_if, 1, SK_TXQA1_Y2_PREF_CSR, 0x00000001);
2653 1.68 jdolecek
2654 1.68 jdolecek /* Disable interrupts */
2655 1.68 jdolecek if (sc_if->sk_port == SK_PORT_A)
2656 1.68 jdolecek sc->sk_intrmask &= ~SK_Y2_INTRS1;
2657 1.68 jdolecek else
2658 1.68 jdolecek sc->sk_intrmask &= ~SK_Y2_INTRS2;
2659 1.68 jdolecek CSR_WRITE_4(sc, SK_IMR, sc->sk_intrmask);
2660 1.68 jdolecek }
2661 1.1 riz
2662 1.1 riz /* Free RX and TX mbufs still in the queues. */
2663 1.1 riz for (i = 0; i < MSK_RX_RING_CNT; i++) {
2664 1.1 riz if (sc_if->sk_cdata.sk_rx_chain[i].sk_mbuf != NULL) {
2665 1.1 riz m_freem(sc_if->sk_cdata.sk_rx_chain[i].sk_mbuf);
2666 1.1 riz sc_if->sk_cdata.sk_rx_chain[i].sk_mbuf = NULL;
2667 1.1 riz }
2668 1.1 riz }
2669 1.1 riz
2670 1.68 jdolecek sc_if->sk_cdata.sk_rx_prod = 0;
2671 1.68 jdolecek sc_if->sk_cdata.sk_rx_cons = 0;
2672 1.68 jdolecek sc_if->sk_cdata.sk_rx_cnt = 0;
2673 1.68 jdolecek
2674 1.1 riz for (i = 0; i < MSK_TX_RING_CNT; i++) {
2675 1.1 riz if (sc_if->sk_cdata.sk_tx_chain[i].sk_mbuf != NULL) {
2676 1.92 msaitoh dma = sc_if->sk_cdata.sk_tx_map[i];
2677 1.92 msaitoh
2678 1.92 msaitoh bus_dmamap_sync(sc->sc_dmatag, dma->dmamap, 0,
2679 1.92 msaitoh dma->dmamap->dm_mapsize, BUS_DMASYNC_POSTWRITE);
2680 1.92 msaitoh
2681 1.92 msaitoh bus_dmamap_unload(sc->sc_dmatag, dma->dmamap);
2682 1.1 riz #if 1
2683 1.1 riz SIMPLEQ_INSERT_HEAD(&sc_if->sk_txmap_head,
2684 1.1 riz sc_if->sk_cdata.sk_tx_map[i], link);
2685 1.1 riz sc_if->sk_cdata.sk_tx_map[i] = 0;
2686 1.1 riz #endif
2687 1.92 msaitoh m_freem(sc_if->sk_cdata.sk_tx_chain[i].sk_mbuf);
2688 1.92 msaitoh sc_if->sk_cdata.sk_tx_chain[i].sk_mbuf = NULL;
2689 1.1 riz }
2690 1.1 riz }
2691 1.1 riz
2692 1.1 riz #if 1
2693 1.1 riz while ((dma = SIMPLEQ_FIRST(&sc_if->sk_txmap_head))) {
2694 1.1 riz SIMPLEQ_REMOVE_HEAD(&sc_if->sk_txmap_head, link);
2695 1.1 riz bus_dmamap_destroy(sc->sc_dmatag, dma->dmamap);
2696 1.1 riz free(dma, M_DEVBUF);
2697 1.1 riz }
2698 1.1 riz #endif
2699 1.1 riz }
2700 1.1 riz
2701 1.70 jdolecek CFATTACH_DECL3_NEW(mskc, sizeof(struct sk_softc), mskc_probe, mskc_attach,
2702 1.70 jdolecek mskc_detach, NULL, NULL, NULL, DVF_DETACH_SHUTDOWN);
2703 1.1 riz
2704 1.70 jdolecek CFATTACH_DECL3_NEW(msk, sizeof(struct sk_if_softc), msk_probe, msk_attach,
2705 1.70 jdolecek msk_detach, NULL, NULL, NULL, DVF_DETACH_SHUTDOWN);
2706 1.1 riz
2707 1.1 riz #ifdef MSK_DEBUG
2708 1.95 maxv static void
2709 1.1 riz msk_dump_txdesc(struct msk_tx_desc *le, int idx)
2710 1.1 riz {
2711 1.1 riz #define DESC_PRINT(X) \
2712 1.83 msaitoh if (X) \
2713 1.1 riz printf("txdesc[%d]." #X "=%#x\n", \
2714 1.1 riz idx, X);
2715 1.1 riz
2716 1.1 riz DESC_PRINT(letoh32(le->sk_addr));
2717 1.1 riz DESC_PRINT(letoh16(le->sk_len));
2718 1.1 riz DESC_PRINT(le->sk_ctl);
2719 1.1 riz DESC_PRINT(le->sk_opcode);
2720 1.1 riz #undef DESC_PRINT
2721 1.1 riz }
2722 1.1 riz
2723 1.95 maxv static void
2724 1.1 riz msk_dump_bytes(const char *data, int len)
2725 1.1 riz {
2726 1.1 riz int c, i, j;
2727 1.1 riz
2728 1.1 riz for (i = 0; i < len; i += 16) {
2729 1.1 riz printf("%08x ", i);
2730 1.1 riz c = len - i;
2731 1.1 riz if (c > 16) c = 16;
2732 1.1 riz
2733 1.1 riz for (j = 0; j < c; j++) {
2734 1.1 riz printf("%02x ", data[i + j] & 0xff);
2735 1.1 riz if ((j & 0xf) == 7 && j > 0)
2736 1.1 riz printf(" ");
2737 1.1 riz }
2738 1.59 jdolecek
2739 1.1 riz for (; j < 16; j++)
2740 1.1 riz printf(" ");
2741 1.1 riz printf(" ");
2742 1.1 riz
2743 1.1 riz for (j = 0; j < c; j++) {
2744 1.1 riz int ch = data[i + j] & 0xff;
2745 1.1 riz printf("%c", ' ' <= ch && ch <= '~' ? ch : ' ');
2746 1.1 riz }
2747 1.59 jdolecek
2748 1.1 riz printf("\n");
2749 1.59 jdolecek
2750 1.1 riz if (c < 16)
2751 1.1 riz break;
2752 1.1 riz }
2753 1.1 riz }
2754 1.1 riz
2755 1.95 maxv static void
2756 1.1 riz msk_dump_mbuf(struct mbuf *m)
2757 1.1 riz {
2758 1.1 riz int count = m->m_pkthdr.len;
2759 1.1 riz
2760 1.1 riz printf("m=%p, m->m_pkthdr.len=%d\n", m, m->m_pkthdr.len);
2761 1.1 riz
2762 1.1 riz while (count > 0 && m) {
2763 1.1 riz printf("m=%p, m->m_data=%p, m->m_len=%d\n",
2764 1.1 riz m, m->m_data, m->m_len);
2765 1.78 jakllsch if (mskdebug >= 4)
2766 1.78 jakllsch msk_dump_bytes(mtod(m, char *), m->m_len);
2767 1.1 riz
2768 1.1 riz count -= m->m_len;
2769 1.1 riz m = m->m_next;
2770 1.1 riz }
2771 1.1 riz }
2772 1.1 riz #endif
2773 1.1 riz
2774 1.1 riz static int
2775 1.1 riz msk_sysctl_handler(SYSCTLFN_ARGS)
2776 1.1 riz {
2777 1.1 riz int error, t;
2778 1.1 riz struct sysctlnode node;
2779 1.1 riz struct sk_softc *sc;
2780 1.1 riz
2781 1.1 riz node = *rnode;
2782 1.1 riz sc = node.sysctl_data;
2783 1.1 riz t = sc->sk_int_mod;
2784 1.1 riz node.sysctl_data = &t;
2785 1.1 riz error = sysctl_lookup(SYSCTLFN_CALL(&node));
2786 1.1 riz if (error || newp == NULL)
2787 1.1 riz return error;
2788 1.1 riz
2789 1.1 riz if (t < SK_IM_MIN || t > SK_IM_MAX)
2790 1.1 riz return EINVAL;
2791 1.1 riz
2792 1.1 riz /* update the softc with sysctl-changed value, and mark
2793 1.1 riz for hardware update */
2794 1.1 riz sc->sk_int_mod = t;
2795 1.1 riz sc->sk_int_mod_pending = 1;
2796 1.1 riz return 0;
2797 1.1 riz }
2798 1.1 riz
2799 1.1 riz /*
2800 1.68 jdolecek * Set up sysctl(3) MIB, hw.msk.* - Individual controllers will be
2801 1.68 jdolecek * set up in mskc_attach()
2802 1.1 riz */
2803 1.1 riz SYSCTL_SETUP(sysctl_msk, "sysctl msk subtree setup")
2804 1.1 riz {
2805 1.1 riz int rc;
2806 1.1 riz const struct sysctlnode *node;
2807 1.1 riz
2808 1.1 riz if ((rc = sysctl_createv(clog, 0, NULL, &node,
2809 1.1 riz 0, CTLTYPE_NODE, "msk",
2810 1.1 riz SYSCTL_DESCR("msk interface controls"),
2811 1.1 riz NULL, 0, NULL, 0, CTL_HW, CTL_CREATE, CTL_EOL)) != 0) {
2812 1.1 riz goto err;
2813 1.1 riz }
2814 1.1 riz
2815 1.1 riz msk_root_num = node->sysctl_num;
2816 1.1 riz return;
2817 1.1 riz
2818 1.1 riz err:
2819 1.1 riz aprint_error("%s: syctl_createv failed (rc = %d)\n", __func__, rc);
2820 1.1 riz }
2821