if_urtwn.c revision 251596
1251538Srpaulo/*	$OpenBSD: if_urtwn.c,v 1.16 2011/02/10 17:26:40 jakemsr Exp $	*/
2251538Srpaulo
3251538Srpaulo/*-
4251538Srpaulo * Copyright (c) 2010 Damien Bergamini <damien.bergamini@free.fr>
5251538Srpaulo *
6251538Srpaulo * Permission to use, copy, modify, and distribute this software for any
7251538Srpaulo * purpose with or without fee is hereby granted, provided that the above
8251538Srpaulo * copyright notice and this permission notice appear in all copies.
9251538Srpaulo *
10251538Srpaulo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11251538Srpaulo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
12251538Srpaulo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
13251538Srpaulo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
14251538Srpaulo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15251538Srpaulo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16251538Srpaulo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
17251538Srpaulo */
18251538Srpaulo
19251538Srpaulo#include <sys/cdefs.h>
20251538Srpaulo__FBSDID("$FreeBSD: head/sys/dev/usb/wlan/if_urtwn.c 251596 2013-06-10 05:45:16Z rpaulo $");
21251538Srpaulo
22251538Srpaulo/*
23251538Srpaulo * Driver for Realtek RTL8188CE-VAU/RTL8188CUS/RTL8188RU/RTL8192CU.
24251538Srpaulo */
25251538Srpaulo
26251538Srpaulo#include <sys/param.h>
27251538Srpaulo#include <sys/sockio.h>
28251538Srpaulo#include <sys/sysctl.h>
29251538Srpaulo#include <sys/lock.h>
30251538Srpaulo#include <sys/mutex.h>
31251538Srpaulo#include <sys/mbuf.h>
32251538Srpaulo#include <sys/kernel.h>
33251538Srpaulo#include <sys/socket.h>
34251538Srpaulo#include <sys/systm.h>
35251538Srpaulo#include <sys/malloc.h>
36251538Srpaulo#include <sys/module.h>
37251538Srpaulo#include <sys/bus.h>
38251538Srpaulo#include <sys/endian.h>
39251538Srpaulo#include <sys/linker.h>
40251538Srpaulo#include <sys/firmware.h>
41251538Srpaulo#include <sys/kdb.h>
42251538Srpaulo
43251538Srpaulo#include <machine/bus.h>
44251538Srpaulo#include <machine/resource.h>
45251538Srpaulo#include <sys/rman.h>
46251538Srpaulo
47251538Srpaulo#include <net/bpf.h>
48251538Srpaulo#include <net/if.h>
49251538Srpaulo#include <net/if_arp.h>
50251538Srpaulo#include <net/ethernet.h>
51251538Srpaulo#include <net/if_dl.h>
52251538Srpaulo#include <net/if_media.h>
53251538Srpaulo#include <net/if_types.h>
54251538Srpaulo
55251538Srpaulo#include <netinet/in.h>
56251538Srpaulo#include <netinet/in_systm.h>
57251538Srpaulo#include <netinet/in_var.h>
58251538Srpaulo#include <netinet/if_ether.h>
59251538Srpaulo#include <netinet/ip.h>
60251538Srpaulo
61251538Srpaulo#include <net80211/ieee80211_var.h>
62251538Srpaulo#include <net80211/ieee80211_regdomain.h>
63251538Srpaulo#include <net80211/ieee80211_radiotap.h>
64251538Srpaulo#include <net80211/ieee80211_ratectl.h>
65251538Srpaulo
66251538Srpaulo#include <dev/usb/usb.h>
67251538Srpaulo#include <dev/usb/usbdi.h>
68251538Srpaulo#include "usbdevs.h"
69251538Srpaulo
70251538Srpaulo#define USB_DEBUG_VAR urtwn_debug
71251538Srpaulo#include <dev/usb/usb_debug.h>
72251538Srpaulo
73251538Srpaulo#include <dev/usb/wlan/if_urtwnreg.h>
74251538Srpaulo
75251538Srpaulo#ifdef USB_DEBUG
76251538Srpaulostatic int urtwn_debug = 0;
77251538Srpaulo
78251538SrpauloSYSCTL_NODE(_hw_usb, OID_AUTO, urtwn, CTLFLAG_RW, 0, "USB urtwn");
79251538SrpauloSYSCTL_INT(_hw_usb_urtwn, OID_AUTO, debug, CTLFLAG_RW, &urtwn_debug, 0,
80251538Srpaulo    "Debug level");
81251538Srpaulo#endif
82251538Srpaulo
83251538Srpaulo#define	IEEE80211_HAS_ADDR4(wh)	\
84251538Srpaulo	(((wh)->i_fc[1] & IEEE80211_FC1_DIR_MASK) == IEEE80211_FC1_DIR_DSTODS)
85251538Srpaulo
86251538Srpaulo/* various supported device vendors/products */
87251596Srpaulostatic const STRUCT_USB_HOST_ID urtwn_devs[] = {
88251538Srpaulo#define URTWN_DEV(v,p)  { USB_VP(USB_VENDOR_##v, USB_PRODUCT_##v##_##p) }
89251538Srpaulo	URTWN_DEV(ABOCOM,	RTL8188CU_1),
90251538Srpaulo	URTWN_DEV(ABOCOM,	RTL8188CU_2),
91251538Srpaulo	URTWN_DEV(ABOCOM,	RTL8192CU),
92251538Srpaulo	URTWN_DEV(ASUS,		RTL8192CU),
93251538Srpaulo	URTWN_DEV(AZUREWAVE,	RTL8188CE_1),
94251538Srpaulo	URTWN_DEV(AZUREWAVE,	RTL8188CE_2),
95251538Srpaulo	URTWN_DEV(AZUREWAVE,	RTL8188CU),
96251538Srpaulo	URTWN_DEV(BELKIN,	F7D2102),
97251538Srpaulo	URTWN_DEV(BELKIN,	RTL8188CU),
98251538Srpaulo	URTWN_DEV(BELKIN,	RTL8192CU),
99251538Srpaulo	URTWN_DEV(CHICONY,	RTL8188CUS_1),
100251538Srpaulo	URTWN_DEV(CHICONY,	RTL8188CUS_2),
101251538Srpaulo	URTWN_DEV(CHICONY,	RTL8188CUS_3),
102251538Srpaulo	URTWN_DEV(CHICONY,	RTL8188CUS_4),
103251538Srpaulo	URTWN_DEV(CHICONY,	RTL8188CUS_5),
104251538Srpaulo	URTWN_DEV(COREGA,	RTL8192CU),
105251538Srpaulo	URTWN_DEV(DLINK,	RTL8188CU),
106251538Srpaulo	URTWN_DEV(DLINK,	RTL8192CU_1),
107251538Srpaulo	URTWN_DEV(DLINK,	RTL8192CU_2),
108251538Srpaulo	URTWN_DEV(DLINK,	RTL8192CU_3),
109251538Srpaulo	URTWN_DEV(EDIMAX,	EW7811UN),
110251538Srpaulo	URTWN_DEV(EDIMAX,	RTL8192CU),
111251538Srpaulo	URTWN_DEV(FEIXUN,	RTL8188CU),
112251538Srpaulo	URTWN_DEV(FEIXUN,	RTL8192CU),
113251538Srpaulo	URTWN_DEV(GUILLEMOT,	HWNUP150),
114251538Srpaulo	URTWN_DEV(HAWKING,	RTL8192CU),
115251538Srpaulo	URTWN_DEV(HP3,		RTL8188CU),
116251538Srpaulo	URTWN_DEV(NETGEAR,	WNA1000M),
117251538Srpaulo	URTWN_DEV(NETGEAR,	RTL8192CU),
118251538Srpaulo	URTWN_DEV(NETGEAR4,	RTL8188CU),
119251538Srpaulo	URTWN_DEV(NOVATECH,	RTL8188CU),
120251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8188CU_1),
121251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8188CU_2),
122251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8188CU_3),
123251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8188CU_4),
124251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8188CUS),
125251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8192CU),
126251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CE_0),
127251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CE_1),
128251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CTV),
129251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CU_0),
130251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CU_1),
131251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CU_2),
132251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CU_COMBO),
133251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CUS),
134251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188RU_1),
135251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188RU_2),
136251538Srpaulo	URTWN_DEV(REALTEK,	RTL8191CU),
137251538Srpaulo	URTWN_DEV(REALTEK,	RTL8192CE),
138251538Srpaulo	URTWN_DEV(REALTEK,	RTL8192CU),
139251538Srpaulo	URTWN_DEV(SITECOMEU,	RTL8188CU_1),
140251538Srpaulo	URTWN_DEV(SITECOMEU,	RTL8188CU_2),
141251538Srpaulo	URTWN_DEV(SITECOMEU,	RTL8192CU),
142251538Srpaulo	URTWN_DEV(TRENDNET,	RTL8188CU),
143251538Srpaulo	URTWN_DEV(TRENDNET,	RTL8192CU),
144251538Srpaulo	URTWN_DEV(ZYXEL,	RTL8192CU),
145251538Srpaulo#undef URTWN_DEV
146251538Srpaulo};
147251538Srpaulo
148251538Srpaulostatic device_probe_t	urtwn_match;
149251538Srpaulostatic device_attach_t	urtwn_attach;
150251538Srpaulostatic device_detach_t	urtwn_detach;
151251538Srpaulo
152251538Srpaulostatic usb_callback_t   urtwn_bulk_tx_callback;
153251538Srpaulostatic usb_callback_t	urtwn_bulk_rx_callback;
154251538Srpaulo
155251538Srpaulostatic usb_error_t	urtwn_do_request(struct urtwn_softc *sc,
156251538Srpaulo			    struct usb_device_request *req, void *data);
157251538Srpaulostatic struct ieee80211vap *urtwn_vap_create(struct ieee80211com *,
158251538Srpaulo		    const char [IFNAMSIZ], int, enum ieee80211_opmode, int,
159251538Srpaulo                    const uint8_t [IEEE80211_ADDR_LEN],
160251538Srpaulo                    const uint8_t [IEEE80211_ADDR_LEN]);
161251538Srpaulostatic void		urtwn_vap_delete(struct ieee80211vap *);
162251538Srpaulostatic struct mbuf *	urtwn_rx_frame(struct urtwn_softc *, uint8_t *, int,
163251538Srpaulo			    int *);
164251538Srpaulostatic struct mbuf *	urtwn_rxeof(struct usb_xfer *, struct urtwn_data *,
165251538Srpaulo			    int *, int8_t *);
166251538Srpaulostatic void		urtwn_txeof(struct usb_xfer *, struct urtwn_data *);
167251538Srpaulostatic int		urtwn_alloc_list(struct urtwn_softc *,
168251538Srpaulo			    struct urtwn_data[], int, int);
169251538Srpaulostatic int		urtwn_alloc_rx_list(struct urtwn_softc *);
170251538Srpaulostatic int		urtwn_alloc_tx_list(struct urtwn_softc *);
171251538Srpaulostatic void		urtwn_free_tx_list(struct urtwn_softc *);
172251538Srpaulostatic void		urtwn_free_rx_list(struct urtwn_softc *);
173251538Srpaulostatic void		urtwn_free_list(struct urtwn_softc *,
174251538Srpaulo			    struct urtwn_data data[], int);
175251538Srpaulostatic struct urtwn_data *	_urtwn_getbuf(struct urtwn_softc *);
176251538Srpaulostatic struct urtwn_data *	urtwn_getbuf(struct urtwn_softc *);
177251538Srpaulostatic int		urtwn_write_region_1(struct urtwn_softc *, uint16_t,
178251538Srpaulo			    uint8_t *, int);
179251538Srpaulostatic void		urtwn_write_1(struct urtwn_softc *, uint16_t, uint8_t);
180251538Srpaulostatic void		urtwn_write_2(struct urtwn_softc *, uint16_t, uint16_t);
181251538Srpaulostatic void		urtwn_write_4(struct urtwn_softc *, uint16_t, uint32_t);
182251538Srpaulostatic int		urtwn_read_region_1(struct urtwn_softc *, uint16_t,
183251538Srpaulo			    uint8_t *, int);
184251538Srpaulostatic uint8_t		urtwn_read_1(struct urtwn_softc *, uint16_t);
185251538Srpaulostatic uint16_t		urtwn_read_2(struct urtwn_softc *, uint16_t);
186251538Srpaulostatic uint32_t		urtwn_read_4(struct urtwn_softc *, uint16_t);
187251538Srpaulostatic int		urtwn_fw_cmd(struct urtwn_softc *, uint8_t,
188251538Srpaulo			    const void *, int);
189251538Srpaulostatic void		urtwn_rf_write(struct urtwn_softc *, int, uint8_t,
190251538Srpaulo			    uint32_t);
191251538Srpaulostatic uint32_t		urtwn_rf_read(struct urtwn_softc *, int, uint8_t);
192251538Srpaulostatic int		urtwn_llt_write(struct urtwn_softc *, uint32_t,
193251538Srpaulo			    uint32_t);
194251538Srpaulostatic uint8_t		urtwn_efuse_read_1(struct urtwn_softc *, uint16_t);
195251538Srpaulostatic void		urtwn_efuse_read(struct urtwn_softc *);
196251538Srpaulostatic int		urtwn_read_chipid(struct urtwn_softc *);
197251538Srpaulostatic void		urtwn_read_rom(struct urtwn_softc *);
198251538Srpaulostatic int		urtwn_ra_init(struct urtwn_softc *);
199251538Srpaulostatic void		urtwn_tsf_sync_enable(struct urtwn_softc *);
200251538Srpaulostatic void		urtwn_set_led(struct urtwn_softc *, int, int);
201251538Srpaulostatic int		urtwn_newstate(struct ieee80211vap *,
202251538Srpaulo			    enum ieee80211_state, int);
203251538Srpaulostatic void		urtwn_watchdog(void *);
204251538Srpaulostatic void		urtwn_update_avgrssi(struct urtwn_softc *, int, int8_t);
205251538Srpaulostatic int8_t		urtwn_get_rssi(struct urtwn_softc *, int, void *);
206251538Srpaulostatic int		urtwn_tx_start(struct urtwn_softc *,
207251538Srpaulo			    struct ieee80211_node *, struct mbuf *,
208251538Srpaulo			    struct urtwn_data *);
209251538Srpaulostatic void		urtwn_start(struct ifnet *);
210251538Srpaulostatic int		urtwn_ioctl(struct ifnet *, u_long, caddr_t);
211251538Srpaulostatic int		urtwn_power_on(struct urtwn_softc *);
212251538Srpaulostatic int		urtwn_llt_init(struct urtwn_softc *);
213251538Srpaulostatic void		urtwn_fw_reset(struct urtwn_softc *);
214251538Srpaulostatic int		urtwn_fw_loadpage(struct urtwn_softc *, int,
215251538Srpaulo			    const uint8_t *, int);
216251538Srpaulostatic int		urtwn_load_firmware(struct urtwn_softc *);
217251538Srpaulostatic int		urtwn_dma_init(struct urtwn_softc *);
218251538Srpaulostatic void		urtwn_mac_init(struct urtwn_softc *);
219251538Srpaulostatic void		urtwn_bb_init(struct urtwn_softc *);
220251538Srpaulostatic void		urtwn_rf_init(struct urtwn_softc *);
221251538Srpaulostatic void		urtwn_cam_init(struct urtwn_softc *);
222251538Srpaulostatic void		urtwn_pa_bias_init(struct urtwn_softc *);
223251538Srpaulostatic void		urtwn_rxfilter_init(struct urtwn_softc *);
224251538Srpaulostatic void		urtwn_edca_init(struct urtwn_softc *);
225251538Srpaulostatic void		urtwn_write_txpower(struct urtwn_softc *, int,
226251538Srpaulo			    uint16_t[]);
227251538Srpaulostatic void		urtwn_get_txpower(struct urtwn_softc *, int,
228251538Srpaulo		      	    struct ieee80211_channel *,
229251538Srpaulo			    struct ieee80211_channel *, uint16_t[]);
230251538Srpaulostatic void		urtwn_set_txpower(struct urtwn_softc *,
231251538Srpaulo		    	    struct ieee80211_channel *,
232251538Srpaulo			    struct ieee80211_channel *);
233251538Srpaulostatic void		urtwn_scan_start(struct ieee80211com *);
234251538Srpaulostatic void		urtwn_scan_end(struct ieee80211com *);
235251538Srpaulostatic void		urtwn_set_channel(struct ieee80211com *);
236251538Srpaulostatic void		urtwn_set_chan(struct urtwn_softc *,
237251538Srpaulo		    	    struct ieee80211_channel *,
238251538Srpaulo			    struct ieee80211_channel *);
239251538Srpaulostatic void		urtwn_update_mcast(struct ifnet *);
240251538Srpaulostatic void		urtwn_iq_calib(struct urtwn_softc *);
241251538Srpaulostatic void		urtwn_lc_calib(struct urtwn_softc *);
242251538Srpaulostatic void		urtwn_init(void *);
243251538Srpaulostatic void		urtwn_init_locked(void *);
244251538Srpaulostatic void		urtwn_stop(struct ifnet *, int);
245251538Srpaulostatic void		urtwn_stop_locked(struct ifnet *, int);
246251538Srpaulostatic void		urtwn_abort_xfers(struct urtwn_softc *);
247251538Srpaulostatic int		urtwn_raw_xmit(struct ieee80211_node *, struct mbuf *,
248251538Srpaulo			    const struct ieee80211_bpf_params *);
249251538Srpaulo
250251538Srpaulo/* Aliases. */
251251538Srpaulo#define	urtwn_bb_write	urtwn_write_4
252251538Srpaulo#define urtwn_bb_read	urtwn_read_4
253251538Srpaulo
254251538Srpaulostatic const struct usb_config urtwn_config[URTWN_N_TRANSFER] = {
255251538Srpaulo	[URTWN_BULK_RX] = {
256251538Srpaulo		.type = UE_BULK,
257251538Srpaulo		.endpoint = UE_ADDR_ANY,
258251538Srpaulo		.direction = UE_DIR_IN,
259251538Srpaulo		.bufsize = URTWN_RXBUFSZ,
260251538Srpaulo		.flags = {
261251538Srpaulo			.pipe_bof = 1,
262251538Srpaulo			.short_xfer_ok = 1
263251538Srpaulo		},
264251538Srpaulo		.callback = urtwn_bulk_rx_callback,
265251538Srpaulo	},
266251538Srpaulo	[URTWN_BULK_TX_BE] = {
267251538Srpaulo		.type = UE_BULK,
268251538Srpaulo		.endpoint = 0x03,
269251538Srpaulo		.direction = UE_DIR_OUT,
270251538Srpaulo		.bufsize = URTWN_TXBUFSZ,
271251538Srpaulo		.flags = {
272251538Srpaulo			.ext_buffer = 1,
273251538Srpaulo			.pipe_bof = 1,
274251538Srpaulo			.force_short_xfer = 1
275251538Srpaulo		},
276251538Srpaulo		.callback = urtwn_bulk_tx_callback,
277251538Srpaulo		.timeout = URTWN_TX_TIMEOUT,	/* ms */
278251538Srpaulo	},
279251538Srpaulo	[URTWN_BULK_TX_BK] = {
280251538Srpaulo		.type = UE_BULK,
281251538Srpaulo		.endpoint = 0x03,
282251538Srpaulo		.direction = UE_DIR_OUT,
283251538Srpaulo		.bufsize = URTWN_TXBUFSZ,
284251538Srpaulo		.flags = {
285251538Srpaulo			.ext_buffer = 1,
286251538Srpaulo			.pipe_bof = 1,
287251538Srpaulo			.force_short_xfer = 1,
288251538Srpaulo		},
289251538Srpaulo		.callback = urtwn_bulk_tx_callback,
290251538Srpaulo		.timeout = URTWN_TX_TIMEOUT,	/* ms */
291251538Srpaulo	},
292251538Srpaulo	[URTWN_BULK_TX_VI] = {
293251538Srpaulo		.type = UE_BULK,
294251538Srpaulo		.endpoint = 0x02,
295251538Srpaulo		.direction = UE_DIR_OUT,
296251538Srpaulo		.bufsize = URTWN_TXBUFSZ,
297251538Srpaulo		.flags = {
298251538Srpaulo			.ext_buffer = 1,
299251538Srpaulo			.pipe_bof = 1,
300251538Srpaulo			.force_short_xfer = 1
301251538Srpaulo		},
302251538Srpaulo		.callback = urtwn_bulk_tx_callback,
303251538Srpaulo		.timeout = URTWN_TX_TIMEOUT,	/* ms */
304251538Srpaulo	},
305251538Srpaulo	[URTWN_BULK_TX_VO] = {
306251538Srpaulo		.type = UE_BULK,
307251538Srpaulo		.endpoint = 0x02,
308251538Srpaulo		.direction = UE_DIR_OUT,
309251538Srpaulo		.bufsize = URTWN_TXBUFSZ,
310251538Srpaulo		.flags = {
311251538Srpaulo			.ext_buffer = 1,
312251538Srpaulo			.pipe_bof = 1,
313251538Srpaulo			.force_short_xfer = 1
314251538Srpaulo		},
315251538Srpaulo		.callback = urtwn_bulk_tx_callback,
316251538Srpaulo		.timeout = URTWN_TX_TIMEOUT,	/* ms */
317251538Srpaulo	},
318251538Srpaulo};
319251538Srpaulo
320251538Srpaulostatic int
321251538Srpaulourtwn_match(device_t self)
322251538Srpaulo{
323251538Srpaulo	struct usb_attach_arg *uaa = device_get_ivars(self);
324251538Srpaulo
325251538Srpaulo	if (uaa->usb_mode != USB_MODE_HOST)
326251538Srpaulo		return (ENXIO);
327251538Srpaulo	if (uaa->info.bConfigIndex != URTWN_CONFIG_INDEX)
328251538Srpaulo		return (ENXIO);
329251538Srpaulo	if (uaa->info.bIfaceIndex != URTWN_IFACE_INDEX)
330251538Srpaulo		return (ENXIO);
331251538Srpaulo
332251538Srpaulo	return (usbd_lookup_id_by_uaa(urtwn_devs, sizeof(urtwn_devs), uaa));
333251538Srpaulo}
334251538Srpaulo
335251538Srpaulostatic int
336251538Srpaulourtwn_attach(device_t self)
337251538Srpaulo{
338251538Srpaulo	struct usb_attach_arg *uaa = device_get_ivars(self);
339251538Srpaulo	struct urtwn_softc *sc = device_get_softc(self);
340251538Srpaulo	struct ifnet *ifp;
341251538Srpaulo	struct ieee80211com *ic;
342251538Srpaulo	uint8_t iface_index, bands;
343251538Srpaulo	int error;
344251538Srpaulo
345251538Srpaulo	device_set_usb_desc(self);
346251538Srpaulo	sc->sc_udev = uaa->device;
347251538Srpaulo	sc->sc_dev = self;
348251538Srpaulo
349251538Srpaulo	mtx_init(&sc->sc_mtx, device_get_nameunit(self),
350251538Srpaulo	    MTX_NETWORK_LOCK, MTX_DEF);
351251538Srpaulo	callout_init(&sc->sc_watchdog_ch, 0);
352251538Srpaulo
353251538Srpaulo	iface_index = URTWN_IFACE_INDEX;
354251538Srpaulo	error = usbd_transfer_setup(uaa->device, &iface_index, sc->sc_xfer,
355251538Srpaulo	    urtwn_config, URTWN_N_TRANSFER, sc, &sc->sc_mtx);
356251538Srpaulo	if (error) {
357251538Srpaulo		device_printf(self, "could not allocate USB transfers, "
358251538Srpaulo		    "err=%s\n", usbd_errstr(error));
359251538Srpaulo		goto detach;
360251538Srpaulo	}
361251538Srpaulo
362251538Srpaulo	URTWN_LOCK(sc);
363251538Srpaulo
364251538Srpaulo	error = urtwn_read_chipid(sc);
365251538Srpaulo	if (error) {
366251538Srpaulo		device_printf(sc->sc_dev, "unsupported test chip\n");
367251538Srpaulo		URTWN_UNLOCK(sc);
368251538Srpaulo		goto detach;
369251538Srpaulo	}
370251538Srpaulo
371251538Srpaulo	/* Determine number of Tx/Rx chains. */
372251538Srpaulo	if (sc->chip & URTWN_CHIP_92C) {
373251538Srpaulo		sc->ntxchains = (sc->chip & URTWN_CHIP_92C_1T2R) ? 1 : 2;
374251538Srpaulo		sc->nrxchains = 2;
375251538Srpaulo	} else {
376251538Srpaulo		sc->ntxchains = 1;
377251538Srpaulo		sc->nrxchains = 1;
378251538Srpaulo	}
379251538Srpaulo	urtwn_read_rom(sc);
380251538Srpaulo
381251538Srpaulo	device_printf(sc->sc_dev, "MAC/BB RTL%s, RF 6052 %dT%dR\n",
382251538Srpaulo	    (sc->chip & URTWN_CHIP_92C) ? "8192CU" :
383251538Srpaulo	    (sc->board_type == R92C_BOARD_TYPE_HIGHPA) ? "8188RU" :
384251538Srpaulo	    (sc->board_type == R92C_BOARD_TYPE_MINICARD) ? "8188CE-VAU" :
385251538Srpaulo	    "8188CUS", sc->ntxchains, sc->nrxchains);
386251538Srpaulo
387251538Srpaulo	URTWN_UNLOCK(sc);
388251538Srpaulo
389251538Srpaulo	ifp = sc->sc_ifp = if_alloc(IFT_IEEE80211);
390251538Srpaulo	if (ifp == NULL) {
391251538Srpaulo		device_printf(sc->sc_dev, "can not if_alloc()\n");
392251538Srpaulo		goto detach;
393251538Srpaulo	}
394251538Srpaulo	ic = ifp->if_l2com;
395251538Srpaulo
396251538Srpaulo	ifp->if_softc = sc;
397251538Srpaulo	if_initname(ifp, "urtwn", device_get_unit(sc->sc_dev));
398251538Srpaulo	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
399251538Srpaulo	ifp->if_init = urtwn_init;
400251538Srpaulo	ifp->if_ioctl = urtwn_ioctl;
401251538Srpaulo	ifp->if_start = urtwn_start;
402251538Srpaulo	IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen);
403251538Srpaulo	ifp->if_snd.ifq_drv_maxlen = ifqmaxlen;
404251538Srpaulo	IFQ_SET_READY(&ifp->if_snd);
405251538Srpaulo
406251538Srpaulo	ic->ic_ifp = ifp;
407251538Srpaulo	ic->ic_phytype = IEEE80211_T_OFDM;	/* not only, but not used */
408251538Srpaulo	ic->ic_opmode = IEEE80211_M_STA;	/* default to BSS mode */
409251538Srpaulo
410251538Srpaulo	/* set device capabilities */
411251538Srpaulo	ic->ic_caps =
412251538Srpaulo		  IEEE80211_C_STA		/* station mode */
413251538Srpaulo		| IEEE80211_C_MONITOR		/* monitor mode */
414251538Srpaulo		| IEEE80211_C_SHPREAMBLE	/* short preamble supported */
415251538Srpaulo		| IEEE80211_C_SHSLOT		/* short slot time supported */
416251538Srpaulo		| IEEE80211_C_BGSCAN		/* capable of bg scanning */
417251538Srpaulo		| IEEE80211_C_WPA		/* 802.11i */
418251538Srpaulo		;
419251538Srpaulo
420251538Srpaulo	bands = 0;
421251538Srpaulo	setbit(&bands, IEEE80211_MODE_11B);
422251538Srpaulo	setbit(&bands, IEEE80211_MODE_11G);
423251538Srpaulo	ieee80211_init_channels(ic, NULL, &bands);
424251538Srpaulo
425251538Srpaulo	ieee80211_ifattach(ic, sc->sc_bssid);
426251538Srpaulo	ic->ic_raw_xmit = urtwn_raw_xmit;
427251538Srpaulo	ic->ic_scan_start = urtwn_scan_start;
428251538Srpaulo	ic->ic_scan_end = urtwn_scan_end;
429251538Srpaulo	ic->ic_set_channel = urtwn_set_channel;
430251538Srpaulo
431251538Srpaulo	ic->ic_vap_create = urtwn_vap_create;
432251538Srpaulo	ic->ic_vap_delete = urtwn_vap_delete;
433251538Srpaulo	ic->ic_update_mcast = urtwn_update_mcast;
434251538Srpaulo
435251538Srpaulo	ieee80211_radiotap_attach(ic, &sc->sc_txtap.wt_ihdr,
436251538Srpaulo	    sizeof(sc->sc_txtap), URTWN_TX_RADIOTAP_PRESENT,
437251538Srpaulo	    &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap),
438251538Srpaulo	    URTWN_RX_RADIOTAP_PRESENT);
439251538Srpaulo
440251538Srpaulo	if (bootverbose)
441251538Srpaulo		ieee80211_announce(ic);
442251538Srpaulo
443251538Srpaulo	return (0);
444251538Srpaulo
445251538Srpaulodetach:
446251538Srpaulo	urtwn_detach(self);
447251538Srpaulo	return (ENXIO);			/* failure */
448251538Srpaulo}
449251538Srpaulo
450251538Srpaulostatic int
451251538Srpaulourtwn_detach(device_t self)
452251538Srpaulo{
453251538Srpaulo	struct urtwn_softc *sc = device_get_softc(self);
454251538Srpaulo	struct ifnet *ifp = sc->sc_ifp;
455251538Srpaulo	struct ieee80211com *ic = ifp->if_l2com;
456251538Srpaulo
457251538Srpaulo	if (!device_is_attached(self))
458251538Srpaulo		return (0);
459251538Srpaulo
460251538Srpaulo	urtwn_stop(ifp, 1);
461251538Srpaulo
462251538Srpaulo	callout_drain(&sc->sc_watchdog_ch);
463251538Srpaulo
464251538Srpaulo	/* stop all USB transfers */
465251538Srpaulo	usbd_transfer_unsetup(sc->sc_xfer, URTWN_N_TRANSFER);
466251538Srpaulo	ieee80211_ifdetach(ic);
467251538Srpaulo
468251538Srpaulo	urtwn_free_tx_list(sc);
469251538Srpaulo	urtwn_free_rx_list(sc);
470251538Srpaulo
471251538Srpaulo	if_free(ifp);
472251538Srpaulo	mtx_destroy(&sc->sc_mtx);
473251538Srpaulo
474251538Srpaulo	return (0);
475251538Srpaulo}
476251538Srpaulo
477251538Srpaulostatic void
478251538Srpaulourtwn_free_tx_list(struct urtwn_softc *sc)
479251538Srpaulo{
480251538Srpaulo	urtwn_free_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT);
481251538Srpaulo}
482251538Srpaulo
483251538Srpaulostatic void
484251538Srpaulourtwn_free_rx_list(struct urtwn_softc *sc)
485251538Srpaulo{
486251538Srpaulo	urtwn_free_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT);
487251538Srpaulo}
488251538Srpaulo
489251538Srpaulostatic void
490251538Srpaulourtwn_free_list(struct urtwn_softc *sc, struct urtwn_data data[], int ndata)
491251538Srpaulo{
492251538Srpaulo	int i;
493251538Srpaulo
494251538Srpaulo	for (i = 0; i < ndata; i++) {
495251538Srpaulo		struct urtwn_data *dp = &data[i];
496251538Srpaulo
497251538Srpaulo		if (dp->buf != NULL) {
498251538Srpaulo			free(dp->buf, M_USBDEV);
499251538Srpaulo			dp->buf = NULL;
500251538Srpaulo		}
501251538Srpaulo		if (dp->ni != NULL) {
502251538Srpaulo			ieee80211_free_node(dp->ni);
503251538Srpaulo			dp->ni = NULL;
504251538Srpaulo		}
505251538Srpaulo	}
506251538Srpaulo}
507251538Srpaulo
508251538Srpaulostatic usb_error_t
509251538Srpaulourtwn_do_request(struct urtwn_softc *sc, struct usb_device_request *req,
510251538Srpaulo    void *data)
511251538Srpaulo{
512251538Srpaulo	usb_error_t err;
513251538Srpaulo	int ntries = 10;
514251538Srpaulo
515251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
516251538Srpaulo
517251538Srpaulo	while (ntries--) {
518251538Srpaulo		err = usbd_do_request_flags(sc->sc_udev, &sc->sc_mtx,
519251538Srpaulo		    req, data, 0, NULL, 250 /* ms */);
520251538Srpaulo		if (err == 0)
521251538Srpaulo			break;
522251538Srpaulo
523251538Srpaulo		DPRINTFN(1, "Control request failed, %s (retrying)\n",
524251538Srpaulo		    usbd_errstr(err));
525251538Srpaulo		usb_pause_mtx(&sc->sc_mtx, hz / 100);
526251538Srpaulo	}
527251538Srpaulo	return (err);
528251538Srpaulo}
529251538Srpaulo
530251538Srpaulostatic struct ieee80211vap *
531251538Srpaulourtwn_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit,
532251538Srpaulo    enum ieee80211_opmode opmode, int flags,
533251538Srpaulo    const uint8_t bssid[IEEE80211_ADDR_LEN],
534251538Srpaulo    const uint8_t mac[IEEE80211_ADDR_LEN])
535251538Srpaulo{
536251538Srpaulo	struct urtwn_vap *uvp;
537251538Srpaulo	struct ieee80211vap *vap;
538251538Srpaulo
539251538Srpaulo	if (!TAILQ_EMPTY(&ic->ic_vaps))		/* only one at a time */
540251538Srpaulo		return (NULL);
541251538Srpaulo
542251538Srpaulo	uvp = (struct urtwn_vap *) malloc(sizeof(struct urtwn_vap),
543251538Srpaulo	    M_80211_VAP, M_NOWAIT | M_ZERO);
544251538Srpaulo	if (uvp == NULL)
545251538Srpaulo		return (NULL);
546251538Srpaulo	vap = &uvp->vap;
547251538Srpaulo	/* enable s/w bmiss handling for sta mode */
548251538Srpaulo	ieee80211_vap_setup(ic, vap, name, unit, opmode,
549251538Srpaulo	    flags | IEEE80211_CLONE_NOBEACONS, bssid, mac);
550251538Srpaulo
551251538Srpaulo	/* override state transition machine */
552251538Srpaulo	uvp->newstate = vap->iv_newstate;
553251538Srpaulo	vap->iv_newstate = urtwn_newstate;
554251538Srpaulo
555251538Srpaulo	/* complete setup */
556251538Srpaulo	ieee80211_vap_attach(vap, ieee80211_media_change,
557251538Srpaulo	    ieee80211_media_status);
558251538Srpaulo	ic->ic_opmode = opmode;
559251538Srpaulo	return (vap);
560251538Srpaulo}
561251538Srpaulo
562251538Srpaulostatic void
563251538Srpaulourtwn_vap_delete(struct ieee80211vap *vap)
564251538Srpaulo{
565251538Srpaulo	struct urtwn_vap *uvp = URTWN_VAP(vap);
566251538Srpaulo
567251538Srpaulo	ieee80211_vap_detach(vap);
568251538Srpaulo	free(uvp, M_80211_VAP);
569251538Srpaulo}
570251538Srpaulo
571251538Srpaulostatic struct mbuf *
572251538Srpaulourtwn_rx_frame(struct urtwn_softc *sc, uint8_t *buf, int pktlen, int *rssi_p)
573251538Srpaulo{
574251538Srpaulo	struct ifnet *ifp = sc->sc_ifp;
575251538Srpaulo	struct ieee80211com *ic = ifp->if_l2com;
576251538Srpaulo	struct ieee80211_frame *wh;
577251538Srpaulo	struct mbuf *m;
578251538Srpaulo	struct r92c_rx_stat *stat;
579251538Srpaulo	uint32_t rxdw0, rxdw3;
580251538Srpaulo	uint8_t rate;
581251538Srpaulo	int8_t rssi = 0;
582251538Srpaulo	int infosz;
583251538Srpaulo
584251538Srpaulo	/*
585251538Srpaulo	 * don't pass packets to the ieee80211 framework if the driver isn't
586251538Srpaulo	 * RUNNING.
587251538Srpaulo	 */
588251538Srpaulo	if (!(ifp->if_drv_flags & IFF_DRV_RUNNING))
589251538Srpaulo		return (NULL);
590251538Srpaulo
591251538Srpaulo	stat = (struct r92c_rx_stat *)buf;
592251538Srpaulo	rxdw0 = le32toh(stat->rxdw0);
593251538Srpaulo	rxdw3 = le32toh(stat->rxdw3);
594251538Srpaulo
595251538Srpaulo	if (rxdw0 & (R92C_RXDW0_CRCERR | R92C_RXDW0_ICVERR)) {
596251538Srpaulo		/*
597251538Srpaulo		 * This should not happen since we setup our Rx filter
598251538Srpaulo		 * to not receive these frames.
599251538Srpaulo		 */
600251538Srpaulo		ifp->if_ierrors++;
601251538Srpaulo		return (NULL);
602251538Srpaulo	}
603251538Srpaulo
604251538Srpaulo	rate = MS(rxdw3, R92C_RXDW3_RATE);
605251538Srpaulo	infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8;
606251538Srpaulo
607251538Srpaulo	/* Get RSSI from PHY status descriptor if present. */
608251538Srpaulo	if (infosz != 0 && (rxdw0 & R92C_RXDW0_PHYST)) {
609251538Srpaulo		rssi = urtwn_get_rssi(sc, rate, &stat[1]);
610251538Srpaulo		/* Update our average RSSI. */
611251538Srpaulo		urtwn_update_avgrssi(sc, rate, rssi);
612251538Srpaulo	}
613251538Srpaulo
614251538Srpaulo	m = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR);
615251538Srpaulo	if (m == NULL) {
616251538Srpaulo		device_printf(sc->sc_dev, "could not create RX mbuf\n");
617251538Srpaulo		return (NULL);
618251538Srpaulo	}
619251538Srpaulo
620251538Srpaulo	/* Finalize mbuf. */
621251538Srpaulo	m->m_pkthdr.rcvif = ifp;
622251538Srpaulo	wh = (struct ieee80211_frame *)((uint8_t *)&stat[1] + infosz);
623251538Srpaulo	memcpy(mtod(m, uint8_t *), wh, pktlen);
624251538Srpaulo	m->m_pkthdr.len = m->m_len = pktlen;
625251538Srpaulo
626251538Srpaulo	if (ieee80211_radiotap_active(ic)) {
627251538Srpaulo		struct urtwn_rx_radiotap_header *tap = &sc->sc_rxtap;
628251538Srpaulo
629251538Srpaulo		tap->wr_flags = 0;
630251538Srpaulo		/* Map HW rate index to 802.11 rate. */
631251538Srpaulo		if (!(rxdw3 & R92C_RXDW3_HT)) {
632251538Srpaulo			switch (rate) {
633251538Srpaulo			/* CCK. */
634251538Srpaulo			case  0: tap->wr_rate =   2; break;
635251538Srpaulo			case  1: tap->wr_rate =   4; break;
636251538Srpaulo			case  2: tap->wr_rate =  11; break;
637251538Srpaulo			case  3: tap->wr_rate =  22; break;
638251538Srpaulo			/* OFDM. */
639251538Srpaulo			case  4: tap->wr_rate =  12; break;
640251538Srpaulo			case  5: tap->wr_rate =  18; break;
641251538Srpaulo			case  6: tap->wr_rate =  24; break;
642251538Srpaulo			case  7: tap->wr_rate =  36; break;
643251538Srpaulo			case  8: tap->wr_rate =  48; break;
644251538Srpaulo			case  9: tap->wr_rate =  72; break;
645251538Srpaulo			case 10: tap->wr_rate =  96; break;
646251538Srpaulo			case 11: tap->wr_rate = 108; break;
647251538Srpaulo			}
648251538Srpaulo		} else if (rate >= 12) {	/* MCS0~15. */
649251538Srpaulo			/* Bit 7 set means HT MCS instead of rate. */
650251538Srpaulo			tap->wr_rate = 0x80 | (rate - 12);
651251538Srpaulo		}
652251538Srpaulo		tap->wr_dbm_antsignal = rssi;
653251538Srpaulo		tap->wr_chan_freq = htole16(ic->ic_curchan->ic_freq);
654251538Srpaulo		tap->wr_chan_flags = htole16(ic->ic_curchan->ic_flags);
655251538Srpaulo	}
656251538Srpaulo
657251538Srpaulo	*rssi_p = rssi;
658251538Srpaulo
659251538Srpaulo	return (m);
660251538Srpaulo}
661251538Srpaulo
662251538Srpaulostatic struct mbuf *
663251538Srpaulourtwn_rxeof(struct usb_xfer *xfer, struct urtwn_data *data, int *rssi,
664251538Srpaulo    int8_t *nf)
665251538Srpaulo{
666251538Srpaulo	struct urtwn_softc *sc = data->sc;
667251538Srpaulo	struct ifnet *ifp = sc->sc_ifp;
668251538Srpaulo	struct r92c_rx_stat *stat;
669251538Srpaulo	struct mbuf *m, *m0 = NULL, *prevm = NULL;
670251538Srpaulo	uint32_t rxdw0;
671251538Srpaulo	uint8_t *buf;
672251538Srpaulo	int len, totlen, pktlen, infosz, npkts;
673251538Srpaulo
674251538Srpaulo	usbd_xfer_status(xfer, &len, NULL, NULL, NULL);
675251538Srpaulo
676251538Srpaulo	if (len < sizeof(*stat)) {
677251538Srpaulo		ifp->if_ierrors++;
678251538Srpaulo		return (NULL);
679251538Srpaulo	}
680251538Srpaulo
681251538Srpaulo	buf = data->buf;
682251538Srpaulo	/* Get the number of encapsulated frames. */
683251538Srpaulo	stat = (struct r92c_rx_stat *)buf;
684251538Srpaulo	npkts = MS(le32toh(stat->rxdw2), R92C_RXDW2_PKTCNT);
685251538Srpaulo	DPRINTFN(6, "Rx %d frames in one chunk\n", npkts);
686251538Srpaulo
687251538Srpaulo	/* Process all of them. */
688251538Srpaulo	while (npkts-- > 0) {
689251538Srpaulo		if (len < sizeof(*stat))
690251538Srpaulo			break;
691251538Srpaulo		stat = (struct r92c_rx_stat *)buf;
692251538Srpaulo		rxdw0 = le32toh(stat->rxdw0);
693251538Srpaulo
694251538Srpaulo		pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN);
695251538Srpaulo		if (pktlen == 0)
696251538Srpaulo			break;
697251538Srpaulo
698251538Srpaulo		infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8;
699251538Srpaulo
700251538Srpaulo		/* Make sure everything fits in xfer. */
701251538Srpaulo		totlen = sizeof(*stat) + infosz + pktlen;
702251538Srpaulo		if (totlen > len)
703251538Srpaulo			break;
704251538Srpaulo
705251538Srpaulo		m = urtwn_rx_frame(sc, buf, pktlen, rssi);
706251538Srpaulo		if (m0 == NULL)
707251538Srpaulo			m0 = m;
708251538Srpaulo		if (prevm == NULL)
709251538Srpaulo			prevm = m;
710251538Srpaulo		else {
711251538Srpaulo			prevm->m_next = m;
712251538Srpaulo			prevm = m;
713251538Srpaulo		}
714251538Srpaulo
715251538Srpaulo		/* Next chunk is 128-byte aligned. */
716251538Srpaulo		totlen = (totlen + 127) & ~127;
717251538Srpaulo		buf += totlen;
718251538Srpaulo		len -= totlen;
719251538Srpaulo	}
720251538Srpaulo
721251538Srpaulo	return (m0);
722251538Srpaulo}
723251538Srpaulo
724251538Srpaulostatic void
725251538Srpaulourtwn_bulk_rx_callback(struct usb_xfer *xfer, usb_error_t error)
726251538Srpaulo{
727251538Srpaulo	struct urtwn_softc *sc = usbd_xfer_softc(xfer);
728251538Srpaulo	struct ifnet *ifp = sc->sc_ifp;
729251538Srpaulo	struct ieee80211com *ic = ifp->if_l2com;
730251538Srpaulo	struct ieee80211_frame *wh;
731251538Srpaulo	struct ieee80211_node *ni;
732251538Srpaulo	struct mbuf *m = NULL, *next;
733251538Srpaulo	struct urtwn_data *data;
734251538Srpaulo	int8_t nf;
735251538Srpaulo	int rssi = 1;
736251538Srpaulo
737251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
738251538Srpaulo
739251538Srpaulo	switch (USB_GET_STATE(xfer)) {
740251538Srpaulo	case USB_ST_TRANSFERRED:
741251538Srpaulo		data = STAILQ_FIRST(&sc->sc_rx_active);
742251538Srpaulo		if (data == NULL)
743251538Srpaulo			goto tr_setup;
744251538Srpaulo		STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next);
745251538Srpaulo		m = urtwn_rxeof(xfer, data, &rssi, &nf);
746251538Srpaulo		STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next);
747251538Srpaulo		/* FALLTHROUGH */
748251538Srpaulo	case USB_ST_SETUP:
749251538Srpaulotr_setup:
750251538Srpaulo		data = STAILQ_FIRST(&sc->sc_rx_inactive);
751251538Srpaulo		if (data == NULL) {
752251538Srpaulo			KASSERT(m == NULL, ("mbuf isn't NULL"));
753251538Srpaulo			return;
754251538Srpaulo		}
755251538Srpaulo		STAILQ_REMOVE_HEAD(&sc->sc_rx_inactive, next);
756251538Srpaulo		STAILQ_INSERT_TAIL(&sc->sc_rx_active, data, next);
757251538Srpaulo		usbd_xfer_set_frame_data(xfer, 0, data->buf,
758251538Srpaulo		    usbd_xfer_max_len(xfer));
759251538Srpaulo		usbd_transfer_submit(xfer);
760251538Srpaulo
761251538Srpaulo		/*
762251538Srpaulo		 * To avoid LOR we should unlock our private mutex here to call
763251538Srpaulo		 * ieee80211_input() because here is at the end of a USB
764251538Srpaulo		 * callback and safe to unlock.
765251538Srpaulo		 */
766251538Srpaulo		URTWN_UNLOCK(sc);
767251538Srpaulo		while (m != NULL) {
768251538Srpaulo			next = m->m_next;
769251538Srpaulo			m->m_next = NULL;
770251538Srpaulo			wh = mtod(m, struct ieee80211_frame *);
771251538Srpaulo			ni = ieee80211_find_rxnode(ic,
772251538Srpaulo			    (struct ieee80211_frame_min *)wh);
773251538Srpaulo			nf = URTWN_NOISE_FLOOR;
774251538Srpaulo			if (ni != NULL) {
775251538Srpaulo				(void)ieee80211_input(ni, m, rssi, nf);
776251538Srpaulo				ieee80211_free_node(ni);
777251538Srpaulo			} else
778251538Srpaulo				(void)ieee80211_input_all(ic, m, rssi, nf);
779251538Srpaulo			m = next;
780251538Srpaulo		}
781251538Srpaulo		URTWN_LOCK(sc);
782251538Srpaulo		break;
783251538Srpaulo	default:
784251538Srpaulo		/* needs it to the inactive queue due to a error. */
785251538Srpaulo		data = STAILQ_FIRST(&sc->sc_rx_active);
786251538Srpaulo		if (data != NULL) {
787251538Srpaulo			STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next);
788251538Srpaulo			STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next);
789251538Srpaulo		}
790251538Srpaulo		if (error != USB_ERR_CANCELLED) {
791251538Srpaulo			usbd_xfer_set_stall(xfer);
792251538Srpaulo			ifp->if_ierrors++;
793251538Srpaulo			goto tr_setup;
794251538Srpaulo		}
795251538Srpaulo		break;
796251538Srpaulo	}
797251538Srpaulo}
798251538Srpaulo
799251538Srpaulostatic void
800251538Srpaulourtwn_txeof(struct usb_xfer *xfer, struct urtwn_data *data)
801251538Srpaulo{
802251538Srpaulo	struct urtwn_softc *sc = usbd_xfer_softc(xfer);
803251538Srpaulo	struct ifnet *ifp = sc->sc_ifp;
804251538Srpaulo	struct mbuf *m;
805251538Srpaulo
806251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
807251538Srpaulo
808251538Srpaulo	/*
809251538Srpaulo	 * Do any tx complete callback.  Note this must be done before releasing
810251538Srpaulo	 * the node reference.
811251538Srpaulo	 */
812251538Srpaulo	if (data->m) {
813251538Srpaulo		m = data->m;
814251538Srpaulo		if (m->m_flags & M_TXCB) {
815251538Srpaulo			/* XXX status? */
816251538Srpaulo			ieee80211_process_callback(data->ni, m, 0);
817251538Srpaulo		}
818251538Srpaulo		m_freem(m);
819251538Srpaulo		data->m = NULL;
820251538Srpaulo	}
821251538Srpaulo	if (data->ni) {
822251538Srpaulo		ieee80211_free_node(data->ni);
823251538Srpaulo		data->ni = NULL;
824251538Srpaulo	}
825251538Srpaulo	sc->sc_txtimer = 0;
826251538Srpaulo	ifp->if_opackets++;
827251538Srpaulo	ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
828251538Srpaulo}
829251538Srpaulo
830251538Srpaulostatic void
831251538Srpaulourtwn_bulk_tx_callback(struct usb_xfer *xfer, usb_error_t error)
832251538Srpaulo{
833251538Srpaulo	struct urtwn_softc *sc = usbd_xfer_softc(xfer);
834251538Srpaulo	struct ifnet *ifp = sc->sc_ifp;
835251538Srpaulo	struct urtwn_data *data;
836251538Srpaulo
837251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
838251538Srpaulo
839251538Srpaulo	switch (USB_GET_STATE(xfer)){
840251538Srpaulo	case USB_ST_TRANSFERRED:
841251538Srpaulo		data = STAILQ_FIRST(&sc->sc_tx_active);
842251538Srpaulo		if (data == NULL)
843251538Srpaulo			goto tr_setup;
844251538Srpaulo		STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next);
845251538Srpaulo		urtwn_txeof(xfer, data);
846251538Srpaulo		STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data, next);
847251538Srpaulo		/* FALLTHROUGH */
848251538Srpaulo	case USB_ST_SETUP:
849251538Srpaulotr_setup:
850251538Srpaulo		data = STAILQ_FIRST(&sc->sc_tx_pending);
851251538Srpaulo		if (data == NULL) {
852251538Srpaulo			DPRINTF("%s: empty pending queue\n", __func__);
853251538Srpaulo			return;
854251538Srpaulo		}
855251538Srpaulo		STAILQ_REMOVE_HEAD(&sc->sc_tx_pending, next);
856251538Srpaulo		STAILQ_INSERT_TAIL(&sc->sc_tx_active, data, next);
857251538Srpaulo
858251538Srpaulo		usbd_xfer_set_frame_data(xfer, 0, data->buf, data->buflen);
859251538Srpaulo		usbd_transfer_submit(xfer);
860251538Srpaulo
861251538Srpaulo		URTWN_UNLOCK(sc);
862251538Srpaulo		urtwn_start(ifp);
863251538Srpaulo		URTWN_LOCK(sc);
864251538Srpaulo		break;
865251538Srpaulo	default:
866251538Srpaulo		data = STAILQ_FIRST(&sc->sc_tx_active);
867251538Srpaulo		if (data == NULL)
868251538Srpaulo			goto tr_setup;
869251538Srpaulo		if (data->ni != NULL) {
870251538Srpaulo			ieee80211_free_node(data->ni);
871251538Srpaulo			data->ni = NULL;
872251538Srpaulo			ifp->if_oerrors++;
873251538Srpaulo		}
874251538Srpaulo		if (error != USB_ERR_CANCELLED) {
875251538Srpaulo			usbd_xfer_set_stall(xfer);
876251538Srpaulo			goto tr_setup;
877251538Srpaulo		}
878251538Srpaulo		break;
879251538Srpaulo	}
880251538Srpaulo}
881251538Srpaulo
882251538Srpaulostatic struct urtwn_data *
883251538Srpaulo_urtwn_getbuf(struct urtwn_softc *sc)
884251538Srpaulo{
885251538Srpaulo	struct urtwn_data *bf;
886251538Srpaulo
887251538Srpaulo	bf = STAILQ_FIRST(&sc->sc_tx_inactive);
888251538Srpaulo	if (bf != NULL)
889251538Srpaulo		STAILQ_REMOVE_HEAD(&sc->sc_tx_inactive, next);
890251538Srpaulo	else
891251538Srpaulo		bf = NULL;
892251538Srpaulo	if (bf == NULL)
893251538Srpaulo		DPRINTF("%s: %s\n", __func__, "out of xmit buffers");
894251538Srpaulo	return (bf);
895251538Srpaulo}
896251538Srpaulo
897251538Srpaulostatic struct urtwn_data *
898251538Srpaulourtwn_getbuf(struct urtwn_softc *sc)
899251538Srpaulo{
900251538Srpaulo        struct urtwn_data *bf;
901251538Srpaulo
902251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
903251538Srpaulo
904251538Srpaulo	bf = _urtwn_getbuf(sc);
905251538Srpaulo	if (bf == NULL) {
906251538Srpaulo		struct ifnet *ifp = sc->sc_ifp;
907251538Srpaulo		DPRINTF("%s: stop queue\n", __func__);
908251538Srpaulo		ifp->if_drv_flags |= IFF_DRV_OACTIVE;
909251538Srpaulo	}
910251538Srpaulo	return (bf);
911251538Srpaulo}
912251538Srpaulo
913251538Srpaulostatic int
914251538Srpaulourtwn_write_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf,
915251538Srpaulo    int len)
916251538Srpaulo{
917251538Srpaulo	usb_device_request_t req;
918251538Srpaulo
919251538Srpaulo	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
920251538Srpaulo	req.bRequest = R92C_REQ_REGS;
921251538Srpaulo	USETW(req.wValue, addr);
922251538Srpaulo	USETW(req.wIndex, 0);
923251538Srpaulo	USETW(req.wLength, len);
924251538Srpaulo	return (urtwn_do_request(sc, &req, buf));
925251538Srpaulo}
926251538Srpaulo
927251538Srpaulostatic void
928251538Srpaulourtwn_write_1(struct urtwn_softc *sc, uint16_t addr, uint8_t val)
929251538Srpaulo{
930251538Srpaulo	urtwn_write_region_1(sc, addr, &val, 1);
931251538Srpaulo}
932251538Srpaulo
933251538Srpaulo
934251538Srpaulostatic void
935251538Srpaulourtwn_write_2(struct urtwn_softc *sc, uint16_t addr, uint16_t val)
936251538Srpaulo{
937251538Srpaulo	val = htole16(val);
938251538Srpaulo	urtwn_write_region_1(sc, addr, (uint8_t *)&val, 2);
939251538Srpaulo}
940251538Srpaulo
941251538Srpaulostatic void
942251538Srpaulourtwn_write_4(struct urtwn_softc *sc, uint16_t addr, uint32_t val)
943251538Srpaulo{
944251538Srpaulo	val = htole32(val);
945251538Srpaulo	urtwn_write_region_1(sc, addr, (uint8_t *)&val, 4);
946251538Srpaulo}
947251538Srpaulo
948251538Srpaulostatic int
949251538Srpaulourtwn_read_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf,
950251538Srpaulo    int len)
951251538Srpaulo{
952251538Srpaulo	usb_device_request_t req;
953251538Srpaulo
954251538Srpaulo	req.bmRequestType = UT_READ_VENDOR_DEVICE;
955251538Srpaulo	req.bRequest = R92C_REQ_REGS;
956251538Srpaulo	USETW(req.wValue, addr);
957251538Srpaulo	USETW(req.wIndex, 0);
958251538Srpaulo	USETW(req.wLength, len);
959251538Srpaulo	return (urtwn_do_request(sc, &req, buf));
960251538Srpaulo}
961251538Srpaulo
962251538Srpaulostatic uint8_t
963251538Srpaulourtwn_read_1(struct urtwn_softc *sc, uint16_t addr)
964251538Srpaulo{
965251538Srpaulo	uint8_t val;
966251538Srpaulo
967251538Srpaulo	if (urtwn_read_region_1(sc, addr, &val, 1) != 0)
968251538Srpaulo		return (0xff);
969251538Srpaulo	return (val);
970251538Srpaulo}
971251538Srpaulo
972251538Srpaulostatic uint16_t
973251538Srpaulourtwn_read_2(struct urtwn_softc *sc, uint16_t addr)
974251538Srpaulo{
975251538Srpaulo	uint16_t val;
976251538Srpaulo
977251538Srpaulo	if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 2) != 0)
978251538Srpaulo		return (0xffff);
979251538Srpaulo	return (le16toh(val));
980251538Srpaulo}
981251538Srpaulo
982251538Srpaulostatic uint32_t
983251538Srpaulourtwn_read_4(struct urtwn_softc *sc, uint16_t addr)
984251538Srpaulo{
985251538Srpaulo	uint32_t val;
986251538Srpaulo
987251538Srpaulo	if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 4) != 0)
988251538Srpaulo		return (0xffffffff);
989251538Srpaulo	return (le32toh(val));
990251538Srpaulo}
991251538Srpaulo
992251538Srpaulostatic int
993251538Srpaulourtwn_fw_cmd(struct urtwn_softc *sc, uint8_t id, const void *buf, int len)
994251538Srpaulo{
995251538Srpaulo	struct r92c_fw_cmd cmd;
996251538Srpaulo	int ntries;
997251538Srpaulo
998251538Srpaulo	/* Wait for current FW box to be empty. */
999251538Srpaulo	for (ntries = 0; ntries < 100; ntries++) {
1000251538Srpaulo		if (!(urtwn_read_1(sc, R92C_HMETFR) & (1 << sc->fwcur)))
1001251538Srpaulo			break;
1002251538Srpaulo		DELAY(1);
1003251538Srpaulo	}
1004251538Srpaulo	if (ntries == 100) {
1005251538Srpaulo		device_printf(sc->sc_dev,
1006251538Srpaulo		    "could not send firmware command\n");
1007251538Srpaulo		return (ETIMEDOUT);
1008251538Srpaulo	}
1009251538Srpaulo	memset(&cmd, 0, sizeof(cmd));
1010251538Srpaulo	cmd.id = id;
1011251538Srpaulo	if (len > 3)
1012251538Srpaulo		cmd.id |= R92C_CMD_FLAG_EXT;
1013251538Srpaulo	KASSERT(len <= sizeof(cmd.msg), ("urtwn_fw_cmd\n"));
1014251538Srpaulo	memcpy(cmd.msg, buf, len);
1015251538Srpaulo
1016251538Srpaulo	/* Write the first word last since that will trigger the FW. */
1017251538Srpaulo	urtwn_write_region_1(sc, R92C_HMEBOX_EXT(sc->fwcur),
1018251538Srpaulo	    (uint8_t *)&cmd + 4, 2);
1019251538Srpaulo	urtwn_write_region_1(sc, R92C_HMEBOX(sc->fwcur),
1020251538Srpaulo	    (uint8_t *)&cmd + 0, 4);
1021251538Srpaulo
1022251538Srpaulo	sc->fwcur = (sc->fwcur + 1) % R92C_H2C_NBOX;
1023251538Srpaulo	return (0);
1024251538Srpaulo}
1025251538Srpaulo
1026251538Srpaulostatic void
1027251538Srpaulourtwn_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, uint32_t val)
1028251538Srpaulo{
1029251538Srpaulo	urtwn_bb_write(sc, R92C_LSSI_PARAM(chain),
1030251538Srpaulo	    SM(R92C_LSSI_PARAM_ADDR, addr) |
1031251538Srpaulo	    SM(R92C_LSSI_PARAM_DATA, val));
1032251538Srpaulo}
1033251538Srpaulo
1034251538Srpaulostatic uint32_t
1035251538Srpaulourtwn_rf_read(struct urtwn_softc *sc, int chain, uint8_t addr)
1036251538Srpaulo{
1037251538Srpaulo	uint32_t reg[R92C_MAX_CHAINS], val;
1038251538Srpaulo
1039251538Srpaulo	reg[0] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(0));
1040251538Srpaulo	if (chain != 0)
1041251538Srpaulo		reg[chain] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(chain));
1042251538Srpaulo
1043251538Srpaulo	urtwn_bb_write(sc, R92C_HSSI_PARAM2(0),
1044251538Srpaulo	    reg[0] & ~R92C_HSSI_PARAM2_READ_EDGE);
1045251538Srpaulo	DELAY(1000);
1046251538Srpaulo
1047251538Srpaulo	urtwn_bb_write(sc, R92C_HSSI_PARAM2(chain),
1048251538Srpaulo	    RW(reg[chain], R92C_HSSI_PARAM2_READ_ADDR, addr) |
1049251538Srpaulo	    R92C_HSSI_PARAM2_READ_EDGE);
1050251538Srpaulo	DELAY(1000);
1051251538Srpaulo
1052251538Srpaulo	urtwn_bb_write(sc, R92C_HSSI_PARAM2(0),
1053251538Srpaulo	    reg[0] | R92C_HSSI_PARAM2_READ_EDGE);
1054251538Srpaulo	DELAY(1000);
1055251538Srpaulo
1056251538Srpaulo	if (urtwn_bb_read(sc, R92C_HSSI_PARAM1(chain)) & R92C_HSSI_PARAM1_PI)
1057251538Srpaulo		val = urtwn_bb_read(sc, R92C_HSPI_READBACK(chain));
1058251538Srpaulo	else
1059251538Srpaulo		val = urtwn_bb_read(sc, R92C_LSSI_READBACK(chain));
1060251538Srpaulo	return (MS(val, R92C_LSSI_READBACK_DATA));
1061251538Srpaulo}
1062251538Srpaulo
1063251538Srpaulostatic int
1064251538Srpaulourtwn_llt_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data)
1065251538Srpaulo{
1066251538Srpaulo	int ntries;
1067251538Srpaulo
1068251538Srpaulo	urtwn_write_4(sc, R92C_LLT_INIT,
1069251538Srpaulo	    SM(R92C_LLT_INIT_OP, R92C_LLT_INIT_OP_WRITE) |
1070251538Srpaulo	    SM(R92C_LLT_INIT_ADDR, addr) |
1071251538Srpaulo	    SM(R92C_LLT_INIT_DATA, data));
1072251538Srpaulo	/* Wait for write operation to complete. */
1073251538Srpaulo	for (ntries = 0; ntries < 20; ntries++) {
1074251538Srpaulo		if (MS(urtwn_read_4(sc, R92C_LLT_INIT), R92C_LLT_INIT_OP) ==
1075251538Srpaulo		    R92C_LLT_INIT_OP_NO_ACTIVE)
1076251538Srpaulo			return (0);
1077251538Srpaulo		DELAY(5);
1078251538Srpaulo	}
1079251538Srpaulo	return (ETIMEDOUT);
1080251538Srpaulo}
1081251538Srpaulo
1082251538Srpaulostatic uint8_t
1083251538Srpaulourtwn_efuse_read_1(struct urtwn_softc *sc, uint16_t addr)
1084251538Srpaulo{
1085251538Srpaulo	uint32_t reg;
1086251538Srpaulo	int ntries;
1087251538Srpaulo
1088251538Srpaulo	reg = urtwn_read_4(sc, R92C_EFUSE_CTRL);
1089251538Srpaulo	reg = RW(reg, R92C_EFUSE_CTRL_ADDR, addr);
1090251538Srpaulo	reg &= ~R92C_EFUSE_CTRL_VALID;
1091251538Srpaulo	urtwn_write_4(sc, R92C_EFUSE_CTRL, reg);
1092251538Srpaulo	/* Wait for read operation to complete. */
1093251538Srpaulo	for (ntries = 0; ntries < 100; ntries++) {
1094251538Srpaulo		reg = urtwn_read_4(sc, R92C_EFUSE_CTRL);
1095251538Srpaulo		if (reg & R92C_EFUSE_CTRL_VALID)
1096251538Srpaulo			return (MS(reg, R92C_EFUSE_CTRL_DATA));
1097251538Srpaulo		DELAY(5);
1098251538Srpaulo	}
1099251538Srpaulo	device_printf(sc->sc_dev,
1100251538Srpaulo	    "could not read efuse byte at address 0x%x\n", addr);
1101251538Srpaulo	return (0xff);
1102251538Srpaulo}
1103251538Srpaulo
1104251538Srpaulostatic void
1105251538Srpaulourtwn_efuse_read(struct urtwn_softc *sc)
1106251538Srpaulo{
1107251538Srpaulo	uint8_t *rom = (uint8_t *)&sc->rom;
1108251538Srpaulo	uint16_t addr = 0;
1109251538Srpaulo	uint32_t reg;
1110251538Srpaulo	uint8_t off, msk;
1111251538Srpaulo	int i;
1112251538Srpaulo
1113251538Srpaulo	reg = urtwn_read_2(sc, R92C_SYS_ISO_CTRL);
1114251538Srpaulo	if (!(reg & R92C_SYS_ISO_CTRL_PWC_EV12V)) {
1115251538Srpaulo		urtwn_write_2(sc, R92C_SYS_ISO_CTRL,
1116251538Srpaulo		    reg | R92C_SYS_ISO_CTRL_PWC_EV12V);
1117251538Srpaulo	}
1118251538Srpaulo	reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
1119251538Srpaulo	if (!(reg & R92C_SYS_FUNC_EN_ELDR)) {
1120251538Srpaulo		urtwn_write_2(sc, R92C_SYS_FUNC_EN,
1121251538Srpaulo		    reg | R92C_SYS_FUNC_EN_ELDR);
1122251538Srpaulo	}
1123251538Srpaulo	reg = urtwn_read_2(sc, R92C_SYS_CLKR);
1124251538Srpaulo	if ((reg & (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) !=
1125251538Srpaulo	    (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) {
1126251538Srpaulo		urtwn_write_2(sc, R92C_SYS_CLKR,
1127251538Srpaulo		    reg | R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M);
1128251538Srpaulo	}
1129251538Srpaulo	memset(&sc->rom, 0xff, sizeof(sc->rom));
1130251538Srpaulo	while (addr < 512) {
1131251538Srpaulo		reg = urtwn_efuse_read_1(sc, addr);
1132251538Srpaulo		if (reg == 0xff)
1133251538Srpaulo			break;
1134251538Srpaulo		addr++;
1135251538Srpaulo		off = reg >> 4;
1136251538Srpaulo		msk = reg & 0xf;
1137251538Srpaulo		for (i = 0; i < 4; i++) {
1138251538Srpaulo			if (msk & (1 << i))
1139251538Srpaulo				continue;
1140251538Srpaulo			rom[off * 8 + i * 2 + 0] =
1141251538Srpaulo			    urtwn_efuse_read_1(sc, addr);
1142251538Srpaulo			addr++;
1143251538Srpaulo			rom[off * 8 + i * 2 + 1] =
1144251538Srpaulo			    urtwn_efuse_read_1(sc, addr);
1145251538Srpaulo			addr++;
1146251538Srpaulo		}
1147251538Srpaulo	}
1148251538Srpaulo#ifdef URTWN_DEBUG
1149251538Srpaulo	if (urtwn_debug >= 2) {
1150251538Srpaulo		/* Dump ROM content. */
1151251538Srpaulo		printf("\n");
1152251538Srpaulo		for (i = 0; i < sizeof(sc->rom); i++)
1153251538Srpaulo			printf("%02x:", rom[i]);
1154251538Srpaulo		printf("\n");
1155251538Srpaulo	}
1156251538Srpaulo#endif
1157251538Srpaulo}
1158251538Srpaulo
1159251538Srpaulostatic int
1160251538Srpaulourtwn_read_chipid(struct urtwn_softc *sc)
1161251538Srpaulo{
1162251538Srpaulo	uint32_t reg;
1163251538Srpaulo
1164251538Srpaulo	reg = urtwn_read_4(sc, R92C_SYS_CFG);
1165251538Srpaulo	if (reg & R92C_SYS_CFG_TRP_VAUX_EN)
1166251538Srpaulo		return (EIO);
1167251538Srpaulo
1168251538Srpaulo	if (reg & R92C_SYS_CFG_TYPE_92C) {
1169251538Srpaulo		sc->chip |= URTWN_CHIP_92C;
1170251538Srpaulo		/* Check if it is a castrated 8192C. */
1171251538Srpaulo		if (MS(urtwn_read_4(sc, R92C_HPON_FSM),
1172251538Srpaulo		    R92C_HPON_FSM_CHIP_BONDING_ID) ==
1173251538Srpaulo		    R92C_HPON_FSM_CHIP_BONDING_ID_92C_1T2R)
1174251538Srpaulo			sc->chip |= URTWN_CHIP_92C_1T2R;
1175251538Srpaulo	}
1176251538Srpaulo	if (reg & R92C_SYS_CFG_VENDOR_UMC) {
1177251538Srpaulo		sc->chip |= URTWN_CHIP_UMC;
1178251538Srpaulo		if (MS(reg, R92C_SYS_CFG_CHIP_VER_RTL) == 0)
1179251538Srpaulo			sc->chip |= URTWN_CHIP_UMC_A_CUT;
1180251538Srpaulo	}
1181251538Srpaulo	return (0);
1182251538Srpaulo}
1183251538Srpaulo
1184251538Srpaulostatic void
1185251538Srpaulourtwn_read_rom(struct urtwn_softc *sc)
1186251538Srpaulo{
1187251538Srpaulo	struct r92c_rom *rom = &sc->rom;
1188251538Srpaulo
1189251538Srpaulo	/* Read full ROM image. */
1190251538Srpaulo	urtwn_efuse_read(sc);
1191251538Srpaulo
1192251538Srpaulo	/* XXX Weird but this is what the vendor driver does. */
1193251538Srpaulo	sc->pa_setting = urtwn_efuse_read_1(sc, 0x1fa);
1194251538Srpaulo	DPRINTF("PA setting=0x%x\n", sc->pa_setting);
1195251538Srpaulo
1196251538Srpaulo	sc->board_type = MS(rom->rf_opt1, R92C_ROM_RF1_BOARD_TYPE);
1197251538Srpaulo
1198251538Srpaulo	sc->regulatory = MS(rom->rf_opt1, R92C_ROM_RF1_REGULATORY);
1199251538Srpaulo	DPRINTF("regulatory type=%d\n", sc->regulatory);
1200251538Srpaulo
1201251538Srpaulo	IEEE80211_ADDR_COPY(sc->sc_bssid, rom->macaddr);
1202251538Srpaulo}
1203251538Srpaulo
1204251538Srpaulo/*
1205251538Srpaulo * Initialize rate adaptation in firmware.
1206251538Srpaulo */
1207251538Srpaulostatic int
1208251538Srpaulourtwn_ra_init(struct urtwn_softc *sc)
1209251538Srpaulo{
1210251538Srpaulo	static const uint8_t map[] =
1211251538Srpaulo	    { 2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108 };
1212251538Srpaulo	struct ieee80211com *ic = sc->sc_ifp->if_l2com;
1213251538Srpaulo	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
1214251538Srpaulo	struct ieee80211_node *ni;
1215251538Srpaulo	struct ieee80211_rateset *rs;
1216251538Srpaulo	struct r92c_fw_cmd_macid_cfg cmd;
1217251538Srpaulo	uint32_t rates, basicrates;
1218251538Srpaulo	uint8_t mode;
1219251538Srpaulo	int maxrate, maxbasicrate, error, i, j;
1220251538Srpaulo
1221251538Srpaulo	ni = ieee80211_ref_node(vap->iv_bss);
1222251538Srpaulo	rs = &ni->ni_rates;
1223251538Srpaulo
1224251538Srpaulo	/* Get normal and basic rates mask. */
1225251538Srpaulo	rates = basicrates = 0;
1226251538Srpaulo	maxrate = maxbasicrate = 0;
1227251538Srpaulo	for (i = 0; i < rs->rs_nrates; i++) {
1228251538Srpaulo		/* Convert 802.11 rate to HW rate index. */
1229251538Srpaulo		for (j = 0; j < nitems(map); j++)
1230251538Srpaulo			if ((rs->rs_rates[i] & IEEE80211_RATE_VAL) == map[j])
1231251538Srpaulo				break;
1232251538Srpaulo		if (j == nitems(map))	/* Unknown rate, skip. */
1233251538Srpaulo			continue;
1234251538Srpaulo		rates |= 1 << j;
1235251538Srpaulo		if (j > maxrate)
1236251538Srpaulo			maxrate = j;
1237251538Srpaulo		if (rs->rs_rates[i] & IEEE80211_RATE_BASIC) {
1238251538Srpaulo			basicrates |= 1 << j;
1239251538Srpaulo			if (j > maxbasicrate)
1240251538Srpaulo				maxbasicrate = j;
1241251538Srpaulo		}
1242251538Srpaulo	}
1243251538Srpaulo	if (ic->ic_curmode == IEEE80211_MODE_11B)
1244251538Srpaulo		mode = R92C_RAID_11B;
1245251538Srpaulo	else
1246251538Srpaulo		mode = R92C_RAID_11BG;
1247251538Srpaulo	DPRINTF("mode=0x%x rates=0x%08x, basicrates=0x%08x\n",
1248251538Srpaulo	    mode, rates, basicrates);
1249251538Srpaulo
1250251538Srpaulo	/* Set rates mask for group addressed frames. */
1251251538Srpaulo	cmd.macid = URTWN_MACID_BC | URTWN_MACID_VALID;
1252251538Srpaulo	cmd.mask = htole32(mode << 28 | basicrates);
1253251538Srpaulo	error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd));
1254251538Srpaulo	if (error != 0) {
1255251538Srpaulo		device_printf(sc->sc_dev,
1256251538Srpaulo		    "could not add broadcast station\n");
1257251538Srpaulo		return (error);
1258251538Srpaulo	}
1259251538Srpaulo	/* Set initial MRR rate. */
1260251538Srpaulo	DPRINTF("maxbasicrate=%d\n", maxbasicrate);
1261251538Srpaulo	urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BC),
1262251538Srpaulo	    maxbasicrate);
1263251538Srpaulo
1264251538Srpaulo	/* Set rates mask for unicast frames. */
1265251538Srpaulo	cmd.macid = URTWN_MACID_BSS | URTWN_MACID_VALID;
1266251538Srpaulo	cmd.mask = htole32(mode << 28 | rates);
1267251538Srpaulo	error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd));
1268251538Srpaulo	if (error != 0) {
1269251538Srpaulo		device_printf(sc->sc_dev, "could not add BSS station\n");
1270251538Srpaulo		return (error);
1271251538Srpaulo	}
1272251538Srpaulo	/* Set initial MRR rate. */
1273251538Srpaulo	DPRINTF("maxrate=%d\n", maxrate);
1274251538Srpaulo	urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BSS),
1275251538Srpaulo	    maxrate);
1276251538Srpaulo
1277251538Srpaulo	/* Indicate highest supported rate. */
1278251538Srpaulo	ni->ni_txrate = rs->rs_nrates - 1;
1279251538Srpaulo	return (0);
1280251538Srpaulo}
1281251538Srpaulo
1282251538Srpaulovoid
1283251538Srpaulourtwn_tsf_sync_enable(struct urtwn_softc *sc)
1284251538Srpaulo{
1285251538Srpaulo	struct ifnet *ifp = sc->sc_ifp;
1286251538Srpaulo	struct ieee80211com *ic = ifp->if_l2com;
1287251538Srpaulo	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
1288251538Srpaulo	struct ieee80211_node *ni = vap->iv_bss;
1289251538Srpaulo
1290251538Srpaulo	uint64_t tsf;
1291251538Srpaulo
1292251538Srpaulo	/* Enable TSF synchronization. */
1293251538Srpaulo	urtwn_write_1(sc, R92C_BCN_CTRL,
1294251538Srpaulo	    urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_DIS_TSF_UDT0);
1295251538Srpaulo
1296251538Srpaulo	urtwn_write_1(sc, R92C_BCN_CTRL,
1297251538Srpaulo	    urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_EN_BCN);
1298251538Srpaulo
1299251538Srpaulo	/* Set initial TSF. */
1300251538Srpaulo	memcpy(&tsf, ni->ni_tstamp.data, 8);
1301251538Srpaulo	tsf = le64toh(tsf);
1302251538Srpaulo	tsf = tsf - (tsf % (vap->iv_bss->ni_intval * IEEE80211_DUR_TU));
1303251538Srpaulo	tsf -= IEEE80211_DUR_TU;
1304251538Srpaulo	urtwn_write_4(sc, R92C_TSFTR + 0, tsf);
1305251538Srpaulo	urtwn_write_4(sc, R92C_TSFTR + 4, tsf >> 32);
1306251538Srpaulo
1307251538Srpaulo	urtwn_write_1(sc, R92C_BCN_CTRL,
1308251538Srpaulo	    urtwn_read_1(sc, R92C_BCN_CTRL) | R92C_BCN_CTRL_EN_BCN);
1309251538Srpaulo}
1310251538Srpaulo
1311251538Srpaulostatic void
1312251538Srpaulourtwn_set_led(struct urtwn_softc *sc, int led, int on)
1313251538Srpaulo{
1314251538Srpaulo	uint8_t reg;
1315251538Srpaulo
1316251538Srpaulo	if (led == URTWN_LED_LINK) {
1317251538Srpaulo		reg = urtwn_read_1(sc, R92C_LEDCFG0) & 0x70;
1318251538Srpaulo		if (!on)
1319251538Srpaulo			reg |= R92C_LEDCFG0_DIS;
1320251538Srpaulo		urtwn_write_1(sc, R92C_LEDCFG0, reg);
1321251538Srpaulo		sc->ledlink = on;	/* Save LED state. */
1322251538Srpaulo	}
1323251538Srpaulo}
1324251538Srpaulo
1325251538Srpaulostatic int
1326251538Srpaulourtwn_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg)
1327251538Srpaulo{
1328251538Srpaulo	struct urtwn_vap *uvp = URTWN_VAP(vap);
1329251538Srpaulo	struct ieee80211com *ic = vap->iv_ic;
1330251538Srpaulo	struct urtwn_softc *sc = ic->ic_ifp->if_softc;
1331251538Srpaulo	struct ieee80211_node *ni;
1332251538Srpaulo	enum ieee80211_state ostate;
1333251538Srpaulo	uint32_t reg;
1334251538Srpaulo
1335251538Srpaulo	ostate = vap->iv_state;
1336251538Srpaulo	DPRINTF("%s -> %s\n", ieee80211_state_name[ostate],
1337251538Srpaulo	    ieee80211_state_name[nstate]);
1338251538Srpaulo
1339251538Srpaulo	IEEE80211_UNLOCK(ic);
1340251538Srpaulo	URTWN_LOCK(sc);
1341251538Srpaulo	callout_stop(&sc->sc_watchdog_ch);
1342251538Srpaulo
1343251538Srpaulo	if (ostate == IEEE80211_S_RUN) {
1344251538Srpaulo		/* Turn link LED off. */
1345251538Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, 0);
1346251538Srpaulo
1347251538Srpaulo		/* Set media status to 'No Link'. */
1348251538Srpaulo		reg = urtwn_read_4(sc, R92C_CR);
1349251538Srpaulo		reg = RW(reg, R92C_CR_NETTYPE, R92C_CR_NETTYPE_NOLINK);
1350251538Srpaulo		urtwn_write_4(sc, R92C_CR, reg);
1351251538Srpaulo
1352251538Srpaulo		/* Stop Rx of data frames. */
1353251538Srpaulo		urtwn_write_2(sc, R92C_RXFLTMAP2, 0);
1354251538Srpaulo
1355251538Srpaulo		/* Rest TSF. */
1356251538Srpaulo		urtwn_write_1(sc, R92C_DUAL_TSF_RST, 0x03);
1357251538Srpaulo
1358251538Srpaulo		/* Disable TSF synchronization. */
1359251538Srpaulo		urtwn_write_1(sc, R92C_BCN_CTRL,
1360251538Srpaulo		    urtwn_read_1(sc, R92C_BCN_CTRL) |
1361251538Srpaulo		    R92C_BCN_CTRL_DIS_TSF_UDT0);
1362251538Srpaulo
1363251538Srpaulo		/* Reset EDCA parameters. */
1364251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002f3217);
1365251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005e4317);
1366251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x00105320);
1367251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a444);
1368251538Srpaulo	}
1369251538Srpaulo
1370251538Srpaulo	switch (nstate) {
1371251538Srpaulo	case IEEE80211_S_INIT:
1372251538Srpaulo		/* Turn link LED off. */
1373251538Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, 0);
1374251538Srpaulo		break;
1375251538Srpaulo	case IEEE80211_S_SCAN:
1376251538Srpaulo		if (ostate != IEEE80211_S_SCAN) {
1377251538Srpaulo			/* Allow Rx from any BSSID. */
1378251538Srpaulo			urtwn_write_4(sc, R92C_RCR,
1379251538Srpaulo			    urtwn_read_4(sc, R92C_RCR) &
1380251538Srpaulo			    ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN));
1381251538Srpaulo
1382251538Srpaulo			/* Set gain for scanning. */
1383251538Srpaulo			reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0));
1384251538Srpaulo			reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x20);
1385251538Srpaulo			urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg);
1386251538Srpaulo
1387251538Srpaulo			reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1));
1388251538Srpaulo			reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x20);
1389251538Srpaulo			urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg);
1390251538Srpaulo		}
1391251538Srpaulo
1392251538Srpaulo		/* Make link LED blink during scan. */
1393251538Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, !sc->ledlink);
1394251538Srpaulo
1395251538Srpaulo		/* Pause AC Tx queues. */
1396251538Srpaulo		urtwn_write_1(sc, R92C_TXPAUSE,
1397251538Srpaulo		    urtwn_read_1(sc, R92C_TXPAUSE) | 0x0f);
1398251538Srpaulo
1399251538Srpaulo		urtwn_set_chan(sc, ic->ic_curchan, NULL);
1400251538Srpaulo		break;
1401251538Srpaulo	case IEEE80211_S_AUTH:
1402251538Srpaulo		/* Set initial gain under link. */
1403251538Srpaulo		reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0));
1404251538Srpaulo		reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x32);
1405251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg);
1406251538Srpaulo
1407251538Srpaulo		reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1));
1408251538Srpaulo		reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x32);
1409251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg);
1410251538Srpaulo
1411251538Srpaulo		urtwn_set_chan(sc, ic->ic_curchan, NULL);
1412251538Srpaulo		break;
1413251538Srpaulo	case IEEE80211_S_RUN:
1414251538Srpaulo		if (vap->iv_opmode == IEEE80211_M_MONITOR) {
1415251538Srpaulo			/* Enable Rx of data frames. */
1416251538Srpaulo			urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff);
1417251538Srpaulo
1418251538Srpaulo			/* Turn link LED on. */
1419251538Srpaulo			urtwn_set_led(sc, URTWN_LED_LINK, 1);
1420251538Srpaulo			break;
1421251538Srpaulo		}
1422251538Srpaulo
1423251538Srpaulo		ni = ieee80211_ref_node(vap->iv_bss);
1424251538Srpaulo		/* Set media status to 'Associated'. */
1425251538Srpaulo		reg = urtwn_read_4(sc, R92C_CR);
1426251538Srpaulo		reg = RW(reg, R92C_CR_NETTYPE, R92C_CR_NETTYPE_INFRA);
1427251538Srpaulo		urtwn_write_4(sc, R92C_CR, reg);
1428251538Srpaulo
1429251538Srpaulo		/* Set BSSID. */
1430251538Srpaulo		urtwn_write_4(sc, R92C_BSSID + 0, LE_READ_4(&ni->ni_bssid[0]));
1431251538Srpaulo		urtwn_write_4(sc, R92C_BSSID + 4, LE_READ_2(&ni->ni_bssid[4]));
1432251538Srpaulo
1433251538Srpaulo		if (ic->ic_curmode == IEEE80211_MODE_11B)
1434251538Srpaulo			urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 0);
1435251538Srpaulo		else	/* 802.11b/g */
1436251538Srpaulo			urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 3);
1437251538Srpaulo
1438251538Srpaulo		/* Enable Rx of data frames. */
1439251538Srpaulo		urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff);
1440251538Srpaulo
1441251538Srpaulo		/* Flush all AC queues. */
1442251538Srpaulo		urtwn_write_1(sc, R92C_TXPAUSE, 0);
1443251538Srpaulo
1444251538Srpaulo		/* Set beacon interval. */
1445251538Srpaulo		urtwn_write_2(sc, R92C_BCN_INTERVAL, ni->ni_intval);
1446251538Srpaulo
1447251538Srpaulo		/* Allow Rx from our BSSID only. */
1448251538Srpaulo		urtwn_write_4(sc, R92C_RCR,
1449251538Srpaulo		    urtwn_read_4(sc, R92C_RCR) |
1450251538Srpaulo		    R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN);
1451251538Srpaulo
1452251538Srpaulo		/* Enable TSF synchronization. */
1453251538Srpaulo		urtwn_tsf_sync_enable(sc);
1454251538Srpaulo
1455251538Srpaulo		urtwn_write_1(sc, R92C_SIFS_CCK + 1, 10);
1456251538Srpaulo		urtwn_write_1(sc, R92C_SIFS_OFDM + 1, 10);
1457251538Srpaulo		urtwn_write_1(sc, R92C_SPEC_SIFS + 1, 10);
1458251538Srpaulo		urtwn_write_1(sc, R92C_MAC_SPEC_SIFS + 1, 10);
1459251538Srpaulo		urtwn_write_1(sc, R92C_R2T_SIFS + 1, 10);
1460251538Srpaulo		urtwn_write_1(sc, R92C_T2T_SIFS + 1, 10);
1461251538Srpaulo
1462251538Srpaulo		/* Intialize rate adaptation. */
1463251538Srpaulo		urtwn_ra_init(sc);
1464251538Srpaulo		/* Turn link LED on. */
1465251538Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, 1);
1466251538Srpaulo
1467251538Srpaulo		sc->avg_pwdb = -1;	/* Reset average RSSI. */
1468251538Srpaulo		/* Reset temperature calibration state machine. */
1469251538Srpaulo		sc->thcal_state = 0;
1470251538Srpaulo		sc->thcal_lctemp = 0;
1471251538Srpaulo		ieee80211_free_node(ni);
1472251538Srpaulo		break;
1473251538Srpaulo	default:
1474251538Srpaulo		break;
1475251538Srpaulo	}
1476251538Srpaulo	URTWN_UNLOCK(sc);
1477251538Srpaulo	IEEE80211_LOCK(ic);
1478251538Srpaulo	return(uvp->newstate(vap, nstate, arg));
1479251538Srpaulo}
1480251538Srpaulo
1481251538Srpaulostatic void
1482251538Srpaulourtwn_watchdog(void *arg)
1483251538Srpaulo{
1484251538Srpaulo	struct urtwn_softc *sc = arg;
1485251538Srpaulo	struct ifnet *ifp = sc->sc_ifp;
1486251538Srpaulo
1487251538Srpaulo	if (sc->sc_txtimer > 0) {
1488251538Srpaulo		if (--sc->sc_txtimer == 0) {
1489251538Srpaulo			device_printf(sc->sc_dev, "device timeout\n");
1490251538Srpaulo			ifp->if_oerrors++;
1491251538Srpaulo			return;
1492251538Srpaulo		}
1493251538Srpaulo		callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
1494251538Srpaulo	}
1495251538Srpaulo}
1496251538Srpaulo
1497251538Srpaulostatic void
1498251538Srpaulourtwn_update_avgrssi(struct urtwn_softc *sc, int rate, int8_t rssi)
1499251538Srpaulo{
1500251538Srpaulo	int pwdb;
1501251538Srpaulo
1502251538Srpaulo	/* Convert antenna signal to percentage. */
1503251538Srpaulo	if (rssi <= -100 || rssi >= 20)
1504251538Srpaulo		pwdb = 0;
1505251538Srpaulo	else if (rssi >= 0)
1506251538Srpaulo		pwdb = 100;
1507251538Srpaulo	else
1508251538Srpaulo		pwdb = 100 + rssi;
1509251538Srpaulo	if (rate <= 3) {
1510251538Srpaulo		/* CCK gain is smaller than OFDM/MCS gain. */
1511251538Srpaulo		pwdb += 6;
1512251538Srpaulo		if (pwdb > 100)
1513251538Srpaulo			pwdb = 100;
1514251538Srpaulo		if (pwdb <= 14)
1515251538Srpaulo			pwdb -= 4;
1516251538Srpaulo		else if (pwdb <= 26)
1517251538Srpaulo			pwdb -= 8;
1518251538Srpaulo		else if (pwdb <= 34)
1519251538Srpaulo			pwdb -= 6;
1520251538Srpaulo		else if (pwdb <= 42)
1521251538Srpaulo			pwdb -= 2;
1522251538Srpaulo	}
1523251538Srpaulo	if (sc->avg_pwdb == -1)	/* Init. */
1524251538Srpaulo		sc->avg_pwdb = pwdb;
1525251538Srpaulo	else if (sc->avg_pwdb < pwdb)
1526251538Srpaulo		sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20) + 1;
1527251538Srpaulo	else
1528251538Srpaulo		sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20);
1529251538Srpaulo	DPRINTFN(4, "PWDB=%d EMA=%d\n", pwdb, sc->avg_pwdb);
1530251538Srpaulo}
1531251538Srpaulo
1532251538Srpaulostatic int8_t
1533251538Srpaulourtwn_get_rssi(struct urtwn_softc *sc, int rate, void *physt)
1534251538Srpaulo{
1535251538Srpaulo	static const int8_t cckoff[] = { 16, -12, -26, -46 };
1536251538Srpaulo	struct r92c_rx_phystat *phy;
1537251538Srpaulo	struct r92c_rx_cck *cck;
1538251538Srpaulo	uint8_t rpt;
1539251538Srpaulo	int8_t rssi;
1540251538Srpaulo
1541251538Srpaulo	if (rate <= 3) {
1542251538Srpaulo		cck = (struct r92c_rx_cck *)physt;
1543251538Srpaulo		if (sc->sc_flags & URTWN_FLAG_CCK_HIPWR) {
1544251538Srpaulo			rpt = (cck->agc_rpt >> 5) & 0x3;
1545251538Srpaulo			rssi = (cck->agc_rpt & 0x1f) << 1;
1546251538Srpaulo		} else {
1547251538Srpaulo			rpt = (cck->agc_rpt >> 6) & 0x3;
1548251538Srpaulo			rssi = cck->agc_rpt & 0x3e;
1549251538Srpaulo		}
1550251538Srpaulo		rssi = cckoff[rpt] - rssi;
1551251538Srpaulo	} else {	/* OFDM/HT. */
1552251538Srpaulo		phy = (struct r92c_rx_phystat *)physt;
1553251538Srpaulo		rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110;
1554251538Srpaulo	}
1555251538Srpaulo	return (rssi);
1556251538Srpaulo}
1557251538Srpaulo
1558251538Srpaulostatic int
1559251538Srpaulourtwn_tx_start(struct urtwn_softc *sc, struct ieee80211_node *ni,
1560251538Srpaulo    struct mbuf *m0, struct urtwn_data *data)
1561251538Srpaulo{
1562251538Srpaulo	struct ifnet *ifp = sc->sc_ifp;
1563251538Srpaulo	struct ieee80211_frame *wh;
1564251538Srpaulo	struct ieee80211_key *k;
1565251538Srpaulo	struct ieee80211com *ic = ifp->if_l2com;
1566251538Srpaulo	struct ieee80211vap *vap = ni->ni_vap;
1567251538Srpaulo	struct usb_xfer *xfer;
1568251538Srpaulo	struct r92c_tx_desc *txd;
1569251538Srpaulo	uint8_t raid, type;
1570251538Srpaulo	uint16_t sum;
1571251538Srpaulo	int i, hasqos, xferlen;
1572251538Srpaulo	struct usb_xfer *urtwn_pipes[4] = {
1573251538Srpaulo		sc->sc_xfer[URTWN_BULK_TX_BE],
1574251538Srpaulo		sc->sc_xfer[URTWN_BULK_TX_BK],
1575251538Srpaulo		sc->sc_xfer[URTWN_BULK_TX_VI],
1576251538Srpaulo		sc->sc_xfer[URTWN_BULK_TX_VO]
1577251538Srpaulo	};
1578251538Srpaulo
1579251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
1580251538Srpaulo
1581251538Srpaulo	/*
1582251538Srpaulo	 * Software crypto.
1583251538Srpaulo	 */
1584251538Srpaulo	wh = mtod(m0, struct ieee80211_frame *);
1585251538Srpaulo	if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
1586251538Srpaulo		k = ieee80211_crypto_encap(ni, m0);
1587251538Srpaulo		if (k == NULL) {
1588251538Srpaulo			device_printf(sc->sc_dev,
1589251538Srpaulo			    "ieee80211_crypto_encap returns NULL.\n");
1590251538Srpaulo			/* XXX we don't expect the fragmented frames */
1591251538Srpaulo			m_freem(m0);
1592251538Srpaulo			return (ENOBUFS);
1593251538Srpaulo		}
1594251538Srpaulo
1595251538Srpaulo		/* in case packet header moved, reset pointer */
1596251538Srpaulo		wh = mtod(m0, struct ieee80211_frame *);
1597251538Srpaulo	}
1598251538Srpaulo
1599251538Srpaulo	switch (wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) {
1600251538Srpaulo	case IEEE80211_FC0_TYPE_CTL:
1601251538Srpaulo	case IEEE80211_FC0_TYPE_MGT:
1602251538Srpaulo		xfer = sc->sc_xfer[URTWN_BULK_TX_VO];
1603251538Srpaulo		break;
1604251538Srpaulo	default:
1605251538Srpaulo		KASSERT(M_WME_GETAC(m0) < 4,
1606251538Srpaulo		    ("unsupported WME pipe %d", M_WME_GETAC(m0)));
1607251538Srpaulo		xfer = urtwn_pipes[M_WME_GETAC(m0)];
1608251538Srpaulo		break;
1609251538Srpaulo	}
1610251538Srpaulo
1611251538Srpaulo	hasqos = 0;
1612251538Srpaulo
1613251538Srpaulo	/* Fill Tx descriptor. */
1614251538Srpaulo	txd = (struct r92c_tx_desc *)data->buf;
1615251538Srpaulo	memset(txd, 0, sizeof(*txd));
1616251538Srpaulo
1617251538Srpaulo	txd->txdw0 |= htole32(
1618251538Srpaulo	    SM(R92C_TXDW0_PKTLEN, m0->m_pkthdr.len) |
1619251538Srpaulo	    SM(R92C_TXDW0_OFFSET, sizeof(*txd)) |
1620251538Srpaulo	    R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG);
1621251538Srpaulo	if (IEEE80211_IS_MULTICAST(wh->i_addr1))
1622251538Srpaulo		txd->txdw0 |= htole32(R92C_TXDW0_BMCAST);
1623251538Srpaulo
1624251538Srpaulo	type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;
1625251538Srpaulo	if (!IEEE80211_IS_MULTICAST(wh->i_addr1) &&
1626251538Srpaulo	    type == IEEE80211_FC0_TYPE_DATA) {
1627251538Srpaulo		if (ic->ic_curmode == IEEE80211_MODE_11B)
1628251538Srpaulo			raid = R92C_RAID_11B;
1629251538Srpaulo		else
1630251538Srpaulo			raid = R92C_RAID_11BG;
1631251538Srpaulo		txd->txdw1 |= htole32(
1632251538Srpaulo		    SM(R92C_TXDW1_MACID, URTWN_MACID_BSS) |
1633251538Srpaulo		    SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_BE) |
1634251538Srpaulo		    SM(R92C_TXDW1_RAID, raid) |
1635251538Srpaulo		    R92C_TXDW1_AGGBK);
1636251538Srpaulo
1637251538Srpaulo		if (ic->ic_flags & IEEE80211_F_USEPROT) {
1638251538Srpaulo			if (ic->ic_protmode == IEEE80211_PROT_CTSONLY) {
1639251538Srpaulo				txd->txdw4 |= htole32(R92C_TXDW4_CTS2SELF |
1640251538Srpaulo				    R92C_TXDW4_HWRTSEN);
1641251538Srpaulo			} else if (ic->ic_protmode == IEEE80211_PROT_RTSCTS) {
1642251538Srpaulo				txd->txdw4 |= htole32(R92C_TXDW4_RTSEN |
1643251538Srpaulo				    R92C_TXDW4_HWRTSEN);
1644251538Srpaulo			}
1645251538Srpaulo		}
1646251538Srpaulo		/* Send RTS at OFDM24. */
1647251538Srpaulo		txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE, 8));
1648251538Srpaulo		txd->txdw5 |= htole32(0x0001ff00);
1649251538Srpaulo		/* Send data at OFDM54. */
1650251538Srpaulo		txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, 11));
1651251538Srpaulo	} else {
1652251538Srpaulo		txd->txdw1 |= htole32(
1653251538Srpaulo		    SM(R92C_TXDW1_MACID, 0) |
1654251538Srpaulo		    SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_MGNT) |
1655251538Srpaulo		    SM(R92C_TXDW1_RAID, R92C_RAID_11B));
1656251538Srpaulo
1657251538Srpaulo		/* Force CCK1. */
1658251538Srpaulo		txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE);
1659251538Srpaulo		txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, 0));
1660251538Srpaulo	}
1661251538Srpaulo	/* Set sequence number (already little endian). */
1662251538Srpaulo	txd->txdseq |= *(uint16_t *)wh->i_seq;
1663251538Srpaulo
1664251538Srpaulo	if (!hasqos) {
1665251538Srpaulo		/* Use HW sequence numbering for non-QoS frames. */
1666251538Srpaulo		txd->txdw4  |= htole32(R92C_TXDW4_HWSEQ);
1667251538Srpaulo		txd->txdseq |= htole16(0x8000);
1668251538Srpaulo	} else
1669251538Srpaulo		txd->txdw4 |= htole32(R92C_TXDW4_QOS);
1670251538Srpaulo
1671251538Srpaulo	/* Compute Tx descriptor checksum. */
1672251538Srpaulo	sum = 0;
1673251538Srpaulo	for (i = 0; i < sizeof(*txd) / 2; i++)
1674251538Srpaulo		sum ^= ((uint16_t *)txd)[i];
1675251538Srpaulo	txd->txdsum = sum; 	/* NB: already little endian. */
1676251538Srpaulo
1677251538Srpaulo	if (ieee80211_radiotap_active_vap(vap)) {
1678251538Srpaulo		struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap;
1679251538Srpaulo
1680251538Srpaulo		tap->wt_flags = 0;
1681251538Srpaulo		tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq);
1682251538Srpaulo		tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags);
1683251538Srpaulo		ieee80211_radiotap_tx(vap, m0);
1684251538Srpaulo	}
1685251538Srpaulo
1686251538Srpaulo	xferlen = sizeof(*txd) + m0->m_pkthdr.len;
1687251538Srpaulo	m_copydata(m0, 0, m0->m_pkthdr.len, (caddr_t)&txd[1]);
1688251538Srpaulo
1689251538Srpaulo	data->buflen = xferlen;
1690251538Srpaulo	data->ni = ni;
1691251538Srpaulo	data->m = m0;
1692251538Srpaulo
1693251538Srpaulo	STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next);
1694251538Srpaulo	usbd_transfer_start(xfer);
1695251538Srpaulo	return (0);
1696251538Srpaulo}
1697251538Srpaulo
1698251538Srpaulostatic void
1699251538Srpaulourtwn_start(struct ifnet *ifp)
1700251538Srpaulo{
1701251538Srpaulo	struct urtwn_softc *sc = ifp->if_softc;
1702251538Srpaulo	struct ieee80211_node *ni;
1703251538Srpaulo	struct mbuf *m;
1704251538Srpaulo	struct urtwn_data *bf;
1705251538Srpaulo
1706251538Srpaulo	if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0)
1707251538Srpaulo		return;
1708251538Srpaulo
1709251538Srpaulo	URTWN_LOCK(sc);
1710251538Srpaulo	for (;;) {
1711251538Srpaulo		IFQ_DRV_DEQUEUE(&ifp->if_snd, m);
1712251538Srpaulo		if (m == NULL)
1713251538Srpaulo			break;
1714251538Srpaulo		bf = urtwn_getbuf(sc);
1715251538Srpaulo		if (bf == NULL) {
1716251538Srpaulo			IFQ_DRV_PREPEND(&ifp->if_snd, m);
1717251538Srpaulo			break;
1718251538Srpaulo		}
1719251538Srpaulo		ni = (struct ieee80211_node *)m->m_pkthdr.rcvif;
1720251538Srpaulo		m->m_pkthdr.rcvif = NULL;
1721251538Srpaulo
1722251538Srpaulo		if (urtwn_tx_start(sc, ni, m, bf) != 0) {
1723251538Srpaulo			ifp->if_oerrors++;
1724251538Srpaulo			STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next);
1725251538Srpaulo			ieee80211_free_node(ni);
1726251538Srpaulo			break;
1727251538Srpaulo		}
1728251538Srpaulo
1729251538Srpaulo		sc->sc_txtimer = 5;
1730251538Srpaulo		callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
1731251538Srpaulo	}
1732251538Srpaulo	URTWN_UNLOCK(sc);
1733251538Srpaulo}
1734251538Srpaulo
1735251538Srpaulostatic int
1736251538Srpaulourtwn_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
1737251538Srpaulo{
1738251538Srpaulo	struct ieee80211com *ic = ifp->if_l2com;
1739251538Srpaulo	struct ifreq *ifr = (struct ifreq *) data;
1740251538Srpaulo	int error = 0, startall = 0;
1741251538Srpaulo
1742251538Srpaulo	switch (cmd) {
1743251538Srpaulo	case SIOCSIFFLAGS:
1744251538Srpaulo		if (ifp->if_flags & IFF_UP) {
1745251538Srpaulo			if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) {
1746251538Srpaulo				urtwn_init(ifp->if_softc);
1747251538Srpaulo				startall = 1;
1748251538Srpaulo			}
1749251538Srpaulo		} else {
1750251538Srpaulo			if (ifp->if_drv_flags & IFF_DRV_RUNNING)
1751251538Srpaulo				urtwn_stop(ifp, 1);
1752251538Srpaulo		}
1753251538Srpaulo		if (startall)
1754251538Srpaulo			ieee80211_start_all(ic);
1755251538Srpaulo		break;
1756251538Srpaulo	case SIOCGIFMEDIA:
1757251538Srpaulo		error = ifmedia_ioctl(ifp, ifr, &ic->ic_media, cmd);
1758251538Srpaulo		break;
1759251538Srpaulo	case SIOCGIFADDR:
1760251538Srpaulo		error = ether_ioctl(ifp, cmd, data);
1761251538Srpaulo		break;
1762251538Srpaulo	default:
1763251538Srpaulo		error = EINVAL;
1764251538Srpaulo		break;
1765251538Srpaulo	}
1766251538Srpaulo	return (error);
1767251538Srpaulo}
1768251538Srpaulo
1769251538Srpaulostatic int
1770251538Srpaulourtwn_alloc_list(struct urtwn_softc *sc, struct urtwn_data data[],
1771251538Srpaulo    int ndata, int maxsz)
1772251538Srpaulo{
1773251538Srpaulo	int i, error;
1774251538Srpaulo
1775251538Srpaulo	for (i = 0; i < ndata; i++) {
1776251538Srpaulo		struct urtwn_data *dp = &data[i];
1777251538Srpaulo		dp->sc = sc;
1778251538Srpaulo		dp->m = NULL;
1779251538Srpaulo		dp->buf = malloc(maxsz, M_USBDEV, M_NOWAIT);
1780251538Srpaulo		if (dp->buf == NULL) {
1781251538Srpaulo			device_printf(sc->sc_dev,
1782251538Srpaulo			    "could not allocate buffer\n");
1783251538Srpaulo			error = ENOMEM;
1784251538Srpaulo			goto fail;
1785251538Srpaulo		}
1786251538Srpaulo		dp->ni = NULL;
1787251538Srpaulo	}
1788251538Srpaulo
1789251538Srpaulo	return (0);
1790251538Srpaulofail:
1791251538Srpaulo	urtwn_free_list(sc, data, ndata);
1792251538Srpaulo	return (error);
1793251538Srpaulo}
1794251538Srpaulo
1795251538Srpaulostatic int
1796251538Srpaulourtwn_alloc_rx_list(struct urtwn_softc *sc)
1797251538Srpaulo{
1798251538Srpaulo        int error, i;
1799251538Srpaulo
1800251538Srpaulo	error = urtwn_alloc_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT,
1801251538Srpaulo	    URTWN_RXBUFSZ);
1802251538Srpaulo	if (error != 0)
1803251538Srpaulo		return (error);
1804251538Srpaulo
1805251538Srpaulo	STAILQ_INIT(&sc->sc_rx_active);
1806251538Srpaulo	STAILQ_INIT(&sc->sc_rx_inactive);
1807251538Srpaulo
1808251538Srpaulo	for (i = 0; i < URTWN_RX_LIST_COUNT; i++)
1809251538Srpaulo		STAILQ_INSERT_HEAD(&sc->sc_rx_inactive, &sc->sc_rx[i], next);
1810251538Srpaulo
1811251538Srpaulo	return (0);
1812251538Srpaulo}
1813251538Srpaulo
1814251538Srpaulostatic int
1815251538Srpaulourtwn_alloc_tx_list(struct urtwn_softc *sc)
1816251538Srpaulo{
1817251538Srpaulo	int error, i;
1818251538Srpaulo
1819251538Srpaulo	error = urtwn_alloc_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT,
1820251538Srpaulo	    URTWN_TXBUFSZ);
1821251538Srpaulo	if (error != 0)
1822251538Srpaulo		return (error);
1823251538Srpaulo
1824251538Srpaulo	STAILQ_INIT(&sc->sc_tx_active);
1825251538Srpaulo	STAILQ_INIT(&sc->sc_tx_inactive);
1826251538Srpaulo	STAILQ_INIT(&sc->sc_tx_pending);
1827251538Srpaulo
1828251538Srpaulo	for (i = 0; i < URTWN_TX_LIST_COUNT; i++)
1829251538Srpaulo		STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, &sc->sc_tx[i], next);
1830251538Srpaulo
1831251538Srpaulo	return (0);
1832251538Srpaulo}
1833251538Srpaulo
1834251538Srpaulostatic int
1835251538Srpaulourtwn_power_on(struct urtwn_softc *sc)
1836251538Srpaulo{
1837251538Srpaulo	uint32_t reg;
1838251538Srpaulo	int ntries;
1839251538Srpaulo
1840251538Srpaulo	/* Wait for autoload done bit. */
1841251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
1842251538Srpaulo		if (urtwn_read_1(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_PFM_ALDN)
1843251538Srpaulo			break;
1844251538Srpaulo		DELAY(5);
1845251538Srpaulo	}
1846251538Srpaulo	if (ntries == 1000) {
1847251538Srpaulo		device_printf(sc->sc_dev,
1848251538Srpaulo		    "timeout waiting for chip autoload\n");
1849251538Srpaulo		return (ETIMEDOUT);
1850251538Srpaulo	}
1851251538Srpaulo
1852251538Srpaulo	/* Unlock ISO/CLK/Power control register. */
1853251538Srpaulo	urtwn_write_1(sc, R92C_RSV_CTRL, 0);
1854251538Srpaulo	/* Move SPS into PWM mode. */
1855251538Srpaulo	urtwn_write_1(sc, R92C_SPS0_CTRL, 0x2b);
1856251538Srpaulo	DELAY(100);
1857251538Srpaulo
1858251538Srpaulo	reg = urtwn_read_1(sc, R92C_LDOV12D_CTRL);
1859251538Srpaulo	if (!(reg & R92C_LDOV12D_CTRL_LDV12_EN)) {
1860251538Srpaulo		urtwn_write_1(sc, R92C_LDOV12D_CTRL,
1861251538Srpaulo		    reg | R92C_LDOV12D_CTRL_LDV12_EN);
1862251538Srpaulo		DELAY(100);
1863251538Srpaulo		urtwn_write_1(sc, R92C_SYS_ISO_CTRL,
1864251538Srpaulo		    urtwn_read_1(sc, R92C_SYS_ISO_CTRL) &
1865251538Srpaulo		    ~R92C_SYS_ISO_CTRL_MD2PP);
1866251538Srpaulo	}
1867251538Srpaulo
1868251538Srpaulo	/* Auto enable WLAN. */
1869251538Srpaulo	urtwn_write_2(sc, R92C_APS_FSMCO,
1870251538Srpaulo	    urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC);
1871251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
1872251538Srpaulo		if (urtwn_read_2(sc, R92C_APS_FSMCO) &
1873251538Srpaulo		    R92C_APS_FSMCO_APFM_ONMAC)
1874251538Srpaulo			break;
1875251538Srpaulo		DELAY(5);
1876251538Srpaulo	}
1877251538Srpaulo	if (ntries == 1000) {
1878251538Srpaulo		device_printf(sc->sc_dev,
1879251538Srpaulo		    "timeout waiting for MAC auto ON\n");
1880251538Srpaulo		return (ETIMEDOUT);
1881251538Srpaulo	}
1882251538Srpaulo
1883251538Srpaulo	/* Enable radio, GPIO and LED functions. */
1884251538Srpaulo	urtwn_write_2(sc, R92C_APS_FSMCO,
1885251538Srpaulo	    R92C_APS_FSMCO_AFSM_HSUS |
1886251538Srpaulo	    R92C_APS_FSMCO_PDN_EN |
1887251538Srpaulo	    R92C_APS_FSMCO_PFM_ALDN);
1888251538Srpaulo	/* Release RF digital isolation. */
1889251538Srpaulo	urtwn_write_2(sc, R92C_SYS_ISO_CTRL,
1890251538Srpaulo	    urtwn_read_2(sc, R92C_SYS_ISO_CTRL) & ~R92C_SYS_ISO_CTRL_DIOR);
1891251538Srpaulo
1892251538Srpaulo	/* Initialize MAC. */
1893251538Srpaulo	urtwn_write_1(sc, R92C_APSD_CTRL,
1894251538Srpaulo	    urtwn_read_1(sc, R92C_APSD_CTRL) & ~R92C_APSD_CTRL_OFF);
1895251538Srpaulo	for (ntries = 0; ntries < 200; ntries++) {
1896251538Srpaulo		if (!(urtwn_read_1(sc, R92C_APSD_CTRL) &
1897251538Srpaulo		    R92C_APSD_CTRL_OFF_STATUS))
1898251538Srpaulo			break;
1899251538Srpaulo		DELAY(5);
1900251538Srpaulo	}
1901251538Srpaulo	if (ntries == 200) {
1902251538Srpaulo		device_printf(sc->sc_dev,
1903251538Srpaulo		    "timeout waiting for MAC initialization\n");
1904251538Srpaulo		return (ETIMEDOUT);
1905251538Srpaulo	}
1906251538Srpaulo
1907251538Srpaulo	/* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */
1908251538Srpaulo	reg = urtwn_read_2(sc, R92C_CR);
1909251538Srpaulo	reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN |
1910251538Srpaulo	    R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN |
1911251538Srpaulo	    R92C_CR_SCHEDULE_EN | R92C_CR_MACTXEN | R92C_CR_MACRXEN |
1912251538Srpaulo	    R92C_CR_ENSEC;
1913251538Srpaulo	urtwn_write_2(sc, R92C_CR, reg);
1914251538Srpaulo
1915251538Srpaulo	urtwn_write_1(sc, 0xfe10, 0x19);
1916251538Srpaulo	return (0);
1917251538Srpaulo}
1918251538Srpaulo
1919251538Srpaulostatic int
1920251538Srpaulourtwn_llt_init(struct urtwn_softc *sc)
1921251538Srpaulo{
1922251538Srpaulo	int i, error;
1923251538Srpaulo
1924251538Srpaulo	/* Reserve pages [0; R92C_TX_PAGE_COUNT]. */
1925251538Srpaulo	for (i = 0; i < R92C_TX_PAGE_COUNT; i++) {
1926251538Srpaulo		if ((error = urtwn_llt_write(sc, i, i + 1)) != 0)
1927251538Srpaulo			return (error);
1928251538Srpaulo	}
1929251538Srpaulo	/* NB: 0xff indicates end-of-list. */
1930251538Srpaulo	if ((error = urtwn_llt_write(sc, i, 0xff)) != 0)
1931251538Srpaulo		return (error);
1932251538Srpaulo	/*
1933251538Srpaulo	 * Use pages [R92C_TX_PAGE_COUNT + 1; R92C_TXPKTBUF_COUNT - 1]
1934251538Srpaulo	 * as ring buffer.
1935251538Srpaulo	 */
1936251538Srpaulo	for (++i; i < R92C_TXPKTBUF_COUNT - 1; i++) {
1937251538Srpaulo		if ((error = urtwn_llt_write(sc, i, i + 1)) != 0)
1938251538Srpaulo			return (error);
1939251538Srpaulo	}
1940251538Srpaulo	/* Make the last page point to the beginning of the ring buffer. */
1941251538Srpaulo	error = urtwn_llt_write(sc, i, R92C_TX_PAGE_COUNT + 1);
1942251538Srpaulo	return (error);
1943251538Srpaulo}
1944251538Srpaulo
1945251538Srpaulostatic void
1946251538Srpaulourtwn_fw_reset(struct urtwn_softc *sc)
1947251538Srpaulo{
1948251538Srpaulo	uint16_t reg;
1949251538Srpaulo	int ntries;
1950251538Srpaulo
1951251538Srpaulo	/* Tell 8051 to reset itself. */
1952251538Srpaulo	urtwn_write_1(sc, R92C_HMETFR + 3, 0x20);
1953251538Srpaulo
1954251538Srpaulo	/* Wait until 8051 resets by itself. */
1955251538Srpaulo	for (ntries = 0; ntries < 100; ntries++) {
1956251538Srpaulo		reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
1957251538Srpaulo		if (!(reg & R92C_SYS_FUNC_EN_CPUEN))
1958251538Srpaulo			return;
1959251538Srpaulo		DELAY(50);
1960251538Srpaulo	}
1961251538Srpaulo	/* Force 8051 reset. */
1962251538Srpaulo	urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN);
1963251538Srpaulo}
1964251538Srpaulo
1965251538Srpaulostatic int
1966251538Srpaulourtwn_fw_loadpage(struct urtwn_softc *sc, int page, const uint8_t *buf, int len)
1967251538Srpaulo{
1968251538Srpaulo	uint32_t reg;
1969251538Srpaulo	int off, mlen, error = 0;
1970251538Srpaulo
1971251538Srpaulo	reg = urtwn_read_4(sc, R92C_MCUFWDL);
1972251538Srpaulo	reg = RW(reg, R92C_MCUFWDL_PAGE, page);
1973251538Srpaulo	urtwn_write_4(sc, R92C_MCUFWDL, reg);
1974251538Srpaulo
1975251538Srpaulo	off = R92C_FW_START_ADDR;
1976251538Srpaulo	while (len > 0) {
1977251538Srpaulo		if (len > 196)
1978251538Srpaulo			mlen = 196;
1979251538Srpaulo		else if (len > 4)
1980251538Srpaulo			mlen = 4;
1981251538Srpaulo		else
1982251538Srpaulo			mlen = 1;
1983251538Srpaulo		/* XXX fix this deconst */
1984251538Srpaulo		error = urtwn_write_region_1(sc, off,
1985251538Srpaulo		    __DECONST(uint8_t *, buf), mlen);
1986251538Srpaulo		if (error != 0)
1987251538Srpaulo			break;
1988251538Srpaulo		off += mlen;
1989251538Srpaulo		buf += mlen;
1990251538Srpaulo		len -= mlen;
1991251538Srpaulo	}
1992251538Srpaulo	return (error);
1993251538Srpaulo}
1994251538Srpaulo
1995251538Srpaulostatic int
1996251538Srpaulourtwn_load_firmware(struct urtwn_softc *sc)
1997251538Srpaulo{
1998251538Srpaulo	const struct firmware *fw;
1999251538Srpaulo	const struct r92c_fw_hdr *hdr;
2000251538Srpaulo	const char *imagename;
2001251538Srpaulo	const u_char *ptr;
2002251538Srpaulo	size_t len;
2003251538Srpaulo	uint32_t reg;
2004251538Srpaulo	int mlen, ntries, page, error;
2005251538Srpaulo
2006251538Srpaulo	/* Read firmware image from the filesystem. */
2007251538Srpaulo	if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) ==
2008251538Srpaulo	    URTWN_CHIP_UMC_A_CUT)
2009251538Srpaulo		imagename = "urtwn-rtl8192cfwU";
2010251538Srpaulo	else
2011251538Srpaulo		imagename = "urtwn-rtl8192cfwT";
2012251538Srpaulo
2013251538Srpaulo	fw = firmware_get(imagename);
2014251538Srpaulo	if (fw == NULL) {
2015251538Srpaulo		device_printf(sc->sc_dev,
2016251538Srpaulo		    "failed loadfirmware of file %s\n", imagename);
2017251538Srpaulo		return (ENOENT);
2018251538Srpaulo	}
2019251538Srpaulo
2020251538Srpaulo	len = fw->datasize;
2021251538Srpaulo
2022251538Srpaulo	if (len < sizeof(*hdr)) {
2023251538Srpaulo		device_printf(sc->sc_dev, "firmware too short\n");
2024251538Srpaulo		error = EINVAL;
2025251538Srpaulo		goto fail;
2026251538Srpaulo	}
2027251538Srpaulo	ptr = fw->data;
2028251538Srpaulo	hdr = (const struct r92c_fw_hdr *)ptr;
2029251538Srpaulo	/* Check if there is a valid FW header and skip it. */
2030251538Srpaulo	if ((le16toh(hdr->signature) >> 4) == 0x88c ||
2031251538Srpaulo	    (le16toh(hdr->signature) >> 4) == 0x92c) {
2032251538Srpaulo		DPRINTF("FW V%d.%d %02d-%02d %02d:%02d\n",
2033251538Srpaulo		    le16toh(hdr->version), le16toh(hdr->subversion),
2034251538Srpaulo		    hdr->month, hdr->date, hdr->hour, hdr->minute);
2035251538Srpaulo		ptr += sizeof(*hdr);
2036251538Srpaulo		len -= sizeof(*hdr);
2037251538Srpaulo	}
2038251538Srpaulo
2039251538Srpaulo	if (urtwn_read_1(sc, R92C_MCUFWDL) & 0x80) {
2040251538Srpaulo		urtwn_fw_reset(sc);
2041251538Srpaulo		urtwn_write_1(sc, R92C_MCUFWDL, 0);
2042251538Srpaulo	}
2043251538Srpaulo	urtwn_write_2(sc, R92C_SYS_FUNC_EN,
2044251538Srpaulo	    urtwn_read_2(sc, R92C_SYS_FUNC_EN) |
2045251538Srpaulo	    R92C_SYS_FUNC_EN_CPUEN);
2046251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL,
2047251538Srpaulo	    urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_EN);
2048251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL + 2,
2049251538Srpaulo	    urtwn_read_1(sc, R92C_MCUFWDL + 2) & ~0x08);
2050251538Srpaulo
2051251538Srpaulo	for (page = 0; len > 0; page++) {
2052251538Srpaulo		mlen = min(len, R92C_FW_PAGE_SIZE);
2053251538Srpaulo		error = urtwn_fw_loadpage(sc, page, ptr, mlen);
2054251538Srpaulo		if (error != 0) {
2055251538Srpaulo			device_printf(sc->sc_dev,
2056251538Srpaulo			    "could not load firmware page\n");
2057251538Srpaulo			goto fail;
2058251538Srpaulo		}
2059251538Srpaulo		ptr += mlen;
2060251538Srpaulo		len -= mlen;
2061251538Srpaulo	}
2062251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL,
2063251538Srpaulo	    urtwn_read_1(sc, R92C_MCUFWDL) & ~R92C_MCUFWDL_EN);
2064251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL + 1, 0);
2065251538Srpaulo
2066251538Srpaulo	/* Wait for checksum report. */
2067251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
2068251538Srpaulo		if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_CHKSUM_RPT)
2069251538Srpaulo			break;
2070251538Srpaulo		DELAY(5);
2071251538Srpaulo	}
2072251538Srpaulo	if (ntries == 1000) {
2073251538Srpaulo		device_printf(sc->sc_dev,
2074251538Srpaulo		    "timeout waiting for checksum report\n");
2075251538Srpaulo		error = ETIMEDOUT;
2076251538Srpaulo		goto fail;
2077251538Srpaulo	}
2078251538Srpaulo
2079251538Srpaulo	reg = urtwn_read_4(sc, R92C_MCUFWDL);
2080251538Srpaulo	reg = (reg & ~R92C_MCUFWDL_WINTINI_RDY) | R92C_MCUFWDL_RDY;
2081251538Srpaulo	urtwn_write_4(sc, R92C_MCUFWDL, reg);
2082251538Srpaulo	/* Wait for firmware readiness. */
2083251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
2084251538Srpaulo		if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_WINTINI_RDY)
2085251538Srpaulo			break;
2086251538Srpaulo		DELAY(5);
2087251538Srpaulo	}
2088251538Srpaulo	if (ntries == 1000) {
2089251538Srpaulo		device_printf(sc->sc_dev,
2090251538Srpaulo		    "timeout waiting for firmware readiness\n");
2091251538Srpaulo		error = ETIMEDOUT;
2092251538Srpaulo		goto fail;
2093251538Srpaulo	}
2094251538Srpaulofail:
2095251538Srpaulo	firmware_put(fw, FIRMWARE_UNLOAD);
2096251538Srpaulo	return (error);
2097251538Srpaulo}
2098251538Srpaulo
2099251538Srpaulostatic int
2100251538Srpaulourtwn_dma_init(struct urtwn_softc *sc)
2101251538Srpaulo{
2102251538Srpaulo	int hashq, hasnq, haslq, nqueues, nqpages, nrempages;
2103251538Srpaulo	uint32_t reg;
2104251538Srpaulo	int error;
2105251538Srpaulo
2106251538Srpaulo	/* Initialize LLT table. */
2107251538Srpaulo	error = urtwn_llt_init(sc);
2108251538Srpaulo	if (error != 0)
2109251538Srpaulo		return (error);
2110251538Srpaulo
2111251538Srpaulo	/* Get Tx queues to USB endpoints mapping. */
2112251538Srpaulo	hashq = hasnq = haslq = 0;
2113251538Srpaulo	reg = urtwn_read_2(sc, R92C_USB_EP + 1);
2114251538Srpaulo	DPRINTFN(2, "USB endpoints mapping 0x%x\n", reg);
2115251538Srpaulo	if (MS(reg, R92C_USB_EP_HQ) != 0)
2116251538Srpaulo		hashq = 1;
2117251538Srpaulo	if (MS(reg, R92C_USB_EP_NQ) != 0)
2118251538Srpaulo		hasnq = 1;
2119251538Srpaulo	if (MS(reg, R92C_USB_EP_LQ) != 0)
2120251538Srpaulo		haslq = 1;
2121251538Srpaulo	nqueues = hashq + hasnq + haslq;
2122251538Srpaulo	if (nqueues == 0)
2123251538Srpaulo		return (EIO);
2124251538Srpaulo	/* Get the number of pages for each queue. */
2125251538Srpaulo	nqpages = (R92C_TX_PAGE_COUNT - R92C_PUBQ_NPAGES) / nqueues;
2126251538Srpaulo	/* The remaining pages are assigned to the high priority queue. */
2127251538Srpaulo	nrempages = (R92C_TX_PAGE_COUNT - R92C_PUBQ_NPAGES) % nqueues;
2128251538Srpaulo
2129251538Srpaulo	/* Set number of pages for normal priority queue. */
2130251538Srpaulo	urtwn_write_1(sc, R92C_RQPN_NPQ, hasnq ? nqpages : 0);
2131251538Srpaulo	urtwn_write_4(sc, R92C_RQPN,
2132251538Srpaulo	    /* Set number of pages for public queue. */
2133251538Srpaulo	    SM(R92C_RQPN_PUBQ, R92C_PUBQ_NPAGES) |
2134251538Srpaulo	    /* Set number of pages for high priority queue. */
2135251538Srpaulo	    SM(R92C_RQPN_HPQ, hashq ? nqpages + nrempages : 0) |
2136251538Srpaulo	    /* Set number of pages for low priority queue. */
2137251538Srpaulo	    SM(R92C_RQPN_LPQ, haslq ? nqpages : 0) |
2138251538Srpaulo	    /* Load values. */
2139251538Srpaulo	    R92C_RQPN_LD);
2140251538Srpaulo
2141251538Srpaulo	urtwn_write_1(sc, R92C_TXPKTBUF_BCNQ_BDNY, R92C_TX_PAGE_BOUNDARY);
2142251538Srpaulo	urtwn_write_1(sc, R92C_TXPKTBUF_MGQ_BDNY, R92C_TX_PAGE_BOUNDARY);
2143251538Srpaulo	urtwn_write_1(sc, R92C_TXPKTBUF_WMAC_LBK_BF_HD, R92C_TX_PAGE_BOUNDARY);
2144251538Srpaulo	urtwn_write_1(sc, R92C_TRXFF_BNDY, R92C_TX_PAGE_BOUNDARY);
2145251538Srpaulo	urtwn_write_1(sc, R92C_TDECTRL + 1, R92C_TX_PAGE_BOUNDARY);
2146251538Srpaulo
2147251538Srpaulo	/* Set queue to USB pipe mapping. */
2148251538Srpaulo	reg = urtwn_read_2(sc, R92C_TRXDMA_CTRL);
2149251538Srpaulo	reg &= ~R92C_TRXDMA_CTRL_QMAP_M;
2150251538Srpaulo	if (nqueues == 1) {
2151251538Srpaulo		if (hashq)
2152251538Srpaulo			reg |= R92C_TRXDMA_CTRL_QMAP_HQ;
2153251538Srpaulo		else if (hasnq)
2154251538Srpaulo			reg |= R92C_TRXDMA_CTRL_QMAP_NQ;
2155251538Srpaulo		else
2156251538Srpaulo			reg |= R92C_TRXDMA_CTRL_QMAP_LQ;
2157251538Srpaulo	} else if (nqueues == 2) {
2158251538Srpaulo		/* All 2-endpoints configs have a high priority queue. */
2159251538Srpaulo		if (!hashq)
2160251538Srpaulo			return (EIO);
2161251538Srpaulo		if (hasnq)
2162251538Srpaulo			reg |= R92C_TRXDMA_CTRL_QMAP_HQ_NQ;
2163251538Srpaulo		else
2164251538Srpaulo			reg |= R92C_TRXDMA_CTRL_QMAP_HQ_LQ;
2165251538Srpaulo	} else
2166251538Srpaulo		reg |= R92C_TRXDMA_CTRL_QMAP_3EP;
2167251538Srpaulo	urtwn_write_2(sc, R92C_TRXDMA_CTRL, reg);
2168251538Srpaulo
2169251538Srpaulo	/* Set Tx/Rx transfer page boundary. */
2170251538Srpaulo	urtwn_write_2(sc, R92C_TRXFF_BNDY + 2, 0x27ff);
2171251538Srpaulo
2172251538Srpaulo	/* Set Tx/Rx transfer page size. */
2173251538Srpaulo	urtwn_write_1(sc, R92C_PBP,
2174251538Srpaulo	    SM(R92C_PBP_PSRX, R92C_PBP_128) |
2175251538Srpaulo	    SM(R92C_PBP_PSTX, R92C_PBP_128));
2176251538Srpaulo	return (0);
2177251538Srpaulo}
2178251538Srpaulo
2179251538Srpaulostatic void
2180251538Srpaulourtwn_mac_init(struct urtwn_softc *sc)
2181251538Srpaulo{
2182251538Srpaulo	int i;
2183251538Srpaulo
2184251538Srpaulo	/* Write MAC initialization values. */
2185251538Srpaulo	for (i = 0; i < nitems(rtl8192cu_mac); i++)
2186251538Srpaulo		urtwn_write_1(sc, rtl8192cu_mac[i].reg, rtl8192cu_mac[i].val);
2187251538Srpaulo}
2188251538Srpaulo
2189251538Srpaulostatic void
2190251538Srpaulourtwn_bb_init(struct urtwn_softc *sc)
2191251538Srpaulo{
2192251538Srpaulo	const struct urtwn_bb_prog *prog;
2193251538Srpaulo	uint32_t reg;
2194251538Srpaulo	int i;
2195251538Srpaulo
2196251538Srpaulo	/* Enable BB and RF. */
2197251538Srpaulo	urtwn_write_2(sc, R92C_SYS_FUNC_EN,
2198251538Srpaulo	    urtwn_read_2(sc, R92C_SYS_FUNC_EN) |
2199251538Srpaulo	    R92C_SYS_FUNC_EN_BBRSTB | R92C_SYS_FUNC_EN_BB_GLB_RST |
2200251538Srpaulo	    R92C_SYS_FUNC_EN_DIO_RF);
2201251538Srpaulo
2202251538Srpaulo	urtwn_write_2(sc, R92C_AFE_PLL_CTRL, 0xdb83);
2203251538Srpaulo
2204251538Srpaulo	urtwn_write_1(sc, R92C_RF_CTRL,
2205251538Srpaulo	    R92C_RF_CTRL_EN | R92C_RF_CTRL_RSTB | R92C_RF_CTRL_SDMRSTB);
2206251538Srpaulo	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
2207251538Srpaulo	    R92C_SYS_FUNC_EN_USBA | R92C_SYS_FUNC_EN_USBD |
2208251538Srpaulo	    R92C_SYS_FUNC_EN_BB_GLB_RST | R92C_SYS_FUNC_EN_BBRSTB);
2209251538Srpaulo
2210251538Srpaulo	urtwn_write_1(sc, R92C_LDOHCI12_CTRL, 0x0f);
2211251538Srpaulo	urtwn_write_1(sc, 0x15, 0xe9);
2212251538Srpaulo	urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 1, 0x80);
2213251538Srpaulo
2214251538Srpaulo	/* Select BB programming based on board type. */
2215251538Srpaulo	if (!(sc->chip & URTWN_CHIP_92C)) {
2216251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_MINICARD)
2217251538Srpaulo			prog = &rtl8188ce_bb_prog;
2218251538Srpaulo		else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA)
2219251538Srpaulo			prog = &rtl8188ru_bb_prog;
2220251538Srpaulo		else
2221251538Srpaulo			prog = &rtl8188cu_bb_prog;
2222251538Srpaulo	} else {
2223251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_MINICARD)
2224251538Srpaulo			prog = &rtl8192ce_bb_prog;
2225251538Srpaulo		else
2226251538Srpaulo			prog = &rtl8192cu_bb_prog;
2227251538Srpaulo	}
2228251538Srpaulo	/* Write BB initialization values. */
2229251538Srpaulo	for (i = 0; i < prog->count; i++) {
2230251538Srpaulo		urtwn_bb_write(sc, prog->regs[i], prog->vals[i]);
2231251538Srpaulo		DELAY(1);
2232251538Srpaulo	}
2233251538Srpaulo
2234251538Srpaulo	if (sc->chip & URTWN_CHIP_92C_1T2R) {
2235251538Srpaulo		/* 8192C 1T only configuration. */
2236251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_TXINFO);
2237251538Srpaulo		reg = (reg & ~0x00000003) | 0x2;
2238251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_TXINFO, reg);
2239251538Srpaulo
2240251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA1_TXINFO);
2241251538Srpaulo		reg = (reg & ~0x00300033) | 0x00200022;
2242251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA1_TXINFO, reg);
2243251538Srpaulo
2244251538Srpaulo		reg = urtwn_bb_read(sc, R92C_CCK0_AFESETTING);
2245251538Srpaulo		reg = (reg & ~0xff000000) | 0x45 << 24;
2246251538Srpaulo		urtwn_bb_write(sc, R92C_CCK0_AFESETTING, reg);
2247251538Srpaulo
2248251538Srpaulo		reg = urtwn_bb_read(sc, R92C_OFDM0_TRXPATHENA);
2249251538Srpaulo		reg = (reg & ~0x000000ff) | 0x23;
2250251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM0_TRXPATHENA, reg);
2251251538Srpaulo
2252251538Srpaulo		reg = urtwn_bb_read(sc, R92C_OFDM0_AGCPARAM1);
2253251538Srpaulo		reg = (reg & ~0x00000030) | 1 << 4;
2254251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM0_AGCPARAM1, reg);
2255251538Srpaulo
2256251538Srpaulo		reg = urtwn_bb_read(sc, 0xe74);
2257251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
2258251538Srpaulo		urtwn_bb_write(sc, 0xe74, reg);
2259251538Srpaulo		reg = urtwn_bb_read(sc, 0xe78);
2260251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
2261251538Srpaulo		urtwn_bb_write(sc, 0xe78, reg);
2262251538Srpaulo		reg = urtwn_bb_read(sc, 0xe7c);
2263251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
2264251538Srpaulo		urtwn_bb_write(sc, 0xe7c, reg);
2265251538Srpaulo		reg = urtwn_bb_read(sc, 0xe80);
2266251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
2267251538Srpaulo		urtwn_bb_write(sc, 0xe80, reg);
2268251538Srpaulo		reg = urtwn_bb_read(sc, 0xe88);
2269251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
2270251538Srpaulo		urtwn_bb_write(sc, 0xe88, reg);
2271251538Srpaulo	}
2272251538Srpaulo
2273251538Srpaulo	/* Write AGC values. */
2274251538Srpaulo	for (i = 0; i < prog->agccount; i++) {
2275251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM0_AGCRSSITABLE,
2276251538Srpaulo		    prog->agcvals[i]);
2277251538Srpaulo		DELAY(1);
2278251538Srpaulo	}
2279251538Srpaulo
2280251538Srpaulo	if (urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)) &
2281251538Srpaulo	    R92C_HSSI_PARAM2_CCK_HIPWR)
2282251538Srpaulo		sc->sc_flags |= URTWN_FLAG_CCK_HIPWR;
2283251538Srpaulo}
2284251538Srpaulo
2285251538Srpaulovoid
2286251538Srpaulourtwn_rf_init(struct urtwn_softc *sc)
2287251538Srpaulo{
2288251538Srpaulo	const struct urtwn_rf_prog *prog;
2289251538Srpaulo	uint32_t reg, type;
2290251538Srpaulo	int i, j, idx, off;
2291251538Srpaulo
2292251538Srpaulo	/* Select RF programming based on board type. */
2293251538Srpaulo	if (!(sc->chip & URTWN_CHIP_92C)) {
2294251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_MINICARD)
2295251538Srpaulo			prog = rtl8188ce_rf_prog;
2296251538Srpaulo		else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA)
2297251538Srpaulo			prog = rtl8188ru_rf_prog;
2298251538Srpaulo		else
2299251538Srpaulo			prog = rtl8188cu_rf_prog;
2300251538Srpaulo	} else
2301251538Srpaulo		prog = rtl8192ce_rf_prog;
2302251538Srpaulo
2303251538Srpaulo	for (i = 0; i < sc->nrxchains; i++) {
2304251538Srpaulo		/* Save RF_ENV control type. */
2305251538Srpaulo		idx = i / 2;
2306251538Srpaulo		off = (i % 2) * 16;
2307251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx));
2308251538Srpaulo		type = (reg >> off) & 0x10;
2309251538Srpaulo
2310251538Srpaulo		/* Set RF_ENV enable. */
2311251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i));
2312251538Srpaulo		reg |= 0x100000;
2313251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg);
2314251538Srpaulo		DELAY(1);
2315251538Srpaulo		/* Set RF_ENV output high. */
2316251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i));
2317251538Srpaulo		reg |= 0x10;
2318251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg);
2319251538Srpaulo		DELAY(1);
2320251538Srpaulo		/* Set address and data lengths of RF registers. */
2321251538Srpaulo		reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i));
2322251538Srpaulo		reg &= ~R92C_HSSI_PARAM2_ADDR_LENGTH;
2323251538Srpaulo		urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg);
2324251538Srpaulo		DELAY(1);
2325251538Srpaulo		reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i));
2326251538Srpaulo		reg &= ~R92C_HSSI_PARAM2_DATA_LENGTH;
2327251538Srpaulo		urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg);
2328251538Srpaulo		DELAY(1);
2329251538Srpaulo
2330251538Srpaulo		/* Write RF initialization values for this chain. */
2331251538Srpaulo		for (j = 0; j < prog[i].count; j++) {
2332251538Srpaulo			if (prog[i].regs[j] >= 0xf9 &&
2333251538Srpaulo			    prog[i].regs[j] <= 0xfe) {
2334251538Srpaulo				/*
2335251538Srpaulo				 * These are fake RF registers offsets that
2336251538Srpaulo				 * indicate a delay is required.
2337251538Srpaulo				 */
2338251538Srpaulo				usb_pause_mtx(&sc->sc_mtx, 50);
2339251538Srpaulo				continue;
2340251538Srpaulo			}
2341251538Srpaulo			urtwn_rf_write(sc, i, prog[i].regs[j],
2342251538Srpaulo			    prog[i].vals[j]);
2343251538Srpaulo			DELAY(1);
2344251538Srpaulo		}
2345251538Srpaulo
2346251538Srpaulo		/* Restore RF_ENV control type. */
2347251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx));
2348251538Srpaulo		reg &= ~(0x10 << off) | (type << off);
2349251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFIFACESW(idx), reg);
2350251538Srpaulo
2351251538Srpaulo		/* Cache RF register CHNLBW. */
2352251538Srpaulo		sc->rf_chnlbw[i] = urtwn_rf_read(sc, i, R92C_RF_CHNLBW);
2353251538Srpaulo	}
2354251538Srpaulo
2355251538Srpaulo	if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) ==
2356251538Srpaulo	    URTWN_CHIP_UMC_A_CUT) {
2357251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_RX_G1, 0x30255);
2358251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_RX_G2, 0x50a00);
2359251538Srpaulo	}
2360251538Srpaulo}
2361251538Srpaulo
2362251538Srpaulostatic void
2363251538Srpaulourtwn_cam_init(struct urtwn_softc *sc)
2364251538Srpaulo{
2365251538Srpaulo	/* Invalidate all CAM entries. */
2366251538Srpaulo	urtwn_write_4(sc, R92C_CAMCMD,
2367251538Srpaulo	    R92C_CAMCMD_POLLING | R92C_CAMCMD_CLR);
2368251538Srpaulo}
2369251538Srpaulo
2370251538Srpaulostatic void
2371251538Srpaulourtwn_pa_bias_init(struct urtwn_softc *sc)
2372251538Srpaulo{
2373251538Srpaulo	uint8_t reg;
2374251538Srpaulo	int i;
2375251538Srpaulo
2376251538Srpaulo	for (i = 0; i < sc->nrxchains; i++) {
2377251538Srpaulo		if (sc->pa_setting & (1 << i))
2378251538Srpaulo			continue;
2379251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0x0f406);
2380251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0x4f406);
2381251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0x8f406);
2382251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0xcf406);
2383251538Srpaulo	}
2384251538Srpaulo	if (!(sc->pa_setting & 0x10)) {
2385251538Srpaulo		reg = urtwn_read_1(sc, 0x16);
2386251538Srpaulo		reg = (reg & ~0xf0) | 0x90;
2387251538Srpaulo		urtwn_write_1(sc, 0x16, reg);
2388251538Srpaulo	}
2389251538Srpaulo}
2390251538Srpaulo
2391251538Srpaulostatic void
2392251538Srpaulourtwn_rxfilter_init(struct urtwn_softc *sc)
2393251538Srpaulo{
2394251538Srpaulo	/* Initialize Rx filter. */
2395251538Srpaulo	/* TODO: use better filter for monitor mode. */
2396251538Srpaulo	urtwn_write_4(sc, R92C_RCR,
2397251538Srpaulo	    R92C_RCR_AAP | R92C_RCR_APM | R92C_RCR_AM | R92C_RCR_AB |
2398251538Srpaulo	    R92C_RCR_APP_ICV | R92C_RCR_AMF | R92C_RCR_HTC_LOC_CTRL |
2399251538Srpaulo	    R92C_RCR_APP_MIC | R92C_RCR_APP_PHYSTS);
2400251538Srpaulo	/* Accept all multicast frames. */
2401251538Srpaulo	urtwn_write_4(sc, R92C_MAR + 0, 0xffffffff);
2402251538Srpaulo	urtwn_write_4(sc, R92C_MAR + 4, 0xffffffff);
2403251538Srpaulo	/* Accept all management frames. */
2404251538Srpaulo	urtwn_write_2(sc, R92C_RXFLTMAP0, 0xffff);
2405251538Srpaulo	/* Reject all control frames. */
2406251538Srpaulo	urtwn_write_2(sc, R92C_RXFLTMAP1, 0x0000);
2407251538Srpaulo	/* Accept all data frames. */
2408251538Srpaulo	urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff);
2409251538Srpaulo}
2410251538Srpaulo
2411251538Srpaulostatic void
2412251538Srpaulourtwn_edca_init(struct urtwn_softc *sc)
2413251538Srpaulo{
2414251538Srpaulo	urtwn_write_2(sc, R92C_SPEC_SIFS, 0x100a);
2415251538Srpaulo	urtwn_write_2(sc, R92C_MAC_SPEC_SIFS, 0x100a);
2416251538Srpaulo	urtwn_write_2(sc, R92C_SIFS_CCK, 0x100a);
2417251538Srpaulo	urtwn_write_2(sc, R92C_SIFS_OFDM, 0x100a);
2418251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x005ea42b);
2419251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a44f);
2420251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005ea324);
2421251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002fa226);
2422251538Srpaulo}
2423251538Srpaulo
2424251538Srpaulovoid
2425251538Srpaulourtwn_write_txpower(struct urtwn_softc *sc, int chain,
2426251538Srpaulo    uint16_t power[URTWN_RIDX_COUNT])
2427251538Srpaulo{
2428251538Srpaulo	uint32_t reg;
2429251538Srpaulo
2430251538Srpaulo	/* Write per-CCK rate Tx power. */
2431251538Srpaulo	if (chain == 0) {
2432251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_A_CCK1_MCS32);
2433251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK1,  power[0]);
2434251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_A_CCK1_MCS32, reg);
2435251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11);
2436251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK2,  power[1]);
2437251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK55, power[2]);
2438251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK11, power[3]);
2439251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg);
2440251538Srpaulo	} else {
2441251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK1_55_MCS32);
2442251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK1,  power[0]);
2443251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK2,  power[1]);
2444251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK55, power[2]);
2445251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_B_CCK1_55_MCS32, reg);
2446251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11);
2447251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK11, power[3]);
2448251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg);
2449251538Srpaulo	}
2450251538Srpaulo	/* Write per-OFDM rate Tx power. */
2451251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_RATE18_06(chain),
2452251538Srpaulo	    SM(R92C_TXAGC_RATE06, power[ 4]) |
2453251538Srpaulo	    SM(R92C_TXAGC_RATE09, power[ 5]) |
2454251538Srpaulo	    SM(R92C_TXAGC_RATE12, power[ 6]) |
2455251538Srpaulo	    SM(R92C_TXAGC_RATE18, power[ 7]));
2456251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_RATE54_24(chain),
2457251538Srpaulo	    SM(R92C_TXAGC_RATE24, power[ 8]) |
2458251538Srpaulo	    SM(R92C_TXAGC_RATE36, power[ 9]) |
2459251538Srpaulo	    SM(R92C_TXAGC_RATE48, power[10]) |
2460251538Srpaulo	    SM(R92C_TXAGC_RATE54, power[11]));
2461251538Srpaulo	/* Write per-MCS Tx power. */
2462251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS03_MCS00(chain),
2463251538Srpaulo	    SM(R92C_TXAGC_MCS00,  power[12]) |
2464251538Srpaulo	    SM(R92C_TXAGC_MCS01,  power[13]) |
2465251538Srpaulo	    SM(R92C_TXAGC_MCS02,  power[14]) |
2466251538Srpaulo	    SM(R92C_TXAGC_MCS03,  power[15]));
2467251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS07_MCS04(chain),
2468251538Srpaulo	    SM(R92C_TXAGC_MCS04,  power[16]) |
2469251538Srpaulo	    SM(R92C_TXAGC_MCS05,  power[17]) |
2470251538Srpaulo	    SM(R92C_TXAGC_MCS06,  power[18]) |
2471251538Srpaulo	    SM(R92C_TXAGC_MCS07,  power[19]));
2472251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS11_MCS08(chain),
2473251538Srpaulo	    SM(R92C_TXAGC_MCS08,  power[20]) |
2474251538Srpaulo	    SM(R92C_TXAGC_MCS08,  power[21]) |
2475251538Srpaulo	    SM(R92C_TXAGC_MCS10,  power[22]) |
2476251538Srpaulo	    SM(R92C_TXAGC_MCS11,  power[23]));
2477251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS15_MCS12(chain),
2478251538Srpaulo	    SM(R92C_TXAGC_MCS12,  power[24]) |
2479251538Srpaulo	    SM(R92C_TXAGC_MCS13,  power[25]) |
2480251538Srpaulo	    SM(R92C_TXAGC_MCS14,  power[26]) |
2481251538Srpaulo	    SM(R92C_TXAGC_MCS15,  power[27]));
2482251538Srpaulo}
2483251538Srpaulo
2484251538Srpaulovoid
2485251538Srpaulourtwn_get_txpower(struct urtwn_softc *sc, int chain,
2486251538Srpaulo    struct ieee80211_channel *c, struct ieee80211_channel *extc,
2487251538Srpaulo    uint16_t power[URTWN_RIDX_COUNT])
2488251538Srpaulo{
2489251538Srpaulo	struct ieee80211com *ic = sc->sc_ifp->if_l2com;
2490251538Srpaulo	struct r92c_rom *rom = &sc->rom;
2491251538Srpaulo	uint16_t cckpow, ofdmpow, htpow, diff, max;
2492251538Srpaulo	const struct urtwn_txpwr *base;
2493251538Srpaulo	int ridx, chan, group;
2494251538Srpaulo
2495251538Srpaulo	/* Determine channel group. */
2496251538Srpaulo	chan = ieee80211_chan2ieee(ic, c);	/* XXX center freq! */
2497251538Srpaulo	if (chan <= 3)
2498251538Srpaulo		group = 0;
2499251538Srpaulo	else if (chan <= 9)
2500251538Srpaulo		group = 1;
2501251538Srpaulo	else
2502251538Srpaulo		group = 2;
2503251538Srpaulo
2504251538Srpaulo	/* Get original Tx power based on board type and RF chain. */
2505251538Srpaulo	if (!(sc->chip & URTWN_CHIP_92C)) {
2506251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_HIGHPA)
2507251538Srpaulo			base = &rtl8188ru_txagc[chain];
2508251538Srpaulo		else
2509251538Srpaulo			base = &rtl8192cu_txagc[chain];
2510251538Srpaulo	} else
2511251538Srpaulo		base = &rtl8192cu_txagc[chain];
2512251538Srpaulo
2513251538Srpaulo	memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0]));
2514251538Srpaulo	if (sc->regulatory == 0) {
2515251538Srpaulo		for (ridx = 0; ridx <= 3; ridx++)
2516251538Srpaulo			power[ridx] = base->pwr[0][ridx];
2517251538Srpaulo	}
2518251538Srpaulo	for (ridx = 4; ridx < URTWN_RIDX_COUNT; ridx++) {
2519251538Srpaulo		if (sc->regulatory == 3) {
2520251538Srpaulo			power[ridx] = base->pwr[0][ridx];
2521251538Srpaulo			/* Apply vendor limits. */
2522251538Srpaulo			if (extc != NULL)
2523251538Srpaulo				max = rom->ht40_max_pwr[group];
2524251538Srpaulo			else
2525251538Srpaulo				max = rom->ht20_max_pwr[group];
2526251538Srpaulo			max = (max >> (chain * 4)) & 0xf;
2527251538Srpaulo			if (power[ridx] > max)
2528251538Srpaulo				power[ridx] = max;
2529251538Srpaulo		} else if (sc->regulatory == 1) {
2530251538Srpaulo			if (extc == NULL)
2531251538Srpaulo				power[ridx] = base->pwr[group][ridx];
2532251538Srpaulo		} else if (sc->regulatory != 2)
2533251538Srpaulo			power[ridx] = base->pwr[0][ridx];
2534251538Srpaulo	}
2535251538Srpaulo
2536251538Srpaulo	/* Compute per-CCK rate Tx power. */
2537251538Srpaulo	cckpow = rom->cck_tx_pwr[chain][group];
2538251538Srpaulo	for (ridx = 0; ridx <= 3; ridx++) {
2539251538Srpaulo		power[ridx] += cckpow;
2540251538Srpaulo		if (power[ridx] > R92C_MAX_TX_PWR)
2541251538Srpaulo			power[ridx] = R92C_MAX_TX_PWR;
2542251538Srpaulo	}
2543251538Srpaulo
2544251538Srpaulo	htpow = rom->ht40_1s_tx_pwr[chain][group];
2545251538Srpaulo	if (sc->ntxchains > 1) {
2546251538Srpaulo		/* Apply reduction for 2 spatial streams. */
2547251538Srpaulo		diff = rom->ht40_2s_tx_pwr_diff[group];
2548251538Srpaulo		diff = (diff >> (chain * 4)) & 0xf;
2549251538Srpaulo		htpow = (htpow > diff) ? htpow - diff : 0;
2550251538Srpaulo	}
2551251538Srpaulo
2552251538Srpaulo	/* Compute per-OFDM rate Tx power. */
2553251538Srpaulo	diff = rom->ofdm_tx_pwr_diff[group];
2554251538Srpaulo	diff = (diff >> (chain * 4)) & 0xf;
2555251538Srpaulo	ofdmpow = htpow + diff;	/* HT->OFDM correction. */
2556251538Srpaulo	for (ridx = 4; ridx <= 11; ridx++) {
2557251538Srpaulo		power[ridx] += ofdmpow;
2558251538Srpaulo		if (power[ridx] > R92C_MAX_TX_PWR)
2559251538Srpaulo			power[ridx] = R92C_MAX_TX_PWR;
2560251538Srpaulo	}
2561251538Srpaulo
2562251538Srpaulo	/* Compute per-MCS Tx power. */
2563251538Srpaulo	if (extc == NULL) {
2564251538Srpaulo		diff = rom->ht20_tx_pwr_diff[group];
2565251538Srpaulo		diff = (diff >> (chain * 4)) & 0xf;
2566251538Srpaulo		htpow += diff;	/* HT40->HT20 correction. */
2567251538Srpaulo	}
2568251538Srpaulo	for (ridx = 12; ridx <= 27; ridx++) {
2569251538Srpaulo		power[ridx] += htpow;
2570251538Srpaulo		if (power[ridx] > R92C_MAX_TX_PWR)
2571251538Srpaulo			power[ridx] = R92C_MAX_TX_PWR;
2572251538Srpaulo	}
2573251538Srpaulo#ifdef URTWN_DEBUG
2574251538Srpaulo	if (urtwn_debug >= 4) {
2575251538Srpaulo		/* Dump per-rate Tx power values. */
2576251538Srpaulo		printf("Tx power for chain %d:\n", chain);
2577251538Srpaulo		for (ridx = 0; ridx < URTWN_RIDX_COUNT; ridx++)
2578251538Srpaulo			printf("Rate %d = %u\n", ridx, power[ridx]);
2579251538Srpaulo	}
2580251538Srpaulo#endif
2581251538Srpaulo}
2582251538Srpaulo
2583251538Srpaulovoid
2584251538Srpaulourtwn_set_txpower(struct urtwn_softc *sc, struct ieee80211_channel *c,
2585251538Srpaulo    struct ieee80211_channel *extc)
2586251538Srpaulo{
2587251538Srpaulo	uint16_t power[URTWN_RIDX_COUNT];
2588251538Srpaulo	int i;
2589251538Srpaulo
2590251538Srpaulo	for (i = 0; i < sc->ntxchains; i++) {
2591251538Srpaulo		/* Compute per-rate Tx power values. */
2592251538Srpaulo		urtwn_get_txpower(sc, i, c, extc, power);
2593251538Srpaulo		/* Write per-rate Tx power values to hardware. */
2594251538Srpaulo		urtwn_write_txpower(sc, i, power);
2595251538Srpaulo	}
2596251538Srpaulo}
2597251538Srpaulo
2598251538Srpaulostatic void
2599251538Srpaulourtwn_scan_start(struct ieee80211com *ic)
2600251538Srpaulo{
2601251538Srpaulo	/* XXX do nothing?  */
2602251538Srpaulo}
2603251538Srpaulo
2604251538Srpaulostatic void
2605251538Srpaulourtwn_scan_end(struct ieee80211com *ic)
2606251538Srpaulo{
2607251538Srpaulo	/* XXX do nothing?  */
2608251538Srpaulo}
2609251538Srpaulo
2610251538Srpaulostatic void
2611251538Srpaulourtwn_set_channel(struct ieee80211com *ic)
2612251538Srpaulo{
2613251538Srpaulo	struct urtwn_softc *sc = ic->ic_ifp->if_softc;
2614251538Srpaulo
2615251538Srpaulo	URTWN_LOCK(sc);
2616251538Srpaulo	urtwn_set_chan(sc, ic->ic_curchan, NULL);
2617251538Srpaulo	URTWN_UNLOCK(sc);
2618251538Srpaulo}
2619251538Srpaulo
2620251538Srpaulostatic void
2621251538Srpaulourtwn_update_mcast(struct ifnet *ifp)
2622251538Srpaulo{
2623251538Srpaulo	/* XXX do nothing?  */
2624251538Srpaulo}
2625251538Srpaulo
2626251538Srpaulostatic void
2627251538Srpaulourtwn_set_chan(struct urtwn_softc *sc, struct ieee80211_channel *c,
2628251538Srpaulo    struct ieee80211_channel *extc)
2629251538Srpaulo{
2630251538Srpaulo	struct ieee80211com *ic = sc->sc_ifp->if_l2com;
2631251538Srpaulo	uint32_t reg;
2632251538Srpaulo	u_int chan;
2633251538Srpaulo	int i;
2634251538Srpaulo
2635251538Srpaulo	chan = ieee80211_chan2ieee(ic, c);	/* XXX center freq! */
2636251538Srpaulo	if (chan == 0 || chan == IEEE80211_CHAN_ANY) {
2637251538Srpaulo		device_printf(sc->sc_dev,
2638251538Srpaulo		    "%s: invalid channel %x\n", __func__, chan);
2639251538Srpaulo		return;
2640251538Srpaulo	}
2641251538Srpaulo
2642251538Srpaulo	/* Set Tx power for this new channel. */
2643251538Srpaulo	urtwn_set_txpower(sc, c, extc);
2644251538Srpaulo
2645251538Srpaulo	for (i = 0; i < sc->nrxchains; i++) {
2646251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_CHNLBW,
2647251538Srpaulo		    RW(sc->rf_chnlbw[i], R92C_RF_CHNLBW_CHNL, chan));
2648251538Srpaulo	}
2649251538Srpaulo#ifndef IEEE80211_NO_HT
2650251538Srpaulo	if (extc != NULL) {
2651251538Srpaulo		/* Is secondary channel below or above primary? */
2652251538Srpaulo		int prichlo = c->ic_freq < extc->ic_freq;
2653251538Srpaulo
2654251538Srpaulo		urtwn_write_1(sc, R92C_BWOPMODE,
2655251538Srpaulo		    urtwn_read_1(sc, R92C_BWOPMODE) & ~R92C_BWOPMODE_20MHZ);
2656251538Srpaulo
2657251538Srpaulo		reg = urtwn_read_1(sc, R92C_RRSR + 2);
2658251538Srpaulo		reg = (reg & ~0x6f) | (prichlo ? 1 : 2) << 5;
2659251538Srpaulo		urtwn_write_1(sc, R92C_RRSR + 2, reg);
2660251538Srpaulo
2661251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFMOD,
2662251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA0_RFMOD) | R92C_RFMOD_40MHZ);
2663251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA1_RFMOD,
2664251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA1_RFMOD) | R92C_RFMOD_40MHZ);
2665251538Srpaulo
2666251538Srpaulo		/* Set CCK side band. */
2667251538Srpaulo		reg = urtwn_bb_read(sc, R92C_CCK0_SYSTEM);
2668251538Srpaulo		reg = (reg & ~0x00000010) | (prichlo ? 0 : 1) << 4;
2669251538Srpaulo		urtwn_bb_write(sc, R92C_CCK0_SYSTEM, reg);
2670251538Srpaulo
2671251538Srpaulo		reg = urtwn_bb_read(sc, R92C_OFDM1_LSTF);
2672251538Srpaulo		reg = (reg & ~0x00000c00) | (prichlo ? 1 : 2) << 10;
2673251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM1_LSTF, reg);
2674251538Srpaulo
2675251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2,
2676251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) &
2677251538Srpaulo		    ~R92C_FPGA0_ANAPARAM2_CBW20);
2678251538Srpaulo
2679251538Srpaulo		reg = urtwn_bb_read(sc, 0x818);
2680251538Srpaulo		reg = (reg & ~0x0c000000) | (prichlo ? 2 : 1) << 26;
2681251538Srpaulo		urtwn_bb_write(sc, 0x818, reg);
2682251538Srpaulo
2683251538Srpaulo		/* Select 40MHz bandwidth. */
2684251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
2685251538Srpaulo		    (sc->rf_chnlbw[0] & ~0xfff) | chan);
2686251538Srpaulo	} else
2687251538Srpaulo#endif
2688251538Srpaulo	{
2689251538Srpaulo		urtwn_write_1(sc, R92C_BWOPMODE,
2690251538Srpaulo		    urtwn_read_1(sc, R92C_BWOPMODE) | R92C_BWOPMODE_20MHZ);
2691251538Srpaulo
2692251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFMOD,
2693251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA0_RFMOD) & ~R92C_RFMOD_40MHZ);
2694251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA1_RFMOD,
2695251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA1_RFMOD) & ~R92C_RFMOD_40MHZ);
2696251538Srpaulo
2697251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2,
2698251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) |
2699251538Srpaulo		    R92C_FPGA0_ANAPARAM2_CBW20);
2700251538Srpaulo
2701251538Srpaulo		/* Select 20MHz bandwidth. */
2702251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
2703251538Srpaulo		    (sc->rf_chnlbw[0] & ~0xfff) | R92C_RF_CHNLBW_BW20 | chan);
2704251538Srpaulo	}
2705251538Srpaulo}
2706251538Srpaulo
2707251538Srpaulostatic void
2708251538Srpaulourtwn_iq_calib(struct urtwn_softc *sc)
2709251538Srpaulo{
2710251538Srpaulo	/* TODO */
2711251538Srpaulo}
2712251538Srpaulo
2713251538Srpaulostatic void
2714251538Srpaulourtwn_lc_calib(struct urtwn_softc *sc)
2715251538Srpaulo{
2716251538Srpaulo	uint32_t rf_ac[2];
2717251538Srpaulo	uint8_t txmode;
2718251538Srpaulo	int i;
2719251538Srpaulo
2720251538Srpaulo	txmode = urtwn_read_1(sc, R92C_OFDM1_LSTF + 3);
2721251538Srpaulo	if ((txmode & 0x70) != 0) {
2722251538Srpaulo		/* Disable all continuous Tx. */
2723251538Srpaulo		urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode & ~0x70);
2724251538Srpaulo
2725251538Srpaulo		/* Set RF mode to standby mode. */
2726251538Srpaulo		for (i = 0; i < sc->nrxchains; i++) {
2727251538Srpaulo			rf_ac[i] = urtwn_rf_read(sc, i, R92C_RF_AC);
2728251538Srpaulo			urtwn_rf_write(sc, i, R92C_RF_AC,
2729251538Srpaulo			    RW(rf_ac[i], R92C_RF_AC_MODE,
2730251538Srpaulo				R92C_RF_AC_MODE_STANDBY));
2731251538Srpaulo		}
2732251538Srpaulo	} else {
2733251538Srpaulo		/* Block all Tx queues. */
2734251538Srpaulo		urtwn_write_1(sc, R92C_TXPAUSE, 0xff);
2735251538Srpaulo	}
2736251538Srpaulo	/* Start calibration. */
2737251538Srpaulo	urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
2738251538Srpaulo	    urtwn_rf_read(sc, 0, R92C_RF_CHNLBW) | R92C_RF_CHNLBW_LCSTART);
2739251538Srpaulo
2740251538Srpaulo	/* Give calibration the time to complete. */
2741251538Srpaulo	usb_pause_mtx(&sc->sc_mtx, 100);
2742251538Srpaulo
2743251538Srpaulo	/* Restore configuration. */
2744251538Srpaulo	if ((txmode & 0x70) != 0) {
2745251538Srpaulo		/* Restore Tx mode. */
2746251538Srpaulo		urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode);
2747251538Srpaulo		/* Restore RF mode. */
2748251538Srpaulo		for (i = 0; i < sc->nrxchains; i++)
2749251538Srpaulo			urtwn_rf_write(sc, i, R92C_RF_AC, rf_ac[i]);
2750251538Srpaulo	} else {
2751251538Srpaulo		/* Unblock all Tx queues. */
2752251538Srpaulo		urtwn_write_1(sc, R92C_TXPAUSE, 0x00);
2753251538Srpaulo	}
2754251538Srpaulo}
2755251538Srpaulo
2756251538Srpaulostatic void
2757251538Srpaulourtwn_init_locked(void *arg)
2758251538Srpaulo{
2759251538Srpaulo	struct urtwn_softc *sc = arg;
2760251538Srpaulo	struct ifnet *ifp = sc->sc_ifp;
2761251538Srpaulo	uint32_t reg;
2762251538Srpaulo	int error;
2763251538Srpaulo
2764251538Srpaulo	if (ifp->if_drv_flags & IFF_DRV_RUNNING)
2765251538Srpaulo		urtwn_stop_locked(ifp, 0);
2766251538Srpaulo
2767251538Srpaulo	/* Init firmware commands ring. */
2768251538Srpaulo	sc->fwcur = 0;
2769251538Srpaulo
2770251538Srpaulo	/* Allocate Tx/Rx buffers. */
2771251538Srpaulo	error = urtwn_alloc_rx_list(sc);
2772251538Srpaulo	if (error != 0)
2773251538Srpaulo		goto fail;
2774251538Srpaulo
2775251538Srpaulo	error = urtwn_alloc_tx_list(sc);
2776251538Srpaulo	if (error != 0)
2777251538Srpaulo		goto fail;
2778251538Srpaulo
2779251538Srpaulo	/* Power on adapter. */
2780251538Srpaulo	error = urtwn_power_on(sc);
2781251538Srpaulo	if (error != 0)
2782251538Srpaulo		goto fail;
2783251538Srpaulo
2784251538Srpaulo	/* Initialize DMA. */
2785251538Srpaulo	error = urtwn_dma_init(sc);
2786251538Srpaulo	if (error != 0)
2787251538Srpaulo		goto fail;
2788251538Srpaulo
2789251538Srpaulo	/* Set info size in Rx descriptors (in 64-bit words). */
2790251538Srpaulo	urtwn_write_1(sc, R92C_RX_DRVINFO_SZ, 4);
2791251538Srpaulo
2792251538Srpaulo	/* Init interrupts. */
2793251538Srpaulo	urtwn_write_4(sc, R92C_HISR, 0xffffffff);
2794251538Srpaulo	urtwn_write_4(sc, R92C_HIMR, 0xffffffff);
2795251538Srpaulo
2796251538Srpaulo	/* Set MAC address. */
2797251538Srpaulo	urtwn_write_region_1(sc, R92C_MACID, IF_LLADDR(ifp),
2798251538Srpaulo	    IEEE80211_ADDR_LEN);
2799251538Srpaulo
2800251538Srpaulo	/* Set initial network type. */
2801251538Srpaulo	reg = urtwn_read_4(sc, R92C_CR);
2802251538Srpaulo	reg = RW(reg, R92C_CR_NETTYPE, R92C_CR_NETTYPE_INFRA);
2803251538Srpaulo	urtwn_write_4(sc, R92C_CR, reg);
2804251538Srpaulo
2805251538Srpaulo	urtwn_rxfilter_init(sc);
2806251538Srpaulo
2807251538Srpaulo	reg = urtwn_read_4(sc, R92C_RRSR);
2808251538Srpaulo	reg = RW(reg, R92C_RRSR_RATE_BITMAP, R92C_RRSR_RATE_CCK_ONLY_1M);
2809251538Srpaulo	urtwn_write_4(sc, R92C_RRSR, reg);
2810251538Srpaulo
2811251538Srpaulo	/* Set short/long retry limits. */
2812251538Srpaulo	urtwn_write_2(sc, R92C_RL,
2813251538Srpaulo	    SM(R92C_RL_SRL, 0x30) | SM(R92C_RL_LRL, 0x30));
2814251538Srpaulo
2815251538Srpaulo	/* Initialize EDCA parameters. */
2816251538Srpaulo	urtwn_edca_init(sc);
2817251538Srpaulo
2818251538Srpaulo	/* Setup rate fallback. */
2819251538Srpaulo	urtwn_write_4(sc, R92C_DARFRC + 0, 0x00000000);
2820251538Srpaulo	urtwn_write_4(sc, R92C_DARFRC + 4, 0x10080404);
2821251538Srpaulo	urtwn_write_4(sc, R92C_RARFRC + 0, 0x04030201);
2822251538Srpaulo	urtwn_write_4(sc, R92C_RARFRC + 4, 0x08070605);
2823251538Srpaulo
2824251538Srpaulo	urtwn_write_1(sc, R92C_FWHW_TXQ_CTRL,
2825251538Srpaulo	    urtwn_read_1(sc, R92C_FWHW_TXQ_CTRL) |
2826251538Srpaulo	    R92C_FWHW_TXQ_CTRL_AMPDU_RTY_NEW);
2827251538Srpaulo	/* Set ACK timeout. */
2828251538Srpaulo	urtwn_write_1(sc, R92C_ACKTO, 0x40);
2829251538Srpaulo
2830251538Srpaulo	/* Setup USB aggregation. */
2831251538Srpaulo	reg = urtwn_read_4(sc, R92C_TDECTRL);
2832251538Srpaulo	reg = RW(reg, R92C_TDECTRL_BLK_DESC_NUM, 6);
2833251538Srpaulo	urtwn_write_4(sc, R92C_TDECTRL, reg);
2834251538Srpaulo	urtwn_write_1(sc, R92C_TRXDMA_CTRL,
2835251538Srpaulo	    urtwn_read_1(sc, R92C_TRXDMA_CTRL) |
2836251538Srpaulo	    R92C_TRXDMA_CTRL_RXDMA_AGG_EN);
2837251538Srpaulo	urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION,
2838251538Srpaulo	    urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) |
2839251538Srpaulo	    R92C_USB_SPECIAL_OPTION_AGG_EN);
2840251538Srpaulo	urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH, 48);
2841251538Srpaulo	urtwn_write_1(sc, R92C_USB_DMA_AGG_TO, 4);
2842251538Srpaulo	urtwn_write_1(sc, R92C_USB_AGG_TH, 8);
2843251538Srpaulo	urtwn_write_1(sc, R92C_USB_AGG_TO, 6);
2844251538Srpaulo
2845251538Srpaulo	/* Initialize beacon parameters. */
2846251538Srpaulo	urtwn_write_2(sc, R92C_TBTT_PROHIBIT, 0x6404);
2847251538Srpaulo	urtwn_write_1(sc, R92C_DRVERLYINT, 0x05);
2848251538Srpaulo	urtwn_write_1(sc, R92C_BCNDMATIM, 0x02);
2849251538Srpaulo	urtwn_write_2(sc, R92C_BCNTCFG, 0x660f);
2850251538Srpaulo
2851251538Srpaulo	/* Setup AMPDU aggregation. */
2852251538Srpaulo	urtwn_write_4(sc, R92C_AGGLEN_LMT, 0x99997631);	/* MCS7~0 */
2853251538Srpaulo	urtwn_write_1(sc, R92C_AGGR_BREAK_TIME, 0x16);
2854251538Srpaulo	urtwn_write_2(sc, 0x4ca, 0x0708);
2855251538Srpaulo
2856251538Srpaulo	urtwn_write_1(sc, R92C_BCN_MAX_ERR, 0xff);
2857251538Srpaulo	urtwn_write_1(sc, R92C_BCN_CTRL, R92C_BCN_CTRL_DIS_TSF_UDT0);
2858251538Srpaulo
2859251538Srpaulo	/* Load 8051 microcode. */
2860251538Srpaulo	error = urtwn_load_firmware(sc);
2861251538Srpaulo	if (error != 0)
2862251538Srpaulo		goto fail;
2863251538Srpaulo
2864251538Srpaulo	/* Initialize MAC/BB/RF blocks. */
2865251538Srpaulo	urtwn_mac_init(sc);
2866251538Srpaulo	urtwn_bb_init(sc);
2867251538Srpaulo	urtwn_rf_init(sc);
2868251538Srpaulo
2869251538Srpaulo	/* Turn CCK and OFDM blocks on. */
2870251538Srpaulo	reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD);
2871251538Srpaulo	reg |= R92C_RFMOD_CCK_EN;
2872251538Srpaulo	urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg);
2873251538Srpaulo	reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD);
2874251538Srpaulo	reg |= R92C_RFMOD_OFDM_EN;
2875251538Srpaulo	urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg);
2876251538Srpaulo
2877251538Srpaulo	/* Clear per-station keys table. */
2878251538Srpaulo	urtwn_cam_init(sc);
2879251538Srpaulo
2880251538Srpaulo	/* Enable hardware sequence numbering. */
2881251538Srpaulo	urtwn_write_1(sc, R92C_HWSEQ_CTRL, 0xff);
2882251538Srpaulo
2883251538Srpaulo	/* Perform LO and IQ calibrations. */
2884251538Srpaulo	urtwn_iq_calib(sc);
2885251538Srpaulo	/* Perform LC calibration. */
2886251538Srpaulo	urtwn_lc_calib(sc);
2887251538Srpaulo
2888251538Srpaulo	/* Fix USB interference issue. */
2889251538Srpaulo	urtwn_write_1(sc, 0xfe40, 0xe0);
2890251538Srpaulo	urtwn_write_1(sc, 0xfe41, 0x8d);
2891251538Srpaulo	urtwn_write_1(sc, 0xfe42, 0x80);
2892251538Srpaulo
2893251538Srpaulo	urtwn_pa_bias_init(sc);
2894251538Srpaulo
2895251538Srpaulo	/* Initialize GPIO setting. */
2896251538Srpaulo	urtwn_write_1(sc, R92C_GPIO_MUXCFG,
2897251538Srpaulo	    urtwn_read_1(sc, R92C_GPIO_MUXCFG) & ~R92C_GPIO_MUXCFG_ENBT);
2898251538Srpaulo
2899251538Srpaulo	/* Fix for lower temperature. */
2900251538Srpaulo	urtwn_write_1(sc, 0x15, 0xe9);
2901251538Srpaulo
2902251538Srpaulo	usbd_transfer_start(sc->sc_xfer[URTWN_BULK_RX]);
2903251538Srpaulo
2904251538Srpaulo	ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
2905251538Srpaulo	ifp->if_drv_flags |= IFF_DRV_RUNNING;
2906251538Srpaulo
2907251538Srpaulo	callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
2908251538Srpaulofail:
2909251538Srpaulo	return;
2910251538Srpaulo}
2911251538Srpaulo
2912251538Srpaulostatic void
2913251538Srpaulourtwn_init(void *arg)
2914251538Srpaulo{
2915251538Srpaulo	struct urtwn_softc *sc = arg;
2916251538Srpaulo
2917251538Srpaulo	URTWN_LOCK(sc);
2918251538Srpaulo	urtwn_init_locked(arg);
2919251538Srpaulo	URTWN_UNLOCK(sc);
2920251538Srpaulo}
2921251538Srpaulo
2922251538Srpaulostatic void
2923251538Srpaulourtwn_stop_locked(struct ifnet *ifp, int disable)
2924251538Srpaulo{
2925251538Srpaulo	struct urtwn_softc *sc = ifp->if_softc;
2926251538Srpaulo
2927251538Srpaulo	(void)disable;
2928251538Srpaulo	ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
2929251538Srpaulo
2930251538Srpaulo	callout_stop(&sc->sc_watchdog_ch);
2931251538Srpaulo	urtwn_abort_xfers(sc);
2932251538Srpaulo}
2933251538Srpaulo
2934251538Srpaulostatic void
2935251538Srpaulourtwn_stop(struct ifnet *ifp, int disable)
2936251538Srpaulo{
2937251538Srpaulo	struct urtwn_softc *sc = ifp->if_softc;
2938251538Srpaulo
2939251538Srpaulo	URTWN_LOCK(sc);
2940251538Srpaulo	urtwn_stop_locked(ifp, disable);
2941251538Srpaulo	URTWN_UNLOCK(sc);
2942251538Srpaulo}
2943251538Srpaulo
2944251538Srpaulostatic void
2945251538Srpaulourtwn_abort_xfers(struct urtwn_softc *sc)
2946251538Srpaulo{
2947251538Srpaulo	int i;
2948251538Srpaulo
2949251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
2950251538Srpaulo
2951251538Srpaulo	/* abort any pending transfers */
2952251538Srpaulo	for (i = 0; i < URTWN_N_TRANSFER; i++)
2953251538Srpaulo		usbd_transfer_stop(sc->sc_xfer[i]);
2954251538Srpaulo}
2955251538Srpaulo
2956251538Srpaulostatic int
2957251538Srpaulourtwn_raw_xmit(struct ieee80211_node *ni, struct mbuf *m,
2958251538Srpaulo    const struct ieee80211_bpf_params *params)
2959251538Srpaulo{
2960251538Srpaulo	struct ieee80211com *ic = ni->ni_ic;
2961251538Srpaulo	struct ifnet *ifp = ic->ic_ifp;
2962251538Srpaulo	struct urtwn_softc *sc = ifp->if_softc;
2963251538Srpaulo	struct urtwn_data *bf;
2964251538Srpaulo
2965251538Srpaulo	/* prevent management frames from being sent if we're not ready */
2966251538Srpaulo	if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) {
2967251538Srpaulo		m_freem(m);
2968251538Srpaulo		ieee80211_free_node(ni);
2969251538Srpaulo		return (ENETDOWN);
2970251538Srpaulo	}
2971251538Srpaulo	URTWN_LOCK(sc);
2972251538Srpaulo	bf = urtwn_getbuf(sc);
2973251538Srpaulo	if (bf == NULL) {
2974251538Srpaulo		ieee80211_free_node(ni);
2975251538Srpaulo		m_freem(m);
2976251538Srpaulo		URTWN_UNLOCK(sc);
2977251538Srpaulo		return (ENOBUFS);
2978251538Srpaulo	}
2979251538Srpaulo
2980251538Srpaulo	ifp->if_opackets++;
2981251538Srpaulo	if (urtwn_tx_start(sc, ni, m, bf) != 0) {
2982251538Srpaulo		ieee80211_free_node(ni);
2983251538Srpaulo		ifp->if_oerrors++;
2984251538Srpaulo		STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next);
2985251538Srpaulo		URTWN_UNLOCK(sc);
2986251538Srpaulo		return (EIO);
2987251538Srpaulo	}
2988251538Srpaulo	URTWN_UNLOCK(sc);
2989251538Srpaulo
2990251538Srpaulo	sc->sc_txtimer = 5;
2991251538Srpaulo	return (0);
2992251538Srpaulo}
2993251538Srpaulo
2994251538Srpaulostatic device_method_t urtwn_methods[] = {
2995251538Srpaulo	/* Device interface */
2996251538Srpaulo	DEVMETHOD(device_probe,		urtwn_match),
2997251538Srpaulo	DEVMETHOD(device_attach,	urtwn_attach),
2998251538Srpaulo	DEVMETHOD(device_detach,	urtwn_detach),
2999251538Srpaulo
3000251538Srpaulo	{ 0, 0 }
3001251538Srpaulo};
3002251538Srpaulo
3003251538Srpaulostatic driver_t urtwn_driver = {
3004251538Srpaulo	"urtwn",
3005251538Srpaulo	urtwn_methods,
3006251538Srpaulo	sizeof(struct urtwn_softc)
3007251538Srpaulo};
3008251538Srpaulo
3009251538Srpaulostatic devclass_t urtwn_devclass;
3010251538Srpaulo
3011251538SrpauloDRIVER_MODULE(urtwn, uhub, urtwn_driver, urtwn_devclass, NULL, NULL);
3012251538SrpauloMODULE_DEPEND(urtwn, usb, 1, 1, 1);
3013251538SrpauloMODULE_DEPEND(urtwn, wlan, 1, 1, 1);
3014251538SrpauloMODULE_DEPEND(urtwn, firmware, 1, 1, 1);
3015251538SrpauloMODULE_DEPEND(urtwn, urtwn_fw, 1, 1, 1);
3016251538SrpauloMODULE_VERSION(urtwn, 1);
3017