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