if_urtwn.c revision 298175
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>
5264912Skevlo * Copyright (c) 2014 Kevin Lo <kevlo@FreeBSD.org>
6292176Savos * Copyright (c) 2015 Andriy Voskoboinyk <avos@FreeBSD.org>
7251538Srpaulo *
8251538Srpaulo * Permission to use, copy, modify, and distribute this software for any
9251538Srpaulo * purpose with or without fee is hereby granted, provided that the above
10251538Srpaulo * copyright notice and this permission notice appear in all copies.
11251538Srpaulo *
12251538Srpaulo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
13251538Srpaulo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
14251538Srpaulo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
15251538Srpaulo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
16251538Srpaulo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17251538Srpaulo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
18251538Srpaulo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19251538Srpaulo */
20251538Srpaulo
21251538Srpaulo#include <sys/cdefs.h>
22251538Srpaulo__FBSDID("$FreeBSD: head/sys/dev/urtwn/if_urtwn.c 298175 2016-04-18 00:28:25Z adrian $");
23251538Srpaulo
24251538Srpaulo/*
25264912Skevlo * Driver for Realtek RTL8188CE-VAU/RTL8188CUS/RTL8188EU/RTL8188RU/RTL8192CU.
26251538Srpaulo */
27251538Srpaulo
28288353Sadrian#include "opt_wlan.h"
29295871Savos#include "opt_urtwn.h"
30288353Sadrian
31251538Srpaulo#include <sys/param.h>
32251538Srpaulo#include <sys/sockio.h>
33251538Srpaulo#include <sys/sysctl.h>
34251538Srpaulo#include <sys/lock.h>
35251538Srpaulo#include <sys/mutex.h>
36291902Skevlo#include <sys/condvar.h>
37251538Srpaulo#include <sys/mbuf.h>
38251538Srpaulo#include <sys/kernel.h>
39251538Srpaulo#include <sys/socket.h>
40251538Srpaulo#include <sys/systm.h>
41251538Srpaulo#include <sys/malloc.h>
42251538Srpaulo#include <sys/module.h>
43251538Srpaulo#include <sys/bus.h>
44251538Srpaulo#include <sys/endian.h>
45251538Srpaulo#include <sys/linker.h>
46251538Srpaulo#include <sys/firmware.h>
47251538Srpaulo#include <sys/kdb.h>
48251538Srpaulo
49251538Srpaulo#include <machine/bus.h>
50251538Srpaulo#include <machine/resource.h>
51251538Srpaulo#include <sys/rman.h>
52251538Srpaulo
53251538Srpaulo#include <net/bpf.h>
54251538Srpaulo#include <net/if.h>
55257176Sglebius#include <net/if_var.h>
56251538Srpaulo#include <net/if_arp.h>
57251538Srpaulo#include <net/ethernet.h>
58251538Srpaulo#include <net/if_dl.h>
59251538Srpaulo#include <net/if_media.h>
60251538Srpaulo#include <net/if_types.h>
61251538Srpaulo
62251538Srpaulo#include <netinet/in.h>
63251538Srpaulo#include <netinet/in_systm.h>
64251538Srpaulo#include <netinet/in_var.h>
65251538Srpaulo#include <netinet/if_ether.h>
66251538Srpaulo#include <netinet/ip.h>
67251538Srpaulo
68251538Srpaulo#include <net80211/ieee80211_var.h>
69288088Sadrian#include <net80211/ieee80211_input.h>
70251538Srpaulo#include <net80211/ieee80211_regdomain.h>
71251538Srpaulo#include <net80211/ieee80211_radiotap.h>
72251538Srpaulo#include <net80211/ieee80211_ratectl.h>
73297596Sadrian#ifdef	IEEE80211_SUPPORT_SUPERG
74297596Sadrian#include <net80211/ieee80211_superg.h>
75297596Sadrian#endif
76251538Srpaulo
77251538Srpaulo#include <dev/usb/usb.h>
78251538Srpaulo#include <dev/usb/usbdi.h>
79291902Skevlo#include <dev/usb/usb_device.h>
80251538Srpaulo#include "usbdevs.h"
81251538Srpaulo
82251538Srpaulo#include <dev/usb/usb_debug.h>
83251538Srpaulo
84297058Sadrian#include <dev/urtwn/if_urtwnreg.h>
85297058Sadrian#include <dev/urtwn/if_urtwnvar.h>
86251538Srpaulo
87251538Srpaulo#ifdef USB_DEBUG
88294471Savosenum {
89294471Savos	URTWN_DEBUG_XMIT	= 0x00000001,	/* basic xmit operation */
90294471Savos	URTWN_DEBUG_RECV	= 0x00000002,	/* basic recv operation */
91294471Savos	URTWN_DEBUG_STATE	= 0x00000004,	/* 802.11 state transitions */
92294471Savos	URTWN_DEBUG_RA		= 0x00000008,	/* f/w rate adaptation setup */
93294471Savos	URTWN_DEBUG_USB		= 0x00000010,	/* usb requests */
94294471Savos	URTWN_DEBUG_FIRMWARE	= 0x00000020,	/* firmware(9) loading debug */
95294471Savos	URTWN_DEBUG_BEACON	= 0x00000040,	/* beacon handling */
96294471Savos	URTWN_DEBUG_INTR	= 0x00000080,	/* ISR */
97294471Savos	URTWN_DEBUG_TEMP	= 0x00000100,	/* temperature calibration */
98294471Savos	URTWN_DEBUG_ROM		= 0x00000200,	/* various ROM info */
99294471Savos	URTWN_DEBUG_KEY		= 0x00000400,	/* crypto keys management */
100294471Savos	URTWN_DEBUG_TXPWR	= 0x00000800,	/* dump Tx power values */
101297175Sadrian	URTWN_DEBUG_RSSI	= 0x00001000,	/* dump RSSI lookups */
102294471Savos	URTWN_DEBUG_ANY		= 0xffffffff
103294471Savos};
104251538Srpaulo
105294471Savos#define URTWN_DPRINTF(_sc, _m, ...) do {			\
106294471Savos	if ((_sc)->sc_debug & (_m))				\
107294471Savos		device_printf((_sc)->sc_dev, __VA_ARGS__);	\
108294471Savos} while(0)
109294471Savos
110294471Savos#else
111294471Savos#define URTWN_DPRINTF(_sc, _m, ...)	do { (void) sc; } while (0)
112251538Srpaulo#endif
113251538Srpaulo
114288088Sadrian#define	IEEE80211_HAS_ADDR4(wh)	IEEE80211_IS_DSTODS(wh)
115251538Srpaulo
116297175Sadrianstatic int urtwn_enable_11n = 1;
117297175SadrianTUNABLE_INT("hw.usb.urtwn.enable_11n", &urtwn_enable_11n);
118297175Sadrian
119251538Srpaulo/* various supported device vendors/products */
120251596Srpaulostatic const STRUCT_USB_HOST_ID urtwn_devs[] = {
121251538Srpaulo#define URTWN_DEV(v,p)  { USB_VP(USB_VENDOR_##v, USB_PRODUCT_##v##_##p) }
122264912Skevlo#define	URTWN_RTL8188E_DEV(v,p)	\
123264912Skevlo	{ USB_VPI(USB_VENDOR_##v, USB_PRODUCT_##v##_##p, URTWN_RTL8188E) }
124264912Skevlo#define URTWN_RTL8188E  1
125251538Srpaulo	URTWN_DEV(ABOCOM,	RTL8188CU_1),
126251538Srpaulo	URTWN_DEV(ABOCOM,	RTL8188CU_2),
127251538Srpaulo	URTWN_DEV(ABOCOM,	RTL8192CU),
128251538Srpaulo	URTWN_DEV(ASUS,		RTL8192CU),
129266721Skevlo	URTWN_DEV(ASUS,		USBN10NANO),
130251538Srpaulo	URTWN_DEV(AZUREWAVE,	RTL8188CE_1),
131251538Srpaulo	URTWN_DEV(AZUREWAVE,	RTL8188CE_2),
132251538Srpaulo	URTWN_DEV(AZUREWAVE,	RTL8188CU),
133251538Srpaulo	URTWN_DEV(BELKIN,	F7D2102),
134251538Srpaulo	URTWN_DEV(BELKIN,	RTL8188CU),
135251538Srpaulo	URTWN_DEV(BELKIN,	RTL8192CU),
136251538Srpaulo	URTWN_DEV(CHICONY,	RTL8188CUS_1),
137251538Srpaulo	URTWN_DEV(CHICONY,	RTL8188CUS_2),
138251538Srpaulo	URTWN_DEV(CHICONY,	RTL8188CUS_3),
139251538Srpaulo	URTWN_DEV(CHICONY,	RTL8188CUS_4),
140251538Srpaulo	URTWN_DEV(CHICONY,	RTL8188CUS_5),
141251538Srpaulo	URTWN_DEV(COREGA,	RTL8192CU),
142251538Srpaulo	URTWN_DEV(DLINK,	RTL8188CU),
143251538Srpaulo	URTWN_DEV(DLINK,	RTL8192CU_1),
144251538Srpaulo	URTWN_DEV(DLINK,	RTL8192CU_2),
145251538Srpaulo	URTWN_DEV(DLINK,	RTL8192CU_3),
146252196Skevlo	URTWN_DEV(DLINK,	DWA131B),
147251538Srpaulo	URTWN_DEV(EDIMAX,	EW7811UN),
148251538Srpaulo	URTWN_DEV(EDIMAX,	RTL8192CU),
149251538Srpaulo	URTWN_DEV(FEIXUN,	RTL8188CU),
150251538Srpaulo	URTWN_DEV(FEIXUN,	RTL8192CU),
151251538Srpaulo	URTWN_DEV(GUILLEMOT,	HWNUP150),
152251538Srpaulo	URTWN_DEV(HAWKING,	RTL8192CU),
153251538Srpaulo	URTWN_DEV(HP3,		RTL8188CU),
154251538Srpaulo	URTWN_DEV(NETGEAR,	WNA1000M),
155251538Srpaulo	URTWN_DEV(NETGEAR,	RTL8192CU),
156251538Srpaulo	URTWN_DEV(NETGEAR4,	RTL8188CU),
157251538Srpaulo	URTWN_DEV(NOVATECH,	RTL8188CU),
158251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8188CU_1),
159251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8188CU_2),
160251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8188CU_3),
161251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8188CU_4),
162251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8188CUS),
163251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8192CU),
164251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CE_0),
165251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CE_1),
166251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CTV),
167251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CU_0),
168251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CU_1),
169251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CU_2),
170282119Skevlo	URTWN_DEV(REALTEK,	RTL8188CU_3),
171251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CU_COMBO),
172251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CUS),
173251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188RU_1),
174251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188RU_2),
175272410Shselasky	URTWN_DEV(REALTEK,	RTL8188RU_3),
176251538Srpaulo	URTWN_DEV(REALTEK,	RTL8191CU),
177251538Srpaulo	URTWN_DEV(REALTEK,	RTL8192CE),
178251538Srpaulo	URTWN_DEV(REALTEK,	RTL8192CU),
179251538Srpaulo	URTWN_DEV(SITECOMEU,	RTL8188CU_1),
180251538Srpaulo	URTWN_DEV(SITECOMEU,	RTL8188CU_2),
181251538Srpaulo	URTWN_DEV(SITECOMEU,	RTL8192CU),
182251538Srpaulo	URTWN_DEV(TRENDNET,	RTL8188CU),
183251538Srpaulo	URTWN_DEV(TRENDNET,	RTL8192CU),
184251538Srpaulo	URTWN_DEV(ZYXEL,	RTL8192CU),
185264912Skevlo	/* URTWN_RTL8188E */
186295907Skevlo	URTWN_RTL8188E_DEV(ABOCOM,	RTL8188EU),
187273589Skevlo	URTWN_RTL8188E_DEV(DLINK,	DWA123D1),
188270191Skevlo	URTWN_RTL8188E_DEV(DLINK,	DWA125D1),
189273589Skevlo	URTWN_RTL8188E_DEV(ELECOM,	WDC150SU2M),
190264912Skevlo	URTWN_RTL8188E_DEV(REALTEK,	RTL8188ETV),
191264912Skevlo	URTWN_RTL8188E_DEV(REALTEK,	RTL8188EU),
192264912Skevlo#undef URTWN_RTL8188E_DEV
193251538Srpaulo#undef URTWN_DEV
194251538Srpaulo};
195251538Srpaulo
196251538Srpaulostatic device_probe_t	urtwn_match;
197251538Srpaulostatic device_attach_t	urtwn_attach;
198251538Srpaulostatic device_detach_t	urtwn_detach;
199251538Srpaulo
200251538Srpaulostatic usb_callback_t   urtwn_bulk_tx_callback;
201251538Srpaulostatic usb_callback_t	urtwn_bulk_rx_callback;
202251538Srpaulo
203294471Savosstatic void		urtwn_sysctlattach(struct urtwn_softc *);
204294471Savosstatic void		urtwn_drain_mbufq(struct urtwn_softc *);
205287197Sglebiusstatic usb_error_t	urtwn_do_request(struct urtwn_softc *,
206287197Sglebius			    struct usb_device_request *, void *);
207251538Srpaulostatic struct ieee80211vap *urtwn_vap_create(struct ieee80211com *,
208251538Srpaulo		    const char [IFNAMSIZ], int, enum ieee80211_opmode, int,
209251538Srpaulo                    const uint8_t [IEEE80211_ADDR_LEN],
210251538Srpaulo                    const uint8_t [IEEE80211_ADDR_LEN]);
211251538Srpaulostatic void		urtwn_vap_delete(struct ieee80211vap *);
212292207Savosstatic struct mbuf *	urtwn_rx_copy_to_mbuf(struct urtwn_softc *,
213292207Savos			    struct r92c_rx_stat *, int);
214292207Savosstatic struct mbuf *	urtwn_report_intr(struct usb_xfer *,
215292207Savos			    struct urtwn_data *);
216292207Savosstatic struct mbuf *	urtwn_rxeof(struct urtwn_softc *, uint8_t *, int);
217292167Savosstatic void		urtwn_r88e_ratectl_tx_complete(struct urtwn_softc *,
218292167Savos			    void *);
219292207Savosstatic struct ieee80211_node *urtwn_rx_frame(struct urtwn_softc *,
220292207Savos			    struct mbuf *, int8_t *);
221289891Savosstatic void		urtwn_txeof(struct urtwn_softc *, struct urtwn_data *,
222289891Savos			    int);
223281069Srpaulostatic int		urtwn_alloc_list(struct urtwn_softc *,
224251538Srpaulo			    struct urtwn_data[], int, int);
225251538Srpaulostatic int		urtwn_alloc_rx_list(struct urtwn_softc *);
226251538Srpaulostatic int		urtwn_alloc_tx_list(struct urtwn_softc *);
227251538Srpaulostatic void		urtwn_free_list(struct urtwn_softc *,
228251538Srpaulo			    struct urtwn_data data[], int);
229289066Skevlostatic void		urtwn_free_rx_list(struct urtwn_softc *);
230289066Skevlostatic void		urtwn_free_tx_list(struct urtwn_softc *);
231251538Srpaulostatic struct urtwn_data *	_urtwn_getbuf(struct urtwn_softc *);
232251538Srpaulostatic struct urtwn_data *	urtwn_getbuf(struct urtwn_softc *);
233291698Savosstatic usb_error_t	urtwn_write_region_1(struct urtwn_softc *, uint16_t,
234251538Srpaulo			    uint8_t *, int);
235291698Savosstatic usb_error_t	urtwn_write_1(struct urtwn_softc *, uint16_t, uint8_t);
236291698Savosstatic usb_error_t	urtwn_write_2(struct urtwn_softc *, uint16_t, uint16_t);
237291698Savosstatic usb_error_t	urtwn_write_4(struct urtwn_softc *, uint16_t, uint32_t);
238291698Savosstatic usb_error_t	urtwn_read_region_1(struct urtwn_softc *, uint16_t,
239251538Srpaulo			    uint8_t *, int);
240251538Srpaulostatic uint8_t		urtwn_read_1(struct urtwn_softc *, uint16_t);
241251538Srpaulostatic uint16_t		urtwn_read_2(struct urtwn_softc *, uint16_t);
242251538Srpaulostatic uint32_t		urtwn_read_4(struct urtwn_softc *, uint16_t);
243281069Srpaulostatic int		urtwn_fw_cmd(struct urtwn_softc *, uint8_t,
244251538Srpaulo			    const void *, int);
245292174Savosstatic void		urtwn_cmdq_cb(void *, int);
246292174Savosstatic int		urtwn_cmd_sleepable(struct urtwn_softc *, const void *,
247292174Savos			    size_t, CMD_FUNC_PROTO);
248264912Skevlostatic void		urtwn_r92c_rf_write(struct urtwn_softc *, int,
249264912Skevlo			    uint8_t, uint32_t);
250281069Srpaulostatic void		urtwn_r88e_rf_write(struct urtwn_softc *, int,
251264912Skevlo			    uint8_t, uint32_t);
252251538Srpaulostatic uint32_t		urtwn_rf_read(struct urtwn_softc *, int, uint8_t);
253281069Srpaulostatic int		urtwn_llt_write(struct urtwn_softc *, uint32_t,
254251538Srpaulo			    uint32_t);
255291264Savosstatic int		urtwn_efuse_read_next(struct urtwn_softc *, uint8_t *);
256291264Savosstatic int		urtwn_efuse_read_data(struct urtwn_softc *, uint8_t *,
257291264Savos			    uint8_t, uint8_t);
258294471Savos#ifdef USB_DEBUG
259291264Savosstatic void		urtwn_dump_rom_contents(struct urtwn_softc *,
260291264Savos			    uint8_t *, uint16_t);
261291264Savos#endif
262291264Savosstatic int		urtwn_efuse_read(struct urtwn_softc *, uint8_t *,
263291264Savos			    uint16_t);
264291698Savosstatic int		urtwn_efuse_switch_power(struct urtwn_softc *);
265251538Srpaulostatic int		urtwn_read_chipid(struct urtwn_softc *);
266291264Savosstatic int		urtwn_read_rom(struct urtwn_softc *);
267291264Savosstatic int		urtwn_r88e_read_rom(struct urtwn_softc *);
268251538Srpaulostatic int		urtwn_ra_init(struct urtwn_softc *);
269290631Savosstatic void		urtwn_init_beacon(struct urtwn_softc *,
270290631Savos			    struct urtwn_vap *);
271290631Savosstatic int		urtwn_setup_beacon(struct urtwn_softc *,
272290631Savos			    struct ieee80211_node *);
273290631Savosstatic void		urtwn_update_beacon(struct ieee80211vap *, int);
274290631Savosstatic int		urtwn_tx_beacon(struct urtwn_softc *sc,
275290631Savos			    struct urtwn_vap *);
276292175Savosstatic int		urtwn_key_alloc(struct ieee80211vap *,
277292175Savos			    struct ieee80211_key *, ieee80211_keyix *,
278292175Savos			    ieee80211_keyix *);
279292175Savosstatic void		urtwn_key_set_cb(struct urtwn_softc *,
280292175Savos			    union sec_param *);
281292175Savosstatic void		urtwn_key_del_cb(struct urtwn_softc *,
282292175Savos			    union sec_param *);
283292175Savosstatic int		urtwn_key_set(struct ieee80211vap *,
284292175Savos			    const struct ieee80211_key *);
285292175Savosstatic int		urtwn_key_delete(struct ieee80211vap *,
286292175Savos			    const struct ieee80211_key *);
287290651Savosstatic void		urtwn_tsf_task_adhoc(void *, int);
288290631Savosstatic void		urtwn_tsf_sync_enable(struct urtwn_softc *,
289290631Savos			    struct ieee80211vap *);
290292203Savosstatic void		urtwn_get_tsf(struct urtwn_softc *, uint64_t *);
291251538Srpaulostatic void		urtwn_set_led(struct urtwn_softc *, int, int);
292289811Savosstatic void		urtwn_set_mode(struct urtwn_softc *, uint8_t);
293290651Savosstatic void		urtwn_ibss_recv_mgmt(struct ieee80211_node *,
294290651Savos			    struct mbuf *, int,
295290651Savos			    const struct ieee80211_rx_stats *, int, int);
296281069Srpaulostatic int		urtwn_newstate(struct ieee80211vap *,
297251538Srpaulo			    enum ieee80211_state, int);
298294473Savosstatic void		urtwn_calib_to(void *);
299294473Savosstatic void		urtwn_calib_cb(struct urtwn_softc *,
300294473Savos			    union sec_param *);
301251538Srpaulostatic void		urtwn_watchdog(void *);
302251538Srpaulostatic void		urtwn_update_avgrssi(struct urtwn_softc *, int, int8_t);
303251538Srpaulostatic int8_t		urtwn_get_rssi(struct urtwn_softc *, int, void *);
304264912Skevlostatic int8_t		urtwn_r88e_get_rssi(struct urtwn_softc *, int, void *);
305290630Savosstatic int		urtwn_tx_data(struct urtwn_softc *,
306251538Srpaulo			    struct ieee80211_node *, struct mbuf *,
307251538Srpaulo			    struct urtwn_data *);
308292221Savosstatic int		urtwn_tx_raw(struct urtwn_softc *,
309292221Savos			    struct ieee80211_node *, struct mbuf *,
310292221Savos			    struct urtwn_data *,
311292221Savos			    const struct ieee80211_bpf_params *);
312290630Savosstatic void		urtwn_tx_start(struct urtwn_softc *, struct mbuf *,
313290630Savos			    uint8_t, struct urtwn_data *);
314287197Sglebiusstatic int		urtwn_transmit(struct ieee80211com *, struct mbuf *);
315287197Sglebiusstatic void		urtwn_start(struct urtwn_softc *);
316287197Sglebiusstatic void		urtwn_parent(struct ieee80211com *);
317264912Skevlostatic int		urtwn_r92c_power_on(struct urtwn_softc *);
318264912Skevlostatic int		urtwn_r88e_power_on(struct urtwn_softc *);
319295874Savosstatic void		urtwn_r92c_power_off(struct urtwn_softc *);
320295874Savosstatic void		urtwn_r88e_power_off(struct urtwn_softc *);
321251538Srpaulostatic int		urtwn_llt_init(struct urtwn_softc *);
322295871Savos#ifndef URTWN_WITHOUT_UCODE
323251538Srpaulostatic void		urtwn_fw_reset(struct urtwn_softc *);
324264912Skevlostatic void		urtwn_r88e_fw_reset(struct urtwn_softc *);
325281069Srpaulostatic int		urtwn_fw_loadpage(struct urtwn_softc *, int,
326251538Srpaulo			    const uint8_t *, int);
327251538Srpaulostatic int		urtwn_load_firmware(struct urtwn_softc *);
328295871Savos#endif
329291902Skevlostatic int		urtwn_dma_init(struct urtwn_softc *);
330291698Savosstatic int		urtwn_mac_init(struct urtwn_softc *);
331251538Srpaulostatic void		urtwn_bb_init(struct urtwn_softc *);
332251538Srpaulostatic void		urtwn_rf_init(struct urtwn_softc *);
333251538Srpaulostatic void		urtwn_cam_init(struct urtwn_softc *);
334292175Savosstatic int		urtwn_cam_write(struct urtwn_softc *, uint32_t,
335292175Savos			    uint32_t);
336251538Srpaulostatic void		urtwn_pa_bias_init(struct urtwn_softc *);
337251538Srpaulostatic void		urtwn_rxfilter_init(struct urtwn_softc *);
338251538Srpaulostatic void		urtwn_edca_init(struct urtwn_softc *);
339281069Srpaulostatic void		urtwn_write_txpower(struct urtwn_softc *, int,
340251538Srpaulo			    uint16_t[]);
341251538Srpaulostatic void		urtwn_get_txpower(struct urtwn_softc *, int,
342281069Srpaulo		      	    struct ieee80211_channel *,
343251538Srpaulo			    struct ieee80211_channel *, uint16_t[]);
344264912Skevlostatic void		urtwn_r88e_get_txpower(struct urtwn_softc *, int,
345281069Srpaulo		      	    struct ieee80211_channel *,
346264912Skevlo			    struct ieee80211_channel *, uint16_t[]);
347251538Srpaulostatic void		urtwn_set_txpower(struct urtwn_softc *,
348281069Srpaulo		    	    struct ieee80211_channel *,
349251538Srpaulo			    struct ieee80211_channel *);
350290048Savosstatic void		urtwn_set_rx_bssid_all(struct urtwn_softc *, int);
351290048Savosstatic void		urtwn_set_gain(struct urtwn_softc *, uint8_t);
352251538Srpaulostatic void		urtwn_scan_start(struct ieee80211com *);
353251538Srpaulostatic void		urtwn_scan_end(struct ieee80211com *);
354251538Srpaulostatic void		urtwn_set_channel(struct ieee80211com *);
355292014Savosstatic int		urtwn_wme_update(struct ieee80211com *);
356294465Savosstatic void		urtwn_update_slot(struct ieee80211com *);
357294465Savosstatic void		urtwn_update_slot_cb(struct urtwn_softc *,
358294465Savos			    union sec_param *);
359294465Savosstatic void		urtwn_update_aifs(struct urtwn_softc *, uint8_t);
360290564Savosstatic void		urtwn_set_promisc(struct urtwn_softc *);
361290564Savosstatic void		urtwn_update_promisc(struct ieee80211com *);
362289066Skevlostatic void		urtwn_update_mcast(struct ieee80211com *);
363297910Sadrianstatic struct ieee80211_node *urtwn_node_alloc(struct ieee80211vap *,
364292167Savos			    const uint8_t mac[IEEE80211_ADDR_LEN]);
365297910Sadrianstatic void		urtwn_newassoc(struct ieee80211_node *, int);
366297910Sadrianstatic void		urtwn_node_free(struct ieee80211_node *);
367251538Srpaulostatic void		urtwn_set_chan(struct urtwn_softc *,
368281069Srpaulo		    	    struct ieee80211_channel *,
369251538Srpaulo			    struct ieee80211_channel *);
370251538Srpaulostatic void		urtwn_iq_calib(struct urtwn_softc *);
371251538Srpaulostatic void		urtwn_lc_calib(struct urtwn_softc *);
372294473Savosstatic void		urtwn_temp_calib(struct urtwn_softc *);
373291698Savosstatic int		urtwn_init(struct urtwn_softc *);
374287197Sglebiusstatic void		urtwn_stop(struct urtwn_softc *);
375251538Srpaulostatic void		urtwn_abort_xfers(struct urtwn_softc *);
376251538Srpaulostatic int		urtwn_raw_xmit(struct ieee80211_node *, struct mbuf *,
377251538Srpaulo			    const struct ieee80211_bpf_params *);
378266472Shselaskystatic void		urtwn_ms_delay(struct urtwn_softc *);
379251538Srpaulo
380251538Srpaulo/* Aliases. */
381251538Srpaulo#define	urtwn_bb_write	urtwn_write_4
382251538Srpaulo#define urtwn_bb_read	urtwn_read_4
383251538Srpaulo
384251538Srpaulostatic const struct usb_config urtwn_config[URTWN_N_TRANSFER] = {
385251538Srpaulo	[URTWN_BULK_RX] = {
386251538Srpaulo		.type = UE_BULK,
387251538Srpaulo		.endpoint = UE_ADDR_ANY,
388251538Srpaulo		.direction = UE_DIR_IN,
389251538Srpaulo		.bufsize = URTWN_RXBUFSZ,
390251538Srpaulo		.flags = {
391251538Srpaulo			.pipe_bof = 1,
392251538Srpaulo			.short_xfer_ok = 1
393251538Srpaulo		},
394251538Srpaulo		.callback = urtwn_bulk_rx_callback,
395251538Srpaulo	},
396251538Srpaulo	[URTWN_BULK_TX_BE] = {
397251538Srpaulo		.type = UE_BULK,
398251538Srpaulo		.endpoint = 0x03,
399251538Srpaulo		.direction = UE_DIR_OUT,
400251538Srpaulo		.bufsize = URTWN_TXBUFSZ,
401251538Srpaulo		.flags = {
402251538Srpaulo			.ext_buffer = 1,
403251538Srpaulo			.pipe_bof = 1,
404251538Srpaulo			.force_short_xfer = 1
405251538Srpaulo		},
406251538Srpaulo		.callback = urtwn_bulk_tx_callback,
407251538Srpaulo		.timeout = URTWN_TX_TIMEOUT,	/* ms */
408251538Srpaulo	},
409251538Srpaulo	[URTWN_BULK_TX_BK] = {
410251538Srpaulo		.type = UE_BULK,
411251538Srpaulo		.endpoint = 0x03,
412251538Srpaulo		.direction = UE_DIR_OUT,
413251538Srpaulo		.bufsize = URTWN_TXBUFSZ,
414251538Srpaulo		.flags = {
415251538Srpaulo			.ext_buffer = 1,
416251538Srpaulo			.pipe_bof = 1,
417251538Srpaulo			.force_short_xfer = 1,
418251538Srpaulo		},
419251538Srpaulo		.callback = urtwn_bulk_tx_callback,
420251538Srpaulo		.timeout = URTWN_TX_TIMEOUT,	/* ms */
421251538Srpaulo	},
422251538Srpaulo	[URTWN_BULK_TX_VI] = {
423251538Srpaulo		.type = UE_BULK,
424251538Srpaulo		.endpoint = 0x02,
425251538Srpaulo		.direction = UE_DIR_OUT,
426251538Srpaulo		.bufsize = URTWN_TXBUFSZ,
427251538Srpaulo		.flags = {
428251538Srpaulo			.ext_buffer = 1,
429251538Srpaulo			.pipe_bof = 1,
430251538Srpaulo			.force_short_xfer = 1
431251538Srpaulo		},
432251538Srpaulo		.callback = urtwn_bulk_tx_callback,
433251538Srpaulo		.timeout = URTWN_TX_TIMEOUT,	/* ms */
434251538Srpaulo	},
435251538Srpaulo	[URTWN_BULK_TX_VO] = {
436251538Srpaulo		.type = UE_BULK,
437251538Srpaulo		.endpoint = 0x02,
438251538Srpaulo		.direction = UE_DIR_OUT,
439251538Srpaulo		.bufsize = URTWN_TXBUFSZ,
440251538Srpaulo		.flags = {
441251538Srpaulo			.ext_buffer = 1,
442251538Srpaulo			.pipe_bof = 1,
443251538Srpaulo			.force_short_xfer = 1
444251538Srpaulo		},
445251538Srpaulo		.callback = urtwn_bulk_tx_callback,
446251538Srpaulo		.timeout = URTWN_TX_TIMEOUT,	/* ms */
447251538Srpaulo	},
448251538Srpaulo};
449251538Srpaulo
450292014Savosstatic const struct wme_to_queue {
451292014Savos	uint16_t reg;
452292014Savos	uint8_t qid;
453292014Savos} wme2queue[WME_NUM_AC] = {
454292014Savos	{ R92C_EDCA_BE_PARAM, URTWN_BULK_TX_BE},
455292014Savos	{ R92C_EDCA_BK_PARAM, URTWN_BULK_TX_BK},
456292014Savos	{ R92C_EDCA_VI_PARAM, URTWN_BULK_TX_VI},
457292014Savos	{ R92C_EDCA_VO_PARAM, URTWN_BULK_TX_VO}
458292014Savos};
459292014Savos
460251538Srpaulostatic int
461251538Srpaulourtwn_match(device_t self)
462251538Srpaulo{
463251538Srpaulo	struct usb_attach_arg *uaa = device_get_ivars(self);
464251538Srpaulo
465251538Srpaulo	if (uaa->usb_mode != USB_MODE_HOST)
466251538Srpaulo		return (ENXIO);
467251538Srpaulo	if (uaa->info.bConfigIndex != URTWN_CONFIG_INDEX)
468251538Srpaulo		return (ENXIO);
469251538Srpaulo	if (uaa->info.bIfaceIndex != URTWN_IFACE_INDEX)
470251538Srpaulo		return (ENXIO);
471251538Srpaulo
472251538Srpaulo	return (usbd_lookup_id_by_uaa(urtwn_devs, sizeof(urtwn_devs), uaa));
473251538Srpaulo}
474251538Srpaulo
475297175Sadrianstatic void
476297175Sadrianurtwn_update_chw(struct ieee80211com *ic)
477297175Sadrian{
478297175Sadrian}
479297175Sadrian
480251538Srpaulostatic int
481297175Sadrianurtwn_ampdu_enable(struct ieee80211_node *ni, struct ieee80211_tx_ampdu *tap)
482297175Sadrian{
483297175Sadrian
484297175Sadrian	/* We're driving this ourselves (eventually); don't involve net80211 */
485297175Sadrian	return (0);
486297175Sadrian}
487297175Sadrian
488297175Sadrianstatic int
489251538Srpaulourtwn_attach(device_t self)
490251538Srpaulo{
491251538Srpaulo	struct usb_attach_arg *uaa = device_get_ivars(self);
492251538Srpaulo	struct urtwn_softc *sc = device_get_softc(self);
493287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
494293339Savos	uint8_t bands[howmany(IEEE80211_MODE_MAX, 8)];
495251538Srpaulo	int error;
496251538Srpaulo
497251538Srpaulo	device_set_usb_desc(self);
498251538Srpaulo	sc->sc_udev = uaa->device;
499251538Srpaulo	sc->sc_dev = self;
500264912Skevlo	if (USB_GET_DRIVER_INFO(uaa) == URTWN_RTL8188E)
501264912Skevlo		sc->chip |= URTWN_CHIP_88E;
502251538Srpaulo
503294471Savos#ifdef USB_DEBUG
504294471Savos	int debug;
505294471Savos	if (resource_int_value(device_get_name(sc->sc_dev),
506294471Savos	    device_get_unit(sc->sc_dev), "debug", &debug) == 0)
507294471Savos		sc->sc_debug = debug;
508294471Savos#endif
509294471Savos
510251538Srpaulo	mtx_init(&sc->sc_mtx, device_get_nameunit(self),
511251538Srpaulo	    MTX_NETWORK_LOCK, MTX_DEF);
512292174Savos	URTWN_CMDQ_LOCK_INIT(sc);
513292167Savos	URTWN_NT_LOCK_INIT(sc);
514294473Savos	callout_init(&sc->sc_calib_to, 0);
515251538Srpaulo	callout_init(&sc->sc_watchdog_ch, 0);
516287197Sglebius	mbufq_init(&sc->sc_snd, ifqmaxlen);
517251538Srpaulo
518291902Skevlo	sc->sc_iface_index = URTWN_IFACE_INDEX;
519291902Skevlo	error = usbd_transfer_setup(uaa->device, &sc->sc_iface_index,
520291902Skevlo	    sc->sc_xfer, urtwn_config, URTWN_N_TRANSFER, sc, &sc->sc_mtx);
521251538Srpaulo	if (error) {
522251538Srpaulo		device_printf(self, "could not allocate USB transfers, "
523251538Srpaulo		    "err=%s\n", usbd_errstr(error));
524251538Srpaulo		goto detach;
525251538Srpaulo	}
526251538Srpaulo
527251538Srpaulo	URTWN_LOCK(sc);
528251538Srpaulo
529251538Srpaulo	error = urtwn_read_chipid(sc);
530251538Srpaulo	if (error) {
531251538Srpaulo		device_printf(sc->sc_dev, "unsupported test chip\n");
532251538Srpaulo		URTWN_UNLOCK(sc);
533251538Srpaulo		goto detach;
534251538Srpaulo	}
535251538Srpaulo
536251538Srpaulo	/* Determine number of Tx/Rx chains. */
537251538Srpaulo	if (sc->chip & URTWN_CHIP_92C) {
538251538Srpaulo		sc->ntxchains = (sc->chip & URTWN_CHIP_92C_1T2R) ? 1 : 2;
539251538Srpaulo		sc->nrxchains = 2;
540251538Srpaulo	} else {
541251538Srpaulo		sc->ntxchains = 1;
542251538Srpaulo		sc->nrxchains = 1;
543251538Srpaulo	}
544251538Srpaulo
545264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
546291264Savos		error = urtwn_r88e_read_rom(sc);
547264912Skevlo	else
548291264Savos		error = urtwn_read_rom(sc);
549291264Savos	if (error != 0) {
550291264Savos		device_printf(sc->sc_dev, "%s: cannot read rom, error %d\n",
551291264Savos		    __func__, error);
552291264Savos		URTWN_UNLOCK(sc);
553291264Savos		goto detach;
554291264Savos	}
555264912Skevlo
556251538Srpaulo	device_printf(sc->sc_dev, "MAC/BB RTL%s, RF 6052 %dT%dR\n",
557251538Srpaulo	    (sc->chip & URTWN_CHIP_92C) ? "8192CU" :
558264912Skevlo	    (sc->chip & URTWN_CHIP_88E) ? "8188EU" :
559251538Srpaulo	    (sc->board_type == R92C_BOARD_TYPE_HIGHPA) ? "8188RU" :
560251538Srpaulo	    (sc->board_type == R92C_BOARD_TYPE_MINICARD) ? "8188CE-VAU" :
561251538Srpaulo	    "8188CUS", sc->ntxchains, sc->nrxchains);
562251538Srpaulo
563251538Srpaulo	URTWN_UNLOCK(sc);
564251538Srpaulo
565283537Sglebius	ic->ic_softc = sc;
566283527Sglebius	ic->ic_name = device_get_nameunit(self);
567251538Srpaulo	ic->ic_phytype = IEEE80211_T_OFDM;	/* not only, but not used */
568251538Srpaulo	ic->ic_opmode = IEEE80211_M_STA;	/* default to BSS mode */
569251538Srpaulo
570251538Srpaulo	/* set device capabilities */
571251538Srpaulo	ic->ic_caps =
572251538Srpaulo		  IEEE80211_C_STA		/* station mode */
573251538Srpaulo		| IEEE80211_C_MONITOR		/* monitor mode */
574290651Savos		| IEEE80211_C_IBSS		/* adhoc mode */
575290631Savos		| IEEE80211_C_HOSTAP		/* hostap mode */
576251538Srpaulo		| IEEE80211_C_SHPREAMBLE	/* short preamble supported */
577251538Srpaulo		| IEEE80211_C_SHSLOT		/* short slot time supported */
578297175Sadrian#if 0
579251538Srpaulo		| IEEE80211_C_BGSCAN		/* capable of bg scanning */
580297175Sadrian#endif
581251538Srpaulo		| IEEE80211_C_WPA		/* 802.11i */
582292014Savos		| IEEE80211_C_WME		/* 802.11e */
583297596Sadrian		| IEEE80211_C_SWAMSDUTX		/* Do software A-MSDU TX */
584297596Sadrian		| IEEE80211_C_FF		/* Atheros fast-frames */
585251538Srpaulo		;
586251538Srpaulo
587292175Savos	ic->ic_cryptocaps =
588292175Savos	    IEEE80211_CRYPTO_WEP |
589292175Savos	    IEEE80211_CRYPTO_TKIP |
590292175Savos	    IEEE80211_CRYPTO_AES_CCM;
591292175Savos
592297175Sadrian	/* Assume they're all 11n capable for now */
593297175Sadrian	if (urtwn_enable_11n) {
594297175Sadrian		device_printf(self, "enabling 11n\n");
595297175Sadrian		ic->ic_htcaps = IEEE80211_HTC_HT |
596297601Sadrian#if 0
597297175Sadrian		    IEEE80211_HTC_AMPDU |
598297601Sadrian#endif
599297175Sadrian		    IEEE80211_HTC_AMSDU |
600297175Sadrian		    IEEE80211_HTCAP_MAXAMSDU_3839 |
601297175Sadrian		    IEEE80211_HTCAP_SMPS_OFF;
602297175Sadrian		/* no HT40 just yet */
603297175Sadrian		// ic->ic_htcaps |= IEEE80211_HTCAP_CHWIDTH40;
604297175Sadrian
605297175Sadrian		/* XXX TODO: verify chains versus streams for urtwn */
606297175Sadrian		ic->ic_txstream = sc->ntxchains;
607297175Sadrian		ic->ic_rxstream = sc->nrxchains;
608297175Sadrian	}
609297175Sadrian
610293339Savos	memset(bands, 0, sizeof(bands));
611293339Savos	setbit(bands, IEEE80211_MODE_11B);
612293339Savos	setbit(bands, IEEE80211_MODE_11G);
613297175Sadrian	if (urtwn_enable_11n)
614297175Sadrian		setbit(bands, IEEE80211_MODE_11NG);
615293339Savos	ieee80211_init_channels(ic, NULL, bands);
616251538Srpaulo
617287197Sglebius	ieee80211_ifattach(ic);
618251538Srpaulo	ic->ic_raw_xmit = urtwn_raw_xmit;
619251538Srpaulo	ic->ic_scan_start = urtwn_scan_start;
620251538Srpaulo	ic->ic_scan_end = urtwn_scan_end;
621251538Srpaulo	ic->ic_set_channel = urtwn_set_channel;
622287197Sglebius	ic->ic_transmit = urtwn_transmit;
623287197Sglebius	ic->ic_parent = urtwn_parent;
624251538Srpaulo	ic->ic_vap_create = urtwn_vap_create;
625251538Srpaulo	ic->ic_vap_delete = urtwn_vap_delete;
626292014Savos	ic->ic_wme.wme_update = urtwn_wme_update;
627294465Savos	ic->ic_updateslot = urtwn_update_slot;
628290564Savos	ic->ic_update_promisc = urtwn_update_promisc;
629251538Srpaulo	ic->ic_update_mcast = urtwn_update_mcast;
630292167Savos	if (sc->chip & URTWN_CHIP_88E) {
631297910Sadrian		ic->ic_node_alloc = urtwn_node_alloc;
632297910Sadrian		ic->ic_newassoc = urtwn_newassoc;
633292167Savos		sc->sc_node_free = ic->ic_node_free;
634297910Sadrian		ic->ic_node_free = urtwn_node_free;
635292167Savos	}
636297175Sadrian	ic->ic_update_chw = urtwn_update_chw;
637297175Sadrian	ic->ic_ampdu_enable = urtwn_ampdu_enable;
638251538Srpaulo
639281069Srpaulo	ieee80211_radiotap_attach(ic, &sc->sc_txtap.wt_ihdr,
640251538Srpaulo	    sizeof(sc->sc_txtap), URTWN_TX_RADIOTAP_PRESENT,
641251538Srpaulo	    &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap),
642251538Srpaulo	    URTWN_RX_RADIOTAP_PRESENT);
643251538Srpaulo
644292174Savos	TASK_INIT(&sc->cmdq_task, 0, urtwn_cmdq_cb, sc);
645292174Savos
646294471Savos	urtwn_sysctlattach(sc);
647294471Savos
648251538Srpaulo	if (bootverbose)
649251538Srpaulo		ieee80211_announce(ic);
650251538Srpaulo
651251538Srpaulo	return (0);
652251538Srpaulo
653251538Srpaulodetach:
654251538Srpaulo	urtwn_detach(self);
655251538Srpaulo	return (ENXIO);			/* failure */
656251538Srpaulo}
657251538Srpaulo
658294471Savosstatic void
659294471Savosurtwn_sysctlattach(struct urtwn_softc *sc)
660294471Savos{
661294471Savos#ifdef USB_DEBUG
662294471Savos	struct sysctl_ctx_list *ctx = device_get_sysctl_ctx(sc->sc_dev);
663294471Savos	struct sysctl_oid *tree = device_get_sysctl_tree(sc->sc_dev);
664294471Savos
665294471Savos	SYSCTL_ADD_U32(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
666294471Savos	    "debug", CTLFLAG_RW, &sc->sc_debug, sc->sc_debug,
667294471Savos	    "control debugging printfs");
668294471Savos#endif
669294471Savos}
670294471Savos
671251538Srpaulostatic int
672251538Srpaulourtwn_detach(device_t self)
673251538Srpaulo{
674251538Srpaulo	struct urtwn_softc *sc = device_get_softc(self);
675287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
676263153Skevlo	unsigned int x;
677281069Srpaulo
678263153Skevlo	/* Prevent further ioctls. */
679263153Skevlo	URTWN_LOCK(sc);
680263153Skevlo	sc->sc_flags |= URTWN_DETACHED;
681263153Skevlo	URTWN_UNLOCK(sc);
682251538Srpaulo
683291698Savos	urtwn_stop(sc);
684291698Savos
685251538Srpaulo	callout_drain(&sc->sc_watchdog_ch);
686294473Savos	callout_drain(&sc->sc_calib_to);
687251538Srpaulo
688288353Sadrian	/* stop all USB transfers */
689288353Sadrian	usbd_transfer_unsetup(sc->sc_xfer, URTWN_N_TRANSFER);
690288353Sadrian
691263153Skevlo	/* Prevent further allocations from RX/TX data lists. */
692263153Skevlo	URTWN_LOCK(sc);
693263153Skevlo	STAILQ_INIT(&sc->sc_tx_active);
694263153Skevlo	STAILQ_INIT(&sc->sc_tx_inactive);
695263153Skevlo	STAILQ_INIT(&sc->sc_tx_pending);
696263153Skevlo
697263153Skevlo	STAILQ_INIT(&sc->sc_rx_active);
698263153Skevlo	STAILQ_INIT(&sc->sc_rx_inactive);
699263153Skevlo	URTWN_UNLOCK(sc);
700263153Skevlo
701263153Skevlo	/* drain USB transfers */
702263153Skevlo	for (x = 0; x != URTWN_N_TRANSFER; x++)
703263153Skevlo		usbd_transfer_drain(sc->sc_xfer[x]);
704263153Skevlo
705263153Skevlo	/* Free data buffers. */
706263153Skevlo	URTWN_LOCK(sc);
707263153Skevlo	urtwn_free_tx_list(sc);
708263153Skevlo	urtwn_free_rx_list(sc);
709263153Skevlo	URTWN_UNLOCK(sc);
710263153Skevlo
711292174Savos	if (ic->ic_softc == sc) {
712292174Savos		ieee80211_draintask(ic, &sc->cmdq_task);
713292174Savos		ieee80211_ifdetach(ic);
714292174Savos	}
715292174Savos
716292167Savos	URTWN_NT_LOCK_DESTROY(sc);
717292174Savos	URTWN_CMDQ_LOCK_DESTROY(sc);
718251538Srpaulo	mtx_destroy(&sc->sc_mtx);
719251538Srpaulo
720251538Srpaulo	return (0);
721251538Srpaulo}
722251538Srpaulo
723251538Srpaulostatic void
724289066Skevlourtwn_drain_mbufq(struct urtwn_softc *sc)
725251538Srpaulo{
726289066Skevlo	struct mbuf *m;
727289066Skevlo	struct ieee80211_node *ni;
728289066Skevlo	URTWN_ASSERT_LOCKED(sc);
729289066Skevlo	while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) {
730289066Skevlo		ni = (struct ieee80211_node *)m->m_pkthdr.rcvif;
731289066Skevlo		m->m_pkthdr.rcvif = NULL;
732289066Skevlo		ieee80211_free_node(ni);
733289066Skevlo		m_freem(m);
734251538Srpaulo	}
735251538Srpaulo}
736251538Srpaulo
737251538Srpaulostatic usb_error_t
738251538Srpaulourtwn_do_request(struct urtwn_softc *sc, struct usb_device_request *req,
739251538Srpaulo    void *data)
740251538Srpaulo{
741251538Srpaulo	usb_error_t err;
742251538Srpaulo	int ntries = 10;
743251538Srpaulo
744251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
745251538Srpaulo
746251538Srpaulo	while (ntries--) {
747251538Srpaulo		err = usbd_do_request_flags(sc->sc_udev, &sc->sc_mtx,
748251538Srpaulo		    req, data, 0, NULL, 250 /* ms */);
749251538Srpaulo		if (err == 0)
750251538Srpaulo			break;
751251538Srpaulo
752294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_USB,
753294471Savos		    "%s: control request failed, %s (retries left: %d)\n",
754294471Savos		    __func__, usbd_errstr(err), ntries);
755251538Srpaulo		usb_pause_mtx(&sc->sc_mtx, hz / 100);
756251538Srpaulo	}
757251538Srpaulo	return (err);
758251538Srpaulo}
759251538Srpaulo
760251538Srpaulostatic struct ieee80211vap *
761251538Srpaulourtwn_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit,
762251538Srpaulo    enum ieee80211_opmode opmode, int flags,
763251538Srpaulo    const uint8_t bssid[IEEE80211_ADDR_LEN],
764251538Srpaulo    const uint8_t mac[IEEE80211_ADDR_LEN])
765251538Srpaulo{
766290631Savos	struct urtwn_softc *sc = ic->ic_softc;
767251538Srpaulo	struct urtwn_vap *uvp;
768251538Srpaulo	struct ieee80211vap *vap;
769251538Srpaulo
770251538Srpaulo	if (!TAILQ_EMPTY(&ic->ic_vaps))		/* only one at a time */
771251538Srpaulo		return (NULL);
772251538Srpaulo
773287197Sglebius	uvp = malloc(sizeof(struct urtwn_vap), M_80211_VAP, M_WAITOK | M_ZERO);
774251538Srpaulo	vap = &uvp->vap;
775251538Srpaulo	/* enable s/w bmiss handling for sta mode */
776251538Srpaulo
777281069Srpaulo	if (ieee80211_vap_setup(ic, vap, name, unit, opmode,
778287197Sglebius	    flags | IEEE80211_CLONE_NOBEACONS, bssid) != 0) {
779257743Shselasky		/* out of memory */
780257743Shselasky		free(uvp, M_80211_VAP);
781257743Shselasky		return (NULL);
782257743Shselasky	}
783257743Shselasky
784290651Savos	if (opmode == IEEE80211_M_HOSTAP || opmode == IEEE80211_M_IBSS)
785290631Savos		urtwn_init_beacon(sc, uvp);
786290631Savos
787251538Srpaulo	/* override state transition machine */
788251538Srpaulo	uvp->newstate = vap->iv_newstate;
789251538Srpaulo	vap->iv_newstate = urtwn_newstate;
790290631Savos	vap->iv_update_beacon = urtwn_update_beacon;
791292175Savos	vap->iv_key_alloc = urtwn_key_alloc;
792292175Savos	vap->iv_key_set = urtwn_key_set;
793292175Savos	vap->iv_key_delete = urtwn_key_delete;
794298138Sadrian
795298138Sadrian	/* 802.11n parameters */
796298138Sadrian	vap->iv_ampdu_density = IEEE80211_HTCAP_MPDUDENSITY_16;
797298175Sadrian	vap->iv_ampdu_rxmax = IEEE80211_HTCAP_MAXRXAMPDU_64K;
798298138Sadrian
799290651Savos	if (opmode == IEEE80211_M_IBSS) {
800290651Savos		uvp->recv_mgmt = vap->iv_recv_mgmt;
801290651Savos		vap->iv_recv_mgmt = urtwn_ibss_recv_mgmt;
802290651Savos		TASK_INIT(&uvp->tsf_task_adhoc, 0, urtwn_tsf_task_adhoc, vap);
803290651Savos	}
804251538Srpaulo
805292167Savos	if (URTWN_CHIP_HAS_RATECTL(sc))
806292167Savos		ieee80211_ratectl_init(vap);
807251538Srpaulo	/* complete setup */
808251538Srpaulo	ieee80211_vap_attach(vap, ieee80211_media_change,
809287197Sglebius	    ieee80211_media_status, mac);
810251538Srpaulo	ic->ic_opmode = opmode;
811251538Srpaulo	return (vap);
812251538Srpaulo}
813251538Srpaulo
814251538Srpaulostatic void
815251538Srpaulourtwn_vap_delete(struct ieee80211vap *vap)
816251538Srpaulo{
817290651Savos	struct ieee80211com *ic = vap->iv_ic;
818292167Savos	struct urtwn_softc *sc = ic->ic_softc;
819251538Srpaulo	struct urtwn_vap *uvp = URTWN_VAP(vap);
820251538Srpaulo
821290651Savos	if (uvp->bcn_mbuf != NULL)
822290651Savos		m_freem(uvp->bcn_mbuf);
823290651Savos	if (vap->iv_opmode == IEEE80211_M_IBSS)
824290651Savos		ieee80211_draintask(ic, &uvp->tsf_task_adhoc);
825292167Savos	if (URTWN_CHIP_HAS_RATECTL(sc))
826292167Savos		ieee80211_ratectl_deinit(vap);
827251538Srpaulo	ieee80211_vap_detach(vap);
828251538Srpaulo	free(uvp, M_80211_VAP);
829251538Srpaulo}
830251538Srpaulo
831251538Srpaulostatic struct mbuf *
832292207Savosurtwn_rx_copy_to_mbuf(struct urtwn_softc *sc, struct r92c_rx_stat *stat,
833292207Savos    int totlen)
834251538Srpaulo{
835287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
836251538Srpaulo	struct mbuf *m;
837292207Savos	uint32_t rxdw0;
838292207Savos	int pktlen;
839251538Srpaulo
840251538Srpaulo	/*
841251538Srpaulo	 * don't pass packets to the ieee80211 framework if the driver isn't
842251538Srpaulo	 * RUNNING.
843251538Srpaulo	 */
844287197Sglebius	if (!(sc->sc_flags & URTWN_RUNNING))
845251538Srpaulo		return (NULL);
846251538Srpaulo
847251538Srpaulo	rxdw0 = le32toh(stat->rxdw0);
848251538Srpaulo	if (rxdw0 & (R92C_RXDW0_CRCERR | R92C_RXDW0_ICVERR)) {
849251538Srpaulo		/*
850251538Srpaulo		 * This should not happen since we setup our Rx filter
851251538Srpaulo		 * to not receive these frames.
852251538Srpaulo		 */
853294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_RECV,
854294471Savos		    "%s: RX flags error (%s)\n", __func__,
855292207Savos		    rxdw0 & R92C_RXDW0_CRCERR ? "CRC" : "ICV");
856292207Savos		goto fail;
857251538Srpaulo	}
858292207Savos
859292207Savos	pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN);
860292207Savos	if (pktlen < sizeof(struct ieee80211_frame_ack)) {
861294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_RECV,
862294471Savos		    "%s: frame is too short: %d\n", __func__, pktlen);
863292207Savos		goto fail;
864271303Skevlo	}
865251538Srpaulo
866292207Savos	if (__predict_false(totlen > MCLBYTES)) {
867292207Savos		/* convert to m_getjcl if this happens */
868292207Savos		device_printf(sc->sc_dev, "%s: frame too long: %d (%d)\n",
869292207Savos		    __func__, pktlen, totlen);
870292207Savos		goto fail;
871251538Srpaulo	}
872251538Srpaulo
873260463Skevlo	m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR);
874292207Savos	if (__predict_false(m == NULL)) {
875292207Savos		device_printf(sc->sc_dev, "%s: could not allocate RX mbuf\n",
876292207Savos		    __func__);
877292207Savos		goto fail;
878251538Srpaulo	}
879251538Srpaulo
880251538Srpaulo	/* Finalize mbuf. */
881292207Savos	memcpy(mtod(m, uint8_t *), (uint8_t *)stat, totlen);
882292207Savos	m->m_pkthdr.len = m->m_len = totlen;
883292207Savos
884251538Srpaulo	return (m);
885292207Savosfail:
886292207Savos	counter_u64_add(ic->ic_ierrors, 1);
887292207Savos	return (NULL);
888251538Srpaulo}
889251538Srpaulo
890251538Srpaulostatic struct mbuf *
891292207Savosurtwn_report_intr(struct usb_xfer *xfer, struct urtwn_data *data)
892251538Srpaulo{
893251538Srpaulo	struct urtwn_softc *sc = data->sc;
894287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
895251538Srpaulo	struct r92c_rx_stat *stat;
896251538Srpaulo	uint8_t *buf;
897292167Savos	int len;
898251538Srpaulo
899251538Srpaulo	usbd_xfer_status(xfer, &len, NULL, NULL, NULL);
900251538Srpaulo
901251538Srpaulo	if (len < sizeof(*stat)) {
902287197Sglebius		counter_u64_add(ic->ic_ierrors, 1);
903251538Srpaulo		return (NULL);
904251538Srpaulo	}
905251538Srpaulo
906251538Srpaulo	buf = data->buf;
907292167Savos	stat = (struct r92c_rx_stat *)buf;
908292167Savos
909297596Sadrian	/*
910297596Sadrian	 * For 88E chips we can tie the FF flushing here;
911297596Sadrian	 * this is where we do know exactly how deep the
912297596Sadrian	 * transmit queue is.
913297596Sadrian	 *
914297596Sadrian	 * But it won't work for R92 chips, so we can't
915297596Sadrian	 * take the easy way out.
916297596Sadrian	 */
917297596Sadrian
918292167Savos	if (sc->chip & URTWN_CHIP_88E) {
919292167Savos		int report_sel = MS(le32toh(stat->rxdw3), R88E_RXDW3_RPT);
920292167Savos
921292167Savos		switch (report_sel) {
922292167Savos		case R88E_RXDW3_RPT_RX:
923292207Savos			return (urtwn_rxeof(sc, buf, len));
924292167Savos		case R88E_RXDW3_RPT_TX1:
925292167Savos			urtwn_r88e_ratectl_tx_complete(sc, &stat[1]);
926292167Savos			break;
927292167Savos		default:
928294471Savos			URTWN_DPRINTF(sc, URTWN_DEBUG_INTR,
929294471Savos			    "%s: case %d was not handled\n", __func__,
930294471Savos			    report_sel);
931292167Savos			break;
932292167Savos		}
933292167Savos	} else
934292207Savos		return (urtwn_rxeof(sc, buf, len));
935292167Savos
936292167Savos	return (NULL);
937292167Savos}
938292167Savos
939292167Savosstatic struct mbuf *
940292207Savosurtwn_rxeof(struct urtwn_softc *sc, uint8_t *buf, int len)
941292167Savos{
942292167Savos	struct r92c_rx_stat *stat;
943292167Savos	struct mbuf *m, *m0 = NULL, *prevm = NULL;
944292167Savos	uint32_t rxdw0;
945292167Savos	int totlen, pktlen, infosz, npkts;
946292167Savos
947251538Srpaulo	/* Get the number of encapsulated frames. */
948251538Srpaulo	stat = (struct r92c_rx_stat *)buf;
949251538Srpaulo	npkts = MS(le32toh(stat->rxdw2), R92C_RXDW2_PKTCNT);
950294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_RECV,
951294471Savos	    "%s: Rx %d frames in one chunk\n", __func__, npkts);
952251538Srpaulo
953251538Srpaulo	/* Process all of them. */
954251538Srpaulo	while (npkts-- > 0) {
955251538Srpaulo		if (len < sizeof(*stat))
956251538Srpaulo			break;
957251538Srpaulo		stat = (struct r92c_rx_stat *)buf;
958251538Srpaulo		rxdw0 = le32toh(stat->rxdw0);
959251538Srpaulo
960251538Srpaulo		pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN);
961251538Srpaulo		if (pktlen == 0)
962251538Srpaulo			break;
963251538Srpaulo
964251538Srpaulo		infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8;
965251538Srpaulo
966251538Srpaulo		/* Make sure everything fits in xfer. */
967251538Srpaulo		totlen = sizeof(*stat) + infosz + pktlen;
968251538Srpaulo		if (totlen > len)
969251538Srpaulo			break;
970251538Srpaulo
971292207Savos		m = urtwn_rx_copy_to_mbuf(sc, stat, totlen);
972251538Srpaulo		if (m0 == NULL)
973251538Srpaulo			m0 = m;
974251538Srpaulo		if (prevm == NULL)
975251538Srpaulo			prevm = m;
976251538Srpaulo		else {
977251538Srpaulo			prevm->m_next = m;
978251538Srpaulo			prevm = m;
979251538Srpaulo		}
980251538Srpaulo
981251538Srpaulo		/* Next chunk is 128-byte aligned. */
982251538Srpaulo		totlen = (totlen + 127) & ~127;
983251538Srpaulo		buf += totlen;
984251538Srpaulo		len -= totlen;
985251538Srpaulo	}
986251538Srpaulo
987251538Srpaulo	return (m0);
988251538Srpaulo}
989251538Srpaulo
990251538Srpaulostatic void
991292167Savosurtwn_r88e_ratectl_tx_complete(struct urtwn_softc *sc, void *arg)
992292167Savos{
993292167Savos	struct r88e_tx_rpt_ccx *rpt = arg;
994292167Savos	struct ieee80211vap *vap;
995292167Savos	struct ieee80211_node *ni;
996292167Savos	uint8_t macid;
997292167Savos	int ntries;
998292167Savos
999292167Savos	macid = MS(rpt->rptb1, R88E_RPTB1_MACID);
1000292167Savos	ntries = MS(rpt->rptb2, R88E_RPTB2_RETRY_CNT);
1001292167Savos
1002292167Savos	URTWN_NT_LOCK(sc);
1003292167Savos	ni = sc->node_list[macid];
1004292167Savos	if (ni != NULL) {
1005292167Savos		vap = ni->ni_vap;
1006294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_INTR, "%s: frame for macid %d was"
1007294471Savos		    "%s sent (%d retries)\n", __func__, macid,
1008294471Savos		    (rpt->rptb1 & R88E_RPTB1_PKT_OK) ? "" : " not",
1009294471Savos		    ntries);
1010292167Savos
1011292167Savos		if (rpt->rptb1 & R88E_RPTB1_PKT_OK) {
1012292167Savos			ieee80211_ratectl_tx_complete(vap, ni,
1013292167Savos			    IEEE80211_RATECTL_TX_SUCCESS, &ntries, NULL);
1014292167Savos		} else {
1015292167Savos			ieee80211_ratectl_tx_complete(vap, ni,
1016292167Savos			    IEEE80211_RATECTL_TX_FAILURE, &ntries, NULL);
1017292167Savos		}
1018294471Savos	} else {
1019294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_INTR, "%s: macid %d, ni is NULL\n",
1020294471Savos		    __func__, macid);
1021294471Savos	}
1022292167Savos	URTWN_NT_UNLOCK(sc);
1023292167Savos}
1024292167Savos
1025292207Savosstatic struct ieee80211_node *
1026292207Savosurtwn_rx_frame(struct urtwn_softc *sc, struct mbuf *m, int8_t *rssi_p)
1027292207Savos{
1028292207Savos	struct ieee80211com *ic = &sc->sc_ic;
1029292207Savos	struct ieee80211_frame_min *wh;
1030292207Savos	struct r92c_rx_stat *stat;
1031292207Savos	uint32_t rxdw0, rxdw3;
1032292207Savos	uint8_t rate, cipher;
1033297910Sadrian	int8_t rssi = -127;
1034292207Savos	int infosz;
1035292207Savos
1036292207Savos	stat = mtod(m, struct r92c_rx_stat *);
1037292207Savos	rxdw0 = le32toh(stat->rxdw0);
1038292207Savos	rxdw3 = le32toh(stat->rxdw3);
1039292207Savos
1040292207Savos	rate = MS(rxdw3, R92C_RXDW3_RATE);
1041292207Savos	cipher = MS(rxdw0, R92C_RXDW0_CIPHER);
1042292207Savos	infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8;
1043292207Savos
1044292207Savos	/* Get RSSI from PHY status descriptor if present. */
1045292207Savos	if (infosz != 0 && (rxdw0 & R92C_RXDW0_PHYST)) {
1046292207Savos		if (sc->chip & URTWN_CHIP_88E)
1047292207Savos			rssi = urtwn_r88e_get_rssi(sc, rate, &stat[1]);
1048292207Savos		else
1049292207Savos			rssi = urtwn_get_rssi(sc, rate, &stat[1]);
1050297910Sadrian		URTWN_DPRINTF(sc, URTWN_DEBUG_RSSI, "%s: rssi=%d\n", __func__, rssi);
1051292207Savos		/* Update our average RSSI. */
1052292207Savos		urtwn_update_avgrssi(sc, rate, rssi);
1053292207Savos	}
1054292207Savos
1055292207Savos	if (ieee80211_radiotap_active(ic)) {
1056292207Savos		struct urtwn_rx_radiotap_header *tap = &sc->sc_rxtap;
1057292207Savos
1058292207Savos		tap->wr_flags = 0;
1059292207Savos
1060292207Savos		urtwn_get_tsf(sc, &tap->wr_tsft);
1061292207Savos		if (__predict_false(le32toh((uint32_t)tap->wr_tsft) <
1062292207Savos				    le32toh(stat->rxdw5))) {
1063292207Savos			tap->wr_tsft = le32toh(tap->wr_tsft  >> 32) - 1;
1064292207Savos			tap->wr_tsft = (uint64_t)htole32(tap->wr_tsft) << 32;
1065292207Savos		} else
1066292207Savos			tap->wr_tsft &= 0xffffffff00000000;
1067292207Savos		tap->wr_tsft += stat->rxdw5;
1068292207Savos
1069297175Sadrian		/* XXX 20/40? */
1070297175Sadrian		/* XXX shortgi? */
1071297175Sadrian
1072292207Savos		/* Map HW rate index to 802.11 rate. */
1073292207Savos		if (!(rxdw3 & R92C_RXDW3_HT)) {
1074292207Savos			tap->wr_rate = ridx2rate[rate];
1075292207Savos		} else if (rate >= 12) {	/* MCS0~15. */
1076292207Savos			/* Bit 7 set means HT MCS instead of rate. */
1077292207Savos			tap->wr_rate = 0x80 | (rate - 12);
1078292207Savos		}
1079297910Sadrian
1080297910Sadrian		/* XXX TODO: this isn't right; should use the last good RSSI */
1081292207Savos		tap->wr_dbm_antsignal = rssi;
1082292207Savos		tap->wr_dbm_antnoise = URTWN_NOISE_FLOOR;
1083292207Savos	}
1084292207Savos
1085292207Savos	*rssi_p = rssi;
1086292207Savos
1087292207Savos	/* Drop descriptor. */
1088292207Savos	m_adj(m, sizeof(*stat) + infosz);
1089292207Savos	wh = mtod(m, struct ieee80211_frame_min *);
1090292207Savos
1091292207Savos	if ((wh->i_fc[1] & IEEE80211_FC1_PROTECTED) &&
1092292207Savos	    cipher != R92C_CAM_ALGO_NONE) {
1093292207Savos		m->m_flags |= M_WEP;
1094292207Savos	}
1095292207Savos
1096292207Savos	if (m->m_len >= sizeof(*wh))
1097292207Savos		return (ieee80211_find_rxnode(ic, wh));
1098292207Savos
1099292207Savos	return (NULL);
1100292207Savos}
1101292207Savos
1102292167Savosstatic void
1103251538Srpaulourtwn_bulk_rx_callback(struct usb_xfer *xfer, usb_error_t error)
1104251538Srpaulo{
1105251538Srpaulo	struct urtwn_softc *sc = usbd_xfer_softc(xfer);
1106287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
1107251538Srpaulo	struct ieee80211_node *ni;
1108251538Srpaulo	struct mbuf *m = NULL, *next;
1109251538Srpaulo	struct urtwn_data *data;
1110292207Savos	int8_t nf, rssi;
1111251538Srpaulo
1112251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
1113251538Srpaulo
1114251538Srpaulo	switch (USB_GET_STATE(xfer)) {
1115251538Srpaulo	case USB_ST_TRANSFERRED:
1116251538Srpaulo		data = STAILQ_FIRST(&sc->sc_rx_active);
1117251538Srpaulo		if (data == NULL)
1118251538Srpaulo			goto tr_setup;
1119251538Srpaulo		STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next);
1120292207Savos		m = urtwn_report_intr(xfer, data);
1121251538Srpaulo		STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next);
1122251538Srpaulo		/* FALLTHROUGH */
1123251538Srpaulo	case USB_ST_SETUP:
1124251538Srpaulotr_setup:
1125251538Srpaulo		data = STAILQ_FIRST(&sc->sc_rx_inactive);
1126251538Srpaulo		if (data == NULL) {
1127251538Srpaulo			KASSERT(m == NULL, ("mbuf isn't NULL"));
1128297596Sadrian			goto finish;
1129251538Srpaulo		}
1130251538Srpaulo		STAILQ_REMOVE_HEAD(&sc->sc_rx_inactive, next);
1131251538Srpaulo		STAILQ_INSERT_TAIL(&sc->sc_rx_active, data, next);
1132251538Srpaulo		usbd_xfer_set_frame_data(xfer, 0, data->buf,
1133251538Srpaulo		    usbd_xfer_max_len(xfer));
1134251538Srpaulo		usbd_transfer_submit(xfer);
1135251538Srpaulo
1136251538Srpaulo		/*
1137251538Srpaulo		 * To avoid LOR we should unlock our private mutex here to call
1138251538Srpaulo		 * ieee80211_input() because here is at the end of a USB
1139251538Srpaulo		 * callback and safe to unlock.
1140251538Srpaulo		 */
1141251538Srpaulo		while (m != NULL) {
1142251538Srpaulo			next = m->m_next;
1143251538Srpaulo			m->m_next = NULL;
1144292207Savos
1145292207Savos			ni = urtwn_rx_frame(sc, m, &rssi);
1146297910Sadrian
1147297910Sadrian			/* Store a global last-good RSSI */
1148297910Sadrian			if (rssi != -127)
1149297910Sadrian				sc->last_rssi = rssi;
1150297910Sadrian
1151292207Savos			URTWN_UNLOCK(sc);
1152292207Savos
1153251538Srpaulo			nf = URTWN_NOISE_FLOOR;
1154251538Srpaulo			if (ni != NULL) {
1155297910Sadrian				if (rssi != -127)
1156297910Sadrian					URTWN_NODE(ni)->last_rssi = rssi;
1157297175Sadrian				if (ni->ni_flags & IEEE80211_NODE_HT)
1158297175Sadrian					m->m_flags |= M_AMPDU;
1159297910Sadrian				(void)ieee80211_input(ni, m,
1160297910Sadrian				    URTWN_NODE(ni)->last_rssi - nf, nf);
1161251538Srpaulo				ieee80211_free_node(ni);
1162289799Savos			} else {
1163297910Sadrian				/* Use last good global RSSI */
1164297910Sadrian				(void)ieee80211_input_all(ic, m,
1165297910Sadrian				    sc->last_rssi - nf, nf);
1166289799Savos			}
1167292207Savos			URTWN_LOCK(sc);
1168251538Srpaulo			m = next;
1169251538Srpaulo		}
1170251538Srpaulo		break;
1171251538Srpaulo	default:
1172251538Srpaulo		/* needs it to the inactive queue due to a error. */
1173251538Srpaulo		data = STAILQ_FIRST(&sc->sc_rx_active);
1174251538Srpaulo		if (data != NULL) {
1175251538Srpaulo			STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next);
1176251538Srpaulo			STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next);
1177251538Srpaulo		}
1178251538Srpaulo		if (error != USB_ERR_CANCELLED) {
1179251538Srpaulo			usbd_xfer_set_stall(xfer);
1180287197Sglebius			counter_u64_add(ic->ic_ierrors, 1);
1181251538Srpaulo			goto tr_setup;
1182251538Srpaulo		}
1183251538Srpaulo		break;
1184251538Srpaulo	}
1185297596Sadrianfinish:
1186297596Sadrian	/* Finished receive; age anything left on the FF queue by a little bump */
1187297596Sadrian	/*
1188297596Sadrian	 * XXX TODO: just make this a callout timer schedule so we can
1189297596Sadrian	 * flush the FF staging queue if we're approaching idle.
1190297596Sadrian	 */
1191297596Sadrian#ifdef	IEEE80211_SUPPORT_SUPERG
1192297596Sadrian	URTWN_UNLOCK(sc);
1193297596Sadrian	ieee80211_ff_age_all(ic, 1);
1194297596Sadrian	URTWN_LOCK(sc);
1195297596Sadrian#endif
1196297596Sadrian
1197297596Sadrian	/* Kick-start more transmit in case we stalled */
1198297596Sadrian	urtwn_start(sc);
1199251538Srpaulo}
1200251538Srpaulo
1201251538Srpaulostatic void
1202289891Savosurtwn_txeof(struct urtwn_softc *sc, struct urtwn_data *data, int status)
1203251538Srpaulo{
1204251538Srpaulo
1205251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
1206289891Savos
1207290631Savos	if (data->ni != NULL)	/* not a beacon frame */
1208290631Savos		ieee80211_tx_complete(data->ni, data->m, status);
1209289891Savos
1210297596Sadrian	if (sc->sc_tx_n_active > 0)
1211297596Sadrian		sc->sc_tx_n_active--;
1212297596Sadrian
1213287197Sglebius	data->ni = NULL;
1214287197Sglebius	data->m = NULL;
1215289891Savos
1216251538Srpaulo	sc->sc_txtimer = 0;
1217289891Savos
1218289891Savos	STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data, next);
1219251538Srpaulo}
1220251538Srpaulo
1221289066Skevlostatic int
1222289066Skevlourtwn_alloc_list(struct urtwn_softc *sc, struct urtwn_data data[],
1223289066Skevlo    int ndata, int maxsz)
1224289066Skevlo{
1225289066Skevlo	int i, error;
1226289066Skevlo
1227289066Skevlo	for (i = 0; i < ndata; i++) {
1228289066Skevlo		struct urtwn_data *dp = &data[i];
1229289066Skevlo		dp->sc = sc;
1230289066Skevlo		dp->m = NULL;
1231289066Skevlo		dp->buf = malloc(maxsz, M_USBDEV, M_NOWAIT);
1232289066Skevlo		if (dp->buf == NULL) {
1233289066Skevlo			device_printf(sc->sc_dev,
1234289066Skevlo			    "could not allocate buffer\n");
1235289066Skevlo			error = ENOMEM;
1236289066Skevlo			goto fail;
1237289066Skevlo		}
1238289066Skevlo		dp->ni = NULL;
1239289066Skevlo	}
1240289066Skevlo
1241289066Skevlo	return (0);
1242289066Skevlofail:
1243289066Skevlo	urtwn_free_list(sc, data, ndata);
1244289066Skevlo	return (error);
1245289066Skevlo}
1246289066Skevlo
1247289066Skevlostatic int
1248289066Skevlourtwn_alloc_rx_list(struct urtwn_softc *sc)
1249289066Skevlo{
1250289066Skevlo        int error, i;
1251289066Skevlo
1252289066Skevlo	error = urtwn_alloc_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT,
1253289066Skevlo	    URTWN_RXBUFSZ);
1254289066Skevlo	if (error != 0)
1255289066Skevlo		return (error);
1256289066Skevlo
1257289066Skevlo	STAILQ_INIT(&sc->sc_rx_active);
1258289066Skevlo	STAILQ_INIT(&sc->sc_rx_inactive);
1259289066Skevlo
1260289066Skevlo	for (i = 0; i < URTWN_RX_LIST_COUNT; i++)
1261289066Skevlo		STAILQ_INSERT_HEAD(&sc->sc_rx_inactive, &sc->sc_rx[i], next);
1262289066Skevlo
1263289066Skevlo	return (0);
1264289066Skevlo}
1265289066Skevlo
1266289066Skevlostatic int
1267289066Skevlourtwn_alloc_tx_list(struct urtwn_softc *sc)
1268289066Skevlo{
1269289066Skevlo	int error, i;
1270289066Skevlo
1271289066Skevlo	error = urtwn_alloc_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT,
1272289066Skevlo	    URTWN_TXBUFSZ);
1273289066Skevlo	if (error != 0)
1274289066Skevlo		return (error);
1275289066Skevlo
1276289066Skevlo	STAILQ_INIT(&sc->sc_tx_active);
1277289066Skevlo	STAILQ_INIT(&sc->sc_tx_inactive);
1278289066Skevlo	STAILQ_INIT(&sc->sc_tx_pending);
1279289066Skevlo
1280289066Skevlo	for (i = 0; i < URTWN_TX_LIST_COUNT; i++)
1281289066Skevlo		STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, &sc->sc_tx[i], next);
1282289066Skevlo
1283289066Skevlo	return (0);
1284289066Skevlo}
1285289066Skevlo
1286251538Srpaulostatic void
1287289066Skevlourtwn_free_list(struct urtwn_softc *sc, struct urtwn_data data[], int ndata)
1288289066Skevlo{
1289289066Skevlo	int i;
1290289066Skevlo
1291289066Skevlo	for (i = 0; i < ndata; i++) {
1292289066Skevlo		struct urtwn_data *dp = &data[i];
1293289066Skevlo
1294289066Skevlo		if (dp->buf != NULL) {
1295289066Skevlo			free(dp->buf, M_USBDEV);
1296289066Skevlo			dp->buf = NULL;
1297289066Skevlo		}
1298289066Skevlo		if (dp->ni != NULL) {
1299289066Skevlo			ieee80211_free_node(dp->ni);
1300289066Skevlo			dp->ni = NULL;
1301289066Skevlo		}
1302289066Skevlo	}
1303289066Skevlo}
1304289066Skevlo
1305289066Skevlostatic void
1306289066Skevlourtwn_free_rx_list(struct urtwn_softc *sc)
1307289066Skevlo{
1308289066Skevlo	urtwn_free_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT);
1309289066Skevlo}
1310289066Skevlo
1311289066Skevlostatic void
1312289066Skevlourtwn_free_tx_list(struct urtwn_softc *sc)
1313289066Skevlo{
1314289066Skevlo	urtwn_free_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT);
1315289066Skevlo}
1316289066Skevlo
1317289066Skevlostatic void
1318251538Srpaulourtwn_bulk_tx_callback(struct usb_xfer *xfer, usb_error_t error)
1319251538Srpaulo{
1320251538Srpaulo	struct urtwn_softc *sc = usbd_xfer_softc(xfer);
1321297596Sadrian#ifdef	IEEE80211_SUPPORT_SUPERG
1322297596Sadrian	struct ieee80211com *ic = &sc->sc_ic;
1323297596Sadrian#endif
1324251538Srpaulo	struct urtwn_data *data;
1325251538Srpaulo
1326251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
1327251538Srpaulo
1328251538Srpaulo	switch (USB_GET_STATE(xfer)){
1329251538Srpaulo	case USB_ST_TRANSFERRED:
1330251538Srpaulo		data = STAILQ_FIRST(&sc->sc_tx_active);
1331251538Srpaulo		if (data == NULL)
1332251538Srpaulo			goto tr_setup;
1333251538Srpaulo		STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next);
1334289891Savos		urtwn_txeof(sc, data, 0);
1335251538Srpaulo		/* FALLTHROUGH */
1336251538Srpaulo	case USB_ST_SETUP:
1337251538Srpaulotr_setup:
1338251538Srpaulo		data = STAILQ_FIRST(&sc->sc_tx_pending);
1339251538Srpaulo		if (data == NULL) {
1340294471Savos			URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT,
1341294471Savos			    "%s: empty pending queue\n", __func__);
1342297596Sadrian			sc->sc_tx_n_active = 0;
1343288353Sadrian			goto finish;
1344251538Srpaulo		}
1345251538Srpaulo		STAILQ_REMOVE_HEAD(&sc->sc_tx_pending, next);
1346251538Srpaulo		STAILQ_INSERT_TAIL(&sc->sc_tx_active, data, next);
1347251538Srpaulo		usbd_xfer_set_frame_data(xfer, 0, data->buf, data->buflen);
1348251538Srpaulo		usbd_transfer_submit(xfer);
1349297596Sadrian		sc->sc_tx_n_active++;
1350251538Srpaulo		break;
1351251538Srpaulo	default:
1352251538Srpaulo		data = STAILQ_FIRST(&sc->sc_tx_active);
1353251538Srpaulo		if (data == NULL)
1354251538Srpaulo			goto tr_setup;
1355289891Savos		STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next);
1356289891Savos		urtwn_txeof(sc, data, 1);
1357251538Srpaulo		if (error != USB_ERR_CANCELLED) {
1358251538Srpaulo			usbd_xfer_set_stall(xfer);
1359251538Srpaulo			goto tr_setup;
1360251538Srpaulo		}
1361251538Srpaulo		break;
1362251538Srpaulo	}
1363288353Sadrianfinish:
1364297596Sadrian#ifdef	IEEE80211_SUPPORT_SUPERG
1365297596Sadrian	/*
1366297596Sadrian	 * If the TX active queue drops below a certain
1367297596Sadrian	 * threshold, ensure we age fast-frames out so they're
1368297596Sadrian	 * transmitted.
1369297596Sadrian	 */
1370297596Sadrian	if (sc->sc_tx_n_active <= 1) {
1371297596Sadrian		/* XXX ew - net80211 should defer this for us! */
1372297596Sadrian
1373297596Sadrian		/*
1374297596Sadrian		 * Note: this sc_tx_n_active currently tracks
1375297596Sadrian		 * the number of pending transmit submissions
1376297596Sadrian		 * and not the actual depth of the TX frames
1377297596Sadrian		 * pending to the hardware.  That means that
1378297596Sadrian		 * we're going to end up with some sub-optimal
1379297596Sadrian		 * aggregation behaviour.
1380297596Sadrian		 */
1381297596Sadrian		/*
1382297596Sadrian		 * XXX TODO: just make this a callout timer schedule so we can
1383297596Sadrian		 * flush the FF staging queue if we're approaching idle.
1384297596Sadrian		 */
1385297596Sadrian		URTWN_UNLOCK(sc);
1386297596Sadrian		ieee80211_ff_flush(ic, WME_AC_VO);
1387297596Sadrian		ieee80211_ff_flush(ic, WME_AC_VI);
1388297596Sadrian		ieee80211_ff_flush(ic, WME_AC_BE);
1389297596Sadrian		ieee80211_ff_flush(ic, WME_AC_BK);
1390297596Sadrian		URTWN_LOCK(sc);
1391297596Sadrian	}
1392297596Sadrian#endif
1393288353Sadrian	/* Kick-start more transmit */
1394288353Sadrian	urtwn_start(sc);
1395251538Srpaulo}
1396251538Srpaulo
1397251538Srpaulostatic struct urtwn_data *
1398251538Srpaulo_urtwn_getbuf(struct urtwn_softc *sc)
1399251538Srpaulo{
1400251538Srpaulo	struct urtwn_data *bf;
1401251538Srpaulo
1402251538Srpaulo	bf = STAILQ_FIRST(&sc->sc_tx_inactive);
1403251538Srpaulo	if (bf != NULL)
1404251538Srpaulo		STAILQ_REMOVE_HEAD(&sc->sc_tx_inactive, next);
1405294471Savos	else {
1406294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT,
1407294471Savos		    "%s: out of xmit buffers\n", __func__);
1408294471Savos	}
1409251538Srpaulo	return (bf);
1410251538Srpaulo}
1411251538Srpaulo
1412251538Srpaulostatic struct urtwn_data *
1413251538Srpaulourtwn_getbuf(struct urtwn_softc *sc)
1414251538Srpaulo{
1415251538Srpaulo        struct urtwn_data *bf;
1416251538Srpaulo
1417251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
1418251538Srpaulo
1419251538Srpaulo	bf = _urtwn_getbuf(sc);
1420294471Savos	if (bf == NULL) {
1421294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT, "%s: stop queue\n",
1422294471Savos		    __func__);
1423294471Savos	}
1424251538Srpaulo	return (bf);
1425251538Srpaulo}
1426251538Srpaulo
1427291698Savosstatic usb_error_t
1428251538Srpaulourtwn_write_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf,
1429251538Srpaulo    int len)
1430251538Srpaulo{
1431251538Srpaulo	usb_device_request_t req;
1432251538Srpaulo
1433251538Srpaulo	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
1434251538Srpaulo	req.bRequest = R92C_REQ_REGS;
1435251538Srpaulo	USETW(req.wValue, addr);
1436251538Srpaulo	USETW(req.wIndex, 0);
1437251538Srpaulo	USETW(req.wLength, len);
1438251538Srpaulo	return (urtwn_do_request(sc, &req, buf));
1439251538Srpaulo}
1440251538Srpaulo
1441291698Savosstatic usb_error_t
1442251538Srpaulourtwn_write_1(struct urtwn_softc *sc, uint16_t addr, uint8_t val)
1443251538Srpaulo{
1444291698Savos	return (urtwn_write_region_1(sc, addr, &val, sizeof(val)));
1445251538Srpaulo}
1446251538Srpaulo
1447291698Savosstatic usb_error_t
1448251538Srpaulourtwn_write_2(struct urtwn_softc *sc, uint16_t addr, uint16_t val)
1449251538Srpaulo{
1450251538Srpaulo	val = htole16(val);
1451291698Savos	return (urtwn_write_region_1(sc, addr, (uint8_t *)&val, sizeof(val)));
1452251538Srpaulo}
1453251538Srpaulo
1454291698Savosstatic usb_error_t
1455251538Srpaulourtwn_write_4(struct urtwn_softc *sc, uint16_t addr, uint32_t val)
1456251538Srpaulo{
1457251538Srpaulo	val = htole32(val);
1458291698Savos	return (urtwn_write_region_1(sc, addr, (uint8_t *)&val, sizeof(val)));
1459251538Srpaulo}
1460251538Srpaulo
1461291698Savosstatic usb_error_t
1462251538Srpaulourtwn_read_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf,
1463251538Srpaulo    int len)
1464251538Srpaulo{
1465251538Srpaulo	usb_device_request_t req;
1466251538Srpaulo
1467251538Srpaulo	req.bmRequestType = UT_READ_VENDOR_DEVICE;
1468251538Srpaulo	req.bRequest = R92C_REQ_REGS;
1469251538Srpaulo	USETW(req.wValue, addr);
1470251538Srpaulo	USETW(req.wIndex, 0);
1471251538Srpaulo	USETW(req.wLength, len);
1472251538Srpaulo	return (urtwn_do_request(sc, &req, buf));
1473251538Srpaulo}
1474251538Srpaulo
1475251538Srpaulostatic uint8_t
1476251538Srpaulourtwn_read_1(struct urtwn_softc *sc, uint16_t addr)
1477251538Srpaulo{
1478251538Srpaulo	uint8_t val;
1479251538Srpaulo
1480251538Srpaulo	if (urtwn_read_region_1(sc, addr, &val, 1) != 0)
1481251538Srpaulo		return (0xff);
1482251538Srpaulo	return (val);
1483251538Srpaulo}
1484251538Srpaulo
1485251538Srpaulostatic uint16_t
1486251538Srpaulourtwn_read_2(struct urtwn_softc *sc, uint16_t addr)
1487251538Srpaulo{
1488251538Srpaulo	uint16_t val;
1489251538Srpaulo
1490251538Srpaulo	if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 2) != 0)
1491251538Srpaulo		return (0xffff);
1492251538Srpaulo	return (le16toh(val));
1493251538Srpaulo}
1494251538Srpaulo
1495251538Srpaulostatic uint32_t
1496251538Srpaulourtwn_read_4(struct urtwn_softc *sc, uint16_t addr)
1497251538Srpaulo{
1498251538Srpaulo	uint32_t val;
1499251538Srpaulo
1500251538Srpaulo	if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 4) != 0)
1501251538Srpaulo		return (0xffffffff);
1502251538Srpaulo	return (le32toh(val));
1503251538Srpaulo}
1504251538Srpaulo
1505251538Srpaulostatic int
1506251538Srpaulourtwn_fw_cmd(struct urtwn_softc *sc, uint8_t id, const void *buf, int len)
1507251538Srpaulo{
1508251538Srpaulo	struct r92c_fw_cmd cmd;
1509291698Savos	usb_error_t error;
1510251538Srpaulo	int ntries;
1511251538Srpaulo
1512295871Savos	if (!(sc->sc_flags & URTWN_FW_LOADED)) {
1513295871Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_FIRMWARE, "%s: firmware "
1514295871Savos		    "was not loaded; command (id %d) will be discarded\n",
1515295871Savos		    __func__, id);
1516295871Savos		return (0);
1517295871Savos	}
1518295871Savos
1519251538Srpaulo	/* Wait for current FW box to be empty. */
1520251538Srpaulo	for (ntries = 0; ntries < 100; ntries++) {
1521251538Srpaulo		if (!(urtwn_read_1(sc, R92C_HMETFR) & (1 << sc->fwcur)))
1522251538Srpaulo			break;
1523266472Shselasky		urtwn_ms_delay(sc);
1524251538Srpaulo	}
1525251538Srpaulo	if (ntries == 100) {
1526251538Srpaulo		device_printf(sc->sc_dev,
1527251538Srpaulo		    "could not send firmware command\n");
1528251538Srpaulo		return (ETIMEDOUT);
1529251538Srpaulo	}
1530251538Srpaulo	memset(&cmd, 0, sizeof(cmd));
1531251538Srpaulo	cmd.id = id;
1532251538Srpaulo	if (len > 3)
1533251538Srpaulo		cmd.id |= R92C_CMD_FLAG_EXT;
1534251538Srpaulo	KASSERT(len <= sizeof(cmd.msg), ("urtwn_fw_cmd\n"));
1535251538Srpaulo	memcpy(cmd.msg, buf, len);
1536251538Srpaulo
1537251538Srpaulo	/* Write the first word last since that will trigger the FW. */
1538291698Savos	error = urtwn_write_region_1(sc, R92C_HMEBOX_EXT(sc->fwcur),
1539251538Srpaulo	    (uint8_t *)&cmd + 4, 2);
1540291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
1541291698Savos		return (EIO);
1542291698Savos	error = urtwn_write_region_1(sc, R92C_HMEBOX(sc->fwcur),
1543251538Srpaulo	    (uint8_t *)&cmd + 0, 4);
1544291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
1545291698Savos		return (EIO);
1546251538Srpaulo
1547251538Srpaulo	sc->fwcur = (sc->fwcur + 1) % R92C_H2C_NBOX;
1548251538Srpaulo	return (0);
1549251538Srpaulo}
1550251538Srpaulo
1551292174Savosstatic void
1552292174Savosurtwn_cmdq_cb(void *arg, int pending)
1553292174Savos{
1554292174Savos	struct urtwn_softc *sc = arg;
1555292174Savos	struct urtwn_cmdq *item;
1556292174Savos
1557292174Savos	/*
1558292174Savos	 * Device must be powered on (via urtwn_power_on())
1559292174Savos	 * before any command may be sent.
1560292174Savos	 */
1561292174Savos	URTWN_LOCK(sc);
1562292174Savos	if (!(sc->sc_flags & URTWN_RUNNING)) {
1563292174Savos		URTWN_UNLOCK(sc);
1564292174Savos		return;
1565292174Savos	}
1566292174Savos
1567292174Savos	URTWN_CMDQ_LOCK(sc);
1568292174Savos	while (sc->cmdq[sc->cmdq_first].func != NULL) {
1569292174Savos		item = &sc->cmdq[sc->cmdq_first];
1570292174Savos		sc->cmdq_first = (sc->cmdq_first + 1) % URTWN_CMDQ_SIZE;
1571292174Savos		URTWN_CMDQ_UNLOCK(sc);
1572292174Savos
1573292174Savos		item->func(sc, &item->data);
1574292174Savos
1575292174Savos		URTWN_CMDQ_LOCK(sc);
1576292174Savos		memset(item, 0, sizeof (*item));
1577292174Savos	}
1578292174Savos	URTWN_CMDQ_UNLOCK(sc);
1579292174Savos	URTWN_UNLOCK(sc);
1580292174Savos}
1581292174Savos
1582292174Savosstatic int
1583292174Savosurtwn_cmd_sleepable(struct urtwn_softc *sc, const void *ptr, size_t len,
1584292174Savos    CMD_FUNC_PROTO)
1585292174Savos{
1586292174Savos	struct ieee80211com *ic = &sc->sc_ic;
1587292174Savos
1588292174Savos	KASSERT(len <= sizeof(union sec_param), ("buffer overflow"));
1589292174Savos
1590292174Savos	URTWN_CMDQ_LOCK(sc);
1591292174Savos	if (sc->cmdq[sc->cmdq_last].func != NULL) {
1592292174Savos		device_printf(sc->sc_dev, "%s: cmdq overflow\n", __func__);
1593292174Savos		URTWN_CMDQ_UNLOCK(sc);
1594292174Savos
1595292174Savos		return (EAGAIN);
1596292174Savos	}
1597292174Savos
1598292174Savos	if (ptr != NULL)
1599292174Savos		memcpy(&sc->cmdq[sc->cmdq_last].data, ptr, len);
1600292174Savos	sc->cmdq[sc->cmdq_last].func = func;
1601292174Savos	sc->cmdq_last = (sc->cmdq_last + 1) % URTWN_CMDQ_SIZE;
1602292174Savos	URTWN_CMDQ_UNLOCK(sc);
1603292174Savos
1604292174Savos	ieee80211_runtask(ic, &sc->cmdq_task);
1605292174Savos
1606292174Savos	return (0);
1607292174Savos}
1608292174Savos
1609264912Skevlostatic __inline void
1610251538Srpaulourtwn_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, uint32_t val)
1611251538Srpaulo{
1612264912Skevlo
1613264912Skevlo	sc->sc_rf_write(sc, chain, addr, val);
1614264912Skevlo}
1615264912Skevlo
1616264912Skevlostatic void
1617264912Skevlourtwn_r92c_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr,
1618264912Skevlo    uint32_t val)
1619264912Skevlo{
1620251538Srpaulo	urtwn_bb_write(sc, R92C_LSSI_PARAM(chain),
1621251538Srpaulo	    SM(R92C_LSSI_PARAM_ADDR, addr) |
1622251538Srpaulo	    SM(R92C_LSSI_PARAM_DATA, val));
1623251538Srpaulo}
1624251538Srpaulo
1625264912Skevlostatic void
1626264912Skevlourtwn_r88e_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr,
1627264912Skevlouint32_t val)
1628264912Skevlo{
1629264912Skevlo	urtwn_bb_write(sc, R92C_LSSI_PARAM(chain),
1630264912Skevlo	    SM(R88E_LSSI_PARAM_ADDR, addr) |
1631264912Skevlo	    SM(R92C_LSSI_PARAM_DATA, val));
1632264912Skevlo}
1633264912Skevlo
1634251538Srpaulostatic uint32_t
1635251538Srpaulourtwn_rf_read(struct urtwn_softc *sc, int chain, uint8_t addr)
1636251538Srpaulo{
1637251538Srpaulo	uint32_t reg[R92C_MAX_CHAINS], val;
1638251538Srpaulo
1639251538Srpaulo	reg[0] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(0));
1640251538Srpaulo	if (chain != 0)
1641251538Srpaulo		reg[chain] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(chain));
1642251538Srpaulo
1643251538Srpaulo	urtwn_bb_write(sc, R92C_HSSI_PARAM2(0),
1644251538Srpaulo	    reg[0] & ~R92C_HSSI_PARAM2_READ_EDGE);
1645266472Shselasky	urtwn_ms_delay(sc);
1646251538Srpaulo
1647251538Srpaulo	urtwn_bb_write(sc, R92C_HSSI_PARAM2(chain),
1648251538Srpaulo	    RW(reg[chain], R92C_HSSI_PARAM2_READ_ADDR, addr) |
1649251538Srpaulo	    R92C_HSSI_PARAM2_READ_EDGE);
1650266472Shselasky	urtwn_ms_delay(sc);
1651251538Srpaulo
1652251538Srpaulo	urtwn_bb_write(sc, R92C_HSSI_PARAM2(0),
1653251538Srpaulo	    reg[0] | R92C_HSSI_PARAM2_READ_EDGE);
1654266472Shselasky	urtwn_ms_delay(sc);
1655251538Srpaulo
1656251538Srpaulo	if (urtwn_bb_read(sc, R92C_HSSI_PARAM1(chain)) & R92C_HSSI_PARAM1_PI)
1657251538Srpaulo		val = urtwn_bb_read(sc, R92C_HSPI_READBACK(chain));
1658251538Srpaulo	else
1659251538Srpaulo		val = urtwn_bb_read(sc, R92C_LSSI_READBACK(chain));
1660251538Srpaulo	return (MS(val, R92C_LSSI_READBACK_DATA));
1661251538Srpaulo}
1662251538Srpaulo
1663251538Srpaulostatic int
1664251538Srpaulourtwn_llt_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data)
1665251538Srpaulo{
1666291698Savos	usb_error_t error;
1667251538Srpaulo	int ntries;
1668251538Srpaulo
1669291698Savos	error = urtwn_write_4(sc, R92C_LLT_INIT,
1670251538Srpaulo	    SM(R92C_LLT_INIT_OP, R92C_LLT_INIT_OP_WRITE) |
1671251538Srpaulo	    SM(R92C_LLT_INIT_ADDR, addr) |
1672251538Srpaulo	    SM(R92C_LLT_INIT_DATA, data));
1673291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
1674291698Savos		return (EIO);
1675251538Srpaulo	/* Wait for write operation to complete. */
1676251538Srpaulo	for (ntries = 0; ntries < 20; ntries++) {
1677251538Srpaulo		if (MS(urtwn_read_4(sc, R92C_LLT_INIT), R92C_LLT_INIT_OP) ==
1678251538Srpaulo		    R92C_LLT_INIT_OP_NO_ACTIVE)
1679251538Srpaulo			return (0);
1680266472Shselasky		urtwn_ms_delay(sc);
1681251538Srpaulo	}
1682251538Srpaulo	return (ETIMEDOUT);
1683251538Srpaulo}
1684251538Srpaulo
1685291264Savosstatic int
1686291264Savosurtwn_efuse_read_next(struct urtwn_softc *sc, uint8_t *val)
1687251538Srpaulo{
1688251538Srpaulo	uint32_t reg;
1689291698Savos	usb_error_t error;
1690251538Srpaulo	int ntries;
1691251538Srpaulo
1692291264Savos	if (sc->last_rom_addr >= URTWN_EFUSE_MAX_LEN)
1693291264Savos		return (EFAULT);
1694291264Savos
1695251538Srpaulo	reg = urtwn_read_4(sc, R92C_EFUSE_CTRL);
1696291264Savos	reg = RW(reg, R92C_EFUSE_CTRL_ADDR, sc->last_rom_addr);
1697251538Srpaulo	reg &= ~R92C_EFUSE_CTRL_VALID;
1698291264Savos
1699291698Savos	error = urtwn_write_4(sc, R92C_EFUSE_CTRL, reg);
1700291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
1701291698Savos		return (EIO);
1702251538Srpaulo	/* Wait for read operation to complete. */
1703251538Srpaulo	for (ntries = 0; ntries < 100; ntries++) {
1704251538Srpaulo		reg = urtwn_read_4(sc, R92C_EFUSE_CTRL);
1705251538Srpaulo		if (reg & R92C_EFUSE_CTRL_VALID)
1706291264Savos			break;
1707266472Shselasky		urtwn_ms_delay(sc);
1708251538Srpaulo	}
1709291264Savos	if (ntries == 100) {
1710291264Savos		device_printf(sc->sc_dev,
1711291264Savos		    "could not read efuse byte at address 0x%x\n",
1712291264Savos		    sc->last_rom_addr);
1713291264Savos		return (ETIMEDOUT);
1714291264Savos	}
1715291264Savos
1716291264Savos	*val = MS(reg, R92C_EFUSE_CTRL_DATA);
1717291264Savos	sc->last_rom_addr++;
1718291264Savos
1719291264Savos	return (0);
1720251538Srpaulo}
1721251538Srpaulo
1722291264Savosstatic int
1723291264Savosurtwn_efuse_read_data(struct urtwn_softc *sc, uint8_t *rom, uint8_t off,
1724291264Savos    uint8_t msk)
1725291264Savos{
1726291264Savos	uint8_t reg;
1727291264Savos	int i, error;
1728291264Savos
1729291264Savos	for (i = 0; i < 4; i++) {
1730291264Savos		if (msk & (1 << i))
1731291264Savos			continue;
1732291264Savos		error = urtwn_efuse_read_next(sc, &reg);
1733291264Savos		if (error != 0)
1734291264Savos			return (error);
1735294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "rom[0x%03X] == 0x%02X\n",
1736294471Savos		    off * 8 + i * 2, reg);
1737291264Savos		rom[off * 8 + i * 2 + 0] = reg;
1738291264Savos
1739291264Savos		error = urtwn_efuse_read_next(sc, &reg);
1740291264Savos		if (error != 0)
1741291264Savos			return (error);
1742294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "rom[0x%03X] == 0x%02X\n",
1743294471Savos		    off * 8 + i * 2 + 1, reg);
1744291264Savos		rom[off * 8 + i * 2 + 1] = reg;
1745291264Savos	}
1746291264Savos
1747291264Savos	return (0);
1748291264Savos}
1749291264Savos
1750294471Savos#ifdef USB_DEBUG
1751251538Srpaulostatic void
1752291264Savosurtwn_dump_rom_contents(struct urtwn_softc *sc, uint8_t *rom, uint16_t size)
1753251538Srpaulo{
1754251538Srpaulo	int i;
1755251538Srpaulo
1756291264Savos	/* Dump ROM contents. */
1757291264Savos	device_printf(sc->sc_dev, "%s:", __func__);
1758291264Savos	for (i = 0; i < size; i++) {
1759291264Savos		if (i % 32 == 0)
1760291264Savos			printf("\n%03X: ", i);
1761291264Savos		else if (i % 4 == 0)
1762291264Savos			printf(" ");
1763291264Savos
1764291264Savos		printf("%02X", rom[i]);
1765291264Savos	}
1766291264Savos	printf("\n");
1767291264Savos}
1768291264Savos#endif
1769291264Savos
1770291264Savosstatic int
1771291264Savosurtwn_efuse_read(struct urtwn_softc *sc, uint8_t *rom, uint16_t size)
1772291264Savos{
1773291264Savos#define URTWN_CHK(res) do {	\
1774291264Savos	if ((error = res) != 0)	\
1775291264Savos		goto end;	\
1776291264Savos} while(0)
1777291264Savos	uint8_t msk, off, reg;
1778291264Savos	int error;
1779291264Savos
1780291698Savos	URTWN_CHK(urtwn_efuse_switch_power(sc));
1781264912Skevlo
1782291264Savos	/* Read full ROM image. */
1783291264Savos	sc->last_rom_addr = 0;
1784291264Savos	memset(rom, 0xff, size);
1785291264Savos
1786291264Savos	URTWN_CHK(urtwn_efuse_read_next(sc, &reg));
1787291264Savos	while (reg != 0xff) {
1788291264Savos		/* check for extended header */
1789291264Savos		if ((sc->chip & URTWN_CHIP_88E) && (reg & 0x1f) == 0x0f) {
1790291264Savos			off = reg >> 5;
1791291264Savos			URTWN_CHK(urtwn_efuse_read_next(sc, &reg));
1792291264Savos
1793291264Savos			if ((reg & 0x0f) != 0x0f)
1794291264Savos				off = ((reg & 0xf0) >> 1) | off;
1795291264Savos			else
1796291264Savos				continue;
1797291264Savos		} else
1798291264Savos			off = reg >> 4;
1799251538Srpaulo		msk = reg & 0xf;
1800291264Savos
1801291264Savos		URTWN_CHK(urtwn_efuse_read_data(sc, rom, off, msk));
1802291264Savos		URTWN_CHK(urtwn_efuse_read_next(sc, &reg));
1803251538Srpaulo	}
1804291264Savos
1805291264Savosend:
1806291264Savos
1807294471Savos#ifdef USB_DEBUG
1808294471Savos	if (sc->sc_debug & URTWN_DEBUG_ROM)
1809291264Savos		urtwn_dump_rom_contents(sc, rom, size);
1810251538Srpaulo#endif
1811291264Savos
1812282623Skevlo	urtwn_write_1(sc, R92C_EFUSE_ACCESS, R92C_EFUSE_ACCESS_OFF);
1813291264Savos
1814291264Savos	if (error != 0) {
1815291264Savos		device_printf(sc->sc_dev, "%s: error while reading ROM\n",
1816291264Savos		    __func__);
1817291264Savos	}
1818291264Savos
1819291264Savos	return (error);
1820291264Savos#undef URTWN_CHK
1821282623Skevlo}
1822281592Skevlo
1823291698Savosstatic int
1824264912Skevlourtwn_efuse_switch_power(struct urtwn_softc *sc)
1825264912Skevlo{
1826291698Savos	usb_error_t error;
1827264912Skevlo	uint32_t reg;
1828251538Srpaulo
1829291698Savos	error = urtwn_write_1(sc, R92C_EFUSE_ACCESS, R92C_EFUSE_ACCESS_ON);
1830291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
1831291698Savos		return (EIO);
1832281918Skevlo
1833264912Skevlo	reg = urtwn_read_2(sc, R92C_SYS_ISO_CTRL);
1834264912Skevlo	if (!(reg & R92C_SYS_ISO_CTRL_PWC_EV12V)) {
1835291698Savos		error = urtwn_write_2(sc, R92C_SYS_ISO_CTRL,
1836264912Skevlo		    reg | R92C_SYS_ISO_CTRL_PWC_EV12V);
1837291698Savos		if (error != USB_ERR_NORMAL_COMPLETION)
1838291698Savos			return (EIO);
1839264912Skevlo	}
1840264912Skevlo	reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
1841264912Skevlo	if (!(reg & R92C_SYS_FUNC_EN_ELDR)) {
1842291698Savos		error = urtwn_write_2(sc, R92C_SYS_FUNC_EN,
1843264912Skevlo		    reg | R92C_SYS_FUNC_EN_ELDR);
1844291698Savos		if (error != USB_ERR_NORMAL_COMPLETION)
1845291698Savos			return (EIO);
1846264912Skevlo	}
1847264912Skevlo	reg = urtwn_read_2(sc, R92C_SYS_CLKR);
1848264912Skevlo	if ((reg & (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) !=
1849264912Skevlo	    (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) {
1850291698Savos		error = urtwn_write_2(sc, R92C_SYS_CLKR,
1851264912Skevlo		    reg | R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M);
1852291698Savos		if (error != USB_ERR_NORMAL_COMPLETION)
1853291698Savos			return (EIO);
1854264912Skevlo	}
1855291698Savos
1856291698Savos	return (0);
1857264912Skevlo}
1858264912Skevlo
1859251538Srpaulostatic int
1860251538Srpaulourtwn_read_chipid(struct urtwn_softc *sc)
1861251538Srpaulo{
1862251538Srpaulo	uint32_t reg;
1863251538Srpaulo
1864264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
1865264912Skevlo		return (0);
1866264912Skevlo
1867251538Srpaulo	reg = urtwn_read_4(sc, R92C_SYS_CFG);
1868251538Srpaulo	if (reg & R92C_SYS_CFG_TRP_VAUX_EN)
1869251538Srpaulo		return (EIO);
1870251538Srpaulo
1871251538Srpaulo	if (reg & R92C_SYS_CFG_TYPE_92C) {
1872251538Srpaulo		sc->chip |= URTWN_CHIP_92C;
1873251538Srpaulo		/* Check if it is a castrated 8192C. */
1874251538Srpaulo		if (MS(urtwn_read_4(sc, R92C_HPON_FSM),
1875251538Srpaulo		    R92C_HPON_FSM_CHIP_BONDING_ID) ==
1876251538Srpaulo		    R92C_HPON_FSM_CHIP_BONDING_ID_92C_1T2R)
1877251538Srpaulo			sc->chip |= URTWN_CHIP_92C_1T2R;
1878251538Srpaulo	}
1879251538Srpaulo	if (reg & R92C_SYS_CFG_VENDOR_UMC) {
1880251538Srpaulo		sc->chip |= URTWN_CHIP_UMC;
1881251538Srpaulo		if (MS(reg, R92C_SYS_CFG_CHIP_VER_RTL) == 0)
1882251538Srpaulo			sc->chip |= URTWN_CHIP_UMC_A_CUT;
1883251538Srpaulo	}
1884251538Srpaulo	return (0);
1885251538Srpaulo}
1886251538Srpaulo
1887291264Savosstatic int
1888251538Srpaulourtwn_read_rom(struct urtwn_softc *sc)
1889251538Srpaulo{
1890291264Savos	struct r92c_rom *rom = &sc->rom.r92c_rom;
1891291264Savos	int error;
1892251538Srpaulo
1893251538Srpaulo	/* Read full ROM image. */
1894291264Savos	error = urtwn_efuse_read(sc, (uint8_t *)rom, sizeof(*rom));
1895291264Savos	if (error != 0)
1896291264Savos		return (error);
1897251538Srpaulo
1898251538Srpaulo	/* XXX Weird but this is what the vendor driver does. */
1899291264Savos	sc->last_rom_addr = 0x1fa;
1900291264Savos	error = urtwn_efuse_read_next(sc, &sc->pa_setting);
1901291264Savos	if (error != 0)
1902291264Savos		return (error);
1903294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "%s: PA setting=0x%x\n", __func__,
1904294471Savos	    sc->pa_setting);
1905251538Srpaulo
1906251538Srpaulo	sc->board_type = MS(rom->rf_opt1, R92C_ROM_RF1_BOARD_TYPE);
1907251538Srpaulo
1908251538Srpaulo	sc->regulatory = MS(rom->rf_opt1, R92C_ROM_RF1_REGULATORY);
1909294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "%s: regulatory type=%d\n",
1910294471Savos	    __func__, sc->regulatory);
1911287197Sglebius	IEEE80211_ADDR_COPY(sc->sc_ic.ic_macaddr, rom->macaddr);
1912251538Srpaulo
1913264912Skevlo	sc->sc_rf_write = urtwn_r92c_rf_write;
1914264912Skevlo	sc->sc_power_on = urtwn_r92c_power_on;
1915295874Savos	sc->sc_power_off = urtwn_r92c_power_off;
1916291264Savos
1917291264Savos	return (0);
1918251538Srpaulo}
1919251538Srpaulo
1920291264Savosstatic int
1921264912Skevlourtwn_r88e_read_rom(struct urtwn_softc *sc)
1922264912Skevlo{
1923294198Savos	struct r88e_rom *rom = &sc->rom.r88e_rom;
1924294198Savos	int error;
1925264912Skevlo
1926294198Savos	error = urtwn_efuse_read(sc, (uint8_t *)rom, sizeof(sc->rom.r88e_rom));
1927291264Savos	if (error != 0)
1928291264Savos		return (error);
1929264912Skevlo
1930294198Savos	sc->bw20_tx_pwr_diff = (rom->tx_pwr_diff >> 4);
1931264912Skevlo	if (sc->bw20_tx_pwr_diff & 0x08)
1932264912Skevlo		sc->bw20_tx_pwr_diff |= 0xf0;
1933294198Savos	sc->ofdm_tx_pwr_diff = (rom->tx_pwr_diff & 0xf);
1934264912Skevlo	if (sc->ofdm_tx_pwr_diff & 0x08)
1935264912Skevlo		sc->ofdm_tx_pwr_diff |= 0xf0;
1936294198Savos	sc->regulatory = MS(rom->rf_board_opt, R92C_ROM_RF1_REGULATORY);
1937294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "%s: regulatory type %d\n",
1938294471Savos	    __func__,sc->regulatory);
1939294198Savos	IEEE80211_ADDR_COPY(sc->sc_ic.ic_macaddr, rom->macaddr);
1940264912Skevlo
1941264912Skevlo	sc->sc_rf_write = urtwn_r88e_rf_write;
1942264912Skevlo	sc->sc_power_on = urtwn_r88e_power_on;
1943295874Savos	sc->sc_power_off = urtwn_r88e_power_off;
1944291264Savos
1945291264Savos	return (0);
1946264912Skevlo}
1947264912Skevlo
1948251538Srpaulo/*
1949251538Srpaulo * Initialize rate adaptation in firmware.
1950251538Srpaulo */
1951251538Srpaulostatic int
1952251538Srpaulourtwn_ra_init(struct urtwn_softc *sc)
1953251538Srpaulo{
1954287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
1955251538Srpaulo	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
1956251538Srpaulo	struct ieee80211_node *ni;
1957297175Sadrian	struct ieee80211_rateset *rs, *rs_ht;
1958251538Srpaulo	struct r92c_fw_cmd_macid_cfg cmd;
1959251538Srpaulo	uint32_t rates, basicrates;
1960251538Srpaulo	uint8_t mode;
1961251538Srpaulo	int maxrate, maxbasicrate, error, i, j;
1962251538Srpaulo
1963251538Srpaulo	ni = ieee80211_ref_node(vap->iv_bss);
1964251538Srpaulo	rs = &ni->ni_rates;
1965297175Sadrian	rs_ht = (struct ieee80211_rateset *) &ni->ni_htrates;
1966251538Srpaulo
1967251538Srpaulo	/* Get normal and basic rates mask. */
1968251538Srpaulo	rates = basicrates = 0;
1969251538Srpaulo	maxrate = maxbasicrate = 0;
1970297175Sadrian
1971297175Sadrian	/* This is for 11bg */
1972251538Srpaulo	for (i = 0; i < rs->rs_nrates; i++) {
1973251538Srpaulo		/* Convert 802.11 rate to HW rate index. */
1974289758Savos		for (j = 0; j < nitems(ridx2rate); j++)
1975289758Savos			if ((rs->rs_rates[i] & IEEE80211_RATE_VAL) ==
1976289758Savos			    ridx2rate[j])
1977251538Srpaulo				break;
1978289758Savos		if (j == nitems(ridx2rate))	/* Unknown rate, skip. */
1979251538Srpaulo			continue;
1980251538Srpaulo		rates |= 1 << j;
1981251538Srpaulo		if (j > maxrate)
1982251538Srpaulo			maxrate = j;
1983251538Srpaulo		if (rs->rs_rates[i] & IEEE80211_RATE_BASIC) {
1984251538Srpaulo			basicrates |= 1 << j;
1985251538Srpaulo			if (j > maxbasicrate)
1986251538Srpaulo				maxbasicrate = j;
1987251538Srpaulo		}
1988251538Srpaulo	}
1989297175Sadrian
1990297175Sadrian	/* If we're doing 11n, enable 11n rates */
1991297175Sadrian	if (ni->ni_flags & IEEE80211_NODE_HT) {
1992297175Sadrian		for (i = 0; i < rs_ht->rs_nrates; i++) {
1993297175Sadrian			if ((rs_ht->rs_rates[i] & 0x7f) > 0xf)
1994297175Sadrian				continue;
1995297175Sadrian			/* 11n rates start at index 12 */
1996297175Sadrian			j = ((rs_ht->rs_rates[i]) & 0xf) + 12;
1997297175Sadrian			rates |= (1 << j);
1998297175Sadrian
1999297175Sadrian			/* Guard against the rate table being oddly ordered */
2000297175Sadrian			if (j > maxrate)
2001297175Sadrian				maxrate = j;
2002297175Sadrian		}
2003297175Sadrian	}
2004297175Sadrian
2005297175Sadrian#if 0
2006297175Sadrian	if (ic->ic_curmode == IEEE80211_MODE_11NG)
2007297175Sadrian		raid = R92C_RAID_11GN;
2008297175Sadrian#endif
2009297175Sadrian	/* NB: group addressed frames are done at 11bg rates for now */
2010251538Srpaulo	if (ic->ic_curmode == IEEE80211_MODE_11B)
2011251538Srpaulo		mode = R92C_RAID_11B;
2012251538Srpaulo	else
2013251538Srpaulo		mode = R92C_RAID_11BG;
2014297175Sadrian	/* XXX misleading 'mode' value here for unicast frames */
2015294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_RA,
2016294471Savos	    "%s: mode 0x%x, rates 0x%08x, basicrates 0x%08x\n", __func__,
2017251538Srpaulo	    mode, rates, basicrates);
2018251538Srpaulo
2019251538Srpaulo	/* Set rates mask for group addressed frames. */
2020251538Srpaulo	cmd.macid = URTWN_MACID_BC | URTWN_MACID_VALID;
2021251538Srpaulo	cmd.mask = htole32(mode << 28 | basicrates);
2022251538Srpaulo	error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd));
2023251538Srpaulo	if (error != 0) {
2024252401Srpaulo		ieee80211_free_node(ni);
2025251538Srpaulo		device_printf(sc->sc_dev,
2026251538Srpaulo		    "could not add broadcast station\n");
2027251538Srpaulo		return (error);
2028251538Srpaulo	}
2029297175Sadrian
2030251538Srpaulo	/* Set initial MRR rate. */
2031294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_RA, "%s: maxbasicrate %d\n", __func__,
2032294471Savos	    maxbasicrate);
2033251538Srpaulo	urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BC),
2034251538Srpaulo	    maxbasicrate);
2035251538Srpaulo
2036251538Srpaulo	/* Set rates mask for unicast frames. */
2037297175Sadrian	if (ni->ni_flags & IEEE80211_NODE_HT)
2038297175Sadrian		mode = R92C_RAID_11GN;
2039297175Sadrian	else if (ic->ic_curmode == IEEE80211_MODE_11B)
2040297175Sadrian		mode = R92C_RAID_11B;
2041297175Sadrian	else
2042297175Sadrian		mode = R92C_RAID_11BG;
2043251538Srpaulo	cmd.macid = URTWN_MACID_BSS | URTWN_MACID_VALID;
2044251538Srpaulo	cmd.mask = htole32(mode << 28 | rates);
2045251538Srpaulo	error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd));
2046251538Srpaulo	if (error != 0) {
2047252401Srpaulo		ieee80211_free_node(ni);
2048251538Srpaulo		device_printf(sc->sc_dev, "could not add BSS station\n");
2049251538Srpaulo		return (error);
2050251538Srpaulo	}
2051251538Srpaulo	/* Set initial MRR rate. */
2052294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_RA, "%s: maxrate %d\n", __func__,
2053294471Savos	    maxrate);
2054251538Srpaulo	urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BSS),
2055251538Srpaulo	    maxrate);
2056251538Srpaulo
2057251538Srpaulo	/* Indicate highest supported rate. */
2058297175Sadrian	if (ni->ni_flags & IEEE80211_NODE_HT)
2059297175Sadrian		ni->ni_txrate = rs_ht->rs_rates[rs_ht->rs_nrates - 1]
2060297175Sadrian		    | IEEE80211_RATE_MCS;
2061297175Sadrian	else
2062297175Sadrian		ni->ni_txrate = rs->rs_rates[rs->rs_nrates - 1];
2063252401Srpaulo	ieee80211_free_node(ni);
2064252401Srpaulo
2065251538Srpaulo	return (0);
2066251538Srpaulo}
2067251538Srpaulo
2068290439Savosstatic void
2069290631Savosurtwn_init_beacon(struct urtwn_softc *sc, struct urtwn_vap *uvp)
2070251538Srpaulo{
2071290631Savos	struct r92c_tx_desc *txd = &uvp->bcn_desc;
2072290631Savos
2073290631Savos	txd->txdw0 = htole32(
2074290631Savos	    SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | R92C_TXDW0_BMCAST |
2075290631Savos	    R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG);
2076290631Savos	txd->txdw1 = htole32(
2077290631Savos	    SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_BEACON) |
2078290631Savos	    SM(R92C_TXDW1_RAID, R92C_RAID_11B));
2079290631Savos
2080291858Savos	if (sc->chip & URTWN_CHIP_88E) {
2081290631Savos		txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, URTWN_MACID_BC));
2082291858Savos		txd->txdseq |= htole16(R88E_TXDSEQ_HWSEQ_EN);
2083291858Savos	} else {
2084290631Savos		txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, URTWN_MACID_BC));
2085291858Savos		txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN);
2086291858Savos	}
2087290631Savos
2088290631Savos	txd->txdw4 = htole32(R92C_TXDW4_DRVRATE);
2089290631Savos	txd->txdw5 = htole32(SM(R92C_TXDW5_DATARATE, URTWN_RIDX_CCK1));
2090251538Srpaulo}
2091251538Srpaulo
2092290631Savosstatic int
2093290631Savosurtwn_setup_beacon(struct urtwn_softc *sc, struct ieee80211_node *ni)
2094290631Savos{
2095290631Savos 	struct ieee80211vap *vap = ni->ni_vap;
2096290631Savos	struct urtwn_vap *uvp = URTWN_VAP(vap);
2097290631Savos	struct mbuf *m;
2098290631Savos	int error;
2099290631Savos
2100290631Savos	URTWN_ASSERT_LOCKED(sc);
2101290631Savos
2102290631Savos	if (ni->ni_chan == IEEE80211_CHAN_ANYC)
2103290631Savos		return (EINVAL);
2104290631Savos
2105290631Savos	m = ieee80211_beacon_alloc(ni);
2106290631Savos	if (m == NULL) {
2107290631Savos		device_printf(sc->sc_dev,
2108290631Savos		    "%s: could not allocate beacon frame\n", __func__);
2109290631Savos		return (ENOMEM);
2110290631Savos	}
2111290631Savos
2112290631Savos	if (uvp->bcn_mbuf != NULL)
2113290631Savos		m_freem(uvp->bcn_mbuf);
2114290631Savos
2115290631Savos	uvp->bcn_mbuf = m;
2116290631Savos
2117290631Savos	if ((error = urtwn_tx_beacon(sc, uvp)) != 0)
2118290631Savos		return (error);
2119290631Savos
2120290631Savos	/* XXX bcnq stuck workaround */
2121290631Savos	if ((error = urtwn_tx_beacon(sc, uvp)) != 0)
2122290631Savos		return (error);
2123290631Savos
2124294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_BEACON, "%s: beacon was %srecognized\n",
2125294471Savos	    __func__, urtwn_read_1(sc, R92C_TDECTRL + 2) &
2126294471Savos	    (R92C_TDECTRL_BCN_VALID >> 16) ? "" : "not ");
2127294471Savos
2128290631Savos	return (0);
2129290631Savos}
2130290631Savos
2131251538Srpaulostatic void
2132290631Savosurtwn_update_beacon(struct ieee80211vap *vap, int item)
2133290631Savos{
2134290631Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2135290631Savos	struct urtwn_vap *uvp = URTWN_VAP(vap);
2136290631Savos	struct ieee80211_beacon_offsets *bo = &vap->iv_bcn_off;
2137290631Savos	struct ieee80211_node *ni = vap->iv_bss;
2138290631Savos	int mcast = 0;
2139290631Savos
2140290631Savos	URTWN_LOCK(sc);
2141290631Savos	if (uvp->bcn_mbuf == NULL) {
2142290631Savos		uvp->bcn_mbuf = ieee80211_beacon_alloc(ni);
2143290631Savos		if (uvp->bcn_mbuf == NULL) {
2144290631Savos			device_printf(sc->sc_dev,
2145290631Savos			    "%s: could not allocate beacon frame\n", __func__);
2146290631Savos			URTWN_UNLOCK(sc);
2147290631Savos			return;
2148290631Savos		}
2149290631Savos	}
2150290631Savos	URTWN_UNLOCK(sc);
2151290631Savos
2152290631Savos	if (item == IEEE80211_BEACON_TIM)
2153290631Savos		mcast = 1;	/* XXX */
2154290631Savos
2155290631Savos	setbit(bo->bo_flags, item);
2156290631Savos	ieee80211_beacon_update(ni, uvp->bcn_mbuf, mcast);
2157290631Savos
2158290631Savos	URTWN_LOCK(sc);
2159290631Savos	urtwn_tx_beacon(sc, uvp);
2160290631Savos	URTWN_UNLOCK(sc);
2161290631Savos}
2162290631Savos
2163290631Savos/*
2164290631Savos * Push a beacon frame into the chip. Beacon will
2165290631Savos * be repeated by the chip every R92C_BCN_INTERVAL.
2166290631Savos */
2167290631Savosstatic int
2168290631Savosurtwn_tx_beacon(struct urtwn_softc *sc, struct urtwn_vap *uvp)
2169290631Savos{
2170290631Savos	struct r92c_tx_desc *desc = &uvp->bcn_desc;
2171290631Savos	struct urtwn_data *bf;
2172290631Savos
2173290631Savos	URTWN_ASSERT_LOCKED(sc);
2174290631Savos
2175290631Savos	bf = urtwn_getbuf(sc);
2176290631Savos	if (bf == NULL)
2177290631Savos		return (ENOMEM);
2178290631Savos
2179290631Savos	memcpy(bf->buf, desc, sizeof(*desc));
2180290631Savos	urtwn_tx_start(sc, uvp->bcn_mbuf, IEEE80211_FC0_TYPE_MGT, bf);
2181290631Savos
2182290631Savos	sc->sc_txtimer = 5;
2183290631Savos	callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
2184290631Savos
2185290631Savos	return (0);
2186290631Savos}
2187290631Savos
2188292175Savosstatic int
2189292175Savosurtwn_key_alloc(struct ieee80211vap *vap, struct ieee80211_key *k,
2190292175Savos    ieee80211_keyix *keyix, ieee80211_keyix *rxkeyix)
2191292175Savos{
2192292175Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2193292175Savos	uint8_t i;
2194292175Savos
2195292175Savos	if (!(&vap->iv_nw_keys[0] <= k &&
2196292175Savos	     k < &vap->iv_nw_keys[IEEE80211_WEP_NKID])) {
2197292175Savos		if (!(k->wk_flags & IEEE80211_KEY_SWCRYPT)) {
2198292175Savos			URTWN_LOCK(sc);
2199292175Savos			/*
2200292175Savos			 * First 4 slots for group keys,
2201292175Savos			 * what is left - for pairwise.
2202292175Savos			 * XXX incompatible with IBSS RSN.
2203292175Savos			 */
2204292175Savos			for (i = IEEE80211_WEP_NKID;
2205292175Savos			     i < R92C_CAM_ENTRY_COUNT; i++) {
2206292175Savos				if ((sc->keys_bmap & (1 << i)) == 0) {
2207292175Savos					sc->keys_bmap |= 1 << i;
2208292175Savos					*keyix = i;
2209292175Savos					break;
2210292175Savos				}
2211292175Savos			}
2212292175Savos			URTWN_UNLOCK(sc);
2213292175Savos			if (i == R92C_CAM_ENTRY_COUNT) {
2214292175Savos				device_printf(sc->sc_dev,
2215292175Savos				    "%s: no free space in the key table\n",
2216292175Savos				    __func__);
2217292175Savos				return 0;
2218292175Savos			}
2219292175Savos		} else
2220292175Savos			*keyix = 0;
2221292175Savos	} else {
2222292175Savos		*keyix = k - vap->iv_nw_keys;
2223292175Savos	}
2224292175Savos	*rxkeyix = *keyix;
2225292175Savos	return 1;
2226292175Savos}
2227292175Savos
2228290631Savosstatic void
2229292175Savosurtwn_key_set_cb(struct urtwn_softc *sc, union sec_param *data)
2230292175Savos{
2231292175Savos	struct ieee80211_key *k = &data->key;
2232292175Savos	uint8_t algo, keyid;
2233292175Savos	int i, error;
2234292175Savos
2235292175Savos	if (k->wk_keyix < IEEE80211_WEP_NKID)
2236292175Savos		keyid = k->wk_keyix;
2237292175Savos	else
2238292175Savos		keyid = 0;
2239292175Savos
2240292175Savos	/* Map net80211 cipher to HW crypto algorithm. */
2241292175Savos	switch (k->wk_cipher->ic_cipher) {
2242292175Savos	case IEEE80211_CIPHER_WEP:
2243292175Savos		if (k->wk_keylen < 8)
2244292175Savos			algo = R92C_CAM_ALGO_WEP40;
2245292175Savos		else
2246292175Savos			algo = R92C_CAM_ALGO_WEP104;
2247292175Savos		break;
2248292175Savos	case IEEE80211_CIPHER_TKIP:
2249292175Savos		algo = R92C_CAM_ALGO_TKIP;
2250292175Savos		break;
2251292175Savos	case IEEE80211_CIPHER_AES_CCM:
2252292175Savos		algo = R92C_CAM_ALGO_AES;
2253292175Savos		break;
2254292175Savos	default:
2255292175Savos		device_printf(sc->sc_dev, "%s: undefined cipher %d\n",
2256292175Savos		    __func__, k->wk_cipher->ic_cipher);
2257292175Savos		return;
2258292175Savos	}
2259292175Savos
2260294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_KEY,
2261294471Savos	    "%s: keyix %d, keyid %d, algo %d/%d, flags %04X, len %d, "
2262294471Savos	    "macaddr %s\n", __func__, k->wk_keyix, keyid,
2263294471Savos	    k->wk_cipher->ic_cipher, algo, k->wk_flags, k->wk_keylen,
2264294471Savos	    ether_sprintf(k->wk_macaddr));
2265292175Savos
2266292175Savos	/* Write key. */
2267292175Savos	for (i = 0; i < 4; i++) {
2268292175Savos		error = urtwn_cam_write(sc, R92C_CAM_KEY(k->wk_keyix, i),
2269292175Savos		    LE_READ_4(&k->wk_key[i * 4]));
2270292175Savos		if (error != 0)
2271292175Savos			goto fail;
2272292175Savos	}
2273292175Savos
2274292175Savos	/* Write CTL0 last since that will validate the CAM entry. */
2275292175Savos	error = urtwn_cam_write(sc, R92C_CAM_CTL1(k->wk_keyix),
2276292175Savos	    LE_READ_4(&k->wk_macaddr[2]));
2277292175Savos	if (error != 0)
2278292175Savos		goto fail;
2279292175Savos	error = urtwn_cam_write(sc, R92C_CAM_CTL0(k->wk_keyix),
2280292175Savos	    SM(R92C_CAM_ALGO, algo) |
2281292175Savos	    SM(R92C_CAM_KEYID, keyid) |
2282292175Savos	    SM(R92C_CAM_MACLO, LE_READ_2(&k->wk_macaddr[0])) |
2283292175Savos	    R92C_CAM_VALID);
2284292175Savos	if (error != 0)
2285292175Savos		goto fail;
2286292175Savos
2287292175Savos	return;
2288292175Savos
2289292175Savosfail:
2290292175Savos	device_printf(sc->sc_dev, "%s fails, error %d\n", __func__, error);
2291292175Savos}
2292292175Savos
2293292175Savosstatic void
2294292175Savosurtwn_key_del_cb(struct urtwn_softc *sc, union sec_param *data)
2295292175Savos{
2296292175Savos	struct ieee80211_key *k = &data->key;
2297292175Savos	int i;
2298292175Savos
2299294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_KEY,
2300294471Savos	    "%s: keyix %d, flags %04X, macaddr %s\n", __func__,
2301292175Savos	    k->wk_keyix, k->wk_flags, ether_sprintf(k->wk_macaddr));
2302292175Savos
2303292175Savos	urtwn_cam_write(sc, R92C_CAM_CTL0(k->wk_keyix), 0);
2304292175Savos	urtwn_cam_write(sc, R92C_CAM_CTL1(k->wk_keyix), 0);
2305292175Savos
2306292175Savos	/* Clear key. */
2307292175Savos	for (i = 0; i < 4; i++)
2308292175Savos		urtwn_cam_write(sc, R92C_CAM_KEY(k->wk_keyix, i), 0);
2309292175Savos	sc->keys_bmap &= ~(1 << k->wk_keyix);
2310292175Savos}
2311292175Savos
2312292175Savosstatic int
2313292175Savosurtwn_key_set(struct ieee80211vap *vap, const struct ieee80211_key *k)
2314292175Savos{
2315292175Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2316292175Savos
2317292175Savos	if (k->wk_flags & IEEE80211_KEY_SWCRYPT) {
2318292175Savos		/* Not for us. */
2319292175Savos		return (1);
2320292175Savos	}
2321292175Savos
2322292175Savos	return (!urtwn_cmd_sleepable(sc, k, sizeof(*k), urtwn_key_set_cb));
2323292175Savos}
2324292175Savos
2325292175Savosstatic int
2326292175Savosurtwn_key_delete(struct ieee80211vap *vap, const struct ieee80211_key *k)
2327292175Savos{
2328292175Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2329292175Savos
2330292175Savos	if (k->wk_flags & IEEE80211_KEY_SWCRYPT) {
2331292175Savos		/* Not for us. */
2332292175Savos		return (1);
2333292175Savos	}
2334292175Savos
2335292175Savos	return (!urtwn_cmd_sleepable(sc, k, sizeof(*k), urtwn_key_del_cb));
2336292175Savos}
2337292175Savos
2338292175Savosstatic void
2339290651Savosurtwn_tsf_task_adhoc(void *arg, int pending)
2340290651Savos{
2341290651Savos	struct ieee80211vap *vap = arg;
2342290651Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2343290651Savos	struct ieee80211_node *ni;
2344290651Savos	uint32_t reg;
2345290651Savos
2346290651Savos	URTWN_LOCK(sc);
2347290651Savos	ni = ieee80211_ref_node(vap->iv_bss);
2348290651Savos	reg = urtwn_read_1(sc, R92C_BCN_CTRL);
2349290651Savos
2350290651Savos	/* Accept beacons with the same BSSID. */
2351290651Savos	urtwn_set_rx_bssid_all(sc, 0);
2352290651Savos
2353290651Savos	/* Enable synchronization. */
2354290651Savos	reg &= ~R92C_BCN_CTRL_DIS_TSF_UDT0;
2355290651Savos	urtwn_write_1(sc, R92C_BCN_CTRL, reg);
2356290651Savos
2357290651Savos	/* Synchronize. */
2358290651Savos	usb_pause_mtx(&sc->sc_mtx, hz * ni->ni_intval * 5 / 1000);
2359290651Savos
2360290651Savos	/* Disable synchronization. */
2361290651Savos	reg |= R92C_BCN_CTRL_DIS_TSF_UDT0;
2362290651Savos	urtwn_write_1(sc, R92C_BCN_CTRL, reg);
2363290651Savos
2364290651Savos	/* Remove beacon filter. */
2365290651Savos	urtwn_set_rx_bssid_all(sc, 1);
2366290651Savos
2367290651Savos	/* Enable beaconing. */
2368290651Savos	urtwn_write_1(sc, R92C_MBID_NUM,
2369290651Savos	    urtwn_read_1(sc, R92C_MBID_NUM) | R92C_MBID_TXBCN_RPT0);
2370290651Savos	reg |= R92C_BCN_CTRL_EN_BCN;
2371290651Savos
2372290651Savos	urtwn_write_1(sc, R92C_BCN_CTRL, reg);
2373290651Savos	ieee80211_free_node(ni);
2374290651Savos	URTWN_UNLOCK(sc);
2375290651Savos}
2376290651Savos
2377290651Savosstatic void
2378290631Savosurtwn_tsf_sync_enable(struct urtwn_softc *sc, struct ieee80211vap *vap)
2379290631Savos{
2380290651Savos	struct ieee80211com *ic = &sc->sc_ic;
2381290651Savos	struct urtwn_vap *uvp = URTWN_VAP(vap);
2382290651Savos
2383290631Savos	/* Reset TSF. */
2384290631Savos	urtwn_write_1(sc, R92C_DUAL_TSF_RST, R92C_DUAL_TSF_RST0);
2385290631Savos
2386290631Savos	switch (vap->iv_opmode) {
2387290631Savos	case IEEE80211_M_STA:
2388290631Savos		/* Enable TSF synchronization. */
2389290631Savos		urtwn_write_1(sc, R92C_BCN_CTRL,
2390290631Savos		    urtwn_read_1(sc, R92C_BCN_CTRL) &
2391290631Savos		    ~R92C_BCN_CTRL_DIS_TSF_UDT0);
2392290631Savos		break;
2393290651Savos	case IEEE80211_M_IBSS:
2394290651Savos		ieee80211_runtask(ic, &uvp->tsf_task_adhoc);
2395290651Savos		break;
2396290631Savos	case IEEE80211_M_HOSTAP:
2397290631Savos		/* Enable beaconing. */
2398290631Savos		urtwn_write_1(sc, R92C_MBID_NUM,
2399290631Savos		    urtwn_read_1(sc, R92C_MBID_NUM) | R92C_MBID_TXBCN_RPT0);
2400290631Savos		urtwn_write_1(sc, R92C_BCN_CTRL,
2401290631Savos		    urtwn_read_1(sc, R92C_BCN_CTRL) | R92C_BCN_CTRL_EN_BCN);
2402290631Savos		break;
2403290631Savos	default:
2404290631Savos		device_printf(sc->sc_dev, "undefined opmode %d\n",
2405290631Savos		    vap->iv_opmode);
2406290631Savos		return;
2407290631Savos	}
2408290631Savos}
2409290631Savos
2410290631Savosstatic void
2411292203Savosurtwn_get_tsf(struct urtwn_softc *sc, uint64_t *buf)
2412292203Savos{
2413292203Savos	urtwn_read_region_1(sc, R92C_TSFTR, (uint8_t *)buf, sizeof(*buf));
2414292203Savos}
2415292203Savos
2416292203Savosstatic void
2417251538Srpaulourtwn_set_led(struct urtwn_softc *sc, int led, int on)
2418251538Srpaulo{
2419251538Srpaulo	uint8_t reg;
2420281069Srpaulo
2421251538Srpaulo	if (led == URTWN_LED_LINK) {
2422264912Skevlo		if (sc->chip & URTWN_CHIP_88E) {
2423264912Skevlo			reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0xf0;
2424264912Skevlo			urtwn_write_1(sc, R92C_LEDCFG2, reg | 0x60);
2425264912Skevlo			if (!on) {
2426264912Skevlo				reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0x90;
2427264912Skevlo				urtwn_write_1(sc, R92C_LEDCFG2,
2428264912Skevlo				    reg | R92C_LEDCFG0_DIS);
2429264912Skevlo				urtwn_write_1(sc, R92C_MAC_PINMUX_CFG,
2430264912Skevlo				    urtwn_read_1(sc, R92C_MAC_PINMUX_CFG) &
2431264912Skevlo				    0xfe);
2432264912Skevlo			}
2433264912Skevlo		} else {
2434264912Skevlo			reg = urtwn_read_1(sc, R92C_LEDCFG0) & 0x70;
2435264912Skevlo			if (!on)
2436264912Skevlo				reg |= R92C_LEDCFG0_DIS;
2437264912Skevlo			urtwn_write_1(sc, R92C_LEDCFG0, reg);
2438264912Skevlo		}
2439264912Skevlo		sc->ledlink = on;       /* Save LED state. */
2440251538Srpaulo	}
2441251538Srpaulo}
2442251538Srpaulo
2443289811Savosstatic void
2444289811Savosurtwn_set_mode(struct urtwn_softc *sc, uint8_t mode)
2445289811Savos{
2446289811Savos	uint8_t reg;
2447289811Savos
2448289811Savos	reg = urtwn_read_1(sc, R92C_MSR);
2449289811Savos	reg = (reg & ~R92C_MSR_MASK) | mode;
2450289811Savos	urtwn_write_1(sc, R92C_MSR, reg);
2451289811Savos}
2452289811Savos
2453290651Savosstatic void
2454290651Savosurtwn_ibss_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m, int subtype,
2455290651Savos    const struct ieee80211_rx_stats *rxs,
2456290651Savos    int rssi, int nf)
2457290651Savos{
2458290651Savos	struct ieee80211vap *vap = ni->ni_vap;
2459290651Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2460290651Savos	struct urtwn_vap *uvp = URTWN_VAP(vap);
2461290651Savos	uint64_t ni_tstamp, curr_tstamp;
2462290651Savos
2463290651Savos	uvp->recv_mgmt(ni, m, subtype, rxs, rssi, nf);
2464290651Savos
2465290651Savos	if (vap->iv_state == IEEE80211_S_RUN &&
2466290651Savos	    (subtype == IEEE80211_FC0_SUBTYPE_BEACON ||
2467290651Savos	    subtype == IEEE80211_FC0_SUBTYPE_PROBE_RESP)) {
2468290651Savos		ni_tstamp = le64toh(ni->ni_tstamp.tsf);
2469290651Savos		URTWN_LOCK(sc);
2470290651Savos		urtwn_get_tsf(sc, &curr_tstamp);
2471290651Savos		URTWN_UNLOCK(sc);
2472290651Savos		curr_tstamp = le64toh(curr_tstamp);
2473290651Savos
2474290651Savos		if (ni_tstamp >= curr_tstamp)
2475290651Savos			(void) ieee80211_ibss_merge(ni);
2476290651Savos	}
2477290651Savos}
2478290651Savos
2479251538Srpaulostatic int
2480251538Srpaulourtwn_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg)
2481251538Srpaulo{
2482251538Srpaulo	struct urtwn_vap *uvp = URTWN_VAP(vap);
2483251538Srpaulo	struct ieee80211com *ic = vap->iv_ic;
2484286949Sadrian	struct urtwn_softc *sc = ic->ic_softc;
2485251538Srpaulo	struct ieee80211_node *ni;
2486251538Srpaulo	enum ieee80211_state ostate;
2487290631Savos	uint32_t reg;
2488290631Savos	uint8_t mode;
2489290631Savos	int error = 0;
2490251538Srpaulo
2491251538Srpaulo	ostate = vap->iv_state;
2492294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_STATE, "%s -> %s\n",
2493294471Savos	    ieee80211_state_name[ostate], ieee80211_state_name[nstate]);
2494251538Srpaulo
2495251538Srpaulo	IEEE80211_UNLOCK(ic);
2496251538Srpaulo	URTWN_LOCK(sc);
2497251538Srpaulo	callout_stop(&sc->sc_watchdog_ch);
2498251538Srpaulo
2499251538Srpaulo	if (ostate == IEEE80211_S_RUN) {
2500294473Savos		/* Stop calibration. */
2501294473Savos		callout_stop(&sc->sc_calib_to);
2502294473Savos
2503251538Srpaulo		/* Turn link LED off. */
2504251538Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, 0);
2505251538Srpaulo
2506251538Srpaulo		/* Set media status to 'No Link'. */
2507289811Savos		urtwn_set_mode(sc, R92C_MSR_NOLINK);
2508251538Srpaulo
2509251538Srpaulo		/* Stop Rx of data frames. */
2510251538Srpaulo		urtwn_write_2(sc, R92C_RXFLTMAP2, 0);
2511251538Srpaulo
2512251538Srpaulo		/* Disable TSF synchronization. */
2513251538Srpaulo		urtwn_write_1(sc, R92C_BCN_CTRL,
2514290631Savos		    (urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_EN_BCN) |
2515251538Srpaulo		    R92C_BCN_CTRL_DIS_TSF_UDT0);
2516251538Srpaulo
2517290631Savos		/* Disable beaconing. */
2518290631Savos		urtwn_write_1(sc, R92C_MBID_NUM,
2519290631Savos		    urtwn_read_1(sc, R92C_MBID_NUM) & ~R92C_MBID_TXBCN_RPT0);
2520290631Savos
2521290631Savos		/* Reset TSF. */
2522290631Savos		urtwn_write_1(sc, R92C_DUAL_TSF_RST, R92C_DUAL_TSF_RST0);
2523290631Savos
2524251538Srpaulo		/* Reset EDCA parameters. */
2525251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002f3217);
2526251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005e4317);
2527251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x00105320);
2528251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a444);
2529251538Srpaulo	}
2530251538Srpaulo
2531251538Srpaulo	switch (nstate) {
2532251538Srpaulo	case IEEE80211_S_INIT:
2533251538Srpaulo		/* Turn link LED off. */
2534251538Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, 0);
2535251538Srpaulo		break;
2536251538Srpaulo	case IEEE80211_S_SCAN:
2537251538Srpaulo		/* Pause AC Tx queues. */
2538251538Srpaulo		urtwn_write_1(sc, R92C_TXPAUSE,
2539293180Savos		    urtwn_read_1(sc, R92C_TXPAUSE) | R92C_TX_QUEUE_AC);
2540251538Srpaulo		break;
2541251538Srpaulo	case IEEE80211_S_AUTH:
2542251538Srpaulo		urtwn_set_chan(sc, ic->ic_curchan, NULL);
2543251538Srpaulo		break;
2544251538Srpaulo	case IEEE80211_S_RUN:
2545251538Srpaulo		if (vap->iv_opmode == IEEE80211_M_MONITOR) {
2546251538Srpaulo			/* Turn link LED on. */
2547251538Srpaulo			urtwn_set_led(sc, URTWN_LED_LINK, 1);
2548251538Srpaulo			break;
2549251538Srpaulo		}
2550251538Srpaulo
2551251538Srpaulo		ni = ieee80211_ref_node(vap->iv_bss);
2552290631Savos
2553290631Savos		if (ic->ic_bsschan == IEEE80211_CHAN_ANYC ||
2554290631Savos		    ni->ni_chan == IEEE80211_CHAN_ANYC) {
2555290631Savos			device_printf(sc->sc_dev,
2556290631Savos			    "%s: could not move to RUN state\n", __func__);
2557290631Savos			error = EINVAL;
2558290631Savos			goto end_run;
2559290631Savos		}
2560290631Savos
2561290631Savos		switch (vap->iv_opmode) {
2562290631Savos		case IEEE80211_M_STA:
2563290631Savos			mode = R92C_MSR_INFRA;
2564290631Savos			break;
2565290651Savos		case IEEE80211_M_IBSS:
2566290651Savos			mode = R92C_MSR_ADHOC;
2567290651Savos			break;
2568290631Savos		case IEEE80211_M_HOSTAP:
2569290631Savos			mode = R92C_MSR_AP;
2570290631Savos			break;
2571290631Savos		default:
2572290631Savos			device_printf(sc->sc_dev, "undefined opmode %d\n",
2573290631Savos			    vap->iv_opmode);
2574290631Savos			error = EINVAL;
2575290631Savos			goto end_run;
2576290631Savos		}
2577290631Savos
2578251538Srpaulo		/* Set media status to 'Associated'. */
2579290631Savos		urtwn_set_mode(sc, mode);
2580251538Srpaulo
2581251538Srpaulo		/* Set BSSID. */
2582251538Srpaulo		urtwn_write_4(sc, R92C_BSSID + 0, LE_READ_4(&ni->ni_bssid[0]));
2583251538Srpaulo		urtwn_write_4(sc, R92C_BSSID + 4, LE_READ_2(&ni->ni_bssid[4]));
2584251538Srpaulo
2585251538Srpaulo		if (ic->ic_curmode == IEEE80211_MODE_11B)
2586251538Srpaulo			urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 0);
2587251538Srpaulo		else	/* 802.11b/g */
2588251538Srpaulo			urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 3);
2589251538Srpaulo
2590251538Srpaulo		/* Enable Rx of data frames. */
2591251538Srpaulo		urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff);
2592251538Srpaulo
2593251538Srpaulo		/* Flush all AC queues. */
2594251538Srpaulo		urtwn_write_1(sc, R92C_TXPAUSE, 0);
2595251538Srpaulo
2596251538Srpaulo		/* Set beacon interval. */
2597251538Srpaulo		urtwn_write_2(sc, R92C_BCN_INTERVAL, ni->ni_intval);
2598251538Srpaulo
2599251538Srpaulo		/* Allow Rx from our BSSID only. */
2600290564Savos		if (ic->ic_promisc == 0) {
2601290631Savos			reg = urtwn_read_4(sc, R92C_RCR);
2602290631Savos
2603290631Savos			if (vap->iv_opmode != IEEE80211_M_HOSTAP)
2604290631Savos				reg |= R92C_RCR_CBSSID_DATA;
2605290651Savos			if (vap->iv_opmode != IEEE80211_M_IBSS)
2606290651Savos				reg |= R92C_RCR_CBSSID_BCN;
2607290631Savos
2608290631Savos			urtwn_write_4(sc, R92C_RCR, reg);
2609290564Savos		}
2610251538Srpaulo
2611290651Savos		if (vap->iv_opmode == IEEE80211_M_HOSTAP ||
2612290651Savos		    vap->iv_opmode == IEEE80211_M_IBSS) {
2613290631Savos			error = urtwn_setup_beacon(sc, ni);
2614290631Savos			if (error != 0) {
2615290631Savos				device_printf(sc->sc_dev,
2616290631Savos				    "unable to push beacon into the chip, "
2617290631Savos				    "error %d\n", error);
2618290631Savos				goto end_run;
2619290631Savos			}
2620290631Savos		}
2621290631Savos
2622251538Srpaulo		/* Enable TSF synchronization. */
2623290631Savos		urtwn_tsf_sync_enable(sc, vap);
2624251538Srpaulo
2625251538Srpaulo		urtwn_write_1(sc, R92C_SIFS_CCK + 1, 10);
2626251538Srpaulo		urtwn_write_1(sc, R92C_SIFS_OFDM + 1, 10);
2627251538Srpaulo		urtwn_write_1(sc, R92C_SPEC_SIFS + 1, 10);
2628251538Srpaulo		urtwn_write_1(sc, R92C_MAC_SPEC_SIFS + 1, 10);
2629251538Srpaulo		urtwn_write_1(sc, R92C_R2T_SIFS + 1, 10);
2630251538Srpaulo		urtwn_write_1(sc, R92C_T2T_SIFS + 1, 10);
2631251538Srpaulo
2632251538Srpaulo		/* Intialize rate adaptation. */
2633292167Savos		if (!(sc->chip & URTWN_CHIP_88E))
2634264912Skevlo			urtwn_ra_init(sc);
2635251538Srpaulo		/* Turn link LED on. */
2636251538Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, 1);
2637251538Srpaulo
2638251538Srpaulo		sc->avg_pwdb = -1;	/* Reset average RSSI. */
2639251538Srpaulo		/* Reset temperature calibration state machine. */
2640294473Savos		sc->sc_flags &= ~URTWN_TEMP_MEASURED;
2641251538Srpaulo		sc->thcal_lctemp = 0;
2642294473Savos		/* Start periodic calibration. */
2643294473Savos		callout_reset(&sc->sc_calib_to, 2*hz, urtwn_calib_to, sc);
2644290631Savos
2645290631Savosend_run:
2646251538Srpaulo		ieee80211_free_node(ni);
2647251538Srpaulo		break;
2648251538Srpaulo	default:
2649251538Srpaulo		break;
2650251538Srpaulo	}
2651290631Savos
2652251538Srpaulo	URTWN_UNLOCK(sc);
2653251538Srpaulo	IEEE80211_LOCK(ic);
2654290631Savos	return (error != 0 ? error : uvp->newstate(vap, nstate, arg));
2655251538Srpaulo}
2656251538Srpaulo
2657251538Srpaulostatic void
2658294473Savosurtwn_calib_to(void *arg)
2659294473Savos{
2660294473Savos	struct urtwn_softc *sc = arg;
2661294473Savos
2662294473Savos	/* Do it in a process context. */
2663294473Savos	urtwn_cmd_sleepable(sc, NULL, 0, urtwn_calib_cb);
2664294473Savos}
2665294473Savos
2666294473Savosstatic void
2667294473Savosurtwn_calib_cb(struct urtwn_softc *sc, union sec_param *data)
2668294473Savos{
2669294473Savos	/* Do temperature compensation. */
2670294473Savos	urtwn_temp_calib(sc);
2671294473Savos
2672294473Savos	if ((urtwn_read_1(sc, R92C_MSR) & R92C_MSR_MASK) != R92C_MSR_NOLINK)
2673294473Savos		callout_reset(&sc->sc_calib_to, 2*hz, urtwn_calib_to, sc);
2674294473Savos}
2675294473Savos
2676294473Savosstatic void
2677251538Srpaulourtwn_watchdog(void *arg)
2678251538Srpaulo{
2679251538Srpaulo	struct urtwn_softc *sc = arg;
2680251538Srpaulo
2681251538Srpaulo	if (sc->sc_txtimer > 0) {
2682251538Srpaulo		if (--sc->sc_txtimer == 0) {
2683251538Srpaulo			device_printf(sc->sc_dev, "device timeout\n");
2684287197Sglebius			counter_u64_add(sc->sc_ic.ic_oerrors, 1);
2685251538Srpaulo			return;
2686251538Srpaulo		}
2687251538Srpaulo		callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
2688251538Srpaulo	}
2689251538Srpaulo}
2690251538Srpaulo
2691251538Srpaulostatic void
2692251538Srpaulourtwn_update_avgrssi(struct urtwn_softc *sc, int rate, int8_t rssi)
2693251538Srpaulo{
2694251538Srpaulo	int pwdb;
2695251538Srpaulo
2696251538Srpaulo	/* Convert antenna signal to percentage. */
2697251538Srpaulo	if (rssi <= -100 || rssi >= 20)
2698251538Srpaulo		pwdb = 0;
2699251538Srpaulo	else if (rssi >= 0)
2700251538Srpaulo		pwdb = 100;
2701251538Srpaulo	else
2702251538Srpaulo		pwdb = 100 + rssi;
2703264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
2704289758Savos		if (rate <= URTWN_RIDX_CCK11) {
2705264912Skevlo			/* CCK gain is smaller than OFDM/MCS gain. */
2706264912Skevlo			pwdb += 6;
2707264912Skevlo			if (pwdb > 100)
2708264912Skevlo				pwdb = 100;
2709264912Skevlo			if (pwdb <= 14)
2710264912Skevlo				pwdb -= 4;
2711264912Skevlo			else if (pwdb <= 26)
2712264912Skevlo				pwdb -= 8;
2713264912Skevlo			else if (pwdb <= 34)
2714264912Skevlo				pwdb -= 6;
2715264912Skevlo			else if (pwdb <= 42)
2716264912Skevlo				pwdb -= 2;
2717264912Skevlo		}
2718251538Srpaulo	}
2719251538Srpaulo	if (sc->avg_pwdb == -1)	/* Init. */
2720251538Srpaulo		sc->avg_pwdb = pwdb;
2721251538Srpaulo	else if (sc->avg_pwdb < pwdb)
2722251538Srpaulo		sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20) + 1;
2723251538Srpaulo	else
2724251538Srpaulo		sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20);
2725297175Sadrian	URTWN_DPRINTF(sc, URTWN_DEBUG_RSSI, "%s: PWDB %d, EMA %d\n", __func__,
2726294471Savos	    pwdb, sc->avg_pwdb);
2727251538Srpaulo}
2728251538Srpaulo
2729251538Srpaulostatic int8_t
2730251538Srpaulourtwn_get_rssi(struct urtwn_softc *sc, int rate, void *physt)
2731251538Srpaulo{
2732251538Srpaulo	static const int8_t cckoff[] = { 16, -12, -26, -46 };
2733251538Srpaulo	struct r92c_rx_phystat *phy;
2734251538Srpaulo	struct r92c_rx_cck *cck;
2735251538Srpaulo	uint8_t rpt;
2736251538Srpaulo	int8_t rssi;
2737251538Srpaulo
2738289758Savos	if (rate <= URTWN_RIDX_CCK11) {
2739251538Srpaulo		cck = (struct r92c_rx_cck *)physt;
2740251538Srpaulo		if (sc->sc_flags & URTWN_FLAG_CCK_HIPWR) {
2741251538Srpaulo			rpt = (cck->agc_rpt >> 5) & 0x3;
2742251538Srpaulo			rssi = (cck->agc_rpt & 0x1f) << 1;
2743251538Srpaulo		} else {
2744251538Srpaulo			rpt = (cck->agc_rpt >> 6) & 0x3;
2745251538Srpaulo			rssi = cck->agc_rpt & 0x3e;
2746251538Srpaulo		}
2747251538Srpaulo		rssi = cckoff[rpt] - rssi;
2748251538Srpaulo	} else {	/* OFDM/HT. */
2749251538Srpaulo		phy = (struct r92c_rx_phystat *)physt;
2750251538Srpaulo		rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110;
2751251538Srpaulo	}
2752251538Srpaulo	return (rssi);
2753251538Srpaulo}
2754251538Srpaulo
2755264912Skevlostatic int8_t
2756264912Skevlourtwn_r88e_get_rssi(struct urtwn_softc *sc, int rate, void *physt)
2757264912Skevlo{
2758264912Skevlo	struct r92c_rx_phystat *phy;
2759264912Skevlo	struct r88e_rx_cck *cck;
2760264912Skevlo	uint8_t cck_agc_rpt, lna_idx, vga_idx;
2761264912Skevlo	int8_t rssi;
2762264912Skevlo
2763264972Skevlo	rssi = 0;
2764289758Savos	if (rate <= URTWN_RIDX_CCK11) {
2765264912Skevlo		cck = (struct r88e_rx_cck *)physt;
2766264912Skevlo		cck_agc_rpt = cck->agc_rpt;
2767264912Skevlo		lna_idx = (cck_agc_rpt & 0xe0) >> 5;
2768281069Srpaulo		vga_idx = cck_agc_rpt & 0x1f;
2769264912Skevlo		switch (lna_idx) {
2770264912Skevlo		case 7:
2771264912Skevlo			if (vga_idx <= 27)
2772264912Skevlo				rssi = -100 + 2* (27 - vga_idx);
2773264912Skevlo			else
2774264912Skevlo				rssi = -100;
2775264912Skevlo			break;
2776264912Skevlo		case 6:
2777264912Skevlo			rssi = -48 + 2 * (2 - vga_idx);
2778264912Skevlo			break;
2779264912Skevlo		case 5:
2780264912Skevlo			rssi = -42 + 2 * (7 - vga_idx);
2781264912Skevlo			break;
2782264912Skevlo		case 4:
2783264912Skevlo			rssi = -36 + 2 * (7 - vga_idx);
2784264912Skevlo			break;
2785264912Skevlo		case 3:
2786264912Skevlo			rssi = -24 + 2 * (7 - vga_idx);
2787264912Skevlo			break;
2788264912Skevlo		case 2:
2789264912Skevlo			rssi = -12 + 2 * (5 - vga_idx);
2790264912Skevlo			break;
2791264912Skevlo		case 1:
2792264912Skevlo			rssi = 8 - (2 * vga_idx);
2793264912Skevlo			break;
2794264912Skevlo		case 0:
2795264912Skevlo			rssi = 14 - (2 * vga_idx);
2796264912Skevlo			break;
2797264912Skevlo		}
2798264912Skevlo		rssi += 6;
2799264912Skevlo	} else {	/* OFDM/HT. */
2800264912Skevlo		phy = (struct r92c_rx_phystat *)physt;
2801264912Skevlo		rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110;
2802264912Skevlo	}
2803264912Skevlo	return (rssi);
2804264912Skevlo}
2805264912Skevlo
2806292167Savosstatic __inline uint8_t
2807292167Savosrate2ridx(uint8_t rate)
2808292167Savos{
2809297175Sadrian	if (rate & IEEE80211_RATE_MCS) {
2810297175Sadrian		/* 11n rates start at idx 12 */
2811297175Sadrian		return ((rate & 0xf) + 12);
2812297175Sadrian	}
2813292167Savos	switch (rate) {
2814297175Sadrian	/* 11g */
2815292167Savos	case 12:	return 4;
2816292167Savos	case 18:	return 5;
2817292167Savos	case 24:	return 6;
2818292167Savos	case 36:	return 7;
2819292167Savos	case 48:	return 8;
2820292167Savos	case 72:	return 9;
2821292167Savos	case 96:	return 10;
2822292167Savos	case 108:	return 11;
2823297175Sadrian	/* 11b */
2824292167Savos	case 2:		return 0;
2825292167Savos	case 4:		return 1;
2826292167Savos	case 11:	return 2;
2827292167Savos	case 22:	return 3;
2828292167Savos	default:	return 0;
2829292167Savos	}
2830292167Savos}
2831292167Savos
2832251538Srpaulostatic int
2833290630Savosurtwn_tx_data(struct urtwn_softc *sc, struct ieee80211_node *ni,
2834290630Savos    struct mbuf *m, struct urtwn_data *data)
2835251538Srpaulo{
2836292167Savos	const struct ieee80211_txparam *tp;
2837287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
2838251538Srpaulo	struct ieee80211vap *vap = ni->ni_vap;
2839292167Savos	struct ieee80211_key *k = NULL;
2840292167Savos	struct ieee80211_channel *chan;
2841292167Savos	struct ieee80211_frame *wh;
2842251538Srpaulo	struct r92c_tx_desc *txd;
2843292167Savos	uint8_t macid, raid, rate, ridx, subtype, type, tid, qsel;
2844292014Savos	int hasqos, ismcast;
2845251538Srpaulo
2846251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
2847251538Srpaulo
2848251538Srpaulo	/*
2849251538Srpaulo	 * Software crypto.
2850251538Srpaulo	 */
2851290630Savos	wh = mtod(m, struct ieee80211_frame *);
2852264912Skevlo	type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;
2853290630Savos	subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;
2854292014Savos	hasqos = IEEE80211_QOS_HAS_SEQ(wh);
2855290630Savos	ismcast = IEEE80211_IS_MULTICAST(wh->i_addr1);
2856264912Skevlo
2857292014Savos	/* Select TX ring for this frame. */
2858292014Savos	if (hasqos) {
2859292014Savos		tid = ((const struct ieee80211_qosframe *)wh)->i_qos[0];
2860292014Savos		tid &= IEEE80211_QOS_TID;
2861292014Savos	} else
2862292014Savos		tid = 0;
2863292014Savos
2864292167Savos	chan = (ni->ni_chan != IEEE80211_CHAN_ANYC) ?
2865292167Savos		ni->ni_chan : ic->ic_curchan;
2866292167Savos	tp = &vap->iv_txparms[ieee80211_chan2mode(chan)];
2867292167Savos
2868292167Savos	/* Choose a TX rate index. */
2869292167Savos	if (type == IEEE80211_FC0_TYPE_MGT)
2870292167Savos		rate = tp->mgmtrate;
2871292167Savos	else if (ismcast)
2872292167Savos		rate = tp->mcastrate;
2873292167Savos	else if (tp->ucastrate != IEEE80211_FIXED_RATE_NONE)
2874292167Savos		rate = tp->ucastrate;
2875292167Savos	else if (m->m_flags & M_EAPOL)
2876292167Savos		rate = tp->mgmtrate;
2877292167Savos	else {
2878292167Savos		if (URTWN_CHIP_HAS_RATECTL(sc)) {
2879292167Savos			/* XXX pass pktlen */
2880292167Savos			(void) ieee80211_ratectl_rate(ni, NULL, 0);
2881292167Savos			rate = ni->ni_txrate;
2882292167Savos		} else {
2883297175Sadrian			/* XXX TODO: drop the default rate for 11b/11g? */
2884297175Sadrian			if (ni->ni_flags & IEEE80211_NODE_HT)
2885297175Sadrian				rate = IEEE80211_RATE_MCS | 0x4; /* MCS4 */
2886297175Sadrian			else if (ic->ic_curmode != IEEE80211_MODE_11B)
2887292167Savos				rate = 108;
2888292167Savos			else
2889292167Savos				rate = 22;
2890292167Savos		}
2891292167Savos	}
2892292167Savos
2893297175Sadrian	/*
2894297175Sadrian	 * XXX TODO: this should be per-node, for 11b versus 11bg
2895297175Sadrian	 * nodes in hostap mode
2896297175Sadrian	 */
2897292167Savos	ridx = rate2ridx(rate);
2898297175Sadrian	if (ni->ni_flags & IEEE80211_NODE_HT)
2899297175Sadrian		raid = R92C_RAID_11GN;
2900297175Sadrian	else if (ic->ic_curmode != IEEE80211_MODE_11B)
2901292167Savos		raid = R92C_RAID_11BG;
2902292167Savos	else
2903292167Savos		raid = R92C_RAID_11B;
2904292167Savos
2905260444Skevlo	if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) {
2906290630Savos		k = ieee80211_crypto_encap(ni, m);
2907251538Srpaulo		if (k == NULL) {
2908251538Srpaulo			device_printf(sc->sc_dev,
2909251538Srpaulo			    "ieee80211_crypto_encap returns NULL.\n");
2910251538Srpaulo			return (ENOBUFS);
2911251538Srpaulo		}
2912251538Srpaulo
2913251538Srpaulo		/* in case packet header moved, reset pointer */
2914290630Savos		wh = mtod(m, struct ieee80211_frame *);
2915251538Srpaulo	}
2916281069Srpaulo
2917251538Srpaulo	/* Fill Tx descriptor. */
2918251538Srpaulo	txd = (struct r92c_tx_desc *)data->buf;
2919251538Srpaulo	memset(txd, 0, sizeof(*txd));
2920251538Srpaulo
2921251538Srpaulo	txd->txdw0 |= htole32(
2922251538Srpaulo	    SM(R92C_TXDW0_OFFSET, sizeof(*txd)) |
2923251538Srpaulo	    R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG);
2924290630Savos	if (ismcast)
2925251538Srpaulo		txd->txdw0 |= htole32(R92C_TXDW0_BMCAST);
2926290630Savos
2927290630Savos	if (!ismcast) {
2928292167Savos		if (sc->chip & URTWN_CHIP_88E) {
2929292167Savos			struct urtwn_node *un = URTWN_NODE(ni);
2930292167Savos			macid = un->id;
2931292167Savos		} else
2932292167Savos			macid = URTWN_MACID_BSS;
2933290630Savos
2934290630Savos		if (type == IEEE80211_FC0_TYPE_DATA) {
2935292014Savos			qsel = tid % URTWN_MAX_TID;
2936290630Savos
2937292167Savos			if (sc->chip & URTWN_CHIP_88E) {
2938292167Savos				txd->txdw2 |= htole32(
2939292167Savos				    R88E_TXDW2_AGGBK |
2940292167Savos				    R88E_TXDW2_CCX_RPT);
2941292167Savos			} else
2942290630Savos				txd->txdw1 |= htole32(R92C_TXDW1_AGGBK);
2943290630Savos
2944297175Sadrian			/* protmode, non-HT */
2945297175Sadrian			/* XXX TODO: noack frames? */
2946297175Sadrian			if ((rate & 0x80) == 0 &&
2947297175Sadrian			    (ic->ic_flags & IEEE80211_F_USEPROT)) {
2948290630Savos				switch (ic->ic_protmode) {
2949290630Savos				case IEEE80211_PROT_CTSONLY:
2950290630Savos					txd->txdw4 |= htole32(
2951290630Savos					    R92C_TXDW4_CTS2SELF |
2952290630Savos					    R92C_TXDW4_HWRTSEN);
2953290630Savos					break;
2954290630Savos				case IEEE80211_PROT_RTSCTS:
2955290630Savos					txd->txdw4 |= htole32(
2956290630Savos					    R92C_TXDW4_RTSEN |
2957290630Savos					    R92C_TXDW4_HWRTSEN);
2958290630Savos					break;
2959290630Savos				default:
2960290630Savos					break;
2961290630Savos				}
2962290630Savos			}
2963297175Sadrian
2964297175Sadrian			/* protmode, HT */
2965297175Sadrian			/* XXX TODO: noack frames? */
2966297175Sadrian			if ((rate & 0x80) &&
2967297175Sadrian			    (ic->ic_htprotmode == IEEE80211_PROT_RTSCTS)) {
2968297175Sadrian				txd->txdw4 |= htole32(
2969297175Sadrian				    R92C_TXDW4_RTSEN |
2970297175Sadrian				    R92C_TXDW4_HWRTSEN);
2971297175Sadrian			}
2972297175Sadrian
2973297175Sadrian			/* XXX TODO: rtsrate is configurable? 24mbit may
2974297175Sadrian			 * be a bit high for RTS rate? */
2975290630Savos			txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE,
2976290630Savos			    URTWN_RIDX_OFDM24));
2977297175Sadrian
2978290630Savos			txd->txdw5 |= htole32(0x0001ff00);
2979290630Savos		} else	/* IEEE80211_FC0_TYPE_MGT */
2980290630Savos			qsel = R92C_TXDW1_QSEL_MGNT;
2981251538Srpaulo	} else {
2982290630Savos		macid = URTWN_MACID_BC;
2983290630Savos		qsel = R92C_TXDW1_QSEL_MGNT;
2984290630Savos	}
2985251538Srpaulo
2986290630Savos	txd->txdw1 |= htole32(
2987290630Savos	    SM(R92C_TXDW1_QSEL, qsel) |
2988290630Savos	    SM(R92C_TXDW1_RAID, raid));
2989290630Savos
2990297175Sadrian	/* XXX TODO: 40MHZ flag? */
2991297175Sadrian	/* XXX TODO: AMPDU flag? (AGG_ENABLE or AGG_BREAK?) Density shift? */
2992297175Sadrian	/* XXX Short preamble? */
2993297175Sadrian	/* XXX Short-GI? */
2994297175Sadrian
2995290630Savos	if (sc->chip & URTWN_CHIP_88E)
2996290630Savos		txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, macid));
2997290630Savos	else
2998290630Savos		txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, macid));
2999290630Savos
3000290630Savos	txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, ridx));
3001297175Sadrian
3002291858Savos	/* Force this rate if needed. */
3003292167Savos	if (URTWN_CHIP_HAS_RATECTL(sc) || ismcast ||
3004297175Sadrian	    (tp->ucastrate != IEEE80211_FIXED_RATE_NONE) ||
3005292167Savos	    (m->m_flags & M_EAPOL) || type != IEEE80211_FC0_TYPE_DATA)
3006251538Srpaulo		txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE);
3007251538Srpaulo
3008292014Savos	if (!hasqos) {
3009251538Srpaulo		/* Use HW sequence numbering for non-QoS frames. */
3010291858Savos		if (sc->chip & URTWN_CHIP_88E)
3011291858Savos			txd->txdseq = htole16(R88E_TXDSEQ_HWSEQ_EN);
3012291858Savos		else
3013291858Savos			txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN);
3014290630Savos	} else {
3015290630Savos		/* Set sequence number. */
3016290630Savos		txd->txdseq = htole16(M_SEQNO_GET(m) % IEEE80211_SEQ_RANGE);
3017290630Savos	}
3018251538Srpaulo
3019292175Savos	if (k != NULL && !(k->wk_flags & IEEE80211_KEY_SWCRYPT)) {
3020292175Savos		uint8_t cipher;
3021292175Savos
3022292175Savos		switch (k->wk_cipher->ic_cipher) {
3023292175Savos		case IEEE80211_CIPHER_WEP:
3024292175Savos		case IEEE80211_CIPHER_TKIP:
3025292175Savos			cipher = R92C_TXDW1_CIPHER_RC4;
3026292175Savos			break;
3027292175Savos		case IEEE80211_CIPHER_AES_CCM:
3028292175Savos			cipher = R92C_TXDW1_CIPHER_AES;
3029292175Savos			break;
3030292175Savos		default:
3031292175Savos			device_printf(sc->sc_dev, "%s: unknown cipher %d\n",
3032292175Savos			    __func__, k->wk_cipher->ic_cipher);
3033292175Savos			return (EINVAL);
3034292175Savos		}
3035292175Savos
3036292175Savos		txd->txdw1 |= htole32(SM(R92C_TXDW1_CIPHER, cipher));
3037292175Savos	}
3038292175Savos
3039251538Srpaulo	if (ieee80211_radiotap_active_vap(vap)) {
3040251538Srpaulo		struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap;
3041251538Srpaulo
3042251538Srpaulo		tap->wt_flags = 0;
3043290630Savos		if (k != NULL)
3044290630Savos			tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP;
3045290630Savos		ieee80211_radiotap_tx(vap, m);
3046251538Srpaulo	}
3047251538Srpaulo
3048290630Savos	data->ni = ni;
3049251538Srpaulo
3050290630Savos	urtwn_tx_start(sc, m, type, data);
3051290630Savos
3052290630Savos	return (0);
3053290630Savos}
3054290630Savos
3055292221Savosstatic int
3056292221Savosurtwn_tx_raw(struct urtwn_softc *sc, struct ieee80211_node *ni,
3057292221Savos    struct mbuf *m, struct urtwn_data *data,
3058292221Savos    const struct ieee80211_bpf_params *params)
3059292221Savos{
3060292221Savos	struct ieee80211vap *vap = ni->ni_vap;
3061292221Savos	struct ieee80211_key *k = NULL;
3062292221Savos	struct ieee80211_frame *wh;
3063292221Savos	struct r92c_tx_desc *txd;
3064292221Savos	uint8_t cipher, ridx, type;
3065292221Savos
3066292221Savos	/* Encrypt the frame if need be. */
3067292221Savos	cipher = R92C_TXDW1_CIPHER_NONE;
3068292221Savos	if (params->ibp_flags & IEEE80211_BPF_CRYPTO) {
3069292221Savos		/* Retrieve key for TX. */
3070292221Savos		k = ieee80211_crypto_encap(ni, m);
3071292221Savos		if (k == NULL)
3072292221Savos			return (ENOBUFS);
3073292221Savos
3074292221Savos		if (!(k->wk_flags & IEEE80211_KEY_SWCRYPT)) {
3075292221Savos			switch (k->wk_cipher->ic_cipher) {
3076292221Savos			case IEEE80211_CIPHER_WEP:
3077292221Savos			case IEEE80211_CIPHER_TKIP:
3078292221Savos				cipher = R92C_TXDW1_CIPHER_RC4;
3079292221Savos				break;
3080292221Savos			case IEEE80211_CIPHER_AES_CCM:
3081292221Savos				cipher = R92C_TXDW1_CIPHER_AES;
3082292221Savos				break;
3083292221Savos			default:
3084292221Savos				device_printf(sc->sc_dev,
3085292221Savos				    "%s: unknown cipher %d\n",
3086292221Savos				    __func__, k->wk_cipher->ic_cipher);
3087292221Savos				return (EINVAL);
3088292221Savos			}
3089292221Savos		}
3090292221Savos	}
3091292221Savos
3092297175Sadrian	/* XXX TODO: 11n checks, matching urtwn_tx_data() */
3093297175Sadrian
3094292221Savos	wh = mtod(m, struct ieee80211_frame *);
3095292221Savos	type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;
3096292221Savos
3097292221Savos	/* Fill Tx descriptor. */
3098292221Savos	txd = (struct r92c_tx_desc *)data->buf;
3099292221Savos	memset(txd, 0, sizeof(*txd));
3100292221Savos
3101292221Savos	txd->txdw0 |= htole32(
3102292221Savos	    SM(R92C_TXDW0_OFFSET, sizeof(*txd)) |
3103292221Savos	    R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG);
3104292221Savos	if (IEEE80211_IS_MULTICAST(wh->i_addr1))
3105292221Savos		txd->txdw0 |= htole32(R92C_TXDW0_BMCAST);
3106292221Savos
3107292221Savos	if (params->ibp_flags & IEEE80211_BPF_RTS)
3108292221Savos		txd->txdw4 |= htole32(R92C_TXDW4_RTSEN);
3109292221Savos	if (params->ibp_flags & IEEE80211_BPF_CTS)
3110292221Savos		txd->txdw4 |= htole32(R92C_TXDW4_CTS2SELF);
3111292221Savos	if (txd->txdw4 & htole32(R92C_TXDW4_RTSEN | R92C_TXDW4_CTS2SELF)) {
3112292221Savos		txd->txdw4 |= htole32(R92C_TXDW4_HWRTSEN);
3113292221Savos		txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE,
3114292221Savos		    URTWN_RIDX_OFDM24));
3115292221Savos	}
3116292221Savos
3117292221Savos	if (sc->chip & URTWN_CHIP_88E)
3118292221Savos		txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, URTWN_MACID_BC));
3119292221Savos	else
3120292221Savos		txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, URTWN_MACID_BC));
3121292221Savos
3122297175Sadrian	/* XXX TODO: rate index/config (RAID) for 11n? */
3123292221Savos	txd->txdw1 |= htole32(SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_MGNT));
3124292221Savos	txd->txdw1 |= htole32(SM(R92C_TXDW1_CIPHER, cipher));
3125292221Savos
3126292221Savos	/* Choose a TX rate index. */
3127292221Savos	ridx = rate2ridx(params->ibp_rate0);
3128292221Savos	txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, ridx));
3129292221Savos	txd->txdw5 |= htole32(0x0001ff00);
3130292221Savos	txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE);
3131292221Savos
3132292221Savos	if (!IEEE80211_QOS_HAS_SEQ(wh)) {
3133292221Savos		/* Use HW sequence numbering for non-QoS frames. */
3134292221Savos		if (sc->chip & URTWN_CHIP_88E)
3135292221Savos			txd->txdseq = htole16(R88E_TXDSEQ_HWSEQ_EN);
3136292221Savos		else
3137292221Savos			txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN);
3138292221Savos	} else {
3139292221Savos		/* Set sequence number. */
3140292221Savos		txd->txdseq = htole16(M_SEQNO_GET(m) % IEEE80211_SEQ_RANGE);
3141292221Savos	}
3142292221Savos
3143292221Savos	if (ieee80211_radiotap_active_vap(vap)) {
3144292221Savos		struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap;
3145292221Savos
3146292221Savos		tap->wt_flags = 0;
3147292221Savos		if (k != NULL)
3148292221Savos			tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP;
3149292221Savos		ieee80211_radiotap_tx(vap, m);
3150292221Savos	}
3151292221Savos
3152292221Savos	data->ni = ni;
3153292221Savos
3154292221Savos	urtwn_tx_start(sc, m, type, data);
3155292221Savos
3156292221Savos	return (0);
3157292221Savos}
3158292221Savos
3159290630Savosstatic void
3160290630Savosurtwn_tx_start(struct urtwn_softc *sc, struct mbuf *m, uint8_t type,
3161290630Savos    struct urtwn_data *data)
3162290630Savos{
3163290630Savos	struct usb_xfer *xfer;
3164290630Savos	struct r92c_tx_desc *txd;
3165290630Savos	uint16_t ac, sum;
3166290630Savos	int i, xferlen;
3167290630Savos
3168290630Savos	URTWN_ASSERT_LOCKED(sc);
3169290630Savos
3170290630Savos	ac = M_WME_GETAC(m);
3171290630Savos
3172290630Savos	switch (type) {
3173290630Savos	case IEEE80211_FC0_TYPE_CTL:
3174290630Savos	case IEEE80211_FC0_TYPE_MGT:
3175290630Savos		xfer = sc->sc_xfer[URTWN_BULK_TX_VO];
3176290630Savos		break;
3177290630Savos	default:
3178292014Savos		xfer = sc->sc_xfer[wme2queue[ac].qid];
3179290630Savos		break;
3180290630Savos	}
3181290630Savos
3182290630Savos	txd = (struct r92c_tx_desc *)data->buf;
3183290630Savos	txd->txdw0 |= htole32(SM(R92C_TXDW0_PKTLEN, m->m_pkthdr.len));
3184290630Savos
3185290630Savos	/* Compute Tx descriptor checksum. */
3186290630Savos	sum = 0;
3187290630Savos	for (i = 0; i < sizeof(*txd) / 2; i++)
3188290630Savos		sum ^= ((uint16_t *)txd)[i];
3189290630Savos	txd->txdsum = sum;	/* NB: already little endian. */
3190290630Savos
3191290630Savos	xferlen = sizeof(*txd) + m->m_pkthdr.len;
3192290630Savos	m_copydata(m, 0, m->m_pkthdr.len, (caddr_t)&txd[1]);
3193290630Savos
3194251538Srpaulo	data->buflen = xferlen;
3195290630Savos	data->m = m;
3196251538Srpaulo
3197251538Srpaulo	STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next);
3198251538Srpaulo	usbd_transfer_start(xfer);
3199251538Srpaulo}
3200251538Srpaulo
3201287197Sglebiusstatic int
3202287197Sglebiusurtwn_transmit(struct ieee80211com *ic, struct mbuf *m)
3203251538Srpaulo{
3204287197Sglebius	struct urtwn_softc *sc = ic->ic_softc;
3205287197Sglebius	int error;
3206261863Srpaulo
3207261863Srpaulo	URTWN_LOCK(sc);
3208287197Sglebius	if ((sc->sc_flags & URTWN_RUNNING) == 0) {
3209287197Sglebius		URTWN_UNLOCK(sc);
3210287197Sglebius		return (ENXIO);
3211287197Sglebius	}
3212287197Sglebius	error = mbufq_enqueue(&sc->sc_snd, m);
3213287197Sglebius	if (error) {
3214287197Sglebius		URTWN_UNLOCK(sc);
3215287197Sglebius		return (error);
3216287197Sglebius	}
3217287197Sglebius	urtwn_start(sc);
3218261863Srpaulo	URTWN_UNLOCK(sc);
3219287197Sglebius
3220287197Sglebius	return (0);
3221261863Srpaulo}
3222261863Srpaulo
3223261863Srpaulostatic void
3224287197Sglebiusurtwn_start(struct urtwn_softc *sc)
3225261863Srpaulo{
3226251538Srpaulo	struct ieee80211_node *ni;
3227251538Srpaulo	struct mbuf *m;
3228251538Srpaulo	struct urtwn_data *bf;
3229251538Srpaulo
3230261863Srpaulo	URTWN_ASSERT_LOCKED(sc);
3231287197Sglebius	while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) {
3232251538Srpaulo		bf = urtwn_getbuf(sc);
3233251538Srpaulo		if (bf == NULL) {
3234287197Sglebius			mbufq_prepend(&sc->sc_snd, m);
3235251538Srpaulo			break;
3236251538Srpaulo		}
3237251538Srpaulo		ni = (struct ieee80211_node *)m->m_pkthdr.rcvif;
3238251538Srpaulo		m->m_pkthdr.rcvif = NULL;
3239297596Sadrian
3240297596Sadrian		URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT, "%s: called; m=%p\n",
3241297596Sadrian		    __func__,
3242297596Sadrian		    m);
3243297596Sadrian
3244290630Savos		if (urtwn_tx_data(sc, ni, m, bf) != 0) {
3245287197Sglebius			if_inc_counter(ni->ni_vap->iv_ifp,
3246287197Sglebius			    IFCOUNTER_OERRORS, 1);
3247251538Srpaulo			STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next);
3248288353Sadrian			m_freem(m);
3249251538Srpaulo			ieee80211_free_node(ni);
3250251538Srpaulo			break;
3251251538Srpaulo		}
3252251538Srpaulo		sc->sc_txtimer = 5;
3253251538Srpaulo		callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
3254251538Srpaulo	}
3255251538Srpaulo}
3256251538Srpaulo
3257287197Sglebiusstatic void
3258287197Sglebiusurtwn_parent(struct ieee80211com *ic)
3259251538Srpaulo{
3260286949Sadrian	struct urtwn_softc *sc = ic->ic_softc;
3261251538Srpaulo
3262263153Skevlo	URTWN_LOCK(sc);
3263287197Sglebius	if (sc->sc_flags & URTWN_DETACHED) {
3264287197Sglebius		URTWN_UNLOCK(sc);
3265287197Sglebius		return;
3266287197Sglebius	}
3267291698Savos	URTWN_UNLOCK(sc);
3268291698Savos
3269287197Sglebius	if (ic->ic_nrunning > 0) {
3270291698Savos		if (urtwn_init(sc) != 0) {
3271291698Savos			struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
3272291698Savos			if (vap != NULL)
3273291698Savos				ieee80211_stop(vap);
3274291698Savos		} else
3275291698Savos			ieee80211_start_all(ic);
3276291698Savos	} else
3277287197Sglebius		urtwn_stop(sc);
3278251538Srpaulo}
3279251538Srpaulo
3280264912Skevlostatic __inline int
3281251538Srpaulourtwn_power_on(struct urtwn_softc *sc)
3282251538Srpaulo{
3283264912Skevlo
3284264912Skevlo	return sc->sc_power_on(sc);
3285264912Skevlo}
3286264912Skevlo
3287264912Skevlostatic int
3288264912Skevlourtwn_r92c_power_on(struct urtwn_softc *sc)
3289264912Skevlo{
3290251538Srpaulo	uint32_t reg;
3291291698Savos	usb_error_t error;
3292251538Srpaulo	int ntries;
3293251538Srpaulo
3294251538Srpaulo	/* Wait for autoload done bit. */
3295251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
3296251538Srpaulo		if (urtwn_read_1(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_PFM_ALDN)
3297251538Srpaulo			break;
3298266472Shselasky		urtwn_ms_delay(sc);
3299251538Srpaulo	}
3300251538Srpaulo	if (ntries == 1000) {
3301251538Srpaulo		device_printf(sc->sc_dev,
3302251538Srpaulo		    "timeout waiting for chip autoload\n");
3303251538Srpaulo		return (ETIMEDOUT);
3304251538Srpaulo	}
3305251538Srpaulo
3306251538Srpaulo	/* Unlock ISO/CLK/Power control register. */
3307291698Savos	error = urtwn_write_1(sc, R92C_RSV_CTRL, 0);
3308291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3309291698Savos		return (EIO);
3310251538Srpaulo	/* Move SPS into PWM mode. */
3311291698Savos	error = urtwn_write_1(sc, R92C_SPS0_CTRL, 0x2b);
3312291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3313291698Savos		return (EIO);
3314266472Shselasky	urtwn_ms_delay(sc);
3315251538Srpaulo
3316251538Srpaulo	reg = urtwn_read_1(sc, R92C_LDOV12D_CTRL);
3317251538Srpaulo	if (!(reg & R92C_LDOV12D_CTRL_LDV12_EN)) {
3318291698Savos		error = urtwn_write_1(sc, R92C_LDOV12D_CTRL,
3319251538Srpaulo		    reg | R92C_LDOV12D_CTRL_LDV12_EN);
3320291698Savos		if (error != USB_ERR_NORMAL_COMPLETION)
3321291698Savos			return (EIO);
3322266472Shselasky		urtwn_ms_delay(sc);
3323291698Savos		error = urtwn_write_1(sc, R92C_SYS_ISO_CTRL,
3324251538Srpaulo		    urtwn_read_1(sc, R92C_SYS_ISO_CTRL) &
3325251538Srpaulo		    ~R92C_SYS_ISO_CTRL_MD2PP);
3326291698Savos		if (error != USB_ERR_NORMAL_COMPLETION)
3327291698Savos			return (EIO);
3328251538Srpaulo	}
3329251538Srpaulo
3330251538Srpaulo	/* Auto enable WLAN. */
3331291698Savos	error = urtwn_write_2(sc, R92C_APS_FSMCO,
3332251538Srpaulo	    urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC);
3333291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3334291698Savos		return (EIO);
3335251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
3336262822Skevlo		if (!(urtwn_read_2(sc, R92C_APS_FSMCO) &
3337262822Skevlo		    R92C_APS_FSMCO_APFM_ONMAC))
3338251538Srpaulo			break;
3339266472Shselasky		urtwn_ms_delay(sc);
3340251538Srpaulo	}
3341251538Srpaulo	if (ntries == 1000) {
3342251538Srpaulo		device_printf(sc->sc_dev,
3343251538Srpaulo		    "timeout waiting for MAC auto ON\n");
3344251538Srpaulo		return (ETIMEDOUT);
3345251538Srpaulo	}
3346251538Srpaulo
3347251538Srpaulo	/* Enable radio, GPIO and LED functions. */
3348291698Savos	error = urtwn_write_2(sc, R92C_APS_FSMCO,
3349251538Srpaulo	    R92C_APS_FSMCO_AFSM_HSUS |
3350251538Srpaulo	    R92C_APS_FSMCO_PDN_EN |
3351251538Srpaulo	    R92C_APS_FSMCO_PFM_ALDN);
3352291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3353291698Savos		return (EIO);
3354251538Srpaulo	/* Release RF digital isolation. */
3355291698Savos	error = urtwn_write_2(sc, R92C_SYS_ISO_CTRL,
3356251538Srpaulo	    urtwn_read_2(sc, R92C_SYS_ISO_CTRL) & ~R92C_SYS_ISO_CTRL_DIOR);
3357291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3358291698Savos		return (EIO);
3359251538Srpaulo
3360251538Srpaulo	/* Initialize MAC. */
3361291698Savos	error = urtwn_write_1(sc, R92C_APSD_CTRL,
3362251538Srpaulo	    urtwn_read_1(sc, R92C_APSD_CTRL) & ~R92C_APSD_CTRL_OFF);
3363291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3364291698Savos		return (EIO);
3365251538Srpaulo	for (ntries = 0; ntries < 200; ntries++) {
3366251538Srpaulo		if (!(urtwn_read_1(sc, R92C_APSD_CTRL) &
3367251538Srpaulo		    R92C_APSD_CTRL_OFF_STATUS))
3368251538Srpaulo			break;
3369266472Shselasky		urtwn_ms_delay(sc);
3370251538Srpaulo	}
3371251538Srpaulo	if (ntries == 200) {
3372251538Srpaulo		device_printf(sc->sc_dev,
3373251538Srpaulo		    "timeout waiting for MAC initialization\n");
3374251538Srpaulo		return (ETIMEDOUT);
3375251538Srpaulo	}
3376251538Srpaulo
3377251538Srpaulo	/* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */
3378251538Srpaulo	reg = urtwn_read_2(sc, R92C_CR);
3379251538Srpaulo	reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN |
3380251538Srpaulo	    R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN |
3381251538Srpaulo	    R92C_CR_SCHEDULE_EN | R92C_CR_MACTXEN | R92C_CR_MACRXEN |
3382251538Srpaulo	    R92C_CR_ENSEC;
3383291698Savos	error = urtwn_write_2(sc, R92C_CR, reg);
3384291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3385291698Savos		return (EIO);
3386251538Srpaulo
3387291698Savos	error = urtwn_write_1(sc, 0xfe10, 0x19);
3388291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3389291698Savos		return (EIO);
3390251538Srpaulo	return (0);
3391251538Srpaulo}
3392251538Srpaulo
3393251538Srpaulostatic int
3394264912Skevlourtwn_r88e_power_on(struct urtwn_softc *sc)
3395264912Skevlo{
3396264912Skevlo	uint32_t reg;
3397291698Savos	usb_error_t error;
3398264912Skevlo	int ntries;
3399264912Skevlo
3400264912Skevlo	/* Wait for power ready bit. */
3401264912Skevlo	for (ntries = 0; ntries < 5000; ntries++) {
3402281918Skevlo		if (urtwn_read_4(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_SUS_HOST)
3403264912Skevlo			break;
3404266472Shselasky		urtwn_ms_delay(sc);
3405264912Skevlo	}
3406264912Skevlo	if (ntries == 5000) {
3407264912Skevlo		device_printf(sc->sc_dev,
3408264912Skevlo		    "timeout waiting for chip power up\n");
3409264912Skevlo		return (ETIMEDOUT);
3410264912Skevlo	}
3411264912Skevlo
3412264912Skevlo	/* Reset BB. */
3413291698Savos	error = urtwn_write_1(sc, R92C_SYS_FUNC_EN,
3414264912Skevlo	    urtwn_read_1(sc, R92C_SYS_FUNC_EN) & ~(R92C_SYS_FUNC_EN_BBRSTB |
3415264912Skevlo	    R92C_SYS_FUNC_EN_BB_GLB_RST));
3416291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3417291698Savos		return (EIO);
3418264912Skevlo
3419291698Savos	error = urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 2,
3420281918Skevlo	    urtwn_read_1(sc, R92C_AFE_XTAL_CTRL + 2) | 0x80);
3421291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3422291698Savos		return (EIO);
3423264912Skevlo
3424264912Skevlo	/* Disable HWPDN. */
3425291698Savos	error = urtwn_write_2(sc, R92C_APS_FSMCO,
3426281918Skevlo	    urtwn_read_2(sc, R92C_APS_FSMCO) & ~R92C_APS_FSMCO_APDM_HPDN);
3427291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3428291698Savos		return (EIO);
3429264912Skevlo
3430264912Skevlo	/* Disable WL suspend. */
3431291698Savos	error = urtwn_write_2(sc, R92C_APS_FSMCO,
3432281918Skevlo	    urtwn_read_2(sc, R92C_APS_FSMCO) &
3433281918Skevlo	    ~(R92C_APS_FSMCO_AFSM_HSUS | R92C_APS_FSMCO_AFSM_PCIE));
3434291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3435291698Savos		return (EIO);
3436264912Skevlo
3437291698Savos	error = urtwn_write_2(sc, R92C_APS_FSMCO,
3438281918Skevlo	    urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC);
3439291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3440291698Savos		return (EIO);
3441264912Skevlo	for (ntries = 0; ntries < 5000; ntries++) {
3442281918Skevlo		if (!(urtwn_read_2(sc, R92C_APS_FSMCO) &
3443281918Skevlo		    R92C_APS_FSMCO_APFM_ONMAC))
3444264912Skevlo			break;
3445266472Shselasky		urtwn_ms_delay(sc);
3446264912Skevlo	}
3447264912Skevlo	if (ntries == 5000)
3448264912Skevlo		return (ETIMEDOUT);
3449264912Skevlo
3450264912Skevlo	/* Enable LDO normal mode. */
3451291698Savos	error = urtwn_write_1(sc, R92C_LPLDO_CTRL,
3452295874Savos	    urtwn_read_1(sc, R92C_LPLDO_CTRL) & ~R92C_LPLDO_CTRL_SLEEP);
3453291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3454291698Savos		return (EIO);
3455264912Skevlo
3456264912Skevlo	/* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */
3457291698Savos	error = urtwn_write_2(sc, R92C_CR, 0);
3458291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3459291698Savos		return (EIO);
3460264912Skevlo	reg = urtwn_read_2(sc, R92C_CR);
3461264912Skevlo	reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN |
3462264912Skevlo	    R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN |
3463264912Skevlo	    R92C_CR_SCHEDULE_EN | R92C_CR_ENSEC | R92C_CR_CALTMR_EN;
3464291698Savos	error = urtwn_write_2(sc, R92C_CR, reg);
3465291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3466291698Savos		return (EIO);
3467264912Skevlo
3468264912Skevlo	return (0);
3469264912Skevlo}
3470264912Skevlo
3471295874Savosstatic __inline void
3472295874Savosurtwn_power_off(struct urtwn_softc *sc)
3473295874Savos{
3474295874Savos
3475295874Savos	return sc->sc_power_off(sc);
3476295874Savos}
3477295874Savos
3478295874Savosstatic void
3479295874Savosurtwn_r92c_power_off(struct urtwn_softc *sc)
3480295874Savos{
3481295874Savos	uint32_t reg;
3482295874Savos
3483295874Savos	/* Block all Tx queues. */
3484295874Savos	urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL);
3485295874Savos
3486295874Savos	/* Disable RF */
3487295874Savos	urtwn_rf_write(sc, 0, 0, 0);
3488295874Savos
3489295874Savos	urtwn_write_1(sc, R92C_APSD_CTRL, R92C_APSD_CTRL_OFF);
3490295874Savos
3491295874Savos	/* Reset BB state machine */
3492295874Savos	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
3493295874Savos	    R92C_SYS_FUNC_EN_USBD | R92C_SYS_FUNC_EN_USBA |
3494295874Savos	    R92C_SYS_FUNC_EN_BB_GLB_RST);
3495295874Savos	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
3496295874Savos	    R92C_SYS_FUNC_EN_USBD | R92C_SYS_FUNC_EN_USBA);
3497295874Savos
3498295874Savos	/*
3499295874Savos	 * Reset digital sequence
3500295874Savos	 */
3501295874Savos#ifndef URTWN_WITHOUT_UCODE
3502295874Savos	if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RDY) {
3503295874Savos		/* Reset MCU ready status */
3504295874Savos		urtwn_write_1(sc, R92C_MCUFWDL, 0);
3505295874Savos
3506295874Savos		/* If firmware in ram code, do reset */
3507295874Savos		urtwn_fw_reset(sc);
3508295874Savos	}
3509295874Savos#endif
3510295874Savos
3511295874Savos	/* Reset MAC and Enable 8051 */
3512295874Savos	urtwn_write_1(sc, R92C_SYS_FUNC_EN + 1,
3513295874Savos	    (R92C_SYS_FUNC_EN_CPUEN |
3514295874Savos	     R92C_SYS_FUNC_EN_ELDR |
3515295874Savos	     R92C_SYS_FUNC_EN_HWPDN) >> 8);
3516295874Savos
3517295874Savos	/* Reset MCU ready status */
3518295874Savos	urtwn_write_1(sc, R92C_MCUFWDL, 0);
3519295874Savos
3520295874Savos	/* Disable MAC clock */
3521295874Savos	urtwn_write_2(sc, R92C_SYS_CLKR,
3522295874Savos	    R92C_SYS_CLKR_ANAD16V_EN |
3523295874Savos	    R92C_SYS_CLKR_ANA8M |
3524295874Savos	    R92C_SYS_CLKR_LOADER_EN |
3525295874Savos	    R92C_SYS_CLKR_80M_SSC_DIS |
3526295874Savos	    R92C_SYS_CLKR_SYS_EN |
3527295874Savos	    R92C_SYS_CLKR_RING_EN |
3528295874Savos	    0x4000);
3529295874Savos
3530295874Savos	/* Disable AFE PLL */
3531295874Savos	urtwn_write_1(sc, R92C_AFE_PLL_CTRL, 0x80);
3532295874Savos
3533295874Savos	/* Gated AFE DIG_CLOCK */
3534295874Savos	urtwn_write_2(sc, R92C_AFE_XTAL_CTRL, 0x880F);
3535295874Savos
3536295874Savos	/* Isolated digital to PON */
3537295874Savos	urtwn_write_1(sc, R92C_SYS_ISO_CTRL,
3538295874Savos	    R92C_SYS_ISO_CTRL_MD2PP |
3539295874Savos	    R92C_SYS_ISO_CTRL_PA2PCIE |
3540295874Savos	    R92C_SYS_ISO_CTRL_PD2CORE |
3541295874Savos	    R92C_SYS_ISO_CTRL_IP2MAC |
3542295874Savos	    R92C_SYS_ISO_CTRL_DIOP |
3543295874Savos	    R92C_SYS_ISO_CTRL_DIOE);
3544295874Savos
3545295874Savos	/*
3546295874Savos	 * Pull GPIO PIN to balance level and LED control
3547295874Savos	 */
3548295874Savos	/* 1. Disable GPIO[7:0] */
3549295874Savos	urtwn_write_2(sc, R92C_GPIO_IOSEL, 0x0000);
3550295874Savos
3551295874Savos	reg = urtwn_read_4(sc, R92C_GPIO_PIN_CTRL) & ~0x0000ff00;
3552295874Savos	reg |= ((reg << 8) & 0x0000ff00) | 0x00ff0000;
3553295874Savos	urtwn_write_4(sc, R92C_GPIO_PIN_CTRL, reg);
3554295874Savos
3555295874Savos	/* Disable GPIO[10:8] */
3556295874Savos	urtwn_write_1(sc, R92C_MAC_PINMUX_CFG, 0x00);
3557295874Savos
3558295874Savos	reg = urtwn_read_2(sc, R92C_GPIO_IO_SEL) & ~0x00f0;
3559295874Savos	reg |= (((reg & 0x000f) << 4) | 0x0780);
3560295874Savos	urtwn_write_2(sc, R92C_GPIO_IO_SEL, reg);
3561295874Savos
3562295874Savos	/* Disable LED0 & 1 */
3563295874Savos	urtwn_write_2(sc, R92C_LEDCFG0, 0x8080);
3564295874Savos
3565295874Savos	/*
3566295874Savos	 * Reset digital sequence
3567295874Savos	 */
3568295874Savos	/* Disable ELDR clock */
3569295874Savos	urtwn_write_2(sc, R92C_SYS_CLKR,
3570295874Savos	    R92C_SYS_CLKR_ANAD16V_EN |
3571295874Savos	    R92C_SYS_CLKR_ANA8M |
3572295874Savos	    R92C_SYS_CLKR_LOADER_EN |
3573295874Savos	    R92C_SYS_CLKR_80M_SSC_DIS |
3574295874Savos	    R92C_SYS_CLKR_SYS_EN |
3575295874Savos	    R92C_SYS_CLKR_RING_EN |
3576295874Savos	    0x4000);
3577295874Savos
3578295874Savos	/* Isolated ELDR to PON */
3579295874Savos	urtwn_write_1(sc, R92C_SYS_ISO_CTRL + 1,
3580295874Savos	    (R92C_SYS_ISO_CTRL_DIOR |
3581295874Savos	     R92C_SYS_ISO_CTRL_PWC_EV12V) >> 8);
3582295874Savos
3583295874Savos	/*
3584295874Savos	 * Disable analog sequence
3585295874Savos	 */
3586295874Savos	/* Disable A15 power */
3587295874Savos	urtwn_write_1(sc, R92C_LDOA15_CTRL, R92C_LDOA15_CTRL_OBUF);
3588295874Savos	/* Disable digital core power */
3589295874Savos	urtwn_write_1(sc, R92C_LDOV12D_CTRL,
3590295874Savos	    urtwn_read_1(sc, R92C_LDOV12D_CTRL) &
3591295874Savos	      ~R92C_LDOV12D_CTRL_LDV12_EN);
3592295874Savos
3593295874Savos	/* Enter PFM mode */
3594295874Savos	urtwn_write_1(sc, R92C_SPS0_CTRL, 0x23);
3595295874Savos
3596295874Savos	/* Set USB suspend */
3597295874Savos	urtwn_write_2(sc, R92C_APS_FSMCO,
3598295874Savos	    R92C_APS_FSMCO_APDM_HOST |
3599295874Savos	    R92C_APS_FSMCO_AFSM_HSUS |
3600295874Savos	    R92C_APS_FSMCO_PFM_ALDN);
3601295874Savos
3602295874Savos	/* Lock ISO/CLK/Power control register. */
3603295874Savos	urtwn_write_1(sc, R92C_RSV_CTRL, 0x0E);
3604295874Savos}
3605295874Savos
3606295874Savosstatic void
3607295874Savosurtwn_r88e_power_off(struct urtwn_softc *sc)
3608295874Savos{
3609295874Savos	uint8_t reg;
3610295874Savos	int ntries;
3611295874Savos
3612295874Savos	/* Disable any kind of TX reports. */
3613295874Savos	urtwn_write_1(sc, R88E_TX_RPT_CTRL,
3614295874Savos	    urtwn_read_1(sc, R88E_TX_RPT_CTRL) &
3615295874Savos	      ~(R88E_TX_RPT1_ENA | R88E_TX_RPT2_ENA));
3616295874Savos
3617295874Savos	/* Stop Rx. */
3618295874Savos	urtwn_write_1(sc, R92C_CR, 0);
3619295874Savos
3620295874Savos	/* Move card to Low Power State. */
3621295874Savos	/* Block all Tx queues. */
3622295874Savos	urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL);
3623295874Savos
3624295874Savos	for (ntries = 0; ntries < 20; ntries++) {
3625295874Savos		/* Should be zero if no packet is transmitting. */
3626295874Savos		if (urtwn_read_4(sc, R88E_SCH_TXCMD) == 0)
3627295874Savos			break;
3628295874Savos
3629295874Savos		urtwn_ms_delay(sc);
3630295874Savos	}
3631295874Savos	if (ntries == 20) {
3632295874Savos		device_printf(sc->sc_dev, "%s: failed to block Tx queues\n",
3633295874Savos		    __func__);
3634295874Savos		return;
3635295874Savos	}
3636295874Savos
3637295874Savos	/* CCK and OFDM are disabled, and clock are gated. */
3638295874Savos	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
3639295874Savos	    urtwn_read_1(sc, R92C_SYS_FUNC_EN) & ~R92C_SYS_FUNC_EN_BBRSTB);
3640295874Savos
3641295874Savos	urtwn_ms_delay(sc);
3642295874Savos
3643295874Savos	/* Reset MAC TRX */
3644295874Savos	urtwn_write_1(sc, R92C_CR,
3645295874Savos	    R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN |
3646295874Savos	    R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN |
3647295874Savos	    R92C_CR_PROTOCOL_EN | R92C_CR_SCHEDULE_EN);
3648295874Savos
3649295874Savos	/* check if removed later */
3650295874Savos	urtwn_write_1(sc, R92C_CR + 1,
3651295874Savos	    urtwn_read_1(sc, R92C_CR + 1) & ~(R92C_CR_ENSEC >> 8));
3652295874Savos
3653295874Savos	/* Respond TxOK to scheduler */
3654295874Savos	urtwn_write_1(sc, R92C_DUAL_TSF_RST,
3655295874Savos	    urtwn_read_1(sc, R92C_DUAL_TSF_RST) | 0x20);
3656295874Savos
3657295874Savos	/* If firmware in ram code, do reset. */
3658295874Savos#ifndef URTWN_WITHOUT_UCODE
3659295874Savos	if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RDY)
3660295874Savos		urtwn_r88e_fw_reset(sc);
3661295874Savos#endif
3662295874Savos
3663295874Savos	/* Reset MCU ready status. */
3664295874Savos	urtwn_write_1(sc, R92C_MCUFWDL, 0x00);
3665295874Savos
3666295874Savos	/* Disable 32k. */
3667295874Savos	urtwn_write_1(sc, R88E_32K_CTRL,
3668295874Savos	    urtwn_read_1(sc, R88E_32K_CTRL) & ~0x01);
3669295874Savos
3670295874Savos	/* Move card to Disabled state. */
3671295874Savos	/* Turn off RF. */
3672295874Savos	urtwn_write_1(sc, R92C_RF_CTRL, 0);
3673295874Savos
3674295874Savos	/* LDO Sleep mode. */
3675295874Savos	urtwn_write_1(sc, R92C_LPLDO_CTRL,
3676295874Savos	    urtwn_read_1(sc, R92C_LPLDO_CTRL) | R92C_LPLDO_CTRL_SLEEP);
3677295874Savos
3678295874Savos	/* Turn off MAC by HW state machine */
3679295874Savos	urtwn_write_1(sc, R92C_APS_FSMCO + 1,
3680295874Savos	    urtwn_read_1(sc, R92C_APS_FSMCO + 1) |
3681295874Savos	    (R92C_APS_FSMCO_APFM_OFF >> 8));
3682295874Savos
3683295874Savos	for (ntries = 0; ntries < 20; ntries++) {
3684295874Savos		/* Wait until it will be disabled. */
3685295874Savos		if ((urtwn_read_1(sc, R92C_APS_FSMCO + 1) &
3686295874Savos		    (R92C_APS_FSMCO_APFM_OFF >> 8)) == 0)
3687295874Savos			break;
3688295874Savos
3689295874Savos		urtwn_ms_delay(sc);
3690295874Savos	}
3691295874Savos	if (ntries == 20) {
3692295874Savos		device_printf(sc->sc_dev, "%s: could not turn off MAC\n",
3693295874Savos		    __func__);
3694295874Savos		return;
3695295874Savos	}
3696295874Savos
3697295874Savos	/* schmit trigger */
3698295874Savos	urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 2,
3699295874Savos	    urtwn_read_1(sc, R92C_AFE_XTAL_CTRL + 2) | 0x80);
3700295874Savos
3701295874Savos	/* Enable WL suspend. */
3702295874Savos	urtwn_write_1(sc, R92C_APS_FSMCO + 1,
3703295874Savos	    (urtwn_read_1(sc, R92C_APS_FSMCO + 1) & ~0x10) | 0x08);
3704295874Savos
3705295874Savos	/* Enable bandgap mbias in suspend. */
3706295874Savos	urtwn_write_1(sc, R92C_APS_FSMCO + 3, 0);
3707295874Savos
3708295874Savos	/* Clear SIC_EN register. */
3709295874Savos	urtwn_write_1(sc, R92C_GPIO_MUXCFG + 1,
3710295874Savos	    urtwn_read_1(sc, R92C_GPIO_MUXCFG + 1) & ~0x10);
3711295874Savos
3712295874Savos	/* Set USB suspend enable local register */
3713295874Savos	urtwn_write_1(sc, R92C_USB_SUSPEND,
3714295874Savos	    urtwn_read_1(sc, R92C_USB_SUSPEND) | 0x10);
3715295874Savos
3716295874Savos	/* Reset MCU IO Wrapper. */
3717295874Savos	reg = urtwn_read_1(sc, R92C_RSV_CTRL + 1);
3718295874Savos	urtwn_write_1(sc, R92C_RSV_CTRL + 1, reg & ~0x08);
3719295874Savos	urtwn_write_1(sc, R92C_RSV_CTRL + 1, reg | 0x08);
3720295874Savos
3721295874Savos	/* marked as 'For Power Consumption' code. */
3722295874Savos	urtwn_write_1(sc, R92C_GPIO_OUT, urtwn_read_1(sc, R92C_GPIO_IN));
3723295874Savos	urtwn_write_1(sc, R92C_GPIO_IOSEL, 0xff);
3724295874Savos
3725295874Savos	urtwn_write_1(sc, R92C_GPIO_IO_SEL,
3726295874Savos	    urtwn_read_1(sc, R92C_GPIO_IO_SEL) << 4);
3727295874Savos	urtwn_write_1(sc, R92C_GPIO_MOD,
3728295874Savos	    urtwn_read_1(sc, R92C_GPIO_MOD) | 0x0f);
3729295874Savos
3730295874Savos	/* Set LNA, TRSW, EX_PA Pin to output mode. */
3731295874Savos	urtwn_write_4(sc, R88E_BB_PAD_CTRL, 0x00080808);
3732295874Savos}
3733295874Savos
3734264912Skevlostatic int
3735251538Srpaulourtwn_llt_init(struct urtwn_softc *sc)
3736251538Srpaulo{
3737264912Skevlo	int i, error, page_count, pktbuf_count;
3738251538Srpaulo
3739264912Skevlo	page_count = (sc->chip & URTWN_CHIP_88E) ?
3740264912Skevlo	    R88E_TX_PAGE_COUNT : R92C_TX_PAGE_COUNT;
3741264912Skevlo	pktbuf_count = (sc->chip & URTWN_CHIP_88E) ?
3742264912Skevlo	    R88E_TXPKTBUF_COUNT : R92C_TXPKTBUF_COUNT;
3743264912Skevlo
3744264912Skevlo	/* Reserve pages [0; page_count]. */
3745264912Skevlo	for (i = 0; i < page_count; i++) {
3746251538Srpaulo		if ((error = urtwn_llt_write(sc, i, i + 1)) != 0)
3747251538Srpaulo			return (error);
3748251538Srpaulo	}
3749251538Srpaulo	/* NB: 0xff indicates end-of-list. */
3750251538Srpaulo	if ((error = urtwn_llt_write(sc, i, 0xff)) != 0)
3751251538Srpaulo		return (error);
3752251538Srpaulo	/*
3753264912Skevlo	 * Use pages [page_count + 1; pktbuf_count - 1]
3754251538Srpaulo	 * as ring buffer.
3755251538Srpaulo	 */
3756264912Skevlo	for (++i; i < pktbuf_count - 1; i++) {
3757251538Srpaulo		if ((error = urtwn_llt_write(sc, i, i + 1)) != 0)
3758251538Srpaulo			return (error);
3759251538Srpaulo	}
3760251538Srpaulo	/* Make the last page point to the beginning of the ring buffer. */
3761264912Skevlo	error = urtwn_llt_write(sc, i, page_count + 1);
3762251538Srpaulo	return (error);
3763251538Srpaulo}
3764251538Srpaulo
3765295871Savos#ifndef URTWN_WITHOUT_UCODE
3766251538Srpaulostatic void
3767251538Srpaulourtwn_fw_reset(struct urtwn_softc *sc)
3768251538Srpaulo{
3769251538Srpaulo	uint16_t reg;
3770251538Srpaulo	int ntries;
3771251538Srpaulo
3772251538Srpaulo	/* Tell 8051 to reset itself. */
3773251538Srpaulo	urtwn_write_1(sc, R92C_HMETFR + 3, 0x20);
3774251538Srpaulo
3775251538Srpaulo	/* Wait until 8051 resets by itself. */
3776251538Srpaulo	for (ntries = 0; ntries < 100; ntries++) {
3777251538Srpaulo		reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
3778251538Srpaulo		if (!(reg & R92C_SYS_FUNC_EN_CPUEN))
3779251538Srpaulo			return;
3780266472Shselasky		urtwn_ms_delay(sc);
3781251538Srpaulo	}
3782251538Srpaulo	/* Force 8051 reset. */
3783251538Srpaulo	urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN);
3784251538Srpaulo}
3785251538Srpaulo
3786264912Skevlostatic void
3787264912Skevlourtwn_r88e_fw_reset(struct urtwn_softc *sc)
3788264912Skevlo{
3789264912Skevlo	uint16_t reg;
3790264912Skevlo
3791264912Skevlo	reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
3792264912Skevlo	urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN);
3793264912Skevlo	urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg | R92C_SYS_FUNC_EN_CPUEN);
3794264912Skevlo}
3795264912Skevlo
3796251538Srpaulostatic int
3797251538Srpaulourtwn_fw_loadpage(struct urtwn_softc *sc, int page, const uint8_t *buf, int len)
3798251538Srpaulo{
3799251538Srpaulo	uint32_t reg;
3800291698Savos	usb_error_t error = USB_ERR_NORMAL_COMPLETION;
3801291698Savos	int off, mlen;
3802251538Srpaulo
3803251538Srpaulo	reg = urtwn_read_4(sc, R92C_MCUFWDL);
3804251538Srpaulo	reg = RW(reg, R92C_MCUFWDL_PAGE, page);
3805251538Srpaulo	urtwn_write_4(sc, R92C_MCUFWDL, reg);
3806251538Srpaulo
3807251538Srpaulo	off = R92C_FW_START_ADDR;
3808251538Srpaulo	while (len > 0) {
3809251538Srpaulo		if (len > 196)
3810251538Srpaulo			mlen = 196;
3811251538Srpaulo		else if (len > 4)
3812251538Srpaulo			mlen = 4;
3813251538Srpaulo		else
3814251538Srpaulo			mlen = 1;
3815251538Srpaulo		/* XXX fix this deconst */
3816281069Srpaulo		error = urtwn_write_region_1(sc, off,
3817251538Srpaulo		    __DECONST(uint8_t *, buf), mlen);
3818291698Savos		if (error != USB_ERR_NORMAL_COMPLETION)
3819251538Srpaulo			break;
3820251538Srpaulo		off += mlen;
3821251538Srpaulo		buf += mlen;
3822251538Srpaulo		len -= mlen;
3823251538Srpaulo	}
3824251538Srpaulo	return (error);
3825251538Srpaulo}
3826251538Srpaulo
3827251538Srpaulostatic int
3828251538Srpaulourtwn_load_firmware(struct urtwn_softc *sc)
3829251538Srpaulo{
3830251538Srpaulo	const struct firmware *fw;
3831251538Srpaulo	const struct r92c_fw_hdr *hdr;
3832251538Srpaulo	const char *imagename;
3833251538Srpaulo	const u_char *ptr;
3834251538Srpaulo	size_t len;
3835251538Srpaulo	uint32_t reg;
3836251538Srpaulo	int mlen, ntries, page, error;
3837251538Srpaulo
3838264864Skevlo	URTWN_UNLOCK(sc);
3839251538Srpaulo	/* Read firmware image from the filesystem. */
3840264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
3841264912Skevlo		imagename = "urtwn-rtl8188eufw";
3842264912Skevlo	else if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) ==
3843264912Skevlo		    URTWN_CHIP_UMC_A_CUT)
3844251538Srpaulo		imagename = "urtwn-rtl8192cfwU";
3845251538Srpaulo	else
3846251538Srpaulo		imagename = "urtwn-rtl8192cfwT";
3847251538Srpaulo
3848251538Srpaulo	fw = firmware_get(imagename);
3849264864Skevlo	URTWN_LOCK(sc);
3850251538Srpaulo	if (fw == NULL) {
3851251538Srpaulo		device_printf(sc->sc_dev,
3852251538Srpaulo		    "failed loadfirmware of file %s\n", imagename);
3853251538Srpaulo		return (ENOENT);
3854251538Srpaulo	}
3855251538Srpaulo
3856251538Srpaulo	len = fw->datasize;
3857251538Srpaulo
3858251538Srpaulo	if (len < sizeof(*hdr)) {
3859251538Srpaulo		device_printf(sc->sc_dev, "firmware too short\n");
3860251538Srpaulo		error = EINVAL;
3861251538Srpaulo		goto fail;
3862251538Srpaulo	}
3863251538Srpaulo	ptr = fw->data;
3864251538Srpaulo	hdr = (const struct r92c_fw_hdr *)ptr;
3865251538Srpaulo	/* Check if there is a valid FW header and skip it. */
3866251538Srpaulo	if ((le16toh(hdr->signature) >> 4) == 0x88c ||
3867264912Skevlo	    (le16toh(hdr->signature) >> 4) == 0x88e ||
3868251538Srpaulo	    (le16toh(hdr->signature) >> 4) == 0x92c) {
3869294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_FIRMWARE,
3870294471Savos		    "FW V%d.%d %02d-%02d %02d:%02d\n",
3871251538Srpaulo		    le16toh(hdr->version), le16toh(hdr->subversion),
3872251538Srpaulo		    hdr->month, hdr->date, hdr->hour, hdr->minute);
3873251538Srpaulo		ptr += sizeof(*hdr);
3874251538Srpaulo		len -= sizeof(*hdr);
3875251538Srpaulo	}
3876251538Srpaulo
3877264912Skevlo	if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RAM_DL_SEL) {
3878264912Skevlo		if (sc->chip & URTWN_CHIP_88E)
3879264912Skevlo			urtwn_r88e_fw_reset(sc);
3880264912Skevlo		else
3881264912Skevlo			urtwn_fw_reset(sc);
3882251538Srpaulo		urtwn_write_1(sc, R92C_MCUFWDL, 0);
3883251538Srpaulo	}
3884264912Skevlo
3885268487Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
3886268487Skevlo		urtwn_write_2(sc, R92C_SYS_FUNC_EN,
3887268487Skevlo		    urtwn_read_2(sc, R92C_SYS_FUNC_EN) |
3888268487Skevlo		    R92C_SYS_FUNC_EN_CPUEN);
3889268487Skevlo	}
3890251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL,
3891251538Srpaulo	    urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_EN);
3892251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL + 2,
3893251538Srpaulo	    urtwn_read_1(sc, R92C_MCUFWDL + 2) & ~0x08);
3894251538Srpaulo
3895263154Skevlo	/* Reset the FWDL checksum. */
3896263154Skevlo	urtwn_write_1(sc, R92C_MCUFWDL,
3897263154Skevlo	    urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_CHKSUM_RPT);
3898263154Skevlo
3899251538Srpaulo	for (page = 0; len > 0; page++) {
3900251538Srpaulo		mlen = min(len, R92C_FW_PAGE_SIZE);
3901251538Srpaulo		error = urtwn_fw_loadpage(sc, page, ptr, mlen);
3902251538Srpaulo		if (error != 0) {
3903251538Srpaulo			device_printf(sc->sc_dev,
3904251538Srpaulo			    "could not load firmware page\n");
3905251538Srpaulo			goto fail;
3906251538Srpaulo		}
3907251538Srpaulo		ptr += mlen;
3908251538Srpaulo		len -= mlen;
3909251538Srpaulo	}
3910251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL,
3911251538Srpaulo	    urtwn_read_1(sc, R92C_MCUFWDL) & ~R92C_MCUFWDL_EN);
3912251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL + 1, 0);
3913251538Srpaulo
3914251538Srpaulo	/* Wait for checksum report. */
3915251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
3916251538Srpaulo		if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_CHKSUM_RPT)
3917251538Srpaulo			break;
3918266472Shselasky		urtwn_ms_delay(sc);
3919251538Srpaulo	}
3920251538Srpaulo	if (ntries == 1000) {
3921251538Srpaulo		device_printf(sc->sc_dev,
3922251538Srpaulo		    "timeout waiting for checksum report\n");
3923251538Srpaulo		error = ETIMEDOUT;
3924251538Srpaulo		goto fail;
3925251538Srpaulo	}
3926251538Srpaulo
3927251538Srpaulo	reg = urtwn_read_4(sc, R92C_MCUFWDL);
3928251538Srpaulo	reg = (reg & ~R92C_MCUFWDL_WINTINI_RDY) | R92C_MCUFWDL_RDY;
3929251538Srpaulo	urtwn_write_4(sc, R92C_MCUFWDL, reg);
3930264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
3931264912Skevlo		urtwn_r88e_fw_reset(sc);
3932251538Srpaulo	/* Wait for firmware readiness. */
3933251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
3934251538Srpaulo		if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_WINTINI_RDY)
3935251538Srpaulo			break;
3936266472Shselasky		urtwn_ms_delay(sc);
3937251538Srpaulo	}
3938251538Srpaulo	if (ntries == 1000) {
3939251538Srpaulo		device_printf(sc->sc_dev,
3940251538Srpaulo		    "timeout waiting for firmware readiness\n");
3941251538Srpaulo		error = ETIMEDOUT;
3942251538Srpaulo		goto fail;
3943251538Srpaulo	}
3944251538Srpaulofail:
3945251538Srpaulo	firmware_put(fw, FIRMWARE_UNLOAD);
3946251538Srpaulo	return (error);
3947251538Srpaulo}
3948295871Savos#endif
3949251538Srpaulo
3950291902Skevlostatic int
3951251538Srpaulourtwn_dma_init(struct urtwn_softc *sc)
3952251538Srpaulo{
3953291902Skevlo	struct usb_endpoint *ep, *ep_end;
3954291698Savos	usb_error_t usb_err;
3955291902Skevlo	uint32_t reg;
3956291902Skevlo	int hashq, hasnq, haslq, nqueues, ntx;
3957291902Skevlo	int error, pagecount, npubqpages, nqpages, nrempages, tx_boundary;
3958281069Srpaulo
3959291695Savos	/* Initialize LLT table. */
3960291695Savos	error = urtwn_llt_init(sc);
3961291695Savos	if (error != 0)
3962291695Savos		return (error);
3963291695Savos
3964291902Skevlo	/* Determine the number of bulk-out pipes. */
3965291902Skevlo	ntx = 0;
3966291902Skevlo	ep = sc->sc_udev->endpoints;
3967291902Skevlo	ep_end = sc->sc_udev->endpoints + sc->sc_udev->endpoints_max;
3968291902Skevlo	for (; ep != ep_end; ep++) {
3969291902Skevlo		if ((ep->edesc == NULL) ||
3970291902Skevlo		    (ep->iface_index != sc->sc_iface_index))
3971291902Skevlo			continue;
3972291902Skevlo		if (UE_GET_DIR(ep->edesc->bEndpointAddress) == UE_DIR_OUT)
3973291902Skevlo			ntx++;
3974291902Skevlo	}
3975291902Skevlo	if (ntx == 0) {
3976291902Skevlo		device_printf(sc->sc_dev,
3977291902Skevlo		    "%d: invalid number of Tx bulk pipes\n", ntx);
3978291698Savos		return (EIO);
3979291902Skevlo	}
3980291695Savos
3981251538Srpaulo	/* Get Tx queues to USB endpoints mapping. */
3982291902Skevlo	hashq = hasnq = haslq = nqueues = 0;
3983291902Skevlo	switch (ntx) {
3984291902Skevlo	case 1: hashq = 1; break;
3985291902Skevlo	case 2: hashq = hasnq = 1; break;
3986291902Skevlo	case 3: case 4: hashq = hasnq = haslq = 1; break;
3987291902Skevlo	}
3988251538Srpaulo	nqueues = hashq + hasnq + haslq;
3989251538Srpaulo	if (nqueues == 0)
3990251538Srpaulo		return (EIO);
3991251538Srpaulo
3992291902Skevlo	npubqpages = nqpages = nrempages = pagecount = 0;
3993291902Skevlo	if (sc->chip & URTWN_CHIP_88E)
3994291902Skevlo		tx_boundary = R88E_TX_PAGE_BOUNDARY;
3995291902Skevlo	else {
3996291902Skevlo		pagecount = R92C_TX_PAGE_COUNT;
3997291902Skevlo		npubqpages = R92C_PUBQ_NPAGES;
3998291902Skevlo		tx_boundary = R92C_TX_PAGE_BOUNDARY;
3999291902Skevlo	}
4000291902Skevlo
4001251538Srpaulo	/* Set number of pages for normal priority queue. */
4002291902Skevlo	if (sc->chip & URTWN_CHIP_88E) {
4003291902Skevlo		usb_err = urtwn_write_2(sc, R92C_RQPN_NPQ, 0xd);
4004291902Skevlo		if (usb_err != USB_ERR_NORMAL_COMPLETION)
4005291902Skevlo			return (EIO);
4006291902Skevlo		usb_err = urtwn_write_4(sc, R92C_RQPN, 0x808e000d);
4007291902Skevlo		if (usb_err != USB_ERR_NORMAL_COMPLETION)
4008291902Skevlo			return (EIO);
4009291902Skevlo	} else {
4010291902Skevlo		/* Get the number of pages for each queue. */
4011291902Skevlo		nqpages = (pagecount - npubqpages) / nqueues;
4012291902Skevlo		/*
4013291902Skevlo		 * The remaining pages are assigned to the high priority
4014291902Skevlo		 * queue.
4015291902Skevlo		 */
4016291902Skevlo		nrempages = (pagecount - npubqpages) % nqueues;
4017291902Skevlo		usb_err = urtwn_write_1(sc, R92C_RQPN_NPQ, hasnq ? nqpages : 0);
4018291902Skevlo		if (usb_err != USB_ERR_NORMAL_COMPLETION)
4019291902Skevlo			return (EIO);
4020291902Skevlo		usb_err = urtwn_write_4(sc, R92C_RQPN,
4021291902Skevlo		    /* Set number of pages for public queue. */
4022291902Skevlo		    SM(R92C_RQPN_PUBQ, npubqpages) |
4023291902Skevlo		    /* Set number of pages for high priority queue. */
4024291902Skevlo		    SM(R92C_RQPN_HPQ, hashq ? nqpages + nrempages : 0) |
4025291902Skevlo		    /* Set number of pages for low priority queue. */
4026291902Skevlo		    SM(R92C_RQPN_LPQ, haslq ? nqpages : 0) |
4027291902Skevlo		    /* Load values. */
4028291902Skevlo		    R92C_RQPN_LD);
4029291902Skevlo		if (usb_err != USB_ERR_NORMAL_COMPLETION)
4030291902Skevlo			return (EIO);
4031291902Skevlo	}
4032251538Srpaulo
4033291902Skevlo	usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_BCNQ_BDNY, tx_boundary);
4034291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4035291698Savos		return (EIO);
4036291902Skevlo	usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_MGQ_BDNY, tx_boundary);
4037291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4038291698Savos		return (EIO);
4039291902Skevlo	usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_WMAC_LBK_BF_HD, tx_boundary);
4040291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4041291698Savos		return (EIO);
4042291902Skevlo	usb_err = urtwn_write_1(sc, R92C_TRXFF_BNDY, tx_boundary);
4043291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4044291698Savos		return (EIO);
4045291902Skevlo	usb_err = urtwn_write_1(sc, R92C_TDECTRL + 1, tx_boundary);
4046291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4047291698Savos		return (EIO);
4048251538Srpaulo
4049251538Srpaulo	/* Set queue to USB pipe mapping. */
4050251538Srpaulo	reg = urtwn_read_2(sc, R92C_TRXDMA_CTRL);
4051251538Srpaulo	reg &= ~R92C_TRXDMA_CTRL_QMAP_M;
4052251538Srpaulo	if (nqueues == 1) {
4053251538Srpaulo		if (hashq)
4054251538Srpaulo			reg |= R92C_TRXDMA_CTRL_QMAP_HQ;
4055251538Srpaulo		else if (hasnq)
4056251538Srpaulo			reg |= R92C_TRXDMA_CTRL_QMAP_NQ;
4057251538Srpaulo		else
4058251538Srpaulo			reg |= R92C_TRXDMA_CTRL_QMAP_LQ;
4059251538Srpaulo	} else if (nqueues == 2) {
4060292056Skevlo		/*
4061292056Skevlo		 * All 2-endpoints configs have high and normal
4062292056Skevlo		 * priority queues.
4063292056Skevlo		 */
4064292056Skevlo		reg |= R92C_TRXDMA_CTRL_QMAP_HQ_NQ;
4065251538Srpaulo	} else
4066251538Srpaulo		reg |= R92C_TRXDMA_CTRL_QMAP_3EP;
4067291902Skevlo	usb_err = urtwn_write_2(sc, R92C_TRXDMA_CTRL, reg);
4068291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4069291698Savos		return (EIO);
4070251538Srpaulo
4071251538Srpaulo	/* Set Tx/Rx transfer page boundary. */
4072291902Skevlo	usb_err = urtwn_write_2(sc, R92C_TRXFF_BNDY + 2,
4073291902Skevlo	    (sc->chip & URTWN_CHIP_88E) ? 0x23ff : 0x27ff);
4074291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4075291698Savos		return (EIO);
4076251538Srpaulo
4077291902Skevlo	/* Set Tx/Rx transfer page size. */
4078291902Skevlo	usb_err = urtwn_write_1(sc, R92C_PBP,
4079291902Skevlo	    SM(R92C_PBP_PSRX, R92C_PBP_128) |
4080291902Skevlo	    SM(R92C_PBP_PSTX, R92C_PBP_128));
4081291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4082264912Skevlo		return (EIO);
4083264912Skevlo
4084264912Skevlo	return (0);
4085264912Skevlo}
4086264912Skevlo
4087291698Savosstatic int
4088251538Srpaulourtwn_mac_init(struct urtwn_softc *sc)
4089251538Srpaulo{
4090291698Savos	usb_error_t error;
4091251538Srpaulo	int i;
4092251538Srpaulo
4093251538Srpaulo	/* Write MAC initialization values. */
4094264912Skevlo	if (sc->chip & URTWN_CHIP_88E) {
4095264912Skevlo		for (i = 0; i < nitems(rtl8188eu_mac); i++) {
4096291698Savos			error = urtwn_write_1(sc, rtl8188eu_mac[i].reg,
4097264912Skevlo			    rtl8188eu_mac[i].val);
4098291698Savos			if (error != USB_ERR_NORMAL_COMPLETION)
4099291698Savos				return (EIO);
4100264912Skevlo		}
4101264912Skevlo		urtwn_write_1(sc, R92C_MAX_AGGR_NUM, 0x07);
4102264912Skevlo	} else {
4103264912Skevlo		for (i = 0; i < nitems(rtl8192cu_mac); i++)
4104291698Savos			error = urtwn_write_1(sc, rtl8192cu_mac[i].reg,
4105264912Skevlo			    rtl8192cu_mac[i].val);
4106291698Savos			if (error != USB_ERR_NORMAL_COMPLETION)
4107291698Savos				return (EIO);
4108264912Skevlo	}
4109291698Savos
4110291698Savos	return (0);
4111251538Srpaulo}
4112251538Srpaulo
4113251538Srpaulostatic void
4114251538Srpaulourtwn_bb_init(struct urtwn_softc *sc)
4115251538Srpaulo{
4116251538Srpaulo	const struct urtwn_bb_prog *prog;
4117251538Srpaulo	uint32_t reg;
4118264912Skevlo	uint8_t crystalcap;
4119251538Srpaulo	int i;
4120251538Srpaulo
4121251538Srpaulo	/* Enable BB and RF. */
4122251538Srpaulo	urtwn_write_2(sc, R92C_SYS_FUNC_EN,
4123251538Srpaulo	    urtwn_read_2(sc, R92C_SYS_FUNC_EN) |
4124251538Srpaulo	    R92C_SYS_FUNC_EN_BBRSTB | R92C_SYS_FUNC_EN_BB_GLB_RST |
4125251538Srpaulo	    R92C_SYS_FUNC_EN_DIO_RF);
4126251538Srpaulo
4127264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E))
4128264912Skevlo		urtwn_write_2(sc, R92C_AFE_PLL_CTRL, 0xdb83);
4129251538Srpaulo
4130251538Srpaulo	urtwn_write_1(sc, R92C_RF_CTRL,
4131251538Srpaulo	    R92C_RF_CTRL_EN | R92C_RF_CTRL_RSTB | R92C_RF_CTRL_SDMRSTB);
4132251538Srpaulo	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
4133251538Srpaulo	    R92C_SYS_FUNC_EN_USBA | R92C_SYS_FUNC_EN_USBD |
4134251538Srpaulo	    R92C_SYS_FUNC_EN_BB_GLB_RST | R92C_SYS_FUNC_EN_BBRSTB);
4135251538Srpaulo
4136264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
4137264912Skevlo		urtwn_write_1(sc, R92C_LDOHCI12_CTRL, 0x0f);
4138264912Skevlo		urtwn_write_1(sc, 0x15, 0xe9);
4139264912Skevlo		urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 1, 0x80);
4140264912Skevlo	}
4141251538Srpaulo
4142251538Srpaulo	/* Select BB programming based on board type. */
4143264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
4144264912Skevlo		prog = &rtl8188eu_bb_prog;
4145264912Skevlo	else if (!(sc->chip & URTWN_CHIP_92C)) {
4146251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_MINICARD)
4147251538Srpaulo			prog = &rtl8188ce_bb_prog;
4148251538Srpaulo		else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA)
4149251538Srpaulo			prog = &rtl8188ru_bb_prog;
4150251538Srpaulo		else
4151251538Srpaulo			prog = &rtl8188cu_bb_prog;
4152251538Srpaulo	} else {
4153251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_MINICARD)
4154251538Srpaulo			prog = &rtl8192ce_bb_prog;
4155251538Srpaulo		else
4156251538Srpaulo			prog = &rtl8192cu_bb_prog;
4157251538Srpaulo	}
4158251538Srpaulo	/* Write BB initialization values. */
4159251538Srpaulo	for (i = 0; i < prog->count; i++) {
4160251538Srpaulo		urtwn_bb_write(sc, prog->regs[i], prog->vals[i]);
4161266472Shselasky		urtwn_ms_delay(sc);
4162251538Srpaulo	}
4163251538Srpaulo
4164251538Srpaulo	if (sc->chip & URTWN_CHIP_92C_1T2R) {
4165251538Srpaulo		/* 8192C 1T only configuration. */
4166251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_TXINFO);
4167251538Srpaulo		reg = (reg & ~0x00000003) | 0x2;
4168251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_TXINFO, reg);
4169251538Srpaulo
4170251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA1_TXINFO);
4171251538Srpaulo		reg = (reg & ~0x00300033) | 0x00200022;
4172251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA1_TXINFO, reg);
4173251538Srpaulo
4174251538Srpaulo		reg = urtwn_bb_read(sc, R92C_CCK0_AFESETTING);
4175251538Srpaulo		reg = (reg & ~0xff000000) | 0x45 << 24;
4176251538Srpaulo		urtwn_bb_write(sc, R92C_CCK0_AFESETTING, reg);
4177251538Srpaulo
4178251538Srpaulo		reg = urtwn_bb_read(sc, R92C_OFDM0_TRXPATHENA);
4179251538Srpaulo		reg = (reg & ~0x000000ff) | 0x23;
4180251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM0_TRXPATHENA, reg);
4181251538Srpaulo
4182251538Srpaulo		reg = urtwn_bb_read(sc, R92C_OFDM0_AGCPARAM1);
4183251538Srpaulo		reg = (reg & ~0x00000030) | 1 << 4;
4184251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM0_AGCPARAM1, reg);
4185251538Srpaulo
4186251538Srpaulo		reg = urtwn_bb_read(sc, 0xe74);
4187251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
4188251538Srpaulo		urtwn_bb_write(sc, 0xe74, reg);
4189251538Srpaulo		reg = urtwn_bb_read(sc, 0xe78);
4190251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
4191251538Srpaulo		urtwn_bb_write(sc, 0xe78, reg);
4192251538Srpaulo		reg = urtwn_bb_read(sc, 0xe7c);
4193251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
4194251538Srpaulo		urtwn_bb_write(sc, 0xe7c, reg);
4195251538Srpaulo		reg = urtwn_bb_read(sc, 0xe80);
4196251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
4197251538Srpaulo		urtwn_bb_write(sc, 0xe80, reg);
4198251538Srpaulo		reg = urtwn_bb_read(sc, 0xe88);
4199251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
4200251538Srpaulo		urtwn_bb_write(sc, 0xe88, reg);
4201251538Srpaulo	}
4202251538Srpaulo
4203251538Srpaulo	/* Write AGC values. */
4204251538Srpaulo	for (i = 0; i < prog->agccount; i++) {
4205251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM0_AGCRSSITABLE,
4206251538Srpaulo		    prog->agcvals[i]);
4207266472Shselasky		urtwn_ms_delay(sc);
4208251538Srpaulo	}
4209251538Srpaulo
4210264912Skevlo	if (sc->chip & URTWN_CHIP_88E) {
4211264912Skevlo		urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553422);
4212266472Shselasky		urtwn_ms_delay(sc);
4213264912Skevlo		urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553420);
4214266472Shselasky		urtwn_ms_delay(sc);
4215264912Skevlo
4216294198Savos		crystalcap = sc->rom.r88e_rom.crystalcap;
4217264912Skevlo		if (crystalcap == 0xff)
4218264912Skevlo			crystalcap = 0x20;
4219264912Skevlo		crystalcap &= 0x3f;
4220264912Skevlo		reg = urtwn_bb_read(sc, R92C_AFE_XTAL_CTRL);
4221264912Skevlo		urtwn_bb_write(sc, R92C_AFE_XTAL_CTRL,
4222264912Skevlo		    RW(reg, R92C_AFE_XTAL_CTRL_ADDR,
4223264912Skevlo		    crystalcap | crystalcap << 6));
4224264912Skevlo	} else {
4225264912Skevlo		if (urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)) &
4226264912Skevlo		    R92C_HSSI_PARAM2_CCK_HIPWR)
4227264912Skevlo			sc->sc_flags |= URTWN_FLAG_CCK_HIPWR;
4228264912Skevlo	}
4229251538Srpaulo}
4230251538Srpaulo
4231289066Skevlostatic void
4232251538Srpaulourtwn_rf_init(struct urtwn_softc *sc)
4233251538Srpaulo{
4234251538Srpaulo	const struct urtwn_rf_prog *prog;
4235251538Srpaulo	uint32_t reg, type;
4236251538Srpaulo	int i, j, idx, off;
4237251538Srpaulo
4238251538Srpaulo	/* Select RF programming based on board type. */
4239264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
4240264912Skevlo		prog = rtl8188eu_rf_prog;
4241264912Skevlo	else if (!(sc->chip & URTWN_CHIP_92C)) {
4242251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_MINICARD)
4243251538Srpaulo			prog = rtl8188ce_rf_prog;
4244251538Srpaulo		else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA)
4245251538Srpaulo			prog = rtl8188ru_rf_prog;
4246251538Srpaulo		else
4247251538Srpaulo			prog = rtl8188cu_rf_prog;
4248251538Srpaulo	} else
4249251538Srpaulo		prog = rtl8192ce_rf_prog;
4250251538Srpaulo
4251251538Srpaulo	for (i = 0; i < sc->nrxchains; i++) {
4252251538Srpaulo		/* Save RF_ENV control type. */
4253251538Srpaulo		idx = i / 2;
4254251538Srpaulo		off = (i % 2) * 16;
4255251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx));
4256251538Srpaulo		type = (reg >> off) & 0x10;
4257251538Srpaulo
4258251538Srpaulo		/* Set RF_ENV enable. */
4259251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i));
4260251538Srpaulo		reg |= 0x100000;
4261251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg);
4262266472Shselasky		urtwn_ms_delay(sc);
4263251538Srpaulo		/* Set RF_ENV output high. */
4264251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i));
4265251538Srpaulo		reg |= 0x10;
4266251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg);
4267266472Shselasky		urtwn_ms_delay(sc);
4268251538Srpaulo		/* Set address and data lengths of RF registers. */
4269251538Srpaulo		reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i));
4270251538Srpaulo		reg &= ~R92C_HSSI_PARAM2_ADDR_LENGTH;
4271251538Srpaulo		urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg);
4272266472Shselasky		urtwn_ms_delay(sc);
4273251538Srpaulo		reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i));
4274251538Srpaulo		reg &= ~R92C_HSSI_PARAM2_DATA_LENGTH;
4275251538Srpaulo		urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg);
4276266472Shselasky		urtwn_ms_delay(sc);
4277251538Srpaulo
4278251538Srpaulo		/* Write RF initialization values for this chain. */
4279251538Srpaulo		for (j = 0; j < prog[i].count; j++) {
4280251538Srpaulo			if (prog[i].regs[j] >= 0xf9 &&
4281251538Srpaulo			    prog[i].regs[j] <= 0xfe) {
4282251538Srpaulo				/*
4283251538Srpaulo				 * These are fake RF registers offsets that
4284251538Srpaulo				 * indicate a delay is required.
4285251538Srpaulo				 */
4286266472Shselasky				usb_pause_mtx(&sc->sc_mtx, hz / 20);	/* 50ms */
4287251538Srpaulo				continue;
4288251538Srpaulo			}
4289251538Srpaulo			urtwn_rf_write(sc, i, prog[i].regs[j],
4290251538Srpaulo			    prog[i].vals[j]);
4291266472Shselasky			urtwn_ms_delay(sc);
4292251538Srpaulo		}
4293251538Srpaulo
4294251538Srpaulo		/* Restore RF_ENV control type. */
4295251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx));
4296251538Srpaulo		reg &= ~(0x10 << off) | (type << off);
4297251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFIFACESW(idx), reg);
4298251538Srpaulo
4299251538Srpaulo		/* Cache RF register CHNLBW. */
4300251538Srpaulo		sc->rf_chnlbw[i] = urtwn_rf_read(sc, i, R92C_RF_CHNLBW);
4301251538Srpaulo	}
4302251538Srpaulo
4303251538Srpaulo	if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) ==
4304251538Srpaulo	    URTWN_CHIP_UMC_A_CUT) {
4305251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_RX_G1, 0x30255);
4306251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_RX_G2, 0x50a00);
4307251538Srpaulo	}
4308251538Srpaulo}
4309251538Srpaulo
4310251538Srpaulostatic void
4311251538Srpaulourtwn_cam_init(struct urtwn_softc *sc)
4312251538Srpaulo{
4313251538Srpaulo	/* Invalidate all CAM entries. */
4314251538Srpaulo	urtwn_write_4(sc, R92C_CAMCMD,
4315251538Srpaulo	    R92C_CAMCMD_POLLING | R92C_CAMCMD_CLR);
4316251538Srpaulo}
4317251538Srpaulo
4318292175Savosstatic int
4319292175Savosurtwn_cam_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data)
4320292175Savos{
4321292175Savos	usb_error_t error;
4322292175Savos
4323292175Savos	error = urtwn_write_4(sc, R92C_CAMWRITE, data);
4324292175Savos	if (error != USB_ERR_NORMAL_COMPLETION)
4325292175Savos		return (EIO);
4326292175Savos	error = urtwn_write_4(sc, R92C_CAMCMD,
4327292175Savos	    R92C_CAMCMD_POLLING | R92C_CAMCMD_WRITE |
4328292175Savos	    SM(R92C_CAMCMD_ADDR, addr));
4329292175Savos	if (error != USB_ERR_NORMAL_COMPLETION)
4330292175Savos		return (EIO);
4331292175Savos
4332292175Savos	return (0);
4333292175Savos}
4334292175Savos
4335251538Srpaulostatic void
4336251538Srpaulourtwn_pa_bias_init(struct urtwn_softc *sc)
4337251538Srpaulo{
4338251538Srpaulo	uint8_t reg;
4339251538Srpaulo	int i;
4340251538Srpaulo
4341251538Srpaulo	for (i = 0; i < sc->nrxchains; i++) {
4342251538Srpaulo		if (sc->pa_setting & (1 << i))
4343251538Srpaulo			continue;
4344251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0x0f406);
4345251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0x4f406);
4346251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0x8f406);
4347251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0xcf406);
4348251538Srpaulo	}
4349251538Srpaulo	if (!(sc->pa_setting & 0x10)) {
4350251538Srpaulo		reg = urtwn_read_1(sc, 0x16);
4351251538Srpaulo		reg = (reg & ~0xf0) | 0x90;
4352251538Srpaulo		urtwn_write_1(sc, 0x16, reg);
4353251538Srpaulo	}
4354251538Srpaulo}
4355251538Srpaulo
4356251538Srpaulostatic void
4357251538Srpaulourtwn_rxfilter_init(struct urtwn_softc *sc)
4358251538Srpaulo{
4359290564Savos	struct ieee80211com *ic = &sc->sc_ic;
4360290564Savos	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
4361290564Savos	uint32_t rcr;
4362290564Savos	uint16_t filter;
4363290564Savos
4364290564Savos	URTWN_ASSERT_LOCKED(sc);
4365290564Savos
4366251538Srpaulo	/* Accept all multicast frames. */
4367251538Srpaulo	urtwn_write_4(sc, R92C_MAR + 0, 0xffffffff);
4368251538Srpaulo	urtwn_write_4(sc, R92C_MAR + 4, 0xffffffff);
4369290564Savos
4370290564Savos	/* Filter for management frames. */
4371290564Savos	filter = 0x7f3f;
4372290631Savos	switch (vap->iv_opmode) {
4373290631Savos	case IEEE80211_M_STA:
4374290564Savos		filter &= ~(
4375290564Savos		    R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_ASSOC_REQ) |
4376290564Savos		    R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_REASSOC_REQ) |
4377290564Savos		    R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_PROBE_REQ));
4378290631Savos		break;
4379290631Savos	case IEEE80211_M_HOSTAP:
4380290631Savos		filter &= ~(
4381290631Savos		    R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_ASSOC_RESP) |
4382296174Savos		    R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_REASSOC_RESP));
4383290631Savos		break;
4384290631Savos	case IEEE80211_M_MONITOR:
4385290651Savos	case IEEE80211_M_IBSS:
4386290631Savos		break;
4387290631Savos	default:
4388290631Savos		device_printf(sc->sc_dev, "%s: undefined opmode %d\n",
4389290631Savos		    __func__, vap->iv_opmode);
4390290631Savos		break;
4391290564Savos	}
4392290564Savos	urtwn_write_2(sc, R92C_RXFLTMAP0, filter);
4393290564Savos
4394251538Srpaulo	/* Reject all control frames. */
4395251538Srpaulo	urtwn_write_2(sc, R92C_RXFLTMAP1, 0x0000);
4396290564Savos
4397290564Savos	/* Reject all data frames. */
4398290564Savos	urtwn_write_2(sc, R92C_RXFLTMAP2, 0x0000);
4399290564Savos
4400290564Savos	rcr = R92C_RCR_AM | R92C_RCR_AB | R92C_RCR_APM |
4401290564Savos	      R92C_RCR_HTC_LOC_CTRL | R92C_RCR_APP_PHYSTS |
4402290564Savos	      R92C_RCR_APP_ICV | R92C_RCR_APP_MIC;
4403290564Savos
4404290564Savos	if (vap->iv_opmode == IEEE80211_M_MONITOR) {
4405290564Savos		/* Accept all frames. */
4406290564Savos		rcr |= R92C_RCR_ACF | R92C_RCR_ADF | R92C_RCR_AMF |
4407290564Savos		       R92C_RCR_AAP;
4408290564Savos	}
4409290564Savos
4410290564Savos	/* Set Rx filter. */
4411290564Savos	urtwn_write_4(sc, R92C_RCR, rcr);
4412290564Savos
4413290564Savos	if (ic->ic_promisc != 0) {
4414290564Savos		/* Update Rx filter. */
4415290564Savos		urtwn_set_promisc(sc);
4416290564Savos	}
4417251538Srpaulo}
4418251538Srpaulo
4419251538Srpaulostatic void
4420251538Srpaulourtwn_edca_init(struct urtwn_softc *sc)
4421251538Srpaulo{
4422251538Srpaulo	urtwn_write_2(sc, R92C_SPEC_SIFS, 0x100a);
4423251538Srpaulo	urtwn_write_2(sc, R92C_MAC_SPEC_SIFS, 0x100a);
4424251538Srpaulo	urtwn_write_2(sc, R92C_SIFS_CCK, 0x100a);
4425251538Srpaulo	urtwn_write_2(sc, R92C_SIFS_OFDM, 0x100a);
4426251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x005ea42b);
4427251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a44f);
4428251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005ea324);
4429251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002fa226);
4430251538Srpaulo}
4431251538Srpaulo
4432289066Skevlostatic void
4433251538Srpaulourtwn_write_txpower(struct urtwn_softc *sc, int chain,
4434251538Srpaulo    uint16_t power[URTWN_RIDX_COUNT])
4435251538Srpaulo{
4436251538Srpaulo	uint32_t reg;
4437251538Srpaulo
4438251538Srpaulo	/* Write per-CCK rate Tx power. */
4439251538Srpaulo	if (chain == 0) {
4440251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_A_CCK1_MCS32);
4441251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK1,  power[0]);
4442251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_A_CCK1_MCS32, reg);
4443251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11);
4444251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK2,  power[1]);
4445251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK55, power[2]);
4446251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK11, power[3]);
4447251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg);
4448251538Srpaulo	} else {
4449251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK1_55_MCS32);
4450251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK1,  power[0]);
4451251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK2,  power[1]);
4452251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK55, power[2]);
4453251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_B_CCK1_55_MCS32, reg);
4454251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11);
4455251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK11, power[3]);
4456251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg);
4457251538Srpaulo	}
4458251538Srpaulo	/* Write per-OFDM rate Tx power. */
4459251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_RATE18_06(chain),
4460251538Srpaulo	    SM(R92C_TXAGC_RATE06, power[ 4]) |
4461251538Srpaulo	    SM(R92C_TXAGC_RATE09, power[ 5]) |
4462251538Srpaulo	    SM(R92C_TXAGC_RATE12, power[ 6]) |
4463251538Srpaulo	    SM(R92C_TXAGC_RATE18, power[ 7]));
4464251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_RATE54_24(chain),
4465251538Srpaulo	    SM(R92C_TXAGC_RATE24, power[ 8]) |
4466251538Srpaulo	    SM(R92C_TXAGC_RATE36, power[ 9]) |
4467251538Srpaulo	    SM(R92C_TXAGC_RATE48, power[10]) |
4468251538Srpaulo	    SM(R92C_TXAGC_RATE54, power[11]));
4469251538Srpaulo	/* Write per-MCS Tx power. */
4470251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS03_MCS00(chain),
4471251538Srpaulo	    SM(R92C_TXAGC_MCS00,  power[12]) |
4472251538Srpaulo	    SM(R92C_TXAGC_MCS01,  power[13]) |
4473251538Srpaulo	    SM(R92C_TXAGC_MCS02,  power[14]) |
4474251538Srpaulo	    SM(R92C_TXAGC_MCS03,  power[15]));
4475251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS07_MCS04(chain),
4476251538Srpaulo	    SM(R92C_TXAGC_MCS04,  power[16]) |
4477251538Srpaulo	    SM(R92C_TXAGC_MCS05,  power[17]) |
4478251538Srpaulo	    SM(R92C_TXAGC_MCS06,  power[18]) |
4479251538Srpaulo	    SM(R92C_TXAGC_MCS07,  power[19]));
4480251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS11_MCS08(chain),
4481251538Srpaulo	    SM(R92C_TXAGC_MCS08,  power[20]) |
4482261506Skevlo	    SM(R92C_TXAGC_MCS09,  power[21]) |
4483251538Srpaulo	    SM(R92C_TXAGC_MCS10,  power[22]) |
4484251538Srpaulo	    SM(R92C_TXAGC_MCS11,  power[23]));
4485251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS15_MCS12(chain),
4486251538Srpaulo	    SM(R92C_TXAGC_MCS12,  power[24]) |
4487251538Srpaulo	    SM(R92C_TXAGC_MCS13,  power[25]) |
4488251538Srpaulo	    SM(R92C_TXAGC_MCS14,  power[26]) |
4489251538Srpaulo	    SM(R92C_TXAGC_MCS15,  power[27]));
4490251538Srpaulo}
4491251538Srpaulo
4492289066Skevlostatic void
4493251538Srpaulourtwn_get_txpower(struct urtwn_softc *sc, int chain,
4494251538Srpaulo    struct ieee80211_channel *c, struct ieee80211_channel *extc,
4495251538Srpaulo    uint16_t power[URTWN_RIDX_COUNT])
4496251538Srpaulo{
4497287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
4498291264Savos	struct r92c_rom *rom = &sc->rom.r92c_rom;
4499251538Srpaulo	uint16_t cckpow, ofdmpow, htpow, diff, max;
4500251538Srpaulo	const struct urtwn_txpwr *base;
4501251538Srpaulo	int ridx, chan, group;
4502251538Srpaulo
4503251538Srpaulo	/* Determine channel group. */
4504251538Srpaulo	chan = ieee80211_chan2ieee(ic, c);	/* XXX center freq! */
4505251538Srpaulo	if (chan <= 3)
4506251538Srpaulo		group = 0;
4507251538Srpaulo	else if (chan <= 9)
4508251538Srpaulo		group = 1;
4509251538Srpaulo	else
4510251538Srpaulo		group = 2;
4511251538Srpaulo
4512251538Srpaulo	/* Get original Tx power based on board type and RF chain. */
4513251538Srpaulo	if (!(sc->chip & URTWN_CHIP_92C)) {
4514251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_HIGHPA)
4515251538Srpaulo			base = &rtl8188ru_txagc[chain];
4516251538Srpaulo		else
4517251538Srpaulo			base = &rtl8192cu_txagc[chain];
4518251538Srpaulo	} else
4519251538Srpaulo		base = &rtl8192cu_txagc[chain];
4520251538Srpaulo
4521251538Srpaulo	memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0]));
4522251538Srpaulo	if (sc->regulatory == 0) {
4523289758Savos		for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++)
4524251538Srpaulo			power[ridx] = base->pwr[0][ridx];
4525251538Srpaulo	}
4526289758Savos	for (ridx = URTWN_RIDX_OFDM6; ridx < URTWN_RIDX_COUNT; ridx++) {
4527251538Srpaulo		if (sc->regulatory == 3) {
4528251538Srpaulo			power[ridx] = base->pwr[0][ridx];
4529251538Srpaulo			/* Apply vendor limits. */
4530251538Srpaulo			if (extc != NULL)
4531251538Srpaulo				max = rom->ht40_max_pwr[group];
4532251538Srpaulo			else
4533251538Srpaulo				max = rom->ht20_max_pwr[group];
4534251538Srpaulo			max = (max >> (chain * 4)) & 0xf;
4535251538Srpaulo			if (power[ridx] > max)
4536251538Srpaulo				power[ridx] = max;
4537251538Srpaulo		} else if (sc->regulatory == 1) {
4538251538Srpaulo			if (extc == NULL)
4539251538Srpaulo				power[ridx] = base->pwr[group][ridx];
4540251538Srpaulo		} else if (sc->regulatory != 2)
4541251538Srpaulo			power[ridx] = base->pwr[0][ridx];
4542251538Srpaulo	}
4543251538Srpaulo
4544251538Srpaulo	/* Compute per-CCK rate Tx power. */
4545251538Srpaulo	cckpow = rom->cck_tx_pwr[chain][group];
4546289758Savos	for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) {
4547251538Srpaulo		power[ridx] += cckpow;
4548251538Srpaulo		if (power[ridx] > R92C_MAX_TX_PWR)
4549251538Srpaulo			power[ridx] = R92C_MAX_TX_PWR;
4550251538Srpaulo	}
4551251538Srpaulo
4552251538Srpaulo	htpow = rom->ht40_1s_tx_pwr[chain][group];
4553251538Srpaulo	if (sc->ntxchains > 1) {
4554251538Srpaulo		/* Apply reduction for 2 spatial streams. */
4555251538Srpaulo		diff = rom->ht40_2s_tx_pwr_diff[group];
4556251538Srpaulo		diff = (diff >> (chain * 4)) & 0xf;
4557251538Srpaulo		htpow = (htpow > diff) ? htpow - diff : 0;
4558251538Srpaulo	}
4559251538Srpaulo
4560251538Srpaulo	/* Compute per-OFDM rate Tx power. */
4561251538Srpaulo	diff = rom->ofdm_tx_pwr_diff[group];
4562251538Srpaulo	diff = (diff >> (chain * 4)) & 0xf;
4563251538Srpaulo	ofdmpow = htpow + diff;	/* HT->OFDM correction. */
4564289758Savos	for (ridx = URTWN_RIDX_OFDM6; ridx <= URTWN_RIDX_OFDM54; ridx++) {
4565251538Srpaulo		power[ridx] += ofdmpow;
4566251538Srpaulo		if (power[ridx] > R92C_MAX_TX_PWR)
4567251538Srpaulo			power[ridx] = R92C_MAX_TX_PWR;
4568251538Srpaulo	}
4569251538Srpaulo
4570251538Srpaulo	/* Compute per-MCS Tx power. */
4571251538Srpaulo	if (extc == NULL) {
4572251538Srpaulo		diff = rom->ht20_tx_pwr_diff[group];
4573251538Srpaulo		diff = (diff >> (chain * 4)) & 0xf;
4574251538Srpaulo		htpow += diff;	/* HT40->HT20 correction. */
4575251538Srpaulo	}
4576251538Srpaulo	for (ridx = 12; ridx <= 27; ridx++) {
4577251538Srpaulo		power[ridx] += htpow;
4578251538Srpaulo		if (power[ridx] > R92C_MAX_TX_PWR)
4579251538Srpaulo			power[ridx] = R92C_MAX_TX_PWR;
4580251538Srpaulo	}
4581294471Savos#ifdef USB_DEBUG
4582294471Savos	if (sc->sc_debug & URTWN_DEBUG_TXPWR) {
4583251538Srpaulo		/* Dump per-rate Tx power values. */
4584251538Srpaulo		printf("Tx power for chain %d:\n", chain);
4585289758Savos		for (ridx = URTWN_RIDX_CCK1; ridx < URTWN_RIDX_COUNT; ridx++)
4586251538Srpaulo			printf("Rate %d = %u\n", ridx, power[ridx]);
4587251538Srpaulo	}
4588251538Srpaulo#endif
4589251538Srpaulo}
4590251538Srpaulo
4591289066Skevlostatic void
4592264912Skevlourtwn_r88e_get_txpower(struct urtwn_softc *sc, int chain,
4593264912Skevlo    struct ieee80211_channel *c, struct ieee80211_channel *extc,
4594264912Skevlo    uint16_t power[URTWN_RIDX_COUNT])
4595264912Skevlo{
4596287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
4597294198Savos	struct r88e_rom *rom = &sc->rom.r88e_rom;
4598264912Skevlo	uint16_t cckpow, ofdmpow, bw20pow, htpow;
4599264912Skevlo	const struct urtwn_r88e_txpwr *base;
4600264912Skevlo	int ridx, chan, group;
4601264912Skevlo
4602264912Skevlo	/* Determine channel group. */
4603264912Skevlo	chan = ieee80211_chan2ieee(ic, c);	/* XXX center freq! */
4604264912Skevlo	if (chan <= 2)
4605264912Skevlo		group = 0;
4606264912Skevlo	else if (chan <= 5)
4607264912Skevlo		group = 1;
4608264912Skevlo	else if (chan <= 8)
4609264912Skevlo		group = 2;
4610264912Skevlo	else if (chan <= 11)
4611264912Skevlo		group = 3;
4612264912Skevlo	else if (chan <= 13)
4613264912Skevlo		group = 4;
4614264912Skevlo	else
4615264912Skevlo		group = 5;
4616264912Skevlo
4617264912Skevlo	/* Get original Tx power based on board type and RF chain. */
4618264912Skevlo	base = &rtl8188eu_txagc[chain];
4619264912Skevlo
4620264912Skevlo	memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0]));
4621264912Skevlo	if (sc->regulatory == 0) {
4622289758Savos		for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++)
4623264912Skevlo			power[ridx] = base->pwr[0][ridx];
4624264912Skevlo	}
4625289758Savos	for (ridx = URTWN_RIDX_OFDM6; ridx < URTWN_RIDX_COUNT; ridx++) {
4626264912Skevlo		if (sc->regulatory == 3)
4627264912Skevlo			power[ridx] = base->pwr[0][ridx];
4628264912Skevlo		else if (sc->regulatory == 1) {
4629264912Skevlo			if (extc == NULL)
4630264912Skevlo				power[ridx] = base->pwr[group][ridx];
4631264912Skevlo		} else if (sc->regulatory != 2)
4632264912Skevlo			power[ridx] = base->pwr[0][ridx];
4633264912Skevlo	}
4634264912Skevlo
4635264912Skevlo	/* Compute per-CCK rate Tx power. */
4636294198Savos	cckpow = rom->cck_tx_pwr[group];
4637289758Savos	for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) {
4638264912Skevlo		power[ridx] += cckpow;
4639264912Skevlo		if (power[ridx] > R92C_MAX_TX_PWR)
4640264912Skevlo			power[ridx] = R92C_MAX_TX_PWR;
4641264912Skevlo	}
4642264912Skevlo
4643294198Savos	htpow = rom->ht40_tx_pwr[group];
4644264912Skevlo
4645264912Skevlo	/* Compute per-OFDM rate Tx power. */
4646264912Skevlo	ofdmpow = htpow + sc->ofdm_tx_pwr_diff;
4647289758Savos	for (ridx = URTWN_RIDX_OFDM6; ridx <= URTWN_RIDX_OFDM54; ridx++) {
4648264912Skevlo		power[ridx] += ofdmpow;
4649264912Skevlo		if (power[ridx] > R92C_MAX_TX_PWR)
4650264912Skevlo			power[ridx] = R92C_MAX_TX_PWR;
4651264912Skevlo	}
4652264912Skevlo
4653264912Skevlo	bw20pow = htpow + sc->bw20_tx_pwr_diff;
4654264912Skevlo	for (ridx = 12; ridx <= 27; ridx++) {
4655264912Skevlo		power[ridx] += bw20pow;
4656264912Skevlo		if (power[ridx] > R92C_MAX_TX_PWR)
4657264912Skevlo			power[ridx] = R92C_MAX_TX_PWR;
4658264912Skevlo	}
4659264912Skevlo}
4660264912Skevlo
4661289066Skevlostatic void
4662251538Srpaulourtwn_set_txpower(struct urtwn_softc *sc, struct ieee80211_channel *c,
4663251538Srpaulo    struct ieee80211_channel *extc)
4664251538Srpaulo{
4665251538Srpaulo	uint16_t power[URTWN_RIDX_COUNT];
4666251538Srpaulo	int i;
4667251538Srpaulo
4668251538Srpaulo	for (i = 0; i < sc->ntxchains; i++) {
4669251538Srpaulo		/* Compute per-rate Tx power values. */
4670264912Skevlo		if (sc->chip & URTWN_CHIP_88E)
4671264912Skevlo			urtwn_r88e_get_txpower(sc, i, c, extc, power);
4672264912Skevlo		else
4673264912Skevlo			urtwn_get_txpower(sc, i, c, extc, power);
4674251538Srpaulo		/* Write per-rate Tx power values to hardware. */
4675251538Srpaulo		urtwn_write_txpower(sc, i, power);
4676251538Srpaulo	}
4677251538Srpaulo}
4678251538Srpaulo
4679251538Srpaulostatic void
4680290048Savosurtwn_set_rx_bssid_all(struct urtwn_softc *sc, int enable)
4681290048Savos{
4682290048Savos	uint32_t reg;
4683290048Savos
4684290048Savos	reg = urtwn_read_4(sc, R92C_RCR);
4685290048Savos	if (enable)
4686290048Savos		reg &= ~R92C_RCR_CBSSID_BCN;
4687290048Savos	else
4688290048Savos		reg |= R92C_RCR_CBSSID_BCN;
4689290048Savos	urtwn_write_4(sc, R92C_RCR, reg);
4690290048Savos}
4691290048Savos
4692290048Savosstatic void
4693290048Savosurtwn_set_gain(struct urtwn_softc *sc, uint8_t gain)
4694290048Savos{
4695290048Savos	uint32_t reg;
4696290048Savos
4697290048Savos	reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0));
4698290048Savos	reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, gain);
4699290048Savos	urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg);
4700290048Savos
4701290048Savos	if (!(sc->chip & URTWN_CHIP_88E)) {
4702290048Savos		reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1));
4703290048Savos		reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, gain);
4704290048Savos		urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg);
4705290048Savos	}
4706290048Savos}
4707290048Savos
4708290048Savosstatic void
4709251538Srpaulourtwn_scan_start(struct ieee80211com *ic)
4710251538Srpaulo{
4711290048Savos	struct urtwn_softc *sc = ic->ic_softc;
4712290048Savos
4713290048Savos	URTWN_LOCK(sc);
4714290048Savos	/* Receive beacons / probe responses from any BSSID. */
4715290651Savos	if (ic->ic_opmode != IEEE80211_M_IBSS)
4716290651Savos		urtwn_set_rx_bssid_all(sc, 1);
4717290651Savos
4718290048Savos	/* Set gain for scanning. */
4719290048Savos	urtwn_set_gain(sc, 0x20);
4720290048Savos	URTWN_UNLOCK(sc);
4721251538Srpaulo}
4722251538Srpaulo
4723251538Srpaulostatic void
4724251538Srpaulourtwn_scan_end(struct ieee80211com *ic)
4725251538Srpaulo{
4726290048Savos	struct urtwn_softc *sc = ic->ic_softc;
4727290048Savos
4728290048Savos	URTWN_LOCK(sc);
4729290048Savos	/* Restore limitations. */
4730290651Savos	if (ic->ic_promisc == 0 && ic->ic_opmode != IEEE80211_M_IBSS)
4731290564Savos		urtwn_set_rx_bssid_all(sc, 0);
4732290651Savos
4733290048Savos	/* Set gain under link. */
4734290048Savos	urtwn_set_gain(sc, 0x32);
4735290048Savos	URTWN_UNLOCK(sc);
4736251538Srpaulo}
4737251538Srpaulo
4738251538Srpaulostatic void
4739251538Srpaulourtwn_set_channel(struct ieee80211com *ic)
4740251538Srpaulo{
4741286949Sadrian	struct urtwn_softc *sc = ic->ic_softc;
4742292173Savos	struct ieee80211_channel *c = ic->ic_curchan;
4743281070Srpaulo	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
4744251538Srpaulo
4745251538Srpaulo	URTWN_LOCK(sc);
4746281070Srpaulo	if (vap->iv_state == IEEE80211_S_SCAN) {
4747281070Srpaulo		/* Make link LED blink during scan. */
4748281070Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, !sc->ledlink);
4749281070Srpaulo	}
4750292173Savos	urtwn_set_chan(sc, c, NULL);
4751292173Savos	sc->sc_rxtap.wr_chan_freq = htole16(c->ic_freq);
4752292173Savos	sc->sc_rxtap.wr_chan_flags = htole16(c->ic_flags);
4753292173Savos	sc->sc_txtap.wt_chan_freq = htole16(c->ic_freq);
4754292173Savos	sc->sc_txtap.wt_chan_flags = htole16(c->ic_flags);
4755251538Srpaulo	URTWN_UNLOCK(sc);
4756251538Srpaulo}
4757251538Srpaulo
4758292014Savosstatic int
4759292014Savosurtwn_wme_update(struct ieee80211com *ic)
4760292014Savos{
4761292014Savos	const struct wmeParams *wmep =
4762292014Savos	    ic->ic_wme.wme_chanParams.cap_wmeParams;
4763292014Savos	struct urtwn_softc *sc = ic->ic_softc;
4764292014Savos	uint8_t aifs, acm, slottime;
4765292014Savos	int ac;
4766292014Savos
4767292014Savos	acm = 0;
4768292165Savos	slottime = IEEE80211_GET_SLOTTIME(ic);
4769292014Savos
4770292014Savos	URTWN_LOCK(sc);
4771292014Savos	for (ac = WME_AC_BE; ac < WME_NUM_AC; ac++) {
4772292014Savos		/* AIFS[AC] = AIFSN[AC] * aSlotTime + aSIFSTime. */
4773292014Savos		aifs = wmep[ac].wmep_aifsn * slottime + IEEE80211_DUR_SIFS;
4774292014Savos		urtwn_write_4(sc, wme2queue[ac].reg,
4775292014Savos		    SM(R92C_EDCA_PARAM_TXOP, wmep[ac].wmep_txopLimit) |
4776292014Savos		    SM(R92C_EDCA_PARAM_ECWMIN, wmep[ac].wmep_logcwmin) |
4777292014Savos		    SM(R92C_EDCA_PARAM_ECWMAX, wmep[ac].wmep_logcwmax) |
4778292014Savos		    SM(R92C_EDCA_PARAM_AIFS, aifs));
4779292014Savos		if (ac != WME_AC_BE)
4780292014Savos			acm |= wmep[ac].wmep_acm << ac;
4781292014Savos	}
4782292014Savos
4783292014Savos	if (acm != 0)
4784292014Savos		acm |= R92C_ACMHWCTRL_EN;
4785292014Savos	urtwn_write_1(sc, R92C_ACMHWCTRL,
4786292014Savos	    (urtwn_read_1(sc, R92C_ACMHWCTRL) & ~R92C_ACMHWCTRL_ACM_MASK) |
4787292014Savos	    acm);
4788292014Savos
4789292014Savos	URTWN_UNLOCK(sc);
4790292014Savos
4791292014Savos	return 0;
4792292014Savos}
4793292014Savos
4794251538Srpaulostatic void
4795294465Savosurtwn_update_slot(struct ieee80211com *ic)
4796294465Savos{
4797294465Savos	urtwn_cmd_sleepable(ic->ic_softc, NULL, 0, urtwn_update_slot_cb);
4798294465Savos}
4799294465Savos
4800294465Savosstatic void
4801294465Savosurtwn_update_slot_cb(struct urtwn_softc *sc, union sec_param *data)
4802294465Savos{
4803294465Savos	struct ieee80211com *ic = &sc->sc_ic;
4804294465Savos	uint8_t slottime;
4805294465Savos
4806294465Savos	slottime = IEEE80211_GET_SLOTTIME(ic);
4807294465Savos
4808294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_ANY, "%s: setting slot time to %uus\n",
4809294471Savos	    __func__, slottime);
4810294465Savos
4811294465Savos	urtwn_write_1(sc, R92C_SLOT, slottime);
4812294465Savos	urtwn_update_aifs(sc, slottime);
4813294465Savos}
4814294465Savos
4815294465Savosstatic void
4816294465Savosurtwn_update_aifs(struct urtwn_softc *sc, uint8_t slottime)
4817294465Savos{
4818294465Savos	const struct wmeParams *wmep =
4819294465Savos	    sc->sc_ic.ic_wme.wme_chanParams.cap_wmeParams;
4820294465Savos	uint8_t aifs, ac;
4821294465Savos
4822294465Savos	for (ac = WME_AC_BE; ac < WME_NUM_AC; ac++) {
4823294465Savos		/* AIFS[AC] = AIFSN[AC] * aSlotTime + aSIFSTime. */
4824294465Savos		aifs = wmep[ac].wmep_aifsn * slottime + IEEE80211_DUR_SIFS;
4825294465Savos		urtwn_write_1(sc, wme2queue[ac].reg, aifs);
4826294465Savos        }
4827294465Savos}
4828294465Savos
4829294465Savosstatic void
4830290564Savosurtwn_set_promisc(struct urtwn_softc *sc)
4831290564Savos{
4832290564Savos	struct ieee80211com *ic = &sc->sc_ic;
4833290564Savos	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
4834290564Savos	uint32_t rcr, mask1, mask2;
4835290564Savos
4836290564Savos	URTWN_ASSERT_LOCKED(sc);
4837290564Savos
4838290564Savos	if (vap->iv_opmode == IEEE80211_M_MONITOR)
4839290564Savos		return;
4840290564Savos
4841290564Savos	mask1 = R92C_RCR_ACF | R92C_RCR_ADF | R92C_RCR_AMF | R92C_RCR_AAP;
4842290564Savos	mask2 = R92C_RCR_APM;
4843290564Savos
4844290564Savos	if (vap->iv_state == IEEE80211_S_RUN) {
4845290564Savos		switch (vap->iv_opmode) {
4846290564Savos		case IEEE80211_M_STA:
4847290631Savos			mask2 |= R92C_RCR_CBSSID_DATA;
4848290631Savos			/* FALLTHROUGH */
4849290631Savos		case IEEE80211_M_HOSTAP:
4850290631Savos			mask2 |= R92C_RCR_CBSSID_BCN;
4851290564Savos			break;
4852290651Savos		case IEEE80211_M_IBSS:
4853290651Savos			mask2 |= R92C_RCR_CBSSID_DATA;
4854290651Savos			break;
4855290564Savos		default:
4856290564Savos			device_printf(sc->sc_dev, "%s: undefined opmode %d\n",
4857290564Savos			    __func__, vap->iv_opmode);
4858290564Savos			return;
4859290564Savos		}
4860290564Savos	}
4861290564Savos
4862290564Savos	rcr = urtwn_read_4(sc, R92C_RCR);
4863290564Savos	if (ic->ic_promisc == 0)
4864290564Savos		rcr = (rcr & ~mask1) | mask2;
4865290564Savos	else
4866290564Savos		rcr = (rcr & ~mask2) | mask1;
4867290564Savos	urtwn_write_4(sc, R92C_RCR, rcr);
4868290564Savos}
4869290564Savos
4870290564Savosstatic void
4871290564Savosurtwn_update_promisc(struct ieee80211com *ic)
4872290564Savos{
4873290564Savos	struct urtwn_softc *sc = ic->ic_softc;
4874290564Savos
4875290564Savos	URTWN_LOCK(sc);
4876290564Savos	if (sc->sc_flags & URTWN_RUNNING)
4877290564Savos		urtwn_set_promisc(sc);
4878290564Savos	URTWN_UNLOCK(sc);
4879290564Savos}
4880290564Savos
4881290564Savosstatic void
4882283540Sglebiusurtwn_update_mcast(struct ieee80211com *ic)
4883251538Srpaulo{
4884251538Srpaulo	/* XXX do nothing?  */
4885251538Srpaulo}
4886251538Srpaulo
4887292167Savosstatic struct ieee80211_node *
4888297910Sadrianurtwn_node_alloc(struct ieee80211vap *vap,
4889292167Savos    const uint8_t mac[IEEE80211_ADDR_LEN])
4890292167Savos{
4891292167Savos	struct urtwn_node *un;
4892292167Savos
4893292167Savos	un = malloc(sizeof (struct urtwn_node), M_80211_NODE,
4894292167Savos	    M_NOWAIT | M_ZERO);
4895292167Savos
4896292167Savos	if (un == NULL)
4897292167Savos		return NULL;
4898292167Savos
4899292167Savos	un->id = URTWN_MACID_UNDEFINED;
4900292167Savos
4901292167Savos	return &un->ni;
4902292167Savos}
4903292167Savos
4904251538Srpaulostatic void
4905297910Sadrianurtwn_newassoc(struct ieee80211_node *ni, int isnew)
4906292167Savos{
4907292167Savos	struct urtwn_softc *sc = ni->ni_ic->ic_softc;
4908292167Savos	struct urtwn_node *un = URTWN_NODE(ni);
4909292167Savos	uint8_t id;
4910292167Savos
4911297910Sadrian	/* Only do this bit for R88E chips */
4912297910Sadrian	if (! (sc->chip & URTWN_CHIP_88E))
4913297910Sadrian		return;
4914297910Sadrian
4915292167Savos	if (!isnew)
4916292167Savos		return;
4917292167Savos
4918292167Savos	URTWN_NT_LOCK(sc);
4919292167Savos	for (id = 0; id <= URTWN_MACID_MAX(sc); id++) {
4920292167Savos		if (id != URTWN_MACID_BC && sc->node_list[id] == NULL) {
4921292167Savos			un->id = id;
4922292167Savos			sc->node_list[id] = ni;
4923292167Savos			break;
4924292167Savos		}
4925292167Savos	}
4926292167Savos	URTWN_NT_UNLOCK(sc);
4927292167Savos
4928292167Savos	if (id > URTWN_MACID_MAX(sc)) {
4929292167Savos		device_printf(sc->sc_dev, "%s: node table is full\n",
4930292167Savos		    __func__);
4931292167Savos	}
4932292167Savos}
4933292167Savos
4934292167Savosstatic void
4935297910Sadrianurtwn_node_free(struct ieee80211_node *ni)
4936292167Savos{
4937292167Savos	struct urtwn_softc *sc = ni->ni_ic->ic_softc;
4938292167Savos	struct urtwn_node *un = URTWN_NODE(ni);
4939292167Savos
4940292167Savos	URTWN_NT_LOCK(sc);
4941292167Savos	if (un->id != URTWN_MACID_UNDEFINED)
4942292167Savos		sc->node_list[un->id] = NULL;
4943292167Savos	URTWN_NT_UNLOCK(sc);
4944292167Savos
4945292167Savos	sc->sc_node_free(ni);
4946292167Savos}
4947292167Savos
4948292167Savosstatic void
4949251538Srpaulourtwn_set_chan(struct urtwn_softc *sc, struct ieee80211_channel *c,
4950251538Srpaulo    struct ieee80211_channel *extc)
4951251538Srpaulo{
4952287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
4953251538Srpaulo	uint32_t reg;
4954251538Srpaulo	u_int chan;
4955251538Srpaulo	int i;
4956251538Srpaulo
4957251538Srpaulo	chan = ieee80211_chan2ieee(ic, c);	/* XXX center freq! */
4958251538Srpaulo	if (chan == 0 || chan == IEEE80211_CHAN_ANY) {
4959251538Srpaulo		device_printf(sc->sc_dev,
4960251538Srpaulo		    "%s: invalid channel %x\n", __func__, chan);
4961251538Srpaulo		return;
4962251538Srpaulo	}
4963251538Srpaulo
4964251538Srpaulo	/* Set Tx power for this new channel. */
4965251538Srpaulo	urtwn_set_txpower(sc, c, extc);
4966251538Srpaulo
4967251538Srpaulo	for (i = 0; i < sc->nrxchains; i++) {
4968251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_CHNLBW,
4969251538Srpaulo		    RW(sc->rf_chnlbw[i], R92C_RF_CHNLBW_CHNL, chan));
4970251538Srpaulo	}
4971251538Srpaulo#ifndef IEEE80211_NO_HT
4972251538Srpaulo	if (extc != NULL) {
4973251538Srpaulo		/* Is secondary channel below or above primary? */
4974251538Srpaulo		int prichlo = c->ic_freq < extc->ic_freq;
4975251538Srpaulo
4976251538Srpaulo		urtwn_write_1(sc, R92C_BWOPMODE,
4977251538Srpaulo		    urtwn_read_1(sc, R92C_BWOPMODE) & ~R92C_BWOPMODE_20MHZ);
4978251538Srpaulo
4979251538Srpaulo		reg = urtwn_read_1(sc, R92C_RRSR + 2);
4980251538Srpaulo		reg = (reg & ~0x6f) | (prichlo ? 1 : 2) << 5;
4981251538Srpaulo		urtwn_write_1(sc, R92C_RRSR + 2, reg);
4982251538Srpaulo
4983251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFMOD,
4984251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA0_RFMOD) | R92C_RFMOD_40MHZ);
4985251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA1_RFMOD,
4986251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA1_RFMOD) | R92C_RFMOD_40MHZ);
4987251538Srpaulo
4988251538Srpaulo		/* Set CCK side band. */
4989251538Srpaulo		reg = urtwn_bb_read(sc, R92C_CCK0_SYSTEM);
4990251538Srpaulo		reg = (reg & ~0x00000010) | (prichlo ? 0 : 1) << 4;
4991251538Srpaulo		urtwn_bb_write(sc, R92C_CCK0_SYSTEM, reg);
4992251538Srpaulo
4993251538Srpaulo		reg = urtwn_bb_read(sc, R92C_OFDM1_LSTF);
4994251538Srpaulo		reg = (reg & ~0x00000c00) | (prichlo ? 1 : 2) << 10;
4995251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM1_LSTF, reg);
4996251538Srpaulo
4997251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2,
4998251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) &
4999251538Srpaulo		    ~R92C_FPGA0_ANAPARAM2_CBW20);
5000251538Srpaulo
5001251538Srpaulo		reg = urtwn_bb_read(sc, 0x818);
5002251538Srpaulo		reg = (reg & ~0x0c000000) | (prichlo ? 2 : 1) << 26;
5003251538Srpaulo		urtwn_bb_write(sc, 0x818, reg);
5004251538Srpaulo
5005251538Srpaulo		/* Select 40MHz bandwidth. */
5006251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
5007251538Srpaulo		    (sc->rf_chnlbw[0] & ~0xfff) | chan);
5008251538Srpaulo	} else
5009251538Srpaulo#endif
5010251538Srpaulo	{
5011251538Srpaulo		urtwn_write_1(sc, R92C_BWOPMODE,
5012251538Srpaulo		    urtwn_read_1(sc, R92C_BWOPMODE) | R92C_BWOPMODE_20MHZ);
5013251538Srpaulo
5014251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFMOD,
5015251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA0_RFMOD) & ~R92C_RFMOD_40MHZ);
5016251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA1_RFMOD,
5017251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA1_RFMOD) & ~R92C_RFMOD_40MHZ);
5018251538Srpaulo
5019264912Skevlo		if (!(sc->chip & URTWN_CHIP_88E)) {
5020264912Skevlo			urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2,
5021264912Skevlo			    urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) |
5022264912Skevlo			    R92C_FPGA0_ANAPARAM2_CBW20);
5023264912Skevlo		}
5024281069Srpaulo
5025251538Srpaulo		/* Select 20MHz bandwidth. */
5026251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
5027281069Srpaulo		    (sc->rf_chnlbw[0] & ~0xfff) | chan |
5028264912Skevlo		    ((sc->chip & URTWN_CHIP_88E) ? R88E_RF_CHNLBW_BW20 :
5029264912Skevlo		    R92C_RF_CHNLBW_BW20));
5030251538Srpaulo	}
5031251538Srpaulo}
5032251538Srpaulo
5033251538Srpaulostatic void
5034251538Srpaulourtwn_iq_calib(struct urtwn_softc *sc)
5035251538Srpaulo{
5036251538Srpaulo	/* TODO */
5037251538Srpaulo}
5038251538Srpaulo
5039251538Srpaulostatic void
5040251538Srpaulourtwn_lc_calib(struct urtwn_softc *sc)
5041251538Srpaulo{
5042251538Srpaulo	uint32_t rf_ac[2];
5043251538Srpaulo	uint8_t txmode;
5044251538Srpaulo	int i;
5045251538Srpaulo
5046251538Srpaulo	txmode = urtwn_read_1(sc, R92C_OFDM1_LSTF + 3);
5047251538Srpaulo	if ((txmode & 0x70) != 0) {
5048251538Srpaulo		/* Disable all continuous Tx. */
5049251538Srpaulo		urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode & ~0x70);
5050251538Srpaulo
5051251538Srpaulo		/* Set RF mode to standby mode. */
5052251538Srpaulo		for (i = 0; i < sc->nrxchains; i++) {
5053251538Srpaulo			rf_ac[i] = urtwn_rf_read(sc, i, R92C_RF_AC);
5054251538Srpaulo			urtwn_rf_write(sc, i, R92C_RF_AC,
5055251538Srpaulo			    RW(rf_ac[i], R92C_RF_AC_MODE,
5056251538Srpaulo				R92C_RF_AC_MODE_STANDBY));
5057251538Srpaulo		}
5058251538Srpaulo	} else {
5059251538Srpaulo		/* Block all Tx queues. */
5060293180Savos		urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL);
5061251538Srpaulo	}
5062251538Srpaulo	/* Start calibration. */
5063251538Srpaulo	urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
5064251538Srpaulo	    urtwn_rf_read(sc, 0, R92C_RF_CHNLBW) | R92C_RF_CHNLBW_LCSTART);
5065251538Srpaulo
5066251538Srpaulo	/* Give calibration the time to complete. */
5067266472Shselasky	usb_pause_mtx(&sc->sc_mtx, hz / 10);		/* 100ms */
5068251538Srpaulo
5069251538Srpaulo	/* Restore configuration. */
5070251538Srpaulo	if ((txmode & 0x70) != 0) {
5071251538Srpaulo		/* Restore Tx mode. */
5072251538Srpaulo		urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode);
5073251538Srpaulo		/* Restore RF mode. */
5074251538Srpaulo		for (i = 0; i < sc->nrxchains; i++)
5075251538Srpaulo			urtwn_rf_write(sc, i, R92C_RF_AC, rf_ac[i]);
5076251538Srpaulo	} else {
5077251538Srpaulo		/* Unblock all Tx queues. */
5078251538Srpaulo		urtwn_write_1(sc, R92C_TXPAUSE, 0x00);
5079251538Srpaulo	}
5080251538Srpaulo}
5081251538Srpaulo
5082294473Savosstatic void
5083294473Savosurtwn_temp_calib(struct urtwn_softc *sc)
5084294473Savos{
5085294473Savos	uint8_t temp;
5086294473Savos
5087294473Savos	URTWN_ASSERT_LOCKED(sc);
5088294473Savos
5089294473Savos	if (!(sc->sc_flags & URTWN_TEMP_MEASURED)) {
5090294473Savos		/* Start measuring temperature. */
5091294473Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP,
5092294473Savos		    "%s: start measuring temperature\n", __func__);
5093294473Savos		if (sc->chip & URTWN_CHIP_88E) {
5094294473Savos			urtwn_rf_write(sc, 0, R88E_RF_T_METER,
5095294473Savos			    R88E_RF_T_METER_START);
5096294473Savos		} else {
5097294473Savos			urtwn_rf_write(sc, 0, R92C_RF_T_METER,
5098294473Savos			    R92C_RF_T_METER_START);
5099294473Savos		}
5100294473Savos		sc->sc_flags |= URTWN_TEMP_MEASURED;
5101294473Savos		return;
5102294473Savos	}
5103294473Savos	sc->sc_flags &= ~URTWN_TEMP_MEASURED;
5104294473Savos
5105294473Savos	/* Read measured temperature. */
5106294473Savos	if (sc->chip & URTWN_CHIP_88E) {
5107294473Savos		temp = MS(urtwn_rf_read(sc, 0, R88E_RF_T_METER),
5108294473Savos		    R88E_RF_T_METER_VAL);
5109294473Savos	} else {
5110294473Savos		temp = MS(urtwn_rf_read(sc, 0, R92C_RF_T_METER),
5111294473Savos		    R92C_RF_T_METER_VAL);
5112294473Savos	}
5113294473Savos	if (temp == 0) {	/* Read failed, skip. */
5114294473Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP,
5115294473Savos		    "%s: temperature read failed, skipping\n", __func__);
5116294473Savos		return;
5117294473Savos	}
5118294473Savos
5119294473Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP,
5120294473Savos	    "%s: temperature: previous %u, current %u\n",
5121294473Savos	    __func__, sc->thcal_lctemp, temp);
5122294473Savos
5123294473Savos	/*
5124294473Savos	 * Redo LC calibration if temperature changed significantly since
5125294473Savos	 * last calibration.
5126294473Savos	 */
5127294473Savos	if (sc->thcal_lctemp == 0) {
5128294473Savos		/* First LC calibration is performed in urtwn_init(). */
5129294473Savos		sc->thcal_lctemp = temp;
5130294473Savos	} else if (abs(temp - sc->thcal_lctemp) > 1) {
5131294473Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP,
5132294473Savos		    "%s: LC calib triggered by temp: %u -> %u\n",
5133294473Savos		    __func__, sc->thcal_lctemp, temp);
5134294473Savos		urtwn_lc_calib(sc);
5135294473Savos		/* Record temperature of last LC calibration. */
5136294473Savos		sc->thcal_lctemp = temp;
5137294473Savos	}
5138294473Savos}
5139294473Savos
5140291698Savosstatic int
5141287197Sglebiusurtwn_init(struct urtwn_softc *sc)
5142251538Srpaulo{
5143287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
5144287197Sglebius	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
5145287197Sglebius	uint8_t macaddr[IEEE80211_ADDR_LEN];
5146251538Srpaulo	uint32_t reg;
5147291698Savos	usb_error_t usb_err = USB_ERR_NORMAL_COMPLETION;
5148251538Srpaulo	int error;
5149251538Srpaulo
5150291698Savos	URTWN_LOCK(sc);
5151291698Savos	if (sc->sc_flags & URTWN_RUNNING) {
5152291698Savos		URTWN_UNLOCK(sc);
5153291698Savos		return (0);
5154291698Savos	}
5155264864Skevlo
5156251538Srpaulo	/* Init firmware commands ring. */
5157251538Srpaulo	sc->fwcur = 0;
5158251538Srpaulo
5159251538Srpaulo	/* Allocate Tx/Rx buffers. */
5160251538Srpaulo	error = urtwn_alloc_rx_list(sc);
5161251538Srpaulo	if (error != 0)
5162251538Srpaulo		goto fail;
5163281069Srpaulo
5164251538Srpaulo	error = urtwn_alloc_tx_list(sc);
5165251538Srpaulo	if (error != 0)
5166251538Srpaulo		goto fail;
5167251538Srpaulo
5168251538Srpaulo	/* Power on adapter. */
5169251538Srpaulo	error = urtwn_power_on(sc);
5170251538Srpaulo	if (error != 0)
5171251538Srpaulo		goto fail;
5172251538Srpaulo
5173251538Srpaulo	/* Initialize DMA. */
5174251538Srpaulo	error = urtwn_dma_init(sc);
5175251538Srpaulo	if (error != 0)
5176251538Srpaulo		goto fail;
5177251538Srpaulo
5178251538Srpaulo	/* Set info size in Rx descriptors (in 64-bit words). */
5179251538Srpaulo	urtwn_write_1(sc, R92C_RX_DRVINFO_SZ, 4);
5180251538Srpaulo
5181251538Srpaulo	/* Init interrupts. */
5182264912Skevlo	if (sc->chip & URTWN_CHIP_88E) {
5183291698Savos		usb_err = urtwn_write_4(sc, R88E_HISR, 0xffffffff);
5184291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5185291698Savos			goto fail;
5186291698Savos		usb_err = urtwn_write_4(sc, R88E_HIMR, R88E_HIMR_CPWM | R88E_HIMR_CPWM2 |
5187264912Skevlo		    R88E_HIMR_TBDER | R88E_HIMR_PSTIMEOUT);
5188291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5189291698Savos			goto fail;
5190291698Savos		usb_err = urtwn_write_4(sc, R88E_HIMRE, R88E_HIMRE_RXFOVW |
5191264912Skevlo		    R88E_HIMRE_TXFOVW | R88E_HIMRE_RXERR | R88E_HIMRE_TXERR);
5192291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5193291698Savos			goto fail;
5194291698Savos		usb_err = urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION,
5195264912Skevlo		    urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) |
5196264912Skevlo		    R92C_USB_SPECIAL_OPTION_INT_BULK_SEL);
5197291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5198291698Savos			goto fail;
5199264912Skevlo	} else {
5200291698Savos		usb_err = urtwn_write_4(sc, R92C_HISR, 0xffffffff);
5201291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5202291698Savos			goto fail;
5203291698Savos		usb_err = urtwn_write_4(sc, R92C_HIMR, 0xffffffff);
5204291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5205291698Savos			goto fail;
5206264912Skevlo	}
5207251538Srpaulo
5208251538Srpaulo	/* Set MAC address. */
5209287197Sglebius	IEEE80211_ADDR_COPY(macaddr, vap ? vap->iv_myaddr : ic->ic_macaddr);
5210291698Savos	usb_err = urtwn_write_region_1(sc, R92C_MACID, macaddr, IEEE80211_ADDR_LEN);
5211291698Savos	if (usb_err != USB_ERR_NORMAL_COMPLETION)
5212291698Savos		goto fail;
5213251538Srpaulo
5214251538Srpaulo	/* Set initial network type. */
5215289811Savos	urtwn_set_mode(sc, R92C_MSR_INFRA);
5216251538Srpaulo
5217290564Savos	/* Initialize Rx filter. */
5218251538Srpaulo	urtwn_rxfilter_init(sc);
5219251538Srpaulo
5220282623Skevlo	/* Set response rate. */
5221251538Srpaulo	reg = urtwn_read_4(sc, R92C_RRSR);
5222251538Srpaulo	reg = RW(reg, R92C_RRSR_RATE_BITMAP, R92C_RRSR_RATE_CCK_ONLY_1M);
5223251538Srpaulo	urtwn_write_4(sc, R92C_RRSR, reg);
5224251538Srpaulo
5225251538Srpaulo	/* Set short/long retry limits. */
5226251538Srpaulo	urtwn_write_2(sc, R92C_RL,
5227251538Srpaulo	    SM(R92C_RL_SRL, 0x30) | SM(R92C_RL_LRL, 0x30));
5228251538Srpaulo
5229251538Srpaulo	/* Initialize EDCA parameters. */
5230251538Srpaulo	urtwn_edca_init(sc);
5231251538Srpaulo
5232251538Srpaulo	/* Setup rate fallback. */
5233264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
5234264912Skevlo		urtwn_write_4(sc, R92C_DARFRC + 0, 0x00000000);
5235264912Skevlo		urtwn_write_4(sc, R92C_DARFRC + 4, 0x10080404);
5236264912Skevlo		urtwn_write_4(sc, R92C_RARFRC + 0, 0x04030201);
5237264912Skevlo		urtwn_write_4(sc, R92C_RARFRC + 4, 0x08070605);
5238264912Skevlo	}
5239251538Srpaulo
5240251538Srpaulo	urtwn_write_1(sc, R92C_FWHW_TXQ_CTRL,
5241251538Srpaulo	    urtwn_read_1(sc, R92C_FWHW_TXQ_CTRL) |
5242251538Srpaulo	    R92C_FWHW_TXQ_CTRL_AMPDU_RTY_NEW);
5243251538Srpaulo	/* Set ACK timeout. */
5244251538Srpaulo	urtwn_write_1(sc, R92C_ACKTO, 0x40);
5245251538Srpaulo
5246251538Srpaulo	/* Setup USB aggregation. */
5247251538Srpaulo	reg = urtwn_read_4(sc, R92C_TDECTRL);
5248251538Srpaulo	reg = RW(reg, R92C_TDECTRL_BLK_DESC_NUM, 6);
5249251538Srpaulo	urtwn_write_4(sc, R92C_TDECTRL, reg);
5250251538Srpaulo	urtwn_write_1(sc, R92C_TRXDMA_CTRL,
5251251538Srpaulo	    urtwn_read_1(sc, R92C_TRXDMA_CTRL) |
5252251538Srpaulo	    R92C_TRXDMA_CTRL_RXDMA_AGG_EN);
5253251538Srpaulo	urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH, 48);
5254264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
5255264912Skevlo		urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH + 1, 4);
5256282266Skevlo	else {
5257264912Skevlo		urtwn_write_1(sc, R92C_USB_DMA_AGG_TO, 4);
5258282266Skevlo		urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION,
5259282266Skevlo		    urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) |
5260282266Skevlo		    R92C_USB_SPECIAL_OPTION_AGG_EN);
5261282266Skevlo		urtwn_write_1(sc, R92C_USB_AGG_TH, 8);
5262282266Skevlo		urtwn_write_1(sc, R92C_USB_AGG_TO, 6);
5263282266Skevlo	}
5264251538Srpaulo
5265251538Srpaulo	/* Initialize beacon parameters. */
5266264912Skevlo	urtwn_write_2(sc, R92C_BCN_CTRL, 0x1010);
5267251538Srpaulo	urtwn_write_2(sc, R92C_TBTT_PROHIBIT, 0x6404);
5268251538Srpaulo	urtwn_write_1(sc, R92C_DRVERLYINT, 0x05);
5269251538Srpaulo	urtwn_write_1(sc, R92C_BCNDMATIM, 0x02);
5270251538Srpaulo	urtwn_write_2(sc, R92C_BCNTCFG, 0x660f);
5271251538Srpaulo
5272264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
5273264912Skevlo		/* Setup AMPDU aggregation. */
5274264912Skevlo		urtwn_write_4(sc, R92C_AGGLEN_LMT, 0x99997631);	/* MCS7~0 */
5275264912Skevlo		urtwn_write_1(sc, R92C_AGGR_BREAK_TIME, 0x16);
5276264912Skevlo		urtwn_write_2(sc, R92C_MAX_AGGR_NUM, 0x0708);
5277251538Srpaulo
5278264912Skevlo		urtwn_write_1(sc, R92C_BCN_MAX_ERR, 0xff);
5279264912Skevlo	}
5280251538Srpaulo
5281295871Savos#ifndef URTWN_WITHOUT_UCODE
5282251538Srpaulo	/* Load 8051 microcode. */
5283251538Srpaulo	error = urtwn_load_firmware(sc);
5284295871Savos	if (error == 0)
5285295871Savos		sc->sc_flags |= URTWN_FW_LOADED;
5286295871Savos#endif
5287251538Srpaulo
5288251538Srpaulo	/* Initialize MAC/BB/RF blocks. */
5289291698Savos	error = urtwn_mac_init(sc);
5290291698Savos	if (error != 0) {
5291291698Savos		device_printf(sc->sc_dev,
5292291698Savos		    "%s: error while initializing MAC block\n", __func__);
5293291698Savos		goto fail;
5294291698Savos	}
5295251538Srpaulo	urtwn_bb_init(sc);
5296251538Srpaulo	urtwn_rf_init(sc);
5297251538Srpaulo
5298290564Savos	/* Reinitialize Rx filter (D3845 is not committed yet). */
5299290564Savos	urtwn_rxfilter_init(sc);
5300290564Savos
5301264912Skevlo	if (sc->chip & URTWN_CHIP_88E) {
5302264912Skevlo		urtwn_write_2(sc, R92C_CR,
5303264912Skevlo		    urtwn_read_2(sc, R92C_CR) | R92C_CR_MACTXEN |
5304264912Skevlo		    R92C_CR_MACRXEN);
5305264912Skevlo	}
5306264912Skevlo
5307251538Srpaulo	/* Turn CCK and OFDM blocks on. */
5308251538Srpaulo	reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD);
5309251538Srpaulo	reg |= R92C_RFMOD_CCK_EN;
5310291698Savos	usb_err = urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg);
5311291698Savos	if (usb_err != USB_ERR_NORMAL_COMPLETION)
5312291698Savos		goto fail;
5313251538Srpaulo	reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD);
5314251538Srpaulo	reg |= R92C_RFMOD_OFDM_EN;
5315291698Savos	usb_err = urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg);
5316291698Savos	if (usb_err != USB_ERR_NORMAL_COMPLETION)
5317291698Savos		goto fail;
5318251538Srpaulo
5319251538Srpaulo	/* Clear per-station keys table. */
5320251538Srpaulo	urtwn_cam_init(sc);
5321251538Srpaulo
5322292175Savos	/* Enable decryption / encryption. */
5323292175Savos	urtwn_write_2(sc, R92C_SECCFG,
5324292175Savos	    R92C_SECCFG_TXUCKEY_DEF | R92C_SECCFG_RXUCKEY_DEF |
5325292175Savos	    R92C_SECCFG_TXENC_ENA | R92C_SECCFG_RXDEC_ENA |
5326292175Savos	    R92C_SECCFG_TXBCKEY_DEF | R92C_SECCFG_RXBCKEY_DEF);
5327292175Savos
5328292175Savos	/*
5329292175Savos	 * Install static keys (if any).
5330292175Savos	 * Must be called after urtwn_cam_init().
5331292175Savos	 */
5332292175Savos	ieee80211_runtask(ic, &sc->cmdq_task);
5333292175Savos
5334251538Srpaulo	/* Enable hardware sequence numbering. */
5335293180Savos	urtwn_write_1(sc, R92C_HWSEQ_CTRL, R92C_TX_QUEUE_ALL);
5336251538Srpaulo
5337292167Savos	/* Enable per-packet TX report. */
5338292167Savos	if (sc->chip & URTWN_CHIP_88E) {
5339292167Savos		urtwn_write_1(sc, R88E_TX_RPT_CTRL,
5340292167Savos		    urtwn_read_1(sc, R88E_TX_RPT_CTRL) | R88E_TX_RPT1_ENA);
5341292167Savos	}
5342292167Savos
5343251538Srpaulo	/* Perform LO and IQ calibrations. */
5344251538Srpaulo	urtwn_iq_calib(sc);
5345251538Srpaulo	/* Perform LC calibration. */
5346251538Srpaulo	urtwn_lc_calib(sc);
5347251538Srpaulo
5348251538Srpaulo	/* Fix USB interference issue. */
5349264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
5350264912Skevlo		urtwn_write_1(sc, 0xfe40, 0xe0);
5351264912Skevlo		urtwn_write_1(sc, 0xfe41, 0x8d);
5352264912Skevlo		urtwn_write_1(sc, 0xfe42, 0x80);
5353251538Srpaulo
5354264912Skevlo		urtwn_pa_bias_init(sc);
5355264912Skevlo	}
5356251538Srpaulo
5357251538Srpaulo	/* Initialize GPIO setting. */
5358251538Srpaulo	urtwn_write_1(sc, R92C_GPIO_MUXCFG,
5359251538Srpaulo	    urtwn_read_1(sc, R92C_GPIO_MUXCFG) & ~R92C_GPIO_MUXCFG_ENBT);
5360251538Srpaulo
5361251538Srpaulo	/* Fix for lower temperature. */
5362264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E))
5363264912Skevlo		urtwn_write_1(sc, 0x15, 0xe9);
5364251538Srpaulo
5365251538Srpaulo	usbd_transfer_start(sc->sc_xfer[URTWN_BULK_RX]);
5366251538Srpaulo
5367287197Sglebius	sc->sc_flags |= URTWN_RUNNING;
5368251538Srpaulo
5369251538Srpaulo	callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
5370251538Srpaulofail:
5371291698Savos	if (usb_err != USB_ERR_NORMAL_COMPLETION)
5372291698Savos		error = EIO;
5373291698Savos
5374291698Savos	URTWN_UNLOCK(sc);
5375291698Savos
5376291698Savos	return (error);
5377251538Srpaulo}
5378251538Srpaulo
5379251538Srpaulostatic void
5380287197Sglebiusurtwn_stop(struct urtwn_softc *sc)
5381251538Srpaulo{
5382251538Srpaulo
5383291698Savos	URTWN_LOCK(sc);
5384291698Savos	if (!(sc->sc_flags & URTWN_RUNNING)) {
5385291698Savos		URTWN_UNLOCK(sc);
5386291698Savos		return;
5387291698Savos	}
5388291698Savos
5389295871Savos	sc->sc_flags &= ~(URTWN_RUNNING | URTWN_FW_LOADED |
5390295871Savos	    URTWN_TEMP_MEASURED);
5391294473Savos	sc->thcal_lctemp = 0;
5392251538Srpaulo	callout_stop(&sc->sc_watchdog_ch);
5393295874Savos
5394251538Srpaulo	urtwn_abort_xfers(sc);
5395288353Sadrian	urtwn_drain_mbufq(sc);
5396295874Savos	urtwn_power_off(sc);
5397291698Savos	URTWN_UNLOCK(sc);
5398251538Srpaulo}
5399251538Srpaulo
5400251538Srpaulostatic void
5401251538Srpaulourtwn_abort_xfers(struct urtwn_softc *sc)
5402251538Srpaulo{
5403251538Srpaulo	int i;
5404251538Srpaulo
5405251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
5406251538Srpaulo
5407251538Srpaulo	/* abort any pending transfers */
5408251538Srpaulo	for (i = 0; i < URTWN_N_TRANSFER; i++)
5409251538Srpaulo		usbd_transfer_stop(sc->sc_xfer[i]);
5410251538Srpaulo}
5411251538Srpaulo
5412251538Srpaulostatic int
5413251538Srpaulourtwn_raw_xmit(struct ieee80211_node *ni, struct mbuf *m,
5414251538Srpaulo    const struct ieee80211_bpf_params *params)
5415251538Srpaulo{
5416251538Srpaulo	struct ieee80211com *ic = ni->ni_ic;
5417286949Sadrian	struct urtwn_softc *sc = ic->ic_softc;
5418251538Srpaulo	struct urtwn_data *bf;
5419290630Savos	int error;
5420251538Srpaulo
5421297596Sadrian	URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT, "%s: called; m=%p\n",
5422297596Sadrian	    __func__,
5423297596Sadrian	    m);
5424297596Sadrian
5425251538Srpaulo	/* prevent management frames from being sent if we're not ready */
5426290630Savos	URTWN_LOCK(sc);
5427287197Sglebius	if (!(sc->sc_flags & URTWN_RUNNING)) {
5428290630Savos		error = ENETDOWN;
5429290630Savos		goto end;
5430251538Srpaulo	}
5431290630Savos
5432251538Srpaulo	bf = urtwn_getbuf(sc);
5433251538Srpaulo	if (bf == NULL) {
5434290630Savos		error = ENOBUFS;
5435290630Savos		goto end;
5436251538Srpaulo	}
5437251538Srpaulo
5438292221Savos	if (params == NULL) {
5439292221Savos		/*
5440292221Savos		 * Legacy path; interpret frame contents to decide
5441292221Savos		 * precisely how to send the frame.
5442292221Savos		 */
5443292221Savos		error = urtwn_tx_data(sc, ni, m, bf);
5444292221Savos	} else {
5445292221Savos		/*
5446292221Savos		 * Caller supplied explicit parameters to use in
5447292221Savos		 * sending the frame.
5448292221Savos		 */
5449292221Savos		error = urtwn_tx_raw(sc, ni, m, bf, params);
5450292221Savos	}
5451292221Savos	if (error != 0) {
5452251538Srpaulo		STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next);
5453290630Savos		goto end;
5454251538Srpaulo	}
5455290630Savos
5456288353Sadrian	sc->sc_txtimer = 5;
5457290630Savos	callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
5458290630Savos
5459290630Savosend:
5460290630Savos	if (error != 0)
5461290630Savos		m_freem(m);
5462290630Savos
5463251538Srpaulo	URTWN_UNLOCK(sc);
5464251538Srpaulo
5465290630Savos	return (error);
5466251538Srpaulo}
5467251538Srpaulo
5468266472Shselaskystatic void
5469266472Shselaskyurtwn_ms_delay(struct urtwn_softc *sc)
5470266472Shselasky{
5471266472Shselasky	usb_pause_mtx(&sc->sc_mtx, hz / 1000);
5472266472Shselasky}
5473266472Shselasky
5474251538Srpaulostatic device_method_t urtwn_methods[] = {
5475251538Srpaulo	/* Device interface */
5476251538Srpaulo	DEVMETHOD(device_probe,		urtwn_match),
5477251538Srpaulo	DEVMETHOD(device_attach,	urtwn_attach),
5478251538Srpaulo	DEVMETHOD(device_detach,	urtwn_detach),
5479251538Srpaulo
5480264912Skevlo	DEVMETHOD_END
5481251538Srpaulo};
5482251538Srpaulo
5483251538Srpaulostatic driver_t urtwn_driver = {
5484251538Srpaulo	"urtwn",
5485251538Srpaulo	urtwn_methods,
5486251538Srpaulo	sizeof(struct urtwn_softc)
5487251538Srpaulo};
5488251538Srpaulo
5489251538Srpaulostatic devclass_t urtwn_devclass;
5490251538Srpaulo
5491251538SrpauloDRIVER_MODULE(urtwn, uhub, urtwn_driver, urtwn_devclass, NULL, NULL);
5492251538SrpauloMODULE_DEPEND(urtwn, usb, 1, 1, 1);
5493251538SrpauloMODULE_DEPEND(urtwn, wlan, 1, 1, 1);
5494295871Savos#ifndef URTWN_WITHOUT_UCODE
5495251538SrpauloMODULE_DEPEND(urtwn, firmware, 1, 1, 1);
5496295871Savos#endif
5497251538SrpauloMODULE_VERSION(urtwn, 1);
5498292080SimpUSB_PNP_HOST_INFO(urtwn_devs);
5499