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