if_urtwn.c revision 298436
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 298436 2016-04-21 20:34:38Z avos $");
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>
69251538Srpaulo#include <net80211/ieee80211_regdomain.h>
70251538Srpaulo#include <net80211/ieee80211_radiotap.h>
71251538Srpaulo#include <net80211/ieee80211_ratectl.h>
72297596Sadrian#ifdef	IEEE80211_SUPPORT_SUPERG
73297596Sadrian#include <net80211/ieee80211_superg.h>
74297596Sadrian#endif
75251538Srpaulo
76251538Srpaulo#include <dev/usb/usb.h>
77251538Srpaulo#include <dev/usb/usbdi.h>
78291902Skevlo#include <dev/usb/usb_device.h>
79251538Srpaulo#include "usbdevs.h"
80251538Srpaulo
81251538Srpaulo#include <dev/usb/usb_debug.h>
82251538Srpaulo
83297058Sadrian#include <dev/urtwn/if_urtwnreg.h>
84297058Sadrian#include <dev/urtwn/if_urtwnvar.h>
85251538Srpaulo
86251538Srpaulo#ifdef USB_DEBUG
87294471Savosenum {
88294471Savos	URTWN_DEBUG_XMIT	= 0x00000001,	/* basic xmit operation */
89294471Savos	URTWN_DEBUG_RECV	= 0x00000002,	/* basic recv operation */
90294471Savos	URTWN_DEBUG_STATE	= 0x00000004,	/* 802.11 state transitions */
91294471Savos	URTWN_DEBUG_RA		= 0x00000008,	/* f/w rate adaptation setup */
92294471Savos	URTWN_DEBUG_USB		= 0x00000010,	/* usb requests */
93294471Savos	URTWN_DEBUG_FIRMWARE	= 0x00000020,	/* firmware(9) loading debug */
94294471Savos	URTWN_DEBUG_BEACON	= 0x00000040,	/* beacon handling */
95294471Savos	URTWN_DEBUG_INTR	= 0x00000080,	/* ISR */
96294471Savos	URTWN_DEBUG_TEMP	= 0x00000100,	/* temperature calibration */
97294471Savos	URTWN_DEBUG_ROM		= 0x00000200,	/* various ROM info */
98294471Savos	URTWN_DEBUG_KEY		= 0x00000400,	/* crypto keys management */
99294471Savos	URTWN_DEBUG_TXPWR	= 0x00000800,	/* dump Tx power values */
100297175Sadrian	URTWN_DEBUG_RSSI	= 0x00001000,	/* dump RSSI lookups */
101294471Savos	URTWN_DEBUG_ANY		= 0xffffffff
102294471Savos};
103251538Srpaulo
104294471Savos#define URTWN_DPRINTF(_sc, _m, ...) do {			\
105294471Savos	if ((_sc)->sc_debug & (_m))				\
106294471Savos		device_printf((_sc)->sc_dev, __VA_ARGS__);	\
107294471Savos} while(0)
108294471Savos
109294471Savos#else
110294471Savos#define URTWN_DPRINTF(_sc, _m, ...)	do { (void) sc; } while (0)
111251538Srpaulo#endif
112251538Srpaulo
113288088Sadrian#define	IEEE80211_HAS_ADDR4(wh)	IEEE80211_IS_DSTODS(wh)
114251538Srpaulo
115297175Sadrianstatic int urtwn_enable_11n = 1;
116297175SadrianTUNABLE_INT("hw.usb.urtwn.enable_11n", &urtwn_enable_11n);
117297175Sadrian
118251538Srpaulo/* various supported device vendors/products */
119251596Srpaulostatic const STRUCT_USB_HOST_ID urtwn_devs[] = {
120251538Srpaulo#define URTWN_DEV(v,p)  { USB_VP(USB_VENDOR_##v, USB_PRODUCT_##v##_##p) }
121264912Skevlo#define	URTWN_RTL8188E_DEV(v,p)	\
122264912Skevlo	{ USB_VPI(USB_VENDOR_##v, USB_PRODUCT_##v##_##p, URTWN_RTL8188E) }
123264912Skevlo#define URTWN_RTL8188E  1
124251538Srpaulo	URTWN_DEV(ABOCOM,	RTL8188CU_1),
125251538Srpaulo	URTWN_DEV(ABOCOM,	RTL8188CU_2),
126251538Srpaulo	URTWN_DEV(ABOCOM,	RTL8192CU),
127251538Srpaulo	URTWN_DEV(ASUS,		RTL8192CU),
128266721Skevlo	URTWN_DEV(ASUS,		USBN10NANO),
129251538Srpaulo	URTWN_DEV(AZUREWAVE,	RTL8188CE_1),
130251538Srpaulo	URTWN_DEV(AZUREWAVE,	RTL8188CE_2),
131251538Srpaulo	URTWN_DEV(AZUREWAVE,	RTL8188CU),
132251538Srpaulo	URTWN_DEV(BELKIN,	F7D2102),
133251538Srpaulo	URTWN_DEV(BELKIN,	RTL8188CU),
134251538Srpaulo	URTWN_DEV(BELKIN,	RTL8192CU),
135251538Srpaulo	URTWN_DEV(CHICONY,	RTL8188CUS_1),
136251538Srpaulo	URTWN_DEV(CHICONY,	RTL8188CUS_2),
137251538Srpaulo	URTWN_DEV(CHICONY,	RTL8188CUS_3),
138251538Srpaulo	URTWN_DEV(CHICONY,	RTL8188CUS_4),
139251538Srpaulo	URTWN_DEV(CHICONY,	RTL8188CUS_5),
140251538Srpaulo	URTWN_DEV(COREGA,	RTL8192CU),
141251538Srpaulo	URTWN_DEV(DLINK,	RTL8188CU),
142251538Srpaulo	URTWN_DEV(DLINK,	RTL8192CU_1),
143251538Srpaulo	URTWN_DEV(DLINK,	RTL8192CU_2),
144251538Srpaulo	URTWN_DEV(DLINK,	RTL8192CU_3),
145252196Skevlo	URTWN_DEV(DLINK,	DWA131B),
146251538Srpaulo	URTWN_DEV(EDIMAX,	EW7811UN),
147251538Srpaulo	URTWN_DEV(EDIMAX,	RTL8192CU),
148251538Srpaulo	URTWN_DEV(FEIXUN,	RTL8188CU),
149251538Srpaulo	URTWN_DEV(FEIXUN,	RTL8192CU),
150251538Srpaulo	URTWN_DEV(GUILLEMOT,	HWNUP150),
151251538Srpaulo	URTWN_DEV(HAWKING,	RTL8192CU),
152251538Srpaulo	URTWN_DEV(HP3,		RTL8188CU),
153251538Srpaulo	URTWN_DEV(NETGEAR,	WNA1000M),
154251538Srpaulo	URTWN_DEV(NETGEAR,	RTL8192CU),
155251538Srpaulo	URTWN_DEV(NETGEAR4,	RTL8188CU),
156251538Srpaulo	URTWN_DEV(NOVATECH,	RTL8188CU),
157251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8188CU_1),
158251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8188CU_2),
159251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8188CU_3),
160251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8188CU_4),
161251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8188CUS),
162251538Srpaulo	URTWN_DEV(PLANEX2,	RTL8192CU),
163251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CE_0),
164251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CE_1),
165251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CTV),
166251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CU_0),
167251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CU_1),
168251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CU_2),
169282119Skevlo	URTWN_DEV(REALTEK,	RTL8188CU_3),
170251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CU_COMBO),
171251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188CUS),
172251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188RU_1),
173251538Srpaulo	URTWN_DEV(REALTEK,	RTL8188RU_2),
174272410Shselasky	URTWN_DEV(REALTEK,	RTL8188RU_3),
175251538Srpaulo	URTWN_DEV(REALTEK,	RTL8191CU),
176251538Srpaulo	URTWN_DEV(REALTEK,	RTL8192CE),
177251538Srpaulo	URTWN_DEV(REALTEK,	RTL8192CU),
178251538Srpaulo	URTWN_DEV(SITECOMEU,	RTL8188CU_1),
179251538Srpaulo	URTWN_DEV(SITECOMEU,	RTL8188CU_2),
180251538Srpaulo	URTWN_DEV(SITECOMEU,	RTL8192CU),
181251538Srpaulo	URTWN_DEV(TRENDNET,	RTL8188CU),
182251538Srpaulo	URTWN_DEV(TRENDNET,	RTL8192CU),
183251538Srpaulo	URTWN_DEV(ZYXEL,	RTL8192CU),
184264912Skevlo	/* URTWN_RTL8188E */
185295907Skevlo	URTWN_RTL8188E_DEV(ABOCOM,	RTL8188EU),
186273589Skevlo	URTWN_RTL8188E_DEV(DLINK,	DWA123D1),
187270191Skevlo	URTWN_RTL8188E_DEV(DLINK,	DWA125D1),
188273589Skevlo	URTWN_RTL8188E_DEV(ELECOM,	WDC150SU2M),
189264912Skevlo	URTWN_RTL8188E_DEV(REALTEK,	RTL8188ETV),
190264912Skevlo	URTWN_RTL8188E_DEV(REALTEK,	RTL8188EU),
191264912Skevlo#undef URTWN_RTL8188E_DEV
192251538Srpaulo#undef URTWN_DEV
193251538Srpaulo};
194251538Srpaulo
195251538Srpaulostatic device_probe_t	urtwn_match;
196251538Srpaulostatic device_attach_t	urtwn_attach;
197251538Srpaulostatic device_detach_t	urtwn_detach;
198251538Srpaulo
199251538Srpaulostatic usb_callback_t   urtwn_bulk_tx_callback;
200251538Srpaulostatic usb_callback_t	urtwn_bulk_rx_callback;
201251538Srpaulo
202294471Savosstatic void		urtwn_sysctlattach(struct urtwn_softc *);
203294471Savosstatic void		urtwn_drain_mbufq(struct urtwn_softc *);
204287197Sglebiusstatic usb_error_t	urtwn_do_request(struct urtwn_softc *,
205287197Sglebius			    struct usb_device_request *, void *);
206251538Srpaulostatic struct ieee80211vap *urtwn_vap_create(struct ieee80211com *,
207251538Srpaulo		    const char [IFNAMSIZ], int, enum ieee80211_opmode, int,
208251538Srpaulo                    const uint8_t [IEEE80211_ADDR_LEN],
209251538Srpaulo                    const uint8_t [IEEE80211_ADDR_LEN]);
210251538Srpaulostatic void		urtwn_vap_delete(struct ieee80211vap *);
211292207Savosstatic struct mbuf *	urtwn_rx_copy_to_mbuf(struct urtwn_softc *,
212292207Savos			    struct r92c_rx_stat *, int);
213292207Savosstatic struct mbuf *	urtwn_report_intr(struct usb_xfer *,
214292207Savos			    struct urtwn_data *);
215292207Savosstatic struct mbuf *	urtwn_rxeof(struct urtwn_softc *, uint8_t *, int);
216292167Savosstatic void		urtwn_r88e_ratectl_tx_complete(struct urtwn_softc *,
217292167Savos			    void *);
218292207Savosstatic struct ieee80211_node *urtwn_rx_frame(struct urtwn_softc *,
219292207Savos			    struct mbuf *, int8_t *);
220289891Savosstatic void		urtwn_txeof(struct urtwn_softc *, struct urtwn_data *,
221289891Savos			    int);
222281069Srpaulostatic int		urtwn_alloc_list(struct urtwn_softc *,
223251538Srpaulo			    struct urtwn_data[], int, int);
224251538Srpaulostatic int		urtwn_alloc_rx_list(struct urtwn_softc *);
225251538Srpaulostatic int		urtwn_alloc_tx_list(struct urtwn_softc *);
226251538Srpaulostatic void		urtwn_free_list(struct urtwn_softc *,
227251538Srpaulo			    struct urtwn_data data[], int);
228289066Skevlostatic void		urtwn_free_rx_list(struct urtwn_softc *);
229289066Skevlostatic void		urtwn_free_tx_list(struct urtwn_softc *);
230251538Srpaulostatic struct urtwn_data *	_urtwn_getbuf(struct urtwn_softc *);
231251538Srpaulostatic struct urtwn_data *	urtwn_getbuf(struct urtwn_softc *);
232291698Savosstatic usb_error_t	urtwn_write_region_1(struct urtwn_softc *, uint16_t,
233251538Srpaulo			    uint8_t *, int);
234291698Savosstatic usb_error_t	urtwn_write_1(struct urtwn_softc *, uint16_t, uint8_t);
235291698Savosstatic usb_error_t	urtwn_write_2(struct urtwn_softc *, uint16_t, uint16_t);
236291698Savosstatic usb_error_t	urtwn_write_4(struct urtwn_softc *, uint16_t, uint32_t);
237291698Savosstatic usb_error_t	urtwn_read_region_1(struct urtwn_softc *, uint16_t,
238251538Srpaulo			    uint8_t *, int);
239251538Srpaulostatic uint8_t		urtwn_read_1(struct urtwn_softc *, uint16_t);
240251538Srpaulostatic uint16_t		urtwn_read_2(struct urtwn_softc *, uint16_t);
241251538Srpaulostatic uint32_t		urtwn_read_4(struct urtwn_softc *, uint16_t);
242281069Srpaulostatic int		urtwn_fw_cmd(struct urtwn_softc *, uint8_t,
243251538Srpaulo			    const void *, int);
244292174Savosstatic void		urtwn_cmdq_cb(void *, int);
245292174Savosstatic int		urtwn_cmd_sleepable(struct urtwn_softc *, const void *,
246292174Savos			    size_t, CMD_FUNC_PROTO);
247264912Skevlostatic void		urtwn_r92c_rf_write(struct urtwn_softc *, int,
248264912Skevlo			    uint8_t, uint32_t);
249281069Srpaulostatic void		urtwn_r88e_rf_write(struct urtwn_softc *, int,
250264912Skevlo			    uint8_t, uint32_t);
251251538Srpaulostatic uint32_t		urtwn_rf_read(struct urtwn_softc *, int, uint8_t);
252281069Srpaulostatic int		urtwn_llt_write(struct urtwn_softc *, uint32_t,
253251538Srpaulo			    uint32_t);
254291264Savosstatic int		urtwn_efuse_read_next(struct urtwn_softc *, uint8_t *);
255291264Savosstatic int		urtwn_efuse_read_data(struct urtwn_softc *, uint8_t *,
256291264Savos			    uint8_t, uint8_t);
257294471Savos#ifdef USB_DEBUG
258291264Savosstatic void		urtwn_dump_rom_contents(struct urtwn_softc *,
259291264Savos			    uint8_t *, uint16_t);
260291264Savos#endif
261291264Savosstatic int		urtwn_efuse_read(struct urtwn_softc *, uint8_t *,
262291264Savos			    uint16_t);
263291698Savosstatic int		urtwn_efuse_switch_power(struct urtwn_softc *);
264251538Srpaulostatic int		urtwn_read_chipid(struct urtwn_softc *);
265291264Savosstatic int		urtwn_read_rom(struct urtwn_softc *);
266291264Savosstatic int		urtwn_r88e_read_rom(struct urtwn_softc *);
267251538Srpaulostatic int		urtwn_ra_init(struct urtwn_softc *);
268290631Savosstatic void		urtwn_init_beacon(struct urtwn_softc *,
269290631Savos			    struct urtwn_vap *);
270290631Savosstatic int		urtwn_setup_beacon(struct urtwn_softc *,
271290631Savos			    struct ieee80211_node *);
272290631Savosstatic void		urtwn_update_beacon(struct ieee80211vap *, int);
273290631Savosstatic int		urtwn_tx_beacon(struct urtwn_softc *sc,
274290631Savos			    struct urtwn_vap *);
275292175Savosstatic int		urtwn_key_alloc(struct ieee80211vap *,
276292175Savos			    struct ieee80211_key *, ieee80211_keyix *,
277292175Savos			    ieee80211_keyix *);
278292175Savosstatic void		urtwn_key_set_cb(struct urtwn_softc *,
279292175Savos			    union sec_param *);
280292175Savosstatic void		urtwn_key_del_cb(struct urtwn_softc *,
281292175Savos			    union sec_param *);
282292175Savosstatic int		urtwn_key_set(struct ieee80211vap *,
283292175Savos			    const struct ieee80211_key *);
284292175Savosstatic int		urtwn_key_delete(struct ieee80211vap *,
285292175Savos			    const struct ieee80211_key *);
286290651Savosstatic void		urtwn_tsf_task_adhoc(void *, int);
287290631Savosstatic void		urtwn_tsf_sync_enable(struct urtwn_softc *,
288290631Savos			    struct ieee80211vap *);
289292203Savosstatic void		urtwn_get_tsf(struct urtwn_softc *, uint64_t *);
290251538Srpaulostatic void		urtwn_set_led(struct urtwn_softc *, int, int);
291289811Savosstatic void		urtwn_set_mode(struct urtwn_softc *, uint8_t);
292290651Savosstatic void		urtwn_ibss_recv_mgmt(struct ieee80211_node *,
293290651Savos			    struct mbuf *, int,
294290651Savos			    const struct ieee80211_rx_stats *, int, int);
295281069Srpaulostatic int		urtwn_newstate(struct ieee80211vap *,
296251538Srpaulo			    enum ieee80211_state, int);
297294473Savosstatic void		urtwn_calib_to(void *);
298294473Savosstatic void		urtwn_calib_cb(struct urtwn_softc *,
299294473Savos			    union sec_param *);
300251538Srpaulostatic void		urtwn_watchdog(void *);
301251538Srpaulostatic void		urtwn_update_avgrssi(struct urtwn_softc *, int, int8_t);
302251538Srpaulostatic int8_t		urtwn_get_rssi(struct urtwn_softc *, int, void *);
303264912Skevlostatic int8_t		urtwn_r88e_get_rssi(struct urtwn_softc *, int, void *);
304290630Savosstatic int		urtwn_tx_data(struct urtwn_softc *,
305251538Srpaulo			    struct ieee80211_node *, struct mbuf *,
306251538Srpaulo			    struct urtwn_data *);
307292221Savosstatic int		urtwn_tx_raw(struct urtwn_softc *,
308292221Savos			    struct ieee80211_node *, struct mbuf *,
309292221Savos			    struct urtwn_data *,
310292221Savos			    const struct ieee80211_bpf_params *);
311290630Savosstatic void		urtwn_tx_start(struct urtwn_softc *, struct mbuf *,
312290630Savos			    uint8_t, struct urtwn_data *);
313287197Sglebiusstatic int		urtwn_transmit(struct ieee80211com *, struct mbuf *);
314287197Sglebiusstatic void		urtwn_start(struct urtwn_softc *);
315287197Sglebiusstatic void		urtwn_parent(struct ieee80211com *);
316264912Skevlostatic int		urtwn_r92c_power_on(struct urtwn_softc *);
317264912Skevlostatic int		urtwn_r88e_power_on(struct urtwn_softc *);
318295874Savosstatic void		urtwn_r92c_power_off(struct urtwn_softc *);
319295874Savosstatic void		urtwn_r88e_power_off(struct urtwn_softc *);
320251538Srpaulostatic int		urtwn_llt_init(struct urtwn_softc *);
321295871Savos#ifndef URTWN_WITHOUT_UCODE
322251538Srpaulostatic void		urtwn_fw_reset(struct urtwn_softc *);
323264912Skevlostatic void		urtwn_r88e_fw_reset(struct urtwn_softc *);
324281069Srpaulostatic int		urtwn_fw_loadpage(struct urtwn_softc *, int,
325251538Srpaulo			    const uint8_t *, int);
326251538Srpaulostatic int		urtwn_load_firmware(struct urtwn_softc *);
327295871Savos#endif
328291902Skevlostatic int		urtwn_dma_init(struct urtwn_softc *);
329291698Savosstatic int		urtwn_mac_init(struct urtwn_softc *);
330251538Srpaulostatic void		urtwn_bb_init(struct urtwn_softc *);
331251538Srpaulostatic void		urtwn_rf_init(struct urtwn_softc *);
332251538Srpaulostatic void		urtwn_cam_init(struct urtwn_softc *);
333292175Savosstatic int		urtwn_cam_write(struct urtwn_softc *, uint32_t,
334292175Savos			    uint32_t);
335251538Srpaulostatic void		urtwn_pa_bias_init(struct urtwn_softc *);
336251538Srpaulostatic void		urtwn_rxfilter_init(struct urtwn_softc *);
337251538Srpaulostatic void		urtwn_edca_init(struct urtwn_softc *);
338281069Srpaulostatic void		urtwn_write_txpower(struct urtwn_softc *, int,
339251538Srpaulo			    uint16_t[]);
340251538Srpaulostatic void		urtwn_get_txpower(struct urtwn_softc *, int,
341281069Srpaulo		      	    struct ieee80211_channel *,
342251538Srpaulo			    struct ieee80211_channel *, uint16_t[]);
343264912Skevlostatic void		urtwn_r88e_get_txpower(struct urtwn_softc *, int,
344281069Srpaulo		      	    struct ieee80211_channel *,
345264912Skevlo			    struct ieee80211_channel *, uint16_t[]);
346251538Srpaulostatic void		urtwn_set_txpower(struct urtwn_softc *,
347281069Srpaulo		    	    struct ieee80211_channel *,
348251538Srpaulo			    struct ieee80211_channel *);
349290048Savosstatic void		urtwn_set_rx_bssid_all(struct urtwn_softc *, int);
350290048Savosstatic void		urtwn_set_gain(struct urtwn_softc *, uint8_t);
351251538Srpaulostatic void		urtwn_scan_start(struct ieee80211com *);
352251538Srpaulostatic void		urtwn_scan_end(struct ieee80211com *);
353251538Srpaulostatic void		urtwn_set_channel(struct ieee80211com *);
354292014Savosstatic int		urtwn_wme_update(struct ieee80211com *);
355294465Savosstatic void		urtwn_update_slot(struct ieee80211com *);
356294465Savosstatic void		urtwn_update_slot_cb(struct urtwn_softc *,
357294465Savos			    union sec_param *);
358294465Savosstatic void		urtwn_update_aifs(struct urtwn_softc *, uint8_t);
359290564Savosstatic void		urtwn_set_promisc(struct urtwn_softc *);
360290564Savosstatic void		urtwn_update_promisc(struct ieee80211com *);
361289066Skevlostatic void		urtwn_update_mcast(struct ieee80211com *);
362297910Sadrianstatic struct ieee80211_node *urtwn_node_alloc(struct ieee80211vap *,
363292167Savos			    const uint8_t mac[IEEE80211_ADDR_LEN]);
364297910Sadrianstatic void		urtwn_newassoc(struct ieee80211_node *, int);
365297910Sadrianstatic void		urtwn_node_free(struct ieee80211_node *);
366251538Srpaulostatic void		urtwn_set_chan(struct urtwn_softc *,
367281069Srpaulo		    	    struct ieee80211_channel *,
368251538Srpaulo			    struct ieee80211_channel *);
369251538Srpaulostatic void		urtwn_iq_calib(struct urtwn_softc *);
370251538Srpaulostatic void		urtwn_lc_calib(struct urtwn_softc *);
371294473Savosstatic void		urtwn_temp_calib(struct urtwn_softc *);
372291698Savosstatic int		urtwn_init(struct urtwn_softc *);
373287197Sglebiusstatic void		urtwn_stop(struct urtwn_softc *);
374251538Srpaulostatic void		urtwn_abort_xfers(struct urtwn_softc *);
375251538Srpaulostatic int		urtwn_raw_xmit(struct ieee80211_node *, struct mbuf *,
376251538Srpaulo			    const struct ieee80211_bpf_params *);
377266472Shselaskystatic void		urtwn_ms_delay(struct urtwn_softc *);
378251538Srpaulo
379251538Srpaulo/* Aliases. */
380251538Srpaulo#define	urtwn_bb_write	urtwn_write_4
381251538Srpaulo#define urtwn_bb_read	urtwn_read_4
382251538Srpaulo
383251538Srpaulostatic const struct usb_config urtwn_config[URTWN_N_TRANSFER] = {
384251538Srpaulo	[URTWN_BULK_RX] = {
385251538Srpaulo		.type = UE_BULK,
386251538Srpaulo		.endpoint = UE_ADDR_ANY,
387251538Srpaulo		.direction = UE_DIR_IN,
388251538Srpaulo		.bufsize = URTWN_RXBUFSZ,
389251538Srpaulo		.flags = {
390251538Srpaulo			.pipe_bof = 1,
391251538Srpaulo			.short_xfer_ok = 1
392251538Srpaulo		},
393251538Srpaulo		.callback = urtwn_bulk_rx_callback,
394251538Srpaulo	},
395251538Srpaulo	[URTWN_BULK_TX_BE] = {
396251538Srpaulo		.type = UE_BULK,
397251538Srpaulo		.endpoint = 0x03,
398251538Srpaulo		.direction = UE_DIR_OUT,
399251538Srpaulo		.bufsize = URTWN_TXBUFSZ,
400251538Srpaulo		.flags = {
401251538Srpaulo			.ext_buffer = 1,
402251538Srpaulo			.pipe_bof = 1,
403251538Srpaulo			.force_short_xfer = 1
404251538Srpaulo		},
405251538Srpaulo		.callback = urtwn_bulk_tx_callback,
406251538Srpaulo		.timeout = URTWN_TX_TIMEOUT,	/* ms */
407251538Srpaulo	},
408251538Srpaulo	[URTWN_BULK_TX_BK] = {
409251538Srpaulo		.type = UE_BULK,
410251538Srpaulo		.endpoint = 0x03,
411251538Srpaulo		.direction = UE_DIR_OUT,
412251538Srpaulo		.bufsize = URTWN_TXBUFSZ,
413251538Srpaulo		.flags = {
414251538Srpaulo			.ext_buffer = 1,
415251538Srpaulo			.pipe_bof = 1,
416251538Srpaulo			.force_short_xfer = 1,
417251538Srpaulo		},
418251538Srpaulo		.callback = urtwn_bulk_tx_callback,
419251538Srpaulo		.timeout = URTWN_TX_TIMEOUT,	/* ms */
420251538Srpaulo	},
421251538Srpaulo	[URTWN_BULK_TX_VI] = {
422251538Srpaulo		.type = UE_BULK,
423251538Srpaulo		.endpoint = 0x02,
424251538Srpaulo		.direction = UE_DIR_OUT,
425251538Srpaulo		.bufsize = URTWN_TXBUFSZ,
426251538Srpaulo		.flags = {
427251538Srpaulo			.ext_buffer = 1,
428251538Srpaulo			.pipe_bof = 1,
429251538Srpaulo			.force_short_xfer = 1
430251538Srpaulo		},
431251538Srpaulo		.callback = urtwn_bulk_tx_callback,
432251538Srpaulo		.timeout = URTWN_TX_TIMEOUT,	/* ms */
433251538Srpaulo	},
434251538Srpaulo	[URTWN_BULK_TX_VO] = {
435251538Srpaulo		.type = UE_BULK,
436251538Srpaulo		.endpoint = 0x02,
437251538Srpaulo		.direction = UE_DIR_OUT,
438251538Srpaulo		.bufsize = URTWN_TXBUFSZ,
439251538Srpaulo		.flags = {
440251538Srpaulo			.ext_buffer = 1,
441251538Srpaulo			.pipe_bof = 1,
442251538Srpaulo			.force_short_xfer = 1
443251538Srpaulo		},
444251538Srpaulo		.callback = urtwn_bulk_tx_callback,
445251538Srpaulo		.timeout = URTWN_TX_TIMEOUT,	/* ms */
446251538Srpaulo	},
447251538Srpaulo};
448251538Srpaulo
449292014Savosstatic const struct wme_to_queue {
450292014Savos	uint16_t reg;
451292014Savos	uint8_t qid;
452292014Savos} wme2queue[WME_NUM_AC] = {
453292014Savos	{ R92C_EDCA_BE_PARAM, URTWN_BULK_TX_BE},
454292014Savos	{ R92C_EDCA_BK_PARAM, URTWN_BULK_TX_BK},
455292014Savos	{ R92C_EDCA_VI_PARAM, URTWN_BULK_TX_VI},
456292014Savos	{ R92C_EDCA_VO_PARAM, URTWN_BULK_TX_VO}
457292014Savos};
458292014Savos
459251538Srpaulostatic int
460251538Srpaulourtwn_match(device_t self)
461251538Srpaulo{
462251538Srpaulo	struct usb_attach_arg *uaa = device_get_ivars(self);
463251538Srpaulo
464251538Srpaulo	if (uaa->usb_mode != USB_MODE_HOST)
465251538Srpaulo		return (ENXIO);
466251538Srpaulo	if (uaa->info.bConfigIndex != URTWN_CONFIG_INDEX)
467251538Srpaulo		return (ENXIO);
468251538Srpaulo	if (uaa->info.bIfaceIndex != URTWN_IFACE_INDEX)
469251538Srpaulo		return (ENXIO);
470251538Srpaulo
471251538Srpaulo	return (usbd_lookup_id_by_uaa(urtwn_devs, sizeof(urtwn_devs), uaa));
472251538Srpaulo}
473251538Srpaulo
474297175Sadrianstatic void
475297175Sadrianurtwn_update_chw(struct ieee80211com *ic)
476297175Sadrian{
477297175Sadrian}
478297175Sadrian
479251538Srpaulostatic int
480297175Sadrianurtwn_ampdu_enable(struct ieee80211_node *ni, struct ieee80211_tx_ampdu *tap)
481297175Sadrian{
482297175Sadrian
483297175Sadrian	/* We're driving this ourselves (eventually); don't involve net80211 */
484297175Sadrian	return (0);
485297175Sadrian}
486297175Sadrian
487297175Sadrianstatic int
488251538Srpaulourtwn_attach(device_t self)
489251538Srpaulo{
490251538Srpaulo	struct usb_attach_arg *uaa = device_get_ivars(self);
491251538Srpaulo	struct urtwn_softc *sc = device_get_softc(self);
492287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
493293339Savos	uint8_t bands[howmany(IEEE80211_MODE_MAX, 8)];
494251538Srpaulo	int error;
495251538Srpaulo
496251538Srpaulo	device_set_usb_desc(self);
497251538Srpaulo	sc->sc_udev = uaa->device;
498251538Srpaulo	sc->sc_dev = self;
499264912Skevlo	if (USB_GET_DRIVER_INFO(uaa) == URTWN_RTL8188E)
500264912Skevlo		sc->chip |= URTWN_CHIP_88E;
501251538Srpaulo
502294471Savos#ifdef USB_DEBUG
503294471Savos	int debug;
504294471Savos	if (resource_int_value(device_get_name(sc->sc_dev),
505294471Savos	    device_get_unit(sc->sc_dev), "debug", &debug) == 0)
506294471Savos		sc->sc_debug = debug;
507294471Savos#endif
508294471Savos
509251538Srpaulo	mtx_init(&sc->sc_mtx, device_get_nameunit(self),
510251538Srpaulo	    MTX_NETWORK_LOCK, MTX_DEF);
511292174Savos	URTWN_CMDQ_LOCK_INIT(sc);
512292167Savos	URTWN_NT_LOCK_INIT(sc);
513294473Savos	callout_init(&sc->sc_calib_to, 0);
514251538Srpaulo	callout_init(&sc->sc_watchdog_ch, 0);
515287197Sglebius	mbufq_init(&sc->sc_snd, ifqmaxlen);
516251538Srpaulo
517291902Skevlo	sc->sc_iface_index = URTWN_IFACE_INDEX;
518291902Skevlo	error = usbd_transfer_setup(uaa->device, &sc->sc_iface_index,
519291902Skevlo	    sc->sc_xfer, urtwn_config, URTWN_N_TRANSFER, sc, &sc->sc_mtx);
520251538Srpaulo	if (error) {
521251538Srpaulo		device_printf(self, "could not allocate USB transfers, "
522251538Srpaulo		    "err=%s\n", usbd_errstr(error));
523251538Srpaulo		goto detach;
524251538Srpaulo	}
525251538Srpaulo
526251538Srpaulo	URTWN_LOCK(sc);
527251538Srpaulo
528251538Srpaulo	error = urtwn_read_chipid(sc);
529251538Srpaulo	if (error) {
530251538Srpaulo		device_printf(sc->sc_dev, "unsupported test chip\n");
531251538Srpaulo		URTWN_UNLOCK(sc);
532251538Srpaulo		goto detach;
533251538Srpaulo	}
534251538Srpaulo
535251538Srpaulo	/* Determine number of Tx/Rx chains. */
536251538Srpaulo	if (sc->chip & URTWN_CHIP_92C) {
537251538Srpaulo		sc->ntxchains = (sc->chip & URTWN_CHIP_92C_1T2R) ? 1 : 2;
538251538Srpaulo		sc->nrxchains = 2;
539251538Srpaulo	} else {
540251538Srpaulo		sc->ntxchains = 1;
541251538Srpaulo		sc->nrxchains = 1;
542251538Srpaulo	}
543251538Srpaulo
544264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
545291264Savos		error = urtwn_r88e_read_rom(sc);
546264912Skevlo	else
547291264Savos		error = urtwn_read_rom(sc);
548291264Savos	if (error != 0) {
549291264Savos		device_printf(sc->sc_dev, "%s: cannot read rom, error %d\n",
550291264Savos		    __func__, error);
551291264Savos		URTWN_UNLOCK(sc);
552291264Savos		goto detach;
553291264Savos	}
554264912Skevlo
555251538Srpaulo	device_printf(sc->sc_dev, "MAC/BB RTL%s, RF 6052 %dT%dR\n",
556251538Srpaulo	    (sc->chip & URTWN_CHIP_92C) ? "8192CU" :
557264912Skevlo	    (sc->chip & URTWN_CHIP_88E) ? "8188EU" :
558251538Srpaulo	    (sc->board_type == R92C_BOARD_TYPE_HIGHPA) ? "8188RU" :
559251538Srpaulo	    (sc->board_type == R92C_BOARD_TYPE_MINICARD) ? "8188CE-VAU" :
560251538Srpaulo	    "8188CUS", sc->ntxchains, sc->nrxchains);
561251538Srpaulo
562251538Srpaulo	URTWN_UNLOCK(sc);
563251538Srpaulo
564283537Sglebius	ic->ic_softc = sc;
565283527Sglebius	ic->ic_name = device_get_nameunit(self);
566251538Srpaulo	ic->ic_phytype = IEEE80211_T_OFDM;	/* not only, but not used */
567251538Srpaulo	ic->ic_opmode = IEEE80211_M_STA;	/* default to BSS mode */
568251538Srpaulo
569251538Srpaulo	/* set device capabilities */
570251538Srpaulo	ic->ic_caps =
571251538Srpaulo		  IEEE80211_C_STA		/* station mode */
572251538Srpaulo		| IEEE80211_C_MONITOR		/* monitor mode */
573290651Savos		| IEEE80211_C_IBSS		/* adhoc mode */
574290631Savos		| IEEE80211_C_HOSTAP		/* hostap mode */
575251538Srpaulo		| IEEE80211_C_SHPREAMBLE	/* short preamble supported */
576251538Srpaulo		| IEEE80211_C_SHSLOT		/* short slot time supported */
577297175Sadrian#if 0
578251538Srpaulo		| IEEE80211_C_BGSCAN		/* capable of bg scanning */
579297175Sadrian#endif
580251538Srpaulo		| IEEE80211_C_WPA		/* 802.11i */
581292014Savos		| IEEE80211_C_WME		/* 802.11e */
582297596Sadrian		| IEEE80211_C_SWAMSDUTX		/* Do software A-MSDU TX */
583297596Sadrian		| IEEE80211_C_FF		/* Atheros fast-frames */
584251538Srpaulo		;
585251538Srpaulo
586292175Savos	ic->ic_cryptocaps =
587292175Savos	    IEEE80211_CRYPTO_WEP |
588292175Savos	    IEEE80211_CRYPTO_TKIP |
589292175Savos	    IEEE80211_CRYPTO_AES_CCM;
590292175Savos
591297175Sadrian	/* Assume they're all 11n capable for now */
592297175Sadrian	if (urtwn_enable_11n) {
593297175Sadrian		device_printf(self, "enabling 11n\n");
594297175Sadrian		ic->ic_htcaps = IEEE80211_HTC_HT |
595297601Sadrian#if 0
596297175Sadrian		    IEEE80211_HTC_AMPDU |
597297601Sadrian#endif
598297175Sadrian		    IEEE80211_HTC_AMSDU |
599297175Sadrian		    IEEE80211_HTCAP_MAXAMSDU_3839 |
600297175Sadrian		    IEEE80211_HTCAP_SMPS_OFF;
601297175Sadrian		/* no HT40 just yet */
602297175Sadrian		// ic->ic_htcaps |= IEEE80211_HTCAP_CHWIDTH40;
603297175Sadrian
604297175Sadrian		/* XXX TODO: verify chains versus streams for urtwn */
605297175Sadrian		ic->ic_txstream = sc->ntxchains;
606297175Sadrian		ic->ic_rxstream = sc->nrxchains;
607297175Sadrian	}
608297175Sadrian
609293339Savos	memset(bands, 0, sizeof(bands));
610293339Savos	setbit(bands, IEEE80211_MODE_11B);
611293339Savos	setbit(bands, IEEE80211_MODE_11G);
612297175Sadrian	if (urtwn_enable_11n)
613297175Sadrian		setbit(bands, IEEE80211_MODE_11NG);
614293339Savos	ieee80211_init_channels(ic, NULL, bands);
615251538Srpaulo
616287197Sglebius	ieee80211_ifattach(ic);
617251538Srpaulo	ic->ic_raw_xmit = urtwn_raw_xmit;
618251538Srpaulo	ic->ic_scan_start = urtwn_scan_start;
619251538Srpaulo	ic->ic_scan_end = urtwn_scan_end;
620251538Srpaulo	ic->ic_set_channel = urtwn_set_channel;
621287197Sglebius	ic->ic_transmit = urtwn_transmit;
622287197Sglebius	ic->ic_parent = urtwn_parent;
623251538Srpaulo	ic->ic_vap_create = urtwn_vap_create;
624251538Srpaulo	ic->ic_vap_delete = urtwn_vap_delete;
625292014Savos	ic->ic_wme.wme_update = urtwn_wme_update;
626294465Savos	ic->ic_updateslot = urtwn_update_slot;
627290564Savos	ic->ic_update_promisc = urtwn_update_promisc;
628251538Srpaulo	ic->ic_update_mcast = urtwn_update_mcast;
629292167Savos	if (sc->chip & URTWN_CHIP_88E) {
630297910Sadrian		ic->ic_node_alloc = urtwn_node_alloc;
631297910Sadrian		ic->ic_newassoc = urtwn_newassoc;
632292167Savos		sc->sc_node_free = ic->ic_node_free;
633297910Sadrian		ic->ic_node_free = urtwn_node_free;
634292167Savos	}
635297175Sadrian	ic->ic_update_chw = urtwn_update_chw;
636297175Sadrian	ic->ic_ampdu_enable = urtwn_ampdu_enable;
637251538Srpaulo
638281069Srpaulo	ieee80211_radiotap_attach(ic, &sc->sc_txtap.wt_ihdr,
639251538Srpaulo	    sizeof(sc->sc_txtap), URTWN_TX_RADIOTAP_PRESENT,
640251538Srpaulo	    &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap),
641251538Srpaulo	    URTWN_RX_RADIOTAP_PRESENT);
642251538Srpaulo
643292174Savos	TASK_INIT(&sc->cmdq_task, 0, urtwn_cmdq_cb, sc);
644292174Savos
645294471Savos	urtwn_sysctlattach(sc);
646294471Savos
647251538Srpaulo	if (bootverbose)
648251538Srpaulo		ieee80211_announce(ic);
649251538Srpaulo
650251538Srpaulo	return (0);
651251538Srpaulo
652251538Srpaulodetach:
653251538Srpaulo	urtwn_detach(self);
654251538Srpaulo	return (ENXIO);			/* failure */
655251538Srpaulo}
656251538Srpaulo
657294471Savosstatic void
658294471Savosurtwn_sysctlattach(struct urtwn_softc *sc)
659294471Savos{
660294471Savos#ifdef USB_DEBUG
661294471Savos	struct sysctl_ctx_list *ctx = device_get_sysctl_ctx(sc->sc_dev);
662294471Savos	struct sysctl_oid *tree = device_get_sysctl_tree(sc->sc_dev);
663294471Savos
664294471Savos	SYSCTL_ADD_U32(ctx, SYSCTL_CHILDREN(tree), OID_AUTO,
665294471Savos	    "debug", CTLFLAG_RW, &sc->sc_debug, sc->sc_debug,
666294471Savos	    "control debugging printfs");
667294471Savos#endif
668294471Savos}
669294471Savos
670251538Srpaulostatic int
671251538Srpaulourtwn_detach(device_t self)
672251538Srpaulo{
673251538Srpaulo	struct urtwn_softc *sc = device_get_softc(self);
674287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
675263153Skevlo	unsigned int x;
676281069Srpaulo
677263153Skevlo	/* Prevent further ioctls. */
678263153Skevlo	URTWN_LOCK(sc);
679263153Skevlo	sc->sc_flags |= URTWN_DETACHED;
680263153Skevlo	URTWN_UNLOCK(sc);
681251538Srpaulo
682291698Savos	urtwn_stop(sc);
683291698Savos
684251538Srpaulo	callout_drain(&sc->sc_watchdog_ch);
685294473Savos	callout_drain(&sc->sc_calib_to);
686251538Srpaulo
687288353Sadrian	/* stop all USB transfers */
688288353Sadrian	usbd_transfer_unsetup(sc->sc_xfer, URTWN_N_TRANSFER);
689288353Sadrian
690263153Skevlo	/* Prevent further allocations from RX/TX data lists. */
691263153Skevlo	URTWN_LOCK(sc);
692263153Skevlo	STAILQ_INIT(&sc->sc_tx_active);
693263153Skevlo	STAILQ_INIT(&sc->sc_tx_inactive);
694263153Skevlo	STAILQ_INIT(&sc->sc_tx_pending);
695263153Skevlo
696263153Skevlo	STAILQ_INIT(&sc->sc_rx_active);
697263153Skevlo	STAILQ_INIT(&sc->sc_rx_inactive);
698263153Skevlo	URTWN_UNLOCK(sc);
699263153Skevlo
700263153Skevlo	/* drain USB transfers */
701263153Skevlo	for (x = 0; x != URTWN_N_TRANSFER; x++)
702263153Skevlo		usbd_transfer_drain(sc->sc_xfer[x]);
703263153Skevlo
704263153Skevlo	/* Free data buffers. */
705263153Skevlo	URTWN_LOCK(sc);
706263153Skevlo	urtwn_free_tx_list(sc);
707263153Skevlo	urtwn_free_rx_list(sc);
708263153Skevlo	URTWN_UNLOCK(sc);
709263153Skevlo
710292174Savos	if (ic->ic_softc == sc) {
711292174Savos		ieee80211_draintask(ic, &sc->cmdq_task);
712292174Savos		ieee80211_ifdetach(ic);
713292174Savos	}
714292174Savos
715292167Savos	URTWN_NT_LOCK_DESTROY(sc);
716292174Savos	URTWN_CMDQ_LOCK_DESTROY(sc);
717251538Srpaulo	mtx_destroy(&sc->sc_mtx);
718251538Srpaulo
719251538Srpaulo	return (0);
720251538Srpaulo}
721251538Srpaulo
722251538Srpaulostatic void
723289066Skevlourtwn_drain_mbufq(struct urtwn_softc *sc)
724251538Srpaulo{
725289066Skevlo	struct mbuf *m;
726289066Skevlo	struct ieee80211_node *ni;
727289066Skevlo	URTWN_ASSERT_LOCKED(sc);
728289066Skevlo	while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) {
729289066Skevlo		ni = (struct ieee80211_node *)m->m_pkthdr.rcvif;
730289066Skevlo		m->m_pkthdr.rcvif = NULL;
731289066Skevlo		ieee80211_free_node(ni);
732289066Skevlo		m_freem(m);
733251538Srpaulo	}
734251538Srpaulo}
735251538Srpaulo
736251538Srpaulostatic usb_error_t
737251538Srpaulourtwn_do_request(struct urtwn_softc *sc, struct usb_device_request *req,
738251538Srpaulo    void *data)
739251538Srpaulo{
740251538Srpaulo	usb_error_t err;
741251538Srpaulo	int ntries = 10;
742251538Srpaulo
743251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
744251538Srpaulo
745251538Srpaulo	while (ntries--) {
746251538Srpaulo		err = usbd_do_request_flags(sc->sc_udev, &sc->sc_mtx,
747251538Srpaulo		    req, data, 0, NULL, 250 /* ms */);
748251538Srpaulo		if (err == 0)
749251538Srpaulo			break;
750251538Srpaulo
751294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_USB,
752294471Savos		    "%s: control request failed, %s (retries left: %d)\n",
753294471Savos		    __func__, usbd_errstr(err), ntries);
754251538Srpaulo		usb_pause_mtx(&sc->sc_mtx, hz / 100);
755251538Srpaulo	}
756251538Srpaulo	return (err);
757251538Srpaulo}
758251538Srpaulo
759251538Srpaulostatic struct ieee80211vap *
760251538Srpaulourtwn_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit,
761251538Srpaulo    enum ieee80211_opmode opmode, int flags,
762251538Srpaulo    const uint8_t bssid[IEEE80211_ADDR_LEN],
763251538Srpaulo    const uint8_t mac[IEEE80211_ADDR_LEN])
764251538Srpaulo{
765290631Savos	struct urtwn_softc *sc = ic->ic_softc;
766251538Srpaulo	struct urtwn_vap *uvp;
767251538Srpaulo	struct ieee80211vap *vap;
768251538Srpaulo
769251538Srpaulo	if (!TAILQ_EMPTY(&ic->ic_vaps))		/* only one at a time */
770251538Srpaulo		return (NULL);
771251538Srpaulo
772287197Sglebius	uvp = malloc(sizeof(struct urtwn_vap), M_80211_VAP, M_WAITOK | M_ZERO);
773251538Srpaulo	vap = &uvp->vap;
774251538Srpaulo	/* enable s/w bmiss handling for sta mode */
775251538Srpaulo
776281069Srpaulo	if (ieee80211_vap_setup(ic, vap, name, unit, opmode,
777287197Sglebius	    flags | IEEE80211_CLONE_NOBEACONS, bssid) != 0) {
778257743Shselasky		/* out of memory */
779257743Shselasky		free(uvp, M_80211_VAP);
780257743Shselasky		return (NULL);
781257743Shselasky	}
782257743Shselasky
783290651Savos	if (opmode == IEEE80211_M_HOSTAP || opmode == IEEE80211_M_IBSS)
784290631Savos		urtwn_init_beacon(sc, uvp);
785290631Savos
786251538Srpaulo	/* override state transition machine */
787251538Srpaulo	uvp->newstate = vap->iv_newstate;
788251538Srpaulo	vap->iv_newstate = urtwn_newstate;
789290631Savos	vap->iv_update_beacon = urtwn_update_beacon;
790292175Savos	vap->iv_key_alloc = urtwn_key_alloc;
791292175Savos	vap->iv_key_set = urtwn_key_set;
792292175Savos	vap->iv_key_delete = urtwn_key_delete;
793298138Sadrian
794298138Sadrian	/* 802.11n parameters */
795298138Sadrian	vap->iv_ampdu_density = IEEE80211_HTCAP_MPDUDENSITY_16;
796298175Sadrian	vap->iv_ampdu_rxmax = IEEE80211_HTCAP_MAXRXAMPDU_64K;
797298138Sadrian
798290651Savos	if (opmode == IEEE80211_M_IBSS) {
799290651Savos		uvp->recv_mgmt = vap->iv_recv_mgmt;
800290651Savos		vap->iv_recv_mgmt = urtwn_ibss_recv_mgmt;
801290651Savos		TASK_INIT(&uvp->tsf_task_adhoc, 0, urtwn_tsf_task_adhoc, vap);
802290651Savos	}
803251538Srpaulo
804292167Savos	if (URTWN_CHIP_HAS_RATECTL(sc))
805292167Savos		ieee80211_ratectl_init(vap);
806251538Srpaulo	/* complete setup */
807251538Srpaulo	ieee80211_vap_attach(vap, ieee80211_media_change,
808287197Sglebius	    ieee80211_media_status, mac);
809251538Srpaulo	ic->ic_opmode = opmode;
810251538Srpaulo	return (vap);
811251538Srpaulo}
812251538Srpaulo
813251538Srpaulostatic void
814251538Srpaulourtwn_vap_delete(struct ieee80211vap *vap)
815251538Srpaulo{
816290651Savos	struct ieee80211com *ic = vap->iv_ic;
817292167Savos	struct urtwn_softc *sc = ic->ic_softc;
818251538Srpaulo	struct urtwn_vap *uvp = URTWN_VAP(vap);
819251538Srpaulo
820290651Savos	if (uvp->bcn_mbuf != NULL)
821290651Savos		m_freem(uvp->bcn_mbuf);
822290651Savos	if (vap->iv_opmode == IEEE80211_M_IBSS)
823290651Savos		ieee80211_draintask(ic, &uvp->tsf_task_adhoc);
824292167Savos	if (URTWN_CHIP_HAS_RATECTL(sc))
825292167Savos		ieee80211_ratectl_deinit(vap);
826251538Srpaulo	ieee80211_vap_detach(vap);
827251538Srpaulo	free(uvp, M_80211_VAP);
828251538Srpaulo}
829251538Srpaulo
830251538Srpaulostatic struct mbuf *
831292207Savosurtwn_rx_copy_to_mbuf(struct urtwn_softc *sc, struct r92c_rx_stat *stat,
832292207Savos    int totlen)
833251538Srpaulo{
834287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
835251538Srpaulo	struct mbuf *m;
836292207Savos	uint32_t rxdw0;
837292207Savos	int pktlen;
838251538Srpaulo
839251538Srpaulo	/*
840251538Srpaulo	 * don't pass packets to the ieee80211 framework if the driver isn't
841251538Srpaulo	 * RUNNING.
842251538Srpaulo	 */
843287197Sglebius	if (!(sc->sc_flags & URTWN_RUNNING))
844251538Srpaulo		return (NULL);
845251538Srpaulo
846251538Srpaulo	rxdw0 = le32toh(stat->rxdw0);
847251538Srpaulo	if (rxdw0 & (R92C_RXDW0_CRCERR | R92C_RXDW0_ICVERR)) {
848251538Srpaulo		/*
849251538Srpaulo		 * This should not happen since we setup our Rx filter
850251538Srpaulo		 * to not receive these frames.
851251538Srpaulo		 */
852294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_RECV,
853294471Savos		    "%s: RX flags error (%s)\n", __func__,
854292207Savos		    rxdw0 & R92C_RXDW0_CRCERR ? "CRC" : "ICV");
855292207Savos		goto fail;
856251538Srpaulo	}
857292207Savos
858292207Savos	pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN);
859292207Savos	if (pktlen < sizeof(struct ieee80211_frame_ack)) {
860294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_RECV,
861294471Savos		    "%s: frame is too short: %d\n", __func__, pktlen);
862292207Savos		goto fail;
863271303Skevlo	}
864251538Srpaulo
865292207Savos	if (__predict_false(totlen > MCLBYTES)) {
866292207Savos		/* convert to m_getjcl if this happens */
867292207Savos		device_printf(sc->sc_dev, "%s: frame too long: %d (%d)\n",
868292207Savos		    __func__, pktlen, totlen);
869292207Savos		goto fail;
870251538Srpaulo	}
871251538Srpaulo
872260463Skevlo	m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR);
873292207Savos	if (__predict_false(m == NULL)) {
874292207Savos		device_printf(sc->sc_dev, "%s: could not allocate RX mbuf\n",
875292207Savos		    __func__);
876292207Savos		goto fail;
877251538Srpaulo	}
878251538Srpaulo
879251538Srpaulo	/* Finalize mbuf. */
880292207Savos	memcpy(mtod(m, uint8_t *), (uint8_t *)stat, totlen);
881292207Savos	m->m_pkthdr.len = m->m_len = totlen;
882292207Savos
883251538Srpaulo	return (m);
884292207Savosfail:
885292207Savos	counter_u64_add(ic->ic_ierrors, 1);
886292207Savos	return (NULL);
887251538Srpaulo}
888251538Srpaulo
889251538Srpaulostatic struct mbuf *
890292207Savosurtwn_report_intr(struct usb_xfer *xfer, struct urtwn_data *data)
891251538Srpaulo{
892251538Srpaulo	struct urtwn_softc *sc = data->sc;
893287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
894251538Srpaulo	struct r92c_rx_stat *stat;
895251538Srpaulo	uint8_t *buf;
896292167Savos	int len;
897251538Srpaulo
898251538Srpaulo	usbd_xfer_status(xfer, &len, NULL, NULL, NULL);
899251538Srpaulo
900251538Srpaulo	if (len < sizeof(*stat)) {
901287197Sglebius		counter_u64_add(ic->ic_ierrors, 1);
902251538Srpaulo		return (NULL);
903251538Srpaulo	}
904251538Srpaulo
905251538Srpaulo	buf = data->buf;
906292167Savos	stat = (struct r92c_rx_stat *)buf;
907292167Savos
908297596Sadrian	/*
909297596Sadrian	 * For 88E chips we can tie the FF flushing here;
910297596Sadrian	 * this is where we do know exactly how deep the
911297596Sadrian	 * transmit queue is.
912297596Sadrian	 *
913297596Sadrian	 * But it won't work for R92 chips, so we can't
914297596Sadrian	 * take the easy way out.
915297596Sadrian	 */
916297596Sadrian
917292167Savos	if (sc->chip & URTWN_CHIP_88E) {
918292167Savos		int report_sel = MS(le32toh(stat->rxdw3), R88E_RXDW3_RPT);
919292167Savos
920292167Savos		switch (report_sel) {
921292167Savos		case R88E_RXDW3_RPT_RX:
922292207Savos			return (urtwn_rxeof(sc, buf, len));
923292167Savos		case R88E_RXDW3_RPT_TX1:
924292167Savos			urtwn_r88e_ratectl_tx_complete(sc, &stat[1]);
925292167Savos			break;
926292167Savos		default:
927294471Savos			URTWN_DPRINTF(sc, URTWN_DEBUG_INTR,
928294471Savos			    "%s: case %d was not handled\n", __func__,
929294471Savos			    report_sel);
930292167Savos			break;
931292167Savos		}
932292167Savos	} else
933292207Savos		return (urtwn_rxeof(sc, buf, len));
934292167Savos
935292167Savos	return (NULL);
936292167Savos}
937292167Savos
938292167Savosstatic struct mbuf *
939292207Savosurtwn_rxeof(struct urtwn_softc *sc, uint8_t *buf, int len)
940292167Savos{
941292167Savos	struct r92c_rx_stat *stat;
942292167Savos	struct mbuf *m, *m0 = NULL, *prevm = NULL;
943292167Savos	uint32_t rxdw0;
944292167Savos	int totlen, pktlen, infosz, npkts;
945292167Savos
946251538Srpaulo	/* Get the number of encapsulated frames. */
947251538Srpaulo	stat = (struct r92c_rx_stat *)buf;
948251538Srpaulo	npkts = MS(le32toh(stat->rxdw2), R92C_RXDW2_PKTCNT);
949294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_RECV,
950294471Savos	    "%s: Rx %d frames in one chunk\n", __func__, npkts);
951251538Srpaulo
952251538Srpaulo	/* Process all of them. */
953251538Srpaulo	while (npkts-- > 0) {
954251538Srpaulo		if (len < sizeof(*stat))
955251538Srpaulo			break;
956251538Srpaulo		stat = (struct r92c_rx_stat *)buf;
957251538Srpaulo		rxdw0 = le32toh(stat->rxdw0);
958251538Srpaulo
959251538Srpaulo		pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN);
960251538Srpaulo		if (pktlen == 0)
961251538Srpaulo			break;
962251538Srpaulo
963251538Srpaulo		infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8;
964251538Srpaulo
965251538Srpaulo		/* Make sure everything fits in xfer. */
966251538Srpaulo		totlen = sizeof(*stat) + infosz + pktlen;
967251538Srpaulo		if (totlen > len)
968251538Srpaulo			break;
969251538Srpaulo
970292207Savos		m = urtwn_rx_copy_to_mbuf(sc, stat, totlen);
971251538Srpaulo		if (m0 == NULL)
972251538Srpaulo			m0 = m;
973251538Srpaulo		if (prevm == NULL)
974251538Srpaulo			prevm = m;
975251538Srpaulo		else {
976251538Srpaulo			prevm->m_next = m;
977251538Srpaulo			prevm = m;
978251538Srpaulo		}
979251538Srpaulo
980251538Srpaulo		/* Next chunk is 128-byte aligned. */
981251538Srpaulo		totlen = (totlen + 127) & ~127;
982251538Srpaulo		buf += totlen;
983251538Srpaulo		len -= totlen;
984251538Srpaulo	}
985251538Srpaulo
986251538Srpaulo	return (m0);
987251538Srpaulo}
988251538Srpaulo
989251538Srpaulostatic void
990292167Savosurtwn_r88e_ratectl_tx_complete(struct urtwn_softc *sc, void *arg)
991292167Savos{
992292167Savos	struct r88e_tx_rpt_ccx *rpt = arg;
993292167Savos	struct ieee80211vap *vap;
994292167Savos	struct ieee80211_node *ni;
995292167Savos	uint8_t macid;
996292167Savos	int ntries;
997292167Savos
998292167Savos	macid = MS(rpt->rptb1, R88E_RPTB1_MACID);
999292167Savos	ntries = MS(rpt->rptb2, R88E_RPTB2_RETRY_CNT);
1000292167Savos
1001292167Savos	URTWN_NT_LOCK(sc);
1002292167Savos	ni = sc->node_list[macid];
1003292167Savos	if (ni != NULL) {
1004292167Savos		vap = ni->ni_vap;
1005294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_INTR, "%s: frame for macid %d was"
1006294471Savos		    "%s sent (%d retries)\n", __func__, macid,
1007294471Savos		    (rpt->rptb1 & R88E_RPTB1_PKT_OK) ? "" : " not",
1008294471Savos		    ntries);
1009292167Savos
1010292167Savos		if (rpt->rptb1 & R88E_RPTB1_PKT_OK) {
1011292167Savos			ieee80211_ratectl_tx_complete(vap, ni,
1012292167Savos			    IEEE80211_RATECTL_TX_SUCCESS, &ntries, NULL);
1013292167Savos		} else {
1014292167Savos			ieee80211_ratectl_tx_complete(vap, ni,
1015292167Savos			    IEEE80211_RATECTL_TX_FAILURE, &ntries, NULL);
1016292167Savos		}
1017294471Savos	} else {
1018294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_INTR, "%s: macid %d, ni is NULL\n",
1019294471Savos		    __func__, macid);
1020294471Savos	}
1021292167Savos	URTWN_NT_UNLOCK(sc);
1022292167Savos}
1023292167Savos
1024292207Savosstatic struct ieee80211_node *
1025292207Savosurtwn_rx_frame(struct urtwn_softc *sc, struct mbuf *m, int8_t *rssi_p)
1026292207Savos{
1027292207Savos	struct ieee80211com *ic = &sc->sc_ic;
1028292207Savos	struct ieee80211_frame_min *wh;
1029292207Savos	struct r92c_rx_stat *stat;
1030292207Savos	uint32_t rxdw0, rxdw3;
1031292207Savos	uint8_t rate, cipher;
1032297910Sadrian	int8_t rssi = -127;
1033292207Savos	int infosz;
1034292207Savos
1035292207Savos	stat = mtod(m, struct r92c_rx_stat *);
1036292207Savos	rxdw0 = le32toh(stat->rxdw0);
1037292207Savos	rxdw3 = le32toh(stat->rxdw3);
1038292207Savos
1039292207Savos	rate = MS(rxdw3, R92C_RXDW3_RATE);
1040292207Savos	cipher = MS(rxdw0, R92C_RXDW0_CIPHER);
1041292207Savos	infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8;
1042292207Savos
1043292207Savos	/* Get RSSI from PHY status descriptor if present. */
1044292207Savos	if (infosz != 0 && (rxdw0 & R92C_RXDW0_PHYST)) {
1045292207Savos		if (sc->chip & URTWN_CHIP_88E)
1046292207Savos			rssi = urtwn_r88e_get_rssi(sc, rate, &stat[1]);
1047292207Savos		else
1048292207Savos			rssi = urtwn_get_rssi(sc, rate, &stat[1]);
1049297910Sadrian		URTWN_DPRINTF(sc, URTWN_DEBUG_RSSI, "%s: rssi=%d\n", __func__, rssi);
1050292207Savos		/* Update our average RSSI. */
1051292207Savos		urtwn_update_avgrssi(sc, rate, rssi);
1052292207Savos	}
1053292207Savos
1054292207Savos	if (ieee80211_radiotap_active(ic)) {
1055292207Savos		struct urtwn_rx_radiotap_header *tap = &sc->sc_rxtap;
1056292207Savos
1057292207Savos		tap->wr_flags = 0;
1058292207Savos
1059292207Savos		urtwn_get_tsf(sc, &tap->wr_tsft);
1060292207Savos		if (__predict_false(le32toh((uint32_t)tap->wr_tsft) <
1061292207Savos				    le32toh(stat->rxdw5))) {
1062292207Savos			tap->wr_tsft = le32toh(tap->wr_tsft  >> 32) - 1;
1063292207Savos			tap->wr_tsft = (uint64_t)htole32(tap->wr_tsft) << 32;
1064292207Savos		} else
1065292207Savos			tap->wr_tsft &= 0xffffffff00000000;
1066292207Savos		tap->wr_tsft += stat->rxdw5;
1067292207Savos
1068297175Sadrian		/* XXX 20/40? */
1069297175Sadrian		/* XXX shortgi? */
1070297175Sadrian
1071292207Savos		/* Map HW rate index to 802.11 rate. */
1072292207Savos		if (!(rxdw3 & R92C_RXDW3_HT)) {
1073292207Savos			tap->wr_rate = ridx2rate[rate];
1074292207Savos		} else if (rate >= 12) {	/* MCS0~15. */
1075292207Savos			/* Bit 7 set means HT MCS instead of rate. */
1076292207Savos			tap->wr_rate = 0x80 | (rate - 12);
1077292207Savos		}
1078297910Sadrian
1079297910Sadrian		/* XXX TODO: this isn't right; should use the last good RSSI */
1080292207Savos		tap->wr_dbm_antsignal = rssi;
1081292207Savos		tap->wr_dbm_antnoise = URTWN_NOISE_FLOOR;
1082292207Savos	}
1083292207Savos
1084292207Savos	*rssi_p = rssi;
1085292207Savos
1086292207Savos	/* Drop descriptor. */
1087292207Savos	m_adj(m, sizeof(*stat) + infosz);
1088292207Savos	wh = mtod(m, struct ieee80211_frame_min *);
1089292207Savos
1090292207Savos	if ((wh->i_fc[1] & IEEE80211_FC1_PROTECTED) &&
1091292207Savos	    cipher != R92C_CAM_ALGO_NONE) {
1092292207Savos		m->m_flags |= M_WEP;
1093292207Savos	}
1094292207Savos
1095292207Savos	if (m->m_len >= sizeof(*wh))
1096292207Savos		return (ieee80211_find_rxnode(ic, wh));
1097292207Savos
1098292207Savos	return (NULL);
1099292207Savos}
1100292207Savos
1101292167Savosstatic void
1102251538Srpaulourtwn_bulk_rx_callback(struct usb_xfer *xfer, usb_error_t error)
1103251538Srpaulo{
1104251538Srpaulo	struct urtwn_softc *sc = usbd_xfer_softc(xfer);
1105287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
1106251538Srpaulo	struct ieee80211_node *ni;
1107251538Srpaulo	struct mbuf *m = NULL, *next;
1108251538Srpaulo	struct urtwn_data *data;
1109292207Savos	int8_t nf, rssi;
1110251538Srpaulo
1111251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
1112251538Srpaulo
1113251538Srpaulo	switch (USB_GET_STATE(xfer)) {
1114251538Srpaulo	case USB_ST_TRANSFERRED:
1115251538Srpaulo		data = STAILQ_FIRST(&sc->sc_rx_active);
1116251538Srpaulo		if (data == NULL)
1117251538Srpaulo			goto tr_setup;
1118251538Srpaulo		STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next);
1119292207Savos		m = urtwn_report_intr(xfer, data);
1120251538Srpaulo		STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next);
1121251538Srpaulo		/* FALLTHROUGH */
1122251538Srpaulo	case USB_ST_SETUP:
1123251538Srpaulotr_setup:
1124251538Srpaulo		data = STAILQ_FIRST(&sc->sc_rx_inactive);
1125251538Srpaulo		if (data == NULL) {
1126251538Srpaulo			KASSERT(m == NULL, ("mbuf isn't NULL"));
1127297596Sadrian			goto finish;
1128251538Srpaulo		}
1129251538Srpaulo		STAILQ_REMOVE_HEAD(&sc->sc_rx_inactive, next);
1130251538Srpaulo		STAILQ_INSERT_TAIL(&sc->sc_rx_active, data, next);
1131251538Srpaulo		usbd_xfer_set_frame_data(xfer, 0, data->buf,
1132251538Srpaulo		    usbd_xfer_max_len(xfer));
1133251538Srpaulo		usbd_transfer_submit(xfer);
1134251538Srpaulo
1135251538Srpaulo		/*
1136251538Srpaulo		 * To avoid LOR we should unlock our private mutex here to call
1137251538Srpaulo		 * ieee80211_input() because here is at the end of a USB
1138251538Srpaulo		 * callback and safe to unlock.
1139251538Srpaulo		 */
1140251538Srpaulo		while (m != NULL) {
1141251538Srpaulo			next = m->m_next;
1142251538Srpaulo			m->m_next = NULL;
1143292207Savos
1144292207Savos			ni = urtwn_rx_frame(sc, m, &rssi);
1145297910Sadrian
1146297910Sadrian			/* Store a global last-good RSSI */
1147297910Sadrian			if (rssi != -127)
1148297910Sadrian				sc->last_rssi = rssi;
1149297910Sadrian
1150292207Savos			URTWN_UNLOCK(sc);
1151292207Savos
1152251538Srpaulo			nf = URTWN_NOISE_FLOOR;
1153251538Srpaulo			if (ni != NULL) {
1154297910Sadrian				if (rssi != -127)
1155297910Sadrian					URTWN_NODE(ni)->last_rssi = rssi;
1156297175Sadrian				if (ni->ni_flags & IEEE80211_NODE_HT)
1157297175Sadrian					m->m_flags |= M_AMPDU;
1158297910Sadrian				(void)ieee80211_input(ni, m,
1159297910Sadrian				    URTWN_NODE(ni)->last_rssi - nf, nf);
1160251538Srpaulo				ieee80211_free_node(ni);
1161289799Savos			} else {
1162297910Sadrian				/* Use last good global RSSI */
1163297910Sadrian				(void)ieee80211_input_all(ic, m,
1164297910Sadrian				    sc->last_rssi - nf, nf);
1165289799Savos			}
1166292207Savos			URTWN_LOCK(sc);
1167251538Srpaulo			m = next;
1168251538Srpaulo		}
1169251538Srpaulo		break;
1170251538Srpaulo	default:
1171251538Srpaulo		/* needs it to the inactive queue due to a error. */
1172251538Srpaulo		data = STAILQ_FIRST(&sc->sc_rx_active);
1173251538Srpaulo		if (data != NULL) {
1174251538Srpaulo			STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next);
1175251538Srpaulo			STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next);
1176251538Srpaulo		}
1177251538Srpaulo		if (error != USB_ERR_CANCELLED) {
1178251538Srpaulo			usbd_xfer_set_stall(xfer);
1179287197Sglebius			counter_u64_add(ic->ic_ierrors, 1);
1180251538Srpaulo			goto tr_setup;
1181251538Srpaulo		}
1182251538Srpaulo		break;
1183251538Srpaulo	}
1184297596Sadrianfinish:
1185297596Sadrian	/* Finished receive; age anything left on the FF queue by a little bump */
1186297596Sadrian	/*
1187297596Sadrian	 * XXX TODO: just make this a callout timer schedule so we can
1188297596Sadrian	 * flush the FF staging queue if we're approaching idle.
1189297596Sadrian	 */
1190297596Sadrian#ifdef	IEEE80211_SUPPORT_SUPERG
1191297596Sadrian	URTWN_UNLOCK(sc);
1192297596Sadrian	ieee80211_ff_age_all(ic, 1);
1193297596Sadrian	URTWN_LOCK(sc);
1194297596Sadrian#endif
1195297596Sadrian
1196297596Sadrian	/* Kick-start more transmit in case we stalled */
1197297596Sadrian	urtwn_start(sc);
1198251538Srpaulo}
1199251538Srpaulo
1200251538Srpaulostatic void
1201289891Savosurtwn_txeof(struct urtwn_softc *sc, struct urtwn_data *data, int status)
1202251538Srpaulo{
1203251538Srpaulo
1204251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
1205289891Savos
1206290631Savos	if (data->ni != NULL)	/* not a beacon frame */
1207290631Savos		ieee80211_tx_complete(data->ni, data->m, status);
1208289891Savos
1209297596Sadrian	if (sc->sc_tx_n_active > 0)
1210297596Sadrian		sc->sc_tx_n_active--;
1211297596Sadrian
1212287197Sglebius	data->ni = NULL;
1213287197Sglebius	data->m = NULL;
1214289891Savos
1215251538Srpaulo	sc->sc_txtimer = 0;
1216289891Savos
1217289891Savos	STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data, next);
1218251538Srpaulo}
1219251538Srpaulo
1220289066Skevlostatic int
1221289066Skevlourtwn_alloc_list(struct urtwn_softc *sc, struct urtwn_data data[],
1222289066Skevlo    int ndata, int maxsz)
1223289066Skevlo{
1224289066Skevlo	int i, error;
1225289066Skevlo
1226289066Skevlo	for (i = 0; i < ndata; i++) {
1227289066Skevlo		struct urtwn_data *dp = &data[i];
1228289066Skevlo		dp->sc = sc;
1229289066Skevlo		dp->m = NULL;
1230289066Skevlo		dp->buf = malloc(maxsz, M_USBDEV, M_NOWAIT);
1231289066Skevlo		if (dp->buf == NULL) {
1232289066Skevlo			device_printf(sc->sc_dev,
1233289066Skevlo			    "could not allocate buffer\n");
1234289066Skevlo			error = ENOMEM;
1235289066Skevlo			goto fail;
1236289066Skevlo		}
1237289066Skevlo		dp->ni = NULL;
1238289066Skevlo	}
1239289066Skevlo
1240289066Skevlo	return (0);
1241289066Skevlofail:
1242289066Skevlo	urtwn_free_list(sc, data, ndata);
1243289066Skevlo	return (error);
1244289066Skevlo}
1245289066Skevlo
1246289066Skevlostatic int
1247289066Skevlourtwn_alloc_rx_list(struct urtwn_softc *sc)
1248289066Skevlo{
1249289066Skevlo        int error, i;
1250289066Skevlo
1251289066Skevlo	error = urtwn_alloc_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT,
1252289066Skevlo	    URTWN_RXBUFSZ);
1253289066Skevlo	if (error != 0)
1254289066Skevlo		return (error);
1255289066Skevlo
1256289066Skevlo	STAILQ_INIT(&sc->sc_rx_active);
1257289066Skevlo	STAILQ_INIT(&sc->sc_rx_inactive);
1258289066Skevlo
1259289066Skevlo	for (i = 0; i < URTWN_RX_LIST_COUNT; i++)
1260289066Skevlo		STAILQ_INSERT_HEAD(&sc->sc_rx_inactive, &sc->sc_rx[i], next);
1261289066Skevlo
1262289066Skevlo	return (0);
1263289066Skevlo}
1264289066Skevlo
1265289066Skevlostatic int
1266289066Skevlourtwn_alloc_tx_list(struct urtwn_softc *sc)
1267289066Skevlo{
1268289066Skevlo	int error, i;
1269289066Skevlo
1270289066Skevlo	error = urtwn_alloc_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT,
1271289066Skevlo	    URTWN_TXBUFSZ);
1272289066Skevlo	if (error != 0)
1273289066Skevlo		return (error);
1274289066Skevlo
1275289066Skevlo	STAILQ_INIT(&sc->sc_tx_active);
1276289066Skevlo	STAILQ_INIT(&sc->sc_tx_inactive);
1277289066Skevlo	STAILQ_INIT(&sc->sc_tx_pending);
1278289066Skevlo
1279289066Skevlo	for (i = 0; i < URTWN_TX_LIST_COUNT; i++)
1280289066Skevlo		STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, &sc->sc_tx[i], next);
1281289066Skevlo
1282289066Skevlo	return (0);
1283289066Skevlo}
1284289066Skevlo
1285251538Srpaulostatic void
1286289066Skevlourtwn_free_list(struct urtwn_softc *sc, struct urtwn_data data[], int ndata)
1287289066Skevlo{
1288289066Skevlo	int i;
1289289066Skevlo
1290289066Skevlo	for (i = 0; i < ndata; i++) {
1291289066Skevlo		struct urtwn_data *dp = &data[i];
1292289066Skevlo
1293289066Skevlo		if (dp->buf != NULL) {
1294289066Skevlo			free(dp->buf, M_USBDEV);
1295289066Skevlo			dp->buf = NULL;
1296289066Skevlo		}
1297289066Skevlo		if (dp->ni != NULL) {
1298289066Skevlo			ieee80211_free_node(dp->ni);
1299289066Skevlo			dp->ni = NULL;
1300289066Skevlo		}
1301289066Skevlo	}
1302289066Skevlo}
1303289066Skevlo
1304289066Skevlostatic void
1305289066Skevlourtwn_free_rx_list(struct urtwn_softc *sc)
1306289066Skevlo{
1307289066Skevlo	urtwn_free_list(sc, sc->sc_rx, URTWN_RX_LIST_COUNT);
1308289066Skevlo}
1309289066Skevlo
1310289066Skevlostatic void
1311289066Skevlourtwn_free_tx_list(struct urtwn_softc *sc)
1312289066Skevlo{
1313289066Skevlo	urtwn_free_list(sc, sc->sc_tx, URTWN_TX_LIST_COUNT);
1314289066Skevlo}
1315289066Skevlo
1316289066Skevlostatic void
1317251538Srpaulourtwn_bulk_tx_callback(struct usb_xfer *xfer, usb_error_t error)
1318251538Srpaulo{
1319251538Srpaulo	struct urtwn_softc *sc = usbd_xfer_softc(xfer);
1320297596Sadrian#ifdef	IEEE80211_SUPPORT_SUPERG
1321297596Sadrian	struct ieee80211com *ic = &sc->sc_ic;
1322297596Sadrian#endif
1323251538Srpaulo	struct urtwn_data *data;
1324251538Srpaulo
1325251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
1326251538Srpaulo
1327251538Srpaulo	switch (USB_GET_STATE(xfer)){
1328251538Srpaulo	case USB_ST_TRANSFERRED:
1329251538Srpaulo		data = STAILQ_FIRST(&sc->sc_tx_active);
1330251538Srpaulo		if (data == NULL)
1331251538Srpaulo			goto tr_setup;
1332251538Srpaulo		STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next);
1333289891Savos		urtwn_txeof(sc, data, 0);
1334251538Srpaulo		/* FALLTHROUGH */
1335251538Srpaulo	case USB_ST_SETUP:
1336251538Srpaulotr_setup:
1337251538Srpaulo		data = STAILQ_FIRST(&sc->sc_tx_pending);
1338251538Srpaulo		if (data == NULL) {
1339294471Savos			URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT,
1340294471Savos			    "%s: empty pending queue\n", __func__);
1341297596Sadrian			sc->sc_tx_n_active = 0;
1342288353Sadrian			goto finish;
1343251538Srpaulo		}
1344251538Srpaulo		STAILQ_REMOVE_HEAD(&sc->sc_tx_pending, next);
1345251538Srpaulo		STAILQ_INSERT_TAIL(&sc->sc_tx_active, data, next);
1346251538Srpaulo		usbd_xfer_set_frame_data(xfer, 0, data->buf, data->buflen);
1347251538Srpaulo		usbd_transfer_submit(xfer);
1348297596Sadrian		sc->sc_tx_n_active++;
1349251538Srpaulo		break;
1350251538Srpaulo	default:
1351251538Srpaulo		data = STAILQ_FIRST(&sc->sc_tx_active);
1352251538Srpaulo		if (data == NULL)
1353251538Srpaulo			goto tr_setup;
1354289891Savos		STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next);
1355289891Savos		urtwn_txeof(sc, data, 1);
1356251538Srpaulo		if (error != USB_ERR_CANCELLED) {
1357251538Srpaulo			usbd_xfer_set_stall(xfer);
1358251538Srpaulo			goto tr_setup;
1359251538Srpaulo		}
1360251538Srpaulo		break;
1361251538Srpaulo	}
1362288353Sadrianfinish:
1363297596Sadrian#ifdef	IEEE80211_SUPPORT_SUPERG
1364297596Sadrian	/*
1365297596Sadrian	 * If the TX active queue drops below a certain
1366297596Sadrian	 * threshold, ensure we age fast-frames out so they're
1367297596Sadrian	 * transmitted.
1368297596Sadrian	 */
1369297596Sadrian	if (sc->sc_tx_n_active <= 1) {
1370297596Sadrian		/* XXX ew - net80211 should defer this for us! */
1371297596Sadrian
1372297596Sadrian		/*
1373297596Sadrian		 * Note: this sc_tx_n_active currently tracks
1374297596Sadrian		 * the number of pending transmit submissions
1375297596Sadrian		 * and not the actual depth of the TX frames
1376297596Sadrian		 * pending to the hardware.  That means that
1377297596Sadrian		 * we're going to end up with some sub-optimal
1378297596Sadrian		 * aggregation behaviour.
1379297596Sadrian		 */
1380297596Sadrian		/*
1381297596Sadrian		 * XXX TODO: just make this a callout timer schedule so we can
1382297596Sadrian		 * flush the FF staging queue if we're approaching idle.
1383297596Sadrian		 */
1384297596Sadrian		URTWN_UNLOCK(sc);
1385297596Sadrian		ieee80211_ff_flush(ic, WME_AC_VO);
1386297596Sadrian		ieee80211_ff_flush(ic, WME_AC_VI);
1387297596Sadrian		ieee80211_ff_flush(ic, WME_AC_BE);
1388297596Sadrian		ieee80211_ff_flush(ic, WME_AC_BK);
1389297596Sadrian		URTWN_LOCK(sc);
1390297596Sadrian	}
1391297596Sadrian#endif
1392288353Sadrian	/* Kick-start more transmit */
1393288353Sadrian	urtwn_start(sc);
1394251538Srpaulo}
1395251538Srpaulo
1396251538Srpaulostatic struct urtwn_data *
1397251538Srpaulo_urtwn_getbuf(struct urtwn_softc *sc)
1398251538Srpaulo{
1399251538Srpaulo	struct urtwn_data *bf;
1400251538Srpaulo
1401251538Srpaulo	bf = STAILQ_FIRST(&sc->sc_tx_inactive);
1402251538Srpaulo	if (bf != NULL)
1403251538Srpaulo		STAILQ_REMOVE_HEAD(&sc->sc_tx_inactive, next);
1404294471Savos	else {
1405294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT,
1406294471Savos		    "%s: out of xmit buffers\n", __func__);
1407294471Savos	}
1408251538Srpaulo	return (bf);
1409251538Srpaulo}
1410251538Srpaulo
1411251538Srpaulostatic struct urtwn_data *
1412251538Srpaulourtwn_getbuf(struct urtwn_softc *sc)
1413251538Srpaulo{
1414251538Srpaulo        struct urtwn_data *bf;
1415251538Srpaulo
1416251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
1417251538Srpaulo
1418251538Srpaulo	bf = _urtwn_getbuf(sc);
1419294471Savos	if (bf == NULL) {
1420294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT, "%s: stop queue\n",
1421294471Savos		    __func__);
1422294471Savos	}
1423251538Srpaulo	return (bf);
1424251538Srpaulo}
1425251538Srpaulo
1426291698Savosstatic usb_error_t
1427251538Srpaulourtwn_write_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf,
1428251538Srpaulo    int len)
1429251538Srpaulo{
1430251538Srpaulo	usb_device_request_t req;
1431251538Srpaulo
1432251538Srpaulo	req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
1433251538Srpaulo	req.bRequest = R92C_REQ_REGS;
1434251538Srpaulo	USETW(req.wValue, addr);
1435251538Srpaulo	USETW(req.wIndex, 0);
1436251538Srpaulo	USETW(req.wLength, len);
1437251538Srpaulo	return (urtwn_do_request(sc, &req, buf));
1438251538Srpaulo}
1439251538Srpaulo
1440291698Savosstatic usb_error_t
1441251538Srpaulourtwn_write_1(struct urtwn_softc *sc, uint16_t addr, uint8_t val)
1442251538Srpaulo{
1443291698Savos	return (urtwn_write_region_1(sc, addr, &val, sizeof(val)));
1444251538Srpaulo}
1445251538Srpaulo
1446291698Savosstatic usb_error_t
1447251538Srpaulourtwn_write_2(struct urtwn_softc *sc, uint16_t addr, uint16_t val)
1448251538Srpaulo{
1449251538Srpaulo	val = htole16(val);
1450291698Savos	return (urtwn_write_region_1(sc, addr, (uint8_t *)&val, sizeof(val)));
1451251538Srpaulo}
1452251538Srpaulo
1453291698Savosstatic usb_error_t
1454251538Srpaulourtwn_write_4(struct urtwn_softc *sc, uint16_t addr, uint32_t val)
1455251538Srpaulo{
1456251538Srpaulo	val = htole32(val);
1457291698Savos	return (urtwn_write_region_1(sc, addr, (uint8_t *)&val, sizeof(val)));
1458251538Srpaulo}
1459251538Srpaulo
1460291698Savosstatic usb_error_t
1461251538Srpaulourtwn_read_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf,
1462251538Srpaulo    int len)
1463251538Srpaulo{
1464251538Srpaulo	usb_device_request_t req;
1465251538Srpaulo
1466251538Srpaulo	req.bmRequestType = UT_READ_VENDOR_DEVICE;
1467251538Srpaulo	req.bRequest = R92C_REQ_REGS;
1468251538Srpaulo	USETW(req.wValue, addr);
1469251538Srpaulo	USETW(req.wIndex, 0);
1470251538Srpaulo	USETW(req.wLength, len);
1471251538Srpaulo	return (urtwn_do_request(sc, &req, buf));
1472251538Srpaulo}
1473251538Srpaulo
1474251538Srpaulostatic uint8_t
1475251538Srpaulourtwn_read_1(struct urtwn_softc *sc, uint16_t addr)
1476251538Srpaulo{
1477251538Srpaulo	uint8_t val;
1478251538Srpaulo
1479251538Srpaulo	if (urtwn_read_region_1(sc, addr, &val, 1) != 0)
1480251538Srpaulo		return (0xff);
1481251538Srpaulo	return (val);
1482251538Srpaulo}
1483251538Srpaulo
1484251538Srpaulostatic uint16_t
1485251538Srpaulourtwn_read_2(struct urtwn_softc *sc, uint16_t addr)
1486251538Srpaulo{
1487251538Srpaulo	uint16_t val;
1488251538Srpaulo
1489251538Srpaulo	if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 2) != 0)
1490251538Srpaulo		return (0xffff);
1491251538Srpaulo	return (le16toh(val));
1492251538Srpaulo}
1493251538Srpaulo
1494251538Srpaulostatic uint32_t
1495251538Srpaulourtwn_read_4(struct urtwn_softc *sc, uint16_t addr)
1496251538Srpaulo{
1497251538Srpaulo	uint32_t val;
1498251538Srpaulo
1499251538Srpaulo	if (urtwn_read_region_1(sc, addr, (uint8_t *)&val, 4) != 0)
1500251538Srpaulo		return (0xffffffff);
1501251538Srpaulo	return (le32toh(val));
1502251538Srpaulo}
1503251538Srpaulo
1504251538Srpaulostatic int
1505251538Srpaulourtwn_fw_cmd(struct urtwn_softc *sc, uint8_t id, const void *buf, int len)
1506251538Srpaulo{
1507251538Srpaulo	struct r92c_fw_cmd cmd;
1508291698Savos	usb_error_t error;
1509251538Srpaulo	int ntries;
1510251538Srpaulo
1511295871Savos	if (!(sc->sc_flags & URTWN_FW_LOADED)) {
1512295871Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_FIRMWARE, "%s: firmware "
1513295871Savos		    "was not loaded; command (id %d) will be discarded\n",
1514295871Savos		    __func__, id);
1515295871Savos		return (0);
1516295871Savos	}
1517295871Savos
1518251538Srpaulo	/* Wait for current FW box to be empty. */
1519251538Srpaulo	for (ntries = 0; ntries < 100; ntries++) {
1520251538Srpaulo		if (!(urtwn_read_1(sc, R92C_HMETFR) & (1 << sc->fwcur)))
1521251538Srpaulo			break;
1522266472Shselasky		urtwn_ms_delay(sc);
1523251538Srpaulo	}
1524251538Srpaulo	if (ntries == 100) {
1525251538Srpaulo		device_printf(sc->sc_dev,
1526251538Srpaulo		    "could not send firmware command\n");
1527251538Srpaulo		return (ETIMEDOUT);
1528251538Srpaulo	}
1529251538Srpaulo	memset(&cmd, 0, sizeof(cmd));
1530251538Srpaulo	cmd.id = id;
1531251538Srpaulo	if (len > 3)
1532251538Srpaulo		cmd.id |= R92C_CMD_FLAG_EXT;
1533251538Srpaulo	KASSERT(len <= sizeof(cmd.msg), ("urtwn_fw_cmd\n"));
1534251538Srpaulo	memcpy(cmd.msg, buf, len);
1535251538Srpaulo
1536251538Srpaulo	/* Write the first word last since that will trigger the FW. */
1537291698Savos	error = urtwn_write_region_1(sc, R92C_HMEBOX_EXT(sc->fwcur),
1538251538Srpaulo	    (uint8_t *)&cmd + 4, 2);
1539291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
1540291698Savos		return (EIO);
1541291698Savos	error = urtwn_write_region_1(sc, R92C_HMEBOX(sc->fwcur),
1542251538Srpaulo	    (uint8_t *)&cmd + 0, 4);
1543291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
1544291698Savos		return (EIO);
1545251538Srpaulo
1546251538Srpaulo	sc->fwcur = (sc->fwcur + 1) % R92C_H2C_NBOX;
1547251538Srpaulo	return (0);
1548251538Srpaulo}
1549251538Srpaulo
1550292174Savosstatic void
1551292174Savosurtwn_cmdq_cb(void *arg, int pending)
1552292174Savos{
1553292174Savos	struct urtwn_softc *sc = arg;
1554292174Savos	struct urtwn_cmdq *item;
1555292174Savos
1556292174Savos	/*
1557292174Savos	 * Device must be powered on (via urtwn_power_on())
1558292174Savos	 * before any command may be sent.
1559292174Savos	 */
1560292174Savos	URTWN_LOCK(sc);
1561292174Savos	if (!(sc->sc_flags & URTWN_RUNNING)) {
1562292174Savos		URTWN_UNLOCK(sc);
1563292174Savos		return;
1564292174Savos	}
1565292174Savos
1566292174Savos	URTWN_CMDQ_LOCK(sc);
1567292174Savos	while (sc->cmdq[sc->cmdq_first].func != NULL) {
1568292174Savos		item = &sc->cmdq[sc->cmdq_first];
1569292174Savos		sc->cmdq_first = (sc->cmdq_first + 1) % URTWN_CMDQ_SIZE;
1570292174Savos		URTWN_CMDQ_UNLOCK(sc);
1571292174Savos
1572292174Savos		item->func(sc, &item->data);
1573292174Savos
1574292174Savos		URTWN_CMDQ_LOCK(sc);
1575292174Savos		memset(item, 0, sizeof (*item));
1576292174Savos	}
1577292174Savos	URTWN_CMDQ_UNLOCK(sc);
1578292174Savos	URTWN_UNLOCK(sc);
1579292174Savos}
1580292174Savos
1581292174Savosstatic int
1582292174Savosurtwn_cmd_sleepable(struct urtwn_softc *sc, const void *ptr, size_t len,
1583292174Savos    CMD_FUNC_PROTO)
1584292174Savos{
1585292174Savos	struct ieee80211com *ic = &sc->sc_ic;
1586292174Savos
1587292174Savos	KASSERT(len <= sizeof(union sec_param), ("buffer overflow"));
1588292174Savos
1589292174Savos	URTWN_CMDQ_LOCK(sc);
1590292174Savos	if (sc->cmdq[sc->cmdq_last].func != NULL) {
1591292174Savos		device_printf(sc->sc_dev, "%s: cmdq overflow\n", __func__);
1592292174Savos		URTWN_CMDQ_UNLOCK(sc);
1593292174Savos
1594292174Savos		return (EAGAIN);
1595292174Savos	}
1596292174Savos
1597292174Savos	if (ptr != NULL)
1598292174Savos		memcpy(&sc->cmdq[sc->cmdq_last].data, ptr, len);
1599292174Savos	sc->cmdq[sc->cmdq_last].func = func;
1600292174Savos	sc->cmdq_last = (sc->cmdq_last + 1) % URTWN_CMDQ_SIZE;
1601292174Savos	URTWN_CMDQ_UNLOCK(sc);
1602292174Savos
1603292174Savos	ieee80211_runtask(ic, &sc->cmdq_task);
1604292174Savos
1605292174Savos	return (0);
1606292174Savos}
1607292174Savos
1608264912Skevlostatic __inline void
1609251538Srpaulourtwn_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, uint32_t val)
1610251538Srpaulo{
1611264912Skevlo
1612264912Skevlo	sc->sc_rf_write(sc, chain, addr, val);
1613264912Skevlo}
1614264912Skevlo
1615264912Skevlostatic void
1616264912Skevlourtwn_r92c_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr,
1617264912Skevlo    uint32_t val)
1618264912Skevlo{
1619251538Srpaulo	urtwn_bb_write(sc, R92C_LSSI_PARAM(chain),
1620251538Srpaulo	    SM(R92C_LSSI_PARAM_ADDR, addr) |
1621251538Srpaulo	    SM(R92C_LSSI_PARAM_DATA, val));
1622251538Srpaulo}
1623251538Srpaulo
1624264912Skevlostatic void
1625264912Skevlourtwn_r88e_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr,
1626264912Skevlouint32_t val)
1627264912Skevlo{
1628264912Skevlo	urtwn_bb_write(sc, R92C_LSSI_PARAM(chain),
1629264912Skevlo	    SM(R88E_LSSI_PARAM_ADDR, addr) |
1630264912Skevlo	    SM(R92C_LSSI_PARAM_DATA, val));
1631264912Skevlo}
1632264912Skevlo
1633251538Srpaulostatic uint32_t
1634251538Srpaulourtwn_rf_read(struct urtwn_softc *sc, int chain, uint8_t addr)
1635251538Srpaulo{
1636251538Srpaulo	uint32_t reg[R92C_MAX_CHAINS], val;
1637251538Srpaulo
1638251538Srpaulo	reg[0] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(0));
1639251538Srpaulo	if (chain != 0)
1640251538Srpaulo		reg[chain] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(chain));
1641251538Srpaulo
1642251538Srpaulo	urtwn_bb_write(sc, R92C_HSSI_PARAM2(0),
1643251538Srpaulo	    reg[0] & ~R92C_HSSI_PARAM2_READ_EDGE);
1644266472Shselasky	urtwn_ms_delay(sc);
1645251538Srpaulo
1646251538Srpaulo	urtwn_bb_write(sc, R92C_HSSI_PARAM2(chain),
1647251538Srpaulo	    RW(reg[chain], R92C_HSSI_PARAM2_READ_ADDR, addr) |
1648251538Srpaulo	    R92C_HSSI_PARAM2_READ_EDGE);
1649266472Shselasky	urtwn_ms_delay(sc);
1650251538Srpaulo
1651251538Srpaulo	urtwn_bb_write(sc, R92C_HSSI_PARAM2(0),
1652251538Srpaulo	    reg[0] | R92C_HSSI_PARAM2_READ_EDGE);
1653266472Shselasky	urtwn_ms_delay(sc);
1654251538Srpaulo
1655251538Srpaulo	if (urtwn_bb_read(sc, R92C_HSSI_PARAM1(chain)) & R92C_HSSI_PARAM1_PI)
1656251538Srpaulo		val = urtwn_bb_read(sc, R92C_HSPI_READBACK(chain));
1657251538Srpaulo	else
1658251538Srpaulo		val = urtwn_bb_read(sc, R92C_LSSI_READBACK(chain));
1659251538Srpaulo	return (MS(val, R92C_LSSI_READBACK_DATA));
1660251538Srpaulo}
1661251538Srpaulo
1662251538Srpaulostatic int
1663251538Srpaulourtwn_llt_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data)
1664251538Srpaulo{
1665291698Savos	usb_error_t error;
1666251538Srpaulo	int ntries;
1667251538Srpaulo
1668291698Savos	error = urtwn_write_4(sc, R92C_LLT_INIT,
1669251538Srpaulo	    SM(R92C_LLT_INIT_OP, R92C_LLT_INIT_OP_WRITE) |
1670251538Srpaulo	    SM(R92C_LLT_INIT_ADDR, addr) |
1671251538Srpaulo	    SM(R92C_LLT_INIT_DATA, data));
1672291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
1673291698Savos		return (EIO);
1674251538Srpaulo	/* Wait for write operation to complete. */
1675251538Srpaulo	for (ntries = 0; ntries < 20; ntries++) {
1676251538Srpaulo		if (MS(urtwn_read_4(sc, R92C_LLT_INIT), R92C_LLT_INIT_OP) ==
1677251538Srpaulo		    R92C_LLT_INIT_OP_NO_ACTIVE)
1678251538Srpaulo			return (0);
1679266472Shselasky		urtwn_ms_delay(sc);
1680251538Srpaulo	}
1681251538Srpaulo	return (ETIMEDOUT);
1682251538Srpaulo}
1683251538Srpaulo
1684291264Savosstatic int
1685291264Savosurtwn_efuse_read_next(struct urtwn_softc *sc, uint8_t *val)
1686251538Srpaulo{
1687251538Srpaulo	uint32_t reg;
1688291698Savos	usb_error_t error;
1689251538Srpaulo	int ntries;
1690251538Srpaulo
1691291264Savos	if (sc->last_rom_addr >= URTWN_EFUSE_MAX_LEN)
1692291264Savos		return (EFAULT);
1693291264Savos
1694251538Srpaulo	reg = urtwn_read_4(sc, R92C_EFUSE_CTRL);
1695291264Savos	reg = RW(reg, R92C_EFUSE_CTRL_ADDR, sc->last_rom_addr);
1696251538Srpaulo	reg &= ~R92C_EFUSE_CTRL_VALID;
1697291264Savos
1698291698Savos	error = urtwn_write_4(sc, R92C_EFUSE_CTRL, reg);
1699291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
1700291698Savos		return (EIO);
1701251538Srpaulo	/* Wait for read operation to complete. */
1702251538Srpaulo	for (ntries = 0; ntries < 100; ntries++) {
1703251538Srpaulo		reg = urtwn_read_4(sc, R92C_EFUSE_CTRL);
1704251538Srpaulo		if (reg & R92C_EFUSE_CTRL_VALID)
1705291264Savos			break;
1706266472Shselasky		urtwn_ms_delay(sc);
1707251538Srpaulo	}
1708291264Savos	if (ntries == 100) {
1709291264Savos		device_printf(sc->sc_dev,
1710291264Savos		    "could not read efuse byte at address 0x%x\n",
1711291264Savos		    sc->last_rom_addr);
1712291264Savos		return (ETIMEDOUT);
1713291264Savos	}
1714291264Savos
1715291264Savos	*val = MS(reg, R92C_EFUSE_CTRL_DATA);
1716291264Savos	sc->last_rom_addr++;
1717291264Savos
1718291264Savos	return (0);
1719251538Srpaulo}
1720251538Srpaulo
1721291264Savosstatic int
1722291264Savosurtwn_efuse_read_data(struct urtwn_softc *sc, uint8_t *rom, uint8_t off,
1723291264Savos    uint8_t msk)
1724291264Savos{
1725291264Savos	uint8_t reg;
1726291264Savos	int i, error;
1727291264Savos
1728291264Savos	for (i = 0; i < 4; i++) {
1729291264Savos		if (msk & (1 << i))
1730291264Savos			continue;
1731291264Savos		error = urtwn_efuse_read_next(sc, &reg);
1732291264Savos		if (error != 0)
1733291264Savos			return (error);
1734294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "rom[0x%03X] == 0x%02X\n",
1735294471Savos		    off * 8 + i * 2, reg);
1736291264Savos		rom[off * 8 + i * 2 + 0] = reg;
1737291264Savos
1738291264Savos		error = urtwn_efuse_read_next(sc, &reg);
1739291264Savos		if (error != 0)
1740291264Savos			return (error);
1741294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "rom[0x%03X] == 0x%02X\n",
1742294471Savos		    off * 8 + i * 2 + 1, reg);
1743291264Savos		rom[off * 8 + i * 2 + 1] = reg;
1744291264Savos	}
1745291264Savos
1746291264Savos	return (0);
1747291264Savos}
1748291264Savos
1749294471Savos#ifdef USB_DEBUG
1750251538Srpaulostatic void
1751291264Savosurtwn_dump_rom_contents(struct urtwn_softc *sc, uint8_t *rom, uint16_t size)
1752251538Srpaulo{
1753251538Srpaulo	int i;
1754251538Srpaulo
1755291264Savos	/* Dump ROM contents. */
1756291264Savos	device_printf(sc->sc_dev, "%s:", __func__);
1757291264Savos	for (i = 0; i < size; i++) {
1758291264Savos		if (i % 32 == 0)
1759291264Savos			printf("\n%03X: ", i);
1760291264Savos		else if (i % 4 == 0)
1761291264Savos			printf(" ");
1762291264Savos
1763291264Savos		printf("%02X", rom[i]);
1764291264Savos	}
1765291264Savos	printf("\n");
1766291264Savos}
1767291264Savos#endif
1768291264Savos
1769291264Savosstatic int
1770291264Savosurtwn_efuse_read(struct urtwn_softc *sc, uint8_t *rom, uint16_t size)
1771291264Savos{
1772291264Savos#define URTWN_CHK(res) do {	\
1773291264Savos	if ((error = res) != 0)	\
1774291264Savos		goto end;	\
1775291264Savos} while(0)
1776291264Savos	uint8_t msk, off, reg;
1777291264Savos	int error;
1778291264Savos
1779291698Savos	URTWN_CHK(urtwn_efuse_switch_power(sc));
1780264912Skevlo
1781291264Savos	/* Read full ROM image. */
1782291264Savos	sc->last_rom_addr = 0;
1783291264Savos	memset(rom, 0xff, size);
1784291264Savos
1785291264Savos	URTWN_CHK(urtwn_efuse_read_next(sc, &reg));
1786291264Savos	while (reg != 0xff) {
1787291264Savos		/* check for extended header */
1788291264Savos		if ((sc->chip & URTWN_CHIP_88E) && (reg & 0x1f) == 0x0f) {
1789291264Savos			off = reg >> 5;
1790291264Savos			URTWN_CHK(urtwn_efuse_read_next(sc, &reg));
1791291264Savos
1792291264Savos			if ((reg & 0x0f) != 0x0f)
1793291264Savos				off = ((reg & 0xf0) >> 1) | off;
1794291264Savos			else
1795291264Savos				continue;
1796291264Savos		} else
1797291264Savos			off = reg >> 4;
1798251538Srpaulo		msk = reg & 0xf;
1799291264Savos
1800291264Savos		URTWN_CHK(urtwn_efuse_read_data(sc, rom, off, msk));
1801291264Savos		URTWN_CHK(urtwn_efuse_read_next(sc, &reg));
1802251538Srpaulo	}
1803291264Savos
1804291264Savosend:
1805291264Savos
1806294471Savos#ifdef USB_DEBUG
1807294471Savos	if (sc->sc_debug & URTWN_DEBUG_ROM)
1808291264Savos		urtwn_dump_rom_contents(sc, rom, size);
1809251538Srpaulo#endif
1810291264Savos
1811282623Skevlo	urtwn_write_1(sc, R92C_EFUSE_ACCESS, R92C_EFUSE_ACCESS_OFF);
1812291264Savos
1813291264Savos	if (error != 0) {
1814291264Savos		device_printf(sc->sc_dev, "%s: error while reading ROM\n",
1815291264Savos		    __func__);
1816291264Savos	}
1817291264Savos
1818291264Savos	return (error);
1819291264Savos#undef URTWN_CHK
1820282623Skevlo}
1821281592Skevlo
1822291698Savosstatic int
1823264912Skevlourtwn_efuse_switch_power(struct urtwn_softc *sc)
1824264912Skevlo{
1825291698Savos	usb_error_t error;
1826264912Skevlo	uint32_t reg;
1827251538Srpaulo
1828291698Savos	error = urtwn_write_1(sc, R92C_EFUSE_ACCESS, R92C_EFUSE_ACCESS_ON);
1829291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
1830291698Savos		return (EIO);
1831281918Skevlo
1832264912Skevlo	reg = urtwn_read_2(sc, R92C_SYS_ISO_CTRL);
1833264912Skevlo	if (!(reg & R92C_SYS_ISO_CTRL_PWC_EV12V)) {
1834291698Savos		error = urtwn_write_2(sc, R92C_SYS_ISO_CTRL,
1835264912Skevlo		    reg | R92C_SYS_ISO_CTRL_PWC_EV12V);
1836291698Savos		if (error != USB_ERR_NORMAL_COMPLETION)
1837291698Savos			return (EIO);
1838264912Skevlo	}
1839264912Skevlo	reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
1840264912Skevlo	if (!(reg & R92C_SYS_FUNC_EN_ELDR)) {
1841291698Savos		error = urtwn_write_2(sc, R92C_SYS_FUNC_EN,
1842264912Skevlo		    reg | R92C_SYS_FUNC_EN_ELDR);
1843291698Savos		if (error != USB_ERR_NORMAL_COMPLETION)
1844291698Savos			return (EIO);
1845264912Skevlo	}
1846264912Skevlo	reg = urtwn_read_2(sc, R92C_SYS_CLKR);
1847264912Skevlo	if ((reg & (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) !=
1848264912Skevlo	    (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) {
1849291698Savos		error = urtwn_write_2(sc, R92C_SYS_CLKR,
1850264912Skevlo		    reg | R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M);
1851291698Savos		if (error != USB_ERR_NORMAL_COMPLETION)
1852291698Savos			return (EIO);
1853264912Skevlo	}
1854291698Savos
1855291698Savos	return (0);
1856264912Skevlo}
1857264912Skevlo
1858251538Srpaulostatic int
1859251538Srpaulourtwn_read_chipid(struct urtwn_softc *sc)
1860251538Srpaulo{
1861251538Srpaulo	uint32_t reg;
1862251538Srpaulo
1863264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
1864264912Skevlo		return (0);
1865264912Skevlo
1866251538Srpaulo	reg = urtwn_read_4(sc, R92C_SYS_CFG);
1867251538Srpaulo	if (reg & R92C_SYS_CFG_TRP_VAUX_EN)
1868251538Srpaulo		return (EIO);
1869251538Srpaulo
1870251538Srpaulo	if (reg & R92C_SYS_CFG_TYPE_92C) {
1871251538Srpaulo		sc->chip |= URTWN_CHIP_92C;
1872251538Srpaulo		/* Check if it is a castrated 8192C. */
1873251538Srpaulo		if (MS(urtwn_read_4(sc, R92C_HPON_FSM),
1874251538Srpaulo		    R92C_HPON_FSM_CHIP_BONDING_ID) ==
1875251538Srpaulo		    R92C_HPON_FSM_CHIP_BONDING_ID_92C_1T2R)
1876251538Srpaulo			sc->chip |= URTWN_CHIP_92C_1T2R;
1877251538Srpaulo	}
1878251538Srpaulo	if (reg & R92C_SYS_CFG_VENDOR_UMC) {
1879251538Srpaulo		sc->chip |= URTWN_CHIP_UMC;
1880251538Srpaulo		if (MS(reg, R92C_SYS_CFG_CHIP_VER_RTL) == 0)
1881251538Srpaulo			sc->chip |= URTWN_CHIP_UMC_A_CUT;
1882251538Srpaulo	}
1883251538Srpaulo	return (0);
1884251538Srpaulo}
1885251538Srpaulo
1886291264Savosstatic int
1887251538Srpaulourtwn_read_rom(struct urtwn_softc *sc)
1888251538Srpaulo{
1889291264Savos	struct r92c_rom *rom = &sc->rom.r92c_rom;
1890291264Savos	int error;
1891251538Srpaulo
1892251538Srpaulo	/* Read full ROM image. */
1893291264Savos	error = urtwn_efuse_read(sc, (uint8_t *)rom, sizeof(*rom));
1894291264Savos	if (error != 0)
1895291264Savos		return (error);
1896251538Srpaulo
1897251538Srpaulo	/* XXX Weird but this is what the vendor driver does. */
1898291264Savos	sc->last_rom_addr = 0x1fa;
1899291264Savos	error = urtwn_efuse_read_next(sc, &sc->pa_setting);
1900291264Savos	if (error != 0)
1901291264Savos		return (error);
1902294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "%s: PA setting=0x%x\n", __func__,
1903294471Savos	    sc->pa_setting);
1904251538Srpaulo
1905251538Srpaulo	sc->board_type = MS(rom->rf_opt1, R92C_ROM_RF1_BOARD_TYPE);
1906251538Srpaulo
1907251538Srpaulo	sc->regulatory = MS(rom->rf_opt1, R92C_ROM_RF1_REGULATORY);
1908294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "%s: regulatory type=%d\n",
1909294471Savos	    __func__, sc->regulatory);
1910287197Sglebius	IEEE80211_ADDR_COPY(sc->sc_ic.ic_macaddr, rom->macaddr);
1911251538Srpaulo
1912264912Skevlo	sc->sc_rf_write = urtwn_r92c_rf_write;
1913264912Skevlo	sc->sc_power_on = urtwn_r92c_power_on;
1914295874Savos	sc->sc_power_off = urtwn_r92c_power_off;
1915291264Savos
1916291264Savos	return (0);
1917251538Srpaulo}
1918251538Srpaulo
1919291264Savosstatic int
1920264912Skevlourtwn_r88e_read_rom(struct urtwn_softc *sc)
1921264912Skevlo{
1922294198Savos	struct r88e_rom *rom = &sc->rom.r88e_rom;
1923294198Savos	int error;
1924264912Skevlo
1925294198Savos	error = urtwn_efuse_read(sc, (uint8_t *)rom, sizeof(sc->rom.r88e_rom));
1926291264Savos	if (error != 0)
1927291264Savos		return (error);
1928264912Skevlo
1929294198Savos	sc->bw20_tx_pwr_diff = (rom->tx_pwr_diff >> 4);
1930264912Skevlo	if (sc->bw20_tx_pwr_diff & 0x08)
1931264912Skevlo		sc->bw20_tx_pwr_diff |= 0xf0;
1932294198Savos	sc->ofdm_tx_pwr_diff = (rom->tx_pwr_diff & 0xf);
1933264912Skevlo	if (sc->ofdm_tx_pwr_diff & 0x08)
1934264912Skevlo		sc->ofdm_tx_pwr_diff |= 0xf0;
1935294198Savos	sc->regulatory = MS(rom->rf_board_opt, R92C_ROM_RF1_REGULATORY);
1936294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_ROM, "%s: regulatory type %d\n",
1937294471Savos	    __func__,sc->regulatory);
1938294198Savos	IEEE80211_ADDR_COPY(sc->sc_ic.ic_macaddr, rom->macaddr);
1939264912Skevlo
1940264912Skevlo	sc->sc_rf_write = urtwn_r88e_rf_write;
1941264912Skevlo	sc->sc_power_on = urtwn_r88e_power_on;
1942295874Savos	sc->sc_power_off = urtwn_r88e_power_off;
1943291264Savos
1944291264Savos	return (0);
1945264912Skevlo}
1946264912Skevlo
1947298436Savosstatic __inline uint8_t
1948298436Savosrate2ridx(uint8_t rate)
1949298436Savos{
1950298436Savos	if (rate & IEEE80211_RATE_MCS) {
1951298436Savos		/* 11n rates start at idx 12 */
1952298436Savos		return ((rate & 0xf) + 12);
1953298436Savos	}
1954298436Savos	switch (rate) {
1955298436Savos	/* 11g */
1956298436Savos	case 12:	return 4;
1957298436Savos	case 18:	return 5;
1958298436Savos	case 24:	return 6;
1959298436Savos	case 36:	return 7;
1960298436Savos	case 48:	return 8;
1961298436Savos	case 72:	return 9;
1962298436Savos	case 96:	return 10;
1963298436Savos	case 108:	return 11;
1964298436Savos	/* 11b */
1965298436Savos	case 2:		return 0;
1966298436Savos	case 4:		return 1;
1967298436Savos	case 11:	return 2;
1968298436Savos	case 22:	return 3;
1969298436Savos	default:	return URTWN_RIDX_UNKNOWN;
1970298436Savos	}
1971298436Savos}
1972298436Savos
1973251538Srpaulo/*
1974251538Srpaulo * Initialize rate adaptation in firmware.
1975251538Srpaulo */
1976251538Srpaulostatic int
1977251538Srpaulourtwn_ra_init(struct urtwn_softc *sc)
1978251538Srpaulo{
1979287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
1980251538Srpaulo	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
1981251538Srpaulo	struct ieee80211_node *ni;
1982297175Sadrian	struct ieee80211_rateset *rs, *rs_ht;
1983251538Srpaulo	struct r92c_fw_cmd_macid_cfg cmd;
1984251538Srpaulo	uint32_t rates, basicrates;
1985298436Savos	uint8_t mode, ridx;
1986298436Savos	int maxrate, maxbasicrate, error, i;
1987251538Srpaulo
1988251538Srpaulo	ni = ieee80211_ref_node(vap->iv_bss);
1989251538Srpaulo	rs = &ni->ni_rates;
1990297175Sadrian	rs_ht = (struct ieee80211_rateset *) &ni->ni_htrates;
1991251538Srpaulo
1992251538Srpaulo	/* Get normal and basic rates mask. */
1993251538Srpaulo	rates = basicrates = 0;
1994251538Srpaulo	maxrate = maxbasicrate = 0;
1995297175Sadrian
1996297175Sadrian	/* This is for 11bg */
1997251538Srpaulo	for (i = 0; i < rs->rs_nrates; i++) {
1998251538Srpaulo		/* Convert 802.11 rate to HW rate index. */
1999298436Savos		ridx = rate2ridx(IEEE80211_RV(rs->rs_rates[i]));
2000298436Savos		if (ridx == URTWN_RIDX_UNKNOWN)	/* Unknown rate, skip. */
2001251538Srpaulo			continue;
2002298436Savos		rates |= 1 << ridx;
2003298436Savos		if (ridx > maxrate)
2004298436Savos			maxrate = ridx;
2005251538Srpaulo		if (rs->rs_rates[i] & IEEE80211_RATE_BASIC) {
2006298436Savos			basicrates |= 1 << ridx;
2007298436Savos			if (ridx > maxbasicrate)
2008298436Savos				maxbasicrate = ridx;
2009251538Srpaulo		}
2010251538Srpaulo	}
2011297175Sadrian
2012297175Sadrian	/* If we're doing 11n, enable 11n rates */
2013297175Sadrian	if (ni->ni_flags & IEEE80211_NODE_HT) {
2014297175Sadrian		for (i = 0; i < rs_ht->rs_nrates; i++) {
2015297175Sadrian			if ((rs_ht->rs_rates[i] & 0x7f) > 0xf)
2016297175Sadrian				continue;
2017297175Sadrian			/* 11n rates start at index 12 */
2018298436Savos			ridx = ((rs_ht->rs_rates[i]) & 0xf) + 12;
2019298436Savos			rates |= (1 << ridx);
2020297175Sadrian
2021297175Sadrian			/* Guard against the rate table being oddly ordered */
2022298436Savos			if (ridx > maxrate)
2023298436Savos				maxrate = ridx;
2024297175Sadrian		}
2025297175Sadrian	}
2026297175Sadrian
2027297175Sadrian#if 0
2028297175Sadrian	if (ic->ic_curmode == IEEE80211_MODE_11NG)
2029297175Sadrian		raid = R92C_RAID_11GN;
2030297175Sadrian#endif
2031297175Sadrian	/* NB: group addressed frames are done at 11bg rates for now */
2032251538Srpaulo	if (ic->ic_curmode == IEEE80211_MODE_11B)
2033251538Srpaulo		mode = R92C_RAID_11B;
2034251538Srpaulo	else
2035251538Srpaulo		mode = R92C_RAID_11BG;
2036297175Sadrian	/* XXX misleading 'mode' value here for unicast frames */
2037294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_RA,
2038294471Savos	    "%s: mode 0x%x, rates 0x%08x, basicrates 0x%08x\n", __func__,
2039251538Srpaulo	    mode, rates, basicrates);
2040251538Srpaulo
2041251538Srpaulo	/* Set rates mask for group addressed frames. */
2042251538Srpaulo	cmd.macid = URTWN_MACID_BC | URTWN_MACID_VALID;
2043251538Srpaulo	cmd.mask = htole32(mode << 28 | basicrates);
2044251538Srpaulo	error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd));
2045251538Srpaulo	if (error != 0) {
2046252401Srpaulo		ieee80211_free_node(ni);
2047251538Srpaulo		device_printf(sc->sc_dev,
2048251538Srpaulo		    "could not add broadcast station\n");
2049251538Srpaulo		return (error);
2050251538Srpaulo	}
2051297175Sadrian
2052251538Srpaulo	/* Set initial MRR rate. */
2053294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_RA, "%s: maxbasicrate %d\n", __func__,
2054294471Savos	    maxbasicrate);
2055251538Srpaulo	urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BC),
2056251538Srpaulo	    maxbasicrate);
2057251538Srpaulo
2058251538Srpaulo	/* Set rates mask for unicast frames. */
2059297175Sadrian	if (ni->ni_flags & IEEE80211_NODE_HT)
2060297175Sadrian		mode = R92C_RAID_11GN;
2061297175Sadrian	else if (ic->ic_curmode == IEEE80211_MODE_11B)
2062297175Sadrian		mode = R92C_RAID_11B;
2063297175Sadrian	else
2064297175Sadrian		mode = R92C_RAID_11BG;
2065251538Srpaulo	cmd.macid = URTWN_MACID_BSS | URTWN_MACID_VALID;
2066251538Srpaulo	cmd.mask = htole32(mode << 28 | rates);
2067251538Srpaulo	error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd));
2068251538Srpaulo	if (error != 0) {
2069252401Srpaulo		ieee80211_free_node(ni);
2070251538Srpaulo		device_printf(sc->sc_dev, "could not add BSS station\n");
2071251538Srpaulo		return (error);
2072251538Srpaulo	}
2073251538Srpaulo	/* Set initial MRR rate. */
2074294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_RA, "%s: maxrate %d\n", __func__,
2075294471Savos	    maxrate);
2076251538Srpaulo	urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BSS),
2077251538Srpaulo	    maxrate);
2078251538Srpaulo
2079251538Srpaulo	/* Indicate highest supported rate. */
2080297175Sadrian	if (ni->ni_flags & IEEE80211_NODE_HT)
2081297175Sadrian		ni->ni_txrate = rs_ht->rs_rates[rs_ht->rs_nrates - 1]
2082297175Sadrian		    | IEEE80211_RATE_MCS;
2083297175Sadrian	else
2084297175Sadrian		ni->ni_txrate = rs->rs_rates[rs->rs_nrates - 1];
2085252401Srpaulo	ieee80211_free_node(ni);
2086252401Srpaulo
2087251538Srpaulo	return (0);
2088251538Srpaulo}
2089251538Srpaulo
2090290439Savosstatic void
2091290631Savosurtwn_init_beacon(struct urtwn_softc *sc, struct urtwn_vap *uvp)
2092251538Srpaulo{
2093290631Savos	struct r92c_tx_desc *txd = &uvp->bcn_desc;
2094290631Savos
2095290631Savos	txd->txdw0 = htole32(
2096290631Savos	    SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | R92C_TXDW0_BMCAST |
2097290631Savos	    R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG);
2098290631Savos	txd->txdw1 = htole32(
2099290631Savos	    SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_BEACON) |
2100290631Savos	    SM(R92C_TXDW1_RAID, R92C_RAID_11B));
2101290631Savos
2102291858Savos	if (sc->chip & URTWN_CHIP_88E) {
2103290631Savos		txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, URTWN_MACID_BC));
2104291858Savos		txd->txdseq |= htole16(R88E_TXDSEQ_HWSEQ_EN);
2105291858Savos	} else {
2106290631Savos		txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, URTWN_MACID_BC));
2107291858Savos		txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN);
2108291858Savos	}
2109290631Savos
2110290631Savos	txd->txdw4 = htole32(R92C_TXDW4_DRVRATE);
2111290631Savos	txd->txdw5 = htole32(SM(R92C_TXDW5_DATARATE, URTWN_RIDX_CCK1));
2112251538Srpaulo}
2113251538Srpaulo
2114290631Savosstatic int
2115290631Savosurtwn_setup_beacon(struct urtwn_softc *sc, struct ieee80211_node *ni)
2116290631Savos{
2117290631Savos 	struct ieee80211vap *vap = ni->ni_vap;
2118290631Savos	struct urtwn_vap *uvp = URTWN_VAP(vap);
2119290631Savos	struct mbuf *m;
2120290631Savos	int error;
2121290631Savos
2122290631Savos	URTWN_ASSERT_LOCKED(sc);
2123290631Savos
2124290631Savos	if (ni->ni_chan == IEEE80211_CHAN_ANYC)
2125290631Savos		return (EINVAL);
2126290631Savos
2127290631Savos	m = ieee80211_beacon_alloc(ni);
2128290631Savos	if (m == NULL) {
2129290631Savos		device_printf(sc->sc_dev,
2130290631Savos		    "%s: could not allocate beacon frame\n", __func__);
2131290631Savos		return (ENOMEM);
2132290631Savos	}
2133290631Savos
2134290631Savos	if (uvp->bcn_mbuf != NULL)
2135290631Savos		m_freem(uvp->bcn_mbuf);
2136290631Savos
2137290631Savos	uvp->bcn_mbuf = m;
2138290631Savos
2139290631Savos	if ((error = urtwn_tx_beacon(sc, uvp)) != 0)
2140290631Savos		return (error);
2141290631Savos
2142290631Savos	/* XXX bcnq stuck workaround */
2143290631Savos	if ((error = urtwn_tx_beacon(sc, uvp)) != 0)
2144290631Savos		return (error);
2145290631Savos
2146294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_BEACON, "%s: beacon was %srecognized\n",
2147294471Savos	    __func__, urtwn_read_1(sc, R92C_TDECTRL + 2) &
2148294471Savos	    (R92C_TDECTRL_BCN_VALID >> 16) ? "" : "not ");
2149294471Savos
2150290631Savos	return (0);
2151290631Savos}
2152290631Savos
2153251538Srpaulostatic void
2154290631Savosurtwn_update_beacon(struct ieee80211vap *vap, int item)
2155290631Savos{
2156290631Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2157290631Savos	struct urtwn_vap *uvp = URTWN_VAP(vap);
2158290631Savos	struct ieee80211_beacon_offsets *bo = &vap->iv_bcn_off;
2159290631Savos	struct ieee80211_node *ni = vap->iv_bss;
2160290631Savos	int mcast = 0;
2161290631Savos
2162290631Savos	URTWN_LOCK(sc);
2163290631Savos	if (uvp->bcn_mbuf == NULL) {
2164290631Savos		uvp->bcn_mbuf = ieee80211_beacon_alloc(ni);
2165290631Savos		if (uvp->bcn_mbuf == NULL) {
2166290631Savos			device_printf(sc->sc_dev,
2167290631Savos			    "%s: could not allocate beacon frame\n", __func__);
2168290631Savos			URTWN_UNLOCK(sc);
2169290631Savos			return;
2170290631Savos		}
2171290631Savos	}
2172290631Savos	URTWN_UNLOCK(sc);
2173290631Savos
2174290631Savos	if (item == IEEE80211_BEACON_TIM)
2175290631Savos		mcast = 1;	/* XXX */
2176290631Savos
2177290631Savos	setbit(bo->bo_flags, item);
2178290631Savos	ieee80211_beacon_update(ni, uvp->bcn_mbuf, mcast);
2179290631Savos
2180290631Savos	URTWN_LOCK(sc);
2181290631Savos	urtwn_tx_beacon(sc, uvp);
2182290631Savos	URTWN_UNLOCK(sc);
2183290631Savos}
2184290631Savos
2185290631Savos/*
2186290631Savos * Push a beacon frame into the chip. Beacon will
2187290631Savos * be repeated by the chip every R92C_BCN_INTERVAL.
2188290631Savos */
2189290631Savosstatic int
2190290631Savosurtwn_tx_beacon(struct urtwn_softc *sc, struct urtwn_vap *uvp)
2191290631Savos{
2192290631Savos	struct r92c_tx_desc *desc = &uvp->bcn_desc;
2193290631Savos	struct urtwn_data *bf;
2194290631Savos
2195290631Savos	URTWN_ASSERT_LOCKED(sc);
2196290631Savos
2197290631Savos	bf = urtwn_getbuf(sc);
2198290631Savos	if (bf == NULL)
2199290631Savos		return (ENOMEM);
2200290631Savos
2201290631Savos	memcpy(bf->buf, desc, sizeof(*desc));
2202290631Savos	urtwn_tx_start(sc, uvp->bcn_mbuf, IEEE80211_FC0_TYPE_MGT, bf);
2203290631Savos
2204290631Savos	sc->sc_txtimer = 5;
2205290631Savos	callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
2206290631Savos
2207290631Savos	return (0);
2208290631Savos}
2209290631Savos
2210292175Savosstatic int
2211292175Savosurtwn_key_alloc(struct ieee80211vap *vap, struct ieee80211_key *k,
2212292175Savos    ieee80211_keyix *keyix, ieee80211_keyix *rxkeyix)
2213292175Savos{
2214292175Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2215292175Savos	uint8_t i;
2216292175Savos
2217292175Savos	if (!(&vap->iv_nw_keys[0] <= k &&
2218292175Savos	     k < &vap->iv_nw_keys[IEEE80211_WEP_NKID])) {
2219292175Savos		if (!(k->wk_flags & IEEE80211_KEY_SWCRYPT)) {
2220292175Savos			URTWN_LOCK(sc);
2221292175Savos			/*
2222292175Savos			 * First 4 slots for group keys,
2223292175Savos			 * what is left - for pairwise.
2224292175Savos			 * XXX incompatible with IBSS RSN.
2225292175Savos			 */
2226292175Savos			for (i = IEEE80211_WEP_NKID;
2227292175Savos			     i < R92C_CAM_ENTRY_COUNT; i++) {
2228292175Savos				if ((sc->keys_bmap & (1 << i)) == 0) {
2229292175Savos					sc->keys_bmap |= 1 << i;
2230292175Savos					*keyix = i;
2231292175Savos					break;
2232292175Savos				}
2233292175Savos			}
2234292175Savos			URTWN_UNLOCK(sc);
2235292175Savos			if (i == R92C_CAM_ENTRY_COUNT) {
2236292175Savos				device_printf(sc->sc_dev,
2237292175Savos				    "%s: no free space in the key table\n",
2238292175Savos				    __func__);
2239292175Savos				return 0;
2240292175Savos			}
2241292175Savos		} else
2242292175Savos			*keyix = 0;
2243292175Savos	} else {
2244292175Savos		*keyix = k - vap->iv_nw_keys;
2245292175Savos	}
2246292175Savos	*rxkeyix = *keyix;
2247292175Savos	return 1;
2248292175Savos}
2249292175Savos
2250290631Savosstatic void
2251292175Savosurtwn_key_set_cb(struct urtwn_softc *sc, union sec_param *data)
2252292175Savos{
2253292175Savos	struct ieee80211_key *k = &data->key;
2254292175Savos	uint8_t algo, keyid;
2255292175Savos	int i, error;
2256292175Savos
2257292175Savos	if (k->wk_keyix < IEEE80211_WEP_NKID)
2258292175Savos		keyid = k->wk_keyix;
2259292175Savos	else
2260292175Savos		keyid = 0;
2261292175Savos
2262292175Savos	/* Map net80211 cipher to HW crypto algorithm. */
2263292175Savos	switch (k->wk_cipher->ic_cipher) {
2264292175Savos	case IEEE80211_CIPHER_WEP:
2265292175Savos		if (k->wk_keylen < 8)
2266292175Savos			algo = R92C_CAM_ALGO_WEP40;
2267292175Savos		else
2268292175Savos			algo = R92C_CAM_ALGO_WEP104;
2269292175Savos		break;
2270292175Savos	case IEEE80211_CIPHER_TKIP:
2271292175Savos		algo = R92C_CAM_ALGO_TKIP;
2272292175Savos		break;
2273292175Savos	case IEEE80211_CIPHER_AES_CCM:
2274292175Savos		algo = R92C_CAM_ALGO_AES;
2275292175Savos		break;
2276292175Savos	default:
2277292175Savos		device_printf(sc->sc_dev, "%s: undefined cipher %d\n",
2278292175Savos		    __func__, k->wk_cipher->ic_cipher);
2279292175Savos		return;
2280292175Savos	}
2281292175Savos
2282294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_KEY,
2283294471Savos	    "%s: keyix %d, keyid %d, algo %d/%d, flags %04X, len %d, "
2284294471Savos	    "macaddr %s\n", __func__, k->wk_keyix, keyid,
2285294471Savos	    k->wk_cipher->ic_cipher, algo, k->wk_flags, k->wk_keylen,
2286294471Savos	    ether_sprintf(k->wk_macaddr));
2287292175Savos
2288292175Savos	/* Write key. */
2289292175Savos	for (i = 0; i < 4; i++) {
2290292175Savos		error = urtwn_cam_write(sc, R92C_CAM_KEY(k->wk_keyix, i),
2291298359Savos		    le32dec(&k->wk_key[i * 4]));
2292292175Savos		if (error != 0)
2293292175Savos			goto fail;
2294292175Savos	}
2295292175Savos
2296292175Savos	/* Write CTL0 last since that will validate the CAM entry. */
2297292175Savos	error = urtwn_cam_write(sc, R92C_CAM_CTL1(k->wk_keyix),
2298298359Savos	    le32dec(&k->wk_macaddr[2]));
2299292175Savos	if (error != 0)
2300292175Savos		goto fail;
2301292175Savos	error = urtwn_cam_write(sc, R92C_CAM_CTL0(k->wk_keyix),
2302292175Savos	    SM(R92C_CAM_ALGO, algo) |
2303292175Savos	    SM(R92C_CAM_KEYID, keyid) |
2304298359Savos	    SM(R92C_CAM_MACLO, le16dec(&k->wk_macaddr[0])) |
2305292175Savos	    R92C_CAM_VALID);
2306292175Savos	if (error != 0)
2307292175Savos		goto fail;
2308292175Savos
2309292175Savos	return;
2310292175Savos
2311292175Savosfail:
2312292175Savos	device_printf(sc->sc_dev, "%s fails, error %d\n", __func__, error);
2313292175Savos}
2314292175Savos
2315292175Savosstatic void
2316292175Savosurtwn_key_del_cb(struct urtwn_softc *sc, union sec_param *data)
2317292175Savos{
2318292175Savos	struct ieee80211_key *k = &data->key;
2319292175Savos	int i;
2320292175Savos
2321294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_KEY,
2322294471Savos	    "%s: keyix %d, flags %04X, macaddr %s\n", __func__,
2323292175Savos	    k->wk_keyix, k->wk_flags, ether_sprintf(k->wk_macaddr));
2324292175Savos
2325292175Savos	urtwn_cam_write(sc, R92C_CAM_CTL0(k->wk_keyix), 0);
2326292175Savos	urtwn_cam_write(sc, R92C_CAM_CTL1(k->wk_keyix), 0);
2327292175Savos
2328292175Savos	/* Clear key. */
2329292175Savos	for (i = 0; i < 4; i++)
2330292175Savos		urtwn_cam_write(sc, R92C_CAM_KEY(k->wk_keyix, i), 0);
2331292175Savos	sc->keys_bmap &= ~(1 << k->wk_keyix);
2332292175Savos}
2333292175Savos
2334292175Savosstatic int
2335292175Savosurtwn_key_set(struct ieee80211vap *vap, const struct ieee80211_key *k)
2336292175Savos{
2337292175Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2338292175Savos
2339292175Savos	if (k->wk_flags & IEEE80211_KEY_SWCRYPT) {
2340292175Savos		/* Not for us. */
2341292175Savos		return (1);
2342292175Savos	}
2343292175Savos
2344292175Savos	return (!urtwn_cmd_sleepable(sc, k, sizeof(*k), urtwn_key_set_cb));
2345292175Savos}
2346292175Savos
2347292175Savosstatic int
2348292175Savosurtwn_key_delete(struct ieee80211vap *vap, const struct ieee80211_key *k)
2349292175Savos{
2350292175Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2351292175Savos
2352292175Savos	if (k->wk_flags & IEEE80211_KEY_SWCRYPT) {
2353292175Savos		/* Not for us. */
2354292175Savos		return (1);
2355292175Savos	}
2356292175Savos
2357292175Savos	return (!urtwn_cmd_sleepable(sc, k, sizeof(*k), urtwn_key_del_cb));
2358292175Savos}
2359292175Savos
2360292175Savosstatic void
2361290651Savosurtwn_tsf_task_adhoc(void *arg, int pending)
2362290651Savos{
2363290651Savos	struct ieee80211vap *vap = arg;
2364290651Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2365290651Savos	struct ieee80211_node *ni;
2366290651Savos	uint32_t reg;
2367290651Savos
2368290651Savos	URTWN_LOCK(sc);
2369290651Savos	ni = ieee80211_ref_node(vap->iv_bss);
2370290651Savos	reg = urtwn_read_1(sc, R92C_BCN_CTRL);
2371290651Savos
2372290651Savos	/* Accept beacons with the same BSSID. */
2373290651Savos	urtwn_set_rx_bssid_all(sc, 0);
2374290651Savos
2375290651Savos	/* Enable synchronization. */
2376290651Savos	reg &= ~R92C_BCN_CTRL_DIS_TSF_UDT0;
2377290651Savos	urtwn_write_1(sc, R92C_BCN_CTRL, reg);
2378290651Savos
2379290651Savos	/* Synchronize. */
2380290651Savos	usb_pause_mtx(&sc->sc_mtx, hz * ni->ni_intval * 5 / 1000);
2381290651Savos
2382290651Savos	/* Disable synchronization. */
2383290651Savos	reg |= R92C_BCN_CTRL_DIS_TSF_UDT0;
2384290651Savos	urtwn_write_1(sc, R92C_BCN_CTRL, reg);
2385290651Savos
2386290651Savos	/* Remove beacon filter. */
2387290651Savos	urtwn_set_rx_bssid_all(sc, 1);
2388290651Savos
2389290651Savos	/* Enable beaconing. */
2390290651Savos	urtwn_write_1(sc, R92C_MBID_NUM,
2391290651Savos	    urtwn_read_1(sc, R92C_MBID_NUM) | R92C_MBID_TXBCN_RPT0);
2392290651Savos	reg |= R92C_BCN_CTRL_EN_BCN;
2393290651Savos
2394290651Savos	urtwn_write_1(sc, R92C_BCN_CTRL, reg);
2395290651Savos	ieee80211_free_node(ni);
2396290651Savos	URTWN_UNLOCK(sc);
2397290651Savos}
2398290651Savos
2399290651Savosstatic void
2400290631Savosurtwn_tsf_sync_enable(struct urtwn_softc *sc, struct ieee80211vap *vap)
2401290631Savos{
2402290651Savos	struct ieee80211com *ic = &sc->sc_ic;
2403290651Savos	struct urtwn_vap *uvp = URTWN_VAP(vap);
2404290651Savos
2405290631Savos	/* Reset TSF. */
2406290631Savos	urtwn_write_1(sc, R92C_DUAL_TSF_RST, R92C_DUAL_TSF_RST0);
2407290631Savos
2408290631Savos	switch (vap->iv_opmode) {
2409290631Savos	case IEEE80211_M_STA:
2410290631Savos		/* Enable TSF synchronization. */
2411290631Savos		urtwn_write_1(sc, R92C_BCN_CTRL,
2412290631Savos		    urtwn_read_1(sc, R92C_BCN_CTRL) &
2413290631Savos		    ~R92C_BCN_CTRL_DIS_TSF_UDT0);
2414290631Savos		break;
2415290651Savos	case IEEE80211_M_IBSS:
2416290651Savos		ieee80211_runtask(ic, &uvp->tsf_task_adhoc);
2417290651Savos		break;
2418290631Savos	case IEEE80211_M_HOSTAP:
2419290631Savos		/* Enable beaconing. */
2420290631Savos		urtwn_write_1(sc, R92C_MBID_NUM,
2421290631Savos		    urtwn_read_1(sc, R92C_MBID_NUM) | R92C_MBID_TXBCN_RPT0);
2422290631Savos		urtwn_write_1(sc, R92C_BCN_CTRL,
2423290631Savos		    urtwn_read_1(sc, R92C_BCN_CTRL) | R92C_BCN_CTRL_EN_BCN);
2424290631Savos		break;
2425290631Savos	default:
2426290631Savos		device_printf(sc->sc_dev, "undefined opmode %d\n",
2427290631Savos		    vap->iv_opmode);
2428290631Savos		return;
2429290631Savos	}
2430290631Savos}
2431290631Savos
2432290631Savosstatic void
2433292203Savosurtwn_get_tsf(struct urtwn_softc *sc, uint64_t *buf)
2434292203Savos{
2435292203Savos	urtwn_read_region_1(sc, R92C_TSFTR, (uint8_t *)buf, sizeof(*buf));
2436292203Savos}
2437292203Savos
2438292203Savosstatic void
2439251538Srpaulourtwn_set_led(struct urtwn_softc *sc, int led, int on)
2440251538Srpaulo{
2441251538Srpaulo	uint8_t reg;
2442281069Srpaulo
2443251538Srpaulo	if (led == URTWN_LED_LINK) {
2444264912Skevlo		if (sc->chip & URTWN_CHIP_88E) {
2445264912Skevlo			reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0xf0;
2446264912Skevlo			urtwn_write_1(sc, R92C_LEDCFG2, reg | 0x60);
2447264912Skevlo			if (!on) {
2448264912Skevlo				reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0x90;
2449264912Skevlo				urtwn_write_1(sc, R92C_LEDCFG2,
2450264912Skevlo				    reg | R92C_LEDCFG0_DIS);
2451264912Skevlo				urtwn_write_1(sc, R92C_MAC_PINMUX_CFG,
2452264912Skevlo				    urtwn_read_1(sc, R92C_MAC_PINMUX_CFG) &
2453264912Skevlo				    0xfe);
2454264912Skevlo			}
2455264912Skevlo		} else {
2456264912Skevlo			reg = urtwn_read_1(sc, R92C_LEDCFG0) & 0x70;
2457264912Skevlo			if (!on)
2458264912Skevlo				reg |= R92C_LEDCFG0_DIS;
2459264912Skevlo			urtwn_write_1(sc, R92C_LEDCFG0, reg);
2460264912Skevlo		}
2461264912Skevlo		sc->ledlink = on;       /* Save LED state. */
2462251538Srpaulo	}
2463251538Srpaulo}
2464251538Srpaulo
2465289811Savosstatic void
2466289811Savosurtwn_set_mode(struct urtwn_softc *sc, uint8_t mode)
2467289811Savos{
2468289811Savos	uint8_t reg;
2469289811Savos
2470289811Savos	reg = urtwn_read_1(sc, R92C_MSR);
2471289811Savos	reg = (reg & ~R92C_MSR_MASK) | mode;
2472289811Savos	urtwn_write_1(sc, R92C_MSR, reg);
2473289811Savos}
2474289811Savos
2475290651Savosstatic void
2476290651Savosurtwn_ibss_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m, int subtype,
2477290651Savos    const struct ieee80211_rx_stats *rxs,
2478290651Savos    int rssi, int nf)
2479290651Savos{
2480290651Savos	struct ieee80211vap *vap = ni->ni_vap;
2481290651Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2482290651Savos	struct urtwn_vap *uvp = URTWN_VAP(vap);
2483290651Savos	uint64_t ni_tstamp, curr_tstamp;
2484290651Savos
2485290651Savos	uvp->recv_mgmt(ni, m, subtype, rxs, rssi, nf);
2486290651Savos
2487290651Savos	if (vap->iv_state == IEEE80211_S_RUN &&
2488290651Savos	    (subtype == IEEE80211_FC0_SUBTYPE_BEACON ||
2489290651Savos	    subtype == IEEE80211_FC0_SUBTYPE_PROBE_RESP)) {
2490290651Savos		ni_tstamp = le64toh(ni->ni_tstamp.tsf);
2491290651Savos		URTWN_LOCK(sc);
2492290651Savos		urtwn_get_tsf(sc, &curr_tstamp);
2493290651Savos		URTWN_UNLOCK(sc);
2494290651Savos		curr_tstamp = le64toh(curr_tstamp);
2495290651Savos
2496290651Savos		if (ni_tstamp >= curr_tstamp)
2497290651Savos			(void) ieee80211_ibss_merge(ni);
2498290651Savos	}
2499290651Savos}
2500290651Savos
2501251538Srpaulostatic int
2502251538Srpaulourtwn_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg)
2503251538Srpaulo{
2504251538Srpaulo	struct urtwn_vap *uvp = URTWN_VAP(vap);
2505251538Srpaulo	struct ieee80211com *ic = vap->iv_ic;
2506286949Sadrian	struct urtwn_softc *sc = ic->ic_softc;
2507251538Srpaulo	struct ieee80211_node *ni;
2508251538Srpaulo	enum ieee80211_state ostate;
2509290631Savos	uint32_t reg;
2510290631Savos	uint8_t mode;
2511290631Savos	int error = 0;
2512251538Srpaulo
2513251538Srpaulo	ostate = vap->iv_state;
2514294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_STATE, "%s -> %s\n",
2515294471Savos	    ieee80211_state_name[ostate], ieee80211_state_name[nstate]);
2516251538Srpaulo
2517251538Srpaulo	IEEE80211_UNLOCK(ic);
2518251538Srpaulo	URTWN_LOCK(sc);
2519251538Srpaulo	callout_stop(&sc->sc_watchdog_ch);
2520251538Srpaulo
2521251538Srpaulo	if (ostate == IEEE80211_S_RUN) {
2522294473Savos		/* Stop calibration. */
2523294473Savos		callout_stop(&sc->sc_calib_to);
2524294473Savos
2525251538Srpaulo		/* Turn link LED off. */
2526251538Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, 0);
2527251538Srpaulo
2528251538Srpaulo		/* Set media status to 'No Link'. */
2529289811Savos		urtwn_set_mode(sc, R92C_MSR_NOLINK);
2530251538Srpaulo
2531251538Srpaulo		/* Stop Rx of data frames. */
2532251538Srpaulo		urtwn_write_2(sc, R92C_RXFLTMAP2, 0);
2533251538Srpaulo
2534251538Srpaulo		/* Disable TSF synchronization. */
2535251538Srpaulo		urtwn_write_1(sc, R92C_BCN_CTRL,
2536290631Savos		    (urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_EN_BCN) |
2537251538Srpaulo		    R92C_BCN_CTRL_DIS_TSF_UDT0);
2538251538Srpaulo
2539290631Savos		/* Disable beaconing. */
2540290631Savos		urtwn_write_1(sc, R92C_MBID_NUM,
2541290631Savos		    urtwn_read_1(sc, R92C_MBID_NUM) & ~R92C_MBID_TXBCN_RPT0);
2542290631Savos
2543290631Savos		/* Reset TSF. */
2544290631Savos		urtwn_write_1(sc, R92C_DUAL_TSF_RST, R92C_DUAL_TSF_RST0);
2545290631Savos
2546251538Srpaulo		/* Reset EDCA parameters. */
2547251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002f3217);
2548251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005e4317);
2549251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x00105320);
2550251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a444);
2551251538Srpaulo	}
2552251538Srpaulo
2553251538Srpaulo	switch (nstate) {
2554251538Srpaulo	case IEEE80211_S_INIT:
2555251538Srpaulo		/* Turn link LED off. */
2556251538Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, 0);
2557251538Srpaulo		break;
2558251538Srpaulo	case IEEE80211_S_SCAN:
2559251538Srpaulo		/* Pause AC Tx queues. */
2560251538Srpaulo		urtwn_write_1(sc, R92C_TXPAUSE,
2561293180Savos		    urtwn_read_1(sc, R92C_TXPAUSE) | R92C_TX_QUEUE_AC);
2562251538Srpaulo		break;
2563251538Srpaulo	case IEEE80211_S_AUTH:
2564251538Srpaulo		urtwn_set_chan(sc, ic->ic_curchan, NULL);
2565251538Srpaulo		break;
2566251538Srpaulo	case IEEE80211_S_RUN:
2567251538Srpaulo		if (vap->iv_opmode == IEEE80211_M_MONITOR) {
2568251538Srpaulo			/* Turn link LED on. */
2569251538Srpaulo			urtwn_set_led(sc, URTWN_LED_LINK, 1);
2570251538Srpaulo			break;
2571251538Srpaulo		}
2572251538Srpaulo
2573251538Srpaulo		ni = ieee80211_ref_node(vap->iv_bss);
2574290631Savos
2575290631Savos		if (ic->ic_bsschan == IEEE80211_CHAN_ANYC ||
2576290631Savos		    ni->ni_chan == IEEE80211_CHAN_ANYC) {
2577290631Savos			device_printf(sc->sc_dev,
2578290631Savos			    "%s: could not move to RUN state\n", __func__);
2579290631Savos			error = EINVAL;
2580290631Savos			goto end_run;
2581290631Savos		}
2582290631Savos
2583290631Savos		switch (vap->iv_opmode) {
2584290631Savos		case IEEE80211_M_STA:
2585290631Savos			mode = R92C_MSR_INFRA;
2586290631Savos			break;
2587290651Savos		case IEEE80211_M_IBSS:
2588290651Savos			mode = R92C_MSR_ADHOC;
2589290651Savos			break;
2590290631Savos		case IEEE80211_M_HOSTAP:
2591290631Savos			mode = R92C_MSR_AP;
2592290631Savos			break;
2593290631Savos		default:
2594290631Savos			device_printf(sc->sc_dev, "undefined opmode %d\n",
2595290631Savos			    vap->iv_opmode);
2596290631Savos			error = EINVAL;
2597290631Savos			goto end_run;
2598290631Savos		}
2599290631Savos
2600251538Srpaulo		/* Set media status to 'Associated'. */
2601290631Savos		urtwn_set_mode(sc, mode);
2602251538Srpaulo
2603251538Srpaulo		/* Set BSSID. */
2604298359Savos		urtwn_write_4(sc, R92C_BSSID + 0, le32dec(&ni->ni_bssid[0]));
2605298359Savos		urtwn_write_4(sc, R92C_BSSID + 4, le16dec(&ni->ni_bssid[4]));
2606251538Srpaulo
2607251538Srpaulo		if (ic->ic_curmode == IEEE80211_MODE_11B)
2608251538Srpaulo			urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 0);
2609251538Srpaulo		else	/* 802.11b/g */
2610251538Srpaulo			urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 3);
2611251538Srpaulo
2612251538Srpaulo		/* Enable Rx of data frames. */
2613251538Srpaulo		urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff);
2614251538Srpaulo
2615251538Srpaulo		/* Flush all AC queues. */
2616251538Srpaulo		urtwn_write_1(sc, R92C_TXPAUSE, 0);
2617251538Srpaulo
2618251538Srpaulo		/* Set beacon interval. */
2619251538Srpaulo		urtwn_write_2(sc, R92C_BCN_INTERVAL, ni->ni_intval);
2620251538Srpaulo
2621251538Srpaulo		/* Allow Rx from our BSSID only. */
2622290564Savos		if (ic->ic_promisc == 0) {
2623290631Savos			reg = urtwn_read_4(sc, R92C_RCR);
2624290631Savos
2625290631Savos			if (vap->iv_opmode != IEEE80211_M_HOSTAP)
2626290631Savos				reg |= R92C_RCR_CBSSID_DATA;
2627290651Savos			if (vap->iv_opmode != IEEE80211_M_IBSS)
2628290651Savos				reg |= R92C_RCR_CBSSID_BCN;
2629290631Savos
2630290631Savos			urtwn_write_4(sc, R92C_RCR, reg);
2631290564Savos		}
2632251538Srpaulo
2633290651Savos		if (vap->iv_opmode == IEEE80211_M_HOSTAP ||
2634290651Savos		    vap->iv_opmode == IEEE80211_M_IBSS) {
2635290631Savos			error = urtwn_setup_beacon(sc, ni);
2636290631Savos			if (error != 0) {
2637290631Savos				device_printf(sc->sc_dev,
2638290631Savos				    "unable to push beacon into the chip, "
2639290631Savos				    "error %d\n", error);
2640290631Savos				goto end_run;
2641290631Savos			}
2642290631Savos		}
2643290631Savos
2644251538Srpaulo		/* Enable TSF synchronization. */
2645290631Savos		urtwn_tsf_sync_enable(sc, vap);
2646251538Srpaulo
2647251538Srpaulo		urtwn_write_1(sc, R92C_SIFS_CCK + 1, 10);
2648251538Srpaulo		urtwn_write_1(sc, R92C_SIFS_OFDM + 1, 10);
2649251538Srpaulo		urtwn_write_1(sc, R92C_SPEC_SIFS + 1, 10);
2650251538Srpaulo		urtwn_write_1(sc, R92C_MAC_SPEC_SIFS + 1, 10);
2651251538Srpaulo		urtwn_write_1(sc, R92C_R2T_SIFS + 1, 10);
2652251538Srpaulo		urtwn_write_1(sc, R92C_T2T_SIFS + 1, 10);
2653251538Srpaulo
2654251538Srpaulo		/* Intialize rate adaptation. */
2655292167Savos		if (!(sc->chip & URTWN_CHIP_88E))
2656264912Skevlo			urtwn_ra_init(sc);
2657251538Srpaulo		/* Turn link LED on. */
2658251538Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, 1);
2659251538Srpaulo
2660251538Srpaulo		sc->avg_pwdb = -1;	/* Reset average RSSI. */
2661251538Srpaulo		/* Reset temperature calibration state machine. */
2662294473Savos		sc->sc_flags &= ~URTWN_TEMP_MEASURED;
2663251538Srpaulo		sc->thcal_lctemp = 0;
2664294473Savos		/* Start periodic calibration. */
2665294473Savos		callout_reset(&sc->sc_calib_to, 2*hz, urtwn_calib_to, sc);
2666290631Savos
2667290631Savosend_run:
2668251538Srpaulo		ieee80211_free_node(ni);
2669251538Srpaulo		break;
2670251538Srpaulo	default:
2671251538Srpaulo		break;
2672251538Srpaulo	}
2673290631Savos
2674251538Srpaulo	URTWN_UNLOCK(sc);
2675251538Srpaulo	IEEE80211_LOCK(ic);
2676290631Savos	return (error != 0 ? error : uvp->newstate(vap, nstate, arg));
2677251538Srpaulo}
2678251538Srpaulo
2679251538Srpaulostatic void
2680294473Savosurtwn_calib_to(void *arg)
2681294473Savos{
2682294473Savos	struct urtwn_softc *sc = arg;
2683294473Savos
2684294473Savos	/* Do it in a process context. */
2685294473Savos	urtwn_cmd_sleepable(sc, NULL, 0, urtwn_calib_cb);
2686294473Savos}
2687294473Savos
2688294473Savosstatic void
2689294473Savosurtwn_calib_cb(struct urtwn_softc *sc, union sec_param *data)
2690294473Savos{
2691294473Savos	/* Do temperature compensation. */
2692294473Savos	urtwn_temp_calib(sc);
2693294473Savos
2694294473Savos	if ((urtwn_read_1(sc, R92C_MSR) & R92C_MSR_MASK) != R92C_MSR_NOLINK)
2695294473Savos		callout_reset(&sc->sc_calib_to, 2*hz, urtwn_calib_to, sc);
2696294473Savos}
2697294473Savos
2698294473Savosstatic void
2699251538Srpaulourtwn_watchdog(void *arg)
2700251538Srpaulo{
2701251538Srpaulo	struct urtwn_softc *sc = arg;
2702251538Srpaulo
2703251538Srpaulo	if (sc->sc_txtimer > 0) {
2704251538Srpaulo		if (--sc->sc_txtimer == 0) {
2705251538Srpaulo			device_printf(sc->sc_dev, "device timeout\n");
2706287197Sglebius			counter_u64_add(sc->sc_ic.ic_oerrors, 1);
2707251538Srpaulo			return;
2708251538Srpaulo		}
2709251538Srpaulo		callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
2710251538Srpaulo	}
2711251538Srpaulo}
2712251538Srpaulo
2713251538Srpaulostatic void
2714251538Srpaulourtwn_update_avgrssi(struct urtwn_softc *sc, int rate, int8_t rssi)
2715251538Srpaulo{
2716251538Srpaulo	int pwdb;
2717251538Srpaulo
2718251538Srpaulo	/* Convert antenna signal to percentage. */
2719251538Srpaulo	if (rssi <= -100 || rssi >= 20)
2720251538Srpaulo		pwdb = 0;
2721251538Srpaulo	else if (rssi >= 0)
2722251538Srpaulo		pwdb = 100;
2723251538Srpaulo	else
2724251538Srpaulo		pwdb = 100 + rssi;
2725264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
2726289758Savos		if (rate <= URTWN_RIDX_CCK11) {
2727264912Skevlo			/* CCK gain is smaller than OFDM/MCS gain. */
2728264912Skevlo			pwdb += 6;
2729264912Skevlo			if (pwdb > 100)
2730264912Skevlo				pwdb = 100;
2731264912Skevlo			if (pwdb <= 14)
2732264912Skevlo				pwdb -= 4;
2733264912Skevlo			else if (pwdb <= 26)
2734264912Skevlo				pwdb -= 8;
2735264912Skevlo			else if (pwdb <= 34)
2736264912Skevlo				pwdb -= 6;
2737264912Skevlo			else if (pwdb <= 42)
2738264912Skevlo				pwdb -= 2;
2739264912Skevlo		}
2740251538Srpaulo	}
2741251538Srpaulo	if (sc->avg_pwdb == -1)	/* Init. */
2742251538Srpaulo		sc->avg_pwdb = pwdb;
2743251538Srpaulo	else if (sc->avg_pwdb < pwdb)
2744251538Srpaulo		sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20) + 1;
2745251538Srpaulo	else
2746251538Srpaulo		sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20);
2747297175Sadrian	URTWN_DPRINTF(sc, URTWN_DEBUG_RSSI, "%s: PWDB %d, EMA %d\n", __func__,
2748294471Savos	    pwdb, sc->avg_pwdb);
2749251538Srpaulo}
2750251538Srpaulo
2751251538Srpaulostatic int8_t
2752251538Srpaulourtwn_get_rssi(struct urtwn_softc *sc, int rate, void *physt)
2753251538Srpaulo{
2754251538Srpaulo	static const int8_t cckoff[] = { 16, -12, -26, -46 };
2755251538Srpaulo	struct r92c_rx_phystat *phy;
2756251538Srpaulo	struct r92c_rx_cck *cck;
2757251538Srpaulo	uint8_t rpt;
2758251538Srpaulo	int8_t rssi;
2759251538Srpaulo
2760289758Savos	if (rate <= URTWN_RIDX_CCK11) {
2761251538Srpaulo		cck = (struct r92c_rx_cck *)physt;
2762251538Srpaulo		if (sc->sc_flags & URTWN_FLAG_CCK_HIPWR) {
2763251538Srpaulo			rpt = (cck->agc_rpt >> 5) & 0x3;
2764251538Srpaulo			rssi = (cck->agc_rpt & 0x1f) << 1;
2765251538Srpaulo		} else {
2766251538Srpaulo			rpt = (cck->agc_rpt >> 6) & 0x3;
2767251538Srpaulo			rssi = cck->agc_rpt & 0x3e;
2768251538Srpaulo		}
2769251538Srpaulo		rssi = cckoff[rpt] - rssi;
2770251538Srpaulo	} else {	/* OFDM/HT. */
2771251538Srpaulo		phy = (struct r92c_rx_phystat *)physt;
2772251538Srpaulo		rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110;
2773251538Srpaulo	}
2774251538Srpaulo	return (rssi);
2775251538Srpaulo}
2776251538Srpaulo
2777264912Skevlostatic int8_t
2778264912Skevlourtwn_r88e_get_rssi(struct urtwn_softc *sc, int rate, void *physt)
2779264912Skevlo{
2780264912Skevlo	struct r92c_rx_phystat *phy;
2781264912Skevlo	struct r88e_rx_cck *cck;
2782264912Skevlo	uint8_t cck_agc_rpt, lna_idx, vga_idx;
2783264912Skevlo	int8_t rssi;
2784264912Skevlo
2785264972Skevlo	rssi = 0;
2786289758Savos	if (rate <= URTWN_RIDX_CCK11) {
2787264912Skevlo		cck = (struct r88e_rx_cck *)physt;
2788264912Skevlo		cck_agc_rpt = cck->agc_rpt;
2789264912Skevlo		lna_idx = (cck_agc_rpt & 0xe0) >> 5;
2790281069Srpaulo		vga_idx = cck_agc_rpt & 0x1f;
2791264912Skevlo		switch (lna_idx) {
2792264912Skevlo		case 7:
2793264912Skevlo			if (vga_idx <= 27)
2794264912Skevlo				rssi = -100 + 2* (27 - vga_idx);
2795264912Skevlo			else
2796264912Skevlo				rssi = -100;
2797264912Skevlo			break;
2798264912Skevlo		case 6:
2799264912Skevlo			rssi = -48 + 2 * (2 - vga_idx);
2800264912Skevlo			break;
2801264912Skevlo		case 5:
2802264912Skevlo			rssi = -42 + 2 * (7 - vga_idx);
2803264912Skevlo			break;
2804264912Skevlo		case 4:
2805264912Skevlo			rssi = -36 + 2 * (7 - vga_idx);
2806264912Skevlo			break;
2807264912Skevlo		case 3:
2808264912Skevlo			rssi = -24 + 2 * (7 - vga_idx);
2809264912Skevlo			break;
2810264912Skevlo		case 2:
2811264912Skevlo			rssi = -12 + 2 * (5 - vga_idx);
2812264912Skevlo			break;
2813264912Skevlo		case 1:
2814264912Skevlo			rssi = 8 - (2 * vga_idx);
2815264912Skevlo			break;
2816264912Skevlo		case 0:
2817264912Skevlo			rssi = 14 - (2 * vga_idx);
2818264912Skevlo			break;
2819264912Skevlo		}
2820264912Skevlo		rssi += 6;
2821264912Skevlo	} else {	/* OFDM/HT. */
2822264912Skevlo		phy = (struct r92c_rx_phystat *)physt;
2823264912Skevlo		rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110;
2824264912Skevlo	}
2825264912Skevlo	return (rssi);
2826264912Skevlo}
2827264912Skevlo
2828251538Srpaulostatic int
2829290630Savosurtwn_tx_data(struct urtwn_softc *sc, struct ieee80211_node *ni,
2830290630Savos    struct mbuf *m, struct urtwn_data *data)
2831251538Srpaulo{
2832292167Savos	const struct ieee80211_txparam *tp;
2833287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
2834251538Srpaulo	struct ieee80211vap *vap = ni->ni_vap;
2835292167Savos	struct ieee80211_key *k = NULL;
2836292167Savos	struct ieee80211_channel *chan;
2837292167Savos	struct ieee80211_frame *wh;
2838251538Srpaulo	struct r92c_tx_desc *txd;
2839292167Savos	uint8_t macid, raid, rate, ridx, subtype, type, tid, qsel;
2840292014Savos	int hasqos, ismcast;
2841251538Srpaulo
2842251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
2843251538Srpaulo
2844251538Srpaulo	/*
2845251538Srpaulo	 * Software crypto.
2846251538Srpaulo	 */
2847290630Savos	wh = mtod(m, struct ieee80211_frame *);
2848264912Skevlo	type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;
2849290630Savos	subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;
2850292014Savos	hasqos = IEEE80211_QOS_HAS_SEQ(wh);
2851290630Savos	ismcast = IEEE80211_IS_MULTICAST(wh->i_addr1);
2852264912Skevlo
2853292014Savos	/* Select TX ring for this frame. */
2854292014Savos	if (hasqos) {
2855292014Savos		tid = ((const struct ieee80211_qosframe *)wh)->i_qos[0];
2856292014Savos		tid &= IEEE80211_QOS_TID;
2857292014Savos	} else
2858292014Savos		tid = 0;
2859292014Savos
2860292167Savos	chan = (ni->ni_chan != IEEE80211_CHAN_ANYC) ?
2861292167Savos		ni->ni_chan : ic->ic_curchan;
2862292167Savos	tp = &vap->iv_txparms[ieee80211_chan2mode(chan)];
2863292167Savos
2864292167Savos	/* Choose a TX rate index. */
2865292167Savos	if (type == IEEE80211_FC0_TYPE_MGT)
2866292167Savos		rate = tp->mgmtrate;
2867292167Savos	else if (ismcast)
2868292167Savos		rate = tp->mcastrate;
2869292167Savos	else if (tp->ucastrate != IEEE80211_FIXED_RATE_NONE)
2870292167Savos		rate = tp->ucastrate;
2871292167Savos	else if (m->m_flags & M_EAPOL)
2872292167Savos		rate = tp->mgmtrate;
2873292167Savos	else {
2874292167Savos		if (URTWN_CHIP_HAS_RATECTL(sc)) {
2875292167Savos			/* XXX pass pktlen */
2876292167Savos			(void) ieee80211_ratectl_rate(ni, NULL, 0);
2877292167Savos			rate = ni->ni_txrate;
2878292167Savos		} else {
2879297175Sadrian			/* XXX TODO: drop the default rate for 11b/11g? */
2880297175Sadrian			if (ni->ni_flags & IEEE80211_NODE_HT)
2881297175Sadrian				rate = IEEE80211_RATE_MCS | 0x4; /* MCS4 */
2882297175Sadrian			else if (ic->ic_curmode != IEEE80211_MODE_11B)
2883292167Savos				rate = 108;
2884292167Savos			else
2885292167Savos				rate = 22;
2886292167Savos		}
2887292167Savos	}
2888292167Savos
2889297175Sadrian	/*
2890297175Sadrian	 * XXX TODO: this should be per-node, for 11b versus 11bg
2891297175Sadrian	 * nodes in hostap mode
2892297175Sadrian	 */
2893292167Savos	ridx = rate2ridx(rate);
2894297175Sadrian	if (ni->ni_flags & IEEE80211_NODE_HT)
2895297175Sadrian		raid = R92C_RAID_11GN;
2896297175Sadrian	else if (ic->ic_curmode != IEEE80211_MODE_11B)
2897292167Savos		raid = R92C_RAID_11BG;
2898292167Savos	else
2899292167Savos		raid = R92C_RAID_11B;
2900292167Savos
2901260444Skevlo	if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) {
2902290630Savos		k = ieee80211_crypto_encap(ni, m);
2903251538Srpaulo		if (k == NULL) {
2904251538Srpaulo			device_printf(sc->sc_dev,
2905251538Srpaulo			    "ieee80211_crypto_encap returns NULL.\n");
2906251538Srpaulo			return (ENOBUFS);
2907251538Srpaulo		}
2908251538Srpaulo
2909251538Srpaulo		/* in case packet header moved, reset pointer */
2910290630Savos		wh = mtod(m, struct ieee80211_frame *);
2911251538Srpaulo	}
2912281069Srpaulo
2913251538Srpaulo	/* Fill Tx descriptor. */
2914251538Srpaulo	txd = (struct r92c_tx_desc *)data->buf;
2915251538Srpaulo	memset(txd, 0, sizeof(*txd));
2916251538Srpaulo
2917251538Srpaulo	txd->txdw0 |= htole32(
2918251538Srpaulo	    SM(R92C_TXDW0_OFFSET, sizeof(*txd)) |
2919251538Srpaulo	    R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG);
2920290630Savos	if (ismcast)
2921251538Srpaulo		txd->txdw0 |= htole32(R92C_TXDW0_BMCAST);
2922290630Savos
2923290630Savos	if (!ismcast) {
2924292167Savos		if (sc->chip & URTWN_CHIP_88E) {
2925292167Savos			struct urtwn_node *un = URTWN_NODE(ni);
2926292167Savos			macid = un->id;
2927292167Savos		} else
2928292167Savos			macid = URTWN_MACID_BSS;
2929290630Savos
2930290630Savos		if (type == IEEE80211_FC0_TYPE_DATA) {
2931292014Savos			qsel = tid % URTWN_MAX_TID;
2932290630Savos
2933292167Savos			if (sc->chip & URTWN_CHIP_88E) {
2934292167Savos				txd->txdw2 |= htole32(
2935292167Savos				    R88E_TXDW2_AGGBK |
2936292167Savos				    R88E_TXDW2_CCX_RPT);
2937292167Savos			} else
2938290630Savos				txd->txdw1 |= htole32(R92C_TXDW1_AGGBK);
2939290630Savos
2940297175Sadrian			/* protmode, non-HT */
2941297175Sadrian			/* XXX TODO: noack frames? */
2942297175Sadrian			if ((rate & 0x80) == 0 &&
2943297175Sadrian			    (ic->ic_flags & IEEE80211_F_USEPROT)) {
2944290630Savos				switch (ic->ic_protmode) {
2945290630Savos				case IEEE80211_PROT_CTSONLY:
2946290630Savos					txd->txdw4 |= htole32(
2947290630Savos					    R92C_TXDW4_CTS2SELF |
2948290630Savos					    R92C_TXDW4_HWRTSEN);
2949290630Savos					break;
2950290630Savos				case IEEE80211_PROT_RTSCTS:
2951290630Savos					txd->txdw4 |= htole32(
2952290630Savos					    R92C_TXDW4_RTSEN |
2953290630Savos					    R92C_TXDW4_HWRTSEN);
2954290630Savos					break;
2955290630Savos				default:
2956290630Savos					break;
2957290630Savos				}
2958290630Savos			}
2959297175Sadrian
2960297175Sadrian			/* protmode, HT */
2961297175Sadrian			/* XXX TODO: noack frames? */
2962297175Sadrian			if ((rate & 0x80) &&
2963297175Sadrian			    (ic->ic_htprotmode == IEEE80211_PROT_RTSCTS)) {
2964297175Sadrian				txd->txdw4 |= htole32(
2965297175Sadrian				    R92C_TXDW4_RTSEN |
2966297175Sadrian				    R92C_TXDW4_HWRTSEN);
2967297175Sadrian			}
2968297175Sadrian
2969297175Sadrian			/* XXX TODO: rtsrate is configurable? 24mbit may
2970297175Sadrian			 * be a bit high for RTS rate? */
2971290630Savos			txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE,
2972290630Savos			    URTWN_RIDX_OFDM24));
2973297175Sadrian
2974290630Savos			txd->txdw5 |= htole32(0x0001ff00);
2975290630Savos		} else	/* IEEE80211_FC0_TYPE_MGT */
2976290630Savos			qsel = R92C_TXDW1_QSEL_MGNT;
2977251538Srpaulo	} else {
2978290630Savos		macid = URTWN_MACID_BC;
2979290630Savos		qsel = R92C_TXDW1_QSEL_MGNT;
2980290630Savos	}
2981251538Srpaulo
2982290630Savos	txd->txdw1 |= htole32(
2983290630Savos	    SM(R92C_TXDW1_QSEL, qsel) |
2984290630Savos	    SM(R92C_TXDW1_RAID, raid));
2985290630Savos
2986297175Sadrian	/* XXX TODO: 40MHZ flag? */
2987297175Sadrian	/* XXX TODO: AMPDU flag? (AGG_ENABLE or AGG_BREAK?) Density shift? */
2988297175Sadrian	/* XXX Short preamble? */
2989297175Sadrian	/* XXX Short-GI? */
2990297175Sadrian
2991290630Savos	if (sc->chip & URTWN_CHIP_88E)
2992290630Savos		txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, macid));
2993290630Savos	else
2994290630Savos		txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, macid));
2995290630Savos
2996290630Savos	txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, ridx));
2997297175Sadrian
2998291858Savos	/* Force this rate if needed. */
2999292167Savos	if (URTWN_CHIP_HAS_RATECTL(sc) || ismcast ||
3000297175Sadrian	    (tp->ucastrate != IEEE80211_FIXED_RATE_NONE) ||
3001292167Savos	    (m->m_flags & M_EAPOL) || type != IEEE80211_FC0_TYPE_DATA)
3002251538Srpaulo		txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE);
3003251538Srpaulo
3004292014Savos	if (!hasqos) {
3005251538Srpaulo		/* Use HW sequence numbering for non-QoS frames. */
3006291858Savos		if (sc->chip & URTWN_CHIP_88E)
3007291858Savos			txd->txdseq = htole16(R88E_TXDSEQ_HWSEQ_EN);
3008291858Savos		else
3009291858Savos			txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN);
3010290630Savos	} else {
3011290630Savos		/* Set sequence number. */
3012290630Savos		txd->txdseq = htole16(M_SEQNO_GET(m) % IEEE80211_SEQ_RANGE);
3013290630Savos	}
3014251538Srpaulo
3015292175Savos	if (k != NULL && !(k->wk_flags & IEEE80211_KEY_SWCRYPT)) {
3016292175Savos		uint8_t cipher;
3017292175Savos
3018292175Savos		switch (k->wk_cipher->ic_cipher) {
3019292175Savos		case IEEE80211_CIPHER_WEP:
3020292175Savos		case IEEE80211_CIPHER_TKIP:
3021292175Savos			cipher = R92C_TXDW1_CIPHER_RC4;
3022292175Savos			break;
3023292175Savos		case IEEE80211_CIPHER_AES_CCM:
3024292175Savos			cipher = R92C_TXDW1_CIPHER_AES;
3025292175Savos			break;
3026292175Savos		default:
3027292175Savos			device_printf(sc->sc_dev, "%s: unknown cipher %d\n",
3028292175Savos			    __func__, k->wk_cipher->ic_cipher);
3029292175Savos			return (EINVAL);
3030292175Savos		}
3031292175Savos
3032292175Savos		txd->txdw1 |= htole32(SM(R92C_TXDW1_CIPHER, cipher));
3033292175Savos	}
3034292175Savos
3035251538Srpaulo	if (ieee80211_radiotap_active_vap(vap)) {
3036251538Srpaulo		struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap;
3037251538Srpaulo
3038251538Srpaulo		tap->wt_flags = 0;
3039290630Savos		if (k != NULL)
3040290630Savos			tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP;
3041290630Savos		ieee80211_radiotap_tx(vap, m);
3042251538Srpaulo	}
3043251538Srpaulo
3044290630Savos	data->ni = ni;
3045251538Srpaulo
3046290630Savos	urtwn_tx_start(sc, m, type, data);
3047290630Savos
3048290630Savos	return (0);
3049290630Savos}
3050290630Savos
3051292221Savosstatic int
3052292221Savosurtwn_tx_raw(struct urtwn_softc *sc, struct ieee80211_node *ni,
3053292221Savos    struct mbuf *m, struct urtwn_data *data,
3054292221Savos    const struct ieee80211_bpf_params *params)
3055292221Savos{
3056292221Savos	struct ieee80211vap *vap = ni->ni_vap;
3057292221Savos	struct ieee80211_key *k = NULL;
3058292221Savos	struct ieee80211_frame *wh;
3059292221Savos	struct r92c_tx_desc *txd;
3060292221Savos	uint8_t cipher, ridx, type;
3061292221Savos
3062292221Savos	/* Encrypt the frame if need be. */
3063292221Savos	cipher = R92C_TXDW1_CIPHER_NONE;
3064292221Savos	if (params->ibp_flags & IEEE80211_BPF_CRYPTO) {
3065292221Savos		/* Retrieve key for TX. */
3066292221Savos		k = ieee80211_crypto_encap(ni, m);
3067292221Savos		if (k == NULL)
3068292221Savos			return (ENOBUFS);
3069292221Savos
3070292221Savos		if (!(k->wk_flags & IEEE80211_KEY_SWCRYPT)) {
3071292221Savos			switch (k->wk_cipher->ic_cipher) {
3072292221Savos			case IEEE80211_CIPHER_WEP:
3073292221Savos			case IEEE80211_CIPHER_TKIP:
3074292221Savos				cipher = R92C_TXDW1_CIPHER_RC4;
3075292221Savos				break;
3076292221Savos			case IEEE80211_CIPHER_AES_CCM:
3077292221Savos				cipher = R92C_TXDW1_CIPHER_AES;
3078292221Savos				break;
3079292221Savos			default:
3080292221Savos				device_printf(sc->sc_dev,
3081292221Savos				    "%s: unknown cipher %d\n",
3082292221Savos				    __func__, k->wk_cipher->ic_cipher);
3083292221Savos				return (EINVAL);
3084292221Savos			}
3085292221Savos		}
3086292221Savos	}
3087292221Savos
3088297175Sadrian	/* XXX TODO: 11n checks, matching urtwn_tx_data() */
3089297175Sadrian
3090292221Savos	wh = mtod(m, struct ieee80211_frame *);
3091292221Savos	type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;
3092292221Savos
3093292221Savos	/* Fill Tx descriptor. */
3094292221Savos	txd = (struct r92c_tx_desc *)data->buf;
3095292221Savos	memset(txd, 0, sizeof(*txd));
3096292221Savos
3097292221Savos	txd->txdw0 |= htole32(
3098292221Savos	    SM(R92C_TXDW0_OFFSET, sizeof(*txd)) |
3099292221Savos	    R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG);
3100292221Savos	if (IEEE80211_IS_MULTICAST(wh->i_addr1))
3101292221Savos		txd->txdw0 |= htole32(R92C_TXDW0_BMCAST);
3102292221Savos
3103292221Savos	if (params->ibp_flags & IEEE80211_BPF_RTS)
3104292221Savos		txd->txdw4 |= htole32(R92C_TXDW4_RTSEN);
3105292221Savos	if (params->ibp_flags & IEEE80211_BPF_CTS)
3106292221Savos		txd->txdw4 |= htole32(R92C_TXDW4_CTS2SELF);
3107292221Savos	if (txd->txdw4 & htole32(R92C_TXDW4_RTSEN | R92C_TXDW4_CTS2SELF)) {
3108292221Savos		txd->txdw4 |= htole32(R92C_TXDW4_HWRTSEN);
3109292221Savos		txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE,
3110292221Savos		    URTWN_RIDX_OFDM24));
3111292221Savos	}
3112292221Savos
3113292221Savos	if (sc->chip & URTWN_CHIP_88E)
3114292221Savos		txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, URTWN_MACID_BC));
3115292221Savos	else
3116292221Savos		txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, URTWN_MACID_BC));
3117292221Savos
3118297175Sadrian	/* XXX TODO: rate index/config (RAID) for 11n? */
3119292221Savos	txd->txdw1 |= htole32(SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_MGNT));
3120292221Savos	txd->txdw1 |= htole32(SM(R92C_TXDW1_CIPHER, cipher));
3121292221Savos
3122292221Savos	/* Choose a TX rate index. */
3123292221Savos	ridx = rate2ridx(params->ibp_rate0);
3124292221Savos	txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, ridx));
3125292221Savos	txd->txdw5 |= htole32(0x0001ff00);
3126292221Savos	txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE);
3127292221Savos
3128292221Savos	if (!IEEE80211_QOS_HAS_SEQ(wh)) {
3129292221Savos		/* Use HW sequence numbering for non-QoS frames. */
3130292221Savos		if (sc->chip & URTWN_CHIP_88E)
3131292221Savos			txd->txdseq = htole16(R88E_TXDSEQ_HWSEQ_EN);
3132292221Savos		else
3133292221Savos			txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN);
3134292221Savos	} else {
3135292221Savos		/* Set sequence number. */
3136292221Savos		txd->txdseq = htole16(M_SEQNO_GET(m) % IEEE80211_SEQ_RANGE);
3137292221Savos	}
3138292221Savos
3139292221Savos	if (ieee80211_radiotap_active_vap(vap)) {
3140292221Savos		struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap;
3141292221Savos
3142292221Savos		tap->wt_flags = 0;
3143292221Savos		if (k != NULL)
3144292221Savos			tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP;
3145292221Savos		ieee80211_radiotap_tx(vap, m);
3146292221Savos	}
3147292221Savos
3148292221Savos	data->ni = ni;
3149292221Savos
3150292221Savos	urtwn_tx_start(sc, m, type, data);
3151292221Savos
3152292221Savos	return (0);
3153292221Savos}
3154292221Savos
3155290630Savosstatic void
3156290630Savosurtwn_tx_start(struct urtwn_softc *sc, struct mbuf *m, uint8_t type,
3157290630Savos    struct urtwn_data *data)
3158290630Savos{
3159290630Savos	struct usb_xfer *xfer;
3160290630Savos	struct r92c_tx_desc *txd;
3161290630Savos	uint16_t ac, sum;
3162290630Savos	int i, xferlen;
3163290630Savos
3164290630Savos	URTWN_ASSERT_LOCKED(sc);
3165290630Savos
3166290630Savos	ac = M_WME_GETAC(m);
3167290630Savos
3168290630Savos	switch (type) {
3169290630Savos	case IEEE80211_FC0_TYPE_CTL:
3170290630Savos	case IEEE80211_FC0_TYPE_MGT:
3171290630Savos		xfer = sc->sc_xfer[URTWN_BULK_TX_VO];
3172290630Savos		break;
3173290630Savos	default:
3174292014Savos		xfer = sc->sc_xfer[wme2queue[ac].qid];
3175290630Savos		break;
3176290630Savos	}
3177290630Savos
3178290630Savos	txd = (struct r92c_tx_desc *)data->buf;
3179290630Savos	txd->txdw0 |= htole32(SM(R92C_TXDW0_PKTLEN, m->m_pkthdr.len));
3180290630Savos
3181290630Savos	/* Compute Tx descriptor checksum. */
3182290630Savos	sum = 0;
3183290630Savos	for (i = 0; i < sizeof(*txd) / 2; i++)
3184290630Savos		sum ^= ((uint16_t *)txd)[i];
3185290630Savos	txd->txdsum = sum;	/* NB: already little endian. */
3186290630Savos
3187290630Savos	xferlen = sizeof(*txd) + m->m_pkthdr.len;
3188290630Savos	m_copydata(m, 0, m->m_pkthdr.len, (caddr_t)&txd[1]);
3189290630Savos
3190251538Srpaulo	data->buflen = xferlen;
3191290630Savos	data->m = m;
3192251538Srpaulo
3193251538Srpaulo	STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next);
3194251538Srpaulo	usbd_transfer_start(xfer);
3195251538Srpaulo}
3196251538Srpaulo
3197287197Sglebiusstatic int
3198287197Sglebiusurtwn_transmit(struct ieee80211com *ic, struct mbuf *m)
3199251538Srpaulo{
3200287197Sglebius	struct urtwn_softc *sc = ic->ic_softc;
3201287197Sglebius	int error;
3202261863Srpaulo
3203261863Srpaulo	URTWN_LOCK(sc);
3204287197Sglebius	if ((sc->sc_flags & URTWN_RUNNING) == 0) {
3205287197Sglebius		URTWN_UNLOCK(sc);
3206287197Sglebius		return (ENXIO);
3207287197Sglebius	}
3208287197Sglebius	error = mbufq_enqueue(&sc->sc_snd, m);
3209287197Sglebius	if (error) {
3210287197Sglebius		URTWN_UNLOCK(sc);
3211287197Sglebius		return (error);
3212287197Sglebius	}
3213287197Sglebius	urtwn_start(sc);
3214261863Srpaulo	URTWN_UNLOCK(sc);
3215287197Sglebius
3216287197Sglebius	return (0);
3217261863Srpaulo}
3218261863Srpaulo
3219261863Srpaulostatic void
3220287197Sglebiusurtwn_start(struct urtwn_softc *sc)
3221261863Srpaulo{
3222251538Srpaulo	struct ieee80211_node *ni;
3223251538Srpaulo	struct mbuf *m;
3224251538Srpaulo	struct urtwn_data *bf;
3225251538Srpaulo
3226261863Srpaulo	URTWN_ASSERT_LOCKED(sc);
3227287197Sglebius	while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) {
3228251538Srpaulo		bf = urtwn_getbuf(sc);
3229251538Srpaulo		if (bf == NULL) {
3230287197Sglebius			mbufq_prepend(&sc->sc_snd, m);
3231251538Srpaulo			break;
3232251538Srpaulo		}
3233251538Srpaulo		ni = (struct ieee80211_node *)m->m_pkthdr.rcvif;
3234251538Srpaulo		m->m_pkthdr.rcvif = NULL;
3235297596Sadrian
3236297596Sadrian		URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT, "%s: called; m=%p\n",
3237297596Sadrian		    __func__,
3238297596Sadrian		    m);
3239297596Sadrian
3240290630Savos		if (urtwn_tx_data(sc, ni, m, bf) != 0) {
3241287197Sglebius			if_inc_counter(ni->ni_vap->iv_ifp,
3242287197Sglebius			    IFCOUNTER_OERRORS, 1);
3243251538Srpaulo			STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next);
3244288353Sadrian			m_freem(m);
3245251538Srpaulo			ieee80211_free_node(ni);
3246251538Srpaulo			break;
3247251538Srpaulo		}
3248251538Srpaulo		sc->sc_txtimer = 5;
3249251538Srpaulo		callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
3250251538Srpaulo	}
3251251538Srpaulo}
3252251538Srpaulo
3253287197Sglebiusstatic void
3254287197Sglebiusurtwn_parent(struct ieee80211com *ic)
3255251538Srpaulo{
3256286949Sadrian	struct urtwn_softc *sc = ic->ic_softc;
3257251538Srpaulo
3258263153Skevlo	URTWN_LOCK(sc);
3259287197Sglebius	if (sc->sc_flags & URTWN_DETACHED) {
3260287197Sglebius		URTWN_UNLOCK(sc);
3261287197Sglebius		return;
3262287197Sglebius	}
3263291698Savos	URTWN_UNLOCK(sc);
3264291698Savos
3265287197Sglebius	if (ic->ic_nrunning > 0) {
3266291698Savos		if (urtwn_init(sc) != 0) {
3267291698Savos			struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
3268291698Savos			if (vap != NULL)
3269291698Savos				ieee80211_stop(vap);
3270291698Savos		} else
3271291698Savos			ieee80211_start_all(ic);
3272291698Savos	} else
3273287197Sglebius		urtwn_stop(sc);
3274251538Srpaulo}
3275251538Srpaulo
3276264912Skevlostatic __inline int
3277251538Srpaulourtwn_power_on(struct urtwn_softc *sc)
3278251538Srpaulo{
3279264912Skevlo
3280264912Skevlo	return sc->sc_power_on(sc);
3281264912Skevlo}
3282264912Skevlo
3283264912Skevlostatic int
3284264912Skevlourtwn_r92c_power_on(struct urtwn_softc *sc)
3285264912Skevlo{
3286251538Srpaulo	uint32_t reg;
3287291698Savos	usb_error_t error;
3288251538Srpaulo	int ntries;
3289251538Srpaulo
3290251538Srpaulo	/* Wait for autoload done bit. */
3291251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
3292251538Srpaulo		if (urtwn_read_1(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_PFM_ALDN)
3293251538Srpaulo			break;
3294266472Shselasky		urtwn_ms_delay(sc);
3295251538Srpaulo	}
3296251538Srpaulo	if (ntries == 1000) {
3297251538Srpaulo		device_printf(sc->sc_dev,
3298251538Srpaulo		    "timeout waiting for chip autoload\n");
3299251538Srpaulo		return (ETIMEDOUT);
3300251538Srpaulo	}
3301251538Srpaulo
3302251538Srpaulo	/* Unlock ISO/CLK/Power control register. */
3303291698Savos	error = urtwn_write_1(sc, R92C_RSV_CTRL, 0);
3304291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3305291698Savos		return (EIO);
3306251538Srpaulo	/* Move SPS into PWM mode. */
3307291698Savos	error = urtwn_write_1(sc, R92C_SPS0_CTRL, 0x2b);
3308291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3309291698Savos		return (EIO);
3310266472Shselasky	urtwn_ms_delay(sc);
3311251538Srpaulo
3312251538Srpaulo	reg = urtwn_read_1(sc, R92C_LDOV12D_CTRL);
3313251538Srpaulo	if (!(reg & R92C_LDOV12D_CTRL_LDV12_EN)) {
3314291698Savos		error = urtwn_write_1(sc, R92C_LDOV12D_CTRL,
3315251538Srpaulo		    reg | R92C_LDOV12D_CTRL_LDV12_EN);
3316291698Savos		if (error != USB_ERR_NORMAL_COMPLETION)
3317291698Savos			return (EIO);
3318266472Shselasky		urtwn_ms_delay(sc);
3319291698Savos		error = urtwn_write_1(sc, R92C_SYS_ISO_CTRL,
3320251538Srpaulo		    urtwn_read_1(sc, R92C_SYS_ISO_CTRL) &
3321251538Srpaulo		    ~R92C_SYS_ISO_CTRL_MD2PP);
3322291698Savos		if (error != USB_ERR_NORMAL_COMPLETION)
3323291698Savos			return (EIO);
3324251538Srpaulo	}
3325251538Srpaulo
3326251538Srpaulo	/* Auto enable WLAN. */
3327291698Savos	error = urtwn_write_2(sc, R92C_APS_FSMCO,
3328251538Srpaulo	    urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC);
3329291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3330291698Savos		return (EIO);
3331251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
3332262822Skevlo		if (!(urtwn_read_2(sc, R92C_APS_FSMCO) &
3333262822Skevlo		    R92C_APS_FSMCO_APFM_ONMAC))
3334251538Srpaulo			break;
3335266472Shselasky		urtwn_ms_delay(sc);
3336251538Srpaulo	}
3337251538Srpaulo	if (ntries == 1000) {
3338251538Srpaulo		device_printf(sc->sc_dev,
3339251538Srpaulo		    "timeout waiting for MAC auto ON\n");
3340251538Srpaulo		return (ETIMEDOUT);
3341251538Srpaulo	}
3342251538Srpaulo
3343251538Srpaulo	/* Enable radio, GPIO and LED functions. */
3344291698Savos	error = urtwn_write_2(sc, R92C_APS_FSMCO,
3345251538Srpaulo	    R92C_APS_FSMCO_AFSM_HSUS |
3346251538Srpaulo	    R92C_APS_FSMCO_PDN_EN |
3347251538Srpaulo	    R92C_APS_FSMCO_PFM_ALDN);
3348291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3349291698Savos		return (EIO);
3350251538Srpaulo	/* Release RF digital isolation. */
3351291698Savos	error = urtwn_write_2(sc, R92C_SYS_ISO_CTRL,
3352251538Srpaulo	    urtwn_read_2(sc, R92C_SYS_ISO_CTRL) & ~R92C_SYS_ISO_CTRL_DIOR);
3353291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3354291698Savos		return (EIO);
3355251538Srpaulo
3356251538Srpaulo	/* Initialize MAC. */
3357291698Savos	error = urtwn_write_1(sc, R92C_APSD_CTRL,
3358251538Srpaulo	    urtwn_read_1(sc, R92C_APSD_CTRL) & ~R92C_APSD_CTRL_OFF);
3359291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3360291698Savos		return (EIO);
3361251538Srpaulo	for (ntries = 0; ntries < 200; ntries++) {
3362251538Srpaulo		if (!(urtwn_read_1(sc, R92C_APSD_CTRL) &
3363251538Srpaulo		    R92C_APSD_CTRL_OFF_STATUS))
3364251538Srpaulo			break;
3365266472Shselasky		urtwn_ms_delay(sc);
3366251538Srpaulo	}
3367251538Srpaulo	if (ntries == 200) {
3368251538Srpaulo		device_printf(sc->sc_dev,
3369251538Srpaulo		    "timeout waiting for MAC initialization\n");
3370251538Srpaulo		return (ETIMEDOUT);
3371251538Srpaulo	}
3372251538Srpaulo
3373251538Srpaulo	/* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */
3374251538Srpaulo	reg = urtwn_read_2(sc, R92C_CR);
3375251538Srpaulo	reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN |
3376251538Srpaulo	    R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN |
3377251538Srpaulo	    R92C_CR_SCHEDULE_EN | R92C_CR_MACTXEN | R92C_CR_MACRXEN |
3378251538Srpaulo	    R92C_CR_ENSEC;
3379291698Savos	error = urtwn_write_2(sc, R92C_CR, reg);
3380291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3381291698Savos		return (EIO);
3382251538Srpaulo
3383291698Savos	error = urtwn_write_1(sc, 0xfe10, 0x19);
3384291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3385291698Savos		return (EIO);
3386251538Srpaulo	return (0);
3387251538Srpaulo}
3388251538Srpaulo
3389251538Srpaulostatic int
3390264912Skevlourtwn_r88e_power_on(struct urtwn_softc *sc)
3391264912Skevlo{
3392264912Skevlo	uint32_t reg;
3393291698Savos	usb_error_t error;
3394264912Skevlo	int ntries;
3395264912Skevlo
3396264912Skevlo	/* Wait for power ready bit. */
3397264912Skevlo	for (ntries = 0; ntries < 5000; ntries++) {
3398281918Skevlo		if (urtwn_read_4(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_SUS_HOST)
3399264912Skevlo			break;
3400266472Shselasky		urtwn_ms_delay(sc);
3401264912Skevlo	}
3402264912Skevlo	if (ntries == 5000) {
3403264912Skevlo		device_printf(sc->sc_dev,
3404264912Skevlo		    "timeout waiting for chip power up\n");
3405264912Skevlo		return (ETIMEDOUT);
3406264912Skevlo	}
3407264912Skevlo
3408264912Skevlo	/* Reset BB. */
3409291698Savos	error = urtwn_write_1(sc, R92C_SYS_FUNC_EN,
3410264912Skevlo	    urtwn_read_1(sc, R92C_SYS_FUNC_EN) & ~(R92C_SYS_FUNC_EN_BBRSTB |
3411264912Skevlo	    R92C_SYS_FUNC_EN_BB_GLB_RST));
3412291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3413291698Savos		return (EIO);
3414264912Skevlo
3415291698Savos	error = urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 2,
3416281918Skevlo	    urtwn_read_1(sc, R92C_AFE_XTAL_CTRL + 2) | 0x80);
3417291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3418291698Savos		return (EIO);
3419264912Skevlo
3420264912Skevlo	/* Disable HWPDN. */
3421291698Savos	error = urtwn_write_2(sc, R92C_APS_FSMCO,
3422281918Skevlo	    urtwn_read_2(sc, R92C_APS_FSMCO) & ~R92C_APS_FSMCO_APDM_HPDN);
3423291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3424291698Savos		return (EIO);
3425264912Skevlo
3426264912Skevlo	/* Disable WL suspend. */
3427291698Savos	error = urtwn_write_2(sc, R92C_APS_FSMCO,
3428281918Skevlo	    urtwn_read_2(sc, R92C_APS_FSMCO) &
3429281918Skevlo	    ~(R92C_APS_FSMCO_AFSM_HSUS | R92C_APS_FSMCO_AFSM_PCIE));
3430291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3431291698Savos		return (EIO);
3432264912Skevlo
3433291698Savos	error = urtwn_write_2(sc, R92C_APS_FSMCO,
3434281918Skevlo	    urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC);
3435291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3436291698Savos		return (EIO);
3437264912Skevlo	for (ntries = 0; ntries < 5000; ntries++) {
3438281918Skevlo		if (!(urtwn_read_2(sc, R92C_APS_FSMCO) &
3439281918Skevlo		    R92C_APS_FSMCO_APFM_ONMAC))
3440264912Skevlo			break;
3441266472Shselasky		urtwn_ms_delay(sc);
3442264912Skevlo	}
3443264912Skevlo	if (ntries == 5000)
3444264912Skevlo		return (ETIMEDOUT);
3445264912Skevlo
3446264912Skevlo	/* Enable LDO normal mode. */
3447291698Savos	error = urtwn_write_1(sc, R92C_LPLDO_CTRL,
3448295874Savos	    urtwn_read_1(sc, R92C_LPLDO_CTRL) & ~R92C_LPLDO_CTRL_SLEEP);
3449291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3450291698Savos		return (EIO);
3451264912Skevlo
3452264912Skevlo	/* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */
3453291698Savos	error = urtwn_write_2(sc, R92C_CR, 0);
3454291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3455291698Savos		return (EIO);
3456264912Skevlo	reg = urtwn_read_2(sc, R92C_CR);
3457264912Skevlo	reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN |
3458264912Skevlo	    R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN |
3459264912Skevlo	    R92C_CR_SCHEDULE_EN | R92C_CR_ENSEC | R92C_CR_CALTMR_EN;
3460291698Savos	error = urtwn_write_2(sc, R92C_CR, reg);
3461291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3462291698Savos		return (EIO);
3463264912Skevlo
3464264912Skevlo	return (0);
3465264912Skevlo}
3466264912Skevlo
3467295874Savosstatic __inline void
3468295874Savosurtwn_power_off(struct urtwn_softc *sc)
3469295874Savos{
3470295874Savos
3471295874Savos	return sc->sc_power_off(sc);
3472295874Savos}
3473295874Savos
3474295874Savosstatic void
3475295874Savosurtwn_r92c_power_off(struct urtwn_softc *sc)
3476295874Savos{
3477295874Savos	uint32_t reg;
3478295874Savos
3479295874Savos	/* Block all Tx queues. */
3480295874Savos	urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL);
3481295874Savos
3482295874Savos	/* Disable RF */
3483295874Savos	urtwn_rf_write(sc, 0, 0, 0);
3484295874Savos
3485295874Savos	urtwn_write_1(sc, R92C_APSD_CTRL, R92C_APSD_CTRL_OFF);
3486295874Savos
3487295874Savos	/* Reset BB state machine */
3488295874Savos	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
3489295874Savos	    R92C_SYS_FUNC_EN_USBD | R92C_SYS_FUNC_EN_USBA |
3490295874Savos	    R92C_SYS_FUNC_EN_BB_GLB_RST);
3491295874Savos	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
3492295874Savos	    R92C_SYS_FUNC_EN_USBD | R92C_SYS_FUNC_EN_USBA);
3493295874Savos
3494295874Savos	/*
3495295874Savos	 * Reset digital sequence
3496295874Savos	 */
3497295874Savos#ifndef URTWN_WITHOUT_UCODE
3498295874Savos	if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RDY) {
3499295874Savos		/* Reset MCU ready status */
3500295874Savos		urtwn_write_1(sc, R92C_MCUFWDL, 0);
3501295874Savos
3502295874Savos		/* If firmware in ram code, do reset */
3503295874Savos		urtwn_fw_reset(sc);
3504295874Savos	}
3505295874Savos#endif
3506295874Savos
3507295874Savos	/* Reset MAC and Enable 8051 */
3508295874Savos	urtwn_write_1(sc, R92C_SYS_FUNC_EN + 1,
3509295874Savos	    (R92C_SYS_FUNC_EN_CPUEN |
3510295874Savos	     R92C_SYS_FUNC_EN_ELDR |
3511295874Savos	     R92C_SYS_FUNC_EN_HWPDN) >> 8);
3512295874Savos
3513295874Savos	/* Reset MCU ready status */
3514295874Savos	urtwn_write_1(sc, R92C_MCUFWDL, 0);
3515295874Savos
3516295874Savos	/* Disable MAC clock */
3517295874Savos	urtwn_write_2(sc, R92C_SYS_CLKR,
3518295874Savos	    R92C_SYS_CLKR_ANAD16V_EN |
3519295874Savos	    R92C_SYS_CLKR_ANA8M |
3520295874Savos	    R92C_SYS_CLKR_LOADER_EN |
3521295874Savos	    R92C_SYS_CLKR_80M_SSC_DIS |
3522295874Savos	    R92C_SYS_CLKR_SYS_EN |
3523295874Savos	    R92C_SYS_CLKR_RING_EN |
3524295874Savos	    0x4000);
3525295874Savos
3526295874Savos	/* Disable AFE PLL */
3527295874Savos	urtwn_write_1(sc, R92C_AFE_PLL_CTRL, 0x80);
3528295874Savos
3529295874Savos	/* Gated AFE DIG_CLOCK */
3530295874Savos	urtwn_write_2(sc, R92C_AFE_XTAL_CTRL, 0x880F);
3531295874Savos
3532295874Savos	/* Isolated digital to PON */
3533295874Savos	urtwn_write_1(sc, R92C_SYS_ISO_CTRL,
3534295874Savos	    R92C_SYS_ISO_CTRL_MD2PP |
3535295874Savos	    R92C_SYS_ISO_CTRL_PA2PCIE |
3536295874Savos	    R92C_SYS_ISO_CTRL_PD2CORE |
3537295874Savos	    R92C_SYS_ISO_CTRL_IP2MAC |
3538295874Savos	    R92C_SYS_ISO_CTRL_DIOP |
3539295874Savos	    R92C_SYS_ISO_CTRL_DIOE);
3540295874Savos
3541295874Savos	/*
3542295874Savos	 * Pull GPIO PIN to balance level and LED control
3543295874Savos	 */
3544295874Savos	/* 1. Disable GPIO[7:0] */
3545295874Savos	urtwn_write_2(sc, R92C_GPIO_IOSEL, 0x0000);
3546295874Savos
3547295874Savos	reg = urtwn_read_4(sc, R92C_GPIO_PIN_CTRL) & ~0x0000ff00;
3548295874Savos	reg |= ((reg << 8) & 0x0000ff00) | 0x00ff0000;
3549295874Savos	urtwn_write_4(sc, R92C_GPIO_PIN_CTRL, reg);
3550295874Savos
3551295874Savos	/* Disable GPIO[10:8] */
3552295874Savos	urtwn_write_1(sc, R92C_MAC_PINMUX_CFG, 0x00);
3553295874Savos
3554295874Savos	reg = urtwn_read_2(sc, R92C_GPIO_IO_SEL) & ~0x00f0;
3555295874Savos	reg |= (((reg & 0x000f) << 4) | 0x0780);
3556295874Savos	urtwn_write_2(sc, R92C_GPIO_IO_SEL, reg);
3557295874Savos
3558295874Savos	/* Disable LED0 & 1 */
3559295874Savos	urtwn_write_2(sc, R92C_LEDCFG0, 0x8080);
3560295874Savos
3561295874Savos	/*
3562295874Savos	 * Reset digital sequence
3563295874Savos	 */
3564295874Savos	/* Disable ELDR clock */
3565295874Savos	urtwn_write_2(sc, R92C_SYS_CLKR,
3566295874Savos	    R92C_SYS_CLKR_ANAD16V_EN |
3567295874Savos	    R92C_SYS_CLKR_ANA8M |
3568295874Savos	    R92C_SYS_CLKR_LOADER_EN |
3569295874Savos	    R92C_SYS_CLKR_80M_SSC_DIS |
3570295874Savos	    R92C_SYS_CLKR_SYS_EN |
3571295874Savos	    R92C_SYS_CLKR_RING_EN |
3572295874Savos	    0x4000);
3573295874Savos
3574295874Savos	/* Isolated ELDR to PON */
3575295874Savos	urtwn_write_1(sc, R92C_SYS_ISO_CTRL + 1,
3576295874Savos	    (R92C_SYS_ISO_CTRL_DIOR |
3577295874Savos	     R92C_SYS_ISO_CTRL_PWC_EV12V) >> 8);
3578295874Savos
3579295874Savos	/*
3580295874Savos	 * Disable analog sequence
3581295874Savos	 */
3582295874Savos	/* Disable A15 power */
3583295874Savos	urtwn_write_1(sc, R92C_LDOA15_CTRL, R92C_LDOA15_CTRL_OBUF);
3584295874Savos	/* Disable digital core power */
3585295874Savos	urtwn_write_1(sc, R92C_LDOV12D_CTRL,
3586295874Savos	    urtwn_read_1(sc, R92C_LDOV12D_CTRL) &
3587295874Savos	      ~R92C_LDOV12D_CTRL_LDV12_EN);
3588295874Savos
3589295874Savos	/* Enter PFM mode */
3590295874Savos	urtwn_write_1(sc, R92C_SPS0_CTRL, 0x23);
3591295874Savos
3592295874Savos	/* Set USB suspend */
3593295874Savos	urtwn_write_2(sc, R92C_APS_FSMCO,
3594295874Savos	    R92C_APS_FSMCO_APDM_HOST |
3595295874Savos	    R92C_APS_FSMCO_AFSM_HSUS |
3596295874Savos	    R92C_APS_FSMCO_PFM_ALDN);
3597295874Savos
3598295874Savos	/* Lock ISO/CLK/Power control register. */
3599295874Savos	urtwn_write_1(sc, R92C_RSV_CTRL, 0x0E);
3600295874Savos}
3601295874Savos
3602295874Savosstatic void
3603295874Savosurtwn_r88e_power_off(struct urtwn_softc *sc)
3604295874Savos{
3605295874Savos	uint8_t reg;
3606295874Savos	int ntries;
3607295874Savos
3608295874Savos	/* Disable any kind of TX reports. */
3609295874Savos	urtwn_write_1(sc, R88E_TX_RPT_CTRL,
3610295874Savos	    urtwn_read_1(sc, R88E_TX_RPT_CTRL) &
3611295874Savos	      ~(R88E_TX_RPT1_ENA | R88E_TX_RPT2_ENA));
3612295874Savos
3613295874Savos	/* Stop Rx. */
3614295874Savos	urtwn_write_1(sc, R92C_CR, 0);
3615295874Savos
3616295874Savos	/* Move card to Low Power State. */
3617295874Savos	/* Block all Tx queues. */
3618295874Savos	urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL);
3619295874Savos
3620295874Savos	for (ntries = 0; ntries < 20; ntries++) {
3621295874Savos		/* Should be zero if no packet is transmitting. */
3622295874Savos		if (urtwn_read_4(sc, R88E_SCH_TXCMD) == 0)
3623295874Savos			break;
3624295874Savos
3625295874Savos		urtwn_ms_delay(sc);
3626295874Savos	}
3627295874Savos	if (ntries == 20) {
3628295874Savos		device_printf(sc->sc_dev, "%s: failed to block Tx queues\n",
3629295874Savos		    __func__);
3630295874Savos		return;
3631295874Savos	}
3632295874Savos
3633295874Savos	/* CCK and OFDM are disabled, and clock are gated. */
3634295874Savos	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
3635295874Savos	    urtwn_read_1(sc, R92C_SYS_FUNC_EN) & ~R92C_SYS_FUNC_EN_BBRSTB);
3636295874Savos
3637295874Savos	urtwn_ms_delay(sc);
3638295874Savos
3639295874Savos	/* Reset MAC TRX */
3640295874Savos	urtwn_write_1(sc, R92C_CR,
3641295874Savos	    R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN |
3642295874Savos	    R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN |
3643295874Savos	    R92C_CR_PROTOCOL_EN | R92C_CR_SCHEDULE_EN);
3644295874Savos
3645295874Savos	/* check if removed later */
3646295874Savos	urtwn_write_1(sc, R92C_CR + 1,
3647295874Savos	    urtwn_read_1(sc, R92C_CR + 1) & ~(R92C_CR_ENSEC >> 8));
3648295874Savos
3649295874Savos	/* Respond TxOK to scheduler */
3650295874Savos	urtwn_write_1(sc, R92C_DUAL_TSF_RST,
3651295874Savos	    urtwn_read_1(sc, R92C_DUAL_TSF_RST) | 0x20);
3652295874Savos
3653295874Savos	/* If firmware in ram code, do reset. */
3654295874Savos#ifndef URTWN_WITHOUT_UCODE
3655295874Savos	if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RDY)
3656295874Savos		urtwn_r88e_fw_reset(sc);
3657295874Savos#endif
3658295874Savos
3659295874Savos	/* Reset MCU ready status. */
3660295874Savos	urtwn_write_1(sc, R92C_MCUFWDL, 0x00);
3661295874Savos
3662295874Savos	/* Disable 32k. */
3663295874Savos	urtwn_write_1(sc, R88E_32K_CTRL,
3664295874Savos	    urtwn_read_1(sc, R88E_32K_CTRL) & ~0x01);
3665295874Savos
3666295874Savos	/* Move card to Disabled state. */
3667295874Savos	/* Turn off RF. */
3668295874Savos	urtwn_write_1(sc, R92C_RF_CTRL, 0);
3669295874Savos
3670295874Savos	/* LDO Sleep mode. */
3671295874Savos	urtwn_write_1(sc, R92C_LPLDO_CTRL,
3672295874Savos	    urtwn_read_1(sc, R92C_LPLDO_CTRL) | R92C_LPLDO_CTRL_SLEEP);
3673295874Savos
3674295874Savos	/* Turn off MAC by HW state machine */
3675295874Savos	urtwn_write_1(sc, R92C_APS_FSMCO + 1,
3676295874Savos	    urtwn_read_1(sc, R92C_APS_FSMCO + 1) |
3677295874Savos	    (R92C_APS_FSMCO_APFM_OFF >> 8));
3678295874Savos
3679295874Savos	for (ntries = 0; ntries < 20; ntries++) {
3680295874Savos		/* Wait until it will be disabled. */
3681295874Savos		if ((urtwn_read_1(sc, R92C_APS_FSMCO + 1) &
3682295874Savos		    (R92C_APS_FSMCO_APFM_OFF >> 8)) == 0)
3683295874Savos			break;
3684295874Savos
3685295874Savos		urtwn_ms_delay(sc);
3686295874Savos	}
3687295874Savos	if (ntries == 20) {
3688295874Savos		device_printf(sc->sc_dev, "%s: could not turn off MAC\n",
3689295874Savos		    __func__);
3690295874Savos		return;
3691295874Savos	}
3692295874Savos
3693295874Savos	/* schmit trigger */
3694295874Savos	urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 2,
3695295874Savos	    urtwn_read_1(sc, R92C_AFE_XTAL_CTRL + 2) | 0x80);
3696295874Savos
3697295874Savos	/* Enable WL suspend. */
3698295874Savos	urtwn_write_1(sc, R92C_APS_FSMCO + 1,
3699295874Savos	    (urtwn_read_1(sc, R92C_APS_FSMCO + 1) & ~0x10) | 0x08);
3700295874Savos
3701295874Savos	/* Enable bandgap mbias in suspend. */
3702295874Savos	urtwn_write_1(sc, R92C_APS_FSMCO + 3, 0);
3703295874Savos
3704295874Savos	/* Clear SIC_EN register. */
3705295874Savos	urtwn_write_1(sc, R92C_GPIO_MUXCFG + 1,
3706295874Savos	    urtwn_read_1(sc, R92C_GPIO_MUXCFG + 1) & ~0x10);
3707295874Savos
3708295874Savos	/* Set USB suspend enable local register */
3709295874Savos	urtwn_write_1(sc, R92C_USB_SUSPEND,
3710295874Savos	    urtwn_read_1(sc, R92C_USB_SUSPEND) | 0x10);
3711295874Savos
3712295874Savos	/* Reset MCU IO Wrapper. */
3713295874Savos	reg = urtwn_read_1(sc, R92C_RSV_CTRL + 1);
3714295874Savos	urtwn_write_1(sc, R92C_RSV_CTRL + 1, reg & ~0x08);
3715295874Savos	urtwn_write_1(sc, R92C_RSV_CTRL + 1, reg | 0x08);
3716295874Savos
3717295874Savos	/* marked as 'For Power Consumption' code. */
3718295874Savos	urtwn_write_1(sc, R92C_GPIO_OUT, urtwn_read_1(sc, R92C_GPIO_IN));
3719295874Savos	urtwn_write_1(sc, R92C_GPIO_IOSEL, 0xff);
3720295874Savos
3721295874Savos	urtwn_write_1(sc, R92C_GPIO_IO_SEL,
3722295874Savos	    urtwn_read_1(sc, R92C_GPIO_IO_SEL) << 4);
3723295874Savos	urtwn_write_1(sc, R92C_GPIO_MOD,
3724295874Savos	    urtwn_read_1(sc, R92C_GPIO_MOD) | 0x0f);
3725295874Savos
3726295874Savos	/* Set LNA, TRSW, EX_PA Pin to output mode. */
3727295874Savos	urtwn_write_4(sc, R88E_BB_PAD_CTRL, 0x00080808);
3728295874Savos}
3729295874Savos
3730264912Skevlostatic int
3731251538Srpaulourtwn_llt_init(struct urtwn_softc *sc)
3732251538Srpaulo{
3733264912Skevlo	int i, error, page_count, pktbuf_count;
3734251538Srpaulo
3735264912Skevlo	page_count = (sc->chip & URTWN_CHIP_88E) ?
3736264912Skevlo	    R88E_TX_PAGE_COUNT : R92C_TX_PAGE_COUNT;
3737264912Skevlo	pktbuf_count = (sc->chip & URTWN_CHIP_88E) ?
3738264912Skevlo	    R88E_TXPKTBUF_COUNT : R92C_TXPKTBUF_COUNT;
3739264912Skevlo
3740264912Skevlo	/* Reserve pages [0; page_count]. */
3741264912Skevlo	for (i = 0; i < page_count; i++) {
3742251538Srpaulo		if ((error = urtwn_llt_write(sc, i, i + 1)) != 0)
3743251538Srpaulo			return (error);
3744251538Srpaulo	}
3745251538Srpaulo	/* NB: 0xff indicates end-of-list. */
3746251538Srpaulo	if ((error = urtwn_llt_write(sc, i, 0xff)) != 0)
3747251538Srpaulo		return (error);
3748251538Srpaulo	/*
3749264912Skevlo	 * Use pages [page_count + 1; pktbuf_count - 1]
3750251538Srpaulo	 * as ring buffer.
3751251538Srpaulo	 */
3752264912Skevlo	for (++i; i < pktbuf_count - 1; i++) {
3753251538Srpaulo		if ((error = urtwn_llt_write(sc, i, i + 1)) != 0)
3754251538Srpaulo			return (error);
3755251538Srpaulo	}
3756251538Srpaulo	/* Make the last page point to the beginning of the ring buffer. */
3757264912Skevlo	error = urtwn_llt_write(sc, i, page_count + 1);
3758251538Srpaulo	return (error);
3759251538Srpaulo}
3760251538Srpaulo
3761295871Savos#ifndef URTWN_WITHOUT_UCODE
3762251538Srpaulostatic void
3763251538Srpaulourtwn_fw_reset(struct urtwn_softc *sc)
3764251538Srpaulo{
3765251538Srpaulo	uint16_t reg;
3766251538Srpaulo	int ntries;
3767251538Srpaulo
3768251538Srpaulo	/* Tell 8051 to reset itself. */
3769251538Srpaulo	urtwn_write_1(sc, R92C_HMETFR + 3, 0x20);
3770251538Srpaulo
3771251538Srpaulo	/* Wait until 8051 resets by itself. */
3772251538Srpaulo	for (ntries = 0; ntries < 100; ntries++) {
3773251538Srpaulo		reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
3774251538Srpaulo		if (!(reg & R92C_SYS_FUNC_EN_CPUEN))
3775251538Srpaulo			return;
3776266472Shselasky		urtwn_ms_delay(sc);
3777251538Srpaulo	}
3778251538Srpaulo	/* Force 8051 reset. */
3779251538Srpaulo	urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN);
3780251538Srpaulo}
3781251538Srpaulo
3782264912Skevlostatic void
3783264912Skevlourtwn_r88e_fw_reset(struct urtwn_softc *sc)
3784264912Skevlo{
3785264912Skevlo	uint16_t reg;
3786264912Skevlo
3787264912Skevlo	reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
3788264912Skevlo	urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN);
3789264912Skevlo	urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg | R92C_SYS_FUNC_EN_CPUEN);
3790264912Skevlo}
3791264912Skevlo
3792251538Srpaulostatic int
3793251538Srpaulourtwn_fw_loadpage(struct urtwn_softc *sc, int page, const uint8_t *buf, int len)
3794251538Srpaulo{
3795251538Srpaulo	uint32_t reg;
3796291698Savos	usb_error_t error = USB_ERR_NORMAL_COMPLETION;
3797291698Savos	int off, mlen;
3798251538Srpaulo
3799251538Srpaulo	reg = urtwn_read_4(sc, R92C_MCUFWDL);
3800251538Srpaulo	reg = RW(reg, R92C_MCUFWDL_PAGE, page);
3801251538Srpaulo	urtwn_write_4(sc, R92C_MCUFWDL, reg);
3802251538Srpaulo
3803251538Srpaulo	off = R92C_FW_START_ADDR;
3804251538Srpaulo	while (len > 0) {
3805251538Srpaulo		if (len > 196)
3806251538Srpaulo			mlen = 196;
3807251538Srpaulo		else if (len > 4)
3808251538Srpaulo			mlen = 4;
3809251538Srpaulo		else
3810251538Srpaulo			mlen = 1;
3811251538Srpaulo		/* XXX fix this deconst */
3812281069Srpaulo		error = urtwn_write_region_1(sc, off,
3813251538Srpaulo		    __DECONST(uint8_t *, buf), mlen);
3814291698Savos		if (error != USB_ERR_NORMAL_COMPLETION)
3815251538Srpaulo			break;
3816251538Srpaulo		off += mlen;
3817251538Srpaulo		buf += mlen;
3818251538Srpaulo		len -= mlen;
3819251538Srpaulo	}
3820251538Srpaulo	return (error);
3821251538Srpaulo}
3822251538Srpaulo
3823251538Srpaulostatic int
3824251538Srpaulourtwn_load_firmware(struct urtwn_softc *sc)
3825251538Srpaulo{
3826251538Srpaulo	const struct firmware *fw;
3827251538Srpaulo	const struct r92c_fw_hdr *hdr;
3828251538Srpaulo	const char *imagename;
3829251538Srpaulo	const u_char *ptr;
3830251538Srpaulo	size_t len;
3831251538Srpaulo	uint32_t reg;
3832251538Srpaulo	int mlen, ntries, page, error;
3833251538Srpaulo
3834264864Skevlo	URTWN_UNLOCK(sc);
3835251538Srpaulo	/* Read firmware image from the filesystem. */
3836264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
3837264912Skevlo		imagename = "urtwn-rtl8188eufw";
3838264912Skevlo	else if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) ==
3839264912Skevlo		    URTWN_CHIP_UMC_A_CUT)
3840251538Srpaulo		imagename = "urtwn-rtl8192cfwU";
3841251538Srpaulo	else
3842251538Srpaulo		imagename = "urtwn-rtl8192cfwT";
3843251538Srpaulo
3844251538Srpaulo	fw = firmware_get(imagename);
3845264864Skevlo	URTWN_LOCK(sc);
3846251538Srpaulo	if (fw == NULL) {
3847251538Srpaulo		device_printf(sc->sc_dev,
3848251538Srpaulo		    "failed loadfirmware of file %s\n", imagename);
3849251538Srpaulo		return (ENOENT);
3850251538Srpaulo	}
3851251538Srpaulo
3852251538Srpaulo	len = fw->datasize;
3853251538Srpaulo
3854251538Srpaulo	if (len < sizeof(*hdr)) {
3855251538Srpaulo		device_printf(sc->sc_dev, "firmware too short\n");
3856251538Srpaulo		error = EINVAL;
3857251538Srpaulo		goto fail;
3858251538Srpaulo	}
3859251538Srpaulo	ptr = fw->data;
3860251538Srpaulo	hdr = (const struct r92c_fw_hdr *)ptr;
3861251538Srpaulo	/* Check if there is a valid FW header and skip it. */
3862251538Srpaulo	if ((le16toh(hdr->signature) >> 4) == 0x88c ||
3863264912Skevlo	    (le16toh(hdr->signature) >> 4) == 0x88e ||
3864251538Srpaulo	    (le16toh(hdr->signature) >> 4) == 0x92c) {
3865294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_FIRMWARE,
3866294471Savos		    "FW V%d.%d %02d-%02d %02d:%02d\n",
3867251538Srpaulo		    le16toh(hdr->version), le16toh(hdr->subversion),
3868251538Srpaulo		    hdr->month, hdr->date, hdr->hour, hdr->minute);
3869251538Srpaulo		ptr += sizeof(*hdr);
3870251538Srpaulo		len -= sizeof(*hdr);
3871251538Srpaulo	}
3872251538Srpaulo
3873264912Skevlo	if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RAM_DL_SEL) {
3874264912Skevlo		if (sc->chip & URTWN_CHIP_88E)
3875264912Skevlo			urtwn_r88e_fw_reset(sc);
3876264912Skevlo		else
3877264912Skevlo			urtwn_fw_reset(sc);
3878251538Srpaulo		urtwn_write_1(sc, R92C_MCUFWDL, 0);
3879251538Srpaulo	}
3880264912Skevlo
3881268487Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
3882268487Skevlo		urtwn_write_2(sc, R92C_SYS_FUNC_EN,
3883268487Skevlo		    urtwn_read_2(sc, R92C_SYS_FUNC_EN) |
3884268487Skevlo		    R92C_SYS_FUNC_EN_CPUEN);
3885268487Skevlo	}
3886251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL,
3887251538Srpaulo	    urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_EN);
3888251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL + 2,
3889251538Srpaulo	    urtwn_read_1(sc, R92C_MCUFWDL + 2) & ~0x08);
3890251538Srpaulo
3891263154Skevlo	/* Reset the FWDL checksum. */
3892263154Skevlo	urtwn_write_1(sc, R92C_MCUFWDL,
3893263154Skevlo	    urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_CHKSUM_RPT);
3894263154Skevlo
3895251538Srpaulo	for (page = 0; len > 0; page++) {
3896251538Srpaulo		mlen = min(len, R92C_FW_PAGE_SIZE);
3897251538Srpaulo		error = urtwn_fw_loadpage(sc, page, ptr, mlen);
3898251538Srpaulo		if (error != 0) {
3899251538Srpaulo			device_printf(sc->sc_dev,
3900251538Srpaulo			    "could not load firmware page\n");
3901251538Srpaulo			goto fail;
3902251538Srpaulo		}
3903251538Srpaulo		ptr += mlen;
3904251538Srpaulo		len -= mlen;
3905251538Srpaulo	}
3906251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL,
3907251538Srpaulo	    urtwn_read_1(sc, R92C_MCUFWDL) & ~R92C_MCUFWDL_EN);
3908251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL + 1, 0);
3909251538Srpaulo
3910251538Srpaulo	/* Wait for checksum report. */
3911251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
3912251538Srpaulo		if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_CHKSUM_RPT)
3913251538Srpaulo			break;
3914266472Shselasky		urtwn_ms_delay(sc);
3915251538Srpaulo	}
3916251538Srpaulo	if (ntries == 1000) {
3917251538Srpaulo		device_printf(sc->sc_dev,
3918251538Srpaulo		    "timeout waiting for checksum report\n");
3919251538Srpaulo		error = ETIMEDOUT;
3920251538Srpaulo		goto fail;
3921251538Srpaulo	}
3922251538Srpaulo
3923251538Srpaulo	reg = urtwn_read_4(sc, R92C_MCUFWDL);
3924251538Srpaulo	reg = (reg & ~R92C_MCUFWDL_WINTINI_RDY) | R92C_MCUFWDL_RDY;
3925251538Srpaulo	urtwn_write_4(sc, R92C_MCUFWDL, reg);
3926264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
3927264912Skevlo		urtwn_r88e_fw_reset(sc);
3928251538Srpaulo	/* Wait for firmware readiness. */
3929251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
3930251538Srpaulo		if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_WINTINI_RDY)
3931251538Srpaulo			break;
3932266472Shselasky		urtwn_ms_delay(sc);
3933251538Srpaulo	}
3934251538Srpaulo	if (ntries == 1000) {
3935251538Srpaulo		device_printf(sc->sc_dev,
3936251538Srpaulo		    "timeout waiting for firmware readiness\n");
3937251538Srpaulo		error = ETIMEDOUT;
3938251538Srpaulo		goto fail;
3939251538Srpaulo	}
3940251538Srpaulofail:
3941251538Srpaulo	firmware_put(fw, FIRMWARE_UNLOAD);
3942251538Srpaulo	return (error);
3943251538Srpaulo}
3944295871Savos#endif
3945251538Srpaulo
3946291902Skevlostatic int
3947251538Srpaulourtwn_dma_init(struct urtwn_softc *sc)
3948251538Srpaulo{
3949291902Skevlo	struct usb_endpoint *ep, *ep_end;
3950291698Savos	usb_error_t usb_err;
3951291902Skevlo	uint32_t reg;
3952291902Skevlo	int hashq, hasnq, haslq, nqueues, ntx;
3953291902Skevlo	int error, pagecount, npubqpages, nqpages, nrempages, tx_boundary;
3954281069Srpaulo
3955291695Savos	/* Initialize LLT table. */
3956291695Savos	error = urtwn_llt_init(sc);
3957291695Savos	if (error != 0)
3958291695Savos		return (error);
3959291695Savos
3960291902Skevlo	/* Determine the number of bulk-out pipes. */
3961291902Skevlo	ntx = 0;
3962291902Skevlo	ep = sc->sc_udev->endpoints;
3963291902Skevlo	ep_end = sc->sc_udev->endpoints + sc->sc_udev->endpoints_max;
3964291902Skevlo	for (; ep != ep_end; ep++) {
3965291902Skevlo		if ((ep->edesc == NULL) ||
3966291902Skevlo		    (ep->iface_index != sc->sc_iface_index))
3967291902Skevlo			continue;
3968291902Skevlo		if (UE_GET_DIR(ep->edesc->bEndpointAddress) == UE_DIR_OUT)
3969291902Skevlo			ntx++;
3970291902Skevlo	}
3971291902Skevlo	if (ntx == 0) {
3972291902Skevlo		device_printf(sc->sc_dev,
3973291902Skevlo		    "%d: invalid number of Tx bulk pipes\n", ntx);
3974291698Savos		return (EIO);
3975291902Skevlo	}
3976291695Savos
3977251538Srpaulo	/* Get Tx queues to USB endpoints mapping. */
3978291902Skevlo	hashq = hasnq = haslq = nqueues = 0;
3979291902Skevlo	switch (ntx) {
3980291902Skevlo	case 1: hashq = 1; break;
3981291902Skevlo	case 2: hashq = hasnq = 1; break;
3982291902Skevlo	case 3: case 4: hashq = hasnq = haslq = 1; break;
3983291902Skevlo	}
3984251538Srpaulo	nqueues = hashq + hasnq + haslq;
3985251538Srpaulo	if (nqueues == 0)
3986251538Srpaulo		return (EIO);
3987251538Srpaulo
3988291902Skevlo	npubqpages = nqpages = nrempages = pagecount = 0;
3989291902Skevlo	if (sc->chip & URTWN_CHIP_88E)
3990291902Skevlo		tx_boundary = R88E_TX_PAGE_BOUNDARY;
3991291902Skevlo	else {
3992291902Skevlo		pagecount = R92C_TX_PAGE_COUNT;
3993291902Skevlo		npubqpages = R92C_PUBQ_NPAGES;
3994291902Skevlo		tx_boundary = R92C_TX_PAGE_BOUNDARY;
3995291902Skevlo	}
3996291902Skevlo
3997251538Srpaulo	/* Set number of pages for normal priority queue. */
3998291902Skevlo	if (sc->chip & URTWN_CHIP_88E) {
3999291902Skevlo		usb_err = urtwn_write_2(sc, R92C_RQPN_NPQ, 0xd);
4000291902Skevlo		if (usb_err != USB_ERR_NORMAL_COMPLETION)
4001291902Skevlo			return (EIO);
4002291902Skevlo		usb_err = urtwn_write_4(sc, R92C_RQPN, 0x808e000d);
4003291902Skevlo		if (usb_err != USB_ERR_NORMAL_COMPLETION)
4004291902Skevlo			return (EIO);
4005291902Skevlo	} else {
4006291902Skevlo		/* Get the number of pages for each queue. */
4007291902Skevlo		nqpages = (pagecount - npubqpages) / nqueues;
4008291902Skevlo		/*
4009291902Skevlo		 * The remaining pages are assigned to the high priority
4010291902Skevlo		 * queue.
4011291902Skevlo		 */
4012291902Skevlo		nrempages = (pagecount - npubqpages) % nqueues;
4013291902Skevlo		usb_err = urtwn_write_1(sc, R92C_RQPN_NPQ, hasnq ? nqpages : 0);
4014291902Skevlo		if (usb_err != USB_ERR_NORMAL_COMPLETION)
4015291902Skevlo			return (EIO);
4016291902Skevlo		usb_err = urtwn_write_4(sc, R92C_RQPN,
4017291902Skevlo		    /* Set number of pages for public queue. */
4018291902Skevlo		    SM(R92C_RQPN_PUBQ, npubqpages) |
4019291902Skevlo		    /* Set number of pages for high priority queue. */
4020291902Skevlo		    SM(R92C_RQPN_HPQ, hashq ? nqpages + nrempages : 0) |
4021291902Skevlo		    /* Set number of pages for low priority queue. */
4022291902Skevlo		    SM(R92C_RQPN_LPQ, haslq ? nqpages : 0) |
4023291902Skevlo		    /* Load values. */
4024291902Skevlo		    R92C_RQPN_LD);
4025291902Skevlo		if (usb_err != USB_ERR_NORMAL_COMPLETION)
4026291902Skevlo			return (EIO);
4027291902Skevlo	}
4028251538Srpaulo
4029291902Skevlo	usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_BCNQ_BDNY, tx_boundary);
4030291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4031291698Savos		return (EIO);
4032291902Skevlo	usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_MGQ_BDNY, tx_boundary);
4033291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4034291698Savos		return (EIO);
4035291902Skevlo	usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_WMAC_LBK_BF_HD, tx_boundary);
4036291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4037291698Savos		return (EIO);
4038291902Skevlo	usb_err = urtwn_write_1(sc, R92C_TRXFF_BNDY, tx_boundary);
4039291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4040291698Savos		return (EIO);
4041291902Skevlo	usb_err = urtwn_write_1(sc, R92C_TDECTRL + 1, tx_boundary);
4042291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4043291698Savos		return (EIO);
4044251538Srpaulo
4045251538Srpaulo	/* Set queue to USB pipe mapping. */
4046251538Srpaulo	reg = urtwn_read_2(sc, R92C_TRXDMA_CTRL);
4047251538Srpaulo	reg &= ~R92C_TRXDMA_CTRL_QMAP_M;
4048251538Srpaulo	if (nqueues == 1) {
4049251538Srpaulo		if (hashq)
4050251538Srpaulo			reg |= R92C_TRXDMA_CTRL_QMAP_HQ;
4051251538Srpaulo		else if (hasnq)
4052251538Srpaulo			reg |= R92C_TRXDMA_CTRL_QMAP_NQ;
4053251538Srpaulo		else
4054251538Srpaulo			reg |= R92C_TRXDMA_CTRL_QMAP_LQ;
4055251538Srpaulo	} else if (nqueues == 2) {
4056292056Skevlo		/*
4057292056Skevlo		 * All 2-endpoints configs have high and normal
4058292056Skevlo		 * priority queues.
4059292056Skevlo		 */
4060292056Skevlo		reg |= R92C_TRXDMA_CTRL_QMAP_HQ_NQ;
4061251538Srpaulo	} else
4062251538Srpaulo		reg |= R92C_TRXDMA_CTRL_QMAP_3EP;
4063291902Skevlo	usb_err = urtwn_write_2(sc, R92C_TRXDMA_CTRL, reg);
4064291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4065291698Savos		return (EIO);
4066251538Srpaulo
4067251538Srpaulo	/* Set Tx/Rx transfer page boundary. */
4068291902Skevlo	usb_err = urtwn_write_2(sc, R92C_TRXFF_BNDY + 2,
4069291902Skevlo	    (sc->chip & URTWN_CHIP_88E) ? 0x23ff : 0x27ff);
4070291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4071291698Savos		return (EIO);
4072251538Srpaulo
4073291902Skevlo	/* Set Tx/Rx transfer page size. */
4074291902Skevlo	usb_err = urtwn_write_1(sc, R92C_PBP,
4075291902Skevlo	    SM(R92C_PBP_PSRX, R92C_PBP_128) |
4076291902Skevlo	    SM(R92C_PBP_PSTX, R92C_PBP_128));
4077291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4078264912Skevlo		return (EIO);
4079264912Skevlo
4080264912Skevlo	return (0);
4081264912Skevlo}
4082264912Skevlo
4083291698Savosstatic int
4084251538Srpaulourtwn_mac_init(struct urtwn_softc *sc)
4085251538Srpaulo{
4086291698Savos	usb_error_t error;
4087251538Srpaulo	int i;
4088251538Srpaulo
4089251538Srpaulo	/* Write MAC initialization values. */
4090264912Skevlo	if (sc->chip & URTWN_CHIP_88E) {
4091264912Skevlo		for (i = 0; i < nitems(rtl8188eu_mac); i++) {
4092291698Savos			error = urtwn_write_1(sc, rtl8188eu_mac[i].reg,
4093264912Skevlo			    rtl8188eu_mac[i].val);
4094291698Savos			if (error != USB_ERR_NORMAL_COMPLETION)
4095291698Savos				return (EIO);
4096264912Skevlo		}
4097264912Skevlo		urtwn_write_1(sc, R92C_MAX_AGGR_NUM, 0x07);
4098264912Skevlo	} else {
4099264912Skevlo		for (i = 0; i < nitems(rtl8192cu_mac); i++)
4100291698Savos			error = urtwn_write_1(sc, rtl8192cu_mac[i].reg,
4101264912Skevlo			    rtl8192cu_mac[i].val);
4102291698Savos			if (error != USB_ERR_NORMAL_COMPLETION)
4103291698Savos				return (EIO);
4104264912Skevlo	}
4105291698Savos
4106291698Savos	return (0);
4107251538Srpaulo}
4108251538Srpaulo
4109251538Srpaulostatic void
4110251538Srpaulourtwn_bb_init(struct urtwn_softc *sc)
4111251538Srpaulo{
4112251538Srpaulo	const struct urtwn_bb_prog *prog;
4113251538Srpaulo	uint32_t reg;
4114264912Skevlo	uint8_t crystalcap;
4115251538Srpaulo	int i;
4116251538Srpaulo
4117251538Srpaulo	/* Enable BB and RF. */
4118251538Srpaulo	urtwn_write_2(sc, R92C_SYS_FUNC_EN,
4119251538Srpaulo	    urtwn_read_2(sc, R92C_SYS_FUNC_EN) |
4120251538Srpaulo	    R92C_SYS_FUNC_EN_BBRSTB | R92C_SYS_FUNC_EN_BB_GLB_RST |
4121251538Srpaulo	    R92C_SYS_FUNC_EN_DIO_RF);
4122251538Srpaulo
4123264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E))
4124264912Skevlo		urtwn_write_2(sc, R92C_AFE_PLL_CTRL, 0xdb83);
4125251538Srpaulo
4126251538Srpaulo	urtwn_write_1(sc, R92C_RF_CTRL,
4127251538Srpaulo	    R92C_RF_CTRL_EN | R92C_RF_CTRL_RSTB | R92C_RF_CTRL_SDMRSTB);
4128251538Srpaulo	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
4129251538Srpaulo	    R92C_SYS_FUNC_EN_USBA | R92C_SYS_FUNC_EN_USBD |
4130251538Srpaulo	    R92C_SYS_FUNC_EN_BB_GLB_RST | R92C_SYS_FUNC_EN_BBRSTB);
4131251538Srpaulo
4132264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
4133264912Skevlo		urtwn_write_1(sc, R92C_LDOHCI12_CTRL, 0x0f);
4134264912Skevlo		urtwn_write_1(sc, 0x15, 0xe9);
4135264912Skevlo		urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 1, 0x80);
4136264912Skevlo	}
4137251538Srpaulo
4138251538Srpaulo	/* Select BB programming based on board type. */
4139264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
4140264912Skevlo		prog = &rtl8188eu_bb_prog;
4141264912Skevlo	else if (!(sc->chip & URTWN_CHIP_92C)) {
4142251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_MINICARD)
4143251538Srpaulo			prog = &rtl8188ce_bb_prog;
4144251538Srpaulo		else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA)
4145251538Srpaulo			prog = &rtl8188ru_bb_prog;
4146251538Srpaulo		else
4147251538Srpaulo			prog = &rtl8188cu_bb_prog;
4148251538Srpaulo	} else {
4149251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_MINICARD)
4150251538Srpaulo			prog = &rtl8192ce_bb_prog;
4151251538Srpaulo		else
4152251538Srpaulo			prog = &rtl8192cu_bb_prog;
4153251538Srpaulo	}
4154251538Srpaulo	/* Write BB initialization values. */
4155251538Srpaulo	for (i = 0; i < prog->count; i++) {
4156251538Srpaulo		urtwn_bb_write(sc, prog->regs[i], prog->vals[i]);
4157266472Shselasky		urtwn_ms_delay(sc);
4158251538Srpaulo	}
4159251538Srpaulo
4160251538Srpaulo	if (sc->chip & URTWN_CHIP_92C_1T2R) {
4161251538Srpaulo		/* 8192C 1T only configuration. */
4162251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_TXINFO);
4163251538Srpaulo		reg = (reg & ~0x00000003) | 0x2;
4164251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_TXINFO, reg);
4165251538Srpaulo
4166251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA1_TXINFO);
4167251538Srpaulo		reg = (reg & ~0x00300033) | 0x00200022;
4168251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA1_TXINFO, reg);
4169251538Srpaulo
4170251538Srpaulo		reg = urtwn_bb_read(sc, R92C_CCK0_AFESETTING);
4171251538Srpaulo		reg = (reg & ~0xff000000) | 0x45 << 24;
4172251538Srpaulo		urtwn_bb_write(sc, R92C_CCK0_AFESETTING, reg);
4173251538Srpaulo
4174251538Srpaulo		reg = urtwn_bb_read(sc, R92C_OFDM0_TRXPATHENA);
4175251538Srpaulo		reg = (reg & ~0x000000ff) | 0x23;
4176251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM0_TRXPATHENA, reg);
4177251538Srpaulo
4178251538Srpaulo		reg = urtwn_bb_read(sc, R92C_OFDM0_AGCPARAM1);
4179251538Srpaulo		reg = (reg & ~0x00000030) | 1 << 4;
4180251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM0_AGCPARAM1, reg);
4181251538Srpaulo
4182251538Srpaulo		reg = urtwn_bb_read(sc, 0xe74);
4183251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
4184251538Srpaulo		urtwn_bb_write(sc, 0xe74, reg);
4185251538Srpaulo		reg = urtwn_bb_read(sc, 0xe78);
4186251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
4187251538Srpaulo		urtwn_bb_write(sc, 0xe78, reg);
4188251538Srpaulo		reg = urtwn_bb_read(sc, 0xe7c);
4189251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
4190251538Srpaulo		urtwn_bb_write(sc, 0xe7c, reg);
4191251538Srpaulo		reg = urtwn_bb_read(sc, 0xe80);
4192251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
4193251538Srpaulo		urtwn_bb_write(sc, 0xe80, reg);
4194251538Srpaulo		reg = urtwn_bb_read(sc, 0xe88);
4195251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
4196251538Srpaulo		urtwn_bb_write(sc, 0xe88, reg);
4197251538Srpaulo	}
4198251538Srpaulo
4199251538Srpaulo	/* Write AGC values. */
4200251538Srpaulo	for (i = 0; i < prog->agccount; i++) {
4201251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM0_AGCRSSITABLE,
4202251538Srpaulo		    prog->agcvals[i]);
4203266472Shselasky		urtwn_ms_delay(sc);
4204251538Srpaulo	}
4205251538Srpaulo
4206264912Skevlo	if (sc->chip & URTWN_CHIP_88E) {
4207264912Skevlo		urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553422);
4208266472Shselasky		urtwn_ms_delay(sc);
4209264912Skevlo		urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553420);
4210266472Shselasky		urtwn_ms_delay(sc);
4211264912Skevlo
4212294198Savos		crystalcap = sc->rom.r88e_rom.crystalcap;
4213264912Skevlo		if (crystalcap == 0xff)
4214264912Skevlo			crystalcap = 0x20;
4215264912Skevlo		crystalcap &= 0x3f;
4216264912Skevlo		reg = urtwn_bb_read(sc, R92C_AFE_XTAL_CTRL);
4217264912Skevlo		urtwn_bb_write(sc, R92C_AFE_XTAL_CTRL,
4218264912Skevlo		    RW(reg, R92C_AFE_XTAL_CTRL_ADDR,
4219264912Skevlo		    crystalcap | crystalcap << 6));
4220264912Skevlo	} else {
4221264912Skevlo		if (urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)) &
4222264912Skevlo		    R92C_HSSI_PARAM2_CCK_HIPWR)
4223264912Skevlo			sc->sc_flags |= URTWN_FLAG_CCK_HIPWR;
4224264912Skevlo	}
4225251538Srpaulo}
4226251538Srpaulo
4227289066Skevlostatic void
4228251538Srpaulourtwn_rf_init(struct urtwn_softc *sc)
4229251538Srpaulo{
4230251538Srpaulo	const struct urtwn_rf_prog *prog;
4231251538Srpaulo	uint32_t reg, type;
4232251538Srpaulo	int i, j, idx, off;
4233251538Srpaulo
4234251538Srpaulo	/* Select RF programming based on board type. */
4235264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
4236264912Skevlo		prog = rtl8188eu_rf_prog;
4237264912Skevlo	else if (!(sc->chip & URTWN_CHIP_92C)) {
4238251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_MINICARD)
4239251538Srpaulo			prog = rtl8188ce_rf_prog;
4240251538Srpaulo		else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA)
4241251538Srpaulo			prog = rtl8188ru_rf_prog;
4242251538Srpaulo		else
4243251538Srpaulo			prog = rtl8188cu_rf_prog;
4244251538Srpaulo	} else
4245251538Srpaulo		prog = rtl8192ce_rf_prog;
4246251538Srpaulo
4247251538Srpaulo	for (i = 0; i < sc->nrxchains; i++) {
4248251538Srpaulo		/* Save RF_ENV control type. */
4249251538Srpaulo		idx = i / 2;
4250251538Srpaulo		off = (i % 2) * 16;
4251251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx));
4252251538Srpaulo		type = (reg >> off) & 0x10;
4253251538Srpaulo
4254251538Srpaulo		/* Set RF_ENV enable. */
4255251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i));
4256251538Srpaulo		reg |= 0x100000;
4257251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg);
4258266472Shselasky		urtwn_ms_delay(sc);
4259251538Srpaulo		/* Set RF_ENV output high. */
4260251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i));
4261251538Srpaulo		reg |= 0x10;
4262251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg);
4263266472Shselasky		urtwn_ms_delay(sc);
4264251538Srpaulo		/* Set address and data lengths of RF registers. */
4265251538Srpaulo		reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i));
4266251538Srpaulo		reg &= ~R92C_HSSI_PARAM2_ADDR_LENGTH;
4267251538Srpaulo		urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg);
4268266472Shselasky		urtwn_ms_delay(sc);
4269251538Srpaulo		reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i));
4270251538Srpaulo		reg &= ~R92C_HSSI_PARAM2_DATA_LENGTH;
4271251538Srpaulo		urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg);
4272266472Shselasky		urtwn_ms_delay(sc);
4273251538Srpaulo
4274251538Srpaulo		/* Write RF initialization values for this chain. */
4275251538Srpaulo		for (j = 0; j < prog[i].count; j++) {
4276251538Srpaulo			if (prog[i].regs[j] >= 0xf9 &&
4277251538Srpaulo			    prog[i].regs[j] <= 0xfe) {
4278251538Srpaulo				/*
4279251538Srpaulo				 * These are fake RF registers offsets that
4280251538Srpaulo				 * indicate a delay is required.
4281251538Srpaulo				 */
4282266472Shselasky				usb_pause_mtx(&sc->sc_mtx, hz / 20);	/* 50ms */
4283251538Srpaulo				continue;
4284251538Srpaulo			}
4285251538Srpaulo			urtwn_rf_write(sc, i, prog[i].regs[j],
4286251538Srpaulo			    prog[i].vals[j]);
4287266472Shselasky			urtwn_ms_delay(sc);
4288251538Srpaulo		}
4289251538Srpaulo
4290251538Srpaulo		/* Restore RF_ENV control type. */
4291251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx));
4292251538Srpaulo		reg &= ~(0x10 << off) | (type << off);
4293251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFIFACESW(idx), reg);
4294251538Srpaulo
4295251538Srpaulo		/* Cache RF register CHNLBW. */
4296251538Srpaulo		sc->rf_chnlbw[i] = urtwn_rf_read(sc, i, R92C_RF_CHNLBW);
4297251538Srpaulo	}
4298251538Srpaulo
4299251538Srpaulo	if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) ==
4300251538Srpaulo	    URTWN_CHIP_UMC_A_CUT) {
4301251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_RX_G1, 0x30255);
4302251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_RX_G2, 0x50a00);
4303251538Srpaulo	}
4304251538Srpaulo}
4305251538Srpaulo
4306251538Srpaulostatic void
4307251538Srpaulourtwn_cam_init(struct urtwn_softc *sc)
4308251538Srpaulo{
4309251538Srpaulo	/* Invalidate all CAM entries. */
4310251538Srpaulo	urtwn_write_4(sc, R92C_CAMCMD,
4311251538Srpaulo	    R92C_CAMCMD_POLLING | R92C_CAMCMD_CLR);
4312251538Srpaulo}
4313251538Srpaulo
4314292175Savosstatic int
4315292175Savosurtwn_cam_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data)
4316292175Savos{
4317292175Savos	usb_error_t error;
4318292175Savos
4319292175Savos	error = urtwn_write_4(sc, R92C_CAMWRITE, data);
4320292175Savos	if (error != USB_ERR_NORMAL_COMPLETION)
4321292175Savos		return (EIO);
4322292175Savos	error = urtwn_write_4(sc, R92C_CAMCMD,
4323292175Savos	    R92C_CAMCMD_POLLING | R92C_CAMCMD_WRITE |
4324292175Savos	    SM(R92C_CAMCMD_ADDR, addr));
4325292175Savos	if (error != USB_ERR_NORMAL_COMPLETION)
4326292175Savos		return (EIO);
4327292175Savos
4328292175Savos	return (0);
4329292175Savos}
4330292175Savos
4331251538Srpaulostatic void
4332251538Srpaulourtwn_pa_bias_init(struct urtwn_softc *sc)
4333251538Srpaulo{
4334251538Srpaulo	uint8_t reg;
4335251538Srpaulo	int i;
4336251538Srpaulo
4337251538Srpaulo	for (i = 0; i < sc->nrxchains; i++) {
4338251538Srpaulo		if (sc->pa_setting & (1 << i))
4339251538Srpaulo			continue;
4340251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0x0f406);
4341251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0x4f406);
4342251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0x8f406);
4343251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0xcf406);
4344251538Srpaulo	}
4345251538Srpaulo	if (!(sc->pa_setting & 0x10)) {
4346251538Srpaulo		reg = urtwn_read_1(sc, 0x16);
4347251538Srpaulo		reg = (reg & ~0xf0) | 0x90;
4348251538Srpaulo		urtwn_write_1(sc, 0x16, reg);
4349251538Srpaulo	}
4350251538Srpaulo}
4351251538Srpaulo
4352251538Srpaulostatic void
4353251538Srpaulourtwn_rxfilter_init(struct urtwn_softc *sc)
4354251538Srpaulo{
4355290564Savos	struct ieee80211com *ic = &sc->sc_ic;
4356290564Savos	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
4357290564Savos	uint32_t rcr;
4358290564Savos	uint16_t filter;
4359290564Savos
4360290564Savos	URTWN_ASSERT_LOCKED(sc);
4361290564Savos
4362251538Srpaulo	/* Accept all multicast frames. */
4363251538Srpaulo	urtwn_write_4(sc, R92C_MAR + 0, 0xffffffff);
4364251538Srpaulo	urtwn_write_4(sc, R92C_MAR + 4, 0xffffffff);
4365290564Savos
4366290564Savos	/* Filter for management frames. */
4367290564Savos	filter = 0x7f3f;
4368290631Savos	switch (vap->iv_opmode) {
4369290631Savos	case IEEE80211_M_STA:
4370290564Savos		filter &= ~(
4371290564Savos		    R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_ASSOC_REQ) |
4372290564Savos		    R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_REASSOC_REQ) |
4373290564Savos		    R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_PROBE_REQ));
4374290631Savos		break;
4375290631Savos	case IEEE80211_M_HOSTAP:
4376290631Savos		filter &= ~(
4377290631Savos		    R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_ASSOC_RESP) |
4378296174Savos		    R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_REASSOC_RESP));
4379290631Savos		break;
4380290631Savos	case IEEE80211_M_MONITOR:
4381290651Savos	case IEEE80211_M_IBSS:
4382290631Savos		break;
4383290631Savos	default:
4384290631Savos		device_printf(sc->sc_dev, "%s: undefined opmode %d\n",
4385290631Savos		    __func__, vap->iv_opmode);
4386290631Savos		break;
4387290564Savos	}
4388290564Savos	urtwn_write_2(sc, R92C_RXFLTMAP0, filter);
4389290564Savos
4390251538Srpaulo	/* Reject all control frames. */
4391251538Srpaulo	urtwn_write_2(sc, R92C_RXFLTMAP1, 0x0000);
4392290564Savos
4393290564Savos	/* Reject all data frames. */
4394290564Savos	urtwn_write_2(sc, R92C_RXFLTMAP2, 0x0000);
4395290564Savos
4396290564Savos	rcr = R92C_RCR_AM | R92C_RCR_AB | R92C_RCR_APM |
4397290564Savos	      R92C_RCR_HTC_LOC_CTRL | R92C_RCR_APP_PHYSTS |
4398290564Savos	      R92C_RCR_APP_ICV | R92C_RCR_APP_MIC;
4399290564Savos
4400290564Savos	if (vap->iv_opmode == IEEE80211_M_MONITOR) {
4401290564Savos		/* Accept all frames. */
4402290564Savos		rcr |= R92C_RCR_ACF | R92C_RCR_ADF | R92C_RCR_AMF |
4403290564Savos		       R92C_RCR_AAP;
4404290564Savos	}
4405290564Savos
4406290564Savos	/* Set Rx filter. */
4407290564Savos	urtwn_write_4(sc, R92C_RCR, rcr);
4408290564Savos
4409290564Savos	if (ic->ic_promisc != 0) {
4410290564Savos		/* Update Rx filter. */
4411290564Savos		urtwn_set_promisc(sc);
4412290564Savos	}
4413251538Srpaulo}
4414251538Srpaulo
4415251538Srpaulostatic void
4416251538Srpaulourtwn_edca_init(struct urtwn_softc *sc)
4417251538Srpaulo{
4418251538Srpaulo	urtwn_write_2(sc, R92C_SPEC_SIFS, 0x100a);
4419251538Srpaulo	urtwn_write_2(sc, R92C_MAC_SPEC_SIFS, 0x100a);
4420251538Srpaulo	urtwn_write_2(sc, R92C_SIFS_CCK, 0x100a);
4421251538Srpaulo	urtwn_write_2(sc, R92C_SIFS_OFDM, 0x100a);
4422251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x005ea42b);
4423251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a44f);
4424251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005ea324);
4425251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002fa226);
4426251538Srpaulo}
4427251538Srpaulo
4428289066Skevlostatic void
4429251538Srpaulourtwn_write_txpower(struct urtwn_softc *sc, int chain,
4430251538Srpaulo    uint16_t power[URTWN_RIDX_COUNT])
4431251538Srpaulo{
4432251538Srpaulo	uint32_t reg;
4433251538Srpaulo
4434251538Srpaulo	/* Write per-CCK rate Tx power. */
4435251538Srpaulo	if (chain == 0) {
4436251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_A_CCK1_MCS32);
4437251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK1,  power[0]);
4438251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_A_CCK1_MCS32, reg);
4439251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11);
4440251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK2,  power[1]);
4441251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK55, power[2]);
4442251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK11, power[3]);
4443251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg);
4444251538Srpaulo	} else {
4445251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK1_55_MCS32);
4446251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK1,  power[0]);
4447251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK2,  power[1]);
4448251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK55, power[2]);
4449251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_B_CCK1_55_MCS32, reg);
4450251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11);
4451251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK11, power[3]);
4452251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg);
4453251538Srpaulo	}
4454251538Srpaulo	/* Write per-OFDM rate Tx power. */
4455251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_RATE18_06(chain),
4456251538Srpaulo	    SM(R92C_TXAGC_RATE06, power[ 4]) |
4457251538Srpaulo	    SM(R92C_TXAGC_RATE09, power[ 5]) |
4458251538Srpaulo	    SM(R92C_TXAGC_RATE12, power[ 6]) |
4459251538Srpaulo	    SM(R92C_TXAGC_RATE18, power[ 7]));
4460251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_RATE54_24(chain),
4461251538Srpaulo	    SM(R92C_TXAGC_RATE24, power[ 8]) |
4462251538Srpaulo	    SM(R92C_TXAGC_RATE36, power[ 9]) |
4463251538Srpaulo	    SM(R92C_TXAGC_RATE48, power[10]) |
4464251538Srpaulo	    SM(R92C_TXAGC_RATE54, power[11]));
4465251538Srpaulo	/* Write per-MCS Tx power. */
4466251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS03_MCS00(chain),
4467251538Srpaulo	    SM(R92C_TXAGC_MCS00,  power[12]) |
4468251538Srpaulo	    SM(R92C_TXAGC_MCS01,  power[13]) |
4469251538Srpaulo	    SM(R92C_TXAGC_MCS02,  power[14]) |
4470251538Srpaulo	    SM(R92C_TXAGC_MCS03,  power[15]));
4471251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS07_MCS04(chain),
4472251538Srpaulo	    SM(R92C_TXAGC_MCS04,  power[16]) |
4473251538Srpaulo	    SM(R92C_TXAGC_MCS05,  power[17]) |
4474251538Srpaulo	    SM(R92C_TXAGC_MCS06,  power[18]) |
4475251538Srpaulo	    SM(R92C_TXAGC_MCS07,  power[19]));
4476251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS11_MCS08(chain),
4477251538Srpaulo	    SM(R92C_TXAGC_MCS08,  power[20]) |
4478261506Skevlo	    SM(R92C_TXAGC_MCS09,  power[21]) |
4479251538Srpaulo	    SM(R92C_TXAGC_MCS10,  power[22]) |
4480251538Srpaulo	    SM(R92C_TXAGC_MCS11,  power[23]));
4481251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS15_MCS12(chain),
4482251538Srpaulo	    SM(R92C_TXAGC_MCS12,  power[24]) |
4483251538Srpaulo	    SM(R92C_TXAGC_MCS13,  power[25]) |
4484251538Srpaulo	    SM(R92C_TXAGC_MCS14,  power[26]) |
4485251538Srpaulo	    SM(R92C_TXAGC_MCS15,  power[27]));
4486251538Srpaulo}
4487251538Srpaulo
4488289066Skevlostatic void
4489251538Srpaulourtwn_get_txpower(struct urtwn_softc *sc, int chain,
4490251538Srpaulo    struct ieee80211_channel *c, struct ieee80211_channel *extc,
4491251538Srpaulo    uint16_t power[URTWN_RIDX_COUNT])
4492251538Srpaulo{
4493287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
4494291264Savos	struct r92c_rom *rom = &sc->rom.r92c_rom;
4495251538Srpaulo	uint16_t cckpow, ofdmpow, htpow, diff, max;
4496251538Srpaulo	const struct urtwn_txpwr *base;
4497251538Srpaulo	int ridx, chan, group;
4498251538Srpaulo
4499251538Srpaulo	/* Determine channel group. */
4500251538Srpaulo	chan = ieee80211_chan2ieee(ic, c);	/* XXX center freq! */
4501251538Srpaulo	if (chan <= 3)
4502251538Srpaulo		group = 0;
4503251538Srpaulo	else if (chan <= 9)
4504251538Srpaulo		group = 1;
4505251538Srpaulo	else
4506251538Srpaulo		group = 2;
4507251538Srpaulo
4508251538Srpaulo	/* Get original Tx power based on board type and RF chain. */
4509251538Srpaulo	if (!(sc->chip & URTWN_CHIP_92C)) {
4510251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_HIGHPA)
4511251538Srpaulo			base = &rtl8188ru_txagc[chain];
4512251538Srpaulo		else
4513251538Srpaulo			base = &rtl8192cu_txagc[chain];
4514251538Srpaulo	} else
4515251538Srpaulo		base = &rtl8192cu_txagc[chain];
4516251538Srpaulo
4517251538Srpaulo	memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0]));
4518251538Srpaulo	if (sc->regulatory == 0) {
4519289758Savos		for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++)
4520251538Srpaulo			power[ridx] = base->pwr[0][ridx];
4521251538Srpaulo	}
4522289758Savos	for (ridx = URTWN_RIDX_OFDM6; ridx < URTWN_RIDX_COUNT; ridx++) {
4523251538Srpaulo		if (sc->regulatory == 3) {
4524251538Srpaulo			power[ridx] = base->pwr[0][ridx];
4525251538Srpaulo			/* Apply vendor limits. */
4526251538Srpaulo			if (extc != NULL)
4527251538Srpaulo				max = rom->ht40_max_pwr[group];
4528251538Srpaulo			else
4529251538Srpaulo				max = rom->ht20_max_pwr[group];
4530251538Srpaulo			max = (max >> (chain * 4)) & 0xf;
4531251538Srpaulo			if (power[ridx] > max)
4532251538Srpaulo				power[ridx] = max;
4533251538Srpaulo		} else if (sc->regulatory == 1) {
4534251538Srpaulo			if (extc == NULL)
4535251538Srpaulo				power[ridx] = base->pwr[group][ridx];
4536251538Srpaulo		} else if (sc->regulatory != 2)
4537251538Srpaulo			power[ridx] = base->pwr[0][ridx];
4538251538Srpaulo	}
4539251538Srpaulo
4540251538Srpaulo	/* Compute per-CCK rate Tx power. */
4541251538Srpaulo	cckpow = rom->cck_tx_pwr[chain][group];
4542289758Savos	for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) {
4543251538Srpaulo		power[ridx] += cckpow;
4544251538Srpaulo		if (power[ridx] > R92C_MAX_TX_PWR)
4545251538Srpaulo			power[ridx] = R92C_MAX_TX_PWR;
4546251538Srpaulo	}
4547251538Srpaulo
4548251538Srpaulo	htpow = rom->ht40_1s_tx_pwr[chain][group];
4549251538Srpaulo	if (sc->ntxchains > 1) {
4550251538Srpaulo		/* Apply reduction for 2 spatial streams. */
4551251538Srpaulo		diff = rom->ht40_2s_tx_pwr_diff[group];
4552251538Srpaulo		diff = (diff >> (chain * 4)) & 0xf;
4553251538Srpaulo		htpow = (htpow > diff) ? htpow - diff : 0;
4554251538Srpaulo	}
4555251538Srpaulo
4556251538Srpaulo	/* Compute per-OFDM rate Tx power. */
4557251538Srpaulo	diff = rom->ofdm_tx_pwr_diff[group];
4558251538Srpaulo	diff = (diff >> (chain * 4)) & 0xf;
4559251538Srpaulo	ofdmpow = htpow + diff;	/* HT->OFDM correction. */
4560289758Savos	for (ridx = URTWN_RIDX_OFDM6; ridx <= URTWN_RIDX_OFDM54; ridx++) {
4561251538Srpaulo		power[ridx] += ofdmpow;
4562251538Srpaulo		if (power[ridx] > R92C_MAX_TX_PWR)
4563251538Srpaulo			power[ridx] = R92C_MAX_TX_PWR;
4564251538Srpaulo	}
4565251538Srpaulo
4566251538Srpaulo	/* Compute per-MCS Tx power. */
4567251538Srpaulo	if (extc == NULL) {
4568251538Srpaulo		diff = rom->ht20_tx_pwr_diff[group];
4569251538Srpaulo		diff = (diff >> (chain * 4)) & 0xf;
4570251538Srpaulo		htpow += diff;	/* HT40->HT20 correction. */
4571251538Srpaulo	}
4572251538Srpaulo	for (ridx = 12; ridx <= 27; ridx++) {
4573251538Srpaulo		power[ridx] += htpow;
4574251538Srpaulo		if (power[ridx] > R92C_MAX_TX_PWR)
4575251538Srpaulo			power[ridx] = R92C_MAX_TX_PWR;
4576251538Srpaulo	}
4577294471Savos#ifdef USB_DEBUG
4578294471Savos	if (sc->sc_debug & URTWN_DEBUG_TXPWR) {
4579251538Srpaulo		/* Dump per-rate Tx power values. */
4580251538Srpaulo		printf("Tx power for chain %d:\n", chain);
4581289758Savos		for (ridx = URTWN_RIDX_CCK1; ridx < URTWN_RIDX_COUNT; ridx++)
4582251538Srpaulo			printf("Rate %d = %u\n", ridx, power[ridx]);
4583251538Srpaulo	}
4584251538Srpaulo#endif
4585251538Srpaulo}
4586251538Srpaulo
4587289066Skevlostatic void
4588264912Skevlourtwn_r88e_get_txpower(struct urtwn_softc *sc, int chain,
4589264912Skevlo    struct ieee80211_channel *c, struct ieee80211_channel *extc,
4590264912Skevlo    uint16_t power[URTWN_RIDX_COUNT])
4591264912Skevlo{
4592287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
4593294198Savos	struct r88e_rom *rom = &sc->rom.r88e_rom;
4594264912Skevlo	uint16_t cckpow, ofdmpow, bw20pow, htpow;
4595264912Skevlo	const struct urtwn_r88e_txpwr *base;
4596264912Skevlo	int ridx, chan, group;
4597264912Skevlo
4598264912Skevlo	/* Determine channel group. */
4599264912Skevlo	chan = ieee80211_chan2ieee(ic, c);	/* XXX center freq! */
4600264912Skevlo	if (chan <= 2)
4601264912Skevlo		group = 0;
4602264912Skevlo	else if (chan <= 5)
4603264912Skevlo		group = 1;
4604264912Skevlo	else if (chan <= 8)
4605264912Skevlo		group = 2;
4606264912Skevlo	else if (chan <= 11)
4607264912Skevlo		group = 3;
4608264912Skevlo	else if (chan <= 13)
4609264912Skevlo		group = 4;
4610264912Skevlo	else
4611264912Skevlo		group = 5;
4612264912Skevlo
4613264912Skevlo	/* Get original Tx power based on board type and RF chain. */
4614264912Skevlo	base = &rtl8188eu_txagc[chain];
4615264912Skevlo
4616264912Skevlo	memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0]));
4617264912Skevlo	if (sc->regulatory == 0) {
4618289758Savos		for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++)
4619264912Skevlo			power[ridx] = base->pwr[0][ridx];
4620264912Skevlo	}
4621289758Savos	for (ridx = URTWN_RIDX_OFDM6; ridx < URTWN_RIDX_COUNT; ridx++) {
4622264912Skevlo		if (sc->regulatory == 3)
4623264912Skevlo			power[ridx] = base->pwr[0][ridx];
4624264912Skevlo		else if (sc->regulatory == 1) {
4625264912Skevlo			if (extc == NULL)
4626264912Skevlo				power[ridx] = base->pwr[group][ridx];
4627264912Skevlo		} else if (sc->regulatory != 2)
4628264912Skevlo			power[ridx] = base->pwr[0][ridx];
4629264912Skevlo	}
4630264912Skevlo
4631264912Skevlo	/* Compute per-CCK rate Tx power. */
4632294198Savos	cckpow = rom->cck_tx_pwr[group];
4633289758Savos	for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) {
4634264912Skevlo		power[ridx] += cckpow;
4635264912Skevlo		if (power[ridx] > R92C_MAX_TX_PWR)
4636264912Skevlo			power[ridx] = R92C_MAX_TX_PWR;
4637264912Skevlo	}
4638264912Skevlo
4639294198Savos	htpow = rom->ht40_tx_pwr[group];
4640264912Skevlo
4641264912Skevlo	/* Compute per-OFDM rate Tx power. */
4642264912Skevlo	ofdmpow = htpow + sc->ofdm_tx_pwr_diff;
4643289758Savos	for (ridx = URTWN_RIDX_OFDM6; ridx <= URTWN_RIDX_OFDM54; ridx++) {
4644264912Skevlo		power[ridx] += ofdmpow;
4645264912Skevlo		if (power[ridx] > R92C_MAX_TX_PWR)
4646264912Skevlo			power[ridx] = R92C_MAX_TX_PWR;
4647264912Skevlo	}
4648264912Skevlo
4649264912Skevlo	bw20pow = htpow + sc->bw20_tx_pwr_diff;
4650264912Skevlo	for (ridx = 12; ridx <= 27; ridx++) {
4651264912Skevlo		power[ridx] += bw20pow;
4652264912Skevlo		if (power[ridx] > R92C_MAX_TX_PWR)
4653264912Skevlo			power[ridx] = R92C_MAX_TX_PWR;
4654264912Skevlo	}
4655264912Skevlo}
4656264912Skevlo
4657289066Skevlostatic void
4658251538Srpaulourtwn_set_txpower(struct urtwn_softc *sc, struct ieee80211_channel *c,
4659251538Srpaulo    struct ieee80211_channel *extc)
4660251538Srpaulo{
4661251538Srpaulo	uint16_t power[URTWN_RIDX_COUNT];
4662251538Srpaulo	int i;
4663251538Srpaulo
4664251538Srpaulo	for (i = 0; i < sc->ntxchains; i++) {
4665251538Srpaulo		/* Compute per-rate Tx power values. */
4666264912Skevlo		if (sc->chip & URTWN_CHIP_88E)
4667264912Skevlo			urtwn_r88e_get_txpower(sc, i, c, extc, power);
4668264912Skevlo		else
4669264912Skevlo			urtwn_get_txpower(sc, i, c, extc, power);
4670251538Srpaulo		/* Write per-rate Tx power values to hardware. */
4671251538Srpaulo		urtwn_write_txpower(sc, i, power);
4672251538Srpaulo	}
4673251538Srpaulo}
4674251538Srpaulo
4675251538Srpaulostatic void
4676290048Savosurtwn_set_rx_bssid_all(struct urtwn_softc *sc, int enable)
4677290048Savos{
4678290048Savos	uint32_t reg;
4679290048Savos
4680290048Savos	reg = urtwn_read_4(sc, R92C_RCR);
4681290048Savos	if (enable)
4682290048Savos		reg &= ~R92C_RCR_CBSSID_BCN;
4683290048Savos	else
4684290048Savos		reg |= R92C_RCR_CBSSID_BCN;
4685290048Savos	urtwn_write_4(sc, R92C_RCR, reg);
4686290048Savos}
4687290048Savos
4688290048Savosstatic void
4689290048Savosurtwn_set_gain(struct urtwn_softc *sc, uint8_t gain)
4690290048Savos{
4691290048Savos	uint32_t reg;
4692290048Savos
4693290048Savos	reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0));
4694290048Savos	reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, gain);
4695290048Savos	urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg);
4696290048Savos
4697290048Savos	if (!(sc->chip & URTWN_CHIP_88E)) {
4698290048Savos		reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1));
4699290048Savos		reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, gain);
4700290048Savos		urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg);
4701290048Savos	}
4702290048Savos}
4703290048Savos
4704290048Savosstatic void
4705251538Srpaulourtwn_scan_start(struct ieee80211com *ic)
4706251538Srpaulo{
4707290048Savos	struct urtwn_softc *sc = ic->ic_softc;
4708290048Savos
4709290048Savos	URTWN_LOCK(sc);
4710290048Savos	/* Receive beacons / probe responses from any BSSID. */
4711290651Savos	if (ic->ic_opmode != IEEE80211_M_IBSS)
4712290651Savos		urtwn_set_rx_bssid_all(sc, 1);
4713290651Savos
4714290048Savos	/* Set gain for scanning. */
4715290048Savos	urtwn_set_gain(sc, 0x20);
4716290048Savos	URTWN_UNLOCK(sc);
4717251538Srpaulo}
4718251538Srpaulo
4719251538Srpaulostatic void
4720251538Srpaulourtwn_scan_end(struct ieee80211com *ic)
4721251538Srpaulo{
4722290048Savos	struct urtwn_softc *sc = ic->ic_softc;
4723290048Savos
4724290048Savos	URTWN_LOCK(sc);
4725290048Savos	/* Restore limitations. */
4726290651Savos	if (ic->ic_promisc == 0 && ic->ic_opmode != IEEE80211_M_IBSS)
4727290564Savos		urtwn_set_rx_bssid_all(sc, 0);
4728290651Savos
4729290048Savos	/* Set gain under link. */
4730290048Savos	urtwn_set_gain(sc, 0x32);
4731290048Savos	URTWN_UNLOCK(sc);
4732251538Srpaulo}
4733251538Srpaulo
4734251538Srpaulostatic void
4735251538Srpaulourtwn_set_channel(struct ieee80211com *ic)
4736251538Srpaulo{
4737286949Sadrian	struct urtwn_softc *sc = ic->ic_softc;
4738292173Savos	struct ieee80211_channel *c = ic->ic_curchan;
4739281070Srpaulo	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
4740251538Srpaulo
4741251538Srpaulo	URTWN_LOCK(sc);
4742281070Srpaulo	if (vap->iv_state == IEEE80211_S_SCAN) {
4743281070Srpaulo		/* Make link LED blink during scan. */
4744281070Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, !sc->ledlink);
4745281070Srpaulo	}
4746292173Savos	urtwn_set_chan(sc, c, NULL);
4747292173Savos	sc->sc_rxtap.wr_chan_freq = htole16(c->ic_freq);
4748292173Savos	sc->sc_rxtap.wr_chan_flags = htole16(c->ic_flags);
4749292173Savos	sc->sc_txtap.wt_chan_freq = htole16(c->ic_freq);
4750292173Savos	sc->sc_txtap.wt_chan_flags = htole16(c->ic_flags);
4751251538Srpaulo	URTWN_UNLOCK(sc);
4752251538Srpaulo}
4753251538Srpaulo
4754292014Savosstatic int
4755292014Savosurtwn_wme_update(struct ieee80211com *ic)
4756292014Savos{
4757292014Savos	const struct wmeParams *wmep =
4758292014Savos	    ic->ic_wme.wme_chanParams.cap_wmeParams;
4759292014Savos	struct urtwn_softc *sc = ic->ic_softc;
4760292014Savos	uint8_t aifs, acm, slottime;
4761292014Savos	int ac;
4762292014Savos
4763292014Savos	acm = 0;
4764292165Savos	slottime = IEEE80211_GET_SLOTTIME(ic);
4765292014Savos
4766292014Savos	URTWN_LOCK(sc);
4767292014Savos	for (ac = WME_AC_BE; ac < WME_NUM_AC; ac++) {
4768292014Savos		/* AIFS[AC] = AIFSN[AC] * aSlotTime + aSIFSTime. */
4769292014Savos		aifs = wmep[ac].wmep_aifsn * slottime + IEEE80211_DUR_SIFS;
4770292014Savos		urtwn_write_4(sc, wme2queue[ac].reg,
4771292014Savos		    SM(R92C_EDCA_PARAM_TXOP, wmep[ac].wmep_txopLimit) |
4772292014Savos		    SM(R92C_EDCA_PARAM_ECWMIN, wmep[ac].wmep_logcwmin) |
4773292014Savos		    SM(R92C_EDCA_PARAM_ECWMAX, wmep[ac].wmep_logcwmax) |
4774292014Savos		    SM(R92C_EDCA_PARAM_AIFS, aifs));
4775292014Savos		if (ac != WME_AC_BE)
4776292014Savos			acm |= wmep[ac].wmep_acm << ac;
4777292014Savos	}
4778292014Savos
4779292014Savos	if (acm != 0)
4780292014Savos		acm |= R92C_ACMHWCTRL_EN;
4781292014Savos	urtwn_write_1(sc, R92C_ACMHWCTRL,
4782292014Savos	    (urtwn_read_1(sc, R92C_ACMHWCTRL) & ~R92C_ACMHWCTRL_ACM_MASK) |
4783292014Savos	    acm);
4784292014Savos
4785292014Savos	URTWN_UNLOCK(sc);
4786292014Savos
4787292014Savos	return 0;
4788292014Savos}
4789292014Savos
4790251538Srpaulostatic void
4791294465Savosurtwn_update_slot(struct ieee80211com *ic)
4792294465Savos{
4793294465Savos	urtwn_cmd_sleepable(ic->ic_softc, NULL, 0, urtwn_update_slot_cb);
4794294465Savos}
4795294465Savos
4796294465Savosstatic void
4797294465Savosurtwn_update_slot_cb(struct urtwn_softc *sc, union sec_param *data)
4798294465Savos{
4799294465Savos	struct ieee80211com *ic = &sc->sc_ic;
4800294465Savos	uint8_t slottime;
4801294465Savos
4802294465Savos	slottime = IEEE80211_GET_SLOTTIME(ic);
4803294465Savos
4804294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_ANY, "%s: setting slot time to %uus\n",
4805294471Savos	    __func__, slottime);
4806294465Savos
4807294465Savos	urtwn_write_1(sc, R92C_SLOT, slottime);
4808294465Savos	urtwn_update_aifs(sc, slottime);
4809294465Savos}
4810294465Savos
4811294465Savosstatic void
4812294465Savosurtwn_update_aifs(struct urtwn_softc *sc, uint8_t slottime)
4813294465Savos{
4814294465Savos	const struct wmeParams *wmep =
4815294465Savos	    sc->sc_ic.ic_wme.wme_chanParams.cap_wmeParams;
4816294465Savos	uint8_t aifs, ac;
4817294465Savos
4818294465Savos	for (ac = WME_AC_BE; ac < WME_NUM_AC; ac++) {
4819294465Savos		/* AIFS[AC] = AIFSN[AC] * aSlotTime + aSIFSTime. */
4820294465Savos		aifs = wmep[ac].wmep_aifsn * slottime + IEEE80211_DUR_SIFS;
4821294465Savos		urtwn_write_1(sc, wme2queue[ac].reg, aifs);
4822294465Savos        }
4823294465Savos}
4824294465Savos
4825294465Savosstatic void
4826290564Savosurtwn_set_promisc(struct urtwn_softc *sc)
4827290564Savos{
4828290564Savos	struct ieee80211com *ic = &sc->sc_ic;
4829290564Savos	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
4830290564Savos	uint32_t rcr, mask1, mask2;
4831290564Savos
4832290564Savos	URTWN_ASSERT_LOCKED(sc);
4833290564Savos
4834290564Savos	if (vap->iv_opmode == IEEE80211_M_MONITOR)
4835290564Savos		return;
4836290564Savos
4837290564Savos	mask1 = R92C_RCR_ACF | R92C_RCR_ADF | R92C_RCR_AMF | R92C_RCR_AAP;
4838290564Savos	mask2 = R92C_RCR_APM;
4839290564Savos
4840290564Savos	if (vap->iv_state == IEEE80211_S_RUN) {
4841290564Savos		switch (vap->iv_opmode) {
4842290564Savos		case IEEE80211_M_STA:
4843290631Savos			mask2 |= R92C_RCR_CBSSID_DATA;
4844290631Savos			/* FALLTHROUGH */
4845290631Savos		case IEEE80211_M_HOSTAP:
4846290631Savos			mask2 |= R92C_RCR_CBSSID_BCN;
4847290564Savos			break;
4848290651Savos		case IEEE80211_M_IBSS:
4849290651Savos			mask2 |= R92C_RCR_CBSSID_DATA;
4850290651Savos			break;
4851290564Savos		default:
4852290564Savos			device_printf(sc->sc_dev, "%s: undefined opmode %d\n",
4853290564Savos			    __func__, vap->iv_opmode);
4854290564Savos			return;
4855290564Savos		}
4856290564Savos	}
4857290564Savos
4858290564Savos	rcr = urtwn_read_4(sc, R92C_RCR);
4859290564Savos	if (ic->ic_promisc == 0)
4860290564Savos		rcr = (rcr & ~mask1) | mask2;
4861290564Savos	else
4862290564Savos		rcr = (rcr & ~mask2) | mask1;
4863290564Savos	urtwn_write_4(sc, R92C_RCR, rcr);
4864290564Savos}
4865290564Savos
4866290564Savosstatic void
4867290564Savosurtwn_update_promisc(struct ieee80211com *ic)
4868290564Savos{
4869290564Savos	struct urtwn_softc *sc = ic->ic_softc;
4870290564Savos
4871290564Savos	URTWN_LOCK(sc);
4872290564Savos	if (sc->sc_flags & URTWN_RUNNING)
4873290564Savos		urtwn_set_promisc(sc);
4874290564Savos	URTWN_UNLOCK(sc);
4875290564Savos}
4876290564Savos
4877290564Savosstatic void
4878283540Sglebiusurtwn_update_mcast(struct ieee80211com *ic)
4879251538Srpaulo{
4880251538Srpaulo	/* XXX do nothing?  */
4881251538Srpaulo}
4882251538Srpaulo
4883292167Savosstatic struct ieee80211_node *
4884297910Sadrianurtwn_node_alloc(struct ieee80211vap *vap,
4885292167Savos    const uint8_t mac[IEEE80211_ADDR_LEN])
4886292167Savos{
4887292167Savos	struct urtwn_node *un;
4888292167Savos
4889292167Savos	un = malloc(sizeof (struct urtwn_node), M_80211_NODE,
4890292167Savos	    M_NOWAIT | M_ZERO);
4891292167Savos
4892292167Savos	if (un == NULL)
4893292167Savos		return NULL;
4894292167Savos
4895292167Savos	un->id = URTWN_MACID_UNDEFINED;
4896292167Savos
4897292167Savos	return &un->ni;
4898292167Savos}
4899292167Savos
4900251538Srpaulostatic void
4901297910Sadrianurtwn_newassoc(struct ieee80211_node *ni, int isnew)
4902292167Savos{
4903292167Savos	struct urtwn_softc *sc = ni->ni_ic->ic_softc;
4904292167Savos	struct urtwn_node *un = URTWN_NODE(ni);
4905292167Savos	uint8_t id;
4906292167Savos
4907297910Sadrian	/* Only do this bit for R88E chips */
4908297910Sadrian	if (! (sc->chip & URTWN_CHIP_88E))
4909297910Sadrian		return;
4910297910Sadrian
4911292167Savos	if (!isnew)
4912292167Savos		return;
4913292167Savos
4914292167Savos	URTWN_NT_LOCK(sc);
4915292167Savos	for (id = 0; id <= URTWN_MACID_MAX(sc); id++) {
4916292167Savos		if (id != URTWN_MACID_BC && sc->node_list[id] == NULL) {
4917292167Savos			un->id = id;
4918292167Savos			sc->node_list[id] = ni;
4919292167Savos			break;
4920292167Savos		}
4921292167Savos	}
4922292167Savos	URTWN_NT_UNLOCK(sc);
4923292167Savos
4924292167Savos	if (id > URTWN_MACID_MAX(sc)) {
4925292167Savos		device_printf(sc->sc_dev, "%s: node table is full\n",
4926292167Savos		    __func__);
4927292167Savos	}
4928292167Savos}
4929292167Savos
4930292167Savosstatic void
4931297910Sadrianurtwn_node_free(struct ieee80211_node *ni)
4932292167Savos{
4933292167Savos	struct urtwn_softc *sc = ni->ni_ic->ic_softc;
4934292167Savos	struct urtwn_node *un = URTWN_NODE(ni);
4935292167Savos
4936292167Savos	URTWN_NT_LOCK(sc);
4937292167Savos	if (un->id != URTWN_MACID_UNDEFINED)
4938292167Savos		sc->node_list[un->id] = NULL;
4939292167Savos	URTWN_NT_UNLOCK(sc);
4940292167Savos
4941292167Savos	sc->sc_node_free(ni);
4942292167Savos}
4943292167Savos
4944292167Savosstatic void
4945251538Srpaulourtwn_set_chan(struct urtwn_softc *sc, struct ieee80211_channel *c,
4946251538Srpaulo    struct ieee80211_channel *extc)
4947251538Srpaulo{
4948287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
4949251538Srpaulo	uint32_t reg;
4950251538Srpaulo	u_int chan;
4951251538Srpaulo	int i;
4952251538Srpaulo
4953251538Srpaulo	chan = ieee80211_chan2ieee(ic, c);	/* XXX center freq! */
4954251538Srpaulo	if (chan == 0 || chan == IEEE80211_CHAN_ANY) {
4955251538Srpaulo		device_printf(sc->sc_dev,
4956251538Srpaulo		    "%s: invalid channel %x\n", __func__, chan);
4957251538Srpaulo		return;
4958251538Srpaulo	}
4959251538Srpaulo
4960251538Srpaulo	/* Set Tx power for this new channel. */
4961251538Srpaulo	urtwn_set_txpower(sc, c, extc);
4962251538Srpaulo
4963251538Srpaulo	for (i = 0; i < sc->nrxchains; i++) {
4964251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_CHNLBW,
4965251538Srpaulo		    RW(sc->rf_chnlbw[i], R92C_RF_CHNLBW_CHNL, chan));
4966251538Srpaulo	}
4967251538Srpaulo#ifndef IEEE80211_NO_HT
4968251538Srpaulo	if (extc != NULL) {
4969251538Srpaulo		/* Is secondary channel below or above primary? */
4970251538Srpaulo		int prichlo = c->ic_freq < extc->ic_freq;
4971251538Srpaulo
4972251538Srpaulo		urtwn_write_1(sc, R92C_BWOPMODE,
4973251538Srpaulo		    urtwn_read_1(sc, R92C_BWOPMODE) & ~R92C_BWOPMODE_20MHZ);
4974251538Srpaulo
4975251538Srpaulo		reg = urtwn_read_1(sc, R92C_RRSR + 2);
4976251538Srpaulo		reg = (reg & ~0x6f) | (prichlo ? 1 : 2) << 5;
4977251538Srpaulo		urtwn_write_1(sc, R92C_RRSR + 2, reg);
4978251538Srpaulo
4979251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFMOD,
4980251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA0_RFMOD) | R92C_RFMOD_40MHZ);
4981251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA1_RFMOD,
4982251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA1_RFMOD) | R92C_RFMOD_40MHZ);
4983251538Srpaulo
4984251538Srpaulo		/* Set CCK side band. */
4985251538Srpaulo		reg = urtwn_bb_read(sc, R92C_CCK0_SYSTEM);
4986251538Srpaulo		reg = (reg & ~0x00000010) | (prichlo ? 0 : 1) << 4;
4987251538Srpaulo		urtwn_bb_write(sc, R92C_CCK0_SYSTEM, reg);
4988251538Srpaulo
4989251538Srpaulo		reg = urtwn_bb_read(sc, R92C_OFDM1_LSTF);
4990251538Srpaulo		reg = (reg & ~0x00000c00) | (prichlo ? 1 : 2) << 10;
4991251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM1_LSTF, reg);
4992251538Srpaulo
4993251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2,
4994251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) &
4995251538Srpaulo		    ~R92C_FPGA0_ANAPARAM2_CBW20);
4996251538Srpaulo
4997251538Srpaulo		reg = urtwn_bb_read(sc, 0x818);
4998251538Srpaulo		reg = (reg & ~0x0c000000) | (prichlo ? 2 : 1) << 26;
4999251538Srpaulo		urtwn_bb_write(sc, 0x818, reg);
5000251538Srpaulo
5001251538Srpaulo		/* Select 40MHz bandwidth. */
5002251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
5003251538Srpaulo		    (sc->rf_chnlbw[0] & ~0xfff) | chan);
5004251538Srpaulo	} else
5005251538Srpaulo#endif
5006251538Srpaulo	{
5007251538Srpaulo		urtwn_write_1(sc, R92C_BWOPMODE,
5008251538Srpaulo		    urtwn_read_1(sc, R92C_BWOPMODE) | R92C_BWOPMODE_20MHZ);
5009251538Srpaulo
5010251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFMOD,
5011251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA0_RFMOD) & ~R92C_RFMOD_40MHZ);
5012251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA1_RFMOD,
5013251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA1_RFMOD) & ~R92C_RFMOD_40MHZ);
5014251538Srpaulo
5015264912Skevlo		if (!(sc->chip & URTWN_CHIP_88E)) {
5016264912Skevlo			urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2,
5017264912Skevlo			    urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) |
5018264912Skevlo			    R92C_FPGA0_ANAPARAM2_CBW20);
5019264912Skevlo		}
5020281069Srpaulo
5021251538Srpaulo		/* Select 20MHz bandwidth. */
5022251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
5023281069Srpaulo		    (sc->rf_chnlbw[0] & ~0xfff) | chan |
5024264912Skevlo		    ((sc->chip & URTWN_CHIP_88E) ? R88E_RF_CHNLBW_BW20 :
5025264912Skevlo		    R92C_RF_CHNLBW_BW20));
5026251538Srpaulo	}
5027251538Srpaulo}
5028251538Srpaulo
5029251538Srpaulostatic void
5030251538Srpaulourtwn_iq_calib(struct urtwn_softc *sc)
5031251538Srpaulo{
5032251538Srpaulo	/* TODO */
5033251538Srpaulo}
5034251538Srpaulo
5035251538Srpaulostatic void
5036251538Srpaulourtwn_lc_calib(struct urtwn_softc *sc)
5037251538Srpaulo{
5038251538Srpaulo	uint32_t rf_ac[2];
5039251538Srpaulo	uint8_t txmode;
5040251538Srpaulo	int i;
5041251538Srpaulo
5042251538Srpaulo	txmode = urtwn_read_1(sc, R92C_OFDM1_LSTF + 3);
5043251538Srpaulo	if ((txmode & 0x70) != 0) {
5044251538Srpaulo		/* Disable all continuous Tx. */
5045251538Srpaulo		urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode & ~0x70);
5046251538Srpaulo
5047251538Srpaulo		/* Set RF mode to standby mode. */
5048251538Srpaulo		for (i = 0; i < sc->nrxchains; i++) {
5049251538Srpaulo			rf_ac[i] = urtwn_rf_read(sc, i, R92C_RF_AC);
5050251538Srpaulo			urtwn_rf_write(sc, i, R92C_RF_AC,
5051251538Srpaulo			    RW(rf_ac[i], R92C_RF_AC_MODE,
5052251538Srpaulo				R92C_RF_AC_MODE_STANDBY));
5053251538Srpaulo		}
5054251538Srpaulo	} else {
5055251538Srpaulo		/* Block all Tx queues. */
5056293180Savos		urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL);
5057251538Srpaulo	}
5058251538Srpaulo	/* Start calibration. */
5059251538Srpaulo	urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
5060251538Srpaulo	    urtwn_rf_read(sc, 0, R92C_RF_CHNLBW) | R92C_RF_CHNLBW_LCSTART);
5061251538Srpaulo
5062251538Srpaulo	/* Give calibration the time to complete. */
5063266472Shselasky	usb_pause_mtx(&sc->sc_mtx, hz / 10);		/* 100ms */
5064251538Srpaulo
5065251538Srpaulo	/* Restore configuration. */
5066251538Srpaulo	if ((txmode & 0x70) != 0) {
5067251538Srpaulo		/* Restore Tx mode. */
5068251538Srpaulo		urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode);
5069251538Srpaulo		/* Restore RF mode. */
5070251538Srpaulo		for (i = 0; i < sc->nrxchains; i++)
5071251538Srpaulo			urtwn_rf_write(sc, i, R92C_RF_AC, rf_ac[i]);
5072251538Srpaulo	} else {
5073251538Srpaulo		/* Unblock all Tx queues. */
5074251538Srpaulo		urtwn_write_1(sc, R92C_TXPAUSE, 0x00);
5075251538Srpaulo	}
5076251538Srpaulo}
5077251538Srpaulo
5078294473Savosstatic void
5079294473Savosurtwn_temp_calib(struct urtwn_softc *sc)
5080294473Savos{
5081294473Savos	uint8_t temp;
5082294473Savos
5083294473Savos	URTWN_ASSERT_LOCKED(sc);
5084294473Savos
5085294473Savos	if (!(sc->sc_flags & URTWN_TEMP_MEASURED)) {
5086294473Savos		/* Start measuring temperature. */
5087294473Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP,
5088294473Savos		    "%s: start measuring temperature\n", __func__);
5089294473Savos		if (sc->chip & URTWN_CHIP_88E) {
5090294473Savos			urtwn_rf_write(sc, 0, R88E_RF_T_METER,
5091294473Savos			    R88E_RF_T_METER_START);
5092294473Savos		} else {
5093294473Savos			urtwn_rf_write(sc, 0, R92C_RF_T_METER,
5094294473Savos			    R92C_RF_T_METER_START);
5095294473Savos		}
5096294473Savos		sc->sc_flags |= URTWN_TEMP_MEASURED;
5097294473Savos		return;
5098294473Savos	}
5099294473Savos	sc->sc_flags &= ~URTWN_TEMP_MEASURED;
5100294473Savos
5101294473Savos	/* Read measured temperature. */
5102294473Savos	if (sc->chip & URTWN_CHIP_88E) {
5103294473Savos		temp = MS(urtwn_rf_read(sc, 0, R88E_RF_T_METER),
5104294473Savos		    R88E_RF_T_METER_VAL);
5105294473Savos	} else {
5106294473Savos		temp = MS(urtwn_rf_read(sc, 0, R92C_RF_T_METER),
5107294473Savos		    R92C_RF_T_METER_VAL);
5108294473Savos	}
5109294473Savos	if (temp == 0) {	/* Read failed, skip. */
5110294473Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP,
5111294473Savos		    "%s: temperature read failed, skipping\n", __func__);
5112294473Savos		return;
5113294473Savos	}
5114294473Savos
5115294473Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP,
5116294473Savos	    "%s: temperature: previous %u, current %u\n",
5117294473Savos	    __func__, sc->thcal_lctemp, temp);
5118294473Savos
5119294473Savos	/*
5120294473Savos	 * Redo LC calibration if temperature changed significantly since
5121294473Savos	 * last calibration.
5122294473Savos	 */
5123294473Savos	if (sc->thcal_lctemp == 0) {
5124294473Savos		/* First LC calibration is performed in urtwn_init(). */
5125294473Savos		sc->thcal_lctemp = temp;
5126294473Savos	} else if (abs(temp - sc->thcal_lctemp) > 1) {
5127294473Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP,
5128294473Savos		    "%s: LC calib triggered by temp: %u -> %u\n",
5129294473Savos		    __func__, sc->thcal_lctemp, temp);
5130294473Savos		urtwn_lc_calib(sc);
5131294473Savos		/* Record temperature of last LC calibration. */
5132294473Savos		sc->thcal_lctemp = temp;
5133294473Savos	}
5134294473Savos}
5135294473Savos
5136291698Savosstatic int
5137287197Sglebiusurtwn_init(struct urtwn_softc *sc)
5138251538Srpaulo{
5139287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
5140287197Sglebius	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
5141287197Sglebius	uint8_t macaddr[IEEE80211_ADDR_LEN];
5142251538Srpaulo	uint32_t reg;
5143291698Savos	usb_error_t usb_err = USB_ERR_NORMAL_COMPLETION;
5144251538Srpaulo	int error;
5145251538Srpaulo
5146291698Savos	URTWN_LOCK(sc);
5147291698Savos	if (sc->sc_flags & URTWN_RUNNING) {
5148291698Savos		URTWN_UNLOCK(sc);
5149291698Savos		return (0);
5150291698Savos	}
5151264864Skevlo
5152251538Srpaulo	/* Init firmware commands ring. */
5153251538Srpaulo	sc->fwcur = 0;
5154251538Srpaulo
5155251538Srpaulo	/* Allocate Tx/Rx buffers. */
5156251538Srpaulo	error = urtwn_alloc_rx_list(sc);
5157251538Srpaulo	if (error != 0)
5158251538Srpaulo		goto fail;
5159281069Srpaulo
5160251538Srpaulo	error = urtwn_alloc_tx_list(sc);
5161251538Srpaulo	if (error != 0)
5162251538Srpaulo		goto fail;
5163251538Srpaulo
5164251538Srpaulo	/* Power on adapter. */
5165251538Srpaulo	error = urtwn_power_on(sc);
5166251538Srpaulo	if (error != 0)
5167251538Srpaulo		goto fail;
5168251538Srpaulo
5169251538Srpaulo	/* Initialize DMA. */
5170251538Srpaulo	error = urtwn_dma_init(sc);
5171251538Srpaulo	if (error != 0)
5172251538Srpaulo		goto fail;
5173251538Srpaulo
5174251538Srpaulo	/* Set info size in Rx descriptors (in 64-bit words). */
5175251538Srpaulo	urtwn_write_1(sc, R92C_RX_DRVINFO_SZ, 4);
5176251538Srpaulo
5177251538Srpaulo	/* Init interrupts. */
5178264912Skevlo	if (sc->chip & URTWN_CHIP_88E) {
5179291698Savos		usb_err = urtwn_write_4(sc, R88E_HISR, 0xffffffff);
5180291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5181291698Savos			goto fail;
5182291698Savos		usb_err = urtwn_write_4(sc, R88E_HIMR, R88E_HIMR_CPWM | R88E_HIMR_CPWM2 |
5183264912Skevlo		    R88E_HIMR_TBDER | R88E_HIMR_PSTIMEOUT);
5184291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5185291698Savos			goto fail;
5186291698Savos		usb_err = urtwn_write_4(sc, R88E_HIMRE, R88E_HIMRE_RXFOVW |
5187264912Skevlo		    R88E_HIMRE_TXFOVW | R88E_HIMRE_RXERR | R88E_HIMRE_TXERR);
5188291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5189291698Savos			goto fail;
5190291698Savos		usb_err = urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION,
5191264912Skevlo		    urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) |
5192264912Skevlo		    R92C_USB_SPECIAL_OPTION_INT_BULK_SEL);
5193291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5194291698Savos			goto fail;
5195264912Skevlo	} else {
5196291698Savos		usb_err = urtwn_write_4(sc, R92C_HISR, 0xffffffff);
5197291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5198291698Savos			goto fail;
5199291698Savos		usb_err = urtwn_write_4(sc, R92C_HIMR, 0xffffffff);
5200291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5201291698Savos			goto fail;
5202264912Skevlo	}
5203251538Srpaulo
5204251538Srpaulo	/* Set MAC address. */
5205287197Sglebius	IEEE80211_ADDR_COPY(macaddr, vap ? vap->iv_myaddr : ic->ic_macaddr);
5206291698Savos	usb_err = urtwn_write_region_1(sc, R92C_MACID, macaddr, IEEE80211_ADDR_LEN);
5207291698Savos	if (usb_err != USB_ERR_NORMAL_COMPLETION)
5208291698Savos		goto fail;
5209251538Srpaulo
5210251538Srpaulo	/* Set initial network type. */
5211289811Savos	urtwn_set_mode(sc, R92C_MSR_INFRA);
5212251538Srpaulo
5213290564Savos	/* Initialize Rx filter. */
5214251538Srpaulo	urtwn_rxfilter_init(sc);
5215251538Srpaulo
5216282623Skevlo	/* Set response rate. */
5217251538Srpaulo	reg = urtwn_read_4(sc, R92C_RRSR);
5218251538Srpaulo	reg = RW(reg, R92C_RRSR_RATE_BITMAP, R92C_RRSR_RATE_CCK_ONLY_1M);
5219251538Srpaulo	urtwn_write_4(sc, R92C_RRSR, reg);
5220251538Srpaulo
5221251538Srpaulo	/* Set short/long retry limits. */
5222251538Srpaulo	urtwn_write_2(sc, R92C_RL,
5223251538Srpaulo	    SM(R92C_RL_SRL, 0x30) | SM(R92C_RL_LRL, 0x30));
5224251538Srpaulo
5225251538Srpaulo	/* Initialize EDCA parameters. */
5226251538Srpaulo	urtwn_edca_init(sc);
5227251538Srpaulo
5228251538Srpaulo	/* Setup rate fallback. */
5229264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
5230264912Skevlo		urtwn_write_4(sc, R92C_DARFRC + 0, 0x00000000);
5231264912Skevlo		urtwn_write_4(sc, R92C_DARFRC + 4, 0x10080404);
5232264912Skevlo		urtwn_write_4(sc, R92C_RARFRC + 0, 0x04030201);
5233264912Skevlo		urtwn_write_4(sc, R92C_RARFRC + 4, 0x08070605);
5234264912Skevlo	}
5235251538Srpaulo
5236251538Srpaulo	urtwn_write_1(sc, R92C_FWHW_TXQ_CTRL,
5237251538Srpaulo	    urtwn_read_1(sc, R92C_FWHW_TXQ_CTRL) |
5238251538Srpaulo	    R92C_FWHW_TXQ_CTRL_AMPDU_RTY_NEW);
5239251538Srpaulo	/* Set ACK timeout. */
5240251538Srpaulo	urtwn_write_1(sc, R92C_ACKTO, 0x40);
5241251538Srpaulo
5242251538Srpaulo	/* Setup USB aggregation. */
5243251538Srpaulo	reg = urtwn_read_4(sc, R92C_TDECTRL);
5244251538Srpaulo	reg = RW(reg, R92C_TDECTRL_BLK_DESC_NUM, 6);
5245251538Srpaulo	urtwn_write_4(sc, R92C_TDECTRL, reg);
5246251538Srpaulo	urtwn_write_1(sc, R92C_TRXDMA_CTRL,
5247251538Srpaulo	    urtwn_read_1(sc, R92C_TRXDMA_CTRL) |
5248251538Srpaulo	    R92C_TRXDMA_CTRL_RXDMA_AGG_EN);
5249251538Srpaulo	urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH, 48);
5250264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
5251264912Skevlo		urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH + 1, 4);
5252282266Skevlo	else {
5253264912Skevlo		urtwn_write_1(sc, R92C_USB_DMA_AGG_TO, 4);
5254282266Skevlo		urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION,
5255282266Skevlo		    urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) |
5256282266Skevlo		    R92C_USB_SPECIAL_OPTION_AGG_EN);
5257282266Skevlo		urtwn_write_1(sc, R92C_USB_AGG_TH, 8);
5258282266Skevlo		urtwn_write_1(sc, R92C_USB_AGG_TO, 6);
5259282266Skevlo	}
5260251538Srpaulo
5261251538Srpaulo	/* Initialize beacon parameters. */
5262264912Skevlo	urtwn_write_2(sc, R92C_BCN_CTRL, 0x1010);
5263251538Srpaulo	urtwn_write_2(sc, R92C_TBTT_PROHIBIT, 0x6404);
5264251538Srpaulo	urtwn_write_1(sc, R92C_DRVERLYINT, 0x05);
5265251538Srpaulo	urtwn_write_1(sc, R92C_BCNDMATIM, 0x02);
5266251538Srpaulo	urtwn_write_2(sc, R92C_BCNTCFG, 0x660f);
5267251538Srpaulo
5268264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
5269264912Skevlo		/* Setup AMPDU aggregation. */
5270264912Skevlo		urtwn_write_4(sc, R92C_AGGLEN_LMT, 0x99997631);	/* MCS7~0 */
5271264912Skevlo		urtwn_write_1(sc, R92C_AGGR_BREAK_TIME, 0x16);
5272264912Skevlo		urtwn_write_2(sc, R92C_MAX_AGGR_NUM, 0x0708);
5273251538Srpaulo
5274264912Skevlo		urtwn_write_1(sc, R92C_BCN_MAX_ERR, 0xff);
5275264912Skevlo	}
5276251538Srpaulo
5277295871Savos#ifndef URTWN_WITHOUT_UCODE
5278251538Srpaulo	/* Load 8051 microcode. */
5279251538Srpaulo	error = urtwn_load_firmware(sc);
5280295871Savos	if (error == 0)
5281295871Savos		sc->sc_flags |= URTWN_FW_LOADED;
5282295871Savos#endif
5283251538Srpaulo
5284251538Srpaulo	/* Initialize MAC/BB/RF blocks. */
5285291698Savos	error = urtwn_mac_init(sc);
5286291698Savos	if (error != 0) {
5287291698Savos		device_printf(sc->sc_dev,
5288291698Savos		    "%s: error while initializing MAC block\n", __func__);
5289291698Savos		goto fail;
5290291698Savos	}
5291251538Srpaulo	urtwn_bb_init(sc);
5292251538Srpaulo	urtwn_rf_init(sc);
5293251538Srpaulo
5294290564Savos	/* Reinitialize Rx filter (D3845 is not committed yet). */
5295290564Savos	urtwn_rxfilter_init(sc);
5296290564Savos
5297264912Skevlo	if (sc->chip & URTWN_CHIP_88E) {
5298264912Skevlo		urtwn_write_2(sc, R92C_CR,
5299264912Skevlo		    urtwn_read_2(sc, R92C_CR) | R92C_CR_MACTXEN |
5300264912Skevlo		    R92C_CR_MACRXEN);
5301264912Skevlo	}
5302264912Skevlo
5303251538Srpaulo	/* Turn CCK and OFDM blocks on. */
5304251538Srpaulo	reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD);
5305251538Srpaulo	reg |= R92C_RFMOD_CCK_EN;
5306291698Savos	usb_err = urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg);
5307291698Savos	if (usb_err != USB_ERR_NORMAL_COMPLETION)
5308291698Savos		goto fail;
5309251538Srpaulo	reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD);
5310251538Srpaulo	reg |= R92C_RFMOD_OFDM_EN;
5311291698Savos	usb_err = urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg);
5312291698Savos	if (usb_err != USB_ERR_NORMAL_COMPLETION)
5313291698Savos		goto fail;
5314251538Srpaulo
5315251538Srpaulo	/* Clear per-station keys table. */
5316251538Srpaulo	urtwn_cam_init(sc);
5317251538Srpaulo
5318292175Savos	/* Enable decryption / encryption. */
5319292175Savos	urtwn_write_2(sc, R92C_SECCFG,
5320292175Savos	    R92C_SECCFG_TXUCKEY_DEF | R92C_SECCFG_RXUCKEY_DEF |
5321292175Savos	    R92C_SECCFG_TXENC_ENA | R92C_SECCFG_RXDEC_ENA |
5322292175Savos	    R92C_SECCFG_TXBCKEY_DEF | R92C_SECCFG_RXBCKEY_DEF);
5323292175Savos
5324292175Savos	/*
5325292175Savos	 * Install static keys (if any).
5326292175Savos	 * Must be called after urtwn_cam_init().
5327292175Savos	 */
5328292175Savos	ieee80211_runtask(ic, &sc->cmdq_task);
5329292175Savos
5330251538Srpaulo	/* Enable hardware sequence numbering. */
5331293180Savos	urtwn_write_1(sc, R92C_HWSEQ_CTRL, R92C_TX_QUEUE_ALL);
5332251538Srpaulo
5333292167Savos	/* Enable per-packet TX report. */
5334292167Savos	if (sc->chip & URTWN_CHIP_88E) {
5335292167Savos		urtwn_write_1(sc, R88E_TX_RPT_CTRL,
5336292167Savos		    urtwn_read_1(sc, R88E_TX_RPT_CTRL) | R88E_TX_RPT1_ENA);
5337292167Savos	}
5338292167Savos
5339251538Srpaulo	/* Perform LO and IQ calibrations. */
5340251538Srpaulo	urtwn_iq_calib(sc);
5341251538Srpaulo	/* Perform LC calibration. */
5342251538Srpaulo	urtwn_lc_calib(sc);
5343251538Srpaulo
5344251538Srpaulo	/* Fix USB interference issue. */
5345264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
5346264912Skevlo		urtwn_write_1(sc, 0xfe40, 0xe0);
5347264912Skevlo		urtwn_write_1(sc, 0xfe41, 0x8d);
5348264912Skevlo		urtwn_write_1(sc, 0xfe42, 0x80);
5349251538Srpaulo
5350264912Skevlo		urtwn_pa_bias_init(sc);
5351264912Skevlo	}
5352251538Srpaulo
5353251538Srpaulo	/* Initialize GPIO setting. */
5354251538Srpaulo	urtwn_write_1(sc, R92C_GPIO_MUXCFG,
5355251538Srpaulo	    urtwn_read_1(sc, R92C_GPIO_MUXCFG) & ~R92C_GPIO_MUXCFG_ENBT);
5356251538Srpaulo
5357251538Srpaulo	/* Fix for lower temperature. */
5358264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E))
5359264912Skevlo		urtwn_write_1(sc, 0x15, 0xe9);
5360251538Srpaulo
5361251538Srpaulo	usbd_transfer_start(sc->sc_xfer[URTWN_BULK_RX]);
5362251538Srpaulo
5363287197Sglebius	sc->sc_flags |= URTWN_RUNNING;
5364251538Srpaulo
5365251538Srpaulo	callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
5366251538Srpaulofail:
5367291698Savos	if (usb_err != USB_ERR_NORMAL_COMPLETION)
5368291698Savos		error = EIO;
5369291698Savos
5370291698Savos	URTWN_UNLOCK(sc);
5371291698Savos
5372291698Savos	return (error);
5373251538Srpaulo}
5374251538Srpaulo
5375251538Srpaulostatic void
5376287197Sglebiusurtwn_stop(struct urtwn_softc *sc)
5377251538Srpaulo{
5378251538Srpaulo
5379291698Savos	URTWN_LOCK(sc);
5380291698Savos	if (!(sc->sc_flags & URTWN_RUNNING)) {
5381291698Savos		URTWN_UNLOCK(sc);
5382291698Savos		return;
5383291698Savos	}
5384291698Savos
5385295871Savos	sc->sc_flags &= ~(URTWN_RUNNING | URTWN_FW_LOADED |
5386295871Savos	    URTWN_TEMP_MEASURED);
5387294473Savos	sc->thcal_lctemp = 0;
5388251538Srpaulo	callout_stop(&sc->sc_watchdog_ch);
5389295874Savos
5390251538Srpaulo	urtwn_abort_xfers(sc);
5391288353Sadrian	urtwn_drain_mbufq(sc);
5392295874Savos	urtwn_power_off(sc);
5393291698Savos	URTWN_UNLOCK(sc);
5394251538Srpaulo}
5395251538Srpaulo
5396251538Srpaulostatic void
5397251538Srpaulourtwn_abort_xfers(struct urtwn_softc *sc)
5398251538Srpaulo{
5399251538Srpaulo	int i;
5400251538Srpaulo
5401251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
5402251538Srpaulo
5403251538Srpaulo	/* abort any pending transfers */
5404251538Srpaulo	for (i = 0; i < URTWN_N_TRANSFER; i++)
5405251538Srpaulo		usbd_transfer_stop(sc->sc_xfer[i]);
5406251538Srpaulo}
5407251538Srpaulo
5408251538Srpaulostatic int
5409251538Srpaulourtwn_raw_xmit(struct ieee80211_node *ni, struct mbuf *m,
5410251538Srpaulo    const struct ieee80211_bpf_params *params)
5411251538Srpaulo{
5412251538Srpaulo	struct ieee80211com *ic = ni->ni_ic;
5413286949Sadrian	struct urtwn_softc *sc = ic->ic_softc;
5414251538Srpaulo	struct urtwn_data *bf;
5415290630Savos	int error;
5416251538Srpaulo
5417297596Sadrian	URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT, "%s: called; m=%p\n",
5418297596Sadrian	    __func__,
5419297596Sadrian	    m);
5420297596Sadrian
5421251538Srpaulo	/* prevent management frames from being sent if we're not ready */
5422290630Savos	URTWN_LOCK(sc);
5423287197Sglebius	if (!(sc->sc_flags & URTWN_RUNNING)) {
5424290630Savos		error = ENETDOWN;
5425290630Savos		goto end;
5426251538Srpaulo	}
5427290630Savos
5428251538Srpaulo	bf = urtwn_getbuf(sc);
5429251538Srpaulo	if (bf == NULL) {
5430290630Savos		error = ENOBUFS;
5431290630Savos		goto end;
5432251538Srpaulo	}
5433251538Srpaulo
5434292221Savos	if (params == NULL) {
5435292221Savos		/*
5436292221Savos		 * Legacy path; interpret frame contents to decide
5437292221Savos		 * precisely how to send the frame.
5438292221Savos		 */
5439292221Savos		error = urtwn_tx_data(sc, ni, m, bf);
5440292221Savos	} else {
5441292221Savos		/*
5442292221Savos		 * Caller supplied explicit parameters to use in
5443292221Savos		 * sending the frame.
5444292221Savos		 */
5445292221Savos		error = urtwn_tx_raw(sc, ni, m, bf, params);
5446292221Savos	}
5447292221Savos	if (error != 0) {
5448251538Srpaulo		STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next);
5449290630Savos		goto end;
5450251538Srpaulo	}
5451290630Savos
5452288353Sadrian	sc->sc_txtimer = 5;
5453290630Savos	callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
5454290630Savos
5455290630Savosend:
5456290630Savos	if (error != 0)
5457290630Savos		m_freem(m);
5458290630Savos
5459251538Srpaulo	URTWN_UNLOCK(sc);
5460251538Srpaulo
5461290630Savos	return (error);
5462251538Srpaulo}
5463251538Srpaulo
5464266472Shselaskystatic void
5465266472Shselaskyurtwn_ms_delay(struct urtwn_softc *sc)
5466266472Shselasky{
5467266472Shselasky	usb_pause_mtx(&sc->sc_mtx, hz / 1000);
5468266472Shselasky}
5469266472Shselasky
5470251538Srpaulostatic device_method_t urtwn_methods[] = {
5471251538Srpaulo	/* Device interface */
5472251538Srpaulo	DEVMETHOD(device_probe,		urtwn_match),
5473251538Srpaulo	DEVMETHOD(device_attach,	urtwn_attach),
5474251538Srpaulo	DEVMETHOD(device_detach,	urtwn_detach),
5475251538Srpaulo
5476264912Skevlo	DEVMETHOD_END
5477251538Srpaulo};
5478251538Srpaulo
5479251538Srpaulostatic driver_t urtwn_driver = {
5480251538Srpaulo	"urtwn",
5481251538Srpaulo	urtwn_methods,
5482251538Srpaulo	sizeof(struct urtwn_softc)
5483251538Srpaulo};
5484251538Srpaulo
5485251538Srpaulostatic devclass_t urtwn_devclass;
5486251538Srpaulo
5487251538SrpauloDRIVER_MODULE(urtwn, uhub, urtwn_driver, urtwn_devclass, NULL, NULL);
5488251538SrpauloMODULE_DEPEND(urtwn, usb, 1, 1, 1);
5489251538SrpauloMODULE_DEPEND(urtwn, wlan, 1, 1, 1);
5490295871Savos#ifndef URTWN_WITHOUT_UCODE
5491251538SrpauloMODULE_DEPEND(urtwn, firmware, 1, 1, 1);
5492295871Savos#endif
5493251538SrpauloMODULE_VERSION(urtwn, 1);
5494292080SimpUSB_PNP_HOST_INFO(urtwn_devs);
5495