if_cemac.c revision 1.13 1 1.13 msaitoh /* $NetBSD: if_cemac.c,v 1.13 2018/06/26 06:48:00 msaitoh Exp $ */
2 1.1 hkenken
3 1.1 hkenken /*
4 1.1 hkenken * Copyright (c) 2015 Genetec Corporation. All rights reserved.
5 1.1 hkenken * Written by Hashimoto Kenichi for Genetec Corporation.
6 1.1 hkenken *
7 1.1 hkenken * Based on arch/arm/at91/at91emac.c
8 1.1 hkenken *
9 1.1 hkenken * Copyright (c) 2007 Embedtronics Oy
10 1.1 hkenken * All rights reserved.
11 1.1 hkenken *
12 1.1 hkenken * Copyright (c) 2004 Jesse Off
13 1.1 hkenken * All rights reserved.
14 1.1 hkenken *
15 1.1 hkenken * Redistribution and use in source and binary forms, with or without
16 1.1 hkenken * modification, are permitted provided that the following conditions
17 1.1 hkenken * are met:
18 1.1 hkenken * 1. Redistributions of source code must retain the above copyright
19 1.1 hkenken * notice, this list of conditions and the following disclaimer.
20 1.1 hkenken * 2. Redistributions in binary form must reproduce the above copyright
21 1.1 hkenken * notice, this list of conditions and the following disclaimer in the
22 1.1 hkenken * documentation and/or other materials provided with the distribution.
23 1.1 hkenken *
24 1.1 hkenken * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
25 1.1 hkenken * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
26 1.1 hkenken * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
27 1.1 hkenken * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
28 1.1 hkenken * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
29 1.1 hkenken * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
30 1.1 hkenken * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
31 1.1 hkenken * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
32 1.1 hkenken * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
33 1.1 hkenken * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
34 1.1 hkenken * POSSIBILITY OF SUCH DAMAGE.
35 1.1 hkenken */
36 1.1 hkenken
37 1.1 hkenken /*
38 1.1 hkenken * Cadence EMAC/GEM ethernet controller IP driver
39 1.1 hkenken * used by arm/at91, arm/zynq SoC
40 1.1 hkenken */
41 1.1 hkenken
42 1.1 hkenken #include <sys/cdefs.h>
43 1.13 msaitoh __KERNEL_RCSID(0, "$NetBSD: if_cemac.c,v 1.13 2018/06/26 06:48:00 msaitoh Exp $");
44 1.1 hkenken
45 1.1 hkenken #include <sys/types.h>
46 1.1 hkenken #include <sys/param.h>
47 1.1 hkenken #include <sys/systm.h>
48 1.1 hkenken #include <sys/ioctl.h>
49 1.1 hkenken #include <sys/kernel.h>
50 1.1 hkenken #include <sys/proc.h>
51 1.1 hkenken #include <sys/malloc.h>
52 1.1 hkenken #include <sys/time.h>
53 1.1 hkenken #include <sys/device.h>
54 1.1 hkenken #include <uvm/uvm_extern.h>
55 1.1 hkenken
56 1.1 hkenken #include <sys/bus.h>
57 1.1 hkenken #include <machine/intr.h>
58 1.1 hkenken
59 1.1 hkenken #include <arm/cpufunc.h>
60 1.1 hkenken
61 1.1 hkenken #include <net/if.h>
62 1.1 hkenken #include <net/if_dl.h>
63 1.1 hkenken #include <net/if_types.h>
64 1.1 hkenken #include <net/if_media.h>
65 1.1 hkenken #include <net/if_ether.h>
66 1.12 msaitoh #include <net/bpf.h>
67 1.1 hkenken
68 1.1 hkenken #include <dev/mii/mii.h>
69 1.1 hkenken #include <dev/mii/miivar.h>
70 1.1 hkenken
71 1.1 hkenken #ifdef INET
72 1.1 hkenken #include <netinet/in.h>
73 1.1 hkenken #include <netinet/in_systm.h>
74 1.1 hkenken #include <netinet/in_var.h>
75 1.1 hkenken #include <netinet/ip.h>
76 1.1 hkenken #include <netinet/if_inarp.h>
77 1.1 hkenken #endif
78 1.1 hkenken
79 1.1 hkenken #ifdef IPKDB_AT91 // @@@
80 1.1 hkenken #include <ipkdb/ipkdb.h>
81 1.1 hkenken #endif
82 1.1 hkenken
83 1.1 hkenken #include <dev/cadence/cemacreg.h>
84 1.1 hkenken #include <dev/cadence/if_cemacvar.h>
85 1.1 hkenken
86 1.1 hkenken #define DEFAULT_MDCDIV 32
87 1.1 hkenken
88 1.1 hkenken #define CEMAC_READ(x) \
89 1.1 hkenken bus_space_read_4(sc->sc_iot, sc->sc_ioh, (x))
90 1.1 hkenken #define CEMAC_WRITE(x, y) \
91 1.1 hkenken bus_space_write_4(sc->sc_iot, sc->sc_ioh, (x), (y))
92 1.1 hkenken #define CEMAC_GEM_WRITE(x, y) \
93 1.1 hkenken do { \
94 1.1 hkenken if (ISSET(sc->cemac_flags, CEMAC_FLAG_GEM)) \
95 1.1 hkenken bus_space_write_4(sc->sc_iot, sc->sc_ioh, (GEM_##x), (y)); \
96 1.1 hkenken else \
97 1.1 hkenken bus_space_write_4(sc->sc_iot, sc->sc_ioh, (ETH_##x), (y)); \
98 1.1 hkenken } while(0)
99 1.1 hkenken
100 1.1 hkenken #define RX_QLEN 64
101 1.1 hkenken #define TX_QLEN 2 /* I'm very sorry but that's where we can get */
102 1.1 hkenken
103 1.1 hkenken struct cemac_qmeta {
104 1.1 hkenken struct mbuf *m;
105 1.1 hkenken bus_dmamap_t m_dmamap;
106 1.1 hkenken };
107 1.1 hkenken
108 1.1 hkenken struct cemac_softc {
109 1.1 hkenken device_t sc_dev;
110 1.1 hkenken bus_space_tag_t sc_iot;
111 1.1 hkenken bus_space_handle_t sc_ioh;
112 1.1 hkenken bus_dma_tag_t sc_dmat;
113 1.1 hkenken uint8_t sc_enaddr[ETHER_ADDR_LEN];
114 1.1 hkenken struct ethercom sc_ethercom;
115 1.1 hkenken mii_data_t sc_mii;
116 1.1 hkenken
117 1.1 hkenken void *rbqpage;
118 1.1 hkenken unsigned rbqlen;
119 1.1 hkenken bus_addr_t rbqpage_dsaddr;
120 1.1 hkenken bus_dmamap_t rbqpage_dmamap;
121 1.1 hkenken void *tbqpage;
122 1.1 hkenken unsigned tbqlen;
123 1.1 hkenken bus_addr_t tbqpage_dsaddr;
124 1.1 hkenken bus_dmamap_t tbqpage_dmamap;
125 1.1 hkenken
126 1.1 hkenken volatile struct eth_dsc *RDSC;
127 1.1 hkenken int rxqi;
128 1.1 hkenken struct cemac_qmeta rxq[RX_QLEN];
129 1.1 hkenken volatile struct eth_dsc *TDSC;
130 1.1 hkenken int txqi, txqc;
131 1.1 hkenken struct cemac_qmeta txq[TX_QLEN];
132 1.1 hkenken callout_t cemac_tick_ch;
133 1.1 hkenken
134 1.1 hkenken int cemac_flags;
135 1.1 hkenken };
136 1.1 hkenken
137 1.1 hkenken static void cemac_init(struct cemac_softc *);
138 1.1 hkenken static int cemac_gctx(struct cemac_softc *);
139 1.1 hkenken static int cemac_mediachange(struct ifnet *);
140 1.1 hkenken static void cemac_mediastatus(struct ifnet *, struct ifmediareq *);
141 1.1 hkenken static int cemac_mii_readreg(device_t, int, int);
142 1.1 hkenken static void cemac_mii_writereg(device_t, int, int, int);
143 1.1 hkenken static void cemac_statchg(struct ifnet *);
144 1.1 hkenken static void cemac_tick(void *);
145 1.1 hkenken static int cemac_ifioctl(struct ifnet *, u_long, void *);
146 1.1 hkenken static void cemac_ifstart(struct ifnet *);
147 1.1 hkenken static void cemac_ifwatchdog(struct ifnet *);
148 1.1 hkenken static int cemac_ifinit(struct ifnet *);
149 1.1 hkenken static void cemac_ifstop(struct ifnet *, int);
150 1.1 hkenken static void cemac_setaddr(struct ifnet *);
151 1.1 hkenken
152 1.1 hkenken #ifdef CEMAC_DEBUG
153 1.1 hkenken int cemac_debug = CEMAC_DEBUG;
154 1.1 hkenken #define DPRINTFN(n,fmt) if (cemac_debug >= (n)) printf fmt
155 1.1 hkenken #else
156 1.1 hkenken #define DPRINTFN(n,fmt)
157 1.1 hkenken #endif
158 1.1 hkenken
159 1.1 hkenken CFATTACH_DECL_NEW(cemac, sizeof(struct cemac_softc),
160 1.1 hkenken cemac_match, cemac_attach, NULL, NULL);
161 1.1 hkenken
162 1.1 hkenken int
163 1.1 hkenken cemac_match_common(device_t parent, cfdata_t match, void *aux)
164 1.1 hkenken {
165 1.1 hkenken if (strcmp(match->cf_name, "cemac") == 0)
166 1.1 hkenken return 1;
167 1.1 hkenken return 0;
168 1.1 hkenken }
169 1.1 hkenken
170 1.1 hkenken void
171 1.1 hkenken cemac_attach_common(device_t self, bus_space_tag_t iot,
172 1.1 hkenken bus_space_handle_t ioh, bus_dma_tag_t dmat, int flags)
173 1.1 hkenken {
174 1.1 hkenken struct cemac_softc *sc = device_private(self);
175 1.1 hkenken prop_data_t enaddr;
176 1.1 hkenken uint32_t u;
177 1.1 hkenken
178 1.1 hkenken
179 1.1 hkenken sc->sc_dev = self;
180 1.1 hkenken sc->sc_ioh = ioh;
181 1.1 hkenken sc->sc_iot = iot;
182 1.1 hkenken sc->sc_dmat = dmat;
183 1.1 hkenken sc->cemac_flags = flags;
184 1.1 hkenken
185 1.1 hkenken aprint_naive("\n");
186 1.1 hkenken if (ISSET(sc->cemac_flags, CEMAC_FLAG_GEM))
187 1.1 hkenken aprint_normal(": Cadence Gigabit Ethernet Controller\n");
188 1.1 hkenken else
189 1.1 hkenken aprint_normal(": Cadence Ethernet Controller\n");
190 1.1 hkenken
191 1.1 hkenken /* configure emac: */
192 1.1 hkenken CEMAC_WRITE(ETH_CTL, 0); // disable everything
193 1.1 hkenken CEMAC_WRITE(ETH_IDR, -1); // disable interrupts
194 1.1 hkenken CEMAC_WRITE(ETH_RBQP, 0); // clear receive
195 1.1 hkenken CEMAC_WRITE(ETH_TBQP, 0); // clear transmit
196 1.1 hkenken if (ISSET(sc->cemac_flags, CEMAC_FLAG_GEM))
197 1.1 hkenken CEMAC_WRITE(ETH_CFG,
198 1.1 hkenken GEM_CFG_CLK_64 | GEM_CFG_GEN | ETH_CFG_SPD | ETH_CFG_FD);
199 1.1 hkenken else
200 1.1 hkenken CEMAC_WRITE(ETH_CFG,
201 1.1 hkenken ETH_CFG_CLK_32 | ETH_CFG_SPD | ETH_CFG_FD | ETH_CFG_BIG);
202 1.1 hkenken //CEMAC_WRITE(ETH_TCR, 0); // send nothing
203 1.1 hkenken //(void)CEMAC_READ(ETH_ISR);
204 1.1 hkenken u = CEMAC_READ(ETH_TSR);
205 1.1 hkenken CEMAC_WRITE(ETH_TSR, (u & (ETH_TSR_UND | ETH_TSR_COMP | ETH_TSR_BNQ
206 1.1 hkenken | ETH_TSR_IDLE | ETH_TSR_RLE
207 1.1 hkenken | ETH_TSR_COL|ETH_TSR_OVR)));
208 1.1 hkenken u = CEMAC_READ(ETH_RSR);
209 1.1 hkenken CEMAC_WRITE(ETH_RSR, (u & (ETH_RSR_OVR|ETH_RSR_REC|ETH_RSR_BNA)));
210 1.1 hkenken
211 1.1 hkenken /* Fetch the Ethernet address from property if set. */
212 1.1 hkenken enaddr = prop_dictionary_get(device_properties(self), "mac-address");
213 1.1 hkenken
214 1.1 hkenken if (enaddr != NULL) {
215 1.1 hkenken KASSERT(prop_object_type(enaddr) == PROP_TYPE_DATA);
216 1.1 hkenken KASSERT(prop_data_size(enaddr) == ETHER_ADDR_LEN);
217 1.1 hkenken memcpy(sc->sc_enaddr, prop_data_data_nocopy(enaddr),
218 1.1 hkenken ETHER_ADDR_LEN);
219 1.1 hkenken } else {
220 1.1 hkenken static const uint8_t hardcoded[ETHER_ADDR_LEN] = {
221 1.1 hkenken 0x00, 0x0d, 0x10, 0x81, 0x0c, 0x94
222 1.1 hkenken };
223 1.1 hkenken memcpy(sc->sc_enaddr, hardcoded, ETHER_ADDR_LEN);
224 1.1 hkenken }
225 1.1 hkenken
226 1.1 hkenken cemac_init(sc);
227 1.1 hkenken }
228 1.1 hkenken
229 1.1 hkenken static int
230 1.1 hkenken cemac_gctx(struct cemac_softc *sc)
231 1.1 hkenken {
232 1.1 hkenken struct ifnet * ifp = &sc->sc_ethercom.ec_if;
233 1.1 hkenken uint32_t tsr;
234 1.1 hkenken
235 1.1 hkenken tsr = CEMAC_READ(ETH_TSR);
236 1.1 hkenken if (!ISSET(sc->cemac_flags, CEMAC_FLAG_GEM)) {
237 1.1 hkenken // no space left
238 1.1 hkenken if (!(tsr & ETH_TSR_BNQ))
239 1.1 hkenken return 0;
240 1.1 hkenken } else {
241 1.1 hkenken if (tsr & GEM_TSR_TXGO)
242 1.1 hkenken return 0;
243 1.1 hkenken }
244 1.1 hkenken CEMAC_WRITE(ETH_TSR, tsr);
245 1.1 hkenken
246 1.1 hkenken // free sent frames
247 1.1 hkenken while (sc->txqc > (ISSET(sc->cemac_flags, CEMAC_FLAG_GEM) ? 0 :
248 1.1 hkenken (tsr & ETH_TSR_IDLE ? 0 : 1))) {
249 1.1 hkenken int bi = sc->txqi % TX_QLEN;
250 1.1 hkenken
251 1.1 hkenken DPRINTFN(3,("%s: TDSC[%i].Addr 0x%08x\n",
252 1.1 hkenken __FUNCTION__, bi, sc->TDSC[bi].Addr));
253 1.1 hkenken DPRINTFN(3,("%s: TDSC[%i].Info 0x%08x\n",
254 1.1 hkenken __FUNCTION__, bi, sc->TDSC[bi].Info));
255 1.1 hkenken
256 1.1 hkenken bus_dmamap_sync(sc->sc_dmat, sc->txq[bi].m_dmamap, 0,
257 1.1 hkenken sc->txq[bi].m->m_pkthdr.len, BUS_DMASYNC_POSTWRITE);
258 1.1 hkenken bus_dmamap_unload(sc->sc_dmat, sc->txq[bi].m_dmamap);
259 1.1 hkenken m_freem(sc->txq[bi].m);
260 1.1 hkenken DPRINTFN(2,("%s: freed idx #%i mbuf %p (txqc=%i)\n",
261 1.1 hkenken __FUNCTION__, bi, sc->txq[bi].m, sc->txqc));
262 1.1 hkenken sc->txq[bi].m = NULL;
263 1.1 hkenken sc->txqi = (bi + 1) % TX_QLEN;
264 1.1 hkenken sc->txqc--;
265 1.1 hkenken }
266 1.1 hkenken
267 1.1 hkenken // mark we're free
268 1.1 hkenken if (ifp->if_flags & IFF_OACTIVE) {
269 1.1 hkenken ifp->if_flags &= ~IFF_OACTIVE;
270 1.1 hkenken /* Disable transmit-buffer-free interrupt */
271 1.1 hkenken /*CEMAC_WRITE(ETH_IDR, ETH_ISR_TBRE);*/
272 1.1 hkenken }
273 1.1 hkenken
274 1.1 hkenken return 1;
275 1.1 hkenken }
276 1.1 hkenken
277 1.1 hkenken int
278 1.1 hkenken cemac_intr(void *arg)
279 1.1 hkenken {
280 1.1 hkenken struct cemac_softc *sc = (struct cemac_softc *)arg;
281 1.1 hkenken struct ifnet * ifp = &sc->sc_ethercom.ec_if;
282 1.1 hkenken uint32_t imr, isr, ctl;
283 1.1 hkenken #ifdef CEMAC_DEBUG
284 1.1 hkenken uint32_t rsr;
285 1.1 hkenken #endif
286 1.1 hkenken int bi;
287 1.1 hkenken
288 1.1 hkenken imr = ~CEMAC_READ(ETH_IMR);
289 1.1 hkenken if (!(imr & (ETH_ISR_RCOM|ETH_ISR_TBRE|ETH_ISR_TIDLE|ETH_ISR_RBNA|ETH_ISR_ROVR|ETH_ISR_TCOM))) {
290 1.1 hkenken // interrupt not enabled, can't be us
291 1.1 hkenken return 0;
292 1.1 hkenken }
293 1.1 hkenken
294 1.1 hkenken isr = CEMAC_READ(ETH_ISR);
295 1.1 hkenken CEMAC_WRITE(ETH_ISR, isr);
296 1.1 hkenken isr &= imr;
297 1.1 hkenken #ifdef CEMAC_DEBUG
298 1.1 hkenken rsr = CEMAC_READ(ETH_RSR); // get receive status register
299 1.1 hkenken #endif
300 1.1 hkenken DPRINTFN(2, ("%s: isr=0x%08X rsr=0x%08X imr=0x%08X\n", __FUNCTION__, isr, rsr, imr));
301 1.1 hkenken
302 1.1 hkenken if (isr & ETH_ISR_RBNA) { // out of receive buffers
303 1.1 hkenken CEMAC_WRITE(ETH_RSR, ETH_RSR_BNA); // clear interrupt
304 1.1 hkenken ctl = CEMAC_READ(ETH_CTL); // get current control register value
305 1.1 hkenken CEMAC_WRITE(ETH_CTL, ctl & ~ETH_CTL_RE); // disable receiver
306 1.1 hkenken CEMAC_WRITE(ETH_RSR, ETH_RSR_BNA); // clear BNA bit
307 1.1 hkenken CEMAC_WRITE(ETH_CTL, ctl | ETH_CTL_RE); // re-enable receiver
308 1.1 hkenken ifp->if_ierrors++;
309 1.1 hkenken ifp->if_ipackets++;
310 1.1 hkenken DPRINTFN(1,("%s: out of receive buffers\n", __FUNCTION__));
311 1.1 hkenken }
312 1.1 hkenken if (isr & ETH_ISR_ROVR) {
313 1.1 hkenken CEMAC_WRITE(ETH_RSR, ETH_RSR_OVR); // clear interrupt
314 1.1 hkenken ifp->if_ierrors++;
315 1.1 hkenken ifp->if_ipackets++;
316 1.1 hkenken DPRINTFN(1,("%s: receive overrun\n", __FUNCTION__));
317 1.1 hkenken }
318 1.1 hkenken
319 1.1 hkenken if (isr & ETH_ISR_RCOM) { // packet has been received!
320 1.1 hkenken uint32_t nfo;
321 1.1 hkenken DPRINTFN(2,("#2 RDSC[%i].INFO=0x%08X\n", sc->rxqi % RX_QLEN, sc->RDSC[sc->rxqi % RX_QLEN].Info));
322 1.1 hkenken while (sc->RDSC[(bi = sc->rxqi % RX_QLEN)].Addr & ETH_RDSC_F_USED) {
323 1.7 rjs int fl, csum;
324 1.1 hkenken struct mbuf *m;
325 1.1 hkenken
326 1.1 hkenken nfo = sc->RDSC[bi].Info;
327 1.1 hkenken fl = (nfo & ETH_RDSC_I_LEN) - 4;
328 1.1 hkenken DPRINTFN(2,("## nfo=0x%08X\n", nfo));
329 1.1 hkenken
330 1.1 hkenken MGETHDR(m, M_DONTWAIT, MT_DATA);
331 1.1 hkenken if (m != NULL) MCLGET(m, M_DONTWAIT);
332 1.1 hkenken if (m != NULL && (m->m_flags & M_EXT)) {
333 1.1 hkenken bus_dmamap_sync(sc->sc_dmat, sc->rxq[bi].m_dmamap, 0,
334 1.1 hkenken MCLBYTES, BUS_DMASYNC_POSTREAD);
335 1.1 hkenken bus_dmamap_unload(sc->sc_dmat,
336 1.1 hkenken sc->rxq[bi].m_dmamap);
337 1.9 ozaki m_set_rcvif(sc->rxq[bi].m, ifp);
338 1.1 hkenken sc->rxq[bi].m->m_pkthdr.len =
339 1.1 hkenken sc->rxq[bi].m->m_len = fl;
340 1.7 rjs switch (nfo & ETH_RDSC_I_CHKSUM) {
341 1.7 rjs case ETH_RDSC_I_CHKSUM_IP:
342 1.7 rjs csum = M_CSUM_IPv4;
343 1.7 rjs break;
344 1.7 rjs case ETH_RDSC_I_CHKSUM_UDP:
345 1.7 rjs csum = M_CSUM_IPv4 | M_CSUM_UDPv4 |
346 1.7 rjs M_CSUM_UDPv6;
347 1.7 rjs break;
348 1.7 rjs case ETH_RDSC_I_CHKSUM_TCP:
349 1.7 rjs csum = M_CSUM_IPv4 | M_CSUM_TCPv4 |
350 1.7 rjs M_CSUM_TCPv6;
351 1.7 rjs break;
352 1.7 rjs default:
353 1.7 rjs csum = 0;
354 1.7 rjs break;
355 1.7 rjs }
356 1.7 rjs sc->rxq[bi].m->m_pkthdr.csum_flags = csum;
357 1.1 hkenken DPRINTFN(2,("received %u bytes packet\n", fl));
358 1.8 ozaki if_percpuq_enqueue(ifp->if_percpuq,
359 1.8 ozaki sc->rxq[bi].m);
360 1.1 hkenken if (mtod(m, intptr_t) & 3)
361 1.1 hkenken m_adj(m, mtod(m, intptr_t) & 3);
362 1.1 hkenken sc->rxq[bi].m = m;
363 1.1 hkenken bus_dmamap_load(sc->sc_dmat,
364 1.1 hkenken sc->rxq[bi].m_dmamap,
365 1.1 hkenken m->m_ext.ext_buf, MCLBYTES,
366 1.1 hkenken NULL, BUS_DMA_NOWAIT);
367 1.1 hkenken bus_dmamap_sync(sc->sc_dmat, sc->rxq[bi].m_dmamap, 0,
368 1.1 hkenken MCLBYTES, BUS_DMASYNC_PREREAD);
369 1.1 hkenken sc->RDSC[bi].Info = 0;
370 1.1 hkenken sc->RDSC[bi].Addr =
371 1.1 hkenken sc->rxq[bi].m_dmamap->dm_segs[0].ds_addr
372 1.1 hkenken | (bi == (RX_QLEN-1) ? ETH_RDSC_F_WRAP : 0);
373 1.1 hkenken } else {
374 1.1 hkenken /* Drop packets until we can get replacement
375 1.1 hkenken * empty mbufs for the RXDQ.
376 1.1 hkenken */
377 1.1 hkenken if (m != NULL)
378 1.1 hkenken m_freem(m);
379 1.1 hkenken ifp->if_ierrors++;
380 1.1 hkenken }
381 1.1 hkenken sc->rxqi++;
382 1.1 hkenken }
383 1.1 hkenken }
384 1.1 hkenken
385 1.11 ozaki if (cemac_gctx(sc) > 0)
386 1.11 ozaki if_schedule_deferred_start(ifp);
387 1.1 hkenken #if 0 // reloop
388 1.1 hkenken irq = CEMAC_READ(IntStsC);
389 1.1 hkenken if ((irq & (IntSts_RxSQ|IntSts_ECI)) != 0)
390 1.1 hkenken goto begin;
391 1.1 hkenken #endif
392 1.1 hkenken
393 1.1 hkenken return (1);
394 1.1 hkenken }
395 1.1 hkenken
396 1.1 hkenken
397 1.1 hkenken static void
398 1.1 hkenken cemac_init(struct cemac_softc *sc)
399 1.1 hkenken {
400 1.1 hkenken bus_dma_segment_t segs;
401 1.1 hkenken int rsegs, err, i;
402 1.1 hkenken struct ifnet * ifp = &sc->sc_ethercom.ec_if;
403 1.1 hkenken uint32_t u;
404 1.1 hkenken #if 0
405 1.1 hkenken int mdcdiv = DEFAULT_MDCDIV;
406 1.1 hkenken #endif
407 1.1 hkenken
408 1.1 hkenken callout_init(&sc->cemac_tick_ch, 0);
409 1.1 hkenken
410 1.1 hkenken // ok...
411 1.1 hkenken CEMAC_WRITE(ETH_CTL, ETH_CTL_MPE); // disable everything
412 1.1 hkenken CEMAC_WRITE(ETH_IDR, -1); // disable interrupts
413 1.1 hkenken CEMAC_WRITE(ETH_RBQP, 0); // clear receive
414 1.1 hkenken CEMAC_WRITE(ETH_TBQP, 0); // clear transmit
415 1.1 hkenken if (ISSET(sc->cemac_flags, CEMAC_FLAG_GEM))
416 1.1 hkenken CEMAC_WRITE(ETH_CFG,
417 1.1 hkenken GEM_CFG_CLK_64 | ETH_CFG_SPD | ETH_CFG_FD | ETH_CFG_BIG);
418 1.1 hkenken else
419 1.1 hkenken CEMAC_WRITE(ETH_CFG,
420 1.1 hkenken ETH_CFG_CLK_32 | ETH_CFG_SPD | ETH_CFG_FD | ETH_CFG_BIG);
421 1.1 hkenken if (ISSET(sc->cemac_flags, CEMAC_FLAG_GEM)) {
422 1.1 hkenken CEMAC_WRITE(GEM_DMA_CFG,
423 1.1 hkenken __SHIFTIN((MCLBYTES + 63) / 64, GEM_DMA_CFG_RX_BUF_SIZE) |
424 1.1 hkenken __SHIFTIN(3, GEM_DMA_CFG_RX_PKTBUF_MEMSZ_SEL) |
425 1.1 hkenken GEM_DMA_CFG_TX_PKTBUF_MEMSZ_SEL |
426 1.1 hkenken __SHIFTIN(16, GEM_DMA_CFG_AHB_FIXED_BURST_LEN) |
427 1.1 hkenken GEM_DMA_CFG_DISC_WHEN_NO_AHB);
428 1.1 hkenken }
429 1.1 hkenken // CEMAC_WRITE(ETH_TCR, 0); // send nothing
430 1.1 hkenken // (void)CEMAC_READ(ETH_ISR);
431 1.1 hkenken u = CEMAC_READ(ETH_TSR);
432 1.1 hkenken CEMAC_WRITE(ETH_TSR, (u & (ETH_TSR_UND | ETH_TSR_COMP | ETH_TSR_BNQ
433 1.1 hkenken | ETH_TSR_IDLE | ETH_TSR_RLE
434 1.1 hkenken | ETH_TSR_COL|ETH_TSR_OVR)));
435 1.1 hkenken u = CEMAC_READ(ETH_RSR);
436 1.1 hkenken CEMAC_WRITE(ETH_RSR, (u & (ETH_RSR_OVR|ETH_RSR_REC|ETH_RSR_BNA)));
437 1.1 hkenken
438 1.1 hkenken #if 0
439 1.1 hkenken if (device_cfdata(sc->sc_dev)->cf_flags)
440 1.1 hkenken mdcdiv = device_cfdata(sc->sc_dev)->cf_flags;
441 1.1 hkenken #endif
442 1.1 hkenken /* set ethernet address */
443 1.1 hkenken CEMAC_GEM_WRITE(SA1L, (sc->sc_enaddr[3] << 24)
444 1.1 hkenken | (sc->sc_enaddr[2] << 16) | (sc->sc_enaddr[1] << 8)
445 1.1 hkenken | (sc->sc_enaddr[0]));
446 1.1 hkenken CEMAC_GEM_WRITE(SA1H, (sc->sc_enaddr[5] << 8)
447 1.1 hkenken | (sc->sc_enaddr[4]));
448 1.1 hkenken CEMAC_GEM_WRITE(SA2L, 0);
449 1.1 hkenken CEMAC_GEM_WRITE(SA2H, 0);
450 1.1 hkenken CEMAC_GEM_WRITE(SA3L, 0);
451 1.1 hkenken CEMAC_GEM_WRITE(SA3H, 0);
452 1.1 hkenken CEMAC_GEM_WRITE(SA4L, 0);
453 1.1 hkenken CEMAC_GEM_WRITE(SA4H, 0);
454 1.1 hkenken
455 1.1 hkenken /* Allocate a page of memory for receive queue descriptors */
456 1.1 hkenken sc->rbqlen = (ETH_DSC_SIZE * (RX_QLEN + 1) * 2 + PAGE_SIZE - 1) / PAGE_SIZE;
457 1.1 hkenken sc->rbqlen *= PAGE_SIZE;
458 1.1 hkenken DPRINTFN(1,("%s: rbqlen=%i\n", __FUNCTION__, sc->rbqlen));
459 1.1 hkenken
460 1.1 hkenken err = bus_dmamem_alloc(sc->sc_dmat, sc->rbqlen, 0,
461 1.1 hkenken MAX(16384, PAGE_SIZE), // see EMAC errata why forced to 16384 byte boundary
462 1.1 hkenken &segs, 1, &rsegs, BUS_DMA_WAITOK);
463 1.1 hkenken if (err == 0) {
464 1.1 hkenken DPRINTFN(1,("%s: -> bus_dmamem_map\n", __FUNCTION__));
465 1.1 hkenken err = bus_dmamem_map(sc->sc_dmat, &segs, 1, sc->rbqlen,
466 1.1 hkenken &sc->rbqpage, (BUS_DMA_WAITOK|BUS_DMA_COHERENT));
467 1.1 hkenken }
468 1.1 hkenken if (err == 0) {
469 1.1 hkenken DPRINTFN(1,("%s: -> bus_dmamap_create\n", __FUNCTION__));
470 1.1 hkenken err = bus_dmamap_create(sc->sc_dmat, sc->rbqlen, 1,
471 1.1 hkenken sc->rbqlen, MAX(16384, PAGE_SIZE), BUS_DMA_WAITOK,
472 1.1 hkenken &sc->rbqpage_dmamap);
473 1.1 hkenken }
474 1.1 hkenken if (err == 0) {
475 1.1 hkenken DPRINTFN(1,("%s: -> bus_dmamap_load\n", __FUNCTION__));
476 1.1 hkenken err = bus_dmamap_load(sc->sc_dmat, sc->rbqpage_dmamap,
477 1.1 hkenken sc->rbqpage, sc->rbqlen, NULL, BUS_DMA_WAITOK);
478 1.1 hkenken }
479 1.1 hkenken if (err != 0)
480 1.1 hkenken panic("%s: Cannot get DMA memory", device_xname(sc->sc_dev));
481 1.1 hkenken
482 1.1 hkenken sc->rbqpage_dsaddr = sc->rbqpage_dmamap->dm_segs[0].ds_addr;
483 1.1 hkenken memset(sc->rbqpage, 0, sc->rbqlen);
484 1.1 hkenken
485 1.1 hkenken /* Allocate a page of memory for transmit queue descriptors */
486 1.1 hkenken sc->tbqlen = (ETH_DSC_SIZE * (TX_QLEN + 1) * 2 + PAGE_SIZE - 1) / PAGE_SIZE;
487 1.1 hkenken sc->tbqlen *= PAGE_SIZE;
488 1.1 hkenken DPRINTFN(1,("%s: tbqlen=%i\n", __FUNCTION__, sc->tbqlen));
489 1.1 hkenken
490 1.1 hkenken err = bus_dmamem_alloc(sc->sc_dmat, sc->tbqlen, 0,
491 1.1 hkenken MAX(16384, PAGE_SIZE), // see EMAC errata why forced to 16384 byte boundary
492 1.1 hkenken &segs, 1, &rsegs, BUS_DMA_WAITOK);
493 1.1 hkenken if (err == 0) {
494 1.1 hkenken DPRINTFN(1,("%s: -> bus_dmamem_map\n", __FUNCTION__));
495 1.1 hkenken err = bus_dmamem_map(sc->sc_dmat, &segs, 1, sc->tbqlen,
496 1.1 hkenken &sc->tbqpage, (BUS_DMA_WAITOK|BUS_DMA_COHERENT));
497 1.1 hkenken }
498 1.1 hkenken if (err == 0) {
499 1.1 hkenken DPRINTFN(1,("%s: -> bus_dmamap_create\n", __FUNCTION__));
500 1.1 hkenken err = bus_dmamap_create(sc->sc_dmat, sc->tbqlen, 1,
501 1.1 hkenken sc->tbqlen, MAX(16384, PAGE_SIZE), BUS_DMA_WAITOK,
502 1.1 hkenken &sc->tbqpage_dmamap);
503 1.1 hkenken }
504 1.1 hkenken if (err == 0) {
505 1.1 hkenken DPRINTFN(1,("%s: -> bus_dmamap_load\n", __FUNCTION__));
506 1.1 hkenken err = bus_dmamap_load(sc->sc_dmat, sc->tbqpage_dmamap,
507 1.1 hkenken sc->tbqpage, sc->tbqlen, NULL, BUS_DMA_WAITOK);
508 1.1 hkenken }
509 1.1 hkenken if (err != 0)
510 1.1 hkenken panic("%s: Cannot get DMA memory", device_xname(sc->sc_dev));
511 1.1 hkenken
512 1.1 hkenken sc->tbqpage_dsaddr = sc->tbqpage_dmamap->dm_segs[0].ds_addr;
513 1.1 hkenken memset(sc->tbqpage, 0, sc->tbqlen);
514 1.1 hkenken
515 1.1 hkenken /* Set up pointers to start of each queue in kernel addr space.
516 1.1 hkenken * Each descriptor queue or status queue entry uses 2 words
517 1.1 hkenken */
518 1.1 hkenken sc->RDSC = (void *)sc->rbqpage;
519 1.1 hkenken sc->TDSC = (void *)sc->tbqpage;
520 1.1 hkenken
521 1.1 hkenken /* init TX queue */
522 1.1 hkenken for (i = 0; i < TX_QLEN; i++) {
523 1.1 hkenken sc->TDSC[i].Addr = 0;
524 1.1 hkenken sc->TDSC[i].Info = ETH_TDSC_I_USED |
525 1.1 hkenken (i == (TX_QLEN - 1) ? ETH_TDSC_I_WRAP : 0);
526 1.1 hkenken }
527 1.1 hkenken
528 1.1 hkenken /* Populate the RXQ with mbufs */
529 1.1 hkenken sc->rxqi = 0;
530 1.1 hkenken for(i = 0; i < RX_QLEN; i++) {
531 1.1 hkenken struct mbuf *m;
532 1.1 hkenken
533 1.1 hkenken err = bus_dmamap_create(sc->sc_dmat, MCLBYTES, 1, MCLBYTES, PAGE_SIZE,
534 1.1 hkenken BUS_DMA_WAITOK, &sc->rxq[i].m_dmamap);
535 1.1 hkenken if (err) {
536 1.1 hkenken panic("%s: dmamap_create failed: %i\n", __FUNCTION__, err);
537 1.1 hkenken }
538 1.1 hkenken MGETHDR(m, M_WAIT, MT_DATA);
539 1.1 hkenken MCLGET(m, M_WAIT);
540 1.1 hkenken sc->rxq[i].m = m;
541 1.1 hkenken if (mtod(m, intptr_t) & 3) {
542 1.1 hkenken m_adj(m, mtod(m, intptr_t) & 3);
543 1.1 hkenken }
544 1.1 hkenken err = bus_dmamap_load(sc->sc_dmat, sc->rxq[i].m_dmamap,
545 1.1 hkenken m->m_ext.ext_buf, MCLBYTES, NULL,
546 1.1 hkenken BUS_DMA_WAITOK);
547 1.1 hkenken if (err) {
548 1.1 hkenken panic("%s: dmamap_load failed: %i\n", __FUNCTION__, err);
549 1.1 hkenken }
550 1.1 hkenken sc->RDSC[i].Addr = sc->rxq[i].m_dmamap->dm_segs[0].ds_addr
551 1.1 hkenken | (i == (RX_QLEN-1) ? ETH_RDSC_F_WRAP : 0);
552 1.1 hkenken sc->RDSC[i].Info = 0;
553 1.1 hkenken bus_dmamap_sync(sc->sc_dmat, sc->rxq[i].m_dmamap, 0,
554 1.1 hkenken MCLBYTES, BUS_DMASYNC_PREREAD);
555 1.1 hkenken }
556 1.1 hkenken
557 1.1 hkenken /* prepare transmit queue */
558 1.1 hkenken for (i = 0; i < TX_QLEN; i++) {
559 1.1 hkenken err = bus_dmamap_create(sc->sc_dmat, MCLBYTES, 1, MCLBYTES, 0,
560 1.1 hkenken (BUS_DMA_WAITOK | BUS_DMA_ALLOCNOW),
561 1.1 hkenken &sc->txq[i].m_dmamap);
562 1.1 hkenken if (err)
563 1.1 hkenken panic("ARGH #1");
564 1.1 hkenken sc->txq[i].m = NULL;
565 1.1 hkenken }
566 1.1 hkenken
567 1.1 hkenken /* Program each queue's start addr, cur addr, and len registers
568 1.1 hkenken * with the physical addresses.
569 1.1 hkenken */
570 1.1 hkenken CEMAC_WRITE(ETH_RBQP, (uint32_t)sc->rbqpage_dsaddr);
571 1.1 hkenken CEMAC_WRITE(ETH_TBQP, (uint32_t)sc->tbqpage_dsaddr);
572 1.1 hkenken
573 1.1 hkenken /* Divide HCLK by 32 for MDC clock */
574 1.1 hkenken sc->sc_ethercom.ec_mii = &sc->sc_mii;
575 1.1 hkenken sc->sc_mii.mii_ifp = ifp;
576 1.1 hkenken sc->sc_mii.mii_readreg = cemac_mii_readreg;
577 1.1 hkenken sc->sc_mii.mii_writereg = cemac_mii_writereg;
578 1.1 hkenken sc->sc_mii.mii_statchg = cemac_statchg;
579 1.1 hkenken ifmedia_init(&sc->sc_mii.mii_media, IFM_IMASK, cemac_mediachange,
580 1.1 hkenken cemac_mediastatus);
581 1.1 hkenken mii_attach(sc->sc_dev, &sc->sc_mii, 0xffffffff, MII_PHY_ANY,
582 1.1 hkenken MII_OFFSET_ANY, 0);
583 1.1 hkenken ifmedia_set(&sc->sc_mii.mii_media, IFM_ETHER|IFM_AUTO);
584 1.1 hkenken
585 1.1 hkenken #if 0
586 1.1 hkenken // enable / disable interrupts
587 1.1 hkenken CEMAC_WRITE(ETH_IDR, -1);
588 1.1 hkenken CEMAC_WRITE(ETH_IER, ETH_ISR_RCOM | ETH_ISR_TBRE | ETH_ISR_TIDLE
589 1.1 hkenken | ETH_ISR_RBNA | ETH_ISR_ROVR | ETH_ISR_TCOM);
590 1.1 hkenken // (void)CEMAC_READ(ETH_ISR); // why
591 1.1 hkenken
592 1.1 hkenken // enable transmitter / receiver
593 1.1 hkenken CEMAC_WRITE(ETH_CTL, ETH_CTL_TE | ETH_CTL_RE | ETH_CTL_ISR
594 1.1 hkenken | ETH_CTL_CSR | ETH_CTL_MPE);
595 1.1 hkenken #endif
596 1.1 hkenken /*
597 1.7 rjs * We can support hardware checksumming.
598 1.7 rjs */
599 1.7 rjs ifp->if_capabilities |=
600 1.7 rjs IFCAP_CSUM_IPv4_Tx | IFCAP_CSUM_IPv4_Rx |
601 1.7 rjs IFCAP_CSUM_TCPv4_Tx | IFCAP_CSUM_TCPv4_Rx |
602 1.7 rjs IFCAP_CSUM_UDPv4_Tx | IFCAP_CSUM_UDPv4_Rx |
603 1.7 rjs IFCAP_CSUM_TCPv6_Tx | IFCAP_CSUM_TCPv6_Rx |
604 1.7 rjs IFCAP_CSUM_UDPv6_Tx | IFCAP_CSUM_UDPv6_Rx;
605 1.7 rjs
606 1.7 rjs /*
607 1.1 hkenken * We can support 802.1Q VLAN-sized frames.
608 1.1 hkenken */
609 1.1 hkenken sc->sc_ethercom.ec_capabilities |= ETHERCAP_VLAN_MTU;
610 1.1 hkenken
611 1.1 hkenken strcpy(ifp->if_xname, device_xname(sc->sc_dev));
612 1.1 hkenken ifp->if_flags = IFF_BROADCAST|IFF_SIMPLEX|IFF_NOTRAILERS|IFF_MULTICAST;
613 1.1 hkenken ifp->if_ioctl = cemac_ifioctl;
614 1.1 hkenken ifp->if_start = cemac_ifstart;
615 1.1 hkenken ifp->if_watchdog = cemac_ifwatchdog;
616 1.1 hkenken ifp->if_init = cemac_ifinit;
617 1.1 hkenken ifp->if_stop = cemac_ifstop;
618 1.1 hkenken ifp->if_timer = 0;
619 1.1 hkenken ifp->if_softc = sc;
620 1.1 hkenken IFQ_SET_READY(&ifp->if_snd);
621 1.1 hkenken if_attach(ifp);
622 1.11 ozaki if_deferred_start_init(ifp, NULL);
623 1.1 hkenken ether_ifattach(ifp, (sc)->sc_enaddr);
624 1.1 hkenken }
625 1.1 hkenken
626 1.1 hkenken static int
627 1.1 hkenken cemac_mediachange(struct ifnet *ifp)
628 1.1 hkenken {
629 1.1 hkenken if (ifp->if_flags & IFF_UP)
630 1.1 hkenken cemac_ifinit(ifp);
631 1.1 hkenken return (0);
632 1.1 hkenken }
633 1.1 hkenken
634 1.1 hkenken static void
635 1.1 hkenken cemac_mediastatus(struct ifnet *ifp, struct ifmediareq *ifmr)
636 1.1 hkenken {
637 1.1 hkenken struct cemac_softc *sc = ifp->if_softc;
638 1.1 hkenken
639 1.1 hkenken mii_pollstat(&sc->sc_mii);
640 1.1 hkenken ifmr->ifm_active = sc->sc_mii.mii_media_active;
641 1.1 hkenken ifmr->ifm_status = sc->sc_mii.mii_media_status;
642 1.1 hkenken }
643 1.1 hkenken
644 1.1 hkenken
645 1.1 hkenken static int
646 1.1 hkenken cemac_mii_readreg(device_t self, int phy, int reg)
647 1.1 hkenken {
648 1.1 hkenken struct cemac_softc *sc;
649 1.1 hkenken
650 1.1 hkenken sc = device_private(self);
651 1.1 hkenken
652 1.1 hkenken CEMAC_WRITE(ETH_MAN, (ETH_MAN_HIGH | ETH_MAN_RW_RD
653 1.1 hkenken | ((phy << ETH_MAN_PHYA_SHIFT) & ETH_MAN_PHYA)
654 1.1 hkenken | ((reg << ETH_MAN_REGA_SHIFT) & ETH_MAN_REGA)
655 1.1 hkenken | ETH_MAN_CODE_IEEE802_3));
656 1.1 hkenken while (!(CEMAC_READ(ETH_SR) & ETH_SR_IDLE));
657 1.1 hkenken
658 1.1 hkenken return (CEMAC_READ(ETH_MAN) & ETH_MAN_DATA);
659 1.1 hkenken }
660 1.1 hkenken
661 1.1 hkenken static void
662 1.1 hkenken cemac_mii_writereg(device_t self, int phy, int reg, int val)
663 1.1 hkenken {
664 1.1 hkenken struct cemac_softc *sc;
665 1.1 hkenken
666 1.1 hkenken sc = device_private(self);
667 1.1 hkenken
668 1.1 hkenken CEMAC_WRITE(ETH_MAN, (ETH_MAN_HIGH | ETH_MAN_RW_WR
669 1.1 hkenken | ((phy << ETH_MAN_PHYA_SHIFT) & ETH_MAN_PHYA)
670 1.1 hkenken | ((reg << ETH_MAN_REGA_SHIFT) & ETH_MAN_REGA)
671 1.1 hkenken | ETH_MAN_CODE_IEEE802_3
672 1.1 hkenken | (val & ETH_MAN_DATA)));
673 1.1 hkenken while (!(CEMAC_READ(ETH_SR) & ETH_SR_IDLE)) ;
674 1.1 hkenken }
675 1.1 hkenken
676 1.1 hkenken
677 1.1 hkenken static void
678 1.1 hkenken cemac_statchg(struct ifnet *ifp)
679 1.1 hkenken {
680 1.1 hkenken struct cemac_softc *sc = ifp->if_softc;
681 1.1 hkenken struct mii_data *mii = &sc->sc_mii;
682 1.1 hkenken uint32_t reg;
683 1.1 hkenken
684 1.1 hkenken /*
685 1.1 hkenken * We must keep the MAC and the PHY in sync as
686 1.1 hkenken * to the status of full-duplex!
687 1.1 hkenken */
688 1.1 hkenken reg = CEMAC_READ(ETH_CFG);
689 1.1 hkenken reg &= ~ETH_CFG_FD;
690 1.1 hkenken if (sc->sc_mii.mii_media_active & IFM_FDX)
691 1.1 hkenken reg |= ETH_CFG_FD;
692 1.1 hkenken
693 1.1 hkenken reg &= ~ETH_CFG_SPD;
694 1.1 hkenken if (ISSET(sc->cemac_flags, CEMAC_FLAG_GEM))
695 1.1 hkenken reg &= ~GEM_CFG_GEN;
696 1.1 hkenken switch (IFM_SUBTYPE(mii->mii_media_active)) {
697 1.1 hkenken case IFM_10_T:
698 1.1 hkenken break;
699 1.1 hkenken case IFM_100_TX:
700 1.1 hkenken reg |= ETH_CFG_SPD;
701 1.1 hkenken break;
702 1.1 hkenken case IFM_1000_T:
703 1.1 hkenken reg |= ETH_CFG_SPD | GEM_CFG_GEN;
704 1.1 hkenken break;
705 1.1 hkenken default:
706 1.1 hkenken break;
707 1.1 hkenken }
708 1.1 hkenken CEMAC_WRITE(ETH_CFG, reg);
709 1.1 hkenken }
710 1.1 hkenken
711 1.1 hkenken static void
712 1.1 hkenken cemac_tick(void *arg)
713 1.1 hkenken {
714 1.1 hkenken struct cemac_softc* sc = (struct cemac_softc *)arg;
715 1.1 hkenken struct ifnet * ifp = &sc->sc_ethercom.ec_if;
716 1.1 hkenken int s;
717 1.1 hkenken
718 1.3 rjs if (ISSET(sc->cemac_flags, CEMAC_FLAG_GEM))
719 1.3 rjs ifp->if_collisions += CEMAC_READ(GEM_SCOL) + CEMAC_READ(GEM_MCOL);
720 1.3 rjs else
721 1.3 rjs ifp->if_collisions += CEMAC_READ(ETH_SCOL) + CEMAC_READ(ETH_MCOL);
722 1.3 rjs
723 1.1 hkenken /* These misses are ok, they will happen if the RAM/CPU can't keep up */
724 1.1 hkenken if (!ISSET(sc->cemac_flags, CEMAC_FLAG_GEM)) {
725 1.1 hkenken uint32_t misses = CEMAC_READ(ETH_DRFC);
726 1.1 hkenken if (misses > 0)
727 1.4 rjs aprint_normal_ifnet(ifp, "%d rx misses\n", misses);
728 1.1 hkenken }
729 1.1 hkenken
730 1.1 hkenken s = splnet();
731 1.1 hkenken if (cemac_gctx(sc) > 0 && IFQ_IS_EMPTY(&ifp->if_snd) == 0)
732 1.1 hkenken cemac_ifstart(ifp);
733 1.1 hkenken splx(s);
734 1.1 hkenken
735 1.1 hkenken mii_tick(&sc->sc_mii);
736 1.1 hkenken callout_reset(&sc->cemac_tick_ch, hz, cemac_tick, sc);
737 1.1 hkenken }
738 1.1 hkenken
739 1.1 hkenken
740 1.1 hkenken static int
741 1.1 hkenken cemac_ifioctl(struct ifnet *ifp, u_long cmd, void *data)
742 1.1 hkenken {
743 1.1 hkenken struct cemac_softc *sc = ifp->if_softc;
744 1.1 hkenken struct ifreq *ifr = (struct ifreq *)data;
745 1.1 hkenken int s, error;
746 1.1 hkenken
747 1.1 hkenken s = splnet();
748 1.1 hkenken switch(cmd) {
749 1.1 hkenken case SIOCSIFMEDIA:
750 1.1 hkenken case SIOCGIFMEDIA:
751 1.1 hkenken error = ifmedia_ioctl(ifp, ifr, &sc->sc_mii.mii_media, cmd);
752 1.1 hkenken break;
753 1.1 hkenken default:
754 1.1 hkenken error = ether_ioctl(ifp, cmd, data);
755 1.7 rjs if (error != ENETRESET)
756 1.7 rjs break;
757 1.7 rjs error = 0;
758 1.7 rjs
759 1.7 rjs if (cmd == SIOCSIFCAP) {
760 1.7 rjs error = (*ifp->if_init)(ifp);
761 1.7 rjs } else if (cmd != SIOCADDMULTI && cmd != SIOCDELMULTI)
762 1.7 rjs ;
763 1.7 rjs else if (ifp->if_flags & IFF_RUNNING) {
764 1.7 rjs cemac_setaddr(ifp);
765 1.1 hkenken }
766 1.1 hkenken }
767 1.1 hkenken splx(s);
768 1.1 hkenken return error;
769 1.1 hkenken }
770 1.1 hkenken
771 1.1 hkenken static void
772 1.1 hkenken cemac_ifstart(struct ifnet *ifp)
773 1.1 hkenken {
774 1.1 hkenken struct cemac_softc *sc = (struct cemac_softc *)ifp->if_softc;
775 1.1 hkenken struct mbuf *m;
776 1.1 hkenken bus_dma_segment_t *segs;
777 1.1 hkenken int s, bi, err, nsegs;
778 1.1 hkenken
779 1.1 hkenken s = splnet();
780 1.1 hkenken start:
781 1.1 hkenken if (cemac_gctx(sc) == 0) {
782 1.1 hkenken /* Enable transmit-buffer-free interrupt */
783 1.1 hkenken CEMAC_WRITE(ETH_IER, ETH_ISR_TBRE);
784 1.1 hkenken ifp->if_flags |= IFF_OACTIVE;
785 1.1 hkenken ifp->if_timer = 10;
786 1.1 hkenken splx(s);
787 1.1 hkenken return;
788 1.1 hkenken }
789 1.1 hkenken
790 1.1 hkenken ifp->if_timer = 0;
791 1.1 hkenken
792 1.1 hkenken IFQ_POLL(&ifp->if_snd, m);
793 1.1 hkenken if (m == NULL) {
794 1.1 hkenken splx(s);
795 1.1 hkenken return;
796 1.1 hkenken }
797 1.1 hkenken
798 1.1 hkenken bi = (sc->txqi + sc->txqc) % TX_QLEN;
799 1.1 hkenken if ((err = bus_dmamap_load_mbuf(sc->sc_dmat, sc->txq[bi].m_dmamap, m,
800 1.1 hkenken BUS_DMA_NOWAIT)) ||
801 1.1 hkenken sc->txq[bi].m_dmamap->dm_segs[0].ds_addr & 0x3 ||
802 1.1 hkenken sc->txq[bi].m_dmamap->dm_nsegs > 1) {
803 1.1 hkenken /* Copy entire mbuf chain to new single */
804 1.1 hkenken struct mbuf *mn;
805 1.1 hkenken
806 1.1 hkenken if (err == 0)
807 1.1 hkenken bus_dmamap_unload(sc->sc_dmat, sc->txq[bi].m_dmamap);
808 1.1 hkenken
809 1.1 hkenken MGETHDR(mn, M_DONTWAIT, MT_DATA);
810 1.1 hkenken if (mn == NULL) goto stop;
811 1.1 hkenken if (m->m_pkthdr.len > MHLEN) {
812 1.1 hkenken MCLGET(mn, M_DONTWAIT);
813 1.1 hkenken if ((mn->m_flags & M_EXT) == 0) {
814 1.1 hkenken m_freem(mn);
815 1.1 hkenken goto stop;
816 1.1 hkenken }
817 1.1 hkenken }
818 1.1 hkenken m_copydata(m, 0, m->m_pkthdr.len, mtod(mn, void *));
819 1.1 hkenken mn->m_pkthdr.len = mn->m_len = m->m_pkthdr.len;
820 1.1 hkenken IFQ_DEQUEUE(&ifp->if_snd, m);
821 1.1 hkenken m_freem(m);
822 1.1 hkenken m = mn;
823 1.1 hkenken bus_dmamap_load_mbuf(sc->sc_dmat, sc->txq[bi].m_dmamap, m,
824 1.1 hkenken BUS_DMA_NOWAIT);
825 1.1 hkenken } else {
826 1.1 hkenken IFQ_DEQUEUE(&ifp->if_snd, m);
827 1.1 hkenken }
828 1.1 hkenken
829 1.13 msaitoh bpf_mtap(ifp, m, BPF_D_OUT);
830 1.1 hkenken
831 1.1 hkenken nsegs = sc->txq[bi].m_dmamap->dm_nsegs;
832 1.1 hkenken segs = sc->txq[bi].m_dmamap->dm_segs;
833 1.1 hkenken if (nsegs > 1)
834 1.1 hkenken panic("#### ARGH #2");
835 1.1 hkenken
836 1.1 hkenken sc->txq[bi].m = m;
837 1.1 hkenken sc->txqc++;
838 1.1 hkenken
839 1.1 hkenken DPRINTFN(2,("%s: start sending idx #%i mbuf %p (txqc=%i, phys %p), len=%u\n",
840 1.1 hkenken __FUNCTION__, bi, sc->txq[bi].m, sc->txqc, (void*)segs->ds_addr,
841 1.1 hkenken (unsigned)m->m_pkthdr.len));
842 1.1 hkenken #ifdef DIAGNOSTIC
843 1.1 hkenken if (sc->txqc > TX_QLEN)
844 1.1 hkenken panic("%s: txqc %i > %i", __FUNCTION__, sc->txqc, TX_QLEN);
845 1.1 hkenken #endif
846 1.1 hkenken
847 1.1 hkenken bus_dmamap_sync(sc->sc_dmat, sc->txq[bi].m_dmamap, 0,
848 1.1 hkenken sc->txq[bi].m_dmamap->dm_mapsize,
849 1.1 hkenken BUS_DMASYNC_PREWRITE);
850 1.1 hkenken
851 1.1 hkenken if (ISSET(sc->cemac_flags, CEMAC_FLAG_GEM)) {
852 1.1 hkenken sc->TDSC[bi].Addr = segs->ds_addr;
853 1.1 hkenken sc->TDSC[bi].Info = __SHIFTIN(m->m_pkthdr.len, ETH_TDSC_I_LEN) |
854 1.1 hkenken ETH_TDSC_I_LAST_BUF | (bi == (TX_QLEN - 1) ? ETH_TDSC_I_WRAP : 0);
855 1.1 hkenken
856 1.1 hkenken DPRINTFN(3,("%s: TDSC[%i].Addr 0x%08x\n",
857 1.1 hkenken __FUNCTION__, bi, sc->TDSC[bi].Addr));
858 1.1 hkenken DPRINTFN(3,("%s: TDSC[%i].Info 0x%08x\n",
859 1.1 hkenken __FUNCTION__, bi, sc->TDSC[bi].Info));
860 1.1 hkenken
861 1.1 hkenken uint32_t ctl = CEMAC_READ(ETH_CTL) | GEM_CTL_STARTTX;
862 1.1 hkenken CEMAC_WRITE(ETH_CTL, ctl);
863 1.1 hkenken DPRINTFN(3,("%s: ETH_CTL 0x%08x\n", __FUNCTION__, CEMAC_READ(ETH_CTL)));
864 1.1 hkenken } else {
865 1.1 hkenken CEMAC_WRITE(ETH_TAR, segs->ds_addr);
866 1.1 hkenken CEMAC_WRITE(ETH_TCR, m->m_pkthdr.len);
867 1.1 hkenken }
868 1.1 hkenken if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
869 1.1 hkenken goto start;
870 1.1 hkenken stop:
871 1.1 hkenken
872 1.1 hkenken splx(s);
873 1.1 hkenken return;
874 1.1 hkenken }
875 1.1 hkenken
876 1.1 hkenken static void
877 1.1 hkenken cemac_ifwatchdog(struct ifnet *ifp)
878 1.1 hkenken {
879 1.1 hkenken struct cemac_softc *sc = (struct cemac_softc *)ifp->if_softc;
880 1.1 hkenken
881 1.1 hkenken if ((ifp->if_flags & IFF_RUNNING) == 0)
882 1.1 hkenken return;
883 1.5 rjs aprint_error_ifnet(ifp, "device timeout, CTL = 0x%08x, CFG = 0x%08x\n",
884 1.4 rjs CEMAC_READ(ETH_CTL), CEMAC_READ(ETH_CFG));
885 1.1 hkenken }
886 1.1 hkenken
887 1.1 hkenken static int
888 1.1 hkenken cemac_ifinit(struct ifnet *ifp)
889 1.1 hkenken {
890 1.1 hkenken struct cemac_softc *sc = ifp->if_softc;
891 1.7 rjs uint32_t dma, cfg;
892 1.1 hkenken int s = splnet();
893 1.1 hkenken
894 1.1 hkenken callout_stop(&sc->cemac_tick_ch);
895 1.1 hkenken
896 1.7 rjs if (ISSET(sc->cemac_flags, CEMAC_FLAG_GEM)) {
897 1.7 rjs
898 1.7 rjs if (ifp->if_capenable &
899 1.7 rjs (IFCAP_CSUM_IPv4_Tx |
900 1.7 rjs IFCAP_CSUM_TCPv4_Tx | IFCAP_CSUM_UDPv4_Tx |
901 1.7 rjs IFCAP_CSUM_TCPv6_Tx | IFCAP_CSUM_UDPv6_Tx)) {
902 1.7 rjs dma = CEMAC_READ(GEM_DMA_CFG);
903 1.7 rjs dma |= GEM_DMA_CFG_CHKSUM_GEN_OFFLOAD_EN;
904 1.7 rjs CEMAC_WRITE(GEM_DMA_CFG, dma);
905 1.7 rjs }
906 1.7 rjs if (ifp->if_capenable &
907 1.7 rjs (IFCAP_CSUM_IPv4_Rx |
908 1.7 rjs IFCAP_CSUM_TCPv4_Rx | IFCAP_CSUM_UDPv4_Rx |
909 1.7 rjs IFCAP_CSUM_TCPv6_Rx | IFCAP_CSUM_UDPv6_Rx)) {
910 1.7 rjs cfg = CEMAC_READ(ETH_CFG);
911 1.7 rjs cfg |= GEM_CFG_RX_CHKSUM_OFFLD_EN;
912 1.7 rjs CEMAC_WRITE(ETH_CFG, cfg);
913 1.7 rjs }
914 1.7 rjs }
915 1.7 rjs
916 1.1 hkenken // enable interrupts
917 1.1 hkenken CEMAC_WRITE(ETH_IDR, -1);
918 1.1 hkenken CEMAC_WRITE(ETH_IER, ETH_ISR_RCOM | ETH_ISR_TBRE | ETH_ISR_TIDLE
919 1.1 hkenken | ETH_ISR_RBNA | ETH_ISR_ROVR | ETH_ISR_TCOM);
920 1.1 hkenken
921 1.1 hkenken // enable transmitter / receiver
922 1.1 hkenken CEMAC_WRITE(ETH_CTL, ETH_CTL_TE | ETH_CTL_RE | ETH_CTL_ISR
923 1.1 hkenken | ETH_CTL_CSR | ETH_CTL_MPE);
924 1.1 hkenken
925 1.1 hkenken mii_mediachg(&sc->sc_mii);
926 1.1 hkenken callout_reset(&sc->cemac_tick_ch, hz, cemac_tick, sc);
927 1.1 hkenken ifp->if_flags |= IFF_RUNNING;
928 1.1 hkenken splx(s);
929 1.1 hkenken return 0;
930 1.1 hkenken }
931 1.1 hkenken
932 1.1 hkenken static void
933 1.1 hkenken cemac_ifstop(struct ifnet *ifp, int disable)
934 1.1 hkenken {
935 1.1 hkenken // uint32_t u;
936 1.1 hkenken struct cemac_softc *sc = ifp->if_softc;
937 1.1 hkenken
938 1.1 hkenken #if 0
939 1.1 hkenken CEMAC_WRITE(ETH_CTL, ETH_CTL_MPE); // disable everything
940 1.1 hkenken CEMAC_WRITE(ETH_IDR, -1); // disable interrupts
941 1.1 hkenken // CEMAC_WRITE(ETH_RBQP, 0); // clear receive
942 1.1 hkenken if (ISSET(sc->cemac_flags, CEMAC_FLAG_GEM))
943 1.1 hkenken CEMAC_WRITE(ETH_CFG,
944 1.1 hkenken GEM_CFG_CLK_64 | ETH_CFG_SPD | ETH_CFG_FD | ETH_CFG_BIG);
945 1.1 hkenken else
946 1.1 hkenken CEMAC_WRITE(ETH_CFG,
947 1.1 hkenken ETH_CFG_CLK_32 | ETH_CFG_SPD | ETH_CFG_FD | ETH_CFG_BIG);
948 1.1 hkenken // CEMAC_WRITE(ETH_TCR, 0); // send nothing
949 1.1 hkenken // (void)CEMAC_READ(ETH_ISR);
950 1.1 hkenken u = CEMAC_READ(ETH_TSR);
951 1.1 hkenken CEMAC_WRITE(ETH_TSR, (u & (ETH_TSR_UND | ETH_TSR_COMP | ETH_TSR_BNQ
952 1.1 hkenken | ETH_TSR_IDLE | ETH_TSR_RLE
953 1.1 hkenken | ETH_TSR_COL|ETH_TSR_OVR)));
954 1.1 hkenken u = CEMAC_READ(ETH_RSR);
955 1.1 hkenken CEMAC_WRITE(ETH_RSR, (u & (ETH_RSR_OVR|ETH_RSR_REC|ETH_RSR_BNA)));
956 1.1 hkenken #endif
957 1.1 hkenken callout_stop(&sc->cemac_tick_ch);
958 1.1 hkenken
959 1.1 hkenken /* Down the MII. */
960 1.1 hkenken mii_down(&sc->sc_mii);
961 1.1 hkenken
962 1.1 hkenken ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
963 1.1 hkenken ifp->if_timer = 0;
964 1.1 hkenken sc->sc_mii.mii_media_status &= ~IFM_ACTIVE;
965 1.1 hkenken }
966 1.1 hkenken
967 1.1 hkenken static void
968 1.1 hkenken cemac_setaddr(struct ifnet *ifp)
969 1.1 hkenken {
970 1.1 hkenken struct cemac_softc *sc = ifp->if_softc;
971 1.1 hkenken struct ethercom *ac = &sc->sc_ethercom;
972 1.1 hkenken struct ether_multi *enm;
973 1.1 hkenken struct ether_multistep step;
974 1.1 hkenken uint8_t ias[3][ETHER_ADDR_LEN];
975 1.1 hkenken uint32_t h, nma = 0, hashes[2] = { 0, 0 };
976 1.1 hkenken uint32_t ctl = CEMAC_READ(ETH_CTL);
977 1.1 hkenken uint32_t cfg = CEMAC_READ(ETH_CFG);
978 1.1 hkenken
979 1.1 hkenken /* disable receiver temporarily */
980 1.1 hkenken CEMAC_WRITE(ETH_CTL, ctl & ~ETH_CTL_RE);
981 1.1 hkenken
982 1.1 hkenken cfg &= ~(ETH_CFG_MTI | ETH_CFG_UNI | ETH_CFG_CAF | ETH_CFG_UNI);
983 1.1 hkenken
984 1.1 hkenken if (ifp->if_flags & IFF_PROMISC) {
985 1.1 hkenken cfg |= ETH_CFG_CAF;
986 1.1 hkenken } else {
987 1.1 hkenken cfg &= ~ETH_CFG_CAF;
988 1.1 hkenken }
989 1.1 hkenken
990 1.1 hkenken // ETH_CFG_BIG?
991 1.1 hkenken
992 1.1 hkenken ifp->if_flags &= ~IFF_ALLMULTI;
993 1.1 hkenken
994 1.1 hkenken ETHER_FIRST_MULTI(step, ac, enm);
995 1.1 hkenken while (enm != NULL) {
996 1.1 hkenken if (memcmp(enm->enm_addrlo, enm->enm_addrhi, ETHER_ADDR_LEN)) {
997 1.1 hkenken /*
998 1.1 hkenken * We must listen to a range of multicast addresses.
999 1.1 hkenken * For now, just accept all multicasts, rather than
1000 1.1 hkenken * trying to set only those filter bits needed to match
1001 1.1 hkenken * the range. (At this time, the only use of address
1002 1.1 hkenken * ranges is for IP multicast routing, for which the
1003 1.1 hkenken * range is big enough to require all bits set.)
1004 1.1 hkenken */
1005 1.6 rjs cfg |= ETH_CFG_MTI;
1006 1.1 hkenken hashes[0] = 0xffffffffUL;
1007 1.1 hkenken hashes[1] = 0xffffffffUL;
1008 1.1 hkenken ifp->if_flags |= IFF_ALLMULTI;
1009 1.1 hkenken nma = 0;
1010 1.1 hkenken break;
1011 1.1 hkenken }
1012 1.1 hkenken
1013 1.1 hkenken if (nma < 3) {
1014 1.1 hkenken /* We can program 3 perfect address filters for mcast */
1015 1.1 hkenken memcpy(ias[nma], enm->enm_addrlo, ETHER_ADDR_LEN);
1016 1.1 hkenken } else {
1017 1.1 hkenken /*
1018 1.1 hkenken * XXX: Datasheet is not very clear here, I'm not sure
1019 1.1 hkenken * if I'm doing this right. --joff
1020 1.1 hkenken */
1021 1.1 hkenken h = ether_crc32_le(enm->enm_addrlo, ETHER_ADDR_LEN);
1022 1.1 hkenken
1023 1.1 hkenken /* Just want the 6 most-significant bits. */
1024 1.1 hkenken h = h >> 26;
1025 1.6 rjs #if 0
1026 1.1 hkenken hashes[h / 32] |= (1 << (h % 32));
1027 1.6 rjs #else
1028 1.6 rjs hashes[0] = 0xffffffffUL;
1029 1.6 rjs hashes[1] = 0xffffffffUL;
1030 1.6 rjs #endif
1031 1.1 hkenken cfg |= ETH_CFG_MTI;
1032 1.1 hkenken }
1033 1.1 hkenken ETHER_NEXT_MULTI(step, enm);
1034 1.1 hkenken nma++;
1035 1.1 hkenken }
1036 1.1 hkenken
1037 1.1 hkenken // program...
1038 1.1 hkenken DPRINTFN(1,("%s: en0 %02x:%02x:%02x:%02x:%02x:%02x\n", __FUNCTION__,
1039 1.1 hkenken sc->sc_enaddr[0], sc->sc_enaddr[1], sc->sc_enaddr[2],
1040 1.1 hkenken sc->sc_enaddr[3], sc->sc_enaddr[4], sc->sc_enaddr[5]));
1041 1.1 hkenken CEMAC_GEM_WRITE(SA1L, (sc->sc_enaddr[3] << 24)
1042 1.1 hkenken | (sc->sc_enaddr[2] << 16) | (sc->sc_enaddr[1] << 8)
1043 1.1 hkenken | (sc->sc_enaddr[0]));
1044 1.1 hkenken CEMAC_GEM_WRITE(SA1H, (sc->sc_enaddr[5] << 8)
1045 1.1 hkenken | (sc->sc_enaddr[4]));
1046 1.6 rjs if (nma > 0) {
1047 1.1 hkenken DPRINTFN(1,("%s: en1 %02x:%02x:%02x:%02x:%02x:%02x\n", __FUNCTION__,
1048 1.1 hkenken ias[0][0], ias[0][1], ias[0][2],
1049 1.1 hkenken ias[0][3], ias[0][4], ias[0][5]));
1050 1.1 hkenken CEMAC_WRITE(ETH_SA2L, (ias[0][3] << 24)
1051 1.1 hkenken | (ias[0][2] << 16) | (ias[0][1] << 8)
1052 1.1 hkenken | (ias[0][0]));
1053 1.1 hkenken CEMAC_WRITE(ETH_SA2H, (ias[0][4] << 8)
1054 1.1 hkenken | (ias[0][5]));
1055 1.1 hkenken }
1056 1.6 rjs if (nma > 1) {
1057 1.1 hkenken DPRINTFN(1,("%s: en2 %02x:%02x:%02x:%02x:%02x:%02x\n", __FUNCTION__,
1058 1.1 hkenken ias[1][0], ias[1][1], ias[1][2],
1059 1.1 hkenken ias[1][3], ias[1][4], ias[1][5]));
1060 1.1 hkenken CEMAC_WRITE(ETH_SA3L, (ias[1][3] << 24)
1061 1.1 hkenken | (ias[1][2] << 16) | (ias[1][1] << 8)
1062 1.1 hkenken | (ias[1][0]));
1063 1.1 hkenken CEMAC_WRITE(ETH_SA3H, (ias[1][4] << 8)
1064 1.1 hkenken | (ias[1][5]));
1065 1.1 hkenken }
1066 1.6 rjs if (nma > 2) {
1067 1.1 hkenken DPRINTFN(1,("%s: en3 %02x:%02x:%02x:%02x:%02x:%02x\n", __FUNCTION__,
1068 1.1 hkenken ias[2][0], ias[2][1], ias[2][2],
1069 1.1 hkenken ias[2][3], ias[2][4], ias[2][5]));
1070 1.6 rjs CEMAC_WRITE(ETH_SA4L, (ias[2][3] << 24)
1071 1.1 hkenken | (ias[2][2] << 16) | (ias[2][1] << 8)
1072 1.1 hkenken | (ias[2][0]));
1073 1.6 rjs CEMAC_WRITE(ETH_SA4H, (ias[2][4] << 8)
1074 1.1 hkenken | (ias[2][5]));
1075 1.1 hkenken }
1076 1.1 hkenken CEMAC_GEM_WRITE(HSH, hashes[0]);
1077 1.1 hkenken CEMAC_GEM_WRITE(HSL, hashes[1]);
1078 1.1 hkenken CEMAC_WRITE(ETH_CFG, cfg);
1079 1.1 hkenken CEMAC_WRITE(ETH_CTL, ctl | ETH_CTL_RE);
1080 1.1 hkenken }
1081