xref: /freebsd/sys/dev/usb/wlan/if_uath.c (revision 7a79cebfbac5e1de4648e0385b828bd161e05874)
1dc60165bSWeongyo Jeong /*-
2dc60165bSWeongyo Jeong  * Copyright (c) 2006 Sam Leffler, Errno Consulting
3dc60165bSWeongyo Jeong  * Copyright (c) 2008-2009 Weongyo Jeong <weongyo@freebsd.org>
4dc60165bSWeongyo Jeong  * All rights reserved.
5dc60165bSWeongyo Jeong  *
6dc60165bSWeongyo Jeong  * Redistribution and use in source and binary forms, with or without
7dc60165bSWeongyo Jeong  * modification, are permitted provided that the following conditions
8dc60165bSWeongyo Jeong  * are met:
9dc60165bSWeongyo Jeong  * 1. Redistributions of source code must retain the above copyright
10dc60165bSWeongyo Jeong  *    notice, this list of conditions and the following disclaimer,
11dc60165bSWeongyo Jeong  *    without modification.
12dc60165bSWeongyo Jeong  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
13dc60165bSWeongyo Jeong  *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
14dc60165bSWeongyo Jeong  *    redistribution must be conditioned upon including a substantially
15dc60165bSWeongyo Jeong  *    similar Disclaimer requirement for further binary redistribution.
16dc60165bSWeongyo Jeong  *
17dc60165bSWeongyo Jeong  * NO WARRANTY
18dc60165bSWeongyo Jeong  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
19dc60165bSWeongyo Jeong  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
20dc60165bSWeongyo Jeong  * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
21dc60165bSWeongyo Jeong  * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
22dc60165bSWeongyo Jeong  * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
23dc60165bSWeongyo Jeong  * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24dc60165bSWeongyo Jeong  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25dc60165bSWeongyo Jeong  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
26dc60165bSWeongyo Jeong  * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27dc60165bSWeongyo Jeong  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
28dc60165bSWeongyo Jeong  * THE POSSIBILITY OF SUCH DAMAGES.
29dc60165bSWeongyo Jeong  */
30dc60165bSWeongyo Jeong 
31dc60165bSWeongyo Jeong /*
32dc60165bSWeongyo Jeong  * This driver is distantly derived from a driver of the same name
33dc60165bSWeongyo Jeong  * by Damien Bergamini.  The original copyright is included below:
34dc60165bSWeongyo Jeong  *
35dc60165bSWeongyo Jeong  * Copyright (c) 2006
36dc60165bSWeongyo Jeong  *	Damien Bergamini <damien.bergamini@free.fr>
37dc60165bSWeongyo Jeong  *
38dc60165bSWeongyo Jeong  * Permission to use, copy, modify, and distribute this software for any
39dc60165bSWeongyo Jeong  * purpose with or without fee is hereby granted, provided that the above
40dc60165bSWeongyo Jeong  * copyright notice and this permission notice appear in all copies.
41dc60165bSWeongyo Jeong  *
42dc60165bSWeongyo Jeong  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
43dc60165bSWeongyo Jeong  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
44dc60165bSWeongyo Jeong  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
45dc60165bSWeongyo Jeong  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
46dc60165bSWeongyo Jeong  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
47dc60165bSWeongyo Jeong  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
48dc60165bSWeongyo Jeong  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
49dc60165bSWeongyo Jeong  */
50dc60165bSWeongyo Jeong 
51dc60165bSWeongyo Jeong #include <sys/cdefs.h>
52dc60165bSWeongyo Jeong __FBSDID("$FreeBSD$");
53dc60165bSWeongyo Jeong 
54dc60165bSWeongyo Jeong /*-
55dc60165bSWeongyo Jeong  * Driver for Atheros AR5523 USB parts.
56dc60165bSWeongyo Jeong  *
57dc60165bSWeongyo Jeong  * The driver requires firmware to be loaded into the device.  This
58dc60165bSWeongyo Jeong  * is done on device discovery from a user application (uathload)
59dc60165bSWeongyo Jeong  * that is launched by devd when a device with suitable product ID
60dc60165bSWeongyo Jeong  * is recognized.  Once firmware has been loaded the device will
61dc60165bSWeongyo Jeong  * reset the USB port and re-attach with the original product ID+1
62dc60165bSWeongyo Jeong  * and this driver will be attached.  The firmware is licensed for
63dc60165bSWeongyo Jeong  * general use (royalty free) and may be incorporated in products.
64dc60165bSWeongyo Jeong  * Note that the firmware normally packaged with the NDIS drivers
65dc60165bSWeongyo Jeong  * for these devices does not work in this way and so does not work
66dc60165bSWeongyo Jeong  * with this driver.
67dc60165bSWeongyo Jeong  */
68dc60165bSWeongyo Jeong #include <sys/param.h>
69dc60165bSWeongyo Jeong #include <sys/sockio.h>
70dc60165bSWeongyo Jeong #include <sys/sysctl.h>
71dc60165bSWeongyo Jeong #include <sys/lock.h>
72dc60165bSWeongyo Jeong #include <sys/mutex.h>
73dc60165bSWeongyo Jeong #include <sys/mbuf.h>
74dc60165bSWeongyo Jeong #include <sys/kernel.h>
75dc60165bSWeongyo Jeong #include <sys/socket.h>
76dc60165bSWeongyo Jeong #include <sys/systm.h>
77dc60165bSWeongyo Jeong #include <sys/malloc.h>
78dc60165bSWeongyo Jeong #include <sys/module.h>
79dc60165bSWeongyo Jeong #include <sys/bus.h>
80dc60165bSWeongyo Jeong #include <sys/endian.h>
81dc60165bSWeongyo Jeong #include <sys/kdb.h>
82dc60165bSWeongyo Jeong 
83dc60165bSWeongyo Jeong #include <machine/bus.h>
84dc60165bSWeongyo Jeong #include <machine/resource.h>
85dc60165bSWeongyo Jeong #include <sys/rman.h>
86dc60165bSWeongyo Jeong 
87dc60165bSWeongyo Jeong #include <net/bpf.h>
88dc60165bSWeongyo Jeong #include <net/if.h>
8976039bc8SGleb Smirnoff #include <net/if_var.h>
90dc60165bSWeongyo Jeong #include <net/if_arp.h>
91dc60165bSWeongyo Jeong #include <net/ethernet.h>
92dc60165bSWeongyo Jeong #include <net/if_dl.h>
93dc60165bSWeongyo Jeong #include <net/if_media.h>
94dc60165bSWeongyo Jeong #include <net/if_types.h>
95dc60165bSWeongyo Jeong 
96dc60165bSWeongyo Jeong #ifdef INET
97dc60165bSWeongyo Jeong #include <netinet/in.h>
98dc60165bSWeongyo Jeong #include <netinet/in_systm.h>
99dc60165bSWeongyo Jeong #include <netinet/in_var.h>
100dc60165bSWeongyo Jeong #include <netinet/if_ether.h>
101dc60165bSWeongyo Jeong #include <netinet/ip.h>
102dc60165bSWeongyo Jeong #endif
103dc60165bSWeongyo Jeong 
104dc60165bSWeongyo Jeong #include <net80211/ieee80211_var.h>
105dc60165bSWeongyo Jeong #include <net80211/ieee80211_regdomain.h>
106dc60165bSWeongyo Jeong #include <net80211/ieee80211_radiotap.h>
107dc60165bSWeongyo Jeong 
108dc60165bSWeongyo Jeong #include <dev/usb/usb.h>
109ed6d949aSAndrew Thompson #include <dev/usb/usbdi.h>
110dc60165bSWeongyo Jeong #include "usbdevs.h"
111dc60165bSWeongyo Jeong 
112dc60165bSWeongyo Jeong #include <dev/usb/wlan/if_uathreg.h>
113dc60165bSWeongyo Jeong #include <dev/usb/wlan/if_uathvar.h>
114dc60165bSWeongyo Jeong 
1156472ac3dSEd Schouten static SYSCTL_NODE(_hw_usb, OID_AUTO, uath, CTLFLAG_RW, 0, "USB Atheros");
116dc60165bSWeongyo Jeong 
117dc60165bSWeongyo Jeong static	int uath_countrycode = CTRY_DEFAULT;	/* country code */
118af3b2549SHans Petter Selasky SYSCTL_INT(_hw_usb_uath, OID_AUTO, countrycode, CTLFLAG_RWTUN, &uath_countrycode,
119dc60165bSWeongyo Jeong     0, "country code");
120dc60165bSWeongyo Jeong static	int uath_regdomain = 0;			/* regulatory domain */
1219360ae40SAndrew Thompson SYSCTL_INT(_hw_usb_uath, OID_AUTO, regdomain, CTLFLAG_RD, &uath_regdomain,
122dc60165bSWeongyo Jeong     0, "regulatory domain");
123dc60165bSWeongyo Jeong 
124dc60165bSWeongyo Jeong #ifdef UATH_DEBUG
125dc60165bSWeongyo Jeong int uath_debug = 0;
126af3b2549SHans Petter Selasky SYSCTL_INT(_hw_usb_uath, OID_AUTO, debug, CTLFLAG_RWTUN, &uath_debug, 0,
127dc60165bSWeongyo Jeong     "uath debug level");
128dc60165bSWeongyo Jeong enum {
129dc60165bSWeongyo Jeong 	UATH_DEBUG_XMIT		= 0x00000001,	/* basic xmit operation */
130dc60165bSWeongyo Jeong 	UATH_DEBUG_XMIT_DUMP	= 0x00000002,	/* xmit dump */
131dc60165bSWeongyo Jeong 	UATH_DEBUG_RECV		= 0x00000004,	/* basic recv operation */
132dc60165bSWeongyo Jeong 	UATH_DEBUG_TX_PROC	= 0x00000008,	/* tx ISR proc */
133dc60165bSWeongyo Jeong 	UATH_DEBUG_RX_PROC	= 0x00000010,	/* rx ISR proc */
134dc60165bSWeongyo Jeong 	UATH_DEBUG_RECV_ALL	= 0x00000020,	/* trace all frames (beacons) */
135dc60165bSWeongyo Jeong 	UATH_DEBUG_INIT		= 0x00000040,	/* initialization of dev */
136dc60165bSWeongyo Jeong 	UATH_DEBUG_DEVCAP	= 0x00000080,	/* dev caps */
137dc60165bSWeongyo Jeong 	UATH_DEBUG_CMDS		= 0x00000100,	/* commands */
138dc60165bSWeongyo Jeong 	UATH_DEBUG_CMDS_DUMP	= 0x00000200,	/* command buffer dump */
139dc60165bSWeongyo Jeong 	UATH_DEBUG_RESET	= 0x00000400,	/* reset processing */
140dc60165bSWeongyo Jeong 	UATH_DEBUG_STATE	= 0x00000800,	/* 802.11 state transitions */
141dc60165bSWeongyo Jeong 	UATH_DEBUG_MULTICAST	= 0x00001000,	/* multicast */
142dc60165bSWeongyo Jeong 	UATH_DEBUG_WME		= 0x00002000,	/* WME */
143dc60165bSWeongyo Jeong 	UATH_DEBUG_CHANNEL	= 0x00004000,	/* channel */
144dc60165bSWeongyo Jeong 	UATH_DEBUG_RATES	= 0x00008000,	/* rates */
145dc60165bSWeongyo Jeong 	UATH_DEBUG_CRYPTO	= 0x00010000,	/* crypto */
146dc60165bSWeongyo Jeong 	UATH_DEBUG_LED		= 0x00020000,	/* LED */
147dc60165bSWeongyo Jeong 	UATH_DEBUG_ANY		= 0xffffffff
148dc60165bSWeongyo Jeong };
149dc60165bSWeongyo Jeong #define	DPRINTF(sc, m, fmt, ...) do {				\
150dc60165bSWeongyo Jeong 	if (sc->sc_debug & (m))					\
151dc60165bSWeongyo Jeong 		printf(fmt, __VA_ARGS__);			\
152dc60165bSWeongyo Jeong } while (0)
153dc60165bSWeongyo Jeong #else
154dc60165bSWeongyo Jeong #define	DPRINTF(sc, m, fmt, ...) do {				\
155dc60165bSWeongyo Jeong 	(void) sc;						\
156dc60165bSWeongyo Jeong } while (0)
157dc60165bSWeongyo Jeong #endif
158dc60165bSWeongyo Jeong 
159dc60165bSWeongyo Jeong /* unaligned little endian access */
160dc60165bSWeongyo Jeong #define LE_READ_2(p)							\
161dc60165bSWeongyo Jeong 	((u_int16_t)							\
162dc60165bSWeongyo Jeong 	 ((((u_int8_t *)(p))[0]      ) | (((u_int8_t *)(p))[1] <<  8)))
163dc60165bSWeongyo Jeong #define LE_READ_4(p)							\
164dc60165bSWeongyo Jeong 	((u_int32_t)							\
165dc60165bSWeongyo Jeong 	 ((((u_int8_t *)(p))[0]      ) | (((u_int8_t *)(p))[1] <<  8) |	\
166dc60165bSWeongyo Jeong 	  (((u_int8_t *)(p))[2] << 16) | (((u_int8_t *)(p))[3] << 24)))
167dc60165bSWeongyo Jeong 
168dc60165bSWeongyo Jeong /* recognized device vendors/products */
169f1a16106SHans Petter Selasky static const STRUCT_USB_HOST_ID uath_devs[] = {
170dc60165bSWeongyo Jeong #define	UATH_DEV(v,p) { USB_VP(USB_VENDOR_##v, USB_PRODUCT_##v##_##p) }
171e257fff4SWeongyo Jeong 	UATH_DEV(ACCTON,		SMCWUSBTG2),
172dc60165bSWeongyo Jeong 	UATH_DEV(ATHEROS,		AR5523),
173dc60165bSWeongyo Jeong 	UATH_DEV(ATHEROS2,		AR5523_1),
174dc60165bSWeongyo Jeong 	UATH_DEV(ATHEROS2,		AR5523_2),
175dc60165bSWeongyo Jeong 	UATH_DEV(ATHEROS2,		AR5523_3),
176dc60165bSWeongyo Jeong 	UATH_DEV(CONCEPTRONIC,		AR5523_1),
177dc60165bSWeongyo Jeong 	UATH_DEV(CONCEPTRONIC,		AR5523_2),
178dc60165bSWeongyo Jeong 	UATH_DEV(DLINK,			DWLAG122),
179dc60165bSWeongyo Jeong 	UATH_DEV(DLINK,			DWLAG132),
180dc60165bSWeongyo Jeong 	UATH_DEV(DLINK,			DWLG132),
18162dcd865SWeongyo Jeong 	UATH_DEV(DLINK2,		DWA120),
182dc60165bSWeongyo Jeong 	UATH_DEV(GIGASET,		AR5523),
183dc60165bSWeongyo Jeong 	UATH_DEV(GIGASET,		SMCWUSBTG),
184dc60165bSWeongyo Jeong 	UATH_DEV(GLOBALSUN,		AR5523_1),
185dc60165bSWeongyo Jeong 	UATH_DEV(GLOBALSUN,		AR5523_2),
186dc60165bSWeongyo Jeong 	UATH_DEV(NETGEAR,		WG111U),
187dc60165bSWeongyo Jeong 	UATH_DEV(NETGEAR3,		WG111T),
188dc60165bSWeongyo Jeong 	UATH_DEV(NETGEAR3,		WPN111),
189dae1952fSAndrew Thompson 	UATH_DEV(NETGEAR3,		WPN111_2),
190dc60165bSWeongyo Jeong 	UATH_DEV(UMEDIA,		TEW444UBEU),
191dc60165bSWeongyo Jeong 	UATH_DEV(UMEDIA,		AR5523_2),
192dc60165bSWeongyo Jeong 	UATH_DEV(WISTRONNEWEB,		AR5523_1),
193dc60165bSWeongyo Jeong 	UATH_DEV(WISTRONNEWEB,		AR5523_2),
194dc60165bSWeongyo Jeong 	UATH_DEV(ZCOM,			AR5523)
195dc60165bSWeongyo Jeong #undef UATH_DEV
196dc60165bSWeongyo Jeong };
197dc60165bSWeongyo Jeong 
198e0a69b51SAndrew Thompson static usb_callback_t uath_intr_rx_callback;
199e0a69b51SAndrew Thompson static usb_callback_t uath_intr_tx_callback;
200e0a69b51SAndrew Thompson static usb_callback_t uath_bulk_rx_callback;
201e0a69b51SAndrew Thompson static usb_callback_t uath_bulk_tx_callback;
202dc60165bSWeongyo Jeong 
203760bc48eSAndrew Thompson static const struct usb_config uath_usbconfig[UATH_N_XFERS] = {
204dc60165bSWeongyo Jeong 	[UATH_INTR_RX] = {
205dc60165bSWeongyo Jeong 		.type = UE_BULK,
206dc60165bSWeongyo Jeong 		.endpoint = 0x1,
207dc60165bSWeongyo Jeong 		.direction = UE_DIR_IN,
2085cbbd666SAndrew Thompson 		.bufsize = UATH_MAX_CMDSZ,
2095cbbd666SAndrew Thompson 		.flags = {
210dc60165bSWeongyo Jeong 			.pipe_bof = 1,
211dc60165bSWeongyo Jeong 			.short_xfer_ok = 1
212dc60165bSWeongyo Jeong 		},
2135cbbd666SAndrew Thompson 		.callback = uath_intr_rx_callback
214dc60165bSWeongyo Jeong 	},
215dc60165bSWeongyo Jeong 	[UATH_INTR_TX] = {
216dc60165bSWeongyo Jeong 		.type = UE_BULK,
217dc60165bSWeongyo Jeong 		.endpoint = 0x1,
218dc60165bSWeongyo Jeong 		.direction = UE_DIR_OUT,
219c180b398SHans Petter Selasky 		.bufsize = UATH_MAX_CMDSZ * UATH_CMD_LIST_COUNT,
2205cbbd666SAndrew Thompson 		.flags = {
221dc60165bSWeongyo Jeong 			.force_short_xfer = 1,
222dc60165bSWeongyo Jeong 			.pipe_bof = 1,
223dc60165bSWeongyo Jeong 		},
2245cbbd666SAndrew Thompson 		.callback = uath_intr_tx_callback,
2255cbbd666SAndrew Thompson 		.timeout = UATH_CMD_TIMEOUT
226dc60165bSWeongyo Jeong 	},
227dc60165bSWeongyo Jeong 	[UATH_BULK_RX] = {
228dc60165bSWeongyo Jeong 		.type = UE_BULK,
229dc60165bSWeongyo Jeong 		.endpoint = 0x2,
230dc60165bSWeongyo Jeong 		.direction = UE_DIR_IN,
2315cbbd666SAndrew Thompson 		.bufsize = MCLBYTES,
2325cbbd666SAndrew Thompson 		.flags = {
233dc60165bSWeongyo Jeong 			.ext_buffer = 1,
234dc60165bSWeongyo Jeong 			.pipe_bof = 1,
235dc60165bSWeongyo Jeong 			.short_xfer_ok = 1
236dc60165bSWeongyo Jeong 		},
2375cbbd666SAndrew Thompson 		.callback = uath_bulk_rx_callback
238dc60165bSWeongyo Jeong 	},
239dc60165bSWeongyo Jeong 	[UATH_BULK_TX] = {
240dc60165bSWeongyo Jeong 		.type = UE_BULK,
241dc60165bSWeongyo Jeong 		.endpoint = 0x2,
242dc60165bSWeongyo Jeong 		.direction = UE_DIR_OUT,
243c180b398SHans Petter Selasky 		.bufsize = UATH_MAX_TXBUFSZ * UATH_TX_DATA_LIST_COUNT,
2445cbbd666SAndrew Thompson 		.flags = {
245dc60165bSWeongyo Jeong 			.force_short_xfer = 1,
246dc60165bSWeongyo Jeong 			.pipe_bof = 1
247dc60165bSWeongyo Jeong 		},
2485cbbd666SAndrew Thompson 		.callback = uath_bulk_tx_callback,
2495cbbd666SAndrew Thompson 		.timeout = UATH_DATA_TIMEOUT
250dc60165bSWeongyo Jeong 	}
251dc60165bSWeongyo Jeong };
252dc60165bSWeongyo Jeong 
253dc60165bSWeongyo Jeong static struct ieee80211vap *uath_vap_create(struct ieee80211com *,
254fcd9500fSBernhard Schmidt 		    const char [IFNAMSIZ], int, enum ieee80211_opmode, int,
255fcd9500fSBernhard Schmidt 		    const uint8_t [IEEE80211_ADDR_LEN],
256fcd9500fSBernhard Schmidt 		    const uint8_t [IEEE80211_ADDR_LEN]);
257dc60165bSWeongyo Jeong static void	uath_vap_delete(struct ieee80211vap *);
258c180b398SHans Petter Selasky static int	uath_alloc_cmd_list(struct uath_softc *, struct uath_cmd []);
259c180b398SHans Petter Selasky static void	uath_free_cmd_list(struct uath_softc *, struct uath_cmd []);
260dc60165bSWeongyo Jeong static int	uath_host_available(struct uath_softc *);
261dc60165bSWeongyo Jeong static int	uath_get_capability(struct uath_softc *, uint32_t, uint32_t *);
262dc60165bSWeongyo Jeong static int	uath_get_devcap(struct uath_softc *);
263dc60165bSWeongyo Jeong static struct uath_cmd *
264dc60165bSWeongyo Jeong 		uath_get_cmdbuf(struct uath_softc *);
265dc60165bSWeongyo Jeong static int	uath_cmd_read(struct uath_softc *, uint32_t, const void *,
266dc60165bSWeongyo Jeong 		    int, void *, int, int);
267dc60165bSWeongyo Jeong static int	uath_cmd_write(struct uath_softc *, uint32_t, const void *,
268dc60165bSWeongyo Jeong 		    int, int);
269dc60165bSWeongyo Jeong static void	uath_stat(void *);
270dc60165bSWeongyo Jeong #ifdef UATH_DEBUG
271dc60165bSWeongyo Jeong static void	uath_dump_cmd(const uint8_t *, int, char);
272dc60165bSWeongyo Jeong static const char *
273dc60165bSWeongyo Jeong 		uath_codename(int);
274dc60165bSWeongyo Jeong #endif
275dc60165bSWeongyo Jeong static int	uath_get_devstatus(struct uath_softc *,
276dc60165bSWeongyo Jeong 		    uint8_t macaddr[IEEE80211_ADDR_LEN]);
277dc60165bSWeongyo Jeong static int	uath_get_status(struct uath_softc *, uint32_t, void *, int);
278dc60165bSWeongyo Jeong static int	uath_alloc_rx_data_list(struct uath_softc *);
279dc60165bSWeongyo Jeong static int	uath_alloc_tx_data_list(struct uath_softc *);
280dc60165bSWeongyo Jeong static void	uath_free_rx_data_list(struct uath_softc *);
281dc60165bSWeongyo Jeong static void	uath_free_tx_data_list(struct uath_softc *);
282*7a79cebfSGleb Smirnoff static int	uath_init(struct uath_softc *);
283*7a79cebfSGleb Smirnoff static void	uath_stop(struct uath_softc *);
284*7a79cebfSGleb Smirnoff static void	uath_parent(struct ieee80211com *);
285*7a79cebfSGleb Smirnoff static int	uath_transmit(struct ieee80211com *, struct mbuf *);
286*7a79cebfSGleb Smirnoff static void	uath_start(struct uath_softc *);
287dc60165bSWeongyo Jeong static int	uath_raw_xmit(struct ieee80211_node *, struct mbuf *,
288dc60165bSWeongyo Jeong 		    const struct ieee80211_bpf_params *);
289dc60165bSWeongyo Jeong static void	uath_scan_start(struct ieee80211com *);
290dc60165bSWeongyo Jeong static void	uath_scan_end(struct ieee80211com *);
291dc60165bSWeongyo Jeong static void	uath_set_channel(struct ieee80211com *);
292272f6adeSGleb Smirnoff static void	uath_update_mcast(struct ieee80211com *);
293272f6adeSGleb Smirnoff static void	uath_update_promisc(struct ieee80211com *);
294dc60165bSWeongyo Jeong static int	uath_config(struct uath_softc *, uint32_t, uint32_t);
295dc60165bSWeongyo Jeong static int	uath_config_multi(struct uath_softc *, uint32_t, const void *,
296dc60165bSWeongyo Jeong 		    int);
297dc60165bSWeongyo Jeong static int	uath_switch_channel(struct uath_softc *,
298dc60165bSWeongyo Jeong 		    struct ieee80211_channel *);
299dc60165bSWeongyo Jeong static int	uath_set_rxfilter(struct uath_softc *, uint32_t, uint32_t);
300dc60165bSWeongyo Jeong static void	uath_watchdog(void *);
301dc60165bSWeongyo Jeong static void	uath_abort_xfers(struct uath_softc *);
302dc60165bSWeongyo Jeong static int	uath_dataflush(struct uath_softc *);
303dc60165bSWeongyo Jeong static int	uath_cmdflush(struct uath_softc *);
304dc60165bSWeongyo Jeong static int	uath_flush(struct uath_softc *);
305dc60165bSWeongyo Jeong static int	uath_set_ledstate(struct uath_softc *, int);
306dc60165bSWeongyo Jeong static int	uath_set_chan(struct uath_softc *, struct ieee80211_channel *);
307dc60165bSWeongyo Jeong static int	uath_reset_tx_queues(struct uath_softc *);
308dc60165bSWeongyo Jeong static int	uath_wme_init(struct uath_softc *);
309dc60165bSWeongyo Jeong static struct uath_data *
310dc60165bSWeongyo Jeong 		uath_getbuf(struct uath_softc *);
311dc60165bSWeongyo Jeong static int	uath_newstate(struct ieee80211vap *, enum ieee80211_state,
312dc60165bSWeongyo Jeong 		    int);
313dc60165bSWeongyo Jeong static int	uath_set_key(struct uath_softc *,
314dc60165bSWeongyo Jeong 		    const struct ieee80211_key *, int);
315dc60165bSWeongyo Jeong static int	uath_set_keys(struct uath_softc *, struct ieee80211vap *);
316dc60165bSWeongyo Jeong static void	uath_sysctl_node(struct uath_softc *);
317dc60165bSWeongyo Jeong 
318dc60165bSWeongyo Jeong static int
319dc60165bSWeongyo Jeong uath_match(device_t dev)
320dc60165bSWeongyo Jeong {
321760bc48eSAndrew Thompson 	struct usb_attach_arg *uaa = device_get_ivars(dev);
322dc60165bSWeongyo Jeong 
323f29a0724SAndrew Thompson 	if (uaa->usb_mode != USB_MODE_HOST)
324dc60165bSWeongyo Jeong 		return (ENXIO);
325dc60165bSWeongyo Jeong 	if (uaa->info.bConfigIndex != UATH_CONFIG_INDEX)
326dc60165bSWeongyo Jeong 		return (ENXIO);
327dc60165bSWeongyo Jeong 	if (uaa->info.bIfaceIndex != UATH_IFACE_INDEX)
328dc60165bSWeongyo Jeong 		return (ENXIO);
329dc60165bSWeongyo Jeong 
330a593f6b8SAndrew Thompson 	return (usbd_lookup_id_by_uaa(uath_devs, sizeof(uath_devs), uaa));
331dc60165bSWeongyo Jeong }
332dc60165bSWeongyo Jeong 
333dc60165bSWeongyo Jeong static int
334dc60165bSWeongyo Jeong uath_attach(device_t dev)
335dc60165bSWeongyo Jeong {
336dc60165bSWeongyo Jeong 	struct uath_softc *sc = device_get_softc(dev);
337760bc48eSAndrew Thompson 	struct usb_attach_arg *uaa = device_get_ivars(dev);
338*7a79cebfSGleb Smirnoff 	struct ieee80211com *ic = &sc->sc_ic;
339dc60165bSWeongyo Jeong 	uint8_t bands, iface_index = UATH_IFACE_INDEX;		/* XXX */
340e0a69b51SAndrew Thompson 	usb_error_t error;
341dc60165bSWeongyo Jeong 
342dc60165bSWeongyo Jeong 	sc->sc_dev = dev;
343dc60165bSWeongyo Jeong 	sc->sc_udev = uaa->device;
344dc60165bSWeongyo Jeong #ifdef UATH_DEBUG
345dc60165bSWeongyo Jeong 	sc->sc_debug = uath_debug;
346dc60165bSWeongyo Jeong #endif
347a593f6b8SAndrew Thompson 	device_set_usb_desc(dev);
348dc60165bSWeongyo Jeong 
349dc60165bSWeongyo Jeong 	/*
350dc60165bSWeongyo Jeong 	 * Only post-firmware devices here.
351dc60165bSWeongyo Jeong 	 */
352dc60165bSWeongyo Jeong 	mtx_init(&sc->sc_mtx, device_get_nameunit(sc->sc_dev), MTX_NETWORK_LOCK,
353dc60165bSWeongyo Jeong 	    MTX_DEF);
354dc60165bSWeongyo Jeong 	callout_init(&sc->stat_ch, 0);
355dc60165bSWeongyo Jeong 	callout_init_mtx(&sc->watchdog_ch, &sc->sc_mtx, 0);
356*7a79cebfSGleb Smirnoff 	mbufq_init(&sc->sc_snd, ifqmaxlen);
357dc60165bSWeongyo Jeong 
358a593f6b8SAndrew Thompson 	error = usbd_transfer_setup(uaa->device, &iface_index, sc->sc_xfer,
359dc60165bSWeongyo Jeong 	    uath_usbconfig, UATH_N_XFERS, sc, &sc->sc_mtx);
360dc60165bSWeongyo Jeong 	if (error) {
361dc60165bSWeongyo Jeong 		device_printf(dev, "could not allocate USB transfers, "
362a593f6b8SAndrew Thompson 		    "err=%s\n", usbd_errstr(error));
3632d8a425bSHans Petter Selasky 		goto fail;
364dc60165bSWeongyo Jeong 	}
365dc60165bSWeongyo Jeong 
366c180b398SHans Petter Selasky 	sc->sc_cmd_dma_buf =
367c180b398SHans Petter Selasky 	    usbd_xfer_get_frame_buffer(sc->sc_xfer[UATH_INTR_TX], 0);
368c180b398SHans Petter Selasky 	sc->sc_tx_dma_buf =
369c180b398SHans Petter Selasky 	    usbd_xfer_get_frame_buffer(sc->sc_xfer[UATH_BULK_TX], 0);
370c180b398SHans Petter Selasky 
371dc60165bSWeongyo Jeong 	/*
3722d8a425bSHans Petter Selasky 	 * Setup buffers for firmware commands.
3732d8a425bSHans Petter Selasky 	 */
3742d8a425bSHans Petter Selasky 	error = uath_alloc_cmd_list(sc, sc->sc_cmd);
3752d8a425bSHans Petter Selasky 	if (error != 0) {
3762d8a425bSHans Petter Selasky 		device_printf(sc->sc_dev,
3772d8a425bSHans Petter Selasky 		    "could not allocate Tx command list\n");
3782d8a425bSHans Petter Selasky 		goto fail1;
3792d8a425bSHans Petter Selasky 	}
3802d8a425bSHans Petter Selasky 
3812d8a425bSHans Petter Selasky 	/*
382dc60165bSWeongyo Jeong 	 * We're now ready to send+receive firmware commands.
383dc60165bSWeongyo Jeong 	 */
384dc60165bSWeongyo Jeong 	UATH_LOCK(sc);
385dc60165bSWeongyo Jeong 	error = uath_host_available(sc);
386dc60165bSWeongyo Jeong 	if (error != 0) {
387dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev, "could not initialize adapter\n");
388*7a79cebfSGleb Smirnoff 		goto fail2;
389dc60165bSWeongyo Jeong 	}
390dc60165bSWeongyo Jeong 	error = uath_get_devcap(sc);
391dc60165bSWeongyo Jeong 	if (error != 0) {
392dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev,
393dc60165bSWeongyo Jeong 		    "could not get device capabilities\n");
394*7a79cebfSGleb Smirnoff 		goto fail2;
395dc60165bSWeongyo Jeong 	}
396dc60165bSWeongyo Jeong 	UATH_UNLOCK(sc);
397dc60165bSWeongyo Jeong 
398dc60165bSWeongyo Jeong 	/* Create device sysctl node. */
399dc60165bSWeongyo Jeong 	uath_sysctl_node(sc);
400dc60165bSWeongyo Jeong 
401dc60165bSWeongyo Jeong 	UATH_LOCK(sc);
402*7a79cebfSGleb Smirnoff 	error = uath_get_devstatus(sc, ic->ic_macaddr);
403dc60165bSWeongyo Jeong 	if (error != 0) {
404dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev, "could not get device status\n");
405*7a79cebfSGleb Smirnoff 		goto fail2;
406dc60165bSWeongyo Jeong 	}
407dc60165bSWeongyo Jeong 
408dc60165bSWeongyo Jeong 	/*
409dc60165bSWeongyo Jeong 	 * Allocate xfers for Rx/Tx data pipes.
410dc60165bSWeongyo Jeong 	 */
411dc60165bSWeongyo Jeong 	error = uath_alloc_rx_data_list(sc);
412dc60165bSWeongyo Jeong 	if (error != 0) {
413dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev, "could not allocate Rx data list\n");
414*7a79cebfSGleb Smirnoff 		goto fail2;
415dc60165bSWeongyo Jeong 	}
416dc60165bSWeongyo Jeong 	error = uath_alloc_tx_data_list(sc);
417dc60165bSWeongyo Jeong 	if (error != 0) {
418dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev, "could not allocate Tx data list\n");
419*7a79cebfSGleb Smirnoff 		goto fail2;
420dc60165bSWeongyo Jeong 	}
421dc60165bSWeongyo Jeong 	UATH_UNLOCK(sc);
422dc60165bSWeongyo Jeong 
42359686fe9SGleb Smirnoff 	ic->ic_softc = sc;
424c8550c02SGleb Smirnoff 	ic->ic_name = device_get_nameunit(dev);
425dc60165bSWeongyo Jeong 	ic->ic_phytype = IEEE80211_T_OFDM;	/* not only, but not used */
426dc60165bSWeongyo Jeong 	ic->ic_opmode = IEEE80211_M_STA;	/* default to BSS mode */
427dc60165bSWeongyo Jeong 
428dc60165bSWeongyo Jeong 	/* set device capabilities */
429dc60165bSWeongyo Jeong 	ic->ic_caps =
430dc60165bSWeongyo Jeong 	    IEEE80211_C_STA |		/* station mode */
431dc60165bSWeongyo Jeong 	    IEEE80211_C_MONITOR |	/* monitor mode supported */
432dc60165bSWeongyo Jeong 	    IEEE80211_C_TXPMGT |	/* tx power management */
433dc60165bSWeongyo Jeong 	    IEEE80211_C_SHPREAMBLE |	/* short preamble supported */
434dc60165bSWeongyo Jeong 	    IEEE80211_C_SHSLOT |	/* short slot time supported */
435dc60165bSWeongyo Jeong 	    IEEE80211_C_WPA |		/* 802.11i */
436dc60165bSWeongyo Jeong 	    IEEE80211_C_BGSCAN |	/* capable of bg scanning */
437dc60165bSWeongyo Jeong 	    IEEE80211_C_TXFRAG;		/* handle tx frags */
438dc60165bSWeongyo Jeong 
439dc60165bSWeongyo Jeong 	/* put a regulatory domain to reveal informations.  */
440dc60165bSWeongyo Jeong 	uath_regdomain = sc->sc_devcap.regDomain;
441dc60165bSWeongyo Jeong 
442dc60165bSWeongyo Jeong 	bands = 0;
443dc60165bSWeongyo Jeong 	setbit(&bands, IEEE80211_MODE_11B);
444dc60165bSWeongyo Jeong 	setbit(&bands, IEEE80211_MODE_11G);
445dc60165bSWeongyo Jeong 	if ((sc->sc_devcap.analog5GhzRevision & 0xf0) == 0x30)
446dc60165bSWeongyo Jeong 		setbit(&bands, IEEE80211_MODE_11A);
447dc60165bSWeongyo Jeong 	/* XXX turbo */
448dc60165bSWeongyo Jeong 	ieee80211_init_channels(ic, NULL, &bands);
449dc60165bSWeongyo Jeong 
450*7a79cebfSGleb Smirnoff 	ieee80211_ifattach(ic);
451dc60165bSWeongyo Jeong 	ic->ic_raw_xmit = uath_raw_xmit;
452dc60165bSWeongyo Jeong 	ic->ic_scan_start = uath_scan_start;
453dc60165bSWeongyo Jeong 	ic->ic_scan_end = uath_scan_end;
454dc60165bSWeongyo Jeong 	ic->ic_set_channel = uath_set_channel;
455dc60165bSWeongyo Jeong 	ic->ic_vap_create = uath_vap_create;
456dc60165bSWeongyo Jeong 	ic->ic_vap_delete = uath_vap_delete;
457dc60165bSWeongyo Jeong 	ic->ic_update_mcast = uath_update_mcast;
458dc60165bSWeongyo Jeong 	ic->ic_update_promisc = uath_update_promisc;
459*7a79cebfSGleb Smirnoff 	ic->ic_transmit = uath_transmit;
460*7a79cebfSGleb Smirnoff 	ic->ic_parent = uath_parent;
461dc60165bSWeongyo Jeong 
4625463c4a4SSam Leffler 	ieee80211_radiotap_attach(ic,
4635463c4a4SSam Leffler 	    &sc->sc_txtap.wt_ihdr, sizeof(sc->sc_txtap),
4645463c4a4SSam Leffler 		UATH_TX_RADIOTAP_PRESENT,
4655463c4a4SSam Leffler 	    &sc->sc_rxtap.wr_ihdr, sizeof(sc->sc_rxtap),
4665463c4a4SSam Leffler 		UATH_RX_RADIOTAP_PRESENT);
467dc60165bSWeongyo Jeong 
468dc60165bSWeongyo Jeong 	if (bootverbose)
469dc60165bSWeongyo Jeong 		ieee80211_announce(ic);
470dc60165bSWeongyo Jeong 
471dc60165bSWeongyo Jeong 	return (0);
472dc60165bSWeongyo Jeong 
473*7a79cebfSGleb Smirnoff fail2:	UATH_UNLOCK(sc);
474*7a79cebfSGleb Smirnoff 	uath_free_cmd_list(sc, sc->sc_cmd);
4752d8a425bSHans Petter Selasky fail1:	usbd_transfer_unsetup(sc->sc_xfer, UATH_N_XFERS);
476dc60165bSWeongyo Jeong fail:
477dc60165bSWeongyo Jeong 	return (error);
478dc60165bSWeongyo Jeong }
479dc60165bSWeongyo Jeong 
480dc60165bSWeongyo Jeong static int
481dc60165bSWeongyo Jeong uath_detach(device_t dev)
482dc60165bSWeongyo Jeong {
483dc60165bSWeongyo Jeong 	struct uath_softc *sc = device_get_softc(dev);
484*7a79cebfSGleb Smirnoff 	struct ieee80211com *ic = &sc->sc_ic;
485645e4d17SHans Petter Selasky 	unsigned int x;
486dc60165bSWeongyo Jeong 
487645e4d17SHans Petter Selasky 	/*
488645e4d17SHans Petter Selasky 	 * Prevent further allocations from RX/TX/CMD
489645e4d17SHans Petter Selasky 	 * data lists and ioctls
490645e4d17SHans Petter Selasky 	 */
491c39515adSWeongyo Jeong 	UATH_LOCK(sc);
492dc60165bSWeongyo Jeong 	sc->sc_flags |= UATH_FLAG_INVALID;
493645e4d17SHans Petter Selasky 
494645e4d17SHans Petter Selasky 	STAILQ_INIT(&sc->sc_rx_active);
495645e4d17SHans Petter Selasky 	STAILQ_INIT(&sc->sc_rx_inactive);
496645e4d17SHans Petter Selasky 
497645e4d17SHans Petter Selasky 	STAILQ_INIT(&sc->sc_tx_active);
498645e4d17SHans Petter Selasky 	STAILQ_INIT(&sc->sc_tx_inactive);
499645e4d17SHans Petter Selasky 	STAILQ_INIT(&sc->sc_tx_pending);
500645e4d17SHans Petter Selasky 
501645e4d17SHans Petter Selasky 	STAILQ_INIT(&sc->sc_cmd_active);
502645e4d17SHans Petter Selasky 	STAILQ_INIT(&sc->sc_cmd_pending);
503645e4d17SHans Petter Selasky 	STAILQ_INIT(&sc->sc_cmd_waiting);
504645e4d17SHans Petter Selasky 	STAILQ_INIT(&sc->sc_cmd_inactive);
505dc60165bSWeongyo Jeong 
506*7a79cebfSGleb Smirnoff 	uath_stop(sc);
507*7a79cebfSGleb Smirnoff 	UATH_UNLOCK(sc);
508ba2c1fbcSAdrian Chadd 
509dc60165bSWeongyo Jeong 	callout_drain(&sc->stat_ch);
510dc60165bSWeongyo Jeong 	callout_drain(&sc->watchdog_ch);
511dc60165bSWeongyo Jeong 
512645e4d17SHans Petter Selasky 	/* drain USB transfers */
513645e4d17SHans Petter Selasky 	for (x = 0; x != UATH_N_XFERS; x++)
514645e4d17SHans Petter Selasky 		usbd_transfer_drain(sc->sc_xfer[x]);
515dc60165bSWeongyo Jeong 
516645e4d17SHans Petter Selasky 	/* free data buffers */
517dc60165bSWeongyo Jeong 	UATH_LOCK(sc);
518dc60165bSWeongyo Jeong 	uath_free_rx_data_list(sc);
519dc60165bSWeongyo Jeong 	uath_free_tx_data_list(sc);
520c180b398SHans Petter Selasky 	uath_free_cmd_list(sc, sc->sc_cmd);
521dc60165bSWeongyo Jeong 	UATH_UNLOCK(sc);
522dc60165bSWeongyo Jeong 
523645e4d17SHans Petter Selasky 	/* free USB transfers and some data buffers */
524645e4d17SHans Petter Selasky 	usbd_transfer_unsetup(sc->sc_xfer, UATH_N_XFERS);
525645e4d17SHans Petter Selasky 
526645e4d17SHans Petter Selasky 	ieee80211_ifdetach(ic);
527*7a79cebfSGleb Smirnoff 	mbufq_drain(&sc->sc_snd);
528dc60165bSWeongyo Jeong 	mtx_destroy(&sc->sc_mtx);
529dc60165bSWeongyo Jeong 	return (0);
530dc60165bSWeongyo Jeong }
531dc60165bSWeongyo Jeong 
532dc60165bSWeongyo Jeong static void
533c180b398SHans Petter Selasky uath_free_cmd_list(struct uath_softc *sc, struct uath_cmd cmds[])
534dc60165bSWeongyo Jeong {
535dc60165bSWeongyo Jeong 	int i;
536dc60165bSWeongyo Jeong 
537c180b398SHans Petter Selasky 	for (i = 0; i != UATH_CMD_LIST_COUNT; i++)
538c180b398SHans Petter Selasky 		cmds[i].buf = NULL;
539dc60165bSWeongyo Jeong }
540dc60165bSWeongyo Jeong 
541dc60165bSWeongyo Jeong static int
542c180b398SHans Petter Selasky uath_alloc_cmd_list(struct uath_softc *sc, struct uath_cmd cmds[])
543dc60165bSWeongyo Jeong {
544c180b398SHans Petter Selasky 	int i;
545dc60165bSWeongyo Jeong 
546dc60165bSWeongyo Jeong 	STAILQ_INIT(&sc->sc_cmd_active);
547dc60165bSWeongyo Jeong 	STAILQ_INIT(&sc->sc_cmd_pending);
548dc60165bSWeongyo Jeong 	STAILQ_INIT(&sc->sc_cmd_waiting);
549dc60165bSWeongyo Jeong 	STAILQ_INIT(&sc->sc_cmd_inactive);
550dc60165bSWeongyo Jeong 
551c180b398SHans Petter Selasky 	for (i = 0; i != UATH_CMD_LIST_COUNT; i++) {
552dc60165bSWeongyo Jeong 		struct uath_cmd *cmd = &cmds[i];
553dc60165bSWeongyo Jeong 
554dc60165bSWeongyo Jeong 		cmd->sc = sc;	/* backpointer for callbacks */
555dc60165bSWeongyo Jeong 		cmd->msgid = i;
556c180b398SHans Petter Selasky 		cmd->buf = ((uint8_t *)sc->sc_cmd_dma_buf) +
557c180b398SHans Petter Selasky 		    (i * UATH_MAX_CMDSZ);
558dc60165bSWeongyo Jeong 		STAILQ_INSERT_TAIL(&sc->sc_cmd_inactive, cmd, next);
559dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_cmd_inactive);
560dc60165bSWeongyo Jeong 	}
561dc60165bSWeongyo Jeong 	return (0);
562dc60165bSWeongyo Jeong }
563dc60165bSWeongyo Jeong 
564dc60165bSWeongyo Jeong static int
565dc60165bSWeongyo Jeong uath_host_available(struct uath_softc *sc)
566dc60165bSWeongyo Jeong {
567dc60165bSWeongyo Jeong 	struct uath_cmd_host_available setup;
568dc60165bSWeongyo Jeong 
569dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
570dc60165bSWeongyo Jeong 
571dc60165bSWeongyo Jeong 	/* inform target the host is available */
572dc60165bSWeongyo Jeong 	setup.sw_ver_major = htobe32(ATH_SW_VER_MAJOR);
573dc60165bSWeongyo Jeong 	setup.sw_ver_minor = htobe32(ATH_SW_VER_MINOR);
574dc60165bSWeongyo Jeong 	setup.sw_ver_patch = htobe32(ATH_SW_VER_PATCH);
575dc60165bSWeongyo Jeong 	setup.sw_ver_build = htobe32(ATH_SW_VER_BUILD);
576dc60165bSWeongyo Jeong 	return uath_cmd_read(sc, WDCMSG_HOST_AVAILABLE,
577dc60165bSWeongyo Jeong 		&setup, sizeof setup, NULL, 0, 0);
578dc60165bSWeongyo Jeong }
579dc60165bSWeongyo Jeong 
580dc60165bSWeongyo Jeong #ifdef UATH_DEBUG
581dc60165bSWeongyo Jeong static void
582dc60165bSWeongyo Jeong uath_dump_cmd(const uint8_t *buf, int len, char prefix)
583dc60165bSWeongyo Jeong {
584dc60165bSWeongyo Jeong 	const char *sep = "";
585dc60165bSWeongyo Jeong 	int i;
586dc60165bSWeongyo Jeong 
587dc60165bSWeongyo Jeong 	for (i = 0; i < len; i++) {
588dc60165bSWeongyo Jeong 		if ((i % 16) == 0) {
589dc60165bSWeongyo Jeong 			printf("%s%c ", sep, prefix);
590dc60165bSWeongyo Jeong 			sep = "\n";
591dc60165bSWeongyo Jeong 		}
592dc60165bSWeongyo Jeong 		else if ((i % 4) == 0)
593dc60165bSWeongyo Jeong 			printf(" ");
594dc60165bSWeongyo Jeong 		printf("%02x", buf[i]);
595dc60165bSWeongyo Jeong 	}
596dc60165bSWeongyo Jeong 	printf("\n");
597dc60165bSWeongyo Jeong }
598dc60165bSWeongyo Jeong 
599dc60165bSWeongyo Jeong static const char *
600dc60165bSWeongyo Jeong uath_codename(int code)
601dc60165bSWeongyo Jeong {
602dc60165bSWeongyo Jeong #define	N(a)	(sizeof(a)/sizeof(a[0]))
603dc60165bSWeongyo Jeong 	static const char *names[] = {
604dc60165bSWeongyo Jeong 	    "0x00",
605dc60165bSWeongyo Jeong 	    "HOST_AVAILABLE",
606dc60165bSWeongyo Jeong 	    "BIND",
607dc60165bSWeongyo Jeong 	    "TARGET_RESET",
608dc60165bSWeongyo Jeong 	    "TARGET_GET_CAPABILITY",
609dc60165bSWeongyo Jeong 	    "TARGET_SET_CONFIG",
610dc60165bSWeongyo Jeong 	    "TARGET_GET_STATUS",
611dc60165bSWeongyo Jeong 	    "TARGET_GET_STATS",
612dc60165bSWeongyo Jeong 	    "TARGET_START",
613dc60165bSWeongyo Jeong 	    "TARGET_STOP",
614dc60165bSWeongyo Jeong 	    "TARGET_ENABLE",
615dc60165bSWeongyo Jeong 	    "TARGET_DISABLE",
616dc60165bSWeongyo Jeong 	    "CREATE_CONNECTION",
617dc60165bSWeongyo Jeong 	    "UPDATE_CONNECT_ATTR",
618dc60165bSWeongyo Jeong 	    "DELETE_CONNECT",
619dc60165bSWeongyo Jeong 	    "SEND",
620dc60165bSWeongyo Jeong 	    "FLUSH",
621dc60165bSWeongyo Jeong 	    "STATS_UPDATE",
622dc60165bSWeongyo Jeong 	    "BMISS",
623dc60165bSWeongyo Jeong 	    "DEVICE_AVAIL",
624dc60165bSWeongyo Jeong 	    "SEND_COMPLETE",
625dc60165bSWeongyo Jeong 	    "DATA_AVAIL",
626dc60165bSWeongyo Jeong 	    "SET_PWR_MODE",
627dc60165bSWeongyo Jeong 	    "BMISS_ACK",
628dc60165bSWeongyo Jeong 	    "SET_LED_STEADY",
629dc60165bSWeongyo Jeong 	    "SET_LED_BLINK",
630dc60165bSWeongyo Jeong 	    "SETUP_BEACON_DESC",
631dc60165bSWeongyo Jeong 	    "BEACON_INIT",
632dc60165bSWeongyo Jeong 	    "RESET_KEY_CACHE",
633dc60165bSWeongyo Jeong 	    "RESET_KEY_CACHE_ENTRY",
634dc60165bSWeongyo Jeong 	    "SET_KEY_CACHE_ENTRY",
635dc60165bSWeongyo Jeong 	    "SET_DECOMP_MASK",
636dc60165bSWeongyo Jeong 	    "SET_REGULATORY_DOMAIN",
637dc60165bSWeongyo Jeong 	    "SET_LED_STATE",
638dc60165bSWeongyo Jeong 	    "WRITE_ASSOCID",
639dc60165bSWeongyo Jeong 	    "SET_STA_BEACON_TIMERS",
640dc60165bSWeongyo Jeong 	    "GET_TSF",
641dc60165bSWeongyo Jeong 	    "RESET_TSF",
642dc60165bSWeongyo Jeong 	    "SET_ADHOC_MODE",
643dc60165bSWeongyo Jeong 	    "SET_BASIC_RATE",
644dc60165bSWeongyo Jeong 	    "MIB_CONTROL",
645dc60165bSWeongyo Jeong 	    "GET_CHANNEL_DATA",
646dc60165bSWeongyo Jeong 	    "GET_CUR_RSSI",
647dc60165bSWeongyo Jeong 	    "SET_ANTENNA_SWITCH",
648dc60165bSWeongyo Jeong 	    "0x2c", "0x2d", "0x2e",
649dc60165bSWeongyo Jeong 	    "USE_SHORT_SLOT_TIME",
650dc60165bSWeongyo Jeong 	    "SET_POWER_MODE",
651dc60165bSWeongyo Jeong 	    "SETUP_PSPOLL_DESC",
652dc60165bSWeongyo Jeong 	    "SET_RX_MULTICAST_FILTER",
653dc60165bSWeongyo Jeong 	    "RX_FILTER",
654dc60165bSWeongyo Jeong 	    "PER_CALIBRATION",
655dc60165bSWeongyo Jeong 	    "RESET",
656dc60165bSWeongyo Jeong 	    "DISABLE",
657dc60165bSWeongyo Jeong 	    "PHY_DISABLE",
658dc60165bSWeongyo Jeong 	    "SET_TX_POWER_LIMIT",
659dc60165bSWeongyo Jeong 	    "SET_TX_QUEUE_PARAMS",
660dc60165bSWeongyo Jeong 	    "SETUP_TX_QUEUE",
661dc60165bSWeongyo Jeong 	    "RELEASE_TX_QUEUE",
662dc60165bSWeongyo Jeong 	};
663dc60165bSWeongyo Jeong 	static char buf[8];
664dc60165bSWeongyo Jeong 
665dc60165bSWeongyo Jeong 	if (code < N(names))
666dc60165bSWeongyo Jeong 		return names[code];
667dc60165bSWeongyo Jeong 	if (code == WDCMSG_SET_DEFAULT_KEY)
668dc60165bSWeongyo Jeong 		return "SET_DEFAULT_KEY";
669dc60165bSWeongyo Jeong 	snprintf(buf, sizeof(buf), "0x%02x", code);
670dc60165bSWeongyo Jeong 	return buf;
671dc60165bSWeongyo Jeong #undef N
672dc60165bSWeongyo Jeong }
673dc60165bSWeongyo Jeong #endif
674dc60165bSWeongyo Jeong 
675dc60165bSWeongyo Jeong /*
676dc60165bSWeongyo Jeong  * Low-level function to send read or write commands to the firmware.
677dc60165bSWeongyo Jeong  */
678dc60165bSWeongyo Jeong static int
679dc60165bSWeongyo Jeong uath_cmdsend(struct uath_softc *sc, uint32_t code, const void *idata, int ilen,
680dc60165bSWeongyo Jeong     void *odata, int olen, int flags)
681dc60165bSWeongyo Jeong {
682dc60165bSWeongyo Jeong 	struct uath_cmd_hdr *hdr;
683dc60165bSWeongyo Jeong 	struct uath_cmd *cmd;
684dc60165bSWeongyo Jeong 	int error;
685dc60165bSWeongyo Jeong 
686dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
687dc60165bSWeongyo Jeong 
688dc60165bSWeongyo Jeong 	/* grab a xfer */
689dc60165bSWeongyo Jeong 	cmd = uath_get_cmdbuf(sc);
690dc60165bSWeongyo Jeong 	if (cmd == NULL) {
691dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev, "%s: empty inactive queue\n",
692dc60165bSWeongyo Jeong 		    __func__);
693dc60165bSWeongyo Jeong 		return (ENOBUFS);
694dc60165bSWeongyo Jeong 	}
695dc60165bSWeongyo Jeong 	cmd->flags = flags;
696dc60165bSWeongyo Jeong 	/* always bulk-out a multiple of 4 bytes */
697dc60165bSWeongyo Jeong 	cmd->buflen = roundup2(sizeof(struct uath_cmd_hdr) + ilen, 4);
698dc60165bSWeongyo Jeong 
699dc60165bSWeongyo Jeong 	hdr = (struct uath_cmd_hdr *)cmd->buf;
700271ae033SHans Petter Selasky 	memset(hdr, 0, sizeof(struct uath_cmd_hdr));
701dc60165bSWeongyo Jeong 	hdr->len   = htobe32(cmd->buflen);
702dc60165bSWeongyo Jeong 	hdr->code  = htobe32(code);
703dc60165bSWeongyo Jeong 	hdr->msgid = cmd->msgid;	/* don't care about endianness */
704dc60165bSWeongyo Jeong 	hdr->magic = htobe32((cmd->flags & UATH_CMD_FLAG_MAGIC) ? 1 << 24 : 0);
705271ae033SHans Petter Selasky 	memcpy((uint8_t *)(hdr + 1), idata, ilen);
706dc60165bSWeongyo Jeong 
707dc60165bSWeongyo Jeong #ifdef UATH_DEBUG
708dc60165bSWeongyo Jeong 	if (sc->sc_debug & UATH_DEBUG_CMDS) {
709dc60165bSWeongyo Jeong 		printf("%s: send  %s [flags 0x%x] olen %d\n",
710dc60165bSWeongyo Jeong 		    __func__, uath_codename(code), cmd->flags, olen);
711dc60165bSWeongyo Jeong 		if (sc->sc_debug & UATH_DEBUG_CMDS_DUMP)
712dc60165bSWeongyo Jeong 			uath_dump_cmd(cmd->buf, cmd->buflen, '+');
713dc60165bSWeongyo Jeong 	}
714dc60165bSWeongyo Jeong #endif
715dc60165bSWeongyo Jeong 	cmd->odata = odata;
716dc60165bSWeongyo Jeong 	KASSERT(odata == NULL ||
717dc60165bSWeongyo Jeong 	    olen < UATH_MAX_CMDSZ - sizeof(*hdr) + sizeof(uint32_t),
718dc60165bSWeongyo Jeong 	    ("odata %p olen %u", odata, olen));
719dc60165bSWeongyo Jeong 	cmd->olen = olen;
720dc60165bSWeongyo Jeong 
721dc60165bSWeongyo Jeong 	STAILQ_INSERT_TAIL(&sc->sc_cmd_pending, cmd, next);
722dc60165bSWeongyo Jeong 	UATH_STAT_INC(sc, st_cmd_pending);
723a593f6b8SAndrew Thompson 	usbd_transfer_start(sc->sc_xfer[UATH_INTR_TX]);
724dc60165bSWeongyo Jeong 
725dc60165bSWeongyo Jeong 	if (cmd->flags & UATH_CMD_FLAG_READ) {
726a593f6b8SAndrew Thompson 		usbd_transfer_start(sc->sc_xfer[UATH_INTR_RX]);
727dc60165bSWeongyo Jeong 
728dc60165bSWeongyo Jeong 		/* wait at most two seconds for command reply */
729dc60165bSWeongyo Jeong 		error = mtx_sleep(cmd, &sc->sc_mtx, 0, "uathcmd", 2 * hz);
730dc60165bSWeongyo Jeong 		cmd->odata = NULL;	/* in case reply comes too late */
731dc60165bSWeongyo Jeong 		if (error != 0) {
732dc60165bSWeongyo Jeong 			device_printf(sc->sc_dev, "timeout waiting for reply "
733dc60165bSWeongyo Jeong 			    "to cmd 0x%x (%u)\n", code, code);
734dc60165bSWeongyo Jeong 		} else if (cmd->olen != olen) {
735dc60165bSWeongyo Jeong 			device_printf(sc->sc_dev, "unexpected reply data count "
736dc60165bSWeongyo Jeong 			    "to cmd 0x%x (%u), got %u, expected %u\n",
737dc60165bSWeongyo Jeong 			    code, code, cmd->olen, olen);
738dc60165bSWeongyo Jeong 			error = EINVAL;
739dc60165bSWeongyo Jeong 		}
740dc60165bSWeongyo Jeong 		return (error);
741dc60165bSWeongyo Jeong 	}
742dc60165bSWeongyo Jeong 	return (0);
743dc60165bSWeongyo Jeong }
744dc60165bSWeongyo Jeong 
745dc60165bSWeongyo Jeong static int
746dc60165bSWeongyo Jeong uath_cmd_read(struct uath_softc *sc, uint32_t code, const void *idata,
747dc60165bSWeongyo Jeong     int ilen, void *odata, int olen, int flags)
748dc60165bSWeongyo Jeong {
749dc60165bSWeongyo Jeong 
750dc60165bSWeongyo Jeong 	flags |= UATH_CMD_FLAG_READ;
751dc60165bSWeongyo Jeong 	return uath_cmdsend(sc, code, idata, ilen, odata, olen, flags);
752dc60165bSWeongyo Jeong }
753dc60165bSWeongyo Jeong 
754dc60165bSWeongyo Jeong static int
755dc60165bSWeongyo Jeong uath_cmd_write(struct uath_softc *sc, uint32_t code, const void *data, int len,
756dc60165bSWeongyo Jeong     int flags)
757dc60165bSWeongyo Jeong {
758dc60165bSWeongyo Jeong 
759dc60165bSWeongyo Jeong 	flags &= ~UATH_CMD_FLAG_READ;
760dc60165bSWeongyo Jeong 	return uath_cmdsend(sc, code, data, len, NULL, 0, flags);
761dc60165bSWeongyo Jeong }
762dc60165bSWeongyo Jeong 
763dc60165bSWeongyo Jeong static struct uath_cmd *
764dc60165bSWeongyo Jeong uath_get_cmdbuf(struct uath_softc *sc)
765dc60165bSWeongyo Jeong {
766dc60165bSWeongyo Jeong 	struct uath_cmd *uc;
767dc60165bSWeongyo Jeong 
768dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
769dc60165bSWeongyo Jeong 
770dc60165bSWeongyo Jeong 	uc = STAILQ_FIRST(&sc->sc_cmd_inactive);
771dc60165bSWeongyo Jeong 	if (uc != NULL) {
772dc60165bSWeongyo Jeong 		STAILQ_REMOVE_HEAD(&sc->sc_cmd_inactive, next);
773dc60165bSWeongyo Jeong 		UATH_STAT_DEC(sc, st_cmd_inactive);
774dc60165bSWeongyo Jeong 	} else
775dc60165bSWeongyo Jeong 		uc = NULL;
776dc60165bSWeongyo Jeong 	if (uc == NULL)
777dc60165bSWeongyo Jeong 		DPRINTF(sc, UATH_DEBUG_XMIT, "%s: %s\n", __func__,
778dc60165bSWeongyo Jeong 		    "out of command xmit buffers");
779dc60165bSWeongyo Jeong 	return (uc);
780dc60165bSWeongyo Jeong }
781dc60165bSWeongyo Jeong 
782dc60165bSWeongyo Jeong /*
783dc60165bSWeongyo Jeong  * This function is called periodically (every second) when associated to
784dc60165bSWeongyo Jeong  * query device statistics.
785dc60165bSWeongyo Jeong  */
786dc60165bSWeongyo Jeong static void
787dc60165bSWeongyo Jeong uath_stat(void *arg)
788dc60165bSWeongyo Jeong {
789dc60165bSWeongyo Jeong 	struct uath_softc *sc = arg;
790dc60165bSWeongyo Jeong 	int error;
791dc60165bSWeongyo Jeong 
792dc60165bSWeongyo Jeong 	UATH_LOCK(sc);
793dc60165bSWeongyo Jeong 	/*
794dc60165bSWeongyo Jeong 	 * Send request for statistics asynchronously. The timer will be
795dc60165bSWeongyo Jeong 	 * restarted when we'll get the stats notification.
796dc60165bSWeongyo Jeong 	 */
797dc60165bSWeongyo Jeong 	error = uath_cmd_write(sc, WDCMSG_TARGET_GET_STATS, NULL, 0,
798dc60165bSWeongyo Jeong 	    UATH_CMD_FLAG_ASYNC);
799dc60165bSWeongyo Jeong 	if (error != 0) {
800dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev,
801dc60165bSWeongyo Jeong 		    "could not query stats, error %d\n", error);
802dc60165bSWeongyo Jeong 	}
803dc60165bSWeongyo Jeong 	UATH_UNLOCK(sc);
804dc60165bSWeongyo Jeong }
805dc60165bSWeongyo Jeong 
806dc60165bSWeongyo Jeong static int
807dc60165bSWeongyo Jeong uath_get_capability(struct uath_softc *sc, uint32_t cap, uint32_t *val)
808dc60165bSWeongyo Jeong {
809dc60165bSWeongyo Jeong 	int error;
810dc60165bSWeongyo Jeong 
811dc60165bSWeongyo Jeong 	cap = htobe32(cap);
812dc60165bSWeongyo Jeong 	error = uath_cmd_read(sc, WDCMSG_TARGET_GET_CAPABILITY,
813dc60165bSWeongyo Jeong 	    &cap, sizeof cap, val, sizeof(uint32_t), UATH_CMD_FLAG_MAGIC);
814dc60165bSWeongyo Jeong 	if (error != 0) {
815dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev, "could not read capability %u\n",
816dc60165bSWeongyo Jeong 		    be32toh(cap));
817dc60165bSWeongyo Jeong 		return (error);
818dc60165bSWeongyo Jeong 	}
819dc60165bSWeongyo Jeong 	*val = be32toh(*val);
820dc60165bSWeongyo Jeong 	return (error);
821dc60165bSWeongyo Jeong }
822dc60165bSWeongyo Jeong 
823dc60165bSWeongyo Jeong static int
824dc60165bSWeongyo Jeong uath_get_devcap(struct uath_softc *sc)
825dc60165bSWeongyo Jeong {
826dc60165bSWeongyo Jeong #define	GETCAP(x, v) do {				\
827dc60165bSWeongyo Jeong 	error = uath_get_capability(sc, x, &v);		\
828dc60165bSWeongyo Jeong 	if (error != 0)					\
829dc60165bSWeongyo Jeong 		return (error);				\
830dc60165bSWeongyo Jeong 	DPRINTF(sc, UATH_DEBUG_DEVCAP,			\
831dc60165bSWeongyo Jeong 	    "%s: %s=0x%08x\n", __func__, #x, v);	\
832dc60165bSWeongyo Jeong } while (0)
833dc60165bSWeongyo Jeong 	struct uath_devcap *cap = &sc->sc_devcap;
834dc60165bSWeongyo Jeong 	int error;
835dc60165bSWeongyo Jeong 
836dc60165bSWeongyo Jeong 	/* collect device capabilities */
837dc60165bSWeongyo Jeong 	GETCAP(CAP_TARGET_VERSION, cap->targetVersion);
838dc60165bSWeongyo Jeong 	GETCAP(CAP_TARGET_REVISION, cap->targetRevision);
839dc60165bSWeongyo Jeong 	GETCAP(CAP_MAC_VERSION, cap->macVersion);
840dc60165bSWeongyo Jeong 	GETCAP(CAP_MAC_REVISION, cap->macRevision);
841dc60165bSWeongyo Jeong 	GETCAP(CAP_PHY_REVISION, cap->phyRevision);
842dc60165bSWeongyo Jeong 	GETCAP(CAP_ANALOG_5GHz_REVISION, cap->analog5GhzRevision);
843dc60165bSWeongyo Jeong 	GETCAP(CAP_ANALOG_2GHz_REVISION, cap->analog2GhzRevision);
844dc60165bSWeongyo Jeong 
845dc60165bSWeongyo Jeong 	GETCAP(CAP_REG_DOMAIN, cap->regDomain);
846dc60165bSWeongyo Jeong 	GETCAP(CAP_REG_CAP_BITS, cap->regCapBits);
847dc60165bSWeongyo Jeong #if 0
848dc60165bSWeongyo Jeong 	/* NB: not supported in rev 1.5 */
849dc60165bSWeongyo Jeong 	GETCAP(CAP_COUNTRY_CODE, cap->countryCode);
850dc60165bSWeongyo Jeong #endif
851dc60165bSWeongyo Jeong 	GETCAP(CAP_WIRELESS_MODES, cap->wirelessModes);
852dc60165bSWeongyo Jeong 	GETCAP(CAP_CHAN_SPREAD_SUPPORT, cap->chanSpreadSupport);
853dc60165bSWeongyo Jeong 	GETCAP(CAP_COMPRESS_SUPPORT, cap->compressSupport);
854dc60165bSWeongyo Jeong 	GETCAP(CAP_BURST_SUPPORT, cap->burstSupport);
855dc60165bSWeongyo Jeong 	GETCAP(CAP_FAST_FRAMES_SUPPORT, cap->fastFramesSupport);
856dc60165bSWeongyo Jeong 	GETCAP(CAP_CHAP_TUNING_SUPPORT, cap->chapTuningSupport);
857dc60165bSWeongyo Jeong 	GETCAP(CAP_TURBOG_SUPPORT, cap->turboGSupport);
858dc60165bSWeongyo Jeong 	GETCAP(CAP_TURBO_PRIME_SUPPORT, cap->turboPrimeSupport);
859dc60165bSWeongyo Jeong 	GETCAP(CAP_DEVICE_TYPE, cap->deviceType);
860dc60165bSWeongyo Jeong 	GETCAP(CAP_WME_SUPPORT, cap->wmeSupport);
861dc60165bSWeongyo Jeong 	GETCAP(CAP_TOTAL_QUEUES, cap->numTxQueues);
862dc60165bSWeongyo Jeong 	GETCAP(CAP_CONNECTION_ID_MAX, cap->connectionIdMax);
863dc60165bSWeongyo Jeong 
864dc60165bSWeongyo Jeong 	GETCAP(CAP_LOW_5GHZ_CHAN, cap->low5GhzChan);
865dc60165bSWeongyo Jeong 	GETCAP(CAP_HIGH_5GHZ_CHAN, cap->high5GhzChan);
866dc60165bSWeongyo Jeong 	GETCAP(CAP_LOW_2GHZ_CHAN, cap->low2GhzChan);
867dc60165bSWeongyo Jeong 	GETCAP(CAP_HIGH_2GHZ_CHAN, cap->high2GhzChan);
868dc60165bSWeongyo Jeong 	GETCAP(CAP_TWICE_ANTENNAGAIN_5G, cap->twiceAntennaGain5G);
869dc60165bSWeongyo Jeong 	GETCAP(CAP_TWICE_ANTENNAGAIN_2G, cap->twiceAntennaGain2G);
870dc60165bSWeongyo Jeong 
871dc60165bSWeongyo Jeong 	GETCAP(CAP_CIPHER_AES_CCM, cap->supportCipherAES_CCM);
872dc60165bSWeongyo Jeong 	GETCAP(CAP_CIPHER_TKIP, cap->supportCipherTKIP);
873dc60165bSWeongyo Jeong 	GETCAP(CAP_MIC_TKIP, cap->supportMicTKIP);
874dc60165bSWeongyo Jeong 
875dc60165bSWeongyo Jeong 	cap->supportCipherWEP = 1;	/* NB: always available */
876dc60165bSWeongyo Jeong 
877dc60165bSWeongyo Jeong 	return (0);
878dc60165bSWeongyo Jeong }
879dc60165bSWeongyo Jeong 
880dc60165bSWeongyo Jeong static int
881dc60165bSWeongyo Jeong uath_get_devstatus(struct uath_softc *sc, uint8_t macaddr[IEEE80211_ADDR_LEN])
882dc60165bSWeongyo Jeong {
883dc60165bSWeongyo Jeong 	int error;
884dc60165bSWeongyo Jeong 
885dc60165bSWeongyo Jeong 	/* retrieve MAC address */
886dc60165bSWeongyo Jeong 	error = uath_get_status(sc, ST_MAC_ADDR, macaddr, IEEE80211_ADDR_LEN);
887dc60165bSWeongyo Jeong 	if (error != 0) {
888dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev, "could not read MAC address\n");
889dc60165bSWeongyo Jeong 		return (error);
890dc60165bSWeongyo Jeong 	}
891dc60165bSWeongyo Jeong 
892dc60165bSWeongyo Jeong 	error = uath_get_status(sc, ST_SERIAL_NUMBER,
893dc60165bSWeongyo Jeong 	    &sc->sc_serial[0], sizeof(sc->sc_serial));
894dc60165bSWeongyo Jeong 	if (error != 0) {
895dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev,
896dc60165bSWeongyo Jeong 		    "could not read device serial number\n");
897dc60165bSWeongyo Jeong 		return (error);
898dc60165bSWeongyo Jeong 	}
899dc60165bSWeongyo Jeong 	return (0);
900dc60165bSWeongyo Jeong }
901dc60165bSWeongyo Jeong 
902dc60165bSWeongyo Jeong static int
903dc60165bSWeongyo Jeong uath_get_status(struct uath_softc *sc, uint32_t which, void *odata, int olen)
904dc60165bSWeongyo Jeong {
905dc60165bSWeongyo Jeong 	int error;
906dc60165bSWeongyo Jeong 
907dc60165bSWeongyo Jeong 	which = htobe32(which);
908dc60165bSWeongyo Jeong 	error = uath_cmd_read(sc, WDCMSG_TARGET_GET_STATUS,
909dc60165bSWeongyo Jeong 	    &which, sizeof(which), odata, olen, UATH_CMD_FLAG_MAGIC);
910dc60165bSWeongyo Jeong 	if (error != 0)
911dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev,
912dc60165bSWeongyo Jeong 		    "could not read EEPROM offset 0x%02x\n", be32toh(which));
913dc60165bSWeongyo Jeong 	return (error);
914dc60165bSWeongyo Jeong }
915dc60165bSWeongyo Jeong 
916dc60165bSWeongyo Jeong static void
917dc60165bSWeongyo Jeong uath_free_data_list(struct uath_softc *sc, struct uath_data data[], int ndata,
918dc60165bSWeongyo Jeong     int fillmbuf)
919dc60165bSWeongyo Jeong {
920dc60165bSWeongyo Jeong 	int i;
921dc60165bSWeongyo Jeong 
922dc60165bSWeongyo Jeong 	for (i = 0; i < ndata; i++) {
923dc60165bSWeongyo Jeong 		struct uath_data *dp = &data[i];
924dc60165bSWeongyo Jeong 
925dc60165bSWeongyo Jeong 		if (fillmbuf == 1) {
926dc60165bSWeongyo Jeong 			if (dp->m != NULL) {
927dc60165bSWeongyo Jeong 				m_freem(dp->m);
928dc60165bSWeongyo Jeong 				dp->m = NULL;
929dc60165bSWeongyo Jeong 				dp->buf = NULL;
930dc60165bSWeongyo Jeong 			}
931dc60165bSWeongyo Jeong 		} else {
932dc60165bSWeongyo Jeong 			dp->buf = NULL;
933dc60165bSWeongyo Jeong 		}
934645e4d17SHans Petter Selasky 		if (dp->ni != NULL) {
935645e4d17SHans Petter Selasky 			ieee80211_free_node(dp->ni);
936645e4d17SHans Petter Selasky 			dp->ni = NULL;
937645e4d17SHans Petter Selasky 		}
938dc60165bSWeongyo Jeong 	}
939dc60165bSWeongyo Jeong }
940dc60165bSWeongyo Jeong 
941dc60165bSWeongyo Jeong static int
942dc60165bSWeongyo Jeong uath_alloc_data_list(struct uath_softc *sc, struct uath_data data[],
943c180b398SHans Petter Selasky     int ndata, int maxsz, void *dma_buf)
944dc60165bSWeongyo Jeong {
945dc60165bSWeongyo Jeong 	int i, error;
946dc60165bSWeongyo Jeong 
947dc60165bSWeongyo Jeong 	for (i = 0; i < ndata; i++) {
948dc60165bSWeongyo Jeong 		struct uath_data *dp = &data[i];
949dc60165bSWeongyo Jeong 
950dc60165bSWeongyo Jeong 		dp->sc = sc;
951c180b398SHans Petter Selasky 		if (dma_buf == NULL) {
952dc60165bSWeongyo Jeong 			/* XXX check maxsz */
953c6499eccSGleb Smirnoff 			dp->m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR);
954dc60165bSWeongyo Jeong 			if (dp->m == NULL) {
955dc60165bSWeongyo Jeong 				device_printf(sc->sc_dev,
956dc60165bSWeongyo Jeong 				    "could not allocate rx mbuf\n");
957dc60165bSWeongyo Jeong 				error = ENOMEM;
958dc60165bSWeongyo Jeong 				goto fail;
959dc60165bSWeongyo Jeong 			}
960dc60165bSWeongyo Jeong 			dp->buf = mtod(dp->m, uint8_t *);
961dc60165bSWeongyo Jeong 		} else {
962dc60165bSWeongyo Jeong 			dp->m = NULL;
963c180b398SHans Petter Selasky 			dp->buf = ((uint8_t *)dma_buf) + (i * maxsz);
964dc60165bSWeongyo Jeong 		}
965dc60165bSWeongyo Jeong 		dp->ni = NULL;
966dc60165bSWeongyo Jeong 	}
967dc60165bSWeongyo Jeong 
968dc60165bSWeongyo Jeong 	return (0);
969dc60165bSWeongyo Jeong 
970c180b398SHans Petter Selasky fail:	uath_free_data_list(sc, data, ndata, 1 /* free mbufs */);
971dc60165bSWeongyo Jeong 	return (error);
972dc60165bSWeongyo Jeong }
973dc60165bSWeongyo Jeong 
974dc60165bSWeongyo Jeong static int
975dc60165bSWeongyo Jeong uath_alloc_rx_data_list(struct uath_softc *sc)
976dc60165bSWeongyo Jeong {
977dc60165bSWeongyo Jeong 	int error, i;
978dc60165bSWeongyo Jeong 
979dc60165bSWeongyo Jeong 	/* XXX is it enough to store the RX packet with MCLBYTES bytes?  */
980dc60165bSWeongyo Jeong 	error = uath_alloc_data_list(sc,
981dc60165bSWeongyo Jeong 	    sc->sc_rx, UATH_RX_DATA_LIST_COUNT, MCLBYTES,
982c180b398SHans Petter Selasky 	    NULL /* setup mbufs */);
983dc60165bSWeongyo Jeong 	if (error != 0)
984dc60165bSWeongyo Jeong 		return (error);
985dc60165bSWeongyo Jeong 
986dc60165bSWeongyo Jeong 	STAILQ_INIT(&sc->sc_rx_active);
987dc60165bSWeongyo Jeong 	STAILQ_INIT(&sc->sc_rx_inactive);
988dc60165bSWeongyo Jeong 
989dc60165bSWeongyo Jeong 	for (i = 0; i < UATH_RX_DATA_LIST_COUNT; i++) {
990dc60165bSWeongyo Jeong 		STAILQ_INSERT_HEAD(&sc->sc_rx_inactive, &sc->sc_rx[i],
991dc60165bSWeongyo Jeong 		    next);
992dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_rx_inactive);
993dc60165bSWeongyo Jeong 	}
994dc60165bSWeongyo Jeong 
995dc60165bSWeongyo Jeong 	return (0);
996dc60165bSWeongyo Jeong }
997dc60165bSWeongyo Jeong 
998dc60165bSWeongyo Jeong static int
999dc60165bSWeongyo Jeong uath_alloc_tx_data_list(struct uath_softc *sc)
1000dc60165bSWeongyo Jeong {
1001dc60165bSWeongyo Jeong 	int error, i;
1002dc60165bSWeongyo Jeong 
1003dc60165bSWeongyo Jeong 	error = uath_alloc_data_list(sc,
1004dc60165bSWeongyo Jeong 	    sc->sc_tx, UATH_TX_DATA_LIST_COUNT, UATH_MAX_TXBUFSZ,
1005c180b398SHans Petter Selasky 	    sc->sc_tx_dma_buf);
1006dc60165bSWeongyo Jeong 	if (error != 0)
1007dc60165bSWeongyo Jeong 		return (error);
1008dc60165bSWeongyo Jeong 
1009dc60165bSWeongyo Jeong 	STAILQ_INIT(&sc->sc_tx_active);
1010dc60165bSWeongyo Jeong 	STAILQ_INIT(&sc->sc_tx_inactive);
1011dc60165bSWeongyo Jeong 	STAILQ_INIT(&sc->sc_tx_pending);
1012dc60165bSWeongyo Jeong 
1013dc60165bSWeongyo Jeong 	for (i = 0; i < UATH_TX_DATA_LIST_COUNT; i++) {
1014dc60165bSWeongyo Jeong 		STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, &sc->sc_tx[i],
1015dc60165bSWeongyo Jeong 		    next);
1016dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_tx_inactive);
1017dc60165bSWeongyo Jeong 	}
1018dc60165bSWeongyo Jeong 
1019dc60165bSWeongyo Jeong 	return (0);
1020dc60165bSWeongyo Jeong }
1021dc60165bSWeongyo Jeong 
1022dc60165bSWeongyo Jeong static void
1023dc60165bSWeongyo Jeong uath_free_rx_data_list(struct uath_softc *sc)
1024dc60165bSWeongyo Jeong {
1025dc60165bSWeongyo Jeong 	uath_free_data_list(sc, sc->sc_rx, UATH_RX_DATA_LIST_COUNT,
1026dc60165bSWeongyo Jeong 	    1 /* free mbufs */);
1027dc60165bSWeongyo Jeong }
1028dc60165bSWeongyo Jeong 
1029dc60165bSWeongyo Jeong static void
1030dc60165bSWeongyo Jeong uath_free_tx_data_list(struct uath_softc *sc)
1031dc60165bSWeongyo Jeong {
1032dc60165bSWeongyo Jeong 	uath_free_data_list(sc, sc->sc_tx, UATH_TX_DATA_LIST_COUNT,
1033dc60165bSWeongyo Jeong 	    0 /* no mbufs */);
1034dc60165bSWeongyo Jeong }
1035dc60165bSWeongyo Jeong 
1036dc60165bSWeongyo Jeong static struct ieee80211vap *
1037fcd9500fSBernhard Schmidt uath_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], int unit,
1038fcd9500fSBernhard Schmidt     enum ieee80211_opmode opmode, int flags,
1039dc60165bSWeongyo Jeong     const uint8_t bssid[IEEE80211_ADDR_LEN],
1040dc60165bSWeongyo Jeong     const uint8_t mac[IEEE80211_ADDR_LEN])
1041dc60165bSWeongyo Jeong {
1042dc60165bSWeongyo Jeong 	struct uath_vap *uvp;
1043dc60165bSWeongyo Jeong 	struct ieee80211vap *vap;
1044dc60165bSWeongyo Jeong 
1045dc60165bSWeongyo Jeong 	if (!TAILQ_EMPTY(&ic->ic_vaps))		/* only one at a time */
1046dc60165bSWeongyo Jeong 		return (NULL);
1047*7a79cebfSGleb Smirnoff 	uvp =  malloc(sizeof(struct uath_vap), M_80211_VAP, M_WAITOK | M_ZERO);
1048dc60165bSWeongyo Jeong 	vap = &uvp->vap;
1049dc60165bSWeongyo Jeong 	/* enable s/w bmiss handling for sta mode */
1050bb2f69e8SHans Petter Selasky 
1051bb2f69e8SHans Petter Selasky 	if (ieee80211_vap_setup(ic, vap, name, unit, opmode,
1052*7a79cebfSGleb Smirnoff 	    flags | IEEE80211_CLONE_NOBEACONS, bssid) != 0) {
1053bb2f69e8SHans Petter Selasky 		/* out of memory */
1054bb2f69e8SHans Petter Selasky 		free(uvp, M_80211_VAP);
1055bb2f69e8SHans Petter Selasky 		return (NULL);
1056bb2f69e8SHans Petter Selasky 	}
1057dc60165bSWeongyo Jeong 
1058dc60165bSWeongyo Jeong 	/* override state transition machine */
1059dc60165bSWeongyo Jeong 	uvp->newstate = vap->iv_newstate;
1060dc60165bSWeongyo Jeong 	vap->iv_newstate = uath_newstate;
1061dc60165bSWeongyo Jeong 
1062dc60165bSWeongyo Jeong 	/* complete setup */
1063dc60165bSWeongyo Jeong 	ieee80211_vap_attach(vap, ieee80211_media_change,
1064*7a79cebfSGleb Smirnoff 	    ieee80211_media_status, mac);
1065dc60165bSWeongyo Jeong 	ic->ic_opmode = opmode;
1066dc60165bSWeongyo Jeong 	return (vap);
1067dc60165bSWeongyo Jeong }
1068dc60165bSWeongyo Jeong 
1069dc60165bSWeongyo Jeong static void
1070dc60165bSWeongyo Jeong uath_vap_delete(struct ieee80211vap *vap)
1071dc60165bSWeongyo Jeong {
1072dc60165bSWeongyo Jeong 	struct uath_vap *uvp = UATH_VAP(vap);
1073dc60165bSWeongyo Jeong 
1074dc60165bSWeongyo Jeong 	ieee80211_vap_detach(vap);
1075dc60165bSWeongyo Jeong 	free(uvp, M_80211_VAP);
1076dc60165bSWeongyo Jeong }
1077dc60165bSWeongyo Jeong 
1078dc60165bSWeongyo Jeong static int
1079*7a79cebfSGleb Smirnoff uath_init(struct uath_softc *sc)
1080dc60165bSWeongyo Jeong {
1081*7a79cebfSGleb Smirnoff 	struct ieee80211com *ic = &sc->sc_ic;
1082*7a79cebfSGleb Smirnoff 	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
1083dc60165bSWeongyo Jeong 	uint32_t val;
1084dc60165bSWeongyo Jeong 	int error;
1085dc60165bSWeongyo Jeong 
1086dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
1087dc60165bSWeongyo Jeong 
1088*7a79cebfSGleb Smirnoff 	if (sc->sc_flags & UATH_FLAG_INITDONE)
1089*7a79cebfSGleb Smirnoff 		uath_stop(sc);
1090dc60165bSWeongyo Jeong 
1091dc60165bSWeongyo Jeong 	/* reset variables */
1092dc60165bSWeongyo Jeong 	sc->sc_intrx_nextnum = sc->sc_msgid = 0;
1093dc60165bSWeongyo Jeong 
1094dc60165bSWeongyo Jeong 	val = htobe32(0);
1095dc60165bSWeongyo Jeong 	uath_cmd_write(sc, WDCMSG_BIND, &val, sizeof val, 0);
1096dc60165bSWeongyo Jeong 
1097dc60165bSWeongyo Jeong 	/* set MAC address */
1098*7a79cebfSGleb Smirnoff 	uath_config_multi(sc, CFG_MAC_ADDR,
1099*7a79cebfSGleb Smirnoff 	    vap ? vap->iv_myaddr : ic->ic_macaddr, IEEE80211_ADDR_LEN);
1100dc60165bSWeongyo Jeong 
1101dc60165bSWeongyo Jeong 	/* XXX honor net80211 state */
1102dc60165bSWeongyo Jeong 	uath_config(sc, CFG_RATE_CONTROL_ENABLE, 0x00000001);
1103dc60165bSWeongyo Jeong 	uath_config(sc, CFG_DIVERSITY_CTL, 0x00000001);
1104dc60165bSWeongyo Jeong 	uath_config(sc, CFG_ABOLT, 0x0000003f);
1105dc60165bSWeongyo Jeong 	uath_config(sc, CFG_WME_ENABLED, 0x00000001);
1106dc60165bSWeongyo Jeong 
1107dc60165bSWeongyo Jeong 	uath_config(sc, CFG_SERVICE_TYPE, 1);
1108dc60165bSWeongyo Jeong 	uath_config(sc, CFG_TP_SCALE, 0x00000000);
1109dc60165bSWeongyo Jeong 	uath_config(sc, CFG_TPC_HALF_DBM5, 0x0000003c);
1110dc60165bSWeongyo Jeong 	uath_config(sc, CFG_TPC_HALF_DBM2, 0x0000003c);
1111dc60165bSWeongyo Jeong 	uath_config(sc, CFG_OVERRD_TX_POWER, 0x00000000);
1112dc60165bSWeongyo Jeong 	uath_config(sc, CFG_GMODE_PROTECTION, 0x00000000);
1113dc60165bSWeongyo Jeong 	uath_config(sc, CFG_GMODE_PROTECT_RATE_INDEX, 0x00000003);
1114dc60165bSWeongyo Jeong 	uath_config(sc, CFG_PROTECTION_TYPE, 0x00000000);
1115dc60165bSWeongyo Jeong 	uath_config(sc, CFG_MODE_CTS, 0x00000002);
1116dc60165bSWeongyo Jeong 
1117dc60165bSWeongyo Jeong 	error = uath_cmd_read(sc, WDCMSG_TARGET_START, NULL, 0,
1118dc60165bSWeongyo Jeong 	    &val, sizeof(val), UATH_CMD_FLAG_MAGIC);
1119dc60165bSWeongyo Jeong 	if (error) {
1120dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev,
1121dc60165bSWeongyo Jeong 		    "could not start target, error %d\n", error);
1122dc60165bSWeongyo Jeong 		goto fail;
1123dc60165bSWeongyo Jeong 	}
1124dc60165bSWeongyo Jeong 	DPRINTF(sc, UATH_DEBUG_INIT, "%s returns handle: 0x%x\n",
1125dc60165bSWeongyo Jeong 	    uath_codename(WDCMSG_TARGET_START), be32toh(val));
1126dc60165bSWeongyo Jeong 
1127dc60165bSWeongyo Jeong 	/* set default channel */
1128dc60165bSWeongyo Jeong 	error = uath_switch_channel(sc, ic->ic_curchan);
1129dc60165bSWeongyo Jeong 	if (error) {
1130dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev,
1131dc60165bSWeongyo Jeong 		    "could not switch channel, error %d\n", error);
1132dc60165bSWeongyo Jeong 		goto fail;
1133dc60165bSWeongyo Jeong 	}
1134dc60165bSWeongyo Jeong 
1135dc60165bSWeongyo Jeong 	val = htobe32(TARGET_DEVICE_AWAKE);
1136dc60165bSWeongyo Jeong 	uath_cmd_write(sc, WDCMSG_SET_PWR_MODE, &val, sizeof val, 0);
1137dc60165bSWeongyo Jeong 	/* XXX? check */
1138dc60165bSWeongyo Jeong 	uath_cmd_write(sc, WDCMSG_RESET_KEY_CACHE, NULL, 0, 0);
1139dc60165bSWeongyo Jeong 
1140a593f6b8SAndrew Thompson 	usbd_transfer_start(sc->sc_xfer[UATH_BULK_RX]);
1141dc60165bSWeongyo Jeong 	/* enable Rx */
1142dc60165bSWeongyo Jeong 	uath_set_rxfilter(sc, 0x0, UATH_FILTER_OP_INIT);
1143dc60165bSWeongyo Jeong 	uath_set_rxfilter(sc,
1144dc60165bSWeongyo Jeong 	    UATH_FILTER_RX_UCAST | UATH_FILTER_RX_MCAST |
1145dc60165bSWeongyo Jeong 	    UATH_FILTER_RX_BCAST | UATH_FILTER_RX_BEACON,
1146dc60165bSWeongyo Jeong 	    UATH_FILTER_OP_SET);
1147dc60165bSWeongyo Jeong 
1148dc60165bSWeongyo Jeong 	sc->sc_flags |= UATH_FLAG_INITDONE;
1149dc60165bSWeongyo Jeong 
1150dc60165bSWeongyo Jeong 	callout_reset(&sc->watchdog_ch, hz, uath_watchdog, sc);
1151dc60165bSWeongyo Jeong 
1152dc60165bSWeongyo Jeong 	return (0);
1153dc60165bSWeongyo Jeong 
1154dc60165bSWeongyo Jeong fail:
1155*7a79cebfSGleb Smirnoff 	uath_stop(sc);
1156dc60165bSWeongyo Jeong 	return (error);
1157dc60165bSWeongyo Jeong }
1158dc60165bSWeongyo Jeong 
1159dc60165bSWeongyo Jeong static void
1160*7a79cebfSGleb Smirnoff uath_stop(struct uath_softc *sc)
1161dc60165bSWeongyo Jeong {
1162dc60165bSWeongyo Jeong 
1163dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
1164dc60165bSWeongyo Jeong 
1165dc60165bSWeongyo Jeong 	sc->sc_flags &= ~UATH_FLAG_INITDONE;
1166dc60165bSWeongyo Jeong 
1167dc60165bSWeongyo Jeong 	callout_stop(&sc->stat_ch);
1168dc60165bSWeongyo Jeong 	callout_stop(&sc->watchdog_ch);
1169dc60165bSWeongyo Jeong 	sc->sc_tx_timer = 0;
1170dc60165bSWeongyo Jeong 	/* abort pending transmits  */
1171dc60165bSWeongyo Jeong 	uath_abort_xfers(sc);
1172dc60165bSWeongyo Jeong 	/* flush data & control requests into the target  */
1173dc60165bSWeongyo Jeong 	(void)uath_flush(sc);
1174dc60165bSWeongyo Jeong 	/* set a LED status to the disconnected.  */
1175dc60165bSWeongyo Jeong 	uath_set_ledstate(sc, 0);
1176dc60165bSWeongyo Jeong 	/* stop the target  */
1177dc60165bSWeongyo Jeong 	uath_cmd_write(sc, WDCMSG_TARGET_STOP, NULL, 0, 0);
1178dc60165bSWeongyo Jeong }
1179dc60165bSWeongyo Jeong 
1180dc60165bSWeongyo Jeong static int
1181dc60165bSWeongyo Jeong uath_config(struct uath_softc *sc, uint32_t reg, uint32_t val)
1182dc60165bSWeongyo Jeong {
1183dc60165bSWeongyo Jeong 	struct uath_write_mac write;
1184dc60165bSWeongyo Jeong 	int error;
1185dc60165bSWeongyo Jeong 
1186dc60165bSWeongyo Jeong 	write.reg = htobe32(reg);
1187dc60165bSWeongyo Jeong 	write.len = htobe32(0);	/* 0 = single write */
1188dc60165bSWeongyo Jeong 	*(uint32_t *)write.data = htobe32(val);
1189dc60165bSWeongyo Jeong 
1190dc60165bSWeongyo Jeong 	error = uath_cmd_write(sc, WDCMSG_TARGET_SET_CONFIG, &write,
1191dc60165bSWeongyo Jeong 	    3 * sizeof (uint32_t), 0);
1192dc60165bSWeongyo Jeong 	if (error != 0) {
1193dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev, "could not write register 0x%02x\n",
1194dc60165bSWeongyo Jeong 		    reg);
1195dc60165bSWeongyo Jeong 	}
1196dc60165bSWeongyo Jeong 	return (error);
1197dc60165bSWeongyo Jeong }
1198dc60165bSWeongyo Jeong 
1199dc60165bSWeongyo Jeong static int
1200dc60165bSWeongyo Jeong uath_config_multi(struct uath_softc *sc, uint32_t reg, const void *data,
1201dc60165bSWeongyo Jeong     int len)
1202dc60165bSWeongyo Jeong {
1203dc60165bSWeongyo Jeong 	struct uath_write_mac write;
1204dc60165bSWeongyo Jeong 	int error;
1205dc60165bSWeongyo Jeong 
1206dc60165bSWeongyo Jeong 	write.reg = htobe32(reg);
1207dc60165bSWeongyo Jeong 	write.len = htobe32(len);
1208dc60165bSWeongyo Jeong 	bcopy(data, write.data, len);
1209dc60165bSWeongyo Jeong 
1210dc60165bSWeongyo Jeong 	/* properly handle the case where len is zero (reset) */
1211dc60165bSWeongyo Jeong 	error = uath_cmd_write(sc, WDCMSG_TARGET_SET_CONFIG, &write,
1212dc60165bSWeongyo Jeong 	    (len == 0) ? sizeof (uint32_t) : 2 * sizeof (uint32_t) + len, 0);
1213dc60165bSWeongyo Jeong 	if (error != 0) {
1214dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev,
1215dc60165bSWeongyo Jeong 		    "could not write %d bytes to register 0x%02x\n", len, reg);
1216dc60165bSWeongyo Jeong 	}
1217dc60165bSWeongyo Jeong 	return (error);
1218dc60165bSWeongyo Jeong }
1219dc60165bSWeongyo Jeong 
1220dc60165bSWeongyo Jeong static int
1221dc60165bSWeongyo Jeong uath_switch_channel(struct uath_softc *sc, struct ieee80211_channel *c)
1222dc60165bSWeongyo Jeong {
1223dc60165bSWeongyo Jeong 	int error;
1224dc60165bSWeongyo Jeong 
1225dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
1226dc60165bSWeongyo Jeong 
1227dc60165bSWeongyo Jeong 	/* set radio frequency */
1228dc60165bSWeongyo Jeong 	error = uath_set_chan(sc, c);
1229dc60165bSWeongyo Jeong 	if (error) {
1230dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev,
1231dc60165bSWeongyo Jeong 		    "could not set channel, error %d\n", error);
1232dc60165bSWeongyo Jeong 		goto failed;
1233dc60165bSWeongyo Jeong 	}
1234dc60165bSWeongyo Jeong 	/* reset Tx rings */
1235dc60165bSWeongyo Jeong 	error = uath_reset_tx_queues(sc);
1236dc60165bSWeongyo Jeong 	if (error) {
1237dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev,
1238dc60165bSWeongyo Jeong 		    "could not reset Tx queues, error %d\n", error);
1239dc60165bSWeongyo Jeong 		goto failed;
1240dc60165bSWeongyo Jeong 	}
1241dc60165bSWeongyo Jeong 	/* set Tx rings WME properties */
1242dc60165bSWeongyo Jeong 	error = uath_wme_init(sc);
1243dc60165bSWeongyo Jeong 	if (error) {
1244dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev,
1245dc60165bSWeongyo Jeong 		    "could not init Tx queues, error %d\n", error);
1246dc60165bSWeongyo Jeong 		goto failed;
1247dc60165bSWeongyo Jeong 	}
1248dc60165bSWeongyo Jeong 	error = uath_set_ledstate(sc, 0);
1249dc60165bSWeongyo Jeong 	if (error) {
1250dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev,
1251dc60165bSWeongyo Jeong 		    "could not set led state, error %d\n", error);
1252dc60165bSWeongyo Jeong 		goto failed;
1253dc60165bSWeongyo Jeong 	}
1254dc60165bSWeongyo Jeong 	error = uath_flush(sc);
1255dc60165bSWeongyo Jeong 	if (error) {
1256dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev,
1257dc60165bSWeongyo Jeong 		    "could not flush pipes, error %d\n", error);
1258dc60165bSWeongyo Jeong 		goto failed;
1259dc60165bSWeongyo Jeong 	}
1260dc60165bSWeongyo Jeong failed:
1261dc60165bSWeongyo Jeong 	return (error);
1262dc60165bSWeongyo Jeong }
1263dc60165bSWeongyo Jeong 
1264dc60165bSWeongyo Jeong static int
1265dc60165bSWeongyo Jeong uath_set_rxfilter(struct uath_softc *sc, uint32_t bits, uint32_t op)
1266dc60165bSWeongyo Jeong {
1267dc60165bSWeongyo Jeong 	struct uath_cmd_rx_filter rxfilter;
1268dc60165bSWeongyo Jeong 
1269dc60165bSWeongyo Jeong 	rxfilter.bits = htobe32(bits);
1270dc60165bSWeongyo Jeong 	rxfilter.op = htobe32(op);
1271dc60165bSWeongyo Jeong 
1272dc60165bSWeongyo Jeong 	DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL,
1273dc60165bSWeongyo Jeong 	    "setting Rx filter=0x%x flags=0x%x\n", bits, op);
1274dc60165bSWeongyo Jeong 	return uath_cmd_write(sc, WDCMSG_RX_FILTER, &rxfilter,
1275dc60165bSWeongyo Jeong 	    sizeof rxfilter, 0);
1276dc60165bSWeongyo Jeong }
1277dc60165bSWeongyo Jeong 
1278dc60165bSWeongyo Jeong static void
1279dc60165bSWeongyo Jeong uath_watchdog(void *arg)
1280dc60165bSWeongyo Jeong {
1281dc60165bSWeongyo Jeong 	struct uath_softc *sc = arg;
1282*7a79cebfSGleb Smirnoff 	struct ieee80211com *ic = &sc->sc_ic;
1283dc60165bSWeongyo Jeong 
1284dc60165bSWeongyo Jeong 	if (sc->sc_tx_timer > 0) {
1285dc60165bSWeongyo Jeong 		if (--sc->sc_tx_timer == 0) {
1286dc60165bSWeongyo Jeong 			device_printf(sc->sc_dev, "device timeout\n");
1287*7a79cebfSGleb Smirnoff 			/*uath_init(sc); XXX needs a process context! */
1288*7a79cebfSGleb Smirnoff 			counter_u64_add(ic->ic_oerrors, 1);
1289dc60165bSWeongyo Jeong 			return;
1290dc60165bSWeongyo Jeong 		}
1291dc60165bSWeongyo Jeong 		callout_reset(&sc->watchdog_ch, hz, uath_watchdog, sc);
1292dc60165bSWeongyo Jeong 	}
1293dc60165bSWeongyo Jeong }
1294dc60165bSWeongyo Jeong 
1295dc60165bSWeongyo Jeong static void
1296dc60165bSWeongyo Jeong uath_abort_xfers(struct uath_softc *sc)
1297dc60165bSWeongyo Jeong {
1298dc60165bSWeongyo Jeong 	int i;
1299dc60165bSWeongyo Jeong 
1300dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
1301dc60165bSWeongyo Jeong 	/* abort any pending transfers */
1302dc60165bSWeongyo Jeong 	for (i = 0; i < UATH_N_XFERS; i++)
1303a593f6b8SAndrew Thompson 		usbd_transfer_stop(sc->sc_xfer[i]);
1304dc60165bSWeongyo Jeong }
1305dc60165bSWeongyo Jeong 
1306dc60165bSWeongyo Jeong static int
1307dc60165bSWeongyo Jeong uath_flush(struct uath_softc *sc)
1308dc60165bSWeongyo Jeong {
1309dc60165bSWeongyo Jeong 	int error;
1310dc60165bSWeongyo Jeong 
1311dc60165bSWeongyo Jeong 	error = uath_dataflush(sc);
1312dc60165bSWeongyo Jeong 	if (error != 0)
1313dc60165bSWeongyo Jeong 		goto failed;
1314dc60165bSWeongyo Jeong 
1315dc60165bSWeongyo Jeong 	error = uath_cmdflush(sc);
1316dc60165bSWeongyo Jeong 	if (error != 0)
1317dc60165bSWeongyo Jeong 		goto failed;
1318dc60165bSWeongyo Jeong 
1319dc60165bSWeongyo Jeong failed:
1320dc60165bSWeongyo Jeong 	return (error);
1321dc60165bSWeongyo Jeong }
1322dc60165bSWeongyo Jeong 
1323dc60165bSWeongyo Jeong static int
1324dc60165bSWeongyo Jeong uath_cmdflush(struct uath_softc *sc)
1325dc60165bSWeongyo Jeong {
1326dc60165bSWeongyo Jeong 
1327dc60165bSWeongyo Jeong 	return uath_cmd_write(sc, WDCMSG_FLUSH, NULL, 0, 0);
1328dc60165bSWeongyo Jeong }
1329dc60165bSWeongyo Jeong 
1330dc60165bSWeongyo Jeong static int
1331dc60165bSWeongyo Jeong uath_dataflush(struct uath_softc *sc)
1332dc60165bSWeongyo Jeong {
1333dc60165bSWeongyo Jeong 	struct uath_data *data;
1334dc60165bSWeongyo Jeong 	struct uath_chunk *chunk;
1335dc60165bSWeongyo Jeong 	struct uath_tx_desc *desc;
1336dc60165bSWeongyo Jeong 
1337dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
1338dc60165bSWeongyo Jeong 
1339dc60165bSWeongyo Jeong 	data = uath_getbuf(sc);
1340dc60165bSWeongyo Jeong 	if (data == NULL)
1341dc60165bSWeongyo Jeong 		return (ENOBUFS);
1342dc60165bSWeongyo Jeong 	data->buflen = sizeof(struct uath_chunk) + sizeof(struct uath_tx_desc);
1343dc60165bSWeongyo Jeong 	data->m = NULL;
1344dc60165bSWeongyo Jeong 	data->ni = NULL;
1345dc60165bSWeongyo Jeong 	chunk = (struct uath_chunk *)data->buf;
1346dc60165bSWeongyo Jeong 	desc = (struct uath_tx_desc *)(chunk + 1);
1347dc60165bSWeongyo Jeong 
1348dc60165bSWeongyo Jeong 	/* one chunk only */
1349dc60165bSWeongyo Jeong 	chunk->seqnum = 0;
1350dc60165bSWeongyo Jeong 	chunk->flags = UATH_CFLAGS_FINAL;
1351dc60165bSWeongyo Jeong 	chunk->length = htobe16(sizeof (struct uath_tx_desc));
1352dc60165bSWeongyo Jeong 
1353271ae033SHans Petter Selasky 	memset(desc, 0, sizeof(struct uath_tx_desc));
1354dc60165bSWeongyo Jeong 	desc->msglen = htobe32(sizeof(struct uath_tx_desc));
1355dc60165bSWeongyo Jeong 	desc->msgid  = (sc->sc_msgid++) + 1; /* don't care about endianness */
1356dc60165bSWeongyo Jeong 	desc->type   = htobe32(WDCMSG_FLUSH);
1357dc60165bSWeongyo Jeong 	desc->txqid  = htobe32(0);
1358dc60165bSWeongyo Jeong 	desc->connid = htobe32(0);
1359dc60165bSWeongyo Jeong 	desc->flags  = htobe32(0);
1360dc60165bSWeongyo Jeong 
1361dc60165bSWeongyo Jeong #ifdef UATH_DEBUG
1362dc60165bSWeongyo Jeong 	if (sc->sc_debug & UATH_DEBUG_CMDS) {
1363dc60165bSWeongyo Jeong 		DPRINTF(sc, UATH_DEBUG_RESET, "send flush ix %d\n",
1364dc60165bSWeongyo Jeong 		    desc->msgid);
1365dc60165bSWeongyo Jeong 		if (sc->sc_debug & UATH_DEBUG_CMDS_DUMP)
1366dc60165bSWeongyo Jeong 			uath_dump_cmd(data->buf, data->buflen, '+');
1367dc60165bSWeongyo Jeong 	}
1368dc60165bSWeongyo Jeong #endif
1369dc60165bSWeongyo Jeong 
1370dc60165bSWeongyo Jeong 	STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next);
1371dc60165bSWeongyo Jeong 	UATH_STAT_INC(sc, st_tx_pending);
1372dc60165bSWeongyo Jeong 	sc->sc_tx_timer = 5;
1373a593f6b8SAndrew Thompson 	usbd_transfer_start(sc->sc_xfer[UATH_BULK_TX]);
1374dc60165bSWeongyo Jeong 
1375dc60165bSWeongyo Jeong 	return (0);
1376dc60165bSWeongyo Jeong }
1377dc60165bSWeongyo Jeong 
1378dc60165bSWeongyo Jeong static struct uath_data *
1379dc60165bSWeongyo Jeong _uath_getbuf(struct uath_softc *sc)
1380dc60165bSWeongyo Jeong {
1381dc60165bSWeongyo Jeong 	struct uath_data *bf;
1382dc60165bSWeongyo Jeong 
1383dc60165bSWeongyo Jeong 	bf = STAILQ_FIRST(&sc->sc_tx_inactive);
1384dc60165bSWeongyo Jeong 	if (bf != NULL) {
1385dc60165bSWeongyo Jeong 		STAILQ_REMOVE_HEAD(&sc->sc_tx_inactive, next);
1386dc60165bSWeongyo Jeong 		UATH_STAT_DEC(sc, st_tx_inactive);
1387dc60165bSWeongyo Jeong 	} else
1388dc60165bSWeongyo Jeong 		bf = NULL;
1389dc60165bSWeongyo Jeong 	if (bf == NULL)
1390dc60165bSWeongyo Jeong 		DPRINTF(sc, UATH_DEBUG_XMIT, "%s: %s\n", __func__,
1391dc60165bSWeongyo Jeong 		    "out of xmit buffers");
1392dc60165bSWeongyo Jeong 	return (bf);
1393dc60165bSWeongyo Jeong }
1394dc60165bSWeongyo Jeong 
1395dc60165bSWeongyo Jeong static struct uath_data *
1396dc60165bSWeongyo Jeong uath_getbuf(struct uath_softc *sc)
1397dc60165bSWeongyo Jeong {
1398dc60165bSWeongyo Jeong 	struct uath_data *bf;
1399dc60165bSWeongyo Jeong 
1400dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
1401dc60165bSWeongyo Jeong 
1402dc60165bSWeongyo Jeong 	bf = _uath_getbuf(sc);
1403*7a79cebfSGleb Smirnoff 	if (bf == NULL)
1404dc60165bSWeongyo Jeong 		DPRINTF(sc, UATH_DEBUG_XMIT, "%s: stop queue\n", __func__);
1405dc60165bSWeongyo Jeong 	return (bf);
1406dc60165bSWeongyo Jeong }
1407dc60165bSWeongyo Jeong 
1408dc60165bSWeongyo Jeong static int
1409dc60165bSWeongyo Jeong uath_set_ledstate(struct uath_softc *sc, int connected)
1410dc60165bSWeongyo Jeong {
1411dc60165bSWeongyo Jeong 
1412dc60165bSWeongyo Jeong 	DPRINTF(sc, UATH_DEBUG_LED,
1413dc60165bSWeongyo Jeong 	    "set led state %sconnected\n", connected ? "" : "!");
1414dc60165bSWeongyo Jeong 	connected = htobe32(connected);
1415dc60165bSWeongyo Jeong 	return uath_cmd_write(sc, WDCMSG_SET_LED_STATE,
1416dc60165bSWeongyo Jeong 	     &connected, sizeof connected, 0);
1417dc60165bSWeongyo Jeong }
1418dc60165bSWeongyo Jeong 
1419dc60165bSWeongyo Jeong static int
1420dc60165bSWeongyo Jeong uath_set_chan(struct uath_softc *sc, struct ieee80211_channel *c)
1421dc60165bSWeongyo Jeong {
1422dc60165bSWeongyo Jeong #ifdef UATH_DEBUG
1423*7a79cebfSGleb Smirnoff 	struct ieee80211com *ic = &sc->sc_ic;
1424dc60165bSWeongyo Jeong #endif
1425dc60165bSWeongyo Jeong 	struct uath_cmd_reset reset;
1426dc60165bSWeongyo Jeong 
1427271ae033SHans Petter Selasky 	memset(&reset, 0, sizeof(reset));
1428dc60165bSWeongyo Jeong 	if (IEEE80211_IS_CHAN_2GHZ(c))
1429dc60165bSWeongyo Jeong 		reset.flags |= htobe32(UATH_CHAN_2GHZ);
1430dc60165bSWeongyo Jeong 	if (IEEE80211_IS_CHAN_5GHZ(c))
1431dc60165bSWeongyo Jeong 		reset.flags |= htobe32(UATH_CHAN_5GHZ);
1432dc60165bSWeongyo Jeong 	/* NB: 11g =>'s 11b so don't specify both OFDM and CCK */
1433f61336e4SSam Leffler 	if (IEEE80211_IS_CHAN_OFDM(c))
1434dc60165bSWeongyo Jeong 		reset.flags |= htobe32(UATH_CHAN_OFDM);
1435f61336e4SSam Leffler 	else if (IEEE80211_IS_CHAN_CCK(c))
1436dc60165bSWeongyo Jeong 		reset.flags |= htobe32(UATH_CHAN_CCK);
1437dc60165bSWeongyo Jeong 	/* turbo can be used in either 2GHz or 5GHz */
1438dc60165bSWeongyo Jeong 	if (c->ic_flags & IEEE80211_CHAN_TURBO)
1439dc60165bSWeongyo Jeong 		reset.flags |= htobe32(UATH_CHAN_TURBO);
1440dc60165bSWeongyo Jeong 	reset.freq = htobe32(c->ic_freq);
1441dc60165bSWeongyo Jeong 	reset.maxrdpower = htobe32(50);	/* XXX */
1442dc60165bSWeongyo Jeong 	reset.channelchange = htobe32(1);
1443dc60165bSWeongyo Jeong 	reset.keeprccontent = htobe32(0);
1444dc60165bSWeongyo Jeong 
1445dc60165bSWeongyo Jeong 	DPRINTF(sc, UATH_DEBUG_CHANNEL, "set channel %d, flags 0x%x freq %u\n",
1446dc60165bSWeongyo Jeong 	    ieee80211_chan2ieee(ic, c),
1447dc60165bSWeongyo Jeong 	    be32toh(reset.flags), be32toh(reset.freq));
1448dc60165bSWeongyo Jeong 	return uath_cmd_write(sc, WDCMSG_RESET, &reset, sizeof reset, 0);
1449dc60165bSWeongyo Jeong }
1450dc60165bSWeongyo Jeong 
1451dc60165bSWeongyo Jeong static int
1452dc60165bSWeongyo Jeong uath_reset_tx_queues(struct uath_softc *sc)
1453dc60165bSWeongyo Jeong {
1454dc60165bSWeongyo Jeong 	int ac, error;
1455dc60165bSWeongyo Jeong 
1456dc60165bSWeongyo Jeong 	DPRINTF(sc, UATH_DEBUG_RESET, "%s: reset Tx queues\n", __func__);
1457dc60165bSWeongyo Jeong 	for (ac = 0; ac < 4; ac++) {
1458dc60165bSWeongyo Jeong 		const uint32_t qid = htobe32(ac);
1459dc60165bSWeongyo Jeong 
1460dc60165bSWeongyo Jeong 		error = uath_cmd_write(sc, WDCMSG_RELEASE_TX_QUEUE, &qid,
1461dc60165bSWeongyo Jeong 		    sizeof qid, 0);
1462dc60165bSWeongyo Jeong 		if (error != 0)
1463dc60165bSWeongyo Jeong 			break;
1464dc60165bSWeongyo Jeong 	}
1465dc60165bSWeongyo Jeong 	return (error);
1466dc60165bSWeongyo Jeong }
1467dc60165bSWeongyo Jeong 
1468dc60165bSWeongyo Jeong static int
1469dc60165bSWeongyo Jeong uath_wme_init(struct uath_softc *sc)
1470dc60165bSWeongyo Jeong {
1471dc60165bSWeongyo Jeong 	/* XXX get from net80211 */
1472dc60165bSWeongyo Jeong 	static const struct uath_wme_settings uath_wme_11g[4] = {
1473dc60165bSWeongyo Jeong 		{ 7, 4, 10,  0, 0 },	/* Background */
1474dc60165bSWeongyo Jeong 		{ 3, 4, 10,  0, 0 },	/* Best-Effort */
1475dc60165bSWeongyo Jeong 		{ 3, 3,  4, 26, 0 },	/* Video */
1476dc60165bSWeongyo Jeong 		{ 2, 2,  3, 47, 0 }	/* Voice */
1477dc60165bSWeongyo Jeong 	};
1478dc60165bSWeongyo Jeong 	struct uath_cmd_txq_setup qinfo;
1479dc60165bSWeongyo Jeong 	int ac, error;
1480dc60165bSWeongyo Jeong 
1481dc60165bSWeongyo Jeong 	DPRINTF(sc, UATH_DEBUG_WME, "%s: setup Tx queues\n", __func__);
1482dc60165bSWeongyo Jeong 	for (ac = 0; ac < 4; ac++) {
1483dc60165bSWeongyo Jeong 		qinfo.qid		= htobe32(ac);
1484dc60165bSWeongyo Jeong 		qinfo.len		= htobe32(sizeof(qinfo.attr));
1485dc60165bSWeongyo Jeong 		qinfo.attr.priority	= htobe32(ac);	/* XXX */
1486dc60165bSWeongyo Jeong 		qinfo.attr.aifs		= htobe32(uath_wme_11g[ac].aifsn);
1487dc60165bSWeongyo Jeong 		qinfo.attr.logcwmin	= htobe32(uath_wme_11g[ac].logcwmin);
1488dc60165bSWeongyo Jeong 		qinfo.attr.logcwmax	= htobe32(uath_wme_11g[ac].logcwmax);
1489dc60165bSWeongyo Jeong 		qinfo.attr.bursttime	= htobe32(UATH_TXOP_TO_US(
1490dc60165bSWeongyo Jeong 					    uath_wme_11g[ac].txop));
1491dc60165bSWeongyo Jeong 		qinfo.attr.mode		= htobe32(uath_wme_11g[ac].acm);/*XXX? */
1492dc60165bSWeongyo Jeong 		qinfo.attr.qflags	= htobe32(1);	/* XXX? */
1493dc60165bSWeongyo Jeong 
1494dc60165bSWeongyo Jeong 		error = uath_cmd_write(sc, WDCMSG_SETUP_TX_QUEUE, &qinfo,
1495dc60165bSWeongyo Jeong 		    sizeof qinfo, 0);
1496dc60165bSWeongyo Jeong 		if (error != 0)
1497dc60165bSWeongyo Jeong 			break;
1498dc60165bSWeongyo Jeong 	}
1499dc60165bSWeongyo Jeong 	return (error);
1500dc60165bSWeongyo Jeong }
1501dc60165bSWeongyo Jeong 
1502*7a79cebfSGleb Smirnoff static void
1503*7a79cebfSGleb Smirnoff uath_parent(struct ieee80211com *ic)
1504dc60165bSWeongyo Jeong {
1505d3fdd08cSAdrian Chadd 	struct uath_softc *sc = ic->ic_softc;
1506645e4d17SHans Petter Selasky 	int startall = 0;
1507645e4d17SHans Petter Selasky 
1508645e4d17SHans Petter Selasky 	UATH_LOCK(sc);
1509*7a79cebfSGleb Smirnoff 	if (sc->sc_flags & UATH_FLAG_INVALID) {
1510645e4d17SHans Petter Selasky 		UATH_UNLOCK(sc);
1511*7a79cebfSGleb Smirnoff 		return;
1512*7a79cebfSGleb Smirnoff 	}
1513dc60165bSWeongyo Jeong 
1514*7a79cebfSGleb Smirnoff 	if (ic->ic_nrunning > 0) {
1515*7a79cebfSGleb Smirnoff 		if (!(sc->sc_flags & UATH_FLAG_INITDONE)) {
1516d3fdd08cSAdrian Chadd 			uath_init(sc);
1517dc60165bSWeongyo Jeong 			startall = 1;
1518dc60165bSWeongyo Jeong 		}
1519*7a79cebfSGleb Smirnoff 	} else if (sc->sc_flags & UATH_FLAG_INITDONE)
1520*7a79cebfSGleb Smirnoff 		uath_stop(sc);
1521*7a79cebfSGleb Smirnoff 	UATH_UNLOCK(sc);
1522dc60165bSWeongyo Jeong 	if (startall)
1523dc60165bSWeongyo Jeong 		ieee80211_start_all(ic);
1524dc60165bSWeongyo Jeong }
1525dc60165bSWeongyo Jeong 
1526dc60165bSWeongyo Jeong static int
1527dc60165bSWeongyo Jeong uath_tx_start(struct uath_softc *sc, struct mbuf *m0, struct ieee80211_node *ni,
1528dc60165bSWeongyo Jeong     struct uath_data *data)
1529dc60165bSWeongyo Jeong {
15305efea30fSAndrew Thompson 	struct ieee80211vap *vap = ni->ni_vap;
1531dc60165bSWeongyo Jeong 	struct uath_chunk *chunk;
1532dc60165bSWeongyo Jeong 	struct uath_tx_desc *desc;
1533dc60165bSWeongyo Jeong 	const struct ieee80211_frame *wh;
1534dc60165bSWeongyo Jeong 	struct ieee80211_key *k;
1535dc60165bSWeongyo Jeong 	int framelen, msglen;
1536dc60165bSWeongyo Jeong 
1537dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
1538dc60165bSWeongyo Jeong 
1539dc60165bSWeongyo Jeong 	data->ni = ni;
1540dc60165bSWeongyo Jeong 	data->m = m0;
1541dc60165bSWeongyo Jeong 	chunk = (struct uath_chunk *)data->buf;
1542dc60165bSWeongyo Jeong 	desc = (struct uath_tx_desc *)(chunk + 1);
1543dc60165bSWeongyo Jeong 
15445463c4a4SSam Leffler 	if (ieee80211_radiotap_active_vap(vap)) {
1545dc60165bSWeongyo Jeong 		struct uath_tx_radiotap_header *tap = &sc->sc_txtap;
1546dc60165bSWeongyo Jeong 
1547dc60165bSWeongyo Jeong 		tap->wt_flags = 0;
1548dc60165bSWeongyo Jeong 		if (m0->m_flags & M_FRAG)
1549dc60165bSWeongyo Jeong 			tap->wt_flags |= IEEE80211_RADIOTAP_F_FRAG;
1550dc60165bSWeongyo Jeong 
15515463c4a4SSam Leffler 		ieee80211_radiotap_tx(vap, m0);
1552dc60165bSWeongyo Jeong 	}
1553dc60165bSWeongyo Jeong 
1554dc60165bSWeongyo Jeong 	wh = mtod(m0, struct ieee80211_frame *);
15555945b5f5SKevin Lo 	if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) {
1556dc60165bSWeongyo Jeong 		k = ieee80211_crypto_encap(ni, m0);
1557dc60165bSWeongyo Jeong 		if (k == NULL) {
1558dc60165bSWeongyo Jeong 			m_freem(m0);
1559dc60165bSWeongyo Jeong 			return (ENOBUFS);
1560dc60165bSWeongyo Jeong 		}
1561dc60165bSWeongyo Jeong 
1562dc60165bSWeongyo Jeong 		/* packet header may have moved, reset our local pointer */
1563dc60165bSWeongyo Jeong 		wh = mtod(m0, struct ieee80211_frame *);
1564dc60165bSWeongyo Jeong 	}
1565dc60165bSWeongyo Jeong 	m_copydata(m0, 0, m0->m_pkthdr.len, (uint8_t *)(desc + 1));
1566dc60165bSWeongyo Jeong 
1567dc60165bSWeongyo Jeong 	framelen = m0->m_pkthdr.len + IEEE80211_CRC_LEN;
1568dc60165bSWeongyo Jeong 	msglen = framelen + sizeof (struct uath_tx_desc);
1569dc60165bSWeongyo Jeong 	data->buflen = msglen + sizeof (struct uath_chunk);
1570dc60165bSWeongyo Jeong 
1571dc60165bSWeongyo Jeong 	/* one chunk only for now */
1572dc60165bSWeongyo Jeong 	chunk->seqnum = sc->sc_seqnum++;
1573dc60165bSWeongyo Jeong 	chunk->flags = (m0->m_flags & M_FRAG) ? 0 : UATH_CFLAGS_FINAL;
1574dc60165bSWeongyo Jeong 	if (m0->m_flags & M_LASTFRAG)
1575dc60165bSWeongyo Jeong 		chunk->flags |= UATH_CFLAGS_FINAL;
1576dc60165bSWeongyo Jeong 	chunk->flags = UATH_CFLAGS_FINAL;
1577dc60165bSWeongyo Jeong 	chunk->length = htobe16(msglen);
1578dc60165bSWeongyo Jeong 
1579dc60165bSWeongyo Jeong 	/* fill Tx descriptor */
1580dc60165bSWeongyo Jeong 	desc->msglen = htobe32(msglen);
1581dc60165bSWeongyo Jeong 	/* NB: to get UATH_TX_NOTIFY reply, `msgid' must be larger than 0  */
1582dc60165bSWeongyo Jeong 	desc->msgid  = (sc->sc_msgid++) + 1; /* don't care about endianness */
1583dc60165bSWeongyo Jeong 	desc->type   = htobe32(WDCMSG_SEND);
1584dc60165bSWeongyo Jeong 	switch (wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) {
1585dc60165bSWeongyo Jeong 	case IEEE80211_FC0_TYPE_CTL:
1586dc60165bSWeongyo Jeong 	case IEEE80211_FC0_TYPE_MGT:
1587dc60165bSWeongyo Jeong 		/* NB: force all management frames to highest queue */
1588dc60165bSWeongyo Jeong 		if (ni->ni_flags & IEEE80211_NODE_QOS) {
1589dc60165bSWeongyo Jeong 			/* NB: force all management frames to highest queue */
1590dc60165bSWeongyo Jeong 			desc->txqid = htobe32(WME_AC_VO | UATH_TXQID_MINRATE);
1591dc60165bSWeongyo Jeong 		} else
1592dc60165bSWeongyo Jeong 			desc->txqid = htobe32(WME_AC_BE | UATH_TXQID_MINRATE);
1593dc60165bSWeongyo Jeong 		break;
1594dc60165bSWeongyo Jeong 	case IEEE80211_FC0_TYPE_DATA:
1595dc60165bSWeongyo Jeong 		/* XXX multicast frames should honor mcastrate */
1596dc60165bSWeongyo Jeong 		desc->txqid = htobe32(M_WME_GETAC(m0));
1597dc60165bSWeongyo Jeong 		break;
1598dc60165bSWeongyo Jeong 	default:
1599dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev, "bogus frame type 0x%x (%s)\n",
1600dc60165bSWeongyo Jeong 			wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK, __func__);
1601dc60165bSWeongyo Jeong 		m_freem(m0);
1602dc60165bSWeongyo Jeong 		return (EIO);
1603dc60165bSWeongyo Jeong 	}
16045efea30fSAndrew Thompson 	if (vap->iv_state == IEEE80211_S_AUTH ||
16055efea30fSAndrew Thompson 	    vap->iv_state == IEEE80211_S_ASSOC ||
16065efea30fSAndrew Thompson 	    vap->iv_state == IEEE80211_S_RUN)
1607dc60165bSWeongyo Jeong 		desc->connid = htobe32(UATH_ID_BSS);
1608dc60165bSWeongyo Jeong 	else
1609dc60165bSWeongyo Jeong 		desc->connid = htobe32(UATH_ID_INVALID);
1610dc60165bSWeongyo Jeong 	desc->flags  = htobe32(0 /* no UATH_TX_NOTIFY */);
1611dc60165bSWeongyo Jeong 	desc->buflen = htobe32(m0->m_pkthdr.len);
1612dc60165bSWeongyo Jeong 
1613dc60165bSWeongyo Jeong #ifdef UATH_DEBUG
1614dc60165bSWeongyo Jeong 	DPRINTF(sc, UATH_DEBUG_XMIT,
1615dc60165bSWeongyo Jeong 	    "send frame ix %u framelen %d msglen %d connid 0x%x txqid 0x%x\n",
1616dc60165bSWeongyo Jeong 	    desc->msgid, framelen, msglen, be32toh(desc->connid),
1617dc60165bSWeongyo Jeong 	    be32toh(desc->txqid));
1618dc60165bSWeongyo Jeong 	if (sc->sc_debug & UATH_DEBUG_XMIT_DUMP)
1619dc60165bSWeongyo Jeong 		uath_dump_cmd(data->buf, data->buflen, '+');
1620dc60165bSWeongyo Jeong #endif
1621dc60165bSWeongyo Jeong 
1622dc60165bSWeongyo Jeong 	STAILQ_INSERT_TAIL(&sc->sc_tx_pending, data, next);
1623dc60165bSWeongyo Jeong 	UATH_STAT_INC(sc, st_tx_pending);
1624a593f6b8SAndrew Thompson 	usbd_transfer_start(sc->sc_xfer[UATH_BULK_TX]);
1625dc60165bSWeongyo Jeong 
1626dc60165bSWeongyo Jeong 	return (0);
1627dc60165bSWeongyo Jeong }
1628dc60165bSWeongyo Jeong 
1629dc60165bSWeongyo Jeong /*
1630dc60165bSWeongyo Jeong  * Cleanup driver resources when we run out of buffers while processing
1631dc60165bSWeongyo Jeong  * fragments; return the tx buffers allocated and drop node references.
1632dc60165bSWeongyo Jeong  */
1633dc60165bSWeongyo Jeong static void
1634dc60165bSWeongyo Jeong uath_txfrag_cleanup(struct uath_softc *sc,
1635dc60165bSWeongyo Jeong     uath_datahead *frags, struct ieee80211_node *ni)
1636dc60165bSWeongyo Jeong {
1637dc60165bSWeongyo Jeong 	struct uath_data *bf, *next;
1638dc60165bSWeongyo Jeong 
1639dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
1640dc60165bSWeongyo Jeong 
1641dc60165bSWeongyo Jeong 	STAILQ_FOREACH_SAFE(bf, frags, next, next) {
1642dc60165bSWeongyo Jeong 		/* NB: bf assumed clean */
1643dc60165bSWeongyo Jeong 		STAILQ_REMOVE_HEAD(frags, next);
1644dc60165bSWeongyo Jeong 		STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next);
1645dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_tx_inactive);
1646dc60165bSWeongyo Jeong 		ieee80211_node_decref(ni);
1647dc60165bSWeongyo Jeong 	}
1648dc60165bSWeongyo Jeong }
1649dc60165bSWeongyo Jeong 
1650dc60165bSWeongyo Jeong /*
1651dc60165bSWeongyo Jeong  * Setup xmit of a fragmented frame.  Allocate a buffer for each frag and bump
1652dc60165bSWeongyo Jeong  * the node reference count to reflect the held reference to be setup by
1653dc60165bSWeongyo Jeong  * uath_tx_start.
1654dc60165bSWeongyo Jeong  */
1655dc60165bSWeongyo Jeong static int
1656dc60165bSWeongyo Jeong uath_txfrag_setup(struct uath_softc *sc, uath_datahead *frags,
1657dc60165bSWeongyo Jeong     struct mbuf *m0, struct ieee80211_node *ni)
1658dc60165bSWeongyo Jeong {
1659dc60165bSWeongyo Jeong 	struct mbuf *m;
1660dc60165bSWeongyo Jeong 	struct uath_data *bf;
1661dc60165bSWeongyo Jeong 
1662dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
1663dc60165bSWeongyo Jeong 	for (m = m0->m_nextpkt; m != NULL; m = m->m_nextpkt) {
1664dc60165bSWeongyo Jeong 		bf = uath_getbuf(sc);
1665dc60165bSWeongyo Jeong 		if (bf == NULL) {       /* out of buffers, cleanup */
1666dc60165bSWeongyo Jeong 			uath_txfrag_cleanup(sc, frags, ni);
1667dc60165bSWeongyo Jeong 			break;
1668dc60165bSWeongyo Jeong 		}
1669dc60165bSWeongyo Jeong 		ieee80211_node_incref(ni);
1670dc60165bSWeongyo Jeong 		STAILQ_INSERT_TAIL(frags, bf, next);
1671dc60165bSWeongyo Jeong 	}
1672dc60165bSWeongyo Jeong 
1673dc60165bSWeongyo Jeong 	return !STAILQ_EMPTY(frags);
1674dc60165bSWeongyo Jeong }
1675dc60165bSWeongyo Jeong 
1676dc60165bSWeongyo Jeong /*
1677dc60165bSWeongyo Jeong  * Reclaim mbuf resources.  For fragmented frames we need to claim each frag
1678dc60165bSWeongyo Jeong  * chained with m_nextpkt.
1679dc60165bSWeongyo Jeong  */
1680dc60165bSWeongyo Jeong static void
1681dc60165bSWeongyo Jeong uath_freetx(struct mbuf *m)
1682dc60165bSWeongyo Jeong {
1683dc60165bSWeongyo Jeong 	struct mbuf *next;
1684dc60165bSWeongyo Jeong 
1685dc60165bSWeongyo Jeong 	do {
1686dc60165bSWeongyo Jeong 		next = m->m_nextpkt;
1687dc60165bSWeongyo Jeong 		m->m_nextpkt = NULL;
1688dc60165bSWeongyo Jeong 		m_freem(m);
1689dc60165bSWeongyo Jeong 	} while ((m = next) != NULL);
1690dc60165bSWeongyo Jeong }
1691dc60165bSWeongyo Jeong 
1692*7a79cebfSGleb Smirnoff static int
1693*7a79cebfSGleb Smirnoff uath_transmit(struct ieee80211com *ic, struct mbuf *m)
1694*7a79cebfSGleb Smirnoff {
1695*7a79cebfSGleb Smirnoff 	struct uath_softc *sc = ic->ic_softc;
1696*7a79cebfSGleb Smirnoff 	int error;
1697*7a79cebfSGleb Smirnoff 
1698*7a79cebfSGleb Smirnoff 	UATH_LOCK(sc);
1699*7a79cebfSGleb Smirnoff 	if ((sc->sc_flags & UATH_FLAG_INITDONE) == 0) {
1700*7a79cebfSGleb Smirnoff 		UATH_UNLOCK(sc);
1701*7a79cebfSGleb Smirnoff 		return (ENXIO);
1702*7a79cebfSGleb Smirnoff 	}
1703*7a79cebfSGleb Smirnoff 	error = mbufq_enqueue(&sc->sc_snd, m);
1704*7a79cebfSGleb Smirnoff 	if (error) {
1705*7a79cebfSGleb Smirnoff 		UATH_UNLOCK(sc);
1706*7a79cebfSGleb Smirnoff 		return (error);
1707*7a79cebfSGleb Smirnoff 	}
1708*7a79cebfSGleb Smirnoff 	uath_start(sc);
1709*7a79cebfSGleb Smirnoff 	UATH_UNLOCK(sc);
1710*7a79cebfSGleb Smirnoff 
1711*7a79cebfSGleb Smirnoff 	return (0);
1712*7a79cebfSGleb Smirnoff }
1713*7a79cebfSGleb Smirnoff 
1714dc60165bSWeongyo Jeong static void
1715*7a79cebfSGleb Smirnoff uath_start(struct uath_softc *sc)
1716dc60165bSWeongyo Jeong {
1717dc60165bSWeongyo Jeong 	struct uath_data *bf;
1718dc60165bSWeongyo Jeong 	struct ieee80211_node *ni;
1719dc60165bSWeongyo Jeong 	struct mbuf *m, *next;
1720dc60165bSWeongyo Jeong 	uath_datahead frags;
1721dc60165bSWeongyo Jeong 
1722*7a79cebfSGleb Smirnoff 	UATH_ASSERT_LOCKED(sc);
1723*7a79cebfSGleb Smirnoff 
1724*7a79cebfSGleb Smirnoff 	if ((sc->sc_flags & UATH_FLAG_INITDONE) == 0 ||
1725dc60165bSWeongyo Jeong 	    (sc->sc_flags & UATH_FLAG_INVALID))
1726dc60165bSWeongyo Jeong 		return;
1727dc60165bSWeongyo Jeong 
1728*7a79cebfSGleb Smirnoff 	while ((m = mbufq_dequeue(&sc->sc_snd)) != NULL) {
1729dc60165bSWeongyo Jeong 		bf = uath_getbuf(sc);
1730*7a79cebfSGleb Smirnoff 		if (bf == NULL) {
1731*7a79cebfSGleb Smirnoff 			mbufq_prepend(&sc->sc_snd, m);
1732dc60165bSWeongyo Jeong 			break;
1733dc60165bSWeongyo Jeong 		}
1734*7a79cebfSGleb Smirnoff 
1735dc60165bSWeongyo Jeong 		ni = (struct ieee80211_node *)m->m_pkthdr.rcvif;
1736dc60165bSWeongyo Jeong 		m->m_pkthdr.rcvif = NULL;
1737dc60165bSWeongyo Jeong 
1738dc60165bSWeongyo Jeong 		/*
1739dc60165bSWeongyo Jeong 		 * Check for fragmentation.  If this frame has been broken up
1740dc60165bSWeongyo Jeong 		 * verify we have enough buffers to send all the fragments
1741dc60165bSWeongyo Jeong 		 * so all go out or none...
1742dc60165bSWeongyo Jeong 		 */
1743dc60165bSWeongyo Jeong 		STAILQ_INIT(&frags);
1744dc60165bSWeongyo Jeong 		if ((m->m_flags & M_FRAG) &&
1745dc60165bSWeongyo Jeong 		    !uath_txfrag_setup(sc, &frags, m, ni)) {
1746dc60165bSWeongyo Jeong 			DPRINTF(sc, UATH_DEBUG_XMIT,
1747dc60165bSWeongyo Jeong 			    "%s: out of txfrag buffers\n", __func__);
1748dc60165bSWeongyo Jeong 			uath_freetx(m);
1749dc60165bSWeongyo Jeong 			goto bad;
1750dc60165bSWeongyo Jeong 		}
1751dc60165bSWeongyo Jeong 		sc->sc_seqnum = 0;
1752dc60165bSWeongyo Jeong 	nextfrag:
1753dc60165bSWeongyo Jeong 		/*
1754dc60165bSWeongyo Jeong 		 * Pass the frame to the h/w for transmission.
1755dc60165bSWeongyo Jeong 		 * Fragmented frames have each frag chained together
1756dc60165bSWeongyo Jeong 		 * with m_nextpkt.  We know there are sufficient uath_data's
1757dc60165bSWeongyo Jeong 		 * to send all the frags because of work done by
1758dc60165bSWeongyo Jeong 		 * uath_txfrag_setup.
1759dc60165bSWeongyo Jeong 		 */
1760dc60165bSWeongyo Jeong 		next = m->m_nextpkt;
1761dc60165bSWeongyo Jeong 		if (uath_tx_start(sc, m, ni, bf) != 0) {
1762dc60165bSWeongyo Jeong 	bad:
1763*7a79cebfSGleb Smirnoff 			if_inc_counter(ni->ni_vap->iv_ifp,
1764*7a79cebfSGleb Smirnoff 			    IFCOUNTER_OERRORS, 1);
1765dc60165bSWeongyo Jeong 	reclaim:
1766dc60165bSWeongyo Jeong 			STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next);
1767dc60165bSWeongyo Jeong 			UATH_STAT_INC(sc, st_tx_inactive);
1768dc60165bSWeongyo Jeong 			uath_txfrag_cleanup(sc, &frags, ni);
1769dc60165bSWeongyo Jeong 			ieee80211_free_node(ni);
1770dc60165bSWeongyo Jeong 			continue;
1771dc60165bSWeongyo Jeong 		}
1772dc60165bSWeongyo Jeong 
1773dc60165bSWeongyo Jeong 		if (next != NULL) {
1774dc60165bSWeongyo Jeong 			/*
1775dc60165bSWeongyo Jeong 			 * Beware of state changing between frags.
1776dc60165bSWeongyo Jeong 			 XXX check sta power-save state?
1777dc60165bSWeongyo Jeong 			*/
1778dc60165bSWeongyo Jeong 			if (ni->ni_vap->iv_state != IEEE80211_S_RUN) {
1779dc60165bSWeongyo Jeong 				DPRINTF(sc, UATH_DEBUG_XMIT,
1780dc60165bSWeongyo Jeong 				    "%s: flush fragmented packet, state %s\n",
1781dc60165bSWeongyo Jeong 				    __func__,
1782dc60165bSWeongyo Jeong 				    ieee80211_state_name[ni->ni_vap->iv_state]);
1783dc60165bSWeongyo Jeong 				uath_freetx(next);
1784dc60165bSWeongyo Jeong 				goto reclaim;
1785dc60165bSWeongyo Jeong 			}
1786dc60165bSWeongyo Jeong 			m = next;
1787dc60165bSWeongyo Jeong 			bf = STAILQ_FIRST(&frags);
1788dc60165bSWeongyo Jeong 			KASSERT(bf != NULL, ("no buf for txfrag"));
1789dc60165bSWeongyo Jeong 			STAILQ_REMOVE_HEAD(&frags, next);
1790dc60165bSWeongyo Jeong 			goto nextfrag;
1791dc60165bSWeongyo Jeong 		}
1792dc60165bSWeongyo Jeong 
1793dc60165bSWeongyo Jeong 		sc->sc_tx_timer = 5;
1794dc60165bSWeongyo Jeong 	}
1795dc60165bSWeongyo Jeong }
1796dc60165bSWeongyo Jeong 
1797dc60165bSWeongyo Jeong static int
1798dc60165bSWeongyo Jeong uath_raw_xmit(struct ieee80211_node *ni, struct mbuf *m,
1799dc60165bSWeongyo Jeong     const struct ieee80211_bpf_params *params)
1800dc60165bSWeongyo Jeong {
1801dc60165bSWeongyo Jeong 	struct ieee80211com *ic = ni->ni_ic;
1802dc60165bSWeongyo Jeong 	struct uath_data *bf;
1803d3fdd08cSAdrian Chadd 	struct uath_softc *sc = ic->ic_softc;
1804dc60165bSWeongyo Jeong 
1805*7a79cebfSGleb Smirnoff 	UATH_LOCK(sc);
1806dc60165bSWeongyo Jeong 	/* prevent management frames from being sent if we're not ready */
1807c39515adSWeongyo Jeong 	if ((sc->sc_flags & UATH_FLAG_INVALID) ||
1808*7a79cebfSGleb Smirnoff 	    !(sc->sc_flags & UATH_FLAG_INITDONE)) {
1809dc60165bSWeongyo Jeong 		m_freem(m);
1810dc60165bSWeongyo Jeong 		ieee80211_free_node(ni);
1811*7a79cebfSGleb Smirnoff 		UATH_UNLOCK(sc);
1812dc60165bSWeongyo Jeong 		return (ENETDOWN);
1813dc60165bSWeongyo Jeong 	}
1814dc60165bSWeongyo Jeong 
1815dc60165bSWeongyo Jeong 	/* grab a TX buffer  */
1816dc60165bSWeongyo Jeong 	bf = uath_getbuf(sc);
1817dc60165bSWeongyo Jeong 	if (bf == NULL) {
1818dc60165bSWeongyo Jeong 		ieee80211_free_node(ni);
1819dc60165bSWeongyo Jeong 		m_freem(m);
1820dc60165bSWeongyo Jeong 		UATH_UNLOCK(sc);
1821dc60165bSWeongyo Jeong 		return (ENOBUFS);
1822dc60165bSWeongyo Jeong 	}
1823dc60165bSWeongyo Jeong 
1824dc60165bSWeongyo Jeong 	sc->sc_seqnum = 0;
1825dc60165bSWeongyo Jeong 	if (uath_tx_start(sc, m, ni, bf) != 0) {
1826dc60165bSWeongyo Jeong 		ieee80211_free_node(ni);
1827dc60165bSWeongyo Jeong 		STAILQ_INSERT_HEAD(&sc->sc_tx_inactive, bf, next);
1828dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_tx_inactive);
1829dc60165bSWeongyo Jeong 		UATH_UNLOCK(sc);
1830dc60165bSWeongyo Jeong 		return (EIO);
1831dc60165bSWeongyo Jeong 	}
1832dc60165bSWeongyo Jeong 	UATH_UNLOCK(sc);
1833dc60165bSWeongyo Jeong 
1834dc60165bSWeongyo Jeong 	sc->sc_tx_timer = 5;
1835dc60165bSWeongyo Jeong 	return (0);
1836dc60165bSWeongyo Jeong }
1837dc60165bSWeongyo Jeong 
1838dc60165bSWeongyo Jeong static void
1839dc60165bSWeongyo Jeong uath_scan_start(struct ieee80211com *ic)
1840dc60165bSWeongyo Jeong {
1841dc60165bSWeongyo Jeong 	/* do nothing  */
1842dc60165bSWeongyo Jeong }
1843dc60165bSWeongyo Jeong 
1844dc60165bSWeongyo Jeong static void
1845dc60165bSWeongyo Jeong uath_scan_end(struct ieee80211com *ic)
1846dc60165bSWeongyo Jeong {
1847dc60165bSWeongyo Jeong 	/* do nothing  */
1848dc60165bSWeongyo Jeong }
1849dc60165bSWeongyo Jeong 
1850dc60165bSWeongyo Jeong static void
1851dc60165bSWeongyo Jeong uath_set_channel(struct ieee80211com *ic)
1852dc60165bSWeongyo Jeong {
1853d3fdd08cSAdrian Chadd 	struct uath_softc *sc = ic->ic_softc;
1854dc60165bSWeongyo Jeong 
1855dc60165bSWeongyo Jeong 	UATH_LOCK(sc);
1856c39515adSWeongyo Jeong 	if ((sc->sc_flags & UATH_FLAG_INVALID) ||
1857*7a79cebfSGleb Smirnoff 	    (sc->sc_flags & UATH_FLAG_INITDONE) == 0) {
1858c39515adSWeongyo Jeong 		UATH_UNLOCK(sc);
1859c39515adSWeongyo Jeong 		return;
1860c39515adSWeongyo Jeong 	}
1861dc60165bSWeongyo Jeong 	(void)uath_switch_channel(sc, ic->ic_curchan);
1862dc60165bSWeongyo Jeong 	UATH_UNLOCK(sc);
1863dc60165bSWeongyo Jeong }
1864dc60165bSWeongyo Jeong 
1865dc60165bSWeongyo Jeong static int
1866dc60165bSWeongyo Jeong uath_set_rxmulti_filter(struct uath_softc *sc)
1867dc60165bSWeongyo Jeong {
18685463c4a4SSam Leffler 	/* XXX broken */
1869dc60165bSWeongyo Jeong 	return (0);
1870dc60165bSWeongyo Jeong }
1871dc60165bSWeongyo Jeong static void
1872272f6adeSGleb Smirnoff uath_update_mcast(struct ieee80211com *ic)
1873dc60165bSWeongyo Jeong {
1874272f6adeSGleb Smirnoff 	struct uath_softc *sc = ic->ic_softc;
1875dc60165bSWeongyo Jeong 
18765463c4a4SSam Leffler 	UATH_LOCK(sc);
1877c39515adSWeongyo Jeong 	if ((sc->sc_flags & UATH_FLAG_INVALID) ||
1878*7a79cebfSGleb Smirnoff 	    (sc->sc_flags & UATH_FLAG_INITDONE) == 0) {
1879c39515adSWeongyo Jeong 		UATH_UNLOCK(sc);
1880c39515adSWeongyo Jeong 		return;
1881c39515adSWeongyo Jeong 	}
1882dc60165bSWeongyo Jeong 	/*
1883dc60165bSWeongyo Jeong 	 * this is for avoiding the race condition when we're try to
1884dc60165bSWeongyo Jeong 	 * connect to the AP with WPA.
1885dc60165bSWeongyo Jeong 	 */
18865463c4a4SSam Leffler 	if (sc->sc_flags & UATH_FLAG_INITDONE)
1887dc60165bSWeongyo Jeong 		(void)uath_set_rxmulti_filter(sc);
18885463c4a4SSam Leffler 	UATH_UNLOCK(sc);
1889dc60165bSWeongyo Jeong }
1890dc60165bSWeongyo Jeong 
1891dc60165bSWeongyo Jeong static void
1892272f6adeSGleb Smirnoff uath_update_promisc(struct ieee80211com *ic)
1893dc60165bSWeongyo Jeong {
1894272f6adeSGleb Smirnoff 	struct uath_softc *sc = ic->ic_softc;
1895dc60165bSWeongyo Jeong 
18965463c4a4SSam Leffler 	UATH_LOCK(sc);
1897c39515adSWeongyo Jeong 	if ((sc->sc_flags & UATH_FLAG_INVALID) ||
1898*7a79cebfSGleb Smirnoff 	    (sc->sc_flags & UATH_FLAG_INITDONE) == 0) {
1899c39515adSWeongyo Jeong 		UATH_UNLOCK(sc);
1900c39515adSWeongyo Jeong 		return;
1901c39515adSWeongyo Jeong 	}
19025463c4a4SSam Leffler 	if (sc->sc_flags & UATH_FLAG_INITDONE) {
1903dc60165bSWeongyo Jeong 		uath_set_rxfilter(sc,
1904dc60165bSWeongyo Jeong 		    UATH_FILTER_RX_UCAST | UATH_FILTER_RX_MCAST |
1905dc60165bSWeongyo Jeong 		    UATH_FILTER_RX_BCAST | UATH_FILTER_RX_BEACON |
1906dc60165bSWeongyo Jeong 		    UATH_FILTER_RX_PROM, UATH_FILTER_OP_SET);
1907dc60165bSWeongyo Jeong 	}
19085463c4a4SSam Leffler 	UATH_UNLOCK(sc);
19095463c4a4SSam Leffler }
1910dc60165bSWeongyo Jeong 
1911dc60165bSWeongyo Jeong static int
1912dc60165bSWeongyo Jeong uath_create_connection(struct uath_softc *sc, uint32_t connid)
1913dc60165bSWeongyo Jeong {
1914dc60165bSWeongyo Jeong 	const struct ieee80211_rateset *rs;
1915*7a79cebfSGleb Smirnoff 	struct ieee80211com *ic = &sc->sc_ic;
1916dc60165bSWeongyo Jeong 	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
19178d8bdb01SAndrew Thompson 	struct ieee80211_node *ni;
1918dc60165bSWeongyo Jeong 	struct uath_cmd_create_connection create;
1919dc60165bSWeongyo Jeong 
19208d8bdb01SAndrew Thompson 	ni = ieee80211_ref_node(vap->iv_bss);
1921271ae033SHans Petter Selasky 	memset(&create, 0, sizeof(create));
1922dc60165bSWeongyo Jeong 	create.connid = htobe32(connid);
1923dc60165bSWeongyo Jeong 	create.bssid = htobe32(0);
1924dc60165bSWeongyo Jeong 	/* XXX packed or not?  */
1925dc60165bSWeongyo Jeong 	create.size = htobe32(sizeof(struct uath_cmd_rateset));
1926dc60165bSWeongyo Jeong 
1927dc60165bSWeongyo Jeong 	rs = &ni->ni_rates;
1928dc60165bSWeongyo Jeong 	create.connattr.rateset.length = rs->rs_nrates;
1929dc60165bSWeongyo Jeong 	bcopy(rs->rs_rates, &create.connattr.rateset.set[0],
1930dc60165bSWeongyo Jeong 	    rs->rs_nrates);
1931dc60165bSWeongyo Jeong 
1932dc60165bSWeongyo Jeong 	/* XXX turbo */
1933dc60165bSWeongyo Jeong 	if (IEEE80211_IS_CHAN_A(ni->ni_chan))
1934dc60165bSWeongyo Jeong 		create.connattr.wlanmode = htobe32(WLAN_MODE_11a);
1935dc60165bSWeongyo Jeong 	else if (IEEE80211_IS_CHAN_ANYG(ni->ni_chan))
1936dc60165bSWeongyo Jeong 		create.connattr.wlanmode = htobe32(WLAN_MODE_11g);
1937dc60165bSWeongyo Jeong 	else
1938dc60165bSWeongyo Jeong 		create.connattr.wlanmode = htobe32(WLAN_MODE_11b);
19398d8bdb01SAndrew Thompson 	ieee80211_free_node(ni);
1940dc60165bSWeongyo Jeong 
1941dc60165bSWeongyo Jeong 	return uath_cmd_write(sc, WDCMSG_CREATE_CONNECTION, &create,
1942dc60165bSWeongyo Jeong 	    sizeof create, 0);
1943dc60165bSWeongyo Jeong }
1944dc60165bSWeongyo Jeong 
1945dc60165bSWeongyo Jeong static int
1946dc60165bSWeongyo Jeong uath_set_rates(struct uath_softc *sc, const struct ieee80211_rateset *rs)
1947dc60165bSWeongyo Jeong {
1948dc60165bSWeongyo Jeong 	struct uath_cmd_rates rates;
1949dc60165bSWeongyo Jeong 
1950271ae033SHans Petter Selasky 	memset(&rates, 0, sizeof(rates));
1951dc60165bSWeongyo Jeong 	rates.connid = htobe32(UATH_ID_BSS);		/* XXX */
1952dc60165bSWeongyo Jeong 	rates.size   = htobe32(sizeof(struct uath_cmd_rateset));
1953dc60165bSWeongyo Jeong 	/* XXX bounds check rs->rs_nrates */
1954dc60165bSWeongyo Jeong 	rates.rateset.length = rs->rs_nrates;
1955dc60165bSWeongyo Jeong 	bcopy(rs->rs_rates, &rates.rateset.set[0], rs->rs_nrates);
1956dc60165bSWeongyo Jeong 
1957dc60165bSWeongyo Jeong 	DPRINTF(sc, UATH_DEBUG_RATES,
1958dc60165bSWeongyo Jeong 	    "setting supported rates nrates=%d\n", rs->rs_nrates);
1959dc60165bSWeongyo Jeong 	return uath_cmd_write(sc, WDCMSG_SET_BASIC_RATE,
1960dc60165bSWeongyo Jeong 	    &rates, sizeof rates, 0);
1961dc60165bSWeongyo Jeong }
1962dc60165bSWeongyo Jeong 
1963dc60165bSWeongyo Jeong static int
1964dc60165bSWeongyo Jeong uath_write_associd(struct uath_softc *sc)
1965dc60165bSWeongyo Jeong {
1966*7a79cebfSGleb Smirnoff 	struct ieee80211com *ic = &sc->sc_ic;
1967dc60165bSWeongyo Jeong 	struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
19688d8bdb01SAndrew Thompson 	struct ieee80211_node *ni;
1969dc60165bSWeongyo Jeong 	struct uath_cmd_set_associd associd;
1970dc60165bSWeongyo Jeong 
19718d8bdb01SAndrew Thompson 	ni = ieee80211_ref_node(vap->iv_bss);
1972271ae033SHans Petter Selasky 	memset(&associd, 0, sizeof(associd));
1973dc60165bSWeongyo Jeong 	associd.defaultrateix = htobe32(1);	/* XXX */
1974dc60165bSWeongyo Jeong 	associd.associd = htobe32(ni->ni_associd);
1975dc60165bSWeongyo Jeong 	associd.timoffset = htobe32(0x3b);	/* XXX */
1976dc60165bSWeongyo Jeong 	IEEE80211_ADDR_COPY(associd.bssid, ni->ni_bssid);
19778d8bdb01SAndrew Thompson 	ieee80211_free_node(ni);
1978dc60165bSWeongyo Jeong 	return uath_cmd_write(sc, WDCMSG_WRITE_ASSOCID, &associd,
1979dc60165bSWeongyo Jeong 	    sizeof associd, 0);
1980dc60165bSWeongyo Jeong }
1981dc60165bSWeongyo Jeong 
1982dc60165bSWeongyo Jeong static int
1983dc60165bSWeongyo Jeong uath_set_ledsteady(struct uath_softc *sc, int lednum, int ledmode)
1984dc60165bSWeongyo Jeong {
1985dc60165bSWeongyo Jeong 	struct uath_cmd_ledsteady led;
1986dc60165bSWeongyo Jeong 
1987dc60165bSWeongyo Jeong 	led.lednum = htobe32(lednum);
1988dc60165bSWeongyo Jeong 	led.ledmode = htobe32(ledmode);
1989dc60165bSWeongyo Jeong 
1990dc60165bSWeongyo Jeong 	DPRINTF(sc, UATH_DEBUG_LED, "set %s led %s (steady)\n",
1991dc60165bSWeongyo Jeong 	    (lednum == UATH_LED_LINK) ? "link" : "activity",
1992dc60165bSWeongyo Jeong 	    ledmode ? "on" : "off");
1993dc60165bSWeongyo Jeong 	return uath_cmd_write(sc, WDCMSG_SET_LED_STEADY, &led, sizeof led, 0);
1994dc60165bSWeongyo Jeong }
1995dc60165bSWeongyo Jeong 
1996dc60165bSWeongyo Jeong static int
1997dc60165bSWeongyo Jeong uath_set_ledblink(struct uath_softc *sc, int lednum, int ledmode,
1998dc60165bSWeongyo Jeong 	int blinkrate, int slowmode)
1999dc60165bSWeongyo Jeong {
2000dc60165bSWeongyo Jeong 	struct uath_cmd_ledblink led;
2001dc60165bSWeongyo Jeong 
2002dc60165bSWeongyo Jeong 	led.lednum = htobe32(lednum);
2003dc60165bSWeongyo Jeong 	led.ledmode = htobe32(ledmode);
2004dc60165bSWeongyo Jeong 	led.blinkrate = htobe32(blinkrate);
2005dc60165bSWeongyo Jeong 	led.slowmode = htobe32(slowmode);
2006dc60165bSWeongyo Jeong 
2007dc60165bSWeongyo Jeong 	DPRINTF(sc, UATH_DEBUG_LED, "set %s led %s (blink)\n",
2008dc60165bSWeongyo Jeong 	    (lednum == UATH_LED_LINK) ? "link" : "activity",
2009dc60165bSWeongyo Jeong 	    ledmode ? "on" : "off");
2010dc60165bSWeongyo Jeong 	return uath_cmd_write(sc, WDCMSG_SET_LED_BLINK, &led, sizeof led, 0);
2011dc60165bSWeongyo Jeong }
2012dc60165bSWeongyo Jeong 
2013dc60165bSWeongyo Jeong static int
2014dc60165bSWeongyo Jeong uath_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg)
2015dc60165bSWeongyo Jeong {
2016dc60165bSWeongyo Jeong 	enum ieee80211_state ostate = vap->iv_state;
2017dc60165bSWeongyo Jeong 	int error;
20188d8bdb01SAndrew Thompson 	struct ieee80211_node *ni;
2019dc60165bSWeongyo Jeong 	struct ieee80211com *ic = vap->iv_ic;
2020d3fdd08cSAdrian Chadd 	struct uath_softc *sc = ic->ic_softc;
2021dc60165bSWeongyo Jeong 	struct uath_vap *uvp = UATH_VAP(vap);
2022dc60165bSWeongyo Jeong 
2023dc60165bSWeongyo Jeong 	DPRINTF(sc, UATH_DEBUG_STATE,
2024dc60165bSWeongyo Jeong 	    "%s: %s -> %s\n", __func__, ieee80211_state_name[vap->iv_state],
2025dc60165bSWeongyo Jeong 	    ieee80211_state_name[nstate]);
2026dc60165bSWeongyo Jeong 
20275efea30fSAndrew Thompson 	IEEE80211_UNLOCK(ic);
2028dc60165bSWeongyo Jeong 	UATH_LOCK(sc);
2029dc60165bSWeongyo Jeong 	callout_stop(&sc->stat_ch);
2030dc60165bSWeongyo Jeong 	callout_stop(&sc->watchdog_ch);
20318d8bdb01SAndrew Thompson 	ni = ieee80211_ref_node(vap->iv_bss);
2032dc60165bSWeongyo Jeong 
2033dc60165bSWeongyo Jeong 	switch (nstate) {
2034dc60165bSWeongyo Jeong 	case IEEE80211_S_INIT:
2035dc60165bSWeongyo Jeong 		if (ostate == IEEE80211_S_RUN) {
2036dc60165bSWeongyo Jeong 			/* turn link and activity LEDs off */
2037dc60165bSWeongyo Jeong 			uath_set_ledstate(sc, 0);
2038dc60165bSWeongyo Jeong 		}
2039dc60165bSWeongyo Jeong 		break;
2040dc60165bSWeongyo Jeong 
2041dc60165bSWeongyo Jeong 	case IEEE80211_S_SCAN:
2042dc60165bSWeongyo Jeong 		break;
2043dc60165bSWeongyo Jeong 
2044dc60165bSWeongyo Jeong 	case IEEE80211_S_AUTH:
2045dc60165bSWeongyo Jeong 		/* XXX good place?  set RTS threshold  */
2046dc60165bSWeongyo Jeong 		uath_config(sc, CFG_USER_RTS_THRESHOLD, vap->iv_rtsthreshold);
2047dc60165bSWeongyo Jeong 		/* XXX bad place  */
2048dc60165bSWeongyo Jeong 		error = uath_set_keys(sc, vap);
2049dc60165bSWeongyo Jeong 		if (error != 0) {
2050dc60165bSWeongyo Jeong 			device_printf(sc->sc_dev,
2051dc60165bSWeongyo Jeong 			    "could not set crypto keys, error %d\n", error);
2052dc60165bSWeongyo Jeong 			break;
2053dc60165bSWeongyo Jeong 		}
2054dc60165bSWeongyo Jeong 		if (uath_switch_channel(sc, ni->ni_chan) != 0) {
2055dc60165bSWeongyo Jeong 			device_printf(sc->sc_dev, "could not switch channel\n");
2056dc60165bSWeongyo Jeong 			break;
2057dc60165bSWeongyo Jeong 		}
2058dc60165bSWeongyo Jeong 		if (uath_create_connection(sc, UATH_ID_BSS) != 0) {
2059dc60165bSWeongyo Jeong 			device_printf(sc->sc_dev,
2060dc60165bSWeongyo Jeong 			    "could not create connection\n");
2061dc60165bSWeongyo Jeong 			break;
2062dc60165bSWeongyo Jeong 		}
2063dc60165bSWeongyo Jeong 		break;
2064dc60165bSWeongyo Jeong 
2065dc60165bSWeongyo Jeong 	case IEEE80211_S_ASSOC:
2066dc60165bSWeongyo Jeong 		if (uath_set_rates(sc, &ni->ni_rates) != 0) {
2067dc60165bSWeongyo Jeong 			device_printf(sc->sc_dev,
2068dc60165bSWeongyo Jeong 			    "could not set negotiated rate set\n");
2069dc60165bSWeongyo Jeong 			break;
2070dc60165bSWeongyo Jeong 		}
2071dc60165bSWeongyo Jeong 		break;
2072dc60165bSWeongyo Jeong 
2073dc60165bSWeongyo Jeong 	case IEEE80211_S_RUN:
2074dc60165bSWeongyo Jeong 		/* XXX monitor mode doesn't be tested  */
2075dc60165bSWeongyo Jeong 		if (ic->ic_opmode == IEEE80211_M_MONITOR) {
2076dc60165bSWeongyo Jeong 			uath_set_ledstate(sc, 1);
2077dc60165bSWeongyo Jeong 			break;
2078dc60165bSWeongyo Jeong 		}
2079dc60165bSWeongyo Jeong 
2080dc60165bSWeongyo Jeong 		/*
2081dc60165bSWeongyo Jeong 		 * Tx rate is controlled by firmware, report the maximum
2082dc60165bSWeongyo Jeong 		 * negotiated rate in ifconfig output.
2083dc60165bSWeongyo Jeong 		 */
2084dc60165bSWeongyo Jeong 		ni->ni_txrate = ni->ni_rates.rs_rates[ni->ni_rates.rs_nrates-1];
2085dc60165bSWeongyo Jeong 
2086dc60165bSWeongyo Jeong 		if (uath_write_associd(sc) != 0) {
2087dc60165bSWeongyo Jeong 			device_printf(sc->sc_dev,
2088dc60165bSWeongyo Jeong 			    "could not write association id\n");
2089dc60165bSWeongyo Jeong 			break;
2090dc60165bSWeongyo Jeong 		}
2091dc60165bSWeongyo Jeong 		/* turn link LED on */
2092dc60165bSWeongyo Jeong 		uath_set_ledsteady(sc, UATH_LED_LINK, UATH_LED_ON);
2093dc60165bSWeongyo Jeong 		/* make activity LED blink */
2094dc60165bSWeongyo Jeong 		uath_set_ledblink(sc, UATH_LED_ACTIVITY, UATH_LED_ON, 1, 2);
2095dc60165bSWeongyo Jeong 		/* set state to associated */
2096dc60165bSWeongyo Jeong 		uath_set_ledstate(sc, 1);
2097dc60165bSWeongyo Jeong 
2098dc60165bSWeongyo Jeong 		/* start statistics timer */
2099dc60165bSWeongyo Jeong 		callout_reset(&sc->stat_ch, hz, uath_stat, sc);
2100dc60165bSWeongyo Jeong 		break;
2101dc60165bSWeongyo Jeong 	default:
2102dc60165bSWeongyo Jeong 		break;
2103dc60165bSWeongyo Jeong 	}
21048d8bdb01SAndrew Thompson 	ieee80211_free_node(ni);
2105dc60165bSWeongyo Jeong 	UATH_UNLOCK(sc);
2106dc60165bSWeongyo Jeong 	IEEE80211_LOCK(ic);
21075efea30fSAndrew Thompson 	return (uvp->newstate(vap, nstate, arg));
2108dc60165bSWeongyo Jeong }
2109dc60165bSWeongyo Jeong 
2110dc60165bSWeongyo Jeong static int
2111dc60165bSWeongyo Jeong uath_set_key(struct uath_softc *sc, const struct ieee80211_key *wk,
2112dc60165bSWeongyo Jeong     int index)
2113dc60165bSWeongyo Jeong {
2114dc60165bSWeongyo Jeong #if 0
2115dc60165bSWeongyo Jeong 	struct uath_cmd_crypto crypto;
2116dc60165bSWeongyo Jeong 	int i;
2117dc60165bSWeongyo Jeong 
2118271ae033SHans Petter Selasky 	memset(&crypto, 0, sizeof(crypto));
2119dc60165bSWeongyo Jeong 	crypto.keyidx = htobe32(index);
2120dc60165bSWeongyo Jeong 	crypto.magic1 = htobe32(1);
2121dc60165bSWeongyo Jeong 	crypto.size   = htobe32(368);
2122dc60165bSWeongyo Jeong 	crypto.mask   = htobe32(0xffff);
2123dc60165bSWeongyo Jeong 	crypto.flags  = htobe32(0x80000068);
2124dc60165bSWeongyo Jeong 	if (index != UATH_DEFAULT_KEY)
2125dc60165bSWeongyo Jeong 		crypto.flags |= htobe32(index << 16);
2126271ae033SHans Petter Selasky 	memset(crypto.magic2, 0xff, sizeof(crypto.magic2));
2127dc60165bSWeongyo Jeong 
2128dc60165bSWeongyo Jeong 	/*
2129dc60165bSWeongyo Jeong 	 * Each byte of the key must be XOR'ed with 10101010 before being
2130dc60165bSWeongyo Jeong 	 * transmitted to the firmware.
2131dc60165bSWeongyo Jeong 	 */
2132dc60165bSWeongyo Jeong 	for (i = 0; i < wk->wk_keylen; i++)
2133dc60165bSWeongyo Jeong 		crypto.key[i] = wk->wk_key[i] ^ 0xaa;
2134dc60165bSWeongyo Jeong 
2135dc60165bSWeongyo Jeong 	DPRINTF(sc, UATH_DEBUG_CRYPTO,
2136dc60165bSWeongyo Jeong 	    "setting crypto key index=%d len=%d\n", index, wk->wk_keylen);
2137dc60165bSWeongyo Jeong 	return uath_cmd_write(sc, WDCMSG_SET_KEY_CACHE_ENTRY, &crypto,
2138dc60165bSWeongyo Jeong 	    sizeof crypto, 0);
2139dc60165bSWeongyo Jeong #else
2140dc60165bSWeongyo Jeong 	/* XXX support H/W cryto  */
2141dc60165bSWeongyo Jeong 	return (0);
2142dc60165bSWeongyo Jeong #endif
2143dc60165bSWeongyo Jeong }
2144dc60165bSWeongyo Jeong 
2145dc60165bSWeongyo Jeong static int
2146dc60165bSWeongyo Jeong uath_set_keys(struct uath_softc *sc, struct ieee80211vap *vap)
2147dc60165bSWeongyo Jeong {
2148dc60165bSWeongyo Jeong 	int i, error;
2149dc60165bSWeongyo Jeong 
2150dc60165bSWeongyo Jeong 	error = 0;
2151dc60165bSWeongyo Jeong 	for (i = 0; i < IEEE80211_WEP_NKID; i++) {
2152dc60165bSWeongyo Jeong 		const struct ieee80211_key *wk = &vap->iv_nw_keys[i];
2153dc60165bSWeongyo Jeong 
2154dc60165bSWeongyo Jeong 		if (wk->wk_flags & (IEEE80211_KEY_XMIT|IEEE80211_KEY_RECV)) {
2155dc60165bSWeongyo Jeong 			error = uath_set_key(sc, wk, i);
2156dc60165bSWeongyo Jeong 			if (error)
2157dc60165bSWeongyo Jeong 				return (error);
2158dc60165bSWeongyo Jeong 		}
2159dc60165bSWeongyo Jeong 	}
2160dc60165bSWeongyo Jeong 	if (vap->iv_def_txkey != IEEE80211_KEYIX_NONE) {
2161dc60165bSWeongyo Jeong 		error = uath_set_key(sc, &vap->iv_nw_keys[vap->iv_def_txkey],
2162dc60165bSWeongyo Jeong 			UATH_DEFAULT_KEY);
2163dc60165bSWeongyo Jeong 	}
2164dc60165bSWeongyo Jeong 	return (error);
2165dc60165bSWeongyo Jeong }
2166dc60165bSWeongyo Jeong 
2167dc60165bSWeongyo Jeong #define	UATH_SYSCTL_STAT_ADD32(c, h, n, p, d)	\
2168dc60165bSWeongyo Jeong 	    SYSCTL_ADD_UINT(c, h, OID_AUTO, n, CTLFLAG_RD, p, 0, d)
2169dc60165bSWeongyo Jeong 
2170dc60165bSWeongyo Jeong static void
2171dc60165bSWeongyo Jeong uath_sysctl_node(struct uath_softc *sc)
2172dc60165bSWeongyo Jeong {
2173dc60165bSWeongyo Jeong 	struct sysctl_ctx_list *ctx;
2174dc60165bSWeongyo Jeong 	struct sysctl_oid_list *child;
2175dc60165bSWeongyo Jeong 	struct sysctl_oid *tree;
2176dc60165bSWeongyo Jeong 	struct uath_stat *stats;
2177dc60165bSWeongyo Jeong 
2178dc60165bSWeongyo Jeong 	stats = &sc->sc_stat;
2179dc60165bSWeongyo Jeong 	ctx = device_get_sysctl_ctx(sc->sc_dev);
2180dc60165bSWeongyo Jeong 	child = SYSCTL_CHILDREN(device_get_sysctl_tree(sc->sc_dev));
2181dc60165bSWeongyo Jeong 
2182dc60165bSWeongyo Jeong 	tree = SYSCTL_ADD_NODE(ctx, child, OID_AUTO, "stats", CTLFLAG_RD,
2183dc60165bSWeongyo Jeong 	    NULL, "UATH statistics");
2184dc60165bSWeongyo Jeong 	child = SYSCTL_CHILDREN(tree);
2185dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "badchunkseqnum",
2186dc60165bSWeongyo Jeong 	    &stats->st_badchunkseqnum, "Bad chunk sequence numbers");
2187dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "invalidlen", &stats->st_invalidlen,
2188dc60165bSWeongyo Jeong 	    "Invalid length");
2189dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "multichunk", &stats->st_multichunk,
2190dc60165bSWeongyo Jeong 	    "Multi chunks");
2191dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "toobigrxpkt",
2192dc60165bSWeongyo Jeong 	    &stats->st_toobigrxpkt, "Too big rx packets");
2193dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "stopinprogress",
2194dc60165bSWeongyo Jeong 	    &stats->st_stopinprogress, "Stop in progress");
2195dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "crcerrs", &stats->st_crcerr,
2196dc60165bSWeongyo Jeong 	    "CRC errors");
2197dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "phyerr", &stats->st_phyerr,
2198dc60165bSWeongyo Jeong 	    "PHY errors");
2199dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "decrypt_crcerr",
2200dc60165bSWeongyo Jeong 	    &stats->st_decrypt_crcerr, "Decryption CRC errors");
2201dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "decrypt_micerr",
2202dc60165bSWeongyo Jeong 	    &stats->st_decrypt_micerr, "Decryption Misc errors");
2203dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "decomperr", &stats->st_decomperr,
2204dc60165bSWeongyo Jeong 	    "Decomp errors");
2205dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "keyerr", &stats->st_keyerr,
2206dc60165bSWeongyo Jeong 	    "Key errors");
2207dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "err", &stats->st_err,
2208dc60165bSWeongyo Jeong 	    "Unknown errors");
2209dc60165bSWeongyo Jeong 
2210dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_active",
2211dc60165bSWeongyo Jeong 	    &stats->st_cmd_active, "Active numbers in Command queue");
2212dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_inactive",
2213dc60165bSWeongyo Jeong 	    &stats->st_cmd_inactive, "Inactive numbers in Command queue");
2214dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_pending",
2215dc60165bSWeongyo Jeong 	    &stats->st_cmd_pending, "Pending numbers in Command queue");
2216dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "cmd_waiting",
2217dc60165bSWeongyo Jeong 	    &stats->st_cmd_waiting, "Waiting numbers in Command queue");
2218dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "rx_active",
2219dc60165bSWeongyo Jeong 	    &stats->st_rx_active, "Active numbers in RX queue");
2220dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "rx_inactive",
2221dc60165bSWeongyo Jeong 	    &stats->st_rx_inactive, "Inactive numbers in RX queue");
2222dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "tx_active",
2223dc60165bSWeongyo Jeong 	    &stats->st_tx_active, "Active numbers in TX queue");
2224dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "tx_inactive",
2225dc60165bSWeongyo Jeong 	    &stats->st_tx_inactive, "Inactive numbers in TX queue");
2226dc60165bSWeongyo Jeong 	UATH_SYSCTL_STAT_ADD32(ctx, child, "tx_pending",
2227dc60165bSWeongyo Jeong 	    &stats->st_tx_pending, "Pending numbers in TX queue");
2228dc60165bSWeongyo Jeong }
2229dc60165bSWeongyo Jeong 
2230dc60165bSWeongyo Jeong #undef UATH_SYSCTL_STAT_ADD32
2231dc60165bSWeongyo Jeong 
2232dc60165bSWeongyo Jeong static void
2233dc60165bSWeongyo Jeong uath_cmdeof(struct uath_softc *sc, struct uath_cmd *cmd)
2234dc60165bSWeongyo Jeong {
2235dc60165bSWeongyo Jeong 	struct uath_cmd_hdr *hdr;
2236dc60165bSWeongyo Jeong 	int dlen;
2237dc60165bSWeongyo Jeong 
2238dc60165bSWeongyo Jeong 	hdr = (struct uath_cmd_hdr *)cmd->buf;
2239dc60165bSWeongyo Jeong 	/* NB: msgid is passed thru w/o byte swapping */
2240dc60165bSWeongyo Jeong #ifdef UATH_DEBUG
2241dc60165bSWeongyo Jeong 	if (sc->sc_debug & UATH_DEBUG_CMDS) {
2242dc60165bSWeongyo Jeong 		int len = be32toh(hdr->len);
2243dc60165bSWeongyo Jeong 		printf("%s: %s [ix %u] len %u status %u\n",
2244dc60165bSWeongyo Jeong 		    __func__, uath_codename(be32toh(hdr->code)),
2245dc60165bSWeongyo Jeong 		    hdr->msgid, len, be32toh(hdr->magic));
2246dc60165bSWeongyo Jeong 		if (sc->sc_debug & UATH_DEBUG_CMDS_DUMP)
2247dc60165bSWeongyo Jeong 			uath_dump_cmd(cmd->buf,
2248dc60165bSWeongyo Jeong 			    len > UATH_MAX_CMDSZ ? sizeof(*hdr) : len, '-');
2249dc60165bSWeongyo Jeong 	}
2250dc60165bSWeongyo Jeong #endif
2251dc60165bSWeongyo Jeong 	hdr->code = be32toh(hdr->code);
2252dc60165bSWeongyo Jeong 	hdr->len = be32toh(hdr->len);
2253dc60165bSWeongyo Jeong 	hdr->magic = be32toh(hdr->magic);	/* target status on return */
2254dc60165bSWeongyo Jeong 
2255dc60165bSWeongyo Jeong 	switch (hdr->code & 0xff) {
2256dc60165bSWeongyo Jeong 	/* reply to a read command */
2257dc60165bSWeongyo Jeong 	default:
2258dc60165bSWeongyo Jeong 		dlen = hdr->len - sizeof(*hdr);
22596d917491SHans Petter Selasky 		if (dlen < 0) {
22606d917491SHans Petter Selasky 			device_printf(sc->sc_dev,
22616d917491SHans Petter Selasky 			    "Invalid header length %d\n", dlen);
22626d917491SHans Petter Selasky 			return;
22636d917491SHans Petter Selasky 		}
2264dc60165bSWeongyo Jeong 		DPRINTF(sc, UATH_DEBUG_RX_PROC | UATH_DEBUG_RECV_ALL,
2265dc60165bSWeongyo Jeong 		    "%s: code %d data len %u\n",
2266dc60165bSWeongyo Jeong 		    __func__, hdr->code & 0xff, dlen);
2267dc60165bSWeongyo Jeong 		/*
2268dc60165bSWeongyo Jeong 		 * The first response from the target after the
2269dc60165bSWeongyo Jeong 		 * HOST_AVAILABLE has an invalid msgid so we must
2270dc60165bSWeongyo Jeong 		 * treat it specially.
2271dc60165bSWeongyo Jeong 		 */
2272dc60165bSWeongyo Jeong 		if (hdr->msgid < UATH_CMD_LIST_COUNT) {
2273dc60165bSWeongyo Jeong 			uint32_t *rp = (uint32_t *)(hdr+1);
2274dc60165bSWeongyo Jeong 			u_int olen;
2275dc60165bSWeongyo Jeong 
2276dc60165bSWeongyo Jeong 			if (!(sizeof(*hdr) <= hdr->len &&
2277dc60165bSWeongyo Jeong 			      hdr->len < UATH_MAX_CMDSZ)) {
2278dc60165bSWeongyo Jeong 				device_printf(sc->sc_dev,
2279dc60165bSWeongyo Jeong 				    "%s: invalid WDC msg length %u; "
2280dc60165bSWeongyo Jeong 				    "msg ignored\n", __func__, hdr->len);
2281dc60165bSWeongyo Jeong 				return;
2282dc60165bSWeongyo Jeong 			}
2283dc60165bSWeongyo Jeong 			/*
2284dc60165bSWeongyo Jeong 			 * Calculate return/receive payload size; the
2285dc60165bSWeongyo Jeong 			 * first word, if present, always gives the
2286dc60165bSWeongyo Jeong 			 * number of bytes--unless it's 0 in which
2287dc60165bSWeongyo Jeong 			 * case a single 32-bit word should be present.
2288dc60165bSWeongyo Jeong 			 */
22896d917491SHans Petter Selasky 			if (dlen >= (int)sizeof(uint32_t)) {
2290dc60165bSWeongyo Jeong 				olen = be32toh(rp[0]);
2291dc60165bSWeongyo Jeong 				dlen -= sizeof(uint32_t);
2292dc60165bSWeongyo Jeong 				if (olen == 0) {
2293dc60165bSWeongyo Jeong 					/* convention is 0 =>'s one word */
2294dc60165bSWeongyo Jeong 					olen = sizeof(uint32_t);
2295dc60165bSWeongyo Jeong 					/* XXX KASSERT(olen == dlen ) */
2296dc60165bSWeongyo Jeong 				}
2297dc60165bSWeongyo Jeong 			} else
2298dc60165bSWeongyo Jeong 				olen = 0;
2299dc60165bSWeongyo Jeong 			if (cmd->odata != NULL) {
2300dc60165bSWeongyo Jeong 				/* NB: cmd->olen validated in uath_cmd */
23016d917491SHans Petter Selasky 				if (olen > (u_int)cmd->olen) {
2302dc60165bSWeongyo Jeong 					/* XXX complain? */
2303dc60165bSWeongyo Jeong 					device_printf(sc->sc_dev,
2304dc60165bSWeongyo Jeong 					    "%s: cmd 0x%x olen %u cmd olen %u\n",
2305dc60165bSWeongyo Jeong 					    __func__, hdr->code, olen,
2306dc60165bSWeongyo Jeong 					    cmd->olen);
2307dc60165bSWeongyo Jeong 					olen = cmd->olen;
2308dc60165bSWeongyo Jeong 				}
23096d917491SHans Petter Selasky 				if (olen > (u_int)dlen) {
2310dc60165bSWeongyo Jeong 					/* XXX complain, shouldn't happen */
2311dc60165bSWeongyo Jeong 					device_printf(sc->sc_dev,
2312dc60165bSWeongyo Jeong 					    "%s: cmd 0x%x olen %u dlen %u\n",
2313dc60165bSWeongyo Jeong 					    __func__, hdr->code, olen, dlen);
2314dc60165bSWeongyo Jeong 					olen = dlen;
2315dc60165bSWeongyo Jeong 				}
2316dc60165bSWeongyo Jeong 				/* XXX have submitter do this */
2317dc60165bSWeongyo Jeong 				/* copy answer into caller's supplied buffer */
2318dc60165bSWeongyo Jeong 				bcopy(&rp[1], cmd->odata, olen);
2319dc60165bSWeongyo Jeong 				cmd->olen = olen;
2320dc60165bSWeongyo Jeong 			}
2321dc60165bSWeongyo Jeong 		}
2322dc60165bSWeongyo Jeong 		wakeup_one(cmd);		/* wake up caller */
2323dc60165bSWeongyo Jeong 		break;
2324dc60165bSWeongyo Jeong 
2325dc60165bSWeongyo Jeong 	case WDCMSG_TARGET_START:
2326dc60165bSWeongyo Jeong 		if (hdr->msgid >= UATH_CMD_LIST_COUNT) {
2327dc60165bSWeongyo Jeong 			/* XXX */
2328dc60165bSWeongyo Jeong 			return;
2329dc60165bSWeongyo Jeong 		}
2330dc60165bSWeongyo Jeong 		dlen = hdr->len - sizeof(*hdr);
23316d917491SHans Petter Selasky 		if (dlen != (int)sizeof(uint32_t)) {
2332dc60165bSWeongyo Jeong 			/* XXX something wrong */
2333dc60165bSWeongyo Jeong 			return;
2334dc60165bSWeongyo Jeong 		}
2335dc60165bSWeongyo Jeong 		/* XXX have submitter do this */
2336dc60165bSWeongyo Jeong 		/* copy answer into caller's supplied buffer */
2337dc60165bSWeongyo Jeong 		bcopy(hdr+1, cmd->odata, sizeof(uint32_t));
2338dc60165bSWeongyo Jeong 		cmd->olen = sizeof(uint32_t);
2339dc60165bSWeongyo Jeong 		wakeup_one(cmd);		/* wake up caller */
2340dc60165bSWeongyo Jeong 		break;
2341dc60165bSWeongyo Jeong 
2342dc60165bSWeongyo Jeong 	case WDCMSG_SEND_COMPLETE:
2343dc60165bSWeongyo Jeong 		/* this notification is sent when UATH_TX_NOTIFY is set */
2344dc60165bSWeongyo Jeong 		DPRINTF(sc, UATH_DEBUG_RX_PROC | UATH_DEBUG_RECV_ALL,
2345dc60165bSWeongyo Jeong 		    "%s: received Tx notification\n", __func__);
2346dc60165bSWeongyo Jeong 		break;
2347dc60165bSWeongyo Jeong 
2348dc60165bSWeongyo Jeong 	case WDCMSG_TARGET_GET_STATS:
2349dc60165bSWeongyo Jeong 		DPRINTF(sc, UATH_DEBUG_RX_PROC | UATH_DEBUG_RECV_ALL,
2350dc60165bSWeongyo Jeong 		    "%s: received device statistics\n", __func__);
2351dc60165bSWeongyo Jeong 		callout_reset(&sc->stat_ch, hz, uath_stat, sc);
2352dc60165bSWeongyo Jeong 		break;
2353dc60165bSWeongyo Jeong 	}
2354dc60165bSWeongyo Jeong }
2355dc60165bSWeongyo Jeong 
2356dc60165bSWeongyo Jeong static void
2357ed6d949aSAndrew Thompson uath_intr_rx_callback(struct usb_xfer *xfer, usb_error_t error)
2358dc60165bSWeongyo Jeong {
2359ed6d949aSAndrew Thompson 	struct uath_softc *sc = usbd_xfer_softc(xfer);
2360dc60165bSWeongyo Jeong 	struct uath_cmd *cmd;
2361ed6d949aSAndrew Thompson 	struct usb_page_cache *pc;
2362ed6d949aSAndrew Thompson 	int actlen;
2363ed6d949aSAndrew Thompson 
2364ed6d949aSAndrew Thompson 	usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
2365dc60165bSWeongyo Jeong 
2366dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
2367dc60165bSWeongyo Jeong 
2368dc60165bSWeongyo Jeong 	switch (USB_GET_STATE(xfer)) {
2369dc60165bSWeongyo Jeong 	case USB_ST_TRANSFERRED:
2370dc60165bSWeongyo Jeong 		cmd = STAILQ_FIRST(&sc->sc_cmd_waiting);
2371dc60165bSWeongyo Jeong 		if (cmd == NULL)
2372dc60165bSWeongyo Jeong 			goto setup;
2373dc60165bSWeongyo Jeong 		STAILQ_REMOVE_HEAD(&sc->sc_cmd_waiting, next);
2374dc60165bSWeongyo Jeong 		UATH_STAT_DEC(sc, st_cmd_waiting);
2375dc60165bSWeongyo Jeong 		STAILQ_INSERT_TAIL(&sc->sc_cmd_inactive, cmd, next);
2376dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_cmd_inactive);
2377dc60165bSWeongyo Jeong 
23786d917491SHans Petter Selasky 		KASSERT(actlen >= (int)sizeof(struct uath_cmd_hdr),
2379dc60165bSWeongyo Jeong 		    ("short xfer error"));
2380ed6d949aSAndrew Thompson 		pc = usbd_xfer_get_frame(xfer, 0);
2381ed6d949aSAndrew Thompson 		usbd_copy_out(pc, 0, cmd->buf, actlen);
2382dc60165bSWeongyo Jeong 		uath_cmdeof(sc, cmd);
2383dc60165bSWeongyo Jeong 	case USB_ST_SETUP:
2384dc60165bSWeongyo Jeong setup:
2385ed6d949aSAndrew Thompson 		usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
2386a593f6b8SAndrew Thompson 		usbd_transfer_submit(xfer);
2387dc60165bSWeongyo Jeong 		break;
2388dc60165bSWeongyo Jeong 	default:
2389ed6d949aSAndrew Thompson 		if (error != USB_ERR_CANCELLED) {
2390ed6d949aSAndrew Thompson 			usbd_xfer_set_stall(xfer);
2391dc60165bSWeongyo Jeong 			goto setup;
2392dc60165bSWeongyo Jeong 		}
2393dc60165bSWeongyo Jeong 		break;
2394dc60165bSWeongyo Jeong 	}
2395dc60165bSWeongyo Jeong }
2396dc60165bSWeongyo Jeong 
2397dc60165bSWeongyo Jeong static void
2398ed6d949aSAndrew Thompson uath_intr_tx_callback(struct usb_xfer *xfer, usb_error_t error)
2399dc60165bSWeongyo Jeong {
2400ed6d949aSAndrew Thompson 	struct uath_softc *sc = usbd_xfer_softc(xfer);
2401dc60165bSWeongyo Jeong 	struct uath_cmd *cmd;
2402dc60165bSWeongyo Jeong 
2403dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
2404dc60165bSWeongyo Jeong 
2405dc60165bSWeongyo Jeong 	cmd = STAILQ_FIRST(&sc->sc_cmd_active);
2406056e0b5dSHans Petter Selasky 	if (cmd != NULL && USB_GET_STATE(xfer) != USB_ST_SETUP) {
2407dc60165bSWeongyo Jeong 		STAILQ_REMOVE_HEAD(&sc->sc_cmd_active, next);
2408dc60165bSWeongyo Jeong 		UATH_STAT_DEC(sc, st_cmd_active);
2409dc60165bSWeongyo Jeong 		STAILQ_INSERT_TAIL((cmd->flags & UATH_CMD_FLAG_READ) ?
2410dc60165bSWeongyo Jeong 		    &sc->sc_cmd_waiting : &sc->sc_cmd_inactive, cmd, next);
2411dc60165bSWeongyo Jeong 		if (cmd->flags & UATH_CMD_FLAG_READ)
2412dc60165bSWeongyo Jeong 			UATH_STAT_INC(sc, st_cmd_waiting);
2413dc60165bSWeongyo Jeong 		else
2414dc60165bSWeongyo Jeong 			UATH_STAT_INC(sc, st_cmd_inactive);
2415056e0b5dSHans Petter Selasky 	}
2416056e0b5dSHans Petter Selasky 
2417056e0b5dSHans Petter Selasky 	switch (USB_GET_STATE(xfer)) {
2418056e0b5dSHans Petter Selasky 	case USB_ST_TRANSFERRED:
2419dc60165bSWeongyo Jeong 	case USB_ST_SETUP:
2420dc60165bSWeongyo Jeong setup:
2421dc60165bSWeongyo Jeong 		cmd = STAILQ_FIRST(&sc->sc_cmd_pending);
2422dc60165bSWeongyo Jeong 		if (cmd == NULL) {
2423dc60165bSWeongyo Jeong 			DPRINTF(sc, UATH_DEBUG_XMIT, "%s: empty pending queue\n",
2424dc60165bSWeongyo Jeong 			    __func__);
2425dc60165bSWeongyo Jeong 			return;
2426dc60165bSWeongyo Jeong 		}
2427dc60165bSWeongyo Jeong 		STAILQ_REMOVE_HEAD(&sc->sc_cmd_pending, next);
2428dc60165bSWeongyo Jeong 		UATH_STAT_DEC(sc, st_cmd_pending);
2429dc60165bSWeongyo Jeong 		STAILQ_INSERT_TAIL((cmd->flags & UATH_CMD_FLAG_ASYNC) ?
2430dc60165bSWeongyo Jeong 		    &sc->sc_cmd_inactive : &sc->sc_cmd_active, cmd, next);
2431dc60165bSWeongyo Jeong 		if (cmd->flags & UATH_CMD_FLAG_ASYNC)
2432dc60165bSWeongyo Jeong 			UATH_STAT_INC(sc, st_cmd_inactive);
2433dc60165bSWeongyo Jeong 		else
2434dc60165bSWeongyo Jeong 			UATH_STAT_INC(sc, st_cmd_active);
2435dc60165bSWeongyo Jeong 
2436ed6d949aSAndrew Thompson 		usbd_xfer_set_frame_data(xfer, 0, cmd->buf, cmd->buflen);
2437a593f6b8SAndrew Thompson 		usbd_transfer_submit(xfer);
2438dc60165bSWeongyo Jeong 		break;
2439dc60165bSWeongyo Jeong 	default:
2440ed6d949aSAndrew Thompson 		if (error != USB_ERR_CANCELLED) {
2441ed6d949aSAndrew Thompson 			usbd_xfer_set_stall(xfer);
2442dc60165bSWeongyo Jeong 			goto setup;
2443dc60165bSWeongyo Jeong 		}
2444dc60165bSWeongyo Jeong 		break;
2445dc60165bSWeongyo Jeong 	}
2446dc60165bSWeongyo Jeong }
2447dc60165bSWeongyo Jeong 
2448dc60165bSWeongyo Jeong static void
2449dc60165bSWeongyo Jeong uath_update_rxstat(struct uath_softc *sc, uint32_t status)
2450dc60165bSWeongyo Jeong {
2451dc60165bSWeongyo Jeong 
2452dc60165bSWeongyo Jeong 	switch (status) {
2453dc60165bSWeongyo Jeong 	case UATH_STATUS_STOP_IN_PROGRESS:
2454dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_stopinprogress);
2455dc60165bSWeongyo Jeong 		break;
2456dc60165bSWeongyo Jeong 	case UATH_STATUS_CRC_ERR:
2457dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_crcerr);
2458dc60165bSWeongyo Jeong 		break;
2459dc60165bSWeongyo Jeong 	case UATH_STATUS_PHY_ERR:
2460dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_phyerr);
2461dc60165bSWeongyo Jeong 		break;
2462dc60165bSWeongyo Jeong 	case UATH_STATUS_DECRYPT_CRC_ERR:
2463dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_decrypt_crcerr);
2464dc60165bSWeongyo Jeong 		break;
2465dc60165bSWeongyo Jeong 	case UATH_STATUS_DECRYPT_MIC_ERR:
2466dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_decrypt_micerr);
2467dc60165bSWeongyo Jeong 		break;
2468dc60165bSWeongyo Jeong 	case UATH_STATUS_DECOMP_ERR:
2469dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_decomperr);
2470dc60165bSWeongyo Jeong 		break;
2471dc60165bSWeongyo Jeong 	case UATH_STATUS_KEY_ERR:
2472dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_keyerr);
2473dc60165bSWeongyo Jeong 		break;
2474dc60165bSWeongyo Jeong 	case UATH_STATUS_ERR:
2475dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_err);
2476dc60165bSWeongyo Jeong 		break;
2477dc60165bSWeongyo Jeong 	default:
2478dc60165bSWeongyo Jeong 		break;
2479dc60165bSWeongyo Jeong 	}
2480dc60165bSWeongyo Jeong }
2481dc60165bSWeongyo Jeong 
2482dc60165bSWeongyo Jeong static struct mbuf *
2483760bc48eSAndrew Thompson uath_data_rxeof(struct usb_xfer *xfer, struct uath_data *data,
2484dc60165bSWeongyo Jeong     struct uath_rx_desc **pdesc)
2485dc60165bSWeongyo Jeong {
2486ed6d949aSAndrew Thompson 	struct uath_softc *sc = usbd_xfer_softc(xfer);
2487*7a79cebfSGleb Smirnoff 	struct ieee80211com *ic = &sc->sc_ic;
2488dc60165bSWeongyo Jeong 	struct uath_chunk *chunk;
2489dc60165bSWeongyo Jeong 	struct uath_rx_desc *desc;
2490dc60165bSWeongyo Jeong 	struct mbuf *m = data->m, *mnew, *mp;
2491dc60165bSWeongyo Jeong 	uint16_t chunklen;
2492ed6d949aSAndrew Thompson 	int actlen;
2493dc60165bSWeongyo Jeong 
2494ed6d949aSAndrew Thompson 	usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
2495ed6d949aSAndrew Thompson 
24966d917491SHans Petter Selasky 	if (actlen < (int)UATH_MIN_RXBUFSZ) {
2497dc60165bSWeongyo Jeong 		DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL,
2498ed6d949aSAndrew Thompson 		    "%s: wrong xfer size (len=%d)\n", __func__, actlen);
2499*7a79cebfSGleb Smirnoff 		counter_u64_add(ic->ic_ierrors, 1);
2500dc60165bSWeongyo Jeong 		return (NULL);
2501dc60165bSWeongyo Jeong 	}
2502dc60165bSWeongyo Jeong 
2503dc60165bSWeongyo Jeong 	chunk = (struct uath_chunk *)data->buf;
2504dc60165bSWeongyo Jeong 	if (chunk->seqnum == 0 && chunk->flags == 0 && chunk->length == 0) {
2505dc60165bSWeongyo Jeong 		device_printf(sc->sc_dev, "%s: strange response\n", __func__);
2506*7a79cebfSGleb Smirnoff 		counter_u64_add(ic->ic_ierrors, 1);
2507dc60165bSWeongyo Jeong 		UATH_RESET_INTRX(sc);
2508dc60165bSWeongyo Jeong 		return (NULL);
2509dc60165bSWeongyo Jeong 	}
2510dc60165bSWeongyo Jeong 
2511dc60165bSWeongyo Jeong 	if (chunk->seqnum != sc->sc_intrx_nextnum) {
2512dc60165bSWeongyo Jeong 		DPRINTF(sc, UATH_DEBUG_XMIT, "invalid seqnum %d, expected %d\n",
2513dc60165bSWeongyo Jeong 		    chunk->seqnum, sc->sc_intrx_nextnum);
2514dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_badchunkseqnum);
2515dc60165bSWeongyo Jeong 		if (sc->sc_intrx_head != NULL)
2516dc60165bSWeongyo Jeong 			m_freem(sc->sc_intrx_head);
2517dc60165bSWeongyo Jeong 		UATH_RESET_INTRX(sc);
2518dc60165bSWeongyo Jeong 		return (NULL);
2519dc60165bSWeongyo Jeong 	}
2520dc60165bSWeongyo Jeong 
2521dc60165bSWeongyo Jeong 	/* check multi-chunk frames  */
2522dc60165bSWeongyo Jeong 	if ((chunk->seqnum == 0 && !(chunk->flags & UATH_CFLAGS_FINAL)) ||
2523dc60165bSWeongyo Jeong 	    (chunk->seqnum != 0 && (chunk->flags & UATH_CFLAGS_FINAL)) ||
2524dc60165bSWeongyo Jeong 	    chunk->flags & UATH_CFLAGS_RXMSG)
2525dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_multichunk);
2526dc60165bSWeongyo Jeong 
2527dc60165bSWeongyo Jeong 	chunklen = be16toh(chunk->length);
2528dc60165bSWeongyo Jeong 	if (chunk->flags & UATH_CFLAGS_FINAL)
2529dc60165bSWeongyo Jeong 		chunklen -= sizeof(struct uath_rx_desc);
2530dc60165bSWeongyo Jeong 
2531dc60165bSWeongyo Jeong 	if (chunklen > 0 &&
2532dc60165bSWeongyo Jeong 	    (!(chunk->flags & UATH_CFLAGS_FINAL) || !(chunk->seqnum == 0))) {
2533dc60165bSWeongyo Jeong 		/* we should use intermediate RX buffer  */
2534dc60165bSWeongyo Jeong 		if (chunk->seqnum == 0)
2535dc60165bSWeongyo Jeong 			UATH_RESET_INTRX(sc);
2536dc60165bSWeongyo Jeong 		if ((sc->sc_intrx_len + sizeof(struct uath_rx_desc) +
2537dc60165bSWeongyo Jeong 		    chunklen) > UATH_MAX_INTRX_SIZE) {
2538dc60165bSWeongyo Jeong 			UATH_STAT_INC(sc, st_invalidlen);
2539*7a79cebfSGleb Smirnoff 			counter_u64_add(ic->ic_ierrors, 1);
2540dc60165bSWeongyo Jeong 			if (sc->sc_intrx_head != NULL)
2541dc60165bSWeongyo Jeong 				m_freem(sc->sc_intrx_head);
2542dc60165bSWeongyo Jeong 			UATH_RESET_INTRX(sc);
2543dc60165bSWeongyo Jeong 			return (NULL);
2544dc60165bSWeongyo Jeong 		}
2545dc60165bSWeongyo Jeong 
2546dc60165bSWeongyo Jeong 		m->m_len = chunklen;
2547dc60165bSWeongyo Jeong 		m->m_data += sizeof(struct uath_chunk);
2548dc60165bSWeongyo Jeong 
2549dc60165bSWeongyo Jeong 		if (sc->sc_intrx_head == NULL) {
2550dc60165bSWeongyo Jeong 			sc->sc_intrx_head = m;
2551dc60165bSWeongyo Jeong 			sc->sc_intrx_tail = m;
2552dc60165bSWeongyo Jeong 		} else {
2553dc60165bSWeongyo Jeong 			m->m_flags &= ~M_PKTHDR;
2554dc60165bSWeongyo Jeong 			sc->sc_intrx_tail->m_next = m;
2555dc60165bSWeongyo Jeong 			sc->sc_intrx_tail = m;
2556dc60165bSWeongyo Jeong 		}
2557dc60165bSWeongyo Jeong 	}
2558dc60165bSWeongyo Jeong 	sc->sc_intrx_len += chunklen;
2559dc60165bSWeongyo Jeong 
2560c6499eccSGleb Smirnoff 	mnew = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR);
2561dc60165bSWeongyo Jeong 	if (mnew == NULL) {
2562dc60165bSWeongyo Jeong 		DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL,
2563dc60165bSWeongyo Jeong 		    "%s: can't get new mbuf, drop frame\n", __func__);
2564*7a79cebfSGleb Smirnoff 		counter_u64_add(ic->ic_ierrors, 1);
2565dc60165bSWeongyo Jeong 		if (sc->sc_intrx_head != NULL)
2566dc60165bSWeongyo Jeong 			m_freem(sc->sc_intrx_head);
2567dc60165bSWeongyo Jeong 		UATH_RESET_INTRX(sc);
2568dc60165bSWeongyo Jeong 		return (NULL);
2569dc60165bSWeongyo Jeong 	}
2570dc60165bSWeongyo Jeong 
2571dc60165bSWeongyo Jeong 	data->m = mnew;
2572dc60165bSWeongyo Jeong 	data->buf = mtod(mnew, uint8_t *);
2573dc60165bSWeongyo Jeong 
2574dc60165bSWeongyo Jeong 	/* if the frame is not final continue the transfer  */
2575dc60165bSWeongyo Jeong 	if (!(chunk->flags & UATH_CFLAGS_FINAL)) {
2576dc60165bSWeongyo Jeong 		sc->sc_intrx_nextnum++;
2577dc60165bSWeongyo Jeong 		UATH_RESET_INTRX(sc);
2578dc60165bSWeongyo Jeong 		return (NULL);
2579dc60165bSWeongyo Jeong 	}
2580dc60165bSWeongyo Jeong 
2581dc60165bSWeongyo Jeong 	/*
2582dc60165bSWeongyo Jeong 	 * if the frame is not set UATH_CFLAGS_RXMSG, then rx descriptor is
2583dc60165bSWeongyo Jeong 	 * located at the end, 32-bit aligned
2584dc60165bSWeongyo Jeong 	 */
2585dc60165bSWeongyo Jeong 	desc = (chunk->flags & UATH_CFLAGS_RXMSG) ?
2586dc60165bSWeongyo Jeong 		(struct uath_rx_desc *)(chunk + 1) :
2587dc60165bSWeongyo Jeong 		(struct uath_rx_desc *)(((uint8_t *)chunk) +
2588dc60165bSWeongyo Jeong 		    sizeof(struct uath_chunk) + be16toh(chunk->length) -
2589dc60165bSWeongyo Jeong 		    sizeof(struct uath_rx_desc));
2590dc60165bSWeongyo Jeong 	*pdesc = desc;
2591dc60165bSWeongyo Jeong 
2592dc60165bSWeongyo Jeong 	DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL,
2593dc60165bSWeongyo Jeong 	    "%s: frame len %u code %u status %u rate %u antenna %u "
2594dc60165bSWeongyo Jeong 	    "rssi %d channel %u phyerror %u connix %u decrypterror %u "
2595dc60165bSWeongyo Jeong 	    "keycachemiss %u\n", __func__, be32toh(desc->framelen)
2596dc60165bSWeongyo Jeong 	    , be32toh(desc->code), be32toh(desc->status), be32toh(desc->rate)
2597dc60165bSWeongyo Jeong 	    , be32toh(desc->antenna), be32toh(desc->rssi), be32toh(desc->channel)
2598dc60165bSWeongyo Jeong 	    , be32toh(desc->phyerror), be32toh(desc->connix)
2599dc60165bSWeongyo Jeong 	    , be32toh(desc->decrypterror), be32toh(desc->keycachemiss));
2600dc60165bSWeongyo Jeong 
2601dc60165bSWeongyo Jeong 	if (be32toh(desc->len) > MCLBYTES) {
2602dc60165bSWeongyo Jeong 		DPRINTF(sc, UATH_DEBUG_RECV | UATH_DEBUG_RECV_ALL,
2603dc60165bSWeongyo Jeong 		    "%s: bad descriptor (len=%d)\n", __func__,
2604dc60165bSWeongyo Jeong 		    be32toh(desc->len));
2605*7a79cebfSGleb Smirnoff 		counter_u64_add(ic->ic_ierrors, 1);
2606dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_toobigrxpkt);
2607dc60165bSWeongyo Jeong 		if (sc->sc_intrx_head != NULL)
2608dc60165bSWeongyo Jeong 			m_freem(sc->sc_intrx_head);
2609dc60165bSWeongyo Jeong 		UATH_RESET_INTRX(sc);
2610dc60165bSWeongyo Jeong 		return (NULL);
2611dc60165bSWeongyo Jeong 	}
2612dc60165bSWeongyo Jeong 
2613dc60165bSWeongyo Jeong 	uath_update_rxstat(sc, be32toh(desc->status));
2614dc60165bSWeongyo Jeong 
2615dc60165bSWeongyo Jeong 	/* finalize mbuf */
2616dc60165bSWeongyo Jeong 	if (sc->sc_intrx_head == NULL) {
2617dc60165bSWeongyo Jeong 		m->m_pkthdr.len = m->m_len =
2618dc60165bSWeongyo Jeong 			be32toh(desc->framelen) - UATH_RX_DUMMYSIZE;
2619dc60165bSWeongyo Jeong 		m->m_data += sizeof(struct uath_chunk);
2620dc60165bSWeongyo Jeong 	} else {
2621dc60165bSWeongyo Jeong 		mp = sc->sc_intrx_head;
2622dc60165bSWeongyo Jeong 		mp->m_flags |= M_PKTHDR;
2623dc60165bSWeongyo Jeong 		mp->m_pkthdr.len = sc->sc_intrx_len;
2624dc60165bSWeongyo Jeong 		m = mp;
2625dc60165bSWeongyo Jeong 	}
2626dc60165bSWeongyo Jeong 
2627dc60165bSWeongyo Jeong 	/* there are a lot more fields in the RX descriptor */
2628c39515adSWeongyo Jeong 	if ((sc->sc_flags & UATH_FLAG_INVALID) == 0 &&
2629c39515adSWeongyo Jeong 	    ieee80211_radiotap_active(ic)) {
2630dc60165bSWeongyo Jeong 		struct uath_rx_radiotap_header *tap = &sc->sc_rxtap;
26315463c4a4SSam Leffler 		uint32_t tsf_hi = be32toh(desc->tstamp_high);
26325463c4a4SSam Leffler 		uint32_t tsf_lo = be32toh(desc->tstamp_low);
2633dc60165bSWeongyo Jeong 
26345463c4a4SSam Leffler 		/* XXX only get low order 24bits of tsf from h/w */
26355463c4a4SSam Leffler 		tap->wr_tsf = htole64(((uint64_t)tsf_hi << 32) | tsf_lo);
26365463c4a4SSam Leffler 		tap->wr_flags = 0;
26375463c4a4SSam Leffler 		if (be32toh(desc->status) == UATH_STATUS_CRC_ERR)
26385463c4a4SSam Leffler 			tap->wr_flags |= IEEE80211_RADIOTAP_F_BADFCS;
26395463c4a4SSam Leffler 		/* XXX map other status to BADFCS? */
26405463c4a4SSam Leffler 		/* XXX ath h/w rate code, need to map */
26415463c4a4SSam Leffler 		tap->wr_rate = be32toh(desc->rate);
26425463c4a4SSam Leffler 		tap->wr_antenna = be32toh(desc->antenna);
26435463c4a4SSam Leffler 		tap->wr_antsignal = -95 + be32toh(desc->rssi);
26445463c4a4SSam Leffler 		tap->wr_antnoise = -95;
2645dc60165bSWeongyo Jeong 	}
2646dc60165bSWeongyo Jeong 
2647dc60165bSWeongyo Jeong 	UATH_RESET_INTRX(sc);
2648dc60165bSWeongyo Jeong 
2649dc60165bSWeongyo Jeong 	return (m);
2650dc60165bSWeongyo Jeong }
2651dc60165bSWeongyo Jeong 
2652dc60165bSWeongyo Jeong static void
2653ed6d949aSAndrew Thompson uath_bulk_rx_callback(struct usb_xfer *xfer, usb_error_t error)
2654dc60165bSWeongyo Jeong {
2655ed6d949aSAndrew Thompson 	struct uath_softc *sc = usbd_xfer_softc(xfer);
2656*7a79cebfSGleb Smirnoff 	struct ieee80211com *ic = &sc->sc_ic;
2657dc60165bSWeongyo Jeong 	struct ieee80211_frame *wh;
2658dc60165bSWeongyo Jeong 	struct ieee80211_node *ni;
2659dc60165bSWeongyo Jeong 	struct mbuf *m = NULL;
2660dc60165bSWeongyo Jeong 	struct uath_data *data;
2661dc60165bSWeongyo Jeong 	struct uath_rx_desc *desc = NULL;
2662dc60165bSWeongyo Jeong 	int8_t nf;
2663dc60165bSWeongyo Jeong 
2664dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
2665dc60165bSWeongyo Jeong 
2666dc60165bSWeongyo Jeong 	switch (USB_GET_STATE(xfer)) {
2667dc60165bSWeongyo Jeong 	case USB_ST_TRANSFERRED:
2668dc60165bSWeongyo Jeong 		data = STAILQ_FIRST(&sc->sc_rx_active);
2669dc60165bSWeongyo Jeong 		if (data == NULL)
2670dc60165bSWeongyo Jeong 			goto setup;
2671dc60165bSWeongyo Jeong 		STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next);
2672dc60165bSWeongyo Jeong 		UATH_STAT_DEC(sc, st_rx_active);
2673dc60165bSWeongyo Jeong 		m = uath_data_rxeof(xfer, data, &desc);
2674dc60165bSWeongyo Jeong 		STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next);
2675dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_rx_inactive);
2676dc60165bSWeongyo Jeong 		/* FALLTHROUGH */
2677dc60165bSWeongyo Jeong 	case USB_ST_SETUP:
2678dc60165bSWeongyo Jeong setup:
2679dc60165bSWeongyo Jeong 		data = STAILQ_FIRST(&sc->sc_rx_inactive);
2680dc60165bSWeongyo Jeong 		if (data == NULL)
2681dc60165bSWeongyo Jeong 			return;
2682dc60165bSWeongyo Jeong 		STAILQ_REMOVE_HEAD(&sc->sc_rx_inactive, next);
2683dc60165bSWeongyo Jeong 		UATH_STAT_DEC(sc, st_rx_inactive);
2684dc60165bSWeongyo Jeong 		STAILQ_INSERT_TAIL(&sc->sc_rx_active, data, next);
2685dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_rx_active);
2686c180b398SHans Petter Selasky 		usbd_xfer_set_frame_data(xfer, 0, data->buf, MCLBYTES);
2687a593f6b8SAndrew Thompson 		usbd_transfer_submit(xfer);
2688dc60165bSWeongyo Jeong 
2689dc60165bSWeongyo Jeong 		/*
2690dc60165bSWeongyo Jeong 		 * To avoid LOR we should unlock our private mutex here to call
2691dc60165bSWeongyo Jeong 		 * ieee80211_input() because here is at the end of a USB
2692dc60165bSWeongyo Jeong 		 * callback and safe to unlock.
2693dc60165bSWeongyo Jeong 		 */
2694c39515adSWeongyo Jeong 		if (sc->sc_flags & UATH_FLAG_INVALID) {
2695c39515adSWeongyo Jeong 			if (m != NULL)
2696c39515adSWeongyo Jeong 				m_freem(m);
2697c39515adSWeongyo Jeong 			return;
2698c39515adSWeongyo Jeong 		}
2699dc60165bSWeongyo Jeong 		UATH_UNLOCK(sc);
2700dc60165bSWeongyo Jeong 		if (m != NULL && desc != NULL) {
2701dc60165bSWeongyo Jeong 			wh = mtod(m, struct ieee80211_frame *);
2702dc60165bSWeongyo Jeong 			ni = ieee80211_find_rxnode(ic,
2703dc60165bSWeongyo Jeong 			    (struct ieee80211_frame_min *)wh);
2704dc60165bSWeongyo Jeong 			nf = -95;	/* XXX */
2705dc60165bSWeongyo Jeong 			if (ni != NULL) {
2706dc60165bSWeongyo Jeong 				(void) ieee80211_input(ni, m,
27075463c4a4SSam Leffler 				    (int)be32toh(desc->rssi), nf);
2708dc60165bSWeongyo Jeong 				/* node is no longer needed */
2709dc60165bSWeongyo Jeong 				ieee80211_free_node(ni);
2710dc60165bSWeongyo Jeong 			} else
2711dc60165bSWeongyo Jeong 				(void) ieee80211_input_all(ic, m,
27125463c4a4SSam Leffler 				    (int)be32toh(desc->rssi), nf);
2713dc60165bSWeongyo Jeong 			m = NULL;
2714dc60165bSWeongyo Jeong 			desc = NULL;
2715dc60165bSWeongyo Jeong 		}
2716dc60165bSWeongyo Jeong 		UATH_LOCK(sc);
2717*7a79cebfSGleb Smirnoff 		uath_start(sc);
2718dc60165bSWeongyo Jeong 		break;
2719dc60165bSWeongyo Jeong 	default:
2720dc60165bSWeongyo Jeong 		/* needs it to the inactive queue due to a error.  */
2721dc60165bSWeongyo Jeong 		data = STAILQ_FIRST(&sc->sc_rx_active);
2722dc60165bSWeongyo Jeong 		if (data != NULL) {
2723dc60165bSWeongyo Jeong 			STAILQ_REMOVE_HEAD(&sc->sc_rx_active, next);
2724dc60165bSWeongyo Jeong 			UATH_STAT_DEC(sc, st_rx_active);
2725dc60165bSWeongyo Jeong 			STAILQ_INSERT_TAIL(&sc->sc_rx_inactive, data, next);
2726dc60165bSWeongyo Jeong 			UATH_STAT_INC(sc, st_rx_inactive);
2727dc60165bSWeongyo Jeong 		}
2728ed6d949aSAndrew Thompson 		if (error != USB_ERR_CANCELLED) {
2729ed6d949aSAndrew Thompson 			usbd_xfer_set_stall(xfer);
2730*7a79cebfSGleb Smirnoff 			counter_u64_add(ic->ic_ierrors, 1);
2731dc60165bSWeongyo Jeong 			goto setup;
2732dc60165bSWeongyo Jeong 		}
2733dc60165bSWeongyo Jeong 		break;
2734dc60165bSWeongyo Jeong 	}
2735dc60165bSWeongyo Jeong }
2736dc60165bSWeongyo Jeong 
2737dc60165bSWeongyo Jeong static void
2738760bc48eSAndrew Thompson uath_data_txeof(struct usb_xfer *xfer, struct uath_data *data)
2739dc60165bSWeongyo Jeong {
2740ed6d949aSAndrew Thompson 	struct uath_softc *sc = usbd_xfer_softc(xfer);
2741dc60165bSWeongyo Jeong 
2742dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
2743dc60165bSWeongyo Jeong 
2744dc60165bSWeongyo Jeong 	if (data->m) {
2745dc60165bSWeongyo Jeong 		/* XXX status? */
2746*7a79cebfSGleb Smirnoff 		ieee80211_tx_complete(data->ni, data->m, 0);
2747dc60165bSWeongyo Jeong 		data->m = NULL;
2748dc60165bSWeongyo Jeong 		data->ni = NULL;
2749dc60165bSWeongyo Jeong 	}
2750dc60165bSWeongyo Jeong 	sc->sc_tx_timer = 0;
2751dc60165bSWeongyo Jeong }
2752dc60165bSWeongyo Jeong 
2753dc60165bSWeongyo Jeong static void
2754ed6d949aSAndrew Thompson uath_bulk_tx_callback(struct usb_xfer *xfer, usb_error_t error)
2755dc60165bSWeongyo Jeong {
2756ed6d949aSAndrew Thompson 	struct uath_softc *sc = usbd_xfer_softc(xfer);
2757dc60165bSWeongyo Jeong 	struct uath_data *data;
2758dc60165bSWeongyo Jeong 
2759dc60165bSWeongyo Jeong 	UATH_ASSERT_LOCKED(sc);
2760dc60165bSWeongyo Jeong 
2761dc60165bSWeongyo Jeong 	switch (USB_GET_STATE(xfer)) {
2762dc60165bSWeongyo Jeong 	case USB_ST_TRANSFERRED:
2763dc60165bSWeongyo Jeong 		data = STAILQ_FIRST(&sc->sc_tx_active);
2764dc60165bSWeongyo Jeong 		if (data == NULL)
2765dc60165bSWeongyo Jeong 			goto setup;
2766dc60165bSWeongyo Jeong 		STAILQ_REMOVE_HEAD(&sc->sc_tx_active, next);
2767dc60165bSWeongyo Jeong 		UATH_STAT_DEC(sc, st_tx_active);
2768dc60165bSWeongyo Jeong 		uath_data_txeof(xfer, data);
2769dc60165bSWeongyo Jeong 		STAILQ_INSERT_TAIL(&sc->sc_tx_inactive, data, next);
2770dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_tx_inactive);
2771dc60165bSWeongyo Jeong 		/* FALLTHROUGH */
2772dc60165bSWeongyo Jeong 	case USB_ST_SETUP:
2773dc60165bSWeongyo Jeong setup:
2774dc60165bSWeongyo Jeong 		data = STAILQ_FIRST(&sc->sc_tx_pending);
2775dc60165bSWeongyo Jeong 		if (data == NULL) {
2776dc60165bSWeongyo Jeong 			DPRINTF(sc, UATH_DEBUG_XMIT, "%s: empty pending queue\n",
2777dc60165bSWeongyo Jeong 			    __func__);
2778dc60165bSWeongyo Jeong 			return;
2779dc60165bSWeongyo Jeong 		}
2780dc60165bSWeongyo Jeong 		STAILQ_REMOVE_HEAD(&sc->sc_tx_pending, next);
2781dc60165bSWeongyo Jeong 		UATH_STAT_DEC(sc, st_tx_pending);
2782dc60165bSWeongyo Jeong 		STAILQ_INSERT_TAIL(&sc->sc_tx_active, data, next);
2783dc60165bSWeongyo Jeong 		UATH_STAT_INC(sc, st_tx_active);
2784dc60165bSWeongyo Jeong 
2785ed6d949aSAndrew Thompson 		usbd_xfer_set_frame_data(xfer, 0, data->buf, data->buflen);
2786a593f6b8SAndrew Thompson 		usbd_transfer_submit(xfer);
2787dc60165bSWeongyo Jeong 
2788*7a79cebfSGleb Smirnoff 		uath_start(sc);
2789dc60165bSWeongyo Jeong 		break;
2790dc60165bSWeongyo Jeong 	default:
2791dc60165bSWeongyo Jeong 		data = STAILQ_FIRST(&sc->sc_tx_active);
2792dc60165bSWeongyo Jeong 		if (data == NULL)
2793dc60165bSWeongyo Jeong 			goto setup;
2794dc60165bSWeongyo Jeong 		if (data->ni != NULL) {
2795*7a79cebfSGleb Smirnoff 			if_inc_counter(data->ni->ni_vap->iv_ifp,
2796*7a79cebfSGleb Smirnoff 			    IFCOUNTER_OERRORS, 1);
2797c39515adSWeongyo Jeong 			if ((sc->sc_flags & UATH_FLAG_INVALID) == 0)
2798dc60165bSWeongyo Jeong 				ieee80211_free_node(data->ni);
2799dc60165bSWeongyo Jeong 			data->ni = NULL;
2800dc60165bSWeongyo Jeong 		}
2801ed6d949aSAndrew Thompson 		if (error != USB_ERR_CANCELLED) {
2802ed6d949aSAndrew Thompson 			usbd_xfer_set_stall(xfer);
2803dc60165bSWeongyo Jeong 			goto setup;
2804dc60165bSWeongyo Jeong 		}
2805dc60165bSWeongyo Jeong 		break;
2806dc60165bSWeongyo Jeong 	}
2807dc60165bSWeongyo Jeong }
2808dc60165bSWeongyo Jeong 
2809dc60165bSWeongyo Jeong static device_method_t uath_methods[] = {
2810dc60165bSWeongyo Jeong 	DEVMETHOD(device_probe, uath_match),
2811dc60165bSWeongyo Jeong 	DEVMETHOD(device_attach, uath_attach),
2812dc60165bSWeongyo Jeong 	DEVMETHOD(device_detach, uath_detach),
2813c180b398SHans Petter Selasky 	DEVMETHOD_END
2814dc60165bSWeongyo Jeong };
2815dc60165bSWeongyo Jeong static driver_t uath_driver = {
28166d917491SHans Petter Selasky 	.name = "uath",
28176d917491SHans Petter Selasky 	.methods = uath_methods,
28186d917491SHans Petter Selasky 	.size = sizeof(struct uath_softc)
2819dc60165bSWeongyo Jeong };
2820dc60165bSWeongyo Jeong static devclass_t uath_devclass;
2821dc60165bSWeongyo Jeong 
2822dc60165bSWeongyo Jeong DRIVER_MODULE(uath, uhub, uath_driver, uath_devclass, NULL, 0);
2823dc60165bSWeongyo Jeong MODULE_DEPEND(uath, wlan, 1, 1, 1);
2824dc60165bSWeongyo Jeong MODULE_DEPEND(uath, usb, 1, 1, 1);
2825910cb8feSAndrew Thompson MODULE_VERSION(uath, 1);
2826