if_run.c revision 1.10.6.10 1 1.10.6.10 skrll /* $NetBSD: if_run.c,v 1.10.6.10 2016/07/09 20:25:15 skrll Exp $ */
2 1.1 nonaka /* $OpenBSD: if_run.c,v 1.90 2012/03/24 15:11:04 jsg Exp $ */
3 1.1 nonaka
4 1.1 nonaka /*-
5 1.1 nonaka * Copyright (c) 2008-2010 Damien Bergamini <damien.bergamini (at) free.fr>
6 1.1 nonaka *
7 1.1 nonaka * Permission to use, copy, modify, and distribute this software for any
8 1.1 nonaka * purpose with or without fee is hereby granted, provided that the above
9 1.1 nonaka * copyright notice and this permission notice appear in all copies.
10 1.1 nonaka *
11 1.1 nonaka * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
12 1.1 nonaka * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
13 1.1 nonaka * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
14 1.1 nonaka * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
15 1.1 nonaka * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
16 1.1 nonaka * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
17 1.1 nonaka * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
18 1.1 nonaka */
19 1.1 nonaka
20 1.1 nonaka /*-
21 1.1 nonaka * Ralink Technology RT2700U/RT2800U/RT3000U chipset driver.
22 1.1 nonaka * http://www.ralinktech.com/
23 1.1 nonaka */
24 1.1 nonaka
25 1.1 nonaka #include <sys/cdefs.h>
26 1.10.6.10 skrll __KERNEL_RCSID(0, "$NetBSD: if_run.c,v 1.10.6.10 2016/07/09 20:25:15 skrll Exp $");
27 1.1 nonaka
28 1.1 nonaka #include <sys/param.h>
29 1.1 nonaka #include <sys/sockio.h>
30 1.1 nonaka #include <sys/sysctl.h>
31 1.1 nonaka #include <sys/mbuf.h>
32 1.1 nonaka #include <sys/kernel.h>
33 1.1 nonaka #include <sys/socket.h>
34 1.1 nonaka #include <sys/systm.h>
35 1.1 nonaka #include <sys/malloc.h>
36 1.1 nonaka #include <sys/callout.h>
37 1.1 nonaka #include <sys/module.h>
38 1.1 nonaka #include <sys/conf.h>
39 1.1 nonaka #include <sys/device.h>
40 1.1 nonaka
41 1.1 nonaka #include <sys/bus.h>
42 1.1 nonaka #include <machine/endian.h>
43 1.1 nonaka #include <sys/intr.h>
44 1.1 nonaka
45 1.1 nonaka #include <net/bpf.h>
46 1.1 nonaka #include <net/if.h>
47 1.1 nonaka #include <net/if_arp.h>
48 1.1 nonaka #include <net/if_dl.h>
49 1.1 nonaka #include <net/if_ether.h>
50 1.1 nonaka #include <net/if_media.h>
51 1.1 nonaka #include <net/if_types.h>
52 1.1 nonaka
53 1.1 nonaka #include <net80211/ieee80211_var.h>
54 1.1 nonaka #include <net80211/ieee80211_amrr.h>
55 1.1 nonaka #include <net80211/ieee80211_radiotap.h>
56 1.1 nonaka
57 1.1 nonaka #include <dev/firmload.h>
58 1.1 nonaka
59 1.1 nonaka #include <dev/usb/usb.h>
60 1.1 nonaka #include <dev/usb/usbdi.h>
61 1.1 nonaka #include <dev/usb/usbdivar.h>
62 1.1 nonaka #include <dev/usb/usbdi_util.h>
63 1.1 nonaka #include <dev/usb/usbdevs.h>
64 1.1 nonaka
65 1.1 nonaka #include <dev/ic/rt2860reg.h> /* shared with ral(4) */
66 1.1 nonaka #include <dev/usb/if_runvar.h>
67 1.1 nonaka
68 1.1 nonaka #ifdef RUN_DEBUG
69 1.1 nonaka #define DPRINTF(x) do { if (run_debug) printf x; } while (0)
70 1.1 nonaka #define DPRINTFN(n, x) do { if (run_debug >= (n)) printf x; } while (0)
71 1.1 nonaka int run_debug = 0;
72 1.1 nonaka #else
73 1.1 nonaka #define DPRINTF(x)
74 1.1 nonaka #define DPRINTFN(n, x)
75 1.1 nonaka #endif
76 1.1 nonaka
77 1.1 nonaka #define USB_ID(v, p) { USB_VENDOR_##v, USB_PRODUCT_##v##_##p }
78 1.1 nonaka static const struct usb_devno run_devs[] = {
79 1.1 nonaka USB_ID(ABOCOM, RT2770),
80 1.1 nonaka USB_ID(ABOCOM, RT2870),
81 1.1 nonaka USB_ID(ABOCOM, RT3070),
82 1.1 nonaka USB_ID(ABOCOM, RT3071),
83 1.1 nonaka USB_ID(ABOCOM, RT3072),
84 1.1 nonaka USB_ID(ABOCOM2, RT2870_1),
85 1.1 nonaka USB_ID(ACCTON, RT2770),
86 1.1 nonaka USB_ID(ACCTON, RT2870_1),
87 1.1 nonaka USB_ID(ACCTON, RT2870_2),
88 1.1 nonaka USB_ID(ACCTON, RT2870_3),
89 1.1 nonaka USB_ID(ACCTON, RT2870_4),
90 1.1 nonaka USB_ID(ACCTON, RT2870_5),
91 1.1 nonaka USB_ID(ACCTON, RT3070),
92 1.1 nonaka USB_ID(ACCTON, RT3070_1),
93 1.1 nonaka USB_ID(ACCTON, RT3070_2),
94 1.1 nonaka USB_ID(ACCTON, RT3070_3),
95 1.1 nonaka USB_ID(ACCTON, RT3070_4),
96 1.1 nonaka USB_ID(ACCTON, RT3070_5),
97 1.1 nonaka USB_ID(ACCTON, RT3070_6),
98 1.1 nonaka USB_ID(AIRTIES, RT3070),
99 1.1 nonaka USB_ID(AIRTIES, RT3070_2),
100 1.1 nonaka USB_ID(ALLWIN, RT2070),
101 1.1 nonaka USB_ID(ALLWIN, RT2770),
102 1.1 nonaka USB_ID(ALLWIN, RT2870),
103 1.1 nonaka USB_ID(ALLWIN, RT3070),
104 1.1 nonaka USB_ID(ALLWIN, RT3071),
105 1.1 nonaka USB_ID(ALLWIN, RT3072),
106 1.1 nonaka USB_ID(ALLWIN, RT3572),
107 1.1 nonaka USB_ID(AMIGO, RT2870_1),
108 1.1 nonaka USB_ID(AMIGO, RT2870_2),
109 1.1 nonaka USB_ID(AMIT, CGWLUSB2GNR),
110 1.1 nonaka USB_ID(AMIT, RT2870_1),
111 1.1 nonaka USB_ID(AMIT2, RT2870),
112 1.1 nonaka USB_ID(ASUSTEK, RT2870_1),
113 1.1 nonaka USB_ID(ASUSTEK, RT2870_2),
114 1.1 nonaka USB_ID(ASUSTEK, RT2870_3),
115 1.1 nonaka USB_ID(ASUSTEK, RT2870_4),
116 1.1 nonaka USB_ID(ASUSTEK, RT2870_5),
117 1.1 nonaka USB_ID(ASUSTEK, RT3070),
118 1.1 nonaka USB_ID(ASUSTEK, RT3070_1),
119 1.1 nonaka USB_ID(ASUSTEK2, USBN11),
120 1.1 nonaka USB_ID(AZUREWAVE, RT2870_1),
121 1.1 nonaka USB_ID(AZUREWAVE, RT2870_2),
122 1.1 nonaka USB_ID(AZUREWAVE, RT3070),
123 1.1 nonaka USB_ID(AZUREWAVE, RT3070_2),
124 1.1 nonaka USB_ID(AZUREWAVE, RT3070_3),
125 1.1 nonaka USB_ID(AZUREWAVE, RT3070_4),
126 1.1 nonaka USB_ID(AZUREWAVE, RT3070_5),
127 1.1 nonaka USB_ID(BELKIN, F5D8053V3),
128 1.1 nonaka USB_ID(BELKIN, F5D8055),
129 1.1 nonaka USB_ID(BELKIN, F5D8055V2),
130 1.1 nonaka USB_ID(BELKIN, F6D4050V1),
131 1.1 nonaka USB_ID(BELKIN, F6D4050V2),
132 1.1 nonaka USB_ID(BELKIN, F7D1101V2),
133 1.1 nonaka USB_ID(BELKIN, RT2870_1),
134 1.1 nonaka USB_ID(BELKIN, RT2870_2),
135 1.1 nonaka USB_ID(BEWAN, RT3070),
136 1.1 nonaka USB_ID(CISCOLINKSYS, AE1000),
137 1.1 nonaka USB_ID(CISCOLINKSYS, AM10),
138 1.1 nonaka USB_ID(CISCOLINKSYS2, RT3070),
139 1.1 nonaka USB_ID(CISCOLINKSYS3, RT3070),
140 1.1 nonaka USB_ID(CONCEPTRONIC, RT2870_1),
141 1.1 nonaka USB_ID(CONCEPTRONIC, RT2870_2),
142 1.1 nonaka USB_ID(CONCEPTRONIC, RT2870_3),
143 1.1 nonaka USB_ID(CONCEPTRONIC, RT2870_4),
144 1.1 nonaka USB_ID(CONCEPTRONIC, RT2870_5),
145 1.1 nonaka USB_ID(CONCEPTRONIC, RT2870_6),
146 1.1 nonaka USB_ID(CONCEPTRONIC, RT2870_7),
147 1.1 nonaka USB_ID(CONCEPTRONIC, RT2870_8),
148 1.1 nonaka USB_ID(CONCEPTRONIC, RT3070_1),
149 1.1 nonaka USB_ID(CONCEPTRONIC, RT3070_2),
150 1.1 nonaka USB_ID(CONCEPTRONIC, RT3070_3),
151 1.1 nonaka USB_ID(COREGA, CGWLUSB300GNM),
152 1.1 nonaka USB_ID(COREGA, RT2870_1),
153 1.1 nonaka USB_ID(COREGA, RT2870_2),
154 1.1 nonaka USB_ID(COREGA, RT2870_3),
155 1.1 nonaka USB_ID(COREGA, RT3070),
156 1.1 nonaka USB_ID(CYBERTAN, RT2870),
157 1.1 nonaka USB_ID(DLINK, RT2870),
158 1.1 nonaka USB_ID(DLINK, RT3072),
159 1.1 nonaka USB_ID(DLINK2, DWA130),
160 1.1 nonaka USB_ID(DLINK2, RT2870_1),
161 1.1 nonaka USB_ID(DLINK2, RT2870_2),
162 1.1 nonaka USB_ID(DLINK2, RT3070_1),
163 1.1 nonaka USB_ID(DLINK2, RT3070_2),
164 1.1 nonaka USB_ID(DLINK2, RT3070_3),
165 1.1 nonaka USB_ID(DLINK2, RT3070_4),
166 1.1 nonaka USB_ID(DLINK2, RT3070_5),
167 1.1 nonaka USB_ID(DLINK2, RT3072),
168 1.1 nonaka USB_ID(DLINK2, RT3072_1),
169 1.1 nonaka USB_ID(DVICO, RT3070),
170 1.1 nonaka USB_ID(EDIMAX, EW7717),
171 1.1 nonaka USB_ID(EDIMAX, EW7718),
172 1.1 nonaka USB_ID(EDIMAX, EW7722UTN),
173 1.1 nonaka USB_ID(EDIMAX, RT2870_1),
174 1.1 nonaka USB_ID(ENCORE, RT3070),
175 1.1 nonaka USB_ID(ENCORE, RT3070_2),
176 1.1 nonaka USB_ID(ENCORE, RT3070_3),
177 1.1 nonaka USB_ID(GIGABYTE, GNWB31N),
178 1.1 nonaka USB_ID(GIGABYTE, GNWB32L),
179 1.1 nonaka USB_ID(GIGABYTE, RT2870_1),
180 1.1 nonaka USB_ID(GIGASET, RT3070_1),
181 1.1 nonaka USB_ID(GIGASET, RT3070_2),
182 1.1 nonaka USB_ID(GUILLEMOT, HWNU300),
183 1.1 nonaka USB_ID(HAWKING, HWUN2),
184 1.1 nonaka USB_ID(HAWKING, RT2870_1),
185 1.1 nonaka USB_ID(HAWKING, RT2870_2),
186 1.1 nonaka USB_ID(HAWKING, RT2870_3),
187 1.1 nonaka USB_ID(HAWKING, RT2870_4),
188 1.1 nonaka USB_ID(HAWKING, RT2870_5),
189 1.1 nonaka USB_ID(HAWKING, RT3070),
190 1.1 nonaka USB_ID(IODATA, RT3072_1),
191 1.1 nonaka USB_ID(IODATA, RT3072_2),
192 1.1 nonaka USB_ID(IODATA, RT3072_3),
193 1.1 nonaka USB_ID(IODATA, RT3072_4),
194 1.1 nonaka USB_ID(LINKSYS4, RT3070),
195 1.1 nonaka USB_ID(LINKSYS4, WUSB100),
196 1.1 nonaka USB_ID(LINKSYS4, WUSB54GC_3),
197 1.1 nonaka USB_ID(LINKSYS4, WUSB600N),
198 1.1 nonaka USB_ID(LINKSYS4, WUSB600NV2),
199 1.1 nonaka USB_ID(LOGITEC, LANW300NU2),
200 1.1 nonaka USB_ID(LOGITEC, RT2870_1),
201 1.1 nonaka USB_ID(LOGITEC, RT2870_2),
202 1.1 nonaka USB_ID(LOGITEC, RT2870_3),
203 1.1 nonaka USB_ID(LOGITEC, RT3020),
204 1.1 nonaka USB_ID(MELCO, RT2870_1),
205 1.1 nonaka USB_ID(MELCO, RT2870_2),
206 1.1 nonaka USB_ID(MELCO, WLIUCAG300N),
207 1.1 nonaka USB_ID(MELCO, WLIUCG300N),
208 1.1 nonaka USB_ID(MELCO, WLIUCG301N),
209 1.1 nonaka USB_ID(MELCO, WLIUCGN),
210 1.1 nonaka USB_ID(MELCO, WLIUCGNHP),
211 1.1 nonaka USB_ID(MELCO, WLIUCGNM),
212 1.1 nonaka USB_ID(MELCO, WLIUCGNM2T),
213 1.1 nonaka USB_ID(MOTOROLA4, RT2770),
214 1.1 nonaka USB_ID(MOTOROLA4, RT3070),
215 1.1 nonaka USB_ID(MSI, RT3070),
216 1.1 nonaka USB_ID(MSI, RT3070_2),
217 1.1 nonaka USB_ID(MSI, RT3070_3),
218 1.1 nonaka USB_ID(MSI, RT3070_4),
219 1.1 nonaka USB_ID(MSI, RT3070_5),
220 1.1 nonaka USB_ID(MSI, RT3070_6),
221 1.1 nonaka USB_ID(MSI, RT3070_7),
222 1.1 nonaka USB_ID(MSI, RT3070_8),
223 1.1 nonaka USB_ID(MSI, RT3070_9),
224 1.1 nonaka USB_ID(MSI, RT3070_10),
225 1.1 nonaka USB_ID(MSI, RT3070_11),
226 1.1 nonaka USB_ID(MSI, RT3070_12),
227 1.1 nonaka USB_ID(MSI, RT3070_13),
228 1.1 nonaka USB_ID(MSI, RT3070_14),
229 1.1 nonaka USB_ID(MSI, RT3070_15),
230 1.1 nonaka USB_ID(OVISLINK, RT3071),
231 1.1 nonaka USB_ID(OVISLINK, RT3072),
232 1.1 nonaka USB_ID(PARA, RT3070),
233 1.1 nonaka USB_ID(PEGATRON, RT2870),
234 1.1 nonaka USB_ID(PEGATRON, RT3070),
235 1.1 nonaka USB_ID(PEGATRON, RT3070_2),
236 1.1 nonaka USB_ID(PEGATRON, RT3070_3),
237 1.1 nonaka USB_ID(PEGATRON, RT3072),
238 1.1 nonaka USB_ID(PHILIPS, RT2870),
239 1.1 nonaka USB_ID(PLANEX2, GWUS300MINIS),
240 1.1 nonaka USB_ID(PLANEX2, GWUSMICRO300),
241 1.1 nonaka USB_ID(PLANEX2, GWUSMICRON),
242 1.1 nonaka USB_ID(PLANEX2, GWUS300MINIX),
243 1.1 nonaka USB_ID(PLANEX2, RT3070),
244 1.1 nonaka USB_ID(QCOM, RT2870),
245 1.1 nonaka USB_ID(QUANTA, RT3070),
246 1.1 nonaka USB_ID(RALINK, RT2070),
247 1.1 nonaka USB_ID(RALINK, RT2770),
248 1.1 nonaka USB_ID(RALINK, RT2870),
249 1.1 nonaka USB_ID(RALINK, RT3070),
250 1.1 nonaka USB_ID(RALINK, RT3071),
251 1.1 nonaka USB_ID(RALINK, RT3072),
252 1.1 nonaka USB_ID(RALINK, RT3370),
253 1.1 nonaka USB_ID(RALINK, RT3572),
254 1.1 nonaka USB_ID(RALINK, RT8070),
255 1.1 nonaka USB_ID(SAMSUNG, RT2870_1),
256 1.1 nonaka USB_ID(SENAO, RT2870_1),
257 1.1 nonaka USB_ID(SENAO, RT2870_2),
258 1.1 nonaka USB_ID(SENAO, RT2870_3),
259 1.1 nonaka USB_ID(SENAO, RT2870_4),
260 1.1 nonaka USB_ID(SENAO, RT3070),
261 1.1 nonaka USB_ID(SENAO, RT3071),
262 1.1 nonaka USB_ID(SENAO, RT3072),
263 1.1 nonaka USB_ID(SENAO, RT3072_2),
264 1.1 nonaka USB_ID(SENAO, RT3072_3),
265 1.1 nonaka USB_ID(SENAO, RT3072_4),
266 1.1 nonaka USB_ID(SENAO, RT3072_5),
267 1.1 nonaka USB_ID(SITECOMEU, RT2870_1),
268 1.1 nonaka USB_ID(SITECOMEU, RT2870_2),
269 1.1 nonaka USB_ID(SITECOMEU, RT2870_3),
270 1.1 nonaka USB_ID(SITECOMEU, RT3070_1),
271 1.1 nonaka USB_ID(SITECOMEU, RT3072_3),
272 1.1 nonaka USB_ID(SITECOMEU, RT3072_4),
273 1.1 nonaka USB_ID(SITECOMEU, RT3072_5),
274 1.1 nonaka USB_ID(SITECOMEU, WL302),
275 1.1 nonaka USB_ID(SITECOMEU, WL315),
276 1.1 nonaka USB_ID(SITECOMEU, WL321),
277 1.1 nonaka USB_ID(SITECOMEU, WL324),
278 1.1 nonaka USB_ID(SITECOMEU, WL329),
279 1.1 nonaka USB_ID(SITECOMEU, WL343),
280 1.1 nonaka USB_ID(SITECOMEU, WL344),
281 1.1 nonaka USB_ID(SITECOMEU, WL345),
282 1.1 nonaka USB_ID(SITECOMEU, WL349V4),
283 1.1 nonaka USB_ID(SITECOMEU, WL608),
284 1.1 nonaka USB_ID(SITECOMEU, WLA4000),
285 1.1 nonaka USB_ID(SITECOMEU, WLA5000),
286 1.1 nonaka USB_ID(SPARKLAN, RT2870_1),
287 1.1 nonaka USB_ID(SPARKLAN, RT2870_2),
288 1.1 nonaka USB_ID(SPARKLAN, RT3070),
289 1.1 nonaka USB_ID(SWEEX2, LW153),
290 1.1 nonaka USB_ID(SWEEX2, LW303),
291 1.1 nonaka USB_ID(SWEEX2, LW313),
292 1.1 nonaka USB_ID(TOSHIBA, RT3070),
293 1.1 nonaka USB_ID(UMEDIA, RT2870_1),
294 1.1 nonaka USB_ID(UMEDIA, TEW645UB),
295 1.1 nonaka USB_ID(ZCOM, RT2870_1),
296 1.1 nonaka USB_ID(ZCOM, RT2870_2),
297 1.1 nonaka USB_ID(ZINWELL, RT2870_1),
298 1.1 nonaka USB_ID(ZINWELL, RT2870_2),
299 1.1 nonaka USB_ID(ZINWELL, RT3070),
300 1.1 nonaka USB_ID(ZINWELL, RT3072),
301 1.1 nonaka USB_ID(ZINWELL, RT3072_2),
302 1.1 nonaka USB_ID(ZYXEL, NWD2105),
303 1.1 nonaka USB_ID(ZYXEL, NWD211AN),
304 1.1 nonaka USB_ID(ZYXEL, RT2870_1),
305 1.1 nonaka USB_ID(ZYXEL, RT2870_2),
306 1.1 nonaka USB_ID(ZYXEL, RT3070),
307 1.1 nonaka };
308 1.1 nonaka
309 1.1 nonaka static int run_match(device_t, cfdata_t, void *);
310 1.1 nonaka static void run_attach(device_t, device_t, void *);
311 1.1 nonaka static int run_detach(device_t, int);
312 1.1 nonaka static int run_activate(device_t, enum devact);
313 1.1 nonaka
314 1.1 nonaka CFATTACH_DECL_NEW(run, sizeof(struct run_softc),
315 1.1 nonaka run_match, run_attach, run_detach, run_activate);
316 1.1 nonaka
317 1.1 nonaka static int run_alloc_rx_ring(struct run_softc *);
318 1.1 nonaka static void run_free_rx_ring(struct run_softc *);
319 1.1 nonaka static int run_alloc_tx_ring(struct run_softc *, int);
320 1.1 nonaka static void run_free_tx_ring(struct run_softc *, int);
321 1.1 nonaka static int run_load_microcode(struct run_softc *);
322 1.1 nonaka static int run_reset(struct run_softc *);
323 1.1 nonaka static int run_read(struct run_softc *, uint16_t, uint32_t *);
324 1.1 nonaka static int run_read_region_1(struct run_softc *, uint16_t,
325 1.1 nonaka uint8_t *, int);
326 1.1 nonaka static int run_write_2(struct run_softc *, uint16_t, uint16_t);
327 1.1 nonaka static int run_write(struct run_softc *, uint16_t, uint32_t);
328 1.1 nonaka static int run_write_region_1(struct run_softc *, uint16_t,
329 1.1 nonaka const uint8_t *, int);
330 1.1 nonaka static int run_set_region_4(struct run_softc *, uint16_t,
331 1.1 nonaka uint32_t, int);
332 1.1 nonaka static int run_efuse_read_2(struct run_softc *, uint16_t,
333 1.1 nonaka uint16_t *);
334 1.1 nonaka static int run_eeprom_read_2(struct run_softc *, uint16_t,
335 1.1 nonaka uint16_t *);
336 1.1 nonaka static int run_rt2870_rf_write(struct run_softc *, uint8_t,
337 1.1 nonaka uint32_t);
338 1.1 nonaka static int run_rt3070_rf_read(struct run_softc *, uint8_t,
339 1.1 nonaka uint8_t *);
340 1.1 nonaka static int run_rt3070_rf_write(struct run_softc *, uint8_t,
341 1.1 nonaka uint8_t);
342 1.1 nonaka static int run_bbp_read(struct run_softc *, uint8_t, uint8_t *);
343 1.1 nonaka static int run_bbp_write(struct run_softc *, uint8_t, uint8_t);
344 1.1 nonaka static int run_mcu_cmd(struct run_softc *, uint8_t, uint16_t);
345 1.1 nonaka static const char * run_get_rf(int);
346 1.1 nonaka static int run_read_eeprom(struct run_softc *);
347 1.1 nonaka static struct ieee80211_node *
348 1.1 nonaka run_node_alloc(struct ieee80211_node_table *);
349 1.1 nonaka static int run_media_change(struct ifnet *);
350 1.1 nonaka static void run_next_scan(void *);
351 1.1 nonaka static void run_task(void *);
352 1.1 nonaka static void run_do_async(struct run_softc *,
353 1.1 nonaka void (*)(struct run_softc *, void *), void *, int);
354 1.1 nonaka static int run_newstate(struct ieee80211com *,
355 1.1 nonaka enum ieee80211_state, int);
356 1.1 nonaka static void run_newstate_cb(struct run_softc *, void *);
357 1.1 nonaka static int run_updateedca(struct ieee80211com *);
358 1.1 nonaka static void run_updateedca_cb(struct run_softc *, void *);
359 1.1 nonaka #ifdef RUN_HWCRYPTO
360 1.1 nonaka static int run_set_key(struct ieee80211com *,
361 1.1 nonaka const struct ieee80211_key *, const uint8_t *);
362 1.1 nonaka static void run_set_key_cb(struct run_softc *, void *);
363 1.1 nonaka static int run_delete_key(struct ieee80211com *,
364 1.1 nonaka const struct ieee80211_key *);
365 1.1 nonaka static void run_delete_key_cb(struct run_softc *, void *);
366 1.1 nonaka #endif
367 1.1 nonaka static void run_calibrate_to(void *);
368 1.1 nonaka static void run_calibrate_cb(struct run_softc *, void *);
369 1.1 nonaka static void run_newassoc(struct ieee80211_node *, int);
370 1.1 nonaka static void run_rx_frame(struct run_softc *, uint8_t *, int);
371 1.10.6.3 skrll static void run_rxeof(struct usbd_xfer *, void *,
372 1.1 nonaka usbd_status);
373 1.10.6.3 skrll static void run_txeof(struct usbd_xfer *, void *,
374 1.1 nonaka usbd_status);
375 1.1 nonaka static int run_tx(struct run_softc *, struct mbuf *,
376 1.1 nonaka struct ieee80211_node *);
377 1.1 nonaka static void run_start(struct ifnet *);
378 1.1 nonaka static void run_watchdog(struct ifnet *);
379 1.1 nonaka static int run_ioctl(struct ifnet *, u_long, void *);
380 1.1 nonaka static void run_select_chan_group(struct run_softc *, int);
381 1.1 nonaka static void run_set_agc(struct run_softc *, uint8_t);
382 1.1 nonaka static void run_set_rx_antenna(struct run_softc *, int);
383 1.1 nonaka static void run_rt2870_set_chan(struct run_softc *, u_int);
384 1.1 nonaka static void run_rt3070_set_chan(struct run_softc *, u_int);
385 1.1 nonaka static void run_rt3572_set_chan(struct run_softc *, u_int);
386 1.1 nonaka static int run_set_chan(struct run_softc *,
387 1.1 nonaka struct ieee80211_channel *);
388 1.1 nonaka static void run_enable_tsf_sync(struct run_softc *);
389 1.1 nonaka static void run_enable_mrr(struct run_softc *);
390 1.1 nonaka static void run_set_txpreamble(struct run_softc *);
391 1.1 nonaka static void run_set_basicrates(struct run_softc *);
392 1.1 nonaka static void run_set_leds(struct run_softc *, uint16_t);
393 1.1 nonaka static void run_set_bssid(struct run_softc *, const uint8_t *);
394 1.1 nonaka static void run_set_macaddr(struct run_softc *, const uint8_t *);
395 1.1 nonaka static void run_updateslot(struct ifnet *);
396 1.1 nonaka static void run_updateslot_cb(struct run_softc *, void *);
397 1.1 nonaka static int8_t run_rssi2dbm(struct run_softc *, uint8_t, uint8_t);
398 1.1 nonaka static int run_bbp_init(struct run_softc *);
399 1.1 nonaka static int run_rt3070_rf_init(struct run_softc *);
400 1.1 nonaka static int run_rt3070_filter_calib(struct run_softc *, uint8_t,
401 1.1 nonaka uint8_t, uint8_t *);
402 1.1 nonaka static void run_rt3070_rf_setup(struct run_softc *);
403 1.1 nonaka static int run_txrx_enable(struct run_softc *);
404 1.1 nonaka static int run_init(struct ifnet *);
405 1.1 nonaka static void run_stop(struct ifnet *, int);
406 1.1 nonaka #ifndef IEEE80211_STA_ONLY
407 1.1 nonaka static int run_setup_beacon(struct run_softc *);
408 1.1 nonaka #endif
409 1.1 nonaka
410 1.1 nonaka static const struct {
411 1.1 nonaka uint32_t reg;
412 1.1 nonaka uint32_t val;
413 1.1 nonaka } rt2870_def_mac[] = {
414 1.1 nonaka RT2870_DEF_MAC
415 1.1 nonaka };
416 1.1 nonaka
417 1.1 nonaka static const struct {
418 1.1 nonaka uint8_t reg;
419 1.1 nonaka uint8_t val;
420 1.1 nonaka } rt2860_def_bbp[] = {
421 1.1 nonaka RT2860_DEF_BBP
422 1.1 nonaka };
423 1.1 nonaka
424 1.1 nonaka static const struct rfprog {
425 1.1 nonaka uint8_t chan;
426 1.1 nonaka uint32_t r1, r2, r3, r4;
427 1.1 nonaka } rt2860_rf2850[] = {
428 1.1 nonaka RT2860_RF2850
429 1.1 nonaka };
430 1.1 nonaka
431 1.1 nonaka static const struct {
432 1.1 nonaka uint8_t n, r, k;
433 1.1 nonaka } rt3070_freqs[] = {
434 1.1 nonaka RT3070_RF3052
435 1.1 nonaka };
436 1.1 nonaka
437 1.1 nonaka static const struct {
438 1.1 nonaka uint8_t reg;
439 1.1 nonaka uint8_t val;
440 1.1 nonaka } rt3070_def_rf[] = {
441 1.1 nonaka RT3070_DEF_RF
442 1.1 nonaka }, rt3572_def_rf[] = {
443 1.1 nonaka RT3572_DEF_RF
444 1.1 nonaka };
445 1.1 nonaka
446 1.1 nonaka static int
447 1.1 nonaka firmware_load(const char *dname, const char *iname, uint8_t **ucodep,
448 1.1 nonaka size_t *sizep)
449 1.1 nonaka {
450 1.1 nonaka firmware_handle_t fh;
451 1.1 nonaka int error;
452 1.1 nonaka
453 1.1 nonaka if ((error = firmware_open(dname, iname, &fh)) != 0)
454 1.10.6.2 skrll return error;
455 1.1 nonaka *sizep = firmware_get_size(fh);
456 1.1 nonaka if ((*ucodep = firmware_malloc(*sizep)) == NULL) {
457 1.1 nonaka firmware_close(fh);
458 1.10.6.2 skrll return ENOMEM;
459 1.1 nonaka }
460 1.1 nonaka if ((error = firmware_read(fh, 0, *ucodep, *sizep)) != 0)
461 1.1 nonaka firmware_free(*ucodep, *sizep);
462 1.1 nonaka firmware_close(fh);
463 1.1 nonaka
464 1.10.6.2 skrll return error;
465 1.1 nonaka }
466 1.1 nonaka
467 1.1 nonaka static int
468 1.1 nonaka run_match(device_t parent, cfdata_t match, void *aux)
469 1.1 nonaka {
470 1.1 nonaka struct usb_attach_arg *uaa = aux;
471 1.1 nonaka
472 1.10.6.4 skrll return (usb_lookup(run_devs, uaa->uaa_vendor, uaa->uaa_product) != NULL) ?
473 1.1 nonaka UMATCH_VENDOR_PRODUCT : UMATCH_NONE;
474 1.1 nonaka }
475 1.1 nonaka
476 1.1 nonaka static void
477 1.1 nonaka run_attach(device_t parent, device_t self, void *aux)
478 1.1 nonaka {
479 1.1 nonaka struct run_softc *sc = device_private(self);
480 1.1 nonaka struct usb_attach_arg *uaa = aux;
481 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
482 1.1 nonaka struct ifnet *ifp = &sc->sc_if;
483 1.1 nonaka usb_interface_descriptor_t *id;
484 1.1 nonaka usb_endpoint_descriptor_t *ed;
485 1.1 nonaka char *devinfop;
486 1.1 nonaka int i, nrx, ntx, ntries, error;
487 1.1 nonaka uint32_t ver;
488 1.1 nonaka
489 1.1 nonaka aprint_naive("\n");
490 1.1 nonaka aprint_normal("\n");
491 1.1 nonaka
492 1.1 nonaka sc->sc_dev = self;
493 1.10.6.4 skrll sc->sc_udev = uaa->uaa_device;
494 1.1 nonaka
495 1.1 nonaka devinfop = usbd_devinfo_alloc(sc->sc_udev, 0);
496 1.1 nonaka aprint_normal_dev(sc->sc_dev, "%s\n", devinfop);
497 1.1 nonaka usbd_devinfo_free(devinfop);
498 1.1 nonaka
499 1.5 skrll error = usbd_set_config_no(sc->sc_udev, 1, 0);
500 1.5 skrll if (error != 0) {
501 1.5 skrll aprint_error_dev(sc->sc_dev, "failed to set configuration"
502 1.5 skrll ", err=%s\n", usbd_errstr(error));
503 1.1 nonaka return;
504 1.1 nonaka }
505 1.1 nonaka
506 1.1 nonaka /* get the first interface handle */
507 1.1 nonaka error = usbd_device2interface_handle(sc->sc_udev, 0, &sc->sc_iface);
508 1.1 nonaka if (error != 0) {
509 1.1 nonaka aprint_error_dev(sc->sc_dev,
510 1.1 nonaka "could not get interface handle\n");
511 1.1 nonaka return;
512 1.1 nonaka }
513 1.1 nonaka
514 1.1 nonaka /*
515 1.1 nonaka * Find all bulk endpoints. There are 7 bulk endpoints: 1 for RX
516 1.1 nonaka * and 6 for TX (4 EDCAs + HCCA + Prio).
517 1.1 nonaka * Update 03-14-2009: some devices like the Planex GW-US300MiniS
518 1.1 nonaka * seem to have only 4 TX bulk endpoints (Fukaumi Naoki).
519 1.1 nonaka */
520 1.1 nonaka nrx = ntx = 0;
521 1.1 nonaka id = usbd_get_interface_descriptor(sc->sc_iface);
522 1.1 nonaka for (i = 0; i < id->bNumEndpoints; i++) {
523 1.1 nonaka ed = usbd_interface2endpoint_descriptor(sc->sc_iface, i);
524 1.1 nonaka if (ed == NULL || UE_GET_XFERTYPE(ed->bmAttributes) != UE_BULK)
525 1.1 nonaka continue;
526 1.1 nonaka
527 1.1 nonaka if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN) {
528 1.1 nonaka sc->rxq.pipe_no = ed->bEndpointAddress;
529 1.1 nonaka nrx++;
530 1.1 nonaka } else if (ntx < 4) {
531 1.1 nonaka sc->txq[ntx].pipe_no = ed->bEndpointAddress;
532 1.1 nonaka ntx++;
533 1.1 nonaka }
534 1.1 nonaka }
535 1.1 nonaka /* make sure we've got them all */
536 1.1 nonaka if (nrx < 1 || ntx < 4) {
537 1.1 nonaka aprint_error_dev(sc->sc_dev, "missing endpoint\n");
538 1.1 nonaka return;
539 1.1 nonaka }
540 1.1 nonaka
541 1.8 jmcneill usb_init_task(&sc->sc_task, run_task, sc, 0);
542 1.1 nonaka callout_init(&sc->scan_to, 0);
543 1.1 nonaka callout_setfunc(&sc->scan_to, run_next_scan, sc);
544 1.1 nonaka callout_init(&sc->calib_to, 0);
545 1.1 nonaka callout_setfunc(&sc->calib_to, run_calibrate_to, sc);
546 1.1 nonaka
547 1.1 nonaka sc->amrr.amrr_min_success_threshold = 1;
548 1.1 nonaka sc->amrr.amrr_max_success_threshold = 10;
549 1.1 nonaka
550 1.1 nonaka /* wait for the chip to settle */
551 1.1 nonaka for (ntries = 0; ntries < 100; ntries++) {
552 1.1 nonaka if (run_read(sc, RT2860_ASIC_VER_ID, &ver) != 0)
553 1.1 nonaka return;
554 1.1 nonaka if (ver != 0 && ver != 0xffffffff)
555 1.1 nonaka break;
556 1.1 nonaka DELAY(10);
557 1.1 nonaka }
558 1.1 nonaka if (ntries == 100) {
559 1.1 nonaka aprint_error_dev(sc->sc_dev,
560 1.1 nonaka "timeout waiting for NIC to initialize\n");
561 1.1 nonaka return;
562 1.1 nonaka }
563 1.1 nonaka sc->mac_ver = ver >> 16;
564 1.1 nonaka sc->mac_rev = ver & 0xffff;
565 1.1 nonaka
566 1.1 nonaka /* retrieve RF rev. no and various other things from EEPROM */
567 1.1 nonaka run_read_eeprom(sc);
568 1.1 nonaka
569 1.1 nonaka aprint_error_dev(sc->sc_dev,
570 1.1 nonaka "MAC/BBP RT%04X (rev 0x%04X), RF %s (MIMO %dT%dR), address %s\n",
571 1.1 nonaka sc->mac_ver, sc->mac_rev, run_get_rf(sc->rf_rev), sc->ntxchains,
572 1.1 nonaka sc->nrxchains, ether_sprintf(ic->ic_myaddr));
573 1.1 nonaka
574 1.1 nonaka ic->ic_ifp = ifp;
575 1.1 nonaka ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */
576 1.1 nonaka ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */
577 1.1 nonaka ic->ic_state = IEEE80211_S_INIT;
578 1.1 nonaka
579 1.1 nonaka /* set device capabilities */
580 1.1 nonaka ic->ic_caps =
581 1.1 nonaka IEEE80211_C_MONITOR | /* monitor mode supported */
582 1.1 nonaka #ifndef IEEE80211_STA_ONLY
583 1.1 nonaka IEEE80211_C_IBSS | /* IBSS mode supported */
584 1.1 nonaka IEEE80211_C_HOSTAP | /* HostAP mode supported */
585 1.1 nonaka #endif
586 1.1 nonaka IEEE80211_C_SHPREAMBLE | /* short preamble supported */
587 1.1 nonaka IEEE80211_C_SHSLOT | /* short slot time supported */
588 1.1 nonaka #ifdef RUN_HWCRYPTO
589 1.1 nonaka IEEE80211_C_WEP | /* WEP */
590 1.1 nonaka IEEE80211_C_TKIP | /* TKIP */
591 1.1 nonaka IEEE80211_C_AES_CCM | /* AES CCMP */
592 1.1 nonaka IEEE80211_C_TKIPMIC | /* TKIPMIC */
593 1.1 nonaka #endif
594 1.1 nonaka IEEE80211_C_WME | /* WME */
595 1.1 nonaka IEEE80211_C_WPA; /* WPA/RSN */
596 1.1 nonaka
597 1.1 nonaka if (sc->rf_rev == RT2860_RF_2750 ||
598 1.1 nonaka sc->rf_rev == RT2860_RF_2850 ||
599 1.1 nonaka sc->rf_rev == RT3070_RF_3052) {
600 1.1 nonaka /* set supported .11a rates */
601 1.1 nonaka ic->ic_sup_rates[IEEE80211_MODE_11A] =
602 1.1 nonaka ieee80211_std_rateset_11a;
603 1.1 nonaka
604 1.1 nonaka /* set supported .11a channels */
605 1.1 nonaka for (i = 14; i < (int)__arraycount(rt2860_rf2850); i++) {
606 1.1 nonaka uint8_t chan = rt2860_rf2850[i].chan;
607 1.1 nonaka ic->ic_channels[chan].ic_freq =
608 1.1 nonaka ieee80211_ieee2mhz(chan, IEEE80211_CHAN_5GHZ);
609 1.1 nonaka ic->ic_channels[chan].ic_flags = IEEE80211_CHAN_A;
610 1.1 nonaka }
611 1.1 nonaka }
612 1.1 nonaka
613 1.1 nonaka /* set supported .11b and .11g rates */
614 1.1 nonaka ic->ic_sup_rates[IEEE80211_MODE_11B] = ieee80211_std_rateset_11b;
615 1.1 nonaka ic->ic_sup_rates[IEEE80211_MODE_11G] = ieee80211_std_rateset_11g;
616 1.1 nonaka
617 1.1 nonaka /* set supported .11b and .11g channels (1 through 14) */
618 1.1 nonaka for (i = 1; i <= 14; i++) {
619 1.1 nonaka ic->ic_channels[i].ic_freq =
620 1.1 nonaka ieee80211_ieee2mhz(i, IEEE80211_CHAN_2GHZ);
621 1.1 nonaka ic->ic_channels[i].ic_flags =
622 1.1 nonaka IEEE80211_CHAN_CCK | IEEE80211_CHAN_OFDM |
623 1.1 nonaka IEEE80211_CHAN_DYN | IEEE80211_CHAN_2GHZ;
624 1.1 nonaka }
625 1.1 nonaka
626 1.1 nonaka ifp->if_softc = sc;
627 1.1 nonaka ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
628 1.1 nonaka ifp->if_init = run_init;
629 1.1 nonaka ifp->if_ioctl = run_ioctl;
630 1.1 nonaka ifp->if_start = run_start;
631 1.1 nonaka ifp->if_watchdog = run_watchdog;
632 1.1 nonaka IFQ_SET_READY(&ifp->if_snd);
633 1.1 nonaka memcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
634 1.1 nonaka
635 1.1 nonaka if_attach(ifp);
636 1.1 nonaka ieee80211_ifattach(ic);
637 1.1 nonaka ic->ic_node_alloc = run_node_alloc;
638 1.1 nonaka ic->ic_newassoc = run_newassoc;
639 1.1 nonaka ic->ic_updateslot = run_updateslot;
640 1.1 nonaka ic->ic_wme.wme_update = run_updateedca;
641 1.1 nonaka #ifdef RUN_HWCRYPTO
642 1.1 nonaka ic->ic_crypto.cs_key_set = run_set_key;
643 1.1 nonaka ic->ic_crypto.cs_key_delete = run_delete_key;
644 1.1 nonaka #endif
645 1.1 nonaka /* override state transition machine */
646 1.1 nonaka sc->sc_newstate = ic->ic_newstate;
647 1.1 nonaka ic->ic_newstate = run_newstate;
648 1.1 nonaka ieee80211_media_init(ic, run_media_change, ieee80211_media_status);
649 1.1 nonaka
650 1.1 nonaka bpf_attach2(ifp, DLT_IEEE802_11_RADIO,
651 1.1 nonaka sizeof(struct ieee80211_frame) + IEEE80211_RADIOTAP_HDRLEN,
652 1.1 nonaka &sc->sc_drvbpf);
653 1.1 nonaka
654 1.1 nonaka sc->sc_rxtap_len = sizeof(sc->sc_rxtapu);
655 1.1 nonaka sc->sc_rxtap.wr_ihdr.it_len = htole16(sc->sc_rxtap_len);
656 1.1 nonaka sc->sc_rxtap.wr_ihdr.it_present = htole32(RUN_RX_RADIOTAP_PRESENT);
657 1.1 nonaka
658 1.1 nonaka sc->sc_txtap_len = sizeof(sc->sc_txtapu);
659 1.1 nonaka sc->sc_txtap.wt_ihdr.it_len = htole16(sc->sc_txtap_len);
660 1.1 nonaka sc->sc_txtap.wt_ihdr.it_present = htole32(RUN_TX_RADIOTAP_PRESENT);
661 1.1 nonaka
662 1.1 nonaka ieee80211_announce(ic);
663 1.1 nonaka
664 1.1 nonaka usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, sc->sc_dev);
665 1.10.6.5 skrll
666 1.10.6.5 skrll if (!pmf_device_register(self, NULL, NULL))
667 1.10.6.5 skrll aprint_error_dev(self, "couldn't establish power handler\n");
668 1.1 nonaka }
669 1.1 nonaka
670 1.1 nonaka static int
671 1.1 nonaka run_detach(device_t self, int flags)
672 1.1 nonaka {
673 1.1 nonaka struct run_softc *sc = device_private(self);
674 1.1 nonaka struct ifnet *ifp = &sc->sc_if;
675 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
676 1.1 nonaka int s;
677 1.1 nonaka
678 1.1 nonaka if (ifp->if_softc == NULL)
679 1.10.6.2 skrll return 0;
680 1.1 nonaka
681 1.10.6.5 skrll pmf_device_deregister(self);
682 1.10.6.5 skrll
683 1.1 nonaka s = splnet();
684 1.1 nonaka
685 1.1 nonaka sc->sc_flags |= RUN_DETACHING;
686 1.1 nonaka
687 1.1 nonaka if (ifp->if_flags & IFF_RUNNING) {
688 1.1 nonaka usb_rem_task(sc->sc_udev, &sc->sc_task);
689 1.1 nonaka run_stop(ifp, 0);
690 1.1 nonaka }
691 1.1 nonaka
692 1.1 nonaka ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
693 1.1 nonaka bpf_detach(ifp);
694 1.1 nonaka ieee80211_ifdetach(ic);
695 1.1 nonaka if_detach(ifp);
696 1.1 nonaka
697 1.1 nonaka splx(s);
698 1.1 nonaka
699 1.1 nonaka usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, sc->sc_dev);
700 1.1 nonaka
701 1.1 nonaka callout_destroy(&sc->scan_to);
702 1.1 nonaka callout_destroy(&sc->calib_to);
703 1.1 nonaka
704 1.10.6.2 skrll return 0;
705 1.1 nonaka }
706 1.1 nonaka
707 1.1 nonaka static int
708 1.1 nonaka run_activate(device_t self, enum devact act)
709 1.1 nonaka {
710 1.1 nonaka struct run_softc *sc = device_private(self);
711 1.1 nonaka
712 1.1 nonaka switch (act) {
713 1.1 nonaka case DVACT_DEACTIVATE:
714 1.1 nonaka if_deactivate(sc->sc_ic.ic_ifp);
715 1.10.6.2 skrll return 0;
716 1.1 nonaka default:
717 1.10.6.2 skrll return EOPNOTSUPP;
718 1.1 nonaka }
719 1.1 nonaka }
720 1.1 nonaka
721 1.1 nonaka static int
722 1.1 nonaka run_alloc_rx_ring(struct run_softc *sc)
723 1.1 nonaka {
724 1.1 nonaka struct run_rx_ring *rxq = &sc->rxq;
725 1.1 nonaka int i, error;
726 1.1 nonaka
727 1.1 nonaka error = usbd_open_pipe(sc->sc_iface, rxq->pipe_no, 0, &rxq->pipeh);
728 1.1 nonaka if (error != 0)
729 1.1 nonaka goto fail;
730 1.1 nonaka
731 1.1 nonaka for (i = 0; i < RUN_RX_RING_COUNT; i++) {
732 1.1 nonaka struct run_rx_data *data = &rxq->data[i];
733 1.1 nonaka
734 1.1 nonaka data->sc = sc; /* backpointer for callbacks */
735 1.1 nonaka
736 1.10.6.7 skrll error = usbd_create_xfer(sc->rxq.pipeh, RUN_MAX_RXSZ,
737 1.10.6.7 skrll USBD_SHORT_XFER_OK, 0, &data->xfer);
738 1.10.6.7 skrll if (error)
739 1.1 nonaka goto fail;
740 1.10.6.7 skrll
741 1.10.6.7 skrll data->buf = usbd_get_buffer(data->xfer);
742 1.1 nonaka }
743 1.1 nonaka if (error != 0)
744 1.1 nonaka fail: run_free_rx_ring(sc);
745 1.10.6.2 skrll return error;
746 1.1 nonaka }
747 1.1 nonaka
748 1.1 nonaka static void
749 1.1 nonaka run_free_rx_ring(struct run_softc *sc)
750 1.1 nonaka {
751 1.1 nonaka struct run_rx_ring *rxq = &sc->rxq;
752 1.1 nonaka int i;
753 1.1 nonaka
754 1.1 nonaka if (rxq->pipeh != NULL) {
755 1.1 nonaka usbd_abort_pipe(rxq->pipeh);
756 1.1 nonaka }
757 1.1 nonaka for (i = 0; i < RUN_RX_RING_COUNT; i++) {
758 1.1 nonaka if (rxq->data[i].xfer != NULL)
759 1.10.6.7 skrll usbd_destroy_xfer(rxq->data[i].xfer);
760 1.1 nonaka rxq->data[i].xfer = NULL;
761 1.1 nonaka }
762 1.10.6.8 skrll if (rxq->pipeh != NULL) {
763 1.10.6.8 skrll usbd_close_pipe(rxq->pipeh);
764 1.10.6.8 skrll rxq->pipeh = NULL;
765 1.10.6.8 skrll }
766 1.1 nonaka }
767 1.1 nonaka
768 1.1 nonaka static int
769 1.1 nonaka run_alloc_tx_ring(struct run_softc *sc, int qid)
770 1.1 nonaka {
771 1.1 nonaka struct run_tx_ring *txq = &sc->txq[qid];
772 1.1 nonaka int i, error;
773 1.1 nonaka
774 1.1 nonaka txq->cur = txq->queued = 0;
775 1.1 nonaka
776 1.1 nonaka error = usbd_open_pipe(sc->sc_iface, txq->pipe_no, 0, &txq->pipeh);
777 1.1 nonaka if (error != 0)
778 1.1 nonaka goto fail;
779 1.1 nonaka
780 1.1 nonaka for (i = 0; i < RUN_TX_RING_COUNT; i++) {
781 1.1 nonaka struct run_tx_data *data = &txq->data[i];
782 1.1 nonaka
783 1.1 nonaka data->sc = sc; /* backpointer for callbacks */
784 1.1 nonaka data->qid = qid;
785 1.1 nonaka
786 1.10.6.7 skrll error = usbd_create_xfer(txq->pipeh, RUN_MAX_TXSZ,
787 1.10.6.7 skrll USBD_FORCE_SHORT_XFER, 0, &data->xfer);
788 1.10.6.7 skrll if (error)
789 1.1 nonaka goto fail;
790 1.10.6.7 skrll
791 1.10.6.7 skrll data->buf = usbd_get_buffer(data->xfer);
792 1.1 nonaka /* zeroize the TXD + TXWI part */
793 1.10.6.6 skrll memset(data->buf, 0, sizeof(struct rt2870_txd) +
794 1.10.6.6 skrll sizeof(struct rt2860_txwi));
795 1.1 nonaka }
796 1.1 nonaka if (error != 0)
797 1.1 nonaka fail: run_free_tx_ring(sc, qid);
798 1.10.6.2 skrll return error;
799 1.1 nonaka }
800 1.1 nonaka
801 1.1 nonaka static void
802 1.1 nonaka run_free_tx_ring(struct run_softc *sc, int qid)
803 1.1 nonaka {
804 1.1 nonaka struct run_tx_ring *txq = &sc->txq[qid];
805 1.1 nonaka int i;
806 1.1 nonaka
807 1.1 nonaka if (txq->pipeh != NULL) {
808 1.1 nonaka usbd_abort_pipe(txq->pipeh);
809 1.1 nonaka usbd_close_pipe(txq->pipeh);
810 1.1 nonaka txq->pipeh = NULL;
811 1.1 nonaka }
812 1.1 nonaka for (i = 0; i < RUN_TX_RING_COUNT; i++) {
813 1.1 nonaka if (txq->data[i].xfer != NULL)
814 1.10.6.7 skrll usbd_destroy_xfer(txq->data[i].xfer);
815 1.1 nonaka txq->data[i].xfer = NULL;
816 1.1 nonaka }
817 1.1 nonaka }
818 1.1 nonaka
819 1.1 nonaka static int
820 1.1 nonaka run_load_microcode(struct run_softc *sc)
821 1.1 nonaka {
822 1.1 nonaka usb_device_request_t req;
823 1.1 nonaka const char *fwname;
824 1.10 martin u_char *ucode = NULL; /* XXX gcc 4.8.3: maybe-uninitialized */
825 1.10 martin size_t size = 0; /* XXX gcc 4.8.3: maybe-uninitialized */
826 1.1 nonaka uint32_t tmp;
827 1.1 nonaka int ntries, error;
828 1.1 nonaka
829 1.1 nonaka /* RT3071/RT3072 use a different firmware */
830 1.1 nonaka if (sc->mac_ver != 0x2860 &&
831 1.1 nonaka sc->mac_ver != 0x2872 &&
832 1.1 nonaka sc->mac_ver != 0x3070)
833 1.1 nonaka fwname = "run-rt3071";
834 1.1 nonaka else
835 1.1 nonaka fwname = "run-rt2870";
836 1.1 nonaka
837 1.3 nonaka if ((error = firmware_load("run", fwname, &ucode, &size)) != 0) {
838 1.1 nonaka aprint_error_dev(sc->sc_dev,
839 1.1 nonaka "error %d, could not read firmware %s\n", error, fwname);
840 1.10.6.2 skrll return error;
841 1.1 nonaka }
842 1.1 nonaka if (size != 4096) {
843 1.1 nonaka aprint_error_dev(sc->sc_dev,
844 1.1 nonaka "invalid firmware size (should be 4KB)\n");
845 1.1 nonaka firmware_free(ucode, size);
846 1.10.6.2 skrll return EINVAL;
847 1.1 nonaka }
848 1.1 nonaka
849 1.1 nonaka run_read(sc, RT2860_ASIC_VER_ID, &tmp);
850 1.1 nonaka /* write microcode image */
851 1.1 nonaka run_write_region_1(sc, RT2870_FW_BASE, ucode, size);
852 1.1 nonaka firmware_free(ucode, size);
853 1.1 nonaka run_write(sc, RT2860_H2M_MAILBOX_CID, 0xffffffff);
854 1.1 nonaka run_write(sc, RT2860_H2M_MAILBOX_STATUS, 0xffffffff);
855 1.1 nonaka
856 1.1 nonaka req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
857 1.1 nonaka req.bRequest = RT2870_RESET;
858 1.1 nonaka USETW(req.wValue, 8);
859 1.1 nonaka USETW(req.wIndex, 0);
860 1.1 nonaka USETW(req.wLength, 0);
861 1.1 nonaka if ((error = usbd_do_request(sc->sc_udev, &req, NULL)) != 0)
862 1.10.6.2 skrll return error;
863 1.1 nonaka
864 1.1 nonaka usbd_delay_ms(sc->sc_udev, 10);
865 1.1 nonaka run_write(sc, RT2860_H2M_MAILBOX, 0);
866 1.1 nonaka if ((error = run_mcu_cmd(sc, RT2860_MCU_CMD_RFRESET, 0)) != 0)
867 1.10.6.2 skrll return error;
868 1.1 nonaka
869 1.1 nonaka /* wait until microcontroller is ready */
870 1.1 nonaka for (ntries = 0; ntries < 1000; ntries++) {
871 1.1 nonaka if ((error = run_read(sc, RT2860_SYS_CTRL, &tmp)) != 0)
872 1.10.6.2 skrll return error;
873 1.1 nonaka if (tmp & RT2860_MCU_READY)
874 1.1 nonaka break;
875 1.1 nonaka DELAY(1000);
876 1.1 nonaka }
877 1.1 nonaka if (ntries == 1000) {
878 1.1 nonaka aprint_error_dev(sc->sc_dev,
879 1.1 nonaka "timeout waiting for MCU to initialize\n");
880 1.10.6.2 skrll return ETIMEDOUT;
881 1.1 nonaka }
882 1.1 nonaka
883 1.1 nonaka sc->sc_flags |= RUN_FWLOADED;
884 1.1 nonaka
885 1.1 nonaka DPRINTF(("microcode successfully loaded after %d tries\n", ntries));
886 1.10.6.2 skrll return 0;
887 1.1 nonaka }
888 1.1 nonaka
889 1.1 nonaka static int
890 1.1 nonaka run_reset(struct run_softc *sc)
891 1.1 nonaka {
892 1.1 nonaka usb_device_request_t req;
893 1.1 nonaka
894 1.1 nonaka req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
895 1.1 nonaka req.bRequest = RT2870_RESET;
896 1.1 nonaka USETW(req.wValue, 1);
897 1.1 nonaka USETW(req.wIndex, 0);
898 1.1 nonaka USETW(req.wLength, 0);
899 1.1 nonaka return usbd_do_request(sc->sc_udev, &req, NULL);
900 1.1 nonaka }
901 1.1 nonaka
902 1.1 nonaka static int
903 1.1 nonaka run_read(struct run_softc *sc, uint16_t reg, uint32_t *val)
904 1.1 nonaka {
905 1.1 nonaka uint32_t tmp;
906 1.1 nonaka int error;
907 1.1 nonaka
908 1.10.6.6 skrll error = run_read_region_1(sc, reg, (uint8_t *)&tmp, sizeof(tmp));
909 1.1 nonaka if (error == 0)
910 1.1 nonaka *val = le32toh(tmp);
911 1.1 nonaka else
912 1.1 nonaka *val = 0xffffffff;
913 1.10.6.2 skrll return error;
914 1.1 nonaka }
915 1.1 nonaka
916 1.1 nonaka static int
917 1.1 nonaka run_read_region_1(struct run_softc *sc, uint16_t reg, uint8_t *buf, int len)
918 1.1 nonaka {
919 1.1 nonaka usb_device_request_t req;
920 1.1 nonaka
921 1.1 nonaka req.bmRequestType = UT_READ_VENDOR_DEVICE;
922 1.1 nonaka req.bRequest = RT2870_READ_REGION_1;
923 1.1 nonaka USETW(req.wValue, 0);
924 1.1 nonaka USETW(req.wIndex, reg);
925 1.1 nonaka USETW(req.wLength, len);
926 1.1 nonaka return usbd_do_request(sc->sc_udev, &req, buf);
927 1.1 nonaka }
928 1.1 nonaka
929 1.1 nonaka static int
930 1.1 nonaka run_write_2(struct run_softc *sc, uint16_t reg, uint16_t val)
931 1.1 nonaka {
932 1.1 nonaka usb_device_request_t req;
933 1.1 nonaka
934 1.1 nonaka req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
935 1.1 nonaka req.bRequest = RT2870_WRITE_2;
936 1.1 nonaka USETW(req.wValue, val);
937 1.1 nonaka USETW(req.wIndex, reg);
938 1.1 nonaka USETW(req.wLength, 0);
939 1.1 nonaka return usbd_do_request(sc->sc_udev, &req, NULL);
940 1.1 nonaka }
941 1.1 nonaka
942 1.1 nonaka static int
943 1.1 nonaka run_write(struct run_softc *sc, uint16_t reg, uint32_t val)
944 1.1 nonaka {
945 1.1 nonaka int error;
946 1.1 nonaka
947 1.1 nonaka if ((error = run_write_2(sc, reg, val & 0xffff)) == 0)
948 1.1 nonaka error = run_write_2(sc, reg + 2, val >> 16);
949 1.10.6.2 skrll return error;
950 1.1 nonaka }
951 1.1 nonaka
952 1.1 nonaka static int
953 1.1 nonaka run_write_region_1(struct run_softc *sc, uint16_t reg, const uint8_t *buf,
954 1.1 nonaka int len)
955 1.1 nonaka {
956 1.1 nonaka #if 1
957 1.1 nonaka int i, error = 0;
958 1.1 nonaka /*
959 1.1 nonaka * NB: the WRITE_REGION_1 command is not stable on RT2860.
960 1.1 nonaka * We thus issue multiple WRITE_2 commands instead.
961 1.1 nonaka */
962 1.1 nonaka KASSERT((len & 1) == 0);
963 1.1 nonaka for (i = 0; i < len && error == 0; i += 2)
964 1.1 nonaka error = run_write_2(sc, reg + i, buf[i] | buf[i + 1] << 8);
965 1.10.6.2 skrll return error;
966 1.1 nonaka #else
967 1.1 nonaka usb_device_request_t req;
968 1.1 nonaka
969 1.1 nonaka req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
970 1.1 nonaka req.bRequest = RT2870_WRITE_REGION_1;
971 1.1 nonaka USETW(req.wValue, 0);
972 1.1 nonaka USETW(req.wIndex, reg);
973 1.1 nonaka USETW(req.wLength, len);
974 1.1 nonaka return usbd_do_request(sc->sc_udev, &req, buf);
975 1.1 nonaka #endif
976 1.1 nonaka }
977 1.1 nonaka
978 1.1 nonaka static int
979 1.1 nonaka run_set_region_4(struct run_softc *sc, uint16_t reg, uint32_t val, int count)
980 1.1 nonaka {
981 1.1 nonaka int error = 0;
982 1.1 nonaka
983 1.1 nonaka for (; count > 0 && error == 0; count--, reg += 4)
984 1.1 nonaka error = run_write(sc, reg, val);
985 1.10.6.2 skrll return error;
986 1.1 nonaka }
987 1.1 nonaka
988 1.1 nonaka /* Read 16-bit from eFUSE ROM (RT3070 only.) */
989 1.1 nonaka static int
990 1.1 nonaka run_efuse_read_2(struct run_softc *sc, uint16_t addr, uint16_t *val)
991 1.1 nonaka {
992 1.1 nonaka uint32_t tmp;
993 1.1 nonaka uint16_t reg;
994 1.1 nonaka int error, ntries;
995 1.1 nonaka
996 1.1 nonaka if ((error = run_read(sc, RT3070_EFUSE_CTRL, &tmp)) != 0)
997 1.10.6.2 skrll return error;
998 1.1 nonaka
999 1.1 nonaka addr *= 2;
1000 1.1 nonaka /*-
1001 1.1 nonaka * Read one 16-byte block into registers EFUSE_DATA[0-3]:
1002 1.1 nonaka * DATA0: F E D C
1003 1.1 nonaka * DATA1: B A 9 8
1004 1.1 nonaka * DATA2: 7 6 5 4
1005 1.1 nonaka * DATA3: 3 2 1 0
1006 1.1 nonaka */
1007 1.1 nonaka tmp &= ~(RT3070_EFSROM_MODE_MASK | RT3070_EFSROM_AIN_MASK);
1008 1.1 nonaka tmp |= (addr & ~0xf) << RT3070_EFSROM_AIN_SHIFT | RT3070_EFSROM_KICK;
1009 1.1 nonaka run_write(sc, RT3070_EFUSE_CTRL, tmp);
1010 1.1 nonaka for (ntries = 0; ntries < 100; ntries++) {
1011 1.1 nonaka if ((error = run_read(sc, RT3070_EFUSE_CTRL, &tmp)) != 0)
1012 1.10.6.2 skrll return error;
1013 1.1 nonaka if (!(tmp & RT3070_EFSROM_KICK))
1014 1.1 nonaka break;
1015 1.1 nonaka DELAY(2);
1016 1.1 nonaka }
1017 1.1 nonaka if (ntries == 100)
1018 1.10.6.2 skrll return ETIMEDOUT;
1019 1.1 nonaka
1020 1.1 nonaka if ((tmp & RT3070_EFUSE_AOUT_MASK) == RT3070_EFUSE_AOUT_MASK) {
1021 1.1 nonaka *val = 0xffff; /* address not found */
1022 1.10.6.2 skrll return 0;
1023 1.1 nonaka }
1024 1.1 nonaka /* determine to which 32-bit register our 16-bit word belongs */
1025 1.1 nonaka reg = RT3070_EFUSE_DATA3 - (addr & 0xc);
1026 1.1 nonaka if ((error = run_read(sc, reg, &tmp)) != 0)
1027 1.10.6.2 skrll return error;
1028 1.1 nonaka
1029 1.1 nonaka *val = (addr & 2) ? tmp >> 16 : tmp & 0xffff;
1030 1.10.6.2 skrll return 0;
1031 1.1 nonaka }
1032 1.1 nonaka
1033 1.1 nonaka static int
1034 1.1 nonaka run_eeprom_read_2(struct run_softc *sc, uint16_t addr, uint16_t *val)
1035 1.1 nonaka {
1036 1.1 nonaka usb_device_request_t req;
1037 1.1 nonaka uint16_t tmp;
1038 1.1 nonaka int error;
1039 1.1 nonaka
1040 1.1 nonaka addr *= 2;
1041 1.1 nonaka req.bmRequestType = UT_READ_VENDOR_DEVICE;
1042 1.1 nonaka req.bRequest = RT2870_EEPROM_READ;
1043 1.1 nonaka USETW(req.wValue, 0);
1044 1.1 nonaka USETW(req.wIndex, addr);
1045 1.10.6.6 skrll USETW(req.wLength, sizeof(tmp));
1046 1.1 nonaka error = usbd_do_request(sc->sc_udev, &req, &tmp);
1047 1.1 nonaka if (error == 0)
1048 1.1 nonaka *val = le16toh(tmp);
1049 1.1 nonaka else
1050 1.1 nonaka *val = 0xffff;
1051 1.10.6.2 skrll return error;
1052 1.1 nonaka }
1053 1.1 nonaka
1054 1.1 nonaka static __inline int
1055 1.1 nonaka run_srom_read(struct run_softc *sc, uint16_t addr, uint16_t *val)
1056 1.1 nonaka {
1057 1.1 nonaka
1058 1.1 nonaka /* either eFUSE ROM or EEPROM */
1059 1.1 nonaka return sc->sc_srom_read(sc, addr, val);
1060 1.1 nonaka }
1061 1.1 nonaka
1062 1.1 nonaka static int
1063 1.1 nonaka run_rt2870_rf_write(struct run_softc *sc, uint8_t reg, uint32_t val)
1064 1.1 nonaka {
1065 1.1 nonaka uint32_t tmp;
1066 1.1 nonaka int error, ntries;
1067 1.1 nonaka
1068 1.1 nonaka for (ntries = 0; ntries < 10; ntries++) {
1069 1.1 nonaka if ((error = run_read(sc, RT2860_RF_CSR_CFG0, &tmp)) != 0)
1070 1.10.6.2 skrll return error;
1071 1.1 nonaka if (!(tmp & RT2860_RF_REG_CTRL))
1072 1.1 nonaka break;
1073 1.1 nonaka }
1074 1.1 nonaka if (ntries == 10)
1075 1.10.6.2 skrll return ETIMEDOUT;
1076 1.1 nonaka
1077 1.1 nonaka /* RF registers are 24-bit on the RT2860 */
1078 1.1 nonaka tmp = RT2860_RF_REG_CTRL | 24 << RT2860_RF_REG_WIDTH_SHIFT |
1079 1.1 nonaka (val & 0x3fffff) << 2 | (reg & 3);
1080 1.1 nonaka return run_write(sc, RT2860_RF_CSR_CFG0, tmp);
1081 1.1 nonaka }
1082 1.1 nonaka
1083 1.1 nonaka static int
1084 1.1 nonaka run_rt3070_rf_read(struct run_softc *sc, uint8_t reg, uint8_t *val)
1085 1.1 nonaka {
1086 1.1 nonaka uint32_t tmp;
1087 1.1 nonaka int error, ntries;
1088 1.1 nonaka
1089 1.1 nonaka for (ntries = 0; ntries < 100; ntries++) {
1090 1.1 nonaka if ((error = run_read(sc, RT3070_RF_CSR_CFG, &tmp)) != 0)
1091 1.10.6.2 skrll return error;
1092 1.1 nonaka if (!(tmp & RT3070_RF_KICK))
1093 1.1 nonaka break;
1094 1.1 nonaka }
1095 1.1 nonaka if (ntries == 100)
1096 1.10.6.2 skrll return ETIMEDOUT;
1097 1.1 nonaka
1098 1.1 nonaka tmp = RT3070_RF_KICK | reg << 8;
1099 1.1 nonaka if ((error = run_write(sc, RT3070_RF_CSR_CFG, tmp)) != 0)
1100 1.10.6.2 skrll return error;
1101 1.1 nonaka
1102 1.1 nonaka for (ntries = 0; ntries < 100; ntries++) {
1103 1.1 nonaka if ((error = run_read(sc, RT3070_RF_CSR_CFG, &tmp)) != 0)
1104 1.10.6.2 skrll return error;
1105 1.1 nonaka if (!(tmp & RT3070_RF_KICK))
1106 1.1 nonaka break;
1107 1.1 nonaka }
1108 1.1 nonaka if (ntries == 100)
1109 1.10.6.2 skrll return ETIMEDOUT;
1110 1.1 nonaka
1111 1.1 nonaka *val = tmp & 0xff;
1112 1.10.6.2 skrll return 0;
1113 1.1 nonaka }
1114 1.1 nonaka
1115 1.1 nonaka static int
1116 1.1 nonaka run_rt3070_rf_write(struct run_softc *sc, uint8_t reg, uint8_t val)
1117 1.1 nonaka {
1118 1.1 nonaka uint32_t tmp;
1119 1.1 nonaka int error, ntries;
1120 1.1 nonaka
1121 1.1 nonaka for (ntries = 0; ntries < 10; ntries++) {
1122 1.1 nonaka if ((error = run_read(sc, RT3070_RF_CSR_CFG, &tmp)) != 0)
1123 1.10.6.2 skrll return error;
1124 1.1 nonaka if (!(tmp & RT3070_RF_KICK))
1125 1.1 nonaka break;
1126 1.1 nonaka }
1127 1.1 nonaka if (ntries == 10)
1128 1.10.6.2 skrll return ETIMEDOUT;
1129 1.1 nonaka
1130 1.1 nonaka tmp = RT3070_RF_WRITE | RT3070_RF_KICK | reg << 8 | val;
1131 1.1 nonaka return run_write(sc, RT3070_RF_CSR_CFG, tmp);
1132 1.1 nonaka }
1133 1.1 nonaka
1134 1.1 nonaka static int
1135 1.1 nonaka run_bbp_read(struct run_softc *sc, uint8_t reg, uint8_t *val)
1136 1.1 nonaka {
1137 1.1 nonaka uint32_t tmp;
1138 1.1 nonaka int ntries, error;
1139 1.1 nonaka
1140 1.1 nonaka for (ntries = 0; ntries < 10; ntries++) {
1141 1.1 nonaka if ((error = run_read(sc, RT2860_BBP_CSR_CFG, &tmp)) != 0)
1142 1.10.6.2 skrll return error;
1143 1.1 nonaka if (!(tmp & RT2860_BBP_CSR_KICK))
1144 1.1 nonaka break;
1145 1.1 nonaka }
1146 1.1 nonaka if (ntries == 10)
1147 1.10.6.2 skrll return ETIMEDOUT;
1148 1.1 nonaka
1149 1.1 nonaka tmp = RT2860_BBP_CSR_READ | RT2860_BBP_CSR_KICK | reg << 8;
1150 1.1 nonaka if ((error = run_write(sc, RT2860_BBP_CSR_CFG, tmp)) != 0)
1151 1.10.6.2 skrll return error;
1152 1.1 nonaka
1153 1.1 nonaka for (ntries = 0; ntries < 10; ntries++) {
1154 1.1 nonaka if ((error = run_read(sc, RT2860_BBP_CSR_CFG, &tmp)) != 0)
1155 1.10.6.2 skrll return error;
1156 1.1 nonaka if (!(tmp & RT2860_BBP_CSR_KICK))
1157 1.1 nonaka break;
1158 1.1 nonaka }
1159 1.1 nonaka if (ntries == 10)
1160 1.10.6.2 skrll return ETIMEDOUT;
1161 1.1 nonaka
1162 1.1 nonaka *val = tmp & 0xff;
1163 1.10.6.2 skrll return 0;
1164 1.1 nonaka }
1165 1.1 nonaka
1166 1.1 nonaka static int
1167 1.1 nonaka run_bbp_write(struct run_softc *sc, uint8_t reg, uint8_t val)
1168 1.1 nonaka {
1169 1.1 nonaka uint32_t tmp;
1170 1.1 nonaka int ntries, error;
1171 1.1 nonaka
1172 1.1 nonaka for (ntries = 0; ntries < 10; ntries++) {
1173 1.1 nonaka if ((error = run_read(sc, RT2860_BBP_CSR_CFG, &tmp)) != 0)
1174 1.10.6.2 skrll return error;
1175 1.1 nonaka if (!(tmp & RT2860_BBP_CSR_KICK))
1176 1.1 nonaka break;
1177 1.1 nonaka }
1178 1.1 nonaka if (ntries == 10)
1179 1.10.6.2 skrll return ETIMEDOUT;
1180 1.1 nonaka
1181 1.1 nonaka tmp = RT2860_BBP_CSR_KICK | reg << 8 | val;
1182 1.1 nonaka return run_write(sc, RT2860_BBP_CSR_CFG, tmp);
1183 1.1 nonaka }
1184 1.1 nonaka
1185 1.1 nonaka /*
1186 1.1 nonaka * Send a command to the 8051 microcontroller unit.
1187 1.1 nonaka */
1188 1.1 nonaka static int
1189 1.1 nonaka run_mcu_cmd(struct run_softc *sc, uint8_t cmd, uint16_t arg)
1190 1.1 nonaka {
1191 1.1 nonaka uint32_t tmp;
1192 1.1 nonaka int error, ntries;
1193 1.1 nonaka
1194 1.1 nonaka for (ntries = 0; ntries < 100; ntries++) {
1195 1.1 nonaka if ((error = run_read(sc, RT2860_H2M_MAILBOX, &tmp)) != 0)
1196 1.10.6.2 skrll return error;
1197 1.1 nonaka if (!(tmp & RT2860_H2M_BUSY))
1198 1.1 nonaka break;
1199 1.1 nonaka }
1200 1.1 nonaka if (ntries == 100)
1201 1.10.6.2 skrll return ETIMEDOUT;
1202 1.1 nonaka
1203 1.1 nonaka tmp = RT2860_H2M_BUSY | RT2860_TOKEN_NO_INTR << 16 | arg;
1204 1.1 nonaka if ((error = run_write(sc, RT2860_H2M_MAILBOX, tmp)) == 0)
1205 1.1 nonaka error = run_write(sc, RT2860_HOST_CMD, cmd);
1206 1.10.6.2 skrll return error;
1207 1.1 nonaka }
1208 1.1 nonaka
1209 1.1 nonaka /*
1210 1.1 nonaka * Add `delta' (signed) to each 4-bit sub-word of a 32-bit word.
1211 1.1 nonaka * Used to adjust per-rate Tx power registers.
1212 1.1 nonaka */
1213 1.1 nonaka static __inline uint32_t
1214 1.1 nonaka b4inc(uint32_t b32, int8_t delta)
1215 1.1 nonaka {
1216 1.1 nonaka int8_t i, b4;
1217 1.1 nonaka
1218 1.1 nonaka for (i = 0; i < 8; i++) {
1219 1.1 nonaka b4 = b32 & 0xf;
1220 1.1 nonaka b4 += delta;
1221 1.1 nonaka if (b4 < 0)
1222 1.1 nonaka b4 = 0;
1223 1.1 nonaka else if (b4 > 0xf)
1224 1.1 nonaka b4 = 0xf;
1225 1.1 nonaka b32 = b32 >> 4 | b4 << 28;
1226 1.1 nonaka }
1227 1.10.6.2 skrll return b32;
1228 1.1 nonaka }
1229 1.1 nonaka
1230 1.1 nonaka static const char *
1231 1.1 nonaka run_get_rf(int rev)
1232 1.1 nonaka {
1233 1.1 nonaka switch (rev) {
1234 1.1 nonaka case RT2860_RF_2820: return "RT2820";
1235 1.1 nonaka case RT2860_RF_2850: return "RT2850";
1236 1.1 nonaka case RT2860_RF_2720: return "RT2720";
1237 1.1 nonaka case RT2860_RF_2750: return "RT2750";
1238 1.1 nonaka case RT3070_RF_3020: return "RT3020";
1239 1.1 nonaka case RT3070_RF_2020: return "RT2020";
1240 1.1 nonaka case RT3070_RF_3021: return "RT3021";
1241 1.1 nonaka case RT3070_RF_3022: return "RT3022";
1242 1.1 nonaka case RT3070_RF_3052: return "RT3052";
1243 1.1 nonaka }
1244 1.1 nonaka return "unknown";
1245 1.1 nonaka }
1246 1.1 nonaka
1247 1.1 nonaka static int
1248 1.1 nonaka run_read_eeprom(struct run_softc *sc)
1249 1.1 nonaka {
1250 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
1251 1.1 nonaka int8_t delta_2ghz, delta_5ghz;
1252 1.1 nonaka uint32_t tmp;
1253 1.1 nonaka uint16_t val;
1254 1.1 nonaka int ridx, ant, i;
1255 1.1 nonaka
1256 1.1 nonaka /* check whether the ROM is eFUSE ROM or EEPROM */
1257 1.1 nonaka sc->sc_srom_read = run_eeprom_read_2;
1258 1.1 nonaka if (sc->mac_ver >= 0x3070) {
1259 1.1 nonaka run_read(sc, RT3070_EFUSE_CTRL, &tmp);
1260 1.1 nonaka DPRINTF(("EFUSE_CTRL=0x%08x\n", tmp));
1261 1.1 nonaka if (tmp & RT3070_SEL_EFUSE)
1262 1.1 nonaka sc->sc_srom_read = run_efuse_read_2;
1263 1.1 nonaka }
1264 1.1 nonaka
1265 1.1 nonaka /* read ROM version */
1266 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_VERSION, &val);
1267 1.1 nonaka DPRINTF(("EEPROM rev=%d, FAE=%d\n", val & 0xff, val >> 8));
1268 1.1 nonaka
1269 1.1 nonaka /* read MAC address */
1270 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_MAC01, &val);
1271 1.1 nonaka ic->ic_myaddr[0] = val & 0xff;
1272 1.1 nonaka ic->ic_myaddr[1] = val >> 8;
1273 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_MAC23, &val);
1274 1.1 nonaka ic->ic_myaddr[2] = val & 0xff;
1275 1.1 nonaka ic->ic_myaddr[3] = val >> 8;
1276 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_MAC45, &val);
1277 1.1 nonaka ic->ic_myaddr[4] = val & 0xff;
1278 1.1 nonaka ic->ic_myaddr[5] = val >> 8;
1279 1.1 nonaka
1280 1.1 nonaka /* read vendor BBP settings */
1281 1.1 nonaka for (i = 0; i < 10; i++) {
1282 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_BBP_BASE + i, &val);
1283 1.1 nonaka sc->bbp[i].val = val & 0xff;
1284 1.1 nonaka sc->bbp[i].reg = val >> 8;
1285 1.1 nonaka DPRINTF(("BBP%d=0x%02x\n", sc->bbp[i].reg, sc->bbp[i].val));
1286 1.1 nonaka }
1287 1.1 nonaka if (sc->mac_ver >= 0x3071) {
1288 1.1 nonaka /* read vendor RF settings */
1289 1.1 nonaka for (i = 0; i < 10; i++) {
1290 1.1 nonaka run_srom_read(sc, RT3071_EEPROM_RF_BASE + i, &val);
1291 1.1 nonaka sc->rf[i].val = val & 0xff;
1292 1.1 nonaka sc->rf[i].reg = val >> 8;
1293 1.1 nonaka DPRINTF(("RF%d=0x%02x\n", sc->rf[i].reg,
1294 1.1 nonaka sc->rf[i].val));
1295 1.1 nonaka }
1296 1.1 nonaka }
1297 1.1 nonaka
1298 1.1 nonaka /* read RF frequency offset from EEPROM */
1299 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_FREQ_LEDS, &val);
1300 1.1 nonaka sc->freq = ((val & 0xff) != 0xff) ? val & 0xff : 0;
1301 1.1 nonaka DPRINTF(("EEPROM freq offset %d\n", sc->freq & 0xff));
1302 1.1 nonaka
1303 1.1 nonaka if ((val >> 8) != 0xff) {
1304 1.1 nonaka /* read LEDs operating mode */
1305 1.1 nonaka sc->leds = val >> 8;
1306 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_LED1, &sc->led[0]);
1307 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_LED2, &sc->led[1]);
1308 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_LED3, &sc->led[2]);
1309 1.1 nonaka } else {
1310 1.1 nonaka /* broken EEPROM, use default settings */
1311 1.1 nonaka sc->leds = 0x01;
1312 1.1 nonaka sc->led[0] = 0x5555;
1313 1.1 nonaka sc->led[1] = 0x2221;
1314 1.1 nonaka sc->led[2] = 0x5627; /* differs from RT2860 */
1315 1.1 nonaka }
1316 1.1 nonaka DPRINTF(("EEPROM LED mode=0x%02x, LEDs=0x%04x/0x%04x/0x%04x\n",
1317 1.1 nonaka sc->leds, sc->led[0], sc->led[1], sc->led[2]));
1318 1.1 nonaka
1319 1.1 nonaka /* read RF information */
1320 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_ANTENNA, &val);
1321 1.1 nonaka if (val == 0xffff) {
1322 1.1 nonaka DPRINTF(("invalid EEPROM antenna info, using default\n"));
1323 1.1 nonaka if (sc->mac_ver == 0x3572) {
1324 1.1 nonaka /* default to RF3052 2T2R */
1325 1.1 nonaka sc->rf_rev = RT3070_RF_3052;
1326 1.1 nonaka sc->ntxchains = 2;
1327 1.1 nonaka sc->nrxchains = 2;
1328 1.1 nonaka } else if (sc->mac_ver >= 0x3070) {
1329 1.1 nonaka /* default to RF3020 1T1R */
1330 1.1 nonaka sc->rf_rev = RT3070_RF_3020;
1331 1.1 nonaka sc->ntxchains = 1;
1332 1.1 nonaka sc->nrxchains = 1;
1333 1.1 nonaka } else {
1334 1.1 nonaka /* default to RF2820 1T2R */
1335 1.1 nonaka sc->rf_rev = RT2860_RF_2820;
1336 1.1 nonaka sc->ntxchains = 1;
1337 1.1 nonaka sc->nrxchains = 2;
1338 1.1 nonaka }
1339 1.1 nonaka } else {
1340 1.1 nonaka sc->rf_rev = (val >> 8) & 0xf;
1341 1.1 nonaka sc->ntxchains = (val >> 4) & 0xf;
1342 1.1 nonaka sc->nrxchains = val & 0xf;
1343 1.1 nonaka }
1344 1.1 nonaka DPRINTF(("EEPROM RF rev=0x%02x chains=%dT%dR\n",
1345 1.1 nonaka sc->rf_rev, sc->ntxchains, sc->nrxchains));
1346 1.1 nonaka
1347 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_CONFIG, &val);
1348 1.1 nonaka DPRINTF(("EEPROM CFG 0x%04x\n", val));
1349 1.1 nonaka /* check if driver should patch the DAC issue */
1350 1.1 nonaka if ((val >> 8) != 0xff)
1351 1.1 nonaka sc->patch_dac = (val >> 15) & 1;
1352 1.1 nonaka if ((val & 0xff) != 0xff) {
1353 1.1 nonaka sc->ext_5ghz_lna = (val >> 3) & 1;
1354 1.1 nonaka sc->ext_2ghz_lna = (val >> 2) & 1;
1355 1.1 nonaka /* check if RF supports automatic Tx access gain control */
1356 1.1 nonaka sc->calib_2ghz = sc->calib_5ghz = (val >> 1) & 1;
1357 1.1 nonaka /* check if we have a hardware radio switch */
1358 1.1 nonaka sc->rfswitch = val & 1;
1359 1.1 nonaka }
1360 1.1 nonaka
1361 1.1 nonaka /* read power settings for 2GHz channels */
1362 1.1 nonaka for (i = 0; i < 14; i += 2) {
1363 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_PWR2GHZ_BASE1 + i / 2, &val);
1364 1.1 nonaka sc->txpow1[i + 0] = (int8_t)(val & 0xff);
1365 1.1 nonaka sc->txpow1[i + 1] = (int8_t)(val >> 8);
1366 1.1 nonaka
1367 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_PWR2GHZ_BASE2 + i / 2, &val);
1368 1.1 nonaka sc->txpow2[i + 0] = (int8_t)(val & 0xff);
1369 1.1 nonaka sc->txpow2[i + 1] = (int8_t)(val >> 8);
1370 1.1 nonaka }
1371 1.1 nonaka /* fix broken Tx power entries */
1372 1.1 nonaka for (i = 0; i < 14; i++) {
1373 1.1 nonaka if (sc->txpow1[i] < 0 || sc->txpow1[i] > 31)
1374 1.1 nonaka sc->txpow1[i] = 5;
1375 1.1 nonaka if (sc->txpow2[i] < 0 || sc->txpow2[i] > 31)
1376 1.1 nonaka sc->txpow2[i] = 5;
1377 1.1 nonaka DPRINTF(("chan %d: power1=%d, power2=%d\n",
1378 1.1 nonaka rt2860_rf2850[i].chan, sc->txpow1[i], sc->txpow2[i]));
1379 1.1 nonaka }
1380 1.1 nonaka /* read power settings for 5GHz channels */
1381 1.1 nonaka for (i = 0; i < 40; i += 2) {
1382 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_PWR5GHZ_BASE1 + i / 2, &val);
1383 1.1 nonaka sc->txpow1[i + 14] = (int8_t)(val & 0xff);
1384 1.1 nonaka sc->txpow1[i + 15] = (int8_t)(val >> 8);
1385 1.1 nonaka
1386 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_PWR5GHZ_BASE2 + i / 2, &val);
1387 1.1 nonaka sc->txpow2[i + 14] = (int8_t)(val & 0xff);
1388 1.1 nonaka sc->txpow2[i + 15] = (int8_t)(val >> 8);
1389 1.1 nonaka }
1390 1.1 nonaka /* fix broken Tx power entries */
1391 1.1 nonaka for (i = 0; i < 40; i++) {
1392 1.1 nonaka if (sc->txpow1[14 + i] < -7 || sc->txpow1[14 + i] > 15)
1393 1.1 nonaka sc->txpow1[14 + i] = 5;
1394 1.1 nonaka if (sc->txpow2[14 + i] < -7 || sc->txpow2[14 + i] > 15)
1395 1.1 nonaka sc->txpow2[14 + i] = 5;
1396 1.1 nonaka DPRINTF(("chan %d: power1=%d, power2=%d\n",
1397 1.1 nonaka rt2860_rf2850[14 + i].chan, sc->txpow1[14 + i],
1398 1.1 nonaka sc->txpow2[14 + i]));
1399 1.1 nonaka }
1400 1.1 nonaka
1401 1.1 nonaka /* read Tx power compensation for each Tx rate */
1402 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_DELTAPWR, &val);
1403 1.1 nonaka delta_2ghz = delta_5ghz = 0;
1404 1.1 nonaka if ((val & 0xff) != 0xff && (val & 0x80)) {
1405 1.1 nonaka delta_2ghz = val & 0xf;
1406 1.1 nonaka if (!(val & 0x40)) /* negative number */
1407 1.1 nonaka delta_2ghz = -delta_2ghz;
1408 1.1 nonaka }
1409 1.1 nonaka val >>= 8;
1410 1.1 nonaka if ((val & 0xff) != 0xff && (val & 0x80)) {
1411 1.1 nonaka delta_5ghz = val & 0xf;
1412 1.1 nonaka if (!(val & 0x40)) /* negative number */
1413 1.1 nonaka delta_5ghz = -delta_5ghz;
1414 1.1 nonaka }
1415 1.1 nonaka DPRINTF(("power compensation=%d (2GHz), %d (5GHz)\n",
1416 1.1 nonaka delta_2ghz, delta_5ghz));
1417 1.1 nonaka
1418 1.1 nonaka for (ridx = 0; ridx < 5; ridx++) {
1419 1.1 nonaka uint32_t reg;
1420 1.1 nonaka
1421 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_RPWR + ridx * 2, &val);
1422 1.1 nonaka reg = val;
1423 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_RPWR + ridx * 2 + 1, &val);
1424 1.1 nonaka reg |= (uint32_t)val << 16;
1425 1.1 nonaka
1426 1.1 nonaka sc->txpow20mhz[ridx] = reg;
1427 1.1 nonaka sc->txpow40mhz_2ghz[ridx] = b4inc(reg, delta_2ghz);
1428 1.1 nonaka sc->txpow40mhz_5ghz[ridx] = b4inc(reg, delta_5ghz);
1429 1.1 nonaka
1430 1.1 nonaka DPRINTF(("ridx %d: power 20MHz=0x%08x, 40MHz/2GHz=0x%08x, "
1431 1.1 nonaka "40MHz/5GHz=0x%08x\n", ridx, sc->txpow20mhz[ridx],
1432 1.1 nonaka sc->txpow40mhz_2ghz[ridx], sc->txpow40mhz_5ghz[ridx]));
1433 1.1 nonaka }
1434 1.1 nonaka
1435 1.1 nonaka /* read RSSI offsets and LNA gains from EEPROM */
1436 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_RSSI1_2GHZ, &val);
1437 1.1 nonaka sc->rssi_2ghz[0] = val & 0xff; /* Ant A */
1438 1.1 nonaka sc->rssi_2ghz[1] = val >> 8; /* Ant B */
1439 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_RSSI2_2GHZ, &val);
1440 1.1 nonaka if (sc->mac_ver >= 0x3070) {
1441 1.1 nonaka /*
1442 1.1 nonaka * On RT3070 chips (limited to 2 Rx chains), this ROM
1443 1.1 nonaka * field contains the Tx mixer gain for the 2GHz band.
1444 1.1 nonaka */
1445 1.1 nonaka if ((val & 0xff) != 0xff)
1446 1.1 nonaka sc->txmixgain_2ghz = val & 0x7;
1447 1.1 nonaka DPRINTF(("tx mixer gain=%u (2GHz)\n", sc->txmixgain_2ghz));
1448 1.1 nonaka } else {
1449 1.1 nonaka sc->rssi_2ghz[2] = val & 0xff; /* Ant C */
1450 1.1 nonaka }
1451 1.1 nonaka sc->lna[2] = val >> 8; /* channel group 2 */
1452 1.1 nonaka
1453 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_RSSI1_5GHZ, &val);
1454 1.1 nonaka sc->rssi_5ghz[0] = val & 0xff; /* Ant A */
1455 1.1 nonaka sc->rssi_5ghz[1] = val >> 8; /* Ant B */
1456 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_RSSI2_5GHZ, &val);
1457 1.1 nonaka if (sc->mac_ver == 0x3572) {
1458 1.1 nonaka /*
1459 1.1 nonaka * On RT3572 chips (limited to 2 Rx chains), this ROM
1460 1.1 nonaka * field contains the Tx mixer gain for the 5GHz band.
1461 1.1 nonaka */
1462 1.1 nonaka if ((val & 0xff) != 0xff)
1463 1.1 nonaka sc->txmixgain_5ghz = val & 0x7;
1464 1.1 nonaka DPRINTF(("tx mixer gain=%u (5GHz)\n", sc->txmixgain_5ghz));
1465 1.1 nonaka } else {
1466 1.1 nonaka sc->rssi_5ghz[2] = val & 0xff; /* Ant C */
1467 1.1 nonaka }
1468 1.1 nonaka sc->lna[3] = val >> 8; /* channel group 3 */
1469 1.1 nonaka
1470 1.1 nonaka run_srom_read(sc, RT2860_EEPROM_LNA, &val);
1471 1.1 nonaka sc->lna[0] = val & 0xff; /* channel group 0 */
1472 1.1 nonaka sc->lna[1] = val >> 8; /* channel group 1 */
1473 1.1 nonaka
1474 1.1 nonaka /* fix broken 5GHz LNA entries */
1475 1.1 nonaka if (sc->lna[2] == 0 || sc->lna[2] == 0xff) {
1476 1.1 nonaka DPRINTF(("invalid LNA for channel group %d\n", 2));
1477 1.1 nonaka sc->lna[2] = sc->lna[1];
1478 1.1 nonaka }
1479 1.1 nonaka if (sc->lna[3] == 0 || sc->lna[3] == 0xff) {
1480 1.1 nonaka DPRINTF(("invalid LNA for channel group %d\n", 3));
1481 1.1 nonaka sc->lna[3] = sc->lna[1];
1482 1.1 nonaka }
1483 1.1 nonaka
1484 1.1 nonaka /* fix broken RSSI offset entries */
1485 1.1 nonaka for (ant = 0; ant < 3; ant++) {
1486 1.1 nonaka if (sc->rssi_2ghz[ant] < -10 || sc->rssi_2ghz[ant] > 10) {
1487 1.1 nonaka DPRINTF(("invalid RSSI%d offset: %d (2GHz)\n",
1488 1.1 nonaka ant + 1, sc->rssi_2ghz[ant]));
1489 1.1 nonaka sc->rssi_2ghz[ant] = 0;
1490 1.1 nonaka }
1491 1.1 nonaka if (sc->rssi_5ghz[ant] < -10 || sc->rssi_5ghz[ant] > 10) {
1492 1.1 nonaka DPRINTF(("invalid RSSI%d offset: %d (5GHz)\n",
1493 1.1 nonaka ant + 1, sc->rssi_5ghz[ant]));
1494 1.1 nonaka sc->rssi_5ghz[ant] = 0;
1495 1.1 nonaka }
1496 1.1 nonaka }
1497 1.10.6.2 skrll return 0;
1498 1.1 nonaka }
1499 1.1 nonaka
1500 1.1 nonaka static struct ieee80211_node *
1501 1.1 nonaka run_node_alloc(struct ieee80211_node_table *nt)
1502 1.1 nonaka {
1503 1.1 nonaka struct run_node *rn =
1504 1.10.6.6 skrll malloc(sizeof(struct run_node), M_DEVBUF, M_NOWAIT | M_ZERO);
1505 1.10.6.2 skrll return rn ? &rn->ni : NULL;
1506 1.1 nonaka }
1507 1.1 nonaka
1508 1.1 nonaka static int
1509 1.1 nonaka run_media_change(struct ifnet *ifp)
1510 1.1 nonaka {
1511 1.1 nonaka struct run_softc *sc = ifp->if_softc;
1512 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
1513 1.1 nonaka uint8_t rate, ridx;
1514 1.1 nonaka int error;
1515 1.1 nonaka
1516 1.1 nonaka error = ieee80211_media_change(ifp);
1517 1.1 nonaka if (error != ENETRESET)
1518 1.10.6.2 skrll return error;
1519 1.1 nonaka
1520 1.1 nonaka if (ic->ic_fixed_rate != IEEE80211_FIXED_RATE_NONE) {
1521 1.1 nonaka rate = ic->ic_sup_rates[ic->ic_curmode].
1522 1.1 nonaka rs_rates[ic->ic_fixed_rate] & IEEE80211_RATE_VAL;
1523 1.1 nonaka for (ridx = 0; ridx <= RT2860_RIDX_MAX; ridx++)
1524 1.1 nonaka if (rt2860_rates[ridx].rate == rate)
1525 1.1 nonaka break;
1526 1.1 nonaka sc->fixed_ridx = ridx;
1527 1.1 nonaka }
1528 1.1 nonaka
1529 1.1 nonaka if ((ifp->if_flags & (IFF_UP | IFF_RUNNING)) == (IFF_UP | IFF_RUNNING))
1530 1.1 nonaka run_init(ifp);
1531 1.1 nonaka
1532 1.10.6.2 skrll return 0;
1533 1.1 nonaka }
1534 1.1 nonaka
1535 1.1 nonaka static void
1536 1.1 nonaka run_next_scan(void *arg)
1537 1.1 nonaka {
1538 1.1 nonaka struct run_softc *sc = arg;
1539 1.1 nonaka
1540 1.1 nonaka if (sc->sc_ic.ic_state == IEEE80211_S_SCAN)
1541 1.1 nonaka ieee80211_next_scan(&sc->sc_ic);
1542 1.1 nonaka }
1543 1.1 nonaka
1544 1.1 nonaka static void
1545 1.1 nonaka run_task(void *arg)
1546 1.1 nonaka {
1547 1.1 nonaka struct run_softc *sc = arg;
1548 1.1 nonaka struct run_host_cmd_ring *ring = &sc->cmdq;
1549 1.1 nonaka struct run_host_cmd *cmd;
1550 1.1 nonaka int s;
1551 1.1 nonaka
1552 1.1 nonaka /* process host commands */
1553 1.1 nonaka s = splusb();
1554 1.1 nonaka while (ring->next != ring->cur) {
1555 1.1 nonaka cmd = &ring->cmd[ring->next];
1556 1.1 nonaka splx(s);
1557 1.1 nonaka /* callback */
1558 1.1 nonaka cmd->cb(sc, cmd->data);
1559 1.1 nonaka s = splusb();
1560 1.1 nonaka ring->queued--;
1561 1.1 nonaka ring->next = (ring->next + 1) % RUN_HOST_CMD_RING_COUNT;
1562 1.1 nonaka }
1563 1.1 nonaka wakeup(ring);
1564 1.1 nonaka splx(s);
1565 1.1 nonaka }
1566 1.1 nonaka
1567 1.1 nonaka static void
1568 1.1 nonaka run_do_async(struct run_softc *sc, void (*cb)(struct run_softc *, void *),
1569 1.1 nonaka void *arg, int len)
1570 1.1 nonaka {
1571 1.1 nonaka struct run_host_cmd_ring *ring = &sc->cmdq;
1572 1.1 nonaka struct run_host_cmd *cmd;
1573 1.1 nonaka int s;
1574 1.1 nonaka
1575 1.1 nonaka if (sc->sc_flags & RUN_DETACHING)
1576 1.1 nonaka return;
1577 1.1 nonaka
1578 1.1 nonaka s = splusb();
1579 1.1 nonaka cmd = &ring->cmd[ring->cur];
1580 1.1 nonaka cmd->cb = cb;
1581 1.10.6.6 skrll KASSERT(len <= sizeof(cmd->data));
1582 1.1 nonaka memcpy(cmd->data, arg, len);
1583 1.1 nonaka ring->cur = (ring->cur + 1) % RUN_HOST_CMD_RING_COUNT;
1584 1.1 nonaka
1585 1.1 nonaka /* if there is no pending command already, schedule a task */
1586 1.1 nonaka if (++ring->queued == 1)
1587 1.1 nonaka usb_add_task(sc->sc_udev, &sc->sc_task, USB_TASKQ_DRIVER);
1588 1.1 nonaka splx(s);
1589 1.1 nonaka }
1590 1.1 nonaka
1591 1.1 nonaka static int
1592 1.1 nonaka run_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg)
1593 1.1 nonaka {
1594 1.1 nonaka struct run_softc *sc = ic->ic_ifp->if_softc;
1595 1.1 nonaka struct run_cmd_newstate cmd;
1596 1.1 nonaka
1597 1.1 nonaka callout_stop(&sc->scan_to);
1598 1.1 nonaka callout_stop(&sc->calib_to);
1599 1.1 nonaka
1600 1.1 nonaka /* do it in a process context */
1601 1.1 nonaka cmd.state = nstate;
1602 1.1 nonaka cmd.arg = arg;
1603 1.10.6.6 skrll run_do_async(sc, run_newstate_cb, &cmd, sizeof(cmd));
1604 1.10.6.2 skrll return 0;
1605 1.1 nonaka }
1606 1.1 nonaka
1607 1.1 nonaka static void
1608 1.1 nonaka run_newstate_cb(struct run_softc *sc, void *arg)
1609 1.1 nonaka {
1610 1.1 nonaka struct run_cmd_newstate *cmd = arg;
1611 1.1 nonaka struct ifnet *ifp = &sc->sc_if;
1612 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
1613 1.1 nonaka enum ieee80211_state ostate;
1614 1.1 nonaka struct ieee80211_node *ni;
1615 1.1 nonaka uint32_t tmp, sta[3];
1616 1.1 nonaka uint8_t wcid;
1617 1.1 nonaka int s;
1618 1.1 nonaka
1619 1.1 nonaka s = splnet();
1620 1.1 nonaka ostate = ic->ic_state;
1621 1.1 nonaka
1622 1.1 nonaka if (ostate == IEEE80211_S_RUN) {
1623 1.1 nonaka /* turn link LED off */
1624 1.1 nonaka run_set_leds(sc, RT2860_LED_RADIO);
1625 1.1 nonaka }
1626 1.1 nonaka
1627 1.1 nonaka switch (cmd->state) {
1628 1.1 nonaka case IEEE80211_S_INIT:
1629 1.1 nonaka if (ostate == IEEE80211_S_RUN) {
1630 1.1 nonaka /* abort TSF synchronization */
1631 1.1 nonaka run_read(sc, RT2860_BCN_TIME_CFG, &tmp);
1632 1.1 nonaka run_write(sc, RT2860_BCN_TIME_CFG,
1633 1.1 nonaka tmp & ~(RT2860_BCN_TX_EN | RT2860_TSF_TIMER_EN |
1634 1.1 nonaka RT2860_TBTT_TIMER_EN));
1635 1.1 nonaka }
1636 1.1 nonaka break;
1637 1.1 nonaka
1638 1.1 nonaka case IEEE80211_S_SCAN:
1639 1.1 nonaka run_set_chan(sc, ic->ic_curchan);
1640 1.1 nonaka callout_schedule(&sc->scan_to, hz / 5);
1641 1.1 nonaka break;
1642 1.1 nonaka
1643 1.1 nonaka case IEEE80211_S_AUTH:
1644 1.1 nonaka case IEEE80211_S_ASSOC:
1645 1.1 nonaka run_set_chan(sc, ic->ic_curchan);
1646 1.1 nonaka break;
1647 1.1 nonaka
1648 1.1 nonaka case IEEE80211_S_RUN:
1649 1.1 nonaka run_set_chan(sc, ic->ic_curchan);
1650 1.1 nonaka
1651 1.1 nonaka ni = ic->ic_bss;
1652 1.1 nonaka
1653 1.1 nonaka if (ic->ic_opmode != IEEE80211_M_MONITOR) {
1654 1.1 nonaka run_updateslot(ifp);
1655 1.1 nonaka run_enable_mrr(sc);
1656 1.1 nonaka run_set_txpreamble(sc);
1657 1.1 nonaka run_set_basicrates(sc);
1658 1.1 nonaka run_set_bssid(sc, ni->ni_bssid);
1659 1.1 nonaka }
1660 1.1 nonaka #ifndef IEEE80211_STA_ONLY
1661 1.1 nonaka if (ic->ic_opmode == IEEE80211_M_HOSTAP ||
1662 1.1 nonaka ic->ic_opmode == IEEE80211_M_IBSS)
1663 1.1 nonaka (void)run_setup_beacon(sc);
1664 1.1 nonaka #endif
1665 1.1 nonaka if (ic->ic_opmode == IEEE80211_M_STA) {
1666 1.1 nonaka /* add BSS entry to the WCID table */
1667 1.1 nonaka wcid = RUN_AID2WCID(ni->ni_associd);
1668 1.1 nonaka run_write_region_1(sc, RT2860_WCID_ENTRY(wcid),
1669 1.1 nonaka ni->ni_macaddr, IEEE80211_ADDR_LEN);
1670 1.1 nonaka
1671 1.1 nonaka /* fake a join to init the tx rate */
1672 1.1 nonaka run_newassoc(ni, 1);
1673 1.1 nonaka }
1674 1.1 nonaka if (ic->ic_opmode != IEEE80211_M_MONITOR) {
1675 1.1 nonaka run_enable_tsf_sync(sc);
1676 1.1 nonaka
1677 1.1 nonaka /* clear statistic registers used by AMRR */
1678 1.1 nonaka run_read_region_1(sc, RT2860_TX_STA_CNT0,
1679 1.10.6.6 skrll (uint8_t *)sta, sizeof(sta));
1680 1.1 nonaka /* start calibration timer */
1681 1.1 nonaka callout_schedule(&sc->calib_to, hz);
1682 1.1 nonaka }
1683 1.1 nonaka
1684 1.1 nonaka /* turn link LED on */
1685 1.1 nonaka run_set_leds(sc, RT2860_LED_RADIO |
1686 1.1 nonaka (IEEE80211_IS_CHAN_2GHZ(ic->ic_curchan) ?
1687 1.1 nonaka RT2860_LED_LINK_2GHZ : RT2860_LED_LINK_5GHZ));
1688 1.1 nonaka break;
1689 1.1 nonaka }
1690 1.1 nonaka (void)sc->sc_newstate(ic, cmd->state, cmd->arg);
1691 1.1 nonaka splx(s);
1692 1.1 nonaka }
1693 1.1 nonaka
1694 1.1 nonaka static int
1695 1.1 nonaka run_updateedca(struct ieee80211com *ic)
1696 1.1 nonaka {
1697 1.1 nonaka
1698 1.1 nonaka /* do it in a process context */
1699 1.1 nonaka run_do_async(ic->ic_ifp->if_softc, run_updateedca_cb, NULL, 0);
1700 1.10.6.2 skrll return 0;
1701 1.1 nonaka }
1702 1.1 nonaka
1703 1.1 nonaka /* ARGSUSED */
1704 1.1 nonaka static void
1705 1.1 nonaka run_updateedca_cb(struct run_softc *sc, void *arg)
1706 1.1 nonaka {
1707 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
1708 1.1 nonaka int s, aci;
1709 1.1 nonaka
1710 1.1 nonaka s = splnet();
1711 1.1 nonaka /* update MAC TX configuration registers */
1712 1.1 nonaka for (aci = 0; aci < WME_NUM_AC; aci++) {
1713 1.1 nonaka run_write(sc, RT2860_EDCA_AC_CFG(aci),
1714 1.1 nonaka ic->ic_wme.wme_params[aci].wmep_logcwmax << 16 |
1715 1.1 nonaka ic->ic_wme.wme_params[aci].wmep_logcwmin << 12 |
1716 1.1 nonaka ic->ic_wme.wme_params[aci].wmep_aifsn << 8 |
1717 1.1 nonaka ic->ic_wme.wme_params[aci].wmep_txopLimit);
1718 1.1 nonaka }
1719 1.1 nonaka
1720 1.1 nonaka /* update SCH/DMA registers too */
1721 1.1 nonaka run_write(sc, RT2860_WMM_AIFSN_CFG,
1722 1.1 nonaka ic->ic_wme.wme_params[WME_AC_VO].wmep_aifsn << 12 |
1723 1.1 nonaka ic->ic_wme.wme_params[WME_AC_VI].wmep_aifsn << 8 |
1724 1.1 nonaka ic->ic_wme.wme_params[WME_AC_BK].wmep_aifsn << 4 |
1725 1.1 nonaka ic->ic_wme.wme_params[WME_AC_BE].wmep_aifsn);
1726 1.1 nonaka run_write(sc, RT2860_WMM_CWMIN_CFG,
1727 1.1 nonaka ic->ic_wme.wme_params[WME_AC_VO].wmep_logcwmin << 12 |
1728 1.1 nonaka ic->ic_wme.wme_params[WME_AC_VI].wmep_logcwmin << 8 |
1729 1.1 nonaka ic->ic_wme.wme_params[WME_AC_BK].wmep_logcwmin << 4 |
1730 1.1 nonaka ic->ic_wme.wme_params[WME_AC_BE].wmep_logcwmin);
1731 1.1 nonaka run_write(sc, RT2860_WMM_CWMAX_CFG,
1732 1.1 nonaka ic->ic_wme.wme_params[WME_AC_VO].wmep_logcwmax << 12 |
1733 1.1 nonaka ic->ic_wme.wme_params[WME_AC_VI].wmep_logcwmax << 8 |
1734 1.1 nonaka ic->ic_wme.wme_params[WME_AC_BK].wmep_logcwmax << 4 |
1735 1.1 nonaka ic->ic_wme.wme_params[WME_AC_BE].wmep_logcwmax);
1736 1.1 nonaka run_write(sc, RT2860_WMM_TXOP0_CFG,
1737 1.1 nonaka ic->ic_wme.wme_params[WME_AC_BK].wmep_txopLimit << 16 |
1738 1.1 nonaka ic->ic_wme.wme_params[WME_AC_BE].wmep_txopLimit);
1739 1.1 nonaka run_write(sc, RT2860_WMM_TXOP1_CFG,
1740 1.1 nonaka ic->ic_wme.wme_params[WME_AC_VO].wmep_txopLimit << 16 |
1741 1.1 nonaka ic->ic_wme.wme_params[WME_AC_VI].wmep_txopLimit);
1742 1.1 nonaka splx(s);
1743 1.1 nonaka }
1744 1.1 nonaka
1745 1.1 nonaka #ifdef RUN_HWCRYPTO
1746 1.1 nonaka static int
1747 1.1 nonaka run_set_key(struct ieee80211com *ic, const struct ieee80211_key *k,
1748 1.1 nonaka const uint8_t *mac)
1749 1.1 nonaka {
1750 1.1 nonaka struct run_softc *sc = ic->ic_ifp->if_softc;
1751 1.1 nonaka struct ieee80211_node *ni = ic->ic_bss;
1752 1.1 nonaka struct run_cmd_key cmd;
1753 1.1 nonaka
1754 1.1 nonaka /* do it in a process context */
1755 1.1 nonaka cmd.key = *k;
1756 1.1 nonaka cmd.associd = (ni != NULL) ? ni->ni_associd : 0;
1757 1.10.6.6 skrll run_do_async(sc, run_set_key_cb, &cmd, sizeof(cmd));
1758 1.1 nonaka return 1;
1759 1.1 nonaka }
1760 1.1 nonaka
1761 1.1 nonaka static void
1762 1.1 nonaka run_set_key_cb(struct run_softc *sc, void *arg)
1763 1.1 nonaka {
1764 1.1 nonaka #ifndef IEEE80211_STA_ONLY
1765 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
1766 1.1 nonaka #endif
1767 1.1 nonaka struct run_cmd_key *cmd = arg;
1768 1.1 nonaka struct ieee80211_key *k = &cmd->key;
1769 1.1 nonaka uint32_t attr;
1770 1.1 nonaka uint16_t base;
1771 1.1 nonaka uint8_t mode, wcid, iv[8];
1772 1.1 nonaka
1773 1.1 nonaka /* map net80211 cipher to RT2860 security mode */
1774 1.1 nonaka switch (k->wk_cipher->ic_cipher) {
1775 1.1 nonaka case IEEE80211_CIPHER_WEP:
1776 1.1 nonaka k->wk_flags |= IEEE80211_KEY_GROUP; /* XXX */
1777 1.1 nonaka if (k->wk_keylen == 5)
1778 1.1 nonaka mode = RT2860_MODE_WEP40;
1779 1.1 nonaka else
1780 1.1 nonaka mode = RT2860_MODE_WEP104;
1781 1.1 nonaka break;
1782 1.1 nonaka case IEEE80211_CIPHER_TKIP:
1783 1.1 nonaka mode = RT2860_MODE_TKIP;
1784 1.1 nonaka break;
1785 1.1 nonaka case IEEE80211_CIPHER_AES_CCM:
1786 1.1 nonaka mode = RT2860_MODE_AES_CCMP;
1787 1.1 nonaka break;
1788 1.1 nonaka default:
1789 1.1 nonaka return;
1790 1.1 nonaka }
1791 1.1 nonaka
1792 1.1 nonaka if (k->wk_flags & IEEE80211_KEY_GROUP) {
1793 1.1 nonaka wcid = 0; /* NB: update WCID0 for group keys */
1794 1.1 nonaka base = RT2860_SKEY(0, k->wk_keyix);
1795 1.1 nonaka } else {
1796 1.1 nonaka wcid = RUN_AID2WCID(cmd->associd);
1797 1.1 nonaka base = RT2860_PKEY(wcid);
1798 1.1 nonaka }
1799 1.1 nonaka
1800 1.1 nonaka if (k->wk_cipher->ic_cipher == IEEE80211_CIPHER_TKIP) {
1801 1.1 nonaka run_write_region_1(sc, base, k->wk_key, 16);
1802 1.1 nonaka #ifndef IEEE80211_STA_ONLY
1803 1.1 nonaka if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
1804 1.1 nonaka run_write_region_1(sc, base + 16, &k->wk_key[16], 8);
1805 1.1 nonaka run_write_region_1(sc, base + 24, &k->wk_key[24], 8);
1806 1.1 nonaka } else
1807 1.1 nonaka #endif
1808 1.1 nonaka {
1809 1.1 nonaka run_write_region_1(sc, base + 16, &k->wk_key[24], 8);
1810 1.1 nonaka run_write_region_1(sc, base + 24, &k->wk_key[16], 8);
1811 1.1 nonaka }
1812 1.1 nonaka } else {
1813 1.1 nonaka /* roundup len to 16-bit: XXX fix write_region_1() instead */
1814 1.1 nonaka run_write_region_1(sc, base, k->wk_key,
1815 1.1 nonaka (k->wk_keylen + 1) & ~1);
1816 1.1 nonaka }
1817 1.1 nonaka
1818 1.1 nonaka if (!(k->wk_flags & IEEE80211_KEY_GROUP) ||
1819 1.1 nonaka (k->wk_flags & IEEE80211_KEY_XMIT)) {
1820 1.1 nonaka /* set initial packet number in IV+EIV */
1821 1.1 nonaka if (k->wk_cipher->ic_cipher == IEEE80211_CIPHER_WEP) {
1822 1.10.6.6 skrll memset(iv, 0, sizeof(iv));
1823 1.1 nonaka iv[3] = sc->sc_ic.ic_crypto.cs_def_txkey << 6;
1824 1.1 nonaka } else {
1825 1.1 nonaka if (k->wk_cipher->ic_cipher == IEEE80211_CIPHER_TKIP) {
1826 1.1 nonaka iv[0] = k->wk_keytsc >> 8;
1827 1.1 nonaka iv[1] = (iv[0] | 0x20) & 0x7f;
1828 1.1 nonaka iv[2] = k->wk_keytsc;
1829 1.1 nonaka } else /* CCMP */ {
1830 1.1 nonaka iv[0] = k->wk_keytsc;
1831 1.1 nonaka iv[1] = k->wk_keytsc >> 8;
1832 1.1 nonaka iv[2] = 0;
1833 1.1 nonaka }
1834 1.1 nonaka iv[3] = k->wk_keyix << 6 | IEEE80211_WEP_EXTIV;
1835 1.1 nonaka iv[4] = k->wk_keytsc >> 16;
1836 1.1 nonaka iv[5] = k->wk_keytsc >> 24;
1837 1.1 nonaka iv[6] = k->wk_keytsc >> 32;
1838 1.1 nonaka iv[7] = k->wk_keytsc >> 40;
1839 1.1 nonaka }
1840 1.1 nonaka run_write_region_1(sc, RT2860_IVEIV(wcid), iv, 8);
1841 1.1 nonaka }
1842 1.1 nonaka
1843 1.1 nonaka if (k->wk_flags & IEEE80211_KEY_GROUP) {
1844 1.1 nonaka /* install group key */
1845 1.1 nonaka run_read(sc, RT2860_SKEY_MODE_0_7, &attr);
1846 1.1 nonaka attr &= ~(0xf << (k->wk_keyix * 4));
1847 1.1 nonaka attr |= mode << (k->wk_keyix * 4);
1848 1.1 nonaka run_write(sc, RT2860_SKEY_MODE_0_7, attr);
1849 1.1 nonaka } else {
1850 1.1 nonaka /* install pairwise key */
1851 1.1 nonaka run_read(sc, RT2860_WCID_ATTR(wcid), &attr);
1852 1.1 nonaka attr = (attr & ~0xf) | (mode << 1) | RT2860_RX_PKEY_EN;
1853 1.1 nonaka run_write(sc, RT2860_WCID_ATTR(wcid), attr);
1854 1.1 nonaka }
1855 1.1 nonaka }
1856 1.1 nonaka
1857 1.1 nonaka static int
1858 1.1 nonaka run_delete_key(struct ieee80211com *ic, const struct ieee80211_key *k)
1859 1.1 nonaka {
1860 1.1 nonaka struct run_softc *sc = ic->ic_ifp->if_softc;
1861 1.1 nonaka struct ieee80211_node *ni = ic->ic_bss;
1862 1.1 nonaka struct run_cmd_key cmd;
1863 1.1 nonaka
1864 1.1 nonaka /* do it in a process context */
1865 1.1 nonaka cmd.key = *k;
1866 1.1 nonaka cmd.associd = (ni != NULL) ? ni->ni_associd : 0;
1867 1.10.6.6 skrll run_do_async(sc, run_delete_key_cb, &cmd, sizeof(cmd));
1868 1.1 nonaka return 1;
1869 1.1 nonaka }
1870 1.1 nonaka
1871 1.1 nonaka static void
1872 1.1 nonaka run_delete_key_cb(struct run_softc *sc, void *arg)
1873 1.1 nonaka {
1874 1.1 nonaka struct run_cmd_key *cmd = arg;
1875 1.1 nonaka struct ieee80211_key *k = &cmd->key;
1876 1.1 nonaka uint32_t attr;
1877 1.1 nonaka uint8_t wcid;
1878 1.1 nonaka
1879 1.1 nonaka if (k->wk_cipher->ic_cipher == IEEE80211_CIPHER_WEP)
1880 1.1 nonaka k->wk_flags |= IEEE80211_KEY_GROUP; /* XXX */
1881 1.1 nonaka
1882 1.1 nonaka if (k->wk_flags & IEEE80211_KEY_GROUP) {
1883 1.1 nonaka /* remove group key */
1884 1.1 nonaka run_read(sc, RT2860_SKEY_MODE_0_7, &attr);
1885 1.1 nonaka attr &= ~(0xf << (k->wk_keyix * 4));
1886 1.1 nonaka run_write(sc, RT2860_SKEY_MODE_0_7, attr);
1887 1.1 nonaka
1888 1.1 nonaka } else {
1889 1.1 nonaka /* remove pairwise key */
1890 1.1 nonaka wcid = RUN_AID2WCID(cmd->associd);
1891 1.1 nonaka run_read(sc, RT2860_WCID_ATTR(wcid), &attr);
1892 1.1 nonaka attr &= ~0xf;
1893 1.1 nonaka run_write(sc, RT2860_WCID_ATTR(wcid), attr);
1894 1.1 nonaka }
1895 1.1 nonaka }
1896 1.1 nonaka #endif
1897 1.1 nonaka
1898 1.1 nonaka static void
1899 1.1 nonaka run_calibrate_to(void *arg)
1900 1.1 nonaka {
1901 1.1 nonaka
1902 1.1 nonaka /* do it in a process context */
1903 1.1 nonaka run_do_async(arg, run_calibrate_cb, NULL, 0);
1904 1.1 nonaka /* next timeout will be rescheduled in the calibration task */
1905 1.1 nonaka }
1906 1.1 nonaka
1907 1.1 nonaka /* ARGSUSED */
1908 1.1 nonaka static void
1909 1.1 nonaka run_calibrate_cb(struct run_softc *sc, void *arg)
1910 1.1 nonaka {
1911 1.1 nonaka struct ifnet *ifp = &sc->sc_if;
1912 1.1 nonaka uint32_t sta[3];
1913 1.1 nonaka int s, error;
1914 1.1 nonaka
1915 1.1 nonaka /* read statistic counters (clear on read) and update AMRR state */
1916 1.1 nonaka error = run_read_region_1(sc, RT2860_TX_STA_CNT0, (uint8_t *)sta,
1917 1.10.6.6 skrll sizeof(sta));
1918 1.1 nonaka if (error != 0)
1919 1.1 nonaka goto skip;
1920 1.1 nonaka
1921 1.1 nonaka DPRINTF(("retrycnt=%d txcnt=%d failcnt=%d\n",
1922 1.1 nonaka le32toh(sta[1]) >> 16, le32toh(sta[1]) & 0xffff,
1923 1.1 nonaka le32toh(sta[0]) & 0xffff));
1924 1.1 nonaka
1925 1.1 nonaka s = splnet();
1926 1.1 nonaka /* count failed TX as errors */
1927 1.1 nonaka ifp->if_oerrors += le32toh(sta[0]) & 0xffff;
1928 1.1 nonaka
1929 1.1 nonaka sc->amn.amn_retrycnt =
1930 1.1 nonaka (le32toh(sta[0]) & 0xffff) + /* failed TX count */
1931 1.1 nonaka (le32toh(sta[1]) >> 16); /* TX retransmission count */
1932 1.1 nonaka
1933 1.1 nonaka sc->amn.amn_txcnt =
1934 1.1 nonaka sc->amn.amn_retrycnt +
1935 1.1 nonaka (le32toh(sta[1]) & 0xffff); /* successful TX count */
1936 1.1 nonaka
1937 1.1 nonaka ieee80211_amrr_choose(&sc->amrr, sc->sc_ic.ic_bss, &sc->amn);
1938 1.1 nonaka splx(s);
1939 1.1 nonaka
1940 1.1 nonaka skip: callout_schedule(&sc->calib_to, hz);
1941 1.1 nonaka }
1942 1.1 nonaka
1943 1.1 nonaka static void
1944 1.1 nonaka run_newassoc(struct ieee80211_node *ni, int isnew)
1945 1.1 nonaka {
1946 1.1 nonaka struct run_softc *sc = ni->ni_ic->ic_ifp->if_softc;
1947 1.1 nonaka struct run_node *rn = (void *)ni;
1948 1.1 nonaka struct ieee80211_rateset *rs = &ni->ni_rates;
1949 1.1 nonaka uint8_t rate;
1950 1.1 nonaka int ridx, i, j;
1951 1.1 nonaka
1952 1.1 nonaka DPRINTF(("new assoc isnew=%d addr=%s\n",
1953 1.1 nonaka isnew, ether_sprintf(ni->ni_macaddr)));
1954 1.1 nonaka
1955 1.1 nonaka ieee80211_amrr_node_init(&sc->amrr, &sc->amn);
1956 1.1 nonaka /* start at lowest available bit-rate, AMRR will raise */
1957 1.1 nonaka ni->ni_txrate = 0;
1958 1.1 nonaka
1959 1.1 nonaka for (i = 0; i < rs->rs_nrates; i++) {
1960 1.1 nonaka rate = rs->rs_rates[i] & IEEE80211_RATE_VAL;
1961 1.1 nonaka /* convert 802.11 rate to hardware rate index */
1962 1.1 nonaka for (ridx = 0; ridx < RT2860_RIDX_MAX; ridx++)
1963 1.1 nonaka if (rt2860_rates[ridx].rate == rate)
1964 1.1 nonaka break;
1965 1.1 nonaka rn->ridx[i] = ridx;
1966 1.1 nonaka /* determine rate of control response frames */
1967 1.1 nonaka for (j = i; j >= 0; j--) {
1968 1.1 nonaka if ((rs->rs_rates[j] & IEEE80211_RATE_BASIC) &&
1969 1.1 nonaka rt2860_rates[rn->ridx[i]].phy ==
1970 1.1 nonaka rt2860_rates[rn->ridx[j]].phy)
1971 1.1 nonaka break;
1972 1.1 nonaka }
1973 1.1 nonaka if (j >= 0) {
1974 1.1 nonaka rn->ctl_ridx[i] = rn->ridx[j];
1975 1.1 nonaka } else {
1976 1.1 nonaka /* no basic rate found, use mandatory one */
1977 1.1 nonaka rn->ctl_ridx[i] = rt2860_rates[ridx].ctl_ridx;
1978 1.1 nonaka }
1979 1.1 nonaka DPRINTF(("rate=0x%02x ridx=%d ctl_ridx=%d\n",
1980 1.1 nonaka rs->rs_rates[i], rn->ridx[i], rn->ctl_ridx[i]));
1981 1.1 nonaka }
1982 1.1 nonaka }
1983 1.1 nonaka
1984 1.1 nonaka /*
1985 1.1 nonaka * Return the Rx chain with the highest RSSI for a given frame.
1986 1.1 nonaka */
1987 1.1 nonaka static __inline uint8_t
1988 1.1 nonaka run_maxrssi_chain(struct run_softc *sc, const struct rt2860_rxwi *rxwi)
1989 1.1 nonaka {
1990 1.1 nonaka uint8_t rxchain = 0;
1991 1.1 nonaka
1992 1.1 nonaka if (sc->nrxchains > 1) {
1993 1.1 nonaka if (rxwi->rssi[1] > rxwi->rssi[rxchain])
1994 1.1 nonaka rxchain = 1;
1995 1.1 nonaka if (sc->nrxchains > 2)
1996 1.1 nonaka if (rxwi->rssi[2] > rxwi->rssi[rxchain])
1997 1.1 nonaka rxchain = 2;
1998 1.1 nonaka }
1999 1.10.6.2 skrll return rxchain;
2000 1.1 nonaka }
2001 1.1 nonaka
2002 1.1 nonaka static void
2003 1.1 nonaka run_rx_frame(struct run_softc *sc, uint8_t *buf, int dmalen)
2004 1.1 nonaka {
2005 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
2006 1.1 nonaka struct ifnet *ifp = &sc->sc_if;
2007 1.1 nonaka struct ieee80211_frame *wh;
2008 1.1 nonaka struct ieee80211_node *ni;
2009 1.1 nonaka struct rt2870_rxd *rxd;
2010 1.1 nonaka struct rt2860_rxwi *rxwi;
2011 1.1 nonaka struct mbuf *m;
2012 1.1 nonaka uint32_t flags;
2013 1.1 nonaka uint16_t len, phy;
2014 1.1 nonaka uint8_t ant, rssi;
2015 1.1 nonaka int s;
2016 1.1 nonaka #ifdef RUN_HWCRYPTO
2017 1.1 nonaka int decrypted = 0;
2018 1.1 nonaka #endif
2019 1.1 nonaka
2020 1.1 nonaka rxwi = (struct rt2860_rxwi *)buf;
2021 1.1 nonaka len = le16toh(rxwi->len) & 0xfff;
2022 1.1 nonaka if (__predict_false(len > dmalen)) {
2023 1.1 nonaka DPRINTF(("bad RXWI length %u > %u\n", len, dmalen));
2024 1.1 nonaka return;
2025 1.1 nonaka }
2026 1.1 nonaka /* Rx descriptor is located at the end */
2027 1.1 nonaka rxd = (struct rt2870_rxd *)(buf + dmalen);
2028 1.1 nonaka flags = le32toh(rxd->flags);
2029 1.1 nonaka
2030 1.1 nonaka if (__predict_false(flags & (RT2860_RX_CRCERR | RT2860_RX_ICVERR))) {
2031 1.1 nonaka ifp->if_ierrors++;
2032 1.1 nonaka return;
2033 1.1 nonaka }
2034 1.1 nonaka
2035 1.1 nonaka wh = (struct ieee80211_frame *)(rxwi + 1);
2036 1.1 nonaka #ifdef RUN_HWCRYPTO
2037 1.1 nonaka if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
2038 1.1 nonaka wh->i_fc[1] &= ~IEEE80211_FC1_WEP;
2039 1.1 nonaka decrypted = 1;
2040 1.1 nonaka }
2041 1.1 nonaka #endif
2042 1.1 nonaka
2043 1.1 nonaka if (__predict_false((flags & RT2860_RX_MICERR))) {
2044 1.1 nonaka /* report MIC failures to net80211 for TKIP */
2045 1.1 nonaka ieee80211_notify_michael_failure(ic, wh, 0/* XXX */);
2046 1.1 nonaka ifp->if_ierrors++;
2047 1.1 nonaka return;
2048 1.1 nonaka }
2049 1.1 nonaka
2050 1.1 nonaka if (flags & RT2860_RX_L2PAD) {
2051 1.1 nonaka u_int hdrlen = ieee80211_hdrspace(ic, wh);
2052 1.1 nonaka ovbcopy(wh, (uint8_t *)wh + 2, hdrlen);
2053 1.1 nonaka wh = (struct ieee80211_frame *)((uint8_t *)wh + 2);
2054 1.1 nonaka }
2055 1.1 nonaka
2056 1.1 nonaka /* could use m_devget but net80211 wants contig mgmt frames */
2057 1.1 nonaka MGETHDR(m, M_DONTWAIT, MT_DATA);
2058 1.1 nonaka if (__predict_false(m == NULL)) {
2059 1.1 nonaka ifp->if_ierrors++;
2060 1.1 nonaka return;
2061 1.1 nonaka }
2062 1.1 nonaka if (len > MHLEN) {
2063 1.1 nonaka MCLGET(m, M_DONTWAIT);
2064 1.1 nonaka if (__predict_false(!(m->m_flags & M_EXT))) {
2065 1.1 nonaka ifp->if_ierrors++;
2066 1.1 nonaka m_freem(m);
2067 1.1 nonaka return;
2068 1.1 nonaka }
2069 1.1 nonaka }
2070 1.1 nonaka /* finalize mbuf */
2071 1.10.6.10 skrll m_set_rcvif(m, ifp);
2072 1.1 nonaka memcpy(mtod(m, void *), wh, len);
2073 1.1 nonaka m->m_pkthdr.len = m->m_len = len;
2074 1.1 nonaka
2075 1.1 nonaka ant = run_maxrssi_chain(sc, rxwi);
2076 1.1 nonaka rssi = rxwi->rssi[ant];
2077 1.1 nonaka
2078 1.1 nonaka if (__predict_false(sc->sc_drvbpf != NULL)) {
2079 1.1 nonaka struct run_rx_radiotap_header *tap = &sc->sc_rxtap;
2080 1.1 nonaka
2081 1.1 nonaka tap->wr_flags = 0;
2082 1.1 nonaka tap->wr_chan_freq = htole16(ic->ic_curchan->ic_freq);
2083 1.1 nonaka tap->wr_chan_flags = htole16(ic->ic_curchan->ic_flags);
2084 1.1 nonaka tap->wr_antsignal = rssi;
2085 1.1 nonaka tap->wr_antenna = ant;
2086 1.1 nonaka tap->wr_dbm_antsignal = run_rssi2dbm(sc, rssi, ant);
2087 1.1 nonaka tap->wr_rate = 2; /* in case it can't be found below */
2088 1.1 nonaka phy = le16toh(rxwi->phy);
2089 1.1 nonaka switch (phy & RT2860_PHY_MODE) {
2090 1.1 nonaka case RT2860_PHY_CCK:
2091 1.1 nonaka switch ((phy & RT2860_PHY_MCS) & ~RT2860_PHY_SHPRE) {
2092 1.1 nonaka case 0: tap->wr_rate = 2; break;
2093 1.1 nonaka case 1: tap->wr_rate = 4; break;
2094 1.1 nonaka case 2: tap->wr_rate = 11; break;
2095 1.1 nonaka case 3: tap->wr_rate = 22; break;
2096 1.1 nonaka }
2097 1.1 nonaka if (phy & RT2860_PHY_SHPRE)
2098 1.1 nonaka tap->wr_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
2099 1.1 nonaka break;
2100 1.1 nonaka case RT2860_PHY_OFDM:
2101 1.1 nonaka switch (phy & RT2860_PHY_MCS) {
2102 1.1 nonaka case 0: tap->wr_rate = 12; break;
2103 1.1 nonaka case 1: tap->wr_rate = 18; break;
2104 1.1 nonaka case 2: tap->wr_rate = 24; break;
2105 1.1 nonaka case 3: tap->wr_rate = 36; break;
2106 1.1 nonaka case 4: tap->wr_rate = 48; break;
2107 1.1 nonaka case 5: tap->wr_rate = 72; break;
2108 1.1 nonaka case 6: tap->wr_rate = 96; break;
2109 1.1 nonaka case 7: tap->wr_rate = 108; break;
2110 1.1 nonaka }
2111 1.1 nonaka break;
2112 1.1 nonaka }
2113 1.1 nonaka bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_rxtap_len, m);
2114 1.1 nonaka }
2115 1.1 nonaka
2116 1.1 nonaka s = splnet();
2117 1.1 nonaka ni = ieee80211_find_rxnode(ic, (struct ieee80211_frame_min *)wh);
2118 1.1 nonaka #ifdef RUN_HWCRYPTO
2119 1.1 nonaka if (decrypted) {
2120 1.1 nonaka uint32_t icflags = ic->ic_flags;
2121 1.1 nonaka
2122 1.1 nonaka ic->ic_flags &= ~IEEE80211_F_DROPUNENC; /* XXX */
2123 1.1 nonaka ieee80211_input(ic, m, ni, rssi, 0);
2124 1.1 nonaka ic->ic_flags = icflags;
2125 1.1 nonaka } else
2126 1.1 nonaka #endif
2127 1.1 nonaka ieee80211_input(ic, m, ni, rssi, 0);
2128 1.1 nonaka
2129 1.1 nonaka /* node is no longer needed */
2130 1.1 nonaka ieee80211_free_node(ni);
2131 1.1 nonaka
2132 1.1 nonaka /*
2133 1.1 nonaka * In HostAP mode, ieee80211_input() will enqueue packets in if_snd
2134 1.1 nonaka * without calling if_start().
2135 1.1 nonaka */
2136 1.1 nonaka if (!IFQ_IS_EMPTY(&ifp->if_snd) && !(ifp->if_flags & IFF_OACTIVE))
2137 1.1 nonaka run_start(ifp);
2138 1.1 nonaka
2139 1.1 nonaka splx(s);
2140 1.1 nonaka }
2141 1.1 nonaka
2142 1.1 nonaka static void
2143 1.10.6.3 skrll run_rxeof(struct usbd_xfer *xfer, void *priv, usbd_status status)
2144 1.1 nonaka {
2145 1.1 nonaka struct run_rx_data *data = priv;
2146 1.1 nonaka struct run_softc *sc = data->sc;
2147 1.1 nonaka uint8_t *buf;
2148 1.1 nonaka uint32_t dmalen;
2149 1.1 nonaka int xferlen;
2150 1.1 nonaka
2151 1.1 nonaka if (__predict_false(status != USBD_NORMAL_COMPLETION)) {
2152 1.1 nonaka DPRINTF(("RX status=%d\n", status));
2153 1.1 nonaka if (status == USBD_STALLED)
2154 1.1 nonaka usbd_clear_endpoint_stall_async(sc->rxq.pipeh);
2155 1.1 nonaka if (status != USBD_CANCELLED)
2156 1.1 nonaka goto skip;
2157 1.1 nonaka return;
2158 1.1 nonaka }
2159 1.1 nonaka usbd_get_xfer_status(xfer, NULL, NULL, &xferlen, NULL);
2160 1.1 nonaka
2161 1.1 nonaka if (__predict_false(xferlen < (int)(sizeof(uint32_t) +
2162 1.1 nonaka sizeof(struct rt2860_rxwi) + sizeof(struct rt2870_rxd)))) {
2163 1.1 nonaka DPRINTF(("xfer too short %d\n", xferlen));
2164 1.1 nonaka goto skip;
2165 1.1 nonaka }
2166 1.1 nonaka
2167 1.1 nonaka /* HW can aggregate multiple 802.11 frames in a single USB xfer */
2168 1.1 nonaka buf = data->buf;
2169 1.1 nonaka while (xferlen > 8) {
2170 1.1 nonaka dmalen = le32toh(*(uint32_t *)buf) & 0xffff;
2171 1.1 nonaka
2172 1.1 nonaka if (__predict_false(dmalen == 0 || (dmalen & 3) != 0)) {
2173 1.1 nonaka DPRINTF(("bad DMA length %u (%x)\n", dmalen, dmalen));
2174 1.1 nonaka break;
2175 1.1 nonaka }
2176 1.1 nonaka if (__predict_false(dmalen + 8 > (uint32_t)xferlen)) {
2177 1.1 nonaka DPRINTF(("bad DMA length %u > %d\n",
2178 1.1 nonaka dmalen + 8, xferlen));
2179 1.1 nonaka break;
2180 1.1 nonaka }
2181 1.10.6.6 skrll run_rx_frame(sc, buf + sizeof(uint32_t), dmalen);
2182 1.1 nonaka buf += dmalen + 8;
2183 1.1 nonaka xferlen -= dmalen + 8;
2184 1.1 nonaka }
2185 1.1 nonaka
2186 1.1 nonaka skip: /* setup a new transfer */
2187 1.10.6.7 skrll usbd_setup_xfer(xfer, data, data->buf, RUN_MAX_RXSZ,
2188 1.10.6.1 skrll USBD_SHORT_XFER_OK, USBD_NO_TIMEOUT, run_rxeof);
2189 1.1 nonaka (void)usbd_transfer(data->xfer);
2190 1.1 nonaka }
2191 1.1 nonaka
2192 1.1 nonaka static void
2193 1.10.6.3 skrll run_txeof(struct usbd_xfer *xfer, void *priv, usbd_status status)
2194 1.1 nonaka {
2195 1.1 nonaka struct run_tx_data *data = priv;
2196 1.1 nonaka struct run_softc *sc = data->sc;
2197 1.1 nonaka struct run_tx_ring *txq = &sc->txq[data->qid];
2198 1.1 nonaka struct ifnet *ifp = &sc->sc_if;
2199 1.1 nonaka int s;
2200 1.1 nonaka
2201 1.1 nonaka if (__predict_false(status != USBD_NORMAL_COMPLETION)) {
2202 1.1 nonaka DPRINTF(("TX status=%d\n", status));
2203 1.1 nonaka if (status == USBD_STALLED)
2204 1.1 nonaka usbd_clear_endpoint_stall_async(txq->pipeh);
2205 1.1 nonaka ifp->if_oerrors++;
2206 1.1 nonaka return;
2207 1.1 nonaka }
2208 1.1 nonaka
2209 1.1 nonaka s = splnet();
2210 1.1 nonaka sc->sc_tx_timer = 0;
2211 1.1 nonaka ifp->if_opackets++;
2212 1.1 nonaka if (--txq->queued < RUN_TX_RING_COUNT) {
2213 1.1 nonaka sc->qfullmsk &= ~(1 << data->qid);
2214 1.1 nonaka ifp->if_flags &= ~IFF_OACTIVE;
2215 1.1 nonaka run_start(ifp);
2216 1.1 nonaka }
2217 1.1 nonaka splx(s);
2218 1.1 nonaka }
2219 1.1 nonaka
2220 1.1 nonaka static int
2221 1.1 nonaka run_tx(struct run_softc *sc, struct mbuf *m, struct ieee80211_node *ni)
2222 1.1 nonaka {
2223 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
2224 1.1 nonaka struct run_node *rn = (void *)ni;
2225 1.1 nonaka struct ieee80211_frame *wh;
2226 1.1 nonaka #ifndef RUN_HWCRYPTO
2227 1.1 nonaka struct ieee80211_key *k;
2228 1.1 nonaka #endif
2229 1.1 nonaka struct run_tx_ring *ring;
2230 1.1 nonaka struct run_tx_data *data;
2231 1.1 nonaka struct rt2870_txd *txd;
2232 1.1 nonaka struct rt2860_txwi *txwi;
2233 1.1 nonaka uint16_t dur;
2234 1.1 nonaka uint8_t type, mcs, tid, qid, qos = 0;
2235 1.1 nonaka int error, hasqos, ridx, ctl_ridx, xferlen;
2236 1.1 nonaka
2237 1.1 nonaka wh = mtod(m, struct ieee80211_frame *);
2238 1.1 nonaka
2239 1.1 nonaka #ifndef RUN_HWCRYPTO
2240 1.1 nonaka if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
2241 1.1 nonaka k = ieee80211_crypto_encap(ic, ni, m);
2242 1.1 nonaka if (k == NULL) {
2243 1.1 nonaka m_freem(m);
2244 1.10.6.2 skrll return ENOBUFS;
2245 1.1 nonaka }
2246 1.1 nonaka
2247 1.1 nonaka /* packet header may have moved, reset our local pointer */
2248 1.1 nonaka wh = mtod(m, struct ieee80211_frame *);
2249 1.1 nonaka }
2250 1.1 nonaka #endif
2251 1.1 nonaka type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;
2252 1.1 nonaka
2253 1.9 christos if ((hasqos = ieee80211_has_qos(wh))) {
2254 1.1 nonaka qos = ((struct ieee80211_qosframe *)wh)->i_qos[0];
2255 1.1 nonaka tid = qos & IEEE80211_QOS_TID;
2256 1.1 nonaka qid = TID_TO_WME_AC(tid);
2257 1.1 nonaka } else {
2258 1.1 nonaka tid = 0;
2259 1.1 nonaka qid = WME_AC_BE;
2260 1.1 nonaka }
2261 1.1 nonaka ring = &sc->txq[qid];
2262 1.1 nonaka data = &ring->data[ring->cur];
2263 1.1 nonaka
2264 1.1 nonaka /* pickup a rate index */
2265 1.1 nonaka if (IEEE80211_IS_MULTICAST(wh->i_addr1) ||
2266 1.1 nonaka type != IEEE80211_FC0_TYPE_DATA) {
2267 1.1 nonaka ridx = (ic->ic_curmode == IEEE80211_MODE_11A) ?
2268 1.1 nonaka RT2860_RIDX_OFDM6 : RT2860_RIDX_CCK1;
2269 1.1 nonaka ctl_ridx = rt2860_rates[ridx].ctl_ridx;
2270 1.1 nonaka } else if (ic->ic_fixed_rate != IEEE80211_FIXED_RATE_NONE) {
2271 1.1 nonaka ridx = sc->fixed_ridx;
2272 1.1 nonaka ctl_ridx = rt2860_rates[ridx].ctl_ridx;
2273 1.1 nonaka } else {
2274 1.1 nonaka ridx = rn->ridx[ni->ni_txrate];
2275 1.1 nonaka ctl_ridx = rn->ctl_ridx[ni->ni_txrate];
2276 1.1 nonaka }
2277 1.1 nonaka
2278 1.1 nonaka /* get MCS code from rate index */
2279 1.1 nonaka mcs = rt2860_rates[ridx].mcs;
2280 1.1 nonaka
2281 1.10.6.6 skrll xferlen = sizeof(*txwi) + m->m_pkthdr.len;
2282 1.1 nonaka /* roundup to 32-bit alignment */
2283 1.1 nonaka xferlen = (xferlen + 3) & ~3;
2284 1.1 nonaka
2285 1.1 nonaka txd = (struct rt2870_txd *)data->buf;
2286 1.1 nonaka txd->flags = RT2860_TX_QSEL_EDCA;
2287 1.1 nonaka txd->len = htole16(xferlen);
2288 1.1 nonaka
2289 1.1 nonaka /* setup TX Wireless Information */
2290 1.1 nonaka txwi = (struct rt2860_txwi *)(txd + 1);
2291 1.1 nonaka txwi->flags = 0;
2292 1.1 nonaka txwi->xflags = hasqos ? 0 : RT2860_TX_NSEQ;
2293 1.1 nonaka txwi->wcid = (type == IEEE80211_FC0_TYPE_DATA) ?
2294 1.1 nonaka RUN_AID2WCID(ni->ni_associd) : 0xff;
2295 1.1 nonaka txwi->len = htole16(m->m_pkthdr.len);
2296 1.1 nonaka if (rt2860_rates[ridx].phy == IEEE80211_T_DS) {
2297 1.1 nonaka txwi->phy = htole16(RT2860_PHY_CCK);
2298 1.1 nonaka if (ridx != RT2860_RIDX_CCK1 &&
2299 1.1 nonaka (ic->ic_flags & IEEE80211_F_SHPREAMBLE))
2300 1.1 nonaka mcs |= RT2860_PHY_SHPRE;
2301 1.1 nonaka } else
2302 1.1 nonaka txwi->phy = htole16(RT2860_PHY_OFDM);
2303 1.1 nonaka txwi->phy |= htole16(mcs);
2304 1.1 nonaka
2305 1.1 nonaka txwi->txop = RT2860_TX_TXOP_BACKOFF;
2306 1.1 nonaka
2307 1.1 nonaka if (!IEEE80211_IS_MULTICAST(wh->i_addr1) &&
2308 1.1 nonaka (!hasqos || (qos & IEEE80211_QOS_ACKPOLICY) !=
2309 1.1 nonaka IEEE80211_QOS_ACKPOLICY_NOACK)) {
2310 1.1 nonaka txwi->xflags |= RT2860_TX_ACK;
2311 1.1 nonaka if (ic->ic_flags & IEEE80211_F_SHPREAMBLE)
2312 1.1 nonaka dur = rt2860_rates[ctl_ridx].sp_ack_dur;
2313 1.1 nonaka else
2314 1.1 nonaka dur = rt2860_rates[ctl_ridx].lp_ack_dur;
2315 1.1 nonaka *(uint16_t *)wh->i_dur = htole16(dur);
2316 1.1 nonaka }
2317 1.1 nonaka
2318 1.1 nonaka #ifndef IEEE80211_STA_ONLY
2319 1.1 nonaka /* ask MAC to insert timestamp into probe responses */
2320 1.1 nonaka if ((wh->i_fc[0] &
2321 1.1 nonaka (IEEE80211_FC0_TYPE_MASK | IEEE80211_FC0_SUBTYPE_MASK)) ==
2322 1.1 nonaka (IEEE80211_FC0_TYPE_MGT | IEEE80211_FC0_SUBTYPE_PROBE_RESP))
2323 1.1 nonaka /* NOTE: beacons do not pass through tx_data() */
2324 1.1 nonaka txwi->flags |= RT2860_TX_TS;
2325 1.1 nonaka #endif
2326 1.1 nonaka
2327 1.1 nonaka if (__predict_false(sc->sc_drvbpf != NULL)) {
2328 1.1 nonaka struct run_tx_radiotap_header *tap = &sc->sc_txtap;
2329 1.1 nonaka
2330 1.1 nonaka tap->wt_flags = 0;
2331 1.1 nonaka tap->wt_rate = rt2860_rates[ridx].rate;
2332 1.1 nonaka tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq);
2333 1.1 nonaka tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags);
2334 1.1 nonaka tap->wt_hwqueue = qid;
2335 1.1 nonaka if (mcs & RT2860_PHY_SHPRE)
2336 1.1 nonaka tap->wt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
2337 1.1 nonaka
2338 1.1 nonaka bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m);
2339 1.1 nonaka }
2340 1.1 nonaka
2341 1.1 nonaka m_copydata(m, 0, m->m_pkthdr.len, (void *)(txwi + 1));
2342 1.1 nonaka m_freem(m);
2343 1.1 nonaka
2344 1.10.6.6 skrll xferlen += sizeof(*txd) + 4;
2345 1.1 nonaka
2346 1.10.6.7 skrll usbd_setup_xfer(data->xfer, data, data->buf, xferlen,
2347 1.10.6.1 skrll USBD_FORCE_SHORT_XFER, RUN_TX_TIMEOUT, run_txeof);
2348 1.1 nonaka error = usbd_transfer(data->xfer);
2349 1.1 nonaka if (__predict_false(error != USBD_IN_PROGRESS &&
2350 1.1 nonaka error != USBD_NORMAL_COMPLETION))
2351 1.10.6.2 skrll return error;
2352 1.1 nonaka
2353 1.1 nonaka ieee80211_free_node(ni);
2354 1.1 nonaka
2355 1.1 nonaka ring->cur = (ring->cur + 1) % RUN_TX_RING_COUNT;
2356 1.1 nonaka if (++ring->queued >= RUN_TX_RING_COUNT)
2357 1.1 nonaka sc->qfullmsk |= 1 << qid;
2358 1.1 nonaka
2359 1.10.6.2 skrll return 0;
2360 1.1 nonaka }
2361 1.1 nonaka
2362 1.1 nonaka static void
2363 1.1 nonaka run_start(struct ifnet *ifp)
2364 1.1 nonaka {
2365 1.1 nonaka struct run_softc *sc = ifp->if_softc;
2366 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
2367 1.1 nonaka struct ether_header *eh;
2368 1.1 nonaka struct ieee80211_node *ni;
2369 1.1 nonaka struct mbuf *m;
2370 1.1 nonaka
2371 1.1 nonaka if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)
2372 1.1 nonaka return;
2373 1.1 nonaka
2374 1.1 nonaka for (;;) {
2375 1.1 nonaka if (sc->qfullmsk != 0) {
2376 1.1 nonaka ifp->if_flags |= IFF_OACTIVE;
2377 1.1 nonaka break;
2378 1.1 nonaka }
2379 1.1 nonaka /* send pending management frames first */
2380 1.1 nonaka IF_DEQUEUE(&ic->ic_mgtq, m);
2381 1.1 nonaka if (m != NULL) {
2382 1.10.6.9 skrll ni = M_GETCTX(m, struct ieee80211_node *);
2383 1.10.6.9 skrll M_CLEARCTX(m);
2384 1.1 nonaka goto sendit;
2385 1.1 nonaka }
2386 1.1 nonaka if (ic->ic_state != IEEE80211_S_RUN)
2387 1.1 nonaka break;
2388 1.1 nonaka
2389 1.1 nonaka /* encapsulate and send data frames */
2390 1.1 nonaka IFQ_DEQUEUE(&ifp->if_snd, m);
2391 1.1 nonaka if (m == NULL)
2392 1.1 nonaka break;
2393 1.1 nonaka if (m->m_len < (int)sizeof(*eh) &&
2394 1.1 nonaka (m = m_pullup(m, sizeof(*eh))) == NULL) {
2395 1.1 nonaka ifp->if_oerrors++;
2396 1.1 nonaka continue;
2397 1.1 nonaka }
2398 1.1 nonaka
2399 1.1 nonaka eh = mtod(m, struct ether_header *);
2400 1.1 nonaka ni = ieee80211_find_txnode(ic, eh->ether_dhost);
2401 1.1 nonaka if (ni == NULL) {
2402 1.1 nonaka m_freem(m);
2403 1.1 nonaka ifp->if_oerrors++;
2404 1.1 nonaka continue;
2405 1.1 nonaka }
2406 1.1 nonaka
2407 1.1 nonaka bpf_mtap(ifp, m);
2408 1.1 nonaka
2409 1.1 nonaka if ((m = ieee80211_encap(ic, m, ni)) == NULL) {
2410 1.1 nonaka ieee80211_free_node(ni);
2411 1.1 nonaka ifp->if_oerrors++;
2412 1.1 nonaka continue;
2413 1.1 nonaka }
2414 1.1 nonaka sendit:
2415 1.1 nonaka bpf_mtap3(ic->ic_rawbpf, m);
2416 1.1 nonaka
2417 1.1 nonaka if (run_tx(sc, m, ni) != 0) {
2418 1.1 nonaka ieee80211_free_node(ni);
2419 1.1 nonaka ifp->if_oerrors++;
2420 1.1 nonaka continue;
2421 1.1 nonaka }
2422 1.1 nonaka
2423 1.1 nonaka sc->sc_tx_timer = 5;
2424 1.1 nonaka ifp->if_timer = 1;
2425 1.1 nonaka }
2426 1.1 nonaka }
2427 1.1 nonaka
2428 1.1 nonaka static void
2429 1.1 nonaka run_watchdog(struct ifnet *ifp)
2430 1.1 nonaka {
2431 1.1 nonaka struct run_softc *sc = ifp->if_softc;
2432 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
2433 1.1 nonaka
2434 1.1 nonaka ifp->if_timer = 0;
2435 1.1 nonaka
2436 1.1 nonaka if (sc->sc_tx_timer > 0) {
2437 1.1 nonaka if (--sc->sc_tx_timer == 0) {
2438 1.1 nonaka aprint_error_dev(sc->sc_dev, "device timeout\n");
2439 1.1 nonaka /* run_init(ifp); XXX needs a process context! */
2440 1.1 nonaka ifp->if_oerrors++;
2441 1.1 nonaka return;
2442 1.1 nonaka }
2443 1.1 nonaka ifp->if_timer = 1;
2444 1.1 nonaka }
2445 1.1 nonaka
2446 1.1 nonaka ieee80211_watchdog(ic);
2447 1.1 nonaka }
2448 1.1 nonaka
2449 1.1 nonaka static int
2450 1.1 nonaka run_ioctl(struct ifnet *ifp, u_long cmd, void *data)
2451 1.1 nonaka {
2452 1.1 nonaka struct run_softc *sc = ifp->if_softc;
2453 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
2454 1.1 nonaka int s, error = 0;
2455 1.1 nonaka
2456 1.1 nonaka s = splnet();
2457 1.1 nonaka
2458 1.1 nonaka switch (cmd) {
2459 1.1 nonaka case SIOCSIFFLAGS:
2460 1.1 nonaka if ((error = ifioctl_common(ifp, cmd, data)) != 0)
2461 1.1 nonaka break;
2462 1.1 nonaka switch (ifp->if_flags & (IFF_UP|IFF_RUNNING)) {
2463 1.1 nonaka case IFF_UP|IFF_RUNNING:
2464 1.1 nonaka break;
2465 1.1 nonaka case IFF_UP:
2466 1.1 nonaka run_init(ifp);
2467 1.1 nonaka break;
2468 1.1 nonaka case IFF_RUNNING:
2469 1.1 nonaka run_stop(ifp, 1);
2470 1.1 nonaka break;
2471 1.1 nonaka case 0:
2472 1.1 nonaka break;
2473 1.1 nonaka }
2474 1.1 nonaka break;
2475 1.1 nonaka
2476 1.1 nonaka case SIOCADDMULTI:
2477 1.1 nonaka case SIOCDELMULTI:
2478 1.1 nonaka if ((error = ether_ioctl(ifp, cmd, data)) == ENETRESET) {
2479 1.1 nonaka /* setup multicast filter, etc */
2480 1.1 nonaka error = 0;
2481 1.1 nonaka }
2482 1.1 nonaka break;
2483 1.1 nonaka
2484 1.1 nonaka default:
2485 1.1 nonaka error = ieee80211_ioctl(ic, cmd, data);
2486 1.1 nonaka break;
2487 1.1 nonaka }
2488 1.1 nonaka
2489 1.1 nonaka if (error == ENETRESET) {
2490 1.1 nonaka if ((ifp->if_flags & (IFF_UP | IFF_RUNNING)) ==
2491 1.1 nonaka (IFF_UP | IFF_RUNNING)) {
2492 1.1 nonaka run_init(ifp);
2493 1.1 nonaka }
2494 1.1 nonaka error = 0;
2495 1.1 nonaka }
2496 1.1 nonaka
2497 1.1 nonaka splx(s);
2498 1.1 nonaka
2499 1.10.6.2 skrll return error;
2500 1.1 nonaka }
2501 1.1 nonaka
2502 1.1 nonaka static void
2503 1.1 nonaka run_select_chan_group(struct run_softc *sc, int group)
2504 1.1 nonaka {
2505 1.1 nonaka uint32_t tmp;
2506 1.1 nonaka uint8_t agc;
2507 1.1 nonaka
2508 1.1 nonaka run_bbp_write(sc, 62, 0x37 - sc->lna[group]);
2509 1.1 nonaka run_bbp_write(sc, 63, 0x37 - sc->lna[group]);
2510 1.1 nonaka run_bbp_write(sc, 64, 0x37 - sc->lna[group]);
2511 1.1 nonaka run_bbp_write(sc, 86, 0x00);
2512 1.1 nonaka
2513 1.1 nonaka if (group == 0) {
2514 1.1 nonaka if (sc->ext_2ghz_lna) {
2515 1.1 nonaka run_bbp_write(sc, 82, 0x62);
2516 1.1 nonaka run_bbp_write(sc, 75, 0x46);
2517 1.1 nonaka } else {
2518 1.1 nonaka run_bbp_write(sc, 82, 0x84);
2519 1.1 nonaka run_bbp_write(sc, 75, 0x50);
2520 1.1 nonaka }
2521 1.1 nonaka } else {
2522 1.1 nonaka if (sc->mac_ver == 0x3572)
2523 1.1 nonaka run_bbp_write(sc, 82, 0x94);
2524 1.1 nonaka else
2525 1.1 nonaka run_bbp_write(sc, 82, 0xf2);
2526 1.1 nonaka if (sc->ext_5ghz_lna)
2527 1.1 nonaka run_bbp_write(sc, 75, 0x46);
2528 1.1 nonaka else
2529 1.1 nonaka run_bbp_write(sc, 75, 0x50);
2530 1.1 nonaka }
2531 1.1 nonaka
2532 1.1 nonaka run_read(sc, RT2860_TX_BAND_CFG, &tmp);
2533 1.1 nonaka tmp &= ~(RT2860_5G_BAND_SEL_N | RT2860_5G_BAND_SEL_P);
2534 1.1 nonaka tmp |= (group == 0) ? RT2860_5G_BAND_SEL_N : RT2860_5G_BAND_SEL_P;
2535 1.1 nonaka run_write(sc, RT2860_TX_BAND_CFG, tmp);
2536 1.1 nonaka
2537 1.1 nonaka /* enable appropriate Power Amplifiers and Low Noise Amplifiers */
2538 1.1 nonaka tmp = RT2860_RFTR_EN | RT2860_TRSW_EN | RT2860_LNA_PE0_EN;
2539 1.1 nonaka if (sc->nrxchains > 1)
2540 1.1 nonaka tmp |= RT2860_LNA_PE1_EN;
2541 1.1 nonaka if (group == 0) { /* 2GHz */
2542 1.1 nonaka tmp |= RT2860_PA_PE_G0_EN;
2543 1.1 nonaka if (sc->ntxchains > 1)
2544 1.1 nonaka tmp |= RT2860_PA_PE_G1_EN;
2545 1.1 nonaka } else { /* 5GHz */
2546 1.1 nonaka tmp |= RT2860_PA_PE_A0_EN;
2547 1.1 nonaka if (sc->ntxchains > 1)
2548 1.1 nonaka tmp |= RT2860_PA_PE_A1_EN;
2549 1.1 nonaka }
2550 1.1 nonaka if (sc->mac_ver == 0x3572) {
2551 1.1 nonaka run_rt3070_rf_write(sc, 8, 0x00);
2552 1.1 nonaka run_write(sc, RT2860_TX_PIN_CFG, tmp);
2553 1.1 nonaka run_rt3070_rf_write(sc, 8, 0x80);
2554 1.1 nonaka } else
2555 1.1 nonaka run_write(sc, RT2860_TX_PIN_CFG, tmp);
2556 1.1 nonaka
2557 1.1 nonaka /* set initial AGC value */
2558 1.1 nonaka if (group == 0) { /* 2GHz band */
2559 1.1 nonaka if (sc->mac_ver >= 0x3070)
2560 1.1 nonaka agc = 0x1c + sc->lna[0] * 2;
2561 1.1 nonaka else
2562 1.1 nonaka agc = 0x2e + sc->lna[0];
2563 1.1 nonaka } else { /* 5GHz band */
2564 1.1 nonaka if (sc->mac_ver == 0x3572)
2565 1.1 nonaka agc = 0x22 + (sc->lna[group] * 5) / 3;
2566 1.1 nonaka else
2567 1.1 nonaka agc = 0x32 + (sc->lna[group] * 5) / 3;
2568 1.1 nonaka }
2569 1.1 nonaka run_set_agc(sc, agc);
2570 1.1 nonaka }
2571 1.1 nonaka
2572 1.1 nonaka static void
2573 1.1 nonaka run_rt2870_set_chan(struct run_softc *sc, u_int chan)
2574 1.1 nonaka {
2575 1.1 nonaka const struct rfprog *rfprog = rt2860_rf2850;
2576 1.1 nonaka uint32_t r2, r3, r4;
2577 1.1 nonaka int8_t txpow1, txpow2;
2578 1.1 nonaka int i;
2579 1.1 nonaka
2580 1.1 nonaka /* find the settings for this channel (we know it exists) */
2581 1.1 nonaka for (i = 0; rfprog[i].chan != chan; i++);
2582 1.1 nonaka
2583 1.1 nonaka r2 = rfprog[i].r2;
2584 1.1 nonaka if (sc->ntxchains == 1)
2585 1.1 nonaka r2 |= 1 << 12; /* 1T: disable Tx chain 2 */
2586 1.1 nonaka if (sc->nrxchains == 1)
2587 1.1 nonaka r2 |= 1 << 15 | 1 << 4; /* 1R: disable Rx chains 2 & 3 */
2588 1.1 nonaka else if (sc->nrxchains == 2)
2589 1.1 nonaka r2 |= 1 << 4; /* 2R: disable Rx chain 3 */
2590 1.1 nonaka
2591 1.1 nonaka /* use Tx power values from EEPROM */
2592 1.1 nonaka txpow1 = sc->txpow1[i];
2593 1.1 nonaka txpow2 = sc->txpow2[i];
2594 1.1 nonaka if (chan > 14) {
2595 1.1 nonaka if (txpow1 >= 0)
2596 1.1 nonaka txpow1 = txpow1 << 1 | 1;
2597 1.1 nonaka else
2598 1.1 nonaka txpow1 = (7 + txpow1) << 1;
2599 1.1 nonaka if (txpow2 >= 0)
2600 1.1 nonaka txpow2 = txpow2 << 1 | 1;
2601 1.1 nonaka else
2602 1.1 nonaka txpow2 = (7 + txpow2) << 1;
2603 1.1 nonaka }
2604 1.1 nonaka r3 = rfprog[i].r3 | txpow1 << 7;
2605 1.1 nonaka r4 = rfprog[i].r4 | sc->freq << 13 | txpow2 << 4;
2606 1.1 nonaka
2607 1.1 nonaka run_rt2870_rf_write(sc, RT2860_RF1, rfprog[i].r1);
2608 1.1 nonaka run_rt2870_rf_write(sc, RT2860_RF2, r2);
2609 1.1 nonaka run_rt2870_rf_write(sc, RT2860_RF3, r3);
2610 1.1 nonaka run_rt2870_rf_write(sc, RT2860_RF4, r4);
2611 1.1 nonaka
2612 1.1 nonaka DELAY(200);
2613 1.1 nonaka
2614 1.1 nonaka run_rt2870_rf_write(sc, RT2860_RF1, rfprog[i].r1);
2615 1.1 nonaka run_rt2870_rf_write(sc, RT2860_RF2, r2);
2616 1.1 nonaka run_rt2870_rf_write(sc, RT2860_RF3, r3 | 1);
2617 1.1 nonaka run_rt2870_rf_write(sc, RT2860_RF4, r4);
2618 1.1 nonaka
2619 1.1 nonaka DELAY(200);
2620 1.1 nonaka
2621 1.1 nonaka run_rt2870_rf_write(sc, RT2860_RF1, rfprog[i].r1);
2622 1.1 nonaka run_rt2870_rf_write(sc, RT2860_RF2, r2);
2623 1.1 nonaka run_rt2870_rf_write(sc, RT2860_RF3, r3);
2624 1.1 nonaka run_rt2870_rf_write(sc, RT2860_RF4, r4);
2625 1.1 nonaka }
2626 1.1 nonaka
2627 1.1 nonaka static void
2628 1.1 nonaka run_rt3070_set_chan(struct run_softc *sc, u_int chan)
2629 1.1 nonaka {
2630 1.1 nonaka int8_t txpow1, txpow2;
2631 1.1 nonaka uint8_t rf;
2632 1.1 nonaka int i;
2633 1.1 nonaka
2634 1.1 nonaka KASSERT(chan >= 1 && chan <= 14); /* RT3070 is 2GHz only */
2635 1.1 nonaka
2636 1.1 nonaka /* find the settings for this channel (we know it exists) */
2637 1.1 nonaka for (i = 0; rt2860_rf2850[i].chan != chan; i++)
2638 1.1 nonaka continue;
2639 1.1 nonaka
2640 1.1 nonaka /* use Tx power values from EEPROM */
2641 1.1 nonaka txpow1 = sc->txpow1[i];
2642 1.1 nonaka txpow2 = sc->txpow2[i];
2643 1.1 nonaka
2644 1.1 nonaka run_rt3070_rf_write(sc, 2, rt3070_freqs[i].n);
2645 1.1 nonaka run_rt3070_rf_write(sc, 3, rt3070_freqs[i].k);
2646 1.1 nonaka run_rt3070_rf_read(sc, 6, &rf);
2647 1.1 nonaka rf = (rf & ~0x03) | rt3070_freqs[i].r;
2648 1.1 nonaka run_rt3070_rf_write(sc, 6, rf);
2649 1.1 nonaka
2650 1.1 nonaka /* set Tx0 power */
2651 1.1 nonaka run_rt3070_rf_read(sc, 12, &rf);
2652 1.1 nonaka rf = (rf & ~0x1f) | txpow1;
2653 1.1 nonaka run_rt3070_rf_write(sc, 12, rf);
2654 1.1 nonaka
2655 1.1 nonaka /* set Tx1 power */
2656 1.1 nonaka run_rt3070_rf_read(sc, 13, &rf);
2657 1.1 nonaka rf = (rf & ~0x1f) | txpow2;
2658 1.1 nonaka run_rt3070_rf_write(sc, 13, rf);
2659 1.1 nonaka
2660 1.1 nonaka run_rt3070_rf_read(sc, 1, &rf);
2661 1.1 nonaka rf &= ~0xfc;
2662 1.1 nonaka if (sc->ntxchains == 1)
2663 1.1 nonaka rf |= 1 << 7 | 1 << 5; /* 1T: disable Tx chains 2 & 3 */
2664 1.1 nonaka else if (sc->ntxchains == 2)
2665 1.1 nonaka rf |= 1 << 7; /* 2T: disable Tx chain 3 */
2666 1.1 nonaka if (sc->nrxchains == 1)
2667 1.1 nonaka rf |= 1 << 6 | 1 << 4; /* 1R: disable Rx chains 2 & 3 */
2668 1.1 nonaka else if (sc->nrxchains == 2)
2669 1.1 nonaka rf |= 1 << 6; /* 2R: disable Rx chain 3 */
2670 1.1 nonaka run_rt3070_rf_write(sc, 1, rf);
2671 1.1 nonaka
2672 1.1 nonaka /* set RF offset */
2673 1.1 nonaka run_rt3070_rf_read(sc, 23, &rf);
2674 1.1 nonaka rf = (rf & ~0x7f) | sc->freq;
2675 1.1 nonaka run_rt3070_rf_write(sc, 23, rf);
2676 1.1 nonaka
2677 1.1 nonaka /* program RF filter */
2678 1.1 nonaka run_rt3070_rf_read(sc, 24, &rf); /* Tx */
2679 1.1 nonaka rf = (rf & ~0x3f) | sc->rf24_20mhz;
2680 1.1 nonaka run_rt3070_rf_write(sc, 24, rf);
2681 1.1 nonaka run_rt3070_rf_read(sc, 31, &rf); /* Rx */
2682 1.1 nonaka rf = (rf & ~0x3f) | sc->rf24_20mhz;
2683 1.1 nonaka run_rt3070_rf_write(sc, 31, rf);
2684 1.1 nonaka
2685 1.1 nonaka /* enable RF tuning */
2686 1.1 nonaka run_rt3070_rf_read(sc, 7, &rf);
2687 1.1 nonaka run_rt3070_rf_write(sc, 7, rf | 0x01);
2688 1.1 nonaka }
2689 1.1 nonaka
2690 1.1 nonaka static void
2691 1.1 nonaka run_rt3572_set_chan(struct run_softc *sc, u_int chan)
2692 1.1 nonaka {
2693 1.1 nonaka int8_t txpow1, txpow2;
2694 1.1 nonaka uint32_t tmp;
2695 1.1 nonaka uint8_t rf;
2696 1.1 nonaka int i;
2697 1.1 nonaka
2698 1.1 nonaka /* find the settings for this channel (we know it exists) */
2699 1.1 nonaka for (i = 0; rt2860_rf2850[i].chan != chan; i++);
2700 1.1 nonaka
2701 1.1 nonaka /* use Tx power values from EEPROM */
2702 1.1 nonaka txpow1 = sc->txpow1[i];
2703 1.1 nonaka txpow2 = sc->txpow2[i];
2704 1.1 nonaka
2705 1.1 nonaka if (chan <= 14) {
2706 1.1 nonaka run_bbp_write(sc, 25, sc->bbp25);
2707 1.1 nonaka run_bbp_write(sc, 26, sc->bbp26);
2708 1.1 nonaka } else {
2709 1.1 nonaka /* enable IQ phase correction */
2710 1.1 nonaka run_bbp_write(sc, 25, 0x09);
2711 1.1 nonaka run_bbp_write(sc, 26, 0xff);
2712 1.1 nonaka }
2713 1.1 nonaka
2714 1.1 nonaka run_rt3070_rf_write(sc, 2, rt3070_freqs[i].n);
2715 1.1 nonaka run_rt3070_rf_write(sc, 3, rt3070_freqs[i].k);
2716 1.1 nonaka run_rt3070_rf_read(sc, 6, &rf);
2717 1.1 nonaka rf = (rf & ~0x0f) | rt3070_freqs[i].r;
2718 1.1 nonaka rf |= (chan <= 14) ? 0x08 : 0x04;
2719 1.1 nonaka run_rt3070_rf_write(sc, 6, rf);
2720 1.1 nonaka
2721 1.1 nonaka /* set PLL mode */
2722 1.1 nonaka run_rt3070_rf_read(sc, 5, &rf);
2723 1.1 nonaka rf &= ~(0x08 | 0x04);
2724 1.1 nonaka rf |= (chan <= 14) ? 0x04 : 0x08;
2725 1.1 nonaka run_rt3070_rf_write(sc, 5, rf);
2726 1.1 nonaka
2727 1.1 nonaka /* set Tx power for chain 0 */
2728 1.1 nonaka if (chan <= 14)
2729 1.1 nonaka rf = 0x60 | txpow1;
2730 1.1 nonaka else
2731 1.1 nonaka rf = 0xe0 | (txpow1 & 0xc) << 1 | (txpow1 & 0x3);
2732 1.1 nonaka run_rt3070_rf_write(sc, 12, rf);
2733 1.1 nonaka
2734 1.1 nonaka /* set Tx power for chain 1 */
2735 1.1 nonaka if (chan <= 14)
2736 1.1 nonaka rf = 0x60 | txpow2;
2737 1.1 nonaka else
2738 1.1 nonaka rf = 0xe0 | (txpow2 & 0xc) << 1 | (txpow2 & 0x3);
2739 1.1 nonaka run_rt3070_rf_write(sc, 13, rf);
2740 1.1 nonaka
2741 1.1 nonaka /* set Tx/Rx streams */
2742 1.1 nonaka run_rt3070_rf_read(sc, 1, &rf);
2743 1.1 nonaka rf &= ~0xfc;
2744 1.1 nonaka if (sc->ntxchains == 1)
2745 1.1 nonaka rf |= 1 << 7 | 1 << 5; /* 1T: disable Tx chains 2 & 3 */
2746 1.1 nonaka else if (sc->ntxchains == 2)
2747 1.1 nonaka rf |= 1 << 7; /* 2T: disable Tx chain 3 */
2748 1.1 nonaka if (sc->nrxchains == 1)
2749 1.1 nonaka rf |= 1 << 6 | 1 << 4; /* 1R: disable Rx chains 2 & 3 */
2750 1.1 nonaka else if (sc->nrxchains == 2)
2751 1.1 nonaka rf |= 1 << 6; /* 2R: disable Rx chain 3 */
2752 1.1 nonaka run_rt3070_rf_write(sc, 1, rf);
2753 1.1 nonaka
2754 1.1 nonaka /* set RF offset */
2755 1.1 nonaka run_rt3070_rf_read(sc, 23, &rf);
2756 1.1 nonaka rf = (rf & ~0x7f) | sc->freq;
2757 1.1 nonaka run_rt3070_rf_write(sc, 23, rf);
2758 1.1 nonaka
2759 1.1 nonaka /* program RF filter */
2760 1.1 nonaka rf = sc->rf24_20mhz;
2761 1.1 nonaka run_rt3070_rf_write(sc, 24, rf); /* Tx */
2762 1.1 nonaka run_rt3070_rf_write(sc, 31, rf); /* Rx */
2763 1.1 nonaka
2764 1.1 nonaka /* enable RF tuning */
2765 1.1 nonaka run_rt3070_rf_read(sc, 7, &rf);
2766 1.1 nonaka rf = (chan <= 14) ? 0xd8 : ((rf & ~0xc8) | 0x14);
2767 1.1 nonaka run_rt3070_rf_write(sc, 7, rf);
2768 1.1 nonaka
2769 1.1 nonaka /* TSSI */
2770 1.1 nonaka rf = (chan <= 14) ? 0xc3 : 0xc0;
2771 1.1 nonaka run_rt3070_rf_write(sc, 9, rf);
2772 1.1 nonaka
2773 1.1 nonaka /* set loop filter 1 */
2774 1.1 nonaka run_rt3070_rf_write(sc, 10, 0xf1);
2775 1.1 nonaka /* set loop filter 2 */
2776 1.1 nonaka run_rt3070_rf_write(sc, 11, (chan <= 14) ? 0xb9 : 0x00);
2777 1.1 nonaka
2778 1.1 nonaka /* set tx_mx2_ic */
2779 1.1 nonaka run_rt3070_rf_write(sc, 15, (chan <= 14) ? 0x53 : 0x43);
2780 1.1 nonaka /* set tx_mx1_ic */
2781 1.1 nonaka if (chan <= 14)
2782 1.1 nonaka rf = 0x48 | sc->txmixgain_2ghz;
2783 1.1 nonaka else
2784 1.1 nonaka rf = 0x78 | sc->txmixgain_5ghz;
2785 1.1 nonaka run_rt3070_rf_write(sc, 16, rf);
2786 1.1 nonaka
2787 1.1 nonaka /* set tx_lo1 */
2788 1.1 nonaka run_rt3070_rf_write(sc, 17, 0x23);
2789 1.1 nonaka /* set tx_lo2 */
2790 1.1 nonaka if (chan <= 14)
2791 1.1 nonaka rf = 0x93;
2792 1.1 nonaka else if (chan <= 64)
2793 1.1 nonaka rf = 0xb7;
2794 1.1 nonaka else if (chan <= 128)
2795 1.1 nonaka rf = 0x74;
2796 1.1 nonaka else
2797 1.1 nonaka rf = 0x72;
2798 1.1 nonaka run_rt3070_rf_write(sc, 19, rf);
2799 1.1 nonaka
2800 1.1 nonaka /* set rx_lo1 */
2801 1.1 nonaka if (chan <= 14)
2802 1.1 nonaka rf = 0xb3;
2803 1.1 nonaka else if (chan <= 64)
2804 1.1 nonaka rf = 0xf6;
2805 1.1 nonaka else if (chan <= 128)
2806 1.1 nonaka rf = 0xf4;
2807 1.1 nonaka else
2808 1.1 nonaka rf = 0xf3;
2809 1.1 nonaka run_rt3070_rf_write(sc, 20, rf);
2810 1.1 nonaka
2811 1.1 nonaka /* set pfd_delay */
2812 1.1 nonaka if (chan <= 14)
2813 1.1 nonaka rf = 0x15;
2814 1.1 nonaka else if (chan <= 64)
2815 1.1 nonaka rf = 0x3d;
2816 1.1 nonaka else
2817 1.1 nonaka rf = 0x01;
2818 1.1 nonaka run_rt3070_rf_write(sc, 25, rf);
2819 1.1 nonaka
2820 1.1 nonaka /* set rx_lo2 */
2821 1.1 nonaka run_rt3070_rf_write(sc, 26, (chan <= 14) ? 0x85 : 0x87);
2822 1.1 nonaka /* set ldo_rf_vc */
2823 1.1 nonaka run_rt3070_rf_write(sc, 27, (chan <= 14) ? 0x00 : 0x01);
2824 1.1 nonaka /* set drv_cc */
2825 1.1 nonaka run_rt3070_rf_write(sc, 29, (chan <= 14) ? 0x9b : 0x9f);
2826 1.1 nonaka
2827 1.1 nonaka run_read(sc, RT2860_GPIO_CTRL, &tmp);
2828 1.1 nonaka tmp &= ~0x8080;
2829 1.1 nonaka if (chan <= 14)
2830 1.1 nonaka tmp |= 0x80;
2831 1.1 nonaka run_write(sc, RT2860_GPIO_CTRL, tmp);
2832 1.1 nonaka
2833 1.1 nonaka /* enable RF tuning */
2834 1.1 nonaka run_rt3070_rf_read(sc, 7, &rf);
2835 1.1 nonaka run_rt3070_rf_write(sc, 7, rf | 0x01);
2836 1.1 nonaka
2837 1.1 nonaka DELAY(2000);
2838 1.1 nonaka }
2839 1.1 nonaka
2840 1.1 nonaka static void
2841 1.1 nonaka run_set_agc(struct run_softc *sc, uint8_t agc)
2842 1.1 nonaka {
2843 1.1 nonaka uint8_t bbp;
2844 1.1 nonaka
2845 1.1 nonaka if (sc->mac_ver == 0x3572) {
2846 1.1 nonaka run_bbp_read(sc, 27, &bbp);
2847 1.1 nonaka bbp &= ~(0x3 << 5);
2848 1.1 nonaka run_bbp_write(sc, 27, bbp | 0 << 5); /* select Rx0 */
2849 1.1 nonaka run_bbp_write(sc, 66, agc);
2850 1.1 nonaka run_bbp_write(sc, 27, bbp | 1 << 5); /* select Rx1 */
2851 1.1 nonaka run_bbp_write(sc, 66, agc);
2852 1.1 nonaka } else
2853 1.1 nonaka run_bbp_write(sc, 66, agc);
2854 1.1 nonaka }
2855 1.1 nonaka
2856 1.1 nonaka static void
2857 1.1 nonaka run_set_rx_antenna(struct run_softc *sc, int aux)
2858 1.1 nonaka {
2859 1.1 nonaka uint32_t tmp;
2860 1.1 nonaka
2861 1.1 nonaka run_mcu_cmd(sc, RT2860_MCU_CMD_ANTSEL, !aux);
2862 1.1 nonaka run_read(sc, RT2860_GPIO_CTRL, &tmp);
2863 1.1 nonaka tmp &= ~0x0808;
2864 1.1 nonaka if (aux)
2865 1.1 nonaka tmp |= 0x08;
2866 1.1 nonaka run_write(sc, RT2860_GPIO_CTRL, tmp);
2867 1.1 nonaka }
2868 1.1 nonaka
2869 1.1 nonaka static int
2870 1.1 nonaka run_set_chan(struct run_softc *sc, struct ieee80211_channel *c)
2871 1.1 nonaka {
2872 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
2873 1.1 nonaka u_int chan, group;
2874 1.1 nonaka
2875 1.1 nonaka chan = ieee80211_chan2ieee(ic, c);
2876 1.1 nonaka if (chan == 0 || chan == IEEE80211_CHAN_ANY)
2877 1.10.6.2 skrll return EINVAL;
2878 1.1 nonaka
2879 1.1 nonaka if (sc->mac_ver == 0x3572)
2880 1.1 nonaka run_rt3572_set_chan(sc, chan);
2881 1.1 nonaka else if (sc->mac_ver >= 0x3070)
2882 1.1 nonaka run_rt3070_set_chan(sc, chan);
2883 1.1 nonaka else
2884 1.1 nonaka run_rt2870_set_chan(sc, chan);
2885 1.1 nonaka
2886 1.1 nonaka /* determine channel group */
2887 1.1 nonaka if (chan <= 14)
2888 1.1 nonaka group = 0;
2889 1.1 nonaka else if (chan <= 64)
2890 1.1 nonaka group = 1;
2891 1.1 nonaka else if (chan <= 128)
2892 1.1 nonaka group = 2;
2893 1.1 nonaka else
2894 1.1 nonaka group = 3;
2895 1.1 nonaka
2896 1.1 nonaka /* XXX necessary only when group has changed! */
2897 1.1 nonaka run_select_chan_group(sc, group);
2898 1.1 nonaka
2899 1.1 nonaka DELAY(1000);
2900 1.10.6.2 skrll return 0;
2901 1.1 nonaka }
2902 1.1 nonaka
2903 1.1 nonaka static void
2904 1.1 nonaka run_enable_tsf_sync(struct run_softc *sc)
2905 1.1 nonaka {
2906 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
2907 1.1 nonaka uint32_t tmp;
2908 1.1 nonaka
2909 1.1 nonaka run_read(sc, RT2860_BCN_TIME_CFG, &tmp);
2910 1.1 nonaka tmp &= ~0x1fffff;
2911 1.1 nonaka tmp |= ic->ic_bss->ni_intval * 16;
2912 1.1 nonaka tmp |= RT2860_TSF_TIMER_EN | RT2860_TBTT_TIMER_EN;
2913 1.1 nonaka if (ic->ic_opmode == IEEE80211_M_STA) {
2914 1.1 nonaka /*
2915 1.1 nonaka * Local TSF is always updated with remote TSF on beacon
2916 1.1 nonaka * reception.
2917 1.1 nonaka */
2918 1.1 nonaka tmp |= 1 << RT2860_TSF_SYNC_MODE_SHIFT;
2919 1.1 nonaka }
2920 1.1 nonaka #ifndef IEEE80211_STA_ONLY
2921 1.1 nonaka else if (ic->ic_opmode == IEEE80211_M_IBSS) {
2922 1.1 nonaka tmp |= RT2860_BCN_TX_EN;
2923 1.1 nonaka /*
2924 1.1 nonaka * Local TSF is updated with remote TSF on beacon reception
2925 1.1 nonaka * only if the remote TSF is greater than local TSF.
2926 1.1 nonaka */
2927 1.1 nonaka tmp |= 2 << RT2860_TSF_SYNC_MODE_SHIFT;
2928 1.1 nonaka } else if (ic->ic_opmode == IEEE80211_M_HOSTAP) {
2929 1.1 nonaka tmp |= RT2860_BCN_TX_EN;
2930 1.1 nonaka /* SYNC with nobody */
2931 1.1 nonaka tmp |= 3 << RT2860_TSF_SYNC_MODE_SHIFT;
2932 1.1 nonaka }
2933 1.1 nonaka #endif
2934 1.1 nonaka run_write(sc, RT2860_BCN_TIME_CFG, tmp);
2935 1.1 nonaka }
2936 1.1 nonaka
2937 1.1 nonaka static void
2938 1.1 nonaka run_enable_mrr(struct run_softc *sc)
2939 1.1 nonaka {
2940 1.1 nonaka #define CCK(mcs) (mcs)
2941 1.1 nonaka #define OFDM(mcs) (1 << 3 | (mcs))
2942 1.1 nonaka run_write(sc, RT2860_LG_FBK_CFG0,
2943 1.1 nonaka OFDM(6) << 28 | /* 54->48 */
2944 1.1 nonaka OFDM(5) << 24 | /* 48->36 */
2945 1.1 nonaka OFDM(4) << 20 | /* 36->24 */
2946 1.1 nonaka OFDM(3) << 16 | /* 24->18 */
2947 1.1 nonaka OFDM(2) << 12 | /* 18->12 */
2948 1.1 nonaka OFDM(1) << 8 | /* 12-> 9 */
2949 1.1 nonaka OFDM(0) << 4 | /* 9-> 6 */
2950 1.1 nonaka OFDM(0)); /* 6-> 6 */
2951 1.1 nonaka
2952 1.1 nonaka run_write(sc, RT2860_LG_FBK_CFG1,
2953 1.1 nonaka CCK(2) << 12 | /* 11->5.5 */
2954 1.1 nonaka CCK(1) << 8 | /* 5.5-> 2 */
2955 1.1 nonaka CCK(0) << 4 | /* 2-> 1 */
2956 1.1 nonaka CCK(0)); /* 1-> 1 */
2957 1.1 nonaka #undef OFDM
2958 1.1 nonaka #undef CCK
2959 1.1 nonaka }
2960 1.1 nonaka
2961 1.1 nonaka static void
2962 1.1 nonaka run_set_txpreamble(struct run_softc *sc)
2963 1.1 nonaka {
2964 1.1 nonaka uint32_t tmp;
2965 1.1 nonaka
2966 1.1 nonaka run_read(sc, RT2860_AUTO_RSP_CFG, &tmp);
2967 1.1 nonaka if (sc->sc_ic.ic_flags & IEEE80211_F_SHPREAMBLE)
2968 1.1 nonaka tmp |= RT2860_CCK_SHORT_EN;
2969 1.1 nonaka else
2970 1.1 nonaka tmp &= ~RT2860_CCK_SHORT_EN;
2971 1.1 nonaka run_write(sc, RT2860_AUTO_RSP_CFG, tmp);
2972 1.1 nonaka }
2973 1.1 nonaka
2974 1.1 nonaka static void
2975 1.1 nonaka run_set_basicrates(struct run_softc *sc)
2976 1.1 nonaka {
2977 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
2978 1.1 nonaka
2979 1.1 nonaka /* set basic rates mask */
2980 1.1 nonaka if (ic->ic_curmode == IEEE80211_MODE_11B)
2981 1.1 nonaka run_write(sc, RT2860_LEGACY_BASIC_RATE, 0x003);
2982 1.1 nonaka else if (ic->ic_curmode == IEEE80211_MODE_11A)
2983 1.1 nonaka run_write(sc, RT2860_LEGACY_BASIC_RATE, 0x150);
2984 1.1 nonaka else /* 11g */
2985 1.1 nonaka run_write(sc, RT2860_LEGACY_BASIC_RATE, 0x15f);
2986 1.1 nonaka }
2987 1.1 nonaka
2988 1.1 nonaka static void
2989 1.1 nonaka run_set_leds(struct run_softc *sc, uint16_t which)
2990 1.1 nonaka {
2991 1.1 nonaka
2992 1.1 nonaka (void)run_mcu_cmd(sc, RT2860_MCU_CMD_LEDS,
2993 1.1 nonaka which | (sc->leds & 0x7f));
2994 1.1 nonaka }
2995 1.1 nonaka
2996 1.1 nonaka static void
2997 1.1 nonaka run_set_bssid(struct run_softc *sc, const uint8_t *bssid)
2998 1.1 nonaka {
2999 1.1 nonaka
3000 1.1 nonaka run_write(sc, RT2860_MAC_BSSID_DW0,
3001 1.1 nonaka bssid[0] | bssid[1] << 8 | bssid[2] << 16 | bssid[3] << 24);
3002 1.1 nonaka run_write(sc, RT2860_MAC_BSSID_DW1,
3003 1.1 nonaka bssid[4] | bssid[5] << 8);
3004 1.1 nonaka }
3005 1.1 nonaka
3006 1.1 nonaka static void
3007 1.1 nonaka run_set_macaddr(struct run_softc *sc, const uint8_t *addr)
3008 1.1 nonaka {
3009 1.1 nonaka
3010 1.1 nonaka run_write(sc, RT2860_MAC_ADDR_DW0,
3011 1.1 nonaka addr[0] | addr[1] << 8 | addr[2] << 16 | addr[3] << 24);
3012 1.1 nonaka run_write(sc, RT2860_MAC_ADDR_DW1,
3013 1.1 nonaka addr[4] | addr[5] << 8 | 0xff << 16);
3014 1.1 nonaka }
3015 1.1 nonaka
3016 1.1 nonaka static void
3017 1.1 nonaka run_updateslot(struct ifnet *ifp)
3018 1.1 nonaka {
3019 1.1 nonaka
3020 1.1 nonaka /* do it in a process context */
3021 1.1 nonaka run_do_async(ifp->if_softc, run_updateslot_cb, NULL, 0);
3022 1.1 nonaka }
3023 1.1 nonaka
3024 1.1 nonaka /* ARGSUSED */
3025 1.1 nonaka static void
3026 1.1 nonaka run_updateslot_cb(struct run_softc *sc, void *arg)
3027 1.1 nonaka {
3028 1.1 nonaka uint32_t tmp;
3029 1.1 nonaka
3030 1.1 nonaka run_read(sc, RT2860_BKOFF_SLOT_CFG, &tmp);
3031 1.1 nonaka tmp &= ~0xff;
3032 1.1 nonaka tmp |= (sc->sc_ic.ic_flags & IEEE80211_F_SHSLOT) ? 9 : 20;
3033 1.1 nonaka run_write(sc, RT2860_BKOFF_SLOT_CFG, tmp);
3034 1.1 nonaka }
3035 1.1 nonaka
3036 1.1 nonaka static int8_t
3037 1.1 nonaka run_rssi2dbm(struct run_softc *sc, uint8_t rssi, uint8_t rxchain)
3038 1.1 nonaka {
3039 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
3040 1.1 nonaka struct ieee80211_channel *c = ic->ic_curchan;
3041 1.1 nonaka int delta;
3042 1.1 nonaka
3043 1.1 nonaka if (IEEE80211_IS_CHAN_5GHZ(c)) {
3044 1.1 nonaka u_int chan = ieee80211_chan2ieee(ic, c);
3045 1.1 nonaka delta = sc->rssi_5ghz[rxchain];
3046 1.1 nonaka
3047 1.1 nonaka /* determine channel group */
3048 1.1 nonaka if (chan <= 64)
3049 1.1 nonaka delta -= sc->lna[1];
3050 1.1 nonaka else if (chan <= 128)
3051 1.1 nonaka delta -= sc->lna[2];
3052 1.1 nonaka else
3053 1.1 nonaka delta -= sc->lna[3];
3054 1.1 nonaka } else
3055 1.1 nonaka delta = sc->rssi_2ghz[rxchain] - sc->lna[0];
3056 1.1 nonaka
3057 1.10.6.2 skrll return -12 - delta - rssi;
3058 1.1 nonaka }
3059 1.1 nonaka
3060 1.1 nonaka static int
3061 1.1 nonaka run_bbp_init(struct run_softc *sc)
3062 1.1 nonaka {
3063 1.1 nonaka int i, error, ntries;
3064 1.1 nonaka uint8_t bbp0;
3065 1.1 nonaka
3066 1.1 nonaka /* wait for BBP to wake up */
3067 1.1 nonaka for (ntries = 0; ntries < 20; ntries++) {
3068 1.1 nonaka if ((error = run_bbp_read(sc, 0, &bbp0)) != 0)
3069 1.10.6.2 skrll return error;
3070 1.1 nonaka if (bbp0 != 0 && bbp0 != 0xff)
3071 1.1 nonaka break;
3072 1.1 nonaka }
3073 1.1 nonaka if (ntries == 20)
3074 1.10.6.2 skrll return ETIMEDOUT;
3075 1.1 nonaka
3076 1.1 nonaka /* initialize BBP registers to default values */
3077 1.1 nonaka for (i = 0; i < (int)__arraycount(rt2860_def_bbp); i++) {
3078 1.1 nonaka run_bbp_write(sc, rt2860_def_bbp[i].reg,
3079 1.1 nonaka rt2860_def_bbp[i].val);
3080 1.1 nonaka }
3081 1.1 nonaka
3082 1.1 nonaka /* fix BBP84 for RT2860E */
3083 1.1 nonaka if (sc->mac_ver == 0x2860 && sc->mac_rev != 0x0101)
3084 1.1 nonaka run_bbp_write(sc, 84, 0x19);
3085 1.1 nonaka
3086 1.1 nonaka if (sc->mac_ver >= 0x3070) {
3087 1.1 nonaka run_bbp_write(sc, 79, 0x13);
3088 1.1 nonaka run_bbp_write(sc, 80, 0x05);
3089 1.1 nonaka run_bbp_write(sc, 81, 0x33);
3090 1.1 nonaka } else if (sc->mac_ver == 0x2860 && sc->mac_rev == 0x0100) {
3091 1.1 nonaka run_bbp_write(sc, 69, 0x16);
3092 1.1 nonaka run_bbp_write(sc, 73, 0x12);
3093 1.1 nonaka }
3094 1.10.6.2 skrll return 0;
3095 1.1 nonaka }
3096 1.1 nonaka
3097 1.1 nonaka static int
3098 1.1 nonaka run_rt3070_rf_init(struct run_softc *sc)
3099 1.1 nonaka {
3100 1.1 nonaka uint32_t tmp;
3101 1.1 nonaka uint8_t rf, target, bbp4;
3102 1.1 nonaka int i;
3103 1.1 nonaka
3104 1.1 nonaka run_rt3070_rf_read(sc, 30, &rf);
3105 1.1 nonaka /* toggle RF R30 bit 7 */
3106 1.1 nonaka run_rt3070_rf_write(sc, 30, rf | 0x80);
3107 1.1 nonaka DELAY(1000);
3108 1.1 nonaka run_rt3070_rf_write(sc, 30, rf & ~0x80);
3109 1.1 nonaka
3110 1.1 nonaka /* initialize RF registers to default value */
3111 1.1 nonaka if (sc->mac_ver == 0x3572) {
3112 1.1 nonaka for (i = 0; i < (int)__arraycount(rt3572_def_rf); i++) {
3113 1.1 nonaka run_rt3070_rf_write(sc, rt3572_def_rf[i].reg,
3114 1.1 nonaka rt3572_def_rf[i].val);
3115 1.1 nonaka }
3116 1.1 nonaka } else {
3117 1.1 nonaka for (i = 0; i < (int)__arraycount(rt3070_def_rf); i++) {
3118 1.1 nonaka run_rt3070_rf_write(sc, rt3070_def_rf[i].reg,
3119 1.1 nonaka rt3070_def_rf[i].val);
3120 1.1 nonaka }
3121 1.1 nonaka }
3122 1.1 nonaka if (sc->mac_ver == 0x3572) {
3123 1.1 nonaka run_rt3070_rf_read(sc, 6, &rf);
3124 1.1 nonaka run_rt3070_rf_write(sc, 6, rf | 0x40);
3125 1.1 nonaka
3126 1.1 nonaka /* increase voltage from 1.2V to 1.35V */
3127 1.1 nonaka run_read(sc, RT3070_LDO_CFG0, &tmp);
3128 1.1 nonaka tmp = (tmp & ~0x1f000000) | 0x0d000000;
3129 1.1 nonaka run_write(sc, RT3070_LDO_CFG0, tmp);
3130 1.1 nonaka if (sc->mac_rev >= 0x0211 || !sc->patch_dac) {
3131 1.1 nonaka /* decrease voltage back to 1.2V */
3132 1.1 nonaka DELAY(1000);
3133 1.1 nonaka tmp = (tmp & ~0x1f000000) | 0x01000000;
3134 1.1 nonaka run_write(sc, RT3070_LDO_CFG0, tmp);
3135 1.1 nonaka }
3136 1.1 nonaka } else if (sc->mac_ver == 0x3071) {
3137 1.1 nonaka run_rt3070_rf_read(sc, 6, &rf);
3138 1.1 nonaka run_rt3070_rf_write(sc, 6, rf | 0x40);
3139 1.1 nonaka run_rt3070_rf_write(sc, 31, 0x14);
3140 1.1 nonaka
3141 1.1 nonaka run_read(sc, RT3070_LDO_CFG0, &tmp);
3142 1.1 nonaka tmp &= ~0x1f000000;
3143 1.1 nonaka if (sc->mac_rev < 0x0211)
3144 1.1 nonaka tmp |= 0x0d000000; /* 1.35V */
3145 1.1 nonaka else
3146 1.1 nonaka tmp |= 0x01000000; /* 1.2V */
3147 1.1 nonaka run_write(sc, RT3070_LDO_CFG0, tmp);
3148 1.1 nonaka
3149 1.1 nonaka /* patch LNA_PE_G1 */
3150 1.1 nonaka run_read(sc, RT3070_GPIO_SWITCH, &tmp);
3151 1.1 nonaka run_write(sc, RT3070_GPIO_SWITCH, tmp & ~0x20);
3152 1.1 nonaka } else if (sc->mac_ver == 0x3070) {
3153 1.1 nonaka /* increase voltage from 1.2V to 1.35V */
3154 1.1 nonaka run_read(sc, RT3070_LDO_CFG0, &tmp);
3155 1.1 nonaka tmp = (tmp & ~0x0f000000) | 0x0d000000;
3156 1.1 nonaka run_write(sc, RT3070_LDO_CFG0, tmp);
3157 1.1 nonaka }
3158 1.1 nonaka
3159 1.1 nonaka /* select 20MHz bandwidth */
3160 1.1 nonaka run_rt3070_rf_read(sc, 31, &rf);
3161 1.1 nonaka run_rt3070_rf_write(sc, 31, rf & ~0x20);
3162 1.1 nonaka
3163 1.1 nonaka /* calibrate filter for 20MHz bandwidth */
3164 1.1 nonaka sc->rf24_20mhz = 0x1f; /* default value */
3165 1.1 nonaka target = (sc->mac_ver < 0x3071) ? 0x16 : 0x13;
3166 1.1 nonaka run_rt3070_filter_calib(sc, 0x07, target, &sc->rf24_20mhz);
3167 1.1 nonaka
3168 1.1 nonaka /* select 40MHz bandwidth */
3169 1.1 nonaka run_bbp_read(sc, 4, &bbp4);
3170 1.1 nonaka run_bbp_write(sc, 4, (bbp4 & ~0x08) | 0x10);
3171 1.1 nonaka run_rt3070_rf_read(sc, 31, &rf);
3172 1.1 nonaka run_rt3070_rf_write(sc, 31, rf | 0x20);
3173 1.1 nonaka
3174 1.1 nonaka /* calibrate filter for 40MHz bandwidth */
3175 1.1 nonaka sc->rf24_40mhz = 0x2f; /* default value */
3176 1.1 nonaka target = (sc->mac_ver < 0x3071) ? 0x19 : 0x15;
3177 1.1 nonaka run_rt3070_filter_calib(sc, 0x27, target, &sc->rf24_40mhz);
3178 1.1 nonaka
3179 1.1 nonaka /* go back to 20MHz bandwidth */
3180 1.1 nonaka run_bbp_read(sc, 4, &bbp4);
3181 1.1 nonaka run_bbp_write(sc, 4, bbp4 & ~0x18);
3182 1.1 nonaka
3183 1.1 nonaka if (sc->mac_ver == 0x3572) {
3184 1.1 nonaka /* save default BBP registers 25 and 26 values */
3185 1.1 nonaka run_bbp_read(sc, 25, &sc->bbp25);
3186 1.1 nonaka run_bbp_read(sc, 26, &sc->bbp26);
3187 1.1 nonaka } else if (sc->mac_rev < 0x0211)
3188 1.1 nonaka run_rt3070_rf_write(sc, 27, 0x03);
3189 1.1 nonaka
3190 1.1 nonaka run_read(sc, RT3070_OPT_14, &tmp);
3191 1.1 nonaka run_write(sc, RT3070_OPT_14, tmp | 1);
3192 1.1 nonaka
3193 1.1 nonaka if (sc->mac_ver == 0x3070 || sc->mac_ver == 0x3071) {
3194 1.1 nonaka run_rt3070_rf_read(sc, 17, &rf);
3195 1.1 nonaka rf &= ~RT3070_TX_LO1;
3196 1.1 nonaka if ((sc->mac_ver == 0x3070 ||
3197 1.1 nonaka (sc->mac_ver == 0x3071 && sc->mac_rev >= 0x0211)) &&
3198 1.1 nonaka !sc->ext_2ghz_lna)
3199 1.1 nonaka rf |= 0x20; /* fix for long range Rx issue */
3200 1.1 nonaka if (sc->txmixgain_2ghz >= 1)
3201 1.1 nonaka rf = (rf & ~0x7) | sc->txmixgain_2ghz;
3202 1.1 nonaka run_rt3070_rf_write(sc, 17, rf);
3203 1.1 nonaka }
3204 1.1 nonaka if (sc->mac_ver == 0x3071) {
3205 1.1 nonaka run_rt3070_rf_read(sc, 1, &rf);
3206 1.1 nonaka rf &= ~(RT3070_RX0_PD | RT3070_TX0_PD);
3207 1.1 nonaka rf |= RT3070_RF_BLOCK | RT3070_RX1_PD | RT3070_TX1_PD;
3208 1.1 nonaka run_rt3070_rf_write(sc, 1, rf);
3209 1.1 nonaka
3210 1.1 nonaka run_rt3070_rf_read(sc, 15, &rf);
3211 1.1 nonaka run_rt3070_rf_write(sc, 15, rf & ~RT3070_TX_LO2);
3212 1.1 nonaka
3213 1.1 nonaka run_rt3070_rf_read(sc, 20, &rf);
3214 1.1 nonaka run_rt3070_rf_write(sc, 20, rf & ~RT3070_RX_LO1);
3215 1.1 nonaka
3216 1.1 nonaka run_rt3070_rf_read(sc, 21, &rf);
3217 1.1 nonaka run_rt3070_rf_write(sc, 21, rf & ~RT3070_RX_LO2);
3218 1.1 nonaka }
3219 1.1 nonaka if (sc->mac_ver == 0x3070 || sc->mac_ver == 0x3071) {
3220 1.1 nonaka /* fix Tx to Rx IQ glitch by raising RF voltage */
3221 1.1 nonaka run_rt3070_rf_read(sc, 27, &rf);
3222 1.1 nonaka rf &= ~0x77;
3223 1.1 nonaka if (sc->mac_rev < 0x0211)
3224 1.1 nonaka rf |= 0x03;
3225 1.1 nonaka run_rt3070_rf_write(sc, 27, rf);
3226 1.1 nonaka }
3227 1.10.6.2 skrll return 0;
3228 1.1 nonaka }
3229 1.1 nonaka
3230 1.1 nonaka static int
3231 1.1 nonaka run_rt3070_filter_calib(struct run_softc *sc, uint8_t init, uint8_t target,
3232 1.1 nonaka uint8_t *val)
3233 1.1 nonaka {
3234 1.1 nonaka uint8_t rf22, rf24;
3235 1.1 nonaka uint8_t bbp55_pb, bbp55_sb, delta;
3236 1.1 nonaka int ntries;
3237 1.1 nonaka
3238 1.1 nonaka /* program filter */
3239 1.1 nonaka run_rt3070_rf_read(sc, 24, &rf24);
3240 1.1 nonaka rf24 = (rf24 & 0xc0) | init; /* initial filter value */
3241 1.1 nonaka run_rt3070_rf_write(sc, 24, rf24);
3242 1.1 nonaka
3243 1.1 nonaka /* enable baseband loopback mode */
3244 1.1 nonaka run_rt3070_rf_read(sc, 22, &rf22);
3245 1.1 nonaka run_rt3070_rf_write(sc, 22, rf22 | 0x01);
3246 1.1 nonaka
3247 1.1 nonaka /* set power and frequency of passband test tone */
3248 1.1 nonaka run_bbp_write(sc, 24, 0x00);
3249 1.1 nonaka for (ntries = 0; ntries < 100; ntries++) {
3250 1.1 nonaka /* transmit test tone */
3251 1.1 nonaka run_bbp_write(sc, 25, 0x90);
3252 1.1 nonaka DELAY(1000);
3253 1.1 nonaka /* read received power */
3254 1.1 nonaka run_bbp_read(sc, 55, &bbp55_pb);
3255 1.1 nonaka if (bbp55_pb != 0)
3256 1.1 nonaka break;
3257 1.1 nonaka }
3258 1.1 nonaka if (ntries == 100)
3259 1.10.6.2 skrll return ETIMEDOUT;
3260 1.1 nonaka
3261 1.1 nonaka /* set power and frequency of stopband test tone */
3262 1.1 nonaka run_bbp_write(sc, 24, 0x06);
3263 1.1 nonaka for (ntries = 0; ntries < 100; ntries++) {
3264 1.1 nonaka /* transmit test tone */
3265 1.1 nonaka run_bbp_write(sc, 25, 0x90);
3266 1.1 nonaka DELAY(1000);
3267 1.1 nonaka /* read received power */
3268 1.1 nonaka run_bbp_read(sc, 55, &bbp55_sb);
3269 1.1 nonaka
3270 1.1 nonaka delta = bbp55_pb - bbp55_sb;
3271 1.1 nonaka if (delta > target)
3272 1.1 nonaka break;
3273 1.1 nonaka
3274 1.1 nonaka /* reprogram filter */
3275 1.1 nonaka rf24++;
3276 1.1 nonaka run_rt3070_rf_write(sc, 24, rf24);
3277 1.1 nonaka }
3278 1.1 nonaka if (ntries < 100) {
3279 1.1 nonaka if (rf24 != init)
3280 1.1 nonaka rf24--; /* backtrack */
3281 1.1 nonaka *val = rf24;
3282 1.1 nonaka run_rt3070_rf_write(sc, 24, rf24);
3283 1.1 nonaka }
3284 1.1 nonaka
3285 1.1 nonaka /* restore initial state */
3286 1.1 nonaka run_bbp_write(sc, 24, 0x00);
3287 1.1 nonaka
3288 1.1 nonaka /* disable baseband loopback mode */
3289 1.1 nonaka run_rt3070_rf_read(sc, 22, &rf22);
3290 1.1 nonaka run_rt3070_rf_write(sc, 22, rf22 & ~0x01);
3291 1.1 nonaka
3292 1.10.6.2 skrll return 0;
3293 1.1 nonaka }
3294 1.1 nonaka
3295 1.1 nonaka static void
3296 1.1 nonaka run_rt3070_rf_setup(struct run_softc *sc)
3297 1.1 nonaka {
3298 1.1 nonaka uint8_t bbp, rf;
3299 1.1 nonaka int i;
3300 1.1 nonaka
3301 1.1 nonaka if (sc->mac_ver == 0x3572) {
3302 1.1 nonaka /* enable DC filter */
3303 1.1 nonaka if (sc->mac_rev >= 0x0201)
3304 1.1 nonaka run_bbp_write(sc, 103, 0xc0);
3305 1.1 nonaka
3306 1.1 nonaka run_bbp_read(sc, 138, &bbp);
3307 1.1 nonaka if (sc->ntxchains == 1)
3308 1.1 nonaka bbp |= 0x20; /* turn off DAC1 */
3309 1.1 nonaka if (sc->nrxchains == 1)
3310 1.1 nonaka bbp &= ~0x02; /* turn off ADC1 */
3311 1.1 nonaka run_bbp_write(sc, 138, bbp);
3312 1.1 nonaka
3313 1.1 nonaka if (sc->mac_rev >= 0x0211) {
3314 1.1 nonaka /* improve power consumption */
3315 1.1 nonaka run_bbp_read(sc, 31, &bbp);
3316 1.1 nonaka run_bbp_write(sc, 31, bbp & ~0x03);
3317 1.1 nonaka }
3318 1.1 nonaka
3319 1.1 nonaka run_rt3070_rf_read(sc, 16, &rf);
3320 1.1 nonaka rf = (rf & ~0x07) | sc->txmixgain_2ghz;
3321 1.1 nonaka run_rt3070_rf_write(sc, 16, rf);
3322 1.1 nonaka } else if (sc->mac_ver == 0x3071) {
3323 1.1 nonaka /* enable DC filter */
3324 1.1 nonaka if (sc->mac_rev >= 0x0201)
3325 1.1 nonaka run_bbp_write(sc, 103, 0xc0);
3326 1.1 nonaka
3327 1.1 nonaka run_bbp_read(sc, 138, &bbp);
3328 1.1 nonaka if (sc->ntxchains == 1)
3329 1.1 nonaka bbp |= 0x20; /* turn off DAC1 */
3330 1.1 nonaka if (sc->nrxchains == 1)
3331 1.1 nonaka bbp &= ~0x02; /* turn off ADC1 */
3332 1.1 nonaka run_bbp_write(sc, 138, bbp);
3333 1.1 nonaka
3334 1.1 nonaka if (sc->mac_rev >= 0x0211) {
3335 1.1 nonaka /* improve power consumption */
3336 1.1 nonaka run_bbp_read(sc, 31, &bbp);
3337 1.1 nonaka run_bbp_write(sc, 31, bbp & ~0x03);
3338 1.1 nonaka }
3339 1.1 nonaka
3340 1.1 nonaka run_write(sc, RT2860_TX_SW_CFG1, 0);
3341 1.1 nonaka if (sc->mac_rev < 0x0211) {
3342 1.1 nonaka run_write(sc, RT2860_TX_SW_CFG2,
3343 1.1 nonaka sc->patch_dac ? 0x2c : 0x0f);
3344 1.1 nonaka } else
3345 1.1 nonaka run_write(sc, RT2860_TX_SW_CFG2, 0);
3346 1.1 nonaka } else if (sc->mac_ver == 0x3070) {
3347 1.1 nonaka if (sc->mac_rev >= 0x0201) {
3348 1.1 nonaka /* enable DC filter */
3349 1.1 nonaka run_bbp_write(sc, 103, 0xc0);
3350 1.1 nonaka
3351 1.1 nonaka /* improve power consumption */
3352 1.1 nonaka run_bbp_read(sc, 31, &bbp);
3353 1.1 nonaka run_bbp_write(sc, 31, bbp & ~0x03);
3354 1.1 nonaka }
3355 1.1 nonaka
3356 1.1 nonaka if (sc->mac_rev < 0x0211) {
3357 1.1 nonaka run_write(sc, RT2860_TX_SW_CFG1, 0);
3358 1.1 nonaka run_write(sc, RT2860_TX_SW_CFG2, 0x2c);
3359 1.1 nonaka } else
3360 1.1 nonaka run_write(sc, RT2860_TX_SW_CFG2, 0);
3361 1.1 nonaka }
3362 1.1 nonaka
3363 1.1 nonaka /* initialize RF registers from ROM for >=RT3071*/
3364 1.1 nonaka if (sc->mac_ver >= 0x3071) {
3365 1.1 nonaka for (i = 0; i < 10; i++) {
3366 1.1 nonaka if (sc->rf[i].reg == 0 || sc->rf[i].reg == 0xff)
3367 1.1 nonaka continue;
3368 1.1 nonaka run_rt3070_rf_write(sc, sc->rf[i].reg, sc->rf[i].val);
3369 1.1 nonaka }
3370 1.1 nonaka }
3371 1.1 nonaka }
3372 1.1 nonaka
3373 1.1 nonaka static int
3374 1.1 nonaka run_txrx_enable(struct run_softc *sc)
3375 1.1 nonaka {
3376 1.1 nonaka uint32_t tmp;
3377 1.1 nonaka int error, ntries;
3378 1.1 nonaka
3379 1.1 nonaka run_write(sc, RT2860_MAC_SYS_CTRL, RT2860_MAC_TX_EN);
3380 1.1 nonaka for (ntries = 0; ntries < 200; ntries++) {
3381 1.1 nonaka if ((error = run_read(sc, RT2860_WPDMA_GLO_CFG, &tmp)) != 0)
3382 1.10.6.2 skrll return error;
3383 1.1 nonaka if ((tmp & (RT2860_TX_DMA_BUSY | RT2860_RX_DMA_BUSY)) == 0)
3384 1.1 nonaka break;
3385 1.1 nonaka DELAY(1000);
3386 1.1 nonaka }
3387 1.1 nonaka if (ntries == 200)
3388 1.10.6.2 skrll return ETIMEDOUT;
3389 1.1 nonaka
3390 1.1 nonaka DELAY(50);
3391 1.1 nonaka
3392 1.1 nonaka tmp |= RT2860_RX_DMA_EN | RT2860_TX_DMA_EN | RT2860_TX_WB_DDONE;
3393 1.1 nonaka run_write(sc, RT2860_WPDMA_GLO_CFG, tmp);
3394 1.1 nonaka
3395 1.1 nonaka /* enable Rx bulk aggregation (set timeout and limit) */
3396 1.1 nonaka tmp = RT2860_USB_TX_EN | RT2860_USB_RX_EN | RT2860_USB_RX_AGG_EN |
3397 1.1 nonaka RT2860_USB_RX_AGG_TO(128) | RT2860_USB_RX_AGG_LMT(2);
3398 1.1 nonaka run_write(sc, RT2860_USB_DMA_CFG, tmp);
3399 1.1 nonaka
3400 1.1 nonaka /* set Rx filter */
3401 1.1 nonaka tmp = RT2860_DROP_CRC_ERR | RT2860_DROP_PHY_ERR;
3402 1.1 nonaka if (sc->sc_ic.ic_opmode != IEEE80211_M_MONITOR) {
3403 1.1 nonaka tmp |= RT2860_DROP_UC_NOME | RT2860_DROP_DUPL |
3404 1.1 nonaka RT2860_DROP_CTS | RT2860_DROP_BA | RT2860_DROP_ACK |
3405 1.1 nonaka RT2860_DROP_VER_ERR | RT2860_DROP_CTRL_RSV |
3406 1.1 nonaka RT2860_DROP_CFACK | RT2860_DROP_CFEND;
3407 1.1 nonaka if (sc->sc_ic.ic_opmode == IEEE80211_M_STA)
3408 1.1 nonaka tmp |= RT2860_DROP_RTS | RT2860_DROP_PSPOLL;
3409 1.1 nonaka }
3410 1.1 nonaka run_write(sc, RT2860_RX_FILTR_CFG, tmp);
3411 1.1 nonaka
3412 1.1 nonaka run_write(sc, RT2860_MAC_SYS_CTRL,
3413 1.1 nonaka RT2860_MAC_RX_EN | RT2860_MAC_TX_EN);
3414 1.1 nonaka
3415 1.10.6.2 skrll return 0;
3416 1.1 nonaka }
3417 1.1 nonaka
3418 1.1 nonaka static int
3419 1.1 nonaka run_init(struct ifnet *ifp)
3420 1.1 nonaka {
3421 1.1 nonaka struct run_softc *sc = ifp->if_softc;
3422 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
3423 1.1 nonaka uint32_t tmp;
3424 1.1 nonaka uint8_t bbp1, bbp3;
3425 1.1 nonaka int i, error, qid, ridx, ntries;
3426 1.1 nonaka
3427 1.1 nonaka for (ntries = 0; ntries < 100; ntries++) {
3428 1.1 nonaka if ((error = run_read(sc, RT2860_ASIC_VER_ID, &tmp)) != 0)
3429 1.1 nonaka goto fail;
3430 1.1 nonaka if (tmp != 0 && tmp != 0xffffffff)
3431 1.1 nonaka break;
3432 1.1 nonaka DELAY(10);
3433 1.1 nonaka }
3434 1.1 nonaka if (ntries == 100) {
3435 1.1 nonaka error = ETIMEDOUT;
3436 1.1 nonaka goto fail;
3437 1.1 nonaka }
3438 1.1 nonaka
3439 1.1 nonaka if ((sc->sc_flags & RUN_FWLOADED) == 0 &&
3440 1.1 nonaka (error = run_load_microcode(sc)) != 0) {
3441 1.1 nonaka aprint_error_dev(sc->sc_dev,
3442 1.1 nonaka "could not load 8051 microcode\n");
3443 1.1 nonaka goto fail;
3444 1.1 nonaka }
3445 1.1 nonaka
3446 1.1 nonaka if (ifp->if_flags & IFF_RUNNING)
3447 1.1 nonaka run_stop(ifp, 0);
3448 1.1 nonaka
3449 1.1 nonaka /* init host command ring */
3450 1.1 nonaka sc->cmdq.cur = sc->cmdq.next = sc->cmdq.queued = 0;
3451 1.1 nonaka
3452 1.1 nonaka /* init Tx rings (4 EDCAs) */
3453 1.1 nonaka for (qid = 0; qid < 4; qid++) {
3454 1.1 nonaka if ((error = run_alloc_tx_ring(sc, qid)) != 0)
3455 1.1 nonaka goto fail;
3456 1.1 nonaka }
3457 1.1 nonaka /* init Rx ring */
3458 1.1 nonaka if ((error = run_alloc_rx_ring(sc)) != 0)
3459 1.1 nonaka goto fail;
3460 1.1 nonaka
3461 1.1 nonaka IEEE80211_ADDR_COPY(ic->ic_myaddr, CLLADDR(ifp->if_sadl));
3462 1.1 nonaka run_set_macaddr(sc, ic->ic_myaddr);
3463 1.1 nonaka
3464 1.1 nonaka for (ntries = 0; ntries < 100; ntries++) {
3465 1.1 nonaka if ((error = run_read(sc, RT2860_WPDMA_GLO_CFG, &tmp)) != 0)
3466 1.1 nonaka goto fail;
3467 1.1 nonaka if ((tmp & (RT2860_TX_DMA_BUSY | RT2860_RX_DMA_BUSY)) == 0)
3468 1.1 nonaka break;
3469 1.1 nonaka DELAY(1000);
3470 1.1 nonaka }
3471 1.1 nonaka if (ntries == 100) {
3472 1.1 nonaka aprint_error_dev(sc->sc_dev,
3473 1.1 nonaka "timeout waiting for DMA engine\n");
3474 1.1 nonaka error = ETIMEDOUT;
3475 1.1 nonaka goto fail;
3476 1.1 nonaka }
3477 1.1 nonaka tmp &= 0xff0;
3478 1.1 nonaka tmp |= RT2860_TX_WB_DDONE;
3479 1.1 nonaka run_write(sc, RT2860_WPDMA_GLO_CFG, tmp);
3480 1.1 nonaka
3481 1.1 nonaka /* turn off PME_OEN to solve high-current issue */
3482 1.1 nonaka run_read(sc, RT2860_SYS_CTRL, &tmp);
3483 1.1 nonaka run_write(sc, RT2860_SYS_CTRL, tmp & ~RT2860_PME_OEN);
3484 1.1 nonaka
3485 1.1 nonaka run_write(sc, RT2860_MAC_SYS_CTRL,
3486 1.1 nonaka RT2860_BBP_HRST | RT2860_MAC_SRST);
3487 1.1 nonaka run_write(sc, RT2860_USB_DMA_CFG, 0);
3488 1.1 nonaka
3489 1.1 nonaka if ((error = run_reset(sc)) != 0) {
3490 1.1 nonaka aprint_error_dev(sc->sc_dev, "could not reset chipset\n");
3491 1.1 nonaka goto fail;
3492 1.1 nonaka }
3493 1.1 nonaka
3494 1.1 nonaka run_write(sc, RT2860_MAC_SYS_CTRL, 0);
3495 1.1 nonaka
3496 1.1 nonaka /* init Tx power for all Tx rates (from EEPROM) */
3497 1.1 nonaka for (ridx = 0; ridx < 5; ridx++) {
3498 1.1 nonaka if (sc->txpow20mhz[ridx] == 0xffffffff)
3499 1.1 nonaka continue;
3500 1.1 nonaka run_write(sc, RT2860_TX_PWR_CFG(ridx), sc->txpow20mhz[ridx]);
3501 1.1 nonaka }
3502 1.1 nonaka
3503 1.1 nonaka for (i = 0; i < (int)__arraycount(rt2870_def_mac); i++)
3504 1.1 nonaka run_write(sc, rt2870_def_mac[i].reg, rt2870_def_mac[i].val);
3505 1.1 nonaka run_write(sc, RT2860_WMM_AIFSN_CFG, 0x00002273);
3506 1.1 nonaka run_write(sc, RT2860_WMM_CWMIN_CFG, 0x00002344);
3507 1.1 nonaka run_write(sc, RT2860_WMM_CWMAX_CFG, 0x000034aa);
3508 1.1 nonaka
3509 1.1 nonaka if (sc->mac_ver >= 0x3070) {
3510 1.1 nonaka /* set delay of PA_PE assertion to 1us (unit of 0.25us) */
3511 1.1 nonaka run_write(sc, RT2860_TX_SW_CFG0,
3512 1.1 nonaka 4 << RT2860_DLY_PAPE_EN_SHIFT);
3513 1.1 nonaka }
3514 1.1 nonaka
3515 1.1 nonaka /* wait while MAC is busy */
3516 1.1 nonaka for (ntries = 0; ntries < 100; ntries++) {
3517 1.1 nonaka if ((error = run_read(sc, RT2860_MAC_STATUS_REG, &tmp)) != 0)
3518 1.1 nonaka goto fail;
3519 1.1 nonaka if (!(tmp & (RT2860_RX_STATUS_BUSY | RT2860_TX_STATUS_BUSY)))
3520 1.1 nonaka break;
3521 1.1 nonaka DELAY(1000);
3522 1.1 nonaka }
3523 1.1 nonaka if (ntries == 100) {
3524 1.1 nonaka error = ETIMEDOUT;
3525 1.1 nonaka goto fail;
3526 1.1 nonaka }
3527 1.1 nonaka
3528 1.1 nonaka /* clear Host to MCU mailbox */
3529 1.1 nonaka run_write(sc, RT2860_H2M_BBPAGENT, 0);
3530 1.1 nonaka run_write(sc, RT2860_H2M_MAILBOX, 0);
3531 1.1 nonaka DELAY(1000);
3532 1.1 nonaka
3533 1.1 nonaka if ((error = run_bbp_init(sc)) != 0) {
3534 1.1 nonaka aprint_error_dev(sc->sc_dev, "could not initialize BBP\n");
3535 1.1 nonaka goto fail;
3536 1.1 nonaka }
3537 1.1 nonaka
3538 1.1 nonaka run_read(sc, RT2860_BCN_TIME_CFG, &tmp);
3539 1.1 nonaka tmp &= ~(RT2860_BCN_TX_EN | RT2860_TSF_TIMER_EN |
3540 1.1 nonaka RT2860_TBTT_TIMER_EN);
3541 1.1 nonaka run_write(sc, RT2860_BCN_TIME_CFG, tmp);
3542 1.1 nonaka
3543 1.1 nonaka /* clear RX WCID search table */
3544 1.1 nonaka run_set_region_4(sc, RT2860_WCID_ENTRY(0), 0, 512);
3545 1.1 nonaka /* clear Pair-wise key table */
3546 1.1 nonaka run_set_region_4(sc, RT2860_PKEY(0), 0, 2048);
3547 1.1 nonaka /* clear IV/EIV table */
3548 1.1 nonaka run_set_region_4(sc, RT2860_IVEIV(0), 0, 512);
3549 1.1 nonaka /* clear WCID attribute table */
3550 1.1 nonaka run_set_region_4(sc, RT2860_WCID_ATTR(0), 0, 8 * 32);
3551 1.1 nonaka /* clear shared key table */
3552 1.1 nonaka run_set_region_4(sc, RT2860_SKEY(0, 0), 0, 8 * 32);
3553 1.1 nonaka /* clear shared key mode */
3554 1.1 nonaka run_set_region_4(sc, RT2860_SKEY_MODE_0_7, 0, 4);
3555 1.1 nonaka
3556 1.1 nonaka run_read(sc, RT2860_US_CYC_CNT, &tmp);
3557 1.1 nonaka tmp = (tmp & ~0xff) | 0x1e;
3558 1.1 nonaka run_write(sc, RT2860_US_CYC_CNT, tmp);
3559 1.1 nonaka
3560 1.1 nonaka if (sc->mac_rev != 0x0101)
3561 1.1 nonaka run_write(sc, RT2860_TXOP_CTRL_CFG, 0x0000583f);
3562 1.1 nonaka
3563 1.1 nonaka run_write(sc, RT2860_WMM_TXOP0_CFG, 0);
3564 1.1 nonaka run_write(sc, RT2860_WMM_TXOP1_CFG, 48 << 16 | 96);
3565 1.1 nonaka
3566 1.1 nonaka /* write vendor-specific BBP values (from EEPROM) */
3567 1.1 nonaka for (i = 0; i < 8; i++) {
3568 1.1 nonaka if (sc->bbp[i].reg == 0 || sc->bbp[i].reg == 0xff)
3569 1.1 nonaka continue;
3570 1.1 nonaka run_bbp_write(sc, sc->bbp[i].reg, sc->bbp[i].val);
3571 1.1 nonaka }
3572 1.1 nonaka
3573 1.1 nonaka /* select Main antenna for 1T1R devices */
3574 1.1 nonaka if (sc->rf_rev == RT3070_RF_3020)
3575 1.1 nonaka run_set_rx_antenna(sc, 0);
3576 1.1 nonaka
3577 1.1 nonaka /* send LEDs operating mode to microcontroller */
3578 1.1 nonaka (void)run_mcu_cmd(sc, RT2860_MCU_CMD_LED1, sc->led[0]);
3579 1.1 nonaka (void)run_mcu_cmd(sc, RT2860_MCU_CMD_LED2, sc->led[1]);
3580 1.1 nonaka (void)run_mcu_cmd(sc, RT2860_MCU_CMD_LED3, sc->led[2]);
3581 1.1 nonaka
3582 1.1 nonaka if (sc->mac_ver >= 0x3070)
3583 1.1 nonaka run_rt3070_rf_init(sc);
3584 1.1 nonaka
3585 1.1 nonaka /* disable non-existing Rx chains */
3586 1.1 nonaka run_bbp_read(sc, 3, &bbp3);
3587 1.1 nonaka bbp3 &= ~(1 << 3 | 1 << 4);
3588 1.1 nonaka if (sc->nrxchains == 2)
3589 1.1 nonaka bbp3 |= 1 << 3;
3590 1.1 nonaka else if (sc->nrxchains == 3)
3591 1.1 nonaka bbp3 |= 1 << 4;
3592 1.1 nonaka run_bbp_write(sc, 3, bbp3);
3593 1.1 nonaka
3594 1.1 nonaka /* disable non-existing Tx chains */
3595 1.1 nonaka run_bbp_read(sc, 1, &bbp1);
3596 1.1 nonaka if (sc->ntxchains == 1)
3597 1.1 nonaka bbp1 &= ~(1 << 3 | 1 << 4);
3598 1.1 nonaka run_bbp_write(sc, 1, bbp1);
3599 1.1 nonaka
3600 1.1 nonaka if (sc->mac_ver >= 0x3070)
3601 1.1 nonaka run_rt3070_rf_setup(sc);
3602 1.1 nonaka
3603 1.1 nonaka /* select default channel */
3604 1.1 nonaka run_set_chan(sc, ic->ic_curchan);
3605 1.1 nonaka
3606 1.1 nonaka /* turn radio LED on */
3607 1.1 nonaka run_set_leds(sc, RT2860_LED_RADIO);
3608 1.1 nonaka
3609 1.1 nonaka #ifdef RUN_HWCRYPTO
3610 1.1 nonaka if (ic->ic_flags & IEEE80211_F_PRIVACY) {
3611 1.1 nonaka /* install WEP keys */
3612 1.1 nonaka for (i = 0; i < IEEE80211_WEP_NKID; i++)
3613 1.1 nonaka (void)run_set_key(ic, &ic->ic_crypto.cs_nw_keys[i],
3614 1.1 nonaka NULL);
3615 1.1 nonaka }
3616 1.1 nonaka #endif
3617 1.1 nonaka
3618 1.1 nonaka for (i = 0; i < RUN_RX_RING_COUNT; i++) {
3619 1.1 nonaka struct run_rx_data *data = &sc->rxq.data[i];
3620 1.1 nonaka
3621 1.10.6.7 skrll usbd_setup_xfer(data->xfer, data, data->buf, RUN_MAX_RXSZ,
3622 1.10.6.7 skrll USBD_SHORT_XFER_OK, USBD_NO_TIMEOUT, run_rxeof);
3623 1.1 nonaka error = usbd_transfer(data->xfer);
3624 1.1 nonaka if (error != USBD_NORMAL_COMPLETION &&
3625 1.1 nonaka error != USBD_IN_PROGRESS)
3626 1.1 nonaka goto fail;
3627 1.1 nonaka }
3628 1.1 nonaka
3629 1.1 nonaka if ((error = run_txrx_enable(sc)) != 0)
3630 1.1 nonaka goto fail;
3631 1.1 nonaka
3632 1.1 nonaka ifp->if_flags &= ~IFF_OACTIVE;
3633 1.1 nonaka ifp->if_flags |= IFF_RUNNING;
3634 1.1 nonaka
3635 1.1 nonaka if (ic->ic_opmode == IEEE80211_M_MONITOR)
3636 1.1 nonaka ieee80211_new_state(ic, IEEE80211_S_RUN, -1);
3637 1.1 nonaka else
3638 1.1 nonaka ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
3639 1.1 nonaka
3640 1.1 nonaka if (error != 0)
3641 1.1 nonaka fail: run_stop(ifp, 1);
3642 1.10.6.2 skrll return error;
3643 1.1 nonaka }
3644 1.1 nonaka
3645 1.1 nonaka static void
3646 1.1 nonaka run_stop(struct ifnet *ifp, int disable)
3647 1.1 nonaka {
3648 1.1 nonaka struct run_softc *sc = ifp->if_softc;
3649 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
3650 1.1 nonaka uint32_t tmp;
3651 1.1 nonaka int ntries, qid;
3652 1.1 nonaka
3653 1.1 nonaka if (ifp->if_flags & IFF_RUNNING)
3654 1.1 nonaka run_set_leds(sc, 0); /* turn all LEDs off */
3655 1.1 nonaka
3656 1.1 nonaka sc->sc_tx_timer = 0;
3657 1.1 nonaka ifp->if_timer = 0;
3658 1.1 nonaka ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
3659 1.1 nonaka
3660 1.1 nonaka callout_stop(&sc->scan_to);
3661 1.1 nonaka callout_stop(&sc->calib_to);
3662 1.1 nonaka
3663 1.1 nonaka ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
3664 1.1 nonaka /* wait for all queued asynchronous commands to complete */
3665 1.1 nonaka while (sc->cmdq.queued > 0)
3666 1.1 nonaka tsleep(&sc->cmdq, 0, "cmdq", 0);
3667 1.1 nonaka
3668 1.1 nonaka /* disable Tx/Rx */
3669 1.1 nonaka run_read(sc, RT2860_MAC_SYS_CTRL, &tmp);
3670 1.1 nonaka tmp &= ~(RT2860_MAC_RX_EN | RT2860_MAC_TX_EN);
3671 1.1 nonaka run_write(sc, RT2860_MAC_SYS_CTRL, tmp);
3672 1.1 nonaka
3673 1.1 nonaka /* wait for pending Tx to complete */
3674 1.1 nonaka for (ntries = 0; ntries < 100; ntries++) {
3675 1.1 nonaka if (run_read(sc, RT2860_TXRXQ_PCNT, &tmp) != 0)
3676 1.1 nonaka break;
3677 1.1 nonaka if ((tmp & RT2860_TX2Q_PCNT_MASK) == 0)
3678 1.1 nonaka break;
3679 1.1 nonaka }
3680 1.1 nonaka DELAY(1000);
3681 1.1 nonaka run_write(sc, RT2860_USB_DMA_CFG, 0);
3682 1.1 nonaka
3683 1.1 nonaka /* reset adapter */
3684 1.1 nonaka run_write(sc, RT2860_MAC_SYS_CTRL, RT2860_BBP_HRST | RT2860_MAC_SRST);
3685 1.1 nonaka run_write(sc, RT2860_MAC_SYS_CTRL, 0);
3686 1.1 nonaka
3687 1.1 nonaka /* reset Tx and Rx rings */
3688 1.1 nonaka sc->qfullmsk = 0;
3689 1.1 nonaka for (qid = 0; qid < 4; qid++)
3690 1.1 nonaka run_free_tx_ring(sc, qid);
3691 1.1 nonaka run_free_rx_ring(sc);
3692 1.1 nonaka }
3693 1.1 nonaka
3694 1.1 nonaka #ifndef IEEE80211_STA_ONLY
3695 1.1 nonaka static int
3696 1.1 nonaka run_setup_beacon(struct run_softc *sc)
3697 1.1 nonaka {
3698 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
3699 1.1 nonaka struct rt2860_txwi txwi;
3700 1.1 nonaka struct mbuf *m;
3701 1.1 nonaka int ridx;
3702 1.1 nonaka
3703 1.1 nonaka if ((m = ieee80211_beacon_alloc(ic, ic->ic_bss, &sc->sc_bo)) == NULL)
3704 1.10.6.2 skrll return ENOBUFS;
3705 1.1 nonaka
3706 1.10.6.6 skrll memset(&txwi, 0, sizeof(txwi));
3707 1.1 nonaka txwi.wcid = 0xff;
3708 1.1 nonaka txwi.len = htole16(m->m_pkthdr.len);
3709 1.1 nonaka /* send beacons at the lowest available rate */
3710 1.1 nonaka ridx = (ic->ic_curmode == IEEE80211_MODE_11A) ?
3711 1.1 nonaka RT2860_RIDX_OFDM6 : RT2860_RIDX_CCK1;
3712 1.1 nonaka txwi.phy = htole16(rt2860_rates[ridx].mcs);
3713 1.1 nonaka if (rt2860_rates[ridx].phy == IEEE80211_T_OFDM)
3714 1.1 nonaka txwi.phy |= htole16(RT2860_PHY_OFDM);
3715 1.1 nonaka txwi.txop = RT2860_TX_TXOP_HT;
3716 1.1 nonaka txwi.flags = RT2860_TX_TS;
3717 1.1 nonaka
3718 1.1 nonaka run_write_region_1(sc, RT2860_BCN_BASE(0),
3719 1.10.6.6 skrll (uint8_t *)&txwi, sizeof(txwi));
3720 1.10.6.6 skrll run_write_region_1(sc, RT2860_BCN_BASE(0) + sizeof(txwi),
3721 1.1 nonaka mtod(m, uint8_t *), m->m_pkthdr.len);
3722 1.1 nonaka
3723 1.1 nonaka m_freem(m);
3724 1.1 nonaka
3725 1.10.6.2 skrll return 0;
3726 1.1 nonaka }
3727 1.1 nonaka #endif
3728 1.1 nonaka
3729 1.2 nonaka MODULE(MODULE_CLASS_DRIVER, if_run, "bpf");
3730 1.1 nonaka
3731 1.1 nonaka #ifdef _MODULE
3732 1.1 nonaka #include "ioconf.c"
3733 1.1 nonaka #endif
3734 1.1 nonaka
3735 1.1 nonaka static int
3736 1.1 nonaka if_run_modcmd(modcmd_t cmd, void *arg)
3737 1.1 nonaka {
3738 1.1 nonaka int error = 0;
3739 1.1 nonaka
3740 1.1 nonaka switch (cmd) {
3741 1.1 nonaka case MODULE_CMD_INIT:
3742 1.1 nonaka #ifdef _MODULE
3743 1.1 nonaka error = config_init_component(cfdriver_ioconf_run,
3744 1.1 nonaka cfattach_ioconf_run, cfdata_ioconf_run);
3745 1.1 nonaka #endif
3746 1.10.6.2 skrll return error;
3747 1.1 nonaka case MODULE_CMD_FINI:
3748 1.1 nonaka #ifdef _MODULE
3749 1.1 nonaka error = config_fini_component(cfdriver_ioconf_run,
3750 1.1 nonaka cfattach_ioconf_run, cfdata_ioconf_run);
3751 1.1 nonaka #endif
3752 1.10.6.2 skrll return error;
3753 1.1 nonaka default:
3754 1.10.6.2 skrll return ENOTTY;
3755 1.1 nonaka }
3756 1.1 nonaka }
3757