if_rum.c revision 187192
1/*-
2 * Copyright (c) 2005-2007 Damien Bergamini <damien.bergamini@free.fr>
3 * Copyright (c) 2006 Niall O'Higgins <niallo@openbsd.org>
4 * Copyright (c) 2007-2008 Hans Petter Selasky <hselasky@freebsd.org>
5 *
6 * Permission to use, copy, modify, and distribute this software for any
7 * purpose with or without fee is hereby granted, provided that the above
8 * copyright notice and this permission notice appear in all copies.
9 *
10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
12 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
13 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
14 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
17 */
18
19/*
20 * NOTE: all function names beginning like "rum_cfg_" can only
21 * be called from within the config thread function !
22 */
23
24#include <sys/cdefs.h>
25__FBSDID("$FreeBSD: head/sys/dev/usb2/wlan/if_rum2.c 187192 2009-01-13 21:18:14Z thompsa $");
26
27/*-
28 * Ralink Technology RT2501USB/RT2601USB chipset driver
29 * http://www.ralinktech.com.tw/
30 */
31
32#include <dev/usb2/include/usb2_devid.h>
33#include <dev/usb2/include/usb2_standard.h>
34#include <dev/usb2/include/usb2_mfunc.h>
35#include <dev/usb2/include/usb2_error.h>
36
37#define	usb2_config_td_cc rum_config_copy
38#define	usb2_config_td_softc rum_softc
39
40#define	USB_DEBUG_VAR rum_debug
41
42#include <dev/usb2/core/usb2_core.h>
43#include <dev/usb2/core/usb2_lookup.h>
44#include <dev/usb2/core/usb2_process.h>
45#include <dev/usb2/core/usb2_config_td.h>
46#include <dev/usb2/core/usb2_debug.h>
47#include <dev/usb2/core/usb2_request.h>
48#include <dev/usb2/core/usb2_busdma.h>
49#include <dev/usb2/core/usb2_util.h>
50
51#include <dev/usb2/wlan/usb2_wlan.h>
52#include <dev/usb2/wlan/if_rumreg.h>
53#include <dev/usb2/wlan/if_rumvar.h>
54#include <dev/usb2/wlan/if_rumfw.h>
55
56#if USB_DEBUG
57static int rum_debug = 0;
58
59SYSCTL_NODE(_hw_usb2, OID_AUTO, rum, CTLFLAG_RW, 0, "USB rum");
60SYSCTL_INT(_hw_usb2_rum, OID_AUTO, debug, CTLFLAG_RW, &rum_debug, 0,
61    "Debug level");
62#endif
63
64/* prototypes */
65
66static device_probe_t rum_probe;
67static device_attach_t rum_attach;
68static device_detach_t rum_detach;
69
70static usb2_callback_t rum_bulk_read_callback;
71static usb2_callback_t rum_bulk_read_clear_stall_callback;
72static usb2_callback_t rum_bulk_write_callback;
73static usb2_callback_t rum_bulk_write_clear_stall_callback;
74
75static usb2_config_td_command_t rum_cfg_first_time_setup;
76static usb2_config_td_command_t rum_config_copy;
77static usb2_config_td_command_t rum_cfg_scan_start;
78static usb2_config_td_command_t rum_cfg_scan_end;
79static usb2_config_td_command_t rum_cfg_select_band;
80static usb2_config_td_command_t rum_cfg_set_chan;
81static usb2_config_td_command_t rum_cfg_enable_tsf_sync;
82static usb2_config_td_command_t rum_cfg_enable_mrr;
83static usb2_config_td_command_t rum_cfg_update_slot;
84static usb2_config_td_command_t rum_cfg_select_antenna;
85static usb2_config_td_command_t rum_cfg_set_txpreamble;
86static usb2_config_td_command_t rum_cfg_update_promisc;
87static usb2_config_td_command_t rum_cfg_pre_init;
88static usb2_config_td_command_t rum_cfg_init;
89static usb2_config_td_command_t rum_cfg_pre_stop;
90static usb2_config_td_command_t rum_cfg_stop;
91static usb2_config_td_command_t rum_cfg_amrr_timeout;
92static usb2_config_td_command_t rum_cfg_prepare_beacon;
93static usb2_config_td_command_t rum_cfg_newstate;
94
95static const char *rum_get_rf(uint32_t);
96static int	rum_ioctl_cb(struct ifnet *, u_long, caddr_t);
97static void	rum_std_command(struct ieee80211com *, usb2_config_td_command_t *);
98static void	rum_scan_start_cb(struct ieee80211com *);
99static void	rum_scan_end_cb(struct ieee80211com *);
100static void	rum_set_channel_cb(struct ieee80211com *);
101static uint16_t	rum_cfg_eeprom_read_2(struct rum_softc *, uint16_t);
102static uint32_t	rum_cfg_bbp_disbusy(struct rum_softc *);
103static uint32_t	rum_cfg_read(struct rum_softc *, uint16_t);
104static uint8_t	rum_cfg_bbp_init(struct rum_softc *);
105static uint8_t	rum_cfg_bbp_read(struct rum_softc *, uint8_t);
106static void	rum_cfg_amrr_start(struct rum_softc *);
107static void	rum_cfg_bbp_write(struct rum_softc *, uint8_t, uint8_t);
108static void	rum_cfg_do_request(struct rum_softc *,
109		    struct usb2_device_request *, void *);
110static void	rum_cfg_eeprom_read(struct rum_softc *, uint16_t, void *,
111		    uint16_t);
112static void	rum_cfg_load_microcode(struct rum_softc *, const uint8_t *,
113		    uint16_t);
114static void	rum_cfg_read_eeprom(struct rum_softc *);
115static void	rum_cfg_read_multi(struct rum_softc *, uint16_t, void *,
116		    uint16_t);
117static void	rum_cfg_rf_write(struct rum_softc *, uint8_t, uint32_t);
118static void	rum_cfg_set_bssid(struct rum_softc *, uint8_t *);
119static void	rum_cfg_set_macaddr(struct rum_softc *, uint8_t *);
120static void	rum_cfg_write(struct rum_softc *, uint16_t, uint32_t);
121static void	rum_cfg_write_multi(struct rum_softc *, uint16_t, void *,
122		    uint16_t);
123static void	rum_end_of_commands(struct rum_softc *);
124static void	rum_init_cb(void *);
125static void	rum_start_cb(struct ifnet *);
126static void	rum_watchdog(void *);
127static uint8_t	rum_get_rssi(struct rum_softc *, uint8_t);
128static struct ieee80211vap *rum_vap_create(struct ieee80211com *,
129		    const char[], int, int, int, const uint8_t[],
130		    const uint8_t[]);
131static void	rum_vap_delete(struct ieee80211vap *);
132static struct ieee80211_node *rum_node_alloc(struct ieee80211vap *,
133		    const uint8_t[]);
134static void	rum_newassoc(struct ieee80211_node *, int);
135static void	rum_cfg_disable_tsf_sync(struct rum_softc *);
136static void	rum_cfg_set_run(struct rum_softc *, struct rum_config_copy *);
137static void	rum_fill_write_queue(struct rum_softc *);
138static void	rum_tx_clean_queue(struct rum_softc *);
139static void	rum_tx_freem(struct mbuf *);
140static void	rum_tx_mgt(struct rum_softc *, struct mbuf *,
141		    struct ieee80211_node *);
142static struct ieee80211vap *rum_get_vap(struct rum_softc *);
143static void	rum_tx_data(struct rum_softc *, struct mbuf *,
144		    struct ieee80211_node *);
145static void	rum_tx_prot(struct rum_softc *, const struct mbuf *,
146		    struct ieee80211_node *, uint8_t, uint16_t);
147static void	rum_tx_raw(struct rum_softc *, struct mbuf *,
148		    struct ieee80211_node *,
149		    const struct ieee80211_bpf_params *);
150static int	rum_raw_xmit_cb(struct ieee80211_node *, struct mbuf *,
151		    const struct ieee80211_bpf_params *);
152static void	rum_setup_desc_and_tx(struct rum_softc *, struct mbuf *,
153		    uint32_t, uint16_t, uint16_t);
154static int	rum_newstate_cb(struct ieee80211vap *,
155		    enum ieee80211_state nstate, int arg);
156static void	rum_update_mcast_cb(struct ifnet *);
157static void	rum_update_promisc_cb(struct ifnet *);
158
159/* various supported device vendors/products */
160static const struct usb2_device_id rum_devs[] = {
161	{USB_VPI(USB_VENDOR_ABOCOM, USB_PRODUCT_ABOCOM_HWU54DM, 0)},
162	{USB_VPI(USB_VENDOR_ABOCOM, USB_PRODUCT_ABOCOM_RT2573_2, 0)},
163	{USB_VPI(USB_VENDOR_ABOCOM, USB_PRODUCT_ABOCOM_RT2573_3, 0)},
164	{USB_VPI(USB_VENDOR_ABOCOM, USB_PRODUCT_ABOCOM_RT2573_4, 0)},
165	{USB_VPI(USB_VENDOR_ABOCOM, USB_PRODUCT_ABOCOM_WUG2700, 0)},
166	{USB_VPI(USB_VENDOR_AMIT, USB_PRODUCT_AMIT_CGWLUSB2GO, 0)},
167	{USB_VPI(USB_VENDOR_ASUS, USB_PRODUCT_ASUS_RT2573_1, 0)},
168	{USB_VPI(USB_VENDOR_ASUS, USB_PRODUCT_ASUS_RT2573_2, 0)},
169	{USB_VPI(USB_VENDOR_BELKIN, USB_PRODUCT_BELKIN_F5D7050A, 0)},
170	{USB_VPI(USB_VENDOR_BELKIN, USB_PRODUCT_BELKIN_F5D9050V3, 0)},
171	{USB_VPI(USB_VENDOR_CISCOLINKSYS, USB_PRODUCT_CISCOLINKSYS_WUSB54GC, 0)},
172	{USB_VPI(USB_VENDOR_CISCOLINKSYS, USB_PRODUCT_CISCOLINKSYS_WUSB54GR, 0)},
173	{USB_VPI(USB_VENDOR_CONCEPTRONIC2, USB_PRODUCT_CONCEPTRONIC2_C54RU2, 0)},
174	{USB_VPI(USB_VENDOR_COREGA, USB_PRODUCT_COREGA_CGWLUSB2GL, 0)},
175	{USB_VPI(USB_VENDOR_COREGA, USB_PRODUCT_COREGA_CGWLUSB2GPX, 0)},
176	{USB_VPI(USB_VENDOR_DICKSMITH, USB_PRODUCT_DICKSMITH_CWD854F, 0)},
177	{USB_VPI(USB_VENDOR_DICKSMITH, USB_PRODUCT_DICKSMITH_RT2573, 0)},
178	{USB_VPI(USB_VENDOR_DLINK2, USB_PRODUCT_DLINK2_DWLG122C1, 0)},
179	{USB_VPI(USB_VENDOR_DLINK2, USB_PRODUCT_DLINK2_WUA1340, 0)},
180	{USB_VPI(USB_VENDOR_DLINK2, USB_PRODUCT_DLINK2_DWA111, 0)},
181	{USB_VPI(USB_VENDOR_DLINK2, USB_PRODUCT_DLINK2_DWA110, 0)},
182	{USB_VPI(USB_VENDOR_GIGABYTE, USB_PRODUCT_GIGABYTE_GNWB01GS, 0)},
183	{USB_VPI(USB_VENDOR_GIGABYTE, USB_PRODUCT_GIGABYTE_GNWI05GS, 0)},
184	{USB_VPI(USB_VENDOR_GIGASET, USB_PRODUCT_GIGASET_RT2573, 0)},
185	{USB_VPI(USB_VENDOR_GOODWAY, USB_PRODUCT_GOODWAY_RT2573, 0)},
186	{USB_VPI(USB_VENDOR_GUILLEMOT, USB_PRODUCT_GUILLEMOT_HWGUSB254LB, 0)},
187	{USB_VPI(USB_VENDOR_GUILLEMOT, USB_PRODUCT_GUILLEMOT_HWGUSB254V2AP, 0)},
188	{USB_VPI(USB_VENDOR_HUAWEI3COM, USB_PRODUCT_HUAWEI3COM_WUB320G, 0)},
189	{USB_VPI(USB_VENDOR_MELCO, USB_PRODUCT_MELCO_G54HP, 0)},
190	{USB_VPI(USB_VENDOR_MELCO, USB_PRODUCT_MELCO_SG54HP, 0)},
191	{USB_VPI(USB_VENDOR_MSI, USB_PRODUCT_MSI_RT2573_1, 0)},
192	{USB_VPI(USB_VENDOR_MSI, USB_PRODUCT_MSI_RT2573_2, 0)},
193	{USB_VPI(USB_VENDOR_MSI, USB_PRODUCT_MSI_RT2573_3, 0)},
194	{USB_VPI(USB_VENDOR_MSI, USB_PRODUCT_MSI_RT2573_4, 0)},
195	{USB_VPI(USB_VENDOR_NOVATECH, USB_PRODUCT_NOVATECH_RT2573, 0)},
196	{USB_VPI(USB_VENDOR_PLANEX2, USB_PRODUCT_PLANEX2_GWUS54HP, 0)},
197	{USB_VPI(USB_VENDOR_PLANEX2, USB_PRODUCT_PLANEX2_GWUS54MINI2, 0)},
198	{USB_VPI(USB_VENDOR_PLANEX2, USB_PRODUCT_PLANEX2_GWUSMM, 0)},
199	{USB_VPI(USB_VENDOR_QCOM, USB_PRODUCT_QCOM_RT2573, 0)},
200	{USB_VPI(USB_VENDOR_QCOM, USB_PRODUCT_QCOM_RT2573_2, 0)},
201	{USB_VPI(USB_VENDOR_RALINK, USB_PRODUCT_RALINK_RT2573, 0)},
202	{USB_VPI(USB_VENDOR_RALINK, USB_PRODUCT_RALINK_RT2573_2, 0)},
203	{USB_VPI(USB_VENDOR_RALINK, USB_PRODUCT_RALINK_RT2671, 0)},
204	{USB_VPI(USB_VENDOR_SITECOMEU, USB_PRODUCT_SITECOMEU_WL113R2, 0)},
205	{USB_VPI(USB_VENDOR_SITECOMEU, USB_PRODUCT_SITECOMEU_WL172, 0)},
206	{USB_VPI(USB_VENDOR_SPARKLAN, USB_PRODUCT_SPARKLAN_RT2573, 0)},
207	{USB_VPI(USB_VENDOR_SURECOM, USB_PRODUCT_SURECOM_RT2573, 0)},
208};
209
210struct rum_def_mac {
211	uint32_t reg;
212	uint32_t val;
213};
214
215static const struct rum_def_mac rum_def_mac[] = {
216	{RT2573_TXRX_CSR0, 0x025fb032},
217	{RT2573_TXRX_CSR1, 0x9eaa9eaf},
218	{RT2573_TXRX_CSR2, 0x8a8b8c8d},
219	{RT2573_TXRX_CSR3, 0x00858687},
220	{RT2573_TXRX_CSR7, 0x2e31353b},
221	{RT2573_TXRX_CSR8, 0x2a2a2a2c},
222	{RT2573_TXRX_CSR15, 0x0000000f},
223	{RT2573_MAC_CSR6, 0x00000fff},
224	{RT2573_MAC_CSR8, 0x016c030a},
225	{RT2573_MAC_CSR10, 0x00000718},
226	{RT2573_MAC_CSR12, 0x00000004},
227	{RT2573_MAC_CSR13, 0x00007f00},
228	{RT2573_SEC_CSR0, 0x00000000},
229	{RT2573_SEC_CSR1, 0x00000000},
230	{RT2573_SEC_CSR5, 0x00000000},
231	{RT2573_PHY_CSR1, 0x000023b0},
232	{RT2573_PHY_CSR5, 0x00040a06},
233	{RT2573_PHY_CSR6, 0x00080606},
234	{RT2573_PHY_CSR7, 0x00000408},
235	{RT2573_AIFSN_CSR, 0x00002273},
236	{RT2573_CWMIN_CSR, 0x00002344},
237	{RT2573_CWMAX_CSR, 0x000034aa}
238};
239
240struct rum_def_bbp {
241	uint8_t	reg;
242	uint8_t	val;
243};
244
245static const struct rum_def_bbp rum_def_bbp[] = {
246	{3, 0x80},
247	{15, 0x30},
248	{17, 0x20},
249	{21, 0xc8},
250	{22, 0x38},
251	{23, 0x06},
252	{24, 0xfe},
253	{25, 0x0a},
254	{26, 0x0d},
255	{32, 0x0b},
256	{34, 0x12},
257	{37, 0x07},
258	{39, 0xf8},
259	{41, 0x60},
260	{53, 0x10},
261	{54, 0x18},
262	{60, 0x10},
263	{61, 0x04},
264	{62, 0x04},
265	{75, 0xfe},
266	{86, 0xfe},
267	{88, 0xfe},
268	{90, 0x0f},
269	{99, 0x00},
270	{102, 0x16},
271	{107, 0x04}
272};
273
274struct rfprog {
275	uint8_t	chan;
276	uint32_t r1, r2, r3, r4;
277};
278
279static const struct rfprog rum_rf5226[] = {
280	{1, 0x00b03, 0x001e1, 0x1a014, 0x30282},
281	{2, 0x00b03, 0x001e1, 0x1a014, 0x30287},
282	{3, 0x00b03, 0x001e2, 0x1a014, 0x30282},
283	{4, 0x00b03, 0x001e2, 0x1a014, 0x30287},
284	{5, 0x00b03, 0x001e3, 0x1a014, 0x30282},
285	{6, 0x00b03, 0x001e3, 0x1a014, 0x30287},
286	{7, 0x00b03, 0x001e4, 0x1a014, 0x30282},
287	{8, 0x00b03, 0x001e4, 0x1a014, 0x30287},
288	{9, 0x00b03, 0x001e5, 0x1a014, 0x30282},
289	{10, 0x00b03, 0x001e5, 0x1a014, 0x30287},
290	{11, 0x00b03, 0x001e6, 0x1a014, 0x30282},
291	{12, 0x00b03, 0x001e6, 0x1a014, 0x30287},
292	{13, 0x00b03, 0x001e7, 0x1a014, 0x30282},
293	{14, 0x00b03, 0x001e8, 0x1a014, 0x30284},
294
295	{34, 0x00b03, 0x20266, 0x36014, 0x30282},
296	{38, 0x00b03, 0x20267, 0x36014, 0x30284},
297	{42, 0x00b03, 0x20268, 0x36014, 0x30286},
298	{46, 0x00b03, 0x20269, 0x36014, 0x30288},
299
300	{36, 0x00b03, 0x00266, 0x26014, 0x30288},
301	{40, 0x00b03, 0x00268, 0x26014, 0x30280},
302	{44, 0x00b03, 0x00269, 0x26014, 0x30282},
303	{48, 0x00b03, 0x0026a, 0x26014, 0x30284},
304	{52, 0x00b03, 0x0026b, 0x26014, 0x30286},
305	{56, 0x00b03, 0x0026c, 0x26014, 0x30288},
306	{60, 0x00b03, 0x0026e, 0x26014, 0x30280},
307	{64, 0x00b03, 0x0026f, 0x26014, 0x30282},
308
309	{100, 0x00b03, 0x0028a, 0x2e014, 0x30280},
310	{104, 0x00b03, 0x0028b, 0x2e014, 0x30282},
311	{108, 0x00b03, 0x0028c, 0x2e014, 0x30284},
312	{112, 0x00b03, 0x0028d, 0x2e014, 0x30286},
313	{116, 0x00b03, 0x0028e, 0x2e014, 0x30288},
314	{120, 0x00b03, 0x002a0, 0x2e014, 0x30280},
315	{124, 0x00b03, 0x002a1, 0x2e014, 0x30282},
316	{128, 0x00b03, 0x002a2, 0x2e014, 0x30284},
317	{132, 0x00b03, 0x002a3, 0x2e014, 0x30286},
318	{136, 0x00b03, 0x002a4, 0x2e014, 0x30288},
319	{140, 0x00b03, 0x002a6, 0x2e014, 0x30280},
320
321	{149, 0x00b03, 0x002a8, 0x2e014, 0x30287},
322	{153, 0x00b03, 0x002a9, 0x2e014, 0x30289},
323	{157, 0x00b03, 0x002ab, 0x2e014, 0x30281},
324	{161, 0x00b03, 0x002ac, 0x2e014, 0x30283},
325	{165, 0x00b03, 0x002ad, 0x2e014, 0x30285}
326};
327
328static const struct rfprog rum_rf5225[] = {
329	{1, 0x00b33, 0x011e1, 0x1a014, 0x30282},
330	{2, 0x00b33, 0x011e1, 0x1a014, 0x30287},
331	{3, 0x00b33, 0x011e2, 0x1a014, 0x30282},
332	{4, 0x00b33, 0x011e2, 0x1a014, 0x30287},
333	{5, 0x00b33, 0x011e3, 0x1a014, 0x30282},
334	{6, 0x00b33, 0x011e3, 0x1a014, 0x30287},
335	{7, 0x00b33, 0x011e4, 0x1a014, 0x30282},
336	{8, 0x00b33, 0x011e4, 0x1a014, 0x30287},
337	{9, 0x00b33, 0x011e5, 0x1a014, 0x30282},
338	{10, 0x00b33, 0x011e5, 0x1a014, 0x30287},
339	{11, 0x00b33, 0x011e6, 0x1a014, 0x30282},
340	{12, 0x00b33, 0x011e6, 0x1a014, 0x30287},
341	{13, 0x00b33, 0x011e7, 0x1a014, 0x30282},
342	{14, 0x00b33, 0x011e8, 0x1a014, 0x30284},
343
344	{34, 0x00b33, 0x01266, 0x26014, 0x30282},
345	{38, 0x00b33, 0x01267, 0x26014, 0x30284},
346	{42, 0x00b33, 0x01268, 0x26014, 0x30286},
347	{46, 0x00b33, 0x01269, 0x26014, 0x30288},
348
349	{36, 0x00b33, 0x01266, 0x26014, 0x30288},
350	{40, 0x00b33, 0x01268, 0x26014, 0x30280},
351	{44, 0x00b33, 0x01269, 0x26014, 0x30282},
352	{48, 0x00b33, 0x0126a, 0x26014, 0x30284},
353	{52, 0x00b33, 0x0126b, 0x26014, 0x30286},
354	{56, 0x00b33, 0x0126c, 0x26014, 0x30288},
355	{60, 0x00b33, 0x0126e, 0x26014, 0x30280},
356	{64, 0x00b33, 0x0126f, 0x26014, 0x30282},
357
358	{100, 0x00b33, 0x0128a, 0x2e014, 0x30280},
359	{104, 0x00b33, 0x0128b, 0x2e014, 0x30282},
360	{108, 0x00b33, 0x0128c, 0x2e014, 0x30284},
361	{112, 0x00b33, 0x0128d, 0x2e014, 0x30286},
362	{116, 0x00b33, 0x0128e, 0x2e014, 0x30288},
363	{120, 0x00b33, 0x012a0, 0x2e014, 0x30280},
364	{124, 0x00b33, 0x012a1, 0x2e014, 0x30282},
365	{128, 0x00b33, 0x012a2, 0x2e014, 0x30284},
366	{132, 0x00b33, 0x012a3, 0x2e014, 0x30286},
367	{136, 0x00b33, 0x012a4, 0x2e014, 0x30288},
368	{140, 0x00b33, 0x012a6, 0x2e014, 0x30280},
369
370	{149, 0x00b33, 0x012a8, 0x2e014, 0x30287},
371	{153, 0x00b33, 0x012a9, 0x2e014, 0x30289},
372	{157, 0x00b33, 0x012ab, 0x2e014, 0x30281},
373	{161, 0x00b33, 0x012ac, 0x2e014, 0x30283},
374	{165, 0x00b33, 0x012ad, 0x2e014, 0x30285}
375};
376
377static const struct usb2_config rum_config[RUM_N_TRANSFER] = {
378	[0] = {
379		.type = UE_BULK,
380		.endpoint = UE_ADDR_ANY,
381		.direction = UE_DIR_OUT,
382		.mh.bufsize = (MCLBYTES + RT2573_TX_DESC_SIZE + 8),
383		.mh.flags = {.pipe_bof = 1,.force_short_xfer = 1,},
384		.mh.callback = &rum_bulk_write_callback,
385		.mh.timeout = 5000,	/* ms */
386	},
387
388	[1] = {
389		.type = UE_BULK,
390		.endpoint = UE_ADDR_ANY,
391		.direction = UE_DIR_IN,
392		.mh.bufsize = (MCLBYTES + RT2573_RX_DESC_SIZE),
393		.mh.flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
394		.mh.callback = &rum_bulk_read_callback,
395	},
396
397	[2] = {
398		.type = UE_CONTROL,
399		.endpoint = 0x00,	/* Control pipe */
400		.direction = UE_DIR_ANY,
401		.mh.bufsize = sizeof(struct usb2_device_request),
402		.mh.callback = &rum_bulk_write_clear_stall_callback,
403		.mh.timeout = 1000,	/* 1 second */
404		.mh.interval = 50,	/* 50ms */
405	},
406
407	[3] = {
408		.type = UE_CONTROL,
409		.endpoint = 0x00,	/* Control pipe */
410		.direction = UE_DIR_ANY,
411		.mh.bufsize = sizeof(struct usb2_device_request),
412		.mh.callback = &rum_bulk_read_clear_stall_callback,
413		.mh.timeout = 1000,	/* 1 second */
414		.mh.interval = 50,	/* 50ms */
415	},
416};
417
418static devclass_t rum_devclass;
419
420static device_method_t rum_methods[] = {
421	DEVMETHOD(device_probe, rum_probe),
422	DEVMETHOD(device_attach, rum_attach),
423	DEVMETHOD(device_detach, rum_detach),
424	{0, 0}
425};
426
427static driver_t rum_driver = {
428	.name = "rum",
429	.methods = rum_methods,
430	.size = sizeof(struct rum_softc),
431};
432
433DRIVER_MODULE(rum, ushub, rum_driver, rum_devclass, NULL, 0);
434MODULE_DEPEND(rum, usb2_wlan, 1, 1, 1);
435MODULE_DEPEND(rum, usb2_core, 1, 1, 1);
436MODULE_DEPEND(rum, wlan, 1, 1, 1);
437MODULE_DEPEND(rum, wlan_amrr, 1, 1, 1);
438
439static int
440rum_probe(device_t dev)
441{
442	struct usb2_attach_arg *uaa = device_get_ivars(dev);
443
444	if (uaa->usb2_mode != USB_MODE_HOST) {
445		return (ENXIO);
446	}
447	if (uaa->info.bConfigIndex != 0) {
448		return (ENXIO);
449	}
450	if (uaa->info.bIfaceIndex != RT2573_IFACE_INDEX) {
451		return (ENXIO);
452	}
453	return (usb2_lookup_id_by_uaa(rum_devs, sizeof(rum_devs), uaa));
454}
455
456static int
457rum_attach(device_t dev)
458{
459	struct usb2_attach_arg *uaa = device_get_ivars(dev);
460	struct rum_softc *sc = device_get_softc(dev);
461	int error;
462	uint8_t iface_index;
463
464	if (sc == NULL) {
465		return (ENOMEM);
466	}
467	device_set_usb2_desc(dev);
468
469	mtx_init(&sc->sc_mtx, "rum lock", MTX_NETWORK_LOCK,
470	    MTX_DEF | MTX_RECURSE);
471
472	snprintf(sc->sc_name, sizeof(sc->sc_name), "%s",
473	    device_get_nameunit(dev));
474
475	sc->sc_udev = uaa->device;
476	sc->sc_unit = device_get_unit(dev);
477
478	usb2_callout_init_mtx(&sc->sc_watchdog, &sc->sc_mtx, 0);
479
480	iface_index = RT2573_IFACE_INDEX;
481	error = usb2_transfer_setup(uaa->device, &iface_index,
482	    sc->sc_xfer, rum_config, RUM_N_TRANSFER, sc, &sc->sc_mtx);
483	if (error) {
484		device_printf(dev, "could not allocate USB transfers, "
485		    "err=%s\n", usb2_errstr(error));
486		goto detach;
487	}
488	error = usb2_config_td_setup(&sc->sc_config_td, sc, &sc->sc_mtx,
489	    &rum_end_of_commands,
490	    sizeof(struct usb2_config_td_cc), 24);
491	if (error) {
492		device_printf(dev, "could not setup config "
493		    "thread!\n");
494		goto detach;
495	}
496	mtx_lock(&sc->sc_mtx);
497
498	/* start setup */
499
500	usb2_config_td_queue_command
501	    (&sc->sc_config_td, NULL, &rum_cfg_first_time_setup, 0, 0);
502
503	rum_watchdog(sc);
504	mtx_unlock(&sc->sc_mtx);
505	return (0);			/* success */
506
507detach:
508	rum_detach(dev);
509	return (ENXIO);			/* failure */
510}
511
512static int
513rum_detach(device_t dev)
514{
515	struct rum_softc *sc = device_get_softc(dev);
516	struct ieee80211com *ic;
517	struct ifnet *ifp;
518
519	usb2_config_td_drain(&sc->sc_config_td);
520
521	mtx_lock(&sc->sc_mtx);
522
523	usb2_callout_stop(&sc->sc_watchdog);
524
525	rum_cfg_pre_stop(sc, NULL, 0);
526
527	ifp = sc->sc_ifp;
528	ic = ifp->if_l2com;
529
530	mtx_unlock(&sc->sc_mtx);
531
532	/* stop all USB transfers first */
533	usb2_transfer_unsetup(sc->sc_xfer, RUM_N_TRANSFER);
534
535	/* get rid of any late children */
536	bus_generic_detach(dev);
537
538	if (ifp) {
539		bpfdetach(ifp);
540		ieee80211_ifdetach(ic);
541		if_free(ifp);
542	}
543	usb2_config_td_unsetup(&sc->sc_config_td);
544
545	usb2_callout_drain(&sc->sc_watchdog);
546
547	mtx_destroy(&sc->sc_mtx);
548
549	return (0);
550}
551
552static void
553rum_cfg_do_request(struct rum_softc *sc, struct usb2_device_request *req,
554    void *data)
555{
556	uint16_t length;
557	usb2_error_t err;
558
559repeat:
560
561	if (usb2_config_td_is_gone(&sc->sc_config_td)) {
562		goto error;
563	}
564	err = usb2_do_request_flags
565	    (sc->sc_udev, &sc->sc_mtx, req, data, 0, NULL, 1000);
566
567	if (err) {
568
569		DPRINTF("device request failed, err=%s "
570		    "(ignored)\n", usb2_errstr(err));
571
572		/* wait a little before next try */
573		if (usb2_config_td_sleep(&sc->sc_config_td, hz / 4)) {
574			goto error;
575		}
576		/* try until we are detached */
577		goto repeat;
578
579error:
580		/* the device has been detached */
581		length = UGETW(req->wLength);
582
583		if ((req->bmRequestType & UT_READ) && length) {
584			bzero(data, length);
585		}
586	}
587}
588
589static void
590rum_cfg_eeprom_read(struct rum_softc *sc, uint16_t addr, void *buf, uint16_t len)
591{
592	struct usb2_device_request req;
593
594	req.bmRequestType = UT_READ_VENDOR_DEVICE;
595	req.bRequest = RT2573_READ_EEPROM;
596	USETW(req.wValue, 0);
597	USETW(req.wIndex, addr);
598	USETW(req.wLength, len);
599
600	rum_cfg_do_request(sc, &req, buf);
601}
602
603static uint16_t
604rum_cfg_eeprom_read_2(struct rum_softc *sc, uint16_t addr)
605{
606	uint16_t tmp;
607
608	rum_cfg_eeprom_read(sc, addr, &tmp, sizeof(tmp));
609	return (le16toh(tmp));
610}
611
612static uint32_t
613rum_cfg_read(struct rum_softc *sc, uint16_t reg)
614{
615	uint32_t val;
616
617	rum_cfg_read_multi(sc, reg, &val, sizeof(val));
618	return (le32toh(val));
619}
620
621static void
622rum_cfg_read_multi(struct rum_softc *sc, uint16_t reg, void *buf, uint16_t len)
623{
624	struct usb2_device_request req;
625
626	req.bmRequestType = UT_READ_VENDOR_DEVICE;
627	req.bRequest = RT2573_READ_MULTI_MAC;
628	USETW(req.wValue, 0);
629	USETW(req.wIndex, reg);
630	USETW(req.wLength, len);
631
632	rum_cfg_do_request(sc, &req, buf);
633}
634
635static void
636rum_cfg_write(struct rum_softc *sc, uint16_t reg, uint32_t val)
637{
638	uint32_t tmp = htole32(val);
639
640	rum_cfg_write_multi(sc, reg, &tmp, sizeof(tmp));
641}
642
643static void
644rum_cfg_write_multi(struct rum_softc *sc, uint16_t reg, void *buf, uint16_t len)
645{
646	struct usb2_device_request req;
647
648	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
649	req.bRequest = RT2573_WRITE_MULTI_MAC;
650	USETW(req.wValue, 0);
651	USETW(req.wIndex, reg);
652	USETW(req.wLength, len);
653
654	rum_cfg_do_request(sc, &req, buf);
655}
656
657static uint32_t
658rum_cfg_bbp_disbusy(struct rum_softc *sc)
659{
660	uint32_t tmp;
661	uint8_t to;
662
663	for (to = 0;; to++) {
664		if (to < 100) {
665			tmp = rum_cfg_read(sc, RT2573_PHY_CSR3);
666
667			if ((tmp & RT2573_BBP_BUSY) == 0) {
668				return (tmp);
669			}
670			if (usb2_config_td_sleep(&sc->sc_config_td, hz / 100)) {
671				break;
672			}
673		} else {
674			break;
675		}
676	}
677	DPRINTF("could not disbusy BBP\n");
678	return (RT2573_BBP_BUSY);	/* failure */
679}
680
681static void
682rum_cfg_bbp_write(struct rum_softc *sc, uint8_t reg, uint8_t val)
683{
684	uint32_t tmp;
685
686	if (rum_cfg_bbp_disbusy(sc) & RT2573_BBP_BUSY) {
687		return;
688	}
689	tmp = RT2573_BBP_BUSY | ((reg & 0x7f) << 8) | val;
690	rum_cfg_write(sc, RT2573_PHY_CSR3, tmp);
691}
692
693static uint8_t
694rum_cfg_bbp_read(struct rum_softc *sc, uint8_t reg)
695{
696	uint32_t val;
697
698	if (rum_cfg_bbp_disbusy(sc) & RT2573_BBP_BUSY) {
699		return (0);
700	}
701	val = RT2573_BBP_BUSY | RT2573_BBP_READ | (reg << 8);
702	rum_cfg_write(sc, RT2573_PHY_CSR3, val);
703
704	val = rum_cfg_bbp_disbusy(sc);
705	return (val & 0xff);
706}
707
708static void
709rum_cfg_rf_write(struct rum_softc *sc, uint8_t reg, uint32_t val)
710{
711	uint32_t tmp;
712	uint8_t to;
713
714	reg &= 3;
715
716	for (to = 0;; to++) {
717		if (to < 100) {
718			tmp = rum_cfg_read(sc, RT2573_PHY_CSR4);
719			if (!(tmp & RT2573_RF_BUSY)) {
720				break;
721			}
722			if (usb2_config_td_sleep(&sc->sc_config_td, hz / 100)) {
723				return;
724			}
725		} else {
726			DPRINTF("could not write to RF\n");
727			return;
728		}
729	}
730
731	tmp = RT2573_RF_BUSY | RT2573_RF_20BIT | ((val & 0xfffff) << 2) | reg;
732	rum_cfg_write(sc, RT2573_PHY_CSR4, tmp);
733
734	DPRINTFN(16, "RF R[%u] <- 0x%05x\n", reg, val & 0xfffff);
735}
736
737static void
738rum_cfg_first_time_setup(struct rum_softc *sc,
739    struct usb2_config_td_cc *cc, uint16_t refcount)
740{
741	struct ieee80211com *ic;
742	struct ifnet *ifp;
743	uint32_t tmp;
744	uint16_t i;
745	uint8_t bands;
746
747	/* setup RX tap header */
748	sc->sc_rxtap_len = sizeof(sc->sc_rxtap);
749	sc->sc_rxtap.wr_ihdr.it_len = htole16(sc->sc_rxtap_len);
750	sc->sc_rxtap.wr_ihdr.it_present = htole32(RT2573_RX_RADIOTAP_PRESENT);
751
752	/* setup TX tap header */
753	sc->sc_txtap_len = sizeof(sc->sc_txtap);
754	sc->sc_txtap.wt_ihdr.it_len = htole16(sc->sc_txtap_len);
755	sc->sc_txtap.wt_ihdr.it_present = htole32(RT2573_TX_RADIOTAP_PRESENT);
756
757	/* retrieve RT2573 rev. no */
758	for (i = 0; i < 100; i++) {
759
760		tmp = rum_cfg_read(sc, RT2573_MAC_CSR0);
761		if (tmp != 0) {
762			break;
763		}
764		/* wait a little */
765		if (usb2_config_td_sleep(&sc->sc_config_td, hz / 100)) {
766			/* device detached */
767			goto done;
768		}
769	}
770
771	if (tmp == 0) {
772		DPRINTF("chip is maybe not ready\n");
773	}
774	/* retrieve MAC address and various other things from EEPROM */
775	rum_cfg_read_eeprom(sc);
776
777	printf("%s: MAC/BBP RT2573 (rev 0x%05x), RF %s\n",
778	    sc->sc_name, tmp, rum_get_rf(sc->sc_rf_rev));
779
780	rum_cfg_load_microcode(sc, rt2573_ucode, sizeof(rt2573_ucode));
781
782	mtx_unlock(&sc->sc_mtx);
783
784	ifp = if_alloc(IFT_IEEE80211);
785
786	mtx_lock(&sc->sc_mtx);
787
788	if (ifp == NULL) {
789		DPRINTFN(0, "could not if_alloc()!\n");
790		goto done;
791	}
792	sc->sc_evilhack = ifp;
793	sc->sc_ifp = ifp;
794	ic = ifp->if_l2com;
795
796	ifp->if_softc = sc;
797	if_initname(ifp, "rum", sc->sc_unit);
798	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
799	ifp->if_init = &rum_init_cb;
800	ifp->if_ioctl = &rum_ioctl_cb;
801	ifp->if_start = &rum_start_cb;
802	ifp->if_watchdog = NULL;
803	IFQ_SET_MAXLEN(&ifp->if_snd, IFQ_MAXLEN);
804	ifp->if_snd.ifq_drv_maxlen = IFQ_MAXLEN;
805	IFQ_SET_READY(&ifp->if_snd);
806
807	bcopy(sc->sc_myaddr, ic->ic_myaddr, sizeof(ic->ic_myaddr));
808
809	ic->ic_ifp = ifp;
810	ic->ic_phytype = IEEE80211_T_OFDM;	/* not only, but not used */
811	ic->ic_opmode = IEEE80211_M_STA;
812
813	/* set device capabilities */
814	ic->ic_caps =
815	    IEEE80211_C_STA		/* station mode supported */
816	    | IEEE80211_C_IBSS		/* IBSS mode supported */
817	    | IEEE80211_C_MONITOR	/* monitor mode supported */
818	    | IEEE80211_C_HOSTAP	/* HostAp mode supported */
819	    | IEEE80211_C_TXPMGT	/* tx power management */
820	    | IEEE80211_C_SHPREAMBLE	/* short preamble supported */
821	    | IEEE80211_C_SHSLOT	/* short slot time supported */
822	    | IEEE80211_C_BGSCAN	/* bg scanning supported */
823	    | IEEE80211_C_WPA		/* 802.11i */
824	    ;
825
826	bands = 0;
827	setbit(&bands, IEEE80211_MODE_11B);
828	setbit(&bands, IEEE80211_MODE_11G);
829	ieee80211_init_channels(ic, NULL, &bands);
830
831	if ((sc->sc_rf_rev == RT2573_RF_5225) ||
832	    (sc->sc_rf_rev == RT2573_RF_5226)) {
833
834		struct ieee80211_channel *c;
835
836		/* set supported .11a channels */
837		for (i = 34; i <= 46; i += 4) {
838			c = ic->ic_channels + (ic->ic_nchans++);
839			c->ic_freq = ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ);
840			c->ic_flags = IEEE80211_CHAN_A;
841			c->ic_ieee = i;
842		}
843		for (i = 36; i <= 64; i += 4) {
844			c = ic->ic_channels + (ic->ic_nchans++);
845			c->ic_freq = ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ);
846			c->ic_flags = IEEE80211_CHAN_A;
847			c->ic_ieee = i;
848		}
849		for (i = 100; i <= 140; i += 4) {
850			c = ic->ic_channels + (ic->ic_nchans++);
851			c->ic_freq = ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ);
852			c->ic_flags = IEEE80211_CHAN_A;
853			c->ic_ieee = i;
854		}
855		for (i = 149; i <= 165; i += 4) {
856			c = ic->ic_channels + (ic->ic_nchans++);
857			c->ic_freq = ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ);
858			c->ic_flags = IEEE80211_CHAN_A;
859			c->ic_ieee = i;
860		}
861	}
862	mtx_unlock(&sc->sc_mtx);
863
864	ieee80211_ifattach(ic);
865
866	mtx_lock(&sc->sc_mtx);
867
868	ic->ic_newassoc = &rum_newassoc;
869	ic->ic_raw_xmit = &rum_raw_xmit_cb;
870	ic->ic_node_alloc = &rum_node_alloc;
871	ic->ic_update_mcast = &rum_update_mcast_cb;
872	ic->ic_update_promisc = &rum_update_promisc_cb;
873	ic->ic_scan_start = &rum_scan_start_cb;
874	ic->ic_scan_end = &rum_scan_end_cb;
875	ic->ic_set_channel = &rum_set_channel_cb;
876	ic->ic_vap_create = &rum_vap_create;
877	ic->ic_vap_delete = &rum_vap_delete;
878
879	sc->sc_rates = ieee80211_get_ratetable(ic->ic_curchan);
880
881	mtx_unlock(&sc->sc_mtx);
882
883	bpfattach(ifp, DLT_IEEE802_11_RADIO,
884	    sizeof(struct ieee80211_frame) + sizeof(sc->sc_txtap));
885
886	if (bootverbose) {
887		ieee80211_announce(ic);
888	}
889	mtx_lock(&sc->sc_mtx);
890done:
891	return;
892}
893
894static void
895rum_end_of_commands(struct rum_softc *sc)
896{
897	sc->sc_flags &= ~RUM_FLAG_WAIT_COMMAND;
898
899	/* start write transfer, if not started */
900	usb2_transfer_start(sc->sc_xfer[0]);
901}
902
903static void
904rum_config_copy_chan(struct rum_config_copy_chan *cc,
905    struct ieee80211com *ic, struct ieee80211_channel *c)
906{
907	if (!c)
908		return;
909	cc->chan_to_ieee =
910	    ieee80211_chan2ieee(ic, c);
911	if (c != IEEE80211_CHAN_ANYC) {
912		cc->chan_to_mode =
913		    ieee80211_chan2mode(c);
914		if (IEEE80211_IS_CHAN_B(c))
915			cc->chan_is_b = 1;
916		if (IEEE80211_IS_CHAN_A(c))
917			cc->chan_is_a = 1;
918		if (IEEE80211_IS_CHAN_2GHZ(c))
919			cc->chan_is_2ghz = 1;
920		if (IEEE80211_IS_CHAN_5GHZ(c))
921			cc->chan_is_5ghz = 1;
922		if (IEEE80211_IS_CHAN_ANYG(c))
923			cc->chan_is_g = 1;
924	}
925}
926
927static void
928rum_config_copy(struct rum_softc *sc,
929    struct usb2_config_td_cc *cc, uint16_t refcount)
930{
931	struct ifnet *ifp;
932	struct ieee80211com *ic;
933	struct ieee80211_node *ni;
934	struct ieee80211vap *vap;
935	const struct ieee80211_txparam *tp;
936
937	bzero(cc, sizeof(*cc));
938
939	ifp = sc->sc_ifp;
940	if (ifp) {
941		cc->if_flags = ifp->if_flags;
942		bcopy(ifp->if_broadcastaddr, cc->if_broadcastaddr,
943		    sizeof(cc->if_broadcastaddr));
944
945		ic = ifp->if_l2com;
946		if (ic) {
947			rum_config_copy_chan(&cc->ic_curchan, ic, ic->ic_curchan);
948			rum_config_copy_chan(&cc->ic_bsschan, ic, ic->ic_bsschan);
949			vap = TAILQ_FIRST(&ic->ic_vaps);
950			if (vap) {
951				ni = vap->iv_bss;
952				if (ni) {
953					cc->iv_bss.ni_intval = ni->ni_intval;
954					bcopy(ni->ni_bssid, cc->iv_bss.ni_bssid,
955					    sizeof(cc->iv_bss.ni_bssid));
956				}
957				tp = vap->iv_txparms + cc->ic_bsschan.chan_to_mode;
958				if (tp->ucastrate == IEEE80211_FIXED_RATE_NONE) {
959					cc->iv_bss.fixed_rate_none = 1;
960				}
961			}
962			cc->ic_opmode = ic->ic_opmode;
963			cc->ic_flags = ic->ic_flags;
964			cc->ic_txpowlimit = ic->ic_txpowlimit;
965			cc->ic_curmode = ic->ic_curmode;
966
967			bcopy(ic->ic_myaddr, cc->ic_myaddr,
968			    sizeof(cc->ic_myaddr));
969		}
970	}
971	sc->sc_flags |= RUM_FLAG_WAIT_COMMAND;
972}
973
974static const char *
975rum_get_rf(uint32_t rev)
976{
977	;				/* indent fix */
978	switch (rev) {
979	case RT2573_RF_2527:
980		return "RT2527 (MIMO XR)";
981	case RT2573_RF_2528:
982		return "RT2528";
983	case RT2573_RF_5225:
984		return "RT5225 (MIMO XR)";
985	case RT2573_RF_5226:
986		return "RT5226";
987	default:
988		return "unknown";
989	}
990}
991
992static void
993rum_bulk_read_callback(struct usb2_xfer *xfer)
994{
995	struct rum_softc *sc = xfer->priv_sc;
996	struct ifnet *ifp = sc->sc_ifp;
997	struct ieee80211com *ic = ifp->if_l2com;
998	struct ieee80211_node *ni;
999
1000	struct mbuf *m = NULL;
1001	uint32_t flags;
1002	uint32_t max_len;
1003	uint8_t rssi = 0;
1004
1005	switch (USB_GET_STATE(xfer)) {
1006	case USB_ST_TRANSFERRED:
1007
1008		DPRINTFN(15, "rx done, actlen=%d\n", xfer->actlen);
1009
1010		if (xfer->actlen < (RT2573_RX_DESC_SIZE + IEEE80211_MIN_LEN)) {
1011			DPRINTF("too short transfer, "
1012			    "%d bytes\n", xfer->actlen);
1013			ifp->if_ierrors++;
1014			goto tr_setup;
1015		}
1016		usb2_copy_out(xfer->frbuffers, 0,
1017		    &sc->sc_rx_desc, RT2573_RX_DESC_SIZE);
1018
1019		flags = le32toh(sc->sc_rx_desc.flags);
1020
1021		if (flags & RT2573_RX_CRC_ERROR) {
1022			/*
1023		         * This should not happen since we did not
1024		         * request to receive those frames when we
1025		         * filled RAL_TXRX_CSR2:
1026		         */
1027			DPRINTFN(6, "PHY or CRC error\n");
1028			ifp->if_ierrors++;
1029			goto tr_setup;
1030		}
1031		m = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR);
1032
1033		if (m == NULL) {
1034			DPRINTF("could not allocate mbuf\n");
1035			ifp->if_ierrors++;
1036			goto tr_setup;
1037		}
1038		max_len = (xfer->actlen - RT2573_RX_DESC_SIZE);
1039
1040		usb2_copy_out(xfer->frbuffers, RT2573_RX_DESC_SIZE,
1041		    m->m_data, max_len);
1042
1043		/* finalize mbuf */
1044		m->m_pkthdr.rcvif = ifp;
1045		m->m_pkthdr.len = m->m_len = (flags >> 16) & 0xfff;
1046
1047		if (m->m_len > max_len) {
1048			DPRINTF("invalid length in RX "
1049			    "descriptor, %u bytes, received %u bytes\n",
1050			    m->m_len, max_len);
1051			ifp->if_ierrors++;
1052			m_freem(m);
1053			m = NULL;
1054			goto tr_setup;
1055		}
1056		rssi = rum_get_rssi(sc, sc->sc_rx_desc.rssi);
1057
1058		DPRINTF("real length=%d bytes, rssi=%d\n", m->m_len, rssi);
1059
1060		if (bpf_peers_present(ifp->if_bpf)) {
1061			struct rum_rx_radiotap_header *tap = &sc->sc_rxtap;
1062
1063			tap->wr_flags = IEEE80211_RADIOTAP_F_FCS;
1064			tap->wr_rate = ieee80211_plcp2rate(sc->sc_rx_desc.rate,
1065			    (sc->sc_rx_desc.flags & htole32(RT2573_RX_OFDM)) ?
1066			    IEEE80211_T_OFDM : IEEE80211_T_CCK);
1067			tap->wr_chan_freq = htole16(ic->ic_curchan->ic_freq);
1068			tap->wr_chan_flags = htole16(ic->ic_curchan->ic_flags);
1069			tap->wr_antenna = sc->sc_rx_ant;
1070			tap->wr_antsignal = rssi;
1071
1072			bpf_mtap2(ifp->if_bpf, tap, sc->sc_rxtap_len, m);
1073		}
1074	case USB_ST_SETUP:
1075tr_setup:
1076
1077		if (sc->sc_flags & RUM_FLAG_READ_STALL) {
1078			usb2_transfer_start(sc->sc_xfer[3]);
1079		} else {
1080			xfer->frlengths[0] = xfer->max_data_length;
1081			usb2_start_hardware(xfer);
1082		}
1083
1084		/*
1085		 * At the end of a USB callback it is always safe to unlock
1086		 * the private mutex of a device! That is why we do the
1087		 * "ieee80211_input" here, and not some lines up!
1088		 */
1089		if (m) {
1090			mtx_unlock(&sc->sc_mtx);
1091
1092			ni = ieee80211_find_rxnode(ic, mtod(m, struct ieee80211_frame_min *));
1093			if (ni != NULL) {
1094				if (ieee80211_input(ni, m, rssi, RT2573_NOISE_FLOOR, 0)) {
1095					/* ignore */
1096				}
1097				/* node is no longer needed */
1098				ieee80211_free_node(ni);
1099			} else {
1100				if (ieee80211_input_all(ic, m, rssi, RT2573_NOISE_FLOOR, 0)) {
1101					/* ignore */
1102				}
1103			}
1104
1105			mtx_lock(&sc->sc_mtx);
1106		}
1107		return;
1108
1109	default:			/* Error */
1110		if (xfer->error != USB_ERR_CANCELLED) {
1111			/* try to clear stall first */
1112			sc->sc_flags |= RUM_FLAG_READ_STALL;
1113			usb2_transfer_start(sc->sc_xfer[3]);
1114		}
1115		return;
1116
1117	}
1118}
1119
1120static void
1121rum_bulk_read_clear_stall_callback(struct usb2_xfer *xfer)
1122{
1123	struct rum_softc *sc = xfer->priv_sc;
1124	struct usb2_xfer *xfer_other = sc->sc_xfer[1];
1125
1126	if (usb2_clear_stall_callback(xfer, xfer_other)) {
1127		DPRINTF("stall cleared\n");
1128		sc->sc_flags &= ~RUM_FLAG_READ_STALL;
1129		usb2_transfer_start(xfer_other);
1130	}
1131}
1132
1133static uint8_t
1134rum_plcp_signal(uint16_t rate)
1135{
1136	;				/* indent fix */
1137	switch (rate) {
1138		/* CCK rates (NB: not IEEE std, device-specific) */
1139	case 2:
1140		return (0x0);
1141	case 4:
1142		return (0x1);
1143	case 11:
1144		return (0x2);
1145	case 22:
1146		return (0x3);
1147
1148		/* OFDM rates (cf IEEE Std 802.11a-1999, pp. 14 Table 80) */
1149	case 12:
1150		return (0xb);
1151	case 18:
1152		return (0xf);
1153	case 24:
1154		return (0xa);
1155	case 36:
1156		return (0xe);
1157	case 48:
1158		return (0x9);
1159	case 72:
1160		return (0xd);
1161	case 96:
1162		return (0x8);
1163	case 108:
1164		return (0xc);
1165
1166		/* XXX unsupported/unknown rate */
1167	default:
1168		return (0xff);
1169	}
1170}
1171
1172/*
1173 * We assume that "m->m_pkthdr.rcvif" is pointing to the "ni" that
1174 * should be freed, when "rum_setup_desc_and_tx" is called.
1175 */
1176
1177static void
1178rum_setup_desc_and_tx(struct rum_softc *sc, struct mbuf *m, uint32_t flags,
1179    uint16_t xflags, uint16_t rate)
1180{
1181	struct ifnet *ifp = sc->sc_ifp;
1182	struct ieee80211com *ic = ifp->if_l2com;
1183	struct mbuf *mm;
1184	enum ieee80211_phytype phytype;
1185	uint16_t plcp_length;
1186	uint16_t len;
1187	uint8_t remainder;
1188	uint8_t is_beacon;
1189
1190	if (xflags & RT2573_TX_BEACON) {
1191		xflags &= ~RT2573_TX_BEACON;
1192		is_beacon = 1;
1193	} else {
1194		is_beacon = 0;
1195	}
1196
1197	if (sc->sc_tx_queue.ifq_len >= IFQ_MAXLEN) {
1198		/* free packet */
1199		rum_tx_freem(m);
1200		ifp->if_oerrors++;
1201		return;
1202	}
1203	if (!((sc->sc_flags & RUM_FLAG_LL_READY) &&
1204	    (sc->sc_flags & RUM_FLAG_HL_READY))) {
1205		/* free packet */
1206		rum_tx_freem(m);
1207		ifp->if_oerrors++;
1208		return;
1209	}
1210	if (rate < 2) {
1211		DPRINTF("rate < 2!\n");
1212
1213		/* avoid division by zero */
1214		rate = 2;
1215	}
1216	ic->ic_lastdata = ticks;
1217	if (bpf_peers_present(ifp->if_bpf)) {
1218		struct rum_tx_radiotap_header *tap = &sc->sc_txtap;
1219
1220		tap->wt_flags = 0;
1221		tap->wt_rate = rate;
1222		tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq);
1223		tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags);
1224		tap->wt_antenna = sc->sc_tx_ant;
1225
1226		bpf_mtap2(ifp->if_bpf, tap, sc->sc_txtap_len, m);
1227	}
1228	len = m->m_pkthdr.len;
1229
1230	flags |= RT2573_TX_VALID;
1231	flags |= (len << 16);
1232
1233	sc->sc_tx_desc.flags = htole32(flags);
1234	sc->sc_tx_desc.xflags = htole16(xflags);
1235
1236	sc->sc_tx_desc.wme = htole16(RT2573_QID(0) | RT2573_AIFSN(2) |
1237	    RT2573_LOGCWMIN(4) | RT2573_LOGCWMAX(10));
1238
1239	/* setup PLCP fields */
1240	sc->sc_tx_desc.plcp_signal = rum_plcp_signal(rate);
1241	sc->sc_tx_desc.plcp_service = 4;
1242
1243	len += IEEE80211_CRC_LEN;
1244
1245	phytype = ieee80211_rate2phytype(sc->sc_rates, rate);
1246
1247	if (phytype == IEEE80211_T_OFDM) {
1248		sc->sc_tx_desc.flags |= htole32(RT2573_TX_OFDM);
1249
1250		plcp_length = (len & 0xfff);
1251		sc->sc_tx_desc.plcp_length_hi = plcp_length >> 6;
1252		sc->sc_tx_desc.plcp_length_lo = plcp_length & 0x3f;
1253	} else {
1254		plcp_length = ((16 * len) + rate - 1) / rate;
1255		if (rate == 22) {
1256			remainder = (16 * len) % 22;
1257			if ((remainder != 0) && (remainder < 7)) {
1258				sc->sc_tx_desc.plcp_service |=
1259				    RT2573_PLCP_LENGEXT;
1260			}
1261		}
1262		sc->sc_tx_desc.plcp_length_hi = plcp_length >> 8;
1263		sc->sc_tx_desc.plcp_length_lo = plcp_length & 0xff;
1264
1265		if ((rate != 2) && (ic->ic_flags & IEEE80211_F_SHPREAMBLE)) {
1266			sc->sc_tx_desc.plcp_signal |= 0x08;
1267		}
1268	}
1269
1270	if (sizeof(sc->sc_tx_desc) > MHLEN) {
1271		DPRINTF("No room for header structure!\n");
1272		rum_tx_freem(m);
1273		return;
1274	}
1275	mm = m_gethdr(M_NOWAIT, MT_DATA);
1276	if (mm == NULL) {
1277		DPRINTF("Could not allocate header mbuf!\n");
1278		rum_tx_freem(m);
1279		return;
1280	}
1281	bcopy(&sc->sc_tx_desc, mm->m_data, sizeof(sc->sc_tx_desc));
1282	mm->m_len = sizeof(sc->sc_tx_desc);
1283	mm->m_next = m;
1284	mm->m_pkthdr.len = mm->m_len + m->m_pkthdr.len;
1285	mm->m_pkthdr.rcvif = NULL;
1286
1287	if (is_beacon) {
1288
1289		if (mm->m_pkthdr.len > sizeof(sc->sc_beacon_buf)) {
1290			DPRINTFN(0, "Truncating beacon"
1291			    ", %u bytes!\n", mm->m_pkthdr.len);
1292			mm->m_pkthdr.len = sizeof(sc->sc_beacon_buf);
1293		}
1294		m_copydata(mm, 0, mm->m_pkthdr.len, sc->sc_beacon_buf);
1295
1296		/* copy the first 24 bytes of Tx descriptor into NIC memory */
1297		rum_cfg_write_multi(sc, RT2573_HW_BEACON_BASE0,
1298		    sc->sc_beacon_buf, mm->m_pkthdr.len);
1299		rum_tx_freem(mm);
1300		return;
1301	}
1302	/* start write transfer, if not started */
1303	_IF_ENQUEUE(&sc->sc_tx_queue, mm);
1304
1305	usb2_transfer_start(sc->sc_xfer[0]);
1306}
1307
1308static void
1309rum_bulk_write_callback(struct usb2_xfer *xfer)
1310{
1311	struct rum_softc *sc = xfer->priv_sc;
1312	struct ifnet *ifp = sc->sc_ifp;
1313	struct mbuf *m;
1314	uint16_t temp_len;
1315	uint8_t align;
1316
1317	switch (USB_GET_STATE(xfer)) {
1318	case USB_ST_TRANSFERRED:
1319		DPRINTFN(11, "transfer complete\n");
1320
1321		ifp->if_opackets++;
1322
1323	case USB_ST_SETUP:
1324		if (sc->sc_flags & RUM_FLAG_WRITE_STALL) {
1325			usb2_transfer_start(sc->sc_xfer[2]);
1326			break;
1327		}
1328		if (sc->sc_flags & RUM_FLAG_WAIT_COMMAND) {
1329			/*
1330			 * don't send anything while a command is pending !
1331			 */
1332			break;
1333		}
1334		rum_fill_write_queue(sc);
1335
1336		_IF_DEQUEUE(&sc->sc_tx_queue, m);
1337
1338		if (m) {
1339
1340			if (m->m_pkthdr.len > (MCLBYTES + RT2573_TX_DESC_SIZE)) {
1341				DPRINTFN(0, "data overflow, %u bytes\n",
1342				    m->m_pkthdr.len);
1343				m->m_pkthdr.len = (MCLBYTES + RT2573_TX_DESC_SIZE);
1344			}
1345			usb2_m_copy_in(xfer->frbuffers, 0,
1346			    m, 0, m->m_pkthdr.len);
1347
1348			/* compute transfer length */
1349			temp_len = m->m_pkthdr.len;
1350
1351			/* make transfer length 32-bit aligned */
1352			align = (-(temp_len)) & 3;
1353
1354			/* check if we need to add four extra bytes */
1355			if (((temp_len + align) % 64) == 0) {
1356				align += 4;
1357			}
1358			/* check if we need to align length */
1359			if (align != 0) {
1360				/* zero the extra bytes */
1361				usb2_bzero(xfer->frbuffers, temp_len, align);
1362				temp_len += align;
1363			}
1364			DPRINTFN(11, "sending frame len=%u ferlen=%u\n",
1365			    m->m_pkthdr.len, temp_len);
1366
1367			xfer->frlengths[0] = temp_len;
1368			usb2_start_hardware(xfer);
1369
1370			/* free mbuf and node */
1371			rum_tx_freem(m);
1372
1373		}
1374		break;
1375
1376	default:			/* Error */
1377		DPRINTFN(11, "transfer error, %s\n",
1378		    usb2_errstr(xfer->error));
1379
1380		if (xfer->error != USB_ERR_CANCELLED) {
1381			/* try to clear stall first */
1382			sc->sc_flags |= RUM_FLAG_WRITE_STALL;
1383			usb2_transfer_start(sc->sc_xfer[2]);
1384		}
1385		ifp->if_oerrors++;
1386		break;
1387	}
1388}
1389
1390static void
1391rum_bulk_write_clear_stall_callback(struct usb2_xfer *xfer)
1392{
1393	struct rum_softc *sc = xfer->priv_sc;
1394	struct usb2_xfer *xfer_other = sc->sc_xfer[0];
1395
1396	if (usb2_clear_stall_callback(xfer, xfer_other)) {
1397		DPRINTF("stall cleared\n");
1398		sc->sc_flags &= ~RUM_FLAG_WRITE_STALL;
1399		usb2_transfer_start(xfer_other);
1400	}
1401}
1402
1403static void
1404rum_watchdog(void *arg)
1405{
1406	struct rum_softc *sc = arg;
1407
1408	mtx_assert(&sc->sc_mtx, MA_OWNED);
1409
1410	if (sc->sc_amrr_timer) {
1411		usb2_config_td_queue_command
1412		    (&sc->sc_config_td, NULL,
1413		    &rum_cfg_amrr_timeout, 0, 0);
1414	}
1415	usb2_callout_reset(&sc->sc_watchdog,
1416	    hz, &rum_watchdog, sc);
1417}
1418
1419static void
1420rum_init_cb(void *arg)
1421{
1422	struct rum_softc *sc = arg;
1423
1424	mtx_lock(&sc->sc_mtx);
1425	usb2_config_td_queue_command
1426	    (&sc->sc_config_td, &rum_cfg_pre_init,
1427	    &rum_cfg_init, 0, 0);
1428	mtx_unlock(&sc->sc_mtx);
1429}
1430
1431static int
1432rum_ioctl_cb(struct ifnet *ifp, u_long cmd, caddr_t data)
1433{
1434	struct rum_softc *sc = ifp->if_softc;
1435	struct ieee80211com *ic = ifp->if_l2com;
1436	int error;
1437
1438	switch (cmd) {
1439	case SIOCSIFFLAGS:
1440		mtx_lock(&sc->sc_mtx);
1441		if (ifp->if_flags & IFF_UP) {
1442			if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) {
1443				usb2_config_td_queue_command
1444				    (&sc->sc_config_td, &rum_cfg_pre_init,
1445				    &rum_cfg_init, 0, 0);
1446			}
1447		} else {
1448			if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
1449				usb2_config_td_queue_command
1450				    (&sc->sc_config_td, &rum_cfg_pre_stop,
1451				    &rum_cfg_stop, 0, 0);
1452			}
1453		}
1454		mtx_unlock(&sc->sc_mtx);
1455		error = 0;
1456		break;
1457
1458	case SIOCGIFMEDIA:
1459	case SIOCSIFMEDIA:
1460		error = ifmedia_ioctl(ifp, (void *)data, &ic->ic_media, cmd);
1461		break;
1462
1463	default:
1464		error = ether_ioctl(ifp, cmd, data);
1465	}
1466	return (error);
1467}
1468
1469static void
1470rum_start_cb(struct ifnet *ifp)
1471{
1472	struct rum_softc *sc = ifp->if_softc;
1473
1474	mtx_lock(&sc->sc_mtx);
1475	/* start write transfer, if not started */
1476	usb2_transfer_start(sc->sc_xfer[0]);
1477	mtx_unlock(&sc->sc_mtx);
1478}
1479
1480static void
1481rum_cfg_newstate(struct rum_softc *sc,
1482    struct usb2_config_td_cc *cc, uint16_t refcount)
1483{
1484	struct ifnet *ifp = sc->sc_ifp;
1485	struct ieee80211com *ic = ifp->if_l2com;
1486	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
1487	struct rum_vap *uvp = RUM_VAP(vap);
1488	enum ieee80211_state ostate;
1489	enum ieee80211_state nstate;
1490	int arg;
1491
1492	ostate = vap->iv_state;
1493	nstate = sc->sc_ns_state;
1494	arg = sc->sc_ns_arg;
1495
1496	if (ostate == IEEE80211_S_INIT) {
1497		/* We are leaving INIT. TSF sync should be off. */
1498		rum_cfg_disable_tsf_sync(sc);
1499	}
1500	switch (nstate) {
1501	case IEEE80211_S_INIT:
1502		break;
1503
1504	case IEEE80211_S_RUN:
1505		rum_cfg_set_run(sc, cc);
1506		break;
1507
1508	default:
1509		break;
1510	}
1511
1512	mtx_unlock(&sc->sc_mtx);
1513	IEEE80211_LOCK(ic);
1514	uvp->newstate(vap, nstate, arg);
1515	if (vap->iv_newstate_cb != NULL)
1516		vap->iv_newstate_cb(vap, nstate, arg);
1517	IEEE80211_UNLOCK(ic);
1518	mtx_lock(&sc->sc_mtx);
1519}
1520
1521static int
1522rum_newstate_cb(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg)
1523{
1524	struct rum_vap *uvp = RUM_VAP(vap);
1525	struct ieee80211com *ic = vap->iv_ic;
1526	struct rum_softc *sc = ic->ic_ifp->if_softc;
1527
1528	DPRINTF("setting new state: %d\n", nstate);
1529
1530	/* Special case - cannot defer this call and cannot block ! */
1531	if (nstate == IEEE80211_S_INIT) {
1532		/* stop timers */
1533		mtx_lock(&sc->sc_mtx);
1534		sc->sc_amrr_timer = 0;
1535		mtx_unlock(&sc->sc_mtx);
1536		return (uvp->newstate(vap, nstate, arg));
1537	}
1538	mtx_lock(&sc->sc_mtx);
1539	if (usb2_config_td_is_gone(&sc->sc_config_td)) {
1540		mtx_unlock(&sc->sc_mtx);
1541		return (0);		/* nothing to do */
1542	}
1543	/* store next state */
1544	sc->sc_ns_state = nstate;
1545	sc->sc_ns_arg = arg;
1546
1547	/* stop timers */
1548	sc->sc_amrr_timer = 0;
1549
1550	/*
1551	 * USB configuration can only be done from the USB configuration
1552	 * thread:
1553	 */
1554	usb2_config_td_queue_command
1555	    (&sc->sc_config_td, &rum_config_copy,
1556	    &rum_cfg_newstate, 0, 0);
1557
1558	mtx_unlock(&sc->sc_mtx);
1559
1560	return (EINPROGRESS);
1561}
1562
1563static void
1564rum_std_command(struct ieee80211com *ic, usb2_config_td_command_t *func)
1565{
1566	struct rum_softc *sc = ic->ic_ifp->if_softc;
1567
1568	mtx_lock(&sc->sc_mtx);
1569
1570	sc->sc_rates = ieee80211_get_ratetable(ic->ic_curchan);
1571
1572	usb2_config_td_queue_command
1573	    (&sc->sc_config_td, &rum_config_copy, func, 0, 0);
1574
1575	mtx_unlock(&sc->sc_mtx);
1576}
1577
1578static void
1579rum_scan_start_cb(struct ieee80211com *ic)
1580{
1581	rum_std_command(ic, &rum_cfg_scan_start);
1582}
1583
1584static void
1585rum_scan_end_cb(struct ieee80211com *ic)
1586{
1587	rum_std_command(ic, &rum_cfg_scan_end);
1588}
1589
1590static void
1591rum_set_channel_cb(struct ieee80211com *ic)
1592{
1593	rum_std_command(ic, &rum_cfg_set_chan);
1594}
1595
1596static void
1597rum_cfg_scan_start(struct rum_softc *sc,
1598    struct usb2_config_td_cc *cc, uint16_t refcount)
1599{
1600	/* abort TSF synchronization */
1601	rum_cfg_disable_tsf_sync(sc);
1602	rum_cfg_set_bssid(sc, cc->if_broadcastaddr);
1603}
1604
1605static void
1606rum_cfg_scan_end(struct rum_softc *sc,
1607    struct usb2_config_td_cc *cc, uint16_t refcount)
1608{
1609	/* enable TSF synchronization */
1610	rum_cfg_enable_tsf_sync(sc, cc, 0);
1611	rum_cfg_set_bssid(sc, cc->iv_bss.ni_bssid);
1612}
1613
1614/*
1615 * Reprogram MAC/BBP to switch to a new band. Values taken from the reference
1616 * driver.
1617 */
1618static void
1619rum_cfg_select_band(struct rum_softc *sc,
1620    struct usb2_config_td_cc *cc, uint16_t refcount)
1621{
1622	uint32_t tmp;
1623	uint8_t bbp17, bbp35, bbp96, bbp97, bbp98, bbp104;
1624
1625	/* update all BBP registers that depend on the band */
1626	bbp17 = 0x20;
1627	bbp96 = 0x48;
1628	bbp104 = 0x2c;
1629	bbp35 = 0x50;
1630	bbp97 = 0x48;
1631	bbp98 = 0x48;
1632
1633	if (cc->ic_curchan.chan_is_5ghz) {
1634		bbp17 += 0x08;
1635		bbp96 += 0x10;
1636		bbp104 += 0x0c;
1637		bbp35 += 0x10;
1638		bbp97 += 0x10;
1639		bbp98 += 0x10;
1640	}
1641	if ((cc->ic_curchan.chan_is_2ghz && sc->sc_ext_2ghz_lna) ||
1642	    (cc->ic_curchan.chan_is_5ghz && sc->sc_ext_5ghz_lna)) {
1643		bbp17 += 0x10;
1644		bbp96 += 0x10;
1645		bbp104 += 0x10;
1646	}
1647	sc->sc_bbp17 = bbp17;
1648	rum_cfg_bbp_write(sc, 17, bbp17);
1649	rum_cfg_bbp_write(sc, 96, bbp96);
1650	rum_cfg_bbp_write(sc, 104, bbp104);
1651
1652	if ((cc->ic_curchan.chan_is_2ghz && sc->sc_ext_2ghz_lna) ||
1653	    (cc->ic_curchan.chan_is_5ghz && sc->sc_ext_5ghz_lna)) {
1654		rum_cfg_bbp_write(sc, 75, 0x80);
1655		rum_cfg_bbp_write(sc, 86, 0x80);
1656		rum_cfg_bbp_write(sc, 88, 0x80);
1657	}
1658	rum_cfg_bbp_write(sc, 35, bbp35);
1659	rum_cfg_bbp_write(sc, 97, bbp97);
1660	rum_cfg_bbp_write(sc, 98, bbp98);
1661
1662	tmp = rum_cfg_read(sc, RT2573_PHY_CSR0);
1663	tmp &= ~(RT2573_PA_PE_2GHZ | RT2573_PA_PE_5GHZ);
1664	if (cc->ic_curchan.chan_is_2ghz)
1665		tmp |= RT2573_PA_PE_2GHZ;
1666	else
1667		tmp |= RT2573_PA_PE_5GHZ;
1668	rum_cfg_write(sc, RT2573_PHY_CSR0, tmp);
1669
1670	/* 802.11a uses a 16 microseconds short interframe space */
1671	sc->sc_sifs = cc->ic_curchan.chan_is_5ghz ? 16 : 10;
1672}
1673
1674static void
1675rum_cfg_set_chan(struct rum_softc *sc,
1676    struct usb2_config_td_cc *cc, uint16_t refcount)
1677{
1678	enum {
1679	N_RF5225 = (sizeof(rum_rf5225) / sizeof(rum_rf5225[0]))};
1680	const struct rfprog *rfprog;
1681	uint32_t chan;
1682	uint16_t i;
1683	uint8_t bbp3;
1684	uint8_t bbp94 = RT2573_BBPR94_DEFAULT;
1685	int8_t power;
1686
1687	chan = cc->ic_curchan.chan_to_ieee;
1688
1689	if ((chan == 0) ||
1690	    (chan == IEEE80211_CHAN_ANY)) {
1691		/* nothing to do */
1692		return;
1693	}
1694	if (chan == sc->sc_last_chan) {
1695		return;
1696	}
1697	sc->sc_last_chan = chan;
1698
1699	/* select the appropriate RF settings based on what EEPROM says */
1700	rfprog = ((sc->sc_rf_rev == RT2573_RF_5225) ||
1701	    (sc->sc_rf_rev == RT2573_RF_2527)) ? rum_rf5225 : rum_rf5226;
1702
1703	/* find the settings for this channel */
1704	for (i = 0;; i++) {
1705		if (i == (N_RF5225 - 1))
1706			break;
1707		if (rfprog[i].chan == chan)
1708			break;
1709	}
1710
1711	DPRINTF("chan=%d, i=%d\n", chan, i);
1712
1713	power = sc->sc_txpow[i];
1714	if (power < 0) {
1715		bbp94 += power;
1716		power = 0;
1717	} else if (power > 31) {
1718		bbp94 += power - 31;
1719		power = 31;
1720	}
1721	/*
1722	 * If we are switching from the 2GHz band to the 5GHz band or
1723	 * vice-versa, BBP registers need to be reprogrammed.
1724	 */
1725	rum_cfg_select_band(sc, cc, 0);
1726	rum_cfg_select_antenna(sc, cc, 0);
1727
1728	rum_cfg_rf_write(sc, RT2573_RF1, rfprog[i].r1);
1729	rum_cfg_rf_write(sc, RT2573_RF2, rfprog[i].r2);
1730	rum_cfg_rf_write(sc, RT2573_RF3, rfprog[i].r3 | (power << 7));
1731	rum_cfg_rf_write(sc, RT2573_RF4, rfprog[i].r4 | (sc->sc_rffreq << 10));
1732
1733	rum_cfg_rf_write(sc, RT2573_RF1, rfprog[i].r1);
1734	rum_cfg_rf_write(sc, RT2573_RF2, rfprog[i].r2);
1735	rum_cfg_rf_write(sc, RT2573_RF3, rfprog[i].r3 | (power << 7) | 1);
1736	rum_cfg_rf_write(sc, RT2573_RF4, rfprog[i].r4 | (sc->sc_rffreq << 10));
1737
1738	rum_cfg_rf_write(sc, RT2573_RF1, rfprog[i].r1);
1739	rum_cfg_rf_write(sc, RT2573_RF2, rfprog[i].r2);
1740	rum_cfg_rf_write(sc, RT2573_RF3, rfprog[i].r3 | (power << 7));
1741	rum_cfg_rf_write(sc, RT2573_RF4, rfprog[i].r4 | (sc->sc_rffreq << 10));
1742
1743	if (usb2_config_td_sleep(&sc->sc_config_td, hz / 100)) {
1744		return;
1745	}
1746	/* enable smart mode for MIMO-capable RFs */
1747	bbp3 = rum_cfg_bbp_read(sc, 3);
1748
1749	if ((sc->sc_rf_rev == RT2573_RF_5225) ||
1750	    (sc->sc_rf_rev == RT2573_RF_2527))
1751		bbp3 &= ~RT2573_SMART_MODE;
1752	else
1753		bbp3 |= RT2573_SMART_MODE;
1754
1755	rum_cfg_bbp_write(sc, 3, bbp3);
1756
1757	rum_cfg_bbp_write(sc, 94, bbp94);
1758
1759	/* update basic rate set */
1760
1761	if (cc->ic_curchan.chan_is_b) {
1762		/* 11b basic rates: 1, 2Mbps */
1763		rum_cfg_write(sc, RT2573_TXRX_CSR5, 0x3);
1764	} else if (cc->ic_curchan.chan_is_a) {
1765		/* 11a basic rates: 6, 12, 24Mbps */
1766		rum_cfg_write(sc, RT2573_TXRX_CSR5, 0x150);
1767	} else {
1768		/* 11b/g basic rates: 1, 2, 5.5, 11Mbps */
1769		rum_cfg_write(sc, RT2573_TXRX_CSR5, 0xf);
1770	}
1771
1772	if (usb2_config_td_sleep(&sc->sc_config_td, hz / 100)) {
1773		return;
1774	}
1775}
1776
1777static void
1778rum_cfg_set_run(struct rum_softc *sc,
1779    struct usb2_config_td_cc *cc)
1780{
1781
1782	if (cc->ic_opmode != IEEE80211_M_MONITOR) {
1783		rum_cfg_update_slot(sc, cc, 0);
1784		rum_cfg_enable_mrr(sc, cc, 0);
1785		rum_cfg_set_txpreamble(sc, cc, 0);
1786
1787		/* update basic rate set */
1788
1789		if (cc->ic_bsschan.chan_is_5ghz) {
1790			/* 11a basic rates: 6, 12, 24Mbps */
1791			rum_cfg_write(sc, RT2573_TXRX_CSR5, 0x150);
1792		} else if (cc->ic_bsschan.chan_is_g) {
1793			/* 11b/g basic rates: 1, 2, 5.5, 11Mbps */
1794			rum_cfg_write(sc, RT2573_TXRX_CSR5, 0xf);
1795		} else {
1796			/* 11b basic rates: 1, 2Mbps */
1797			rum_cfg_write(sc, RT2573_TXRX_CSR5, 0x3);
1798		}
1799		rum_cfg_set_bssid(sc, cc->iv_bss.ni_bssid);
1800	}
1801	if ((cc->ic_opmode == IEEE80211_M_HOSTAP) ||
1802	    (cc->ic_opmode == IEEE80211_M_IBSS)) {
1803		rum_cfg_prepare_beacon(sc, cc, 0);
1804	}
1805	if (cc->ic_opmode != IEEE80211_M_MONITOR) {
1806		rum_cfg_enable_tsf_sync(sc, cc, 0);
1807	}
1808	if (cc->iv_bss.fixed_rate_none) {
1809		/* enable automatic rate adaptation */
1810		rum_cfg_amrr_start(sc);
1811	}
1812}
1813
1814static void
1815rum_cfg_enable_tsf_sync(struct rum_softc *sc,
1816    struct usb2_config_td_cc *cc, uint16_t refcount)
1817{
1818	uint32_t tmp;
1819
1820	if (cc->ic_opmode != IEEE80211_M_STA) {
1821		/*
1822		 * Change default 16ms TBTT adjustment to 8ms.
1823		 * Must be done before enabling beacon generation.
1824		 */
1825		rum_cfg_write(sc, RT2573_TXRX_CSR10, (1 << 12) | 8);
1826	}
1827	tmp = rum_cfg_read(sc, RT2573_TXRX_CSR9) & 0xff000000;
1828
1829	/* set beacon interval (in 1/16ms unit) */
1830	tmp |= cc->iv_bss.ni_intval * 16;
1831
1832	tmp |= RT2573_TSF_TICKING | RT2573_ENABLE_TBTT;
1833	if (cc->ic_opmode == IEEE80211_M_STA)
1834		tmp |= RT2573_TSF_MODE(1);
1835	else
1836		tmp |= RT2573_TSF_MODE(2) | RT2573_GENERATE_BEACON;
1837
1838	rum_cfg_write(sc, RT2573_TXRX_CSR9, tmp);
1839}
1840
1841static void
1842rum_cfg_disable_tsf_sync(struct rum_softc *sc)
1843{
1844	uint32_t tmp;
1845
1846	/* abort TSF synchronization */
1847	tmp = rum_cfg_read(sc, RT2573_TXRX_CSR9);
1848	rum_cfg_write(sc, RT2573_TXRX_CSR9, tmp & ~0x00ffffff);
1849}
1850
1851/*
1852 * Enable multi-rate retries for frames sent at OFDM rates.
1853 * In 802.11b/g mode, allow fallback to CCK rates.
1854 */
1855static void
1856rum_cfg_enable_mrr(struct rum_softc *sc,
1857    struct usb2_config_td_cc *cc, uint16_t refcount)
1858{
1859	uint32_t tmp;
1860
1861	tmp = rum_cfg_read(sc, RT2573_TXRX_CSR4);
1862
1863	if (cc->ic_curchan.chan_is_5ghz)
1864		tmp &= ~RT2573_MRR_CCK_FALLBACK;
1865	else
1866		tmp |= RT2573_MRR_CCK_FALLBACK;
1867
1868	tmp |= RT2573_MRR_ENABLED;
1869
1870	rum_cfg_write(sc, RT2573_TXRX_CSR4, tmp);
1871}
1872
1873static void
1874rum_cfg_update_slot(struct rum_softc *sc,
1875    struct usb2_config_td_cc *cc, uint16_t refcount)
1876{
1877	uint32_t tmp;
1878	uint8_t slottime;
1879
1880	slottime = (cc->ic_flags & IEEE80211_F_SHSLOT) ? 9 : 20;
1881
1882	tmp = rum_cfg_read(sc, RT2573_MAC_CSR9);
1883	tmp = (tmp & ~0xff) | slottime;
1884	rum_cfg_write(sc, RT2573_MAC_CSR9, tmp);
1885
1886	DPRINTF("setting slot time to %u us\n", slottime);
1887}
1888
1889static void
1890rum_cfg_set_txpreamble(struct rum_softc *sc,
1891    struct usb2_config_td_cc *cc, uint16_t refcount)
1892{
1893	uint32_t tmp;
1894
1895	tmp = rum_cfg_read(sc, RT2573_TXRX_CSR4);
1896
1897	if (cc->ic_flags & IEEE80211_F_SHPREAMBLE)
1898		tmp |= RT2573_SHORT_PREAMBLE;
1899	else
1900		tmp &= ~RT2573_SHORT_PREAMBLE;
1901
1902	rum_cfg_write(sc, RT2573_TXRX_CSR4, tmp);
1903}
1904
1905static void
1906rum_cfg_set_bssid(struct rum_softc *sc, uint8_t *bssid)
1907{
1908	uint32_t tmp;
1909
1910	tmp = bssid[0] | (bssid[1] << 8) | (bssid[2] << 16) | (bssid[3] << 24);
1911	rum_cfg_write(sc, RT2573_MAC_CSR4, tmp);
1912
1913	tmp = (bssid[4]) | (bssid[5] << 8) | (RT2573_ONE_BSSID << 16);
1914	rum_cfg_write(sc, RT2573_MAC_CSR5, tmp);
1915}
1916
1917static void
1918rum_cfg_set_macaddr(struct rum_softc *sc, uint8_t *addr)
1919{
1920	uint32_t tmp;
1921
1922	tmp = addr[0] | (addr[1] << 8) | (addr[2] << 16) | (addr[3] << 24);
1923	rum_cfg_write(sc, RT2573_MAC_CSR2, tmp);
1924
1925	tmp = addr[4] | (addr[5] << 8) | (0xff << 16);
1926	rum_cfg_write(sc, RT2573_MAC_CSR3, tmp);
1927}
1928
1929static void
1930rum_cfg_update_promisc(struct rum_softc *sc,
1931    struct usb2_config_td_cc *cc, uint16_t refcount)
1932{
1933	uint32_t tmp;
1934
1935	tmp = rum_cfg_read(sc, RT2573_TXRX_CSR0);
1936
1937	if (cc->if_flags & IFF_PROMISC)
1938		tmp &= ~RT2573_DROP_NOT_TO_ME;
1939	else
1940		tmp |= RT2573_DROP_NOT_TO_ME;
1941
1942	rum_cfg_write(sc, RT2573_TXRX_CSR0, tmp);
1943
1944	DPRINTF("%s promiscuous mode\n",
1945	    (cc->if_flags & IFF_PROMISC) ?
1946	    "entering" : "leaving");
1947}
1948
1949static void
1950rum_cfg_select_antenna(struct rum_softc *sc,
1951    struct usb2_config_td_cc *cc, uint16_t refcount)
1952{
1953	uint32_t tmp;
1954	uint8_t bbp3;
1955	uint8_t bbp4;
1956	uint8_t bbp77;
1957	uint8_t rx_ant;
1958	uint8_t is_5ghz;
1959
1960	bbp3 = rum_cfg_bbp_read(sc, 3);
1961	bbp4 = rum_cfg_bbp_read(sc, 4);
1962	bbp77 = rum_cfg_bbp_read(sc, 77);
1963
1964	bbp3 &= ~0x01;
1965	bbp4 &= ~0x23;
1966
1967	rx_ant = sc->sc_rx_ant;
1968	is_5ghz = cc->ic_curchan.chan_is_5ghz;
1969
1970	switch (sc->sc_rf_rev) {
1971	case RT2573_RF_5226:
1972	case RT2573_RF_5225:
1973		if (rx_ant == 0) {
1974			/* Diversity */
1975			bbp4 |= 0x02;
1976			if (is_5ghz == 0)
1977				bbp4 |= 0x20;
1978		} else if (rx_ant == 1) {
1979			/* RX: Antenna A */
1980			bbp4 |= 0x01;
1981			if (is_5ghz)
1982				bbp77 &= ~0x03;
1983			else
1984				bbp77 |= 0x03;
1985		} else if (rx_ant == 2) {
1986			/* RX: Antenna B */
1987			bbp4 |= 0x01;
1988			if (is_5ghz)
1989				bbp77 |= 0x03;
1990			else
1991				bbp77 &= ~0x03;
1992		}
1993		break;
1994
1995	case RT2573_RF_2528:
1996	case RT2573_RF_2527:
1997		if (rx_ant == 0) {
1998			/* Diversity */
1999			bbp4 |= 0x22;
2000		} else if (rx_ant == 1) {
2001			/* RX: Antenna A */
2002			bbp4 |= 0x21;
2003			bbp77 |= 0x03;
2004		} else if (rx_ant == 2) {
2005			/* RX: Antenna B */
2006			bbp4 |= 0x21;
2007			bbp77 &= ~0x03;
2008		}
2009		break;
2010	default:
2011		break;
2012	}
2013	bbp4 &= ~(sc->sc_ftype << 5);
2014
2015	/* make sure Rx is disabled before switching antenna */
2016	tmp = rum_cfg_read(sc, RT2573_TXRX_CSR0);
2017	rum_cfg_write(sc, RT2573_TXRX_CSR0, tmp | RT2573_DISABLE_RX);
2018
2019	rum_cfg_bbp_write(sc, 3, bbp3);
2020	rum_cfg_bbp_write(sc, 4, bbp4);
2021	rum_cfg_bbp_write(sc, 77, bbp77);
2022
2023	rum_cfg_write(sc, RT2573_TXRX_CSR0, tmp);
2024}
2025
2026static void
2027rum_cfg_read_eeprom(struct rum_softc *sc)
2028{
2029	uint16_t val;
2030
2031	/* read MAC address */
2032	rum_cfg_eeprom_read(sc, RT2573_EEPROM_ADDRESS, sc->sc_myaddr, 6);
2033
2034	val = rum_cfg_eeprom_read_2(sc, RT2573_EEPROM_ANTENNA);
2035	sc->sc_rf_rev = (val >> 11) & 0x1f;
2036	sc->sc_hw_radio = (val >> 10) & 0x1;
2037	sc->sc_ftype = (val >> 6) & 0x1;
2038	sc->sc_rx_ant = (val >> 4) & 0x3;
2039	sc->sc_tx_ant = (val >> 2) & 0x3;
2040	sc->sc_nb_ant = (val & 0x3);
2041
2042	DPRINTF("RF revision=%d\n", sc->sc_rf_rev);
2043
2044	val = rum_cfg_eeprom_read_2(sc, RT2573_EEPROM_CONFIG2);
2045	sc->sc_ext_5ghz_lna = (val >> 6) & 0x1;
2046	sc->sc_ext_2ghz_lna = (val >> 4) & 0x1;
2047
2048	DPRINTF("External 2GHz LNA=%d, External 5GHz LNA=%d\n",
2049	    sc->sc_ext_2ghz_lna, sc->sc_ext_5ghz_lna);
2050
2051	val = rum_cfg_eeprom_read_2(sc, RT2573_EEPROM_RSSI_2GHZ_OFFSET);
2052	if ((val & 0xff) != 0xff)
2053		sc->sc_rssi_2ghz_corr = (int8_t)(val & 0xff);	/* signed */
2054	else
2055		sc->sc_rssi_2ghz_corr = 0;
2056
2057	/* range check */
2058	if ((sc->sc_rssi_2ghz_corr < -10) ||
2059	    (sc->sc_rssi_2ghz_corr > 10)) {
2060		sc->sc_rssi_2ghz_corr = 0;
2061	}
2062	val = rum_cfg_eeprom_read_2(sc, RT2573_EEPROM_RSSI_5GHZ_OFFSET);
2063	if ((val & 0xff) != 0xff)
2064		sc->sc_rssi_5ghz_corr = (int8_t)(val & 0xff);	/* signed */
2065	else
2066		sc->sc_rssi_5ghz_corr = 0;
2067
2068	/* range check */
2069	if ((sc->sc_rssi_5ghz_corr < -10) ||
2070	    (sc->sc_rssi_5ghz_corr > 10)) {
2071		sc->sc_rssi_5ghz_corr = 0;
2072	}
2073	if (sc->sc_ext_2ghz_lna) {
2074		sc->sc_rssi_2ghz_corr -= 14;
2075	}
2076	if (sc->sc_ext_5ghz_lna) {
2077		sc->sc_rssi_5ghz_corr -= 14;
2078	}
2079	DPRINTF("RSSI 2GHz corr=%d, RSSI 5GHz corr=%d\n",
2080	    sc->sc_rssi_2ghz_corr, sc->sc_rssi_5ghz_corr);
2081
2082	val = rum_cfg_eeprom_read_2(sc, RT2573_EEPROM_FREQ_OFFSET);
2083	if ((val & 0xff) != 0xff)
2084		sc->sc_rffreq = (val & 0xff);
2085	else
2086		sc->sc_rffreq = 0;
2087
2088	DPRINTF("RF freq=%d\n", sc->sc_rffreq);
2089
2090	/* read Tx power for all a/b/g channels */
2091	rum_cfg_eeprom_read(sc, RT2573_EEPROM_TXPOWER, sc->sc_txpow, 14);
2092
2093	/* XXX default Tx power for 802.11a channels */
2094	memset(sc->sc_txpow + 14, 24, sizeof(sc->sc_txpow) - 14);
2095
2096	/* read default values for BBP registers */
2097	rum_cfg_eeprom_read(sc, RT2573_EEPROM_BBP_BASE, sc->sc_bbp_prom, 2 * 16);
2098}
2099
2100static uint8_t
2101rum_cfg_bbp_init(struct rum_softc *sc)
2102{
2103	enum {
2104		N_DEF_BBP = (sizeof(rum_def_bbp) / sizeof(rum_def_bbp[0])),
2105	};
2106	uint16_t i;
2107	uint8_t to;
2108	uint8_t tmp;
2109
2110	/* wait for BBP to become ready */
2111	for (to = 0;; to++) {
2112		if (to < 100) {
2113			tmp = rum_cfg_bbp_read(sc, 0);
2114			if ((tmp != 0x00) &&
2115			    (tmp != 0xff)) {
2116				break;
2117			}
2118			if (usb2_config_td_sleep(&sc->sc_config_td, hz / 100)) {
2119				return (1);	/* failure */
2120			}
2121		} else {
2122			DPRINTF("timeout waiting for BBP\n");
2123			return (1);	/* failure */
2124		}
2125	}
2126
2127	/* initialize BBP registers to default values */
2128	for (i = 0; i < N_DEF_BBP; i++) {
2129		rum_cfg_bbp_write(sc, rum_def_bbp[i].reg, rum_def_bbp[i].val);
2130	}
2131
2132	/* write vendor-specific BBP values (from EEPROM) */
2133	for (i = 0; i < 16; i++) {
2134		if ((sc->sc_bbp_prom[i].reg == 0) ||
2135		    (sc->sc_bbp_prom[i].reg == 0xff)) {
2136			continue;
2137		}
2138		rum_cfg_bbp_write(sc, sc->sc_bbp_prom[i].reg, sc->sc_bbp_prom[i].val);
2139	}
2140	return (0);
2141}
2142
2143static void
2144rum_cfg_pre_init(struct rum_softc *sc,
2145    struct usb2_config_td_cc *cc, uint16_t refcount)
2146{
2147	struct ifnet *ifp = sc->sc_ifp;
2148	struct ieee80211com *ic = ifp->if_l2com;
2149
2150	/* immediate configuration */
2151
2152	rum_cfg_pre_stop(sc, cc, 0);
2153
2154	ifp->if_drv_flags |= IFF_DRV_RUNNING;
2155
2156	sc->sc_flags |= RUM_FLAG_HL_READY;
2157
2158	IEEE80211_ADDR_COPY(ic->ic_myaddr, IF_LLADDR(ifp));
2159}
2160
2161static void
2162rum_cfg_init(struct rum_softc *sc,
2163    struct usb2_config_td_cc *cc, uint16_t refcount)
2164{
2165	enum {
2166		N_DEF_MAC = (sizeof(rum_def_mac) / sizeof(rum_def_mac[0])),
2167	};
2168
2169	uint32_t tmp;
2170	uint16_t i;
2171	uint8_t to;
2172
2173	/* delayed configuration */
2174
2175	rum_cfg_stop(sc, cc, 0);
2176
2177	/* initialize MAC registers to default values */
2178	for (i = 0; i < N_DEF_MAC; i++) {
2179		rum_cfg_write(sc, rum_def_mac[i].reg, rum_def_mac[i].val);
2180	}
2181
2182	/* set host ready */
2183	rum_cfg_write(sc, RT2573_MAC_CSR1, 3);
2184	rum_cfg_write(sc, RT2573_MAC_CSR1, 0);
2185
2186	/* wait for BBP/RF to wakeup */
2187	for (to = 0;; to++) {
2188		if (to < 100) {
2189			if (rum_cfg_read(sc, RT2573_MAC_CSR12) & 8) {
2190				break;
2191			}
2192			rum_cfg_write(sc, RT2573_MAC_CSR12, 4);	/* force wakeup */
2193
2194			if (usb2_config_td_sleep(&sc->sc_config_td, hz / 100)) {
2195				goto fail;
2196			}
2197		} else {
2198			DPRINTF("timeout waiting for "
2199			    "BBP/RF to wakeup\n");
2200			goto fail;
2201		}
2202	}
2203
2204	if (rum_cfg_bbp_init(sc)) {
2205		goto fail;
2206	}
2207	/* select default channel */
2208
2209	sc->sc_last_chan = 0;
2210
2211	rum_cfg_set_chan(sc, cc, 0);
2212
2213	/* clear STA registers */
2214	rum_cfg_read_multi(sc, RT2573_STA_CSR0, sc->sc_sta, sizeof(sc->sc_sta));
2215	/* set MAC address */
2216	rum_cfg_set_macaddr(sc, cc->ic_myaddr);
2217
2218	/* initialize ASIC */
2219	rum_cfg_write(sc, RT2573_MAC_CSR1, 4);
2220
2221	/*
2222	 * make sure that the first transaction
2223	 * clears the stall:
2224	 */
2225	sc->sc_flags |= (RUM_FLAG_READ_STALL |
2226	    RUM_FLAG_WRITE_STALL |
2227	    RUM_FLAG_LL_READY);
2228
2229	if ((sc->sc_flags & RUM_FLAG_LL_READY) &&
2230	    (sc->sc_flags & RUM_FLAG_HL_READY)) {
2231		struct ifnet *ifp = sc->sc_ifp;
2232		struct ieee80211com *ic = ifp->if_l2com;
2233
2234		/*
2235		 * start the USB transfers, if not already started:
2236		 */
2237		usb2_transfer_start(sc->sc_xfer[1]);
2238		usb2_transfer_start(sc->sc_xfer[0]);
2239
2240		/*
2241		 * start IEEE802.11 layer
2242		 */
2243		mtx_unlock(&sc->sc_mtx);
2244		ieee80211_start_all(ic);
2245		mtx_lock(&sc->sc_mtx);
2246	}
2247	/* update Rx filter */
2248	tmp = rum_cfg_read(sc, RT2573_TXRX_CSR0) & 0xffff;
2249
2250	tmp |= RT2573_DROP_PHY_ERROR | RT2573_DROP_CRC_ERROR;
2251
2252	if (cc->ic_opmode != IEEE80211_M_MONITOR) {
2253		tmp |= RT2573_DROP_CTL | RT2573_DROP_VER_ERROR |
2254		    RT2573_DROP_ACKCTS;
2255		if (cc->ic_opmode != IEEE80211_M_HOSTAP) {
2256			tmp |= RT2573_DROP_TODS;
2257		}
2258		if (!(cc->if_flags & IFF_PROMISC)) {
2259			tmp |= RT2573_DROP_NOT_TO_ME;
2260		}
2261	}
2262	rum_cfg_write(sc, RT2573_TXRX_CSR0, tmp);
2263
2264	return;
2265
2266fail:
2267	rum_cfg_pre_stop(sc, NULL, 0);
2268
2269	if (cc) {
2270		rum_cfg_stop(sc, cc, 0);
2271	}
2272}
2273
2274static void
2275rum_cfg_pre_stop(struct rum_softc *sc,
2276    struct usb2_config_td_cc *cc, uint16_t refcount)
2277{
2278	struct ifnet *ifp = sc->sc_ifp;
2279
2280	if (cc) {
2281		/* copy the needed configuration */
2282		rum_config_copy(sc, cc, refcount);
2283	}
2284	/* immediate configuration */
2285
2286	if (ifp) {
2287		/* clear flags */
2288		ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
2289	}
2290	sc->sc_flags &= ~(RUM_FLAG_HL_READY |
2291	    RUM_FLAG_LL_READY);
2292
2293	/*
2294	 * stop all the transfers, if not already stopped:
2295	 */
2296	usb2_transfer_stop(sc->sc_xfer[0]);
2297	usb2_transfer_stop(sc->sc_xfer[1]);
2298	usb2_transfer_stop(sc->sc_xfer[2]);
2299	usb2_transfer_stop(sc->sc_xfer[3]);
2300
2301	/* clean up transmission */
2302	rum_tx_clean_queue(sc);
2303}
2304
2305static void
2306rum_cfg_stop(struct rum_softc *sc,
2307    struct usb2_config_td_cc *cc, uint16_t refcount)
2308{
2309	uint32_t tmp;
2310
2311	/* disable Rx */
2312	tmp = rum_cfg_read(sc, RT2573_TXRX_CSR0);
2313	rum_cfg_write(sc, RT2573_TXRX_CSR0, tmp | RT2573_DISABLE_RX);
2314
2315	/* reset ASIC */
2316	rum_cfg_write(sc, RT2573_MAC_CSR1, 3);
2317
2318	/* wait a little */
2319	usb2_config_td_sleep(&sc->sc_config_td, hz / 10);
2320
2321	rum_cfg_write(sc, RT2573_MAC_CSR1, 0);
2322
2323	/* wait a little */
2324	usb2_config_td_sleep(&sc->sc_config_td, hz / 10);
2325}
2326
2327static void
2328rum_cfg_amrr_start(struct rum_softc *sc)
2329{
2330	struct ieee80211vap *vap;
2331	struct ieee80211_node *ni;
2332
2333	vap = rum_get_vap(sc);
2334
2335	if (vap == NULL) {
2336		return;
2337	}
2338	ni = vap->iv_bss;
2339	if (ni == NULL) {
2340		return;
2341	}
2342	/* init AMRR */
2343
2344	ieee80211_amrr_node_init(&RUM_VAP(vap)->amrr, &RUM_NODE(ni)->amn, ni);
2345
2346	/* enable AMRR timer */
2347
2348	sc->sc_amrr_timer = 1;
2349}
2350
2351static void
2352rum_cfg_amrr_timeout(struct rum_softc *sc,
2353    struct usb2_config_td_cc *cc, uint16_t refcount)
2354{
2355	struct ifnet *ifp = sc->sc_ifp;
2356	struct ieee80211vap *vap;
2357	struct ieee80211_node *ni;
2358	uint32_t ok;
2359	uint32_t fail;
2360
2361	/* clear statistic registers (STA_CSR0 to STA_CSR5) */
2362	rum_cfg_read_multi(sc, RT2573_STA_CSR0, sc->sc_sta, sizeof(sc->sc_sta));
2363
2364	vap = rum_get_vap(sc);
2365	if (vap == NULL) {
2366		return;
2367	}
2368	ni = vap->iv_bss;
2369	if (ni == NULL) {
2370		return;
2371	}
2372	if ((sc->sc_flags & RUM_FLAG_LL_READY) &&
2373	    (sc->sc_flags & RUM_FLAG_HL_READY)) {
2374
2375		ok = (le32toh(sc->sc_sta[4]) >> 16) +	/* TX ok w/o retry */
2376		    (le32toh(sc->sc_sta[5]) & 0xffff);	/* TX ok w/ retry */
2377		fail = (le32toh(sc->sc_sta[5]) >> 16);	/* TX retry-fail count */
2378
2379		if (sc->sc_amrr_timer) {
2380			ieee80211_amrr_tx_update(&RUM_NODE(vap->iv_bss)->amn,
2381			    ok + fail, ok, (le32toh(sc->sc_sta[5]) & 0xffff) + fail);
2382
2383			if (ieee80211_amrr_choose(ni, &RUM_NODE(ni)->amn)) {
2384				/* ignore */
2385			}
2386		}
2387		ifp->if_oerrors += fail;/* count TX retry-fail as Tx errors */
2388	}
2389}
2390
2391static void
2392rum_cfg_load_microcode(struct rum_softc *sc, const uint8_t *ucode, uint16_t size)
2393{
2394	struct usb2_device_request req;
2395	uint16_t reg = RT2573_MCU_CODE_BASE;
2396
2397	/* copy firmware image into NIC */
2398	while (size >= 4) {
2399		rum_cfg_write(sc, reg, UGETDW(ucode));
2400		reg += 4;
2401		ucode += 4;
2402		size -= 4;
2403	}
2404
2405	if (size != 0) {
2406		DPRINTF("possibly invalid firmware\n");
2407	}
2408	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
2409	req.bRequest = RT2573_MCU_CNTL;
2410	USETW(req.wValue, RT2573_MCU_RUN);
2411	USETW(req.wIndex, 0);
2412	USETW(req.wLength, 0);
2413
2414	rum_cfg_do_request(sc, &req, NULL);
2415}
2416
2417static void
2418rum_cfg_prepare_beacon(struct rum_softc *sc,
2419    struct usb2_config_td_cc *cc, uint16_t refcount)
2420{
2421	struct ieee80211_node *ni;
2422	struct ieee80211vap *vap;
2423	struct ieee80211com *ic;
2424	const struct ieee80211_txparam *tp;
2425	struct mbuf *m;
2426
2427	vap = rum_get_vap(sc);
2428	if (vap == NULL) {
2429		return;
2430	}
2431	ni = vap->iv_bss;
2432	if (ni == NULL) {
2433		return;
2434	}
2435	ic = vap->iv_ic;
2436	if (ic == NULL) {
2437		return;
2438	}
2439	DPRINTFN(11, "Sending beacon frame.\n");
2440
2441	m = ieee80211_beacon_alloc(ni, &RUM_VAP(vap)->bo);
2442	if (m == NULL) {
2443		DPRINTFN(0, "could not allocate beacon\n");
2444		return;
2445	}
2446	tp = &vap->iv_txparms[ieee80211_chan2mode(ic->ic_bsschan)];
2447
2448	m->m_pkthdr.rcvif = (void *)ieee80211_ref_node(ni);
2449	rum_setup_desc_and_tx(sc, m, RT2573_TX_TIMESTAMP, RT2573_TX_HWSEQ | RT2573_TX_BEACON, tp->mgmtrate);
2450}
2451
2452static uint8_t
2453rum_get_rssi(struct rum_softc *sc, uint8_t raw)
2454{
2455	struct ifnet *ifp = sc->sc_ifp;
2456	struct ieee80211com *ic = ifp->if_l2com;
2457	int16_t rssi;
2458	uint8_t lna;
2459	uint8_t agc;
2460
2461	lna = (raw >> 5) & 0x3;
2462	agc = raw & 0x1f;
2463
2464	if (lna == 0) {
2465		/*
2466                 * No RSSI mapping
2467                 *
2468                 * NB: Since RSSI is relative to noise floor, -1 is
2469                 *     adequate for caller to know error happened.
2470                 */
2471		return (0);
2472	}
2473	rssi = (2 * agc) - RT2573_NOISE_FLOOR;
2474
2475	if (IEEE80211_IS_CHAN_2GHZ(ic->ic_curchan)) {
2476
2477		rssi += sc->sc_rssi_2ghz_corr;
2478
2479		if (lna == 1)
2480			rssi -= 64;
2481		else if (lna == 2)
2482			rssi -= 74;
2483		else if (lna == 3)
2484			rssi -= 90;
2485	} else {
2486
2487		rssi += sc->sc_rssi_5ghz_corr;
2488
2489		if ((!sc->sc_ext_5ghz_lna) && (lna != 1))
2490			rssi += 4;
2491
2492		if (lna == 1)
2493			rssi -= 64;
2494		else if (lna == 2)
2495			rssi -= 86;
2496		else if (lna == 3)
2497			rssi -= 100;
2498	}
2499
2500	/* range check */
2501
2502	if (rssi < 0)
2503		rssi = 0;
2504	else if (rssi > 255)
2505		rssi = 255;
2506
2507	return (rssi);
2508}
2509
2510static struct ieee80211vap *
2511rum_vap_create(struct ieee80211com *ic,
2512    const char name[IFNAMSIZ], int unit, int opmode, int flags,
2513    const uint8_t bssid[IEEE80211_ADDR_LEN],
2514    const uint8_t mac[IEEE80211_ADDR_LEN])
2515{
2516	struct rum_vap *rvp;
2517	struct ieee80211vap *vap;
2518	struct rum_softc *sc = ic->ic_ifp->if_softc;
2519
2520	DPRINTF("\n");
2521
2522	/* Need to sync with config thread: */
2523	mtx_lock(&sc->sc_mtx);
2524	if (usb2_config_td_sync(&sc->sc_config_td)) {
2525		mtx_unlock(&sc->sc_mtx);
2526		/* config thread is gone */
2527		return (NULL);
2528	}
2529	mtx_unlock(&sc->sc_mtx);
2530
2531	if (!TAILQ_EMPTY(&ic->ic_vaps))	/* only one at a time */
2532		return NULL;
2533	rvp = (struct rum_vap *)malloc(sizeof(struct rum_vap),
2534	    M_80211_VAP, M_NOWAIT | M_ZERO);
2535	if (rvp == NULL)
2536		return NULL;
2537	vap = &rvp->vap;
2538	/* enable s/w bmiss handling for sta mode */
2539	ieee80211_vap_setup(ic, vap, name, unit, opmode,
2540	    flags | IEEE80211_CLONE_NOBEACONS, bssid, mac);
2541
2542	/* override state transition machine */
2543	rvp->newstate = vap->iv_newstate;
2544	vap->iv_newstate = &rum_newstate_cb;
2545
2546	ieee80211_amrr_init(&rvp->amrr, vap,
2547	    IEEE80211_AMRR_MIN_SUCCESS_THRESHOLD,
2548	    IEEE80211_AMRR_MAX_SUCCESS_THRESHOLD,
2549	    1000 /* 1 sec */ );
2550
2551	/* complete setup */
2552	ieee80211_vap_attach(vap, ieee80211_media_change, ieee80211_media_status);
2553
2554	/* store current operation mode */
2555	ic->ic_opmode = opmode;
2556
2557	return (vap);
2558}
2559
2560static void
2561rum_vap_delete(struct ieee80211vap *vap)
2562{
2563	struct rum_vap *rvp = RUM_VAP(vap);
2564	struct rum_softc *sc = vap->iv_ic->ic_ifp->if_softc;
2565
2566	DPRINTF("\n");
2567
2568	/* Need to sync with config thread: */
2569	mtx_lock(&sc->sc_mtx);
2570	if (usb2_config_td_sync(&sc->sc_config_td)) {
2571		/* ignore */
2572	}
2573	mtx_unlock(&sc->sc_mtx);
2574
2575	ieee80211_amrr_cleanup(&rvp->amrr);
2576	ieee80211_vap_detach(vap);
2577	free(rvp, M_80211_VAP);
2578}
2579
2580/* ARGUSED */
2581static struct ieee80211_node *
2582rum_node_alloc(struct ieee80211vap *vap __unused,
2583    const uint8_t mac[IEEE80211_ADDR_LEN] __unused)
2584{
2585	struct rum_node *rn;
2586
2587	rn = malloc(sizeof(struct rum_node), M_80211_NODE, M_NOWAIT | M_ZERO);
2588	return ((rn != NULL) ? &rn->ni : NULL);
2589}
2590
2591static void
2592rum_newassoc(struct ieee80211_node *ni, int isnew)
2593{
2594	struct ieee80211vap *vap = ni->ni_vap;
2595
2596	ieee80211_amrr_node_init(&RUM_VAP(vap)->amrr, &RUM_NODE(ni)->amn, ni);
2597}
2598
2599static void
2600rum_fill_write_queue(struct rum_softc *sc)
2601{
2602	struct ifnet *ifp = sc->sc_ifp;
2603	struct ieee80211_node *ni;
2604	struct mbuf *m;
2605
2606	/*
2607	 * We only fill up half of the queue with data frames. The rest is
2608	 * reserved for other kinds of frames.
2609	 */
2610
2611	while (sc->sc_tx_queue.ifq_len < (IFQ_MAXLEN / 2)) {
2612
2613		IFQ_DRV_DEQUEUE(&ifp->if_snd, m);
2614		if (m == NULL)
2615			break;
2616
2617		ni = (void *)(m->m_pkthdr.rcvif);
2618		m = ieee80211_encap(ni, m);
2619		if (m == NULL) {
2620			ieee80211_free_node(ni);
2621			continue;
2622		}
2623		rum_tx_data(sc, m, ni);
2624	}
2625}
2626
2627static void
2628rum_tx_clean_queue(struct rum_softc *sc)
2629{
2630	struct mbuf *m;
2631
2632	for (;;) {
2633		_IF_DEQUEUE(&sc->sc_tx_queue, m);
2634
2635		if (!m) {
2636			break;
2637		}
2638		rum_tx_freem(m);
2639	}
2640}
2641
2642static void
2643rum_tx_freem(struct mbuf *m)
2644{
2645	struct ieee80211_node *ni;
2646
2647	while (m) {
2648		ni = (void *)(m->m_pkthdr.rcvif);
2649		if (!ni) {
2650			m = m_free(m);
2651			continue;
2652		}
2653		if (m->m_flags & M_TXCB) {
2654			ieee80211_process_callback(ni, m, 0);
2655		}
2656		m_freem(m);
2657		ieee80211_free_node(ni);
2658
2659		break;
2660	}
2661}
2662
2663static void
2664rum_tx_mgt(struct rum_softc *sc, struct mbuf *m, struct ieee80211_node *ni)
2665{
2666	struct ieee80211vap *vap = ni->ni_vap;
2667	struct ieee80211com *ic = ni->ni_ic;
2668	const struct ieee80211_txparam *tp;
2669	struct ieee80211_frame *wh;
2670	struct ieee80211_key *k;
2671	uint32_t flags;
2672	uint16_t dur;
2673
2674	tp = &vap->iv_txparms[ieee80211_chan2mode(ic->ic_curchan)];
2675
2676	wh = mtod(m, struct ieee80211_frame *);
2677	if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
2678		k = ieee80211_crypto_encap(ni, m);
2679		if (k == NULL) {
2680			m_freem(m);
2681			ieee80211_free_node(ni);
2682			return;
2683		}
2684		wh = mtod(m, struct ieee80211_frame *);
2685	}
2686	flags = 0;
2687	if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) {
2688		flags |= RT2573_TX_NEED_ACK;
2689
2690		dur = ieee80211_ack_duration(sc->sc_rates, tp->mgmtrate,
2691		    ic->ic_flags & IEEE80211_F_SHPREAMBLE);
2692		USETW(wh->i_dur, dur);
2693
2694		/* tell hardware to add timestamp for probe responses */
2695		if ((wh->i_fc[0] &
2696		    (IEEE80211_FC0_TYPE_MASK | IEEE80211_FC0_SUBTYPE_MASK)) ==
2697		    (IEEE80211_FC0_TYPE_MGT | IEEE80211_FC0_SUBTYPE_PROBE_RESP))
2698			flags |= RT2573_TX_TIMESTAMP;
2699	}
2700	m->m_pkthdr.rcvif = (void *)ni;
2701	rum_setup_desc_and_tx(sc, m, flags, 0, tp->mgmtrate);
2702}
2703
2704static struct ieee80211vap *
2705rum_get_vap(struct rum_softc *sc)
2706{
2707	struct ifnet *ifp;
2708	struct ieee80211com *ic;
2709
2710	if (sc == NULL) {
2711		return NULL;
2712	}
2713	ifp = sc->sc_ifp;
2714	if (ifp == NULL) {
2715		return NULL;
2716	}
2717	ic = ifp->if_l2com;
2718	if (ic == NULL) {
2719		return NULL;
2720	}
2721	return TAILQ_FIRST(&ic->ic_vaps);
2722}
2723
2724static void
2725rum_tx_data(struct rum_softc *sc, struct mbuf *m,
2726    struct ieee80211_node *ni)
2727{
2728	struct ieee80211vap *vap = ni->ni_vap;
2729	struct ieee80211com *ic = ni->ni_ic;
2730	const struct ieee80211_txparam *tp;
2731	struct ieee80211_frame *wh;
2732	struct ieee80211_key *k;
2733	uint32_t flags = 0;
2734	uint16_t dur;
2735	uint16_t rate;
2736
2737	DPRINTFN(11, "Sending data.\n");
2738
2739	wh = mtod(m, struct ieee80211_frame *);
2740
2741	tp = &vap->iv_txparms[ieee80211_chan2mode(ni->ni_chan)];
2742	if (IEEE80211_IS_MULTICAST(wh->i_addr1))
2743		rate = tp->mcastrate;
2744	else if (tp->ucastrate != IEEE80211_FIXED_RATE_NONE)
2745		rate = tp->ucastrate;
2746	else
2747		rate = ni->ni_txrate;
2748
2749	if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
2750		k = ieee80211_crypto_encap(ni, m);
2751		if (k == NULL) {
2752			m_freem(m);
2753			ieee80211_free_node(ni);
2754			return;
2755		}
2756		/* packet header may have moved, reset our local pointer */
2757		wh = mtod(m, struct ieee80211_frame *);
2758	}
2759	if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) {
2760		uint8_t prot = IEEE80211_PROT_NONE;
2761
2762		if (m->m_pkthdr.len + IEEE80211_CRC_LEN > vap->iv_rtsthreshold)
2763			prot = IEEE80211_PROT_RTSCTS;
2764		else if ((ic->ic_flags & IEEE80211_F_USEPROT) &&
2765		    ieee80211_rate2phytype(sc->sc_rates, rate) == IEEE80211_T_OFDM)
2766			prot = ic->ic_protmode;
2767		if (prot != IEEE80211_PROT_NONE) {
2768			rum_tx_prot(sc, m, ni, prot, rate);
2769			flags |= RT2573_TX_LONG_RETRY | RT2573_TX_IFS_SIFS;
2770		}
2771		flags |= RT2573_TX_NEED_ACK;
2772		flags |= RT2573_TX_MORE_FRAG;
2773
2774		dur = ieee80211_ack_duration(sc->sc_rates, rate,
2775		    ic->ic_flags & IEEE80211_F_SHPREAMBLE);
2776		USETW(wh->i_dur, dur);
2777	}
2778	m->m_pkthdr.rcvif = (void *)ni;
2779	rum_setup_desc_and_tx(sc, m, flags, 0, rate);
2780}
2781
2782static void
2783rum_tx_prot(struct rum_softc *sc,
2784    const struct mbuf *m, struct ieee80211_node *ni,
2785    uint8_t prot, uint16_t rate)
2786{
2787	struct ieee80211com *ic = ni->ni_ic;
2788	const struct ieee80211_frame *wh;
2789	struct mbuf *mprot;
2790	uint32_t flags;
2791	uint16_t protrate;
2792	uint16_t ackrate;
2793	uint16_t pktlen;
2794	uint16_t dur;
2795	uint8_t isshort;
2796
2797	KASSERT((prot == IEEE80211_PROT_RTSCTS) ||
2798	    (prot == IEEE80211_PROT_CTSONLY),
2799	    ("protection %u", prot));
2800
2801	DPRINTFN(11, "Sending protection frame.\n");
2802
2803	wh = mtod(m, const struct ieee80211_frame *);
2804	pktlen = m->m_pkthdr.len + IEEE80211_CRC_LEN;
2805
2806	protrate = ieee80211_ctl_rate(sc->sc_rates, rate);
2807	ackrate = ieee80211_ack_rate(sc->sc_rates, rate);
2808
2809	isshort = (ic->ic_flags & IEEE80211_F_SHPREAMBLE) != 0;
2810	dur = ieee80211_compute_duration(sc->sc_rates, pktlen, rate, isshort);
2811	+ieee80211_ack_duration(sc->sc_rates, rate, isshort);
2812	flags = RT2573_TX_MORE_FRAG;
2813	if (prot == IEEE80211_PROT_RTSCTS) {
2814		/* NB: CTS is the same size as an ACK */
2815		dur += ieee80211_ack_duration(sc->sc_rates, rate, isshort);
2816		flags |= RT2573_TX_NEED_ACK;
2817		mprot = ieee80211_alloc_rts(ic, wh->i_addr1, wh->i_addr2, dur);
2818	} else {
2819		mprot = ieee80211_alloc_cts(ic, ni->ni_vap->iv_myaddr, dur);
2820	}
2821	if (mprot == NULL) {
2822		return;
2823	}
2824	mprot->m_pkthdr.rcvif = (void *)ieee80211_ref_node(ni);
2825	rum_setup_desc_and_tx(sc, mprot, flags, 0, protrate);
2826}
2827
2828static void
2829rum_tx_raw(struct rum_softc *sc, struct mbuf *m, struct ieee80211_node *ni,
2830    const struct ieee80211_bpf_params *params)
2831{
2832	uint32_t flags;
2833	uint16_t rate;
2834
2835	DPRINTFN(11, "Sending raw frame.\n");
2836
2837	rate = params->ibp_rate0 & IEEE80211_RATE_VAL;
2838
2839	/* XXX validate */
2840	if (rate == 0) {
2841		m_freem(m);
2842		ieee80211_free_node(ni);
2843		return;
2844	}
2845	flags = 0;
2846	if ((params->ibp_flags & IEEE80211_BPF_NOACK) == 0)
2847		flags |= RT2573_TX_NEED_ACK;
2848	if (params->ibp_flags & (IEEE80211_BPF_RTS | IEEE80211_BPF_CTS)) {
2849		rum_tx_prot(sc, m, ni,
2850		    params->ibp_flags & IEEE80211_BPF_RTS ?
2851		    IEEE80211_PROT_RTSCTS : IEEE80211_PROT_CTSONLY,
2852		    rate);
2853		flags |= RT2573_TX_LONG_RETRY | RT2573_TX_IFS_SIFS;
2854	}
2855	m->m_pkthdr.rcvif = (void *)ni;
2856	rum_setup_desc_and_tx(sc, m, flags, 0, rate);
2857}
2858
2859static int
2860rum_raw_xmit_cb(struct ieee80211_node *ni, struct mbuf *m,
2861    const struct ieee80211_bpf_params *params)
2862{
2863	struct ieee80211com *ic = ni->ni_ic;
2864	struct ifnet *ifp = ic->ic_ifp;
2865	struct rum_softc *sc = ifp->if_softc;
2866
2867	mtx_lock(&sc->sc_mtx);
2868	if (params == NULL) {
2869		/*
2870		 * Legacy path; interpret frame contents to decide
2871		 * precisely how to send the frame.
2872		 */
2873		rum_tx_mgt(sc, m, ni);
2874	} else {
2875		/*
2876		 * Caller supplied explicit parameters to use in
2877		 * sending the frame.
2878		 */
2879		rum_tx_raw(sc, m, ni, params);
2880	}
2881	mtx_unlock(&sc->sc_mtx);
2882	return (0);
2883}
2884
2885static void
2886rum_update_mcast_cb(struct ifnet *ifp)
2887{
2888	/* not supported */
2889}
2890
2891static void
2892rum_update_promisc_cb(struct ifnet *ifp)
2893{
2894	struct rum_softc *sc = ifp->if_softc;
2895
2896	mtx_lock(&sc->sc_mtx);
2897	usb2_config_td_queue_command
2898	    (&sc->sc_config_td, &rum_config_copy,
2899	    &rum_cfg_update_promisc, 0, 0);
2900	mtx_unlock(&sc->sc_mtx);
2901}
2902