if_scx.c revision 1.14 1 1.14 nisimura /* $NetBSD: if_scx.c,v 1.14 2020/03/25 20:19:46 nisimura Exp $ */
2 1.1 nisimura
3 1.1 nisimura /*-
4 1.1 nisimura * Copyright (c) 2020 The NetBSD Foundation, Inc.
5 1.1 nisimura * All rights reserved.
6 1.1 nisimura *
7 1.1 nisimura * This code is derived from software contributed to The NetBSD Foundation
8 1.1 nisimura * by Tohru Nishimura.
9 1.1 nisimura *
10 1.1 nisimura * Redistribution and use in source and binary forms, with or without
11 1.1 nisimura * modification, are permitted provided that the following conditions
12 1.1 nisimura * are met:
13 1.1 nisimura * 1. Redistributions of source code must retain the above copyright
14 1.1 nisimura * notice, this list of conditions and the following disclaimer.
15 1.1 nisimura * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 nisimura * notice, this list of conditions and the following disclaimer in the
17 1.1 nisimura * documentation and/or other materials provided with the distribution.
18 1.1 nisimura *
19 1.1 nisimura * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 nisimura * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 nisimura * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 nisimura * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 nisimura * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 nisimura * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 nisimura * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 nisimura * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 nisimura * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 nisimura * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 nisimura * POSSIBILITY OF SUCH DAMAGE.
30 1.1 nisimura */
31 1.1 nisimura
32 1.1 nisimura #define NOT_MP_SAFE 0
33 1.1 nisimura
34 1.1 nisimura /*
35 1.1 nisimura * Socionext SC2A11 SynQuacer NetSec GbE driver
36 1.1 nisimura *
37 1.1 nisimura * (possibly incorrect notes to be removed eventually)
38 1.1 nisimura * - 32 byte descriptor for 64 bit paddr design.
39 1.1 nisimura * - multiple rings seems available. There are special descriptor fields
40 1.1 nisimura * to designify ring number from which to arrive or to which go.
41 1.1 nisimura * - memory mapped EEPROM to hold MAC address. The rest of the area is
42 1.1 nisimura * occupied by a set of ucode for two DMA engines and one packet engine.
43 1.9 nisimura * - The size of frame address filter is unknown. Might be 16 or even 128.
44 1.1 nisimura * - The first slot is my own station address. Always enabled to perform
45 1.1 nisimura * to identify oneself.
46 1.9 nisimura * - 1~16 are for supplimental MAC addresses. Independently enabled for
47 1.9 nisimura * use. Good to catch multicast. Byte-wise selective match available.
48 1.9 nisimura * Use the mask to catch { 0x01, 0x00, 0x00 } and/or { 0x33, 0x33 }.
49 1.9 nisimura * - 16~128 might be exact match without byte-mask.
50 1.1 nisimura * - The size of multicast hash filter store is unknown. Might be 256 bit.
51 1.7 nisimura * - Socionext/Linaro "NetSec" code makes many cut shorts. Some constants
52 1.7 nisimura * are left unexplained. The values should be handled via external
53 1.7 nisimura * controls like FDT descriptions. Fortunately, Intel/Altera CycloneV PDFs
54 1.7 nisimura * describe every detail of "such the instance of" DW EMAC IP and
55 1.7 nisimura * most of them are likely applicable to SC2A11 GbE.
56 1.14 nisimura * - DW EMAC implmentation (0x20) is 0x10.0x36
57 1.1 nisimura */
58 1.1 nisimura
59 1.1 nisimura #include <sys/cdefs.h>
60 1.14 nisimura __KERNEL_RCSID(0, "$NetBSD: if_scx.c,v 1.14 2020/03/25 20:19:46 nisimura Exp $");
61 1.1 nisimura
62 1.1 nisimura #include <sys/param.h>
63 1.1 nisimura #include <sys/bus.h>
64 1.1 nisimura #include <sys/intr.h>
65 1.1 nisimura #include <sys/device.h>
66 1.1 nisimura #include <sys/callout.h>
67 1.1 nisimura #include <sys/mbuf.h>
68 1.1 nisimura #include <sys/malloc.h>
69 1.1 nisimura #include <sys/errno.h>
70 1.1 nisimura #include <sys/rndsource.h>
71 1.1 nisimura #include <sys/kernel.h>
72 1.1 nisimura #include <sys/systm.h>
73 1.1 nisimura
74 1.1 nisimura #include <net/if.h>
75 1.1 nisimura #include <net/if_media.h>
76 1.1 nisimura #include <net/if_dl.h>
77 1.1 nisimura #include <net/if_ether.h>
78 1.1 nisimura #include <dev/mii/mii.h>
79 1.1 nisimura #include <dev/mii/miivar.h>
80 1.1 nisimura #include <net/bpf.h>
81 1.1 nisimura
82 1.1 nisimura #include <dev/fdt/fdtvar.h>
83 1.1 nisimura #include <dev/acpi/acpireg.h>
84 1.1 nisimura #include <dev/acpi/acpivar.h>
85 1.1 nisimura #include <dev/acpi/acpi_intr.h>
86 1.1 nisimura
87 1.13 nisimura /* SC2A11 register block */
88 1.1 nisimura #define SWRESET 0x104
89 1.1 nisimura #define COMINIT 0x120
90 1.1 nisimura #define INTRST 0x200
91 1.1 nisimura #define IRQ_RX (1U<<1)
92 1.1 nisimura #define IRQ_TX (1U<<0)
93 1.1 nisimura #define INTREN 0x204
94 1.1 nisimura #define INTR_SET 0x234
95 1.1 nisimura #define INTR_CLR 0x238
96 1.1 nisimura #define TXINTST 0x400
97 1.1 nisimura #define TXINTEN 0x404
98 1.1 nisimura #define TXINT_SET 0x428
99 1.1 nisimura #define TXINT_CLR 0x42c
100 1.1 nisimura #define TXI_NTOWNR (1U<<17)
101 1.1 nisimura #define TXI_TR_ERR (1U<<16)
102 1.1 nisimura #define TXI_TXDONE (1U<<15)
103 1.1 nisimura #define TXI_TMREXP (1U<<14)
104 1.1 nisimura #define RXINTST 0x440
105 1.1 nisimura #define RXINTEN 0x444
106 1.1 nisimura #define RXINT_SET 0x468
107 1.1 nisimura #define RXINT_CLR 0x46c
108 1.1 nisimura #define RXI_RC_ERR (1U<<16)
109 1.1 nisimura #define RXI_PKTCNT (1U<<15)
110 1.1 nisimura #define RXI_TMREXP (1U<<14)
111 1.1 nisimura #define TXTIMER 0x41c
112 1.1 nisimura #define RXTIMER 0x45c
113 1.1 nisimura #define TXCOUNT 0x410
114 1.1 nisimura #define RXCOUNT 0x454
115 1.3 nisimura #define H2MENG 0x210 /* DMAC host2media ucode port */
116 1.3 nisimura #define M2HENG 0x21c /* DMAC media2host ucode port */
117 1.1 nisimura #define PKTENG 0x0d0 /* packet engine ucode port */
118 1.1 nisimura #define HWVER0 0x22c
119 1.1 nisimura #define HWVER1 0x230
120 1.1 nisimura
121 1.1 nisimura #define MACSTAT 0x1024 /* gmac status */
122 1.1 nisimura #define MACDATA 0x11c0 /* gmac rd/wr data */
123 1.1 nisimura #define MACCMD 0x11c4 /* gmac operation */
124 1.1 nisimura #define CMD_IOWR (1U<<28) /* write op */
125 1.1 nisimura #define CMD_BUSY (1U<<31) /* busy bit */
126 1.1 nisimura #define DESCENG_INIT 0x11fc
127 1.1 nisimura #define DESCENG_SRST 0x1204
128 1.1 nisimura
129 1.13 nisimura /* GMAC register block. use mac_write()/mac_read() to handle */
130 1.1 nisimura #define GMACMCR 0x0000 /* MAC configuration */
131 1.1 nisimura #define MCR_IBN (1U<<30) /* */
132 1.1 nisimura #define MCR_CST (1U<<25) /* strip CRC */
133 1.1 nisimura #define MCR_TC (1U<<24) /* keep RGMII PHY notified */
134 1.3 nisimura #define MCR_JE (1U<<20) /* ignore oversized >9018 condition */
135 1.1 nisimura #define MCR_USEMII (1U<<15) /* 1: RMII/MII, 0: RGMII */
136 1.1 nisimura #define MCR_SPD100 (1U<<14) /* force speed 100 */
137 1.1 nisimura #define MCR_USEFDX (1U<<11) /* force full duplex */
138 1.1 nisimura #define MCR_IPCKEN (1U<<10) /* handle checksum */
139 1.5 nisimura #define MCR_ACS (1U<<7) /* auto pad strip CRC */
140 1.1 nisimura #define MCR_TXE (1U<<3) /* start Tx DMA engine */
141 1.1 nisimura #define MCR_RXE (1U<<2) /* start Rx DMA engine */
142 1.1 nisimura #define _MCR_FDX 0x0000280c /* XXX TBD */
143 1.1 nisimura #define _MCR_HDX 0x0001a00c /* XXX TBD */
144 1.1 nisimura #define GMACAFR 0x0004 /* frame DA/SA address filter */
145 1.2 nisimura #define AFR_RA (1U<<31) /* receive block all on */
146 1.1 nisimura #define AFR_HPF (1U<<10) /* activate hash or perfect filter */
147 1.1 nisimura #define AFR_SAF (1U<<9) /* source address filter */
148 1.1 nisimura #define AFR_SAIF (1U<<8) /* SA inverse filtering */
149 1.1 nisimura #define AFR_PCF (3U<<6) /* */
150 1.1 nisimura #define AFR_RB (1U<<5) /* reject broadcast frame */
151 1.1 nisimura #define AFR_AM (1U<<4) /* accept all multicast frame */
152 1.1 nisimura #define AFR_DAIF (1U<<3) /* DA inverse filtering */
153 1.1 nisimura #define AFR_MHTE (1U<<2) /* use multicast hash table */
154 1.1 nisimura #define AFR_UHTE (1U<<1) /* use additional MAC addresses */
155 1.1 nisimura #define AFR_PM (1U<<0) /* run promisc mode */
156 1.1 nisimura #define _AFR 0x80000001 /* XXX TBD */
157 1.1 nisimura #define GMACMHTH 0x0008 /* XXX multicast hash table 63:32 */
158 1.1 nisimura #define GMACMHTL 0x000c /* XXX multicast hash table 31:0 */
159 1.1 nisimura #define GMACGAR 0x0010 /* MDIO operation */
160 1.1 nisimura #define GAR_PHY (11) /* mii phy 15:11 */
161 1.1 nisimura #define GAR_REG (6) /* mii reg 10:6 */
162 1.1 nisimura #define GAR_CTL (2) /* control 5:2 */
163 1.1 nisimura #define GAR_IOWR (1U<<1) /* MDIO write op */
164 1.1 nisimura #define GAR_BUSY (1U) /* busy bit */
165 1.1 nisimura #define GMACGDR 0x0014 /* MDIO rd/wr data */
166 1.1 nisimura #define GMACFCR 0x0018 /* 802.3x flowcontrol */
167 1.1 nisimura #define FCR_RFE (1U<<2) /* accept PAUSE to throttle Tx */
168 1.1 nisimura #define FCR_TFE (1U<<1) /* generate PAUSE to moderate Rx lvl */
169 1.8 nisimura #define GMACVTAG 0x001c /* VLAN tag control */
170 1.14 nisimura #define GMACIMPL 0x0020 /* implementation number XX.YY */
171 1.1 nisimura #define GMACMAH0 0x0040 /* MAC address 0 47:32 */
172 1.1 nisimura #define GMACMAL0 0x0044 /* MAC address 0 31:0 */
173 1.2 nisimura #define GMACMAH(i) ((i)*8+0x40) /* supplimental MAC addr 1 - 15 */
174 1.1 nisimura #define GMACMAL(i) ((i)*8+0x44)
175 1.13 nisimura #define GMACMIISR 0x00d8 /* resolved xMII link status */
176 1.13 nisimura /* 3 link up detected
177 1.13 nisimura * 2:1 resovled speed
178 1.14 nisimura * 0 2.5Mhz (10Mbps)
179 1.13 nisimura * 1 25Mhz (100bps)
180 1.13 nisimura * 2 125Mhz (1000Mbps)
181 1.13 nisimura * 1 full duplex detected */
182 1.13 nisimura
183 1.8 nisimura #define GMACMHT0 0x0500 /* multicast hash table 0 - 7 */
184 1.11 nisimura #define GMACMHT(i) ((i)*4+0x500)
185 1.11 nisimura #define GMACVHT 0x0588 /* VLAN tag hash */
186 1.11 nisimura #define GMACAMAH(i) ((i)*8+0x800) /* supplimental MAC addr 16-127 */
187 1.11 nisimura #define GMACAMAL(i) ((i)*8+0x804)
188 1.12 nisimura #define GMACEVCNT(i) ((i)*4+0x114) /* event counter 0x114~284 */
189 1.13 nisimura #define GMACEVCTL 0x0100 /* clear event counter registers */
190 1.2 nisimura
191 1.3 nisimura #define GMACBMR 0x1000 /* DMA bus mode control
192 1.1 nisimura * 24 4PBL
193 1.1 nisimura * 22:17 RPBL
194 1.1 nisimura * 16 fix burst
195 1.1 nisimura * 15:14 priority between Rx and Tx
196 1.11 nisimura * 3 rxtx ratio 41
197 1.11 nisimura * 2 rxtx ratio 31
198 1.11 nisimura * 1 rxtx ratio 21
199 1.11 nisimura * 0 rxtx ratio 11
200 1.1 nisimura * 13:8 PBL possible DMA burst len
201 1.12 nisimura * 0 reset op. self clear
202 1.1 nisimura */
203 1.1 nisimura #define _BMR 0x00412080 /* XXX TBD */
204 1.1 nisimura #define _BMR0 0x00020181 /* XXX TBD */
205 1.1 nisimura #define BMR_RST (1U<<0) /* reset op. self clear when done */
206 1.12 nisimura #define GMACTDS 0x1004 /* write any to resume tdes */
207 1.12 nisimura #define GMACRDS 0x1008 /* write any to resume rdes */
208 1.12 nisimura #define GMACRDLAR 0x100c /* rdes base address 32bit paddr */
209 1.12 nisimura #define _RDLAR 0x18000 /* XXX TBD system SRAM with CC ? */
210 1.12 nisimura #define GMACTDLAR 0x1010 /* tdes base address 32bit paddr */
211 1.12 nisimura #define _TDLAR 0x1c000 /* XXX TBD system SRAM with CC ? */
212 1.1 nisimura #define GMACOMR 0x1018 /* DMA operation */
213 1.3 nisimura #define OMR_TXE (1U<<13) /* start Tx DMA engine, 0 to stop */
214 1.3 nisimura #define OMR_RXE (1U<<1) /* start Rx DMA engine, 0 to stop */
215 1.1 nisimura
216 1.1 nisimura /* descriptor format definition */
217 1.1 nisimura struct tdes {
218 1.1 nisimura uint32_t t0, t1, t2, t3;
219 1.1 nisimura };
220 1.1 nisimura
221 1.1 nisimura struct rdes {
222 1.1 nisimura uint32_t r0, r1, r2, r3;
223 1.1 nisimura };
224 1.1 nisimura
225 1.1 nisimura #define T0_OWN (1U<<31) /* desc is ready to Tx */
226 1.1 nisimura #define T0_EOD (1U<<30) /* end of descriptor array */
227 1.6 nisimura #define T0_DRID (24) /* 29:24 D-RID */
228 1.1 nisimura #define T0_PT (1U<<21) /* 23:21 PT */
229 1.6 nisimura #define T0_TRID (16) /* 20:16 T-RID */
230 1.1 nisimura #define T0_FS (1U<<9) /* first segment of frame */
231 1.1 nisimura #define T0_LS (1U<<8) /* last segment of frame */
232 1.1 nisimura #define T0_CSUM (1U<<7) /* enable check sum offload */
233 1.1 nisimura #define T0_SGOL (1U<<6) /* enable TCP segment offload */
234 1.1 nisimura #define T0_TRS (1U<<4) /* 5:4 TRS */
235 1.1 nisimura #define T0_IOC (0) /* XXX TBD interrupt when completed */
236 1.1 nisimura /* T1 segment address 63:32 */
237 1.1 nisimura /* T2 segment address 31:0 */
238 1.1 nisimura /* T3 31:16 TCP segment length, 15:0 segment length to transmit */
239 1.1 nisimura #define R0_OWN (1U<<31) /* desc is empty */
240 1.1 nisimura #define R0_EOD (1U<<30) /* end of descriptor array */
241 1.6 nisimura #define R0_SRID (24) /* 29:24 S-RID */
242 1.1 nisimura #define R0_FR (1U<<23) /* FR */
243 1.1 nisimura #define R0_ER (1U<<21) /* Rx error indication */
244 1.1 nisimura #define R0_ERR (3U<<16) /* 18:16 receive error code */
245 1.6 nisimura #define R0_TDRID (14) /* 15:14 TD-RID */
246 1.1 nisimura #define R0_FS (1U<<9) /* first segment of frame */
247 1.1 nisimura #define R0_LS (1U<<8) /* last segment of frame */
248 1.1 nisimura #define R0_CSUM (3U<<6) /* 7:6 checksum status */
249 1.1 nisimura #define R0_CERR (2U<<6) /* 0 (undone), 1 (found ok), 2 (bad) */
250 1.1 nisimura /* R1 frame address 63:32 */
251 1.1 nisimura /* R2 frame address 31:0 */
252 1.1 nisimura /* R3 31:16 received frame length, 15:0 buffer length to receive */
253 1.1 nisimura
254 1.6 nisimura #define MD_NTXSEGS 16 /* fixed */
255 1.6 nisimura #define MD_TXQUEUELEN 16 /* tunable */
256 1.6 nisimura #define MD_TXQUEUELEN_MASK (MD_TXQUEUELEN - 1)
257 1.6 nisimura #define MD_TXQUEUE_GC (MD_TXQUEUELEN / 4)
258 1.6 nisimura #define MD_NTXDESC (MD_TXQUEUELEN * MD_NTXSEGS)
259 1.6 nisimura #define MD_NTXDESC_MASK (MD_NTXDESC - 1)
260 1.6 nisimura #define MD_NEXTTX(x) (((x) + 1) & MD_NTXDESC_MASK)
261 1.6 nisimura #define MD_NEXTTXS(x) (((x) + 1) & MD_TXQUEUELEN_MASK)
262 1.6 nisimura
263 1.6 nisimura #define MD_NRXDESC 64 /* tunable */
264 1.6 nisimura #define MD_NRXDESC_MASK (MD_NRXDESC - 1)
265 1.6 nisimura #define MD_NEXTRX(x) (((x) + 1) & MD_NRXDESC_MASK)
266 1.1 nisimura
267 1.1 nisimura #define SCX_INIT_RXDESC(sc, x) \
268 1.1 nisimura do { \
269 1.1 nisimura struct scx_rxsoft *__rxs = &(sc)->sc_rxsoft[(x)]; \
270 1.1 nisimura struct rdes *__rxd = &(sc)->sc_rxdescs[(x)]; \
271 1.1 nisimura struct mbuf *__m = __rxs->rxs_mbuf; \
272 1.1 nisimura bus_addr_t __paddr =__rxs->rxs_dmamap->dm_segs[0].ds_addr; \
273 1.1 nisimura __m->m_data = __m->m_ext.ext_buf; \
274 1.1 nisimura __rxd->r3 = __rxs->rxs_dmamap->dm_segs[0].ds_len; \
275 1.1 nisimura __rxd->r2 = htole32(BUS_ADDR_LO32(__paddr)); \
276 1.1 nisimura __rxd->r1 = htole32(BUS_ADDR_HI32(__paddr)); \
277 1.1 nisimura __rxd->r0 = R0_OWN | R0_FS | R0_LS; \
278 1.6 nisimura if ((x) == MD_NRXDESC - 1) __rxd->r0 |= R0_EOD; \
279 1.1 nisimura } while (/*CONSTCOND*/0)
280 1.1 nisimura
281 1.1 nisimura struct control_data {
282 1.6 nisimura struct tdes cd_txdescs[MD_NTXDESC];
283 1.6 nisimura struct rdes cd_rxdescs[MD_NRXDESC];
284 1.1 nisimura };
285 1.1 nisimura #define SCX_CDOFF(x) offsetof(struct control_data, x)
286 1.1 nisimura #define SCX_CDTXOFF(x) SCX_CDOFF(cd_txdescs[(x)])
287 1.1 nisimura #define SCX_CDRXOFF(x) SCX_CDOFF(cd_rxdescs[(x)])
288 1.1 nisimura
289 1.1 nisimura struct scx_txsoft {
290 1.1 nisimura struct mbuf *txs_mbuf; /* head of our mbuf chain */
291 1.1 nisimura bus_dmamap_t txs_dmamap; /* our DMA map */
292 1.1 nisimura int txs_firstdesc; /* first descriptor in packet */
293 1.1 nisimura int txs_lastdesc; /* last descriptor in packet */
294 1.1 nisimura int txs_ndesc; /* # of descriptors used */
295 1.1 nisimura };
296 1.1 nisimura
297 1.1 nisimura struct scx_rxsoft {
298 1.1 nisimura struct mbuf *rxs_mbuf; /* head of our mbuf chain */
299 1.1 nisimura bus_dmamap_t rxs_dmamap; /* our DMA map */
300 1.1 nisimura };
301 1.1 nisimura
302 1.1 nisimura struct scx_softc {
303 1.1 nisimura device_t sc_dev; /* generic device information */
304 1.1 nisimura bus_space_tag_t sc_st; /* bus space tag */
305 1.1 nisimura bus_space_handle_t sc_sh; /* bus space handle */
306 1.1 nisimura bus_size_t sc_sz; /* csr map size */
307 1.1 nisimura bus_space_handle_t sc_eesh; /* eeprom section handle */
308 1.1 nisimura bus_size_t sc_eesz; /* eeprom map size */
309 1.1 nisimura bus_dma_tag_t sc_dmat; /* bus DMA tag */
310 1.14 nisimura bus_dma_tag_t sc_dmat32;
311 1.1 nisimura struct ethercom sc_ethercom; /* Ethernet common data */
312 1.1 nisimura struct mii_data sc_mii; /* MII */
313 1.1 nisimura callout_t sc_tick_ch; /* PHY monitor callout */
314 1.1 nisimura bus_dma_segment_t sc_seg; /* descriptor store seg */
315 1.1 nisimura int sc_nseg; /* descriptor store nseg */
316 1.3 nisimura void *sc_ih; /* interrupt cookie */
317 1.1 nisimura int sc_phy_id; /* PHY address */
318 1.3 nisimura int sc_flowflags; /* 802.3x PAUSE flow control */
319 1.7 nisimura uint32_t sc_mdclk; /* GAR 5:2 clock selection */
320 1.3 nisimura uint32_t sc_t0coso; /* T0_CSUM | T0_SGOL to run */
321 1.3 nisimura int sc_ucodeloaded; /* ucode for H2M/M2H/PKT */
322 1.8 nisimura int sc_100mii; /* 1 for RMII/MII, 0 for RGMII */
323 1.1 nisimura int sc_phandle; /* fdt phandle */
324 1.14 nisimura uint64_t sc_freq;
325 1.1 nisimura
326 1.1 nisimura bus_dmamap_t sc_cddmamap; /* control data DMA map */
327 1.1 nisimura #define sc_cddma sc_cddmamap->dm_segs[0].ds_addr
328 1.1 nisimura
329 1.1 nisimura struct control_data *sc_control_data;
330 1.1 nisimura #define sc_txdescs sc_control_data->cd_txdescs
331 1.1 nisimura #define sc_rxdescs sc_control_data->cd_rxdescs
332 1.1 nisimura
333 1.6 nisimura struct scx_txsoft sc_txsoft[MD_TXQUEUELEN];
334 1.6 nisimura struct scx_rxsoft sc_rxsoft[MD_NRXDESC];
335 1.1 nisimura int sc_txfree; /* number of free Tx descriptors */
336 1.1 nisimura int sc_txnext; /* next ready Tx descriptor */
337 1.1 nisimura int sc_txsfree; /* number of free Tx jobs */
338 1.1 nisimura int sc_txsnext; /* next ready Tx job */
339 1.1 nisimura int sc_txsdirty; /* dirty Tx jobs */
340 1.1 nisimura int sc_rxptr; /* next ready Rx descriptor/descsoft */
341 1.1 nisimura
342 1.1 nisimura krndsource_t rnd_source; /* random source */
343 1.1 nisimura };
344 1.1 nisimura
345 1.1 nisimura #define SCX_CDTXADDR(sc, x) ((sc)->sc_cddma + SCX_CDTXOFF((x)))
346 1.1 nisimura #define SCX_CDRXADDR(sc, x) ((sc)->sc_cddma + SCX_CDRXOFF((x)))
347 1.1 nisimura
348 1.1 nisimura #define SCX_CDTXSYNC(sc, x, n, ops) \
349 1.1 nisimura do { \
350 1.1 nisimura int __x, __n; \
351 1.1 nisimura \
352 1.1 nisimura __x = (x); \
353 1.1 nisimura __n = (n); \
354 1.1 nisimura \
355 1.1 nisimura /* If it will wrap around, sync to the end of the ring. */ \
356 1.6 nisimura if ((__x + __n) > MD_NTXDESC) { \
357 1.1 nisimura bus_dmamap_sync((sc)->sc_dmat, (sc)->sc_cddmamap, \
358 1.1 nisimura SCX_CDTXOFF(__x), sizeof(struct tdes) * \
359 1.6 nisimura (MD_NTXDESC - __x), (ops)); \
360 1.6 nisimura __n -= (MD_NTXDESC - __x); \
361 1.1 nisimura __x = 0; \
362 1.1 nisimura } \
363 1.1 nisimura \
364 1.1 nisimura /* Now sync whatever is left. */ \
365 1.1 nisimura bus_dmamap_sync((sc)->sc_dmat, (sc)->sc_cddmamap, \
366 1.1 nisimura SCX_CDTXOFF(__x), sizeof(struct tdes) * __n, (ops)); \
367 1.1 nisimura } while (/*CONSTCOND*/0)
368 1.1 nisimura
369 1.1 nisimura #define SCX_CDRXSYNC(sc, x, ops) \
370 1.1 nisimura do { \
371 1.1 nisimura bus_dmamap_sync((sc)->sc_dmat, (sc)->sc_cddmamap, \
372 1.1 nisimura SCX_CDRXOFF((x)), sizeof(struct rdes), (ops)); \
373 1.1 nisimura } while (/*CONSTCOND*/0)
374 1.1 nisimura
375 1.1 nisimura static int scx_fdt_match(device_t, cfdata_t, void *);
376 1.1 nisimura static void scx_fdt_attach(device_t, device_t, void *);
377 1.1 nisimura static int scx_acpi_match(device_t, cfdata_t, void *);
378 1.1 nisimura static void scx_acpi_attach(device_t, device_t, void *);
379 1.1 nisimura
380 1.1 nisimura CFATTACH_DECL_NEW(scx_fdt, sizeof(struct scx_softc),
381 1.1 nisimura scx_fdt_match, scx_fdt_attach, NULL, NULL);
382 1.1 nisimura
383 1.1 nisimura CFATTACH_DECL_NEW(scx_acpi, sizeof(struct scx_softc),
384 1.1 nisimura scx_acpi_match, scx_acpi_attach, NULL, NULL);
385 1.1 nisimura
386 1.1 nisimura static void scx_attach_i(struct scx_softc *);
387 1.1 nisimura static void scx_reset(struct scx_softc *);
388 1.1 nisimura static int scx_init(struct ifnet *);
389 1.1 nisimura static void scx_start(struct ifnet *);
390 1.1 nisimura static void scx_stop(struct ifnet *, int);
391 1.1 nisimura static void scx_watchdog(struct ifnet *);
392 1.1 nisimura static int scx_ioctl(struct ifnet *, u_long, void *);
393 1.1 nisimura static void scx_set_rcvfilt(struct scx_softc *);
394 1.1 nisimura static int scx_ifmedia_upd(struct ifnet *);
395 1.1 nisimura static void scx_ifmedia_sts(struct ifnet *, struct ifmediareq *);
396 1.1 nisimura static void mii_statchg(struct ifnet *);
397 1.1 nisimura static void phy_tick(void *);
398 1.1 nisimura static int mii_readreg(device_t, int, int, uint16_t *);
399 1.1 nisimura static int mii_writereg(device_t, int, int, uint16_t);
400 1.1 nisimura static int scx_intr(void *);
401 1.1 nisimura static void txreap(struct scx_softc *);
402 1.1 nisimura static void rxintr(struct scx_softc *);
403 1.1 nisimura static int add_rxbuf(struct scx_softc *, int);
404 1.13 nisimura
405 1.1 nisimura static int spin_waitfor(struct scx_softc *, int, int);
406 1.1 nisimura static int mac_read(struct scx_softc *, int);
407 1.1 nisimura static void mac_write(struct scx_softc *, int, int);
408 1.1 nisimura static void loaducode(struct scx_softc *);
409 1.2 nisimura static void injectucode(struct scx_softc *, int, bus_addr_t, bus_size_t);
410 1.14 nisimura static int get_mdioclk(uint32_t);
411 1.1 nisimura
412 1.1 nisimura #define CSR_READ(sc,off) \
413 1.1 nisimura bus_space_read_4((sc)->sc_st, (sc)->sc_sh, (off))
414 1.1 nisimura #define CSR_WRITE(sc,off,val) \
415 1.1 nisimura bus_space_write_4((sc)->sc_st, (sc)->sc_sh, (off), (val))
416 1.1 nisimura #define EE_READ(sc,off) \
417 1.1 nisimura bus_space_read_4((sc)->sc_st, (sc)->sc_eesh, (off))
418 1.1 nisimura
419 1.1 nisimura static int
420 1.1 nisimura scx_fdt_match(device_t parent, cfdata_t cf, void *aux)
421 1.1 nisimura {
422 1.1 nisimura static const char * compatible[] = {
423 1.1 nisimura "socionext,synquacer-netsec",
424 1.1 nisimura NULL
425 1.1 nisimura };
426 1.1 nisimura struct fdt_attach_args * const faa = aux;
427 1.1 nisimura
428 1.1 nisimura return of_match_compatible(faa->faa_phandle, compatible);
429 1.1 nisimura }
430 1.1 nisimura
431 1.1 nisimura static void
432 1.1 nisimura scx_fdt_attach(device_t parent, device_t self, void *aux)
433 1.1 nisimura {
434 1.1 nisimura struct scx_softc * const sc = device_private(self);
435 1.1 nisimura struct fdt_attach_args * const faa = aux;
436 1.1 nisimura const int phandle = faa->faa_phandle;
437 1.1 nisimura bus_space_tag_t bst = faa->faa_bst;
438 1.1 nisimura bus_space_handle_t bsh;
439 1.1 nisimura bus_space_handle_t eebsh;
440 1.2 nisimura bus_addr_t addr[2];
441 1.2 nisimura bus_size_t size[2];
442 1.1 nisimura char intrstr[128];
443 1.4 nisimura const char *phy_mode;
444 1.1 nisimura
445 1.2 nisimura if (fdtbus_get_reg(phandle, 0, addr+0, size+0) != 0
446 1.2 nisimura || bus_space_map(faa->faa_bst, addr[0], size[0], 0, &bsh) != 0) {
447 1.1 nisimura aprint_error(": unable to map device csr\n");
448 1.1 nisimura return;
449 1.1 nisimura }
450 1.1 nisimura if (!fdtbus_intr_str(phandle, 0, intrstr, sizeof(intrstr))) {
451 1.1 nisimura aprint_error(": failed to decode interrupt\n");
452 1.1 nisimura goto fail;
453 1.1 nisimura }
454 1.1 nisimura sc->sc_ih = fdtbus_intr_establish(phandle, 0, IPL_NET,
455 1.1 nisimura NOT_MP_SAFE, scx_intr, sc);
456 1.1 nisimura if (sc->sc_ih == NULL) {
457 1.1 nisimura aprint_error_dev(self, "couldn't establish interrupt\n");
458 1.1 nisimura goto fail;
459 1.1 nisimura }
460 1.2 nisimura if (fdtbus_get_reg(phandle, 1, addr+1, size+1) != 0
461 1.10 nisimura || bus_space_map(faa->faa_bst, addr[1], size[1], 0, &eebsh) != 0) {
462 1.1 nisimura aprint_error(": unable to map device eeprom\n");
463 1.1 nisimura goto fail;
464 1.1 nisimura }
465 1.1 nisimura
466 1.4 nisimura
467 1.1 nisimura aprint_naive("\n");
468 1.14 nisimura /* aprint_normal(": Gigabit Ethernet Controller\n"); */
469 1.1 nisimura aprint_normal_dev(self, "interrupt on %s\n", intrstr);
470 1.1 nisimura
471 1.1 nisimura sc->sc_dev = self;
472 1.1 nisimura sc->sc_st = bst;
473 1.1 nisimura sc->sc_sh = bsh;
474 1.2 nisimura sc->sc_sz = size[0];
475 1.1 nisimura sc->sc_eesh = eebsh;
476 1.2 nisimura sc->sc_eesz = size[1];
477 1.1 nisimura sc->sc_dmat = faa->faa_dmat;
478 1.1 nisimura sc->sc_phandle = phandle;
479 1.14 nisimura
480 1.14 nisimura phy_mode = fdtbus_get_string(phandle, "phy-mode");
481 1.14 nisimura if (phy_mode == NULL)
482 1.14 nisimura aprint_error(": missing 'phy-mode' property\n");
483 1.14 nisimura sc->sc_100mii = (phy_mode != NULL && strcmp(phy_mode, "rgmii") != 0);
484 1.14 nisimura sc->sc_phy_id = 7; /* XXX */
485 1.14 nisimura sc->sc_freq = 250 * 1000 * 1000; /* XXX */
486 1.14 nisimura aprint_normal_dev(self,
487 1.14 nisimura "phy mode %s, phy id %d, freq %ld\n", phy_mode, sc->sc_phy_id, sc->sc_freq);
488 1.1 nisimura
489 1.1 nisimura scx_attach_i(sc);
490 1.1 nisimura return;
491 1.1 nisimura fail:
492 1.1 nisimura if (sc->sc_eesz)
493 1.1 nisimura bus_space_unmap(sc->sc_st, sc->sc_eesh, sc->sc_eesz);
494 1.1 nisimura if (sc->sc_sz)
495 1.1 nisimura bus_space_unmap(sc->sc_st, sc->sc_sh, sc->sc_sz);
496 1.1 nisimura return;
497 1.1 nisimura }
498 1.1 nisimura
499 1.1 nisimura static int
500 1.1 nisimura scx_acpi_match(device_t parent, cfdata_t cf, void *aux)
501 1.1 nisimura {
502 1.1 nisimura static const char * compatible[] = {
503 1.1 nisimura "SCX0001",
504 1.1 nisimura NULL
505 1.1 nisimura };
506 1.1 nisimura struct acpi_attach_args *aa = aux;
507 1.1 nisimura
508 1.1 nisimura if (aa->aa_node->ad_type != ACPI_TYPE_DEVICE)
509 1.1 nisimura return 0;
510 1.1 nisimura return acpi_match_hid(aa->aa_node->ad_devinfo, compatible);
511 1.1 nisimura }
512 1.1 nisimura
513 1.1 nisimura static void
514 1.1 nisimura scx_acpi_attach(device_t parent, device_t self, void *aux)
515 1.1 nisimura {
516 1.1 nisimura struct scx_softc * const sc = device_private(self);
517 1.1 nisimura struct acpi_attach_args * const aa = aux;
518 1.1 nisimura ACPI_HANDLE handle = aa->aa_node->ad_handle;
519 1.1 nisimura bus_space_tag_t bst = aa->aa_memt;
520 1.1 nisimura bus_space_handle_t bsh, eebsh;
521 1.1 nisimura struct acpi_resources res;
522 1.1 nisimura struct acpi_mem *mem;
523 1.1 nisimura struct acpi_irq *irq;
524 1.14 nisimura char *phy_mode;
525 1.14 nisimura ACPI_INTEGER acpi_phy, acpi_freq;
526 1.1 nisimura ACPI_STATUS rv;
527 1.1 nisimura
528 1.1 nisimura rv = acpi_resource_parse(self, handle, "_CRS",
529 1.1 nisimura &res, &acpi_resource_parse_ops_default);
530 1.1 nisimura if (ACPI_FAILURE(rv))
531 1.1 nisimura return;
532 1.1 nisimura mem = acpi_res_mem(&res, 0);
533 1.1 nisimura irq = acpi_res_irq(&res, 0);
534 1.1 nisimura if (mem == NULL || irq == NULL || mem->ar_length == 0) {
535 1.1 nisimura aprint_error(": incomplete csr resources\n");
536 1.1 nisimura return;
537 1.1 nisimura }
538 1.1 nisimura if (bus_space_map(bst, mem->ar_base, mem->ar_length, 0, &bsh) != 0) {
539 1.1 nisimura aprint_error(": couldn't map registers\n");
540 1.1 nisimura return;
541 1.1 nisimura }
542 1.1 nisimura sc->sc_sz = mem->ar_length;
543 1.1 nisimura sc->sc_ih = acpi_intr_establish(self, (uint64_t)handle, IPL_NET,
544 1.1 nisimura NOT_MP_SAFE, scx_intr, sc, device_xname(self));
545 1.1 nisimura if (sc->sc_ih == NULL) {
546 1.1 nisimura aprint_error_dev(self, "couldn't establish interrupt\n");
547 1.1 nisimura goto fail;
548 1.1 nisimura }
549 1.1 nisimura mem = acpi_res_mem(&res, 1); /* EEPROM for MAC address and ucode */
550 1.1 nisimura if (mem == NULL || mem->ar_length == 0) {
551 1.1 nisimura aprint_error(": incomplete eeprom resources\n");
552 1.1 nisimura goto fail;
553 1.1 nisimura }
554 1.1 nisimura if (bus_space_map(bst, mem->ar_base, mem->ar_length, 0, &eebsh) != 0) {
555 1.1 nisimura aprint_error(": couldn't map registers\n");
556 1.1 nisimura goto fail;
557 1.1 nisimura }
558 1.1 nisimura sc->sc_eesz = mem->ar_length;
559 1.1 nisimura
560 1.14 nisimura rv = acpi_dsd_string(handle, "phy-mode", &phy_mode);
561 1.14 nisimura if (ACPI_FAILURE(rv)) {
562 1.14 nisimura aprint_error(": missing 'phy-mode' property\n");
563 1.14 nisimura phy_mode = NULL;
564 1.14 nisimura }
565 1.14 nisimura rv = acpi_dsd_integer(handle, "phy-channel", &acpi_phy);
566 1.14 nisimura if (ACPI_FAILURE(rv))
567 1.14 nisimura acpi_phy = 31;
568 1.14 nisimura rv = acpi_dsd_integer(handle, "socionext,phy-clock-frequency",
569 1.14 nisimura &acpi_freq);
570 1.14 nisimura if (ACPI_FAILURE(rv))
571 1.14 nisimura acpi_freq = 999;
572 1.14 nisimura
573 1.1 nisimura aprint_naive("\n");
574 1.14 nisimura /* aprint_normal(": Gigabit Ethernet Controller\n"); */
575 1.1 nisimura
576 1.1 nisimura sc->sc_dev = self;
577 1.1 nisimura sc->sc_st = bst;
578 1.1 nisimura sc->sc_sh = bsh;
579 1.1 nisimura sc->sc_eesh = eebsh;
580 1.1 nisimura sc->sc_dmat = aa->aa_dmat64;
581 1.14 nisimura sc->sc_dmat32 = aa->aa_dmat; /* descriptor needs dma32 */
582 1.1 nisimura
583 1.14 nisimura aprint_normal_dev(self,
584 1.14 nisimura "phy mode %s, phy id %d, freq %ld\n", phy_mode, (int)acpi_phy, acpi_freq);
585 1.14 nisimura sc->sc_100mii = (phy_mode && strcmp(phy_mode, "rgmii") != 0);
586 1.14 nisimura sc->sc_freq = acpi_freq;
587 1.14 nisimura sc->sc_phy_id = (int)acpi_phy;
588 1.10 nisimura
589 1.1 nisimura scx_attach_i(sc);
590 1.1 nisimura
591 1.1 nisimura acpi_resource_cleanup(&res);
592 1.1 nisimura return;
593 1.1 nisimura fail:
594 1.1 nisimura if (sc->sc_eesz > 0)
595 1.1 nisimura bus_space_unmap(sc->sc_st, sc->sc_eesh, sc->sc_eesz);
596 1.1 nisimura if (sc->sc_sz > 0)
597 1.1 nisimura bus_space_unmap(sc->sc_st, sc->sc_sh, sc->sc_sz);
598 1.1 nisimura acpi_resource_cleanup(&res);
599 1.1 nisimura return;
600 1.1 nisimura }
601 1.1 nisimura
602 1.1 nisimura static void
603 1.1 nisimura scx_attach_i(struct scx_softc *sc)
604 1.1 nisimura {
605 1.1 nisimura struct ifnet * const ifp = &sc->sc_ethercom.ec_if;
606 1.1 nisimura struct mii_data * const mii = &sc->sc_mii;
607 1.1 nisimura struct ifmedia * const ifm = &mii->mii_media;
608 1.14 nisimura uint32_t hwver;
609 1.1 nisimura uint8_t enaddr[ETHER_ADDR_LEN];
610 1.1 nisimura bus_dma_segment_t seg;
611 1.1 nisimura uint32_t csr;
612 1.1 nisimura int i, nseg, error = 0;
613 1.1 nisimura
614 1.1 nisimura hwver = CSR_READ(sc, HWVER1);
615 1.1 nisimura csr = bus_space_read_4(sc->sc_st, sc->sc_eesh, 0);
616 1.1 nisimura enaddr[0] = csr >> 24;
617 1.1 nisimura enaddr[1] = csr >> 16;
618 1.1 nisimura enaddr[2] = csr >> 8;
619 1.1 nisimura enaddr[3] = csr;
620 1.1 nisimura csr = bus_space_read_4(sc->sc_st, sc->sc_eesh, 4);
621 1.1 nisimura enaddr[4] = csr >> 24;
622 1.1 nisimura enaddr[5] = csr >> 16;
623 1.13 nisimura csr = mac_read(sc, GMACIMPL);
624 1.1 nisimura
625 1.14 nisimura aprint_normal_dev(sc->sc_dev,
626 1.14 nisimura "Socionext NetSec GbE hw %d.%d impl 0x%x\n",
627 1.14 nisimura hwver >> 16, hwver & 0xffff, csr);
628 1.1 nisimura aprint_normal_dev(sc->sc_dev,
629 1.1 nisimura "Ethernet address %s\n", ether_sprintf(enaddr));
630 1.1 nisimura
631 1.1 nisimura sc->sc_phy_id = MII_PHY_ANY;
632 1.14 nisimura sc->sc_mdclk = get_mdioclk(sc->sc_freq); /* 5:2 clk control */
633 1.14 nisimura sc->sc_mdclk = 5; /* XXX */
634 1.14 nisimura aprint_normal_dev(sc->sc_dev, "using %d for mdclk\n", sc->sc_mdclk);
635 1.14 nisimura sc->sc_mdclk <<= 2;
636 1.1 nisimura
637 1.1 nisimura sc->sc_flowflags = 0;
638 1.1 nisimura
639 1.3 nisimura if (sc->sc_ucodeloaded == 0)
640 1.1 nisimura loaducode(sc);
641 1.1 nisimura
642 1.1 nisimura mii->mii_ifp = ifp;
643 1.1 nisimura mii->mii_readreg = mii_readreg;
644 1.1 nisimura mii->mii_writereg = mii_writereg;
645 1.1 nisimura mii->mii_statchg = mii_statchg;
646 1.1 nisimura
647 1.1 nisimura sc->sc_ethercom.ec_mii = mii;
648 1.1 nisimura ifmedia_init(ifm, 0, scx_ifmedia_upd, scx_ifmedia_sts);
649 1.1 nisimura mii_attach(sc->sc_dev, mii, 0xffffffff, sc->sc_phy_id,
650 1.1 nisimura MII_OFFSET_ANY, MIIF_DOPAUSE);
651 1.1 nisimura if (LIST_FIRST(&mii->mii_phys) == NULL) {
652 1.1 nisimura ifmedia_add(ifm, IFM_ETHER | IFM_NONE, 0, NULL);
653 1.1 nisimura ifmedia_set(ifm, IFM_ETHER | IFM_NONE);
654 1.1 nisimura } else
655 1.1 nisimura ifmedia_set(ifm, IFM_ETHER | IFM_AUTO);
656 1.1 nisimura ifm->ifm_media = ifm->ifm_cur->ifm_media; /* as if user has requested */
657 1.1 nisimura
658 1.1 nisimura strlcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
659 1.1 nisimura ifp->if_softc = sc;
660 1.1 nisimura ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
661 1.1 nisimura ifp->if_ioctl = scx_ioctl;
662 1.1 nisimura ifp->if_start = scx_start;
663 1.1 nisimura ifp->if_watchdog = scx_watchdog;
664 1.1 nisimura ifp->if_init = scx_init;
665 1.1 nisimura ifp->if_stop = scx_stop;
666 1.1 nisimura IFQ_SET_READY(&ifp->if_snd);
667 1.1 nisimura
668 1.1 nisimura if_attach(ifp);
669 1.1 nisimura if_deferred_start_init(ifp, NULL);
670 1.1 nisimura ether_ifattach(ifp, enaddr);
671 1.1 nisimura
672 1.1 nisimura callout_init(&sc->sc_tick_ch, 0);
673 1.1 nisimura callout_setfunc(&sc->sc_tick_ch, phy_tick, sc);
674 1.1 nisimura
675 1.1 nisimura /*
676 1.1 nisimura * Allocate the control data structures, and create and load the
677 1.1 nisimura * DMA map for it.
678 1.1 nisimura */
679 1.14 nisimura error = bus_dmamem_alloc(sc->sc_dmat32,
680 1.1 nisimura sizeof(struct control_data), PAGE_SIZE, 0, &seg, 1, &nseg, 0);
681 1.1 nisimura if (error != 0) {
682 1.1 nisimura aprint_error_dev(sc->sc_dev,
683 1.1 nisimura "unable to allocate control data, error = %d\n", error);
684 1.1 nisimura goto fail_0;
685 1.1 nisimura }
686 1.14 nisimura error = bus_dmamem_map(sc->sc_dmat32, &seg, nseg,
687 1.1 nisimura sizeof(struct control_data), (void **)&sc->sc_control_data,
688 1.1 nisimura BUS_DMA_COHERENT);
689 1.1 nisimura if (error != 0) {
690 1.1 nisimura aprint_error_dev(sc->sc_dev,
691 1.1 nisimura "unable to map control data, error = %d\n", error);
692 1.1 nisimura goto fail_1;
693 1.1 nisimura }
694 1.14 nisimura error = bus_dmamap_create(sc->sc_dmat32,
695 1.1 nisimura sizeof(struct control_data), 1,
696 1.1 nisimura sizeof(struct control_data), 0, 0, &sc->sc_cddmamap);
697 1.1 nisimura if (error != 0) {
698 1.1 nisimura aprint_error_dev(sc->sc_dev,
699 1.1 nisimura "unable to create control data DMA map, "
700 1.1 nisimura "error = %d\n", error);
701 1.1 nisimura goto fail_2;
702 1.1 nisimura }
703 1.14 nisimura error = bus_dmamap_load(sc->sc_dmat32, sc->sc_cddmamap,
704 1.1 nisimura sc->sc_control_data, sizeof(struct control_data), NULL, 0);
705 1.1 nisimura if (error != 0) {
706 1.1 nisimura aprint_error_dev(sc->sc_dev,
707 1.1 nisimura "unable to load control data DMA map, error = %d\n",
708 1.1 nisimura error);
709 1.1 nisimura goto fail_3;
710 1.1 nisimura }
711 1.6 nisimura for (i = 0; i < MD_TXQUEUELEN; i++) {
712 1.14 nisimura if ((error = bus_dmamap_create(sc->sc_dmat32, MCLBYTES,
713 1.6 nisimura MD_NTXSEGS, MCLBYTES, 0, 0,
714 1.1 nisimura &sc->sc_txsoft[i].txs_dmamap)) != 0) {
715 1.1 nisimura aprint_error_dev(sc->sc_dev,
716 1.1 nisimura "unable to create tx DMA map %d, error = %d\n",
717 1.1 nisimura i, error);
718 1.1 nisimura goto fail_4;
719 1.1 nisimura }
720 1.1 nisimura }
721 1.6 nisimura for (i = 0; i < MD_NRXDESC; i++) {
722 1.14 nisimura if ((error = bus_dmamap_create(sc->sc_dmat32, MCLBYTES,
723 1.1 nisimura 1, MCLBYTES, 0, 0, &sc->sc_rxsoft[i].rxs_dmamap)) != 0) {
724 1.1 nisimura aprint_error_dev(sc->sc_dev,
725 1.1 nisimura "unable to create rx DMA map %d, error = %d\n",
726 1.1 nisimura i, error);
727 1.1 nisimura goto fail_5;
728 1.1 nisimura }
729 1.1 nisimura sc->sc_rxsoft[i].rxs_mbuf = NULL;
730 1.1 nisimura }
731 1.1 nisimura sc->sc_seg = seg;
732 1.1 nisimura sc->sc_nseg = nseg;
733 1.14 nisimura aprint_normal_dev(sc->sc_dev, "descriptor ds_addr %lx, ds_len %lx, nseg %d\n", seg.ds_addr, seg.ds_len, nseg);
734 1.1 nisimura
735 1.1 nisimura if (pmf_device_register(sc->sc_dev, NULL, NULL))
736 1.1 nisimura pmf_class_network_register(sc->sc_dev, ifp);
737 1.1 nisimura else
738 1.1 nisimura aprint_error_dev(sc->sc_dev,
739 1.1 nisimura "couldn't establish power handler\n");
740 1.1 nisimura
741 1.1 nisimura rnd_attach_source(&sc->rnd_source, device_xname(sc->sc_dev),
742 1.1 nisimura RND_TYPE_NET, RND_FLAG_DEFAULT);
743 1.1 nisimura
744 1.1 nisimura return;
745 1.1 nisimura
746 1.1 nisimura fail_5:
747 1.6 nisimura for (i = 0; i < MD_NRXDESC; i++) {
748 1.1 nisimura if (sc->sc_rxsoft[i].rxs_dmamap != NULL)
749 1.1 nisimura bus_dmamap_destroy(sc->sc_dmat,
750 1.1 nisimura sc->sc_rxsoft[i].rxs_dmamap);
751 1.1 nisimura }
752 1.1 nisimura fail_4:
753 1.6 nisimura for (i = 0; i < MD_TXQUEUELEN; i++) {
754 1.1 nisimura if (sc->sc_txsoft[i].txs_dmamap != NULL)
755 1.1 nisimura bus_dmamap_destroy(sc->sc_dmat,
756 1.1 nisimura sc->sc_txsoft[i].txs_dmamap);
757 1.1 nisimura }
758 1.1 nisimura bus_dmamap_unload(sc->sc_dmat, sc->sc_cddmamap);
759 1.1 nisimura fail_3:
760 1.1 nisimura bus_dmamap_destroy(sc->sc_dmat, sc->sc_cddmamap);
761 1.1 nisimura fail_2:
762 1.1 nisimura bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_control_data,
763 1.1 nisimura sizeof(struct control_data));
764 1.1 nisimura fail_1:
765 1.1 nisimura bus_dmamem_free(sc->sc_dmat, &seg, nseg);
766 1.1 nisimura fail_0:
767 1.1 nisimura if (sc->sc_phandle)
768 1.1 nisimura fdtbus_intr_disestablish(sc->sc_phandle, sc->sc_ih);
769 1.1 nisimura else
770 1.1 nisimura acpi_intr_disestablish(sc->sc_ih);
771 1.1 nisimura bus_space_unmap(sc->sc_st, sc->sc_sh, sc->sc_sz);
772 1.1 nisimura return;
773 1.1 nisimura }
774 1.1 nisimura
775 1.1 nisimura static void
776 1.1 nisimura scx_reset(struct scx_softc *sc)
777 1.1 nisimura {
778 1.1 nisimura
779 1.1 nisimura mac_write(sc, GMACBMR, BMR_RST); /* may take for a while */
780 1.1 nisimura (void)spin_waitfor(sc, GMACBMR, BMR_RST);
781 1.1 nisimura
782 1.1 nisimura CSR_WRITE(sc, DESCENG_SRST, 1);
783 1.1 nisimura CSR_WRITE(sc, DESCENG_INIT, 1);
784 1.1 nisimura mac_write(sc, GMACBMR, _BMR);
785 1.1 nisimura mac_write(sc, GMACRDLAR, _RDLAR);
786 1.1 nisimura mac_write(sc, GMACTDLAR, _TDLAR);
787 1.1 nisimura mac_write(sc, GMACAFR, _AFR);
788 1.13 nisimura mac_write(sc, GMACEVCTL, 1);
789 1.1 nisimura }
790 1.1 nisimura
791 1.1 nisimura static int
792 1.1 nisimura scx_init(struct ifnet *ifp)
793 1.1 nisimura {
794 1.1 nisimura struct scx_softc *sc = ifp->if_softc;
795 1.1 nisimura const uint8_t *ea = CLLADDR(ifp->if_sadl);
796 1.1 nisimura uint32_t csr;
797 1.1 nisimura int i;
798 1.1 nisimura
799 1.1 nisimura /* Cancel pending I/O. */
800 1.1 nisimura scx_stop(ifp, 0);
801 1.1 nisimura
802 1.1 nisimura /* Reset the chip to a known state. */
803 1.1 nisimura scx_reset(sc);
804 1.1 nisimura
805 1.1 nisimura /* set my address in perfect match slot 0 */
806 1.1 nisimura csr = (ea[3] << 24) | (ea[2] << 16) | (ea[1] << 8) | ea[0];
807 1.13 nisimura mac_write(sc, GMACMAL0, csr);
808 1.1 nisimura csr = (ea[5] << 8) | ea[4];
809 1.13 nisimura mac_write(sc, GMACMAH0, csr | 1U<<31); /* always valid? */
810 1.1 nisimura
811 1.1 nisimura /* accept multicast frame or run promisc mode */
812 1.1 nisimura scx_set_rcvfilt(sc);
813 1.1 nisimura
814 1.1 nisimura (void)scx_ifmedia_upd(ifp);
815 1.1 nisimura
816 1.13 nisimura /* build sane Tx */
817 1.13 nisimura memset(sc->sc_txdescs, 0, sizeof(struct tdes) * MD_NTXDESC);
818 1.13 nisimura sc->sc_txdescs[MD_NTXDESC - 1].t0 |= T0_EOD; /* tie off the ring */
819 1.13 nisimura SCX_CDTXSYNC(sc, 0, MD_NTXDESC,
820 1.13 nisimura BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
821 1.13 nisimura sc->sc_txfree = MD_NTXDESC;
822 1.13 nisimura sc->sc_txnext = 0;
823 1.13 nisimura for (i = 0; i < MD_TXQUEUELEN; i++)
824 1.13 nisimura sc->sc_txsoft[i].txs_mbuf = NULL;
825 1.13 nisimura sc->sc_txsfree = MD_TXQUEUELEN;
826 1.13 nisimura sc->sc_txsnext = 0;
827 1.13 nisimura sc->sc_txsdirty = 0;
828 1.13 nisimura
829 1.13 nisimura /* load Rx descriptors with fresh mbuf */
830 1.13 nisimura for (i = 0; i < MD_NRXDESC; i++)
831 1.13 nisimura (void)add_rxbuf(sc, i);
832 1.13 nisimura sc->sc_rxptr = 0;
833 1.13 nisimura
834 1.13 nisimura /* XXX 32 bit paddr XXX hand Tx/Rx rings to HW XXX */
835 1.13 nisimura mac_write(sc, GMACTDLAR, SCX_CDTXADDR(sc, 0));
836 1.13 nisimura mac_write(sc, GMACRDLAR, SCX_CDRXADDR(sc, 0));
837 1.13 nisimura
838 1.1 nisimura /* kick to start GMAC engine */
839 1.1 nisimura CSR_WRITE(sc, RXINT_CLR, ~0);
840 1.1 nisimura CSR_WRITE(sc, TXINT_CLR, ~0);
841 1.13 nisimura csr = mac_read(sc, GMACOMR);
842 1.1 nisimura mac_write(sc, GMACOMR, csr | OMR_RXE | OMR_TXE);
843 1.1 nisimura
844 1.1 nisimura ifp->if_flags |= IFF_RUNNING;
845 1.1 nisimura ifp->if_flags &= ~IFF_OACTIVE;
846 1.1 nisimura
847 1.1 nisimura /* start one second timer */
848 1.1 nisimura callout_schedule(&sc->sc_tick_ch, hz);
849 1.1 nisimura
850 1.1 nisimura return 0;
851 1.1 nisimura }
852 1.1 nisimura
853 1.1 nisimura static void
854 1.1 nisimura scx_stop(struct ifnet *ifp, int disable)
855 1.1 nisimura {
856 1.1 nisimura struct scx_softc *sc = ifp->if_softc;
857 1.1 nisimura
858 1.1 nisimura /* Stop the one second clock. */
859 1.1 nisimura callout_stop(&sc->sc_tick_ch);
860 1.1 nisimura
861 1.1 nisimura /* Down the MII. */
862 1.1 nisimura mii_down(&sc->sc_mii);
863 1.1 nisimura
864 1.1 nisimura /* Mark the interface down and cancel the watchdog timer. */
865 1.1 nisimura ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
866 1.1 nisimura ifp->if_timer = 0;
867 1.1 nisimura }
868 1.1 nisimura
869 1.1 nisimura static void
870 1.1 nisimura scx_watchdog(struct ifnet *ifp)
871 1.1 nisimura {
872 1.1 nisimura struct scx_softc *sc = ifp->if_softc;
873 1.1 nisimura
874 1.1 nisimura /*
875 1.1 nisimura * Since we're not interrupting every packet, sweep
876 1.1 nisimura * up before we report an error.
877 1.1 nisimura */
878 1.1 nisimura txreap(sc);
879 1.1 nisimura
880 1.6 nisimura if (sc->sc_txfree != MD_NTXDESC) {
881 1.1 nisimura aprint_error_dev(sc->sc_dev,
882 1.1 nisimura "device timeout (txfree %d txsfree %d txnext %d)\n",
883 1.1 nisimura sc->sc_txfree, sc->sc_txsfree, sc->sc_txnext);
884 1.1 nisimura if_statinc(ifp, if_oerrors);
885 1.1 nisimura
886 1.1 nisimura /* Reset the interface. */
887 1.1 nisimura scx_init(ifp);
888 1.1 nisimura }
889 1.1 nisimura
890 1.1 nisimura scx_start(ifp);
891 1.1 nisimura }
892 1.1 nisimura
893 1.1 nisimura static int
894 1.1 nisimura scx_ioctl(struct ifnet *ifp, u_long cmd, void *data)
895 1.1 nisimura {
896 1.1 nisimura struct scx_softc *sc = ifp->if_softc;
897 1.1 nisimura struct ifreq *ifr = (struct ifreq *)data;
898 1.1 nisimura struct ifmedia *ifm;
899 1.1 nisimura int s, error;
900 1.1 nisimura
901 1.1 nisimura s = splnet();
902 1.1 nisimura
903 1.1 nisimura switch (cmd) {
904 1.1 nisimura case SIOCSIFMEDIA:
905 1.1 nisimura /* Flow control requires full-duplex mode. */
906 1.1 nisimura if (IFM_SUBTYPE(ifr->ifr_media) == IFM_AUTO ||
907 1.1 nisimura (ifr->ifr_media & IFM_FDX) == 0)
908 1.1 nisimura ifr->ifr_media &= ~IFM_ETH_FMASK;
909 1.1 nisimura if (IFM_SUBTYPE(ifr->ifr_media) != IFM_AUTO) {
910 1.1 nisimura if ((ifr->ifr_media & IFM_ETH_FMASK) == IFM_FLOW) {
911 1.1 nisimura /* We can do both TXPAUSE and RXPAUSE. */
912 1.1 nisimura ifr->ifr_media |=
913 1.1 nisimura IFM_ETH_TXPAUSE | IFM_ETH_RXPAUSE;
914 1.1 nisimura }
915 1.1 nisimura sc->sc_flowflags = ifr->ifr_media & IFM_ETH_FMASK;
916 1.1 nisimura }
917 1.1 nisimura ifm = &sc->sc_mii.mii_media;
918 1.1 nisimura error = ifmedia_ioctl(ifp, ifr, ifm, cmd);
919 1.1 nisimura break;
920 1.1 nisimura default:
921 1.1 nisimura if ((error = ether_ioctl(ifp, cmd, data)) != ENETRESET)
922 1.1 nisimura break;
923 1.1 nisimura
924 1.1 nisimura error = 0;
925 1.1 nisimura
926 1.1 nisimura if (cmd == SIOCSIFCAP)
927 1.1 nisimura error = (*ifp->if_init)(ifp);
928 1.1 nisimura if (cmd != SIOCADDMULTI && cmd != SIOCDELMULTI)
929 1.1 nisimura ;
930 1.1 nisimura else if (ifp->if_flags & IFF_RUNNING) {
931 1.1 nisimura /*
932 1.1 nisimura * Multicast list has changed; set the hardware filter
933 1.1 nisimura * accordingly.
934 1.1 nisimura */
935 1.1 nisimura scx_set_rcvfilt(sc);
936 1.1 nisimura }
937 1.1 nisimura break;
938 1.1 nisimura }
939 1.1 nisimura
940 1.1 nisimura splx(s);
941 1.1 nisimura return error;
942 1.1 nisimura }
943 1.1 nisimura
944 1.1 nisimura static void
945 1.1 nisimura scx_set_rcvfilt(struct scx_softc *sc)
946 1.1 nisimura {
947 1.1 nisimura struct ethercom * const ec = &sc->sc_ethercom;
948 1.1 nisimura struct ifnet * const ifp = &ec->ec_if;
949 1.1 nisimura struct ether_multistep step;
950 1.1 nisimura struct ether_multi *enm;
951 1.1 nisimura uint32_t mchash[8]; /* 8x 32 = 256 bit */
952 1.1 nisimura uint32_t csr, crc;
953 1.1 nisimura int i;
954 1.1 nisimura
955 1.13 nisimura csr = mac_read(sc, GMACAFR);
956 1.1 nisimura csr &= ~(AFR_PM | AFR_AM | AFR_MHTE);
957 1.13 nisimura mac_write(sc, GMACAFR, csr);
958 1.1 nisimura
959 1.1 nisimura ETHER_LOCK(ec);
960 1.1 nisimura if (ifp->if_flags & IFF_PROMISC) {
961 1.1 nisimura ec->ec_flags |= ETHER_F_ALLMULTI;
962 1.1 nisimura ETHER_UNLOCK(ec);
963 1.1 nisimura goto update;
964 1.1 nisimura }
965 1.1 nisimura ec->ec_flags &= ~ETHER_F_ALLMULTI;
966 1.1 nisimura
967 1.1 nisimura /* clear 15 entry supplimental perfect match filter */
968 1.1 nisimura for (i = 1; i < 16; i++)
969 1.13 nisimura mac_write(sc, GMACMAH(i), 0);
970 1.1 nisimura /* build 256 bit multicast hash filter */
971 1.1 nisimura memset(mchash, 0, sizeof(mchash));
972 1.1 nisimura crc = 0;
973 1.1 nisimura
974 1.1 nisimura ETHER_FIRST_MULTI(step, ec, enm);
975 1.1 nisimura i = 1; /* slot 0 is occupied */
976 1.1 nisimura while (enm != NULL) {
977 1.1 nisimura if (memcmp(enm->enm_addrlo, enm->enm_addrhi, ETHER_ADDR_LEN)) {
978 1.1 nisimura /*
979 1.1 nisimura * We must listen to a range of multicast addresses.
980 1.1 nisimura * For now, just accept all multicasts, rather than
981 1.1 nisimura * trying to set only those filter bits needed to match
982 1.1 nisimura * the range. (At this time, the only use of address
983 1.1 nisimura * ranges is for IP multicast routing, for which the
984 1.1 nisimura * range is big enough to require all bits set.)
985 1.1 nisimura */
986 1.1 nisimura ec->ec_flags |= ETHER_F_ALLMULTI;
987 1.1 nisimura ETHER_UNLOCK(ec);
988 1.1 nisimura goto update;
989 1.1 nisimura }
990 1.1 nisimura printf("[%d] %s\n", i, ether_sprintf(enm->enm_addrlo));
991 1.1 nisimura if (i < 16) {
992 1.9 nisimura /* use 15 entry perfect match filter */
993 1.1 nisimura uint32_t addr;
994 1.1 nisimura uint8_t *ep = enm->enm_addrlo;
995 1.1 nisimura addr = (ep[3] << 24) | (ep[2] << 16)
996 1.1 nisimura | (ep[1] << 8) | ep[0];
997 1.13 nisimura mac_write(sc, GMACMAL(i), addr);
998 1.1 nisimura addr = (ep[5] << 8) | ep[4];
999 1.13 nisimura mac_write(sc, GMACMAH(i), addr | 1U<<31);
1000 1.1 nisimura } else {
1001 1.1 nisimura /* use hash table when too many */
1002 1.1 nisimura /* bit_reserve_32(~crc) !? */
1003 1.1 nisimura crc = ether_crc32_le(enm->enm_addrlo, ETHER_ADDR_LEN);
1004 1.1 nisimura /* 3(31:29) 5(28:24) bit sampling */
1005 1.1 nisimura mchash[crc >> 29] |= 1 << ((crc >> 24) & 0x1f);
1006 1.1 nisimura }
1007 1.1 nisimura ETHER_NEXT_MULTI(step, enm);
1008 1.1 nisimura i++;
1009 1.1 nisimura }
1010 1.1 nisimura ETHER_UNLOCK(ec);
1011 1.1 nisimura
1012 1.1 nisimura if (crc)
1013 1.1 nisimura csr |= AFR_MHTE;
1014 1.8 nisimura for (i = 0; i < __arraycount(mchash); i++)
1015 1.13 nisimura mac_write(sc, GMACMHT(i), mchash[i]);
1016 1.13 nisimura mac_write(sc, GMACAFR, csr);
1017 1.1 nisimura return;
1018 1.1 nisimura
1019 1.1 nisimura update:
1020 1.8 nisimura /* With PM or AM, MHTE/MHT0-7 are never consulted. really? */
1021 1.1 nisimura if (ifp->if_flags & IFF_PROMISC)
1022 1.1 nisimura csr |= AFR_PM; /* run promisc. mode */
1023 1.1 nisimura else
1024 1.1 nisimura csr |= AFR_AM; /* accept all multicast */
1025 1.13 nisimura mac_write(sc, GMACAFR, csr);
1026 1.1 nisimura return;
1027 1.1 nisimura }
1028 1.1 nisimura
1029 1.1 nisimura static int
1030 1.1 nisimura scx_ifmedia_upd(struct ifnet *ifp)
1031 1.1 nisimura {
1032 1.1 nisimura struct scx_softc *sc = ifp->if_softc;
1033 1.1 nisimura struct ifmedia *ifm = &sc->sc_mii.mii_media;
1034 1.1 nisimura
1035 1.1 nisimura if (IFM_SUBTYPE(ifm->ifm_cur->ifm_media) == IFM_AUTO) {
1036 1.1 nisimura ; /* restart AN */
1037 1.1 nisimura ; /* enable AN */
1038 1.1 nisimura ; /* advertise flow control pause */
1039 1.1 nisimura ; /* adv. 100FDX,100HDX,10FDX,10HDX */
1040 1.1 nisimura } else {
1041 1.5 nisimura #if 1 /* XXX not sure to belong here XXX */
1042 1.1 nisimura uint32_t mcr = mac_read(sc, GMACMCR);
1043 1.1 nisimura if (IFM_SUBTYPE(ifm->ifm_cur->ifm_media) == IFM_1000_T)
1044 1.1 nisimura mcr &= ~MCR_USEMII; /* RGMII+SPD1000 */
1045 1.1 nisimura else {
1046 1.5 nisimura if (IFM_SUBTYPE(ifm->ifm_cur->ifm_media) == IFM_100_TX
1047 1.5 nisimura && sc->sc_100mii)
1048 1.1 nisimura mcr |= MCR_SPD100;
1049 1.5 nisimura mcr |= MCR_USEMII;
1050 1.1 nisimura }
1051 1.1 nisimura if (ifm->ifm_cur->ifm_media & IFM_FDX)
1052 1.1 nisimura mcr |= MCR_USEFDX;
1053 1.1 nisimura mcr |= MCR_CST | MCR_JE;
1054 1.5 nisimura if (sc->sc_100mii == 0)
1055 1.5 nisimura mcr |= MCR_IBN;
1056 1.1 nisimura mac_write(sc, GMACMCR, mcr);
1057 1.1 nisimura #endif
1058 1.1 nisimura }
1059 1.1 nisimura return 0;
1060 1.1 nisimura }
1061 1.1 nisimura
1062 1.1 nisimura static void
1063 1.1 nisimura scx_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
1064 1.1 nisimura {
1065 1.1 nisimura struct scx_softc *sc = ifp->if_softc;
1066 1.1 nisimura struct mii_data *mii = &sc->sc_mii;
1067 1.1 nisimura
1068 1.1 nisimura mii_pollstat(mii);
1069 1.1 nisimura ifmr->ifm_status = mii->mii_media_status;
1070 1.1 nisimura ifmr->ifm_active = sc->sc_flowflags |
1071 1.1 nisimura (mii->mii_media_active & ~IFM_ETH_FMASK);
1072 1.1 nisimura }
1073 1.1 nisimura
1074 1.1 nisimura void
1075 1.1 nisimura mii_statchg(struct ifnet *ifp)
1076 1.1 nisimura {
1077 1.1 nisimura struct scx_softc *sc = ifp->if_softc;
1078 1.1 nisimura struct mii_data *mii = &sc->sc_mii;
1079 1.1 nisimura uint32_t fcr;
1080 1.13 nisimura #if 1
1081 1.13 nisimura /* decode MIISR register value */
1082 1.13 nisimura uint32_t miisr = mac_read(sc, GMACMIISR);
1083 1.13 nisimura int spd = (miisr >> 1) & 03;
1084 1.14 nisimura printf("MII link status (0x%x) %s",
1085 1.14 nisimura miisr, (miisr & 8) ? "up" : "down");
1086 1.14 nisimura if (miisr & 8) {
1087 1.14 nisimura printf(" spd%d", (spd == 2) ? 1000 : (spd == 1) ? 100 : 10);
1088 1.14 nisimura if (miisr & 1)
1089 1.14 nisimura printf(",full-duplex");
1090 1.14 nisimura }
1091 1.13 nisimura printf("\n");
1092 1.13 nisimura #endif
1093 1.1 nisimura /* Get flow control negotiation result. */
1094 1.1 nisimura if (IFM_SUBTYPE(mii->mii_media.ifm_cur->ifm_media) == IFM_AUTO &&
1095 1.1 nisimura (mii->mii_media_active & IFM_ETH_FMASK) != sc->sc_flowflags)
1096 1.1 nisimura sc->sc_flowflags = mii->mii_media_active & IFM_ETH_FMASK;
1097 1.1 nisimura
1098 1.1 nisimura /* Adjust PAUSE flow control. */
1099 1.1 nisimura fcr = mac_read(sc, GMACFCR) & ~(FCR_TFE | FCR_RFE);
1100 1.1 nisimura if (mii->mii_media_active & IFM_FDX) {
1101 1.1 nisimura if (sc->sc_flowflags & IFM_ETH_TXPAUSE)
1102 1.1 nisimura fcr |= FCR_TFE;
1103 1.1 nisimura if (sc->sc_flowflags & IFM_ETH_RXPAUSE)
1104 1.1 nisimura fcr |= FCR_RFE;
1105 1.1 nisimura }
1106 1.1 nisimura mac_write(sc, GMACFCR, fcr);
1107 1.1 nisimura
1108 1.1 nisimura printf("%ctxfe, %crxfe\n",
1109 1.1 nisimura (fcr & FCR_TFE) ? '+' : '-', (fcr & FCR_RFE) ? '+' : '-');
1110 1.1 nisimura }
1111 1.1 nisimura
1112 1.1 nisimura static void
1113 1.1 nisimura phy_tick(void *arg)
1114 1.1 nisimura {
1115 1.1 nisimura struct scx_softc *sc = arg;
1116 1.1 nisimura struct mii_data *mii = &sc->sc_mii;
1117 1.1 nisimura int s;
1118 1.1 nisimura
1119 1.1 nisimura s = splnet();
1120 1.1 nisimura mii_tick(mii);
1121 1.1 nisimura splx(s);
1122 1.1 nisimura
1123 1.1 nisimura callout_schedule(&sc->sc_tick_ch, hz);
1124 1.1 nisimura }
1125 1.1 nisimura
1126 1.1 nisimura static int
1127 1.1 nisimura mii_readreg(device_t self, int phy, int reg, uint16_t *val)
1128 1.1 nisimura {
1129 1.1 nisimura struct scx_softc *sc = device_private(self);
1130 1.7 nisimura uint32_t miia;
1131 1.1 nisimura int error;
1132 1.1 nisimura
1133 1.7 nisimura miia = (phy << GAR_PHY) | (reg << GAR_REG) | sc->sc_mdclk;
1134 1.7 nisimura mac_write(sc, GMACGAR, miia | GAR_BUSY);
1135 1.1 nisimura error = spin_waitfor(sc, GMACGAR, GAR_BUSY);
1136 1.1 nisimura if (error)
1137 1.1 nisimura return error;
1138 1.1 nisimura *val = mac_read(sc, GMACGDR);
1139 1.1 nisimura return 0;
1140 1.1 nisimura }
1141 1.1 nisimura
1142 1.1 nisimura static int
1143 1.1 nisimura mii_writereg(device_t self, int phy, int reg, uint16_t val)
1144 1.1 nisimura {
1145 1.1 nisimura struct scx_softc *sc = device_private(self);
1146 1.7 nisimura uint32_t miia;
1147 1.1 nisimura uint16_t dummy;
1148 1.1 nisimura int error;
1149 1.1 nisimura
1150 1.7 nisimura miia = (phy << GAR_PHY) | (reg << GAR_REG) | sc->sc_mdclk;
1151 1.1 nisimura mac_write(sc, GMACGDR, val);
1152 1.7 nisimura mac_write(sc, GMACGAR, miia | GAR_IOWR | GAR_BUSY);
1153 1.1 nisimura error = spin_waitfor(sc, GMACGAR, GAR_BUSY);
1154 1.1 nisimura if (error)
1155 1.1 nisimura return error;
1156 1.1 nisimura mii_readreg(self, phy, MII_PHYIDR1, &dummy); /* dummy read cycle */
1157 1.1 nisimura return 0;
1158 1.1 nisimura }
1159 1.1 nisimura
1160 1.1 nisimura static void
1161 1.1 nisimura scx_start(struct ifnet *ifp)
1162 1.1 nisimura {
1163 1.1 nisimura struct scx_softc *sc = ifp->if_softc;
1164 1.1 nisimura struct mbuf *m0, *m;
1165 1.1 nisimura struct scx_txsoft *txs;
1166 1.1 nisimura bus_dmamap_t dmamap;
1167 1.1 nisimura int error, nexttx, lasttx, ofree, seg;
1168 1.1 nisimura uint32_t tdes0;
1169 1.1 nisimura
1170 1.1 nisimura if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)
1171 1.1 nisimura return;
1172 1.1 nisimura
1173 1.1 nisimura /* Remember the previous number of free descriptors. */
1174 1.1 nisimura ofree = sc->sc_txfree;
1175 1.1 nisimura
1176 1.1 nisimura /*
1177 1.1 nisimura * Loop through the send queue, setting up transmit descriptors
1178 1.1 nisimura * until we drain the queue, or use up all available transmit
1179 1.1 nisimura * descriptors.
1180 1.1 nisimura */
1181 1.1 nisimura for (;;) {
1182 1.1 nisimura IFQ_POLL(&ifp->if_snd, m0);
1183 1.1 nisimura if (m0 == NULL)
1184 1.1 nisimura break;
1185 1.1 nisimura
1186 1.6 nisimura if (sc->sc_txsfree < MD_TXQUEUE_GC) {
1187 1.1 nisimura txreap(sc);
1188 1.1 nisimura if (sc->sc_txsfree == 0)
1189 1.1 nisimura break;
1190 1.1 nisimura }
1191 1.1 nisimura txs = &sc->sc_txsoft[sc->sc_txsnext];
1192 1.1 nisimura dmamap = txs->txs_dmamap;
1193 1.1 nisimura
1194 1.1 nisimura error = bus_dmamap_load_mbuf(sc->sc_dmat, dmamap, m0,
1195 1.1 nisimura BUS_DMA_WRITE | BUS_DMA_NOWAIT);
1196 1.1 nisimura if (error) {
1197 1.1 nisimura if (error == EFBIG) {
1198 1.1 nisimura aprint_error_dev(sc->sc_dev,
1199 1.1 nisimura "Tx packet consumes too many "
1200 1.1 nisimura "DMA segments, dropping...\n");
1201 1.1 nisimura IFQ_DEQUEUE(&ifp->if_snd, m0);
1202 1.1 nisimura m_freem(m0);
1203 1.1 nisimura continue;
1204 1.1 nisimura }
1205 1.1 nisimura /* Short on resources, just stop for now. */
1206 1.1 nisimura break;
1207 1.1 nisimura }
1208 1.1 nisimura
1209 1.1 nisimura if (dmamap->dm_nsegs > sc->sc_txfree) {
1210 1.1 nisimura /*
1211 1.1 nisimura * Not enough free descriptors to transmit this
1212 1.1 nisimura * packet. We haven't committed anything yet,
1213 1.1 nisimura * so just unload the DMA map, put the packet
1214 1.1 nisimura * back on the queue, and punt. Notify the upper
1215 1.1 nisimura * layer that there are not more slots left.
1216 1.1 nisimura */
1217 1.1 nisimura ifp->if_flags |= IFF_OACTIVE;
1218 1.1 nisimura bus_dmamap_unload(sc->sc_dmat, dmamap);
1219 1.1 nisimura break;
1220 1.1 nisimura }
1221 1.1 nisimura
1222 1.1 nisimura IFQ_DEQUEUE(&ifp->if_snd, m0);
1223 1.1 nisimura
1224 1.1 nisimura /*
1225 1.1 nisimura * WE ARE NOW COMMITTED TO TRANSMITTING THE PACKET.
1226 1.1 nisimura */
1227 1.1 nisimura
1228 1.1 nisimura bus_dmamap_sync(sc->sc_dmat, dmamap, 0, dmamap->dm_mapsize,
1229 1.1 nisimura BUS_DMASYNC_PREWRITE);
1230 1.1 nisimura
1231 1.1 nisimura tdes0 = 0; /* to postpone 1st segment T0_OWN write */
1232 1.1 nisimura lasttx = -1;
1233 1.1 nisimura for (nexttx = sc->sc_txnext, seg = 0;
1234 1.1 nisimura seg < dmamap->dm_nsegs;
1235 1.6 nisimura seg++, nexttx = MD_NEXTTX(nexttx)) {
1236 1.1 nisimura struct tdes *tdes = &sc->sc_txdescs[nexttx];
1237 1.1 nisimura bus_addr_t paddr = dmamap->dm_segs[seg].ds_addr;
1238 1.1 nisimura /*
1239 1.1 nisimura * If this is the first descriptor we're
1240 1.1 nisimura * enqueueing, don't set the OWN bit just
1241 1.1 nisimura * yet. That could cause a race condition.
1242 1.1 nisimura * We'll do it below.
1243 1.1 nisimura */
1244 1.1 nisimura tdes->t3 = dmamap->dm_segs[seg].ds_len;
1245 1.1 nisimura tdes->t2 = htole32(BUS_ADDR_LO32(paddr));
1246 1.1 nisimura tdes->t1 = htole32(BUS_ADDR_HI32(paddr));
1247 1.1 nisimura tdes->t0 = tdes0 | (tdes->t0 & T0_EOD) |
1248 1.1 nisimura (15 << T0_TRID) | T0_PT |
1249 1.1 nisimura sc->sc_t0coso | T0_TRS;
1250 1.1 nisimura tdes0 = T0_OWN; /* 2nd and other segments */
1251 1.1 nisimura lasttx = nexttx;
1252 1.1 nisimura }
1253 1.1 nisimura /*
1254 1.1 nisimura * Outgoing NFS mbuf must be unloaded when Tx completed.
1255 1.1 nisimura * Without T1_IC NFS mbuf is left unack'ed for excessive
1256 1.1 nisimura * time and NFS stops to proceed until scx_watchdog()
1257 1.1 nisimura * calls txreap() to reclaim the unack'ed mbuf.
1258 1.1 nisimura * It's painful to traverse every mbuf chain to determine
1259 1.1 nisimura * whether someone is waiting for Tx completion.
1260 1.1 nisimura */
1261 1.1 nisimura m = m0;
1262 1.1 nisimura do {
1263 1.1 nisimura if ((m->m_flags & M_EXT) && m->m_ext.ext_free) {
1264 1.1 nisimura sc->sc_txdescs[lasttx].t0 |= T0_IOC; /* !!! */
1265 1.1 nisimura break;
1266 1.1 nisimura }
1267 1.1 nisimura } while ((m = m->m_next) != NULL);
1268 1.1 nisimura
1269 1.1 nisimura /* Write deferred 1st segment T0_OWN at the final stage */
1270 1.1 nisimura sc->sc_txdescs[lasttx].t0 |= T0_LS;
1271 1.1 nisimura sc->sc_txdescs[sc->sc_txnext].t0 |= (T0_FS | T0_OWN);
1272 1.1 nisimura SCX_CDTXSYNC(sc, sc->sc_txnext, dmamap->dm_nsegs,
1273 1.1 nisimura BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1274 1.1 nisimura
1275 1.1 nisimura /* Tell DMA start transmit */
1276 1.13 nisimura mac_write(sc, GMACTDS, 1);
1277 1.1 nisimura
1278 1.1 nisimura txs->txs_mbuf = m0;
1279 1.1 nisimura txs->txs_firstdesc = sc->sc_txnext;
1280 1.1 nisimura txs->txs_lastdesc = lasttx;
1281 1.1 nisimura txs->txs_ndesc = dmamap->dm_nsegs;
1282 1.1 nisimura
1283 1.1 nisimura sc->sc_txfree -= txs->txs_ndesc;
1284 1.1 nisimura sc->sc_txnext = nexttx;
1285 1.1 nisimura sc->sc_txsfree--;
1286 1.6 nisimura sc->sc_txsnext = MD_NEXTTXS(sc->sc_txsnext);
1287 1.1 nisimura /*
1288 1.1 nisimura * Pass the packet to any BPF listeners.
1289 1.1 nisimura */
1290 1.1 nisimura bpf_mtap(ifp, m0, BPF_D_OUT);
1291 1.1 nisimura }
1292 1.1 nisimura
1293 1.1 nisimura if (sc->sc_txsfree == 0 || sc->sc_txfree == 0) {
1294 1.1 nisimura /* No more slots left; notify upper layer. */
1295 1.1 nisimura ifp->if_flags |= IFF_OACTIVE;
1296 1.1 nisimura }
1297 1.1 nisimura if (sc->sc_txfree != ofree) {
1298 1.1 nisimura /* Set a watchdog timer in case the chip flakes out. */
1299 1.1 nisimura ifp->if_timer = 5;
1300 1.1 nisimura }
1301 1.1 nisimura }
1302 1.1 nisimura
1303 1.1 nisimura static int
1304 1.1 nisimura scx_intr(void *arg)
1305 1.1 nisimura {
1306 1.1 nisimura struct scx_softc *sc = arg;
1307 1.1 nisimura struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1308 1.3 nisimura
1309 1.1 nisimura (void)ifp;
1310 1.13 nisimura /* XXX decode interrupt cause to pick isr() XXX */
1311 1.1 nisimura rxintr(sc);
1312 1.1 nisimura txreap(sc);
1313 1.1 nisimura return 1;
1314 1.1 nisimura }
1315 1.1 nisimura
1316 1.1 nisimura static void
1317 1.1 nisimura txreap(struct scx_softc *sc)
1318 1.1 nisimura {
1319 1.1 nisimura struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1320 1.1 nisimura struct scx_txsoft *txs;
1321 1.1 nisimura uint32_t txstat;
1322 1.1 nisimura int i;
1323 1.1 nisimura
1324 1.1 nisimura ifp->if_flags &= ~IFF_OACTIVE;
1325 1.1 nisimura
1326 1.6 nisimura for (i = sc->sc_txsdirty; sc->sc_txsfree != MD_TXQUEUELEN;
1327 1.6 nisimura i = MD_NEXTTXS(i), sc->sc_txsfree++) {
1328 1.1 nisimura txs = &sc->sc_txsoft[i];
1329 1.1 nisimura
1330 1.1 nisimura SCX_CDTXSYNC(sc, txs->txs_firstdesc, txs->txs_ndesc,
1331 1.1 nisimura BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1332 1.1 nisimura
1333 1.1 nisimura txstat = sc->sc_txdescs[txs->txs_lastdesc].t0;
1334 1.1 nisimura if (txstat & T0_OWN) /* desc is still in use */
1335 1.1 nisimura break;
1336 1.1 nisimura
1337 1.1 nisimura /* There is no way to tell transmission status per frame */
1338 1.1 nisimura
1339 1.1 nisimura if_statinc(ifp, if_opackets);
1340 1.1 nisimura
1341 1.1 nisimura sc->sc_txfree += txs->txs_ndesc;
1342 1.1 nisimura bus_dmamap_sync(sc->sc_dmat, txs->txs_dmamap,
1343 1.1 nisimura 0, txs->txs_dmamap->dm_mapsize, BUS_DMASYNC_POSTWRITE);
1344 1.1 nisimura bus_dmamap_unload(sc->sc_dmat, txs->txs_dmamap);
1345 1.1 nisimura m_freem(txs->txs_mbuf);
1346 1.1 nisimura txs->txs_mbuf = NULL;
1347 1.1 nisimura }
1348 1.1 nisimura sc->sc_txsdirty = i;
1349 1.6 nisimura if (sc->sc_txsfree == MD_TXQUEUELEN)
1350 1.1 nisimura ifp->if_timer = 0;
1351 1.1 nisimura }
1352 1.1 nisimura
1353 1.1 nisimura static void
1354 1.1 nisimura rxintr(struct scx_softc *sc)
1355 1.1 nisimura {
1356 1.1 nisimura struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1357 1.1 nisimura struct scx_rxsoft *rxs;
1358 1.1 nisimura struct mbuf *m;
1359 1.1 nisimura uint32_t rxstat;
1360 1.1 nisimura int i, len;
1361 1.1 nisimura
1362 1.6 nisimura for (i = sc->sc_rxptr; /*CONSTCOND*/ 1; i = MD_NEXTRX(i)) {
1363 1.1 nisimura rxs = &sc->sc_rxsoft[i];
1364 1.1 nisimura
1365 1.1 nisimura SCX_CDRXSYNC(sc, i,
1366 1.1 nisimura BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1367 1.1 nisimura
1368 1.1 nisimura rxstat = sc->sc_rxdescs[i].r0;
1369 1.1 nisimura if (rxstat & R0_OWN) /* desc is left empty */
1370 1.1 nisimura break;
1371 1.1 nisimura
1372 1.1 nisimura /* R0_FS | R0_LS must have been marked for this desc */
1373 1.1 nisimura
1374 1.1 nisimura bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
1375 1.1 nisimura rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_POSTREAD);
1376 1.1 nisimura
1377 1.1 nisimura len = sc->sc_rxdescs[i].r3 >> 16; /* 31:16 received */
1378 1.1 nisimura len -= ETHER_CRC_LEN; /* Trim CRC off */
1379 1.1 nisimura m = rxs->rxs_mbuf;
1380 1.1 nisimura
1381 1.1 nisimura if (add_rxbuf(sc, i) != 0) {
1382 1.1 nisimura if_statinc(ifp, if_ierrors);
1383 1.1 nisimura SCX_INIT_RXDESC(sc, i);
1384 1.1 nisimura bus_dmamap_sync(sc->sc_dmat,
1385 1.1 nisimura rxs->rxs_dmamap, 0,
1386 1.1 nisimura rxs->rxs_dmamap->dm_mapsize,
1387 1.1 nisimura BUS_DMASYNC_PREREAD);
1388 1.1 nisimura continue;
1389 1.1 nisimura }
1390 1.1 nisimura
1391 1.1 nisimura m_set_rcvif(m, ifp);
1392 1.1 nisimura m->m_pkthdr.len = m->m_len = len;
1393 1.1 nisimura
1394 1.1 nisimura if (rxstat & R0_CSUM) {
1395 1.1 nisimura uint32_t csum = M_CSUM_IPv4;
1396 1.1 nisimura if (rxstat & R0_CERR)
1397 1.1 nisimura csum |= M_CSUM_IPv4_BAD;
1398 1.1 nisimura m->m_pkthdr.csum_flags |= csum;
1399 1.1 nisimura }
1400 1.1 nisimura if_percpuq_enqueue(ifp->if_percpuq, m);
1401 1.1 nisimura }
1402 1.1 nisimura sc->sc_rxptr = i;
1403 1.1 nisimura }
1404 1.1 nisimura
1405 1.1 nisimura static int
1406 1.1 nisimura add_rxbuf(struct scx_softc *sc, int i)
1407 1.1 nisimura {
1408 1.1 nisimura struct scx_rxsoft *rxs = &sc->sc_rxsoft[i];
1409 1.1 nisimura struct mbuf *m;
1410 1.1 nisimura int error;
1411 1.1 nisimura
1412 1.1 nisimura MGETHDR(m, M_DONTWAIT, MT_DATA);
1413 1.1 nisimura if (m == NULL)
1414 1.1 nisimura return ENOBUFS;
1415 1.1 nisimura
1416 1.1 nisimura MCLGET(m, M_DONTWAIT);
1417 1.1 nisimura if ((m->m_flags & M_EXT) == 0) {
1418 1.1 nisimura m_freem(m);
1419 1.1 nisimura return ENOBUFS;
1420 1.1 nisimura }
1421 1.1 nisimura
1422 1.1 nisimura if (rxs->rxs_mbuf != NULL)
1423 1.1 nisimura bus_dmamap_unload(sc->sc_dmat, rxs->rxs_dmamap);
1424 1.1 nisimura
1425 1.1 nisimura rxs->rxs_mbuf = m;
1426 1.1 nisimura
1427 1.1 nisimura error = bus_dmamap_load(sc->sc_dmat, rxs->rxs_dmamap,
1428 1.1 nisimura m->m_ext.ext_buf, m->m_ext.ext_size, NULL, BUS_DMA_NOWAIT);
1429 1.1 nisimura if (error) {
1430 1.1 nisimura aprint_error_dev(sc->sc_dev,
1431 1.1 nisimura "can't load rx DMA map %d, error = %d\n", i, error);
1432 1.1 nisimura panic("add_rxbuf");
1433 1.1 nisimura }
1434 1.1 nisimura
1435 1.1 nisimura bus_dmamap_sync(sc->sc_dmat, rxs->rxs_dmamap, 0,
1436 1.1 nisimura rxs->rxs_dmamap->dm_mapsize, BUS_DMASYNC_PREREAD);
1437 1.1 nisimura SCX_INIT_RXDESC(sc, i);
1438 1.1 nisimura
1439 1.1 nisimura return 0;
1440 1.1 nisimura }
1441 1.1 nisimura
1442 1.1 nisimura static int
1443 1.1 nisimura spin_waitfor(struct scx_softc *sc, int reg, int exist)
1444 1.1 nisimura {
1445 1.1 nisimura int val, loop;
1446 1.1 nisimura
1447 1.1 nisimura val = CSR_READ(sc, reg);
1448 1.1 nisimura if ((val & exist) == 0)
1449 1.1 nisimura return 0;
1450 1.1 nisimura loop = 3000;
1451 1.1 nisimura do {
1452 1.1 nisimura DELAY(10);
1453 1.1 nisimura val = CSR_READ(sc, reg);
1454 1.5 nisimura } while (--loop > 0 && (val & exist));
1455 1.1 nisimura return (loop > 0) ? 0 : ETIMEDOUT;
1456 1.1 nisimura }
1457 1.1 nisimura
1458 1.13 nisimura /* GMAC register needs to use indirect rd/wr via memory mapped registers. */
1459 1.13 nisimura
1460 1.1 nisimura static int
1461 1.1 nisimura mac_read(struct scx_softc *sc, int reg)
1462 1.1 nisimura {
1463 1.1 nisimura
1464 1.1 nisimura CSR_WRITE(sc, MACCMD, reg);
1465 1.1 nisimura (void)spin_waitfor(sc, MACCMD, CMD_BUSY);
1466 1.1 nisimura return CSR_READ(sc, MACDATA);
1467 1.1 nisimura }
1468 1.1 nisimura
1469 1.1 nisimura static void
1470 1.1 nisimura mac_write(struct scx_softc *sc, int reg, int val)
1471 1.1 nisimura {
1472 1.1 nisimura
1473 1.1 nisimura CSR_WRITE(sc, MACDATA, val);
1474 1.1 nisimura CSR_WRITE(sc, MACCMD, reg | CMD_IOWR);
1475 1.1 nisimura (void)spin_waitfor(sc, MACCMD, CMD_BUSY);
1476 1.1 nisimura }
1477 1.1 nisimura
1478 1.13 nisimura /*
1479 1.13 nisimura * 3 independent uengines exist * to process host2media, media2host and
1480 1.13 nisimura * packet data flows.
1481 1.13 nisimura */
1482 1.1 nisimura static void
1483 1.1 nisimura loaducode(struct scx_softc *sc)
1484 1.1 nisimura {
1485 1.1 nisimura uint32_t up, lo, sz;
1486 1.1 nisimura uint64_t addr;
1487 1.1 nisimura
1488 1.3 nisimura sc->sc_ucodeloaded = 1;
1489 1.3 nisimura
1490 1.1 nisimura up = EE_READ(sc, 0x08); /* H->M ucode addr high */
1491 1.1 nisimura lo = EE_READ(sc, 0x0c); /* H->M ucode addr low */
1492 1.1 nisimura sz = EE_READ(sc, 0x10); /* H->M ucode size */
1493 1.2 nisimura sz *= 4;
1494 1.1 nisimura addr = ((uint64_t)up << 32) | lo;
1495 1.14 nisimura aprint_normal_dev(sc->sc_dev, "0x%x H2M ucode %u\n", lo, sz);
1496 1.3 nisimura injectucode(sc, H2MENG, (bus_addr_t)addr, (bus_size_t)sz);
1497 1.1 nisimura
1498 1.1 nisimura up = EE_READ(sc, 0x14); /* M->H ucode addr high */
1499 1.1 nisimura lo = EE_READ(sc, 0x18); /* M->H ucode addr low */
1500 1.1 nisimura sz = EE_READ(sc, 0x1c); /* M->H ucode size */
1501 1.2 nisimura sz *= 4;
1502 1.1 nisimura addr = ((uint64_t)up << 32) | lo;
1503 1.3 nisimura injectucode(sc, M2HENG, (bus_addr_t)addr, (bus_size_t)sz);
1504 1.14 nisimura aprint_normal_dev(sc->sc_dev, "0x%x M2H ucode %u\n", lo, sz);
1505 1.1 nisimura
1506 1.1 nisimura lo = EE_READ(sc, 0x20); /* PKT ucode addr */
1507 1.1 nisimura sz = EE_READ(sc, 0x24); /* PKT ucode size */
1508 1.2 nisimura sz *= 4;
1509 1.3 nisimura injectucode(sc, PKTENG, (bus_addr_t)lo, (bus_size_t)sz);
1510 1.14 nisimura aprint_normal_dev(sc->sc_dev, "0x%x PKT ucode %u\n", lo, sz);
1511 1.1 nisimura }
1512 1.1 nisimura
1513 1.1 nisimura static void
1514 1.2 nisimura injectucode(struct scx_softc *sc, int port,
1515 1.2 nisimura bus_addr_t addr, bus_size_t size)
1516 1.1 nisimura {
1517 1.2 nisimura bus_space_handle_t bsh;
1518 1.2 nisimura bus_size_t off;
1519 1.1 nisimura uint32_t ucode;
1520 1.1 nisimura
1521 1.14 nisimura if (bus_space_map(sc->sc_st, addr, size, 0, &bsh) != 0) {
1522 1.3 nisimura aprint_error_dev(sc->sc_dev,
1523 1.3 nisimura "eeprom map failure for ucode port 0x%x\n", port);
1524 1.2 nisimura return;
1525 1.2 nisimura }
1526 1.5 nisimura for (off = 0; off < size; off += 4) {
1527 1.2 nisimura ucode = bus_space_read_4(sc->sc_st, bsh, off);
1528 1.1 nisimura CSR_WRITE(sc, port, ucode);
1529 1.1 nisimura }
1530 1.2 nisimura bus_space_unmap(sc->sc_st, bsh, size);
1531 1.1 nisimura }
1532 1.13 nisimura
1533 1.13 nisimura /* bit selection to determine MDIO speed */
1534 1.13 nisimura
1535 1.13 nisimura static int
1536 1.13 nisimura get_mdioclk(uint32_t freq)
1537 1.13 nisimura {
1538 1.13 nisimura
1539 1.13 nisimura const struct {
1540 1.13 nisimura uint16_t freq, bit; /* GAR 5:2 MDIO frequency selection */
1541 1.13 nisimura } mdioclk[] = {
1542 1.13 nisimura { 35, 2 }, /* 25-35 MHz */
1543 1.13 nisimura { 60, 3 }, /* 35-60 MHz */
1544 1.13 nisimura { 100, 0 }, /* 60-100 MHz */
1545 1.13 nisimura { 150, 1 }, /* 100-150 MHz */
1546 1.13 nisimura { 250, 4 }, /* 150-250 MHz */
1547 1.13 nisimura { 300, 5 }, /* 250-300 MHz */
1548 1.13 nisimura };
1549 1.13 nisimura int i;
1550 1.13 nisimura
1551 1.14 nisimura freq /= 1000 * 1000;
1552 1.13 nisimura /* convert MDIO clk to a divisor value */
1553 1.13 nisimura if (freq < mdioclk[0].freq)
1554 1.13 nisimura return mdioclk[0].bit;
1555 1.13 nisimura for (i = 1; i < __arraycount(mdioclk); i++) {
1556 1.13 nisimura if (freq < mdioclk[i].freq)
1557 1.13 nisimura return mdioclk[i-1].bit;
1558 1.13 nisimura }
1559 1.13 nisimura return mdioclk[__arraycount(mdioclk) - 1].bit << GAR_CTL;
1560 1.13 nisimura }
1561