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