File: | dev/usb/if_ure.c |
Warning: | line 274, column 6 Assigned value is garbage or undefined |
Press '?' to see keyboard shortcuts
Keyboard shortcuts:
1 | /* $OpenBSD: if_ure.c,v 1.33 2023/09/09 14:23:37 kevlo Exp $ */ | |||
2 | /*- | |||
3 | * Copyright (c) 2015, 2016, 2019 Kevin Lo <kevlo@openbsd.org> | |||
4 | * Copyright (c) 2020 Jonathon Fletcher <jonathon.fletcher@gmail.com> | |||
5 | * All rights reserved. | |||
6 | * | |||
7 | * Redistribution and use in source and binary forms, with or without | |||
8 | * modification, are permitted provided that the following conditions | |||
9 | * are met: | |||
10 | * 1. Redistributions of source code must retain the above copyright | |||
11 | * notice, this list of conditions and the following disclaimer. | |||
12 | * 2. Redistributions in binary form must reproduce the above copyright | |||
13 | * notice, this list of conditions and the following disclaimer in the | |||
14 | * documentation and/or other materials provided with the distribution. | |||
15 | * | |||
16 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND | |||
17 | * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE | |||
18 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE | |||
19 | * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE | |||
20 | * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL | |||
21 | * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS | |||
22 | * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) | |||
23 | * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT | |||
24 | * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY | |||
25 | * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF | |||
26 | * SUCH DAMAGE. | |||
27 | */ | |||
28 | ||||
29 | #include "bpfilter.h" | |||
30 | #include "vlan.h" | |||
31 | ||||
32 | #include <sys/param.h> | |||
33 | #include <sys/systm.h> | |||
34 | #include <sys/sockio.h> | |||
35 | #include <sys/rwlock.h> | |||
36 | #include <sys/mbuf.h> | |||
37 | #include <sys/kernel.h> | |||
38 | #include <sys/socket.h> | |||
39 | #include <sys/device.h> | |||
40 | ||||
41 | #include <machine/bus.h> | |||
42 | ||||
43 | #include <net/if.h> | |||
44 | #include <net/if_media.h> | |||
45 | ||||
46 | #if NBPFILTER1 > 0 | |||
47 | #include <net/bpf.h> | |||
48 | #endif | |||
49 | ||||
50 | #include <netinet/in.h> | |||
51 | #include <netinet/if_ether.h> | |||
52 | ||||
53 | #include <dev/mii/mii.h> | |||
54 | #include <dev/mii/miivar.h> | |||
55 | ||||
56 | #include <dev/usb/usb.h> | |||
57 | #include <dev/usb/usbdi.h> | |||
58 | #include <dev/usb/usbdi_util.h> | |||
59 | #include <dev/usb/usbdivar.h> | |||
60 | #include <dev/usb/usbdevs.h> | |||
61 | ||||
62 | #include <dev/ic/rtl81x9reg.h> | |||
63 | #include <dev/usb/if_urereg.h> | |||
64 | ||||
65 | #ifdef URE_DEBUG | |||
66 | #define DPRINTF(x) do { if (uredebug) printf x; } while (0) | |||
67 | #define DPRINTFN(n,x) do { if (uredebug >= (n)) printf x; } while (0) | |||
68 | int uredebug = 0; | |||
69 | #else | |||
70 | #define DPRINTF(x) | |||
71 | #define DPRINTFN(n,x) | |||
72 | #endif | |||
73 | ||||
74 | const struct usb_devno ure_devs[] = { | |||
75 | { USB_VENDOR_ASUS0x0b05, USB_PRODUCT_ASUS_RTL81560x18d1 }, | |||
76 | { USB_VENDOR_BELKIN0x050d, USB_PRODUCT_BELKIN_RTL8152B0x047a }, | |||
77 | { USB_VENDOR_BELKIN0x050d, USB_PRODUCT_BELKIN_RTL81530x048a }, | |||
78 | { USB_VENDOR_CISCOLINKSYS0x13b1, USB_PRODUCT_CISCOLINKSYS_USB3GIGV10x0041 }, | |||
79 | { USB_VENDOR_CLEVO0x30da, USB_PRODUCT_CLEVO_RTL8153B0x5101 }, | |||
80 | { USB_VENDOR_CLUB3D0x2d1c, USB_PRODUCT_CLUB3D_RTL81530x8153 }, | |||
81 | { USB_VENDOR_DLINK0x2001, USB_PRODUCT_DLINK_RTL8153_10x7e34 }, | |||
82 | { USB_VENDOR_DLINK0x2001, USB_PRODUCT_DLINK_RTL8153_20xa710 }, | |||
83 | { USB_VENDOR_DYNABOOK0x30f3, USB_PRODUCT_DYNABOOK_RTL8153B_10x0419 }, | |||
84 | { USB_VENDOR_DYNABOOK0x30f3, USB_PRODUCT_DYNABOOK_RTL8153B_20x0425 }, | |||
85 | { USB_VENDOR_ELECOM0x056e, USB_PRODUCT_ELECOM_RTL8153B0x4013 }, | |||
86 | { USB_VENDOR_ELECOM0x056e, USB_PRODUCT_ELECOM_RTL8156B0x4017 }, | |||
87 | { USB_VENDOR_IOI0x0f21, USB_PRODUCT_IOI_RTL81530x8153 }, | |||
88 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_DOCK_ETHERNET0x3062 }, | |||
89 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_ONELINK0x720a }, | |||
90 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_ONELINKPLUS0x3054 }, | |||
91 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_ONELINKPRO0x304f }, | |||
92 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_RTL8153B_10x3069 }, | |||
93 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_RTL8153B_20x3098 }, | |||
94 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_RTL8153B_30x309b }, | |||
95 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_RTL8153B_40x309c }, | |||
96 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_RTL8153B_50x309d }, | |||
97 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_RTL8153B_60x7214 }, | |||
98 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_RTL8153B_70x721e }, | |||
99 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_RTL8153B_80x8153 }, | |||
100 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_RTL8153B_90xa359 }, | |||
101 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_RTL8153_10x7205 }, | |||
102 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_RTL8153_20x720b }, | |||
103 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_RTL8153_30x720c }, | |||
104 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_TABLETDOCK0x3052 }, | |||
105 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_TB3DOCK0xa3c1 }, | |||
106 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_TB3DOCKGEN20x3082 }, | |||
107 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_TB3GFXDOCK0x3065 }, | |||
108 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_USBCDOCKGEN20xa387 }, | |||
109 | { USB_VENDOR_LENOVO0x17ef, USB_PRODUCT_LENOVO_WIGIGDOCK0x3057 }, | |||
110 | { USB_VENDOR_LG0x043e, USB_PRODUCT_LG_RTL81530x9819 }, | |||
111 | { USB_VENDOR_LG0x043e, USB_PRODUCT_LG_RTL8153B0x9820 }, | |||
112 | { USB_VENDOR_LUXSHARE0x208e, USB_PRODUCT_LUXSHARE_RTL81530xd003 }, | |||
113 | { USB_VENDOR_MICROSOFT0x045e, USB_PRODUCT_MICROSOFT_DOCKETH0x07ab }, | |||
114 | { USB_VENDOR_MICROSOFT0x045e, USB_PRODUCT_MICROSOFT_DOCKETH20x07c6 }, | |||
115 | { USB_VENDOR_MICROSOFT0x045e, USB_PRODUCT_MICROSOFT_SURFETH0x0927 }, | |||
116 | { USB_VENDOR_MICROSOFT0x045e, USB_PRODUCT_MICROSOFT_WINDEVETH0x0c5e }, | |||
117 | { USB_VENDOR_NVIDIA0x0955, USB_PRODUCT_NVIDIA_TEGRAETH0x09ff }, | |||
118 | { USB_VENDOR_PIONEERDJ0x2b73, USB_PRODUCT_PIONEERDJ_RTL8152B0x0007 }, | |||
119 | { USB_VENDOR_PIONEERDJ0x2b73, USB_PRODUCT_PIONEERDJ_RTL8153B0x0031 }, | |||
120 | { USB_VENDOR_REALTEK0x0bda, USB_PRODUCT_REALTEK_RTL81520x8152 }, | |||
121 | { USB_VENDOR_REALTEK0x0bda, USB_PRODUCT_REALTEK_RTL8152B0x8050 }, | |||
122 | { USB_VENDOR_REALTEK0x0bda, USB_PRODUCT_REALTEK_RTL81530x8153 }, | |||
123 | { USB_VENDOR_REALTEK0x0bda, USB_PRODUCT_REALTEK_RTL81560x8156 }, | |||
124 | { USB_VENDOR_SAMSUNG20x04e8, USB_PRODUCT_SAMSUNG2_RTL81530xa101 }, | |||
125 | { USB_VENDOR_TOSHIBA0x0930, USB_PRODUCT_TOSHIBA_RTL8153B0x0416 }, | |||
126 | { USB_VENDOR_TPLINK0x2357, USB_PRODUCT_TPLINK_EU3000x0601 }, | |||
127 | { USB_VENDOR_TPLINK0x2357, USB_PRODUCT_TPLINK_RTL8152B_10x0602 }, | |||
128 | { USB_VENDOR_TPLINK0x2357, USB_PRODUCT_TPLINK_RTL8152B_20x0603 }, | |||
129 | { USB_VENDOR_TRENDNET0x20f4, USB_PRODUCT_TRENDNET_RTL81560xe02b }, | |||
130 | { USB_VENDOR_TTL0x1025, USB_PRODUCT_TTL_RTL81530x104e }, | |||
131 | { USB_VENDOR_TWINHEAD0x14ff, USB_PRODUCT_TWINHEAD_RTL8153B0x1400 }, | |||
132 | { USB_VENDOR_XIAOMI0x2717, USB_PRODUCT_XIAOMI_RTL8152B0x0011 }, | |||
133 | }; | |||
134 | ||||
135 | int ure_match(struct device *, void *, void *); | |||
136 | void ure_attach(struct device *, struct device *, void *); | |||
137 | int ure_detach(struct device *, int); | |||
138 | ||||
139 | struct cfdriver ure_cd = { | |||
140 | NULL((void *)0), "ure", DV_IFNET | |||
141 | }; | |||
142 | ||||
143 | const struct cfattach ure_ca = { | |||
144 | sizeof(struct ure_softc), ure_match, ure_attach, ure_detach | |||
145 | }; | |||
146 | ||||
147 | int ure_ctl(struct ure_softc *, uint8_t, uint16_t, uint16_t, | |||
148 | void *, int); | |||
149 | int ure_read_mem(struct ure_softc *, uint16_t, uint16_t, void *, | |||
150 | int); | |||
151 | int ure_write_mem(struct ure_softc *, uint16_t, uint16_t, void *, | |||
152 | int); | |||
153 | uint8_t ure_read_1(struct ure_softc *, uint16_t, uint16_t); | |||
154 | uint16_t ure_read_2(struct ure_softc *, uint16_t, uint16_t); | |||
155 | uint32_t ure_read_4(struct ure_softc *, uint16_t, uint16_t); | |||
156 | int ure_write_1(struct ure_softc *, uint16_t, uint16_t, uint32_t); | |||
157 | int ure_write_2(struct ure_softc *, uint16_t, uint16_t, uint32_t); | |||
158 | int ure_write_4(struct ure_softc *, uint16_t, uint16_t, uint32_t); | |||
159 | uint16_t ure_ocp_reg_read(struct ure_softc *, uint16_t); | |||
160 | void ure_ocp_reg_write(struct ure_softc *, uint16_t, uint16_t); | |||
161 | ||||
162 | void ure_init(void *); | |||
163 | void ure_stop(struct ure_softc *); | |||
164 | void ure_start(struct ifnet *); | |||
165 | void ure_reset(struct ure_softc *); | |||
166 | void ure_watchdog(struct ifnet *); | |||
167 | ||||
168 | void ure_miibus_statchg(struct device *); | |||
169 | int ure_miibus_readreg(struct device *, int, int); | |||
170 | void ure_miibus_writereg(struct device *, int, int, int); | |||
171 | void ure_lock_mii(struct ure_softc *); | |||
172 | void ure_unlock_mii(struct ure_softc *); | |||
173 | ||||
174 | int ure_encap_txpkt(struct mbuf *, char *, uint32_t); | |||
175 | int ure_encap_xfer(struct ifnet *, struct ure_softc *, | |||
176 | struct ure_chain *); | |||
177 | void ure_rxeof(struct usbd_xfer *, void *, usbd_status); | |||
178 | void ure_txeof(struct usbd_xfer *, void *, usbd_status); | |||
179 | int ure_xfer_list_init(struct ure_softc *, struct ure_chain *, | |||
180 | uint32_t, int); | |||
181 | void ure_xfer_list_free(struct ure_softc *, struct ure_chain *, int); | |||
182 | ||||
183 | void ure_tick_task(void *); | |||
184 | void ure_tick(void *); | |||
185 | ||||
186 | void ure_ifmedia_init(struct ifnet *); | |||
187 | int ure_ifmedia_upd(struct ifnet *); | |||
188 | void ure_ifmedia_sts(struct ifnet *, struct ifmediareq *); | |||
189 | void ure_add_media_types(struct ure_softc *); | |||
190 | void ure_link_state(struct ure_softc *); | |||
191 | int ure_get_link_status(struct ure_softc *); | |||
192 | void ure_iff(struct ure_softc *); | |||
193 | void ure_rxvlan(struct ure_softc *); | |||
194 | int ure_ioctl(struct ifnet *, u_long, caddr_t); | |||
195 | void ure_rtl8152_init(struct ure_softc *); | |||
196 | void ure_rtl8153_init(struct ure_softc *); | |||
197 | void ure_rtl8153b_init(struct ure_softc *); | |||
198 | void ure_rtl8152_nic_reset(struct ure_softc *); | |||
199 | void ure_rtl8153_nic_reset(struct ure_softc *); | |||
200 | uint16_t ure_rtl8153_phy_status(struct ure_softc *, int); | |||
201 | void ure_wait_for_flash(struct ure_softc *); | |||
202 | void ure_reset_bmu(struct ure_softc *); | |||
203 | void ure_disable_teredo(struct ure_softc *); | |||
204 | ||||
205 | #define URE_SETBIT_1(sc, reg, index, x)ure_write_1(sc, reg, index, ure_read_1(sc, reg, index) | (x)) \ | |||
206 | ure_write_1(sc, reg, index, ure_read_1(sc, reg, index) | (x)) | |||
207 | #define URE_SETBIT_2(sc, reg, index, x)ure_write_2(sc, reg, index, ure_read_2(sc, reg, index) | (x)) \ | |||
208 | ure_write_2(sc, reg, index, ure_read_2(sc, reg, index) | (x)) | |||
209 | #define URE_SETBIT_4(sc, reg, index, x)ure_write_4(sc, reg, index, ure_read_4(sc, reg, index) | (x)) \ | |||
210 | ure_write_4(sc, reg, index, ure_read_4(sc, reg, index) | (x)) | |||
211 | ||||
212 | #define URE_CLRBIT_1(sc, reg, index, x)ure_write_1(sc, reg, index, ure_read_1(sc, reg, index) & ~ (x)) \ | |||
213 | ure_write_1(sc, reg, index, ure_read_1(sc, reg, index) & ~(x)) | |||
214 | #define URE_CLRBIT_2(sc, reg, index, x)ure_write_2(sc, reg, index, ure_read_2(sc, reg, index) & ~ (x)) \ | |||
215 | ure_write_2(sc, reg, index, ure_read_2(sc, reg, index) & ~(x)) | |||
216 | #define URE_CLRBIT_4(sc, reg, index, x)ure_write_4(sc, reg, index, ure_read_4(sc, reg, index) & ~ (x)) \ | |||
217 | ure_write_4(sc, reg, index, ure_read_4(sc, reg, index) & ~(x)) | |||
218 | ||||
219 | int | |||
220 | ure_ctl(struct ure_softc *sc, uint8_t rw, uint16_t val, uint16_t index, | |||
221 | void *buf, int len) | |||
222 | { | |||
223 | usb_device_request_t req; | |||
224 | usbd_status err; | |||
225 | ||||
226 | if (usbd_is_dying(sc->ure_udev)) | |||
227 | return 0; | |||
228 | ||||
229 | if (rw == URE_CTL_WRITE0x02) | |||
230 | req.bmRequestType = UT_WRITE_VENDOR_DEVICE(0x00 | 0x40 | 0x00); | |||
231 | else | |||
232 | req.bmRequestType = UT_READ_VENDOR_DEVICE(0x80 | 0x40 | 0x00); | |||
233 | req.bRequest = UR_SET_ADDRESS0x05; | |||
234 | USETW(req.wValue, val)(*(u_int16_t *)(req.wValue) = (val)); | |||
235 | USETW(req.wIndex, index)(*(u_int16_t *)(req.wIndex) = (index)); | |||
236 | USETW(req.wLength, len)(*(u_int16_t *)(req.wLength) = (len)); | |||
237 | ||||
238 | DPRINTFN(5, ("ure_ctl: rw %d, val 0x%04hu, index 0x%04hu, len %d\n", | |||
239 | rw, val, index, len)); | |||
240 | err = usbd_do_request(sc->ure_udev, &req, buf); | |||
241 | if (err) { | |||
242 | DPRINTF(("ure_ctl: error %d\n", err)); | |||
243 | return -1; | |||
244 | } | |||
245 | ||||
246 | return 0; | |||
247 | } | |||
248 | ||||
249 | int | |||
250 | ure_read_mem(struct ure_softc *sc, uint16_t addr, uint16_t index, | |||
251 | void *buf, int len) | |||
252 | { | |||
253 | return (ure_ctl(sc, URE_CTL_READ0x01, addr, index, buf, len)); | |||
254 | } | |||
255 | ||||
256 | int | |||
257 | ure_write_mem(struct ure_softc *sc, uint16_t addr, uint16_t index, | |||
258 | void *buf, int len) | |||
259 | { | |||
260 | return (ure_ctl(sc, URE_CTL_WRITE0x02, addr, index, buf, len)); | |||
261 | } | |||
262 | ||||
263 | uint8_t | |||
264 | ure_read_1(struct ure_softc *sc, uint16_t reg, uint16_t index) | |||
265 | { | |||
266 | uint32_t val; | |||
267 | uint8_t temp[4]; | |||
268 | uint8_t shift; | |||
269 | ||||
270 | shift = (reg & 3) << 3; | |||
271 | reg &= ~3; | |||
272 | ||||
273 | ure_read_mem(sc, reg, index, &temp, 4); | |||
274 | val = UGETDW(temp)(*(u_int32_t *)(temp)); | |||
| ||||
275 | val >>= shift; | |||
276 | ||||
277 | return (val & 0xff); | |||
278 | } | |||
279 | ||||
280 | uint16_t | |||
281 | ure_read_2(struct ure_softc *sc, uint16_t reg, uint16_t index) | |||
282 | { | |||
283 | uint32_t val; | |||
284 | uint8_t temp[4]; | |||
285 | uint8_t shift; | |||
286 | ||||
287 | shift = (reg & 2) << 3; | |||
288 | reg &= ~3; | |||
289 | ||||
290 | ure_read_mem(sc, reg, index, &temp, 4); | |||
291 | val = UGETDW(temp)(*(u_int32_t *)(temp)); | |||
292 | val >>= shift; | |||
293 | ||||
294 | return (val & 0xffff); | |||
295 | } | |||
296 | ||||
297 | uint32_t | |||
298 | ure_read_4(struct ure_softc *sc, uint16_t reg, uint16_t index) | |||
299 | { | |||
300 | uint8_t temp[4]; | |||
301 | ||||
302 | ure_read_mem(sc, reg, index, &temp, 4); | |||
303 | return (UGETDW(temp)(*(u_int32_t *)(temp))); | |||
304 | } | |||
305 | ||||
306 | int | |||
307 | ure_write_1(struct ure_softc *sc, uint16_t reg, uint16_t index, uint32_t val) | |||
308 | { | |||
309 | uint16_t byen; | |||
310 | uint8_t temp[4]; | |||
311 | uint8_t shift; | |||
312 | ||||
313 | byen = URE_BYTE_EN_BYTE0x11; | |||
314 | shift = reg & 3; | |||
315 | val &= 0xff; | |||
316 | ||||
317 | if (reg & 3) { | |||
318 | byen <<= shift; | |||
319 | val <<= (shift << 3); | |||
320 | reg &= ~3; | |||
321 | } | |||
322 | ||||
323 | USETDW(temp, val)(*(u_int32_t *)(temp) = (val)); | |||
324 | return (ure_write_mem(sc, reg, index | byen, &temp, 4)); | |||
325 | } | |||
326 | ||||
327 | int | |||
328 | ure_write_2(struct ure_softc *sc, uint16_t reg, uint16_t index, uint32_t val) | |||
329 | { | |||
330 | uint16_t byen; | |||
331 | uint8_t temp[4]; | |||
332 | uint8_t shift; | |||
333 | ||||
334 | byen = URE_BYTE_EN_WORD0x33; | |||
335 | shift = reg & 2; | |||
336 | val &= 0xffff; | |||
337 | ||||
338 | if (reg & 2) { | |||
339 | byen <<= shift; | |||
340 | val <<= (shift << 3); | |||
341 | reg &= ~3; | |||
342 | } | |||
343 | ||||
344 | USETDW(temp, val)(*(u_int32_t *)(temp) = (val)); | |||
345 | return (ure_write_mem(sc, reg, index | byen, &temp, 4)); | |||
346 | } | |||
347 | ||||
348 | int | |||
349 | ure_write_4(struct ure_softc *sc, uint16_t reg, uint16_t index, uint32_t val) | |||
350 | { | |||
351 | uint8_t temp[4]; | |||
352 | ||||
353 | USETDW(temp, val)(*(u_int32_t *)(temp) = (val)); | |||
354 | return (ure_write_mem(sc, reg, index | URE_BYTE_EN_DWORD0xff, &temp, 4)); | |||
355 | } | |||
356 | ||||
357 | uint16_t | |||
358 | ure_ocp_reg_read(struct ure_softc *sc, uint16_t addr) | |||
359 | { | |||
360 | uint16_t reg; | |||
361 | ||||
362 | ure_write_2(sc, URE_PLA_OCP_GPHY_BASE0xe86c, URE_MCU_TYPE_PLA0x0100, addr & 0xf000); | |||
363 | reg = (addr & 0x0fff) | 0xb000; | |||
364 | ||||
365 | return (ure_read_2(sc, reg, URE_MCU_TYPE_PLA0x0100)); | |||
366 | } | |||
367 | ||||
368 | void | |||
369 | ure_ocp_reg_write(struct ure_softc *sc, uint16_t addr, uint16_t data) | |||
370 | { | |||
371 | uint16_t reg; | |||
372 | ||||
373 | ure_write_2(sc, URE_PLA_OCP_GPHY_BASE0xe86c, URE_MCU_TYPE_PLA0x0100, addr & 0xf000); | |||
374 | reg = (addr & 0x0fff) | 0xb000; | |||
375 | ||||
376 | ure_write_2(sc, reg, URE_MCU_TYPE_PLA0x0100, data); | |||
377 | } | |||
378 | ||||
379 | int | |||
380 | ure_miibus_readreg(struct device *dev, int phy, int reg) | |||
381 | { | |||
382 | struct ure_softc *sc = (void *)dev; | |||
383 | uint16_t val; | |||
384 | ||||
385 | if (usbd_is_dying(sc->ure_udev)) | |||
| ||||
386 | return 0; | |||
387 | ||||
388 | /* Let the rgephy driver read the URE_PLA_PHYSTATUS register. */ | |||
389 | if (reg == RL_GMEDIASTAT0x006C) | |||
390 | return ure_read_1(sc, URE_PLA_PHYSTATUS0xe908, URE_MCU_TYPE_PLA0x0100); | |||
391 | ||||
392 | ure_lock_mii(sc); | |||
393 | val = ure_ocp_reg_read(sc, URE_OCP_BASE_MII0xa400 + reg * 2); | |||
394 | ure_unlock_mii(sc); | |||
395 | ||||
396 | return val; /* letoh16? */ | |||
397 | } | |||
398 | ||||
399 | void | |||
400 | ure_miibus_writereg(struct device *dev, int phy, int reg, int val) | |||
401 | { | |||
402 | struct ure_softc *sc = (void *)dev; | |||
403 | ||||
404 | ure_lock_mii(sc); | |||
405 | ure_ocp_reg_write(sc, URE_OCP_BASE_MII0xa400 + reg * 2, val); /* htole16? */ | |||
406 | ure_unlock_mii(sc); | |||
407 | } | |||
408 | ||||
409 | void | |||
410 | ure_miibus_statchg(struct device *dev) | |||
411 | { | |||
412 | struct ure_softc *sc = (void *)dev; | |||
413 | struct mii_data *mii = &sc->ure_mii; | |||
414 | struct ifnet *ifp = &sc->ure_ac.ac_if; | |||
415 | ||||
416 | if ((ifp->if_flags & IFF_RUNNING0x40) == 0) | |||
417 | return; | |||
418 | ||||
419 | sc->ure_flags &= ~URE_FLAG_LINK0x0001; | |||
420 | if ((mii->mii_media_status & (IFM_ACTIVE0x0000000000000002ULL | IFM_AVALID0x0000000000000001ULL)) == | |||
421 | (IFM_ACTIVE0x0000000000000002ULL | IFM_AVALID0x0000000000000001ULL)) { | |||
422 | switch (IFM_SUBTYPE(mii->mii_media_active)((mii->mii_media_active) & 0x00000000000000ffULL)) { | |||
423 | case IFM_10_T3: | |||
424 | case IFM_100_TX6: | |||
425 | sc->ure_flags |= URE_FLAG_LINK0x0001; | |||
426 | break; | |||
427 | case IFM_1000_T16: | |||
428 | if ((sc->ure_flags & URE_FLAG_81520x1000) != 0) | |||
429 | break; | |||
430 | sc->ure_flags |= URE_FLAG_LINK0x0001; | |||
431 | break; | |||
432 | default: | |||
433 | break; | |||
434 | } | |||
435 | } | |||
436 | ||||
437 | /* Lost link, do nothing. */ | |||
438 | if ((sc->ure_flags & URE_FLAG_LINK0x0001) == 0) | |||
439 | return; | |||
440 | ||||
441 | /* | |||
442 | * After a link change the media settings are getting reset on the | |||
443 | * hardware, and need to be re-initialized again for communication | |||
444 | * to continue work. | |||
445 | */ | |||
446 | ure_ifmedia_init(ifp); | |||
447 | } | |||
448 | ||||
449 | void | |||
450 | ure_ifmedia_init(struct ifnet *ifp) | |||
451 | { | |||
452 | struct ure_softc *sc = ifp->if_softc; | |||
453 | uint32_t reg = 0; | |||
454 | ||||
455 | /* Set MAC address. */ | |||
456 | ure_write_1(sc, URE_PLA_CRWECR0xe81c, URE_MCU_TYPE_PLA0x0100, URE_CRWECR_CONFIG0xc0); | |||
457 | ure_write_mem(sc, URE_PLA_IDR0xc000, URE_MCU_TYPE_PLA0x0100 | URE_BYTE_EN_SIX_BYTES0x3f, | |||
458 | sc->ure_ac.ac_enaddr, 8); | |||
459 | ure_write_1(sc, URE_PLA_CRWECR0xe81c, URE_MCU_TYPE_PLA0x0100, URE_CRWECR_NORAML0x00); | |||
460 | ||||
461 | if (!(sc->ure_flags & URE_FLAG_81520x1000)) { | |||
462 | if (sc->ure_flags & URE_FLAG_8156B0x8000) | |||
463 | URE_CLRBIT_2(sc, URE_USB_RX_AGGR_NUM, URE_MCU_TYPE_USB,ure_write_2(sc, 0xd4ee, 0x0000, ure_read_2(sc, 0xd4ee, 0x0000 ) & ~(0x1ff)) | |||
464 | URE_RX_AGGR_NUM_MASK)ure_write_2(sc, 0xd4ee, 0x0000, ure_read_2(sc, 0xd4ee, 0x0000 ) & ~(0x1ff)); | |||
465 | ||||
466 | reg = sc->ure_rxbufsz - URE_FRAMELEN(ifp->if_mtu)(ifp->if_data.ifi_mtu + ((6 * 2) + 2) + 4 + 4) - | |||
467 | sizeof(struct ure_rxpkt) - URE_RX_BUF_ALIGN8; | |||
468 | if (sc->ure_flags & | |||
469 | (URE_FLAG_8153B0x2000 | URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000)) { | |||
470 | ure_write_2(sc, URE_USB_RX_EARLY_SIZE0xd42e, URE_MCU_TYPE_USB0x0000, | |||
471 | reg / 8); | |||
472 | ||||
473 | ure_write_2(sc, URE_USB_RX_EARLY_AGG0xd42c, URE_MCU_TYPE_USB0x0000, | |||
474 | (sc->ure_flags & URE_FLAG_8153B0x2000) ? 158 : 80); | |||
475 | ure_write_2(sc, URE_USB_PM_CTRL_STATUS0xd432, | |||
476 | URE_MCU_TYPE_USB0x0000, 1875); | |||
477 | } else { | |||
478 | ure_write_2(sc, URE_USB_RX_EARLY_SIZE0xd42e, URE_MCU_TYPE_USB0x0000, | |||
479 | reg / 4); | |||
480 | switch (sc->ure_udev->speed) { | |||
481 | case USB_SPEED_SUPER4: | |||
482 | reg = URE_COALESCE_SUPER85000U / 8; | |||
483 | break; | |||
484 | case USB_SPEED_HIGH3: | |||
485 | reg = URE_COALESCE_HIGH250000U / 8; | |||
486 | break; | |||
487 | default: | |||
488 | reg = URE_COALESCE_SLOW524280U / 8; | |||
489 | break; | |||
490 | } | |||
491 | ure_write_2(sc, URE_USB_RX_EARLY_AGG0xd42c, URE_MCU_TYPE_USB0x0000, | |||
492 | reg); | |||
493 | } | |||
494 | ||||
495 | if (sc->ure_chip & URE_CHIP_VER_74200x80) { | |||
496 | URE_SETBIT_2(sc, URE_PLA_MAC_PWR_CTRL4,ure_write_2(sc, 0xe0ce, 0x0100, ure_read_2(sc, 0xe0ce, 0x0100 ) | (0x0040)) | |||
497 | URE_MCU_TYPE_PLA, URE_IDLE_SPDWN_EN)ure_write_2(sc, 0xe0ce, 0x0100, ure_read_2(sc, 0xe0ce, 0x0100 ) | (0x0040)); | |||
498 | } | |||
499 | ||||
500 | if ((sc->ure_chip & URE_CHIP_VER_60100x40) || | |||
501 | (sc->ure_flags & URE_FLAG_8156B0x8000)) { | |||
502 | URE_CLRBIT_2(sc, URE_USB_FW_TASK, URE_MCU_TYPE_USB,ure_write_2(sc, 0xd4e8, 0x0000, ure_read_2(sc, 0xd4e8, 0x0000 ) & ~(0x0002)) | |||
503 | URE_FC_PATCH_TASK)ure_write_2(sc, 0xd4e8, 0x0000, ure_read_2(sc, 0xd4e8, 0x0000 ) & ~(0x0002)); | |||
504 | usbd_delay_ms(sc->ure_udev, 1); | |||
505 | URE_SETBIT_2(sc, URE_USB_FW_TASK, URE_MCU_TYPE_USB,ure_write_2(sc, 0xd4e8, 0x0000, ure_read_2(sc, 0xd4e8, 0x0000 ) | (0x0002)) | |||
506 | URE_FC_PATCH_TASK)ure_write_2(sc, 0xd4e8, 0x0000, ure_read_2(sc, 0xd4e8, 0x0000 ) | (0x0002)); | |||
507 | } | |||
508 | } | |||
509 | ||||
510 | /* Reset the packet filter. */ | |||
511 | URE_CLRBIT_2(sc, URE_PLA_FMC, URE_MCU_TYPE_PLA, URE_FMC_FCR_MCU_EN)ure_write_2(sc, 0xc0b4, 0x0100, ure_read_2(sc, 0xc0b4, 0x0100 ) & ~(0x0001)); | |||
512 | URE_SETBIT_2(sc, URE_PLA_FMC, URE_MCU_TYPE_PLA, URE_FMC_FCR_MCU_EN)ure_write_2(sc, 0xc0b4, 0x0100, ure_read_2(sc, 0xc0b4, 0x0100 ) | (0x0001)); | |||
513 | ||||
514 | /* Enable transmit and receive. */ | |||
515 | URE_SETBIT_1(sc, URE_PLA_CR, URE_MCU_TYPE_PLA, URE_CR_RE | URE_CR_TE)ure_write_1(sc, 0xe813, 0x0100, ure_read_1(sc, 0xe813, 0x0100 ) | (0x08 | 0x04)); | |||
516 | ||||
517 | if (sc->ure_flags & (URE_FLAG_8153B0x2000 | URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000)) { | |||
518 | ure_write_1(sc, URE_USB_UPT_RXDMA_OWN0xd437, URE_MCU_TYPE_USB0x0000, | |||
519 | URE_OWN_UPDATE0x01 | URE_OWN_CLEAR0x02); | |||
520 | } | |||
521 | ||||
522 | URE_CLRBIT_2(sc, URE_PLA_MISC_1, URE_MCU_TYPE_PLA, URE_RXDY_GATED_EN)ure_write_2(sc, 0xe85a, 0x0100, ure_read_2(sc, 0xe85a, 0x0100 ) & ~(0x0008)); | |||
523 | } | |||
524 | ||||
525 | int | |||
526 | ure_ifmedia_upd(struct ifnet *ifp) | |||
527 | { | |||
528 | struct ure_softc *sc = ifp->if_softc; | |||
529 | struct mii_data *mii = &sc->ure_mii; | |||
530 | struct ifmedia *ifm = &sc->ure_ifmedia; | |||
531 | int anar, gig, err, reg; | |||
532 | ||||
533 | if (sc->ure_flags & (URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000)) { | |||
534 | if (IFM_TYPE(ifm->ifm_media)((ifm->ifm_media) & 0x000000000000ff00ULL) != IFM_ETHER0x0000000000000100ULL) | |||
535 | return (EINVAL22); | |||
536 | ||||
537 | if (!(sc->ure_chip & URE_CHIP_VER_74200x80)) { | |||
538 | reg = ure_ocp_reg_read(sc, URE_OCP_10GBT_CTRL0xa5d4); | |||
539 | reg &= ~URE_ADV_2500TFDX0x0080; | |||
540 | } | |||
541 | ||||
542 | anar = gig = 0; | |||
543 | switch (IFM_SUBTYPE(ifm->ifm_media)((ifm->ifm_media) & 0x00000000000000ffULL)) { | |||
544 | case IFM_AUTO0ULL: | |||
545 | anar |= ANAR_TX_FD0x0100 | ANAR_TX0x0080 | ANAR_10_FD0x0040 | ANAR_100x0020; | |||
546 | gig |= GTCR_ADV_1000TFDX0x0200 | GTCR_ADV_1000THDX0x0100; | |||
547 | if (!(sc->ure_chip & URE_CHIP_VER_74200x80)) | |||
548 | reg |= URE_ADV_2500TFDX0x0080; | |||
549 | break; | |||
550 | case IFM_2500_T34: | |||
551 | anar |= ANAR_TX_FD0x0100 | ANAR_TX0x0080 | ANAR_10_FD0x0040 | ANAR_100x0020; | |||
552 | gig |= GTCR_ADV_1000TFDX0x0200 | GTCR_ADV_1000THDX0x0100; | |||
553 | reg |= URE_ADV_2500TFDX0x0080; | |||
554 | ifp->if_baudrateif_data.ifi_baudrate = IF_Mbps(2500)((((2500) * 1000ULL) * 1000ULL)); | |||
555 | break; | |||
556 | case IFM_1000_T16: | |||
557 | anar |= ANAR_TX_FD0x0100 | ANAR_TX0x0080 | ANAR_10_FD0x0040 | ANAR_100x0020; | |||
558 | gig |= GTCR_ADV_1000TFDX0x0200 | GTCR_ADV_1000THDX0x0100; | |||
559 | ifp->if_baudrateif_data.ifi_baudrate = IF_Gbps(1)((((((1) * 1000ULL) * 1000ULL) * 1000ULL))); | |||
560 | break; | |||
561 | case IFM_100_TX6: | |||
562 | anar |= ANAR_TX0x0080 | ANAR_TX_FD0x0100; | |||
563 | ifp->if_baudrateif_data.ifi_baudrate = IF_Mbps(100)((((100) * 1000ULL) * 1000ULL)); | |||
564 | break; | |||
565 | case IFM_10_T3: | |||
566 | anar |= ANAR_100x0020 | ANAR_10_FD0x0040; | |||
567 | ifp->if_baudrateif_data.ifi_baudrate = IF_Mbps(10)((((10) * 1000ULL) * 1000ULL)); | |||
568 | break; | |||
569 | default: | |||
570 | printf("%s: unsupported media type\n", | |||
571 | sc->ure_dev.dv_xname); | |||
572 | return (EINVAL22); | |||
573 | } | |||
574 | ||||
575 | ure_ocp_reg_write(sc, URE_OCP_BASE_MII0xa400 + MII_ANAR0x04 * 2, | |||
576 | anar | ANAR_PAUSE_ASYM(2 << 10) | ANAR_FC0x0400); | |||
577 | ure_ocp_reg_write(sc, URE_OCP_BASE_MII0xa400 + MII_100T2CR0x09 * 2, gig); | |||
578 | if (!(sc->ure_chip & URE_CHIP_VER_74200x80)) | |||
579 | ure_ocp_reg_write(sc, URE_OCP_10GBT_CTRL0xa5d4, reg); | |||
580 | ure_ocp_reg_write(sc, URE_OCP_BASE_MII0xa400 + MII_BMCR0x00, | |||
581 | BMCR_AUTOEN0x1000 | BMCR_STARTNEG0x0200); | |||
582 | ||||
583 | return (0); | |||
584 | } | |||
585 | ||||
586 | if (mii->mii_instance) { | |||
587 | struct mii_softc *miisc; | |||
588 | LIST_FOREACH(miisc, &mii->mii_phys, mii_list)for((miisc) = ((&mii->mii_phys)->lh_first); (miisc) != ((void *)0); (miisc) = ((miisc)->mii_list.le_next)) | |||
589 | PHY_RESET(miisc)(*(miisc)->mii_funcs->pf_reset)((miisc)); | |||
590 | } | |||
591 | ||||
592 | err = mii_mediachg(mii); | |||
593 | if (err == ENXIO6) | |||
594 | return (0); | |||
595 | else | |||
596 | return (err); | |||
597 | } | |||
598 | ||||
599 | void | |||
600 | ure_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr) | |||
601 | { | |||
602 | struct ure_softc *sc = ifp->if_softc; | |||
603 | struct mii_data *mii = &sc->ure_mii; | |||
604 | uint16_t status = 0; | |||
605 | ||||
606 | if (sc->ure_flags & (URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000)) { | |||
607 | ifmr->ifm_status = IFM_AVALID0x0000000000000001ULL; | |||
608 | if (ure_get_link_status(sc)) { | |||
609 | ifmr->ifm_status |= IFM_ACTIVE0x0000000000000002ULL; | |||
610 | status = ure_read_2(sc, URE_PLA_PHYSTATUS0xe908, | |||
611 | URE_MCU_TYPE_PLA0x0100); | |||
612 | if ((status & URE_PHYSTATUS_FDX0x0001) || | |||
613 | (status & URE_PHYSTATUS_2500MBPS0x0400)) | |||
614 | ifmr->ifm_active |= IFM_FDX0x0000010000000000ULL; | |||
615 | else | |||
616 | ifmr->ifm_active |= IFM_HDX0x0000020000000000ULL; | |||
617 | if (status & URE_PHYSTATUS_10MBPS0x0004) | |||
618 | ifmr->ifm_active |= IFM_10_T3; | |||
619 | else if (status & URE_PHYSTATUS_100MBPS0x0008) | |||
620 | ifmr->ifm_active |= IFM_100_TX6; | |||
621 | else if (status & URE_PHYSTATUS_1000MBPS0x0010) | |||
622 | ifmr->ifm_active |= IFM_1000_T16; | |||
623 | else if (status & URE_PHYSTATUS_2500MBPS0x0400) | |||
624 | ifmr->ifm_active |= IFM_2500_T34; | |||
625 | } | |||
626 | return; | |||
627 | } | |||
628 | ||||
629 | mii_pollstat(mii); | |||
630 | ifmr->ifm_active = mii->mii_media_active; | |||
631 | ifmr->ifm_status = mii->mii_media_status; | |||
632 | } | |||
633 | ||||
634 | void | |||
635 | ure_add_media_types(struct ure_softc *sc) | |||
636 | { | |||
637 | ifmedia_add(&sc->ure_ifmedia, IFM_ETHER0x0000000000000100ULL | IFM_10_T3, 0, NULL((void *)0)); | |||
638 | ifmedia_add(&sc->ure_ifmedia, IFM_ETHER0x0000000000000100ULL | IFM_10_T3 | IFM_FDX0x0000010000000000ULL, 0, NULL((void *)0)); | |||
639 | ifmedia_add(&sc->ure_ifmedia, IFM_ETHER0x0000000000000100ULL | IFM_100_TX6, 0, NULL((void *)0)); | |||
640 | ifmedia_add(&sc->ure_ifmedia, IFM_ETHER0x0000000000000100ULL | IFM_100_TX6 | IFM_FDX0x0000010000000000ULL, 0, | |||
641 | NULL((void *)0)); | |||
642 | ifmedia_add(&sc->ure_ifmedia, IFM_ETHER0x0000000000000100ULL | IFM_1000_T16, 0, NULL((void *)0)); | |||
643 | ifmedia_add(&sc->ure_ifmedia, IFM_ETHER0x0000000000000100ULL | IFM_1000_T16 | IFM_FDX0x0000010000000000ULL, 0, | |||
644 | NULL((void *)0)); | |||
645 | if (!(sc->ure_chip & URE_CHIP_VER_74200x80)) { | |||
646 | ifmedia_add(&sc->ure_ifmedia, IFM_ETHER0x0000000000000100ULL | IFM_2500_T34, 0, NULL((void *)0)); | |||
647 | ifmedia_add(&sc->ure_ifmedia, IFM_ETHER0x0000000000000100ULL | IFM_2500_T34 | IFM_FDX0x0000010000000000ULL, | |||
648 | 0, NULL((void *)0)); | |||
649 | } | |||
650 | } | |||
651 | ||||
652 | void | |||
653 | ure_link_state(struct ure_softc *sc) | |||
654 | { | |||
655 | struct ifnet *ifp = &sc->ure_ac.ac_if; | |||
656 | int link = LINK_STATE_DOWN2; | |||
657 | ||||
658 | if (ure_get_link_status(sc)) | |||
659 | link = LINK_STATE_UP4; | |||
660 | ||||
661 | if (ifp->if_link_stateif_data.ifi_link_state != link) { | |||
662 | ifp->if_link_stateif_data.ifi_link_state = link; | |||
663 | if_link_state_change(ifp); | |||
664 | } | |||
665 | } | |||
666 | ||||
667 | int | |||
668 | ure_get_link_status(struct ure_softc *sc) | |||
669 | { | |||
670 | if (ure_read_2(sc, URE_PLA_PHYSTATUS0xe908, URE_MCU_TYPE_PLA0x0100) & | |||
671 | URE_PHYSTATUS_LINK0x0002) { | |||
672 | sc->ure_flags |= URE_FLAG_LINK0x0001; | |||
673 | return (1); | |||
674 | } else { | |||
675 | sc->ure_flags &= ~URE_FLAG_LINK0x0001; | |||
676 | return (0); | |||
677 | } | |||
678 | } | |||
679 | ||||
680 | void | |||
681 | ure_iff(struct ure_softc *sc) | |||
682 | { | |||
683 | struct ifnet *ifp = &sc->ure_ac.ac_if; | |||
684 | struct ether_multi *enm; | |||
685 | struct ether_multistep step; | |||
686 | uint32_t hashes[2] = { 0, 0 }; | |||
687 | uint32_t hash; | |||
688 | uint32_t rxmode; | |||
689 | ||||
690 | if (usbd_is_dying(sc->ure_udev)) | |||
691 | return; | |||
692 | ||||
693 | rxmode = ure_read_4(sc, URE_PLA_RCR0xc010, URE_MCU_TYPE_PLA0x0100); | |||
694 | rxmode &= ~URE_RCR_ACPT_ALL(0x00000001 | 0x00000002 | 0x00000004 | 0x00000008); | |||
695 | ifp->if_flags &= ~IFF_ALLMULTI0x200; | |||
696 | ||||
697 | /* | |||
698 | * Always accept frames destined to our station address. | |||
699 | * Always accept broadcast frames. | |||
700 | */ | |||
701 | rxmode |= URE_RCR_APM0x00000002 | URE_RCR_AB0x00000008; | |||
702 | ||||
703 | if (ifp->if_flags & IFF_PROMISC0x100 || sc->ure_ac.ac_multirangecnt > 0) { | |||
704 | ifp->if_flags |= IFF_ALLMULTI0x200; | |||
705 | rxmode |= URE_RCR_AM0x00000004; | |||
706 | if (ifp->if_flags & IFF_PROMISC0x100) | |||
707 | rxmode |= URE_RCR_AAP0x00000001; | |||
708 | hashes[0] = hashes[1] = 0xffffffff; | |||
709 | } else { | |||
710 | rxmode |= URE_RCR_AM0x00000004; | |||
711 | ||||
712 | ETHER_FIRST_MULTI(step, &sc->ure_ac, enm)do { (step).e_enm = ((&(&sc->ure_ac)->ac_multiaddrs )->lh_first); do { if ((((enm)) = ((step)).e_enm) != ((void *)0)) ((step)).e_enm = ((((enm)))->enm_list.le_next); } while ( 0); } while ( 0); | |||
713 | while (enm != NULL((void *)0)) { | |||
714 | hash = ether_crc32_be(enm->enm_addrlo, ETHER_ADDR_LEN6) | |||
715 | >> 26; | |||
716 | if (hash < 32) | |||
717 | hashes[0] |= (1 << hash); | |||
718 | else | |||
719 | hashes[1] |= (1 << (hash - 32)); | |||
720 | ||||
721 | ETHER_NEXT_MULTI(step, enm)do { if (((enm) = (step).e_enm) != ((void *)0)) (step).e_enm = (((enm))->enm_list.le_next); } while ( 0); | |||
722 | } | |||
723 | ||||
724 | hash = swap32(hashes[0])(__uint32_t)(__builtin_constant_p(hashes[0]) ? (__uint32_t)(( (__uint32_t)(hashes[0]) & 0xff) << 24 | ((__uint32_t )(hashes[0]) & 0xff00) << 8 | ((__uint32_t)(hashes[ 0]) & 0xff0000) >> 8 | ((__uint32_t)(hashes[0]) & 0xff000000) >> 24) : __swap32md(hashes[0])); | |||
725 | hashes[0] = swap32(hashes[1])(__uint32_t)(__builtin_constant_p(hashes[1]) ? (__uint32_t)(( (__uint32_t)(hashes[1]) & 0xff) << 24 | ((__uint32_t )(hashes[1]) & 0xff00) << 8 | ((__uint32_t)(hashes[ 1]) & 0xff0000) >> 8 | ((__uint32_t)(hashes[1]) & 0xff000000) >> 24) : __swap32md(hashes[1])); | |||
726 | hashes[1] = hash; | |||
727 | } | |||
728 | ||||
729 | ure_write_mem(sc, URE_PLA_MAR0xcd00, URE_MCU_TYPE_PLA0x0100 | URE_BYTE_EN_DWORD0xff, | |||
730 | hashes, sizeof(hashes)); | |||
731 | ure_write_4(sc, URE_PLA_RCR0xc010, URE_MCU_TYPE_PLA0x0100, rxmode); | |||
732 | } | |||
733 | ||||
734 | void | |||
735 | ure_rxvlan(struct ure_softc *sc) | |||
736 | { | |||
737 | struct ifnet *ifp = &sc->ure_ac.ac_if; | |||
738 | uint16_t reg; | |||
739 | ||||
740 | if (sc->ure_flags & (URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000)) { | |||
741 | reg = ure_read_2(sc, URE_PLA_RCR10xc012, URE_MCU_TYPE_PLA0x0100); | |||
742 | reg &= ~(URE_INNER_VLAN0x0040 | URE_OUTER_VLAN0x0080); | |||
743 | if (ifp->if_capabilitiesif_data.ifi_capabilities & IFCAP_VLAN_HWTAGGING0x00000020) | |||
744 | reg |= (URE_INNER_VLAN0x0040 | URE_OUTER_VLAN0x0080); | |||
745 | ure_write_2(sc, URE_PLA_RCR10xc012, URE_MCU_TYPE_PLA0x0100, reg); | |||
746 | } else { | |||
747 | reg = ure_read_2(sc, URE_PLA_CPCR0xe854, URE_MCU_TYPE_PLA0x0100); | |||
748 | reg &= ~URE_CPCR_RX_VLAN0x0040; | |||
749 | if (ifp->if_capabilitiesif_data.ifi_capabilities & IFCAP_VLAN_HWTAGGING0x00000020) | |||
750 | reg |= URE_CPCR_RX_VLAN0x0040; | |||
751 | ure_write_2(sc, URE_PLA_CPCR0xe854, URE_MCU_TYPE_PLA0x0100, reg); | |||
752 | } | |||
753 | } | |||
754 | ||||
755 | void | |||
756 | ure_reset(struct ure_softc *sc) | |||
757 | { | |||
758 | int i; | |||
759 | ||||
760 | if (sc->ure_flags & URE_FLAG_81560x4000) { | |||
761 | URE_CLRBIT_1(sc, URE_PLA_CR, URE_MCU_TYPE_PLA, URE_CR_TE)ure_write_1(sc, 0xe813, 0x0100, ure_read_1(sc, 0xe813, 0x0100 ) & ~(0x04)); | |||
762 | URE_CLRBIT_2(sc, URE_USB_BMU_RESET, URE_MCU_TYPE_USB,ure_write_2(sc, 0xd4b0, 0x0000, ure_read_2(sc, 0xd4b0, 0x0000 ) & ~(0x01)) | |||
763 | BMU_RESET_EP_IN)ure_write_2(sc, 0xd4b0, 0x0000, ure_read_2(sc, 0xd4b0, 0x0000 ) & ~(0x01)); | |||
764 | URE_SETBIT_2(sc, URE_USB_USB_CTRL, URE_MCU_TYPE_USB,ure_write_2(sc, 0xd406, 0x0000, ure_read_2(sc, 0xd406, 0x0000 ) | (0x0008)) | |||
765 | URE_CDC_ECM_EN)ure_write_2(sc, 0xd406, 0x0000, ure_read_2(sc, 0xd406, 0x0000 ) | (0x0008)); | |||
766 | URE_CLRBIT_1(sc, URE_PLA_CR, URE_MCU_TYPE_PLA, URE_CR_RE)ure_write_1(sc, 0xe813, 0x0100, ure_read_1(sc, 0xe813, 0x0100 ) & ~(0x08)); | |||
767 | URE_SETBIT_2(sc, URE_USB_BMU_RESET, URE_MCU_TYPE_USB,ure_write_2(sc, 0xd4b0, 0x0000, ure_read_2(sc, 0xd4b0, 0x0000 ) | (0x01)) | |||
768 | BMU_RESET_EP_IN)ure_write_2(sc, 0xd4b0, 0x0000, ure_read_2(sc, 0xd4b0, 0x0000 ) | (0x01)); | |||
769 | URE_CLRBIT_2(sc, URE_USB_USB_CTRL, URE_MCU_TYPE_USB,ure_write_2(sc, 0xd406, 0x0000, ure_read_2(sc, 0xd406, 0x0000 ) & ~(0x0008)) | |||
770 | URE_CDC_ECM_EN)ure_write_2(sc, 0xd406, 0x0000, ure_read_2(sc, 0xd406, 0x0000 ) & ~(0x0008)); | |||
771 | } else { | |||
772 | ure_write_1(sc, URE_PLA_CR0xe813, URE_MCU_TYPE_PLA0x0100, URE_CR_RST0x10); | |||
773 | ||||
774 | for (i = 0; i < URE_TIMEOUT1000; i++) { | |||
775 | if (!(ure_read_1(sc, URE_PLA_CR0xe813, URE_MCU_TYPE_PLA0x0100) & | |||
776 | URE_CR_RST0x10)) | |||
777 | break; | |||
778 | DELAY(100)(*delay_func)(100); | |||
779 | } | |||
780 | if (i == URE_TIMEOUT1000) | |||
781 | printf("%s: reset never completed\n", | |||
782 | sc->ure_dev.dv_xname); | |||
783 | } | |||
784 | } | |||
785 | ||||
786 | void | |||
787 | ure_watchdog(struct ifnet *ifp) | |||
788 | { | |||
789 | struct ure_softc *sc = ifp->if_softc; | |||
790 | struct ure_chain *c; | |||
791 | usbd_status err; | |||
792 | int i, s; | |||
793 | ||||
794 | ifp->if_timer = 0; | |||
795 | ||||
796 | if (usbd_is_dying(sc->ure_udev)) | |||
797 | return; | |||
798 | ||||
799 | if ((ifp->if_flags & (IFF_RUNNING0x40|IFF_UP0x1)) != (IFF_RUNNING0x40|IFF_UP0x1)) | |||
800 | return; | |||
801 | ||||
802 | sc = ifp->if_softc; | |||
803 | s = splnet()splraise(0x4); | |||
804 | ||||
805 | ifp->if_oerrorsif_data.ifi_oerrors++; | |||
806 | DPRINTF(("%s: watchdog timeout\n", sc->ure_dev.dv_xname)); | |||
807 | ||||
808 | for (i = 0; i < URE_TX_LIST_CNT1; i++) { | |||
809 | c = &sc->ure_cdata.ure_tx_chain[i]; | |||
810 | if (c->uc_cnt > 0) { | |||
811 | usbd_get_xfer_status(c->uc_xfer, NULL((void *)0), NULL((void *)0), NULL((void *)0), | |||
812 | &err); | |||
813 | ure_txeof(c->uc_xfer, c, err); | |||
814 | } | |||
815 | } | |||
816 | ||||
817 | if (ifq_is_oactive(&ifp->if_snd)) | |||
818 | ifq_restart(&ifp->if_snd); | |||
819 | splx(s)spllower(s); | |||
820 | } | |||
821 | ||||
822 | void | |||
823 | ure_init(void *xsc) | |||
824 | { | |||
825 | struct ure_softc *sc = xsc; | |||
826 | struct ure_chain *c; | |||
827 | struct ifnet *ifp = &sc->ure_ac.ac_if; | |||
828 | usbd_status err; | |||
829 | int s, i; | |||
830 | ||||
831 | s = splnet()splraise(0x4); | |||
832 | ||||
833 | /* Cancel pending I/O. */ | |||
834 | ure_stop(sc); | |||
835 | ||||
836 | if (sc->ure_flags & URE_FLAG_81520x1000) | |||
837 | ure_rtl8152_nic_reset(sc); | |||
838 | else | |||
839 | ure_rtl8153_nic_reset(sc); | |||
840 | ||||
841 | if (ure_xfer_list_init(sc, sc->ure_cdata.ure_rx_chain, | |||
842 | sc->ure_rxbufsz, URE_RX_LIST_CNT1) == ENOBUFS55) { | |||
843 | printf("%s: rx list init failed\n", sc->ure_dev.dv_xname); | |||
844 | splx(s)spllower(s); | |||
845 | return; | |||
846 | } | |||
847 | ||||
848 | if (ure_xfer_list_init(sc, sc->ure_cdata.ure_tx_chain, | |||
849 | sc->ure_txbufsz, URE_TX_LIST_CNT1) == ENOBUFS55) { | |||
850 | printf("%s: tx list init failed\n", sc->ure_dev.dv_xname); | |||
851 | splx(s)spllower(s); | |||
852 | return; | |||
853 | } | |||
854 | ||||
855 | /* Initialize the SLIST we are using for the multiple tx buffers */ | |||
856 | SLIST_INIT(&sc->ure_cdata.ure_tx_free){ ((&sc->ure_cdata.ure_tx_free)->slh_first) = ((void *)0); }; | |||
857 | for (i = 0; i < URE_TX_LIST_CNT1; i++) | |||
858 | SLIST_INSERT_HEAD(&sc->ure_cdata.ure_tx_free,do { (&sc->ure_cdata.ure_tx_chain[i])->uc_list.sle_next = (&sc->ure_cdata.ure_tx_free)->slh_first; (&sc ->ure_cdata.ure_tx_free)->slh_first = (&sc->ure_cdata .ure_tx_chain[i]); } while (0) | |||
859 | &sc->ure_cdata.ure_tx_chain[i], uc_list)do { (&sc->ure_cdata.ure_tx_chain[i])->uc_list.sle_next = (&sc->ure_cdata.ure_tx_free)->slh_first; (&sc ->ure_cdata.ure_tx_free)->slh_first = (&sc->ure_cdata .ure_tx_chain[i]); } while (0); | |||
860 | ||||
861 | /* Setup MAC address, and enable TX/RX. */ | |||
862 | ure_ifmedia_init(ifp); | |||
863 | ||||
864 | /* Load the multicast filter. */ | |||
865 | ure_iff(sc); | |||
866 | ||||
867 | /* Open RX and TX pipes. */ | |||
868 | err = usbd_open_pipe(sc->ure_iface, sc->ure_ed[URE_ENDPT_RX0], | |||
869 | USBD_EXCLUSIVE_USE0x01, &sc->ure_ep[URE_ENDPT_RX0]); | |||
870 | if (err) { | |||
871 | printf("%s: open rx pipe failed: %s\n", | |||
872 | sc->ure_dev.dv_xname, usbd_errstr(err)); | |||
873 | splx(s)spllower(s); | |||
874 | return; | |||
875 | } | |||
876 | ||||
877 | err = usbd_open_pipe(sc->ure_iface, sc->ure_ed[URE_ENDPT_TX1], | |||
878 | USBD_EXCLUSIVE_USE0x01, &sc->ure_ep[URE_ENDPT_TX1]); | |||
879 | if (err) { | |||
880 | printf("%s: open tx pipe failed: %s\n", | |||
881 | sc->ure_dev.dv_xname, usbd_errstr(err)); | |||
882 | splx(s)spllower(s); | |||
883 | return; | |||
884 | } | |||
885 | ||||
886 | /* Start up the receive pipe. */ | |||
887 | for (i = 0; i < URE_RX_LIST_CNT1; i++) { | |||
888 | c = &sc->ure_cdata.ure_rx_chain[i]; | |||
889 | usbd_setup_xfer(c->uc_xfer, sc->ure_ep[URE_ENDPT_RX0], | |||
890 | c, c->uc_buf, c->uc_bufmax, | |||
891 | USBD_SHORT_XFER_OK0x04 | USBD_NO_COPY0x01, | |||
892 | USBD_NO_TIMEOUT0, ure_rxeof); | |||
893 | usbd_transfer(c->uc_xfer); | |||
894 | } | |||
895 | ||||
896 | ure_ifmedia_upd(ifp); | |||
897 | ||||
898 | /* Indicate we are up and running. */ | |||
899 | sc->ure_flags &= ~URE_FLAG_LINK0x0001; | |||
900 | ifp->if_flags |= IFF_RUNNING0x40; | |||
901 | ifq_clr_oactive(&ifp->if_snd); | |||
902 | ||||
903 | timeout_add_sec(&sc->ure_stat_ch, 1); | |||
904 | ||||
905 | splx(s)spllower(s); | |||
906 | } | |||
907 | ||||
908 | void | |||
909 | ure_start(struct ifnet *ifp) | |||
910 | { | |||
911 | struct ure_softc *sc = ifp->if_softc; | |||
912 | struct ure_cdata *cd = &sc->ure_cdata; | |||
913 | struct ure_chain *c; | |||
914 | struct mbuf *m = NULL((void *)0); | |||
915 | uint32_t new_buflen; | |||
916 | int s, mlen; | |||
917 | ||||
918 | if (!(sc->ure_flags & URE_FLAG_LINK0x0001) || | |||
919 | (ifp->if_flags & (IFF_RUNNING0x40|IFF_UP0x1)) != | |||
920 | (IFF_RUNNING0x40|IFF_UP0x1)) { | |||
921 | return; | |||
922 | } | |||
923 | ||||
924 | s = splnet()splraise(0x4); | |||
925 | ||||
926 | c = SLIST_FIRST(&cd->ure_tx_free)((&cd->ure_tx_free)->slh_first); | |||
927 | while (c != NULL((void *)0)) { | |||
928 | m = ifq_deq_begin(&ifp->if_snd); | |||
929 | if (m == NULL((void *)0)) | |||
930 | break; | |||
931 | ||||
932 | mlen = m->m_pkthdrM_dat.MH.MH_pkthdr.len; | |||
933 | ||||
934 | /* Discard packet larger than buffer. */ | |||
935 | if (mlen + sizeof(struct ure_txpkt) >= c->uc_bufmax) { | |||
936 | ifq_deq_commit(&ifp->if_snd, m); | |||
937 | m_freem(m); | |||
938 | ifp->if_oerrorsif_data.ifi_oerrors++; | |||
939 | continue; | |||
940 | } | |||
941 | ||||
942 | /* | |||
943 | * If packet larger than remaining space, send buffer and | |||
944 | * continue. | |||
945 | */ | |||
946 | new_buflen = roundup(c->uc_buflen, URE_TX_BUF_ALIGN)((((c->uc_buflen)+((4)-1))/(4))*(4)); | |||
947 | if (new_buflen + sizeof(struct ure_txpkt) + mlen >= | |||
948 | c->uc_bufmax) { | |||
949 | ifq_deq_rollback(&ifp->if_snd, m); | |||
950 | SLIST_REMOVE_HEAD(&cd->ure_tx_free, uc_list)do { (&cd->ure_tx_free)->slh_first = (&cd->ure_tx_free )->slh_first->uc_list.sle_next; } while (0); | |||
951 | if (ure_encap_xfer(ifp, sc, c)) { | |||
952 | SLIST_INSERT_HEAD(&cd->ure_tx_free, c,do { (c)->uc_list.sle_next = (&cd->ure_tx_free)-> slh_first; (&cd->ure_tx_free)->slh_first = (c); } while (0) | |||
953 | uc_list)do { (c)->uc_list.sle_next = (&cd->ure_tx_free)-> slh_first; (&cd->ure_tx_free)->slh_first = (c); } while (0); | |||
954 | break; | |||
955 | } | |||
956 | c = SLIST_FIRST(&cd->ure_tx_free)((&cd->ure_tx_free)->slh_first); | |||
957 | continue; | |||
958 | } | |||
959 | ||||
960 | /* Append packet to current buffer. */ | |||
961 | mlen = ure_encap_txpkt(m, c->uc_buf + new_buflen, | |||
962 | c->uc_bufmax - new_buflen); | |||
963 | if (mlen <= 0) { | |||
964 | ifq_deq_rollback(&ifp->if_snd, m); | |||
965 | break; | |||
966 | } | |||
967 | ||||
968 | ifq_deq_commit(&ifp->if_snd, m); | |||
969 | c->uc_cnt += 1; | |||
970 | c->uc_buflen = new_buflen + mlen; | |||
971 | ||||
972 | #if NBPFILTER1 > 0 | |||
973 | if (ifp->if_bpf) | |||
974 | bpf_mtap(ifp->if_bpf, m, BPF_DIRECTION_OUT(1 << 1)); | |||
975 | #endif | |||
976 | ||||
977 | m_freem(m); | |||
978 | } | |||
979 | ||||
980 | if (c != NULL((void *)0)) { | |||
981 | /* Send current buffer unless empty */ | |||
982 | if (c->uc_buflen > 0 && c->uc_cnt > 0) { | |||
983 | SLIST_REMOVE_HEAD(&cd->ure_tx_free, uc_list)do { (&cd->ure_tx_free)->slh_first = (&cd->ure_tx_free )->slh_first->uc_list.sle_next; } while (0); | |||
984 | if (ure_encap_xfer(ifp, sc, c)) { | |||
985 | SLIST_INSERT_HEAD(&cd->ure_tx_free, c,do { (c)->uc_list.sle_next = (&cd->ure_tx_free)-> slh_first; (&cd->ure_tx_free)->slh_first = (c); } while (0) | |||
986 | uc_list)do { (c)->uc_list.sle_next = (&cd->ure_tx_free)-> slh_first; (&cd->ure_tx_free)->slh_first = (c); } while (0); | |||
987 | } | |||
988 | c = SLIST_FIRST(&cd->ure_tx_free)((&cd->ure_tx_free)->slh_first); | |||
989 | } | |||
990 | } | |||
991 | ||||
992 | ifp->if_timer = 5; | |||
993 | if (c == NULL((void *)0)) | |||
994 | ifq_set_oactive(&ifp->if_snd); | |||
995 | splx(s)spllower(s); | |||
996 | } | |||
997 | ||||
998 | void | |||
999 | ure_tick(void *xsc) | |||
1000 | { | |||
1001 | struct ure_softc *sc = xsc; | |||
1002 | ||||
1003 | if (sc == NULL((void *)0)) | |||
1004 | return; | |||
1005 | ||||
1006 | if (usbd_is_dying(sc->ure_udev)) | |||
1007 | return; | |||
1008 | ||||
1009 | usb_add_task(sc->ure_udev, &sc->ure_tick_task); | |||
1010 | } | |||
1011 | ||||
1012 | void | |||
1013 | ure_stop(struct ure_softc *sc) | |||
1014 | { | |||
1015 | struct ure_cdata *cd; | |||
1016 | struct ifnet *ifp; | |||
1017 | usbd_status err; | |||
1018 | ||||
1019 | ure_reset(sc); | |||
1020 | ||||
1021 | ifp = &sc->ure_ac.ac_if; | |||
1022 | ifp->if_timer = 0; | |||
1023 | ifp->if_flags &= ~IFF_RUNNING0x40; | |||
1024 | ifq_clr_oactive(&ifp->if_snd); | |||
1025 | ||||
1026 | timeout_del(&sc->ure_stat_ch); | |||
1027 | sc->ure_flags &= ~URE_FLAG_LINK0x0001; | |||
1028 | ||||
1029 | if (sc->ure_ep[URE_ENDPT_RX0] != NULL((void *)0)) { | |||
1030 | err = usbd_close_pipe(sc->ure_ep[URE_ENDPT_RX0]); | |||
1031 | if (err) { | |||
1032 | printf("%s: close rx pipe failed: %s\n", | |||
1033 | sc->ure_dev.dv_xname, usbd_errstr(err)); | |||
1034 | } | |||
1035 | sc->ure_ep[URE_ENDPT_RX0] = NULL((void *)0); | |||
1036 | } | |||
1037 | ||||
1038 | if (sc->ure_ep[URE_ENDPT_TX1] != NULL((void *)0)) { | |||
1039 | err = usbd_close_pipe(sc->ure_ep[URE_ENDPT_TX1]); | |||
1040 | if (err) { | |||
1041 | printf("%s: close tx pipe failed: %s\n", | |||
1042 | sc->ure_dev.dv_xname, usbd_errstr(err)); | |||
1043 | } | |||
1044 | sc->ure_ep[URE_ENDPT_TX1] = NULL((void *)0); | |||
1045 | } | |||
1046 | ||||
1047 | cd = &sc->ure_cdata; | |||
1048 | ure_xfer_list_free(sc, cd->ure_rx_chain, URE_RX_LIST_CNT1); | |||
1049 | ure_xfer_list_free(sc, cd->ure_tx_chain, URE_TX_LIST_CNT1); | |||
1050 | } | |||
1051 | ||||
1052 | int | |||
1053 | ure_xfer_list_init(struct ure_softc *sc, struct ure_chain *ch, | |||
1054 | uint32_t bufsize, int listlen) | |||
1055 | { | |||
1056 | struct ure_chain *c; | |||
1057 | int i; | |||
1058 | ||||
1059 | for (i = 0; i < listlen; i++) { | |||
1060 | c = &ch[i]; | |||
1061 | c->uc_sc = sc; | |||
1062 | c->uc_idx = i; | |||
1063 | c->uc_buflen = 0; | |||
1064 | c->uc_bufmax = bufsize; | |||
1065 | c->uc_cnt = 0; | |||
1066 | if (c->uc_xfer == NULL((void *)0)) { | |||
1067 | c->uc_xfer = usbd_alloc_xfer(sc->ure_udev); | |||
1068 | if (c->uc_xfer == NULL((void *)0)) | |||
1069 | return (ENOBUFS55); | |||
1070 | c->uc_buf = usbd_alloc_buffer(c->uc_xfer, c->uc_bufmax); | |||
1071 | if (c->uc_buf == NULL((void *)0)) { | |||
1072 | usbd_free_xfer(c->uc_xfer); | |||
1073 | c->uc_xfer = NULL((void *)0); | |||
1074 | return (ENOBUFS55); | |||
1075 | } | |||
1076 | } | |||
1077 | } | |||
1078 | ||||
1079 | return (0); | |||
1080 | } | |||
1081 | ||||
1082 | void | |||
1083 | ure_xfer_list_free(struct ure_softc *sc, struct ure_chain *ch, int listlen) | |||
1084 | { | |||
1085 | int i; | |||
1086 | ||||
1087 | for (i = 0; i < listlen; i++) { | |||
1088 | if (ch[i].uc_buf != NULL((void *)0)) { | |||
1089 | ch[i].uc_buf = NULL((void *)0); | |||
1090 | } | |||
1091 | ch[i].uc_cnt = 0; | |||
1092 | if (ch[i].uc_xfer != NULL((void *)0)) { | |||
1093 | usbd_free_xfer(ch[i].uc_xfer); | |||
1094 | ch[i].uc_xfer = NULL((void *)0); | |||
1095 | } | |||
1096 | } | |||
1097 | } | |||
1098 | ||||
1099 | void | |||
1100 | ure_rtl8152_init(struct ure_softc *sc) | |||
1101 | { | |||
1102 | uint32_t pwrctrl; | |||
1103 | ||||
1104 | /* Disable ALDPS. */ | |||
1105 | ure_ocp_reg_write(sc, URE_OCP_ALDPS_CONFIG0x2010, URE_ENPDNPS0x0200 | URE_LINKENA0x0100 | | |||
1106 | URE_DIS_SDSAVE0x0010); | |||
1107 | usbd_delay_ms(sc->ure_udev, 20); | |||
1108 | ||||
1109 | if (sc->ure_chip & URE_CHIP_VER_4C000x01) | |||
1110 | URE_CLRBIT_2(sc, URE_PLA_LED_FEATURE, URE_MCU_TYPE_PLA,ure_write_2(sc, 0xdd92, 0x0100, ure_read_2(sc, 0xdd92, 0x0100 ) & ~(0x0700)) | |||
1111 | URE_LED_MODE_MASK)ure_write_2(sc, 0xdd92, 0x0100, ure_read_2(sc, 0xdd92, 0x0100 ) & ~(0x0700)); | |||
1112 | ||||
1113 | URE_CLRBIT_2(sc, URE_USB_UPS_CTRL, URE_MCU_TYPE_USB, URE_POWER_CUT)ure_write_2(sc, 0xd800, 0x0000, ure_read_2(sc, 0xd800, 0x0000 ) & ~(0x0100)); | |||
1114 | URE_CLRBIT_2(sc, URE_USB_PM_CTRL_STATUS, URE_MCU_TYPE_USB,ure_write_2(sc, 0xd432, 0x0000, ure_read_2(sc, 0xd432, 0x0000 ) & ~(0x0001)) | |||
1115 | URE_RESUME_INDICATE)ure_write_2(sc, 0xd432, 0x0000, ure_read_2(sc, 0xd432, 0x0000 ) & ~(0x0001)); | |||
1116 | ||||
1117 | URE_SETBIT_2(sc, URE_PLA_PHY_PWR, URE_MCU_TYPE_PLA,ure_write_2(sc, 0xe84c, 0x0100, ure_read_2(sc, 0xe84c, 0x0100 ) | (0x0080 | 0x0040)) | |||
1118 | URE_TX_10M_IDLE_EN | URE_PFM_PWM_SWITCH)ure_write_2(sc, 0xe84c, 0x0100, ure_read_2(sc, 0xe84c, 0x0100 ) | (0x0080 | 0x0040)); | |||
1119 | pwrctrl = ure_read_4(sc, URE_PLA_MAC_PWR_CTRL0xe0c0, URE_MCU_TYPE_PLA0x0100); | |||
1120 | pwrctrl &= ~URE_MCU_CLK_RATIO_MASK0x0f0f0f0f; | |||
1121 | pwrctrl |= URE_MCU_CLK_RATIO0x07010f07 | URE_D3_CLK_GATED_EN0x00004000; | |||
1122 | ure_write_4(sc, URE_PLA_MAC_PWR_CTRL0xe0c0, URE_MCU_TYPE_PLA0x0100, pwrctrl); | |||
1123 | ure_write_2(sc, URE_PLA_GPHY_INTR_IMR0xe022, URE_MCU_TYPE_PLA0x0100, | |||
1124 | URE_GPHY_STS_MSK0x0001 | URE_SPEED_DOWN_MSK0x0002 | URE_SPDWN_RXDV_MSK0x0004 | | |||
1125 | URE_SPDWN_LINKCHG_MSK0x0008); | |||
1126 | ||||
1127 | URE_SETBIT_2(sc, URE_PLA_RSTTALLY, URE_MCU_TYPE_PLA, URE_TALLY_RESET)ure_write_2(sc, 0xe800, 0x0100, ure_read_2(sc, 0xe800, 0x0100 ) | (0x0001)); | |||
1128 | ||||
1129 | /* Enable Rx aggregation. */ | |||
1130 | URE_CLRBIT_2(sc, URE_USB_USB_CTRL, URE_MCU_TYPE_USB,ure_write_2(sc, 0xd406, 0x0000, ure_read_2(sc, 0xd406, 0x0000 ) & ~(0x0010 | 0x0080)) | |||
1131 | URE_RX_AGG_DISABLE | URE_RX_ZERO_EN)ure_write_2(sc, 0xd406, 0x0000, ure_read_2(sc, 0xd406, 0x0000 ) & ~(0x0010 | 0x0080)); | |||
1132 | } | |||
1133 | ||||
1134 | void | |||
1135 | ure_rtl8153_init(struct ure_softc *sc) | |||
1136 | { | |||
1137 | uint16_t reg; | |||
1138 | uint8_t u1u2[8]; | |||
1139 | int i; | |||
1140 | ||||
1141 | memset(u1u2, 0x00, sizeof(u1u2))__builtin_memset((u1u2), (0x00), (sizeof(u1u2))); | |||
1142 | ure_write_mem(sc, URE_USB_TOLERANCE0xd490, URE_BYTE_EN_SIX_BYTES0x3f, u1u2, | |||
1143 | sizeof(u1u2)); | |||
1144 | ||||
1145 | for (i = 0; i < 500; i++) { | |||
1146 | if (ure_read_2(sc, URE_PLA_BOOT_CTRL0xe004, URE_MCU_TYPE_PLA0x0100) & | |||
1147 | URE_AUTOLOAD_DONE0x0002) | |||
1148 | break; | |||
1149 | usbd_delay_ms(sc->ure_udev, 20); | |||
1150 | } | |||
1151 | if (i == 500) | |||
1152 | printf("%s: timeout waiting for chip autoload\n", | |||
1153 | sc->ure_dev.dv_xname); | |||
1154 | ||||
1155 | ure_rtl8153_phy_status(sc, 0); | |||
1156 | ||||
1157 | if (sc->ure_chip & (URE_CHIP_VER_5C000x04 | URE_CHIP_VER_5C100x08 | | |||
1158 | URE_CHIP_VER_5C200x10)) { | |||
1159 | ure_ocp_reg_write(sc, URE_OCP_ADC_CFG0xbc06, | |||
1160 | URE_CKADSEL_L0x0100 | URE_ADC_EN0x0080 | URE_EN_EMI_L0x0040); | |||
1161 | } | |||
1162 | ||||
1163 | ure_rtl8153_phy_status(sc, URE_PHY_STAT_LAN_ON3); | |||
1164 | ||||
1165 | URE_CLRBIT_2(sc, URE_USB_U2P3_CTRL, URE_MCU_TYPE_USB, URE_U2P3_ENABLE)ure_write_2(sc, 0xb460, 0x0000, ure_read_2(sc, 0xb460, 0x0000 ) & ~(0x0001)); | |||
1166 | ||||
1167 | if (sc->ure_chip & URE_CHIP_VER_5C100x08) { | |||
1168 | reg = ure_read_2(sc, URE_USB_SSPHYLINK20xb428, URE_MCU_TYPE_USB0x0000); | |||
1169 | reg &= ~URE_PWD_DN_SCALE_MASK0x3ffe; | |||
1170 | reg |= URE_PWD_DN_SCALE(96)((96) << 1); | |||
1171 | ure_write_2(sc, URE_USB_SSPHYLINK20xb428, URE_MCU_TYPE_USB0x0000, reg); | |||
1172 | ||||
1173 | URE_SETBIT_1(sc, URE_USB_USB2PHY, URE_MCU_TYPE_USB,ure_write_1(sc, 0xb41e, 0x0000, ure_read_1(sc, 0xb41e, 0x0000 ) | (0x0002 | 0x0001)) | |||
1174 | URE_USB2PHY_L1 | URE_USB2PHY_SUSPEND)ure_write_1(sc, 0xb41e, 0x0000, ure_read_1(sc, 0xb41e, 0x0000 ) | (0x0002 | 0x0001)); | |||
1175 | } else if (sc->ure_chip & URE_CHIP_VER_5C200x10) { | |||
1176 | URE_CLRBIT_1(sc, URE_PLA_DMY_REG0, URE_MCU_TYPE_PLA,ure_write_1(sc, 0xc0b0, 0x0100, ure_read_1(sc, 0xc0b0, 0x0100 ) & ~(0x0002)) | |||
1177 | URE_ECM_ALDPS)ure_write_1(sc, 0xc0b0, 0x0100, ure_read_1(sc, 0xc0b0, 0x0100 ) & ~(0x0002)); | |||
1178 | } | |||
1179 | if (sc->ure_chip & (URE_CHIP_VER_5C200x10 | URE_CHIP_VER_5C300x20)) { | |||
1180 | if (ure_read_2(sc, URE_USB_BURST_SIZE0xcfc0, URE_MCU_TYPE_USB0x0000)) | |||
1181 | URE_SETBIT_1(sc, URE_USB_CSR_DUMMY1, URE_MCU_TYPE_USB,ure_write_1(sc, 0xb464, 0x0000, ure_read_1(sc, 0xb464, 0x0000 ) | (0x0001)) | |||
1182 | URE_DYNAMIC_BURST)ure_write_1(sc, 0xb464, 0x0000, ure_read_1(sc, 0xb464, 0x0000 ) | (0x0001)); | |||
1183 | else | |||
1184 | URE_CLRBIT_1(sc, URE_USB_CSR_DUMMY1, URE_MCU_TYPE_USB,ure_write_1(sc, 0xb464, 0x0000, ure_read_1(sc, 0xb464, 0x0000 ) & ~(0x0001)) | |||
1185 | URE_DYNAMIC_BURST)ure_write_1(sc, 0xb464, 0x0000, ure_read_1(sc, 0xb464, 0x0000 ) & ~(0x0001)); | |||
1186 | } | |||
1187 | ||||
1188 | URE_SETBIT_1(sc, URE_USB_CSR_DUMMY2, URE_MCU_TYPE_USB, URE_EP4_FULL_FC)ure_write_1(sc, 0xb466, 0x0000, ure_read_1(sc, 0xb466, 0x0000 ) | (0x0001)); | |||
1189 | ||||
1190 | URE_CLRBIT_2(sc, URE_USB_WDT11_CTRL, URE_MCU_TYPE_USB, URE_TIMER11_EN)ure_write_2(sc, 0xe43c, 0x0000, ure_read_2(sc, 0xe43c, 0x0000 ) & ~(0x0001)); | |||
1191 | ||||
1192 | URE_CLRBIT_2(sc, URE_PLA_LED_FEATURE, URE_MCU_TYPE_PLA,ure_write_2(sc, 0xdd92, 0x0100, ure_read_2(sc, 0xdd92, 0x0100 ) & ~(0x0700)) | |||
1193 | URE_LED_MODE_MASK)ure_write_2(sc, 0xdd92, 0x0100, ure_read_2(sc, 0xdd92, 0x0100 ) & ~(0x0700)); | |||
1194 | ||||
1195 | if ((sc->ure_chip & URE_CHIP_VER_5C100x08) && | |||
1196 | sc->ure_udev->speed != USB_SPEED_SUPER4) | |||
1197 | reg = URE_LPM_TIMER_500MS0x04; | |||
1198 | else | |||
1199 | reg = URE_LPM_TIMER_500US0x0c; | |||
1200 | ure_write_1(sc, URE_USB_LPM_CTRL0xd41a, URE_MCU_TYPE_USB0x0000, | |||
1201 | URE_FIFO_EMPTY_1FB0x30 | URE_ROK_EXIT_LPM0x02 | reg); | |||
1202 | ||||
1203 | reg = ure_read_2(sc, URE_USB_AFE_CTRL20xd824, URE_MCU_TYPE_USB0x0000); | |||
1204 | reg &= ~URE_SEN_VAL_MASK0xf800; | |||
1205 | reg |= URE_SEN_VAL_NORMAL0xa000 | URE_SEL_RXIDLE0x0100; | |||
1206 | ure_write_2(sc, URE_USB_AFE_CTRL20xd824, URE_MCU_TYPE_USB0x0000, reg); | |||
1207 | ||||
1208 | ure_write_2(sc, URE_USB_CONNECT_TIMER0xcbf8, URE_MCU_TYPE_USB0x0000, 0x0001); | |||
1209 | ||||
1210 | URE_CLRBIT_2(sc, URE_USB_POWER_CUT, URE_MCU_TYPE_USB,ure_write_2(sc, 0xd80a, 0x0000, ure_read_2(sc, 0xd80a, 0x0000 ) & ~(0x0001 | 0x0008)) | |||
1211 | URE_PWR_EN | URE_PHASE2_EN)ure_write_2(sc, 0xd80a, 0x0000, ure_read_2(sc, 0xd80a, 0x0000 ) & ~(0x0001 | 0x0008)); | |||
1212 | URE_CLRBIT_2(sc, URE_USB_MISC_0, URE_MCU_TYPE_USB, URE_PCUT_STATUS)ure_write_2(sc, 0xd81a, 0x0000, ure_read_2(sc, 0xd81a, 0x0000 ) & ~(0x0001)); | |||
1213 | ||||
1214 | memset(u1u2, 0xff, sizeof(u1u2))__builtin_memset((u1u2), (0xff), (sizeof(u1u2))); | |||
1215 | ure_write_mem(sc, URE_USB_TOLERANCE0xd490, URE_BYTE_EN_SIX_BYTES0x3f, u1u2, | |||
1216 | sizeof(u1u2)); | |||
1217 | ||||
1218 | ure_write_2(sc, URE_PLA_MAC_PWR_CTRL0xe0c0, URE_MCU_TYPE_PLA0x0100, 0); | |||
1219 | ure_write_2(sc, URE_PLA_MAC_PWR_CTRL20xe0ca, URE_MCU_TYPE_PLA0x0100, 0); | |||
1220 | ure_write_2(sc, URE_PLA_MAC_PWR_CTRL30xe0cc, URE_MCU_TYPE_PLA0x0100, 0); | |||
1221 | ure_write_2(sc, URE_PLA_MAC_PWR_CTRL40xe0ce, URE_MCU_TYPE_PLA0x0100, 0); | |||
1222 | ||||
1223 | /* Enable Rx aggregation. */ | |||
1224 | URE_CLRBIT_2(sc, URE_USB_USB_CTRL, URE_MCU_TYPE_USB,ure_write_2(sc, 0xd406, 0x0000, ure_read_2(sc, 0xd406, 0x0000 ) & ~(0x0010 | 0x0080)) | |||
1225 | URE_RX_AGG_DISABLE | URE_RX_ZERO_EN)ure_write_2(sc, 0xd406, 0x0000, ure_read_2(sc, 0xd406, 0x0000 ) & ~(0x0010 | 0x0080)); | |||
1226 | ||||
1227 | URE_SETBIT_2(sc, URE_PLA_RSTTALLY, URE_MCU_TYPE_PLA, URE_TALLY_RESET)ure_write_2(sc, 0xe800, 0x0100, ure_read_2(sc, 0xe800, 0x0100 ) | (0x0001)); | |||
1228 | } | |||
1229 | ||||
1230 | void | |||
1231 | ure_rtl8153b_init(struct ure_softc *sc) | |||
1232 | { | |||
1233 | uint16_t reg; | |||
1234 | int i; | |||
1235 | ||||
1236 | if (sc->ure_flags & (URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000)) { | |||
1237 | URE_CLRBIT_1(sc, URE_USB_ECM_OP, URE_MCU_TYPE_USB,ure_write_1(sc, 0xd26b, 0x0000, ure_read_1(sc, 0xd26b, 0x0000 ) & ~(0x0001)) | |||
1238 | URE_EN_ALL_SPEED)ure_write_1(sc, 0xd26b, 0x0000, ure_read_1(sc, 0xd26b, 0x0000 ) & ~(0x0001)); | |||
1239 | ure_write_2(sc, URE_USB_SPEED_OPTION0xd32a, URE_MCU_TYPE_USB0x0000, 0); | |||
1240 | URE_SETBIT_2(sc, URE_USB_ECM_OPTION, URE_MCU_TYPE_USB,ure_write_2(sc, 0xcfee, 0x0000, ure_read_2(sc, 0xcfee, 0x0000 ) | (0x0020)) | |||
1241 | URE_BYPASS_MAC_RESET)ure_write_2(sc, 0xcfee, 0x0000, ure_read_2(sc, 0xcfee, 0x0000 ) | (0x0020)); | |||
1242 | ||||
1243 | if (sc->ure_flags & URE_FLAG_8156B0x8000) | |||
1244 | URE_SETBIT_2(sc, URE_USB_U2P3_CTRL, URE_MCU_TYPE_USB,ure_write_2(sc, 0xb460, 0x0000, ure_read_2(sc, 0xb460, 0x0000 ) | (0x0008)) | |||
1245 | URE_RX_DETECT8)ure_write_2(sc, 0xb460, 0x0000, ure_read_2(sc, 0xb460, 0x0000 ) | (0x0008)); | |||
1246 | } | |||
1247 | ||||
1248 | URE_CLRBIT_2(sc, URE_USB_LPM_CONFIG, URE_MCU_TYPE_USB, LPM_U1U2_EN)ure_write_2(sc, 0xcfd8, 0x0000, ure_read_2(sc, 0xcfd8, 0x0000 ) & ~(0x0001)); | |||
1249 | ||||
1250 | if (sc->ure_flags & URE_FLAG_8156B0x8000) | |||
1251 | ure_wait_for_flash(sc); | |||
1252 | ||||
1253 | for (i = 0; i < 500; i++) { | |||
1254 | if (ure_read_2(sc, URE_PLA_BOOT_CTRL0xe004, URE_MCU_TYPE_PLA0x0100) & | |||
1255 | URE_AUTOLOAD_DONE0x0002) | |||
1256 | break; | |||
1257 | usbd_delay_ms(sc->ure_udev, 20); | |||
1258 | } | |||
1259 | if (i == 500) | |||
1260 | printf("%s: timeout waiting for chip autoload\n", | |||
1261 | sc->ure_dev.dv_xname); | |||
1262 | ||||
1263 | ure_rtl8153_phy_status(sc, 0); | |||
1264 | ure_rtl8153_phy_status(sc, URE_PHY_STAT_LAN_ON3); | |||
1265 | ||||
1266 | URE_CLRBIT_2(sc, URE_USB_U2P3_CTRL, URE_MCU_TYPE_USB, URE_U2P3_ENABLE)ure_write_2(sc, 0xb460, 0x0000, ure_read_2(sc, 0xb460, 0x0000 ) & ~(0x0001)); | |||
1267 | ||||
1268 | /* MSC timer, 32760 ms. */ | |||
1269 | ure_write_2(sc, URE_USB_MSC_TIMER0xcbfc, URE_MCU_TYPE_USB0x0000, 4095); | |||
1270 | ||||
1271 | if (!(sc->ure_flags & URE_FLAG_8153B0x2000)) { | |||
1272 | /* U1/U2/L1 idle timer, 500 us. */ | |||
1273 | ure_write_2(sc, URE_USB_U1U2_TIMER0xd4da, URE_MCU_TYPE_USB0x0000, 500); | |||
1274 | } | |||
1275 | ||||
1276 | URE_CLRBIT_2(sc, URE_USB_POWER_CUT, URE_MCU_TYPE_USB, URE_PWR_EN)ure_write_2(sc, 0xd80a, 0x0000, ure_read_2(sc, 0xd80a, 0x0000 ) & ~(0x0001)); | |||
1277 | URE_CLRBIT_2(sc, URE_USB_MISC_0, URE_MCU_TYPE_USB, URE_PCUT_STATUS)ure_write_2(sc, 0xd81a, 0x0000, ure_read_2(sc, 0xd81a, 0x0000 ) & ~(0x0001)); | |||
1278 | ||||
1279 | URE_CLRBIT_1(sc, URE_USB_POWER_CUT, URE_MCU_TYPE_USB,ure_write_1(sc, 0xd80a, 0x0000, ure_read_1(sc, 0xd80a, 0x0000 ) & ~(0x0010 | 0x0020)) | |||
1280 | URE_UPS_EN | URE_USP_PREWAKE)ure_write_1(sc, 0xd80a, 0x0000, ure_read_1(sc, 0xd80a, 0x0000 ) & ~(0x0010 | 0x0020)); | |||
1281 | URE_CLRBIT_1(sc, URE_USB_MISC_2, URE_MCU_TYPE_USB,ure_write_1(sc, 0xcfff, 0x0000, ure_read_1(sc, 0xcfff, 0x0000 ) & ~(0x01 | 0x80)) | |||
1282 | URE_UPS_FORCE_PWR_DOWN | URE_UPS_NO_UPS)ure_write_1(sc, 0xcfff, 0x0000, ure_read_1(sc, 0xcfff, 0x0000 ) & ~(0x01 | 0x80)); | |||
1283 | ||||
1284 | URE_CLRBIT_1(sc, URE_PLA_INDICATE_FALG, URE_MCU_TYPE_PLA,ure_write_1(sc, 0xd38c, 0x0100, ure_read_1(sc, 0xd38c, 0x0100 ) & ~(0x01)) | |||
1285 | URE_UPCOMING_RUNTIME_D3)ure_write_1(sc, 0xd38c, 0x0100, ure_read_1(sc, 0xd38c, 0x0100 ) & ~(0x01)); | |||
1286 | URE_CLRBIT_1(sc, URE_PLA_SUSPEND_FLAG, URE_MCU_TYPE_PLA,ure_write_1(sc, 0xd38a, 0x0100, ure_read_1(sc, 0xd38a, 0x0100 ) & ~(0x01)) | |||
1287 | URE_LINK_CHG_EVENT)ure_write_1(sc, 0xd38a, 0x0100, ure_read_1(sc, 0xd38a, 0x0100 ) & ~(0x01)); | |||
1288 | URE_CLRBIT_2(sc, URE_PLA_EXTRA_STATUS, URE_MCU_TYPE_PLA,ure_write_2(sc, 0xd398, 0x0100, ure_read_2(sc, 0xd398, 0x0100 ) & ~(0x0100)) | |||
1289 | URE_LINK_CHANGE_FLAG)ure_write_2(sc, 0xd398, 0x0100, ure_read_2(sc, 0xd398, 0x0100 ) & ~(0x0100)); | |||
1290 | ||||
1291 | ure_write_1(sc, URE_PLA_CRWECR0xe81c, URE_MCU_TYPE_PLA0x0100, URE_CRWECR_CONFIG0xc0); | |||
1292 | URE_CLRBIT_2(sc, URE_PLA_CONFIG34, URE_MCU_TYPE_PLA,ure_write_2(sc, 0xe820, 0x0100, ure_read_2(sc, 0xe820, 0x0100 ) & ~(0x0008)) | |||
1293 | URE_LINK_OFF_WAKE_EN)ure_write_2(sc, 0xe820, 0x0100, ure_read_2(sc, 0xe820, 0x0100 ) & ~(0x0008)); | |||
1294 | ure_write_1(sc, URE_PLA_CRWECR0xe81c, URE_MCU_TYPE_PLA0x0100, URE_CRWECR_NORAML0x00); | |||
1295 | ||||
1296 | if (sc->ure_flags & URE_FLAG_8153B0x2000) { | |||
1297 | reg = ure_read_2(sc, URE_PLA_EXTRA_STATUS0xd398, URE_MCU_TYPE_PLA0x0100); | |||
1298 | if (ure_read_2(sc, URE_PLA_PHYSTATUS0xe908, URE_MCU_TYPE_PLA0x0100) & | |||
1299 | URE_PHYSTATUS_LINK0x0002) | |||
1300 | reg |= URE_CUR_LINK_OK0x8000; | |||
1301 | else | |||
1302 | reg &= ~URE_CUR_LINK_OK0x8000; | |||
1303 | ure_write_2(sc, URE_PLA_EXTRA_STATUS0xd398, URE_MCU_TYPE_PLA0x0100, | |||
1304 | reg | URE_POLL_LINK_CHG0x0001); | |||
1305 | } | |||
1306 | ||||
1307 | if (sc->ure_udev->speed == USB_SPEED_SUPER4) { | |||
1308 | URE_SETBIT_2(sc, URE_USB_LPM_CONFIG, URE_MCU_TYPE_USB,ure_write_2(sc, 0xcfd8, 0x0000, ure_read_2(sc, 0xcfd8, 0x0000 ) | (0x0001)) | |||
1309 | LPM_U1U2_EN)ure_write_2(sc, 0xcfd8, 0x0000, ure_read_2(sc, 0xcfd8, 0x0000 ) | (0x0001)); | |||
1310 | } | |||
1311 | ||||
1312 | if (sc->ure_flags & URE_FLAG_8156B0x8000) { | |||
1313 | URE_CLRBIT_2(sc, URE_PLA_RCR, URE_MCU_TYPE_PLA, URE_SLOT_EN)ure_write_2(sc, 0xc010, 0x0100, ure_read_2(sc, 0xc010, 0x0100 ) & ~(0x00000800)); | |||
1314 | URE_SETBIT_2(sc, URE_PLA_CPCR, URE_MCU_TYPE_PLA,ure_write_2(sc, 0xe854, 0x0100, ure_read_2(sc, 0xe854, 0x0100 ) | (0x0001)) | |||
1315 | URE_FLOW_CTRL_EN)ure_write_2(sc, 0xe854, 0x0100, ure_read_2(sc, 0xe854, 0x0100 ) | (0x0001)); | |||
1316 | ||||
1317 | /* Enable fc timer and set timer to 600 ms. */ | |||
1318 | ure_write_2(sc, URE_USB_FC_TIMER0xd340, URE_MCU_TYPE_USB0x0000, | |||
1319 | URE_CTRL_TIMER_EN0x8000 | 75); | |||
1320 | ||||
1321 | reg = ure_read_2(sc, URE_USB_FW_CTRL0xd334, URE_MCU_TYPE_USB0x0000); | |||
1322 | if (!(ure_read_2(sc, URE_PLA_POL_GPIO_CTRL0xdc6a, URE_MCU_TYPE_PLA0x0100) & | |||
1323 | URE_DACK_DET_EN0x8000)) | |||
1324 | reg |= URE_FLOW_CTRL_PATCH_20x0100; | |||
1325 | reg &= ~URE_AUTO_SPEEDUP0x0008; | |||
1326 | ure_write_2(sc, URE_USB_FW_CTRL0xd334, URE_MCU_TYPE_USB0x0000, reg); | |||
1327 | ||||
1328 | URE_SETBIT_2(sc, URE_USB_FW_TASK, URE_MCU_TYPE_USB,ure_write_2(sc, 0xd4e8, 0x0000, ure_read_2(sc, 0xd4e8, 0x0000 ) | (0x0002)) | |||
1329 | URE_FC_PATCH_TASK)ure_write_2(sc, 0xd4e8, 0x0000, ure_read_2(sc, 0xd4e8, 0x0000 ) | (0x0002)); | |||
1330 | } | |||
1331 | ||||
1332 | /* MAC clock speed down. */ | |||
1333 | if (sc->ure_flags & (URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000)) { | |||
1334 | ure_write_2(sc, URE_PLA_MAC_PWR_CTRL0xe0c0, URE_MCU_TYPE_PLA0x0100, 0x0403); | |||
1335 | reg = ure_read_2(sc, URE_PLA_MAC_PWR_CTRL20xe0ca, URE_MCU_TYPE_PLA0x0100); | |||
1336 | reg &= ~URE_EEE_SPDWN_RATIO_MASK0x00ff; | |||
1337 | reg |= URE_MAC_CLK_SPDWN_EN0x8000 | 0x0003; | |||
1338 | ure_write_2(sc, URE_PLA_MAC_PWR_CTRL20xe0ca, URE_MCU_TYPE_PLA0x0100, reg); | |||
1339 | ||||
1340 | URE_CLRBIT_2(sc, URE_PLA_MAC_PWR_CTRL3, URE_MCU_TYPE_PLA,ure_write_2(sc, 0xe0cc, 0x0100, ure_read_2(sc, 0xe0cc, 0x0100 ) & ~(0x4000)) | |||
1341 | URE_PLA_MCU_SPDWN_EN)ure_write_2(sc, 0xe0cc, 0x0100, ure_read_2(sc, 0xe0cc, 0x0100 ) & ~(0x4000)); | |||
1342 | ||||
1343 | reg = ure_read_2(sc, URE_PLA_EXTRA_STATUS0xd398, URE_MCU_TYPE_PLA0x0100); | |||
1344 | if (ure_read_2(sc, URE_PLA_PHYSTATUS0xe908, URE_MCU_TYPE_PLA0x0100) & | |||
1345 | URE_PHYSTATUS_LINK0x0002) | |||
1346 | reg |= URE_CUR_LINK_OK0x8000; | |||
1347 | else | |||
1348 | reg &= ~URE_CUR_LINK_OK0x8000; | |||
1349 | ure_write_2(sc, URE_PLA_EXTRA_STATUS0xd398, URE_MCU_TYPE_PLA0x0100, | |||
1350 | reg | URE_POLL_LINK_CHG0x0001); | |||
1351 | } else | |||
1352 | URE_SETBIT_2(sc, URE_PLA_MAC_PWR_CTRL2, URE_MCU_TYPE_PLA,ure_write_2(sc, 0xe0ca, 0x0100, ure_read_2(sc, 0xe0ca, 0x0100 ) | (0x8000)) | |||
1353 | URE_MAC_CLK_SPDWN_EN)ure_write_2(sc, 0xe0ca, 0x0100, ure_read_2(sc, 0xe0ca, 0x0100 ) | (0x8000)); | |||
1354 | ||||
1355 | /* Enable Rx aggregation. */ | |||
1356 | URE_CLRBIT_2(sc, URE_USB_USB_CTRL, URE_MCU_TYPE_USB,ure_write_2(sc, 0xd406, 0x0000, ure_read_2(sc, 0xd406, 0x0000 ) & ~(0x0010 | 0x0080)) | |||
1357 | URE_RX_AGG_DISABLE | URE_RX_ZERO_EN)ure_write_2(sc, 0xd406, 0x0000, ure_read_2(sc, 0xd406, 0x0000 ) & ~(0x0010 | 0x0080)); | |||
1358 | ||||
1359 | if (sc->ure_flags & URE_FLAG_81560x4000) | |||
1360 | URE_SETBIT_1(sc, URE_USB_BMU_CONFIG, URE_MCU_TYPE_USB,ure_write_1(sc, 0xd4b4, 0x0000, ure_read_1(sc, 0xd4b4, 0x0000 ) | (0x02)) | |||
1361 | URE_ACT_ODMA)ure_write_1(sc, 0xd4b4, 0x0000, ure_read_1(sc, 0xd4b4, 0x0000 ) | (0x02)); | |||
1362 | ||||
1363 | if (!(sc->ure_flags & URE_FLAG_8153B0x2000)) { | |||
1364 | /* | |||
1365 | * Select force mode through 0xa5b4 bit 15 | |||
1366 | * 0: MDIO force mode | |||
1367 | * 1: MMD force mode | |||
1368 | */ | |||
1369 | reg = ure_ocp_reg_read(sc, 0xa5b4); | |||
1370 | if (reg & 0x8000) | |||
1371 | ure_ocp_reg_write(sc, 0xa5b4, reg & ~0x8000); | |||
1372 | } | |||
1373 | ||||
1374 | URE_SETBIT_2(sc, URE_PLA_RSTTALLY, URE_MCU_TYPE_PLA, URE_TALLY_RESET)ure_write_2(sc, 0xe800, 0x0100, ure_read_2(sc, 0xe800, 0x0100 ) | (0x0001)); | |||
1375 | } | |||
1376 | ||||
1377 | void | |||
1378 | ure_rtl8152_nic_reset(struct ure_softc *sc) | |||
1379 | { | |||
1380 | uint32_t rx_fifo1, rx_fifo2; | |||
1381 | int i; | |||
1382 | ||||
1383 | /* Disable ALDPS. */ | |||
1384 | ure_ocp_reg_write(sc, URE_OCP_ALDPS_CONFIG0x2010, URE_ENPDNPS0x0200 | URE_LINKENA0x0100 | | |||
1385 | URE_DIS_SDSAVE0x0010); | |||
1386 | usbd_delay_ms(sc->ure_udev, 20); | |||
1387 | ||||
1388 | URE_CLRBIT_4(sc, URE_PLA_RCR, URE_MCU_TYPE_PLA, URE_RCR_ACPT_ALL)ure_write_4(sc, 0xc010, 0x0100, ure_read_4(sc, 0xc010, 0x0100 ) & ~((0x00000001 | 0x00000002 | 0x00000004 | 0x00000008) )); | |||
1389 | ||||
1390 | URE_SETBIT_2(sc, URE_PLA_MISC_1, URE_MCU_TYPE_PLA, URE_RXDY_GATED_EN)ure_write_2(sc, 0xe85a, 0x0100, ure_read_2(sc, 0xe85a, 0x0100 ) | (0x0008)); | |||
1391 | ure_disable_teredo(sc); | |||
1392 | ure_write_1(sc, URE_PLA_CRWECR0xe81c, URE_MCU_TYPE_PLA0x0100, URE_CRWECR_NORAML0x00); | |||
1393 | ure_write_1(sc, URE_PLA_CR0xe813, URE_MCU_TYPE_PLA0x0100, 0); | |||
1394 | ||||
1395 | URE_CLRBIT_1(sc, URE_PLA_OOB_CTRL, URE_MCU_TYPE_PLA, URE_NOW_IS_OOB)ure_write_1(sc, 0xe84f, 0x0100, ure_read_1(sc, 0xe84f, 0x0100 ) & ~(0x80)); | |||
1396 | URE_CLRBIT_2(sc, URE_PLA_SFF_STS_7, URE_MCU_TYPE_PLA, URE_MCU_BORW_EN)ure_write_2(sc, 0xe8de, 0x0100, ure_read_2(sc, 0xe8de, 0x0100 ) & ~(0x4000)); | |||
1397 | for (i = 0; i < URE_TIMEOUT1000; i++) { | |||
1398 | if (ure_read_1(sc, URE_PLA_OOB_CTRL0xe84f, URE_MCU_TYPE_PLA0x0100) & | |||
1399 | URE_LINK_LIST_READY0x02) | |||
1400 | break; | |||
1401 | usbd_delay_ms(sc->ure_udev, 1); | |||
1402 | } | |||
1403 | if (i == URE_TIMEOUT1000) | |||
1404 | printf("%s: timeout waiting for OOB control\n", | |||
1405 | sc->ure_dev.dv_xname); | |||
1406 | URE_SETBIT_2(sc, URE_PLA_SFF_STS_7, URE_MCU_TYPE_PLA, URE_RE_INIT_LL)ure_write_2(sc, 0xe8de, 0x0100, ure_read_2(sc, 0xe8de, 0x0100 ) | (0x8000)); | |||
1407 | for (i = 0; i < URE_TIMEOUT1000; i++) { | |||
1408 | if (ure_read_1(sc, URE_PLA_OOB_CTRL0xe84f, URE_MCU_TYPE_PLA0x0100) & | |||
1409 | URE_LINK_LIST_READY0x02) | |||
1410 | break; | |||
1411 | usbd_delay_ms(sc->ure_udev, 1); | |||
1412 | } | |||
1413 | if (i == URE_TIMEOUT1000) | |||
1414 | printf("%s: timeout waiting for OOB control\n", | |||
1415 | sc->ure_dev.dv_xname); | |||
1416 | ||||
1417 | ure_reset(sc); | |||
1418 | ||||
1419 | /* Configure Rx FIFO threshold. */ | |||
1420 | ure_write_4(sc, URE_PLA_RXFIFO_CTRL00xc0a0, URE_MCU_TYPE_PLA0x0100, | |||
1421 | URE_RXFIFO_THR1_NORMAL0x00080002); | |||
1422 | if (sc->ure_udev->speed == USB_SPEED_FULL2) { | |||
1423 | rx_fifo1 = URE_RXFIFO_THR2_FULL0x00000060; | |||
1424 | rx_fifo2 = URE_RXFIFO_THR3_FULL0x00000078; | |||
1425 | } else { | |||
1426 | rx_fifo1 = URE_RXFIFO_THR2_HIGH0x00000038; | |||
1427 | rx_fifo2 = URE_RXFIFO_THR3_HIGH0x00000048; | |||
1428 | } | |||
1429 | ure_write_4(sc, URE_PLA_RXFIFO_CTRL10xc0a4, URE_MCU_TYPE_PLA0x0100, rx_fifo1); | |||
1430 | ure_write_4(sc, URE_PLA_RXFIFO_CTRL20xc0a8, URE_MCU_TYPE_PLA0x0100, rx_fifo2); | |||
1431 | ||||
1432 | /* Configure Tx FIFO threshold. */ | |||
1433 | ure_write_4(sc, URE_PLA_TXFIFO_CTRL0xe618, URE_MCU_TYPE_PLA0x0100, | |||
1434 | URE_TXFIFO_THR_NORMAL0x00400008); | |||
1435 | ||||
1436 | ure_write_1(sc, URE_USB_TX_AGG0xd40a, URE_MCU_TYPE_USB0x0000, | |||
1437 | URE_TX_AGG_MAX_THRESHOLD0x03); | |||
1438 | ure_write_4(sc, URE_USB_RX_BUF_TH0xd40c, URE_MCU_TYPE_USB0x0000, URE_RX_THR_HIGH0x7a120180); | |||
1439 | ure_write_4(sc, URE_USB_TX_DMA0xd434, URE_MCU_TYPE_USB0x0000, | |||
1440 | URE_TEST_MODE_DISABLE0x00000001 | URE_TX_SIZE_ADJUST10x00000100); | |||
1441 | ||||
1442 | ure_rxvlan(sc); | |||
1443 | ure_write_2(sc, URE_PLA_RMS0xc016, URE_MCU_TYPE_PLA0x0100, | |||
1444 | ETHER_MAX_LEN1518 + ETHER_VLAN_ENCAP_LEN4); | |||
1445 | URE_SETBIT_2(sc, URE_PLA_TCR0, URE_MCU_TYPE_PLA, URE_TCR0_AUTO_FIFO)ure_write_2(sc, 0xe610, 0x0100, ure_read_2(sc, 0xe610, 0x0100 ) | (0x0080)); | |||
1446 | ||||
1447 | /* Enable ALDPS. */ | |||
1448 | ure_ocp_reg_write(sc, URE_OCP_ALDPS_CONFIG0x2010, | |||
1449 | URE_ENPWRSAVE0x8000 | URE_ENPDNPS0x0200 | URE_LINKENA0x0100 | URE_DIS_SDSAVE0x0010); | |||
1450 | } | |||
1451 | ||||
1452 | void | |||
1453 | ure_rtl8153_nic_reset(struct ure_softc *sc) | |||
1454 | { | |||
1455 | struct ifnet *ifp = &sc->ure_ac.ac_if; | |||
1456 | uint32_t reg = 0; | |||
1457 | uint8_t u1u2[8] = { 0 }; | |||
1458 | int i; | |||
1459 | ||||
1460 | if (sc->ure_flags & (URE_FLAG_8153B0x2000 | URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000)) { | |||
1461 | URE_CLRBIT_2(sc, URE_USB_LPM_CONFIG, URE_MCU_TYPE_USB,ure_write_2(sc, 0xcfd8, 0x0000, ure_read_2(sc, 0xcfd8, 0x0000 ) & ~(0x0001)) | |||
1462 | LPM_U1U2_EN)ure_write_2(sc, 0xcfd8, 0x0000, ure_read_2(sc, 0xcfd8, 0x0000 ) & ~(0x0001)); | |||
1463 | } else { | |||
1464 | memset(u1u2, 0x00, sizeof(u1u2))__builtin_memset((u1u2), (0x00), (sizeof(u1u2))); | |||
1465 | ure_write_mem(sc, URE_USB_TOLERANCE0xd490, URE_BYTE_EN_SIX_BYTES0x3f, | |||
1466 | u1u2, sizeof(u1u2)); | |||
1467 | } | |||
1468 | URE_CLRBIT_2(sc, URE_USB_U2P3_CTRL, URE_MCU_TYPE_USB, URE_U2P3_ENABLE)ure_write_2(sc, 0xb460, 0x0000, ure_read_2(sc, 0xb460, 0x0000 ) & ~(0x0001)); | |||
1469 | ||||
1470 | /* Disable ALDPS. */ | |||
1471 | ure_ocp_reg_write(sc, URE_OCP_POWER_CFG0xa430, | |||
1472 | ure_ocp_reg_read(sc, URE_OCP_POWER_CFG0xa430) & ~URE_EN_ALDPS0x0004); | |||
1473 | for (i = 0; i < 20; i++) { | |||
1474 | usbd_delay_ms(sc->ure_udev, 1); | |||
1475 | if (ure_read_2(sc, 0xe000, URE_MCU_TYPE_PLA0x0100) & 0x0100) | |||
1476 | break; | |||
1477 | } | |||
1478 | ||||
1479 | URE_SETBIT_2(sc, URE_PLA_MISC_1, URE_MCU_TYPE_PLA, URE_RXDY_GATED_EN)ure_write_2(sc, 0xe85a, 0x0100, ure_read_2(sc, 0xe85a, 0x0100 ) | (0x0008)); | |||
1480 | ure_disable_teredo(sc); | |||
1481 | ||||
1482 | URE_CLRBIT_4(sc, URE_PLA_RCR, URE_MCU_TYPE_PLA, URE_RCR_ACPT_ALL)ure_write_4(sc, 0xc010, 0x0100, ure_read_4(sc, 0xc010, 0x0100 ) & ~((0x00000001 | 0x00000002 | 0x00000004 | 0x00000008) )); | |||
1483 | ||||
1484 | ure_reset(sc); | |||
1485 | ure_reset_bmu(sc); | |||
1486 | ||||
1487 | URE_CLRBIT_1(sc, URE_PLA_OOB_CTRL, URE_MCU_TYPE_PLA, URE_NOW_IS_OOB)ure_write_1(sc, 0xe84f, 0x0100, ure_read_1(sc, 0xe84f, 0x0100 ) & ~(0x80)); | |||
1488 | URE_CLRBIT_2(sc, URE_PLA_SFF_STS_7, URE_MCU_TYPE_PLA, URE_MCU_BORW_EN)ure_write_2(sc, 0xe8de, 0x0100, ure_read_2(sc, 0xe8de, 0x0100 ) & ~(0x4000)); | |||
1489 | ||||
1490 | if (!(sc->ure_flags & (URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000))) { | |||
1491 | for (i = 0; i < URE_TIMEOUT1000; i++) { | |||
1492 | if (ure_read_1(sc, URE_PLA_OOB_CTRL0xe84f, URE_MCU_TYPE_PLA0x0100) & | |||
1493 | URE_LINK_LIST_READY0x02) | |||
1494 | break; | |||
1495 | usbd_delay_ms(sc->ure_udev, 1); | |||
1496 | } | |||
1497 | if (i == URE_TIMEOUT1000) | |||
1498 | printf("%s: timeout waiting for OOB control\n", | |||
1499 | sc->ure_dev.dv_xname); | |||
1500 | URE_SETBIT_2(sc, URE_PLA_SFF_STS_7, URE_MCU_TYPE_PLA,ure_write_2(sc, 0xe8de, 0x0100, ure_read_2(sc, 0xe8de, 0x0100 ) | (0x8000)) | |||
1501 | URE_RE_INIT_LL)ure_write_2(sc, 0xe8de, 0x0100, ure_read_2(sc, 0xe8de, 0x0100 ) | (0x8000)); | |||
1502 | for (i = 0; i < URE_TIMEOUT1000; i++) { | |||
1503 | if (ure_read_1(sc, URE_PLA_OOB_CTRL0xe84f, URE_MCU_TYPE_PLA0x0100) & | |||
1504 | URE_LINK_LIST_READY0x02) | |||
1505 | break; | |||
1506 | usbd_delay_ms(sc->ure_udev, 1); | |||
1507 | } | |||
1508 | if (i == URE_TIMEOUT1000) | |||
1509 | printf("%s: timeout waiting for OOB control\n", | |||
1510 | sc->ure_dev.dv_xname); | |||
1511 | } | |||
1512 | ||||
1513 | ure_rxvlan(sc); | |||
1514 | ||||
1515 | ure_write_2(sc, URE_PLA_RMS0xc016, URE_MCU_TYPE_PLA0x0100, | |||
1516 | URE_FRAMELEN(ifp->if_mtu)(ifp->if_data.ifi_mtu + ((6 * 2) + 2) + 4 + 4)); | |||
1517 | ure_write_1(sc, URE_PLA_MTPS0xe615, URE_MCU_TYPE_PLA0x0100, MTPS_JUMBO192); | |||
1518 | ||||
1519 | if (sc->ure_flags & (URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000)) { | |||
1520 | ure_write_2(sc, URE_PLA_RX_FIFO_FULL0xc0a6, URE_MCU_TYPE_PLA0x0100, | |||
1521 | (sc->ure_flags & URE_FLAG_81560x4000) ? 1024 : 512); | |||
1522 | ure_write_2(sc, URE_PLA_RX_FIFO_EMPTY0xc0aa, URE_MCU_TYPE_PLA0x0100, | |||
1523 | (sc->ure_flags & URE_FLAG_81560x4000) ? 2048 : 1024); | |||
1524 | ||||
1525 | /* Tx share fifo free credit full threshold. */ | |||
1526 | ure_write_2(sc, URE_PLA_TXFIFO_CTRL0xe618, URE_MCU_TYPE_PLA0x0100, 8); | |||
1527 | ure_write_2(sc, URE_PLA_TXFIFO_FULL0xe61a, URE_MCU_TYPE_PLA0x0100, 128); | |||
1528 | ||||
1529 | if (sc->ure_flags & URE_FLAG_81560x4000) | |||
1530 | URE_SETBIT_2(sc, URE_USB_BMU_CONFIG, URE_MCU_TYPE_USB,ure_write_2(sc, 0xd4b4, 0x0000, ure_read_2(sc, 0xd4b4, 0x0000 ) | (0x02)) | |||
1531 | URE_ACT_ODMA)ure_write_2(sc, 0xd4b4, 0x0000, ure_read_2(sc, 0xd4b4, 0x0000 ) | (0x02)); | |||
1532 | ||||
1533 | /* FIFO settings */ | |||
1534 | reg = ure_read_2(sc, URE_PLA_RXFIFO_FULL0xc0a2, URE_MCU_TYPE_PLA0x0100); | |||
1535 | reg &= ~URE_RXFIFO_FULL_MASK0x0fff; | |||
1536 | ure_write_2(sc, URE_PLA_RXFIFO_FULL0xc0a2, URE_MCU_TYPE_PLA0x0100, | |||
1537 | reg | 0x0008); | |||
1538 | ||||
1539 | URE_CLRBIT_2(sc, URE_PLA_MAC_PWR_CTRL3, URE_MCU_TYPE_PLA,ure_write_2(sc, 0xe0cc, 0x0100, ure_read_2(sc, 0xe0cc, 0x0100 ) & ~(0x4000)) | |||
1540 | URE_PLA_MCU_SPDWN_EN)ure_write_2(sc, 0xe0cc, 0x0100, ure_read_2(sc, 0xe0cc, 0x0100 ) & ~(0x4000)); | |||
1541 | ||||
1542 | URE_CLRBIT_2(sc, URE_USB_SPEED_OPTION, URE_MCU_TYPE_USB,ure_write_2(sc, 0xd32a, 0x0000, ure_read_2(sc, 0xd32a, 0x0000 ) & ~(0x0100 | 0x0200)) | |||
1543 | URE_RG_PWRDN_EN | URE_ALL_SPEED_OFF)ure_write_2(sc, 0xd32a, 0x0000, ure_read_2(sc, 0xd32a, 0x0000 ) & ~(0x0100 | 0x0200)); | |||
1544 | ||||
1545 | ure_write_4(sc, URE_USB_RX_BUF_TH0xd40c, URE_MCU_TYPE_USB0x0000, | |||
1546 | 0x00600400); | |||
1547 | } else { | |||
1548 | URE_SETBIT_2(sc, URE_PLA_TCR0, URE_MCU_TYPE_PLA,ure_write_2(sc, 0xe610, 0x0100, ure_read_2(sc, 0xe610, 0x0100 ) | (0x0080)) | |||
1549 | URE_TCR0_AUTO_FIFO)ure_write_2(sc, 0xe610, 0x0100, ure_read_2(sc, 0xe610, 0x0100 ) | (0x0080)); | |||
1550 | ure_reset(sc); | |||
1551 | ||||
1552 | /* Configure Rx FIFO threshold. */ | |||
1553 | ure_write_4(sc, URE_PLA_RXFIFO_CTRL00xc0a0, URE_MCU_TYPE_PLA0x0100, | |||
1554 | URE_RXFIFO_THR1_NORMAL0x00080002); | |||
1555 | ure_write_2(sc, URE_PLA_RXFIFO_CTRL10xc0a4, URE_MCU_TYPE_PLA0x0100, | |||
1556 | URE_RXFIFO_THR2_NORMAL0x00a0); | |||
1557 | ure_write_2(sc, URE_PLA_RXFIFO_CTRL20xc0a8, URE_MCU_TYPE_PLA0x0100, | |||
1558 | URE_RXFIFO_THR3_NORMAL0x0110); | |||
1559 | ||||
1560 | /* Configure Tx FIFO threshold. */ | |||
1561 | ure_write_4(sc, URE_PLA_TXFIFO_CTRL0xe618, URE_MCU_TYPE_PLA0x0100, | |||
1562 | URE_TXFIFO_THR_NORMAL20x01000008); | |||
1563 | ||||
1564 | if (sc->ure_flags & URE_FLAG_8153B0x2000) { | |||
1565 | ure_write_4(sc, URE_USB_RX_BUF_TH0xd40c, URE_MCU_TYPE_USB0x0000, | |||
1566 | URE_RX_THR_B0x00010001); | |||
1567 | ||||
1568 | URE_CLRBIT_2(sc, URE_PLA_MAC_PWR_CTRL3,ure_write_2(sc, 0xe0cc, 0x0100, ure_read_2(sc, 0xe0cc, 0x0100 ) & ~(0x4000)) | |||
1569 | URE_MCU_TYPE_PLA, URE_PLA_MCU_SPDWN_EN)ure_write_2(sc, 0xe0cc, 0x0100, ure_read_2(sc, 0xe0cc, 0x0100 ) & ~(0x4000)); | |||
1570 | } else { | |||
1571 | URE_SETBIT_1(sc, URE_PLA_CONFIG6, URE_MCU_TYPE_PLA,ure_write_1(sc, 0xe90a, 0x0100, ure_read_1(sc, 0xe90a, 0x0100 ) | (0x01)) | |||
1572 | URE_LANWAKE_CLR_EN)ure_write_1(sc, 0xe90a, 0x0100, ure_read_1(sc, 0xe90a, 0x0100 ) | (0x01)); | |||
1573 | URE_CLRBIT_1(sc, URE_PLA_LWAKE_CTRL_REG,ure_write_1(sc, 0xe007, 0x0100, ure_read_1(sc, 0xe007, 0x0100 ) & ~(0x80)) | |||
1574 | URE_MCU_TYPE_PLA, URE_LANWAKE_PIN)ure_write_1(sc, 0xe007, 0x0100, ure_read_1(sc, 0xe007, 0x0100 ) & ~(0x80)); | |||
1575 | URE_CLRBIT_2(sc, URE_USB_SSPHYLINK1, URE_MCU_TYPE_USB,ure_write_2(sc, 0xb426, 0x0000, ure_read_2(sc, 0xb426, 0x0000 ) & ~(0x0002)) | |||
1576 | URE_DELAY_PHY_PWR_CHG)ure_write_2(sc, 0xb426, 0x0000, ure_read_2(sc, 0xb426, 0x0000 ) & ~(0x0002)); | |||
1577 | } | |||
1578 | } | |||
1579 | ||||
1580 | /* Enable ALDPS. */ | |||
1581 | ure_ocp_reg_write(sc, URE_OCP_POWER_CFG0xa430, | |||
1582 | ure_ocp_reg_read(sc, URE_OCP_POWER_CFG0xa430) | URE_EN_ALDPS0x0004); | |||
1583 | ||||
1584 | if ((sc->ure_chip & (URE_CHIP_VER_5C200x10 | URE_CHIP_VER_5C300x20)) || | |||
1585 | (sc->ure_flags & (URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000))) | |||
1586 | URE_SETBIT_2(sc, URE_USB_U2P3_CTRL, URE_MCU_TYPE_USB,ure_write_2(sc, 0xb460, 0x0000, ure_read_2(sc, 0xb460, 0x0000 ) | (0x0001)) | |||
1587 | URE_U2P3_ENABLE)ure_write_2(sc, 0xb460, 0x0000, ure_read_2(sc, 0xb460, 0x0000 ) | (0x0001)); | |||
1588 | ||||
1589 | if (sc->ure_flags & (URE_FLAG_8153B0x2000 | URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000)) { | |||
1590 | if (sc->ure_udev->speed == USB_SPEED_SUPER4) | |||
1591 | URE_SETBIT_2(sc, URE_USB_LPM_CONFIG, URE_MCU_TYPE_USB,ure_write_2(sc, 0xcfd8, 0x0000, ure_read_2(sc, 0xcfd8, 0x0000 ) | (0x0001)) | |||
1592 | LPM_U1U2_EN)ure_write_2(sc, 0xcfd8, 0x0000, ure_read_2(sc, 0xcfd8, 0x0000 ) | (0x0001)); | |||
1593 | } else { | |||
1594 | memset(u1u2, 0xff, sizeof(u1u2))__builtin_memset((u1u2), (0xff), (sizeof(u1u2))); | |||
1595 | ure_write_mem(sc, URE_USB_TOLERANCE0xd490, URE_BYTE_EN_SIX_BYTES0x3f, | |||
1596 | u1u2, sizeof(u1u2)); | |||
1597 | } | |||
1598 | } | |||
1599 | ||||
1600 | uint16_t | |||
1601 | ure_rtl8153_phy_status(struct ure_softc *sc, int desired) | |||
1602 | { | |||
1603 | uint16_t reg; | |||
1604 | int i; | |||
1605 | ||||
1606 | for (i = 0; i < 500; i++) { | |||
1607 | reg = ure_ocp_reg_read(sc, URE_OCP_PHY_STATUS0xa420) & | |||
1608 | URE_PHY_STAT_MASK0x0007; | |||
1609 | if (desired) { | |||
1610 | if (reg == desired) | |||
1611 | break; | |||
1612 | } else { | |||
1613 | if (reg == URE_PHY_STAT_LAN_ON3 || | |||
1614 | reg == URE_PHY_STAT_PWRDN5 || | |||
1615 | reg == URE_PHY_STAT_EXT_INIT2) | |||
1616 | break; | |||
1617 | } | |||
1618 | usbd_delay_ms(sc->ure_udev, 20); | |||
1619 | } | |||
1620 | if (i == 500) | |||
1621 | printf("%s: timeout waiting for phy to stabilize\n", | |||
1622 | sc->ure_dev.dv_xname); | |||
1623 | ||||
1624 | return reg; | |||
1625 | } | |||
1626 | ||||
1627 | void | |||
1628 | ure_wait_for_flash(struct ure_softc *sc) | |||
1629 | { | |||
1630 | int i; | |||
1631 | ||||
1632 | if ((ure_read_2(sc, URE_PLA_GPHY_CTRL0xd3ae, URE_MCU_TYPE_PLA0x0100) & | |||
1633 | URE_GPHY_FLASH0x0002) && | |||
1634 | !(ure_read_2(sc, URE_USB_GPHY_CTRL0xd284, URE_MCU_TYPE_USB0x0000) & | |||
1635 | URE_BYPASS_FLASH0x0020)) { | |||
1636 | for (i = 0; i < 100; i++) { | |||
1637 | if (ure_read_2(sc, URE_USB_GPHY_CTRL0xd284, | |||
1638 | URE_MCU_TYPE_USB0x0000) & URE_GPHY_PATCH_DONE0x0004) | |||
1639 | break; | |||
1640 | DELAY(1000)(*delay_func)(1000); | |||
1641 | } | |||
1642 | if (i == 100) | |||
1643 | printf("%s: timeout waiting for loading flash\n", | |||
1644 | sc->ure_dev.dv_xname); | |||
1645 | } | |||
1646 | } | |||
1647 | ||||
1648 | void | |||
1649 | ure_reset_bmu(struct ure_softc *sc) | |||
1650 | { | |||
1651 | uint8_t reg; | |||
1652 | ||||
1653 | reg = ure_read_1(sc, URE_USB_BMU_RESET0xd4b0, URE_MCU_TYPE_USB0x0000); | |||
1654 | reg &= ~(BMU_RESET_EP_IN0x01 | BMU_RESET_EP_OUT0x02); | |||
1655 | ure_write_1(sc, URE_USB_BMU_RESET0xd4b0, URE_MCU_TYPE_USB0x0000, reg); | |||
1656 | reg |= BMU_RESET_EP_IN0x01 | BMU_RESET_EP_OUT0x02; | |||
1657 | ure_write_1(sc, URE_USB_BMU_RESET0xd4b0, URE_MCU_TYPE_USB0x0000, reg); | |||
1658 | } | |||
1659 | ||||
1660 | void | |||
1661 | ure_disable_teredo(struct ure_softc *sc) | |||
1662 | { | |||
1663 | if (sc->ure_flags & (URE_FLAG_8153B0x2000 | URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000)) | |||
1664 | ure_write_1(sc, URE_PLA_TEREDO_CFG0xc0bc, URE_MCU_TYPE_PLA0x0100, 0xff); | |||
1665 | else { | |||
1666 | URE_CLRBIT_2(sc, URE_PLA_TEREDO_CFG, URE_MCU_TYPE_PLA,ure_write_2(sc, 0xc0bc, 0x0100, ure_read_2(sc, 0xc0bc, 0x0100 ) & ~(0x8000 | 0x00fe | 0x0001)) | |||
1667 | URE_TEREDO_SEL | URE_TEREDO_RS_EVENT_MASK |ure_write_2(sc, 0xc0bc, 0x0100, ure_read_2(sc, 0xc0bc, 0x0100 ) & ~(0x8000 | 0x00fe | 0x0001)) | |||
1668 | URE_OOB_TEREDO_EN)ure_write_2(sc, 0xc0bc, 0x0100, ure_read_2(sc, 0xc0bc, 0x0100 ) & ~(0x8000 | 0x00fe | 0x0001)); | |||
1669 | } | |||
1670 | ure_write_2(sc, URE_PLA_WDT6_CTRL0xe428, URE_MCU_TYPE_PLA0x0100, URE_WDT6_SET_MODE0x0010); | |||
1671 | ure_write_2(sc, URE_PLA_REALWOW_TIMER0xd2e8, URE_MCU_TYPE_PLA0x0100, 0); | |||
1672 | ure_write_4(sc, URE_PLA_TEREDO_TIMER0xd2cc, URE_MCU_TYPE_PLA0x0100, 0); | |||
1673 | } | |||
1674 | ||||
1675 | int | |||
1676 | ure_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) | |||
1677 | { | |||
1678 | struct ure_softc *sc = ifp->if_softc; | |||
1679 | struct ifreq *ifr = (struct ifreq *)data; | |||
1680 | int s, error = 0; | |||
1681 | ||||
1682 | s = splnet()splraise(0x4); | |||
1683 | ||||
1684 | switch (cmd) { | |||
1685 | case SIOCSIFADDR((unsigned long)0x80000000 | ((sizeof(struct ifreq) & 0x1fff ) << 16) | ((('i')) << 8) | ((12))): | |||
1686 | ifp->if_flags |= IFF_UP0x1; | |||
1687 | if (!(ifp->if_flags & IFF_RUNNING0x40)) | |||
1688 | ure_init(sc); | |||
1689 | break; | |||
1690 | ||||
1691 | case SIOCSIFFLAGS((unsigned long)0x80000000 | ((sizeof(struct ifreq) & 0x1fff ) << 16) | ((('i')) << 8) | ((16))): | |||
1692 | if (ifp->if_flags & IFF_UP0x1) { | |||
1693 | if (ifp->if_flags & IFF_RUNNING0x40) | |||
1694 | error = ENETRESET52; | |||
1695 | else | |||
1696 | ure_init(sc); | |||
1697 | } else { | |||
1698 | if (ifp->if_flags & IFF_RUNNING0x40) | |||
1699 | ure_stop(sc); | |||
1700 | } | |||
1701 | break; | |||
1702 | ||||
1703 | case SIOCGIFMEDIA(((unsigned long)0x80000000|(unsigned long)0x40000000) | ((sizeof (struct ifmediareq) & 0x1fff) << 16) | ((('i')) << 8) | ((56))): | |||
1704 | case SIOCSIFMEDIA(((unsigned long)0x80000000|(unsigned long)0x40000000) | ((sizeof (struct ifreq) & 0x1fff) << 16) | ((('i')) << 8) | ((55))): | |||
1705 | if (sc->ure_flags & (URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000)) | |||
1706 | error = ifmedia_ioctl(ifp, ifr, &sc->ure_ifmedia, cmd); | |||
1707 | else | |||
1708 | error = ifmedia_ioctl(ifp, ifr, &sc->ure_mii.mii_media, | |||
1709 | cmd); | |||
1710 | break; | |||
1711 | ||||
1712 | default: | |||
1713 | error = ether_ioctl(ifp, &sc->ure_ac, cmd, data); | |||
1714 | } | |||
1715 | ||||
1716 | if (error == ENETRESET52) { | |||
1717 | if (ifp->if_flags & IFF_RUNNING0x40) | |||
1718 | ure_iff(sc); | |||
1719 | error = 0; | |||
1720 | } | |||
1721 | ||||
1722 | splx(s)spllower(s); | |||
1723 | ||||
1724 | return (error); | |||
1725 | } | |||
1726 | ||||
1727 | int | |||
1728 | ure_match(struct device *parent, void *match, void *aux) | |||
1729 | { | |||
1730 | struct usb_attach_arg *uaa = aux; | |||
1731 | ||||
1732 | if (uaa->iface == NULL((void *)0) || uaa->configno != 1) | |||
1733 | return (UMATCH_NONE0); | |||
1734 | ||||
1735 | return (usb_lookup(ure_devs, uaa->vendor, uaa->product)usbd_match_device((const struct usb_devno *)(ure_devs), sizeof (ure_devs) / sizeof ((ure_devs)[0]), sizeof ((ure_devs)[0]), (uaa->vendor), (uaa->product)) != NULL((void *)0) ? | |||
1736 | UMATCH_VENDOR_PRODUCT_CONF_IFACE8 : UMATCH_NONE0); | |||
1737 | } | |||
1738 | ||||
1739 | void | |||
1740 | ure_attach(struct device *parent, struct device *self, void *aux) | |||
1741 | { | |||
1742 | struct ure_softc *sc = (struct ure_softc *)self; | |||
1743 | struct usb_attach_arg *uaa = aux; | |||
1744 | usb_interface_descriptor_t *id; | |||
1745 | usb_endpoint_descriptor_t *ed; | |||
1746 | u_char eaddr[8]; /* 4byte padded */ | |||
1747 | struct ifnet *ifp; | |||
1748 | int i, mii_flags = 0, s; | |||
1749 | uint16_t ver; | |||
1750 | ||||
1751 | sc->ure_udev = uaa->device; | |||
1752 | sc->ure_iface = uaa->iface; | |||
1753 | ||||
1754 | usb_init_task(&sc->ure_tick_task, ure_tick_task, sc,((&sc->ure_tick_task)->fun = (ure_tick_task), (& sc->ure_tick_task)->arg = (sc), (&sc->ure_tick_task )->type = (0), (&sc->ure_tick_task)->state = 0x0 ) | |||
1755 | USB_TASK_TYPE_GENERIC)((&sc->ure_tick_task)->fun = (ure_tick_task), (& sc->ure_tick_task)->arg = (sc), (&sc->ure_tick_task )->type = (0), (&sc->ure_tick_task)->state = 0x0 ); | |||
1756 | ||||
1757 | id = usbd_get_interface_descriptor(sc->ure_iface); | |||
1758 | ||||
1759 | for (i = 0; i < id->bNumEndpoints; i++) { | |||
1760 | ed = usbd_interface2endpoint_descriptor(sc->ure_iface, i); | |||
1761 | if (!ed) { | |||
1762 | printf("%s: couldn't get ep %d\n", | |||
1763 | sc->ure_dev.dv_xname, i); | |||
1764 | return; | |||
1765 | } | |||
1766 | if (UE_GET_DIR(ed->bEndpointAddress)((ed->bEndpointAddress) & 0x80) == UE_DIR_IN0x80 && | |||
1767 | UE_GET_XFERTYPE(ed->bmAttributes)((ed->bmAttributes) & 0x03) == UE_BULK0x02) { | |||
1768 | sc->ure_ed[URE_ENDPT_RX0] = ed->bEndpointAddress; | |||
1769 | } else if (UE_GET_DIR(ed->bEndpointAddress)((ed->bEndpointAddress) & 0x80) == UE_DIR_OUT0x00 && | |||
1770 | UE_GET_XFERTYPE(ed->bmAttributes)((ed->bmAttributes) & 0x03) == UE_BULK0x02) { | |||
1771 | sc->ure_ed[URE_ENDPT_TX1] = ed->bEndpointAddress; | |||
1772 | } | |||
1773 | } | |||
1774 | ||||
1775 | sc->ure_txbufsz = URE_TX_BUFSZ16384; | |||
1776 | sc->ure_rxbufsz = URE_8153_RX_BUFSZ32768; | |||
1777 | ||||
1778 | s = splnet()splraise(0x4); | |||
1779 | ||||
1780 | sc->ure_phyno = 0; | |||
1781 | printf("%s: ", sc->ure_dev.dv_xname); | |||
1782 | ||||
1783 | ver = ure_read_2(sc, URE_PLA_TCR10xe612, URE_MCU_TYPE_PLA0x0100) & URE_VERSION_MASK0x7cf0; | |||
1784 | switch (ver) { | |||
1785 | case 0x4c00: | |||
1786 | sc->ure_flags = URE_FLAG_81520x1000; | |||
1787 | sc->ure_rxbufsz = URE_8152_RX_BUFSZ16384; | |||
1788 | sc->ure_chip |= URE_CHIP_VER_4C000x01; | |||
1789 | printf("RTL8152 (0x4c00)"); | |||
1790 | break; | |||
1791 | case 0x4c10: | |||
1792 | sc->ure_flags = URE_FLAG_81520x1000; | |||
1793 | sc->ure_rxbufsz = URE_8152_RX_BUFSZ16384; | |||
1794 | sc->ure_chip |= URE_CHIP_VER_4C100x02; | |||
1795 | printf("RTL8152 (0x4c10)"); | |||
1796 | break; | |||
1797 | case 0x5c00: | |||
1798 | sc->ure_chip |= URE_CHIP_VER_5C000x04; | |||
1799 | printf("RTL8153 (0x5c00)"); | |||
1800 | break; | |||
1801 | case 0x5c10: | |||
1802 | sc->ure_chip |= URE_CHIP_VER_5C100x08; | |||
1803 | printf("RTL8153 (0x5c10)"); | |||
1804 | break; | |||
1805 | case 0x5c20: | |||
1806 | sc->ure_chip |= URE_CHIP_VER_5C200x10; | |||
1807 | printf("RTL8153 (0x5c20)"); | |||
1808 | break; | |||
1809 | case 0x5c30: | |||
1810 | sc->ure_chip |= URE_CHIP_VER_5C300x20; | |||
1811 | printf("RTL8153 (0x5c30)"); | |||
1812 | break; | |||
1813 | case 0x6000: | |||
1814 | sc->ure_flags = URE_FLAG_8153B0x2000; | |||
1815 | printf("RTL8153B (0x6000)"); | |||
1816 | break; | |||
1817 | case 0x6010: | |||
1818 | sc->ure_flags = URE_FLAG_8153B0x2000; | |||
1819 | printf("RTL8153B (0x6010)"); | |||
1820 | break; | |||
1821 | case 0x7020: | |||
1822 | sc->ure_flags = URE_FLAG_81560x4000; | |||
1823 | printf("RTL8156 (0x7020)"); | |||
1824 | break; | |||
1825 | case 0x7030: | |||
1826 | sc->ure_flags = URE_FLAG_81560x4000; | |||
1827 | printf("RTL8156 (0x7030)"); | |||
1828 | break; | |||
1829 | case 0x7410: | |||
1830 | sc->ure_flags = URE_FLAG_8156B0x8000; | |||
1831 | printf("RTL8156B (0x7410)"); | |||
1832 | break; | |||
1833 | case 0x7420: | |||
1834 | sc->ure_flags = URE_FLAG_8156B0x8000; | |||
1835 | sc->ure_chip = URE_CHIP_VER_74200x80; | |||
1836 | printf("RTL8153D (0x7420)"); | |||
1837 | break; | |||
1838 | default: | |||
1839 | printf(", unknown ver %02x", ver); | |||
1840 | break; | |||
1841 | } | |||
1842 | ||||
1843 | if (sc->ure_flags & URE_FLAG_81520x1000) | |||
1844 | ure_rtl8152_init(sc); | |||
1845 | else if (sc->ure_flags & (URE_FLAG_8153B0x2000 | URE_FLAG_81560x4000 | | |||
1846 | URE_FLAG_8156B0x8000)) | |||
1847 | ure_rtl8153b_init(sc); | |||
1848 | else | |||
1849 | ure_rtl8153_init(sc); | |||
1850 | ||||
1851 | if (sc->ure_chip & URE_CHIP_VER_4C000x01) | |||
1852 | ure_read_mem(sc, URE_PLA_IDR0xc000, URE_MCU_TYPE_PLA0x0100, eaddr, | |||
1853 | sizeof(eaddr)); | |||
1854 | else | |||
1855 | ure_read_mem(sc, URE_PLA_BACKUP0xd000, URE_MCU_TYPE_PLA0x0100, eaddr, | |||
1856 | sizeof(eaddr)); | |||
1857 | ||||
1858 | printf(", address %s\n", ether_sprintf(eaddr)); | |||
1859 | ||||
1860 | bcopy(eaddr, (char *)&sc->ure_ac.ac_enaddr, ETHER_ADDR_LEN6); | |||
1861 | ||||
1862 | ifp = &sc->ure_ac.ac_if; | |||
1863 | ifp->if_softc = sc; | |||
1864 | strlcpy(ifp->if_xname, sc->ure_dev.dv_xname, IFNAMSIZ16); | |||
1865 | ifp->if_flags = IFF_BROADCAST0x2 | IFF_SIMPLEX0x800 | IFF_MULTICAST0x8000; | |||
1866 | ifp->if_ioctl = ure_ioctl; | |||
1867 | ifp->if_start = ure_start; | |||
1868 | ifp->if_watchdog = ure_watchdog; | |||
1869 | ||||
1870 | ifp->if_capabilitiesif_data.ifi_capabilities = IFCAP_VLAN_MTU0x00000010 | IFCAP_CSUM_IPv40x00000001 | | |||
1871 | IFCAP_CSUM_TCPv40x00000002 | IFCAP_CSUM_UDPv40x00000004; | |||
1872 | ||||
1873 | #if NVLAN1 > 0 | |||
1874 | ifp->if_capabilitiesif_data.ifi_capabilities |= IFCAP_VLAN_HWTAGGING0x00000020; | |||
1875 | #endif | |||
1876 | ||||
1877 | if (sc->ure_flags & (URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000)) { | |||
1878 | ifmedia_init(&sc->ure_ifmedia, IFM_IMASK0xff00000000000000ULL, ure_ifmedia_upd, | |||
1879 | ure_ifmedia_sts); | |||
1880 | ure_add_media_types(sc); | |||
1881 | ifmedia_add(&sc->ure_ifmedia, IFM_ETHER0x0000000000000100ULL | IFM_AUTO0ULL, 0, NULL((void *)0)); | |||
1882 | ifmedia_set(&sc->ure_ifmedia, IFM_ETHER0x0000000000000100ULL | IFM_AUTO0ULL); | |||
1883 | sc->ure_ifmedia.ifm_media = sc->ure_ifmedia.ifm_cur->ifm_media; | |||
1884 | } else { | |||
1885 | rw_init(&sc->ure_mii_lock, "uremii")_rw_init_flags(&sc->ure_mii_lock, "uremii", 0, ((void * )0)); | |||
1886 | ||||
1887 | sc->ure_mii.mii_ifp = ifp; | |||
1888 | sc->ure_mii.mii_readreg = ure_miibus_readreg; | |||
1889 | sc->ure_mii.mii_writereg = ure_miibus_writereg; | |||
1890 | sc->ure_mii.mii_statchg = ure_miibus_statchg; | |||
1891 | sc->ure_mii.mii_flags = MIIF_AUTOTSLEEP0x0010; | |||
1892 | ||||
1893 | ifmedia_init(&sc->ure_mii.mii_media, 0, ure_ifmedia_upd, | |||
1894 | ure_ifmedia_sts); | |||
1895 | if (!(sc->ure_flags & URE_FLAG_81520x1000)) | |||
1896 | mii_flags |= MIIF_DOPAUSE0x0100; | |||
1897 | mii_attach(self, &sc->ure_mii, 0xffffffff, sc->ure_phyno, | |||
1898 | MII_OFFSET_ANY-1, mii_flags); | |||
1899 | if (LIST_FIRST(&sc->ure_mii.mii_phys)((&sc->ure_mii.mii_phys)->lh_first) == NULL((void *)0)) { | |||
1900 | ifmedia_add(&sc->ure_mii.mii_media, | |||
1901 | IFM_ETHER0x0000000000000100ULL | IFM_NONE2ULL, 0, NULL((void *)0)); | |||
1902 | ifmedia_set(&sc->ure_mii.mii_media, | |||
1903 | IFM_ETHER0x0000000000000100ULL | IFM_NONE2ULL); | |||
1904 | } else | |||
1905 | ifmedia_set(&sc->ure_mii.mii_media, | |||
1906 | IFM_ETHER0x0000000000000100ULL | IFM_AUTO0ULL); | |||
1907 | } | |||
1908 | ||||
1909 | if_attach(ifp); | |||
1910 | ether_ifattach(ifp); | |||
1911 | ||||
1912 | timeout_set(&sc->ure_stat_ch, ure_tick, sc); | |||
1913 | ||||
1914 | splx(s)spllower(s); | |||
1915 | } | |||
1916 | ||||
1917 | int | |||
1918 | ure_detach(struct device *self, int flags) | |||
1919 | { | |||
1920 | struct ure_softc *sc = (struct ure_softc *)self; | |||
1921 | struct ifnet *ifp = &sc->ure_ac.ac_if; | |||
1922 | int s; | |||
1923 | ||||
1924 | if (timeout_initialized(&sc->ure_stat_ch)((&sc->ure_stat_ch)->to_flags & 0x04)) | |||
1925 | timeout_del(&sc->ure_stat_ch); | |||
1926 | ||||
1927 | if (sc->ure_ep[URE_ENDPT_TX1] != NULL((void *)0)) | |||
1928 | usbd_abort_pipe(sc->ure_ep[URE_ENDPT_TX1]); | |||
1929 | if (sc->ure_ep[URE_ENDPT_RX0] != NULL((void *)0)) | |||
1930 | usbd_abort_pipe(sc->ure_ep[URE_ENDPT_RX0]); | |||
1931 | ||||
1932 | usb_rem_task(sc->ure_udev, &sc->ure_tick_task); | |||
1933 | ||||
1934 | s = splusb()splraise(0x2); | |||
1935 | ||||
1936 | if (--sc->ure_refcnt >= 0) { | |||
1937 | usb_detach_wait(&sc->ure_dev); | |||
1938 | } | |||
1939 | ||||
1940 | if (ifp->if_flags & IFF_RUNNING0x40) | |||
1941 | ure_stop(sc); | |||
1942 | ||||
1943 | mii_detach(&sc->ure_mii, MII_PHY_ANY-1, MII_OFFSET_ANY-1); | |||
1944 | ifmedia_delete_instance(&sc->ure_mii.mii_media, IFM_INST_ANY((uint64_t) -1)); | |||
1945 | if (ifp->if_softc != NULL((void *)0)) { | |||
1946 | ether_ifdetach(ifp); | |||
1947 | if_detach(ifp); | |||
1948 | } | |||
1949 | ||||
1950 | splx(s)spllower(s); | |||
1951 | ||||
1952 | return 0; | |||
1953 | } | |||
1954 | ||||
1955 | void | |||
1956 | ure_tick_task(void *xsc) | |||
1957 | { | |||
1958 | struct ure_softc *sc = xsc; | |||
1959 | struct mii_data *mii; | |||
1960 | int s; | |||
1961 | ||||
1962 | if (sc == NULL((void *)0)) | |||
1963 | return; | |||
1964 | ||||
1965 | if (usbd_is_dying(sc->ure_udev)) | |||
1966 | return; | |||
1967 | mii = &sc->ure_mii; | |||
1968 | ||||
1969 | s = splnet()splraise(0x4); | |||
1970 | if (sc->ure_flags & (URE_FLAG_81560x4000 | URE_FLAG_8156B0x8000)) | |||
1971 | ure_link_state(sc); | |||
1972 | else { | |||
1973 | mii_tick(mii); | |||
1974 | if ((sc->ure_flags & URE_FLAG_LINK0x0001) == 0) | |||
1975 | ure_miibus_statchg(&sc->ure_dev); | |||
1976 | } | |||
1977 | timeout_add_sec(&sc->ure_stat_ch, 1); | |||
1978 | splx(s)spllower(s); | |||
1979 | } | |||
1980 | ||||
1981 | void | |||
1982 | ure_lock_mii(struct ure_softc *sc) | |||
1983 | { | |||
1984 | sc->ure_refcnt++; | |||
1985 | rw_enter_write(&sc->ure_mii_lock); | |||
1986 | } | |||
1987 | ||||
1988 | void | |||
1989 | ure_unlock_mii(struct ure_softc *sc) | |||
1990 | { | |||
1991 | rw_exit_write(&sc->ure_mii_lock); | |||
1992 | if (--sc->ure_refcnt < 0) | |||
1993 | usb_detach_wakeup(&sc->ure_dev); | |||
1994 | } | |||
1995 | ||||
1996 | void | |||
1997 | ure_rxeof(struct usbd_xfer *xfer, void *priv, usbd_status status) | |||
1998 | { | |||
1999 | struct ure_chain *c = (struct ure_chain *)priv; | |||
2000 | struct ure_softc *sc = c->uc_sc; | |||
2001 | struct ifnet *ifp = &sc->ure_ac.ac_if; | |||
2002 | u_char *buf = c->uc_buf; | |||
2003 | uint32_t cflags, rxvlan, total_len; | |||
2004 | struct mbuf_list ml = MBUF_LIST_INITIALIZER(){ ((void *)0), ((void *)0), 0 }; | |||
2005 | struct mbuf *m; | |||
2006 | int pktlen = 0, s; | |||
2007 | struct ure_rxpkt rxhdr; | |||
2008 | ||||
2009 | if (usbd_is_dying(sc->ure_udev)) | |||
2010 | return; | |||
2011 | ||||
2012 | if (!(ifp->if_flags & IFF_RUNNING0x40)) | |||
2013 | return; | |||
2014 | ||||
2015 | if (status != USBD_NORMAL_COMPLETION) { | |||
2016 | if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) | |||
2017 | return; | |||
2018 | if (usbd_ratecheck(&sc->ure_rx_notice)) { | |||
2019 | printf("%s: usb errors on rx: %s\n", | |||
2020 | sc->ure_dev.dv_xname, usbd_errstr(status)); | |||
2021 | } | |||
2022 | if (status == USBD_STALLED) | |||
2023 | usbd_clear_endpoint_stall_async( | |||
2024 | sc->ure_ep[URE_ENDPT_RX0]); | |||
2025 | goto done; | |||
2026 | } | |||
2027 | ||||
2028 | usbd_get_xfer_status(xfer, NULL((void *)0), NULL((void *)0), &total_len, NULL((void *)0)); | |||
2029 | DPRINTFN(3, ("received %d bytes\n", total_len)); | |||
2030 | ||||
2031 | do { | |||
2032 | if (total_len < sizeof(rxhdr)) { | |||
2033 | DPRINTF(("too few bytes left for a packet header\n")); | |||
2034 | ifp->if_ierrorsif_data.ifi_ierrors++; | |||
2035 | goto done; | |||
2036 | } | |||
2037 | ||||
2038 | buf += roundup(pktlen, URE_RX_BUF_ALIGN)((((pktlen)+((8)-1))/(8))*(8)); | |||
2039 | ||||
2040 | memcpy(&rxhdr, buf, sizeof(rxhdr))__builtin_memcpy((&rxhdr), (buf), (sizeof(rxhdr))); | |||
2041 | total_len -= sizeof(rxhdr); | |||
2042 | ||||
2043 | pktlen = letoh32(rxhdr.ure_pktlen)((__uint32_t)(rxhdr.ure_pktlen)) & URE_RXPKT_LEN_MASK0x7fff; | |||
2044 | DPRINTFN(4, ("next packet is %d bytes\n", pktlen)); | |||
2045 | if (pktlen > total_len) { | |||
2046 | DPRINTF(("not enough bytes left for next packet\n")); | |||
2047 | ifp->if_ierrorsif_data.ifi_ierrors++; | |||
2048 | goto done; | |||
2049 | } | |||
2050 | ||||
2051 | total_len -= roundup(pktlen, URE_RX_BUF_ALIGN)((((pktlen)+((8)-1))/(8))*(8)); | |||
2052 | buf += sizeof(rxhdr); | |||
2053 | ||||
2054 | m = m_devget(buf, pktlen - ETHER_CRC_LEN4, ETHER_ALIGN2); | |||
2055 | if (m == NULL((void *)0)) { | |||
2056 | DPRINTF(("unable to allocate mbuf for next packet\n")); | |||
2057 | ifp->if_ierrorsif_data.ifi_ierrors++; | |||
2058 | goto done; | |||
2059 | } | |||
2060 | ||||
2061 | cflags = letoh32(rxhdr.ure_csum)((__uint32_t)(rxhdr.ure_csum)); | |||
2062 | rxvlan = letoh32(rxhdr.ure_vlan)((__uint32_t)(rxhdr.ure_vlan)); | |||
2063 | ||||
2064 | /* Check IP header checksum. */ | |||
2065 | if ((rxvlan & URE_RXPKT_IPV4(1 << 19)) && | |||
2066 | !(cflags & URE_RXPKT_IPSUMBAD(1 << 23))) | |||
2067 | m->m_pkthdrM_dat.MH.MH_pkthdr.csum_flags |= M_IPV4_CSUM_IN_OK0x0008; | |||
2068 | ||||
2069 | /* Check TCP/UDP checksum. */ | |||
2070 | if ((rxvlan & (URE_RXPKT_IPV4(1 << 19) | URE_RXPKT_IPV6(1 << 20))) && | |||
2071 | (((rxvlan & URE_RXPKT_TCP(1 << 22)) && | |||
2072 | !(cflags & URE_RXPKT_TCPSUMBAD(1 << 21))) || | |||
2073 | ((rxvlan & URE_RXPKT_UDP(1 << 23)) && | |||
2074 | !(cflags & URE_RXPKT_UDPSUMBAD(1 << 22))))) | |||
2075 | m->m_pkthdrM_dat.MH.MH_pkthdr.csum_flags |= M_TCP_CSUM_IN_OK0x0020 | | |||
2076 | M_UDP_CSUM_IN_OK0x0080; | |||
2077 | #if NVLAN1 > 0 | |||
2078 | if (rxvlan & URE_RXPKT_VLAN_TAG(1 << 16)) { | |||
2079 | m->m_pkthdrM_dat.MH.MH_pkthdr.ether_vtag = | |||
2080 | swap16(rxvlan & URE_RXPKT_VLAN_DATA)(__uint16_t)(__builtin_constant_p(rxvlan & 0xffff) ? (__uint16_t )(((__uint16_t)(rxvlan & 0xffff) & 0xffU) << 8 | ((__uint16_t)(rxvlan & 0xffff) & 0xff00U) >> 8 ) : __swap16md(rxvlan & 0xffff)); | |||
2081 | m->m_flagsm_hdr.mh_flags |= M_VLANTAG0x0020; | |||
2082 | } | |||
2083 | #endif | |||
2084 | ||||
2085 | ml_enqueue(&ml, m); | |||
2086 | } while (total_len > 0); | |||
2087 | ||||
2088 | done: | |||
2089 | s = splnet()splraise(0x4); | |||
2090 | if_input(ifp, &ml); | |||
2091 | splx(s)spllower(s); | |||
2092 | memset(c->uc_buf, 0, sc->ure_rxbufsz)__builtin_memset((c->uc_buf), (0), (sc->ure_rxbufsz)); | |||
2093 | ||||
2094 | usbd_setup_xfer(xfer, sc->ure_ep[URE_ENDPT_RX0], c, c->uc_buf, | |||
2095 | sc->ure_rxbufsz, USBD_SHORT_XFER_OK0x04 | USBD_NO_COPY0x01, | |||
2096 | USBD_NO_TIMEOUT0, ure_rxeof); | |||
2097 | usbd_transfer(xfer); | |||
2098 | } | |||
2099 | ||||
2100 | ||||
2101 | void | |||
2102 | ure_txeof(struct usbd_xfer *xfer, void *priv, usbd_status status) | |||
2103 | { | |||
2104 | struct ure_softc *sc; | |||
2105 | struct ure_chain *c; | |||
2106 | struct ifnet *ifp; | |||
2107 | int s; | |||
2108 | ||||
2109 | c = priv; | |||
2110 | sc = c->uc_sc; | |||
2111 | ifp = &sc->ure_ac.ac_if; | |||
2112 | ||||
2113 | if (usbd_is_dying(sc->ure_udev)) | |||
2114 | return; | |||
2115 | ||||
2116 | if (status != USBD_NORMAL_COMPLETION) | |||
2117 | DPRINTF(("%s: %s uc_idx=%u : %s\n", sc->ure_dev.dv_xname, | |||
2118 | __func__, c->uc_idx, usbd_errstr(status))); | |||
2119 | ||||
2120 | s = splnet()splraise(0x4); | |||
2121 | ||||
2122 | c->uc_cnt = 0; | |||
2123 | c->uc_buflen = 0; | |||
2124 | ||||
2125 | SLIST_INSERT_HEAD(&sc->ure_cdata.ure_tx_free, c, uc_list)do { (c)->uc_list.sle_next = (&sc->ure_cdata.ure_tx_free )->slh_first; (&sc->ure_cdata.ure_tx_free)->slh_first = (c); } while (0); | |||
2126 | ||||
2127 | if (status != USBD_NORMAL_COMPLETION) { | |||
2128 | if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) { | |||
2129 | splx(s)spllower(s); | |||
2130 | return; | |||
2131 | } | |||
2132 | ||||
2133 | ifp->if_oerrorsif_data.ifi_oerrors++; | |||
2134 | printf("%s: usb error on tx: %s\n", sc->ure_dev.dv_xname, | |||
2135 | usbd_errstr(status)); | |||
2136 | ||||
2137 | if (status == USBD_STALLED) | |||
2138 | usbd_clear_endpoint_stall_async( | |||
2139 | sc->ure_ep[URE_ENDPT_TX1]); | |||
2140 | splx(s)spllower(s); | |||
2141 | return; | |||
2142 | } | |||
2143 | ||||
2144 | ifp->if_timer = 0; | |||
2145 | if (ifq_is_oactive(&ifp->if_snd)) | |||
2146 | ifq_restart(&ifp->if_snd); | |||
2147 | splx(s)spllower(s); | |||
2148 | } | |||
2149 | ||||
2150 | int | |||
2151 | ure_encap_txpkt(struct mbuf *m, char *buf, uint32_t maxlen) | |||
2152 | { | |||
2153 | struct ure_txpkt txhdr; | |||
2154 | uint32_t len = sizeof(txhdr), cflags = 0; | |||
2155 | ||||
2156 | if (len + m->m_pkthdrM_dat.MH.MH_pkthdr.len > maxlen) | |||
2157 | return (-1); | |||
2158 | ||||
2159 | if ((m->m_pkthdrM_dat.MH.MH_pkthdr.csum_flags & | |||
2160 | (M_IPV4_CSUM_OUT0x0001 | M_TCP_CSUM_OUT0x0002 | M_UDP_CSUM_OUT0x0004)) != 0) { | |||
2161 | cflags |= URE_TXPKT_IPV4(1 << 29); | |||
2162 | if (m->m_pkthdrM_dat.MH.MH_pkthdr.csum_flags & M_TCP_CSUM_OUT0x0002) | |||
2163 | cflags |= URE_TXPKT_TCP(1 << 30); | |||
2164 | if (m->m_pkthdrM_dat.MH.MH_pkthdr.csum_flags & M_UDP_CSUM_OUT0x0004) | |||
2165 | cflags |= URE_TXPKT_UDP(1U << 31); | |||
2166 | } | |||
2167 | ||||
2168 | #if NVLAN1 > 0 | |||
2169 | if (m->m_flagsm_hdr.mh_flags & M_VLANTAG0x0020) | |||
2170 | cflags |= URE_TXPKT_VLAN_TAG(1 << 16) | swap16(m->m_pkthdr.ether_vtag)(__uint16_t)(__builtin_constant_p(m->M_dat.MH.MH_pkthdr.ether_vtag ) ? (__uint16_t)(((__uint16_t)(m->M_dat.MH.MH_pkthdr.ether_vtag ) & 0xffU) << 8 | ((__uint16_t)(m->M_dat.MH.MH_pkthdr .ether_vtag) & 0xff00U) >> 8) : __swap16md(m->M_dat .MH.MH_pkthdr.ether_vtag)); | |||
2171 | #endif | |||
2172 | ||||
2173 | txhdr.ure_pktlen = htole32(m->m_pkthdr.len | URE_TXPKT_TX_FS |((__uint32_t)(m->M_dat.MH.MH_pkthdr.len | (1U << 31) | (1 << 30))) | |||
2174 | URE_TXPKT_TX_LS)((__uint32_t)(m->M_dat.MH.MH_pkthdr.len | (1U << 31) | (1 << 30))); | |||
2175 | txhdr.ure_vlan = htole32(cflags)((__uint32_t)(cflags)); | |||
2176 | memcpy(buf, &txhdr, len)__builtin_memcpy((buf), (&txhdr), (len)); | |||
2177 | ||||
2178 | m_copydata(m, 0, m->m_pkthdrM_dat.MH.MH_pkthdr.len, buf + len); | |||
2179 | len += m->m_pkthdrM_dat.MH.MH_pkthdr.len; | |||
2180 | ||||
2181 | return (len); | |||
2182 | } | |||
2183 | ||||
2184 | int | |||
2185 | ure_encap_xfer(struct ifnet *ifp, struct ure_softc *sc, struct ure_chain *c) | |||
2186 | { | |||
2187 | usbd_status err; | |||
2188 | ||||
2189 | usbd_setup_xfer(c->uc_xfer, sc->ure_ep[URE_ENDPT_TX1], c, c->uc_buf, | |||
2190 | c->uc_buflen, USBD_FORCE_SHORT_XFER0x08 | USBD_NO_COPY0x01, 10000, | |||
2191 | ure_txeof); | |||
2192 | ||||
2193 | err = usbd_transfer(c->uc_xfer); | |||
2194 | if (err != USBD_IN_PROGRESS) { | |||
2195 | c->uc_cnt = 0; | |||
2196 | c->uc_buflen = 0; | |||
2197 | ure_stop(sc); | |||
2198 | return (EIO5); | |||
2199 | } | |||
2200 | ||||
2201 | return (0); | |||
2202 | } |