if_kse.c revision 1.6 1 1.6 nisimura /* $NetBSD: if_kse.c,v 1.6 2007/10/14 11:49:39 nisimura Exp $ */
2 1.1 nisimura
3 1.1 nisimura /*
4 1.1 nisimura * Copyright (c) 2006 Tohru Nishimura
5 1.1 nisimura *
6 1.1 nisimura * Redistribution and use in source and binary forms, with or without
7 1.1 nisimura * modification, are permitted provided that the following conditions
8 1.1 nisimura * are met:
9 1.1 nisimura * 1. Redistributions of source code must retain the above copyright
10 1.1 nisimura * notice, this list of conditions and the following disclaimer.
11 1.1 nisimura * 2. Redistributions in binary form must reproduce the above copyright
12 1.1 nisimura * notice, this list of conditions and the following disclaimer in the
13 1.1 nisimura * documentation and/or other materials provided with the distribution.
14 1.1 nisimura * 3. All advertising materials mentioning features or use of this software
15 1.1 nisimura * must display the following acknowledgement:
16 1.1 nisimura * This product includes software developed by Tohru Nishimura.
17 1.1 nisimura * 4. The name of the author may not be used to endorse or promote products
18 1.1 nisimura * derived from this software without specific prior written permission.
19 1.1 nisimura *
20 1.1 nisimura * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21 1.1 nisimura * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22 1.1 nisimura * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23 1.1 nisimura * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
24 1.1 nisimura * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25 1.1 nisimura * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
26 1.1 nisimura * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
27 1.1 nisimura * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
28 1.1 nisimura * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29 1.1 nisimura * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 1.1 nisimura */
31 1.1 nisimura
32 1.1 nisimura #include <sys/cdefs.h>
33 1.6 nisimura __KERNEL_RCSID(0, "$NetBSD: if_kse.c,v 1.6 2007/10/14 11:49:39 nisimura Exp $");
34 1.1 nisimura
35 1.1 nisimura #include "bpfilter.h"
36 1.1 nisimura
37 1.1 nisimura #include <sys/param.h>
38 1.1 nisimura #include <sys/systm.h>
39 1.1 nisimura #include <sys/callout.h>
40 1.1 nisimura #include <sys/mbuf.h>
41 1.1 nisimura #include <sys/malloc.h>
42 1.1 nisimura #include <sys/kernel.h>
43 1.1 nisimura #include <sys/ioctl.h>
44 1.1 nisimura #include <sys/errno.h>
45 1.1 nisimura #include <sys/device.h>
46 1.1 nisimura #include <sys/queue.h>
47 1.1 nisimura
48 1.1 nisimura #include <machine/endian.h>
49 1.1 nisimura #include <machine/bus.h>
50 1.1 nisimura #include <machine/intr.h>
51 1.1 nisimura
52 1.1 nisimura #include <net/if.h>
53 1.1 nisimura #include <net/if_media.h>
54 1.1 nisimura #include <net/if_dl.h>
55 1.1 nisimura #include <net/if_ether.h>
56 1.1 nisimura
57 1.1 nisimura #if NBPFILTER > 0
58 1.1 nisimura #include <net/bpf.h>
59 1.1 nisimura #endif
60 1.1 nisimura
61 1.1 nisimura #include <dev/pci/pcivar.h>
62 1.1 nisimura #include <dev/pci/pcireg.h>
63 1.1 nisimura #include <dev/pci/pcidevs.h>
64 1.1 nisimura
65 1.1 nisimura #define CSR_READ_4(sc, off) \
66 1.1 nisimura bus_space_read_4(sc->sc_st, sc->sc_sh, off)
67 1.1 nisimura #define CSR_WRITE_4(sc, off, val) \
68 1.1 nisimura bus_space_write_4(sc->sc_st, sc->sc_sh, off, val)
69 1.1 nisimura #define CSR_READ_2(sc, off) \
70 1.1 nisimura bus_space_read_2(sc->sc_st, sc->sc_sh, off)
71 1.1 nisimura #define CSR_WRITE_2(sc, off, val) \
72 1.1 nisimura bus_space_write_2(sc->sc_st, sc->sc_sh, off, val)
73 1.1 nisimura
74 1.1 nisimura #define MDTXC 0x000 /* DMA transmit control */
75 1.1 nisimura #define MDRXC 0x004 /* DMA receive control */
76 1.1 nisimura #define MDTSC 0x008 /* DMA transmit start */
77 1.1 nisimura #define MDRSC 0x00c /* DMA receive start */
78 1.1 nisimura #define TDLB 0x010 /* transmit descriptor list base */
79 1.1 nisimura #define RDLB 0x014 /* receive descriptor list base */
80 1.1 nisimura #define INTEN 0x028 /* interrupt enable */
81 1.1 nisimura #define INTST 0x02c /* interrupt status */
82 1.6 nisimura #define MTR0 0x100 /* multicast table 31:0 */
83 1.6 nisimura #define MTR1 0x104 /* multicast table 63:32 */
84 1.1 nisimura #define MARL 0x200 /* MAC address low */
85 1.1 nisimura #define MARM 0x202 /* MAC address middle */
86 1.1 nisimura #define MARH 0x204 /* MAC address high */
87 1.1 nisimura #define GRR 0x216 /* global reset */
88 1.1 nisimura #define CIDR 0x400 /* chip ID and enable */
89 1.1 nisimura #define CGCR 0x40a /* chip global control */
90 1.1 nisimura #define P1CR4 0x512 /* port 1 control 4 */
91 1.1 nisimura #define P1SR 0x514 /* port 1 status */
92 1.1 nisimura
93 1.1 nisimura #define TXC_BS_MSK 0x3f000000 /* burst size */
94 1.1 nisimura #define TXC_BS_SFT (24) /* 1,2,4,8,16,32 or 0 for unlimited */
95 1.1 nisimura #define TXC_UCG (1U<<18) /* generate UDP checksum */
96 1.1 nisimura #define TXC_TCG (1U<<17) /* generate TCP checksum */
97 1.1 nisimura #define TXC_ICG (1U<<16) /* generate IP checksum */
98 1.1 nisimura #define TXC_FCE (1U<<9) /* enable flowcontrol */
99 1.1 nisimura #define TXC_EP (1U<<2) /* enable automatic padding */
100 1.1 nisimura #define TXC_AC (1U<<1) /* add CRC to frame */
101 1.1 nisimura #define TXC_TEN (1) /* enable DMA to run */
102 1.1 nisimura
103 1.1 nisimura #define RXC_BS_MSK 0x3f000000 /* burst size */
104 1.1 nisimura #define RXC_BS_SFT (24) /* 1,2,4,8,16,32 or 0 for unlimited */
105 1.6 nisimura #define RXC_IHAE (1U<<19) /* IP header alignment enable */
106 1.5 nisimura #define RXC_UCC (1U<<18) /* run UDP checksum */
107 1.5 nisimura #define RXC_TCC (1U<<17) /* run TDP checksum */
108 1.5 nisimura #define RXC_ICC (1U<<16) /* run IP checksum */
109 1.1 nisimura #define RXC_FCE (1U<<9) /* enable flowcontrol */
110 1.1 nisimura #define RXC_RB (1U<<6) /* receive broadcast frame */
111 1.1 nisimura #define RXC_RM (1U<<5) /* receive multicast frame */
112 1.1 nisimura #define RXC_RU (1U<<4) /* receive unicast frame */
113 1.1 nisimura #define RXC_RE (1U<<3) /* accept error frame */
114 1.1 nisimura #define RXC_RA (1U<<2) /* receive all frame */
115 1.6 nisimura #define RXC_MHTE (1U<<1) /* use multicast hash table */
116 1.1 nisimura #define RXC_REN (1) /* enable DMA to run */
117 1.1 nisimura
118 1.1 nisimura #define INT_DMLCS (1U<<31) /* link status change */
119 1.1 nisimura #define INT_DMTS (1U<<30) /* sending desc. has posted Tx done */
120 1.1 nisimura #define INT_DMRS (1U<<29) /* frame was received */
121 1.1 nisimura #define INT_DMRBUS (1U<<27) /* Rx descriptor pool is full */
122 1.1 nisimura
123 1.1 nisimura #define T0_OWN (1U<<31) /* desc is ready to Tx */
124 1.1 nisimura
125 1.1 nisimura #define R0_OWN (1U<<31) /* desc is empty */
126 1.1 nisimura #define R0_FS (1U<<30) /* first segment of frame */
127 1.1 nisimura #define R0_LS (1U<<29) /* last segment of frame */
128 1.1 nisimura #define R0_IPE (1U<<28) /* IP checksum error */
129 1.1 nisimura #define R0_TCPE (1U<<27) /* TCP checksum error */
130 1.1 nisimura #define R0_UDPE (1U<<26) /* UDP checksum error */
131 1.1 nisimura #define R0_ES (1U<<25) /* error summary */
132 1.1 nisimura #define R0_MF (1U<<24) /* multicast frame */
133 1.5 nisimura #define R0_SPN 0x00300000 /* 21:20 switch port 1/2 */
134 1.5 nisimura #define R0_ALIGN 0x00300000 /* 21:20 (KSZ8692P) Rx align amount */
135 1.5 nisimura #define R0_RE (1U<<19) /* MII reported error */
136 1.5 nisimura #define R0_TL (1U<<18) /* frame too long, beyond 1518 */
137 1.1 nisimura #define R0_RF (1U<<17) /* damaged runt frame */
138 1.1 nisimura #define R0_CE (1U<<16) /* CRC error */
139 1.1 nisimura #define R0_FT (1U<<15) /* frame type */
140 1.1 nisimura #define R0_FL_MASK 0x7ff /* frame length 10:0 */
141 1.1 nisimura
142 1.1 nisimura #define T1_IC (1U<<31) /* post interrupt on complete */
143 1.1 nisimura #define T1_FS (1U<<30) /* first segment of frame */
144 1.1 nisimura #define T1_LS (1U<<29) /* last segment of frame */
145 1.1 nisimura #define T1_IPCKG (1U<<28) /* generate IP checksum */
146 1.1 nisimura #define T1_TCPCKG (1U<<27) /* generate TCP checksum */
147 1.1 nisimura #define T1_UDPCKG (1U<<26) /* generate UDP checksum */
148 1.1 nisimura #define T1_TER (1U<<25) /* end of ring */
149 1.5 nisimura #define T1_SPN 0x00300000 /* 21:20 switch port 1/2 */
150 1.1 nisimura #define T1_TBS_MASK 0x7ff /* segment size 10:0 */
151 1.1 nisimura
152 1.1 nisimura #define R1_RER (1U<<25) /* end of ring */
153 1.6 nisimura #define R1_RBS_MASK 0x7fd /* segment size 10:0 */
154 1.1 nisimura
155 1.1 nisimura #define KSE_NTXSEGS 16
156 1.1 nisimura #define KSE_TXQUEUELEN 64
157 1.1 nisimura #define KSE_TXQUEUELEN_MASK (KSE_TXQUEUELEN - 1)
158 1.1 nisimura #define KSE_TXQUEUE_GC (KSE_TXQUEUELEN / 4)
159 1.1 nisimura #define KSE_NTXDESC 256
160 1.1 nisimura #define KSE_NTXDESC_MASK (KSE_NTXDESC - 1)
161 1.1 nisimura #define KSE_NEXTTX(x) (((x) + 1) & KSE_NTXDESC_MASK)
162 1.1 nisimura #define KSE_NEXTTXS(x) (((x) + 1) & KSE_TXQUEUELEN_MASK)
163 1.1 nisimura
164 1.1 nisimura #define KSE_NRXDESC 64
165 1.1 nisimura #define KSE_NRXDESC_MASK (KSE_NRXDESC - 1)
166 1.1 nisimura #define KSE_NEXTRX(x) (((x) + 1) & KSE_NRXDESC_MASK)
167 1.1 nisimura
168 1.1 nisimura struct tdes {
169 1.2 tsutsui uint32_t t0, t1, t2, t3;
170 1.1 nisimura };
171 1.1 nisimura
172 1.1 nisimura struct rdes {
173 1.2 tsutsui uint32_t r0, r1, r2, r3;
174 1.1 nisimura };
175 1.1 nisimura
176 1.1 nisimura struct kse_control_data {
177 1.1 nisimura struct tdes kcd_txdescs[KSE_NTXDESC];
178 1.1 nisimura struct rdes kcd_rxdescs[KSE_NRXDESC];
179 1.1 nisimura };
180 1.1 nisimura #define KSE_CDOFF(x) offsetof(struct kse_control_data, x)
181 1.1 nisimura #define KSE_CDTXOFF(x) KSE_CDOFF(kcd_txdescs[(x)])
182 1.1 nisimura #define KSE_CDRXOFF(x) KSE_CDOFF(kcd_rxdescs[(x)])
183 1.1 nisimura
184 1.1 nisimura struct kse_txsoft {
185 1.1 nisimura struct mbuf *txs_mbuf; /* head of our mbuf chain */
186 1.1 nisimura bus_dmamap_t txs_dmamap; /* our DMA map */
187 1.1 nisimura int txs_firstdesc; /* first descriptor in packet */
188 1.1 nisimura int txs_lastdesc; /* last descriptor in packet */
189 1.1 nisimura int txs_ndesc; /* # of descriptors used */
190 1.1 nisimura };
191 1.1 nisimura
192 1.1 nisimura struct kse_rxsoft {
193 1.1 nisimura struct mbuf *rxs_mbuf; /* head of our mbuf chain */
194 1.1 nisimura bus_dmamap_t rxs_dmamap; /* our DMA map */
195 1.1 nisimura };
196 1.1 nisimura
197 1.1 nisimura struct kse_softc {
198 1.1 nisimura struct device sc_dev; /* generic device information */
199 1.1 nisimura bus_space_tag_t sc_st; /* bus space tag */
200 1.1 nisimura bus_space_handle_t sc_sh; /* bus space handle */
201 1.1 nisimura bus_dma_tag_t sc_dmat; /* bus DMA tag */
202 1.1 nisimura struct ethercom sc_ethercom; /* Ethernet common data */
203 1.1 nisimura void *sc_ih; /* interrupt cookie */
204 1.1 nisimura
205 1.1 nisimura struct ifmedia sc_media; /* ifmedia information */
206 1.1 nisimura int sc_media_status; /* PHY */
207 1.2 tsutsui int sc_media_active; /* PHY */
208 1.4 ad callout_t sc_callout; /* tick callout */
209 1.1 nisimura
210 1.1 nisimura bus_dmamap_t sc_cddmamap; /* control data DMA map */
211 1.1 nisimura #define sc_cddma sc_cddmamap->dm_segs[0].ds_addr
212 1.1 nisimura
213 1.1 nisimura struct kse_control_data *sc_control_data;
214 1.1 nisimura #define sc_txdescs sc_control_data->kcd_txdescs
215 1.1 nisimura #define sc_rxdescs sc_control_data->kcd_rxdescs
216 1.1 nisimura
217 1.1 nisimura struct kse_txsoft sc_txsoft[KSE_TXQUEUELEN];
218 1.1 nisimura struct kse_rxsoft sc_rxsoft[KSE_NRXDESC];
219 1.1 nisimura int sc_txfree; /* number of free Tx descriptors */
220 1.1 nisimura int sc_txnext; /* next ready Tx descriptor */
221 1.1 nisimura int sc_txsfree; /* number of free Tx jobs */
222 1.1 nisimura int sc_txsnext; /* next ready Tx job */
223 1.1 nisimura int sc_txsdirty; /* dirty Tx jobs */
224 1.1 nisimura int sc_rxptr; /* next ready Rx descriptor/descsoft */
225 1.1 nisimura
226 1.2 tsutsui uint32_t sc_txc, sc_rxc;
227 1.2 tsutsui uint32_t sc_t1csum;
228 1.2 tsutsui int sc_mcsum;
229 1.2 tsutsui uint32_t sc_chip;
230 1.1 nisimura };
231 1.1 nisimura
232 1.1 nisimura #define KSE_CDTXADDR(sc, x) ((sc)->sc_cddma + KSE_CDTXOFF((x)))
233 1.1 nisimura #define KSE_CDRXADDR(sc, x) ((sc)->sc_cddma + KSE_CDRXOFF((x)))
234 1.1 nisimura
235 1.1 nisimura #define KSE_CDTXSYNC(sc, x, n, ops) \
236 1.1 nisimura do { \
237 1.1 nisimura int __x, __n; \
238 1.1 nisimura \
239 1.1 nisimura __x = (x); \
240 1.1 nisimura __n = (n); \
241 1.1 nisimura \
242 1.1 nisimura /* If it will wrap around, sync to the end of the ring. */ \
243 1.1 nisimura if ((__x + __n) > KSE_NTXDESC) { \
244 1.1 nisimura bus_dmamap_sync((sc)->sc_dmat, (sc)->sc_cddmamap, \
245 1.1 nisimura KSE_CDTXOFF(__x), sizeof(struct tdes) * \
246 1.1 nisimura (KSE_NTXDESC - __x), (ops)); \
247 1.1 nisimura __n -= (KSE_NTXDESC - __x); \
248 1.1 nisimura __x = 0; \
249 1.1 nisimura } \
250 1.1 nisimura \
251 1.1 nisimura /* Now sync whatever is left. */ \
252 1.1 nisimura bus_dmamap_sync((sc)->sc_dmat, (sc)->sc_cddmamap, \
253 1.1 nisimura KSE_CDTXOFF(__x), sizeof(struct tdes) * __n, (ops)); \
254 1.1 nisimura } while (/*CONSTCOND*/0)
255 1.1 nisimura
256 1.1 nisimura #define KSE_CDRXSYNC(sc, x, ops) \
257 1.1 nisimura do { \
258 1.1 nisimura bus_dmamap_sync((sc)->sc_dmat, (sc)->sc_cddmamap, \
259 1.1 nisimura KSE_CDRXOFF((x)), sizeof(struct rdes), (ops)); \
260 1.1 nisimura } while (/*CONSTCOND*/0)
261 1.1 nisimura
262 1.1 nisimura #define KSE_INIT_RXDESC(sc, x) \
263 1.1 nisimura do { \
264 1.1 nisimura struct kse_rxsoft *__rxs = &(sc)->sc_rxsoft[(x)]; \
265 1.1 nisimura struct rdes *__rxd = &(sc)->sc_rxdescs[(x)]; \
266 1.1 nisimura struct mbuf *__m = __rxs->rxs_mbuf; \
267 1.1 nisimura \
268 1.1 nisimura __m->m_data = __m->m_ext.ext_buf; \
269 1.1 nisimura __rxd->r2 = __rxs->rxs_dmamap->dm_segs[0].ds_addr; \
270 1.1 nisimura __rxd->r1 = R1_RBS_MASK /* __m->m_ext.ext_size */; \
271 1.1 nisimura __rxd->r0 = R0_OWN; \
272 1.1 nisimura KSE_CDRXSYNC((sc), (x), BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE); \
273 1.1 nisimura } while (/*CONSTCOND*/0)
274 1.1 nisimura
275 1.2 tsutsui u_int kse_burstsize = 16; /* DMA burst length tuning knob */
276 1.1 nisimura
277 1.1 nisimura #ifdef KSEDIAGNOSTIC
278 1.2 tsutsui u_int kse_monitor_rxintr; /* fragmented UDP csum HW bug hook */
279 1.1 nisimura #endif
280 1.1 nisimura
281 1.1 nisimura static int kse_match(struct device *, struct cfdata *, void *);
282 1.1 nisimura static void kse_attach(struct device *, struct device *, void *);
283 1.1 nisimura
284 1.1 nisimura CFATTACH_DECL(kse, sizeof(struct kse_softc),
285 1.1 nisimura kse_match, kse_attach, NULL, NULL);
286 1.1 nisimura
287 1.3 christos static int kse_ioctl(struct ifnet *, u_long, void *);
288 1.1 nisimura static void kse_start(struct ifnet *);
289 1.1 nisimura static void kse_watchdog(struct ifnet *);
290 1.1 nisimura static int kse_init(struct ifnet *);
291 1.1 nisimura static void kse_stop(struct ifnet *, int);
292 1.1 nisimura static void kse_reset(struct kse_softc *);
293 1.1 nisimura static void kse_set_filter(struct kse_softc *);
294 1.1 nisimura static int add_rxbuf(struct kse_softc *, int);
295 1.1 nisimura static void rxdrain(struct kse_softc *);
296 1.1 nisimura static int kse_intr(void *);
297 1.1 nisimura static void rxintr(struct kse_softc *);
298 1.1 nisimura static void txreap(struct kse_softc *);
299 1.1 nisimura static void lnkchg(struct kse_softc *);
300 1.1 nisimura static int ifmedia_upd(struct ifnet *);
301 1.1 nisimura static void ifmedia_sts(struct ifnet *, struct ifmediareq *);
302 1.1 nisimura static void phy_tick(void *);
303 1.1 nisimura
304 1.1 nisimura static int
305 1.1 nisimura kse_match(struct device *parent, struct cfdata *match, void *aux)
306 1.1 nisimura {
307 1.1 nisimura struct pci_attach_args *pa = (struct pci_attach_args *)aux;
308 1.1 nisimura
309 1.1 nisimura if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_MICREL &&
310 1.1 nisimura (PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_MICREL_KSZ8842 ||
311 1.1 nisimura PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_MICREL_KSZ8841) &&
312 1.1 nisimura PCI_CLASS(pa->pa_class) == PCI_CLASS_NETWORK)
313 1.1 nisimura return 1;
314 1.1 nisimura
315 1.1 nisimura return 0;
316 1.1 nisimura }
317 1.1 nisimura
318 1.1 nisimura static void
319 1.1 nisimura kse_attach(struct device *parent, struct device *self, void *aux)
320 1.1 nisimura {
321 1.1 nisimura struct kse_softc *sc = (struct kse_softc *)self;
322 1.1 nisimura struct pci_attach_args *pa = aux;
323 1.1 nisimura pci_chipset_tag_t pc = pa->pa_pc;
324 1.1 nisimura pci_intr_handle_t ih;
325 1.1 nisimura const char *intrstr;
326 1.1 nisimura struct ifnet *ifp;
327 1.1 nisimura uint8_t enaddr[ETHER_ADDR_LEN];
328 1.1 nisimura bus_dma_segment_t seg;
329 1.1 nisimura int error, i, nseg;
330 1.1 nisimura pcireg_t pmode;
331 1.1 nisimura int pmreg;
332 1.1 nisimura
333 1.1 nisimura if (pci_mapreg_map(pa, 0x10,
334 1.1 nisimura PCI_MAPREG_TYPE_MEM | PCI_MAPREG_MEM_TYPE_32BIT,
335 1.1 nisimura 0, &sc->sc_st, &sc->sc_sh, NULL, NULL) != 0) {
336 1.1 nisimura printf(": unable to map device registers\n");
337 1.1 nisimura return;
338 1.1 nisimura }
339 1.1 nisimura
340 1.1 nisimura sc->sc_dmat = pa->pa_dmat;
341 1.1 nisimura
342 1.1 nisimura /* Make sure bus mastering is enabled. */
343 1.1 nisimura pci_conf_write(pc, pa->pa_tag, PCI_COMMAND_STATUS_REG,
344 1.1 nisimura pci_conf_read(pc, pa->pa_tag, PCI_COMMAND_STATUS_REG) |
345 1.1 nisimura PCI_COMMAND_MASTER_ENABLE);
346 1.1 nisimura
347 1.1 nisimura /* Get it out of power save mode, if needed. */
348 1.1 nisimura if (pci_get_capability(pc, pa->pa_tag, PCI_CAP_PWRMGMT, &pmreg, 0)) {
349 1.1 nisimura pmode = pci_conf_read(pc, pa->pa_tag, pmreg + PCI_PMCSR) &
350 1.1 nisimura PCI_PMCSR_STATE_MASK;
351 1.1 nisimura if (pmode == PCI_PMCSR_STATE_D3) {
352 1.1 nisimura /*
353 1.1 nisimura * The card has lost all configuration data in
354 1.1 nisimura * this state, so punt.
355 1.1 nisimura */
356 1.1 nisimura printf("%s: unable to wake from power state D3\n",
357 1.1 nisimura sc->sc_dev.dv_xname);
358 1.1 nisimura return;
359 1.1 nisimura }
360 1.1 nisimura if (pmode != PCI_PMCSR_STATE_D0) {
361 1.1 nisimura printf("%s: waking up from power date D%d\n",
362 1.1 nisimura sc->sc_dev.dv_xname, pmode);
363 1.1 nisimura pci_conf_write(pc, pa->pa_tag, pmreg + PCI_PMCSR,
364 1.1 nisimura PCI_PMCSR_STATE_D0);
365 1.1 nisimura }
366 1.1 nisimura }
367 1.1 nisimura
368 1.1 nisimura sc->sc_chip = PCI_PRODUCT(pa->pa_id);
369 1.1 nisimura printf(": Micrel KSZ%04x Ethernet (rev. 0x%02x)\n",
370 1.1 nisimura sc->sc_chip, PCI_REVISION(pa->pa_class));
371 1.1 nisimura
372 1.1 nisimura /*
373 1.1 nisimura * Read the Ethernet address from the EEPROM.
374 1.1 nisimura */
375 1.1 nisimura i = CSR_READ_2(sc, MARL);
376 1.1 nisimura enaddr[5] = i; enaddr[4] = i >> 8;
377 1.1 nisimura i = CSR_READ_2(sc, MARM);
378 1.1 nisimura enaddr[3] = i; enaddr[2] = i >> 8;
379 1.1 nisimura i = CSR_READ_2(sc, MARH);
380 1.1 nisimura enaddr[1] = i; enaddr[0] = i >> 8;
381 1.1 nisimura printf("%s: Ethernet address: %s\n",
382 1.1 nisimura sc->sc_dev.dv_xname, ether_sprintf(enaddr));
383 1.1 nisimura
384 1.1 nisimura /*
385 1.1 nisimura * Enable chip function.
386 1.1 nisimura */
387 1.1 nisimura CSR_WRITE_2(sc, CIDR, 1);
388 1.1 nisimura
389 1.1 nisimura /*
390 1.1 nisimura * Map and establish our interrupt.
391 1.1 nisimura */
392 1.1 nisimura if (pci_intr_map(pa, &ih)) {
393 1.1 nisimura printf("%s: unable to map interrupt\n", sc->sc_dev.dv_xname);
394 1.1 nisimura return;
395 1.1 nisimura }
396 1.1 nisimura intrstr = pci_intr_string(pc, ih);
397 1.1 nisimura sc->sc_ih = pci_intr_establish(pc, ih, IPL_NET, kse_intr, sc);
398 1.1 nisimura if (sc->sc_ih == NULL) {
399 1.1 nisimura printf("%s: unable to establish interrupt",
400 1.1 nisimura sc->sc_dev.dv_xname);
401 1.1 nisimura if (intrstr != NULL)
402 1.1 nisimura printf(" at %s", intrstr);
403 1.1 nisimura printf("\n");
404 1.1 nisimura return;
405 1.1 nisimura }
406 1.1 nisimura printf("%s: interrupting at %s\n", sc->sc_dev.dv_xname, intrstr);
407 1.1 nisimura
408 1.1 nisimura /*
409 1.1 nisimura * Allocate the control data structures, and create and load the
410 1.1 nisimura * DMA map for it.
411 1.1 nisimura */
412 1.1 nisimura error = bus_dmamem_alloc(sc->sc_dmat,
413 1.1 nisimura sizeof(struct kse_control_data), PAGE_SIZE, 0, &seg, 1, &nseg, 0);
414 1.1 nisimura if (error != 0) {
415 1.1 nisimura printf("%s: unable to allocate control data, error = %d\n",
416 1.1 nisimura sc->sc_dev.dv_xname, error);
417 1.1 nisimura goto fail_0;
418 1.1 nisimura }
419 1.1 nisimura error = bus_dmamem_map(sc->sc_dmat, &seg, nseg,
420 1.3 christos sizeof(struct kse_control_data), (void **)&sc->sc_control_data,
421 1.1 nisimura BUS_DMA_COHERENT);
422 1.1 nisimura if (error != 0) {
423 1.1 nisimura printf("%s: unable to map control data, error = %d\n",
424 1.1 nisimura sc->sc_dev.dv_xname, error);
425 1.1 nisimura goto fail_1;
426 1.1 nisimura }
427 1.1 nisimura error = bus_dmamap_create(sc->sc_dmat,
428 1.1 nisimura sizeof(struct kse_control_data), 1,
429 1.1 nisimura sizeof(struct kse_control_data), 0, 0, &sc->sc_cddmamap);
430 1.1 nisimura if (error != 0) {
431 1.1 nisimura printf("%s: unable to create control data DMA map, "
432 1.1 nisimura "error = %d\n", sc->sc_dev.dv_xname, error);
433 1.1 nisimura goto fail_2;
434 1.1 nisimura }
435 1.1 nisimura error = bus_dmamap_load(sc->sc_dmat, sc->sc_cddmamap,
436 1.1 nisimura sc->sc_control_data, sizeof(struct kse_control_data), NULL, 0);
437 1.1 nisimura if (error != 0) {
438 1.1 nisimura printf("%s: unable to load control data DMA map, error = %d\n",
439 1.1 nisimura sc->sc_dev.dv_xname, error);
440 1.1 nisimura goto fail_3;
441 1.1 nisimura }
442 1.1 nisimura for (i = 0; i < KSE_TXQUEUELEN; i++) {
443 1.1 nisimura if ((error = bus_dmamap_create(sc->sc_dmat, MCLBYTES,
444 1.1 nisimura KSE_NTXSEGS, MCLBYTES, 0, 0,
445 1.1 nisimura &sc->sc_txsoft[i].txs_dmamap)) != 0) {
446 1.1 nisimura printf("%s: unable to create tx DMA map %d, "
447 1.1 nisimura "error = %d\n", sc->sc_dev.dv_xname, i, error);
448 1.1 nisimura goto fail_4;
449 1.1 nisimura }
450 1.1 nisimura }
451 1.1 nisimura for (i = 0; i < KSE_NRXDESC; i++) {
452 1.1 nisimura if ((error = bus_dmamap_create(sc->sc_dmat, MCLBYTES,
453 1.1 nisimura 1, MCLBYTES, 0, 0, &sc->sc_rxsoft[i].rxs_dmamap)) != 0) {
454 1.1 nisimura printf("%s: unable to create rx DMA map %d, "
455 1.1 nisimura "error = %d\n", sc->sc_dev.dv_xname, i, error);
456 1.1 nisimura goto fail_5;
457 1.1 nisimura }
458 1.1 nisimura sc->sc_rxsoft[i].rxs_mbuf = NULL;
459 1.1 nisimura }
460 1.1 nisimura
461 1.4 ad callout_init(&sc->sc_callout, 0);
462 1.1 nisimura
463 1.1 nisimura ifmedia_init(&sc->sc_media, 0, ifmedia_upd, ifmedia_sts);
464 1.1 nisimura ifmedia_add(&sc->sc_media, IFM_ETHER|IFM_10_T, 0, NULL);
465 1.1 nisimura ifmedia_add(&sc->sc_media, IFM_ETHER|IFM_10_T|IFM_FDX, 0, NULL);
466 1.1 nisimura ifmedia_add(&sc->sc_media, IFM_ETHER|IFM_100_TX, 0, NULL);
467 1.1 nisimura ifmedia_add(&sc->sc_media, IFM_ETHER|IFM_100_TX|IFM_FDX, 0, NULL);
468 1.1 nisimura ifmedia_add(&sc->sc_media, IFM_ETHER|IFM_AUTO, 0, NULL);
469 1.1 nisimura ifmedia_set(&sc->sc_media, IFM_ETHER|IFM_AUTO);
470 1.1 nisimura
471 1.1 nisimura printf("%s: 10baseT, 10baseT-FDX, 100baseTX, 100baseTX-FDX, auto\n",
472 1.1 nisimura sc->sc_dev.dv_xname);
473 1.1 nisimura
474 1.1 nisimura ifp = &sc->sc_ethercom.ec_if;
475 1.1 nisimura strcpy(ifp->if_xname, sc->sc_dev.dv_xname);
476 1.1 nisimura ifp->if_softc = sc;
477 1.1 nisimura ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
478 1.1 nisimura ifp->if_ioctl = kse_ioctl;
479 1.1 nisimura ifp->if_start = kse_start;
480 1.1 nisimura ifp->if_watchdog = kse_watchdog;
481 1.1 nisimura ifp->if_init = kse_init;
482 1.1 nisimura ifp->if_stop = kse_stop;
483 1.1 nisimura IFQ_SET_READY(&ifp->if_snd);
484 1.1 nisimura
485 1.1 nisimura /*
486 1.1 nisimura * KSZ8842 can handle 802.1Q VLAN-sized frames,
487 1.1 nisimura * can do IPv4, TCPv4, and UDPv4 checksums in hardware.
488 1.1 nisimura */
489 1.1 nisimura sc->sc_ethercom.ec_capabilities |= ETHERCAP_VLAN_MTU;
490 1.1 nisimura ifp->if_capabilities |=
491 1.1 nisimura IFCAP_CSUM_IPv4_Tx | IFCAP_CSUM_IPv4_Rx |
492 1.1 nisimura IFCAP_CSUM_TCPv4_Tx | IFCAP_CSUM_TCPv4_Rx |
493 1.1 nisimura IFCAP_CSUM_UDPv4_Tx | IFCAP_CSUM_UDPv4_Rx;
494 1.1 nisimura
495 1.1 nisimura if_attach(ifp);
496 1.1 nisimura ether_ifattach(ifp, enaddr);
497 1.1 nisimura return;
498 1.1 nisimura
499 1.1 nisimura fail_5:
500 1.1 nisimura for (i = 0; i < KSE_NRXDESC; i++) {
501 1.1 nisimura if (sc->sc_rxsoft[i].rxs_dmamap != NULL)
502 1.1 nisimura bus_dmamap_destroy(sc->sc_dmat,
503 1.1 nisimura sc->sc_rxsoft[i].rxs_dmamap);
504 1.1 nisimura }
505 1.1 nisimura fail_4:
506 1.1 nisimura for (i = 0; i < KSE_TXQUEUELEN; i++) {
507 1.1 nisimura if (sc->sc_txsoft[i].txs_dmamap != NULL)
508 1.1 nisimura bus_dmamap_destroy(sc->sc_dmat,
509 1.1 nisimura sc->sc_txsoft[i].txs_dmamap);
510 1.1 nisimura }
511 1.1 nisimura bus_dmamap_unload(sc->sc_dmat, sc->sc_cddmamap);
512 1.1 nisimura fail_3:
513 1.1 nisimura bus_dmamap_destroy(sc->sc_dmat, sc->sc_cddmamap);
514 1.1 nisimura fail_2:
515 1.3 christos bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_control_data,
516 1.1 nisimura sizeof(struct kse_control_data));
517 1.1 nisimura fail_1:
518 1.1 nisimura bus_dmamem_free(sc->sc_dmat, &seg, nseg);
519 1.1 nisimura fail_0:
520 1.1 nisimura return;
521 1.1 nisimura }
522 1.1 nisimura
523 1.1 nisimura static int
524 1.3 christos kse_ioctl(struct ifnet *ifp, u_long cmd, void *data)
525 1.1 nisimura {
526 1.1 nisimura struct kse_softc *sc = ifp->if_softc;
527 1.1 nisimura struct ifreq *ifr = (struct ifreq *)data;
528 1.1 nisimura int s, error;
529 1.1 nisimura
530 1.1 nisimura s = splnet();
531 1.1 nisimura
532 1.1 nisimura switch (cmd) {
533 1.1 nisimura case SIOCSIFMEDIA:
534 1.1 nisimura case SIOCGIFMEDIA:
535 1.1 nisimura error = ifmedia_ioctl(ifp, ifr, &sc->sc_media, cmd);
536 1.1 nisimura break;
537 1.1 nisimura
538 1.1 nisimura default:
539 1.1 nisimura error = ether_ioctl(ifp, cmd, data);
540 1.1 nisimura if (cmd == ENETRESET) {
541 1.1 nisimura /*
542 1.1 nisimura * Multicast list has changed; set the hardware filter
543 1.1 nisimura * accordingly.
544 1.1 nisimura */
545 1.6 nisimura if (ifp->if_flags & IFF_RUNNING)
546 1.6 nisimura kse_set_filter(sc);
547 1.1 nisimura error = 0;
548 1.1 nisimura }
549 1.1 nisimura break;
550 1.1 nisimura }
551 1.1 nisimura
552 1.1 nisimura kse_start(ifp);
553 1.1 nisimura
554 1.1 nisimura splx(s);
555 1.1 nisimura return error;
556 1.1 nisimura }
557 1.1 nisimura
558 1.1 nisimura #define KSE_INTRS (INT_DMLCS|INT_DMTS|INT_DMRS|INT_DMRBUS)
559 1.1 nisimura
560 1.1 nisimura static int
561 1.1 nisimura kse_init(struct ifnet *ifp)
562 1.1 nisimura {
563 1.1 nisimura struct kse_softc *sc = ifp->if_softc;
564 1.2 tsutsui uint32_t paddr;
565 1.1 nisimura int i, error = 0;
566 1.1 nisimura
567 1.1 nisimura /* cancel pending I/O */
568 1.1 nisimura kse_stop(ifp, 0);
569 1.1 nisimura
570 1.1 nisimura /* reset all registers but PCI configuration */
571 1.1 nisimura kse_reset(sc);
572 1.1 nisimura
573 1.1 nisimura /* craft Tx descriptor ring */
574 1.1 nisimura memset(sc->sc_txdescs, 0, sizeof(sc->sc_txdescs));
575 1.1 nisimura for (i = 0, paddr = KSE_CDTXADDR(sc, 1); i < KSE_NTXDESC - 1; i++) {
576 1.1 nisimura sc->sc_txdescs[i].t3 = paddr;
577 1.1 nisimura paddr += sizeof(struct tdes);
578 1.1 nisimura }
579 1.1 nisimura sc->sc_txdescs[KSE_NTXDESC - 1].t3 = KSE_CDTXADDR(sc, 0);
580 1.1 nisimura KSE_CDTXSYNC(sc, 0, KSE_NTXDESC,
581 1.1 nisimura BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
582 1.1 nisimura sc->sc_txfree = KSE_NTXDESC;
583 1.1 nisimura sc->sc_txnext = 0;
584 1.1 nisimura
585 1.1 nisimura for (i = 0; i < KSE_TXQUEUELEN; i++)
586 1.1 nisimura sc->sc_txsoft[i].txs_mbuf = NULL;
587 1.1 nisimura sc->sc_txsfree = KSE_TXQUEUELEN;
588 1.1 nisimura sc->sc_txsnext = 0;
589 1.1 nisimura sc->sc_txsdirty = 0;
590 1.1 nisimura
591 1.1 nisimura /* craft Rx descriptor ring */
592 1.1 nisimura memset(sc->sc_rxdescs, 0, sizeof(sc->sc_rxdescs));
593 1.1 nisimura for (i = 0, paddr = KSE_CDRXADDR(sc, 1); i < KSE_NRXDESC - 1; i++) {
594 1.1 nisimura sc->sc_rxdescs[i].r3 = paddr;
595 1.1 nisimura paddr += sizeof(struct rdes);
596 1.1 nisimura }
597 1.1 nisimura sc->sc_rxdescs[KSE_NRXDESC - 1].r3 = KSE_CDRXADDR(sc, 0);
598 1.1 nisimura for (i = 0; i < KSE_NRXDESC; i++) {
599 1.1 nisimura if (sc->sc_rxsoft[i].rxs_mbuf == NULL) {
600 1.1 nisimura if ((error = add_rxbuf(sc, i)) != 0) {
601 1.1 nisimura printf("%s: unable to allocate or map rx "
602 1.1 nisimura "buffer %d, error = %d\n",
603 1.1 nisimura sc->sc_dev.dv_xname, i, error);
604 1.1 nisimura rxdrain(sc);
605 1.1 nisimura goto out;
606 1.1 nisimura }
607 1.1 nisimura }
608 1.1 nisimura else
609 1.1 nisimura KSE_INIT_RXDESC(sc, i);
610 1.1 nisimura }
611 1.1 nisimura sc->sc_rxptr = 0;
612 1.1 nisimura
613 1.1 nisimura /* hand Tx/Rx rings to HW */
614 1.1 nisimura CSR_WRITE_4(sc, TDLB, KSE_CDTXADDR(sc, 0));
615 1.1 nisimura CSR_WRITE_4(sc, RDLB, KSE_CDRXADDR(sc, 0));
616 1.1 nisimura
617 1.1 nisimura sc->sc_txc = TXC_TEN | TXC_EP | TXC_AC | TXC_FCE;
618 1.1 nisimura sc->sc_rxc = RXC_REN | RXC_RU | RXC_FCE;
619 1.1 nisimura if (ifp->if_flags & IFF_PROMISC)
620 1.1 nisimura sc->sc_rxc |= RXC_RA;
621 1.1 nisimura if (ifp->if_flags & IFF_BROADCAST)
622 1.1 nisimura sc->sc_rxc |= RXC_RB;
623 1.1 nisimura sc->sc_t1csum = sc->sc_mcsum = 0;
624 1.1 nisimura if (ifp->if_capenable & IFCAP_CSUM_IPv4_Rx) {
625 1.5 nisimura sc->sc_rxc |= RXC_ICC;
626 1.1 nisimura sc->sc_mcsum |= M_CSUM_IPv4;
627 1.1 nisimura }
628 1.1 nisimura if (ifp->if_capenable & IFCAP_CSUM_IPv4_Tx) {
629 1.1 nisimura sc->sc_txc |= TXC_ICG;
630 1.1 nisimura sc->sc_t1csum |= T1_IPCKG;
631 1.1 nisimura }
632 1.1 nisimura if (ifp->if_capenable & IFCAP_CSUM_TCPv4_Rx) {
633 1.5 nisimura sc->sc_rxc |= RXC_TCC;
634 1.1 nisimura sc->sc_mcsum |= M_CSUM_TCPv4;
635 1.1 nisimura }
636 1.1 nisimura if (ifp->if_capenable & IFCAP_CSUM_TCPv4_Tx) {
637 1.1 nisimura sc->sc_txc |= TXC_TCG;
638 1.1 nisimura sc->sc_t1csum |= T1_TCPCKG;
639 1.1 nisimura }
640 1.1 nisimura if (ifp->if_capenable & IFCAP_CSUM_UDPv4_Rx) {
641 1.5 nisimura sc->sc_rxc |= RXC_UCC;
642 1.1 nisimura sc->sc_mcsum |= M_CSUM_UDPv4;
643 1.1 nisimura }
644 1.1 nisimura if (ifp->if_capenable & IFCAP_CSUM_UDPv4_Tx) {
645 1.1 nisimura sc->sc_txc |= TXC_UCG;
646 1.1 nisimura sc->sc_t1csum |= T1_UDPCKG;
647 1.1 nisimura }
648 1.1 nisimura sc->sc_txc |= (kse_burstsize << TXC_BS_SFT);
649 1.1 nisimura sc->sc_rxc |= (kse_burstsize << RXC_BS_SFT);
650 1.1 nisimura
651 1.6 nisimura /* build multicast hash filter if necessary */
652 1.6 nisimura kse_set_filter(sc);
653 1.6 nisimura
654 1.1 nisimura /* set current media */
655 1.1 nisimura (void)ifmedia_upd(ifp);
656 1.1 nisimura
657 1.1 nisimura /* enable transmitter and receiver */
658 1.1 nisimura CSR_WRITE_4(sc, MDTXC, sc->sc_txc);
659 1.1 nisimura CSR_WRITE_4(sc, MDRXC, sc->sc_rxc);
660 1.1 nisimura CSR_WRITE_4(sc, MDRSC, 1);
661 1.1 nisimura
662 1.1 nisimura /* enable interrupts */
663 1.1 nisimura CSR_WRITE_4(sc, INTST, ~0);
664 1.1 nisimura CSR_WRITE_4(sc, INTEN, KSE_INTRS);
665 1.1 nisimura
666 1.1 nisimura ifp->if_flags |= IFF_RUNNING;
667 1.1 nisimura ifp->if_flags &= ~IFF_OACTIVE;
668 1.1 nisimura
669 1.1 nisimura /* start one second timer */
670 1.1 nisimura callout_reset(&sc->sc_callout, hz, phy_tick, sc);
671 1.1 nisimura
672 1.1 nisimura out:
673 1.1 nisimura if (error) {
674 1.1 nisimura ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
675 1.1 nisimura ifp->if_timer = 0;
676 1.1 nisimura printf("%s: interface not running\n", sc->sc_dev.dv_xname);
677 1.1 nisimura }
678 1.1 nisimura return error;
679 1.1 nisimura }
680 1.1 nisimura
681 1.1 nisimura static void
682 1.1 nisimura kse_stop(struct ifnet *ifp, int disable)
683 1.1 nisimura {
684 1.1 nisimura struct kse_softc *sc = ifp->if_softc;
685 1.1 nisimura struct kse_txsoft *txs;
686 1.1 nisimura int i;
687 1.1 nisimura
688 1.1 nisimura callout_stop(&sc->sc_callout);
689 1.1 nisimura
690 1.1 nisimura sc->sc_txc &= ~TXC_TEN;
691 1.1 nisimura sc->sc_rxc &= ~RXC_REN;
692 1.1 nisimura CSR_WRITE_4(sc, MDTXC, sc->sc_txc);
693 1.1 nisimura CSR_WRITE_4(sc, MDRXC, sc->sc_rxc);
694 1.1 nisimura
695 1.1 nisimura for (i = 0; i < KSE_TXQUEUELEN; i++) {
696 1.1 nisimura txs = &sc->sc_txsoft[i];
697 1.1 nisimura if (txs->txs_mbuf != NULL) {
698 1.1 nisimura bus_dmamap_unload(sc->sc_dmat, txs->txs_dmamap);
699 1.1 nisimura m_freem(txs->txs_mbuf);
700 1.1 nisimura txs->txs_mbuf = NULL;
701 1.1 nisimura }
702 1.1 nisimura }
703 1.1 nisimura
704 1.1 nisimura if (disable)
705 1.1 nisimura rxdrain(sc);
706 1.1 nisimura
707 1.1 nisimura ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
708 1.1 nisimura ifp->if_timer = 0;
709 1.1 nisimura }
710 1.1 nisimura
711 1.1 nisimura static void
712 1.1 nisimura kse_reset(struct kse_softc *sc)
713 1.1 nisimura {
714 1.1 nisimura
715 1.1 nisimura CSR_WRITE_2(sc, GRR, 1);
716 1.1 nisimura delay(1000); /* PDF does not mention the delay amount */
717 1.1 nisimura CSR_WRITE_2(sc, GRR, 0);
718 1.1 nisimura
719 1.1 nisimura CSR_WRITE_2(sc, CIDR, 1);
720 1.1 nisimura }
721 1.1 nisimura
722 1.1 nisimura static void
723 1.1 nisimura kse_watchdog(struct ifnet *ifp)
724 1.1 nisimura {
725 1.1 nisimura struct kse_softc *sc = ifp->if_softc;
726 1.1 nisimura
727 1.1 nisimura /*
728 1.1 nisimura * Since we're not interrupting every packet, sweep
729 1.1 nisimura * up before we report an error.
730 1.1 nisimura */
731 1.1 nisimura txreap(sc);
732 1.1 nisimura
733 1.1 nisimura if (sc->sc_txfree != KSE_NTXDESC) {
734 1.1 nisimura printf("%s: device timeout (txfree %d txsfree %d txnext %d)\n",
735 1.1 nisimura sc->sc_dev.dv_xname, sc->sc_txfree, sc->sc_txsfree,
736 1.1 nisimura sc->sc_txnext);
737 1.1 nisimura ifp->if_oerrors++;
738 1.1 nisimura
739 1.1 nisimura /* Reset the interface. */
740 1.1 nisimura kse_init(ifp);
741 1.1 nisimura }
742 1.1 nisimura else if (ifp->if_flags & IFF_DEBUG)
743 1.1 nisimura printf("%s: recovered from device timeout\n",
744 1.1 nisimura sc->sc_dev.dv_xname);
745 1.1 nisimura
746 1.1 nisimura /* Try to get more packets going. */
747 1.1 nisimura kse_start(ifp);
748 1.1 nisimura }
749 1.1 nisimura
750 1.1 nisimura static void
751 1.1 nisimura kse_start(struct ifnet *ifp)
752 1.1 nisimura {
753 1.1 nisimura struct kse_softc *sc = ifp->if_softc;
754 1.1 nisimura struct mbuf *m0;
755 1.1 nisimura struct kse_txsoft *txs;
756 1.1 nisimura bus_dmamap_t dmamap;
757 1.1 nisimura int error, nexttx, lasttx, ofree, seg;
758 1.6 nisimura uint32_t tdes0;
759 1.1 nisimura
760 1.1 nisimura if ((ifp->if_flags & (IFF_RUNNING|IFF_OACTIVE)) != IFF_RUNNING)
761 1.1 nisimura return;
762 1.1 nisimura
763 1.1 nisimura /*
764 1.1 nisimura * Remember the previous number of free descriptors.
765 1.1 nisimura */
766 1.1 nisimura ofree = sc->sc_txfree;
767 1.1 nisimura
768 1.1 nisimura /*
769 1.1 nisimura * Loop through the send queue, setting up transmit descriptors
770 1.1 nisimura * until we drain the queue, or use up all available transmit
771 1.1 nisimura * descriptors.
772 1.1 nisimura */
773 1.1 nisimura for (;;) {
774 1.1 nisimura IFQ_POLL(&ifp->if_snd, m0);
775 1.1 nisimura if (m0 == NULL)
776 1.1 nisimura break;
777 1.1 nisimura
778 1.1 nisimura if (sc->sc_txsfree < KSE_TXQUEUE_GC) {
779 1.1 nisimura txreap(sc);
780 1.1 nisimura if (sc->sc_txsfree == 0)
781 1.1 nisimura break;
782 1.1 nisimura }
783 1.1 nisimura txs = &sc->sc_txsoft[sc->sc_txsnext];
784 1.1 nisimura dmamap = txs->txs_dmamap;
785 1.1 nisimura
786 1.1 nisimura error = bus_dmamap_load_mbuf(sc->sc_dmat, dmamap, m0,
787 1.1 nisimura BUS_DMA_WRITE|BUS_DMA_NOWAIT);
788 1.1 nisimura if (error) {
789 1.1 nisimura if (error == EFBIG) {
790 1.1 nisimura printf("%s: Tx packet consumes too many "
791 1.1 nisimura "DMA segments, dropping...\n",
792 1.1 nisimura sc->sc_dev.dv_xname);
793 1.1 nisimura IFQ_DEQUEUE(&ifp->if_snd, m0);
794 1.1 nisimura m_freem(m0);
795 1.1 nisimura continue;
796 1.1 nisimura }
797 1.1 nisimura /* Short on resources, just stop for now. */
798 1.1 nisimura break;
799 1.1 nisimura }
800 1.1 nisimura
801 1.1 nisimura if (dmamap->dm_nsegs > sc->sc_txfree) {
802 1.1 nisimura /*
803 1.1 nisimura * Not enough free descriptors to transmit this
804 1.1 nisimura * packet. We haven't committed anything yet,
805 1.1 nisimura * so just unload the DMA map, put the packet
806 1.1 nisimura * back on the queue, and punt. Notify the upper
807 1.1 nisimura * layer that there are not more slots left.
808 1.1 nisimura */
809 1.1 nisimura ifp->if_flags |= IFF_OACTIVE;
810 1.1 nisimura bus_dmamap_unload(sc->sc_dmat, dmamap);
811 1.1 nisimura break;
812 1.1 nisimura }
813 1.1 nisimura
814 1.1 nisimura IFQ_DEQUEUE(&ifp->if_snd, m0);
815 1.1 nisimura
816 1.1 nisimura /*
817 1.1 nisimura * WE ARE NOW COMMITTED TO TRANSMITTING THE PACKET.
818 1.1 nisimura */
819 1.1 nisimura
820 1.1 nisimura bus_dmamap_sync(sc->sc_dmat, dmamap, 0, dmamap->dm_mapsize,
821 1.1 nisimura BUS_DMASYNC_PREWRITE);
822 1.1 nisimura
823 1.6 nisimura lasttx = -1; tdes0 = 0;
824 1.1 nisimura for (nexttx = sc->sc_txnext, seg = 0;
825 1.1 nisimura seg < dmamap->dm_nsegs;
826 1.1 nisimura seg++, nexttx = KSE_NEXTTX(nexttx)) {
827 1.1 nisimura struct tdes *tdes = &sc->sc_txdescs[nexttx];
828 1.1 nisimura /*
829 1.1 nisimura * If this is the first descriptor we're
830 1.1 nisimura * enqueueing, don't set the OWN bit just
831 1.1 nisimura * yet. That could cause a race condition.
832 1.1 nisimura * We'll do it below.
833 1.1 nisimura */
834 1.1 nisimura tdes->t2 = dmamap->dm_segs[seg].ds_addr;
835 1.1 nisimura tdes->t1 = sc->sc_t1csum
836 1.1 nisimura | (dmamap->dm_segs[seg].ds_len & T1_TBS_MASK);
837 1.6 nisimura tdes->t0 = tdes0;
838 1.6 nisimura tdes0 |= T0_OWN;
839 1.1 nisimura lasttx = nexttx;
840 1.1 nisimura }
841 1.1 nisimura #if 0
842 1.1 nisimura /*
843 1.1 nisimura * T1_IC bit could schedule Tx frame done interrupt here,
844 1.1 nisimura * but this driver takes a "shoot away" Tx strategy.
845 1.1 nisimura */
846 1.1 nisimura #else
847 1.1 nisimura {
848 1.1 nisimura /*
849 1.1 nisimura * Outgoing NFS mbuf must be unloaded when Tx completed.
850 1.1 nisimura * Without T1_IC NFS mbuf is left unack'ed for excessive
851 1.1 nisimura * time and NFS stops to proceed until kse_watchdog()
852 1.1 nisimura * calls txreap() to reclaim the unack'ed mbuf.
853 1.5 nisimura * It's painful to traverse every mbuf chain to determine
854 1.1 nisimura * whether someone is waiting for Tx completion.
855 1.1 nisimura */
856 1.1 nisimura struct mbuf *m = m0;
857 1.1 nisimura do {
858 1.1 nisimura if ((m->m_flags & M_EXT) && m->m_ext.ext_free) {
859 1.1 nisimura sc->sc_txdescs[lasttx].t1 |= T1_IC;
860 1.1 nisimura break;
861 1.1 nisimura }
862 1.1 nisimura } while ((m = m->m_next) != NULL);
863 1.1 nisimura }
864 1.1 nisimura #endif
865 1.1 nisimura
866 1.1 nisimura /* write last T0_OWN bit of the 1st segment */
867 1.1 nisimura sc->sc_txdescs[lasttx].t1 |= T1_LS;
868 1.1 nisimura sc->sc_txdescs[sc->sc_txnext].t1 |= T1_FS;
869 1.1 nisimura sc->sc_txdescs[sc->sc_txnext].t0 = T0_OWN;
870 1.1 nisimura KSE_CDTXSYNC(sc, sc->sc_txnext, dmamap->dm_nsegs,
871 1.1 nisimura BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
872 1.1 nisimura
873 1.1 nisimura /* tell DMA start transmit */
874 1.1 nisimura CSR_WRITE_4(sc, MDTSC, 1);
875 1.1 nisimura
876 1.1 nisimura txs->txs_mbuf = m0;
877 1.1 nisimura txs->txs_firstdesc = sc->sc_txnext;
878 1.1 nisimura txs->txs_lastdesc = lasttx;
879 1.1 nisimura txs->txs_ndesc = dmamap->dm_nsegs;
880 1.1 nisimura
881 1.1 nisimura sc->sc_txfree -= txs->txs_ndesc;
882 1.1 nisimura sc->sc_txnext = nexttx;
883 1.1 nisimura sc->sc_txsfree--;
884 1.1 nisimura sc->sc_txsnext = KSE_NEXTTXS(sc->sc_txsnext);
885 1.1 nisimura #if NBPFILTER > 0
886 1.1 nisimura /*
887 1.1 nisimura * Pass the packet to any BPF listeners.
888 1.1 nisimura */
889 1.1 nisimura if (ifp->if_bpf)
890 1.1 nisimura bpf_mtap(ifp->if_bpf, m0);
891 1.1 nisimura #endif /* NBPFILTER > 0 */
892 1.1 nisimura }
893 1.1 nisimura
894 1.1 nisimura if (sc->sc_txsfree == 0 || sc->sc_txfree == 0) {
895 1.1 nisimura /* No more slots left; notify upper layer. */
896 1.1 nisimura ifp->if_flags |= IFF_OACTIVE;
897 1.1 nisimura }
898 1.1 nisimura if (sc->sc_txfree != ofree) {
899 1.1 nisimura /* Set a watchdog timer in case the chip flakes out. */
900 1.1 nisimura ifp->if_timer = 5;
901 1.1 nisimura }
902 1.1 nisimura }
903 1.1 nisimura
904 1.1 nisimura static void
905 1.1 nisimura kse_set_filter(struct kse_softc *sc)
906 1.1 nisimura {
907 1.1 nisimura struct ether_multistep step;
908 1.1 nisimura struct ether_multi *enm;
909 1.1 nisimura struct ifnet *ifp = &sc->sc_ethercom.ec_if;
910 1.6 nisimura uint32_t h, hashes[2];
911 1.6 nisimura
912 1.6 nisimura sc->sc_rxc &= ~(RXC_MHTE | RXC_RM);
913 1.6 nisimura ifp->if_flags &= ~IFF_ALLMULTI;
914 1.6 nisimura if (ifp->if_flags & IFF_PROMISC)
915 1.6 nisimura return;
916 1.1 nisimura
917 1.1 nisimura ETHER_FIRST_MULTI(step, &sc->sc_ethercom, enm);
918 1.6 nisimura if (enm == NULL)
919 1.6 nisimura return;
920 1.6 nisimura hashes[0] = hashes[1] = 0;
921 1.6 nisimura do {
922 1.6 nisimura if (memcmp(enm->enm_addrlo, enm->enm_addrhi, ETHER_ADDR_LEN)) {
923 1.6 nisimura /*
924 1.6 nisimura * We must listen to a range of multicast addresses.
925 1.6 nisimura * For now, just accept all multicasts, rather than
926 1.6 nisimura * trying to set only those filter bits needed to match
927 1.6 nisimura * the range. (At this time, the only use of address
928 1.6 nisimura * ranges is for IP multicast routing, for which the
929 1.6 nisimura * range is big enough to require all bits set.)
930 1.6 nisimura */
931 1.6 nisimura goto allmulti;
932 1.1 nisimura }
933 1.6 nisimura h = ether_crc32_le(enm->enm_addrlo, ETHER_ADDR_LEN) >> 26;
934 1.6 nisimura hashes[h >> 5] |= 1 << (h & 0x1f);
935 1.1 nisimura ETHER_NEXT_MULTI(step, enm);
936 1.6 nisimura } while (enm != NULL);
937 1.6 nisimura sc->sc_rxc |= RXC_MHTE;
938 1.6 nisimura CSR_WRITE_4(sc, MTR0, hashes[0]);
939 1.6 nisimura CSR_WRITE_4(sc, MTR1, hashes[1]);
940 1.1 nisimura return;
941 1.6 nisimura allmulti:
942 1.6 nisimura sc->sc_rxc |= RXC_RM;
943 1.6 nisimura ifp->if_flags |= IFF_ALLMULTI;
944 1.1 nisimura }
945 1.1 nisimura
946 1.1 nisimura static int
947 1.1 nisimura add_rxbuf(struct kse_softc *sc, int idx)
948 1.1 nisimura {
949 1.1 nisimura struct kse_rxsoft *rxs = &sc->sc_rxsoft[idx];
950 1.1 nisimura struct mbuf *m;
951 1.1 nisimura int error;
952 1.1 nisimura
953 1.1 nisimura MGETHDR(m, M_DONTWAIT, MT_DATA);
954 1.1 nisimura if (m == NULL)
955 1.1 nisimura return ENOBUFS;
956 1.1 nisimura
957 1.1 nisimura MCLGET(m, M_DONTWAIT);
958 1.1 nisimura if ((m->m_flags & M_EXT) == 0) {
959 1.1 nisimura m_freem(m);
960 1.1 nisimura return ENOBUFS;
961 1.1 nisimura }
962 1.1 nisimura
963 1.1 nisimura if (rxs->rxs_mbuf != NULL)
964 1.1 nisimura bus_dmamap_unload(sc->sc_dmat, rxs->rxs_dmamap);
965 1.1 nisimura
966 1.1 nisimura rxs->rxs_mbuf = m;
967 1.1 nisimura
968 1.1 nisimura error = bus_dmamap_load(sc->sc_dmat, rxs->rxs_dmamap,
969 1.1 nisimura m->m_ext.ext_buf, m->m_ext.ext_size, NULL, BUS_DMA_NOWAIT);
970 1.1 nisimura if (error) {
971 1.1 nisimura printf("%s: can't load rx DMA map %d, error = %d\n",
972 1.1 nisimura sc->sc_dev.dv_xname, idx, error);
973 1.1 nisimura panic("kse_add_rxbuf");
974 1.1 nisimura }
975 1.1 nisimura
976 1.1 nisimura bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
977 1.1 nisimura rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_PREREAD);
978 1.1 nisimura
979 1.1 nisimura KSE_INIT_RXDESC(sc, idx);
980 1.1 nisimura
981 1.1 nisimura return 0;
982 1.1 nisimura }
983 1.1 nisimura
984 1.1 nisimura static void
985 1.1 nisimura rxdrain(struct kse_softc *sc)
986 1.1 nisimura {
987 1.1 nisimura struct kse_rxsoft *rxs;
988 1.1 nisimura int i;
989 1.1 nisimura
990 1.1 nisimura for (i = 0; i < KSE_NRXDESC; i++) {
991 1.1 nisimura rxs = &sc->sc_rxsoft[i];
992 1.1 nisimura if (rxs->rxs_mbuf != NULL) {
993 1.1 nisimura bus_dmamap_unload(sc->sc_dmat, rxs->rxs_dmamap);
994 1.1 nisimura m_freem(rxs->rxs_mbuf);
995 1.1 nisimura rxs->rxs_mbuf = NULL;
996 1.1 nisimura }
997 1.1 nisimura }
998 1.1 nisimura }
999 1.1 nisimura
1000 1.1 nisimura static int
1001 1.1 nisimura kse_intr(void *arg)
1002 1.1 nisimura {
1003 1.1 nisimura struct kse_softc *sc = arg;
1004 1.2 tsutsui uint32_t isr;
1005 1.1 nisimura
1006 1.1 nisimura if ((isr = CSR_READ_4(sc, INTST)) == 0)
1007 1.1 nisimura return 0;
1008 1.1 nisimura
1009 1.1 nisimura if (isr & INT_DMRS)
1010 1.1 nisimura rxintr(sc);
1011 1.1 nisimura if (isr & INT_DMTS)
1012 1.1 nisimura txreap(sc);
1013 1.1 nisimura if (isr & INT_DMLCS)
1014 1.1 nisimura lnkchg(sc);
1015 1.1 nisimura if (isr & INT_DMRBUS)
1016 1.1 nisimura printf("%s: Rx descriptor full\n", sc->sc_dev.dv_xname);
1017 1.1 nisimura
1018 1.1 nisimura CSR_WRITE_4(sc, INTST, isr);
1019 1.1 nisimura return 1;
1020 1.1 nisimura }
1021 1.1 nisimura
1022 1.1 nisimura static void
1023 1.1 nisimura rxintr(struct kse_softc *sc)
1024 1.1 nisimura {
1025 1.1 nisimura struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1026 1.1 nisimura struct kse_rxsoft *rxs;
1027 1.1 nisimura struct mbuf *m;
1028 1.2 tsutsui uint32_t rxstat;
1029 1.1 nisimura int i, len;
1030 1.1 nisimura
1031 1.1 nisimura for (i = sc->sc_rxptr; /*CONSTCOND*/ 1; i = KSE_NEXTRX(i)) {
1032 1.1 nisimura rxs = &sc->sc_rxsoft[i];
1033 1.1 nisimura
1034 1.1 nisimura KSE_CDRXSYNC(sc, i,
1035 1.1 nisimura BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
1036 1.1 nisimura
1037 1.1 nisimura rxstat = sc->sc_rxdescs[i].r0;
1038 1.1 nisimura
1039 1.1 nisimura if (rxstat & R0_OWN) /* desc is left empty */
1040 1.1 nisimura break;
1041 1.1 nisimura
1042 1.1 nisimura /* R0_FS|R0_LS must have been marked for this desc */
1043 1.1 nisimura
1044 1.1 nisimura if (rxstat & R0_ES) {
1045 1.1 nisimura ifp->if_ierrors++;
1046 1.1 nisimura #define PRINTERR(bit, str) \
1047 1.1 nisimura if (rxstat & (bit)) \
1048 1.1 nisimura printf("%s: receive error: %s\n", \
1049 1.1 nisimura sc->sc_dev.dv_xname, str)
1050 1.1 nisimura PRINTERR(R0_TL, "frame too long");
1051 1.1 nisimura PRINTERR(R0_RF, "runt frame");
1052 1.1 nisimura PRINTERR(R0_CE, "bad FCS");
1053 1.1 nisimura #undef PRINTERR
1054 1.1 nisimura KSE_INIT_RXDESC(sc, i);
1055 1.1 nisimura continue;
1056 1.1 nisimura }
1057 1.1 nisimura
1058 1.1 nisimura /* HW errata; frame might be too small or too large */
1059 1.1 nisimura
1060 1.1 nisimura bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
1061 1.1 nisimura rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_POSTREAD);
1062 1.1 nisimura
1063 1.1 nisimura len = rxstat & R0_FL_MASK;
1064 1.2 tsutsui len -= ETHER_CRC_LEN; /* trim CRC off */
1065 1.1 nisimura m = rxs->rxs_mbuf;
1066 1.1 nisimura
1067 1.1 nisimura if (add_rxbuf(sc, i) != 0) {
1068 1.1 nisimura ifp->if_ierrors++;
1069 1.1 nisimura KSE_INIT_RXDESC(sc, i);
1070 1.1 nisimura bus_dmamap_sync(sc->sc_dmat,
1071 1.1 nisimura rxs->rxs_dmamap, 0,
1072 1.1 nisimura rxs->rxs_dmamap->dm_mapsize,
1073 1.1 nisimura BUS_DMASYNC_PREREAD);
1074 1.1 nisimura continue;
1075 1.1 nisimura }
1076 1.1 nisimura
1077 1.1 nisimura ifp->if_ipackets++;
1078 1.1 nisimura m->m_pkthdr.rcvif = ifp;
1079 1.1 nisimura m->m_pkthdr.len = m->m_len = len;
1080 1.1 nisimura
1081 1.1 nisimura if (sc->sc_mcsum) {
1082 1.1 nisimura m->m_pkthdr.csum_flags |= sc->sc_mcsum;
1083 1.1 nisimura if (rxstat & R0_IPE)
1084 1.1 nisimura m->m_pkthdr.csum_flags |= M_CSUM_IPv4_BAD;
1085 1.1 nisimura if (rxstat & (R0_TCPE | R0_UDPE))
1086 1.1 nisimura m->m_pkthdr.csum_flags |= M_CSUM_TCP_UDP_BAD;
1087 1.1 nisimura }
1088 1.1 nisimura #if NBPFILTER > 0
1089 1.1 nisimura if (ifp->if_bpf)
1090 1.1 nisimura bpf_mtap(ifp->if_bpf, m);
1091 1.1 nisimura #endif /* NBPFILTER > 0 */
1092 1.1 nisimura (*ifp->if_input)(ifp, m);
1093 1.1 nisimura #ifdef KSEDIAGNOSTIC
1094 1.1 nisimura if (kse_monitor_rxintr > 0) {
1095 1.1 nisimura printf("m stat %x data %p len %d\n",
1096 1.1 nisimura rxstat, m->m_data, m->m_len);
1097 1.1 nisimura }
1098 1.1 nisimura #endif
1099 1.1 nisimura }
1100 1.1 nisimura sc->sc_rxptr = i;
1101 1.1 nisimura }
1102 1.1 nisimura
1103 1.1 nisimura static void
1104 1.1 nisimura txreap(struct kse_softc *sc)
1105 1.1 nisimura {
1106 1.1 nisimura struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1107 1.1 nisimura struct kse_txsoft *txs;
1108 1.2 tsutsui uint32_t txstat;
1109 1.1 nisimura int i;
1110 1.1 nisimura
1111 1.1 nisimura ifp->if_flags &= ~IFF_OACTIVE;
1112 1.1 nisimura
1113 1.1 nisimura for (i = sc->sc_txsdirty; sc->sc_txsfree != KSE_TXQUEUELEN;
1114 1.1 nisimura i = KSE_NEXTTXS(i), sc->sc_txsfree++) {
1115 1.1 nisimura txs = &sc->sc_txsoft[i];
1116 1.1 nisimura
1117 1.1 nisimura KSE_CDTXSYNC(sc, txs->txs_firstdesc, txs->txs_ndesc,
1118 1.1 nisimura BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
1119 1.1 nisimura
1120 1.1 nisimura txstat = sc->sc_txdescs[txs->txs_lastdesc].t0;
1121 1.1 nisimura
1122 1.1 nisimura if (txstat & T0_OWN) /* desc is still in use */
1123 1.1 nisimura break;
1124 1.1 nisimura
1125 1.1 nisimura /* there is no way to tell transmission status per frame */
1126 1.1 nisimura
1127 1.1 nisimura ifp->if_opackets++;
1128 1.1 nisimura
1129 1.1 nisimura sc->sc_txfree += txs->txs_ndesc;
1130 1.1 nisimura bus_dmamap_sync(sc->sc_dmat, txs->txs_dmamap,
1131 1.1 nisimura 0, txs->txs_dmamap->dm_mapsize, BUS_DMASYNC_POSTWRITE);
1132 1.1 nisimura bus_dmamap_unload(sc->sc_dmat, txs->txs_dmamap);
1133 1.1 nisimura m_freem(txs->txs_mbuf);
1134 1.1 nisimura txs->txs_mbuf = NULL;
1135 1.1 nisimura }
1136 1.1 nisimura sc->sc_txsdirty = i;
1137 1.1 nisimura if (sc->sc_txsfree == KSE_TXQUEUELEN)
1138 1.1 nisimura ifp->if_timer = 0;
1139 1.1 nisimura }
1140 1.1 nisimura
1141 1.1 nisimura static void
1142 1.1 nisimura lnkchg(struct kse_softc *sc)
1143 1.1 nisimura {
1144 1.1 nisimura struct ifmediareq ifmr;
1145 1.1 nisimura
1146 1.1 nisimura #if 0 /* rambling link status */
1147 1.1 nisimura printf("%s: link %s\n", sc->sc_dev.dv_xname,
1148 1.1 nisimura (CSR_READ_2(sc, P1SR) & (1U << 5)) ? "up" : "down");
1149 1.1 nisimura #endif
1150 1.1 nisimura ifmedia_sts(&sc->sc_ethercom.ec_if, &ifmr);
1151 1.1 nisimura }
1152 1.1 nisimura
1153 1.1 nisimura static int
1154 1.1 nisimura ifmedia_upd(struct ifnet *ifp)
1155 1.1 nisimura {
1156 1.1 nisimura struct kse_softc *sc = ifp->if_softc;
1157 1.1 nisimura struct ifmedia *ifm = &sc->sc_media;
1158 1.2 tsutsui uint16_t ctl;
1159 1.1 nisimura
1160 1.1 nisimura ctl = 0;
1161 1.1 nisimura if (IFM_SUBTYPE(ifm->ifm_media) == IFM_AUTO) {
1162 1.1 nisimura ctl |= (1U << 13); /* restart AN */
1163 1.1 nisimura ctl |= (1U << 7); /* enable AN */
1164 1.1 nisimura ctl |= (1U << 4); /* advertise flow control pause */
1165 1.1 nisimura ctl |= (1U << 3) | (1U << 2) | (1U << 1) | (1U << 0);
1166 1.1 nisimura }
1167 1.1 nisimura else {
1168 1.1 nisimura if (IFM_SUBTYPE(ifm->ifm_media) == IFM_100_TX)
1169 1.1 nisimura ctl |= (1U << 6);
1170 1.1 nisimura if (ifm->ifm_media & IFM_FDX)
1171 1.1 nisimura ctl |= (1U << 5);
1172 1.1 nisimura }
1173 1.1 nisimura CSR_WRITE_2(sc, P1CR4, ctl);
1174 1.1 nisimura
1175 1.1 nisimura sc->sc_media_active = IFM_NONE;
1176 1.1 nisimura sc->sc_media_status = IFM_AVALID;
1177 1.1 nisimura
1178 1.1 nisimura return 0;
1179 1.1 nisimura }
1180 1.1 nisimura
1181 1.1 nisimura static void
1182 1.1 nisimura ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
1183 1.1 nisimura {
1184 1.1 nisimura struct kse_softc *sc = ifp->if_softc;
1185 1.1 nisimura struct ifmedia *ifm = &sc->sc_media;
1186 1.2 tsutsui uint16_t ctl, sts, result;
1187 1.1 nisimura
1188 1.1 nisimura ifmr->ifm_status = IFM_AVALID;
1189 1.1 nisimura ifmr->ifm_active = IFM_ETHER;
1190 1.1 nisimura
1191 1.1 nisimura ctl = CSR_READ_2(sc, P1CR4);
1192 1.1 nisimura sts = CSR_READ_2(sc, P1SR);
1193 1.1 nisimura if ((sts & (1U << 5)) == 0) {
1194 1.1 nisimura ifmr->ifm_active |= IFM_NONE;
1195 1.1 nisimura goto out; /* link is down */
1196 1.1 nisimura }
1197 1.1 nisimura ifmr->ifm_status |= IFM_ACTIVE;
1198 1.1 nisimura if (IFM_SUBTYPE(ifm->ifm_media) == IFM_AUTO) {
1199 1.1 nisimura if ((sts & (1U << 6)) == 0) {
1200 1.1 nisimura ifmr->ifm_active |= IFM_NONE;
1201 1.1 nisimura goto out; /* negotiation in progress */
1202 1.1 nisimura }
1203 1.1 nisimura result = ctl & sts & 017;
1204 1.1 nisimura if (result & (1U << 3))
1205 1.1 nisimura ifmr->ifm_active |= IFM_100_TX|IFM_FDX;
1206 1.1 nisimura else if (result & (1U << 2))
1207 1.1 nisimura ifmr->ifm_active |= IFM_100_TX;
1208 1.1 nisimura else if (result & (1U << 1))
1209 1.1 nisimura ifmr->ifm_active |= IFM_10_T|IFM_FDX;
1210 1.1 nisimura else if (result & (1U << 0))
1211 1.1 nisimura ifmr->ifm_active |= IFM_10_T;
1212 1.1 nisimura else
1213 1.1 nisimura ifmr->ifm_active |= IFM_NONE;
1214 1.1 nisimura if (ctl & (1U << 4))
1215 1.1 nisimura ifmr->ifm_active |= IFM_FLOW | IFM_ETH_RXPAUSE;
1216 1.1 nisimura if (sts & (1U << 4))
1217 1.1 nisimura ifmr->ifm_active |= IFM_FLOW | IFM_ETH_TXPAUSE;
1218 1.1 nisimura }
1219 1.1 nisimura else {
1220 1.1 nisimura ifmr->ifm_active |= (sts & (1U << 10)) ? IFM_100_TX : IFM_10_T;
1221 1.1 nisimura if (sts & (1U << 9))
1222 1.1 nisimura ifmr->ifm_active |= IFM_FDX;
1223 1.1 nisimura if (sts & (1U << 12))
1224 1.1 nisimura ifmr->ifm_active |= IFM_FLOW | IFM_ETH_RXPAUSE;
1225 1.1 nisimura if (sts & (1U << 11))
1226 1.1 nisimura ifmr->ifm_active |= IFM_FLOW | IFM_ETH_TXPAUSE;
1227 1.1 nisimura }
1228 1.1 nisimura
1229 1.1 nisimura out:
1230 1.1 nisimura sc->sc_media_status = ifmr->ifm_status;
1231 1.1 nisimura sc->sc_media_active = ifmr->ifm_active;
1232 1.1 nisimura }
1233 1.1 nisimura
1234 1.1 nisimura static void
1235 1.1 nisimura phy_tick(void *arg)
1236 1.1 nisimura {
1237 1.1 nisimura struct kse_softc *sc = arg;
1238 1.1 nisimura struct ifmediareq ifmr;
1239 1.1 nisimura int s;
1240 1.1 nisimura
1241 1.1 nisimura s = splnet();
1242 1.1 nisimura ifmedia_sts(&sc->sc_ethercom.ec_if, &ifmr);
1243 1.1 nisimura splx(s);
1244 1.1 nisimura
1245 1.1 nisimura callout_reset(&sc->sc_callout, hz, phy_tick, sc);
1246 1.1 nisimura }
1247