if_urtwn.c revision 298359
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 298359 2016-04-20 18:29:30Z 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
1947251538Srpaulo/*
1948251538Srpaulo * Initialize rate adaptation in firmware.
1949251538Srpaulo */
1950251538Srpaulostatic int
1951251538Srpaulourtwn_ra_init(struct urtwn_softc *sc)
1952251538Srpaulo{
1953287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
1954251538Srpaulo	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
1955251538Srpaulo	struct ieee80211_node *ni;
1956297175Sadrian	struct ieee80211_rateset *rs, *rs_ht;
1957251538Srpaulo	struct r92c_fw_cmd_macid_cfg cmd;
1958251538Srpaulo	uint32_t rates, basicrates;
1959251538Srpaulo	uint8_t mode;
1960251538Srpaulo	int maxrate, maxbasicrate, error, i, j;
1961251538Srpaulo
1962251538Srpaulo	ni = ieee80211_ref_node(vap->iv_bss);
1963251538Srpaulo	rs = &ni->ni_rates;
1964297175Sadrian	rs_ht = (struct ieee80211_rateset *) &ni->ni_htrates;
1965251538Srpaulo
1966251538Srpaulo	/* Get normal and basic rates mask. */
1967251538Srpaulo	rates = basicrates = 0;
1968251538Srpaulo	maxrate = maxbasicrate = 0;
1969297175Sadrian
1970297175Sadrian	/* This is for 11bg */
1971251538Srpaulo	for (i = 0; i < rs->rs_nrates; i++) {
1972251538Srpaulo		/* Convert 802.11 rate to HW rate index. */
1973289758Savos		for (j = 0; j < nitems(ridx2rate); j++)
1974289758Savos			if ((rs->rs_rates[i] & IEEE80211_RATE_VAL) ==
1975289758Savos			    ridx2rate[j])
1976251538Srpaulo				break;
1977289758Savos		if (j == nitems(ridx2rate))	/* Unknown rate, skip. */
1978251538Srpaulo			continue;
1979251538Srpaulo		rates |= 1 << j;
1980251538Srpaulo		if (j > maxrate)
1981251538Srpaulo			maxrate = j;
1982251538Srpaulo		if (rs->rs_rates[i] & IEEE80211_RATE_BASIC) {
1983251538Srpaulo			basicrates |= 1 << j;
1984251538Srpaulo			if (j > maxbasicrate)
1985251538Srpaulo				maxbasicrate = j;
1986251538Srpaulo		}
1987251538Srpaulo	}
1988297175Sadrian
1989297175Sadrian	/* If we're doing 11n, enable 11n rates */
1990297175Sadrian	if (ni->ni_flags & IEEE80211_NODE_HT) {
1991297175Sadrian		for (i = 0; i < rs_ht->rs_nrates; i++) {
1992297175Sadrian			if ((rs_ht->rs_rates[i] & 0x7f) > 0xf)
1993297175Sadrian				continue;
1994297175Sadrian			/* 11n rates start at index 12 */
1995297175Sadrian			j = ((rs_ht->rs_rates[i]) & 0xf) + 12;
1996297175Sadrian			rates |= (1 << j);
1997297175Sadrian
1998297175Sadrian			/* Guard against the rate table being oddly ordered */
1999297175Sadrian			if (j > maxrate)
2000297175Sadrian				maxrate = j;
2001297175Sadrian		}
2002297175Sadrian	}
2003297175Sadrian
2004297175Sadrian#if 0
2005297175Sadrian	if (ic->ic_curmode == IEEE80211_MODE_11NG)
2006297175Sadrian		raid = R92C_RAID_11GN;
2007297175Sadrian#endif
2008297175Sadrian	/* NB: group addressed frames are done at 11bg rates for now */
2009251538Srpaulo	if (ic->ic_curmode == IEEE80211_MODE_11B)
2010251538Srpaulo		mode = R92C_RAID_11B;
2011251538Srpaulo	else
2012251538Srpaulo		mode = R92C_RAID_11BG;
2013297175Sadrian	/* XXX misleading 'mode' value here for unicast frames */
2014294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_RA,
2015294471Savos	    "%s: mode 0x%x, rates 0x%08x, basicrates 0x%08x\n", __func__,
2016251538Srpaulo	    mode, rates, basicrates);
2017251538Srpaulo
2018251538Srpaulo	/* Set rates mask for group addressed frames. */
2019251538Srpaulo	cmd.macid = URTWN_MACID_BC | URTWN_MACID_VALID;
2020251538Srpaulo	cmd.mask = htole32(mode << 28 | basicrates);
2021251538Srpaulo	error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd));
2022251538Srpaulo	if (error != 0) {
2023252401Srpaulo		ieee80211_free_node(ni);
2024251538Srpaulo		device_printf(sc->sc_dev,
2025251538Srpaulo		    "could not add broadcast station\n");
2026251538Srpaulo		return (error);
2027251538Srpaulo	}
2028297175Sadrian
2029251538Srpaulo	/* Set initial MRR rate. */
2030294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_RA, "%s: maxbasicrate %d\n", __func__,
2031294471Savos	    maxbasicrate);
2032251538Srpaulo	urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BC),
2033251538Srpaulo	    maxbasicrate);
2034251538Srpaulo
2035251538Srpaulo	/* Set rates mask for unicast frames. */
2036297175Sadrian	if (ni->ni_flags & IEEE80211_NODE_HT)
2037297175Sadrian		mode = R92C_RAID_11GN;
2038297175Sadrian	else if (ic->ic_curmode == IEEE80211_MODE_11B)
2039297175Sadrian		mode = R92C_RAID_11B;
2040297175Sadrian	else
2041297175Sadrian		mode = R92C_RAID_11BG;
2042251538Srpaulo	cmd.macid = URTWN_MACID_BSS | URTWN_MACID_VALID;
2043251538Srpaulo	cmd.mask = htole32(mode << 28 | rates);
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, "could not add BSS station\n");
2048251538Srpaulo		return (error);
2049251538Srpaulo	}
2050251538Srpaulo	/* Set initial MRR rate. */
2051294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_RA, "%s: maxrate %d\n", __func__,
2052294471Savos	    maxrate);
2053251538Srpaulo	urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BSS),
2054251538Srpaulo	    maxrate);
2055251538Srpaulo
2056251538Srpaulo	/* Indicate highest supported rate. */
2057297175Sadrian	if (ni->ni_flags & IEEE80211_NODE_HT)
2058297175Sadrian		ni->ni_txrate = rs_ht->rs_rates[rs_ht->rs_nrates - 1]
2059297175Sadrian		    | IEEE80211_RATE_MCS;
2060297175Sadrian	else
2061297175Sadrian		ni->ni_txrate = rs->rs_rates[rs->rs_nrates - 1];
2062252401Srpaulo	ieee80211_free_node(ni);
2063252401Srpaulo
2064251538Srpaulo	return (0);
2065251538Srpaulo}
2066251538Srpaulo
2067290439Savosstatic void
2068290631Savosurtwn_init_beacon(struct urtwn_softc *sc, struct urtwn_vap *uvp)
2069251538Srpaulo{
2070290631Savos	struct r92c_tx_desc *txd = &uvp->bcn_desc;
2071290631Savos
2072290631Savos	txd->txdw0 = htole32(
2073290631Savos	    SM(R92C_TXDW0_OFFSET, sizeof(*txd)) | R92C_TXDW0_BMCAST |
2074290631Savos	    R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG);
2075290631Savos	txd->txdw1 = htole32(
2076290631Savos	    SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_BEACON) |
2077290631Savos	    SM(R92C_TXDW1_RAID, R92C_RAID_11B));
2078290631Savos
2079291858Savos	if (sc->chip & URTWN_CHIP_88E) {
2080290631Savos		txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, URTWN_MACID_BC));
2081291858Savos		txd->txdseq |= htole16(R88E_TXDSEQ_HWSEQ_EN);
2082291858Savos	} else {
2083290631Savos		txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, URTWN_MACID_BC));
2084291858Savos		txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN);
2085291858Savos	}
2086290631Savos
2087290631Savos	txd->txdw4 = htole32(R92C_TXDW4_DRVRATE);
2088290631Savos	txd->txdw5 = htole32(SM(R92C_TXDW5_DATARATE, URTWN_RIDX_CCK1));
2089251538Srpaulo}
2090251538Srpaulo
2091290631Savosstatic int
2092290631Savosurtwn_setup_beacon(struct urtwn_softc *sc, struct ieee80211_node *ni)
2093290631Savos{
2094290631Savos 	struct ieee80211vap *vap = ni->ni_vap;
2095290631Savos	struct urtwn_vap *uvp = URTWN_VAP(vap);
2096290631Savos	struct mbuf *m;
2097290631Savos	int error;
2098290631Savos
2099290631Savos	URTWN_ASSERT_LOCKED(sc);
2100290631Savos
2101290631Savos	if (ni->ni_chan == IEEE80211_CHAN_ANYC)
2102290631Savos		return (EINVAL);
2103290631Savos
2104290631Savos	m = ieee80211_beacon_alloc(ni);
2105290631Savos	if (m == NULL) {
2106290631Savos		device_printf(sc->sc_dev,
2107290631Savos		    "%s: could not allocate beacon frame\n", __func__);
2108290631Savos		return (ENOMEM);
2109290631Savos	}
2110290631Savos
2111290631Savos	if (uvp->bcn_mbuf != NULL)
2112290631Savos		m_freem(uvp->bcn_mbuf);
2113290631Savos
2114290631Savos	uvp->bcn_mbuf = m;
2115290631Savos
2116290631Savos	if ((error = urtwn_tx_beacon(sc, uvp)) != 0)
2117290631Savos		return (error);
2118290631Savos
2119290631Savos	/* XXX bcnq stuck workaround */
2120290631Savos	if ((error = urtwn_tx_beacon(sc, uvp)) != 0)
2121290631Savos		return (error);
2122290631Savos
2123294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_BEACON, "%s: beacon was %srecognized\n",
2124294471Savos	    __func__, urtwn_read_1(sc, R92C_TDECTRL + 2) &
2125294471Savos	    (R92C_TDECTRL_BCN_VALID >> 16) ? "" : "not ");
2126294471Savos
2127290631Savos	return (0);
2128290631Savos}
2129290631Savos
2130251538Srpaulostatic void
2131290631Savosurtwn_update_beacon(struct ieee80211vap *vap, int item)
2132290631Savos{
2133290631Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2134290631Savos	struct urtwn_vap *uvp = URTWN_VAP(vap);
2135290631Savos	struct ieee80211_beacon_offsets *bo = &vap->iv_bcn_off;
2136290631Savos	struct ieee80211_node *ni = vap->iv_bss;
2137290631Savos	int mcast = 0;
2138290631Savos
2139290631Savos	URTWN_LOCK(sc);
2140290631Savos	if (uvp->bcn_mbuf == NULL) {
2141290631Savos		uvp->bcn_mbuf = ieee80211_beacon_alloc(ni);
2142290631Savos		if (uvp->bcn_mbuf == NULL) {
2143290631Savos			device_printf(sc->sc_dev,
2144290631Savos			    "%s: could not allocate beacon frame\n", __func__);
2145290631Savos			URTWN_UNLOCK(sc);
2146290631Savos			return;
2147290631Savos		}
2148290631Savos	}
2149290631Savos	URTWN_UNLOCK(sc);
2150290631Savos
2151290631Savos	if (item == IEEE80211_BEACON_TIM)
2152290631Savos		mcast = 1;	/* XXX */
2153290631Savos
2154290631Savos	setbit(bo->bo_flags, item);
2155290631Savos	ieee80211_beacon_update(ni, uvp->bcn_mbuf, mcast);
2156290631Savos
2157290631Savos	URTWN_LOCK(sc);
2158290631Savos	urtwn_tx_beacon(sc, uvp);
2159290631Savos	URTWN_UNLOCK(sc);
2160290631Savos}
2161290631Savos
2162290631Savos/*
2163290631Savos * Push a beacon frame into the chip. Beacon will
2164290631Savos * be repeated by the chip every R92C_BCN_INTERVAL.
2165290631Savos */
2166290631Savosstatic int
2167290631Savosurtwn_tx_beacon(struct urtwn_softc *sc, struct urtwn_vap *uvp)
2168290631Savos{
2169290631Savos	struct r92c_tx_desc *desc = &uvp->bcn_desc;
2170290631Savos	struct urtwn_data *bf;
2171290631Savos
2172290631Savos	URTWN_ASSERT_LOCKED(sc);
2173290631Savos
2174290631Savos	bf = urtwn_getbuf(sc);
2175290631Savos	if (bf == NULL)
2176290631Savos		return (ENOMEM);
2177290631Savos
2178290631Savos	memcpy(bf->buf, desc, sizeof(*desc));
2179290631Savos	urtwn_tx_start(sc, uvp->bcn_mbuf, IEEE80211_FC0_TYPE_MGT, bf);
2180290631Savos
2181290631Savos	sc->sc_txtimer = 5;
2182290631Savos	callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
2183290631Savos
2184290631Savos	return (0);
2185290631Savos}
2186290631Savos
2187292175Savosstatic int
2188292175Savosurtwn_key_alloc(struct ieee80211vap *vap, struct ieee80211_key *k,
2189292175Savos    ieee80211_keyix *keyix, ieee80211_keyix *rxkeyix)
2190292175Savos{
2191292175Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2192292175Savos	uint8_t i;
2193292175Savos
2194292175Savos	if (!(&vap->iv_nw_keys[0] <= k &&
2195292175Savos	     k < &vap->iv_nw_keys[IEEE80211_WEP_NKID])) {
2196292175Savos		if (!(k->wk_flags & IEEE80211_KEY_SWCRYPT)) {
2197292175Savos			URTWN_LOCK(sc);
2198292175Savos			/*
2199292175Savos			 * First 4 slots for group keys,
2200292175Savos			 * what is left - for pairwise.
2201292175Savos			 * XXX incompatible with IBSS RSN.
2202292175Savos			 */
2203292175Savos			for (i = IEEE80211_WEP_NKID;
2204292175Savos			     i < R92C_CAM_ENTRY_COUNT; i++) {
2205292175Savos				if ((sc->keys_bmap & (1 << i)) == 0) {
2206292175Savos					sc->keys_bmap |= 1 << i;
2207292175Savos					*keyix = i;
2208292175Savos					break;
2209292175Savos				}
2210292175Savos			}
2211292175Savos			URTWN_UNLOCK(sc);
2212292175Savos			if (i == R92C_CAM_ENTRY_COUNT) {
2213292175Savos				device_printf(sc->sc_dev,
2214292175Savos				    "%s: no free space in the key table\n",
2215292175Savos				    __func__);
2216292175Savos				return 0;
2217292175Savos			}
2218292175Savos		} else
2219292175Savos			*keyix = 0;
2220292175Savos	} else {
2221292175Savos		*keyix = k - vap->iv_nw_keys;
2222292175Savos	}
2223292175Savos	*rxkeyix = *keyix;
2224292175Savos	return 1;
2225292175Savos}
2226292175Savos
2227290631Savosstatic void
2228292175Savosurtwn_key_set_cb(struct urtwn_softc *sc, union sec_param *data)
2229292175Savos{
2230292175Savos	struct ieee80211_key *k = &data->key;
2231292175Savos	uint8_t algo, keyid;
2232292175Savos	int i, error;
2233292175Savos
2234292175Savos	if (k->wk_keyix < IEEE80211_WEP_NKID)
2235292175Savos		keyid = k->wk_keyix;
2236292175Savos	else
2237292175Savos		keyid = 0;
2238292175Savos
2239292175Savos	/* Map net80211 cipher to HW crypto algorithm. */
2240292175Savos	switch (k->wk_cipher->ic_cipher) {
2241292175Savos	case IEEE80211_CIPHER_WEP:
2242292175Savos		if (k->wk_keylen < 8)
2243292175Savos			algo = R92C_CAM_ALGO_WEP40;
2244292175Savos		else
2245292175Savos			algo = R92C_CAM_ALGO_WEP104;
2246292175Savos		break;
2247292175Savos	case IEEE80211_CIPHER_TKIP:
2248292175Savos		algo = R92C_CAM_ALGO_TKIP;
2249292175Savos		break;
2250292175Savos	case IEEE80211_CIPHER_AES_CCM:
2251292175Savos		algo = R92C_CAM_ALGO_AES;
2252292175Savos		break;
2253292175Savos	default:
2254292175Savos		device_printf(sc->sc_dev, "%s: undefined cipher %d\n",
2255292175Savos		    __func__, k->wk_cipher->ic_cipher);
2256292175Savos		return;
2257292175Savos	}
2258292175Savos
2259294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_KEY,
2260294471Savos	    "%s: keyix %d, keyid %d, algo %d/%d, flags %04X, len %d, "
2261294471Savos	    "macaddr %s\n", __func__, k->wk_keyix, keyid,
2262294471Savos	    k->wk_cipher->ic_cipher, algo, k->wk_flags, k->wk_keylen,
2263294471Savos	    ether_sprintf(k->wk_macaddr));
2264292175Savos
2265292175Savos	/* Write key. */
2266292175Savos	for (i = 0; i < 4; i++) {
2267292175Savos		error = urtwn_cam_write(sc, R92C_CAM_KEY(k->wk_keyix, i),
2268298359Savos		    le32dec(&k->wk_key[i * 4]));
2269292175Savos		if (error != 0)
2270292175Savos			goto fail;
2271292175Savos	}
2272292175Savos
2273292175Savos	/* Write CTL0 last since that will validate the CAM entry. */
2274292175Savos	error = urtwn_cam_write(sc, R92C_CAM_CTL1(k->wk_keyix),
2275298359Savos	    le32dec(&k->wk_macaddr[2]));
2276292175Savos	if (error != 0)
2277292175Savos		goto fail;
2278292175Savos	error = urtwn_cam_write(sc, R92C_CAM_CTL0(k->wk_keyix),
2279292175Savos	    SM(R92C_CAM_ALGO, algo) |
2280292175Savos	    SM(R92C_CAM_KEYID, keyid) |
2281298359Savos	    SM(R92C_CAM_MACLO, le16dec(&k->wk_macaddr[0])) |
2282292175Savos	    R92C_CAM_VALID);
2283292175Savos	if (error != 0)
2284292175Savos		goto fail;
2285292175Savos
2286292175Savos	return;
2287292175Savos
2288292175Savosfail:
2289292175Savos	device_printf(sc->sc_dev, "%s fails, error %d\n", __func__, error);
2290292175Savos}
2291292175Savos
2292292175Savosstatic void
2293292175Savosurtwn_key_del_cb(struct urtwn_softc *sc, union sec_param *data)
2294292175Savos{
2295292175Savos	struct ieee80211_key *k = &data->key;
2296292175Savos	int i;
2297292175Savos
2298294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_KEY,
2299294471Savos	    "%s: keyix %d, flags %04X, macaddr %s\n", __func__,
2300292175Savos	    k->wk_keyix, k->wk_flags, ether_sprintf(k->wk_macaddr));
2301292175Savos
2302292175Savos	urtwn_cam_write(sc, R92C_CAM_CTL0(k->wk_keyix), 0);
2303292175Savos	urtwn_cam_write(sc, R92C_CAM_CTL1(k->wk_keyix), 0);
2304292175Savos
2305292175Savos	/* Clear key. */
2306292175Savos	for (i = 0; i < 4; i++)
2307292175Savos		urtwn_cam_write(sc, R92C_CAM_KEY(k->wk_keyix, i), 0);
2308292175Savos	sc->keys_bmap &= ~(1 << k->wk_keyix);
2309292175Savos}
2310292175Savos
2311292175Savosstatic int
2312292175Savosurtwn_key_set(struct ieee80211vap *vap, const struct ieee80211_key *k)
2313292175Savos{
2314292175Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2315292175Savos
2316292175Savos	if (k->wk_flags & IEEE80211_KEY_SWCRYPT) {
2317292175Savos		/* Not for us. */
2318292175Savos		return (1);
2319292175Savos	}
2320292175Savos
2321292175Savos	return (!urtwn_cmd_sleepable(sc, k, sizeof(*k), urtwn_key_set_cb));
2322292175Savos}
2323292175Savos
2324292175Savosstatic int
2325292175Savosurtwn_key_delete(struct ieee80211vap *vap, const struct ieee80211_key *k)
2326292175Savos{
2327292175Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2328292175Savos
2329292175Savos	if (k->wk_flags & IEEE80211_KEY_SWCRYPT) {
2330292175Savos		/* Not for us. */
2331292175Savos		return (1);
2332292175Savos	}
2333292175Savos
2334292175Savos	return (!urtwn_cmd_sleepable(sc, k, sizeof(*k), urtwn_key_del_cb));
2335292175Savos}
2336292175Savos
2337292175Savosstatic void
2338290651Savosurtwn_tsf_task_adhoc(void *arg, int pending)
2339290651Savos{
2340290651Savos	struct ieee80211vap *vap = arg;
2341290651Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2342290651Savos	struct ieee80211_node *ni;
2343290651Savos	uint32_t reg;
2344290651Savos
2345290651Savos	URTWN_LOCK(sc);
2346290651Savos	ni = ieee80211_ref_node(vap->iv_bss);
2347290651Savos	reg = urtwn_read_1(sc, R92C_BCN_CTRL);
2348290651Savos
2349290651Savos	/* Accept beacons with the same BSSID. */
2350290651Savos	urtwn_set_rx_bssid_all(sc, 0);
2351290651Savos
2352290651Savos	/* Enable synchronization. */
2353290651Savos	reg &= ~R92C_BCN_CTRL_DIS_TSF_UDT0;
2354290651Savos	urtwn_write_1(sc, R92C_BCN_CTRL, reg);
2355290651Savos
2356290651Savos	/* Synchronize. */
2357290651Savos	usb_pause_mtx(&sc->sc_mtx, hz * ni->ni_intval * 5 / 1000);
2358290651Savos
2359290651Savos	/* Disable synchronization. */
2360290651Savos	reg |= R92C_BCN_CTRL_DIS_TSF_UDT0;
2361290651Savos	urtwn_write_1(sc, R92C_BCN_CTRL, reg);
2362290651Savos
2363290651Savos	/* Remove beacon filter. */
2364290651Savos	urtwn_set_rx_bssid_all(sc, 1);
2365290651Savos
2366290651Savos	/* Enable beaconing. */
2367290651Savos	urtwn_write_1(sc, R92C_MBID_NUM,
2368290651Savos	    urtwn_read_1(sc, R92C_MBID_NUM) | R92C_MBID_TXBCN_RPT0);
2369290651Savos	reg |= R92C_BCN_CTRL_EN_BCN;
2370290651Savos
2371290651Savos	urtwn_write_1(sc, R92C_BCN_CTRL, reg);
2372290651Savos	ieee80211_free_node(ni);
2373290651Savos	URTWN_UNLOCK(sc);
2374290651Savos}
2375290651Savos
2376290651Savosstatic void
2377290631Savosurtwn_tsf_sync_enable(struct urtwn_softc *sc, struct ieee80211vap *vap)
2378290631Savos{
2379290651Savos	struct ieee80211com *ic = &sc->sc_ic;
2380290651Savos	struct urtwn_vap *uvp = URTWN_VAP(vap);
2381290651Savos
2382290631Savos	/* Reset TSF. */
2383290631Savos	urtwn_write_1(sc, R92C_DUAL_TSF_RST, R92C_DUAL_TSF_RST0);
2384290631Savos
2385290631Savos	switch (vap->iv_opmode) {
2386290631Savos	case IEEE80211_M_STA:
2387290631Savos		/* Enable TSF synchronization. */
2388290631Savos		urtwn_write_1(sc, R92C_BCN_CTRL,
2389290631Savos		    urtwn_read_1(sc, R92C_BCN_CTRL) &
2390290631Savos		    ~R92C_BCN_CTRL_DIS_TSF_UDT0);
2391290631Savos		break;
2392290651Savos	case IEEE80211_M_IBSS:
2393290651Savos		ieee80211_runtask(ic, &uvp->tsf_task_adhoc);
2394290651Savos		break;
2395290631Savos	case IEEE80211_M_HOSTAP:
2396290631Savos		/* Enable beaconing. */
2397290631Savos		urtwn_write_1(sc, R92C_MBID_NUM,
2398290631Savos		    urtwn_read_1(sc, R92C_MBID_NUM) | R92C_MBID_TXBCN_RPT0);
2399290631Savos		urtwn_write_1(sc, R92C_BCN_CTRL,
2400290631Savos		    urtwn_read_1(sc, R92C_BCN_CTRL) | R92C_BCN_CTRL_EN_BCN);
2401290631Savos		break;
2402290631Savos	default:
2403290631Savos		device_printf(sc->sc_dev, "undefined opmode %d\n",
2404290631Savos		    vap->iv_opmode);
2405290631Savos		return;
2406290631Savos	}
2407290631Savos}
2408290631Savos
2409290631Savosstatic void
2410292203Savosurtwn_get_tsf(struct urtwn_softc *sc, uint64_t *buf)
2411292203Savos{
2412292203Savos	urtwn_read_region_1(sc, R92C_TSFTR, (uint8_t *)buf, sizeof(*buf));
2413292203Savos}
2414292203Savos
2415292203Savosstatic void
2416251538Srpaulourtwn_set_led(struct urtwn_softc *sc, int led, int on)
2417251538Srpaulo{
2418251538Srpaulo	uint8_t reg;
2419281069Srpaulo
2420251538Srpaulo	if (led == URTWN_LED_LINK) {
2421264912Skevlo		if (sc->chip & URTWN_CHIP_88E) {
2422264912Skevlo			reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0xf0;
2423264912Skevlo			urtwn_write_1(sc, R92C_LEDCFG2, reg | 0x60);
2424264912Skevlo			if (!on) {
2425264912Skevlo				reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0x90;
2426264912Skevlo				urtwn_write_1(sc, R92C_LEDCFG2,
2427264912Skevlo				    reg | R92C_LEDCFG0_DIS);
2428264912Skevlo				urtwn_write_1(sc, R92C_MAC_PINMUX_CFG,
2429264912Skevlo				    urtwn_read_1(sc, R92C_MAC_PINMUX_CFG) &
2430264912Skevlo				    0xfe);
2431264912Skevlo			}
2432264912Skevlo		} else {
2433264912Skevlo			reg = urtwn_read_1(sc, R92C_LEDCFG0) & 0x70;
2434264912Skevlo			if (!on)
2435264912Skevlo				reg |= R92C_LEDCFG0_DIS;
2436264912Skevlo			urtwn_write_1(sc, R92C_LEDCFG0, reg);
2437264912Skevlo		}
2438264912Skevlo		sc->ledlink = on;       /* Save LED state. */
2439251538Srpaulo	}
2440251538Srpaulo}
2441251538Srpaulo
2442289811Savosstatic void
2443289811Savosurtwn_set_mode(struct urtwn_softc *sc, uint8_t mode)
2444289811Savos{
2445289811Savos	uint8_t reg;
2446289811Savos
2447289811Savos	reg = urtwn_read_1(sc, R92C_MSR);
2448289811Savos	reg = (reg & ~R92C_MSR_MASK) | mode;
2449289811Savos	urtwn_write_1(sc, R92C_MSR, reg);
2450289811Savos}
2451289811Savos
2452290651Savosstatic void
2453290651Savosurtwn_ibss_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m, int subtype,
2454290651Savos    const struct ieee80211_rx_stats *rxs,
2455290651Savos    int rssi, int nf)
2456290651Savos{
2457290651Savos	struct ieee80211vap *vap = ni->ni_vap;
2458290651Savos	struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2459290651Savos	struct urtwn_vap *uvp = URTWN_VAP(vap);
2460290651Savos	uint64_t ni_tstamp, curr_tstamp;
2461290651Savos
2462290651Savos	uvp->recv_mgmt(ni, m, subtype, rxs, rssi, nf);
2463290651Savos
2464290651Savos	if (vap->iv_state == IEEE80211_S_RUN &&
2465290651Savos	    (subtype == IEEE80211_FC0_SUBTYPE_BEACON ||
2466290651Savos	    subtype == IEEE80211_FC0_SUBTYPE_PROBE_RESP)) {
2467290651Savos		ni_tstamp = le64toh(ni->ni_tstamp.tsf);
2468290651Savos		URTWN_LOCK(sc);
2469290651Savos		urtwn_get_tsf(sc, &curr_tstamp);
2470290651Savos		URTWN_UNLOCK(sc);
2471290651Savos		curr_tstamp = le64toh(curr_tstamp);
2472290651Savos
2473290651Savos		if (ni_tstamp >= curr_tstamp)
2474290651Savos			(void) ieee80211_ibss_merge(ni);
2475290651Savos	}
2476290651Savos}
2477290651Savos
2478251538Srpaulostatic int
2479251538Srpaulourtwn_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg)
2480251538Srpaulo{
2481251538Srpaulo	struct urtwn_vap *uvp = URTWN_VAP(vap);
2482251538Srpaulo	struct ieee80211com *ic = vap->iv_ic;
2483286949Sadrian	struct urtwn_softc *sc = ic->ic_softc;
2484251538Srpaulo	struct ieee80211_node *ni;
2485251538Srpaulo	enum ieee80211_state ostate;
2486290631Savos	uint32_t reg;
2487290631Savos	uint8_t mode;
2488290631Savos	int error = 0;
2489251538Srpaulo
2490251538Srpaulo	ostate = vap->iv_state;
2491294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_STATE, "%s -> %s\n",
2492294471Savos	    ieee80211_state_name[ostate], ieee80211_state_name[nstate]);
2493251538Srpaulo
2494251538Srpaulo	IEEE80211_UNLOCK(ic);
2495251538Srpaulo	URTWN_LOCK(sc);
2496251538Srpaulo	callout_stop(&sc->sc_watchdog_ch);
2497251538Srpaulo
2498251538Srpaulo	if (ostate == IEEE80211_S_RUN) {
2499294473Savos		/* Stop calibration. */
2500294473Savos		callout_stop(&sc->sc_calib_to);
2501294473Savos
2502251538Srpaulo		/* Turn link LED off. */
2503251538Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, 0);
2504251538Srpaulo
2505251538Srpaulo		/* Set media status to 'No Link'. */
2506289811Savos		urtwn_set_mode(sc, R92C_MSR_NOLINK);
2507251538Srpaulo
2508251538Srpaulo		/* Stop Rx of data frames. */
2509251538Srpaulo		urtwn_write_2(sc, R92C_RXFLTMAP2, 0);
2510251538Srpaulo
2511251538Srpaulo		/* Disable TSF synchronization. */
2512251538Srpaulo		urtwn_write_1(sc, R92C_BCN_CTRL,
2513290631Savos		    (urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_EN_BCN) |
2514251538Srpaulo		    R92C_BCN_CTRL_DIS_TSF_UDT0);
2515251538Srpaulo
2516290631Savos		/* Disable beaconing. */
2517290631Savos		urtwn_write_1(sc, R92C_MBID_NUM,
2518290631Savos		    urtwn_read_1(sc, R92C_MBID_NUM) & ~R92C_MBID_TXBCN_RPT0);
2519290631Savos
2520290631Savos		/* Reset TSF. */
2521290631Savos		urtwn_write_1(sc, R92C_DUAL_TSF_RST, R92C_DUAL_TSF_RST0);
2522290631Savos
2523251538Srpaulo		/* Reset EDCA parameters. */
2524251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002f3217);
2525251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005e4317);
2526251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x00105320);
2527251538Srpaulo		urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a444);
2528251538Srpaulo	}
2529251538Srpaulo
2530251538Srpaulo	switch (nstate) {
2531251538Srpaulo	case IEEE80211_S_INIT:
2532251538Srpaulo		/* Turn link LED off. */
2533251538Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, 0);
2534251538Srpaulo		break;
2535251538Srpaulo	case IEEE80211_S_SCAN:
2536251538Srpaulo		/* Pause AC Tx queues. */
2537251538Srpaulo		urtwn_write_1(sc, R92C_TXPAUSE,
2538293180Savos		    urtwn_read_1(sc, R92C_TXPAUSE) | R92C_TX_QUEUE_AC);
2539251538Srpaulo		break;
2540251538Srpaulo	case IEEE80211_S_AUTH:
2541251538Srpaulo		urtwn_set_chan(sc, ic->ic_curchan, NULL);
2542251538Srpaulo		break;
2543251538Srpaulo	case IEEE80211_S_RUN:
2544251538Srpaulo		if (vap->iv_opmode == IEEE80211_M_MONITOR) {
2545251538Srpaulo			/* Turn link LED on. */
2546251538Srpaulo			urtwn_set_led(sc, URTWN_LED_LINK, 1);
2547251538Srpaulo			break;
2548251538Srpaulo		}
2549251538Srpaulo
2550251538Srpaulo		ni = ieee80211_ref_node(vap->iv_bss);
2551290631Savos
2552290631Savos		if (ic->ic_bsschan == IEEE80211_CHAN_ANYC ||
2553290631Savos		    ni->ni_chan == IEEE80211_CHAN_ANYC) {
2554290631Savos			device_printf(sc->sc_dev,
2555290631Savos			    "%s: could not move to RUN state\n", __func__);
2556290631Savos			error = EINVAL;
2557290631Savos			goto end_run;
2558290631Savos		}
2559290631Savos
2560290631Savos		switch (vap->iv_opmode) {
2561290631Savos		case IEEE80211_M_STA:
2562290631Savos			mode = R92C_MSR_INFRA;
2563290631Savos			break;
2564290651Savos		case IEEE80211_M_IBSS:
2565290651Savos			mode = R92C_MSR_ADHOC;
2566290651Savos			break;
2567290631Savos		case IEEE80211_M_HOSTAP:
2568290631Savos			mode = R92C_MSR_AP;
2569290631Savos			break;
2570290631Savos		default:
2571290631Savos			device_printf(sc->sc_dev, "undefined opmode %d\n",
2572290631Savos			    vap->iv_opmode);
2573290631Savos			error = EINVAL;
2574290631Savos			goto end_run;
2575290631Savos		}
2576290631Savos
2577251538Srpaulo		/* Set media status to 'Associated'. */
2578290631Savos		urtwn_set_mode(sc, mode);
2579251538Srpaulo
2580251538Srpaulo		/* Set BSSID. */
2581298359Savos		urtwn_write_4(sc, R92C_BSSID + 0, le32dec(&ni->ni_bssid[0]));
2582298359Savos		urtwn_write_4(sc, R92C_BSSID + 4, le16dec(&ni->ni_bssid[4]));
2583251538Srpaulo
2584251538Srpaulo		if (ic->ic_curmode == IEEE80211_MODE_11B)
2585251538Srpaulo			urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 0);
2586251538Srpaulo		else	/* 802.11b/g */
2587251538Srpaulo			urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 3);
2588251538Srpaulo
2589251538Srpaulo		/* Enable Rx of data frames. */
2590251538Srpaulo		urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff);
2591251538Srpaulo
2592251538Srpaulo		/* Flush all AC queues. */
2593251538Srpaulo		urtwn_write_1(sc, R92C_TXPAUSE, 0);
2594251538Srpaulo
2595251538Srpaulo		/* Set beacon interval. */
2596251538Srpaulo		urtwn_write_2(sc, R92C_BCN_INTERVAL, ni->ni_intval);
2597251538Srpaulo
2598251538Srpaulo		/* Allow Rx from our BSSID only. */
2599290564Savos		if (ic->ic_promisc == 0) {
2600290631Savos			reg = urtwn_read_4(sc, R92C_RCR);
2601290631Savos
2602290631Savos			if (vap->iv_opmode != IEEE80211_M_HOSTAP)
2603290631Savos				reg |= R92C_RCR_CBSSID_DATA;
2604290651Savos			if (vap->iv_opmode != IEEE80211_M_IBSS)
2605290651Savos				reg |= R92C_RCR_CBSSID_BCN;
2606290631Savos
2607290631Savos			urtwn_write_4(sc, R92C_RCR, reg);
2608290564Savos		}
2609251538Srpaulo
2610290651Savos		if (vap->iv_opmode == IEEE80211_M_HOSTAP ||
2611290651Savos		    vap->iv_opmode == IEEE80211_M_IBSS) {
2612290631Savos			error = urtwn_setup_beacon(sc, ni);
2613290631Savos			if (error != 0) {
2614290631Savos				device_printf(sc->sc_dev,
2615290631Savos				    "unable to push beacon into the chip, "
2616290631Savos				    "error %d\n", error);
2617290631Savos				goto end_run;
2618290631Savos			}
2619290631Savos		}
2620290631Savos
2621251538Srpaulo		/* Enable TSF synchronization. */
2622290631Savos		urtwn_tsf_sync_enable(sc, vap);
2623251538Srpaulo
2624251538Srpaulo		urtwn_write_1(sc, R92C_SIFS_CCK + 1, 10);
2625251538Srpaulo		urtwn_write_1(sc, R92C_SIFS_OFDM + 1, 10);
2626251538Srpaulo		urtwn_write_1(sc, R92C_SPEC_SIFS + 1, 10);
2627251538Srpaulo		urtwn_write_1(sc, R92C_MAC_SPEC_SIFS + 1, 10);
2628251538Srpaulo		urtwn_write_1(sc, R92C_R2T_SIFS + 1, 10);
2629251538Srpaulo		urtwn_write_1(sc, R92C_T2T_SIFS + 1, 10);
2630251538Srpaulo
2631251538Srpaulo		/* Intialize rate adaptation. */
2632292167Savos		if (!(sc->chip & URTWN_CHIP_88E))
2633264912Skevlo			urtwn_ra_init(sc);
2634251538Srpaulo		/* Turn link LED on. */
2635251538Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, 1);
2636251538Srpaulo
2637251538Srpaulo		sc->avg_pwdb = -1;	/* Reset average RSSI. */
2638251538Srpaulo		/* Reset temperature calibration state machine. */
2639294473Savos		sc->sc_flags &= ~URTWN_TEMP_MEASURED;
2640251538Srpaulo		sc->thcal_lctemp = 0;
2641294473Savos		/* Start periodic calibration. */
2642294473Savos		callout_reset(&sc->sc_calib_to, 2*hz, urtwn_calib_to, sc);
2643290631Savos
2644290631Savosend_run:
2645251538Srpaulo		ieee80211_free_node(ni);
2646251538Srpaulo		break;
2647251538Srpaulo	default:
2648251538Srpaulo		break;
2649251538Srpaulo	}
2650290631Savos
2651251538Srpaulo	URTWN_UNLOCK(sc);
2652251538Srpaulo	IEEE80211_LOCK(ic);
2653290631Savos	return (error != 0 ? error : uvp->newstate(vap, nstate, arg));
2654251538Srpaulo}
2655251538Srpaulo
2656251538Srpaulostatic void
2657294473Savosurtwn_calib_to(void *arg)
2658294473Savos{
2659294473Savos	struct urtwn_softc *sc = arg;
2660294473Savos
2661294473Savos	/* Do it in a process context. */
2662294473Savos	urtwn_cmd_sleepable(sc, NULL, 0, urtwn_calib_cb);
2663294473Savos}
2664294473Savos
2665294473Savosstatic void
2666294473Savosurtwn_calib_cb(struct urtwn_softc *sc, union sec_param *data)
2667294473Savos{
2668294473Savos	/* Do temperature compensation. */
2669294473Savos	urtwn_temp_calib(sc);
2670294473Savos
2671294473Savos	if ((urtwn_read_1(sc, R92C_MSR) & R92C_MSR_MASK) != R92C_MSR_NOLINK)
2672294473Savos		callout_reset(&sc->sc_calib_to, 2*hz, urtwn_calib_to, sc);
2673294473Savos}
2674294473Savos
2675294473Savosstatic void
2676251538Srpaulourtwn_watchdog(void *arg)
2677251538Srpaulo{
2678251538Srpaulo	struct urtwn_softc *sc = arg;
2679251538Srpaulo
2680251538Srpaulo	if (sc->sc_txtimer > 0) {
2681251538Srpaulo		if (--sc->sc_txtimer == 0) {
2682251538Srpaulo			device_printf(sc->sc_dev, "device timeout\n");
2683287197Sglebius			counter_u64_add(sc->sc_ic.ic_oerrors, 1);
2684251538Srpaulo			return;
2685251538Srpaulo		}
2686251538Srpaulo		callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
2687251538Srpaulo	}
2688251538Srpaulo}
2689251538Srpaulo
2690251538Srpaulostatic void
2691251538Srpaulourtwn_update_avgrssi(struct urtwn_softc *sc, int rate, int8_t rssi)
2692251538Srpaulo{
2693251538Srpaulo	int pwdb;
2694251538Srpaulo
2695251538Srpaulo	/* Convert antenna signal to percentage. */
2696251538Srpaulo	if (rssi <= -100 || rssi >= 20)
2697251538Srpaulo		pwdb = 0;
2698251538Srpaulo	else if (rssi >= 0)
2699251538Srpaulo		pwdb = 100;
2700251538Srpaulo	else
2701251538Srpaulo		pwdb = 100 + rssi;
2702264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
2703289758Savos		if (rate <= URTWN_RIDX_CCK11) {
2704264912Skevlo			/* CCK gain is smaller than OFDM/MCS gain. */
2705264912Skevlo			pwdb += 6;
2706264912Skevlo			if (pwdb > 100)
2707264912Skevlo				pwdb = 100;
2708264912Skevlo			if (pwdb <= 14)
2709264912Skevlo				pwdb -= 4;
2710264912Skevlo			else if (pwdb <= 26)
2711264912Skevlo				pwdb -= 8;
2712264912Skevlo			else if (pwdb <= 34)
2713264912Skevlo				pwdb -= 6;
2714264912Skevlo			else if (pwdb <= 42)
2715264912Skevlo				pwdb -= 2;
2716264912Skevlo		}
2717251538Srpaulo	}
2718251538Srpaulo	if (sc->avg_pwdb == -1)	/* Init. */
2719251538Srpaulo		sc->avg_pwdb = pwdb;
2720251538Srpaulo	else if (sc->avg_pwdb < pwdb)
2721251538Srpaulo		sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20) + 1;
2722251538Srpaulo	else
2723251538Srpaulo		sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20);
2724297175Sadrian	URTWN_DPRINTF(sc, URTWN_DEBUG_RSSI, "%s: PWDB %d, EMA %d\n", __func__,
2725294471Savos	    pwdb, sc->avg_pwdb);
2726251538Srpaulo}
2727251538Srpaulo
2728251538Srpaulostatic int8_t
2729251538Srpaulourtwn_get_rssi(struct urtwn_softc *sc, int rate, void *physt)
2730251538Srpaulo{
2731251538Srpaulo	static const int8_t cckoff[] = { 16, -12, -26, -46 };
2732251538Srpaulo	struct r92c_rx_phystat *phy;
2733251538Srpaulo	struct r92c_rx_cck *cck;
2734251538Srpaulo	uint8_t rpt;
2735251538Srpaulo	int8_t rssi;
2736251538Srpaulo
2737289758Savos	if (rate <= URTWN_RIDX_CCK11) {
2738251538Srpaulo		cck = (struct r92c_rx_cck *)physt;
2739251538Srpaulo		if (sc->sc_flags & URTWN_FLAG_CCK_HIPWR) {
2740251538Srpaulo			rpt = (cck->agc_rpt >> 5) & 0x3;
2741251538Srpaulo			rssi = (cck->agc_rpt & 0x1f) << 1;
2742251538Srpaulo		} else {
2743251538Srpaulo			rpt = (cck->agc_rpt >> 6) & 0x3;
2744251538Srpaulo			rssi = cck->agc_rpt & 0x3e;
2745251538Srpaulo		}
2746251538Srpaulo		rssi = cckoff[rpt] - rssi;
2747251538Srpaulo	} else {	/* OFDM/HT. */
2748251538Srpaulo		phy = (struct r92c_rx_phystat *)physt;
2749251538Srpaulo		rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110;
2750251538Srpaulo	}
2751251538Srpaulo	return (rssi);
2752251538Srpaulo}
2753251538Srpaulo
2754264912Skevlostatic int8_t
2755264912Skevlourtwn_r88e_get_rssi(struct urtwn_softc *sc, int rate, void *physt)
2756264912Skevlo{
2757264912Skevlo	struct r92c_rx_phystat *phy;
2758264912Skevlo	struct r88e_rx_cck *cck;
2759264912Skevlo	uint8_t cck_agc_rpt, lna_idx, vga_idx;
2760264912Skevlo	int8_t rssi;
2761264912Skevlo
2762264972Skevlo	rssi = 0;
2763289758Savos	if (rate <= URTWN_RIDX_CCK11) {
2764264912Skevlo		cck = (struct r88e_rx_cck *)physt;
2765264912Skevlo		cck_agc_rpt = cck->agc_rpt;
2766264912Skevlo		lna_idx = (cck_agc_rpt & 0xe0) >> 5;
2767281069Srpaulo		vga_idx = cck_agc_rpt & 0x1f;
2768264912Skevlo		switch (lna_idx) {
2769264912Skevlo		case 7:
2770264912Skevlo			if (vga_idx <= 27)
2771264912Skevlo				rssi = -100 + 2* (27 - vga_idx);
2772264912Skevlo			else
2773264912Skevlo				rssi = -100;
2774264912Skevlo			break;
2775264912Skevlo		case 6:
2776264912Skevlo			rssi = -48 + 2 * (2 - vga_idx);
2777264912Skevlo			break;
2778264912Skevlo		case 5:
2779264912Skevlo			rssi = -42 + 2 * (7 - vga_idx);
2780264912Skevlo			break;
2781264912Skevlo		case 4:
2782264912Skevlo			rssi = -36 + 2 * (7 - vga_idx);
2783264912Skevlo			break;
2784264912Skevlo		case 3:
2785264912Skevlo			rssi = -24 + 2 * (7 - vga_idx);
2786264912Skevlo			break;
2787264912Skevlo		case 2:
2788264912Skevlo			rssi = -12 + 2 * (5 - vga_idx);
2789264912Skevlo			break;
2790264912Skevlo		case 1:
2791264912Skevlo			rssi = 8 - (2 * vga_idx);
2792264912Skevlo			break;
2793264912Skevlo		case 0:
2794264912Skevlo			rssi = 14 - (2 * vga_idx);
2795264912Skevlo			break;
2796264912Skevlo		}
2797264912Skevlo		rssi += 6;
2798264912Skevlo	} else {	/* OFDM/HT. */
2799264912Skevlo		phy = (struct r92c_rx_phystat *)physt;
2800264912Skevlo		rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110;
2801264912Skevlo	}
2802264912Skevlo	return (rssi);
2803264912Skevlo}
2804264912Skevlo
2805292167Savosstatic __inline uint8_t
2806292167Savosrate2ridx(uint8_t rate)
2807292167Savos{
2808297175Sadrian	if (rate & IEEE80211_RATE_MCS) {
2809297175Sadrian		/* 11n rates start at idx 12 */
2810297175Sadrian		return ((rate & 0xf) + 12);
2811297175Sadrian	}
2812292167Savos	switch (rate) {
2813297175Sadrian	/* 11g */
2814292167Savos	case 12:	return 4;
2815292167Savos	case 18:	return 5;
2816292167Savos	case 24:	return 6;
2817292167Savos	case 36:	return 7;
2818292167Savos	case 48:	return 8;
2819292167Savos	case 72:	return 9;
2820292167Savos	case 96:	return 10;
2821292167Savos	case 108:	return 11;
2822297175Sadrian	/* 11b */
2823292167Savos	case 2:		return 0;
2824292167Savos	case 4:		return 1;
2825292167Savos	case 11:	return 2;
2826292167Savos	case 22:	return 3;
2827292167Savos	default:	return 0;
2828292167Savos	}
2829292167Savos}
2830292167Savos
2831251538Srpaulostatic int
2832290630Savosurtwn_tx_data(struct urtwn_softc *sc, struct ieee80211_node *ni,
2833290630Savos    struct mbuf *m, struct urtwn_data *data)
2834251538Srpaulo{
2835292167Savos	const struct ieee80211_txparam *tp;
2836287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
2837251538Srpaulo	struct ieee80211vap *vap = ni->ni_vap;
2838292167Savos	struct ieee80211_key *k = NULL;
2839292167Savos	struct ieee80211_channel *chan;
2840292167Savos	struct ieee80211_frame *wh;
2841251538Srpaulo	struct r92c_tx_desc *txd;
2842292167Savos	uint8_t macid, raid, rate, ridx, subtype, type, tid, qsel;
2843292014Savos	int hasqos, ismcast;
2844251538Srpaulo
2845251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
2846251538Srpaulo
2847251538Srpaulo	/*
2848251538Srpaulo	 * Software crypto.
2849251538Srpaulo	 */
2850290630Savos	wh = mtod(m, struct ieee80211_frame *);
2851264912Skevlo	type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;
2852290630Savos	subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;
2853292014Savos	hasqos = IEEE80211_QOS_HAS_SEQ(wh);
2854290630Savos	ismcast = IEEE80211_IS_MULTICAST(wh->i_addr1);
2855264912Skevlo
2856292014Savos	/* Select TX ring for this frame. */
2857292014Savos	if (hasqos) {
2858292014Savos		tid = ((const struct ieee80211_qosframe *)wh)->i_qos[0];
2859292014Savos		tid &= IEEE80211_QOS_TID;
2860292014Savos	} else
2861292014Savos		tid = 0;
2862292014Savos
2863292167Savos	chan = (ni->ni_chan != IEEE80211_CHAN_ANYC) ?
2864292167Savos		ni->ni_chan : ic->ic_curchan;
2865292167Savos	tp = &vap->iv_txparms[ieee80211_chan2mode(chan)];
2866292167Savos
2867292167Savos	/* Choose a TX rate index. */
2868292167Savos	if (type == IEEE80211_FC0_TYPE_MGT)
2869292167Savos		rate = tp->mgmtrate;
2870292167Savos	else if (ismcast)
2871292167Savos		rate = tp->mcastrate;
2872292167Savos	else if (tp->ucastrate != IEEE80211_FIXED_RATE_NONE)
2873292167Savos		rate = tp->ucastrate;
2874292167Savos	else if (m->m_flags & M_EAPOL)
2875292167Savos		rate = tp->mgmtrate;
2876292167Savos	else {
2877292167Savos		if (URTWN_CHIP_HAS_RATECTL(sc)) {
2878292167Savos			/* XXX pass pktlen */
2879292167Savos			(void) ieee80211_ratectl_rate(ni, NULL, 0);
2880292167Savos			rate = ni->ni_txrate;
2881292167Savos		} else {
2882297175Sadrian			/* XXX TODO: drop the default rate for 11b/11g? */
2883297175Sadrian			if (ni->ni_flags & IEEE80211_NODE_HT)
2884297175Sadrian				rate = IEEE80211_RATE_MCS | 0x4; /* MCS4 */
2885297175Sadrian			else if (ic->ic_curmode != IEEE80211_MODE_11B)
2886292167Savos				rate = 108;
2887292167Savos			else
2888292167Savos				rate = 22;
2889292167Savos		}
2890292167Savos	}
2891292167Savos
2892297175Sadrian	/*
2893297175Sadrian	 * XXX TODO: this should be per-node, for 11b versus 11bg
2894297175Sadrian	 * nodes in hostap mode
2895297175Sadrian	 */
2896292167Savos	ridx = rate2ridx(rate);
2897297175Sadrian	if (ni->ni_flags & IEEE80211_NODE_HT)
2898297175Sadrian		raid = R92C_RAID_11GN;
2899297175Sadrian	else if (ic->ic_curmode != IEEE80211_MODE_11B)
2900292167Savos		raid = R92C_RAID_11BG;
2901292167Savos	else
2902292167Savos		raid = R92C_RAID_11B;
2903292167Savos
2904260444Skevlo	if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) {
2905290630Savos		k = ieee80211_crypto_encap(ni, m);
2906251538Srpaulo		if (k == NULL) {
2907251538Srpaulo			device_printf(sc->sc_dev,
2908251538Srpaulo			    "ieee80211_crypto_encap returns NULL.\n");
2909251538Srpaulo			return (ENOBUFS);
2910251538Srpaulo		}
2911251538Srpaulo
2912251538Srpaulo		/* in case packet header moved, reset pointer */
2913290630Savos		wh = mtod(m, struct ieee80211_frame *);
2914251538Srpaulo	}
2915281069Srpaulo
2916251538Srpaulo	/* Fill Tx descriptor. */
2917251538Srpaulo	txd = (struct r92c_tx_desc *)data->buf;
2918251538Srpaulo	memset(txd, 0, sizeof(*txd));
2919251538Srpaulo
2920251538Srpaulo	txd->txdw0 |= htole32(
2921251538Srpaulo	    SM(R92C_TXDW0_OFFSET, sizeof(*txd)) |
2922251538Srpaulo	    R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG);
2923290630Savos	if (ismcast)
2924251538Srpaulo		txd->txdw0 |= htole32(R92C_TXDW0_BMCAST);
2925290630Savos
2926290630Savos	if (!ismcast) {
2927292167Savos		if (sc->chip & URTWN_CHIP_88E) {
2928292167Savos			struct urtwn_node *un = URTWN_NODE(ni);
2929292167Savos			macid = un->id;
2930292167Savos		} else
2931292167Savos			macid = URTWN_MACID_BSS;
2932290630Savos
2933290630Savos		if (type == IEEE80211_FC0_TYPE_DATA) {
2934292014Savos			qsel = tid % URTWN_MAX_TID;
2935290630Savos
2936292167Savos			if (sc->chip & URTWN_CHIP_88E) {
2937292167Savos				txd->txdw2 |= htole32(
2938292167Savos				    R88E_TXDW2_AGGBK |
2939292167Savos				    R88E_TXDW2_CCX_RPT);
2940292167Savos			} else
2941290630Savos				txd->txdw1 |= htole32(R92C_TXDW1_AGGBK);
2942290630Savos
2943297175Sadrian			/* protmode, non-HT */
2944297175Sadrian			/* XXX TODO: noack frames? */
2945297175Sadrian			if ((rate & 0x80) == 0 &&
2946297175Sadrian			    (ic->ic_flags & IEEE80211_F_USEPROT)) {
2947290630Savos				switch (ic->ic_protmode) {
2948290630Savos				case IEEE80211_PROT_CTSONLY:
2949290630Savos					txd->txdw4 |= htole32(
2950290630Savos					    R92C_TXDW4_CTS2SELF |
2951290630Savos					    R92C_TXDW4_HWRTSEN);
2952290630Savos					break;
2953290630Savos				case IEEE80211_PROT_RTSCTS:
2954290630Savos					txd->txdw4 |= htole32(
2955290630Savos					    R92C_TXDW4_RTSEN |
2956290630Savos					    R92C_TXDW4_HWRTSEN);
2957290630Savos					break;
2958290630Savos				default:
2959290630Savos					break;
2960290630Savos				}
2961290630Savos			}
2962297175Sadrian
2963297175Sadrian			/* protmode, HT */
2964297175Sadrian			/* XXX TODO: noack frames? */
2965297175Sadrian			if ((rate & 0x80) &&
2966297175Sadrian			    (ic->ic_htprotmode == IEEE80211_PROT_RTSCTS)) {
2967297175Sadrian				txd->txdw4 |= htole32(
2968297175Sadrian				    R92C_TXDW4_RTSEN |
2969297175Sadrian				    R92C_TXDW4_HWRTSEN);
2970297175Sadrian			}
2971297175Sadrian
2972297175Sadrian			/* XXX TODO: rtsrate is configurable? 24mbit may
2973297175Sadrian			 * be a bit high for RTS rate? */
2974290630Savos			txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE,
2975290630Savos			    URTWN_RIDX_OFDM24));
2976297175Sadrian
2977290630Savos			txd->txdw5 |= htole32(0x0001ff00);
2978290630Savos		} else	/* IEEE80211_FC0_TYPE_MGT */
2979290630Savos			qsel = R92C_TXDW1_QSEL_MGNT;
2980251538Srpaulo	} else {
2981290630Savos		macid = URTWN_MACID_BC;
2982290630Savos		qsel = R92C_TXDW1_QSEL_MGNT;
2983290630Savos	}
2984251538Srpaulo
2985290630Savos	txd->txdw1 |= htole32(
2986290630Savos	    SM(R92C_TXDW1_QSEL, qsel) |
2987290630Savos	    SM(R92C_TXDW1_RAID, raid));
2988290630Savos
2989297175Sadrian	/* XXX TODO: 40MHZ flag? */
2990297175Sadrian	/* XXX TODO: AMPDU flag? (AGG_ENABLE or AGG_BREAK?) Density shift? */
2991297175Sadrian	/* XXX Short preamble? */
2992297175Sadrian	/* XXX Short-GI? */
2993297175Sadrian
2994290630Savos	if (sc->chip & URTWN_CHIP_88E)
2995290630Savos		txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, macid));
2996290630Savos	else
2997290630Savos		txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, macid));
2998290630Savos
2999290630Savos	txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, ridx));
3000297175Sadrian
3001291858Savos	/* Force this rate if needed. */
3002292167Savos	if (URTWN_CHIP_HAS_RATECTL(sc) || ismcast ||
3003297175Sadrian	    (tp->ucastrate != IEEE80211_FIXED_RATE_NONE) ||
3004292167Savos	    (m->m_flags & M_EAPOL) || type != IEEE80211_FC0_TYPE_DATA)
3005251538Srpaulo		txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE);
3006251538Srpaulo
3007292014Savos	if (!hasqos) {
3008251538Srpaulo		/* Use HW sequence numbering for non-QoS frames. */
3009291858Savos		if (sc->chip & URTWN_CHIP_88E)
3010291858Savos			txd->txdseq = htole16(R88E_TXDSEQ_HWSEQ_EN);
3011291858Savos		else
3012291858Savos			txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN);
3013290630Savos	} else {
3014290630Savos		/* Set sequence number. */
3015290630Savos		txd->txdseq = htole16(M_SEQNO_GET(m) % IEEE80211_SEQ_RANGE);
3016290630Savos	}
3017251538Srpaulo
3018292175Savos	if (k != NULL && !(k->wk_flags & IEEE80211_KEY_SWCRYPT)) {
3019292175Savos		uint8_t cipher;
3020292175Savos
3021292175Savos		switch (k->wk_cipher->ic_cipher) {
3022292175Savos		case IEEE80211_CIPHER_WEP:
3023292175Savos		case IEEE80211_CIPHER_TKIP:
3024292175Savos			cipher = R92C_TXDW1_CIPHER_RC4;
3025292175Savos			break;
3026292175Savos		case IEEE80211_CIPHER_AES_CCM:
3027292175Savos			cipher = R92C_TXDW1_CIPHER_AES;
3028292175Savos			break;
3029292175Savos		default:
3030292175Savos			device_printf(sc->sc_dev, "%s: unknown cipher %d\n",
3031292175Savos			    __func__, k->wk_cipher->ic_cipher);
3032292175Savos			return (EINVAL);
3033292175Savos		}
3034292175Savos
3035292175Savos		txd->txdw1 |= htole32(SM(R92C_TXDW1_CIPHER, cipher));
3036292175Savos	}
3037292175Savos
3038251538Srpaulo	if (ieee80211_radiotap_active_vap(vap)) {
3039251538Srpaulo		struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap;
3040251538Srpaulo
3041251538Srpaulo		tap->wt_flags = 0;
3042290630Savos		if (k != NULL)
3043290630Savos			tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP;
3044290630Savos		ieee80211_radiotap_tx(vap, m);
3045251538Srpaulo	}
3046251538Srpaulo
3047290630Savos	data->ni = ni;
3048251538Srpaulo
3049290630Savos	urtwn_tx_start(sc, m, type, data);
3050290630Savos
3051290630Savos	return (0);
3052290630Savos}
3053290630Savos
3054292221Savosstatic int
3055292221Savosurtwn_tx_raw(struct urtwn_softc *sc, struct ieee80211_node *ni,
3056292221Savos    struct mbuf *m, struct urtwn_data *data,
3057292221Savos    const struct ieee80211_bpf_params *params)
3058292221Savos{
3059292221Savos	struct ieee80211vap *vap = ni->ni_vap;
3060292221Savos	struct ieee80211_key *k = NULL;
3061292221Savos	struct ieee80211_frame *wh;
3062292221Savos	struct r92c_tx_desc *txd;
3063292221Savos	uint8_t cipher, ridx, type;
3064292221Savos
3065292221Savos	/* Encrypt the frame if need be. */
3066292221Savos	cipher = R92C_TXDW1_CIPHER_NONE;
3067292221Savos	if (params->ibp_flags & IEEE80211_BPF_CRYPTO) {
3068292221Savos		/* Retrieve key for TX. */
3069292221Savos		k = ieee80211_crypto_encap(ni, m);
3070292221Savos		if (k == NULL)
3071292221Savos			return (ENOBUFS);
3072292221Savos
3073292221Savos		if (!(k->wk_flags & IEEE80211_KEY_SWCRYPT)) {
3074292221Savos			switch (k->wk_cipher->ic_cipher) {
3075292221Savos			case IEEE80211_CIPHER_WEP:
3076292221Savos			case IEEE80211_CIPHER_TKIP:
3077292221Savos				cipher = R92C_TXDW1_CIPHER_RC4;
3078292221Savos				break;
3079292221Savos			case IEEE80211_CIPHER_AES_CCM:
3080292221Savos				cipher = R92C_TXDW1_CIPHER_AES;
3081292221Savos				break;
3082292221Savos			default:
3083292221Savos				device_printf(sc->sc_dev,
3084292221Savos				    "%s: unknown cipher %d\n",
3085292221Savos				    __func__, k->wk_cipher->ic_cipher);
3086292221Savos				return (EINVAL);
3087292221Savos			}
3088292221Savos		}
3089292221Savos	}
3090292221Savos
3091297175Sadrian	/* XXX TODO: 11n checks, matching urtwn_tx_data() */
3092297175Sadrian
3093292221Savos	wh = mtod(m, struct ieee80211_frame *);
3094292221Savos	type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;
3095292221Savos
3096292221Savos	/* Fill Tx descriptor. */
3097292221Savos	txd = (struct r92c_tx_desc *)data->buf;
3098292221Savos	memset(txd, 0, sizeof(*txd));
3099292221Savos
3100292221Savos	txd->txdw0 |= htole32(
3101292221Savos	    SM(R92C_TXDW0_OFFSET, sizeof(*txd)) |
3102292221Savos	    R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG);
3103292221Savos	if (IEEE80211_IS_MULTICAST(wh->i_addr1))
3104292221Savos		txd->txdw0 |= htole32(R92C_TXDW0_BMCAST);
3105292221Savos
3106292221Savos	if (params->ibp_flags & IEEE80211_BPF_RTS)
3107292221Savos		txd->txdw4 |= htole32(R92C_TXDW4_RTSEN);
3108292221Savos	if (params->ibp_flags & IEEE80211_BPF_CTS)
3109292221Savos		txd->txdw4 |= htole32(R92C_TXDW4_CTS2SELF);
3110292221Savos	if (txd->txdw4 & htole32(R92C_TXDW4_RTSEN | R92C_TXDW4_CTS2SELF)) {
3111292221Savos		txd->txdw4 |= htole32(R92C_TXDW4_HWRTSEN);
3112292221Savos		txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE,
3113292221Savos		    URTWN_RIDX_OFDM24));
3114292221Savos	}
3115292221Savos
3116292221Savos	if (sc->chip & URTWN_CHIP_88E)
3117292221Savos		txd->txdw1 |= htole32(SM(R88E_TXDW1_MACID, URTWN_MACID_BC));
3118292221Savos	else
3119292221Savos		txd->txdw1 |= htole32(SM(R92C_TXDW1_MACID, URTWN_MACID_BC));
3120292221Savos
3121297175Sadrian	/* XXX TODO: rate index/config (RAID) for 11n? */
3122292221Savos	txd->txdw1 |= htole32(SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_MGNT));
3123292221Savos	txd->txdw1 |= htole32(SM(R92C_TXDW1_CIPHER, cipher));
3124292221Savos
3125292221Savos	/* Choose a TX rate index. */
3126292221Savos	ridx = rate2ridx(params->ibp_rate0);
3127292221Savos	txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, ridx));
3128292221Savos	txd->txdw5 |= htole32(0x0001ff00);
3129292221Savos	txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE);
3130292221Savos
3131292221Savos	if (!IEEE80211_QOS_HAS_SEQ(wh)) {
3132292221Savos		/* Use HW sequence numbering for non-QoS frames. */
3133292221Savos		if (sc->chip & URTWN_CHIP_88E)
3134292221Savos			txd->txdseq = htole16(R88E_TXDSEQ_HWSEQ_EN);
3135292221Savos		else
3136292221Savos			txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ_EN);
3137292221Savos	} else {
3138292221Savos		/* Set sequence number. */
3139292221Savos		txd->txdseq = htole16(M_SEQNO_GET(m) % IEEE80211_SEQ_RANGE);
3140292221Savos	}
3141292221Savos
3142292221Savos	if (ieee80211_radiotap_active_vap(vap)) {
3143292221Savos		struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap;
3144292221Savos
3145292221Savos		tap->wt_flags = 0;
3146292221Savos		if (k != NULL)
3147292221Savos			tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP;
3148292221Savos		ieee80211_radiotap_tx(vap, m);
3149292221Savos	}
3150292221Savos
3151292221Savos	data->ni = ni;
3152292221Savos
3153292221Savos	urtwn_tx_start(sc, m, type, data);
3154292221Savos
3155292221Savos	return (0);
3156292221Savos}
3157292221Savos
3158290630Savosstatic void
3159290630Savosurtwn_tx_start(struct urtwn_softc *sc, struct mbuf *m, uint8_t type,
3160290630Savos    struct urtwn_data *data)
3161290630Savos{
3162290630Savos	struct usb_xfer *xfer;
3163290630Savos	struct r92c_tx_desc *txd;
3164290630Savos	uint16_t ac, sum;
3165290630Savos	int i, xferlen;
3166290630Savos
3167290630Savos	URTWN_ASSERT_LOCKED(sc);
3168290630Savos
3169290630Savos	ac = M_WME_GETAC(m);
3170290630Savos
3171290630Savos	switch (type) {
3172290630Savos	case IEEE80211_FC0_TYPE_CTL:
3173290630Savos	case IEEE80211_FC0_TYPE_MGT:
3174290630Savos		xfer = sc->sc_xfer[URTWN_BULK_TX_VO];
3175290630Savos		break;
3176290630Savos	default:
3177292014Savos		xfer = sc->sc_xfer[wme2queue[ac].qid];
3178290630Savos		break;
3179290630Savos	}
3180290630Savos
3181290630Savos	txd = (struct r92c_tx_desc *)data->buf;
3182290630Savos	txd->txdw0 |= htole32(SM(R92C_TXDW0_PKTLEN, m->m_pkthdr.len));
3183290630Savos
3184290630Savos	/* Compute Tx descriptor checksum. */
3185290630Savos	sum = 0;
3186290630Savos	for (i = 0; i < sizeof(*txd) / 2; i++)
3187290630Savos		sum ^= ((uint16_t *)txd)[i];
3188290630Savos	txd->txdsum = sum;	/* NB: already little endian. */
3189290630Savos
3190290630Savos	xferlen = sizeof(*txd) + m->m_pkthdr.len;
3191290630Savos	m_copydata(m, 0, m->m_pkthdr.len, (caddr_t)&txd[1]);
3192290630Savos
3193251538Srpaulo	data->buflen = xferlen;
3194290630Savos	data->m = m;
3195251538Srpaulo
3196251538Srpaulo	STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next);
3197251538Srpaulo	usbd_transfer_start(xfer);
3198251538Srpaulo}
3199251538Srpaulo
3200287197Sglebiusstatic int
3201287197Sglebiusurtwn_transmit(struct ieee80211com *ic, struct mbuf *m)
3202251538Srpaulo{
3203287197Sglebius	struct urtwn_softc *sc = ic->ic_softc;
3204287197Sglebius	int error;
3205261863Srpaulo
3206261863Srpaulo	URTWN_LOCK(sc);
3207287197Sglebius	if ((sc->sc_flags & URTWN_RUNNING) == 0) {
3208287197Sglebius		URTWN_UNLOCK(sc);
3209287197Sglebius		return (ENXIO);
3210287197Sglebius	}
3211287197Sglebius	error = mbufq_enqueue(&sc->sc_snd, m);
3212287197Sglebius	if (error) {
3213287197Sglebius		URTWN_UNLOCK(sc);
3214287197Sglebius		return (error);
3215287197Sglebius	}
3216287197Sglebius	urtwn_start(sc);
3217261863Srpaulo	URTWN_UNLOCK(sc);
3218287197Sglebius
3219287197Sglebius	return (0);
3220261863Srpaulo}
3221261863Srpaulo
3222261863Srpaulostatic void
3223287197Sglebiusurtwn_start(struct urtwn_softc *sc)
3224261863Srpaulo{
3225251538Srpaulo	struct ieee80211_node *ni;
3226251538Srpaulo	struct mbuf *m;
3227251538Srpaulo	struct urtwn_data *bf;
3228251538Srpaulo
3229261863Srpaulo	URTWN_ASSERT_LOCKED(sc);
3230287197Sglebius	while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) {
3231251538Srpaulo		bf = urtwn_getbuf(sc);
3232251538Srpaulo		if (bf == NULL) {
3233287197Sglebius			mbufq_prepend(&sc->sc_snd, m);
3234251538Srpaulo			break;
3235251538Srpaulo		}
3236251538Srpaulo		ni = (struct ieee80211_node *)m->m_pkthdr.rcvif;
3237251538Srpaulo		m->m_pkthdr.rcvif = NULL;
3238297596Sadrian
3239297596Sadrian		URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT, "%s: called; m=%p\n",
3240297596Sadrian		    __func__,
3241297596Sadrian		    m);
3242297596Sadrian
3243290630Savos		if (urtwn_tx_data(sc, ni, m, bf) != 0) {
3244287197Sglebius			if_inc_counter(ni->ni_vap->iv_ifp,
3245287197Sglebius			    IFCOUNTER_OERRORS, 1);
3246251538Srpaulo			STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next);
3247288353Sadrian			m_freem(m);
3248251538Srpaulo			ieee80211_free_node(ni);
3249251538Srpaulo			break;
3250251538Srpaulo		}
3251251538Srpaulo		sc->sc_txtimer = 5;
3252251538Srpaulo		callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
3253251538Srpaulo	}
3254251538Srpaulo}
3255251538Srpaulo
3256287197Sglebiusstatic void
3257287197Sglebiusurtwn_parent(struct ieee80211com *ic)
3258251538Srpaulo{
3259286949Sadrian	struct urtwn_softc *sc = ic->ic_softc;
3260251538Srpaulo
3261263153Skevlo	URTWN_LOCK(sc);
3262287197Sglebius	if (sc->sc_flags & URTWN_DETACHED) {
3263287197Sglebius		URTWN_UNLOCK(sc);
3264287197Sglebius		return;
3265287197Sglebius	}
3266291698Savos	URTWN_UNLOCK(sc);
3267291698Savos
3268287197Sglebius	if (ic->ic_nrunning > 0) {
3269291698Savos		if (urtwn_init(sc) != 0) {
3270291698Savos			struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
3271291698Savos			if (vap != NULL)
3272291698Savos				ieee80211_stop(vap);
3273291698Savos		} else
3274291698Savos			ieee80211_start_all(ic);
3275291698Savos	} else
3276287197Sglebius		urtwn_stop(sc);
3277251538Srpaulo}
3278251538Srpaulo
3279264912Skevlostatic __inline int
3280251538Srpaulourtwn_power_on(struct urtwn_softc *sc)
3281251538Srpaulo{
3282264912Skevlo
3283264912Skevlo	return sc->sc_power_on(sc);
3284264912Skevlo}
3285264912Skevlo
3286264912Skevlostatic int
3287264912Skevlourtwn_r92c_power_on(struct urtwn_softc *sc)
3288264912Skevlo{
3289251538Srpaulo	uint32_t reg;
3290291698Savos	usb_error_t error;
3291251538Srpaulo	int ntries;
3292251538Srpaulo
3293251538Srpaulo	/* Wait for autoload done bit. */
3294251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
3295251538Srpaulo		if (urtwn_read_1(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_PFM_ALDN)
3296251538Srpaulo			break;
3297266472Shselasky		urtwn_ms_delay(sc);
3298251538Srpaulo	}
3299251538Srpaulo	if (ntries == 1000) {
3300251538Srpaulo		device_printf(sc->sc_dev,
3301251538Srpaulo		    "timeout waiting for chip autoload\n");
3302251538Srpaulo		return (ETIMEDOUT);
3303251538Srpaulo	}
3304251538Srpaulo
3305251538Srpaulo	/* Unlock ISO/CLK/Power control register. */
3306291698Savos	error = urtwn_write_1(sc, R92C_RSV_CTRL, 0);
3307291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3308291698Savos		return (EIO);
3309251538Srpaulo	/* Move SPS into PWM mode. */
3310291698Savos	error = urtwn_write_1(sc, R92C_SPS0_CTRL, 0x2b);
3311291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3312291698Savos		return (EIO);
3313266472Shselasky	urtwn_ms_delay(sc);
3314251538Srpaulo
3315251538Srpaulo	reg = urtwn_read_1(sc, R92C_LDOV12D_CTRL);
3316251538Srpaulo	if (!(reg & R92C_LDOV12D_CTRL_LDV12_EN)) {
3317291698Savos		error = urtwn_write_1(sc, R92C_LDOV12D_CTRL,
3318251538Srpaulo		    reg | R92C_LDOV12D_CTRL_LDV12_EN);
3319291698Savos		if (error != USB_ERR_NORMAL_COMPLETION)
3320291698Savos			return (EIO);
3321266472Shselasky		urtwn_ms_delay(sc);
3322291698Savos		error = urtwn_write_1(sc, R92C_SYS_ISO_CTRL,
3323251538Srpaulo		    urtwn_read_1(sc, R92C_SYS_ISO_CTRL) &
3324251538Srpaulo		    ~R92C_SYS_ISO_CTRL_MD2PP);
3325291698Savos		if (error != USB_ERR_NORMAL_COMPLETION)
3326291698Savos			return (EIO);
3327251538Srpaulo	}
3328251538Srpaulo
3329251538Srpaulo	/* Auto enable WLAN. */
3330291698Savos	error = urtwn_write_2(sc, R92C_APS_FSMCO,
3331251538Srpaulo	    urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC);
3332291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3333291698Savos		return (EIO);
3334251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
3335262822Skevlo		if (!(urtwn_read_2(sc, R92C_APS_FSMCO) &
3336262822Skevlo		    R92C_APS_FSMCO_APFM_ONMAC))
3337251538Srpaulo			break;
3338266472Shselasky		urtwn_ms_delay(sc);
3339251538Srpaulo	}
3340251538Srpaulo	if (ntries == 1000) {
3341251538Srpaulo		device_printf(sc->sc_dev,
3342251538Srpaulo		    "timeout waiting for MAC auto ON\n");
3343251538Srpaulo		return (ETIMEDOUT);
3344251538Srpaulo	}
3345251538Srpaulo
3346251538Srpaulo	/* Enable radio, GPIO and LED functions. */
3347291698Savos	error = urtwn_write_2(sc, R92C_APS_FSMCO,
3348251538Srpaulo	    R92C_APS_FSMCO_AFSM_HSUS |
3349251538Srpaulo	    R92C_APS_FSMCO_PDN_EN |
3350251538Srpaulo	    R92C_APS_FSMCO_PFM_ALDN);
3351291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3352291698Savos		return (EIO);
3353251538Srpaulo	/* Release RF digital isolation. */
3354291698Savos	error = urtwn_write_2(sc, R92C_SYS_ISO_CTRL,
3355251538Srpaulo	    urtwn_read_2(sc, R92C_SYS_ISO_CTRL) & ~R92C_SYS_ISO_CTRL_DIOR);
3356291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3357291698Savos		return (EIO);
3358251538Srpaulo
3359251538Srpaulo	/* Initialize MAC. */
3360291698Savos	error = urtwn_write_1(sc, R92C_APSD_CTRL,
3361251538Srpaulo	    urtwn_read_1(sc, R92C_APSD_CTRL) & ~R92C_APSD_CTRL_OFF);
3362291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3363291698Savos		return (EIO);
3364251538Srpaulo	for (ntries = 0; ntries < 200; ntries++) {
3365251538Srpaulo		if (!(urtwn_read_1(sc, R92C_APSD_CTRL) &
3366251538Srpaulo		    R92C_APSD_CTRL_OFF_STATUS))
3367251538Srpaulo			break;
3368266472Shselasky		urtwn_ms_delay(sc);
3369251538Srpaulo	}
3370251538Srpaulo	if (ntries == 200) {
3371251538Srpaulo		device_printf(sc->sc_dev,
3372251538Srpaulo		    "timeout waiting for MAC initialization\n");
3373251538Srpaulo		return (ETIMEDOUT);
3374251538Srpaulo	}
3375251538Srpaulo
3376251538Srpaulo	/* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */
3377251538Srpaulo	reg = urtwn_read_2(sc, R92C_CR);
3378251538Srpaulo	reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN |
3379251538Srpaulo	    R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN |
3380251538Srpaulo	    R92C_CR_SCHEDULE_EN | R92C_CR_MACTXEN | R92C_CR_MACRXEN |
3381251538Srpaulo	    R92C_CR_ENSEC;
3382291698Savos	error = urtwn_write_2(sc, R92C_CR, reg);
3383291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3384291698Savos		return (EIO);
3385251538Srpaulo
3386291698Savos	error = urtwn_write_1(sc, 0xfe10, 0x19);
3387291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3388291698Savos		return (EIO);
3389251538Srpaulo	return (0);
3390251538Srpaulo}
3391251538Srpaulo
3392251538Srpaulostatic int
3393264912Skevlourtwn_r88e_power_on(struct urtwn_softc *sc)
3394264912Skevlo{
3395264912Skevlo	uint32_t reg;
3396291698Savos	usb_error_t error;
3397264912Skevlo	int ntries;
3398264912Skevlo
3399264912Skevlo	/* Wait for power ready bit. */
3400264912Skevlo	for (ntries = 0; ntries < 5000; ntries++) {
3401281918Skevlo		if (urtwn_read_4(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_SUS_HOST)
3402264912Skevlo			break;
3403266472Shselasky		urtwn_ms_delay(sc);
3404264912Skevlo	}
3405264912Skevlo	if (ntries == 5000) {
3406264912Skevlo		device_printf(sc->sc_dev,
3407264912Skevlo		    "timeout waiting for chip power up\n");
3408264912Skevlo		return (ETIMEDOUT);
3409264912Skevlo	}
3410264912Skevlo
3411264912Skevlo	/* Reset BB. */
3412291698Savos	error = urtwn_write_1(sc, R92C_SYS_FUNC_EN,
3413264912Skevlo	    urtwn_read_1(sc, R92C_SYS_FUNC_EN) & ~(R92C_SYS_FUNC_EN_BBRSTB |
3414264912Skevlo	    R92C_SYS_FUNC_EN_BB_GLB_RST));
3415291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3416291698Savos		return (EIO);
3417264912Skevlo
3418291698Savos	error = urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 2,
3419281918Skevlo	    urtwn_read_1(sc, R92C_AFE_XTAL_CTRL + 2) | 0x80);
3420291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3421291698Savos		return (EIO);
3422264912Skevlo
3423264912Skevlo	/* Disable HWPDN. */
3424291698Savos	error = urtwn_write_2(sc, R92C_APS_FSMCO,
3425281918Skevlo	    urtwn_read_2(sc, R92C_APS_FSMCO) & ~R92C_APS_FSMCO_APDM_HPDN);
3426291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3427291698Savos		return (EIO);
3428264912Skevlo
3429264912Skevlo	/* Disable WL suspend. */
3430291698Savos	error = urtwn_write_2(sc, R92C_APS_FSMCO,
3431281918Skevlo	    urtwn_read_2(sc, R92C_APS_FSMCO) &
3432281918Skevlo	    ~(R92C_APS_FSMCO_AFSM_HSUS | R92C_APS_FSMCO_AFSM_PCIE));
3433291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3434291698Savos		return (EIO);
3435264912Skevlo
3436291698Savos	error = urtwn_write_2(sc, R92C_APS_FSMCO,
3437281918Skevlo	    urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC);
3438291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3439291698Savos		return (EIO);
3440264912Skevlo	for (ntries = 0; ntries < 5000; ntries++) {
3441281918Skevlo		if (!(urtwn_read_2(sc, R92C_APS_FSMCO) &
3442281918Skevlo		    R92C_APS_FSMCO_APFM_ONMAC))
3443264912Skevlo			break;
3444266472Shselasky		urtwn_ms_delay(sc);
3445264912Skevlo	}
3446264912Skevlo	if (ntries == 5000)
3447264912Skevlo		return (ETIMEDOUT);
3448264912Skevlo
3449264912Skevlo	/* Enable LDO normal mode. */
3450291698Savos	error = urtwn_write_1(sc, R92C_LPLDO_CTRL,
3451295874Savos	    urtwn_read_1(sc, R92C_LPLDO_CTRL) & ~R92C_LPLDO_CTRL_SLEEP);
3452291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3453291698Savos		return (EIO);
3454264912Skevlo
3455264912Skevlo	/* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */
3456291698Savos	error = urtwn_write_2(sc, R92C_CR, 0);
3457291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3458291698Savos		return (EIO);
3459264912Skevlo	reg = urtwn_read_2(sc, R92C_CR);
3460264912Skevlo	reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN |
3461264912Skevlo	    R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN |
3462264912Skevlo	    R92C_CR_SCHEDULE_EN | R92C_CR_ENSEC | R92C_CR_CALTMR_EN;
3463291698Savos	error = urtwn_write_2(sc, R92C_CR, reg);
3464291698Savos	if (error != USB_ERR_NORMAL_COMPLETION)
3465291698Savos		return (EIO);
3466264912Skevlo
3467264912Skevlo	return (0);
3468264912Skevlo}
3469264912Skevlo
3470295874Savosstatic __inline void
3471295874Savosurtwn_power_off(struct urtwn_softc *sc)
3472295874Savos{
3473295874Savos
3474295874Savos	return sc->sc_power_off(sc);
3475295874Savos}
3476295874Savos
3477295874Savosstatic void
3478295874Savosurtwn_r92c_power_off(struct urtwn_softc *sc)
3479295874Savos{
3480295874Savos	uint32_t reg;
3481295874Savos
3482295874Savos	/* Block all Tx queues. */
3483295874Savos	urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL);
3484295874Savos
3485295874Savos	/* Disable RF */
3486295874Savos	urtwn_rf_write(sc, 0, 0, 0);
3487295874Savos
3488295874Savos	urtwn_write_1(sc, R92C_APSD_CTRL, R92C_APSD_CTRL_OFF);
3489295874Savos
3490295874Savos	/* Reset BB state machine */
3491295874Savos	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
3492295874Savos	    R92C_SYS_FUNC_EN_USBD | R92C_SYS_FUNC_EN_USBA |
3493295874Savos	    R92C_SYS_FUNC_EN_BB_GLB_RST);
3494295874Savos	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
3495295874Savos	    R92C_SYS_FUNC_EN_USBD | R92C_SYS_FUNC_EN_USBA);
3496295874Savos
3497295874Savos	/*
3498295874Savos	 * Reset digital sequence
3499295874Savos	 */
3500295874Savos#ifndef URTWN_WITHOUT_UCODE
3501295874Savos	if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RDY) {
3502295874Savos		/* Reset MCU ready status */
3503295874Savos		urtwn_write_1(sc, R92C_MCUFWDL, 0);
3504295874Savos
3505295874Savos		/* If firmware in ram code, do reset */
3506295874Savos		urtwn_fw_reset(sc);
3507295874Savos	}
3508295874Savos#endif
3509295874Savos
3510295874Savos	/* Reset MAC and Enable 8051 */
3511295874Savos	urtwn_write_1(sc, R92C_SYS_FUNC_EN + 1,
3512295874Savos	    (R92C_SYS_FUNC_EN_CPUEN |
3513295874Savos	     R92C_SYS_FUNC_EN_ELDR |
3514295874Savos	     R92C_SYS_FUNC_EN_HWPDN) >> 8);
3515295874Savos
3516295874Savos	/* Reset MCU ready status */
3517295874Savos	urtwn_write_1(sc, R92C_MCUFWDL, 0);
3518295874Savos
3519295874Savos	/* Disable MAC clock */
3520295874Savos	urtwn_write_2(sc, R92C_SYS_CLKR,
3521295874Savos	    R92C_SYS_CLKR_ANAD16V_EN |
3522295874Savos	    R92C_SYS_CLKR_ANA8M |
3523295874Savos	    R92C_SYS_CLKR_LOADER_EN |
3524295874Savos	    R92C_SYS_CLKR_80M_SSC_DIS |
3525295874Savos	    R92C_SYS_CLKR_SYS_EN |
3526295874Savos	    R92C_SYS_CLKR_RING_EN |
3527295874Savos	    0x4000);
3528295874Savos
3529295874Savos	/* Disable AFE PLL */
3530295874Savos	urtwn_write_1(sc, R92C_AFE_PLL_CTRL, 0x80);
3531295874Savos
3532295874Savos	/* Gated AFE DIG_CLOCK */
3533295874Savos	urtwn_write_2(sc, R92C_AFE_XTAL_CTRL, 0x880F);
3534295874Savos
3535295874Savos	/* Isolated digital to PON */
3536295874Savos	urtwn_write_1(sc, R92C_SYS_ISO_CTRL,
3537295874Savos	    R92C_SYS_ISO_CTRL_MD2PP |
3538295874Savos	    R92C_SYS_ISO_CTRL_PA2PCIE |
3539295874Savos	    R92C_SYS_ISO_CTRL_PD2CORE |
3540295874Savos	    R92C_SYS_ISO_CTRL_IP2MAC |
3541295874Savos	    R92C_SYS_ISO_CTRL_DIOP |
3542295874Savos	    R92C_SYS_ISO_CTRL_DIOE);
3543295874Savos
3544295874Savos	/*
3545295874Savos	 * Pull GPIO PIN to balance level and LED control
3546295874Savos	 */
3547295874Savos	/* 1. Disable GPIO[7:0] */
3548295874Savos	urtwn_write_2(sc, R92C_GPIO_IOSEL, 0x0000);
3549295874Savos
3550295874Savos	reg = urtwn_read_4(sc, R92C_GPIO_PIN_CTRL) & ~0x0000ff00;
3551295874Savos	reg |= ((reg << 8) & 0x0000ff00) | 0x00ff0000;
3552295874Savos	urtwn_write_4(sc, R92C_GPIO_PIN_CTRL, reg);
3553295874Savos
3554295874Savos	/* Disable GPIO[10:8] */
3555295874Savos	urtwn_write_1(sc, R92C_MAC_PINMUX_CFG, 0x00);
3556295874Savos
3557295874Savos	reg = urtwn_read_2(sc, R92C_GPIO_IO_SEL) & ~0x00f0;
3558295874Savos	reg |= (((reg & 0x000f) << 4) | 0x0780);
3559295874Savos	urtwn_write_2(sc, R92C_GPIO_IO_SEL, reg);
3560295874Savos
3561295874Savos	/* Disable LED0 & 1 */
3562295874Savos	urtwn_write_2(sc, R92C_LEDCFG0, 0x8080);
3563295874Savos
3564295874Savos	/*
3565295874Savos	 * Reset digital sequence
3566295874Savos	 */
3567295874Savos	/* Disable ELDR clock */
3568295874Savos	urtwn_write_2(sc, R92C_SYS_CLKR,
3569295874Savos	    R92C_SYS_CLKR_ANAD16V_EN |
3570295874Savos	    R92C_SYS_CLKR_ANA8M |
3571295874Savos	    R92C_SYS_CLKR_LOADER_EN |
3572295874Savos	    R92C_SYS_CLKR_80M_SSC_DIS |
3573295874Savos	    R92C_SYS_CLKR_SYS_EN |
3574295874Savos	    R92C_SYS_CLKR_RING_EN |
3575295874Savos	    0x4000);
3576295874Savos
3577295874Savos	/* Isolated ELDR to PON */
3578295874Savos	urtwn_write_1(sc, R92C_SYS_ISO_CTRL + 1,
3579295874Savos	    (R92C_SYS_ISO_CTRL_DIOR |
3580295874Savos	     R92C_SYS_ISO_CTRL_PWC_EV12V) >> 8);
3581295874Savos
3582295874Savos	/*
3583295874Savos	 * Disable analog sequence
3584295874Savos	 */
3585295874Savos	/* Disable A15 power */
3586295874Savos	urtwn_write_1(sc, R92C_LDOA15_CTRL, R92C_LDOA15_CTRL_OBUF);
3587295874Savos	/* Disable digital core power */
3588295874Savos	urtwn_write_1(sc, R92C_LDOV12D_CTRL,
3589295874Savos	    urtwn_read_1(sc, R92C_LDOV12D_CTRL) &
3590295874Savos	      ~R92C_LDOV12D_CTRL_LDV12_EN);
3591295874Savos
3592295874Savos	/* Enter PFM mode */
3593295874Savos	urtwn_write_1(sc, R92C_SPS0_CTRL, 0x23);
3594295874Savos
3595295874Savos	/* Set USB suspend */
3596295874Savos	urtwn_write_2(sc, R92C_APS_FSMCO,
3597295874Savos	    R92C_APS_FSMCO_APDM_HOST |
3598295874Savos	    R92C_APS_FSMCO_AFSM_HSUS |
3599295874Savos	    R92C_APS_FSMCO_PFM_ALDN);
3600295874Savos
3601295874Savos	/* Lock ISO/CLK/Power control register. */
3602295874Savos	urtwn_write_1(sc, R92C_RSV_CTRL, 0x0E);
3603295874Savos}
3604295874Savos
3605295874Savosstatic void
3606295874Savosurtwn_r88e_power_off(struct urtwn_softc *sc)
3607295874Savos{
3608295874Savos	uint8_t reg;
3609295874Savos	int ntries;
3610295874Savos
3611295874Savos	/* Disable any kind of TX reports. */
3612295874Savos	urtwn_write_1(sc, R88E_TX_RPT_CTRL,
3613295874Savos	    urtwn_read_1(sc, R88E_TX_RPT_CTRL) &
3614295874Savos	      ~(R88E_TX_RPT1_ENA | R88E_TX_RPT2_ENA));
3615295874Savos
3616295874Savos	/* Stop Rx. */
3617295874Savos	urtwn_write_1(sc, R92C_CR, 0);
3618295874Savos
3619295874Savos	/* Move card to Low Power State. */
3620295874Savos	/* Block all Tx queues. */
3621295874Savos	urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL);
3622295874Savos
3623295874Savos	for (ntries = 0; ntries < 20; ntries++) {
3624295874Savos		/* Should be zero if no packet is transmitting. */
3625295874Savos		if (urtwn_read_4(sc, R88E_SCH_TXCMD) == 0)
3626295874Savos			break;
3627295874Savos
3628295874Savos		urtwn_ms_delay(sc);
3629295874Savos	}
3630295874Savos	if (ntries == 20) {
3631295874Savos		device_printf(sc->sc_dev, "%s: failed to block Tx queues\n",
3632295874Savos		    __func__);
3633295874Savos		return;
3634295874Savos	}
3635295874Savos
3636295874Savos	/* CCK and OFDM are disabled, and clock are gated. */
3637295874Savos	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
3638295874Savos	    urtwn_read_1(sc, R92C_SYS_FUNC_EN) & ~R92C_SYS_FUNC_EN_BBRSTB);
3639295874Savos
3640295874Savos	urtwn_ms_delay(sc);
3641295874Savos
3642295874Savos	/* Reset MAC TRX */
3643295874Savos	urtwn_write_1(sc, R92C_CR,
3644295874Savos	    R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN |
3645295874Savos	    R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN |
3646295874Savos	    R92C_CR_PROTOCOL_EN | R92C_CR_SCHEDULE_EN);
3647295874Savos
3648295874Savos	/* check if removed later */
3649295874Savos	urtwn_write_1(sc, R92C_CR + 1,
3650295874Savos	    urtwn_read_1(sc, R92C_CR + 1) & ~(R92C_CR_ENSEC >> 8));
3651295874Savos
3652295874Savos	/* Respond TxOK to scheduler */
3653295874Savos	urtwn_write_1(sc, R92C_DUAL_TSF_RST,
3654295874Savos	    urtwn_read_1(sc, R92C_DUAL_TSF_RST) | 0x20);
3655295874Savos
3656295874Savos	/* If firmware in ram code, do reset. */
3657295874Savos#ifndef URTWN_WITHOUT_UCODE
3658295874Savos	if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RDY)
3659295874Savos		urtwn_r88e_fw_reset(sc);
3660295874Savos#endif
3661295874Savos
3662295874Savos	/* Reset MCU ready status. */
3663295874Savos	urtwn_write_1(sc, R92C_MCUFWDL, 0x00);
3664295874Savos
3665295874Savos	/* Disable 32k. */
3666295874Savos	urtwn_write_1(sc, R88E_32K_CTRL,
3667295874Savos	    urtwn_read_1(sc, R88E_32K_CTRL) & ~0x01);
3668295874Savos
3669295874Savos	/* Move card to Disabled state. */
3670295874Savos	/* Turn off RF. */
3671295874Savos	urtwn_write_1(sc, R92C_RF_CTRL, 0);
3672295874Savos
3673295874Savos	/* LDO Sleep mode. */
3674295874Savos	urtwn_write_1(sc, R92C_LPLDO_CTRL,
3675295874Savos	    urtwn_read_1(sc, R92C_LPLDO_CTRL) | R92C_LPLDO_CTRL_SLEEP);
3676295874Savos
3677295874Savos	/* Turn off MAC by HW state machine */
3678295874Savos	urtwn_write_1(sc, R92C_APS_FSMCO + 1,
3679295874Savos	    urtwn_read_1(sc, R92C_APS_FSMCO + 1) |
3680295874Savos	    (R92C_APS_FSMCO_APFM_OFF >> 8));
3681295874Savos
3682295874Savos	for (ntries = 0; ntries < 20; ntries++) {
3683295874Savos		/* Wait until it will be disabled. */
3684295874Savos		if ((urtwn_read_1(sc, R92C_APS_FSMCO + 1) &
3685295874Savos		    (R92C_APS_FSMCO_APFM_OFF >> 8)) == 0)
3686295874Savos			break;
3687295874Savos
3688295874Savos		urtwn_ms_delay(sc);
3689295874Savos	}
3690295874Savos	if (ntries == 20) {
3691295874Savos		device_printf(sc->sc_dev, "%s: could not turn off MAC\n",
3692295874Savos		    __func__);
3693295874Savos		return;
3694295874Savos	}
3695295874Savos
3696295874Savos	/* schmit trigger */
3697295874Savos	urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 2,
3698295874Savos	    urtwn_read_1(sc, R92C_AFE_XTAL_CTRL + 2) | 0x80);
3699295874Savos
3700295874Savos	/* Enable WL suspend. */
3701295874Savos	urtwn_write_1(sc, R92C_APS_FSMCO + 1,
3702295874Savos	    (urtwn_read_1(sc, R92C_APS_FSMCO + 1) & ~0x10) | 0x08);
3703295874Savos
3704295874Savos	/* Enable bandgap mbias in suspend. */
3705295874Savos	urtwn_write_1(sc, R92C_APS_FSMCO + 3, 0);
3706295874Savos
3707295874Savos	/* Clear SIC_EN register. */
3708295874Savos	urtwn_write_1(sc, R92C_GPIO_MUXCFG + 1,
3709295874Savos	    urtwn_read_1(sc, R92C_GPIO_MUXCFG + 1) & ~0x10);
3710295874Savos
3711295874Savos	/* Set USB suspend enable local register */
3712295874Savos	urtwn_write_1(sc, R92C_USB_SUSPEND,
3713295874Savos	    urtwn_read_1(sc, R92C_USB_SUSPEND) | 0x10);
3714295874Savos
3715295874Savos	/* Reset MCU IO Wrapper. */
3716295874Savos	reg = urtwn_read_1(sc, R92C_RSV_CTRL + 1);
3717295874Savos	urtwn_write_1(sc, R92C_RSV_CTRL + 1, reg & ~0x08);
3718295874Savos	urtwn_write_1(sc, R92C_RSV_CTRL + 1, reg | 0x08);
3719295874Savos
3720295874Savos	/* marked as 'For Power Consumption' code. */
3721295874Savos	urtwn_write_1(sc, R92C_GPIO_OUT, urtwn_read_1(sc, R92C_GPIO_IN));
3722295874Savos	urtwn_write_1(sc, R92C_GPIO_IOSEL, 0xff);
3723295874Savos
3724295874Savos	urtwn_write_1(sc, R92C_GPIO_IO_SEL,
3725295874Savos	    urtwn_read_1(sc, R92C_GPIO_IO_SEL) << 4);
3726295874Savos	urtwn_write_1(sc, R92C_GPIO_MOD,
3727295874Savos	    urtwn_read_1(sc, R92C_GPIO_MOD) | 0x0f);
3728295874Savos
3729295874Savos	/* Set LNA, TRSW, EX_PA Pin to output mode. */
3730295874Savos	urtwn_write_4(sc, R88E_BB_PAD_CTRL, 0x00080808);
3731295874Savos}
3732295874Savos
3733264912Skevlostatic int
3734251538Srpaulourtwn_llt_init(struct urtwn_softc *sc)
3735251538Srpaulo{
3736264912Skevlo	int i, error, page_count, pktbuf_count;
3737251538Srpaulo
3738264912Skevlo	page_count = (sc->chip & URTWN_CHIP_88E) ?
3739264912Skevlo	    R88E_TX_PAGE_COUNT : R92C_TX_PAGE_COUNT;
3740264912Skevlo	pktbuf_count = (sc->chip & URTWN_CHIP_88E) ?
3741264912Skevlo	    R88E_TXPKTBUF_COUNT : R92C_TXPKTBUF_COUNT;
3742264912Skevlo
3743264912Skevlo	/* Reserve pages [0; page_count]. */
3744264912Skevlo	for (i = 0; i < page_count; i++) {
3745251538Srpaulo		if ((error = urtwn_llt_write(sc, i, i + 1)) != 0)
3746251538Srpaulo			return (error);
3747251538Srpaulo	}
3748251538Srpaulo	/* NB: 0xff indicates end-of-list. */
3749251538Srpaulo	if ((error = urtwn_llt_write(sc, i, 0xff)) != 0)
3750251538Srpaulo		return (error);
3751251538Srpaulo	/*
3752264912Skevlo	 * Use pages [page_count + 1; pktbuf_count - 1]
3753251538Srpaulo	 * as ring buffer.
3754251538Srpaulo	 */
3755264912Skevlo	for (++i; i < pktbuf_count - 1; i++) {
3756251538Srpaulo		if ((error = urtwn_llt_write(sc, i, i + 1)) != 0)
3757251538Srpaulo			return (error);
3758251538Srpaulo	}
3759251538Srpaulo	/* Make the last page point to the beginning of the ring buffer. */
3760264912Skevlo	error = urtwn_llt_write(sc, i, page_count + 1);
3761251538Srpaulo	return (error);
3762251538Srpaulo}
3763251538Srpaulo
3764295871Savos#ifndef URTWN_WITHOUT_UCODE
3765251538Srpaulostatic void
3766251538Srpaulourtwn_fw_reset(struct urtwn_softc *sc)
3767251538Srpaulo{
3768251538Srpaulo	uint16_t reg;
3769251538Srpaulo	int ntries;
3770251538Srpaulo
3771251538Srpaulo	/* Tell 8051 to reset itself. */
3772251538Srpaulo	urtwn_write_1(sc, R92C_HMETFR + 3, 0x20);
3773251538Srpaulo
3774251538Srpaulo	/* Wait until 8051 resets by itself. */
3775251538Srpaulo	for (ntries = 0; ntries < 100; ntries++) {
3776251538Srpaulo		reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
3777251538Srpaulo		if (!(reg & R92C_SYS_FUNC_EN_CPUEN))
3778251538Srpaulo			return;
3779266472Shselasky		urtwn_ms_delay(sc);
3780251538Srpaulo	}
3781251538Srpaulo	/* Force 8051 reset. */
3782251538Srpaulo	urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN);
3783251538Srpaulo}
3784251538Srpaulo
3785264912Skevlostatic void
3786264912Skevlourtwn_r88e_fw_reset(struct urtwn_softc *sc)
3787264912Skevlo{
3788264912Skevlo	uint16_t reg;
3789264912Skevlo
3790264912Skevlo	reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
3791264912Skevlo	urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN);
3792264912Skevlo	urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg | R92C_SYS_FUNC_EN_CPUEN);
3793264912Skevlo}
3794264912Skevlo
3795251538Srpaulostatic int
3796251538Srpaulourtwn_fw_loadpage(struct urtwn_softc *sc, int page, const uint8_t *buf, int len)
3797251538Srpaulo{
3798251538Srpaulo	uint32_t reg;
3799291698Savos	usb_error_t error = USB_ERR_NORMAL_COMPLETION;
3800291698Savos	int off, mlen;
3801251538Srpaulo
3802251538Srpaulo	reg = urtwn_read_4(sc, R92C_MCUFWDL);
3803251538Srpaulo	reg = RW(reg, R92C_MCUFWDL_PAGE, page);
3804251538Srpaulo	urtwn_write_4(sc, R92C_MCUFWDL, reg);
3805251538Srpaulo
3806251538Srpaulo	off = R92C_FW_START_ADDR;
3807251538Srpaulo	while (len > 0) {
3808251538Srpaulo		if (len > 196)
3809251538Srpaulo			mlen = 196;
3810251538Srpaulo		else if (len > 4)
3811251538Srpaulo			mlen = 4;
3812251538Srpaulo		else
3813251538Srpaulo			mlen = 1;
3814251538Srpaulo		/* XXX fix this deconst */
3815281069Srpaulo		error = urtwn_write_region_1(sc, off,
3816251538Srpaulo		    __DECONST(uint8_t *, buf), mlen);
3817291698Savos		if (error != USB_ERR_NORMAL_COMPLETION)
3818251538Srpaulo			break;
3819251538Srpaulo		off += mlen;
3820251538Srpaulo		buf += mlen;
3821251538Srpaulo		len -= mlen;
3822251538Srpaulo	}
3823251538Srpaulo	return (error);
3824251538Srpaulo}
3825251538Srpaulo
3826251538Srpaulostatic int
3827251538Srpaulourtwn_load_firmware(struct urtwn_softc *sc)
3828251538Srpaulo{
3829251538Srpaulo	const struct firmware *fw;
3830251538Srpaulo	const struct r92c_fw_hdr *hdr;
3831251538Srpaulo	const char *imagename;
3832251538Srpaulo	const u_char *ptr;
3833251538Srpaulo	size_t len;
3834251538Srpaulo	uint32_t reg;
3835251538Srpaulo	int mlen, ntries, page, error;
3836251538Srpaulo
3837264864Skevlo	URTWN_UNLOCK(sc);
3838251538Srpaulo	/* Read firmware image from the filesystem. */
3839264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
3840264912Skevlo		imagename = "urtwn-rtl8188eufw";
3841264912Skevlo	else if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) ==
3842264912Skevlo		    URTWN_CHIP_UMC_A_CUT)
3843251538Srpaulo		imagename = "urtwn-rtl8192cfwU";
3844251538Srpaulo	else
3845251538Srpaulo		imagename = "urtwn-rtl8192cfwT";
3846251538Srpaulo
3847251538Srpaulo	fw = firmware_get(imagename);
3848264864Skevlo	URTWN_LOCK(sc);
3849251538Srpaulo	if (fw == NULL) {
3850251538Srpaulo		device_printf(sc->sc_dev,
3851251538Srpaulo		    "failed loadfirmware of file %s\n", imagename);
3852251538Srpaulo		return (ENOENT);
3853251538Srpaulo	}
3854251538Srpaulo
3855251538Srpaulo	len = fw->datasize;
3856251538Srpaulo
3857251538Srpaulo	if (len < sizeof(*hdr)) {
3858251538Srpaulo		device_printf(sc->sc_dev, "firmware too short\n");
3859251538Srpaulo		error = EINVAL;
3860251538Srpaulo		goto fail;
3861251538Srpaulo	}
3862251538Srpaulo	ptr = fw->data;
3863251538Srpaulo	hdr = (const struct r92c_fw_hdr *)ptr;
3864251538Srpaulo	/* Check if there is a valid FW header and skip it. */
3865251538Srpaulo	if ((le16toh(hdr->signature) >> 4) == 0x88c ||
3866264912Skevlo	    (le16toh(hdr->signature) >> 4) == 0x88e ||
3867251538Srpaulo	    (le16toh(hdr->signature) >> 4) == 0x92c) {
3868294471Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_FIRMWARE,
3869294471Savos		    "FW V%d.%d %02d-%02d %02d:%02d\n",
3870251538Srpaulo		    le16toh(hdr->version), le16toh(hdr->subversion),
3871251538Srpaulo		    hdr->month, hdr->date, hdr->hour, hdr->minute);
3872251538Srpaulo		ptr += sizeof(*hdr);
3873251538Srpaulo		len -= sizeof(*hdr);
3874251538Srpaulo	}
3875251538Srpaulo
3876264912Skevlo	if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RAM_DL_SEL) {
3877264912Skevlo		if (sc->chip & URTWN_CHIP_88E)
3878264912Skevlo			urtwn_r88e_fw_reset(sc);
3879264912Skevlo		else
3880264912Skevlo			urtwn_fw_reset(sc);
3881251538Srpaulo		urtwn_write_1(sc, R92C_MCUFWDL, 0);
3882251538Srpaulo	}
3883264912Skevlo
3884268487Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
3885268487Skevlo		urtwn_write_2(sc, R92C_SYS_FUNC_EN,
3886268487Skevlo		    urtwn_read_2(sc, R92C_SYS_FUNC_EN) |
3887268487Skevlo		    R92C_SYS_FUNC_EN_CPUEN);
3888268487Skevlo	}
3889251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL,
3890251538Srpaulo	    urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_EN);
3891251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL + 2,
3892251538Srpaulo	    urtwn_read_1(sc, R92C_MCUFWDL + 2) & ~0x08);
3893251538Srpaulo
3894263154Skevlo	/* Reset the FWDL checksum. */
3895263154Skevlo	urtwn_write_1(sc, R92C_MCUFWDL,
3896263154Skevlo	    urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_CHKSUM_RPT);
3897263154Skevlo
3898251538Srpaulo	for (page = 0; len > 0; page++) {
3899251538Srpaulo		mlen = min(len, R92C_FW_PAGE_SIZE);
3900251538Srpaulo		error = urtwn_fw_loadpage(sc, page, ptr, mlen);
3901251538Srpaulo		if (error != 0) {
3902251538Srpaulo			device_printf(sc->sc_dev,
3903251538Srpaulo			    "could not load firmware page\n");
3904251538Srpaulo			goto fail;
3905251538Srpaulo		}
3906251538Srpaulo		ptr += mlen;
3907251538Srpaulo		len -= mlen;
3908251538Srpaulo	}
3909251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL,
3910251538Srpaulo	    urtwn_read_1(sc, R92C_MCUFWDL) & ~R92C_MCUFWDL_EN);
3911251538Srpaulo	urtwn_write_1(sc, R92C_MCUFWDL + 1, 0);
3912251538Srpaulo
3913251538Srpaulo	/* Wait for checksum report. */
3914251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
3915251538Srpaulo		if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_CHKSUM_RPT)
3916251538Srpaulo			break;
3917266472Shselasky		urtwn_ms_delay(sc);
3918251538Srpaulo	}
3919251538Srpaulo	if (ntries == 1000) {
3920251538Srpaulo		device_printf(sc->sc_dev,
3921251538Srpaulo		    "timeout waiting for checksum report\n");
3922251538Srpaulo		error = ETIMEDOUT;
3923251538Srpaulo		goto fail;
3924251538Srpaulo	}
3925251538Srpaulo
3926251538Srpaulo	reg = urtwn_read_4(sc, R92C_MCUFWDL);
3927251538Srpaulo	reg = (reg & ~R92C_MCUFWDL_WINTINI_RDY) | R92C_MCUFWDL_RDY;
3928251538Srpaulo	urtwn_write_4(sc, R92C_MCUFWDL, reg);
3929264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
3930264912Skevlo		urtwn_r88e_fw_reset(sc);
3931251538Srpaulo	/* Wait for firmware readiness. */
3932251538Srpaulo	for (ntries = 0; ntries < 1000; ntries++) {
3933251538Srpaulo		if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_WINTINI_RDY)
3934251538Srpaulo			break;
3935266472Shselasky		urtwn_ms_delay(sc);
3936251538Srpaulo	}
3937251538Srpaulo	if (ntries == 1000) {
3938251538Srpaulo		device_printf(sc->sc_dev,
3939251538Srpaulo		    "timeout waiting for firmware readiness\n");
3940251538Srpaulo		error = ETIMEDOUT;
3941251538Srpaulo		goto fail;
3942251538Srpaulo	}
3943251538Srpaulofail:
3944251538Srpaulo	firmware_put(fw, FIRMWARE_UNLOAD);
3945251538Srpaulo	return (error);
3946251538Srpaulo}
3947295871Savos#endif
3948251538Srpaulo
3949291902Skevlostatic int
3950251538Srpaulourtwn_dma_init(struct urtwn_softc *sc)
3951251538Srpaulo{
3952291902Skevlo	struct usb_endpoint *ep, *ep_end;
3953291698Savos	usb_error_t usb_err;
3954291902Skevlo	uint32_t reg;
3955291902Skevlo	int hashq, hasnq, haslq, nqueues, ntx;
3956291902Skevlo	int error, pagecount, npubqpages, nqpages, nrempages, tx_boundary;
3957281069Srpaulo
3958291695Savos	/* Initialize LLT table. */
3959291695Savos	error = urtwn_llt_init(sc);
3960291695Savos	if (error != 0)
3961291695Savos		return (error);
3962291695Savos
3963291902Skevlo	/* Determine the number of bulk-out pipes. */
3964291902Skevlo	ntx = 0;
3965291902Skevlo	ep = sc->sc_udev->endpoints;
3966291902Skevlo	ep_end = sc->sc_udev->endpoints + sc->sc_udev->endpoints_max;
3967291902Skevlo	for (; ep != ep_end; ep++) {
3968291902Skevlo		if ((ep->edesc == NULL) ||
3969291902Skevlo		    (ep->iface_index != sc->sc_iface_index))
3970291902Skevlo			continue;
3971291902Skevlo		if (UE_GET_DIR(ep->edesc->bEndpointAddress) == UE_DIR_OUT)
3972291902Skevlo			ntx++;
3973291902Skevlo	}
3974291902Skevlo	if (ntx == 0) {
3975291902Skevlo		device_printf(sc->sc_dev,
3976291902Skevlo		    "%d: invalid number of Tx bulk pipes\n", ntx);
3977291698Savos		return (EIO);
3978291902Skevlo	}
3979291695Savos
3980251538Srpaulo	/* Get Tx queues to USB endpoints mapping. */
3981291902Skevlo	hashq = hasnq = haslq = nqueues = 0;
3982291902Skevlo	switch (ntx) {
3983291902Skevlo	case 1: hashq = 1; break;
3984291902Skevlo	case 2: hashq = hasnq = 1; break;
3985291902Skevlo	case 3: case 4: hashq = hasnq = haslq = 1; break;
3986291902Skevlo	}
3987251538Srpaulo	nqueues = hashq + hasnq + haslq;
3988251538Srpaulo	if (nqueues == 0)
3989251538Srpaulo		return (EIO);
3990251538Srpaulo
3991291902Skevlo	npubqpages = nqpages = nrempages = pagecount = 0;
3992291902Skevlo	if (sc->chip & URTWN_CHIP_88E)
3993291902Skevlo		tx_boundary = R88E_TX_PAGE_BOUNDARY;
3994291902Skevlo	else {
3995291902Skevlo		pagecount = R92C_TX_PAGE_COUNT;
3996291902Skevlo		npubqpages = R92C_PUBQ_NPAGES;
3997291902Skevlo		tx_boundary = R92C_TX_PAGE_BOUNDARY;
3998291902Skevlo	}
3999291902Skevlo
4000251538Srpaulo	/* Set number of pages for normal priority queue. */
4001291902Skevlo	if (sc->chip & URTWN_CHIP_88E) {
4002291902Skevlo		usb_err = urtwn_write_2(sc, R92C_RQPN_NPQ, 0xd);
4003291902Skevlo		if (usb_err != USB_ERR_NORMAL_COMPLETION)
4004291902Skevlo			return (EIO);
4005291902Skevlo		usb_err = urtwn_write_4(sc, R92C_RQPN, 0x808e000d);
4006291902Skevlo		if (usb_err != USB_ERR_NORMAL_COMPLETION)
4007291902Skevlo			return (EIO);
4008291902Skevlo	} else {
4009291902Skevlo		/* Get the number of pages for each queue. */
4010291902Skevlo		nqpages = (pagecount - npubqpages) / nqueues;
4011291902Skevlo		/*
4012291902Skevlo		 * The remaining pages are assigned to the high priority
4013291902Skevlo		 * queue.
4014291902Skevlo		 */
4015291902Skevlo		nrempages = (pagecount - npubqpages) % nqueues;
4016291902Skevlo		usb_err = urtwn_write_1(sc, R92C_RQPN_NPQ, hasnq ? nqpages : 0);
4017291902Skevlo		if (usb_err != USB_ERR_NORMAL_COMPLETION)
4018291902Skevlo			return (EIO);
4019291902Skevlo		usb_err = urtwn_write_4(sc, R92C_RQPN,
4020291902Skevlo		    /* Set number of pages for public queue. */
4021291902Skevlo		    SM(R92C_RQPN_PUBQ, npubqpages) |
4022291902Skevlo		    /* Set number of pages for high priority queue. */
4023291902Skevlo		    SM(R92C_RQPN_HPQ, hashq ? nqpages + nrempages : 0) |
4024291902Skevlo		    /* Set number of pages for low priority queue. */
4025291902Skevlo		    SM(R92C_RQPN_LPQ, haslq ? nqpages : 0) |
4026291902Skevlo		    /* Load values. */
4027291902Skevlo		    R92C_RQPN_LD);
4028291902Skevlo		if (usb_err != USB_ERR_NORMAL_COMPLETION)
4029291902Skevlo			return (EIO);
4030291902Skevlo	}
4031251538Srpaulo
4032291902Skevlo	usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_BCNQ_BDNY, tx_boundary);
4033291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4034291698Savos		return (EIO);
4035291902Skevlo	usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_MGQ_BDNY, tx_boundary);
4036291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4037291698Savos		return (EIO);
4038291902Skevlo	usb_err = urtwn_write_1(sc, R92C_TXPKTBUF_WMAC_LBK_BF_HD, tx_boundary);
4039291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4040291698Savos		return (EIO);
4041291902Skevlo	usb_err = urtwn_write_1(sc, R92C_TRXFF_BNDY, tx_boundary);
4042291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4043291698Savos		return (EIO);
4044291902Skevlo	usb_err = urtwn_write_1(sc, R92C_TDECTRL + 1, tx_boundary);
4045291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4046291698Savos		return (EIO);
4047251538Srpaulo
4048251538Srpaulo	/* Set queue to USB pipe mapping. */
4049251538Srpaulo	reg = urtwn_read_2(sc, R92C_TRXDMA_CTRL);
4050251538Srpaulo	reg &= ~R92C_TRXDMA_CTRL_QMAP_M;
4051251538Srpaulo	if (nqueues == 1) {
4052251538Srpaulo		if (hashq)
4053251538Srpaulo			reg |= R92C_TRXDMA_CTRL_QMAP_HQ;
4054251538Srpaulo		else if (hasnq)
4055251538Srpaulo			reg |= R92C_TRXDMA_CTRL_QMAP_NQ;
4056251538Srpaulo		else
4057251538Srpaulo			reg |= R92C_TRXDMA_CTRL_QMAP_LQ;
4058251538Srpaulo	} else if (nqueues == 2) {
4059292056Skevlo		/*
4060292056Skevlo		 * All 2-endpoints configs have high and normal
4061292056Skevlo		 * priority queues.
4062292056Skevlo		 */
4063292056Skevlo		reg |= R92C_TRXDMA_CTRL_QMAP_HQ_NQ;
4064251538Srpaulo	} else
4065251538Srpaulo		reg |= R92C_TRXDMA_CTRL_QMAP_3EP;
4066291902Skevlo	usb_err = urtwn_write_2(sc, R92C_TRXDMA_CTRL, reg);
4067291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4068291698Savos		return (EIO);
4069251538Srpaulo
4070251538Srpaulo	/* Set Tx/Rx transfer page boundary. */
4071291902Skevlo	usb_err = urtwn_write_2(sc, R92C_TRXFF_BNDY + 2,
4072291902Skevlo	    (sc->chip & URTWN_CHIP_88E) ? 0x23ff : 0x27ff);
4073291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4074291698Savos		return (EIO);
4075251538Srpaulo
4076291902Skevlo	/* Set Tx/Rx transfer page size. */
4077291902Skevlo	usb_err = urtwn_write_1(sc, R92C_PBP,
4078291902Skevlo	    SM(R92C_PBP_PSRX, R92C_PBP_128) |
4079291902Skevlo	    SM(R92C_PBP_PSTX, R92C_PBP_128));
4080291902Skevlo	if (usb_err != USB_ERR_NORMAL_COMPLETION)
4081264912Skevlo		return (EIO);
4082264912Skevlo
4083264912Skevlo	return (0);
4084264912Skevlo}
4085264912Skevlo
4086291698Savosstatic int
4087251538Srpaulourtwn_mac_init(struct urtwn_softc *sc)
4088251538Srpaulo{
4089291698Savos	usb_error_t error;
4090251538Srpaulo	int i;
4091251538Srpaulo
4092251538Srpaulo	/* Write MAC initialization values. */
4093264912Skevlo	if (sc->chip & URTWN_CHIP_88E) {
4094264912Skevlo		for (i = 0; i < nitems(rtl8188eu_mac); i++) {
4095291698Savos			error = urtwn_write_1(sc, rtl8188eu_mac[i].reg,
4096264912Skevlo			    rtl8188eu_mac[i].val);
4097291698Savos			if (error != USB_ERR_NORMAL_COMPLETION)
4098291698Savos				return (EIO);
4099264912Skevlo		}
4100264912Skevlo		urtwn_write_1(sc, R92C_MAX_AGGR_NUM, 0x07);
4101264912Skevlo	} else {
4102264912Skevlo		for (i = 0; i < nitems(rtl8192cu_mac); i++)
4103291698Savos			error = urtwn_write_1(sc, rtl8192cu_mac[i].reg,
4104264912Skevlo			    rtl8192cu_mac[i].val);
4105291698Savos			if (error != USB_ERR_NORMAL_COMPLETION)
4106291698Savos				return (EIO);
4107264912Skevlo	}
4108291698Savos
4109291698Savos	return (0);
4110251538Srpaulo}
4111251538Srpaulo
4112251538Srpaulostatic void
4113251538Srpaulourtwn_bb_init(struct urtwn_softc *sc)
4114251538Srpaulo{
4115251538Srpaulo	const struct urtwn_bb_prog *prog;
4116251538Srpaulo	uint32_t reg;
4117264912Skevlo	uint8_t crystalcap;
4118251538Srpaulo	int i;
4119251538Srpaulo
4120251538Srpaulo	/* Enable BB and RF. */
4121251538Srpaulo	urtwn_write_2(sc, R92C_SYS_FUNC_EN,
4122251538Srpaulo	    urtwn_read_2(sc, R92C_SYS_FUNC_EN) |
4123251538Srpaulo	    R92C_SYS_FUNC_EN_BBRSTB | R92C_SYS_FUNC_EN_BB_GLB_RST |
4124251538Srpaulo	    R92C_SYS_FUNC_EN_DIO_RF);
4125251538Srpaulo
4126264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E))
4127264912Skevlo		urtwn_write_2(sc, R92C_AFE_PLL_CTRL, 0xdb83);
4128251538Srpaulo
4129251538Srpaulo	urtwn_write_1(sc, R92C_RF_CTRL,
4130251538Srpaulo	    R92C_RF_CTRL_EN | R92C_RF_CTRL_RSTB | R92C_RF_CTRL_SDMRSTB);
4131251538Srpaulo	urtwn_write_1(sc, R92C_SYS_FUNC_EN,
4132251538Srpaulo	    R92C_SYS_FUNC_EN_USBA | R92C_SYS_FUNC_EN_USBD |
4133251538Srpaulo	    R92C_SYS_FUNC_EN_BB_GLB_RST | R92C_SYS_FUNC_EN_BBRSTB);
4134251538Srpaulo
4135264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
4136264912Skevlo		urtwn_write_1(sc, R92C_LDOHCI12_CTRL, 0x0f);
4137264912Skevlo		urtwn_write_1(sc, 0x15, 0xe9);
4138264912Skevlo		urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 1, 0x80);
4139264912Skevlo	}
4140251538Srpaulo
4141251538Srpaulo	/* Select BB programming based on board type. */
4142264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
4143264912Skevlo		prog = &rtl8188eu_bb_prog;
4144264912Skevlo	else if (!(sc->chip & URTWN_CHIP_92C)) {
4145251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_MINICARD)
4146251538Srpaulo			prog = &rtl8188ce_bb_prog;
4147251538Srpaulo		else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA)
4148251538Srpaulo			prog = &rtl8188ru_bb_prog;
4149251538Srpaulo		else
4150251538Srpaulo			prog = &rtl8188cu_bb_prog;
4151251538Srpaulo	} else {
4152251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_MINICARD)
4153251538Srpaulo			prog = &rtl8192ce_bb_prog;
4154251538Srpaulo		else
4155251538Srpaulo			prog = &rtl8192cu_bb_prog;
4156251538Srpaulo	}
4157251538Srpaulo	/* Write BB initialization values. */
4158251538Srpaulo	for (i = 0; i < prog->count; i++) {
4159251538Srpaulo		urtwn_bb_write(sc, prog->regs[i], prog->vals[i]);
4160266472Shselasky		urtwn_ms_delay(sc);
4161251538Srpaulo	}
4162251538Srpaulo
4163251538Srpaulo	if (sc->chip & URTWN_CHIP_92C_1T2R) {
4164251538Srpaulo		/* 8192C 1T only configuration. */
4165251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_TXINFO);
4166251538Srpaulo		reg = (reg & ~0x00000003) | 0x2;
4167251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_TXINFO, reg);
4168251538Srpaulo
4169251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA1_TXINFO);
4170251538Srpaulo		reg = (reg & ~0x00300033) | 0x00200022;
4171251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA1_TXINFO, reg);
4172251538Srpaulo
4173251538Srpaulo		reg = urtwn_bb_read(sc, R92C_CCK0_AFESETTING);
4174251538Srpaulo		reg = (reg & ~0xff000000) | 0x45 << 24;
4175251538Srpaulo		urtwn_bb_write(sc, R92C_CCK0_AFESETTING, reg);
4176251538Srpaulo
4177251538Srpaulo		reg = urtwn_bb_read(sc, R92C_OFDM0_TRXPATHENA);
4178251538Srpaulo		reg = (reg & ~0x000000ff) | 0x23;
4179251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM0_TRXPATHENA, reg);
4180251538Srpaulo
4181251538Srpaulo		reg = urtwn_bb_read(sc, R92C_OFDM0_AGCPARAM1);
4182251538Srpaulo		reg = (reg & ~0x00000030) | 1 << 4;
4183251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM0_AGCPARAM1, reg);
4184251538Srpaulo
4185251538Srpaulo		reg = urtwn_bb_read(sc, 0xe74);
4186251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
4187251538Srpaulo		urtwn_bb_write(sc, 0xe74, reg);
4188251538Srpaulo		reg = urtwn_bb_read(sc, 0xe78);
4189251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
4190251538Srpaulo		urtwn_bb_write(sc, 0xe78, reg);
4191251538Srpaulo		reg = urtwn_bb_read(sc, 0xe7c);
4192251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
4193251538Srpaulo		urtwn_bb_write(sc, 0xe7c, reg);
4194251538Srpaulo		reg = urtwn_bb_read(sc, 0xe80);
4195251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
4196251538Srpaulo		urtwn_bb_write(sc, 0xe80, reg);
4197251538Srpaulo		reg = urtwn_bb_read(sc, 0xe88);
4198251538Srpaulo		reg = (reg & ~0x0c000000) | 2 << 26;
4199251538Srpaulo		urtwn_bb_write(sc, 0xe88, reg);
4200251538Srpaulo	}
4201251538Srpaulo
4202251538Srpaulo	/* Write AGC values. */
4203251538Srpaulo	for (i = 0; i < prog->agccount; i++) {
4204251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM0_AGCRSSITABLE,
4205251538Srpaulo		    prog->agcvals[i]);
4206266472Shselasky		urtwn_ms_delay(sc);
4207251538Srpaulo	}
4208251538Srpaulo
4209264912Skevlo	if (sc->chip & URTWN_CHIP_88E) {
4210264912Skevlo		urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553422);
4211266472Shselasky		urtwn_ms_delay(sc);
4212264912Skevlo		urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553420);
4213266472Shselasky		urtwn_ms_delay(sc);
4214264912Skevlo
4215294198Savos		crystalcap = sc->rom.r88e_rom.crystalcap;
4216264912Skevlo		if (crystalcap == 0xff)
4217264912Skevlo			crystalcap = 0x20;
4218264912Skevlo		crystalcap &= 0x3f;
4219264912Skevlo		reg = urtwn_bb_read(sc, R92C_AFE_XTAL_CTRL);
4220264912Skevlo		urtwn_bb_write(sc, R92C_AFE_XTAL_CTRL,
4221264912Skevlo		    RW(reg, R92C_AFE_XTAL_CTRL_ADDR,
4222264912Skevlo		    crystalcap | crystalcap << 6));
4223264912Skevlo	} else {
4224264912Skevlo		if (urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)) &
4225264912Skevlo		    R92C_HSSI_PARAM2_CCK_HIPWR)
4226264912Skevlo			sc->sc_flags |= URTWN_FLAG_CCK_HIPWR;
4227264912Skevlo	}
4228251538Srpaulo}
4229251538Srpaulo
4230289066Skevlostatic void
4231251538Srpaulourtwn_rf_init(struct urtwn_softc *sc)
4232251538Srpaulo{
4233251538Srpaulo	const struct urtwn_rf_prog *prog;
4234251538Srpaulo	uint32_t reg, type;
4235251538Srpaulo	int i, j, idx, off;
4236251538Srpaulo
4237251538Srpaulo	/* Select RF programming based on board type. */
4238264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
4239264912Skevlo		prog = rtl8188eu_rf_prog;
4240264912Skevlo	else if (!(sc->chip & URTWN_CHIP_92C)) {
4241251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_MINICARD)
4242251538Srpaulo			prog = rtl8188ce_rf_prog;
4243251538Srpaulo		else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA)
4244251538Srpaulo			prog = rtl8188ru_rf_prog;
4245251538Srpaulo		else
4246251538Srpaulo			prog = rtl8188cu_rf_prog;
4247251538Srpaulo	} else
4248251538Srpaulo		prog = rtl8192ce_rf_prog;
4249251538Srpaulo
4250251538Srpaulo	for (i = 0; i < sc->nrxchains; i++) {
4251251538Srpaulo		/* Save RF_ENV control type. */
4252251538Srpaulo		idx = i / 2;
4253251538Srpaulo		off = (i % 2) * 16;
4254251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx));
4255251538Srpaulo		type = (reg >> off) & 0x10;
4256251538Srpaulo
4257251538Srpaulo		/* Set RF_ENV enable. */
4258251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i));
4259251538Srpaulo		reg |= 0x100000;
4260251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg);
4261266472Shselasky		urtwn_ms_delay(sc);
4262251538Srpaulo		/* Set RF_ENV output high. */
4263251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i));
4264251538Srpaulo		reg |= 0x10;
4265251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg);
4266266472Shselasky		urtwn_ms_delay(sc);
4267251538Srpaulo		/* Set address and data lengths of RF registers. */
4268251538Srpaulo		reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i));
4269251538Srpaulo		reg &= ~R92C_HSSI_PARAM2_ADDR_LENGTH;
4270251538Srpaulo		urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg);
4271266472Shselasky		urtwn_ms_delay(sc);
4272251538Srpaulo		reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i));
4273251538Srpaulo		reg &= ~R92C_HSSI_PARAM2_DATA_LENGTH;
4274251538Srpaulo		urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg);
4275266472Shselasky		urtwn_ms_delay(sc);
4276251538Srpaulo
4277251538Srpaulo		/* Write RF initialization values for this chain. */
4278251538Srpaulo		for (j = 0; j < prog[i].count; j++) {
4279251538Srpaulo			if (prog[i].regs[j] >= 0xf9 &&
4280251538Srpaulo			    prog[i].regs[j] <= 0xfe) {
4281251538Srpaulo				/*
4282251538Srpaulo				 * These are fake RF registers offsets that
4283251538Srpaulo				 * indicate a delay is required.
4284251538Srpaulo				 */
4285266472Shselasky				usb_pause_mtx(&sc->sc_mtx, hz / 20);	/* 50ms */
4286251538Srpaulo				continue;
4287251538Srpaulo			}
4288251538Srpaulo			urtwn_rf_write(sc, i, prog[i].regs[j],
4289251538Srpaulo			    prog[i].vals[j]);
4290266472Shselasky			urtwn_ms_delay(sc);
4291251538Srpaulo		}
4292251538Srpaulo
4293251538Srpaulo		/* Restore RF_ENV control type. */
4294251538Srpaulo		reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx));
4295251538Srpaulo		reg &= ~(0x10 << off) | (type << off);
4296251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFIFACESW(idx), reg);
4297251538Srpaulo
4298251538Srpaulo		/* Cache RF register CHNLBW. */
4299251538Srpaulo		sc->rf_chnlbw[i] = urtwn_rf_read(sc, i, R92C_RF_CHNLBW);
4300251538Srpaulo	}
4301251538Srpaulo
4302251538Srpaulo	if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) ==
4303251538Srpaulo	    URTWN_CHIP_UMC_A_CUT) {
4304251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_RX_G1, 0x30255);
4305251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_RX_G2, 0x50a00);
4306251538Srpaulo	}
4307251538Srpaulo}
4308251538Srpaulo
4309251538Srpaulostatic void
4310251538Srpaulourtwn_cam_init(struct urtwn_softc *sc)
4311251538Srpaulo{
4312251538Srpaulo	/* Invalidate all CAM entries. */
4313251538Srpaulo	urtwn_write_4(sc, R92C_CAMCMD,
4314251538Srpaulo	    R92C_CAMCMD_POLLING | R92C_CAMCMD_CLR);
4315251538Srpaulo}
4316251538Srpaulo
4317292175Savosstatic int
4318292175Savosurtwn_cam_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data)
4319292175Savos{
4320292175Savos	usb_error_t error;
4321292175Savos
4322292175Savos	error = urtwn_write_4(sc, R92C_CAMWRITE, data);
4323292175Savos	if (error != USB_ERR_NORMAL_COMPLETION)
4324292175Savos		return (EIO);
4325292175Savos	error = urtwn_write_4(sc, R92C_CAMCMD,
4326292175Savos	    R92C_CAMCMD_POLLING | R92C_CAMCMD_WRITE |
4327292175Savos	    SM(R92C_CAMCMD_ADDR, addr));
4328292175Savos	if (error != USB_ERR_NORMAL_COMPLETION)
4329292175Savos		return (EIO);
4330292175Savos
4331292175Savos	return (0);
4332292175Savos}
4333292175Savos
4334251538Srpaulostatic void
4335251538Srpaulourtwn_pa_bias_init(struct urtwn_softc *sc)
4336251538Srpaulo{
4337251538Srpaulo	uint8_t reg;
4338251538Srpaulo	int i;
4339251538Srpaulo
4340251538Srpaulo	for (i = 0; i < sc->nrxchains; i++) {
4341251538Srpaulo		if (sc->pa_setting & (1 << i))
4342251538Srpaulo			continue;
4343251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0x0f406);
4344251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0x4f406);
4345251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0x8f406);
4346251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_IPA, 0xcf406);
4347251538Srpaulo	}
4348251538Srpaulo	if (!(sc->pa_setting & 0x10)) {
4349251538Srpaulo		reg = urtwn_read_1(sc, 0x16);
4350251538Srpaulo		reg = (reg & ~0xf0) | 0x90;
4351251538Srpaulo		urtwn_write_1(sc, 0x16, reg);
4352251538Srpaulo	}
4353251538Srpaulo}
4354251538Srpaulo
4355251538Srpaulostatic void
4356251538Srpaulourtwn_rxfilter_init(struct urtwn_softc *sc)
4357251538Srpaulo{
4358290564Savos	struct ieee80211com *ic = &sc->sc_ic;
4359290564Savos	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
4360290564Savos	uint32_t rcr;
4361290564Savos	uint16_t filter;
4362290564Savos
4363290564Savos	URTWN_ASSERT_LOCKED(sc);
4364290564Savos
4365251538Srpaulo	/* Accept all multicast frames. */
4366251538Srpaulo	urtwn_write_4(sc, R92C_MAR + 0, 0xffffffff);
4367251538Srpaulo	urtwn_write_4(sc, R92C_MAR + 4, 0xffffffff);
4368290564Savos
4369290564Savos	/* Filter for management frames. */
4370290564Savos	filter = 0x7f3f;
4371290631Savos	switch (vap->iv_opmode) {
4372290631Savos	case IEEE80211_M_STA:
4373290564Savos		filter &= ~(
4374290564Savos		    R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_ASSOC_REQ) |
4375290564Savos		    R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_REASSOC_REQ) |
4376290564Savos		    R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_PROBE_REQ));
4377290631Savos		break;
4378290631Savos	case IEEE80211_M_HOSTAP:
4379290631Savos		filter &= ~(
4380290631Savos		    R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_ASSOC_RESP) |
4381296174Savos		    R92C_RXFLTMAP_SUBTYPE(IEEE80211_FC0_SUBTYPE_REASSOC_RESP));
4382290631Savos		break;
4383290631Savos	case IEEE80211_M_MONITOR:
4384290651Savos	case IEEE80211_M_IBSS:
4385290631Savos		break;
4386290631Savos	default:
4387290631Savos		device_printf(sc->sc_dev, "%s: undefined opmode %d\n",
4388290631Savos		    __func__, vap->iv_opmode);
4389290631Savos		break;
4390290564Savos	}
4391290564Savos	urtwn_write_2(sc, R92C_RXFLTMAP0, filter);
4392290564Savos
4393251538Srpaulo	/* Reject all control frames. */
4394251538Srpaulo	urtwn_write_2(sc, R92C_RXFLTMAP1, 0x0000);
4395290564Savos
4396290564Savos	/* Reject all data frames. */
4397290564Savos	urtwn_write_2(sc, R92C_RXFLTMAP2, 0x0000);
4398290564Savos
4399290564Savos	rcr = R92C_RCR_AM | R92C_RCR_AB | R92C_RCR_APM |
4400290564Savos	      R92C_RCR_HTC_LOC_CTRL | R92C_RCR_APP_PHYSTS |
4401290564Savos	      R92C_RCR_APP_ICV | R92C_RCR_APP_MIC;
4402290564Savos
4403290564Savos	if (vap->iv_opmode == IEEE80211_M_MONITOR) {
4404290564Savos		/* Accept all frames. */
4405290564Savos		rcr |= R92C_RCR_ACF | R92C_RCR_ADF | R92C_RCR_AMF |
4406290564Savos		       R92C_RCR_AAP;
4407290564Savos	}
4408290564Savos
4409290564Savos	/* Set Rx filter. */
4410290564Savos	urtwn_write_4(sc, R92C_RCR, rcr);
4411290564Savos
4412290564Savos	if (ic->ic_promisc != 0) {
4413290564Savos		/* Update Rx filter. */
4414290564Savos		urtwn_set_promisc(sc);
4415290564Savos	}
4416251538Srpaulo}
4417251538Srpaulo
4418251538Srpaulostatic void
4419251538Srpaulourtwn_edca_init(struct urtwn_softc *sc)
4420251538Srpaulo{
4421251538Srpaulo	urtwn_write_2(sc, R92C_SPEC_SIFS, 0x100a);
4422251538Srpaulo	urtwn_write_2(sc, R92C_MAC_SPEC_SIFS, 0x100a);
4423251538Srpaulo	urtwn_write_2(sc, R92C_SIFS_CCK, 0x100a);
4424251538Srpaulo	urtwn_write_2(sc, R92C_SIFS_OFDM, 0x100a);
4425251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x005ea42b);
4426251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a44f);
4427251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005ea324);
4428251538Srpaulo	urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002fa226);
4429251538Srpaulo}
4430251538Srpaulo
4431289066Skevlostatic void
4432251538Srpaulourtwn_write_txpower(struct urtwn_softc *sc, int chain,
4433251538Srpaulo    uint16_t power[URTWN_RIDX_COUNT])
4434251538Srpaulo{
4435251538Srpaulo	uint32_t reg;
4436251538Srpaulo
4437251538Srpaulo	/* Write per-CCK rate Tx power. */
4438251538Srpaulo	if (chain == 0) {
4439251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_A_CCK1_MCS32);
4440251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK1,  power[0]);
4441251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_A_CCK1_MCS32, reg);
4442251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11);
4443251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK2,  power[1]);
4444251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK55, power[2]);
4445251538Srpaulo		reg = RW(reg, R92C_TXAGC_A_CCK11, power[3]);
4446251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg);
4447251538Srpaulo	} else {
4448251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK1_55_MCS32);
4449251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK1,  power[0]);
4450251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK2,  power[1]);
4451251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK55, power[2]);
4452251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_B_CCK1_55_MCS32, reg);
4453251538Srpaulo		reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11);
4454251538Srpaulo		reg = RW(reg, R92C_TXAGC_B_CCK11, power[3]);
4455251538Srpaulo		urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg);
4456251538Srpaulo	}
4457251538Srpaulo	/* Write per-OFDM rate Tx power. */
4458251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_RATE18_06(chain),
4459251538Srpaulo	    SM(R92C_TXAGC_RATE06, power[ 4]) |
4460251538Srpaulo	    SM(R92C_TXAGC_RATE09, power[ 5]) |
4461251538Srpaulo	    SM(R92C_TXAGC_RATE12, power[ 6]) |
4462251538Srpaulo	    SM(R92C_TXAGC_RATE18, power[ 7]));
4463251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_RATE54_24(chain),
4464251538Srpaulo	    SM(R92C_TXAGC_RATE24, power[ 8]) |
4465251538Srpaulo	    SM(R92C_TXAGC_RATE36, power[ 9]) |
4466251538Srpaulo	    SM(R92C_TXAGC_RATE48, power[10]) |
4467251538Srpaulo	    SM(R92C_TXAGC_RATE54, power[11]));
4468251538Srpaulo	/* Write per-MCS Tx power. */
4469251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS03_MCS00(chain),
4470251538Srpaulo	    SM(R92C_TXAGC_MCS00,  power[12]) |
4471251538Srpaulo	    SM(R92C_TXAGC_MCS01,  power[13]) |
4472251538Srpaulo	    SM(R92C_TXAGC_MCS02,  power[14]) |
4473251538Srpaulo	    SM(R92C_TXAGC_MCS03,  power[15]));
4474251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS07_MCS04(chain),
4475251538Srpaulo	    SM(R92C_TXAGC_MCS04,  power[16]) |
4476251538Srpaulo	    SM(R92C_TXAGC_MCS05,  power[17]) |
4477251538Srpaulo	    SM(R92C_TXAGC_MCS06,  power[18]) |
4478251538Srpaulo	    SM(R92C_TXAGC_MCS07,  power[19]));
4479251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS11_MCS08(chain),
4480251538Srpaulo	    SM(R92C_TXAGC_MCS08,  power[20]) |
4481261506Skevlo	    SM(R92C_TXAGC_MCS09,  power[21]) |
4482251538Srpaulo	    SM(R92C_TXAGC_MCS10,  power[22]) |
4483251538Srpaulo	    SM(R92C_TXAGC_MCS11,  power[23]));
4484251538Srpaulo	urtwn_bb_write(sc, R92C_TXAGC_MCS15_MCS12(chain),
4485251538Srpaulo	    SM(R92C_TXAGC_MCS12,  power[24]) |
4486251538Srpaulo	    SM(R92C_TXAGC_MCS13,  power[25]) |
4487251538Srpaulo	    SM(R92C_TXAGC_MCS14,  power[26]) |
4488251538Srpaulo	    SM(R92C_TXAGC_MCS15,  power[27]));
4489251538Srpaulo}
4490251538Srpaulo
4491289066Skevlostatic void
4492251538Srpaulourtwn_get_txpower(struct urtwn_softc *sc, int chain,
4493251538Srpaulo    struct ieee80211_channel *c, struct ieee80211_channel *extc,
4494251538Srpaulo    uint16_t power[URTWN_RIDX_COUNT])
4495251538Srpaulo{
4496287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
4497291264Savos	struct r92c_rom *rom = &sc->rom.r92c_rom;
4498251538Srpaulo	uint16_t cckpow, ofdmpow, htpow, diff, max;
4499251538Srpaulo	const struct urtwn_txpwr *base;
4500251538Srpaulo	int ridx, chan, group;
4501251538Srpaulo
4502251538Srpaulo	/* Determine channel group. */
4503251538Srpaulo	chan = ieee80211_chan2ieee(ic, c);	/* XXX center freq! */
4504251538Srpaulo	if (chan <= 3)
4505251538Srpaulo		group = 0;
4506251538Srpaulo	else if (chan <= 9)
4507251538Srpaulo		group = 1;
4508251538Srpaulo	else
4509251538Srpaulo		group = 2;
4510251538Srpaulo
4511251538Srpaulo	/* Get original Tx power based on board type and RF chain. */
4512251538Srpaulo	if (!(sc->chip & URTWN_CHIP_92C)) {
4513251538Srpaulo		if (sc->board_type == R92C_BOARD_TYPE_HIGHPA)
4514251538Srpaulo			base = &rtl8188ru_txagc[chain];
4515251538Srpaulo		else
4516251538Srpaulo			base = &rtl8192cu_txagc[chain];
4517251538Srpaulo	} else
4518251538Srpaulo		base = &rtl8192cu_txagc[chain];
4519251538Srpaulo
4520251538Srpaulo	memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0]));
4521251538Srpaulo	if (sc->regulatory == 0) {
4522289758Savos		for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++)
4523251538Srpaulo			power[ridx] = base->pwr[0][ridx];
4524251538Srpaulo	}
4525289758Savos	for (ridx = URTWN_RIDX_OFDM6; ridx < URTWN_RIDX_COUNT; ridx++) {
4526251538Srpaulo		if (sc->regulatory == 3) {
4527251538Srpaulo			power[ridx] = base->pwr[0][ridx];
4528251538Srpaulo			/* Apply vendor limits. */
4529251538Srpaulo			if (extc != NULL)
4530251538Srpaulo				max = rom->ht40_max_pwr[group];
4531251538Srpaulo			else
4532251538Srpaulo				max = rom->ht20_max_pwr[group];
4533251538Srpaulo			max = (max >> (chain * 4)) & 0xf;
4534251538Srpaulo			if (power[ridx] > max)
4535251538Srpaulo				power[ridx] = max;
4536251538Srpaulo		} else if (sc->regulatory == 1) {
4537251538Srpaulo			if (extc == NULL)
4538251538Srpaulo				power[ridx] = base->pwr[group][ridx];
4539251538Srpaulo		} else if (sc->regulatory != 2)
4540251538Srpaulo			power[ridx] = base->pwr[0][ridx];
4541251538Srpaulo	}
4542251538Srpaulo
4543251538Srpaulo	/* Compute per-CCK rate Tx power. */
4544251538Srpaulo	cckpow = rom->cck_tx_pwr[chain][group];
4545289758Savos	for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) {
4546251538Srpaulo		power[ridx] += cckpow;
4547251538Srpaulo		if (power[ridx] > R92C_MAX_TX_PWR)
4548251538Srpaulo			power[ridx] = R92C_MAX_TX_PWR;
4549251538Srpaulo	}
4550251538Srpaulo
4551251538Srpaulo	htpow = rom->ht40_1s_tx_pwr[chain][group];
4552251538Srpaulo	if (sc->ntxchains > 1) {
4553251538Srpaulo		/* Apply reduction for 2 spatial streams. */
4554251538Srpaulo		diff = rom->ht40_2s_tx_pwr_diff[group];
4555251538Srpaulo		diff = (diff >> (chain * 4)) & 0xf;
4556251538Srpaulo		htpow = (htpow > diff) ? htpow - diff : 0;
4557251538Srpaulo	}
4558251538Srpaulo
4559251538Srpaulo	/* Compute per-OFDM rate Tx power. */
4560251538Srpaulo	diff = rom->ofdm_tx_pwr_diff[group];
4561251538Srpaulo	diff = (diff >> (chain * 4)) & 0xf;
4562251538Srpaulo	ofdmpow = htpow + diff;	/* HT->OFDM correction. */
4563289758Savos	for (ridx = URTWN_RIDX_OFDM6; ridx <= URTWN_RIDX_OFDM54; ridx++) {
4564251538Srpaulo		power[ridx] += ofdmpow;
4565251538Srpaulo		if (power[ridx] > R92C_MAX_TX_PWR)
4566251538Srpaulo			power[ridx] = R92C_MAX_TX_PWR;
4567251538Srpaulo	}
4568251538Srpaulo
4569251538Srpaulo	/* Compute per-MCS Tx power. */
4570251538Srpaulo	if (extc == NULL) {
4571251538Srpaulo		diff = rom->ht20_tx_pwr_diff[group];
4572251538Srpaulo		diff = (diff >> (chain * 4)) & 0xf;
4573251538Srpaulo		htpow += diff;	/* HT40->HT20 correction. */
4574251538Srpaulo	}
4575251538Srpaulo	for (ridx = 12; ridx <= 27; ridx++) {
4576251538Srpaulo		power[ridx] += htpow;
4577251538Srpaulo		if (power[ridx] > R92C_MAX_TX_PWR)
4578251538Srpaulo			power[ridx] = R92C_MAX_TX_PWR;
4579251538Srpaulo	}
4580294471Savos#ifdef USB_DEBUG
4581294471Savos	if (sc->sc_debug & URTWN_DEBUG_TXPWR) {
4582251538Srpaulo		/* Dump per-rate Tx power values. */
4583251538Srpaulo		printf("Tx power for chain %d:\n", chain);
4584289758Savos		for (ridx = URTWN_RIDX_CCK1; ridx < URTWN_RIDX_COUNT; ridx++)
4585251538Srpaulo			printf("Rate %d = %u\n", ridx, power[ridx]);
4586251538Srpaulo	}
4587251538Srpaulo#endif
4588251538Srpaulo}
4589251538Srpaulo
4590289066Skevlostatic void
4591264912Skevlourtwn_r88e_get_txpower(struct urtwn_softc *sc, int chain,
4592264912Skevlo    struct ieee80211_channel *c, struct ieee80211_channel *extc,
4593264912Skevlo    uint16_t power[URTWN_RIDX_COUNT])
4594264912Skevlo{
4595287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
4596294198Savos	struct r88e_rom *rom = &sc->rom.r88e_rom;
4597264912Skevlo	uint16_t cckpow, ofdmpow, bw20pow, htpow;
4598264912Skevlo	const struct urtwn_r88e_txpwr *base;
4599264912Skevlo	int ridx, chan, group;
4600264912Skevlo
4601264912Skevlo	/* Determine channel group. */
4602264912Skevlo	chan = ieee80211_chan2ieee(ic, c);	/* XXX center freq! */
4603264912Skevlo	if (chan <= 2)
4604264912Skevlo		group = 0;
4605264912Skevlo	else if (chan <= 5)
4606264912Skevlo		group = 1;
4607264912Skevlo	else if (chan <= 8)
4608264912Skevlo		group = 2;
4609264912Skevlo	else if (chan <= 11)
4610264912Skevlo		group = 3;
4611264912Skevlo	else if (chan <= 13)
4612264912Skevlo		group = 4;
4613264912Skevlo	else
4614264912Skevlo		group = 5;
4615264912Skevlo
4616264912Skevlo	/* Get original Tx power based on board type and RF chain. */
4617264912Skevlo	base = &rtl8188eu_txagc[chain];
4618264912Skevlo
4619264912Skevlo	memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0]));
4620264912Skevlo	if (sc->regulatory == 0) {
4621289758Savos		for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++)
4622264912Skevlo			power[ridx] = base->pwr[0][ridx];
4623264912Skevlo	}
4624289758Savos	for (ridx = URTWN_RIDX_OFDM6; ridx < URTWN_RIDX_COUNT; ridx++) {
4625264912Skevlo		if (sc->regulatory == 3)
4626264912Skevlo			power[ridx] = base->pwr[0][ridx];
4627264912Skevlo		else if (sc->regulatory == 1) {
4628264912Skevlo			if (extc == NULL)
4629264912Skevlo				power[ridx] = base->pwr[group][ridx];
4630264912Skevlo		} else if (sc->regulatory != 2)
4631264912Skevlo			power[ridx] = base->pwr[0][ridx];
4632264912Skevlo	}
4633264912Skevlo
4634264912Skevlo	/* Compute per-CCK rate Tx power. */
4635294198Savos	cckpow = rom->cck_tx_pwr[group];
4636289758Savos	for (ridx = URTWN_RIDX_CCK1; ridx <= URTWN_RIDX_CCK11; ridx++) {
4637264912Skevlo		power[ridx] += cckpow;
4638264912Skevlo		if (power[ridx] > R92C_MAX_TX_PWR)
4639264912Skevlo			power[ridx] = R92C_MAX_TX_PWR;
4640264912Skevlo	}
4641264912Skevlo
4642294198Savos	htpow = rom->ht40_tx_pwr[group];
4643264912Skevlo
4644264912Skevlo	/* Compute per-OFDM rate Tx power. */
4645264912Skevlo	ofdmpow = htpow + sc->ofdm_tx_pwr_diff;
4646289758Savos	for (ridx = URTWN_RIDX_OFDM6; ridx <= URTWN_RIDX_OFDM54; ridx++) {
4647264912Skevlo		power[ridx] += ofdmpow;
4648264912Skevlo		if (power[ridx] > R92C_MAX_TX_PWR)
4649264912Skevlo			power[ridx] = R92C_MAX_TX_PWR;
4650264912Skevlo	}
4651264912Skevlo
4652264912Skevlo	bw20pow = htpow + sc->bw20_tx_pwr_diff;
4653264912Skevlo	for (ridx = 12; ridx <= 27; ridx++) {
4654264912Skevlo		power[ridx] += bw20pow;
4655264912Skevlo		if (power[ridx] > R92C_MAX_TX_PWR)
4656264912Skevlo			power[ridx] = R92C_MAX_TX_PWR;
4657264912Skevlo	}
4658264912Skevlo}
4659264912Skevlo
4660289066Skevlostatic void
4661251538Srpaulourtwn_set_txpower(struct urtwn_softc *sc, struct ieee80211_channel *c,
4662251538Srpaulo    struct ieee80211_channel *extc)
4663251538Srpaulo{
4664251538Srpaulo	uint16_t power[URTWN_RIDX_COUNT];
4665251538Srpaulo	int i;
4666251538Srpaulo
4667251538Srpaulo	for (i = 0; i < sc->ntxchains; i++) {
4668251538Srpaulo		/* Compute per-rate Tx power values. */
4669264912Skevlo		if (sc->chip & URTWN_CHIP_88E)
4670264912Skevlo			urtwn_r88e_get_txpower(sc, i, c, extc, power);
4671264912Skevlo		else
4672264912Skevlo			urtwn_get_txpower(sc, i, c, extc, power);
4673251538Srpaulo		/* Write per-rate Tx power values to hardware. */
4674251538Srpaulo		urtwn_write_txpower(sc, i, power);
4675251538Srpaulo	}
4676251538Srpaulo}
4677251538Srpaulo
4678251538Srpaulostatic void
4679290048Savosurtwn_set_rx_bssid_all(struct urtwn_softc *sc, int enable)
4680290048Savos{
4681290048Savos	uint32_t reg;
4682290048Savos
4683290048Savos	reg = urtwn_read_4(sc, R92C_RCR);
4684290048Savos	if (enable)
4685290048Savos		reg &= ~R92C_RCR_CBSSID_BCN;
4686290048Savos	else
4687290048Savos		reg |= R92C_RCR_CBSSID_BCN;
4688290048Savos	urtwn_write_4(sc, R92C_RCR, reg);
4689290048Savos}
4690290048Savos
4691290048Savosstatic void
4692290048Savosurtwn_set_gain(struct urtwn_softc *sc, uint8_t gain)
4693290048Savos{
4694290048Savos	uint32_t reg;
4695290048Savos
4696290048Savos	reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0));
4697290048Savos	reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, gain);
4698290048Savos	urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg);
4699290048Savos
4700290048Savos	if (!(sc->chip & URTWN_CHIP_88E)) {
4701290048Savos		reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1));
4702290048Savos		reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, gain);
4703290048Savos		urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg);
4704290048Savos	}
4705290048Savos}
4706290048Savos
4707290048Savosstatic void
4708251538Srpaulourtwn_scan_start(struct ieee80211com *ic)
4709251538Srpaulo{
4710290048Savos	struct urtwn_softc *sc = ic->ic_softc;
4711290048Savos
4712290048Savos	URTWN_LOCK(sc);
4713290048Savos	/* Receive beacons / probe responses from any BSSID. */
4714290651Savos	if (ic->ic_opmode != IEEE80211_M_IBSS)
4715290651Savos		urtwn_set_rx_bssid_all(sc, 1);
4716290651Savos
4717290048Savos	/* Set gain for scanning. */
4718290048Savos	urtwn_set_gain(sc, 0x20);
4719290048Savos	URTWN_UNLOCK(sc);
4720251538Srpaulo}
4721251538Srpaulo
4722251538Srpaulostatic void
4723251538Srpaulourtwn_scan_end(struct ieee80211com *ic)
4724251538Srpaulo{
4725290048Savos	struct urtwn_softc *sc = ic->ic_softc;
4726290048Savos
4727290048Savos	URTWN_LOCK(sc);
4728290048Savos	/* Restore limitations. */
4729290651Savos	if (ic->ic_promisc == 0 && ic->ic_opmode != IEEE80211_M_IBSS)
4730290564Savos		urtwn_set_rx_bssid_all(sc, 0);
4731290651Savos
4732290048Savos	/* Set gain under link. */
4733290048Savos	urtwn_set_gain(sc, 0x32);
4734290048Savos	URTWN_UNLOCK(sc);
4735251538Srpaulo}
4736251538Srpaulo
4737251538Srpaulostatic void
4738251538Srpaulourtwn_set_channel(struct ieee80211com *ic)
4739251538Srpaulo{
4740286949Sadrian	struct urtwn_softc *sc = ic->ic_softc;
4741292173Savos	struct ieee80211_channel *c = ic->ic_curchan;
4742281070Srpaulo	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
4743251538Srpaulo
4744251538Srpaulo	URTWN_LOCK(sc);
4745281070Srpaulo	if (vap->iv_state == IEEE80211_S_SCAN) {
4746281070Srpaulo		/* Make link LED blink during scan. */
4747281070Srpaulo		urtwn_set_led(sc, URTWN_LED_LINK, !sc->ledlink);
4748281070Srpaulo	}
4749292173Savos	urtwn_set_chan(sc, c, NULL);
4750292173Savos	sc->sc_rxtap.wr_chan_freq = htole16(c->ic_freq);
4751292173Savos	sc->sc_rxtap.wr_chan_flags = htole16(c->ic_flags);
4752292173Savos	sc->sc_txtap.wt_chan_freq = htole16(c->ic_freq);
4753292173Savos	sc->sc_txtap.wt_chan_flags = htole16(c->ic_flags);
4754251538Srpaulo	URTWN_UNLOCK(sc);
4755251538Srpaulo}
4756251538Srpaulo
4757292014Savosstatic int
4758292014Savosurtwn_wme_update(struct ieee80211com *ic)
4759292014Savos{
4760292014Savos	const struct wmeParams *wmep =
4761292014Savos	    ic->ic_wme.wme_chanParams.cap_wmeParams;
4762292014Savos	struct urtwn_softc *sc = ic->ic_softc;
4763292014Savos	uint8_t aifs, acm, slottime;
4764292014Savos	int ac;
4765292014Savos
4766292014Savos	acm = 0;
4767292165Savos	slottime = IEEE80211_GET_SLOTTIME(ic);
4768292014Savos
4769292014Savos	URTWN_LOCK(sc);
4770292014Savos	for (ac = WME_AC_BE; ac < WME_NUM_AC; ac++) {
4771292014Savos		/* AIFS[AC] = AIFSN[AC] * aSlotTime + aSIFSTime. */
4772292014Savos		aifs = wmep[ac].wmep_aifsn * slottime + IEEE80211_DUR_SIFS;
4773292014Savos		urtwn_write_4(sc, wme2queue[ac].reg,
4774292014Savos		    SM(R92C_EDCA_PARAM_TXOP, wmep[ac].wmep_txopLimit) |
4775292014Savos		    SM(R92C_EDCA_PARAM_ECWMIN, wmep[ac].wmep_logcwmin) |
4776292014Savos		    SM(R92C_EDCA_PARAM_ECWMAX, wmep[ac].wmep_logcwmax) |
4777292014Savos		    SM(R92C_EDCA_PARAM_AIFS, aifs));
4778292014Savos		if (ac != WME_AC_BE)
4779292014Savos			acm |= wmep[ac].wmep_acm << ac;
4780292014Savos	}
4781292014Savos
4782292014Savos	if (acm != 0)
4783292014Savos		acm |= R92C_ACMHWCTRL_EN;
4784292014Savos	urtwn_write_1(sc, R92C_ACMHWCTRL,
4785292014Savos	    (urtwn_read_1(sc, R92C_ACMHWCTRL) & ~R92C_ACMHWCTRL_ACM_MASK) |
4786292014Savos	    acm);
4787292014Savos
4788292014Savos	URTWN_UNLOCK(sc);
4789292014Savos
4790292014Savos	return 0;
4791292014Savos}
4792292014Savos
4793251538Srpaulostatic void
4794294465Savosurtwn_update_slot(struct ieee80211com *ic)
4795294465Savos{
4796294465Savos	urtwn_cmd_sleepable(ic->ic_softc, NULL, 0, urtwn_update_slot_cb);
4797294465Savos}
4798294465Savos
4799294465Savosstatic void
4800294465Savosurtwn_update_slot_cb(struct urtwn_softc *sc, union sec_param *data)
4801294465Savos{
4802294465Savos	struct ieee80211com *ic = &sc->sc_ic;
4803294465Savos	uint8_t slottime;
4804294465Savos
4805294465Savos	slottime = IEEE80211_GET_SLOTTIME(ic);
4806294465Savos
4807294471Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_ANY, "%s: setting slot time to %uus\n",
4808294471Savos	    __func__, slottime);
4809294465Savos
4810294465Savos	urtwn_write_1(sc, R92C_SLOT, slottime);
4811294465Savos	urtwn_update_aifs(sc, slottime);
4812294465Savos}
4813294465Savos
4814294465Savosstatic void
4815294465Savosurtwn_update_aifs(struct urtwn_softc *sc, uint8_t slottime)
4816294465Savos{
4817294465Savos	const struct wmeParams *wmep =
4818294465Savos	    sc->sc_ic.ic_wme.wme_chanParams.cap_wmeParams;
4819294465Savos	uint8_t aifs, ac;
4820294465Savos
4821294465Savos	for (ac = WME_AC_BE; ac < WME_NUM_AC; ac++) {
4822294465Savos		/* AIFS[AC] = AIFSN[AC] * aSlotTime + aSIFSTime. */
4823294465Savos		aifs = wmep[ac].wmep_aifsn * slottime + IEEE80211_DUR_SIFS;
4824294465Savos		urtwn_write_1(sc, wme2queue[ac].reg, aifs);
4825294465Savos        }
4826294465Savos}
4827294465Savos
4828294465Savosstatic void
4829290564Savosurtwn_set_promisc(struct urtwn_softc *sc)
4830290564Savos{
4831290564Savos	struct ieee80211com *ic = &sc->sc_ic;
4832290564Savos	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
4833290564Savos	uint32_t rcr, mask1, mask2;
4834290564Savos
4835290564Savos	URTWN_ASSERT_LOCKED(sc);
4836290564Savos
4837290564Savos	if (vap->iv_opmode == IEEE80211_M_MONITOR)
4838290564Savos		return;
4839290564Savos
4840290564Savos	mask1 = R92C_RCR_ACF | R92C_RCR_ADF | R92C_RCR_AMF | R92C_RCR_AAP;
4841290564Savos	mask2 = R92C_RCR_APM;
4842290564Savos
4843290564Savos	if (vap->iv_state == IEEE80211_S_RUN) {
4844290564Savos		switch (vap->iv_opmode) {
4845290564Savos		case IEEE80211_M_STA:
4846290631Savos			mask2 |= R92C_RCR_CBSSID_DATA;
4847290631Savos			/* FALLTHROUGH */
4848290631Savos		case IEEE80211_M_HOSTAP:
4849290631Savos			mask2 |= R92C_RCR_CBSSID_BCN;
4850290564Savos			break;
4851290651Savos		case IEEE80211_M_IBSS:
4852290651Savos			mask2 |= R92C_RCR_CBSSID_DATA;
4853290651Savos			break;
4854290564Savos		default:
4855290564Savos			device_printf(sc->sc_dev, "%s: undefined opmode %d\n",
4856290564Savos			    __func__, vap->iv_opmode);
4857290564Savos			return;
4858290564Savos		}
4859290564Savos	}
4860290564Savos
4861290564Savos	rcr = urtwn_read_4(sc, R92C_RCR);
4862290564Savos	if (ic->ic_promisc == 0)
4863290564Savos		rcr = (rcr & ~mask1) | mask2;
4864290564Savos	else
4865290564Savos		rcr = (rcr & ~mask2) | mask1;
4866290564Savos	urtwn_write_4(sc, R92C_RCR, rcr);
4867290564Savos}
4868290564Savos
4869290564Savosstatic void
4870290564Savosurtwn_update_promisc(struct ieee80211com *ic)
4871290564Savos{
4872290564Savos	struct urtwn_softc *sc = ic->ic_softc;
4873290564Savos
4874290564Savos	URTWN_LOCK(sc);
4875290564Savos	if (sc->sc_flags & URTWN_RUNNING)
4876290564Savos		urtwn_set_promisc(sc);
4877290564Savos	URTWN_UNLOCK(sc);
4878290564Savos}
4879290564Savos
4880290564Savosstatic void
4881283540Sglebiusurtwn_update_mcast(struct ieee80211com *ic)
4882251538Srpaulo{
4883251538Srpaulo	/* XXX do nothing?  */
4884251538Srpaulo}
4885251538Srpaulo
4886292167Savosstatic struct ieee80211_node *
4887297910Sadrianurtwn_node_alloc(struct ieee80211vap *vap,
4888292167Savos    const uint8_t mac[IEEE80211_ADDR_LEN])
4889292167Savos{
4890292167Savos	struct urtwn_node *un;
4891292167Savos
4892292167Savos	un = malloc(sizeof (struct urtwn_node), M_80211_NODE,
4893292167Savos	    M_NOWAIT | M_ZERO);
4894292167Savos
4895292167Savos	if (un == NULL)
4896292167Savos		return NULL;
4897292167Savos
4898292167Savos	un->id = URTWN_MACID_UNDEFINED;
4899292167Savos
4900292167Savos	return &un->ni;
4901292167Savos}
4902292167Savos
4903251538Srpaulostatic void
4904297910Sadrianurtwn_newassoc(struct ieee80211_node *ni, int isnew)
4905292167Savos{
4906292167Savos	struct urtwn_softc *sc = ni->ni_ic->ic_softc;
4907292167Savos	struct urtwn_node *un = URTWN_NODE(ni);
4908292167Savos	uint8_t id;
4909292167Savos
4910297910Sadrian	/* Only do this bit for R88E chips */
4911297910Sadrian	if (! (sc->chip & URTWN_CHIP_88E))
4912297910Sadrian		return;
4913297910Sadrian
4914292167Savos	if (!isnew)
4915292167Savos		return;
4916292167Savos
4917292167Savos	URTWN_NT_LOCK(sc);
4918292167Savos	for (id = 0; id <= URTWN_MACID_MAX(sc); id++) {
4919292167Savos		if (id != URTWN_MACID_BC && sc->node_list[id] == NULL) {
4920292167Savos			un->id = id;
4921292167Savos			sc->node_list[id] = ni;
4922292167Savos			break;
4923292167Savos		}
4924292167Savos	}
4925292167Savos	URTWN_NT_UNLOCK(sc);
4926292167Savos
4927292167Savos	if (id > URTWN_MACID_MAX(sc)) {
4928292167Savos		device_printf(sc->sc_dev, "%s: node table is full\n",
4929292167Savos		    __func__);
4930292167Savos	}
4931292167Savos}
4932292167Savos
4933292167Savosstatic void
4934297910Sadrianurtwn_node_free(struct ieee80211_node *ni)
4935292167Savos{
4936292167Savos	struct urtwn_softc *sc = ni->ni_ic->ic_softc;
4937292167Savos	struct urtwn_node *un = URTWN_NODE(ni);
4938292167Savos
4939292167Savos	URTWN_NT_LOCK(sc);
4940292167Savos	if (un->id != URTWN_MACID_UNDEFINED)
4941292167Savos		sc->node_list[un->id] = NULL;
4942292167Savos	URTWN_NT_UNLOCK(sc);
4943292167Savos
4944292167Savos	sc->sc_node_free(ni);
4945292167Savos}
4946292167Savos
4947292167Savosstatic void
4948251538Srpaulourtwn_set_chan(struct urtwn_softc *sc, struct ieee80211_channel *c,
4949251538Srpaulo    struct ieee80211_channel *extc)
4950251538Srpaulo{
4951287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
4952251538Srpaulo	uint32_t reg;
4953251538Srpaulo	u_int chan;
4954251538Srpaulo	int i;
4955251538Srpaulo
4956251538Srpaulo	chan = ieee80211_chan2ieee(ic, c);	/* XXX center freq! */
4957251538Srpaulo	if (chan == 0 || chan == IEEE80211_CHAN_ANY) {
4958251538Srpaulo		device_printf(sc->sc_dev,
4959251538Srpaulo		    "%s: invalid channel %x\n", __func__, chan);
4960251538Srpaulo		return;
4961251538Srpaulo	}
4962251538Srpaulo
4963251538Srpaulo	/* Set Tx power for this new channel. */
4964251538Srpaulo	urtwn_set_txpower(sc, c, extc);
4965251538Srpaulo
4966251538Srpaulo	for (i = 0; i < sc->nrxchains; i++) {
4967251538Srpaulo		urtwn_rf_write(sc, i, R92C_RF_CHNLBW,
4968251538Srpaulo		    RW(sc->rf_chnlbw[i], R92C_RF_CHNLBW_CHNL, chan));
4969251538Srpaulo	}
4970251538Srpaulo#ifndef IEEE80211_NO_HT
4971251538Srpaulo	if (extc != NULL) {
4972251538Srpaulo		/* Is secondary channel below or above primary? */
4973251538Srpaulo		int prichlo = c->ic_freq < extc->ic_freq;
4974251538Srpaulo
4975251538Srpaulo		urtwn_write_1(sc, R92C_BWOPMODE,
4976251538Srpaulo		    urtwn_read_1(sc, R92C_BWOPMODE) & ~R92C_BWOPMODE_20MHZ);
4977251538Srpaulo
4978251538Srpaulo		reg = urtwn_read_1(sc, R92C_RRSR + 2);
4979251538Srpaulo		reg = (reg & ~0x6f) | (prichlo ? 1 : 2) << 5;
4980251538Srpaulo		urtwn_write_1(sc, R92C_RRSR + 2, reg);
4981251538Srpaulo
4982251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFMOD,
4983251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA0_RFMOD) | R92C_RFMOD_40MHZ);
4984251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA1_RFMOD,
4985251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA1_RFMOD) | R92C_RFMOD_40MHZ);
4986251538Srpaulo
4987251538Srpaulo		/* Set CCK side band. */
4988251538Srpaulo		reg = urtwn_bb_read(sc, R92C_CCK0_SYSTEM);
4989251538Srpaulo		reg = (reg & ~0x00000010) | (prichlo ? 0 : 1) << 4;
4990251538Srpaulo		urtwn_bb_write(sc, R92C_CCK0_SYSTEM, reg);
4991251538Srpaulo
4992251538Srpaulo		reg = urtwn_bb_read(sc, R92C_OFDM1_LSTF);
4993251538Srpaulo		reg = (reg & ~0x00000c00) | (prichlo ? 1 : 2) << 10;
4994251538Srpaulo		urtwn_bb_write(sc, R92C_OFDM1_LSTF, reg);
4995251538Srpaulo
4996251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2,
4997251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) &
4998251538Srpaulo		    ~R92C_FPGA0_ANAPARAM2_CBW20);
4999251538Srpaulo
5000251538Srpaulo		reg = urtwn_bb_read(sc, 0x818);
5001251538Srpaulo		reg = (reg & ~0x0c000000) | (prichlo ? 2 : 1) << 26;
5002251538Srpaulo		urtwn_bb_write(sc, 0x818, reg);
5003251538Srpaulo
5004251538Srpaulo		/* Select 40MHz bandwidth. */
5005251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
5006251538Srpaulo		    (sc->rf_chnlbw[0] & ~0xfff) | chan);
5007251538Srpaulo	} else
5008251538Srpaulo#endif
5009251538Srpaulo	{
5010251538Srpaulo		urtwn_write_1(sc, R92C_BWOPMODE,
5011251538Srpaulo		    urtwn_read_1(sc, R92C_BWOPMODE) | R92C_BWOPMODE_20MHZ);
5012251538Srpaulo
5013251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA0_RFMOD,
5014251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA0_RFMOD) & ~R92C_RFMOD_40MHZ);
5015251538Srpaulo		urtwn_bb_write(sc, R92C_FPGA1_RFMOD,
5016251538Srpaulo		    urtwn_bb_read(sc, R92C_FPGA1_RFMOD) & ~R92C_RFMOD_40MHZ);
5017251538Srpaulo
5018264912Skevlo		if (!(sc->chip & URTWN_CHIP_88E)) {
5019264912Skevlo			urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2,
5020264912Skevlo			    urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) |
5021264912Skevlo			    R92C_FPGA0_ANAPARAM2_CBW20);
5022264912Skevlo		}
5023281069Srpaulo
5024251538Srpaulo		/* Select 20MHz bandwidth. */
5025251538Srpaulo		urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
5026281069Srpaulo		    (sc->rf_chnlbw[0] & ~0xfff) | chan |
5027264912Skevlo		    ((sc->chip & URTWN_CHIP_88E) ? R88E_RF_CHNLBW_BW20 :
5028264912Skevlo		    R92C_RF_CHNLBW_BW20));
5029251538Srpaulo	}
5030251538Srpaulo}
5031251538Srpaulo
5032251538Srpaulostatic void
5033251538Srpaulourtwn_iq_calib(struct urtwn_softc *sc)
5034251538Srpaulo{
5035251538Srpaulo	/* TODO */
5036251538Srpaulo}
5037251538Srpaulo
5038251538Srpaulostatic void
5039251538Srpaulourtwn_lc_calib(struct urtwn_softc *sc)
5040251538Srpaulo{
5041251538Srpaulo	uint32_t rf_ac[2];
5042251538Srpaulo	uint8_t txmode;
5043251538Srpaulo	int i;
5044251538Srpaulo
5045251538Srpaulo	txmode = urtwn_read_1(sc, R92C_OFDM1_LSTF + 3);
5046251538Srpaulo	if ((txmode & 0x70) != 0) {
5047251538Srpaulo		/* Disable all continuous Tx. */
5048251538Srpaulo		urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode & ~0x70);
5049251538Srpaulo
5050251538Srpaulo		/* Set RF mode to standby mode. */
5051251538Srpaulo		for (i = 0; i < sc->nrxchains; i++) {
5052251538Srpaulo			rf_ac[i] = urtwn_rf_read(sc, i, R92C_RF_AC);
5053251538Srpaulo			urtwn_rf_write(sc, i, R92C_RF_AC,
5054251538Srpaulo			    RW(rf_ac[i], R92C_RF_AC_MODE,
5055251538Srpaulo				R92C_RF_AC_MODE_STANDBY));
5056251538Srpaulo		}
5057251538Srpaulo	} else {
5058251538Srpaulo		/* Block all Tx queues. */
5059293180Savos		urtwn_write_1(sc, R92C_TXPAUSE, R92C_TX_QUEUE_ALL);
5060251538Srpaulo	}
5061251538Srpaulo	/* Start calibration. */
5062251538Srpaulo	urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
5063251538Srpaulo	    urtwn_rf_read(sc, 0, R92C_RF_CHNLBW) | R92C_RF_CHNLBW_LCSTART);
5064251538Srpaulo
5065251538Srpaulo	/* Give calibration the time to complete. */
5066266472Shselasky	usb_pause_mtx(&sc->sc_mtx, hz / 10);		/* 100ms */
5067251538Srpaulo
5068251538Srpaulo	/* Restore configuration. */
5069251538Srpaulo	if ((txmode & 0x70) != 0) {
5070251538Srpaulo		/* Restore Tx mode. */
5071251538Srpaulo		urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode);
5072251538Srpaulo		/* Restore RF mode. */
5073251538Srpaulo		for (i = 0; i < sc->nrxchains; i++)
5074251538Srpaulo			urtwn_rf_write(sc, i, R92C_RF_AC, rf_ac[i]);
5075251538Srpaulo	} else {
5076251538Srpaulo		/* Unblock all Tx queues. */
5077251538Srpaulo		urtwn_write_1(sc, R92C_TXPAUSE, 0x00);
5078251538Srpaulo	}
5079251538Srpaulo}
5080251538Srpaulo
5081294473Savosstatic void
5082294473Savosurtwn_temp_calib(struct urtwn_softc *sc)
5083294473Savos{
5084294473Savos	uint8_t temp;
5085294473Savos
5086294473Savos	URTWN_ASSERT_LOCKED(sc);
5087294473Savos
5088294473Savos	if (!(sc->sc_flags & URTWN_TEMP_MEASURED)) {
5089294473Savos		/* Start measuring temperature. */
5090294473Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP,
5091294473Savos		    "%s: start measuring temperature\n", __func__);
5092294473Savos		if (sc->chip & URTWN_CHIP_88E) {
5093294473Savos			urtwn_rf_write(sc, 0, R88E_RF_T_METER,
5094294473Savos			    R88E_RF_T_METER_START);
5095294473Savos		} else {
5096294473Savos			urtwn_rf_write(sc, 0, R92C_RF_T_METER,
5097294473Savos			    R92C_RF_T_METER_START);
5098294473Savos		}
5099294473Savos		sc->sc_flags |= URTWN_TEMP_MEASURED;
5100294473Savos		return;
5101294473Savos	}
5102294473Savos	sc->sc_flags &= ~URTWN_TEMP_MEASURED;
5103294473Savos
5104294473Savos	/* Read measured temperature. */
5105294473Savos	if (sc->chip & URTWN_CHIP_88E) {
5106294473Savos		temp = MS(urtwn_rf_read(sc, 0, R88E_RF_T_METER),
5107294473Savos		    R88E_RF_T_METER_VAL);
5108294473Savos	} else {
5109294473Savos		temp = MS(urtwn_rf_read(sc, 0, R92C_RF_T_METER),
5110294473Savos		    R92C_RF_T_METER_VAL);
5111294473Savos	}
5112294473Savos	if (temp == 0) {	/* Read failed, skip. */
5113294473Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP,
5114294473Savos		    "%s: temperature read failed, skipping\n", __func__);
5115294473Savos		return;
5116294473Savos	}
5117294473Savos
5118294473Savos	URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP,
5119294473Savos	    "%s: temperature: previous %u, current %u\n",
5120294473Savos	    __func__, sc->thcal_lctemp, temp);
5121294473Savos
5122294473Savos	/*
5123294473Savos	 * Redo LC calibration if temperature changed significantly since
5124294473Savos	 * last calibration.
5125294473Savos	 */
5126294473Savos	if (sc->thcal_lctemp == 0) {
5127294473Savos		/* First LC calibration is performed in urtwn_init(). */
5128294473Savos		sc->thcal_lctemp = temp;
5129294473Savos	} else if (abs(temp - sc->thcal_lctemp) > 1) {
5130294473Savos		URTWN_DPRINTF(sc, URTWN_DEBUG_TEMP,
5131294473Savos		    "%s: LC calib triggered by temp: %u -> %u\n",
5132294473Savos		    __func__, sc->thcal_lctemp, temp);
5133294473Savos		urtwn_lc_calib(sc);
5134294473Savos		/* Record temperature of last LC calibration. */
5135294473Savos		sc->thcal_lctemp = temp;
5136294473Savos	}
5137294473Savos}
5138294473Savos
5139291698Savosstatic int
5140287197Sglebiusurtwn_init(struct urtwn_softc *sc)
5141251538Srpaulo{
5142287197Sglebius	struct ieee80211com *ic = &sc->sc_ic;
5143287197Sglebius	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
5144287197Sglebius	uint8_t macaddr[IEEE80211_ADDR_LEN];
5145251538Srpaulo	uint32_t reg;
5146291698Savos	usb_error_t usb_err = USB_ERR_NORMAL_COMPLETION;
5147251538Srpaulo	int error;
5148251538Srpaulo
5149291698Savos	URTWN_LOCK(sc);
5150291698Savos	if (sc->sc_flags & URTWN_RUNNING) {
5151291698Savos		URTWN_UNLOCK(sc);
5152291698Savos		return (0);
5153291698Savos	}
5154264864Skevlo
5155251538Srpaulo	/* Init firmware commands ring. */
5156251538Srpaulo	sc->fwcur = 0;
5157251538Srpaulo
5158251538Srpaulo	/* Allocate Tx/Rx buffers. */
5159251538Srpaulo	error = urtwn_alloc_rx_list(sc);
5160251538Srpaulo	if (error != 0)
5161251538Srpaulo		goto fail;
5162281069Srpaulo
5163251538Srpaulo	error = urtwn_alloc_tx_list(sc);
5164251538Srpaulo	if (error != 0)
5165251538Srpaulo		goto fail;
5166251538Srpaulo
5167251538Srpaulo	/* Power on adapter. */
5168251538Srpaulo	error = urtwn_power_on(sc);
5169251538Srpaulo	if (error != 0)
5170251538Srpaulo		goto fail;
5171251538Srpaulo
5172251538Srpaulo	/* Initialize DMA. */
5173251538Srpaulo	error = urtwn_dma_init(sc);
5174251538Srpaulo	if (error != 0)
5175251538Srpaulo		goto fail;
5176251538Srpaulo
5177251538Srpaulo	/* Set info size in Rx descriptors (in 64-bit words). */
5178251538Srpaulo	urtwn_write_1(sc, R92C_RX_DRVINFO_SZ, 4);
5179251538Srpaulo
5180251538Srpaulo	/* Init interrupts. */
5181264912Skevlo	if (sc->chip & URTWN_CHIP_88E) {
5182291698Savos		usb_err = urtwn_write_4(sc, R88E_HISR, 0xffffffff);
5183291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5184291698Savos			goto fail;
5185291698Savos		usb_err = urtwn_write_4(sc, R88E_HIMR, R88E_HIMR_CPWM | R88E_HIMR_CPWM2 |
5186264912Skevlo		    R88E_HIMR_TBDER | R88E_HIMR_PSTIMEOUT);
5187291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5188291698Savos			goto fail;
5189291698Savos		usb_err = urtwn_write_4(sc, R88E_HIMRE, R88E_HIMRE_RXFOVW |
5190264912Skevlo		    R88E_HIMRE_TXFOVW | R88E_HIMRE_RXERR | R88E_HIMRE_TXERR);
5191291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5192291698Savos			goto fail;
5193291698Savos		usb_err = urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION,
5194264912Skevlo		    urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) |
5195264912Skevlo		    R92C_USB_SPECIAL_OPTION_INT_BULK_SEL);
5196291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5197291698Savos			goto fail;
5198264912Skevlo	} else {
5199291698Savos		usb_err = urtwn_write_4(sc, R92C_HISR, 0xffffffff);
5200291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5201291698Savos			goto fail;
5202291698Savos		usb_err = urtwn_write_4(sc, R92C_HIMR, 0xffffffff);
5203291698Savos		if (usb_err != USB_ERR_NORMAL_COMPLETION)
5204291698Savos			goto fail;
5205264912Skevlo	}
5206251538Srpaulo
5207251538Srpaulo	/* Set MAC address. */
5208287197Sglebius	IEEE80211_ADDR_COPY(macaddr, vap ? vap->iv_myaddr : ic->ic_macaddr);
5209291698Savos	usb_err = urtwn_write_region_1(sc, R92C_MACID, macaddr, IEEE80211_ADDR_LEN);
5210291698Savos	if (usb_err != USB_ERR_NORMAL_COMPLETION)
5211291698Savos		goto fail;
5212251538Srpaulo
5213251538Srpaulo	/* Set initial network type. */
5214289811Savos	urtwn_set_mode(sc, R92C_MSR_INFRA);
5215251538Srpaulo
5216290564Savos	/* Initialize Rx filter. */
5217251538Srpaulo	urtwn_rxfilter_init(sc);
5218251538Srpaulo
5219282623Skevlo	/* Set response rate. */
5220251538Srpaulo	reg = urtwn_read_4(sc, R92C_RRSR);
5221251538Srpaulo	reg = RW(reg, R92C_RRSR_RATE_BITMAP, R92C_RRSR_RATE_CCK_ONLY_1M);
5222251538Srpaulo	urtwn_write_4(sc, R92C_RRSR, reg);
5223251538Srpaulo
5224251538Srpaulo	/* Set short/long retry limits. */
5225251538Srpaulo	urtwn_write_2(sc, R92C_RL,
5226251538Srpaulo	    SM(R92C_RL_SRL, 0x30) | SM(R92C_RL_LRL, 0x30));
5227251538Srpaulo
5228251538Srpaulo	/* Initialize EDCA parameters. */
5229251538Srpaulo	urtwn_edca_init(sc);
5230251538Srpaulo
5231251538Srpaulo	/* Setup rate fallback. */
5232264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
5233264912Skevlo		urtwn_write_4(sc, R92C_DARFRC + 0, 0x00000000);
5234264912Skevlo		urtwn_write_4(sc, R92C_DARFRC + 4, 0x10080404);
5235264912Skevlo		urtwn_write_4(sc, R92C_RARFRC + 0, 0x04030201);
5236264912Skevlo		urtwn_write_4(sc, R92C_RARFRC + 4, 0x08070605);
5237264912Skevlo	}
5238251538Srpaulo
5239251538Srpaulo	urtwn_write_1(sc, R92C_FWHW_TXQ_CTRL,
5240251538Srpaulo	    urtwn_read_1(sc, R92C_FWHW_TXQ_CTRL) |
5241251538Srpaulo	    R92C_FWHW_TXQ_CTRL_AMPDU_RTY_NEW);
5242251538Srpaulo	/* Set ACK timeout. */
5243251538Srpaulo	urtwn_write_1(sc, R92C_ACKTO, 0x40);
5244251538Srpaulo
5245251538Srpaulo	/* Setup USB aggregation. */
5246251538Srpaulo	reg = urtwn_read_4(sc, R92C_TDECTRL);
5247251538Srpaulo	reg = RW(reg, R92C_TDECTRL_BLK_DESC_NUM, 6);
5248251538Srpaulo	urtwn_write_4(sc, R92C_TDECTRL, reg);
5249251538Srpaulo	urtwn_write_1(sc, R92C_TRXDMA_CTRL,
5250251538Srpaulo	    urtwn_read_1(sc, R92C_TRXDMA_CTRL) |
5251251538Srpaulo	    R92C_TRXDMA_CTRL_RXDMA_AGG_EN);
5252251538Srpaulo	urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH, 48);
5253264912Skevlo	if (sc->chip & URTWN_CHIP_88E)
5254264912Skevlo		urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH + 1, 4);
5255282266Skevlo	else {
5256264912Skevlo		urtwn_write_1(sc, R92C_USB_DMA_AGG_TO, 4);
5257282266Skevlo		urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION,
5258282266Skevlo		    urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) |
5259282266Skevlo		    R92C_USB_SPECIAL_OPTION_AGG_EN);
5260282266Skevlo		urtwn_write_1(sc, R92C_USB_AGG_TH, 8);
5261282266Skevlo		urtwn_write_1(sc, R92C_USB_AGG_TO, 6);
5262282266Skevlo	}
5263251538Srpaulo
5264251538Srpaulo	/* Initialize beacon parameters. */
5265264912Skevlo	urtwn_write_2(sc, R92C_BCN_CTRL, 0x1010);
5266251538Srpaulo	urtwn_write_2(sc, R92C_TBTT_PROHIBIT, 0x6404);
5267251538Srpaulo	urtwn_write_1(sc, R92C_DRVERLYINT, 0x05);
5268251538Srpaulo	urtwn_write_1(sc, R92C_BCNDMATIM, 0x02);
5269251538Srpaulo	urtwn_write_2(sc, R92C_BCNTCFG, 0x660f);
5270251538Srpaulo
5271264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
5272264912Skevlo		/* Setup AMPDU aggregation. */
5273264912Skevlo		urtwn_write_4(sc, R92C_AGGLEN_LMT, 0x99997631);	/* MCS7~0 */
5274264912Skevlo		urtwn_write_1(sc, R92C_AGGR_BREAK_TIME, 0x16);
5275264912Skevlo		urtwn_write_2(sc, R92C_MAX_AGGR_NUM, 0x0708);
5276251538Srpaulo
5277264912Skevlo		urtwn_write_1(sc, R92C_BCN_MAX_ERR, 0xff);
5278264912Skevlo	}
5279251538Srpaulo
5280295871Savos#ifndef URTWN_WITHOUT_UCODE
5281251538Srpaulo	/* Load 8051 microcode. */
5282251538Srpaulo	error = urtwn_load_firmware(sc);
5283295871Savos	if (error == 0)
5284295871Savos		sc->sc_flags |= URTWN_FW_LOADED;
5285295871Savos#endif
5286251538Srpaulo
5287251538Srpaulo	/* Initialize MAC/BB/RF blocks. */
5288291698Savos	error = urtwn_mac_init(sc);
5289291698Savos	if (error != 0) {
5290291698Savos		device_printf(sc->sc_dev,
5291291698Savos		    "%s: error while initializing MAC block\n", __func__);
5292291698Savos		goto fail;
5293291698Savos	}
5294251538Srpaulo	urtwn_bb_init(sc);
5295251538Srpaulo	urtwn_rf_init(sc);
5296251538Srpaulo
5297290564Savos	/* Reinitialize Rx filter (D3845 is not committed yet). */
5298290564Savos	urtwn_rxfilter_init(sc);
5299290564Savos
5300264912Skevlo	if (sc->chip & URTWN_CHIP_88E) {
5301264912Skevlo		urtwn_write_2(sc, R92C_CR,
5302264912Skevlo		    urtwn_read_2(sc, R92C_CR) | R92C_CR_MACTXEN |
5303264912Skevlo		    R92C_CR_MACRXEN);
5304264912Skevlo	}
5305264912Skevlo
5306251538Srpaulo	/* Turn CCK and OFDM blocks on. */
5307251538Srpaulo	reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD);
5308251538Srpaulo	reg |= R92C_RFMOD_CCK_EN;
5309291698Savos	usb_err = urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg);
5310291698Savos	if (usb_err != USB_ERR_NORMAL_COMPLETION)
5311291698Savos		goto fail;
5312251538Srpaulo	reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD);
5313251538Srpaulo	reg |= R92C_RFMOD_OFDM_EN;
5314291698Savos	usb_err = urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg);
5315291698Savos	if (usb_err != USB_ERR_NORMAL_COMPLETION)
5316291698Savos		goto fail;
5317251538Srpaulo
5318251538Srpaulo	/* Clear per-station keys table. */
5319251538Srpaulo	urtwn_cam_init(sc);
5320251538Srpaulo
5321292175Savos	/* Enable decryption / encryption. */
5322292175Savos	urtwn_write_2(sc, R92C_SECCFG,
5323292175Savos	    R92C_SECCFG_TXUCKEY_DEF | R92C_SECCFG_RXUCKEY_DEF |
5324292175Savos	    R92C_SECCFG_TXENC_ENA | R92C_SECCFG_RXDEC_ENA |
5325292175Savos	    R92C_SECCFG_TXBCKEY_DEF | R92C_SECCFG_RXBCKEY_DEF);
5326292175Savos
5327292175Savos	/*
5328292175Savos	 * Install static keys (if any).
5329292175Savos	 * Must be called after urtwn_cam_init().
5330292175Savos	 */
5331292175Savos	ieee80211_runtask(ic, &sc->cmdq_task);
5332292175Savos
5333251538Srpaulo	/* Enable hardware sequence numbering. */
5334293180Savos	urtwn_write_1(sc, R92C_HWSEQ_CTRL, R92C_TX_QUEUE_ALL);
5335251538Srpaulo
5336292167Savos	/* Enable per-packet TX report. */
5337292167Savos	if (sc->chip & URTWN_CHIP_88E) {
5338292167Savos		urtwn_write_1(sc, R88E_TX_RPT_CTRL,
5339292167Savos		    urtwn_read_1(sc, R88E_TX_RPT_CTRL) | R88E_TX_RPT1_ENA);
5340292167Savos	}
5341292167Savos
5342251538Srpaulo	/* Perform LO and IQ calibrations. */
5343251538Srpaulo	urtwn_iq_calib(sc);
5344251538Srpaulo	/* Perform LC calibration. */
5345251538Srpaulo	urtwn_lc_calib(sc);
5346251538Srpaulo
5347251538Srpaulo	/* Fix USB interference issue. */
5348264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E)) {
5349264912Skevlo		urtwn_write_1(sc, 0xfe40, 0xe0);
5350264912Skevlo		urtwn_write_1(sc, 0xfe41, 0x8d);
5351264912Skevlo		urtwn_write_1(sc, 0xfe42, 0x80);
5352251538Srpaulo
5353264912Skevlo		urtwn_pa_bias_init(sc);
5354264912Skevlo	}
5355251538Srpaulo
5356251538Srpaulo	/* Initialize GPIO setting. */
5357251538Srpaulo	urtwn_write_1(sc, R92C_GPIO_MUXCFG,
5358251538Srpaulo	    urtwn_read_1(sc, R92C_GPIO_MUXCFG) & ~R92C_GPIO_MUXCFG_ENBT);
5359251538Srpaulo
5360251538Srpaulo	/* Fix for lower temperature. */
5361264912Skevlo	if (!(sc->chip & URTWN_CHIP_88E))
5362264912Skevlo		urtwn_write_1(sc, 0x15, 0xe9);
5363251538Srpaulo
5364251538Srpaulo	usbd_transfer_start(sc->sc_xfer[URTWN_BULK_RX]);
5365251538Srpaulo
5366287197Sglebius	sc->sc_flags |= URTWN_RUNNING;
5367251538Srpaulo
5368251538Srpaulo	callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
5369251538Srpaulofail:
5370291698Savos	if (usb_err != USB_ERR_NORMAL_COMPLETION)
5371291698Savos		error = EIO;
5372291698Savos
5373291698Savos	URTWN_UNLOCK(sc);
5374291698Savos
5375291698Savos	return (error);
5376251538Srpaulo}
5377251538Srpaulo
5378251538Srpaulostatic void
5379287197Sglebiusurtwn_stop(struct urtwn_softc *sc)
5380251538Srpaulo{
5381251538Srpaulo
5382291698Savos	URTWN_LOCK(sc);
5383291698Savos	if (!(sc->sc_flags & URTWN_RUNNING)) {
5384291698Savos		URTWN_UNLOCK(sc);
5385291698Savos		return;
5386291698Savos	}
5387291698Savos
5388295871Savos	sc->sc_flags &= ~(URTWN_RUNNING | URTWN_FW_LOADED |
5389295871Savos	    URTWN_TEMP_MEASURED);
5390294473Savos	sc->thcal_lctemp = 0;
5391251538Srpaulo	callout_stop(&sc->sc_watchdog_ch);
5392295874Savos
5393251538Srpaulo	urtwn_abort_xfers(sc);
5394288353Sadrian	urtwn_drain_mbufq(sc);
5395295874Savos	urtwn_power_off(sc);
5396291698Savos	URTWN_UNLOCK(sc);
5397251538Srpaulo}
5398251538Srpaulo
5399251538Srpaulostatic void
5400251538Srpaulourtwn_abort_xfers(struct urtwn_softc *sc)
5401251538Srpaulo{
5402251538Srpaulo	int i;
5403251538Srpaulo
5404251538Srpaulo	URTWN_ASSERT_LOCKED(sc);
5405251538Srpaulo
5406251538Srpaulo	/* abort any pending transfers */
5407251538Srpaulo	for (i = 0; i < URTWN_N_TRANSFER; i++)
5408251538Srpaulo		usbd_transfer_stop(sc->sc_xfer[i]);
5409251538Srpaulo}
5410251538Srpaulo
5411251538Srpaulostatic int
5412251538Srpaulourtwn_raw_xmit(struct ieee80211_node *ni, struct mbuf *m,
5413251538Srpaulo    const struct ieee80211_bpf_params *params)
5414251538Srpaulo{
5415251538Srpaulo	struct ieee80211com *ic = ni->ni_ic;
5416286949Sadrian	struct urtwn_softc *sc = ic->ic_softc;
5417251538Srpaulo	struct urtwn_data *bf;
5418290630Savos	int error;
5419251538Srpaulo
5420297596Sadrian	URTWN_DPRINTF(sc, URTWN_DEBUG_XMIT, "%s: called; m=%p\n",
5421297596Sadrian	    __func__,
5422297596Sadrian	    m);
5423297596Sadrian
5424251538Srpaulo	/* prevent management frames from being sent if we're not ready */
5425290630Savos	URTWN_LOCK(sc);
5426287197Sglebius	if (!(sc->sc_flags & URTWN_RUNNING)) {
5427290630Savos		error = ENETDOWN;
5428290630Savos		goto end;
5429251538Srpaulo	}
5430290630Savos
5431251538Srpaulo	bf = urtwn_getbuf(sc);
5432251538Srpaulo	if (bf == NULL) {
5433290630Savos		error = ENOBUFS;
5434290630Savos		goto end;
5435251538Srpaulo	}
5436251538Srpaulo
5437292221Savos	if (params == NULL) {
5438292221Savos		/*
5439292221Savos		 * Legacy path; interpret frame contents to decide
5440292221Savos		 * precisely how to send the frame.
5441292221Savos		 */
5442292221Savos		error = urtwn_tx_data(sc, ni, m, bf);
5443292221Savos	} else {
5444292221Savos		/*
5445292221Savos		 * Caller supplied explicit parameters to use in
5446292221Savos		 * sending the frame.
5447292221Savos		 */
5448292221Savos		error = urtwn_tx_raw(sc, ni, m, bf, params);
5449292221Savos	}
5450292221Savos	if (error != 0) {
5451251538Srpaulo		STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next);
5452290630Savos		goto end;
5453251538Srpaulo	}
5454290630Savos
5455288353Sadrian	sc->sc_txtimer = 5;
5456290630Savos	callout_reset(&sc->sc_watchdog_ch, hz, urtwn_watchdog, sc);
5457290630Savos
5458290630Savosend:
5459290630Savos	if (error != 0)
5460290630Savos		m_freem(m);
5461290630Savos
5462251538Srpaulo	URTWN_UNLOCK(sc);
5463251538Srpaulo
5464290630Savos	return (error);
5465251538Srpaulo}
5466251538Srpaulo
5467266472Shselaskystatic void
5468266472Shselaskyurtwn_ms_delay(struct urtwn_softc *sc)
5469266472Shselasky{
5470266472Shselasky	usb_pause_mtx(&sc->sc_mtx, hz / 1000);
5471266472Shselasky}
5472266472Shselasky
5473251538Srpaulostatic device_method_t urtwn_methods[] = {
5474251538Srpaulo	/* Device interface */
5475251538Srpaulo	DEVMETHOD(device_probe,		urtwn_match),
5476251538Srpaulo	DEVMETHOD(device_attach,	urtwn_attach),
5477251538Srpaulo	DEVMETHOD(device_detach,	urtwn_detach),
5478251538Srpaulo
5479264912Skevlo	DEVMETHOD_END
5480251538Srpaulo};
5481251538Srpaulo
5482251538Srpaulostatic driver_t urtwn_driver = {
5483251538Srpaulo	"urtwn",
5484251538Srpaulo	urtwn_methods,
5485251538Srpaulo	sizeof(struct urtwn_softc)
5486251538Srpaulo};
5487251538Srpaulo
5488251538Srpaulostatic devclass_t urtwn_devclass;
5489251538Srpaulo
5490251538SrpauloDRIVER_MODULE(urtwn, uhub, urtwn_driver, urtwn_devclass, NULL, NULL);
5491251538SrpauloMODULE_DEPEND(urtwn, usb, 1, 1, 1);
5492251538SrpauloMODULE_DEPEND(urtwn, wlan, 1, 1, 1);
5493295871Savos#ifndef URTWN_WITHOUT_UCODE
5494251538SrpauloMODULE_DEPEND(urtwn, firmware, 1, 1, 1);
5495295871Savos#endif
5496251538SrpauloMODULE_VERSION(urtwn, 1);
5497292080SimpUSB_PNP_HOST_INFO(urtwn_devs);
5498