if_rge.c revision 1.25 1 1.25 nonaka /* $NetBSD: if_rge.c,v 1.25 2022/12/21 05:19:15 nonaka Exp $ */
2 1.17 jakllsch /* $OpenBSD: if_rge.c,v 1.9 2020/12/12 11:48:53 jan Exp $ */
3 1.1 sevan
4 1.1 sevan /*
5 1.17 jakllsch * Copyright (c) 2019, 2020 Kevin Lo <kevlo (at) openbsd.org>
6 1.1 sevan *
7 1.1 sevan * Permission to use, copy, modify, and distribute this software for any
8 1.1 sevan * purpose with or without fee is hereby granted, provided that the above
9 1.1 sevan * copyright notice and this permission notice appear in all copies.
10 1.1 sevan *
11 1.1 sevan * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
12 1.1 sevan * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
13 1.1 sevan * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
14 1.1 sevan * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
15 1.1 sevan * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
16 1.1 sevan * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
17 1.1 sevan * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
18 1.1 sevan */
19 1.1 sevan
20 1.2 sevan #include <sys/cdefs.h>
21 1.25 nonaka __KERNEL_RCSID(0, "$NetBSD: if_rge.c,v 1.25 2022/12/21 05:19:15 nonaka Exp $");
22 1.2 sevan
23 1.2 sevan #include <sys/types.h>
24 1.1 sevan
25 1.1 sevan #include <sys/param.h>
26 1.1 sevan #include <sys/systm.h>
27 1.1 sevan #include <sys/sockio.h>
28 1.1 sevan #include <sys/mbuf.h>
29 1.1 sevan #include <sys/kernel.h>
30 1.1 sevan #include <sys/socket.h>
31 1.1 sevan #include <sys/device.h>
32 1.1 sevan #include <sys/endian.h>
33 1.3 sevan #include <sys/callout.h>
34 1.3 sevan #include <sys/workqueue.h>
35 1.1 sevan
36 1.1 sevan #include <net/if.h>
37 1.2 sevan
38 1.2 sevan #include <net/if_dl.h>
39 1.2 sevan #include <net/if_ether.h>
40 1.2 sevan
41 1.1 sevan #include <net/if_media.h>
42 1.1 sevan
43 1.1 sevan #include <netinet/in.h>
44 1.2 sevan #include <net/if_ether.h>
45 1.1 sevan
46 1.1 sevan #include <net/bpf.h>
47 1.1 sevan
48 1.2 sevan #include <sys/bus.h>
49 1.1 sevan #include <machine/intr.h>
50 1.1 sevan
51 1.1 sevan #include <dev/mii/mii.h>
52 1.1 sevan
53 1.1 sevan #include <dev/pci/pcivar.h>
54 1.1 sevan #include <dev/pci/pcireg.h>
55 1.1 sevan #include <dev/pci/pcidevs.h>
56 1.1 sevan
57 1.1 sevan #include <dev/pci/if_rgereg.h>
58 1.1 sevan
59 1.2 sevan #ifdef __NetBSD__
60 1.2 sevan #define letoh32 htole32
61 1.2 sevan #define nitems(x) __arraycount(x)
62 1.7 sevan
63 1.7 sevan static struct mbuf *
64 1.17 jakllsch MCLGETL(struct rge_softc *sc __unused, int how,
65 1.17 jakllsch u_int size)
66 1.7 sevan {
67 1.7 sevan struct mbuf *m;
68 1.7 sevan
69 1.7 sevan MGETHDR(m, how, MT_DATA);
70 1.7 sevan if (m == NULL)
71 1.7 sevan return NULL;
72 1.7 sevan
73 1.7 sevan MEXTMALLOC(m, size, how);
74 1.7 sevan if ((m->m_flags & M_EXT) == 0) {
75 1.7 sevan m_freem(m);
76 1.7 sevan return NULL;
77 1.7 sevan }
78 1.7 sevan return m;
79 1.7 sevan }
80 1.7 sevan
81 1.3 sevan #ifdef NET_MPSAFE
82 1.3 sevan #define RGE_MPSAFE 1
83 1.3 sevan #define CALLOUT_FLAGS CALLOUT_MPSAFE
84 1.3 sevan #else
85 1.3 sevan #define CALLOUT_FLAGS 0
86 1.3 sevan #endif
87 1.2 sevan #endif
88 1.2 sevan
89 1.17 jakllsch #ifdef RGE_DEBUG
90 1.17 jakllsch #define DPRINTF(x) do { if (rge_debug > 0) printf x; } while (0)
91 1.17 jakllsch int rge_debug = 0;
92 1.17 jakllsch #else
93 1.17 jakllsch #define DPRINTF(x)
94 1.17 jakllsch #endif
95 1.17 jakllsch
96 1.2 sevan static int rge_match(device_t, cfdata_t, void *);
97 1.5 skrll static void rge_attach(device_t, device_t, void *);
98 1.1 sevan int rge_intr(void *);
99 1.1 sevan int rge_encap(struct rge_softc *, struct mbuf *, int);
100 1.2 sevan int rge_ioctl(struct ifnet *, u_long, void *);
101 1.2 sevan void rge_start(struct ifnet *);
102 1.1 sevan void rge_watchdog(struct ifnet *);
103 1.1 sevan int rge_init(struct ifnet *);
104 1.17 jakllsch void rge_stop(struct ifnet *, int);
105 1.1 sevan int rge_ifmedia_upd(struct ifnet *);
106 1.1 sevan void rge_ifmedia_sts(struct ifnet *, struct ifmediareq *);
107 1.1 sevan int rge_allocmem(struct rge_softc *);
108 1.1 sevan int rge_newbuf(struct rge_softc *, int);
109 1.1 sevan void rge_discard_rxbuf(struct rge_softc *, int);
110 1.1 sevan int rge_rx_list_init(struct rge_softc *);
111 1.1 sevan void rge_tx_list_init(struct rge_softc *);
112 1.1 sevan int rge_rxeof(struct rge_softc *);
113 1.1 sevan int rge_txeof(struct rge_softc *);
114 1.1 sevan void rge_reset(struct rge_softc *);
115 1.1 sevan void rge_iff(struct rge_softc *);
116 1.1 sevan void rge_set_phy_power(struct rge_softc *, int);
117 1.1 sevan void rge_phy_config(struct rge_softc *);
118 1.17 jakllsch void rge_phy_config_mac_cfg2(struct rge_softc *);
119 1.17 jakllsch void rge_phy_config_mac_cfg3(struct rge_softc *);
120 1.17 jakllsch void rge_phy_config_mac_cfg4(struct rge_softc *);
121 1.17 jakllsch void rge_phy_config_mac_cfg5(struct rge_softc *);
122 1.17 jakllsch void rge_phy_config_mcu(struct rge_softc *, uint16_t);
123 1.1 sevan void rge_set_macaddr(struct rge_softc *, const uint8_t *);
124 1.1 sevan void rge_get_macaddr(struct rge_softc *, uint8_t *);
125 1.1 sevan void rge_hw_init(struct rge_softc *);
126 1.1 sevan void rge_disable_phy_ocp_pwrsave(struct rge_softc *);
127 1.1 sevan void rge_patch_phy_mcu(struct rge_softc *, int);
128 1.1 sevan void rge_add_media_types(struct rge_softc *);
129 1.1 sevan void rge_config_imtype(struct rge_softc *, int);
130 1.17 jakllsch void rge_disable_hw_im(struct rge_softc *);
131 1.1 sevan void rge_disable_sim_im(struct rge_softc *);
132 1.1 sevan void rge_setup_sim_im(struct rge_softc *);
133 1.1 sevan void rge_setup_intr(struct rge_softc *, int);
134 1.1 sevan void rge_exit_oob(struct rge_softc *);
135 1.1 sevan void rge_write_csi(struct rge_softc *, uint32_t, uint32_t);
136 1.1 sevan uint32_t rge_read_csi(struct rge_softc *, uint32_t);
137 1.1 sevan void rge_write_mac_ocp(struct rge_softc *, uint16_t, uint16_t);
138 1.1 sevan uint16_t rge_read_mac_ocp(struct rge_softc *, uint16_t);
139 1.1 sevan void rge_write_ephy(struct rge_softc *, uint16_t, uint16_t);
140 1.17 jakllsch uint16_t rge_read_ephy(struct rge_softc *, uint16_t);
141 1.1 sevan void rge_write_phy(struct rge_softc *, uint16_t, uint16_t, uint16_t);
142 1.17 jakllsch uint16_t rge_read_phy(struct rge_softc *, uint16_t, uint16_t);
143 1.1 sevan void rge_write_phy_ocp(struct rge_softc *, uint16_t, uint16_t);
144 1.1 sevan uint16_t rge_read_phy_ocp(struct rge_softc *, uint16_t);
145 1.1 sevan int rge_get_link_status(struct rge_softc *);
146 1.3 sevan void rge_txstart(struct work *, void *);
147 1.1 sevan void rge_tick(void *);
148 1.1 sevan void rge_link_state(struct rge_softc *);
149 1.1 sevan
150 1.1 sevan static const struct {
151 1.1 sevan uint16_t reg;
152 1.1 sevan uint16_t val;
153 1.17 jakllsch } rtl8125_mac_cfg2_mcu[] = {
154 1.1 sevan RTL8125_MAC_CFG2_MCU
155 1.1 sevan }, rtl8125_mac_cfg3_mcu[] = {
156 1.1 sevan RTL8125_MAC_CFG3_MCU
157 1.17 jakllsch }, rtl8125_mac_cfg4_mcu[] = {
158 1.17 jakllsch RTL8125_MAC_CFG4_MCU
159 1.17 jakllsch }, rtl8125_mac_cfg5_mcu[] = {
160 1.17 jakllsch RTL8125_MAC_CFG5_MCU
161 1.1 sevan };
162 1.1 sevan
163 1.2 sevan CFATTACH_DECL_NEW(rge, sizeof(struct rge_softc), rge_match, rge_attach,
164 1.2 sevan NULL, NULL); /* Sevan - detach function? */
165 1.1 sevan
166 1.19 thorpej static const struct device_compatible_entry compat_data[] = {
167 1.19 thorpej { .id = PCI_ID_CODE(PCI_VENDOR_REALTEK, PCI_PRODUCT_REALTEK_E3000) },
168 1.19 thorpej { .id = PCI_ID_CODE(PCI_VENDOR_REALTEK, PCI_PRODUCT_REALTEK_RT8125) },
169 1.19 thorpej
170 1.19 thorpej PCI_COMPAT_EOL
171 1.1 sevan };
172 1.1 sevan
173 1.2 sevan static int
174 1.2 sevan rge_match(device_t parent, cfdata_t match, void *aux)
175 1.1 sevan {
176 1.2 sevan struct pci_attach_args *pa =aux;
177 1.2 sevan
178 1.19 thorpej return pci_compatible_match(pa, compat_data);
179 1.1 sevan }
180 1.1 sevan
181 1.1 sevan void
182 1.2 sevan rge_attach(device_t parent, device_t self, void *aux)
183 1.1 sevan {
184 1.11 sevan struct rge_softc *sc = device_private(self);
185 1.1 sevan struct pci_attach_args *pa = aux;
186 1.1 sevan pci_chipset_tag_t pc = pa->pa_pc;
187 1.17 jakllsch pci_intr_handle_t *ihp;
188 1.2 sevan char intrbuf[PCI_INTRSTR_LEN];
189 1.1 sevan const char *intrstr = NULL;
190 1.1 sevan struct ifnet *ifp;
191 1.1 sevan pcireg_t reg;
192 1.1 sevan uint32_t hwrev;
193 1.1 sevan uint8_t eaddr[ETHER_ADDR_LEN];
194 1.1 sevan int offset;
195 1.17 jakllsch pcireg_t command;
196 1.1 sevan
197 1.1 sevan pci_set_powerstate(pa->pa_pc, pa->pa_tag, PCI_PMCSR_STATE_D0);
198 1.1 sevan
199 1.12 sevan sc->sc_dev = self;
200 1.12 sevan
201 1.17 jakllsch pci_aprint_devinfo(pa, "Ethernet controller");
202 1.17 jakllsch
203 1.5 skrll /*
204 1.1 sevan * Map control/status registers.
205 1.1 sevan */
206 1.1 sevan if (pci_mapreg_map(pa, RGE_PCI_BAR2, PCI_MAPREG_TYPE_MEM |
207 1.1 sevan PCI_MAPREG_MEM_TYPE_64BIT, 0, &sc->rge_btag, &sc->rge_bhandle,
208 1.2 sevan NULL, &sc->rge_bsize)) {
209 1.1 sevan if (pci_mapreg_map(pa, RGE_PCI_BAR1, PCI_MAPREG_TYPE_MEM |
210 1.1 sevan PCI_MAPREG_MEM_TYPE_32BIT, 0, &sc->rge_btag,
211 1.2 sevan &sc->rge_bhandle, NULL, &sc->rge_bsize)) {
212 1.1 sevan if (pci_mapreg_map(pa, RGE_PCI_BAR0, PCI_MAPREG_TYPE_IO,
213 1.1 sevan 0, &sc->rge_btag, &sc->rge_bhandle, NULL,
214 1.2 sevan &sc->rge_bsize)) {
215 1.13 sevan aprint_error(": can't map mem or i/o space\n");
216 1.1 sevan return;
217 1.1 sevan }
218 1.1 sevan }
219 1.1 sevan }
220 1.1 sevan
221 1.17 jakllsch int counts[PCI_INTR_TYPE_SIZE] = {
222 1.17 jakllsch [PCI_INTR_TYPE_INTX] = 1,
223 1.17 jakllsch [PCI_INTR_TYPE_MSI] = 1,
224 1.17 jakllsch [PCI_INTR_TYPE_MSIX] = 1,
225 1.17 jakllsch };
226 1.17 jakllsch int max_type = PCI_INTR_TYPE_MSIX;
227 1.5 skrll /*
228 1.1 sevan * Allocate interrupt.
229 1.1 sevan */
230 1.17 jakllsch if (pci_intr_alloc(pa, &ihp, counts, max_type) != 0) {
231 1.13 sevan aprint_error(": couldn't map interrupt\n");
232 1.1 sevan return;
233 1.1 sevan }
234 1.17 jakllsch switch (pci_intr_type(pc, ihp[0])) {
235 1.17 jakllsch case PCI_INTR_TYPE_MSIX:
236 1.17 jakllsch case PCI_INTR_TYPE_MSI:
237 1.17 jakllsch sc->rge_flags |= RGE_FLAG_MSI;
238 1.17 jakllsch break;
239 1.17 jakllsch default:
240 1.17 jakllsch break;
241 1.17 jakllsch }
242 1.17 jakllsch intrstr = pci_intr_string(pc, ihp[0], intrbuf, sizeof(intrbuf));
243 1.17 jakllsch sc->sc_ih = pci_intr_establish_xname(pc, ihp[0], IPL_NET, rge_intr,
244 1.14 sevan sc, device_xname(sc->sc_dev));
245 1.1 sevan if (sc->sc_ih == NULL) {
246 1.13 sevan aprint_error_dev(sc->sc_dev, ": couldn't establish interrupt");
247 1.1 sevan if (intrstr != NULL)
248 1.13 sevan aprint_error(" at %s\n", intrstr);
249 1.13 sevan aprint_error("\n");
250 1.1 sevan return;
251 1.1 sevan }
252 1.13 sevan aprint_normal_dev(sc->sc_dev, "interrupting at %s\n", intrstr);
253 1.1 sevan
254 1.9 thorpej if (pci_dma64_available(pa))
255 1.9 thorpej sc->sc_dmat = pa->pa_dmat64;
256 1.9 thorpej else
257 1.9 thorpej sc->sc_dmat = pa->pa_dmat;
258 1.9 thorpej
259 1.1 sevan sc->sc_pc = pa->pa_pc;
260 1.1 sevan sc->sc_tag = pa->pa_tag;
261 1.1 sevan
262 1.1 sevan /* Determine hardware revision */
263 1.1 sevan hwrev = RGE_READ_4(sc, RGE_TXCFG) & RGE_TXCFG_HWREV;
264 1.1 sevan switch (hwrev) {
265 1.1 sevan case 0x60800000:
266 1.1 sevan sc->rge_type = MAC_CFG2;
267 1.1 sevan break;
268 1.1 sevan case 0x60900000:
269 1.1 sevan sc->rge_type = MAC_CFG3;
270 1.1 sevan break;
271 1.17 jakllsch case 0x64000000:
272 1.17 jakllsch sc->rge_type = MAC_CFG4;
273 1.17 jakllsch break;
274 1.17 jakllsch case 0x64100000:
275 1.17 jakllsch sc->rge_type = MAC_CFG5;
276 1.17 jakllsch break;
277 1.1 sevan default:
278 1.13 sevan aprint_error(": unknown version 0x%08x\n", hwrev);
279 1.1 sevan return;
280 1.1 sevan }
281 1.1 sevan
282 1.1 sevan rge_config_imtype(sc, RGE_IMTYPE_SIM);
283 1.1 sevan
284 1.5 skrll /*
285 1.1 sevan * PCI Express check.
286 1.1 sevan */
287 1.1 sevan if (pci_get_capability(pa->pa_pc, pa->pa_tag, PCI_CAP_PCIEXPRESS,
288 1.1 sevan &offset, NULL)) {
289 1.17 jakllsch /* Disable PCIe ASPM and ECPM. */
290 1.1 sevan reg = pci_conf_read(pa->pa_pc, pa->pa_tag,
291 1.2 sevan offset + PCIE_LCSR);
292 1.17 jakllsch reg &= ~(PCIE_LCSR_ASPM_L0S | PCIE_LCSR_ASPM_L1 |
293 1.17 jakllsch PCIE_LCSR_ENCLKPM);
294 1.2 sevan pci_conf_write(pa->pa_pc, pa->pa_tag, offset + PCIE_LCSR,
295 1.1 sevan reg);
296 1.1 sevan }
297 1.1 sevan
298 1.1 sevan rge_exit_oob(sc);
299 1.1 sevan rge_hw_init(sc);
300 1.1 sevan
301 1.1 sevan rge_get_macaddr(sc, eaddr);
302 1.13 sevan aprint_normal_dev(sc->sc_dev, "Ethernet address %s\n",
303 1.13 sevan ether_sprintf(eaddr));
304 1.1 sevan
305 1.2 sevan memcpy(sc->sc_enaddr, eaddr, ETHER_ADDR_LEN);
306 1.1 sevan
307 1.1 sevan rge_set_phy_power(sc, 1);
308 1.1 sevan rge_phy_config(sc);
309 1.1 sevan
310 1.1 sevan if (rge_allocmem(sc))
311 1.1 sevan return;
312 1.1 sevan
313 1.2 sevan ifp = &sc->sc_ec.ec_if;
314 1.1 sevan ifp->if_softc = sc;
315 1.14 sevan strlcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
316 1.1 sevan ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
317 1.2 sevan #ifdef RGE_MPSAFE
318 1.18 knakahar ifp->if_extflags = IFEF_MPSAFE;
319 1.2 sevan #endif
320 1.1 sevan ifp->if_ioctl = rge_ioctl;
321 1.17 jakllsch ifp->if_stop = rge_stop;
322 1.2 sevan ifp->if_start = rge_start;
323 1.17 jakllsch ifp->if_init = rge_init;
324 1.1 sevan ifp->if_watchdog = rge_watchdog;
325 1.17 jakllsch IFQ_SET_MAXLEN(&ifp->if_snd, RGE_TX_LIST_CNT - 1);
326 1.1 sevan
327 1.17 jakllsch #if notyet
328 1.17 jakllsch ifp->if_capabilities = IFCAP_CSUM_IPv4_Rx |
329 1.2 sevan IFCAP_CSUM_IPv4_Tx |IFCAP_CSUM_TCPv4_Rx | IFCAP_CSUM_TCPv4_Tx|
330 1.2 sevan IFCAP_CSUM_UDPv4_Rx | IFCAP_CSUM_UDPv4_Tx;
331 1.17 jakllsch #endif
332 1.1 sevan
333 1.17 jakllsch sc->sc_ec.ec_capabilities |= ETHERCAP_VLAN_MTU;
334 1.17 jakllsch sc->sc_ec.ec_capabilities |= ETHERCAP_VLAN_HWTAGGING;
335 1.1 sevan
336 1.3 sevan callout_init(&sc->sc_timeout, CALLOUT_FLAGS);
337 1.3 sevan callout_setfunc(&sc->sc_timeout, rge_tick, sc);
338 1.17 jakllsch
339 1.17 jakllsch command = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
340 1.17 jakllsch command |= PCI_COMMAND_MASTER_ENABLE;
341 1.17 jakllsch pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, command);
342 1.1 sevan
343 1.1 sevan /* Initialize ifmedia structures. */
344 1.17 jakllsch sc->sc_ec.ec_ifmedia = &sc->sc_media;
345 1.1 sevan ifmedia_init(&sc->sc_media, IFM_IMASK, rge_ifmedia_upd,
346 1.1 sevan rge_ifmedia_sts);
347 1.1 sevan rge_add_media_types(sc);
348 1.1 sevan ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_AUTO, 0, NULL);
349 1.1 sevan ifmedia_set(&sc->sc_media, IFM_ETHER | IFM_AUTO);
350 1.1 sevan sc->sc_media.ifm_media = sc->sc_media.ifm_cur->ifm_media;
351 1.1 sevan
352 1.1 sevan if_attach(ifp);
353 1.2 sevan ether_ifattach(ifp, eaddr);
354 1.20 msaitoh
355 1.20 msaitoh if (pmf_device_register(self, NULL, NULL))
356 1.20 msaitoh pmf_class_network_register(self, ifp);
357 1.20 msaitoh else
358 1.20 msaitoh aprint_error_dev(self, "couldn't establish power handler\n");
359 1.1 sevan }
360 1.1 sevan
361 1.1 sevan int
362 1.1 sevan rge_intr(void *arg)
363 1.1 sevan {
364 1.1 sevan struct rge_softc *sc = arg;
365 1.2 sevan struct ifnet *ifp = &sc->sc_ec.ec_if;
366 1.1 sevan uint32_t status;
367 1.1 sevan int claimed = 0, rx, tx;
368 1.1 sevan
369 1.1 sevan if (!(ifp->if_flags & IFF_RUNNING))
370 1.1 sevan return (0);
371 1.1 sevan
372 1.1 sevan /* Disable interrupts. */
373 1.1 sevan RGE_WRITE_4(sc, RGE_IMR, 0);
374 1.1 sevan
375 1.1 sevan if (!(sc->rge_flags & RGE_FLAG_MSI)) {
376 1.17 jakllsch if ((RGE_READ_4(sc, RGE_ISR) & sc->rge_intrs) == 0)
377 1.1 sevan return (0);
378 1.1 sevan }
379 1.17 jakllsch
380 1.17 jakllsch status = RGE_READ_4(sc, RGE_ISR);
381 1.1 sevan if (status)
382 1.1 sevan RGE_WRITE_4(sc, RGE_ISR, status);
383 1.1 sevan
384 1.1 sevan if (status & RGE_ISR_PCS_TIMEOUT)
385 1.1 sevan claimed = 1;
386 1.1 sevan
387 1.1 sevan rx = tx = 0;
388 1.17 jakllsch if (status & sc->rge_intrs) {
389 1.1 sevan if (status &
390 1.1 sevan (sc->rge_rx_ack | RGE_ISR_RX_ERR | RGE_ISR_RX_FIFO_OFLOW)) {
391 1.1 sevan rx |= rge_rxeof(sc);
392 1.1 sevan claimed = 1;
393 1.1 sevan }
394 1.1 sevan
395 1.1 sevan if (status & (sc->rge_tx_ack | RGE_ISR_TX_ERR)) {
396 1.1 sevan tx |= rge_txeof(sc);
397 1.1 sevan claimed = 1;
398 1.1 sevan }
399 1.1 sevan
400 1.1 sevan if (status & RGE_ISR_SYSTEM_ERR) {
401 1.2 sevan KERNEL_LOCK(1, NULL);
402 1.1 sevan rge_init(ifp);
403 1.2 sevan KERNEL_UNLOCK_ONE(NULL);
404 1.1 sevan claimed = 1;
405 1.1 sevan }
406 1.1 sevan }
407 1.1 sevan
408 1.1 sevan if (sc->rge_timerintr) {
409 1.1 sevan if ((tx | rx) == 0) {
410 1.1 sevan /*
411 1.1 sevan * Nothing needs to be processed, fallback
412 1.1 sevan * to use TX/RX interrupts.
413 1.1 sevan */
414 1.1 sevan rge_setup_intr(sc, RGE_IMTYPE_NONE);
415 1.1 sevan
416 1.1 sevan /*
417 1.1 sevan * Recollect, mainly to avoid the possible
418 1.1 sevan * race introduced by changing interrupt
419 1.1 sevan * masks.
420 1.1 sevan */
421 1.1 sevan rge_rxeof(sc);
422 1.1 sevan rge_txeof(sc);
423 1.1 sevan } else
424 1.1 sevan RGE_WRITE_4(sc, RGE_TIMERCNT, 1);
425 1.1 sevan } else if (tx | rx) {
426 1.1 sevan /*
427 1.1 sevan * Assume that using simulated interrupt moderation
428 1.1 sevan * (hardware timer based) could reduce the interrupt
429 1.1 sevan * rate.
430 1.1 sevan */
431 1.1 sevan rge_setup_intr(sc, RGE_IMTYPE_SIM);
432 1.1 sevan }
433 1.1 sevan
434 1.1 sevan RGE_WRITE_4(sc, RGE_IMR, sc->rge_intrs);
435 1.1 sevan
436 1.1 sevan return (claimed);
437 1.1 sevan }
438 1.1 sevan
439 1.1 sevan int
440 1.1 sevan rge_encap(struct rge_softc *sc, struct mbuf *m, int idx)
441 1.1 sevan {
442 1.1 sevan struct rge_tx_desc *d = NULL;
443 1.1 sevan struct rge_txq *txq;
444 1.1 sevan bus_dmamap_t txmap;
445 1.1 sevan uint32_t cmdsts, cflags = 0;
446 1.1 sevan int cur, error, i, last, nsegs;
447 1.1 sevan
448 1.17 jakllsch #if notyet
449 1.1 sevan /*
450 1.1 sevan * Set RGE_TDEXTSTS_IPCSUM if any checksum offloading is requested.
451 1.1 sevan * Otherwise, RGE_TDEXTSTS_TCPCSUM / RGE_TDEXTSTS_UDPCSUM does not
452 1.1 sevan * take affect.
453 1.1 sevan */
454 1.1 sevan if ((m->m_pkthdr.csum_flags &
455 1.2 sevan (M_CSUM_IPv4 | M_CSUM_TCPv4 | M_CSUM_UDPv4)) != 0) {
456 1.1 sevan cflags |= RGE_TDEXTSTS_IPCSUM;
457 1.1 sevan if (m->m_pkthdr.csum_flags & M_TCP_CSUM_OUT)
458 1.1 sevan cflags |= RGE_TDEXTSTS_TCPCSUM;
459 1.1 sevan if (m->m_pkthdr.csum_flags & M_UDP_CSUM_OUT)
460 1.1 sevan cflags |= RGE_TDEXTSTS_UDPCSUM;
461 1.1 sevan }
462 1.17 jakllsch #endif
463 1.1 sevan
464 1.1 sevan txq = &sc->rge_ldata.rge_txq[idx];
465 1.1 sevan txmap = txq->txq_dmamap;
466 1.1 sevan
467 1.1 sevan error = bus_dmamap_load_mbuf(sc->sc_dmat, txmap, m, BUS_DMA_NOWAIT);
468 1.1 sevan switch (error) {
469 1.1 sevan case 0:
470 1.1 sevan break;
471 1.1 sevan case EFBIG: /* mbuf chain is too fragmented */
472 1.1 sevan if (m_defrag(m, M_DONTWAIT) == 0 &&
473 1.1 sevan bus_dmamap_load_mbuf(sc->sc_dmat, txmap, m,
474 1.1 sevan BUS_DMA_NOWAIT) == 0)
475 1.1 sevan break;
476 1.1 sevan
477 1.1 sevan /* FALLTHROUGH */
478 1.1 sevan default:
479 1.1 sevan return (0);
480 1.1 sevan }
481 1.1 sevan
482 1.1 sevan bus_dmamap_sync(sc->sc_dmat, txmap, 0, txmap->dm_mapsize,
483 1.1 sevan BUS_DMASYNC_PREWRITE);
484 1.1 sevan
485 1.1 sevan nsegs = txmap->dm_nsegs;
486 1.1 sevan
487 1.1 sevan /* Set up hardware VLAN tagging. */
488 1.17 jakllsch if (vlan_has_tag(m))
489 1.17 jakllsch cflags |= bswap16(vlan_get_tag(m)) | RGE_TDEXTSTS_VTAG;
490 1.1 sevan
491 1.17 jakllsch last = cur = idx;
492 1.1 sevan cmdsts = RGE_TDCMDSTS_SOF;
493 1.1 sevan
494 1.1 sevan for (i = 0; i < txmap->dm_nsegs; i++) {
495 1.1 sevan d = &sc->rge_ldata.rge_tx_list[cur];
496 1.1 sevan
497 1.1 sevan d->rge_extsts = htole32(cflags);
498 1.1 sevan d->rge_addrlo = htole32(RGE_ADDR_LO(txmap->dm_segs[i].ds_addr));
499 1.1 sevan d->rge_addrhi = htole32(RGE_ADDR_HI(txmap->dm_segs[i].ds_addr));
500 1.1 sevan
501 1.1 sevan cmdsts |= txmap->dm_segs[i].ds_len;
502 1.1 sevan
503 1.1 sevan if (cur == RGE_TX_LIST_CNT - 1)
504 1.1 sevan cmdsts |= RGE_TDCMDSTS_EOR;
505 1.1 sevan
506 1.1 sevan d->rge_cmdsts = htole32(cmdsts);
507 1.1 sevan
508 1.1 sevan last = cur;
509 1.1 sevan cmdsts = RGE_TDCMDSTS_OWN;
510 1.1 sevan cur = RGE_NEXT_TX_DESC(cur);
511 1.1 sevan }
512 1.1 sevan
513 1.1 sevan /* Set EOF on the last descriptor. */
514 1.1 sevan d->rge_cmdsts |= htole32(RGE_TDCMDSTS_EOF);
515 1.1 sevan
516 1.1 sevan /* Transfer ownership of packet to the chip. */
517 1.1 sevan d = &sc->rge_ldata.rge_tx_list[idx];
518 1.1 sevan
519 1.1 sevan d->rge_cmdsts |= htole32(RGE_TDCMDSTS_OWN);
520 1.1 sevan
521 1.1 sevan bus_dmamap_sync(sc->sc_dmat, sc->rge_ldata.rge_tx_list_map,
522 1.1 sevan cur * sizeof(struct rge_tx_desc), sizeof(struct rge_tx_desc),
523 1.1 sevan BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
524 1.1 sevan
525 1.1 sevan /* Update info of TX queue and descriptors. */
526 1.1 sevan txq->txq_mbuf = m;
527 1.1 sevan txq->txq_descidx = last;
528 1.1 sevan
529 1.1 sevan return (nsegs);
530 1.1 sevan }
531 1.1 sevan
532 1.1 sevan int
533 1.2 sevan rge_ioctl(struct ifnet *ifp, u_long cmd, void *data)
534 1.1 sevan {
535 1.1 sevan struct rge_softc *sc = ifp->if_softc;
536 1.17 jakllsch //struct ifreq *ifr = (struct ifreq *)data;
537 1.1 sevan int s, error = 0;
538 1.1 sevan
539 1.1 sevan s = splnet();
540 1.1 sevan
541 1.1 sevan switch (cmd) {
542 1.1 sevan case SIOCSIFFLAGS:
543 1.17 jakllsch if ((error = ifioctl_common(ifp, cmd, data)) != 0)
544 1.17 jakllsch break;
545 1.17 jakllsch /* XXX set an ifflags callback and let ether_ioctl
546 1.17 jakllsch * handle all of this.
547 1.17 jakllsch */
548 1.1 sevan if (ifp->if_flags & IFF_UP) {
549 1.1 sevan if (ifp->if_flags & IFF_RUNNING)
550 1.1 sevan error = ENETRESET;
551 1.1 sevan else
552 1.1 sevan rge_init(ifp);
553 1.1 sevan } else {
554 1.1 sevan if (ifp->if_flags & IFF_RUNNING)
555 1.17 jakllsch rge_stop(ifp, 1);
556 1.1 sevan }
557 1.1 sevan break;
558 1.1 sevan default:
559 1.2 sevan error = ether_ioctl(ifp, cmd, data);
560 1.1 sevan }
561 1.1 sevan
562 1.1 sevan if (error == ENETRESET) {
563 1.1 sevan if (ifp->if_flags & IFF_RUNNING)
564 1.1 sevan rge_iff(sc);
565 1.1 sevan error = 0;
566 1.1 sevan }
567 1.1 sevan
568 1.1 sevan splx(s);
569 1.1 sevan return (error);
570 1.1 sevan }
571 1.1 sevan
572 1.1 sevan void
573 1.3 sevan rge_start(struct ifnet *ifp)
574 1.1 sevan {
575 1.1 sevan struct rge_softc *sc = ifp->if_softc;
576 1.1 sevan struct mbuf *m;
577 1.1 sevan int free, idx, used;
578 1.1 sevan int queued = 0;
579 1.1 sevan
580 1.2 sevan #define LINK_STATE_IS_UP(_s) \
581 1.2 sevan ((_s) >= LINK_STATE_UP || (_s) == LINK_STATE_UNKNOWN)
582 1.2 sevan
583 1.1 sevan if (!LINK_STATE_IS_UP(ifp->if_link_state)) {
584 1.17 jakllsch IFQ_PURGE(&ifp->if_snd);
585 1.1 sevan return;
586 1.1 sevan }
587 1.1 sevan
588 1.1 sevan /* Calculate free space. */
589 1.1 sevan idx = sc->rge_ldata.rge_txq_prodidx;
590 1.1 sevan free = sc->rge_ldata.rge_txq_considx;
591 1.1 sevan if (free <= idx)
592 1.1 sevan free += RGE_TX_LIST_CNT;
593 1.1 sevan free -= idx;
594 1.1 sevan
595 1.1 sevan for (;;) {
596 1.1 sevan if (RGE_TX_NSEGS >= free + 2) {
597 1.3 sevan SET(ifp->if_flags, IFF_OACTIVE);
598 1.1 sevan break;
599 1.1 sevan }
600 1.1 sevan
601 1.3 sevan IFQ_DEQUEUE(&ifp->if_snd, m);
602 1.1 sevan if (m == NULL)
603 1.1 sevan break;
604 1.1 sevan
605 1.1 sevan used = rge_encap(sc, m, idx);
606 1.1 sevan if (used == 0) {
607 1.1 sevan m_freem(m);
608 1.1 sevan continue;
609 1.1 sevan }
610 1.1 sevan
611 1.1 sevan KASSERT(used <= free);
612 1.1 sevan free -= used;
613 1.1 sevan
614 1.17 jakllsch bpf_mtap(ifp, m, BPF_D_OUT);
615 1.1 sevan
616 1.1 sevan idx += used;
617 1.1 sevan if (idx >= RGE_TX_LIST_CNT)
618 1.1 sevan idx -= RGE_TX_LIST_CNT;
619 1.1 sevan
620 1.1 sevan queued++;
621 1.1 sevan }
622 1.1 sevan
623 1.1 sevan if (queued == 0)
624 1.1 sevan return;
625 1.1 sevan
626 1.1 sevan /* Set a timeout in case the chip goes out to lunch. */
627 1.1 sevan ifp->if_timer = 5;
628 1.1 sevan
629 1.1 sevan sc->rge_ldata.rge_txq_prodidx = idx;
630 1.17 jakllsch #if 0
631 1.1 sevan ifq_serialize(ifq, &sc->sc_task);
632 1.17 jakllsch #else
633 1.17 jakllsch rge_txstart(&sc->sc_task, sc);
634 1.17 jakllsch #endif
635 1.1 sevan }
636 1.1 sevan
637 1.1 sevan void
638 1.1 sevan rge_watchdog(struct ifnet *ifp)
639 1.1 sevan {
640 1.1 sevan struct rge_softc *sc = ifp->if_softc;
641 1.1 sevan
642 1.16 jakllsch device_printf(sc->sc_dev, "watchdog timeout\n");
643 1.4 skrll if_statinc(ifp, if_oerrors);
644 1.1 sevan
645 1.1 sevan rge_init(ifp);
646 1.1 sevan }
647 1.1 sevan
648 1.1 sevan int
649 1.1 sevan rge_init(struct ifnet *ifp)
650 1.1 sevan {
651 1.1 sevan struct rge_softc *sc = ifp->if_softc;
652 1.1 sevan uint32_t val;
653 1.1 sevan int i;
654 1.1 sevan
655 1.17 jakllsch rge_stop(ifp, 0);
656 1.1 sevan
657 1.1 sevan /* Set MAC address. */
658 1.17 jakllsch rge_set_macaddr(sc, CLLADDR(ifp->if_sadl));
659 1.1 sevan
660 1.17 jakllsch /* Set Maximum frame size. */
661 1.17 jakllsch RGE_WRITE_2(sc, RGE_RXMAXSIZE, RGE_JUMBO_FRAMELEN);
662 1.1 sevan
663 1.1 sevan /* Initialize RX descriptors list. */
664 1.1 sevan if (rge_rx_list_init(sc) == ENOBUFS) {
665 1.16 jakllsch device_printf(sc->sc_dev,
666 1.13 sevan "init failed: no memory for RX buffers\n");
667 1.17 jakllsch rge_stop(ifp, 1);
668 1.1 sevan return (ENOBUFS);
669 1.1 sevan }
670 1.1 sevan
671 1.1 sevan /* Initialize TX descriptors. */
672 1.1 sevan rge_tx_list_init(sc);
673 1.1 sevan
674 1.1 sevan /* Load the addresses of the RX and TX lists into the chip. */
675 1.1 sevan RGE_WRITE_4(sc, RGE_RXDESC_ADDR_LO,
676 1.1 sevan RGE_ADDR_LO(sc->rge_ldata.rge_rx_list_map->dm_segs[0].ds_addr));
677 1.1 sevan RGE_WRITE_4(sc, RGE_RXDESC_ADDR_HI,
678 1.1 sevan RGE_ADDR_HI(sc->rge_ldata.rge_rx_list_map->dm_segs[0].ds_addr));
679 1.1 sevan RGE_WRITE_4(sc, RGE_TXDESC_ADDR_LO,
680 1.1 sevan RGE_ADDR_LO(sc->rge_ldata.rge_tx_list_map->dm_segs[0].ds_addr));
681 1.1 sevan RGE_WRITE_4(sc, RGE_TXDESC_ADDR_HI,
682 1.1 sevan RGE_ADDR_HI(sc->rge_ldata.rge_tx_list_map->dm_segs[0].ds_addr));
683 1.1 sevan
684 1.1 sevan RGE_SETBIT_1(sc, RGE_EECMD, RGE_EECMD_WRITECFG);
685 1.1 sevan
686 1.1 sevan RGE_CLRBIT_1(sc, 0xf1, 0x80);
687 1.1 sevan RGE_CLRBIT_1(sc, RGE_CFG2, RGE_CFG2_CLKREQ_EN);
688 1.1 sevan RGE_CLRBIT_1(sc, RGE_CFG5, RGE_CFG5_PME_STS);
689 1.1 sevan RGE_CLRBIT_1(sc, RGE_CFG3, RGE_CFG3_RDY_TO_L23);
690 1.1 sevan
691 1.1 sevan /* Clear interrupt moderation timer. */
692 1.1 sevan for (i = 0; i < 64; i++)
693 1.17 jakllsch RGE_WRITE_4(sc, RGE_INTMITI(i), 0);
694 1.1 sevan
695 1.1 sevan /* Set the initial RX and TX configurations. */
696 1.1 sevan RGE_WRITE_4(sc, RGE_RXCFG, RGE_RXCFG_CONFIG);
697 1.1 sevan RGE_WRITE_4(sc, RGE_TXCFG, RGE_TXCFG_CONFIG);
698 1.1 sevan
699 1.1 sevan val = rge_read_csi(sc, 0x70c) & ~0xff000000;
700 1.1 sevan rge_write_csi(sc, 0x70c, val | 0x27000000);
701 1.1 sevan
702 1.1 sevan /* Enable hardware optimization function. */
703 1.1 sevan val = pci_conf_read(sc->sc_pc, sc->sc_tag, 0x78) & ~0x00007000;
704 1.1 sevan pci_conf_write(sc->sc_pc, sc->sc_tag, 0x78, val | 0x00005000);
705 1.1 sevan
706 1.1 sevan RGE_WRITE_2(sc, 0x0382, 0x221b);
707 1.1 sevan RGE_WRITE_1(sc, 0x4500, 0);
708 1.1 sevan RGE_WRITE_2(sc, 0x4800, 0);
709 1.1 sevan RGE_CLRBIT_1(sc, RGE_CFG1, RGE_CFG1_SPEED_DOWN);
710 1.1 sevan
711 1.1 sevan rge_write_mac_ocp(sc, 0xc140, 0xffff);
712 1.1 sevan rge_write_mac_ocp(sc, 0xc142, 0xffff);
713 1.1 sevan
714 1.1 sevan val = rge_read_mac_ocp(sc, 0xd3e2) & ~0x0fff;
715 1.1 sevan rge_write_mac_ocp(sc, 0xd3e2, val | 0x03a9);
716 1.1 sevan
717 1.1 sevan RGE_MAC_CLRBIT(sc, 0xd3e4, 0x00ff);
718 1.1 sevan RGE_MAC_SETBIT(sc, 0xe860, 0x0080);
719 1.1 sevan RGE_MAC_SETBIT(sc, 0xeb58, 0x0001);
720 1.1 sevan
721 1.1 sevan val = rge_read_mac_ocp(sc, 0xe614) & ~0x0700;
722 1.17 jakllsch if (sc->rge_type == MAC_CFG2 || sc->rge_type == MAC_CFG3)
723 1.17 jakllsch rge_write_mac_ocp(sc, 0xe614, val | 0x0400);
724 1.17 jakllsch else
725 1.17 jakllsch rge_write_mac_ocp(sc, 0xe614, val | 0x0200);
726 1.1 sevan
727 1.1 sevan RGE_MAC_CLRBIT(sc, 0xe63e, 0x0c00);
728 1.1 sevan
729 1.17 jakllsch if (sc->rge_type == MAC_CFG2 || sc->rge_type == MAC_CFG3) {
730 1.17 jakllsch val = rge_read_mac_ocp(sc, 0xe63e) & ~0x0030;
731 1.17 jakllsch rge_write_mac_ocp(sc, 0xe63e, val | 0x0020);
732 1.17 jakllsch } else
733 1.17 jakllsch RGE_MAC_CLRBIT(sc, 0xe63e, 0x0030);
734 1.1 sevan
735 1.1 sevan RGE_MAC_SETBIT(sc, 0xc0b4, 0x000c);
736 1.1 sevan
737 1.17 jakllsch val = rge_read_mac_ocp(sc, 0xeb6a) & ~0x00ff;
738 1.1 sevan rge_write_mac_ocp(sc, 0xeb6a, val | 0x0033);
739 1.1 sevan
740 1.1 sevan val = rge_read_mac_ocp(sc, 0xeb50) & ~0x03e0;
741 1.1 sevan rge_write_mac_ocp(sc, 0xeb50, val | 0x0040);
742 1.1 sevan
743 1.1 sevan val = rge_read_mac_ocp(sc, 0xe056) & ~0x00f0;
744 1.1 sevan rge_write_mac_ocp(sc, 0xe056, val | 0x0030);
745 1.1 sevan
746 1.1 sevan RGE_WRITE_1(sc, RGE_TDFNR, 0x10);
747 1.1 sevan
748 1.17 jakllsch RGE_SETBIT_1(sc, RGE_DLLPR, RGE_DLLPR_TX_10M_PS_EN);
749 1.17 jakllsch
750 1.1 sevan RGE_MAC_CLRBIT(sc, 0xe040, 0x1000);
751 1.1 sevan
752 1.17 jakllsch val = rge_read_mac_ocp(sc, 0xea1c) & ~0x0003;
753 1.17 jakllsch rge_write_mac_ocp(sc, 0xea1c, val | 0x0001);
754 1.17 jakllsch
755 1.1 sevan val = rge_read_mac_ocp(sc, 0xe0c0) & ~0x4f0f;
756 1.1 sevan rge_write_mac_ocp(sc, 0xe0c0, val | 0x4403);
757 1.1 sevan
758 1.1 sevan RGE_MAC_SETBIT(sc, 0xe052, 0x0068);
759 1.1 sevan RGE_MAC_CLRBIT(sc, 0xe052, 0x0080);
760 1.1 sevan
761 1.1 sevan val = rge_read_mac_ocp(sc, 0xc0ac) & ~0x0080;
762 1.1 sevan rge_write_mac_ocp(sc, 0xc0ac, val | 0x1f00);
763 1.1 sevan
764 1.1 sevan val = rge_read_mac_ocp(sc, 0xd430) & ~0x0fff;
765 1.1 sevan rge_write_mac_ocp(sc, 0xd430, val | 0x047f);
766 1.1 sevan
767 1.17 jakllsch val = rge_read_mac_ocp(sc, 0xe84c) & ~0x0040;
768 1.17 jakllsch if (sc->rge_type == MAC_CFG2 || sc->rge_type == MAC_CFG3)
769 1.17 jakllsch rge_write_mac_ocp(sc, 0xe84c, 0x00c0);
770 1.17 jakllsch else
771 1.17 jakllsch rge_write_mac_ocp(sc, 0xe84c, 0x0080);
772 1.17 jakllsch
773 1.17 jakllsch RGE_SETBIT_1(sc, RGE_DLLPR, RGE_DLLPR_PFM_EN);
774 1.17 jakllsch
775 1.17 jakllsch if (sc->rge_type == MAC_CFG2 || sc->rge_type == MAC_CFG3)
776 1.17 jakllsch RGE_SETBIT_1(sc, RGE_MCUCMD, 0x01);
777 1.1 sevan
778 1.1 sevan /* Disable EEE plus. */
779 1.1 sevan RGE_MAC_CLRBIT(sc, 0xe080, 0x0002);
780 1.1 sevan
781 1.1 sevan RGE_MAC_CLRBIT(sc, 0xea1c, 0x0004);
782 1.1 sevan
783 1.1 sevan RGE_MAC_SETBIT(sc, 0xeb54, 0x0001);
784 1.1 sevan DELAY(1);
785 1.1 sevan RGE_MAC_CLRBIT(sc, 0xeb54, 0x0001);
786 1.1 sevan
787 1.1 sevan RGE_CLRBIT_4(sc, 0x1880, 0x0030);
788 1.1 sevan
789 1.1 sevan rge_write_mac_ocp(sc, 0xe098, 0xc302);
790 1.1 sevan
791 1.17 jakllsch if ((sc->sc_ec.ec_capenable & ETHERCAP_VLAN_HWTAGGING) != 0)
792 1.1 sevan RGE_SETBIT_4(sc, RGE_RXCFG, RGE_RXCFG_VLANSTRIP);
793 1.17 jakllsch else
794 1.17 jakllsch RGE_CLRBIT_4(sc, RGE_RXCFG, RGE_RXCFG_VLANSTRIP);
795 1.1 sevan
796 1.1 sevan RGE_SETBIT_2(sc, RGE_CPLUSCMD, RGE_CPLUSCMD_RXCSUM);
797 1.1 sevan
798 1.1 sevan for (i = 0; i < 10; i++) {
799 1.1 sevan if (!(rge_read_mac_ocp(sc, 0xe00e) & 0x2000))
800 1.1 sevan break;
801 1.1 sevan DELAY(1000);
802 1.1 sevan }
803 1.1 sevan
804 1.1 sevan /* Disable RXDV gate. */
805 1.1 sevan RGE_CLRBIT_1(sc, RGE_PPSW, 0x08);
806 1.1 sevan DELAY(2000);
807 1.1 sevan
808 1.1 sevan rge_ifmedia_upd(ifp);
809 1.1 sevan
810 1.1 sevan /* Enable transmit and receive. */
811 1.1 sevan RGE_WRITE_1(sc, RGE_CMD, RGE_CMD_TXENB | RGE_CMD_RXENB);
812 1.1 sevan
813 1.1 sevan /* Program promiscuous mode and multicast filters. */
814 1.1 sevan rge_iff(sc);
815 1.1 sevan
816 1.1 sevan RGE_CLRBIT_1(sc, RGE_CFG2, RGE_CFG2_CLKREQ_EN);
817 1.1 sevan RGE_CLRBIT_1(sc, RGE_CFG5, RGE_CFG5_PME_STS);
818 1.1 sevan
819 1.1 sevan RGE_CLRBIT_1(sc, RGE_EECMD, RGE_EECMD_WRITECFG);
820 1.1 sevan
821 1.1 sevan /* Enable interrupts. */
822 1.1 sevan rge_setup_intr(sc, RGE_IMTYPE_SIM);
823 1.1 sevan
824 1.1 sevan ifp->if_flags |= IFF_RUNNING;
825 1.3 sevan CLR(ifp->if_flags, IFF_OACTIVE);
826 1.1 sevan
827 1.3 sevan callout_schedule(&sc->sc_timeout, 1);
828 1.1 sevan
829 1.1 sevan return (0);
830 1.1 sevan }
831 1.1 sevan
832 1.1 sevan /*
833 1.1 sevan * Stop the adapter and free any mbufs allocated to the RX and TX lists.
834 1.1 sevan */
835 1.1 sevan void
836 1.17 jakllsch rge_stop(struct ifnet *ifp, int disable)
837 1.1 sevan {
838 1.1 sevan struct rge_softc *sc = ifp->if_softc;
839 1.1 sevan int i;
840 1.1 sevan
841 1.17 jakllsch if (disable) {
842 1.17 jakllsch callout_halt(&sc->sc_timeout, NULL);
843 1.23 skrll } else
844 1.17 jakllsch callout_stop(&sc->sc_timeout);
845 1.1 sevan
846 1.1 sevan ifp->if_timer = 0;
847 1.1 sevan ifp->if_flags &= ~IFF_RUNNING;
848 1.1 sevan sc->rge_timerintr = 0;
849 1.1 sevan
850 1.1 sevan RGE_CLRBIT_4(sc, RGE_RXCFG, RGE_RXCFG_ALLPHYS | RGE_RXCFG_INDIV |
851 1.1 sevan RGE_RXCFG_MULTI | RGE_RXCFG_BROAD | RGE_RXCFG_RUNT |
852 1.1 sevan RGE_RXCFG_ERRPKT);
853 1.1 sevan
854 1.1 sevan RGE_WRITE_4(sc, RGE_IMR, 0);
855 1.17 jakllsch
856 1.17 jakllsch /* Clear timer interrupts. */
857 1.17 jakllsch RGE_WRITE_4(sc, RGE_TIMERINT0, 0);
858 1.17 jakllsch RGE_WRITE_4(sc, RGE_TIMERINT1, 0);
859 1.17 jakllsch RGE_WRITE_4(sc, RGE_TIMERINT2, 0);
860 1.17 jakllsch RGE_WRITE_4(sc, RGE_TIMERINT3, 0);
861 1.1 sevan
862 1.1 sevan rge_reset(sc);
863 1.1 sevan
864 1.17 jakllsch // intr_barrier(sc->sc_ih);
865 1.17 jakllsch // ifq_barrier(&ifp->if_snd);
866 1.2 sevan /* ifq_clr_oactive(&ifp->if_snd); Sevan - OpenBSD queue API */
867 1.1 sevan
868 1.1 sevan if (sc->rge_head != NULL) {
869 1.1 sevan m_freem(sc->rge_head);
870 1.1 sevan sc->rge_head = sc->rge_tail = NULL;
871 1.1 sevan }
872 1.1 sevan
873 1.1 sevan /* Free the TX list buffers. */
874 1.1 sevan for (i = 0; i < RGE_TX_LIST_CNT; i++) {
875 1.1 sevan if (sc->rge_ldata.rge_txq[i].txq_mbuf != NULL) {
876 1.1 sevan bus_dmamap_unload(sc->sc_dmat,
877 1.1 sevan sc->rge_ldata.rge_txq[i].txq_dmamap);
878 1.1 sevan m_freem(sc->rge_ldata.rge_txq[i].txq_mbuf);
879 1.1 sevan sc->rge_ldata.rge_txq[i].txq_mbuf = NULL;
880 1.1 sevan }
881 1.1 sevan }
882 1.1 sevan
883 1.1 sevan /* Free the RX list buffers. */
884 1.1 sevan for (i = 0; i < RGE_RX_LIST_CNT; i++) {
885 1.1 sevan if (sc->rge_ldata.rge_rxq[i].rxq_mbuf != NULL) {
886 1.1 sevan bus_dmamap_unload(sc->sc_dmat,
887 1.1 sevan sc->rge_ldata.rge_rxq[i].rxq_dmamap);
888 1.1 sevan m_freem(sc->rge_ldata.rge_rxq[i].rxq_mbuf);
889 1.1 sevan sc->rge_ldata.rge_rxq[i].rxq_mbuf = NULL;
890 1.1 sevan }
891 1.1 sevan }
892 1.1 sevan }
893 1.1 sevan
894 1.1 sevan /*
895 1.1 sevan * Set media options.
896 1.1 sevan */
897 1.1 sevan int
898 1.1 sevan rge_ifmedia_upd(struct ifnet *ifp)
899 1.1 sevan {
900 1.1 sevan struct rge_softc *sc = ifp->if_softc;
901 1.1 sevan struct ifmedia *ifm = &sc->sc_media;
902 1.1 sevan int anar, gig, val;
903 1.1 sevan
904 1.1 sevan if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER)
905 1.1 sevan return (EINVAL);
906 1.1 sevan
907 1.1 sevan /* Disable Gigabit Lite. */
908 1.1 sevan RGE_PHY_CLRBIT(sc, 0xa428, 0x0200);
909 1.1 sevan RGE_PHY_CLRBIT(sc, 0xa5ea, 0x0001);
910 1.1 sevan
911 1.1 sevan val = rge_read_phy_ocp(sc, 0xa5d4);
912 1.1 sevan val &= ~RGE_ADV_2500TFDX;
913 1.1 sevan
914 1.1 sevan anar = gig = 0;
915 1.1 sevan switch (IFM_SUBTYPE(ifm->ifm_media)) {
916 1.1 sevan case IFM_AUTO:
917 1.17 jakllsch anar = ANAR_TX_FD | ANAR_TX | ANAR_10_FD | ANAR_10;
918 1.17 jakllsch gig = GTCR_ADV_1000TFDX | GTCR_ADV_1000THDX;
919 1.1 sevan val |= RGE_ADV_2500TFDX;
920 1.1 sevan break;
921 1.1 sevan case IFM_2500_T:
922 1.17 jakllsch anar = ANAR_TX_FD | ANAR_TX | ANAR_10_FD | ANAR_10;
923 1.17 jakllsch gig = GTCR_ADV_1000TFDX | GTCR_ADV_1000THDX;
924 1.1 sevan val |= RGE_ADV_2500TFDX;
925 1.1 sevan ifp->if_baudrate = IF_Mbps(2500);
926 1.1 sevan break;
927 1.1 sevan case IFM_1000_T:
928 1.17 jakllsch anar = ANAR_TX_FD | ANAR_TX | ANAR_10_FD | ANAR_10;
929 1.17 jakllsch gig = GTCR_ADV_1000TFDX | GTCR_ADV_1000THDX;
930 1.1 sevan ifp->if_baudrate = IF_Gbps(1);
931 1.1 sevan break;
932 1.1 sevan case IFM_100_TX:
933 1.17 jakllsch gig = rge_read_phy(sc, 0, MII_100T2CR) &
934 1.17 jakllsch ~(GTCR_ADV_1000TFDX | GTCR_ADV_1000THDX);
935 1.17 jakllsch anar = ((ifm->ifm_media & IFM_GMASK) == IFM_FDX) ?
936 1.17 jakllsch ANAR_TX | ANAR_TX_FD | ANAR_10_FD | ANAR_10 :
937 1.17 jakllsch ANAR_TX | ANAR_10_FD | ANAR_10;
938 1.1 sevan ifp->if_baudrate = IF_Mbps(100);
939 1.1 sevan break;
940 1.1 sevan case IFM_10_T:
941 1.17 jakllsch gig = rge_read_phy(sc, 0, MII_100T2CR) &
942 1.17 jakllsch ~(GTCR_ADV_1000TFDX | GTCR_ADV_1000THDX);
943 1.17 jakllsch anar = ((ifm->ifm_media & IFM_GMASK) == IFM_FDX) ?
944 1.17 jakllsch ANAR_10_FD | ANAR_10 : ANAR_10;
945 1.1 sevan ifp->if_baudrate = IF_Mbps(10);
946 1.1 sevan break;
947 1.1 sevan default:
948 1.16 jakllsch device_printf(sc->sc_dev,
949 1.13 sevan "unsupported media type\n");
950 1.1 sevan return (EINVAL);
951 1.1 sevan }
952 1.1 sevan
953 1.1 sevan rge_write_phy(sc, 0, MII_ANAR, anar | ANAR_PAUSE_ASYM | ANAR_FC);
954 1.1 sevan rge_write_phy(sc, 0, MII_100T2CR, gig);
955 1.1 sevan rge_write_phy_ocp(sc, 0xa5d4, val);
956 1.17 jakllsch rge_write_phy(sc, 0, MII_BMCR, BMCR_RESET | BMCR_AUTOEN |
957 1.17 jakllsch BMCR_STARTNEG);
958 1.1 sevan
959 1.1 sevan return (0);
960 1.1 sevan }
961 1.1 sevan
962 1.1 sevan /*
963 1.1 sevan * Report current media status.
964 1.1 sevan */
965 1.1 sevan void
966 1.1 sevan rge_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
967 1.1 sevan {
968 1.1 sevan struct rge_softc *sc = ifp->if_softc;
969 1.1 sevan uint16_t status = 0;
970 1.1 sevan
971 1.1 sevan ifmr->ifm_status = IFM_AVALID;
972 1.1 sevan ifmr->ifm_active = IFM_ETHER;
973 1.1 sevan
974 1.1 sevan if (rge_get_link_status(sc)) {
975 1.1 sevan ifmr->ifm_status |= IFM_ACTIVE;
976 1.1 sevan
977 1.1 sevan status = RGE_READ_2(sc, RGE_PHYSTAT);
978 1.1 sevan if ((status & RGE_PHYSTAT_FDX) ||
979 1.1 sevan (status & RGE_PHYSTAT_2500MBPS))
980 1.1 sevan ifmr->ifm_active |= IFM_FDX;
981 1.1 sevan else
982 1.1 sevan ifmr->ifm_active |= IFM_HDX;
983 1.1 sevan
984 1.1 sevan if (status & RGE_PHYSTAT_10MBPS)
985 1.1 sevan ifmr->ifm_active |= IFM_10_T;
986 1.1 sevan else if (status & RGE_PHYSTAT_100MBPS)
987 1.1 sevan ifmr->ifm_active |= IFM_100_TX;
988 1.1 sevan else if (status & RGE_PHYSTAT_1000MBPS)
989 1.1 sevan ifmr->ifm_active |= IFM_1000_T;
990 1.1 sevan else if (status & RGE_PHYSTAT_2500MBPS)
991 1.1 sevan ifmr->ifm_active |= IFM_2500_T;
992 1.1 sevan }
993 1.1 sevan }
994 1.1 sevan
995 1.5 skrll /*
996 1.1 sevan * Allocate memory for RX/TX rings.
997 1.1 sevan */
998 1.1 sevan int
999 1.1 sevan rge_allocmem(struct rge_softc *sc)
1000 1.1 sevan {
1001 1.1 sevan int error, i;
1002 1.1 sevan
1003 1.1 sevan /* Allocate DMA'able memory for the TX ring. */
1004 1.1 sevan error = bus_dmamap_create(sc->sc_dmat, RGE_TX_LIST_SZ, 1,
1005 1.1 sevan RGE_TX_LIST_SZ, 0, BUS_DMA_NOWAIT, &sc->rge_ldata.rge_tx_list_map);
1006 1.1 sevan if (error) {
1007 1.13 sevan aprint_error_dev(sc->sc_dev, "can't create TX list map\n");
1008 1.1 sevan return (error);
1009 1.1 sevan }
1010 1.1 sevan error = bus_dmamem_alloc(sc->sc_dmat, RGE_TX_LIST_SZ, RGE_ALIGN, 0,
1011 1.1 sevan &sc->rge_ldata.rge_tx_listseg, 1, &sc->rge_ldata.rge_tx_listnseg,
1012 1.17 jakllsch BUS_DMA_NOWAIT);
1013 1.1 sevan if (error) {
1014 1.13 sevan aprint_error_dev(sc->sc_dev, "can't alloc TX list\n");
1015 1.1 sevan return (error);
1016 1.1 sevan }
1017 1.1 sevan
1018 1.1 sevan /* Load the map for the TX ring. */
1019 1.1 sevan error = bus_dmamem_map(sc->sc_dmat, &sc->rge_ldata.rge_tx_listseg,
1020 1.1 sevan sc->rge_ldata.rge_tx_listnseg, RGE_TX_LIST_SZ,
1021 1.8 sevan (void **) &sc->rge_ldata.rge_tx_list,
1022 1.17 jakllsch BUS_DMA_NOWAIT | BUS_DMA_COHERENT);
1023 1.1 sevan if (error) {
1024 1.13 sevan aprint_error_dev(sc->sc_dev, "can't map TX dma buffers\n");
1025 1.1 sevan bus_dmamem_free(sc->sc_dmat, &sc->rge_ldata.rge_tx_listseg,
1026 1.1 sevan sc->rge_ldata.rge_tx_listnseg);
1027 1.1 sevan return (error);
1028 1.1 sevan }
1029 1.17 jakllsch memset(sc->rge_ldata.rge_tx_list, 0, RGE_TX_LIST_SZ);
1030 1.1 sevan error = bus_dmamap_load(sc->sc_dmat, sc->rge_ldata.rge_tx_list_map,
1031 1.1 sevan sc->rge_ldata.rge_tx_list, RGE_TX_LIST_SZ, NULL, BUS_DMA_NOWAIT);
1032 1.1 sevan if (error) {
1033 1.13 sevan aprint_error_dev(sc->sc_dev, "can't load TX dma map\n");
1034 1.1 sevan bus_dmamap_destroy(sc->sc_dmat, sc->rge_ldata.rge_tx_list_map);
1035 1.1 sevan bus_dmamem_unmap(sc->sc_dmat,
1036 1.2 sevan sc->rge_ldata.rge_tx_list, RGE_TX_LIST_SZ);
1037 1.1 sevan bus_dmamem_free(sc->sc_dmat, &sc->rge_ldata.rge_tx_listseg,
1038 1.1 sevan sc->rge_ldata.rge_tx_listnseg);
1039 1.1 sevan return (error);
1040 1.1 sevan }
1041 1.1 sevan
1042 1.1 sevan /* Create DMA maps for TX buffers. */
1043 1.1 sevan for (i = 0; i < RGE_TX_LIST_CNT; i++) {
1044 1.1 sevan error = bus_dmamap_create(sc->sc_dmat, RGE_JUMBO_FRAMELEN,
1045 1.1 sevan RGE_TX_NSEGS, RGE_JUMBO_FRAMELEN, 0, 0,
1046 1.1 sevan &sc->rge_ldata.rge_txq[i].txq_dmamap);
1047 1.1 sevan if (error) {
1048 1.13 sevan aprint_error_dev(sc->sc_dev, "can't create DMA map for TX\n");
1049 1.1 sevan return (error);
1050 1.1 sevan }
1051 1.1 sevan }
1052 1.1 sevan
1053 1.1 sevan /* Allocate DMA'able memory for the RX ring. */
1054 1.1 sevan error = bus_dmamap_create(sc->sc_dmat, RGE_RX_LIST_SZ, 1,
1055 1.1 sevan RGE_RX_LIST_SZ, 0, 0, &sc->rge_ldata.rge_rx_list_map);
1056 1.1 sevan if (error) {
1057 1.13 sevan aprint_error_dev(sc->sc_dev, "can't create RX list map\n");
1058 1.1 sevan return (error);
1059 1.1 sevan }
1060 1.1 sevan error = bus_dmamem_alloc(sc->sc_dmat, RGE_RX_LIST_SZ, RGE_ALIGN, 0,
1061 1.1 sevan &sc->rge_ldata.rge_rx_listseg, 1, &sc->rge_ldata.rge_rx_listnseg,
1062 1.17 jakllsch BUS_DMA_NOWAIT);
1063 1.1 sevan if (error) {
1064 1.13 sevan aprint_error_dev(sc->sc_dev, "can't alloc RX list\n");
1065 1.1 sevan return (error);
1066 1.1 sevan }
1067 1.1 sevan
1068 1.1 sevan /* Load the map for the RX ring. */
1069 1.1 sevan error = bus_dmamem_map(sc->sc_dmat, &sc->rge_ldata.rge_rx_listseg,
1070 1.1 sevan sc->rge_ldata.rge_rx_listnseg, RGE_RX_LIST_SZ,
1071 1.8 sevan (void **) &sc->rge_ldata.rge_rx_list,
1072 1.17 jakllsch BUS_DMA_NOWAIT | BUS_DMA_COHERENT);
1073 1.1 sevan if (error) {
1074 1.13 sevan aprint_error_dev(sc->sc_dev, "can't map RX dma buffers\n");
1075 1.1 sevan bus_dmamem_free(sc->sc_dmat, &sc->rge_ldata.rge_rx_listseg,
1076 1.1 sevan sc->rge_ldata.rge_rx_listnseg);
1077 1.1 sevan return (error);
1078 1.1 sevan }
1079 1.17 jakllsch memset(sc->rge_ldata.rge_rx_list, 0, RGE_RX_LIST_SZ);
1080 1.1 sevan error = bus_dmamap_load(sc->sc_dmat, sc->rge_ldata.rge_rx_list_map,
1081 1.1 sevan sc->rge_ldata.rge_rx_list, RGE_RX_LIST_SZ, NULL, BUS_DMA_NOWAIT);
1082 1.1 sevan if (error) {
1083 1.13 sevan aprint_error_dev(sc->sc_dev, "can't load RX dma map\n");
1084 1.1 sevan bus_dmamap_destroy(sc->sc_dmat, sc->rge_ldata.rge_rx_list_map);
1085 1.1 sevan bus_dmamem_unmap(sc->sc_dmat,
1086 1.2 sevan sc->rge_ldata.rge_rx_list, RGE_RX_LIST_SZ);
1087 1.1 sevan bus_dmamem_free(sc->sc_dmat, &sc->rge_ldata.rge_rx_listseg,
1088 1.1 sevan sc->rge_ldata.rge_rx_listnseg);
1089 1.1 sevan return (error);
1090 1.1 sevan }
1091 1.1 sevan
1092 1.1 sevan /* Create DMA maps for RX buffers. */
1093 1.1 sevan for (i = 0; i < RGE_RX_LIST_CNT; i++) {
1094 1.1 sevan error = bus_dmamap_create(sc->sc_dmat, RGE_JUMBO_FRAMELEN, 1,
1095 1.1 sevan RGE_JUMBO_FRAMELEN, 0, 0,
1096 1.1 sevan &sc->rge_ldata.rge_rxq[i].rxq_dmamap);
1097 1.1 sevan if (error) {
1098 1.13 sevan aprint_error_dev(sc->sc_dev, "can't create DMA map for RX\n");
1099 1.1 sevan return (error);
1100 1.1 sevan }
1101 1.1 sevan }
1102 1.1 sevan
1103 1.1 sevan return (error);
1104 1.1 sevan }
1105 1.1 sevan
1106 1.1 sevan /*
1107 1.1 sevan * Initialize the RX descriptor and attach an mbuf cluster.
1108 1.1 sevan */
1109 1.1 sevan int
1110 1.1 sevan rge_newbuf(struct rge_softc *sc, int idx)
1111 1.1 sevan {
1112 1.1 sevan struct mbuf *m;
1113 1.1 sevan struct rge_rx_desc *r;
1114 1.1 sevan struct rge_rxq *rxq;
1115 1.1 sevan bus_dmamap_t rxmap;
1116 1.1 sevan
1117 1.17 jakllsch m = MCLGETL(NULL, M_DONTWAIT, RGE_JUMBO_FRAMELEN);
1118 1.1 sevan if (m == NULL)
1119 1.1 sevan return (ENOBUFS);
1120 1.1 sevan
1121 1.1 sevan m->m_len = m->m_pkthdr.len = RGE_JUMBO_FRAMELEN;
1122 1.1 sevan
1123 1.1 sevan rxq = &sc->rge_ldata.rge_rxq[idx];
1124 1.1 sevan rxmap = rxq->rxq_dmamap;
1125 1.1 sevan
1126 1.1 sevan if (bus_dmamap_load_mbuf(sc->sc_dmat, rxmap, m, BUS_DMA_NOWAIT))
1127 1.1 sevan goto out;
1128 1.1 sevan
1129 1.1 sevan bus_dmamap_sync(sc->sc_dmat, rxmap, 0, rxmap->dm_mapsize,
1130 1.1 sevan BUS_DMASYNC_PREREAD);
1131 1.1 sevan
1132 1.1 sevan /* Map the segments into RX descriptors. */
1133 1.1 sevan r = &sc->rge_ldata.rge_rx_list[idx];
1134 1.1 sevan
1135 1.1 sevan rxq->rxq_mbuf = m;
1136 1.1 sevan
1137 1.25 nonaka r->hi_qword1.rx_qword4.rge_extsts = 0;
1138 1.25 nonaka r->hi_qword0.rge_addr = htole64(rxmap->dm_segs[0].ds_addr);
1139 1.1 sevan
1140 1.25 nonaka r->hi_qword1.rx_qword4.rge_cmdsts = htole32(rxmap->dm_segs[0].ds_len);
1141 1.1 sevan if (idx == RGE_RX_LIST_CNT - 1)
1142 1.25 nonaka r->hi_qword1.rx_qword4.rge_cmdsts |= htole32(RGE_RDCMDSTS_EOR);
1143 1.1 sevan
1144 1.25 nonaka r->hi_qword1.rx_qword4.rge_cmdsts |= htole32(RGE_RDCMDSTS_OWN);
1145 1.1 sevan
1146 1.1 sevan bus_dmamap_sync(sc->sc_dmat, sc->rge_ldata.rge_rx_list_map,
1147 1.1 sevan idx * sizeof(struct rge_rx_desc), sizeof(struct rge_rx_desc),
1148 1.1 sevan BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1149 1.1 sevan
1150 1.1 sevan return (0);
1151 1.1 sevan out:
1152 1.1 sevan if (m != NULL)
1153 1.1 sevan m_freem(m);
1154 1.1 sevan return (ENOMEM);
1155 1.1 sevan }
1156 1.1 sevan
1157 1.1 sevan void
1158 1.1 sevan rge_discard_rxbuf(struct rge_softc *sc, int idx)
1159 1.1 sevan {
1160 1.1 sevan struct rge_rx_desc *r;
1161 1.1 sevan
1162 1.1 sevan r = &sc->rge_ldata.rge_rx_list[idx];
1163 1.1 sevan
1164 1.25 nonaka r->hi_qword1.rx_qword4.rge_cmdsts = htole32(RGE_JUMBO_FRAMELEN);
1165 1.25 nonaka r->hi_qword1.rx_qword4.rge_extsts = 0;
1166 1.1 sevan if (idx == RGE_RX_LIST_CNT - 1)
1167 1.25 nonaka r->hi_qword1.rx_qword4.rge_cmdsts |= htole32(RGE_RDCMDSTS_EOR);
1168 1.25 nonaka r->hi_qword1.rx_qword4.rge_cmdsts |= htole32(RGE_RDCMDSTS_OWN);
1169 1.1 sevan
1170 1.1 sevan bus_dmamap_sync(sc->sc_dmat, sc->rge_ldata.rge_rx_list_map,
1171 1.1 sevan idx * sizeof(struct rge_rx_desc), sizeof(struct rge_rx_desc),
1172 1.1 sevan BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1173 1.1 sevan }
1174 1.1 sevan
1175 1.1 sevan int
1176 1.1 sevan rge_rx_list_init(struct rge_softc *sc)
1177 1.1 sevan {
1178 1.1 sevan int i;
1179 1.1 sevan
1180 1.1 sevan memset(sc->rge_ldata.rge_rx_list, 0, RGE_RX_LIST_SZ);
1181 1.1 sevan
1182 1.1 sevan for (i = 0; i < RGE_RX_LIST_CNT; i++) {
1183 1.1 sevan sc->rge_ldata.rge_rxq[i].rxq_mbuf = NULL;
1184 1.1 sevan if (rge_newbuf(sc, i) == ENOBUFS)
1185 1.1 sevan return (ENOBUFS);
1186 1.1 sevan }
1187 1.1 sevan
1188 1.17 jakllsch sc->rge_ldata.rge_rxq_prodidx = sc->rge_ldata.rge_rxq_considx = 0;
1189 1.1 sevan sc->rge_head = sc->rge_tail = NULL;
1190 1.1 sevan
1191 1.1 sevan return (0);
1192 1.1 sevan }
1193 1.1 sevan
1194 1.1 sevan void
1195 1.1 sevan rge_tx_list_init(struct rge_softc *sc)
1196 1.1 sevan {
1197 1.1 sevan int i;
1198 1.1 sevan
1199 1.1 sevan memset(sc->rge_ldata.rge_tx_list, 0, RGE_TX_LIST_SZ);
1200 1.1 sevan
1201 1.1 sevan for (i = 0; i < RGE_TX_LIST_CNT; i++)
1202 1.1 sevan sc->rge_ldata.rge_txq[i].txq_mbuf = NULL;
1203 1.1 sevan
1204 1.1 sevan bus_dmamap_sync(sc->sc_dmat, sc->rge_ldata.rge_tx_list_map, 0,
1205 1.1 sevan sc->rge_ldata.rge_tx_list_map->dm_mapsize,
1206 1.1 sevan BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1207 1.1 sevan
1208 1.1 sevan sc->rge_ldata.rge_txq_prodidx = sc->rge_ldata.rge_txq_considx = 0;
1209 1.1 sevan }
1210 1.1 sevan
1211 1.1 sevan int
1212 1.1 sevan rge_rxeof(struct rge_softc *sc)
1213 1.1 sevan {
1214 1.1 sevan struct mbuf *m;
1215 1.2 sevan struct ifnet *ifp = &sc->sc_ec.ec_if;
1216 1.1 sevan struct rge_rx_desc *cur_rx;
1217 1.1 sevan struct rge_rxq *rxq;
1218 1.1 sevan uint32_t rxstat, extsts;
1219 1.1 sevan int i, total_len, rx = 0;
1220 1.1 sevan
1221 1.17 jakllsch for (i = sc->rge_ldata.rge_rxq_considx; ; i = RGE_NEXT_RX_DESC(i)) {
1222 1.1 sevan /* Invalidate the descriptor memory. */
1223 1.1 sevan bus_dmamap_sync(sc->sc_dmat, sc->rge_ldata.rge_rx_list_map,
1224 1.1 sevan i * sizeof(struct rge_rx_desc), sizeof(struct rge_rx_desc),
1225 1.1 sevan BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1226 1.1 sevan
1227 1.1 sevan cur_rx = &sc->rge_ldata.rge_rx_list[i];
1228 1.1 sevan
1229 1.1 sevan if (RGE_OWN(cur_rx))
1230 1.1 sevan break;
1231 1.1 sevan
1232 1.25 nonaka rxstat = letoh32(cur_rx->hi_qword1.rx_qword4.rge_cmdsts);
1233 1.25 nonaka extsts = letoh32(cur_rx->hi_qword1.rx_qword4.rge_extsts);
1234 1.5 skrll
1235 1.1 sevan total_len = RGE_RXBYTES(cur_rx);
1236 1.1 sevan rxq = &sc->rge_ldata.rge_rxq[i];
1237 1.1 sevan m = rxq->rxq_mbuf;
1238 1.17 jakllsch rxq->rxq_mbuf = NULL;
1239 1.1 sevan rx = 1;
1240 1.1 sevan
1241 1.1 sevan /* Invalidate the RX mbuf and unload its map. */
1242 1.1 sevan bus_dmamap_sync(sc->sc_dmat, rxq->rxq_dmamap, 0,
1243 1.1 sevan rxq->rxq_dmamap->dm_mapsize, BUS_DMASYNC_POSTREAD);
1244 1.1 sevan bus_dmamap_unload(sc->sc_dmat, rxq->rxq_dmamap);
1245 1.1 sevan
1246 1.1 sevan if ((rxstat & (RGE_RDCMDSTS_SOF | RGE_RDCMDSTS_EOF)) !=
1247 1.1 sevan (RGE_RDCMDSTS_SOF | RGE_RDCMDSTS_EOF)) {
1248 1.1 sevan rge_discard_rxbuf(sc, i);
1249 1.1 sevan continue;
1250 1.1 sevan }
1251 1.1 sevan
1252 1.1 sevan if (rxstat & RGE_RDCMDSTS_RXERRSUM) {
1253 1.4 skrll if_statinc(ifp, if_ierrors);
1254 1.1 sevan /*
1255 1.1 sevan * If this is part of a multi-fragment packet,
1256 1.1 sevan * discard all the pieces.
1257 1.1 sevan */
1258 1.1 sevan if (sc->rge_head != NULL) {
1259 1.1 sevan m_freem(sc->rge_head);
1260 1.1 sevan sc->rge_head = sc->rge_tail = NULL;
1261 1.1 sevan }
1262 1.1 sevan rge_discard_rxbuf(sc, i);
1263 1.1 sevan continue;
1264 1.1 sevan }
1265 1.1 sevan
1266 1.1 sevan /*
1267 1.1 sevan * If allocating a replacement mbuf fails,
1268 1.1 sevan * reload the current one.
1269 1.1 sevan */
1270 1.1 sevan
1271 1.1 sevan if (rge_newbuf(sc, i) == ENOBUFS) {
1272 1.1 sevan if (sc->rge_head != NULL) {
1273 1.1 sevan m_freem(sc->rge_head);
1274 1.1 sevan sc->rge_head = sc->rge_tail = NULL;
1275 1.1 sevan }
1276 1.1 sevan rge_discard_rxbuf(sc, i);
1277 1.1 sevan continue;
1278 1.1 sevan }
1279 1.1 sevan
1280 1.17 jakllsch m_set_rcvif(m, ifp);
1281 1.1 sevan if (sc->rge_head != NULL) {
1282 1.1 sevan m->m_len = total_len;
1283 1.1 sevan /*
1284 1.1 sevan * Special case: if there's 4 bytes or less
1285 1.1 sevan * in this buffer, the mbuf can be discarded:
1286 1.1 sevan * the last 4 bytes is the CRC, which we don't
1287 1.1 sevan * care about anyway.
1288 1.1 sevan */
1289 1.1 sevan if (m->m_len <= ETHER_CRC_LEN) {
1290 1.1 sevan sc->rge_tail->m_len -=
1291 1.1 sevan (ETHER_CRC_LEN - m->m_len);
1292 1.1 sevan m_freem(m);
1293 1.1 sevan } else {
1294 1.1 sevan m->m_len -= ETHER_CRC_LEN;
1295 1.1 sevan m->m_flags &= ~M_PKTHDR;
1296 1.1 sevan sc->rge_tail->m_next = m;
1297 1.1 sevan }
1298 1.1 sevan m = sc->rge_head;
1299 1.1 sevan sc->rge_head = sc->rge_tail = NULL;
1300 1.1 sevan m->m_pkthdr.len = total_len - ETHER_CRC_LEN;
1301 1.1 sevan } else
1302 1.17 jakllsch #if 0
1303 1.1 sevan m->m_pkthdr.len = m->m_len =
1304 1.1 sevan (total_len - ETHER_CRC_LEN);
1305 1.17 jakllsch #else
1306 1.17 jakllsch {
1307 1.17 jakllsch m->m_pkthdr.len = m->m_len = total_len;
1308 1.17 jakllsch m->m_flags |= M_HASFCS;
1309 1.17 jakllsch }
1310 1.17 jakllsch #endif
1311 1.1 sevan
1312 1.17 jakllsch #if notyet
1313 1.1 sevan /* Check IP header checksum. */
1314 1.25 nonaka if (!(extsts & RGE_RDEXTSTS_IPCSUMERR) &&
1315 1.1 sevan (extsts & RGE_RDEXTSTS_IPV4))
1316 1.1 sevan m->m_pkthdr.csum_flags |= M_IPV4_CSUM_IN_OK;
1317 1.1 sevan
1318 1.1 sevan /* Check TCP/UDP checksum. */
1319 1.1 sevan if ((extsts & (RGE_RDEXTSTS_IPV4 | RGE_RDEXTSTS_IPV6)) &&
1320 1.25 nonaka (((extsts & RGE_RDEXTSTS_TCPPKT) &&
1321 1.25 nonaka !(extsts & RGE_RDEXTSTS_TCPCSUMERR)) ||
1322 1.25 nonaka ((extsts & RGE_RDEXTSTS_UDPPKT) &&
1323 1.25 nonaka !(extsts & RGE_RDEXTSTS_UDPCSUMERR))))
1324 1.1 sevan m->m_pkthdr.csum_flags |= M_TCP_CSUM_IN_OK |
1325 1.1 sevan M_UDP_CSUM_IN_OK;
1326 1.17 jakllsch #endif
1327 1.1 sevan
1328 1.1 sevan if (extsts & RGE_RDEXTSTS_VTAG) {
1329 1.17 jakllsch vlan_set_tag(m,
1330 1.17 jakllsch bswap16(extsts & RGE_RDEXTSTS_VLAN_MASK));
1331 1.1 sevan }
1332 1.1 sevan
1333 1.17 jakllsch if_percpuq_enqueue(ifp->if_percpuq, m);
1334 1.1 sevan }
1335 1.1 sevan
1336 1.17 jakllsch sc->rge_ldata.rge_rxq_considx = i;
1337 1.1 sevan
1338 1.1 sevan return (rx);
1339 1.1 sevan }
1340 1.1 sevan
1341 1.1 sevan int
1342 1.1 sevan rge_txeof(struct rge_softc *sc)
1343 1.1 sevan {
1344 1.2 sevan struct ifnet *ifp = &sc->sc_ec.ec_if;
1345 1.1 sevan struct rge_txq *txq;
1346 1.1 sevan uint32_t txstat;
1347 1.1 sevan int cons, idx, prod;
1348 1.1 sevan int free = 0;
1349 1.1 sevan
1350 1.1 sevan prod = sc->rge_ldata.rge_txq_prodidx;
1351 1.1 sevan cons = sc->rge_ldata.rge_txq_considx;
1352 1.1 sevan
1353 1.1 sevan while (prod != cons) {
1354 1.1 sevan txq = &sc->rge_ldata.rge_txq[cons];
1355 1.1 sevan idx = txq->txq_descidx;
1356 1.1 sevan
1357 1.1 sevan bus_dmamap_sync(sc->sc_dmat, sc->rge_ldata.rge_tx_list_map,
1358 1.1 sevan idx * sizeof(struct rge_tx_desc),
1359 1.1 sevan sizeof(struct rge_tx_desc),
1360 1.1 sevan BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1361 1.1 sevan
1362 1.1 sevan txstat = letoh32(sc->rge_ldata.rge_tx_list[idx].rge_cmdsts);
1363 1.1 sevan
1364 1.1 sevan if (txstat & RGE_TDCMDSTS_OWN) {
1365 1.1 sevan free = 2;
1366 1.1 sevan break;
1367 1.1 sevan }
1368 1.1 sevan
1369 1.5 skrll bus_dmamap_sync(sc->sc_dmat, txq->txq_dmamap, 0,
1370 1.1 sevan txq->txq_dmamap->dm_mapsize, BUS_DMASYNC_POSTWRITE);
1371 1.1 sevan bus_dmamap_unload(sc->sc_dmat, txq->txq_dmamap);
1372 1.1 sevan m_freem(txq->txq_mbuf);
1373 1.1 sevan txq->txq_mbuf = NULL;
1374 1.1 sevan
1375 1.1 sevan if (txstat & (RGE_TDCMDSTS_EXCESSCOLL | RGE_TDCMDSTS_COLL))
1376 1.4 skrll if_statinc(ifp, if_collisions);
1377 1.1 sevan if (txstat & RGE_TDCMDSTS_TXERR)
1378 1.4 skrll if_statinc(ifp, if_oerrors);
1379 1.1 sevan
1380 1.1 sevan bus_dmamap_sync(sc->sc_dmat, sc->rge_ldata.rge_tx_list_map,
1381 1.1 sevan idx * sizeof(struct rge_tx_desc),
1382 1.1 sevan sizeof(struct rge_tx_desc),
1383 1.1 sevan BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1384 1.1 sevan
1385 1.1 sevan cons = RGE_NEXT_TX_DESC(idx);
1386 1.1 sevan free = 1;
1387 1.1 sevan }
1388 1.1 sevan
1389 1.1 sevan if (free == 0)
1390 1.1 sevan return (0);
1391 1.1 sevan
1392 1.1 sevan sc->rge_ldata.rge_txq_considx = cons;
1393 1.1 sevan
1394 1.17 jakllsch #if 0
1395 1.1 sevan if (ifq_is_oactive(&ifp->if_snd))
1396 1.1 sevan ifq_restart(&ifp->if_snd);
1397 1.1 sevan else if (free == 2)
1398 1.1 sevan ifq_serialize(&ifp->if_snd, &sc->sc_task);
1399 1.1 sevan else
1400 1.1 sevan ifp->if_timer = 0;
1401 1.17 jakllsch #else
1402 1.17 jakllsch #if 0
1403 1.17 jakllsch if (!IF_IS_EMPTY(&ifp->if_snd))
1404 1.17 jakllsch rge_start(ifp);
1405 1.17 jakllsch else
1406 1.17 jakllsch if (free == 2)
1407 1.17 jakllsch if (0) { rge_txstart(&sc->sc_task, sc); }
1408 1.17 jakllsch else
1409 1.17 jakllsch #endif
1410 1.17 jakllsch ifp->if_timer = 0;
1411 1.17 jakllsch #endif
1412 1.1 sevan
1413 1.1 sevan return (1);
1414 1.1 sevan }
1415 1.1 sevan
1416 1.1 sevan void
1417 1.1 sevan rge_reset(struct rge_softc *sc)
1418 1.1 sevan {
1419 1.1 sevan int i;
1420 1.1 sevan
1421 1.1 sevan /* Enable RXDV gate. */
1422 1.1 sevan RGE_SETBIT_1(sc, RGE_PPSW, 0x08);
1423 1.1 sevan DELAY(2000);
1424 1.1 sevan
1425 1.17 jakllsch for (i = 0; i < 3000; i++) {
1426 1.17 jakllsch DELAY(50);
1427 1.1 sevan if ((RGE_READ_1(sc, RGE_MCUCMD) & (RGE_MCUCMD_RXFIFO_EMPTY |
1428 1.1 sevan RGE_MCUCMD_TXFIFO_EMPTY)) == (RGE_MCUCMD_RXFIFO_EMPTY |
1429 1.1 sevan RGE_MCUCMD_TXFIFO_EMPTY))
1430 1.1 sevan break;
1431 1.1 sevan }
1432 1.17 jakllsch if (sc->rge_type == MAC_CFG4 || sc->rge_type == MAC_CFG5) {
1433 1.17 jakllsch for (i = 0; i < 3000; i++) {
1434 1.17 jakllsch DELAY(50);
1435 1.17 jakllsch if ((RGE_READ_2(sc, RGE_IM) & 0x0103) == 0x0103)
1436 1.17 jakllsch break;
1437 1.17 jakllsch }
1438 1.17 jakllsch }
1439 1.17 jakllsch
1440 1.17 jakllsch DELAY(2000);
1441 1.1 sevan
1442 1.1 sevan /* Soft reset. */
1443 1.1 sevan RGE_WRITE_1(sc, RGE_CMD, RGE_CMD_RESET);
1444 1.1 sevan
1445 1.1 sevan for (i = 0; i < RGE_TIMEOUT; i++) {
1446 1.1 sevan DELAY(100);
1447 1.1 sevan if (!(RGE_READ_1(sc, RGE_CMD) & RGE_CMD_RESET))
1448 1.1 sevan break;
1449 1.1 sevan }
1450 1.1 sevan if (i == RGE_TIMEOUT)
1451 1.16 jakllsch device_printf(sc->sc_dev, "reset never completed!\n");
1452 1.1 sevan }
1453 1.1 sevan
1454 1.1 sevan void
1455 1.1 sevan rge_iff(struct rge_softc *sc)
1456 1.1 sevan {
1457 1.2 sevan struct ifnet *ifp = &sc->sc_ec.ec_if;
1458 1.17 jakllsch struct ethercom *ec = &sc->sc_ec;
1459 1.1 sevan struct ether_multi *enm;
1460 1.1 sevan struct ether_multistep step;
1461 1.1 sevan uint32_t hashes[2];
1462 1.1 sevan uint32_t rxfilt;
1463 1.1 sevan int h = 0;
1464 1.1 sevan
1465 1.1 sevan rxfilt = RGE_READ_4(sc, RGE_RXCFG);
1466 1.1 sevan rxfilt &= ~(RGE_RXCFG_ALLPHYS | RGE_RXCFG_MULTI);
1467 1.1 sevan ifp->if_flags &= ~IFF_ALLMULTI;
1468 1.1 sevan
1469 1.1 sevan /*
1470 1.1 sevan * Always accept frames destined to our station address.
1471 1.1 sevan * Always accept broadcast frames.
1472 1.1 sevan */
1473 1.1 sevan rxfilt |= RGE_RXCFG_INDIV | RGE_RXCFG_BROAD;
1474 1.1 sevan
1475 1.17 jakllsch if (ifp->if_flags & IFF_PROMISC) {
1476 1.17 jakllsch allmulti:
1477 1.1 sevan ifp->if_flags |= IFF_ALLMULTI;
1478 1.1 sevan rxfilt |= RGE_RXCFG_MULTI;
1479 1.1 sevan if (ifp->if_flags & IFF_PROMISC)
1480 1.1 sevan rxfilt |= RGE_RXCFG_ALLPHYS;
1481 1.1 sevan hashes[0] = hashes[1] = 0xffffffff;
1482 1.1 sevan } else {
1483 1.1 sevan rxfilt |= RGE_RXCFG_MULTI;
1484 1.1 sevan /* Program new filter. */
1485 1.1 sevan memset(hashes, 0, sizeof(hashes));
1486 1.1 sevan
1487 1.17 jakllsch ETHER_LOCK(ec);
1488 1.17 jakllsch ETHER_FIRST_MULTI(step, ec, enm);
1489 1.1 sevan while (enm != NULL) {
1490 1.17 jakllsch if (memcmp(enm->enm_addrlo, enm->enm_addrhi,
1491 1.17 jakllsch ETHER_ADDR_LEN) != 0) {
1492 1.17 jakllsch ETHER_UNLOCK(ec);
1493 1.17 jakllsch goto allmulti;
1494 1.17 jakllsch }
1495 1.1 sevan h = ether_crc32_be(enm->enm_addrlo,
1496 1.1 sevan ETHER_ADDR_LEN) >> 26;
1497 1.1 sevan
1498 1.1 sevan if (h < 32)
1499 1.21 msaitoh hashes[0] |= (1U << h);
1500 1.1 sevan else
1501 1.21 msaitoh hashes[1] |= (1U << (h - 32));
1502 1.1 sevan
1503 1.1 sevan ETHER_NEXT_MULTI(step, enm);
1504 1.1 sevan }
1505 1.17 jakllsch ETHER_UNLOCK(ec);
1506 1.1 sevan }
1507 1.1 sevan
1508 1.1 sevan RGE_WRITE_4(sc, RGE_RXCFG, rxfilt);
1509 1.2 sevan RGE_WRITE_4(sc, RGE_MAR0, bswap32(hashes[1]));
1510 1.2 sevan RGE_WRITE_4(sc, RGE_MAR4, bswap32(hashes[0]));
1511 1.1 sevan }
1512 1.1 sevan
1513 1.1 sevan void
1514 1.1 sevan rge_set_phy_power(struct rge_softc *sc, int on)
1515 1.1 sevan {
1516 1.1 sevan int i;
1517 1.1 sevan
1518 1.1 sevan if (on) {
1519 1.1 sevan RGE_SETBIT_1(sc, RGE_PMCH, 0xc0);
1520 1.1 sevan
1521 1.1 sevan rge_write_phy(sc, 0, MII_BMCR, BMCR_AUTOEN);
1522 1.1 sevan
1523 1.1 sevan for (i = 0; i < RGE_TIMEOUT; i++) {
1524 1.10 sevan if ((rge_read_phy_ocp(sc, 0xa420) & 0x0007) == 3)
1525 1.1 sevan break;
1526 1.1 sevan DELAY(1000);
1527 1.1 sevan }
1528 1.17 jakllsch } else {
1529 1.1 sevan rge_write_phy(sc, 0, MII_BMCR, BMCR_AUTOEN | BMCR_PDOWN);
1530 1.17 jakllsch RGE_CLRBIT_1(sc, RGE_PMCH, 0x80);
1531 1.17 jakllsch RGE_CLRBIT_1(sc, RGE_PPSW, 0x40);
1532 1.17 jakllsch }
1533 1.1 sevan }
1534 1.1 sevan
1535 1.1 sevan void
1536 1.1 sevan rge_phy_config(struct rge_softc *sc)
1537 1.1 sevan {
1538 1.17 jakllsch /* Read microcode version. */
1539 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x801e);
1540 1.17 jakllsch sc->rge_mcodever = rge_read_phy_ocp(sc, 0xa438);
1541 1.17 jakllsch
1542 1.17 jakllsch switch (sc->rge_type) {
1543 1.17 jakllsch case MAC_CFG2:
1544 1.17 jakllsch rge_phy_config_mac_cfg2(sc);
1545 1.17 jakllsch break;
1546 1.17 jakllsch case MAC_CFG3:
1547 1.17 jakllsch rge_phy_config_mac_cfg3(sc);
1548 1.17 jakllsch break;
1549 1.17 jakllsch case MAC_CFG4:
1550 1.17 jakllsch rge_phy_config_mac_cfg4(sc);
1551 1.17 jakllsch break;
1552 1.17 jakllsch case MAC_CFG5:
1553 1.17 jakllsch rge_phy_config_mac_cfg5(sc);
1554 1.17 jakllsch break;
1555 1.17 jakllsch default:
1556 1.17 jakllsch break; /* Can't happen. */
1557 1.17 jakllsch }
1558 1.17 jakllsch
1559 1.17 jakllsch rge_write_phy(sc, 0x0a5b, 0x12,
1560 1.17 jakllsch rge_read_phy(sc, 0x0a5b, 0x12) & ~0x8000);
1561 1.17 jakllsch
1562 1.17 jakllsch /* Disable EEE. */
1563 1.17 jakllsch RGE_MAC_CLRBIT(sc, 0xe040, 0x0003);
1564 1.17 jakllsch if (sc->rge_type == MAC_CFG2 || sc->rge_type == MAC_CFG3) {
1565 1.17 jakllsch RGE_MAC_CLRBIT(sc, 0xeb62, 0x0006);
1566 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xa432, 0x0010);
1567 1.17 jakllsch }
1568 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xa5d0, 0x0006);
1569 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xa6d4, 0x0001);
1570 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xa6d8, 0x0010);
1571 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xa428, 0x0080);
1572 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xa4a2, 0x0200);
1573 1.17 jakllsch
1574 1.17 jakllsch rge_patch_phy_mcu(sc, 1);
1575 1.17 jakllsch RGE_MAC_CLRBIT(sc, 0xe052, 0x0001);
1576 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xa442, 0x3000);
1577 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xa430, 0x8000);
1578 1.17 jakllsch rge_patch_phy_mcu(sc, 0);
1579 1.17 jakllsch }
1580 1.17 jakllsch
1581 1.17 jakllsch void
1582 1.17 jakllsch rge_phy_config_mac_cfg2(struct rge_softc *sc)
1583 1.17 jakllsch {
1584 1.17 jakllsch uint16_t val;
1585 1.17 jakllsch int i;
1586 1.17 jakllsch
1587 1.17 jakllsch for (i = 0; i < nitems(rtl8125_mac_cfg2_ephy); i++)
1588 1.17 jakllsch rge_write_ephy(sc, rtl8125_mac_cfg2_ephy[i].reg,
1589 1.17 jakllsch rtl8125_mac_cfg2_ephy[i].val);
1590 1.17 jakllsch
1591 1.17 jakllsch rge_phy_config_mcu(sc, RGE_MAC_CFG2_MCODE_VER);
1592 1.17 jakllsch
1593 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xad40) & ~0x03ff;
1594 1.17 jakllsch rge_write_phy_ocp(sc, 0xad40, val | 0x0084);
1595 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xad4e, 0x0010);
1596 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xad16) & ~0x03ff;
1597 1.17 jakllsch rge_write_phy_ocp(sc, 0xad16, val | 0x0006);
1598 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xad32) & ~0x03ff;
1599 1.17 jakllsch rge_write_phy_ocp(sc, 0xad32, val | 0x0006);
1600 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xac08, 0x1100);
1601 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xac8a) & ~0xf000;
1602 1.17 jakllsch rge_write_phy_ocp(sc, 0xac8a, val | 0x7000);
1603 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xad18, 0x0400);
1604 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xad1a, 0x03ff);
1605 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xad1c, 0x03ff);
1606 1.17 jakllsch
1607 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80ea);
1608 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1609 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0xc400);
1610 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80eb);
1611 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0x0700;
1612 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x0300);
1613 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80f8);
1614 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1615 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x1c00);
1616 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80f1);
1617 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1618 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x3000);
1619 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80fe);
1620 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1621 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0xa500);
1622 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x8102);
1623 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1624 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x5000);
1625 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x8105);
1626 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1627 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x3300);
1628 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x8100);
1629 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1630 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x7000);
1631 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x8104);
1632 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1633 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0xf000);
1634 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x8106);
1635 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1636 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x6500);
1637 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80dc);
1638 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1639 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0xed00);
1640 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80df);
1641 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xa438, 0x0100);
1642 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80e1);
1643 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xa438, 0x0100);
1644 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xbf06) & ~0x003f;
1645 1.17 jakllsch rge_write_phy_ocp(sc, 0xbf06, val | 0x0038);
1646 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x819f);
1647 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0xd0b6);
1648 1.17 jakllsch rge_write_phy_ocp(sc, 0xbc34, 0x5555);
1649 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xbf0a) & ~0x0e00;
1650 1.17 jakllsch rge_write_phy_ocp(sc, 0xbf0a, val | 0x0a00);
1651 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xa5c0, 0x0400);
1652 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xa442, 0x0800);
1653 1.17 jakllsch }
1654 1.17 jakllsch
1655 1.17 jakllsch void
1656 1.17 jakllsch rge_phy_config_mac_cfg3(struct rge_softc *sc)
1657 1.17 jakllsch {
1658 1.17 jakllsch struct ifnet *ifp = &sc->sc_ec.ec_if;
1659 1.17 jakllsch uint16_t val;
1660 1.1 sevan int i;
1661 1.1 sevan static const uint16_t mac_cfg3_a438_value[] =
1662 1.1 sevan { 0x0043, 0x00a7, 0x00d6, 0x00ec, 0x00f6, 0x00fb, 0x00fd, 0x00ff,
1663 1.1 sevan 0x00bb, 0x0058, 0x0029, 0x0013, 0x0009, 0x0004, 0x0002 };
1664 1.1 sevan
1665 1.1 sevan static const uint16_t mac_cfg3_b88e_value[] =
1666 1.5 skrll { 0xc091, 0x6e12, 0xc092, 0x1214, 0xc094, 0x1516, 0xc096, 0x171b,
1667 1.1 sevan 0xc098, 0x1b1c, 0xc09a, 0x1f1f, 0xc09c, 0x2021, 0xc09e, 0x2224,
1668 1.1 sevan 0xc0a0, 0x2424, 0xc0a2, 0x2424, 0xc0a4, 0x2424, 0xc018, 0x0af2,
1669 1.1 sevan 0xc01a, 0x0d4a, 0xc01c, 0x0f26, 0xc01e, 0x118d, 0xc020, 0x14f3,
1670 1.1 sevan 0xc022, 0x175a, 0xc024, 0x19c0, 0xc026, 0x1c26, 0xc089, 0x6050,
1671 1.1 sevan 0xc08a, 0x5f6e, 0xc08c, 0x6e6e, 0xc08e, 0x6e6e, 0xc090, 0x6e12 };
1672 1.1 sevan
1673 1.17 jakllsch for (i = 0; i < nitems(rtl8125_mac_cfg3_ephy); i++)
1674 1.17 jakllsch rge_write_ephy(sc, rtl8125_mac_cfg3_ephy[i].reg,
1675 1.17 jakllsch rtl8125_mac_cfg3_ephy[i].val);
1676 1.17 jakllsch
1677 1.17 jakllsch val = rge_read_ephy(sc, 0x002a) & ~0x7000;
1678 1.17 jakllsch rge_write_ephy(sc, 0x002a, val | 0x3000);
1679 1.17 jakllsch RGE_EPHY_CLRBIT(sc, 0x0019, 0x0040);
1680 1.17 jakllsch RGE_EPHY_SETBIT(sc, 0x001b, 0x0e00);
1681 1.17 jakllsch RGE_EPHY_CLRBIT(sc, 0x001b, 0x7000);
1682 1.17 jakllsch rge_write_ephy(sc, 0x0002, 0x6042);
1683 1.17 jakllsch rge_write_ephy(sc, 0x0006, 0x0014);
1684 1.17 jakllsch val = rge_read_ephy(sc, 0x006a) & ~0x7000;
1685 1.17 jakllsch rge_write_ephy(sc, 0x006a, val | 0x3000);
1686 1.17 jakllsch RGE_EPHY_CLRBIT(sc, 0x0059, 0x0040);
1687 1.17 jakllsch RGE_EPHY_SETBIT(sc, 0x005b, 0x0e00);
1688 1.17 jakllsch RGE_EPHY_CLRBIT(sc, 0x005b, 0x7000);
1689 1.17 jakllsch rge_write_ephy(sc, 0x0042, 0x6042);
1690 1.17 jakllsch rge_write_ephy(sc, 0x0046, 0x0014);
1691 1.17 jakllsch
1692 1.17 jakllsch rge_phy_config_mcu(sc, RGE_MAC_CFG3_MCODE_VER);
1693 1.17 jakllsch
1694 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xad4e, 0x0010);
1695 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xad16) & ~0x03ff;
1696 1.17 jakllsch rge_write_phy_ocp(sc, 0xad16, val | 0x03ff);
1697 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xad32) & ~0x003f;
1698 1.17 jakllsch rge_write_phy_ocp(sc, 0xad32, val | 0x0006);
1699 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xac08, 0x1000);
1700 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xac08, 0x0100);
1701 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xacc0) & ~0x0003;
1702 1.17 jakllsch rge_write_phy_ocp(sc, 0xacc0, val | 0x0002);
1703 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xad40) & ~0x00e0;
1704 1.17 jakllsch rge_write_phy_ocp(sc, 0xad40, val | 0x0040);
1705 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xad40) & ~0x0007;
1706 1.17 jakllsch rge_write_phy_ocp(sc, 0xad40, val | 0x0004);
1707 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xac14, 0x0080);
1708 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xac80, 0x0300);
1709 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xac5e) & ~0x0007;
1710 1.17 jakllsch rge_write_phy_ocp(sc, 0xac5e, val | 0x0002);
1711 1.17 jakllsch rge_write_phy_ocp(sc, 0xad4c, 0x00a8);
1712 1.17 jakllsch rge_write_phy_ocp(sc, 0xac5c, 0x01ff);
1713 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xac8a) & ~0x00f0;
1714 1.17 jakllsch rge_write_phy_ocp(sc, 0xac8a, val | 0x0030);
1715 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x8157);
1716 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xb87e) & ~0xff00;
1717 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, val | 0x0500);
1718 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x8159);
1719 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xb87e) & ~0xff00;
1720 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, val | 0x0700);
1721 1.17 jakllsch RGE_WRITE_2(sc, RGE_EEE_TXIDLE_TIMER, ifp->if_mtu + ETHER_HDR_LEN +
1722 1.17 jakllsch 32);
1723 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x80a2);
1724 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x0153);
1725 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x809c);
1726 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x0153);
1727 1.17 jakllsch
1728 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x81b3);
1729 1.17 jakllsch for (i = 0; i < nitems(mac_cfg3_a438_value); i++)
1730 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, mac_cfg3_a438_value[i]);
1731 1.17 jakllsch for (i = 0; i < 26; i++)
1732 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0);
1733 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x8257);
1734 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x020f);
1735 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80ea);
1736 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x7843);
1737 1.17 jakllsch
1738 1.17 jakllsch rge_patch_phy_mcu(sc, 1);
1739 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xb896, 0x0001);
1740 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xb892, 0xff00);
1741 1.17 jakllsch for (i = 0; i < nitems(mac_cfg3_b88e_value); i += 2) {
1742 1.17 jakllsch rge_write_phy_ocp(sc, 0xb88e, mac_cfg3_b88e_value[i]);
1743 1.17 jakllsch rge_write_phy_ocp(sc, 0xb890, mac_cfg3_b88e_value[i + 1]);
1744 1.17 jakllsch }
1745 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xb896, 0x0001);
1746 1.17 jakllsch rge_patch_phy_mcu(sc, 0);
1747 1.17 jakllsch
1748 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xd068, 0x2000);
1749 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x81a2);
1750 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xa438, 0x0100);
1751 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xb54c) & ~0xff00;
1752 1.17 jakllsch rge_write_phy_ocp(sc, 0xb54c, val | 0xdb00);
1753 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xa454, 0x0001);
1754 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xa5d4, 0x0020);
1755 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xad4e, 0x0010);
1756 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xa86a, 0x0001);
1757 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xa442, 0x0800);
1758 1.17 jakllsch }
1759 1.17 jakllsch
1760 1.17 jakllsch void
1761 1.17 jakllsch rge_phy_config_mac_cfg4(struct rge_softc *sc)
1762 1.17 jakllsch {
1763 1.17 jakllsch struct ifnet *ifp = &sc->sc_ec.ec_if;
1764 1.17 jakllsch uint16_t val;
1765 1.17 jakllsch int i;
1766 1.17 jakllsch static const uint16_t mac_cfg4_b87c_value[] =
1767 1.23 skrll { 0x8013, 0x0700, 0x8fb9, 0x2801, 0x8fba, 0x0100, 0x8fbc, 0x1900,
1768 1.23 skrll 0x8fbe, 0xe100, 0x8fc0, 0x0800, 0x8fc2, 0xe500, 0x8fc4, 0x0f00,
1769 1.23 skrll 0x8fc6, 0xf100, 0x8fc8, 0x0400, 0x8fca, 0xf300, 0x8fcc, 0xfd00,
1770 1.23 skrll 0x8fce, 0xff00, 0x8fd0, 0xfb00, 0x8fd2, 0x0100, 0x8fd4, 0xf400,
1771 1.23 skrll 0x8fd6, 0xff00, 0x8fd8, 0xf600, 0x813d, 0x390e, 0x814f, 0x790e,
1772 1.17 jakllsch 0x80b0, 0x0f31 };
1773 1.17 jakllsch
1774 1.17 jakllsch for (i = 0; i < nitems(rtl8125_mac_cfg4_ephy); i++)
1775 1.17 jakllsch rge_write_ephy(sc, rtl8125_mac_cfg4_ephy[i].reg,
1776 1.17 jakllsch rtl8125_mac_cfg4_ephy[i].val);
1777 1.17 jakllsch
1778 1.17 jakllsch rge_write_phy_ocp(sc, 0xbf86, 0x9000);
1779 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xc402, 0x0400);
1780 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xc402, 0x0400);
1781 1.17 jakllsch rge_write_phy_ocp(sc, 0xbd86, 0x1010);
1782 1.17 jakllsch rge_write_phy_ocp(sc, 0xbd88, 0x1010);
1783 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xbd4e) & ~0x0c00;
1784 1.17 jakllsch rge_write_phy_ocp(sc, 0xbd4e, val | 0x0800);
1785 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xbf46) & ~0x0f00;
1786 1.17 jakllsch rge_write_phy_ocp(sc, 0xbf46, val | 0x0700);
1787 1.17 jakllsch
1788 1.17 jakllsch rge_phy_config_mcu(sc, RGE_MAC_CFG4_MCODE_VER);
1789 1.17 jakllsch
1790 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xa442, 0x0800);
1791 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xbc08, 0x000c);
1792 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x8fff);
1793 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1794 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x0400);
1795 1.17 jakllsch for (i = 0; i < 6; i++) {
1796 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x8560 + i * 2);
1797 1.17 jakllsch if (i < 3)
1798 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x19cc);
1799 1.17 jakllsch else
1800 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x147d);
1801 1.17 jakllsch }
1802 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x8ffe);
1803 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x0907);
1804 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xacda) & ~0xff00;
1805 1.17 jakllsch rge_write_phy_ocp(sc, 0xacda, val | 0xff00);
1806 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xacde) & ~0xf000;
1807 1.17 jakllsch rge_write_phy_ocp(sc, 0xacde, val | 0xf000);
1808 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x80d6);
1809 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x2801);
1810 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x80F2);
1811 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x2801);
1812 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x80f4);
1813 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x6077);
1814 1.17 jakllsch rge_write_phy_ocp(sc, 0xb506, 0x01e7);
1815 1.17 jakllsch rge_write_phy_ocp(sc, 0xac8c, 0x0ffc);
1816 1.17 jakllsch rge_write_phy_ocp(sc, 0xac46, 0xb7b4);
1817 1.17 jakllsch rge_write_phy_ocp(sc, 0xac50, 0x0fbc);
1818 1.17 jakllsch rge_write_phy_ocp(sc, 0xac3c, 0x9240);
1819 1.17 jakllsch rge_write_phy_ocp(sc, 0xac4E, 0x0db4);
1820 1.17 jakllsch rge_write_phy_ocp(sc, 0xacc6, 0x0707);
1821 1.17 jakllsch rge_write_phy_ocp(sc, 0xacc8, 0xa0d3);
1822 1.17 jakllsch rge_write_phy_ocp(sc, 0xad08, 0x0007);
1823 1.17 jakllsch for (i = 0; i < nitems(mac_cfg4_b87c_value); i += 2) {
1824 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, mac_cfg4_b87c_value[i]);
1825 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, mac_cfg4_b87c_value[i + 1]);
1826 1.17 jakllsch }
1827 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xbf4c, 0x0002);
1828 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xbcca, 0x0300);
1829 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x8141);
1830 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x320e);
1831 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x8153);
1832 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x720e);
1833 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xa432, 0x0040);
1834 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x8529);
1835 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x050e);
1836 1.17 jakllsch RGE_WRITE_2(sc, RGE_EEE_TXIDLE_TIMER, ifp->if_mtu + ETHER_HDR_LEN +
1837 1.17 jakllsch 32);
1838 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x816c);
1839 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0xc4a0);
1840 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x8170);
1841 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0xc4a0);
1842 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x8174);
1843 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x04a0);
1844 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x8178);
1845 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x04a0);
1846 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x817c);
1847 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x0719);
1848 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x8ff4);
1849 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x0400);
1850 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x8ff1);
1851 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x0404);
1852 1.17 jakllsch rge_write_phy_ocp(sc, 0xbf4a, 0x001b);
1853 1.17 jakllsch for (i = 0; i < 6; i++) {
1854 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x8033 + i * 4);
1855 1.17 jakllsch if (i == 2)
1856 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0xfc32);
1857 1.17 jakllsch else
1858 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x7c13);
1859 1.17 jakllsch }
1860 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x8145);
1861 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x370e);
1862 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x8157);
1863 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x770e);
1864 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x8169);
1865 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x0d0a);
1866 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x817b);
1867 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x1d0a);
1868 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x8217);
1869 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1870 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x5000);
1871 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x821a);
1872 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1873 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x5000);
1874 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80da);
1875 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x0403);
1876 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80dc);
1877 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1878 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x1000);
1879 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80b3);
1880 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x0384);
1881 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80b7);
1882 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x2007);
1883 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80ba);
1884 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1885 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x6c00);
1886 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80b5);
1887 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0xf009);
1888 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80bd);
1889 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1890 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x9f00);
1891 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80c7);
1892 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0xf083);
1893 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80dd);
1894 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x03f0);
1895 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80df);
1896 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1897 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x1000);
1898 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80cb);
1899 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x2007);
1900 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80ce);
1901 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1902 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x6c00);
1903 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80c9);
1904 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x8009);
1905 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80d1);
1906 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1907 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0x8000);
1908 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80a3);
1909 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x200a);
1910 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80a5);
1911 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0xf0ad);
1912 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x809f);
1913 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x6073);
1914 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80a1);
1915 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x000b);
1916 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x80a9);
1917 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
1918 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, val | 0xc000);
1919 1.17 jakllsch rge_patch_phy_mcu(sc, 1);
1920 1.23 skrll RGE_PHY_CLRBIT(sc, 0xb896, 0x0001);
1921 1.23 skrll RGE_PHY_CLRBIT(sc, 0xb892, 0xff00);
1922 1.17 jakllsch rge_write_phy_ocp(sc, 0xb88e, 0xc23e);
1923 1.17 jakllsch rge_write_phy_ocp(sc, 0xb890, 0x0000);
1924 1.17 jakllsch rge_write_phy_ocp(sc, 0xb88e, 0xc240);
1925 1.17 jakllsch rge_write_phy_ocp(sc, 0xb890, 0x0103);
1926 1.17 jakllsch rge_write_phy_ocp(sc, 0xb88e, 0xc242);
1927 1.17 jakllsch rge_write_phy_ocp(sc, 0xb890, 0x0507);
1928 1.17 jakllsch rge_write_phy_ocp(sc, 0xb88e, 0xc244);
1929 1.17 jakllsch rge_write_phy_ocp(sc, 0xb890, 0x090b);
1930 1.17 jakllsch rge_write_phy_ocp(sc, 0xb88e, 0xc246);
1931 1.17 jakllsch rge_write_phy_ocp(sc, 0xb890, 0x0c0e);
1932 1.17 jakllsch rge_write_phy_ocp(sc, 0xb88e, 0xc248);
1933 1.17 jakllsch rge_write_phy_ocp(sc, 0xb890, 0x1012);
1934 1.17 jakllsch rge_write_phy_ocp(sc, 0xb88e, 0xc24a);
1935 1.17 jakllsch rge_write_phy_ocp(sc, 0xb890, 0x1416);
1936 1.23 skrll RGE_PHY_SETBIT(sc, 0xb896, 0x0001);
1937 1.17 jakllsch rge_patch_phy_mcu(sc, 0);
1938 1.23 skrll RGE_PHY_SETBIT(sc, 0xa86a, 0x0001);
1939 1.23 skrll RGE_PHY_SETBIT(sc, 0xa6f0, 0x0001);
1940 1.17 jakllsch rge_write_phy_ocp(sc, 0xbfa0, 0xd70d);
1941 1.17 jakllsch rge_write_phy_ocp(sc, 0xbfa2, 0x4100);
1942 1.17 jakllsch rge_write_phy_ocp(sc, 0xbfa4, 0xe868);
1943 1.17 jakllsch rge_write_phy_ocp(sc, 0xbfa6, 0xdc59);
1944 1.17 jakllsch rge_write_phy_ocp(sc, 0xb54c, 0x3c18);
1945 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xbfa4, 0x0020);
1946 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x817d);
1947 1.23 skrll RGE_PHY_SETBIT(sc, 0xa438, 0x1000);
1948 1.17 jakllsch }
1949 1.17 jakllsch
1950 1.17 jakllsch void
1951 1.17 jakllsch rge_phy_config_mac_cfg5(struct rge_softc *sc)
1952 1.17 jakllsch {
1953 1.17 jakllsch struct ifnet *ifp = &sc->sc_ec.ec_if;
1954 1.17 jakllsch uint16_t val;
1955 1.17 jakllsch int i;
1956 1.1 sevan
1957 1.17 jakllsch for (i = 0; i < nitems(rtl8125_mac_cfg5_ephy); i++)
1958 1.17 jakllsch rge_write_ephy(sc, rtl8125_mac_cfg5_ephy[i].reg,
1959 1.17 jakllsch rtl8125_mac_cfg5_ephy[i].val);
1960 1.17 jakllsch
1961 1.17 jakllsch val = rge_read_ephy(sc, 0x0022) & ~0x0030;
1962 1.17 jakllsch rge_write_ephy(sc, 0x0022, val | 0x0020);
1963 1.17 jakllsch val = rge_read_ephy(sc, 0x0062) & ~0x0030;
1964 1.17 jakllsch rge_write_ephy(sc, 0x0062, val | 0x0020);
1965 1.17 jakllsch
1966 1.17 jakllsch rge_phy_config_mcu(sc, RGE_MAC_CFG5_MCODE_VER);
1967 1.17 jakllsch
1968 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xa442, 0x0800);
1969 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xac46) & ~0x00f0;
1970 1.17 jakllsch rge_write_phy_ocp(sc, 0xac46, val | 0x0090);
1971 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xad30) & ~0x0003;
1972 1.17 jakllsch rge_write_phy_ocp(sc, 0xad30, val | 0x0001);
1973 1.17 jakllsch RGE_WRITE_2(sc, RGE_EEE_TXIDLE_TIMER, ifp->if_mtu + ETHER_HDR_LEN +
1974 1.17 jakllsch 32);
1975 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x80f5);
1976 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x760e);
1977 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x8107);
1978 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, 0x360e);
1979 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87c, 0x8551);
1980 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xb87e) & ~0xff00;
1981 1.17 jakllsch rge_write_phy_ocp(sc, 0xb87e, val | 0x0800);
1982 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xbf00) & ~0xe000;
1983 1.17 jakllsch rge_write_phy_ocp(sc, 0xbf00, val | 0xa000);
1984 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xbf46) & ~0x0f00;
1985 1.17 jakllsch rge_write_phy_ocp(sc, 0xbf46, val | 0x0300);
1986 1.17 jakllsch for (i = 0; i < 10; i++) {
1987 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x8044 + i * 6);
1988 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x2417);
1989 1.17 jakllsch }
1990 1.17 jakllsch RGE_PHY_SETBIT(sc, 0xa4ca, 0x0040);
1991 1.17 jakllsch val = rge_read_phy_ocp(sc, 0xbf84) & ~0xe000;
1992 1.17 jakllsch rge_write_phy_ocp(sc, 0xbf84, val | 0xa000);
1993 1.17 jakllsch }
1994 1.1 sevan
1995 1.17 jakllsch void
1996 1.17 jakllsch rge_phy_config_mcu(struct rge_softc *sc, uint16_t mcode_version)
1997 1.17 jakllsch {
1998 1.17 jakllsch if (sc->rge_mcodever != mcode_version) {
1999 1.17 jakllsch int i;
2000 1.1 sevan
2001 1.17 jakllsch rge_patch_phy_mcu(sc, 1);
2002 1.1 sevan
2003 1.17 jakllsch if (sc->rge_type == MAC_CFG2 || sc->rge_type == MAC_CFG3) {
2004 1.1 sevan rge_write_phy_ocp(sc, 0xa436, 0x8024);
2005 1.17 jakllsch if (sc->rge_type == MAC_CFG2)
2006 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x8600);
2007 1.17 jakllsch else
2008 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, 0x8601);
2009 1.1 sevan rge_write_phy_ocp(sc, 0xa436, 0xb82e);
2010 1.1 sevan rge_write_phy_ocp(sc, 0xa438, 0x0001);
2011 1.1 sevan
2012 1.1 sevan RGE_PHY_SETBIT(sc, 0xb820, 0x0080);
2013 1.17 jakllsch }
2014 1.17 jakllsch
2015 1.17 jakllsch if (sc->rge_type == MAC_CFG2) {
2016 1.1 sevan for (i = 0; i < nitems(rtl8125_mac_cfg2_mcu); i++) {
2017 1.1 sevan rge_write_phy_ocp(sc,
2018 1.1 sevan rtl8125_mac_cfg2_mcu[i].reg,
2019 1.1 sevan rtl8125_mac_cfg2_mcu[i].val);
2020 1.1 sevan }
2021 1.17 jakllsch } else if (sc->rge_type == MAC_CFG3) {
2022 1.1 sevan for (i = 0; i < nitems(rtl8125_mac_cfg3_mcu); i++) {
2023 1.1 sevan rge_write_phy_ocp(sc,
2024 1.1 sevan rtl8125_mac_cfg3_mcu[i].reg,
2025 1.1 sevan rtl8125_mac_cfg3_mcu[i].val);
2026 1.1 sevan }
2027 1.17 jakllsch } else if (sc->rge_type == MAC_CFG4) {
2028 1.17 jakllsch for (i = 0; i < nitems(rtl8125_mac_cfg4_mcu); i++) {
2029 1.17 jakllsch rge_write_phy_ocp(sc,
2030 1.17 jakllsch rtl8125_mac_cfg4_mcu[i].reg,
2031 1.17 jakllsch rtl8125_mac_cfg4_mcu[i].val);
2032 1.17 jakllsch }
2033 1.17 jakllsch } else if (sc->rge_type == MAC_CFG5) {
2034 1.17 jakllsch for (i = 0; i < nitems(rtl8125_mac_cfg5_mcu); i++) {
2035 1.17 jakllsch rge_write_phy_ocp(sc,
2036 1.17 jakllsch rtl8125_mac_cfg5_mcu[i].reg,
2037 1.17 jakllsch rtl8125_mac_cfg5_mcu[i].val);
2038 1.17 jakllsch }
2039 1.17 jakllsch }
2040 1.17 jakllsch
2041 1.17 jakllsch if (sc->rge_type == MAC_CFG2 || sc->rge_type == MAC_CFG3) {
2042 1.1 sevan RGE_PHY_CLRBIT(sc, 0xb820, 0x0080);
2043 1.1 sevan
2044 1.1 sevan rge_write_phy_ocp(sc, 0xa436, 0);
2045 1.1 sevan rge_write_phy_ocp(sc, 0xa438, 0);
2046 1.1 sevan RGE_PHY_CLRBIT(sc, 0xb82e, 0x0001);
2047 1.1 sevan rge_write_phy_ocp(sc, 0xa436, 0x8024);
2048 1.1 sevan rge_write_phy_ocp(sc, 0xa438, 0);
2049 1.17 jakllsch }
2050 1.1 sevan
2051 1.1 sevan rge_patch_phy_mcu(sc, 0);
2052 1.1 sevan
2053 1.17 jakllsch /* Write microcode version. */
2054 1.17 jakllsch rge_write_phy_ocp(sc, 0xa436, 0x801e);
2055 1.17 jakllsch rge_write_phy_ocp(sc, 0xa438, mcode_version);
2056 1.1 sevan }
2057 1.1 sevan }
2058 1.1 sevan
2059 1.1 sevan void
2060 1.1 sevan rge_set_macaddr(struct rge_softc *sc, const uint8_t *addr)
2061 1.1 sevan {
2062 1.1 sevan RGE_SETBIT_1(sc, RGE_EECMD, RGE_EECMD_WRITECFG);
2063 1.1 sevan RGE_WRITE_4(sc, RGE_MAC0,
2064 1.21 msaitoh (uint32_t)addr[3] << 24 | addr[2] << 16 | addr[1] << 8 | addr[0]);
2065 1.1 sevan RGE_WRITE_4(sc, RGE_MAC4,
2066 1.1 sevan addr[5] << 8 | addr[4]);
2067 1.1 sevan RGE_CLRBIT_1(sc, RGE_EECMD, RGE_EECMD_WRITECFG);
2068 1.1 sevan }
2069 1.1 sevan
2070 1.1 sevan void
2071 1.1 sevan rge_get_macaddr(struct rge_softc *sc, uint8_t *addr)
2072 1.1 sevan {
2073 1.22 msaitoh int i;
2074 1.22 msaitoh
2075 1.22 msaitoh for (i = 0; i < ETHER_ADDR_LEN; i++)
2076 1.22 msaitoh addr[i] = RGE_READ_1(sc, RGE_ADDR0 + i);
2077 1.1 sevan }
2078 1.1 sevan
2079 1.1 sevan void
2080 1.1 sevan rge_hw_init(struct rge_softc *sc)
2081 1.1 sevan {
2082 1.1 sevan int i;
2083 1.1 sevan
2084 1.1 sevan RGE_SETBIT_1(sc, RGE_EECMD, RGE_EECMD_WRITECFG);
2085 1.1 sevan RGE_CLRBIT_1(sc, RGE_CFG5, RGE_CFG5_PME_STS);
2086 1.1 sevan RGE_CLRBIT_1(sc, RGE_CFG2, RGE_CFG2_CLKREQ_EN);
2087 1.1 sevan RGE_CLRBIT_1(sc, RGE_EECMD, RGE_EECMD_WRITECFG);
2088 1.1 sevan RGE_CLRBIT_1(sc, 0xf1, 0x80);
2089 1.1 sevan
2090 1.1 sevan /* Disable UPS. */
2091 1.1 sevan RGE_MAC_CLRBIT(sc, 0xd40a, 0x0010);
2092 1.1 sevan
2093 1.1 sevan /* Configure MAC MCU. */
2094 1.1 sevan rge_write_mac_ocp(sc, 0xfc38, 0);
2095 1.1 sevan
2096 1.1 sevan for (i = 0xfc28; i < 0xfc38; i += 2)
2097 1.1 sevan rge_write_mac_ocp(sc, i, 0);
2098 1.1 sevan
2099 1.1 sevan DELAY(3000);
2100 1.1 sevan rge_write_mac_ocp(sc, 0xfc26, 0);
2101 1.1 sevan
2102 1.1 sevan if (sc->rge_type == MAC_CFG3) {
2103 1.17 jakllsch for (i = 0; i < nitems(rtl8125_mac_bps); i++) {
2104 1.17 jakllsch rge_write_mac_ocp(sc, rtl8125_mac_bps[i].reg,
2105 1.17 jakllsch rtl8125_mac_bps[i].val);
2106 1.17 jakllsch }
2107 1.17 jakllsch } else if (sc->rge_type == MAC_CFG5) {
2108 1.17 jakllsch for (i = 0; i < nitems(rtl8125b_mac_bps); i++) {
2109 1.17 jakllsch rge_write_mac_ocp(sc, rtl8125b_mac_bps[i].reg,
2110 1.17 jakllsch rtl8125b_mac_bps[i].val);
2111 1.17 jakllsch }
2112 1.1 sevan }
2113 1.1 sevan
2114 1.1 sevan /* Disable PHY power saving. */
2115 1.1 sevan rge_disable_phy_ocp_pwrsave(sc);
2116 1.1 sevan
2117 1.1 sevan /* Set PCIe uncorrectable error status. */
2118 1.1 sevan rge_write_csi(sc, 0x108,
2119 1.1 sevan rge_read_csi(sc, 0x108) | 0x00100000);
2120 1.1 sevan }
2121 1.1 sevan
2122 1.1 sevan void
2123 1.1 sevan rge_disable_phy_ocp_pwrsave(struct rge_softc *sc)
2124 1.1 sevan {
2125 1.1 sevan if (rge_read_phy_ocp(sc, 0xc416) != 0x0500) {
2126 1.1 sevan rge_patch_phy_mcu(sc, 1);
2127 1.1 sevan rge_write_phy_ocp(sc, 0xc416, 0);
2128 1.1 sevan rge_write_phy_ocp(sc, 0xc416, 0x0500);
2129 1.1 sevan rge_patch_phy_mcu(sc, 0);
2130 1.1 sevan }
2131 1.1 sevan }
2132 1.1 sevan
2133 1.1 sevan void
2134 1.1 sevan rge_patch_phy_mcu(struct rge_softc *sc, int set)
2135 1.1 sevan {
2136 1.1 sevan int i;
2137 1.1 sevan
2138 1.1 sevan if (set)
2139 1.1 sevan RGE_PHY_SETBIT(sc, 0xb820, 0x0010);
2140 1.1 sevan else
2141 1.1 sevan RGE_PHY_CLRBIT(sc, 0xb820, 0x0010);
2142 1.1 sevan
2143 1.1 sevan for (i = 0; i < 1000; i++) {
2144 1.17 jakllsch if ((rge_read_phy_ocp(sc, 0xb800) & 0x0040) == 0x0040)
2145 1.17 jakllsch break;
2146 1.1 sevan DELAY(100);
2147 1.1 sevan }
2148 1.17 jakllsch if (i == 1000) {
2149 1.17 jakllsch DPRINTF(("timeout waiting to patch phy mcu\n"));
2150 1.17 jakllsch return;
2151 1.17 jakllsch }
2152 1.1 sevan }
2153 1.1 sevan
2154 1.1 sevan void
2155 1.1 sevan rge_add_media_types(struct rge_softc *sc)
2156 1.1 sevan {
2157 1.1 sevan ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_10_T, 0, NULL);
2158 1.1 sevan ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_10_T | IFM_FDX, 0, NULL);
2159 1.1 sevan ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_100_TX, 0, NULL);
2160 1.1 sevan ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_100_TX | IFM_FDX, 0, NULL);
2161 1.1 sevan ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_1000_T, 0, NULL);
2162 1.1 sevan ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_1000_T | IFM_FDX, 0, NULL);
2163 1.1 sevan ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_2500_T, 0, NULL);
2164 1.1 sevan ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_2500_T | IFM_FDX, 0, NULL);
2165 1.1 sevan }
2166 1.1 sevan
2167 1.1 sevan void
2168 1.1 sevan rge_config_imtype(struct rge_softc *sc, int imtype)
2169 1.1 sevan {
2170 1.1 sevan switch (imtype) {
2171 1.1 sevan case RGE_IMTYPE_NONE:
2172 1.1 sevan sc->rge_intrs = RGE_INTRS;
2173 1.1 sevan sc->rge_rx_ack = RGE_ISR_RX_OK | RGE_ISR_RX_DESC_UNAVAIL |
2174 1.1 sevan RGE_ISR_RX_FIFO_OFLOW;
2175 1.1 sevan sc->rge_tx_ack = RGE_ISR_TX_OK;
2176 1.1 sevan break;
2177 1.1 sevan case RGE_IMTYPE_SIM:
2178 1.1 sevan sc->rge_intrs = RGE_INTRS_TIMER;
2179 1.1 sevan sc->rge_rx_ack = RGE_ISR_PCS_TIMEOUT;
2180 1.1 sevan sc->rge_tx_ack = RGE_ISR_PCS_TIMEOUT;
2181 1.1 sevan break;
2182 1.1 sevan default:
2183 1.14 sevan panic("%s: unknown imtype %d", device_xname(sc->sc_dev), imtype);
2184 1.1 sevan }
2185 1.1 sevan }
2186 1.1 sevan
2187 1.1 sevan void
2188 1.17 jakllsch rge_disable_hw_im(struct rge_softc *sc)
2189 1.17 jakllsch {
2190 1.17 jakllsch RGE_WRITE_2(sc, RGE_IM, 0);
2191 1.17 jakllsch }
2192 1.17 jakllsch
2193 1.17 jakllsch void
2194 1.1 sevan rge_disable_sim_im(struct rge_softc *sc)
2195 1.1 sevan {
2196 1.17 jakllsch RGE_WRITE_4(sc, RGE_TIMERINT0, 0);
2197 1.1 sevan sc->rge_timerintr = 0;
2198 1.1 sevan }
2199 1.1 sevan
2200 1.1 sevan void
2201 1.1 sevan rge_setup_sim_im(struct rge_softc *sc)
2202 1.1 sevan {
2203 1.17 jakllsch RGE_WRITE_4(sc, RGE_TIMERINT0, 0x2600);
2204 1.1 sevan RGE_WRITE_4(sc, RGE_TIMERCNT, 1);
2205 1.1 sevan sc->rge_timerintr = 1;
2206 1.1 sevan }
2207 1.1 sevan
2208 1.1 sevan void
2209 1.1 sevan rge_setup_intr(struct rge_softc *sc, int imtype)
2210 1.1 sevan {
2211 1.1 sevan rge_config_imtype(sc, imtype);
2212 1.1 sevan
2213 1.1 sevan /* Enable interrupts. */
2214 1.1 sevan RGE_WRITE_4(sc, RGE_IMR, sc->rge_intrs);
2215 1.1 sevan
2216 1.1 sevan switch (imtype) {
2217 1.1 sevan case RGE_IMTYPE_NONE:
2218 1.1 sevan rge_disable_sim_im(sc);
2219 1.17 jakllsch rge_disable_hw_im(sc);
2220 1.1 sevan break;
2221 1.1 sevan case RGE_IMTYPE_SIM:
2222 1.17 jakllsch rge_disable_hw_im(sc);
2223 1.1 sevan rge_setup_sim_im(sc);
2224 1.1 sevan break;
2225 1.1 sevan default:
2226 1.14 sevan panic("%s: unknown imtype %d", device_xname(sc->sc_dev), imtype);
2227 1.1 sevan }
2228 1.1 sevan }
2229 1.1 sevan
2230 1.1 sevan void
2231 1.1 sevan rge_exit_oob(struct rge_softc *sc)
2232 1.1 sevan {
2233 1.1 sevan int i;
2234 1.1 sevan
2235 1.1 sevan RGE_CLRBIT_4(sc, RGE_RXCFG, RGE_RXCFG_ALLPHYS | RGE_RXCFG_INDIV |
2236 1.1 sevan RGE_RXCFG_MULTI | RGE_RXCFG_BROAD | RGE_RXCFG_RUNT |
2237 1.1 sevan RGE_RXCFG_ERRPKT);
2238 1.1 sevan
2239 1.1 sevan /* Disable RealWoW. */
2240 1.1 sevan rge_write_mac_ocp(sc, 0xc0bc, 0x00ff);
2241 1.1 sevan
2242 1.1 sevan rge_reset(sc);
2243 1.1 sevan
2244 1.1 sevan /* Disable OOB. */
2245 1.1 sevan RGE_CLRBIT_1(sc, RGE_MCUCMD, RGE_MCUCMD_IS_OOB);
2246 1.1 sevan
2247 1.1 sevan RGE_MAC_CLRBIT(sc, 0xe8de, 0x4000);
2248 1.1 sevan
2249 1.1 sevan for (i = 0; i < 10; i++) {
2250 1.1 sevan DELAY(100);
2251 1.1 sevan if (RGE_READ_2(sc, RGE_TWICMD) & 0x0200)
2252 1.1 sevan break;
2253 1.1 sevan }
2254 1.1 sevan
2255 1.1 sevan rge_write_mac_ocp(sc, 0xc0aa, 0x07d0);
2256 1.17 jakllsch rge_write_mac_ocp(sc, 0xc0a6, 0x01b5);
2257 1.1 sevan rge_write_mac_ocp(sc, 0xc01e, 0x5555);
2258 1.1 sevan
2259 1.1 sevan for (i = 0; i < 10; i++) {
2260 1.1 sevan DELAY(100);
2261 1.1 sevan if (RGE_READ_2(sc, RGE_TWICMD) & 0x0200)
2262 1.1 sevan break;
2263 1.1 sevan }
2264 1.1 sevan
2265 1.1 sevan if (rge_read_mac_ocp(sc, 0xd42c) & 0x0100) {
2266 1.17 jakllsch printf("%s: rge_exit_oob(): rtl8125_is_ups_resume!!\n",
2267 1.17 jakllsch device_xname(sc->sc_dev));
2268 1.1 sevan for (i = 0; i < RGE_TIMEOUT; i++) {
2269 1.10 sevan if ((rge_read_phy_ocp(sc, 0xa420) & 0x0007) == 2)
2270 1.1 sevan break;
2271 1.1 sevan DELAY(1000);
2272 1.1 sevan }
2273 1.1 sevan RGE_MAC_CLRBIT(sc, 0xd408, 0x0100);
2274 1.17 jakllsch if (sc->rge_type == MAC_CFG4 || sc->rge_type == MAC_CFG5)
2275 1.17 jakllsch RGE_PHY_CLRBIT(sc, 0xa466, 0x0001);
2276 1.1 sevan RGE_PHY_CLRBIT(sc, 0xa468, 0x000a);
2277 1.1 sevan }
2278 1.1 sevan }
2279 1.1 sevan
2280 1.1 sevan void
2281 1.1 sevan rge_write_csi(struct rge_softc *sc, uint32_t reg, uint32_t val)
2282 1.1 sevan {
2283 1.1 sevan int i;
2284 1.1 sevan
2285 1.1 sevan RGE_WRITE_4(sc, RGE_CSIDR, val);
2286 1.17 jakllsch RGE_WRITE_4(sc, RGE_CSIAR, (reg & RGE_CSIAR_ADDR_MASK) |
2287 1.1 sevan (RGE_CSIAR_BYTE_EN << RGE_CSIAR_BYTE_EN_SHIFT) | RGE_CSIAR_BUSY);
2288 1.1 sevan
2289 1.1 sevan for (i = 0; i < 10; i++) {
2290 1.1 sevan DELAY(100);
2291 1.1 sevan if (!(RGE_READ_4(sc, RGE_CSIAR) & RGE_CSIAR_BUSY))
2292 1.1 sevan break;
2293 1.1 sevan }
2294 1.1 sevan
2295 1.1 sevan DELAY(20);
2296 1.1 sevan }
2297 1.1 sevan
2298 1.1 sevan uint32_t
2299 1.1 sevan rge_read_csi(struct rge_softc *sc, uint32_t reg)
2300 1.1 sevan {
2301 1.1 sevan int i;
2302 1.1 sevan
2303 1.17 jakllsch RGE_WRITE_4(sc, RGE_CSIAR, (reg & RGE_CSIAR_ADDR_MASK) |
2304 1.1 sevan (RGE_CSIAR_BYTE_EN << RGE_CSIAR_BYTE_EN_SHIFT));
2305 1.1 sevan
2306 1.1 sevan for (i = 0; i < 10; i++) {
2307 1.1 sevan DELAY(100);
2308 1.1 sevan if (RGE_READ_4(sc, RGE_CSIAR) & RGE_CSIAR_BUSY)
2309 1.1 sevan break;
2310 1.1 sevan }
2311 1.1 sevan
2312 1.1 sevan DELAY(20);
2313 1.1 sevan
2314 1.1 sevan return (RGE_READ_4(sc, RGE_CSIDR));
2315 1.1 sevan }
2316 1.1 sevan
2317 1.1 sevan void
2318 1.1 sevan rge_write_mac_ocp(struct rge_softc *sc, uint16_t reg, uint16_t val)
2319 1.1 sevan {
2320 1.1 sevan uint32_t tmp;
2321 1.1 sevan
2322 1.1 sevan tmp = (reg >> 1) << RGE_MACOCP_ADDR_SHIFT;
2323 1.1 sevan tmp += val;
2324 1.1 sevan tmp |= RGE_MACOCP_BUSY;
2325 1.1 sevan RGE_WRITE_4(sc, RGE_MACOCP, tmp);
2326 1.1 sevan }
2327 1.1 sevan
2328 1.1 sevan uint16_t
2329 1.1 sevan rge_read_mac_ocp(struct rge_softc *sc, uint16_t reg)
2330 1.1 sevan {
2331 1.1 sevan uint32_t val;
2332 1.1 sevan
2333 1.1 sevan val = (reg >> 1) << RGE_MACOCP_ADDR_SHIFT;
2334 1.1 sevan RGE_WRITE_4(sc, RGE_MACOCP, val);
2335 1.1 sevan
2336 1.1 sevan return (RGE_READ_4(sc, RGE_MACOCP) & RGE_MACOCP_DATA_MASK);
2337 1.1 sevan }
2338 1.1 sevan
2339 1.1 sevan void
2340 1.1 sevan rge_write_ephy(struct rge_softc *sc, uint16_t reg, uint16_t val)
2341 1.1 sevan {
2342 1.1 sevan uint32_t tmp;
2343 1.1 sevan int i;
2344 1.1 sevan
2345 1.1 sevan tmp = (reg & RGE_EPHYAR_ADDR_MASK) << RGE_EPHYAR_ADDR_SHIFT;
2346 1.1 sevan tmp |= RGE_EPHYAR_BUSY | (val & RGE_EPHYAR_DATA_MASK);
2347 1.1 sevan RGE_WRITE_4(sc, RGE_EPHYAR, tmp);
2348 1.1 sevan
2349 1.1 sevan for (i = 0; i < 10; i++) {
2350 1.1 sevan DELAY(100);
2351 1.1 sevan if (!(RGE_READ_4(sc, RGE_EPHYAR) & RGE_EPHYAR_BUSY))
2352 1.1 sevan break;
2353 1.1 sevan }
2354 1.1 sevan
2355 1.1 sevan DELAY(20);
2356 1.1 sevan }
2357 1.1 sevan
2358 1.17 jakllsch uint16_t
2359 1.17 jakllsch rge_read_ephy(struct rge_softc *sc, uint16_t reg)
2360 1.17 jakllsch {
2361 1.17 jakllsch uint32_t val;
2362 1.17 jakllsch int i;
2363 1.17 jakllsch
2364 1.17 jakllsch val = (reg & RGE_EPHYAR_ADDR_MASK) << RGE_EPHYAR_ADDR_SHIFT;
2365 1.17 jakllsch RGE_WRITE_4(sc, RGE_EPHYAR, val);
2366 1.17 jakllsch
2367 1.17 jakllsch for (i = 0; i < 10; i++) {
2368 1.17 jakllsch DELAY(100);
2369 1.17 jakllsch val = RGE_READ_4(sc, RGE_EPHYAR);
2370 1.17 jakllsch if (val & RGE_EPHYAR_BUSY)
2371 1.17 jakllsch break;
2372 1.17 jakllsch }
2373 1.17 jakllsch
2374 1.17 jakllsch DELAY(20);
2375 1.17 jakllsch
2376 1.17 jakllsch return (val & RGE_EPHYAR_DATA_MASK);
2377 1.17 jakllsch }
2378 1.17 jakllsch
2379 1.1 sevan void
2380 1.1 sevan rge_write_phy(struct rge_softc *sc, uint16_t addr, uint16_t reg, uint16_t val)
2381 1.1 sevan {
2382 1.1 sevan uint16_t off, phyaddr;
2383 1.1 sevan
2384 1.1 sevan phyaddr = addr ? addr : RGE_PHYBASE + (reg / 8);
2385 1.1 sevan phyaddr <<= 4;
2386 1.1 sevan
2387 1.1 sevan off = addr ? reg : 0x10 + (reg % 8);
2388 1.1 sevan
2389 1.1 sevan phyaddr += (off - 16) << 1;
2390 1.1 sevan
2391 1.1 sevan rge_write_phy_ocp(sc, phyaddr, val);
2392 1.1 sevan }
2393 1.1 sevan
2394 1.17 jakllsch uint16_t
2395 1.17 jakllsch rge_read_phy(struct rge_softc *sc, uint16_t addr, uint16_t reg)
2396 1.17 jakllsch {
2397 1.17 jakllsch uint16_t off, phyaddr;
2398 1.17 jakllsch
2399 1.17 jakllsch phyaddr = addr ? addr : RGE_PHYBASE + (reg / 8);
2400 1.17 jakllsch phyaddr <<= 4;
2401 1.17 jakllsch
2402 1.17 jakllsch off = addr ? reg : 0x10 + (reg % 8);
2403 1.17 jakllsch
2404 1.17 jakllsch phyaddr += (off - 16) << 1;
2405 1.17 jakllsch
2406 1.17 jakllsch return (rge_read_phy_ocp(sc, phyaddr));
2407 1.17 jakllsch }
2408 1.17 jakllsch
2409 1.1 sevan void
2410 1.1 sevan rge_write_phy_ocp(struct rge_softc *sc, uint16_t reg, uint16_t val)
2411 1.1 sevan {
2412 1.1 sevan uint32_t tmp;
2413 1.1 sevan int i;
2414 1.1 sevan
2415 1.1 sevan tmp = (reg >> 1) << RGE_PHYOCP_ADDR_SHIFT;
2416 1.1 sevan tmp |= RGE_PHYOCP_BUSY | val;
2417 1.1 sevan RGE_WRITE_4(sc, RGE_PHYOCP, tmp);
2418 1.1 sevan
2419 1.1 sevan for (i = 0; i < RGE_TIMEOUT; i++) {
2420 1.1 sevan DELAY(1);
2421 1.1 sevan if (!(RGE_READ_4(sc, RGE_PHYOCP) & RGE_PHYOCP_BUSY))
2422 1.1 sevan break;
2423 1.1 sevan }
2424 1.1 sevan }
2425 1.1 sevan
2426 1.1 sevan uint16_t
2427 1.1 sevan rge_read_phy_ocp(struct rge_softc *sc, uint16_t reg)
2428 1.1 sevan {
2429 1.1 sevan uint32_t val;
2430 1.1 sevan int i;
2431 1.1 sevan
2432 1.1 sevan val = (reg >> 1) << RGE_PHYOCP_ADDR_SHIFT;
2433 1.1 sevan RGE_WRITE_4(sc, RGE_PHYOCP, val);
2434 1.1 sevan
2435 1.1 sevan for (i = 0; i < RGE_TIMEOUT; i++) {
2436 1.1 sevan DELAY(1);
2437 1.1 sevan val = RGE_READ_4(sc, RGE_PHYOCP);
2438 1.1 sevan if (val & RGE_PHYOCP_BUSY)
2439 1.1 sevan break;
2440 1.1 sevan }
2441 1.1 sevan
2442 1.1 sevan return (val & RGE_PHYOCP_DATA_MASK);
2443 1.1 sevan }
2444 1.1 sevan
2445 1.1 sevan int
2446 1.1 sevan rge_get_link_status(struct rge_softc *sc)
2447 1.1 sevan {
2448 1.1 sevan return ((RGE_READ_2(sc, RGE_PHYSTAT) & RGE_PHYSTAT_LINK) ? 1 : 0);
2449 1.1 sevan }
2450 1.1 sevan
2451 1.1 sevan void
2452 1.3 sevan rge_txstart(struct work *wk, void *arg)
2453 1.1 sevan {
2454 1.1 sevan struct rge_softc *sc = arg;
2455 1.1 sevan
2456 1.1 sevan RGE_WRITE_2(sc, RGE_TXSTART, RGE_TXSTART_START);
2457 1.1 sevan }
2458 1.1 sevan
2459 1.1 sevan void
2460 1.1 sevan rge_tick(void *arg)
2461 1.1 sevan {
2462 1.1 sevan struct rge_softc *sc = arg;
2463 1.1 sevan int s;
2464 1.1 sevan
2465 1.1 sevan s = splnet();
2466 1.1 sevan rge_link_state(sc);
2467 1.1 sevan splx(s);
2468 1.1 sevan
2469 1.17 jakllsch callout_schedule(&sc->sc_timeout, hz);
2470 1.1 sevan }
2471 1.1 sevan
2472 1.1 sevan void
2473 1.1 sevan rge_link_state(struct rge_softc *sc)
2474 1.1 sevan {
2475 1.2 sevan struct ifnet *ifp = &sc->sc_ec.ec_if;
2476 1.1 sevan int link = LINK_STATE_DOWN;
2477 1.1 sevan
2478 1.1 sevan if (rge_get_link_status(sc))
2479 1.1 sevan link = LINK_STATE_UP;
2480 1.1 sevan
2481 1.17 jakllsch if (ifp->if_link_state != link) { /* XXX not safe to access */
2482 1.17 jakllsch if_link_state_change(ifp, link);
2483 1.1 sevan }
2484 1.1 sevan }
2485