xref: /freebsd/sys/dev/iwi/if_iwi.c (revision 84f55b29e90600005d9864731644845e627932d5)
1ceaec73dSDamien Bergamini /*	$FreeBSD$	*/
2ceaec73dSDamien Bergamini 
3ceaec73dSDamien Bergamini /*-
484f55b29SDamien Bergamini  * Copyright (c) 2004-2006
5ceaec73dSDamien Bergamini  *      Damien Bergamini <damien.bergamini@free.fr>. All rights reserved.
6ceaec73dSDamien Bergamini  *
7ceaec73dSDamien Bergamini  * Redistribution and use in source and binary forms, with or without
8ceaec73dSDamien Bergamini  * modification, are permitted provided that the following conditions
9ceaec73dSDamien Bergamini  * are met:
10ceaec73dSDamien Bergamini  * 1. Redistributions of source code must retain the above copyright
11ceaec73dSDamien Bergamini  *    notice unmodified, this list of conditions, and the following
12ceaec73dSDamien Bergamini  *    disclaimer.
13ceaec73dSDamien Bergamini  * 2. Redistributions in binary form must reproduce the above copyright
14ceaec73dSDamien Bergamini  *    notice, this list of conditions and the following disclaimer in the
15ceaec73dSDamien Bergamini  *    documentation and/or other materials provided with the distribution.
16ceaec73dSDamien Bergamini  *
17ceaec73dSDamien Bergamini  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18ceaec73dSDamien Bergamini  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19ceaec73dSDamien Bergamini  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20ceaec73dSDamien Bergamini  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21ceaec73dSDamien Bergamini  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22ceaec73dSDamien Bergamini  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23ceaec73dSDamien Bergamini  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24ceaec73dSDamien Bergamini  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25ceaec73dSDamien Bergamini  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26ceaec73dSDamien Bergamini  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27ceaec73dSDamien Bergamini  * SUCH DAMAGE.
28ceaec73dSDamien Bergamini  */
29ceaec73dSDamien Bergamini 
30ceaec73dSDamien Bergamini #include <sys/cdefs.h>
31ceaec73dSDamien Bergamini __FBSDID("$FreeBSD$");
32ceaec73dSDamien Bergamini 
33ceaec73dSDamien Bergamini /*-
34ceaec73dSDamien Bergamini  * Intel(R) PRO/Wireless 2200BG/2225BG/2915ABG driver
35ceaec73dSDamien Bergamini  * http://www.intel.com/network/connectivity/products/wireless/prowireless_mobile.htm
36ceaec73dSDamien Bergamini  */
37ceaec73dSDamien Bergamini 
38ceaec73dSDamien Bergamini #include <sys/param.h>
39ceaec73dSDamien Bergamini #include <sys/sysctl.h>
40ceaec73dSDamien Bergamini #include <sys/sockio.h>
41ceaec73dSDamien Bergamini #include <sys/mbuf.h>
42ceaec73dSDamien Bergamini #include <sys/kernel.h>
43ceaec73dSDamien Bergamini #include <sys/socket.h>
44ceaec73dSDamien Bergamini #include <sys/systm.h>
45ceaec73dSDamien Bergamini #include <sys/malloc.h>
46ceaec73dSDamien Bergamini #include <sys/module.h>
47ceaec73dSDamien Bergamini #include <sys/bus.h>
48ceaec73dSDamien Bergamini #include <sys/endian.h>
49408146edSDamien Bergamini #include <sys/proc.h>
50408146edSDamien Bergamini #include <sys/mount.h>
51408146edSDamien Bergamini #include <sys/namei.h>
52408146edSDamien Bergamini #include <sys/vnode.h>
53ceaec73dSDamien Bergamini 
54ceaec73dSDamien Bergamini #include <machine/bus.h>
55ceaec73dSDamien Bergamini #include <machine/resource.h>
56ceaec73dSDamien Bergamini #include <machine/clock.h>
57ceaec73dSDamien Bergamini #include <sys/rman.h>
58ceaec73dSDamien Bergamini 
59ceaec73dSDamien Bergamini #include <dev/pci/pcireg.h>
60ceaec73dSDamien Bergamini #include <dev/pci/pcivar.h>
61ceaec73dSDamien Bergamini 
62ceaec73dSDamien Bergamini #include <net/bpf.h>
63ceaec73dSDamien Bergamini #include <net/if.h>
64ceaec73dSDamien Bergamini #include <net/if_arp.h>
65ceaec73dSDamien Bergamini #include <net/ethernet.h>
66ceaec73dSDamien Bergamini #include <net/if_dl.h>
67ceaec73dSDamien Bergamini #include <net/if_media.h>
68ceaec73dSDamien Bergamini #include <net/if_types.h>
69ceaec73dSDamien Bergamini 
70ceaec73dSDamien Bergamini #include <net80211/ieee80211_var.h>
71ceaec73dSDamien Bergamini #include <net80211/ieee80211_radiotap.h>
72ceaec73dSDamien Bergamini 
73ceaec73dSDamien Bergamini #include <netinet/in.h>
74ceaec73dSDamien Bergamini #include <netinet/in_systm.h>
75ceaec73dSDamien Bergamini #include <netinet/in_var.h>
76ceaec73dSDamien Bergamini #include <netinet/ip.h>
77ceaec73dSDamien Bergamini #include <netinet/if_ether.h>
78ceaec73dSDamien Bergamini 
79ceaec73dSDamien Bergamini #include <dev/iwi/if_iwivar.h>
8084f55b29SDamien Bergamini #include <dev/iwi/if_iwireg.h>
81ceaec73dSDamien Bergamini 
82ceaec73dSDamien Bergamini #ifdef IWI_DEBUG
83ceaec73dSDamien Bergamini #define DPRINTF(x)	do { if (iwi_debug > 0) printf x; } while (0)
84ceaec73dSDamien Bergamini #define DPRINTFN(n, x)	do { if (iwi_debug >= (n)) printf x; } while (0)
85ceaec73dSDamien Bergamini int iwi_debug = 0;
86ceaec73dSDamien Bergamini SYSCTL_INT(_debug, OID_AUTO, iwi, CTLFLAG_RW, &iwi_debug, 0, "iwi debug level");
87ceaec73dSDamien Bergamini #else
88ceaec73dSDamien Bergamini #define DPRINTF(x)
89ceaec73dSDamien Bergamini #define DPRINTFN(n, x)
90ceaec73dSDamien Bergamini #endif
91ceaec73dSDamien Bergamini 
92ceaec73dSDamien Bergamini MODULE_DEPEND(iwi, pci,  1, 1, 1);
93ceaec73dSDamien Bergamini MODULE_DEPEND(iwi, wlan, 1, 1, 1);
94ceaec73dSDamien Bergamini 
95ceaec73dSDamien Bergamini struct iwi_ident {
96ceaec73dSDamien Bergamini 	uint16_t	vendor;
97ceaec73dSDamien Bergamini 	uint16_t	device;
98ceaec73dSDamien Bergamini 	const char	*name;
99ceaec73dSDamien Bergamini };
100ceaec73dSDamien Bergamini 
101ceaec73dSDamien Bergamini static const struct iwi_ident iwi_ident_table[] = {
102ceaec73dSDamien Bergamini 	{ 0x8086, 0x4220, "Intel(R) PRO/Wireless 2200BG" },
103ceaec73dSDamien Bergamini 	{ 0x8086, 0x4221, "Intel(R) PRO/Wireless 2225BG" },
104ceaec73dSDamien Bergamini 	{ 0x8086, 0x4223, "Intel(R) PRO/Wireless 2915ABG" },
105ceaec73dSDamien Bergamini 	{ 0x8086, 0x4224, "Intel(R) PRO/Wireless 2915ABG" },
106ceaec73dSDamien Bergamini 
107ceaec73dSDamien Bergamini 	{ 0, 0, NULL }
108ceaec73dSDamien Bergamini };
109ceaec73dSDamien Bergamini 
110ceaec73dSDamien Bergamini static void	iwi_dma_map_addr(void *, bus_dma_segment_t *, int, int);
111ceaec73dSDamien Bergamini static int	iwi_alloc_cmd_ring(struct iwi_softc *, struct iwi_cmd_ring *,
112ceaec73dSDamien Bergamini 		    int);
113ceaec73dSDamien Bergamini static void	iwi_reset_cmd_ring(struct iwi_softc *, struct iwi_cmd_ring *);
114ceaec73dSDamien Bergamini static void	iwi_free_cmd_ring(struct iwi_softc *, struct iwi_cmd_ring *);
115ceaec73dSDamien Bergamini static int	iwi_alloc_tx_ring(struct iwi_softc *, struct iwi_tx_ring *,
116ec01dc2bSDamien Bergamini 		    int, bus_addr_t, bus_addr_t);
117ceaec73dSDamien Bergamini static void	iwi_reset_tx_ring(struct iwi_softc *, struct iwi_tx_ring *);
118ceaec73dSDamien Bergamini static void	iwi_free_tx_ring(struct iwi_softc *, struct iwi_tx_ring *);
119ceaec73dSDamien Bergamini static int	iwi_alloc_rx_ring(struct iwi_softc *, struct iwi_rx_ring *,
120ceaec73dSDamien Bergamini 		    int);
121ceaec73dSDamien Bergamini static void	iwi_reset_rx_ring(struct iwi_softc *, struct iwi_rx_ring *);
122ceaec73dSDamien Bergamini static void	iwi_free_rx_ring(struct iwi_softc *, struct iwi_rx_ring *);
12328a38073SDamien Bergamini static struct	ieee80211_node *iwi_node_alloc(struct ieee80211_node_table *);
12428a38073SDamien Bergamini static void	iwi_node_free(struct ieee80211_node *);
125ceaec73dSDamien Bergamini static int	iwi_media_change(struct ifnet *);
126ceaec73dSDamien Bergamini static void	iwi_media_status(struct ifnet *, struct ifmediareq *);
127ceaec73dSDamien Bergamini static int	iwi_newstate(struct ieee80211com *, enum ieee80211_state, int);
128ec01dc2bSDamien Bergamini static int	iwi_wme_update(struct ieee80211com *);
129ceaec73dSDamien Bergamini static uint16_t	iwi_read_prom_word(struct iwi_softc *, uint8_t);
130ceaec73dSDamien Bergamini static void	iwi_fix_channel(struct ieee80211com *, struct mbuf *);
131ceaec73dSDamien Bergamini static void	iwi_frame_intr(struct iwi_softc *, struct iwi_rx_data *, int,
132ceaec73dSDamien Bergamini 		    struct iwi_frame *);
133ceaec73dSDamien Bergamini static void	iwi_notification_intr(struct iwi_softc *, struct iwi_notif *);
134ceaec73dSDamien Bergamini static void	iwi_rx_intr(struct iwi_softc *);
135ec01dc2bSDamien Bergamini static void	iwi_tx_intr(struct iwi_softc *, struct iwi_tx_ring *);
136ceaec73dSDamien Bergamini static void	iwi_intr(void *);
137ceaec73dSDamien Bergamini static int	iwi_cmd(struct iwi_softc *, uint8_t, void *, uint8_t, int);
13828a38073SDamien Bergamini static void	iwi_write_ibssnode(struct iwi_softc *, const struct iwi_node *);
139ceaec73dSDamien Bergamini static int	iwi_tx_start(struct ifnet *, struct mbuf *,
1400b74a285SDamien Bergamini 		    struct ieee80211_node *, int);
141ceaec73dSDamien Bergamini static void	iwi_start(struct ifnet *);
142ceaec73dSDamien Bergamini static void	iwi_watchdog(struct ifnet *);
143ceaec73dSDamien Bergamini static int	iwi_ioctl(struct ifnet *, u_long, caddr_t);
144ceaec73dSDamien Bergamini static void	iwi_stop_master(struct iwi_softc *);
145ceaec73dSDamien Bergamini static int	iwi_reset(struct iwi_softc *);
146408146edSDamien Bergamini static int	iwi_load_ucode(struct iwi_softc *, const char *);
147408146edSDamien Bergamini static int	iwi_load_firmware(struct iwi_softc *, const char *);
148ceaec73dSDamien Bergamini static int	iwi_config(struct iwi_softc *);
149acea4241SDamien Bergamini static int	iwi_set_chan(struct iwi_softc *, struct ieee80211_channel *);
150ceaec73dSDamien Bergamini static int	iwi_scan(struct iwi_softc *);
151ceaec73dSDamien Bergamini static int	iwi_auth_and_assoc(struct iwi_softc *);
152ceaec73dSDamien Bergamini static void	iwi_init(void *);
153ceaec73dSDamien Bergamini static void	iwi_stop(void *);
154408146edSDamien Bergamini static int	iwi_read_firmware(const char *, caddr_t *, size_t *);
155ceaec73dSDamien Bergamini static int	iwi_sysctl_stats(SYSCTL_HANDLER_ARGS);
156ceaec73dSDamien Bergamini static int	iwi_sysctl_radio(SYSCTL_HANDLER_ARGS);
157ceaec73dSDamien Bergamini 
158ceaec73dSDamien Bergamini static int iwi_probe(device_t);
159ceaec73dSDamien Bergamini static int iwi_attach(device_t);
160ceaec73dSDamien Bergamini static int iwi_detach(device_t);
161ceaec73dSDamien Bergamini static int iwi_shutdown(device_t);
162ceaec73dSDamien Bergamini static int iwi_suspend(device_t);
163ceaec73dSDamien Bergamini static int iwi_resume(device_t);
164ceaec73dSDamien Bergamini 
165ceaec73dSDamien Bergamini static device_method_t iwi_methods[] = {
166ceaec73dSDamien Bergamini 	/* Device interface */
167ceaec73dSDamien Bergamini 	DEVMETHOD(device_probe,		iwi_probe),
168ceaec73dSDamien Bergamini 	DEVMETHOD(device_attach,	iwi_attach),
169ceaec73dSDamien Bergamini 	DEVMETHOD(device_detach,	iwi_detach),
170ceaec73dSDamien Bergamini 	DEVMETHOD(device_shutdown,	iwi_shutdown),
171ceaec73dSDamien Bergamini 	DEVMETHOD(device_suspend,	iwi_suspend),
172ceaec73dSDamien Bergamini 	DEVMETHOD(device_resume,	iwi_resume),
173ceaec73dSDamien Bergamini 
174ceaec73dSDamien Bergamini 	{ 0, 0 }
175ceaec73dSDamien Bergamini };
176ceaec73dSDamien Bergamini 
177ceaec73dSDamien Bergamini static driver_t iwi_driver = {
178ceaec73dSDamien Bergamini 	"iwi",
179ceaec73dSDamien Bergamini 	iwi_methods,
180ceaec73dSDamien Bergamini 	sizeof (struct iwi_softc)
181ceaec73dSDamien Bergamini };
182ceaec73dSDamien Bergamini 
183ceaec73dSDamien Bergamini static devclass_t iwi_devclass;
184ceaec73dSDamien Bergamini 
185ceaec73dSDamien Bergamini DRIVER_MODULE(iwi, pci, iwi_driver, iwi_devclass, 0, 0);
186ceaec73dSDamien Bergamini 
187ceaec73dSDamien Bergamini /*
188ceaec73dSDamien Bergamini  * Supported rates for 802.11a/b/g modes (in 500Kbps unit).
189ceaec73dSDamien Bergamini  */
190ceaec73dSDamien Bergamini static const struct ieee80211_rateset iwi_rateset_11a =
191ceaec73dSDamien Bergamini 	{ 8, { 12, 18, 24, 36, 48, 72, 96, 108 } };
192ceaec73dSDamien Bergamini 
193ceaec73dSDamien Bergamini static const struct ieee80211_rateset iwi_rateset_11b =
194ceaec73dSDamien Bergamini 	{ 4, { 2, 4, 11, 22 } };
195ceaec73dSDamien Bergamini 
196ceaec73dSDamien Bergamini static const struct ieee80211_rateset iwi_rateset_11g =
197ceaec73dSDamien Bergamini 	{ 12, { 2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108 } };
198ceaec73dSDamien Bergamini 
199ceaec73dSDamien Bergamini static int
200ceaec73dSDamien Bergamini iwi_probe(device_t dev)
201ceaec73dSDamien Bergamini {
202ceaec73dSDamien Bergamini 	const struct iwi_ident *ident;
203ceaec73dSDamien Bergamini 
204ceaec73dSDamien Bergamini 	for (ident = iwi_ident_table; ident->name != NULL; ident++) {
205ceaec73dSDamien Bergamini 		if (pci_get_vendor(dev) == ident->vendor &&
206ceaec73dSDamien Bergamini 		    pci_get_device(dev) == ident->device) {
207ceaec73dSDamien Bergamini 			device_set_desc(dev, ident->name);
208ceaec73dSDamien Bergamini 			return 0;
209ceaec73dSDamien Bergamini 		}
210ceaec73dSDamien Bergamini 	}
211ceaec73dSDamien Bergamini 	return ENXIO;
212ceaec73dSDamien Bergamini }
213ceaec73dSDamien Bergamini 
214ceaec73dSDamien Bergamini /* Base Address Register */
215ceaec73dSDamien Bergamini #define IWI_PCI_BAR0	0x10
216ceaec73dSDamien Bergamini 
217ceaec73dSDamien Bergamini static int
218ceaec73dSDamien Bergamini iwi_attach(device_t dev)
219ceaec73dSDamien Bergamini {
220ceaec73dSDamien Bergamini 	struct iwi_softc *sc = device_get_softc(dev);
221fc74a9f9SBrooks Davis 	struct ifnet *ifp;
222ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
223ceaec73dSDamien Bergamini 	uint16_t val;
224ceaec73dSDamien Bergamini 	int error, i;
225ceaec73dSDamien Bergamini 
226ceaec73dSDamien Bergamini 	sc->sc_dev = dev;
227ceaec73dSDamien Bergamini 
228ceaec73dSDamien Bergamini 	mtx_init(&sc->sc_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK,
229ceaec73dSDamien Bergamini 	    MTX_DEF | MTX_RECURSE);
230ceaec73dSDamien Bergamini 
23128a38073SDamien Bergamini 	sc->sc_unr = new_unrhdr(0, IWI_MAX_IBSSNODE, &sc->sc_mtx);
23228a38073SDamien Bergamini 
233ceaec73dSDamien Bergamini 	if (pci_get_powerstate(dev) != PCI_POWERSTATE_D0) {
234ceaec73dSDamien Bergamini 		device_printf(dev, "chip is in D%d power mode "
235ceaec73dSDamien Bergamini 		    "-- setting to D0\n", pci_get_powerstate(dev));
236ceaec73dSDamien Bergamini 		pci_set_powerstate(dev, PCI_POWERSTATE_D0);
237ceaec73dSDamien Bergamini 	}
238ceaec73dSDamien Bergamini 
239acea4241SDamien Bergamini 	pci_write_config(dev, 0x41, 0, 1);
240acea4241SDamien Bergamini 
241ceaec73dSDamien Bergamini 	/* enable bus-mastering */
242ceaec73dSDamien Bergamini 	pci_enable_busmaster(dev);
243ceaec73dSDamien Bergamini 
244ceaec73dSDamien Bergamini 	sc->mem_rid = IWI_PCI_BAR0;
245ceaec73dSDamien Bergamini 	sc->mem = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &sc->mem_rid,
246ceaec73dSDamien Bergamini 	    RF_ACTIVE);
247ceaec73dSDamien Bergamini 	if (sc->mem == NULL) {
248ceaec73dSDamien Bergamini 		device_printf(dev, "could not allocate memory resource\n");
249ceaec73dSDamien Bergamini 		goto fail;
250ceaec73dSDamien Bergamini 	}
251ceaec73dSDamien Bergamini 
252ceaec73dSDamien Bergamini 	sc->sc_st = rman_get_bustag(sc->mem);
253ceaec73dSDamien Bergamini 	sc->sc_sh = rman_get_bushandle(sc->mem);
254ceaec73dSDamien Bergamini 
255ceaec73dSDamien Bergamini 	sc->irq_rid = 0;
256ceaec73dSDamien Bergamini 	sc->irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->irq_rid,
257ceaec73dSDamien Bergamini 	    RF_ACTIVE | RF_SHAREABLE);
258ceaec73dSDamien Bergamini 	if (sc->irq == NULL) {
259ceaec73dSDamien Bergamini 		device_printf(dev, "could not allocate interrupt resource\n");
260ceaec73dSDamien Bergamini 		goto fail;
261ceaec73dSDamien Bergamini 	}
262ceaec73dSDamien Bergamini 
263ceaec73dSDamien Bergamini 	if (iwi_reset(sc) != 0) {
264ceaec73dSDamien Bergamini 		device_printf(dev, "could not reset adapter\n");
265ceaec73dSDamien Bergamini 		goto fail;
266ceaec73dSDamien Bergamini 	}
267ceaec73dSDamien Bergamini 
268ceaec73dSDamien Bergamini 	/*
269ceaec73dSDamien Bergamini 	 * Allocate rings.
270ceaec73dSDamien Bergamini 	 */
271ceaec73dSDamien Bergamini 	if (iwi_alloc_cmd_ring(sc, &sc->cmdq, IWI_CMD_RING_COUNT) != 0) {
272ceaec73dSDamien Bergamini 		device_printf(dev, "could not allocate Cmd ring\n");
273ceaec73dSDamien Bergamini 		goto fail;
274ceaec73dSDamien Bergamini 	}
275ceaec73dSDamien Bergamini 
276ec01dc2bSDamien Bergamini 	error = iwi_alloc_tx_ring(sc, &sc->txq[0], IWI_TX_RING_COUNT,
277ec01dc2bSDamien Bergamini 	    IWI_CSR_TX1_RIDX, IWI_CSR_TX1_WIDX);
278ec01dc2bSDamien Bergamini 	if (error != 0) {
279ec01dc2bSDamien Bergamini 		device_printf(dev, "could not allocate Tx ring 1\n");
280ec01dc2bSDamien Bergamini 		goto fail;
281ec01dc2bSDamien Bergamini 	}
282ec01dc2bSDamien Bergamini 
283ec01dc2bSDamien Bergamini 	error = iwi_alloc_tx_ring(sc, &sc->txq[1], IWI_TX_RING_COUNT,
284ec01dc2bSDamien Bergamini 	    IWI_CSR_TX2_RIDX, IWI_CSR_TX2_WIDX);
285ec01dc2bSDamien Bergamini 	if (error != 0) {
286ec01dc2bSDamien Bergamini 		device_printf(dev, "could not allocate Tx ring 2\n");
287ec01dc2bSDamien Bergamini 		goto fail;
288ec01dc2bSDamien Bergamini 	}
289ec01dc2bSDamien Bergamini 
290ec01dc2bSDamien Bergamini 	error = iwi_alloc_tx_ring(sc, &sc->txq[2], IWI_TX_RING_COUNT,
291ec01dc2bSDamien Bergamini 	    IWI_CSR_TX3_RIDX, IWI_CSR_TX3_WIDX);
292ec01dc2bSDamien Bergamini 	if (error != 0) {
293ec01dc2bSDamien Bergamini 		device_printf(dev, "could not allocate Tx ring 3\n");
294ec01dc2bSDamien Bergamini 		goto fail;
295ec01dc2bSDamien Bergamini 	}
296ec01dc2bSDamien Bergamini 
297ec01dc2bSDamien Bergamini 	error = iwi_alloc_tx_ring(sc, &sc->txq[3], IWI_TX_RING_COUNT,
298ec01dc2bSDamien Bergamini 	    IWI_CSR_TX4_RIDX, IWI_CSR_TX4_WIDX);
299ec01dc2bSDamien Bergamini 	if (error != 0) {
300ec01dc2bSDamien Bergamini 		device_printf(dev, "could not allocate Tx ring 4\n");
301ceaec73dSDamien Bergamini 		goto fail;
302ceaec73dSDamien Bergamini 	}
303ceaec73dSDamien Bergamini 
304ceaec73dSDamien Bergamini 	if (iwi_alloc_rx_ring(sc, &sc->rxq, IWI_RX_RING_COUNT) != 0) {
305ceaec73dSDamien Bergamini 		device_printf(dev, "could not allocate Rx ring\n");
306ceaec73dSDamien Bergamini 		goto fail;
307ceaec73dSDamien Bergamini 	}
308ceaec73dSDamien Bergamini 
309fc74a9f9SBrooks Davis 	ifp = sc->sc_ifp = if_alloc(IFT_ETHER);
310fc74a9f9SBrooks Davis 	if (ifp == NULL) {
311fc74a9f9SBrooks Davis 		device_printf(dev, "can not if_alloc()\n");
312fc74a9f9SBrooks Davis 		goto fail;
313fc74a9f9SBrooks Davis 	}
314ceaec73dSDamien Bergamini 	ifp->if_softc = sc;
315ceaec73dSDamien Bergamini 	if_initname(ifp, device_get_name(dev), device_get_unit(dev));
316ceaec73dSDamien Bergamini 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
317ceaec73dSDamien Bergamini 	ifp->if_init = iwi_init;
318ceaec73dSDamien Bergamini 	ifp->if_ioctl = iwi_ioctl;
319ceaec73dSDamien Bergamini 	ifp->if_start = iwi_start;
320ceaec73dSDamien Bergamini 	ifp->if_watchdog = iwi_watchdog;
321ceaec73dSDamien Bergamini 	IFQ_SET_MAXLEN(&ifp->if_snd, IFQ_MAXLEN);
322ceaec73dSDamien Bergamini 	ifp->if_snd.ifq_drv_maxlen = IFQ_MAXLEN;
323ceaec73dSDamien Bergamini 	IFQ_SET_READY(&ifp->if_snd);
324ceaec73dSDamien Bergamini 
325ceaec73dSDamien Bergamini 	ic->ic_ifp = ifp;
326ec01dc2bSDamien Bergamini 	ic->ic_wme.wme_update = iwi_wme_update;
327ceaec73dSDamien Bergamini 	ic->ic_phytype = IEEE80211_T_OFDM; /* not only, but not used */
328ceaec73dSDamien Bergamini 	ic->ic_opmode = IEEE80211_M_STA; /* default to BSS mode */
329ceaec73dSDamien Bergamini 	ic->ic_state = IEEE80211_S_INIT;
330ceaec73dSDamien Bergamini 
331ceaec73dSDamien Bergamini 	/* set device capabilities */
332ec01dc2bSDamien Bergamini 	ic->ic_caps =
3330b74a285SDamien Bergamini 	    IEEE80211_C_IBSS |		/* IBSS mode supported */
334ec01dc2bSDamien Bergamini 	    IEEE80211_C_MONITOR |	/* monitor mode supported */
335ec01dc2bSDamien Bergamini 	    IEEE80211_C_TXPMGT |	/* tx power management */
336ec01dc2bSDamien Bergamini 	    IEEE80211_C_SHPREAMBLE |	/* short preamble supported */
337ec01dc2bSDamien Bergamini 	    IEEE80211_C_WPA |		/* 802.11i */
338ec01dc2bSDamien Bergamini 	    IEEE80211_C_WME;		/* 802.11e */
339ceaec73dSDamien Bergamini 
340ceaec73dSDamien Bergamini 	/* read MAC address from EEPROM */
341ceaec73dSDamien Bergamini 	val = iwi_read_prom_word(sc, IWI_EEPROM_MAC + 0);
34281e6343cSDamien Bergamini 	ic->ic_myaddr[0] = val & 0xff;
34381e6343cSDamien Bergamini 	ic->ic_myaddr[1] = val >> 8;
344ceaec73dSDamien Bergamini 	val = iwi_read_prom_word(sc, IWI_EEPROM_MAC + 1);
34581e6343cSDamien Bergamini 	ic->ic_myaddr[2] = val & 0xff;
34681e6343cSDamien Bergamini 	ic->ic_myaddr[3] = val >> 8;
347ceaec73dSDamien Bergamini 	val = iwi_read_prom_word(sc, IWI_EEPROM_MAC + 2);
34881e6343cSDamien Bergamini 	ic->ic_myaddr[4] = val & 0xff;
34981e6343cSDamien Bergamini 	ic->ic_myaddr[5] = val >> 8;
350ceaec73dSDamien Bergamini 
351ceaec73dSDamien Bergamini 	if (pci_get_device(dev) >= 0x4223) {
352ceaec73dSDamien Bergamini 		/* set supported .11a rates (2915ABG only) */
353ceaec73dSDamien Bergamini 		ic->ic_sup_rates[IEEE80211_MODE_11A] = iwi_rateset_11a;
354ceaec73dSDamien Bergamini 
355ceaec73dSDamien Bergamini 		/* set supported .11a channels */
356ceaec73dSDamien Bergamini 		for (i = 36; i <= 64; i += 4) {
357ceaec73dSDamien Bergamini 			ic->ic_channels[i].ic_freq =
358ceaec73dSDamien Bergamini 			    ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ);
359ceaec73dSDamien Bergamini 			ic->ic_channels[i].ic_flags = IEEE80211_CHAN_A;
360ceaec73dSDamien Bergamini 		}
361ceaec73dSDamien Bergamini 		for (i = 149; i <= 165; i += 4) {
362ceaec73dSDamien Bergamini 			ic->ic_channels[i].ic_freq =
363ceaec73dSDamien Bergamini 			    ieee80211_ieee2mhz(i, IEEE80211_CHAN_5GHZ);
364ceaec73dSDamien Bergamini 			ic->ic_channels[i].ic_flags = IEEE80211_CHAN_A;
365ceaec73dSDamien Bergamini 		}
366ceaec73dSDamien Bergamini 	}
367ceaec73dSDamien Bergamini 
368ceaec73dSDamien Bergamini 	/* set supported .11b and .11g rates */
369ceaec73dSDamien Bergamini 	ic->ic_sup_rates[IEEE80211_MODE_11B] = iwi_rateset_11b;
370ceaec73dSDamien Bergamini 	ic->ic_sup_rates[IEEE80211_MODE_11G] = iwi_rateset_11g;
371ceaec73dSDamien Bergamini 
372ceaec73dSDamien Bergamini 	/* set supported .11b and .11g channels (1 through 14) */
373ceaec73dSDamien Bergamini 	for (i = 1; i <= 14; i++) {
374ceaec73dSDamien Bergamini 		ic->ic_channels[i].ic_freq =
375ceaec73dSDamien Bergamini 		    ieee80211_ieee2mhz(i, IEEE80211_CHAN_2GHZ);
376ceaec73dSDamien Bergamini 		ic->ic_channels[i].ic_flags =
377ceaec73dSDamien Bergamini 		    IEEE80211_CHAN_CCK | IEEE80211_CHAN_OFDM |
378ceaec73dSDamien Bergamini 		    IEEE80211_CHAN_DYN | IEEE80211_CHAN_2GHZ;
379ceaec73dSDamien Bergamini 	}
380ceaec73dSDamien Bergamini 
381ceaec73dSDamien Bergamini 	ieee80211_ifattach(ic);
38228a38073SDamien Bergamini 	/* override default methods */
38328a38073SDamien Bergamini 	ic->ic_node_alloc = iwi_node_alloc;
38428a38073SDamien Bergamini 	sc->sc_node_free = ic->ic_node_free;
38528a38073SDamien Bergamini 	ic->ic_node_free = iwi_node_free;
386ceaec73dSDamien Bergamini 	/* override state transition machine */
387ceaec73dSDamien Bergamini 	sc->sc_newstate = ic->ic_newstate;
388ceaec73dSDamien Bergamini 	ic->ic_newstate = iwi_newstate;
389ceaec73dSDamien Bergamini 	ieee80211_media_init(ic, iwi_media_change, iwi_media_status);
390ceaec73dSDamien Bergamini 
391ceaec73dSDamien Bergamini 	bpfattach2(ifp, DLT_IEEE802_11_RADIO,
392ceaec73dSDamien Bergamini 	    sizeof (struct ieee80211_frame) + 64, &sc->sc_drvbpf);
393ceaec73dSDamien Bergamini 
394ceaec73dSDamien Bergamini 	sc->sc_rxtap_len = sizeof sc->sc_rxtapu;
395ceaec73dSDamien Bergamini 	sc->sc_rxtap.wr_ihdr.it_len = htole16(sc->sc_rxtap_len);
396ceaec73dSDamien Bergamini 	sc->sc_rxtap.wr_ihdr.it_present = htole32(IWI_RX_RADIOTAP_PRESENT);
397ceaec73dSDamien Bergamini 
398ceaec73dSDamien Bergamini 	sc->sc_txtap_len = sizeof sc->sc_txtapu;
399ceaec73dSDamien Bergamini 	sc->sc_txtap.wt_ihdr.it_len = htole16(sc->sc_txtap_len);
400ceaec73dSDamien Bergamini 	sc->sc_txtap.wt_ihdr.it_present = htole32(IWI_TX_RADIOTAP_PRESENT);
401ceaec73dSDamien Bergamini 
402ceaec73dSDamien Bergamini 	/*
403ceaec73dSDamien Bergamini 	 * Add a few sysctl knobs.
404ceaec73dSDamien Bergamini 	 */
405ceaec73dSDamien Bergamini 	sc->dwelltime = 100;
406ceaec73dSDamien Bergamini 	sc->bluetooth = 1;
407acea4241SDamien Bergamini 	sc->antenna = 0;
408ceaec73dSDamien Bergamini 
409ceaec73dSDamien Bergamini 	SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
410ceaec73dSDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "radio",
411ceaec73dSDamien Bergamini 	    CTLTYPE_INT | CTLFLAG_RD, sc, 0, iwi_sysctl_radio, "I",
412ceaec73dSDamien Bergamini 	    "radio transmitter switch state (0=off, 1=on)");
413ceaec73dSDamien Bergamini 
414ceaec73dSDamien Bergamini 	SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
415ceaec73dSDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "stats",
416ceaec73dSDamien Bergamini 	    CTLTYPE_OPAQUE | CTLFLAG_RD, sc, 0, iwi_sysctl_stats, "S",
417ceaec73dSDamien Bergamini 	    "statistics");
418ceaec73dSDamien Bergamini 
419ceaec73dSDamien Bergamini 	SYSCTL_ADD_INT(device_get_sysctl_ctx(dev),
420ceaec73dSDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "dwell",
421ceaec73dSDamien Bergamini 	    CTLFLAG_RW, &sc->dwelltime, 0,
422ceaec73dSDamien Bergamini 	    "channel dwell time (ms) for AP/station scanning");
423ceaec73dSDamien Bergamini 
424ceaec73dSDamien Bergamini 	SYSCTL_ADD_INT(device_get_sysctl_ctx(dev),
425ceaec73dSDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "bluetooth",
426ceaec73dSDamien Bergamini 	    CTLFLAG_RW, &sc->bluetooth, 0, "bluetooth coexistence");
427ceaec73dSDamien Bergamini 
428acea4241SDamien Bergamini 	SYSCTL_ADD_INT(device_get_sysctl_ctx(dev),
429acea4241SDamien Bergamini 	    SYSCTL_CHILDREN(device_get_sysctl_tree(dev)), OID_AUTO, "antenna",
430acea4241SDamien Bergamini 	    CTLFLAG_RW, &sc->antenna, 0, "antenna (0=auto)");
431acea4241SDamien Bergamini 
432ceaec73dSDamien Bergamini 	/*
433ceaec73dSDamien Bergamini 	 * Hook our interrupt after all initialization is complete.
434ceaec73dSDamien Bergamini 	 */
435ceaec73dSDamien Bergamini 	error = bus_setup_intr(dev, sc->irq, INTR_TYPE_NET | INTR_MPSAFE,
436ceaec73dSDamien Bergamini 	    iwi_intr, sc, &sc->sc_ih);
437ceaec73dSDamien Bergamini 	if (error != 0) {
438ceaec73dSDamien Bergamini 		device_printf(dev, "could not set up interrupt\n");
439ceaec73dSDamien Bergamini 		goto fail;
440ceaec73dSDamien Bergamini 	}
441ceaec73dSDamien Bergamini 
442ceaec73dSDamien Bergamini 	if (bootverbose)
443ceaec73dSDamien Bergamini 		ieee80211_announce(ic);
444ceaec73dSDamien Bergamini 
445ceaec73dSDamien Bergamini 	return 0;
446ceaec73dSDamien Bergamini 
447ceaec73dSDamien Bergamini fail:	iwi_detach(dev);
448ceaec73dSDamien Bergamini 	return ENXIO;
449ceaec73dSDamien Bergamini }
450ceaec73dSDamien Bergamini 
451ceaec73dSDamien Bergamini static int
452ceaec73dSDamien Bergamini iwi_detach(device_t dev)
453ceaec73dSDamien Bergamini {
454ceaec73dSDamien Bergamini 	struct iwi_softc *sc = device_get_softc(dev);
455ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
456ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
457ceaec73dSDamien Bergamini 
458ceaec73dSDamien Bergamini 	iwi_stop(sc);
459ceaec73dSDamien Bergamini 
4600b74a285SDamien Bergamini 	if (ifp != NULL) {
461ceaec73dSDamien Bergamini 		bpfdetach(ifp);
462ceaec73dSDamien Bergamini 		ieee80211_ifdetach(ic);
4630b74a285SDamien Bergamini 	}
464ceaec73dSDamien Bergamini 
465ceaec73dSDamien Bergamini 	iwi_free_cmd_ring(sc, &sc->cmdq);
466ec01dc2bSDamien Bergamini 	iwi_free_tx_ring(sc, &sc->txq[0]);
467ec01dc2bSDamien Bergamini 	iwi_free_tx_ring(sc, &sc->txq[1]);
468ec01dc2bSDamien Bergamini 	iwi_free_tx_ring(sc, &sc->txq[2]);
469ec01dc2bSDamien Bergamini 	iwi_free_tx_ring(sc, &sc->txq[3]);
470ceaec73dSDamien Bergamini 	iwi_free_rx_ring(sc, &sc->rxq);
471ceaec73dSDamien Bergamini 
472ceaec73dSDamien Bergamini 	if (sc->irq != NULL) {
473ceaec73dSDamien Bergamini 		bus_teardown_intr(dev, sc->irq, sc->sc_ih);
474ceaec73dSDamien Bergamini 		bus_release_resource(dev, SYS_RES_IRQ, sc->irq_rid, sc->irq);
475ceaec73dSDamien Bergamini 	}
476ceaec73dSDamien Bergamini 
477ceaec73dSDamien Bergamini 	if (sc->mem != NULL)
478ceaec73dSDamien Bergamini 		bus_release_resource(dev, SYS_RES_MEMORY, sc->mem_rid, sc->mem);
479ceaec73dSDamien Bergamini 
480ad4f426eSWarner Losh 	if (ifp != NULL)
481ad4f426eSWarner Losh 		if_free(ifp);
4827e47fb02SDamien Bergamini 
48328a38073SDamien Bergamini 	if (sc->sc_unr != NULL)
48428a38073SDamien Bergamini 		delete_unrhdr(sc->sc_unr);
48528a38073SDamien Bergamini 
486ceaec73dSDamien Bergamini 	mtx_destroy(&sc->sc_mtx);
487ceaec73dSDamien Bergamini 
488ceaec73dSDamien Bergamini 	return 0;
489ceaec73dSDamien Bergamini }
490ceaec73dSDamien Bergamini 
491ceaec73dSDamien Bergamini static void
492ceaec73dSDamien Bergamini iwi_dma_map_addr(void *arg, bus_dma_segment_t *segs, int nseg, int error)
493ceaec73dSDamien Bergamini {
494ceaec73dSDamien Bergamini 	if (error != 0)
495ceaec73dSDamien Bergamini 		return;
496ceaec73dSDamien Bergamini 
497ceaec73dSDamien Bergamini 	KASSERT(nseg == 1, ("too many DMA segments, %d should be 1", nseg));
498ceaec73dSDamien Bergamini 
499ceaec73dSDamien Bergamini 	*(bus_addr_t *)arg = segs[0].ds_addr;
500ceaec73dSDamien Bergamini }
501ceaec73dSDamien Bergamini 
502ceaec73dSDamien Bergamini static int
503ceaec73dSDamien Bergamini iwi_alloc_cmd_ring(struct iwi_softc *sc, struct iwi_cmd_ring *ring, int count)
504ceaec73dSDamien Bergamini {
505ceaec73dSDamien Bergamini 	int error;
506ceaec73dSDamien Bergamini 
507ceaec73dSDamien Bergamini 	ring->count = count;
508ceaec73dSDamien Bergamini 	ring->queued = 0;
509ceaec73dSDamien Bergamini 	ring->cur = ring->next = 0;
510ceaec73dSDamien Bergamini 
511ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT,
512ceaec73dSDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, count * IWI_CMD_DESC_SIZE, 1,
513ceaec73dSDamien Bergamini 	    count * IWI_CMD_DESC_SIZE, 0, NULL, NULL, &ring->desc_dmat);
514ceaec73dSDamien Bergamini 	if (error != 0) {
515ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not create desc DMA tag\n");
516ceaec73dSDamien Bergamini 		goto fail;
517ceaec73dSDamien Bergamini 	}
518ceaec73dSDamien Bergamini 
519ceaec73dSDamien Bergamini 	error = bus_dmamem_alloc(ring->desc_dmat, (void **)&ring->desc,
520ceaec73dSDamien Bergamini 	    BUS_DMA_NOWAIT | BUS_DMA_ZERO, &ring->desc_map);
521ceaec73dSDamien Bergamini 	if (error != 0) {
522ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate DMA memory\n");
523ceaec73dSDamien Bergamini 		goto fail;
524ceaec73dSDamien Bergamini 	}
525ceaec73dSDamien Bergamini 
526ceaec73dSDamien Bergamini 	error = bus_dmamap_load(ring->desc_dmat, ring->desc_map, ring->desc,
527ceaec73dSDamien Bergamini 	    count * IWI_CMD_DESC_SIZE, iwi_dma_map_addr, &ring->physaddr, 0);
528ceaec73dSDamien Bergamini 	if (error != 0) {
529ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not load desc DMA map\n");
530ceaec73dSDamien Bergamini 		goto fail;
531ceaec73dSDamien Bergamini 	}
532ceaec73dSDamien Bergamini 
533ceaec73dSDamien Bergamini 	return 0;
534ceaec73dSDamien Bergamini 
535ceaec73dSDamien Bergamini fail:	iwi_free_cmd_ring(sc, ring);
536ceaec73dSDamien Bergamini 	return error;
537ceaec73dSDamien Bergamini }
538ceaec73dSDamien Bergamini 
539ceaec73dSDamien Bergamini static void
540ceaec73dSDamien Bergamini iwi_reset_cmd_ring(struct iwi_softc *sc, struct iwi_cmd_ring *ring)
541ceaec73dSDamien Bergamini {
542ceaec73dSDamien Bergamini 	ring->queued = 0;
543ceaec73dSDamien Bergamini 	ring->cur = ring->next = 0;
544ceaec73dSDamien Bergamini }
545ceaec73dSDamien Bergamini 
546ceaec73dSDamien Bergamini static void
547ceaec73dSDamien Bergamini iwi_free_cmd_ring(struct iwi_softc *sc, struct iwi_cmd_ring *ring)
548ceaec73dSDamien Bergamini {
549ceaec73dSDamien Bergamini 	if (ring->desc != NULL) {
550ceaec73dSDamien Bergamini 		bus_dmamap_sync(ring->desc_dmat, ring->desc_map,
551ceaec73dSDamien Bergamini 		    BUS_DMASYNC_POSTWRITE);
552ceaec73dSDamien Bergamini 		bus_dmamap_unload(ring->desc_dmat, ring->desc_map);
553ceaec73dSDamien Bergamini 		bus_dmamem_free(ring->desc_dmat, ring->desc, ring->desc_map);
554ceaec73dSDamien Bergamini 	}
555ceaec73dSDamien Bergamini 
556ceaec73dSDamien Bergamini 	if (ring->desc_dmat != NULL)
557ceaec73dSDamien Bergamini 		bus_dma_tag_destroy(ring->desc_dmat);
558ceaec73dSDamien Bergamini }
559ceaec73dSDamien Bergamini 
560ceaec73dSDamien Bergamini static int
561ec01dc2bSDamien Bergamini iwi_alloc_tx_ring(struct iwi_softc *sc, struct iwi_tx_ring *ring, int count,
562ec01dc2bSDamien Bergamini     bus_addr_t csr_ridx, bus_addr_t csr_widx)
563ceaec73dSDamien Bergamini {
564ceaec73dSDamien Bergamini 	int i, error;
565ceaec73dSDamien Bergamini 
566ceaec73dSDamien Bergamini 	ring->count = count;
567ceaec73dSDamien Bergamini 	ring->queued = 0;
568ceaec73dSDamien Bergamini 	ring->cur = ring->next = 0;
569ec01dc2bSDamien Bergamini 	ring->csr_ridx = csr_ridx;
570ec01dc2bSDamien Bergamini 	ring->csr_widx = csr_widx;
571ceaec73dSDamien Bergamini 
572ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT,
573ceaec73dSDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, count * IWI_TX_DESC_SIZE, 1,
574ceaec73dSDamien Bergamini 	    count * IWI_TX_DESC_SIZE, 0, NULL, NULL, &ring->desc_dmat);
575ceaec73dSDamien Bergamini 	if (error != 0) {
576ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not create desc DMA tag\n");
577ceaec73dSDamien Bergamini 		goto fail;
578ceaec73dSDamien Bergamini 	}
579ceaec73dSDamien Bergamini 
580ceaec73dSDamien Bergamini 	error = bus_dmamem_alloc(ring->desc_dmat, (void **)&ring->desc,
581ceaec73dSDamien Bergamini 	    BUS_DMA_NOWAIT | BUS_DMA_ZERO, &ring->desc_map);
582ceaec73dSDamien Bergamini 	if (error != 0) {
583ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate DMA memory\n");
584ceaec73dSDamien Bergamini 		goto fail;
585ceaec73dSDamien Bergamini 	}
586ceaec73dSDamien Bergamini 
587ceaec73dSDamien Bergamini 	error = bus_dmamap_load(ring->desc_dmat, ring->desc_map, ring->desc,
588ceaec73dSDamien Bergamini 	    count * IWI_TX_DESC_SIZE, iwi_dma_map_addr, &ring->physaddr, 0);
589ceaec73dSDamien Bergamini 	if (error != 0) {
590ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not load desc DMA map\n");
591ceaec73dSDamien Bergamini 		goto fail;
592ceaec73dSDamien Bergamini 	}
593ceaec73dSDamien Bergamini 
594ceaec73dSDamien Bergamini 	ring->data = malloc(count * sizeof (struct iwi_tx_data), M_DEVBUF,
595ceaec73dSDamien Bergamini 	    M_NOWAIT | M_ZERO);
596ceaec73dSDamien Bergamini 	if (ring->data == NULL) {
597ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate soft data\n");
598ceaec73dSDamien Bergamini 		error = ENOMEM;
599ceaec73dSDamien Bergamini 		goto fail;
600ceaec73dSDamien Bergamini 	}
601ceaec73dSDamien Bergamini 
602ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 1, 0, BUS_SPACE_MAXADDR_32BIT,
60384f55b29SDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, MCLBYTES, IWI_MAX_NSEG - 2,
60484f55b29SDamien Bergamini 	    MCLBYTES, 0, NULL, NULL, &ring->data_dmat);
605ceaec73dSDamien Bergamini 	if (error != 0) {
606ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not create data DMA tag\n");
607ceaec73dSDamien Bergamini 		goto fail;
608ceaec73dSDamien Bergamini 	}
609ceaec73dSDamien Bergamini 
610ceaec73dSDamien Bergamini 	for (i = 0; i < count; i++) {
611ceaec73dSDamien Bergamini 		error = bus_dmamap_create(ring->data_dmat, 0,
612ceaec73dSDamien Bergamini 		    &ring->data[i].map);
613ceaec73dSDamien Bergamini 		if (error != 0) {
614ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev, "could not create DMA map\n");
615ceaec73dSDamien Bergamini 			goto fail;
616ceaec73dSDamien Bergamini 		}
617ceaec73dSDamien Bergamini 	}
618ceaec73dSDamien Bergamini 
619ceaec73dSDamien Bergamini 	return 0;
620ceaec73dSDamien Bergamini 
621ceaec73dSDamien Bergamini fail:	iwi_free_tx_ring(sc, ring);
622ceaec73dSDamien Bergamini 	return error;
623ceaec73dSDamien Bergamini }
624ceaec73dSDamien Bergamini 
625ceaec73dSDamien Bergamini static void
626ceaec73dSDamien Bergamini iwi_reset_tx_ring(struct iwi_softc *sc, struct iwi_tx_ring *ring)
627ceaec73dSDamien Bergamini {
628ceaec73dSDamien Bergamini 	struct iwi_tx_data *data;
629ceaec73dSDamien Bergamini 	int i;
630ceaec73dSDamien Bergamini 
631ceaec73dSDamien Bergamini 	for (i = 0; i < ring->count; i++) {
632ceaec73dSDamien Bergamini 		data = &ring->data[i];
633ceaec73dSDamien Bergamini 
634ceaec73dSDamien Bergamini 		if (data->m != NULL) {
635ceaec73dSDamien Bergamini 			bus_dmamap_sync(ring->data_dmat, data->map,
636ceaec73dSDamien Bergamini 			    BUS_DMASYNC_POSTWRITE);
637ceaec73dSDamien Bergamini 			bus_dmamap_unload(ring->data_dmat, data->map);
638ceaec73dSDamien Bergamini 			m_freem(data->m);
639ceaec73dSDamien Bergamini 			data->m = NULL;
640ceaec73dSDamien Bergamini 		}
641ceaec73dSDamien Bergamini 
642ceaec73dSDamien Bergamini 		if (data->ni != NULL) {
643ceaec73dSDamien Bergamini 			ieee80211_free_node(data->ni);
644ceaec73dSDamien Bergamini 			data->ni = NULL;
645ceaec73dSDamien Bergamini 		}
646ceaec73dSDamien Bergamini 	}
647ceaec73dSDamien Bergamini 
648ceaec73dSDamien Bergamini 	ring->queued = 0;
649ceaec73dSDamien Bergamini 	ring->cur = ring->next = 0;
650ceaec73dSDamien Bergamini }
651ceaec73dSDamien Bergamini 
652ceaec73dSDamien Bergamini static void
653ceaec73dSDamien Bergamini iwi_free_tx_ring(struct iwi_softc *sc, struct iwi_tx_ring *ring)
654ceaec73dSDamien Bergamini {
655ceaec73dSDamien Bergamini 	struct iwi_tx_data *data;
656ceaec73dSDamien Bergamini 	int i;
657ceaec73dSDamien Bergamini 
658ceaec73dSDamien Bergamini 	if (ring->desc != NULL) {
659ceaec73dSDamien Bergamini 		bus_dmamap_sync(ring->desc_dmat, ring->desc_map,
660ceaec73dSDamien Bergamini 		    BUS_DMASYNC_POSTWRITE);
661ceaec73dSDamien Bergamini 		bus_dmamap_unload(ring->desc_dmat, ring->desc_map);
662ceaec73dSDamien Bergamini 		bus_dmamem_free(ring->desc_dmat, ring->desc, ring->desc_map);
663ceaec73dSDamien Bergamini 	}
664ceaec73dSDamien Bergamini 
665ceaec73dSDamien Bergamini 	if (ring->desc_dmat != NULL)
666ceaec73dSDamien Bergamini 		bus_dma_tag_destroy(ring->desc_dmat);
667ceaec73dSDamien Bergamini 
668ceaec73dSDamien Bergamini 	if (ring->data != NULL) {
669ceaec73dSDamien Bergamini 		for (i = 0; i < ring->count; i++) {
670ceaec73dSDamien Bergamini 			data = &ring->data[i];
671ceaec73dSDamien Bergamini 
672ceaec73dSDamien Bergamini 			if (data->m != NULL) {
673ceaec73dSDamien Bergamini 				bus_dmamap_sync(ring->data_dmat, data->map,
674ceaec73dSDamien Bergamini 				    BUS_DMASYNC_POSTWRITE);
675ceaec73dSDamien Bergamini 				bus_dmamap_unload(ring->data_dmat, data->map);
676ceaec73dSDamien Bergamini 				m_freem(data->m);
677ceaec73dSDamien Bergamini 			}
678ceaec73dSDamien Bergamini 
679ceaec73dSDamien Bergamini 			if (data->ni != NULL)
680ceaec73dSDamien Bergamini 				ieee80211_free_node(data->ni);
681ceaec73dSDamien Bergamini 
682ceaec73dSDamien Bergamini 			if (data->map != NULL)
683ceaec73dSDamien Bergamini 				bus_dmamap_destroy(ring->data_dmat, data->map);
684ceaec73dSDamien Bergamini 		}
685ceaec73dSDamien Bergamini 
686ceaec73dSDamien Bergamini 		free(ring->data, M_DEVBUF);
687ceaec73dSDamien Bergamini 	}
688ceaec73dSDamien Bergamini 
689ceaec73dSDamien Bergamini 	if (ring->data_dmat != NULL)
690ceaec73dSDamien Bergamini 		bus_dma_tag_destroy(ring->data_dmat);
691ceaec73dSDamien Bergamini }
692ceaec73dSDamien Bergamini 
693ceaec73dSDamien Bergamini static int
694ceaec73dSDamien Bergamini iwi_alloc_rx_ring(struct iwi_softc *sc, struct iwi_rx_ring *ring, int count)
695ceaec73dSDamien Bergamini {
696ceaec73dSDamien Bergamini 	struct iwi_rx_data *data;
697ceaec73dSDamien Bergamini 	int i, error;
698ceaec73dSDamien Bergamini 
699ceaec73dSDamien Bergamini 	ring->count = count;
700ceaec73dSDamien Bergamini 	ring->cur = 0;
701ceaec73dSDamien Bergamini 
702ceaec73dSDamien Bergamini 	ring->data = malloc(count * sizeof (struct iwi_rx_data), M_DEVBUF,
703ceaec73dSDamien Bergamini 	    M_NOWAIT | M_ZERO);
704ceaec73dSDamien Bergamini 	if (ring->data == NULL) {
705ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not allocate soft data\n");
706ceaec73dSDamien Bergamini 		error = ENOMEM;
707ceaec73dSDamien Bergamini 		goto fail;
708ceaec73dSDamien Bergamini 	}
709ceaec73dSDamien Bergamini 
710ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 1, 0, BUS_SPACE_MAXADDR_32BIT,
711ceaec73dSDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, MCLBYTES, 1, MCLBYTES, 0, NULL,
712ceaec73dSDamien Bergamini 	    NULL, &ring->data_dmat);
713ceaec73dSDamien Bergamini 	if (error != 0) {
714ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not create data DMA tag\n");
715ceaec73dSDamien Bergamini 		goto fail;
716ceaec73dSDamien Bergamini 	}
717ceaec73dSDamien Bergamini 
718ceaec73dSDamien Bergamini 	for (i = 0; i < count; i++) {
719ceaec73dSDamien Bergamini 		data = &ring->data[i];
720ceaec73dSDamien Bergamini 
721ceaec73dSDamien Bergamini 		error = bus_dmamap_create(ring->data_dmat, 0, &data->map);
722ceaec73dSDamien Bergamini 		if (error != 0) {
723ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev, "could not create DMA map\n");
724ceaec73dSDamien Bergamini 			goto fail;
725ceaec73dSDamien Bergamini 		}
726ceaec73dSDamien Bergamini 
727ceaec73dSDamien Bergamini 		data->m = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR);
728ceaec73dSDamien Bergamini 		if (data->m == NULL) {
729ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
730ceaec73dSDamien Bergamini 			    "could not allocate rx mbuf\n");
731ceaec73dSDamien Bergamini 			error = ENOMEM;
732ceaec73dSDamien Bergamini 			goto fail;
733ceaec73dSDamien Bergamini 		}
734ceaec73dSDamien Bergamini 
735ceaec73dSDamien Bergamini 		error = bus_dmamap_load(ring->data_dmat, data->map,
736ceaec73dSDamien Bergamini 		    mtod(data->m, void *), MCLBYTES, iwi_dma_map_addr,
737ceaec73dSDamien Bergamini 		    &data->physaddr, 0);
738ceaec73dSDamien Bergamini 		if (error != 0) {
739ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
740ceaec73dSDamien Bergamini 			    "could not load rx buf DMA map");
741ceaec73dSDamien Bergamini 			goto fail;
742ceaec73dSDamien Bergamini 		}
743ceaec73dSDamien Bergamini 
744ceaec73dSDamien Bergamini 		data->reg = IWI_CSR_RX_BASE + i * 4;
745ceaec73dSDamien Bergamini 	}
746ceaec73dSDamien Bergamini 
747ceaec73dSDamien Bergamini 	return 0;
748ceaec73dSDamien Bergamini 
749ceaec73dSDamien Bergamini fail:	iwi_free_rx_ring(sc, ring);
750ceaec73dSDamien Bergamini 	return error;
751ceaec73dSDamien Bergamini }
752ceaec73dSDamien Bergamini 
753ceaec73dSDamien Bergamini static void
754ceaec73dSDamien Bergamini iwi_reset_rx_ring(struct iwi_softc *sc, struct iwi_rx_ring *ring)
755ceaec73dSDamien Bergamini {
756ceaec73dSDamien Bergamini 	ring->cur = 0;
757ceaec73dSDamien Bergamini }
758ceaec73dSDamien Bergamini 
759ceaec73dSDamien Bergamini static void
760ceaec73dSDamien Bergamini iwi_free_rx_ring(struct iwi_softc *sc, struct iwi_rx_ring *ring)
761ceaec73dSDamien Bergamini {
762ceaec73dSDamien Bergamini 	struct iwi_rx_data *data;
763ceaec73dSDamien Bergamini 	int i;
764ceaec73dSDamien Bergamini 
765ceaec73dSDamien Bergamini 	if (ring->data != NULL) {
766ceaec73dSDamien Bergamini 		for (i = 0; i < ring->count; i++) {
767ceaec73dSDamien Bergamini 			data = &ring->data[i];
768ceaec73dSDamien Bergamini 
769ceaec73dSDamien Bergamini 			if (data->m != NULL) {
770ceaec73dSDamien Bergamini 				bus_dmamap_sync(ring->data_dmat, data->map,
771ceaec73dSDamien Bergamini 				    BUS_DMASYNC_POSTREAD);
772ceaec73dSDamien Bergamini 				bus_dmamap_unload(ring->data_dmat, data->map);
773ceaec73dSDamien Bergamini 				m_freem(data->m);
774ceaec73dSDamien Bergamini 			}
775ceaec73dSDamien Bergamini 
776ceaec73dSDamien Bergamini 			if (data->map != NULL)
777ceaec73dSDamien Bergamini 				bus_dmamap_destroy(ring->data_dmat, data->map);
778ceaec73dSDamien Bergamini 		}
779ceaec73dSDamien Bergamini 
780ceaec73dSDamien Bergamini 		free(ring->data, M_DEVBUF);
781ceaec73dSDamien Bergamini 	}
782ceaec73dSDamien Bergamini 
783ceaec73dSDamien Bergamini 	if (ring->data_dmat != NULL)
784ceaec73dSDamien Bergamini 		bus_dma_tag_destroy(ring->data_dmat);
785ceaec73dSDamien Bergamini }
786ceaec73dSDamien Bergamini 
787ceaec73dSDamien Bergamini static int
788ceaec73dSDamien Bergamini iwi_shutdown(device_t dev)
789ceaec73dSDamien Bergamini {
790ceaec73dSDamien Bergamini 	struct iwi_softc *sc = device_get_softc(dev);
791ceaec73dSDamien Bergamini 
792ceaec73dSDamien Bergamini 	iwi_stop(sc);
793ceaec73dSDamien Bergamini 
794ceaec73dSDamien Bergamini 	return 0;
795ceaec73dSDamien Bergamini }
796ceaec73dSDamien Bergamini 
797ceaec73dSDamien Bergamini static int
798ceaec73dSDamien Bergamini iwi_suspend(device_t dev)
799ceaec73dSDamien Bergamini {
800ceaec73dSDamien Bergamini 	struct iwi_softc *sc = device_get_softc(dev);
801ceaec73dSDamien Bergamini 
802ceaec73dSDamien Bergamini 	iwi_stop(sc);
803ceaec73dSDamien Bergamini 
804ceaec73dSDamien Bergamini 	return 0;
805ceaec73dSDamien Bergamini }
806ceaec73dSDamien Bergamini 
807ceaec73dSDamien Bergamini static int
808ceaec73dSDamien Bergamini iwi_resume(device_t dev)
809ceaec73dSDamien Bergamini {
810ceaec73dSDamien Bergamini 	struct iwi_softc *sc = device_get_softc(dev);
811ceaec73dSDamien Bergamini 	struct ifnet *ifp = sc->sc_ic.ic_ifp;
812ceaec73dSDamien Bergamini 
813ceaec73dSDamien Bergamini 	IWI_LOCK(sc);
814ceaec73dSDamien Bergamini 
815acea4241SDamien Bergamini 	pci_write_config(dev, 0x41, 0, 1);
816acea4241SDamien Bergamini 
817ceaec73dSDamien Bergamini 	if (ifp->if_flags & IFF_UP) {
818ceaec73dSDamien Bergamini 		ifp->if_init(ifp->if_softc);
81913f4c340SRobert Watson 		if (ifp->if_drv_flags & IFF_DRV_RUNNING)
820ceaec73dSDamien Bergamini 			ifp->if_start(ifp);
821ceaec73dSDamien Bergamini 	}
822ceaec73dSDamien Bergamini 
823ceaec73dSDamien Bergamini 	IWI_UNLOCK(sc);
824ceaec73dSDamien Bergamini 
825ceaec73dSDamien Bergamini 	return 0;
826ceaec73dSDamien Bergamini }
827ceaec73dSDamien Bergamini 
82828a38073SDamien Bergamini static struct ieee80211_node *
82928a38073SDamien Bergamini iwi_node_alloc(struct ieee80211_node_table *nt)
83028a38073SDamien Bergamini {
83128a38073SDamien Bergamini 	struct iwi_node *in;
83228a38073SDamien Bergamini 
83328a38073SDamien Bergamini 	in = malloc(sizeof (struct iwi_node), M_80211_NODE, M_NOWAIT | M_ZERO);
83428a38073SDamien Bergamini 	if (in == NULL)
83528a38073SDamien Bergamini 		return NULL;
83628a38073SDamien Bergamini 
83728a38073SDamien Bergamini 	in->in_station = -1;
83828a38073SDamien Bergamini 
83928a38073SDamien Bergamini 	return &in->in_node;
84028a38073SDamien Bergamini }
84128a38073SDamien Bergamini 
84228a38073SDamien Bergamini static void
84328a38073SDamien Bergamini iwi_node_free(struct ieee80211_node *ni)
84428a38073SDamien Bergamini {
84528a38073SDamien Bergamini 	struct ieee80211com *ic = ni->ni_ic;
84628a38073SDamien Bergamini 	struct iwi_softc *sc = ic->ic_ifp->if_softc;
84728a38073SDamien Bergamini 	struct iwi_node *in = (struct iwi_node *)ni;
84828a38073SDamien Bergamini 
84928a38073SDamien Bergamini 	if (in->in_station != -1)
85028a38073SDamien Bergamini 		free_unr(sc->sc_unr, in->in_station);
85128a38073SDamien Bergamini 
85228a38073SDamien Bergamini 	sc->sc_node_free(ni);
85328a38073SDamien Bergamini }
85428a38073SDamien Bergamini 
855ceaec73dSDamien Bergamini static int
856ceaec73dSDamien Bergamini iwi_media_change(struct ifnet *ifp)
857ceaec73dSDamien Bergamini {
858ceaec73dSDamien Bergamini 	struct iwi_softc *sc = ifp->if_softc;
859ceaec73dSDamien Bergamini 	int error;
860ceaec73dSDamien Bergamini 
861ceaec73dSDamien Bergamini 	IWI_LOCK(sc);
862ceaec73dSDamien Bergamini 
863ceaec73dSDamien Bergamini 	error = ieee80211_media_change(ifp);
864ceaec73dSDamien Bergamini 	if (error != ENETRESET) {
865ceaec73dSDamien Bergamini 		IWI_UNLOCK(sc);
866ceaec73dSDamien Bergamini 		return error;
867ceaec73dSDamien Bergamini 	}
868ceaec73dSDamien Bergamini 
86913f4c340SRobert Watson 	if ((ifp->if_flags & IFF_UP) && (ifp->if_drv_flags & IFF_DRV_RUNNING))
870ceaec73dSDamien Bergamini 		iwi_init(sc);
871ceaec73dSDamien Bergamini 
872ceaec73dSDamien Bergamini 	IWI_UNLOCK(sc);
873ceaec73dSDamien Bergamini 
874ceaec73dSDamien Bergamini 	return 0;
875ceaec73dSDamien Bergamini }
876ceaec73dSDamien Bergamini 
877ceaec73dSDamien Bergamini /*
87828a38073SDamien Bergamini  * The firmware automatically adapts the transmit speed.  We report its current
87928a38073SDamien Bergamini  * value here.
880ceaec73dSDamien Bergamini  */
881ceaec73dSDamien Bergamini static void
882ceaec73dSDamien Bergamini iwi_media_status(struct ifnet *ifp, struct ifmediareq *imr)
883ceaec73dSDamien Bergamini {
884ceaec73dSDamien Bergamini 	struct iwi_softc *sc = ifp->if_softc;
885ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
886ceaec73dSDamien Bergamini #define N(a)	(sizeof (a) / sizeof (a[0]))
887ceaec73dSDamien Bergamini 	static const struct {
888ceaec73dSDamien Bergamini 		uint32_t	val;
889ceaec73dSDamien Bergamini 		int		rate;
890ceaec73dSDamien Bergamini 	} rates[] = {
891ceaec73dSDamien Bergamini 		{ IWI_RATE_DS1,      2 },
892ceaec73dSDamien Bergamini 		{ IWI_RATE_DS2,      4 },
893ceaec73dSDamien Bergamini 		{ IWI_RATE_DS5,     11 },
894ceaec73dSDamien Bergamini 		{ IWI_RATE_DS11,    22 },
895ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM6,   12 },
896ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM9,   18 },
897ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM12,  24 },
898ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM18,  36 },
899ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM24,  48 },
900ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM36,  72 },
901ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM48,  96 },
902ceaec73dSDamien Bergamini 		{ IWI_RATE_OFDM54, 108 },
903ceaec73dSDamien Bergamini 	};
904ceaec73dSDamien Bergamini 	uint32_t val;
905ceaec73dSDamien Bergamini 	int rate, i;
906ceaec73dSDamien Bergamini 
907ceaec73dSDamien Bergamini 	imr->ifm_status = IFM_AVALID;
908ceaec73dSDamien Bergamini 	imr->ifm_active = IFM_IEEE80211;
909ceaec73dSDamien Bergamini 	if (ic->ic_state == IEEE80211_S_RUN)
910ceaec73dSDamien Bergamini 		imr->ifm_status |= IFM_ACTIVE;
911ceaec73dSDamien Bergamini 
912ceaec73dSDamien Bergamini 	/* read current transmission rate from adapter */
913ceaec73dSDamien Bergamini 	val = CSR_READ_4(sc, IWI_CSR_CURRENT_TX_RATE);
914ceaec73dSDamien Bergamini 
915ceaec73dSDamien Bergamini 	/* convert rate to 802.11 rate */
916ceaec73dSDamien Bergamini 	for (i = 0; i < N(rates) && rates[i].val != val; i++);
917ceaec73dSDamien Bergamini 	rate = (i < N(rates)) ? rates[i].rate : 0;
918ceaec73dSDamien Bergamini 
919ceaec73dSDamien Bergamini 	imr->ifm_active |= ieee80211_rate2media(ic, rate, ic->ic_curmode);
920ceaec73dSDamien Bergamini 	switch (ic->ic_opmode) {
921ceaec73dSDamien Bergamini 	case IEEE80211_M_STA:
922ceaec73dSDamien Bergamini 		break;
923ceaec73dSDamien Bergamini 
924ceaec73dSDamien Bergamini 	case IEEE80211_M_IBSS:
925ceaec73dSDamien Bergamini 		imr->ifm_active |= IFM_IEEE80211_ADHOC;
926ceaec73dSDamien Bergamini 		break;
927ceaec73dSDamien Bergamini 
928ceaec73dSDamien Bergamini 	case IEEE80211_M_MONITOR:
929ceaec73dSDamien Bergamini 		imr->ifm_active |= IFM_IEEE80211_MONITOR;
930ceaec73dSDamien Bergamini 		break;
931ceaec73dSDamien Bergamini 
932ceaec73dSDamien Bergamini 	case IEEE80211_M_AHDEMO:
933ceaec73dSDamien Bergamini 	case IEEE80211_M_HOSTAP:
934ceaec73dSDamien Bergamini 		/* should not get there */
935ceaec73dSDamien Bergamini 		break;
936ceaec73dSDamien Bergamini 	}
937ceaec73dSDamien Bergamini #undef N
938ceaec73dSDamien Bergamini }
939ceaec73dSDamien Bergamini 
940ceaec73dSDamien Bergamini static int
941ceaec73dSDamien Bergamini iwi_newstate(struct ieee80211com *ic, enum ieee80211_state nstate, int arg)
942ceaec73dSDamien Bergamini {
943ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
944ceaec73dSDamien Bergamini 	struct iwi_softc *sc = ifp->if_softc;
94584f55b29SDamien Bergamini 	enum ieee80211_state ostate;
94684f55b29SDamien Bergamini 	uint32_t tmp;
94784f55b29SDamien Bergamini 
94884f55b29SDamien Bergamini 	ostate = ic->ic_state;
949ceaec73dSDamien Bergamini 
950ceaec73dSDamien Bergamini 	switch (nstate) {
951ceaec73dSDamien Bergamini 	case IEEE80211_S_SCAN:
952acea4241SDamien Bergamini 		if (sc->flags & IWI_FLAG_SCANNING)
953acea4241SDamien Bergamini 			break;
954acea4241SDamien Bergamini 
955acea4241SDamien Bergamini 		ieee80211_node_table_reset(&ic->ic_scan);
956acea4241SDamien Bergamini 		ic->ic_flags |= IEEE80211_F_SCAN | IEEE80211_F_ASCAN;
957acea4241SDamien Bergamini 		sc->flags |= IWI_FLAG_SCANNING;
958ceaec73dSDamien Bergamini 		iwi_scan(sc);
959ceaec73dSDamien Bergamini 		break;
960ceaec73dSDamien Bergamini 
961ceaec73dSDamien Bergamini 	case IEEE80211_S_AUTH:
962ceaec73dSDamien Bergamini 		iwi_auth_and_assoc(sc);
963ceaec73dSDamien Bergamini 		break;
964ceaec73dSDamien Bergamini 
965ceaec73dSDamien Bergamini 	case IEEE80211_S_RUN:
966ceaec73dSDamien Bergamini 		if (ic->ic_opmode == IEEE80211_M_IBSS)
96784f55b29SDamien Bergamini 			iwi_auth_and_assoc(sc);
968acea4241SDamien Bergamini 		else if (ic->ic_opmode == IEEE80211_M_MONITOR)
969acea4241SDamien Bergamini 			iwi_set_chan(sc, ic->ic_ibss_chan);
970acea4241SDamien Bergamini 
97184f55b29SDamien Bergamini 		/* assoc led on */
97284f55b29SDamien Bergamini 		tmp = MEM_READ_4(sc, IWI_MEM_EVENT_CTL) & IWI_LED_MASK;
97384f55b29SDamien Bergamini 		MEM_WRITE_4(sc, IWI_MEM_EVENT_CTL, tmp | IWI_LED_ASSOC);
97484f55b29SDamien Bergamini 
975acea4241SDamien Bergamini 		return sc->sc_newstate(ic, nstate,
976acea4241SDamien Bergamini 		    IEEE80211_FC0_SUBTYPE_ASSOC_RESP);
977ceaec73dSDamien Bergamini 
978ceaec73dSDamien Bergamini 	case IEEE80211_S_ASSOC:
979acea4241SDamien Bergamini 		break;
980acea4241SDamien Bergamini 
981ceaec73dSDamien Bergamini 	case IEEE80211_S_INIT:
982acea4241SDamien Bergamini 		sc->flags &= ~IWI_FLAG_SCANNING;
98384f55b29SDamien Bergamini 
98484f55b29SDamien Bergamini 		if (ostate != IEEE80211_S_RUN)
98584f55b29SDamien Bergamini 			break;
98684f55b29SDamien Bergamini 
98784f55b29SDamien Bergamini 		/* assoc led off */
98884f55b29SDamien Bergamini 		tmp = MEM_READ_4(sc, IWI_MEM_EVENT_CTL) & IWI_LED_MASK;
98984f55b29SDamien Bergamini 		MEM_WRITE_4(sc, IWI_MEM_EVENT_CTL, tmp & ~IWI_LED_ASSOC);
990ceaec73dSDamien Bergamini 		break;
991ceaec73dSDamien Bergamini 	}
992ceaec73dSDamien Bergamini 
993ceaec73dSDamien Bergamini 	ic->ic_state = nstate;
99484f55b29SDamien Bergamini 
995ceaec73dSDamien Bergamini 	return 0;
996ceaec73dSDamien Bergamini }
997ceaec73dSDamien Bergamini 
998fb533d55SDamien Bergamini /*
999fb533d55SDamien Bergamini  * WME parameters coming from IEEE 802.11e specification.  These values are
1000fb533d55SDamien Bergamini  * already declared in ieee80211_proto.c, but they are static so they can't
1001fb533d55SDamien Bergamini  * be reused here.
1002fb533d55SDamien Bergamini  */
1003fb533d55SDamien Bergamini static const struct wmeParams iwi_wme_cck_params[WME_NUM_AC] = {
1004fb533d55SDamien Bergamini 	{ 0, 3, 5,  7,   0 },	/* WME_AC_BE */
1005fb533d55SDamien Bergamini 	{ 0, 3, 5, 10,   0 },	/* WME_AC_BK */
1006fb533d55SDamien Bergamini 	{ 0, 2, 4,  5, 188 },	/* WME_AC_VI */
1007fb533d55SDamien Bergamini 	{ 0, 2, 3,  4, 102 }	/* WME_AC_VO */
1008fb533d55SDamien Bergamini };
1009fb533d55SDamien Bergamini 
1010fb533d55SDamien Bergamini static const struct wmeParams iwi_wme_ofdm_params[WME_NUM_AC] = {
1011fb533d55SDamien Bergamini 	{ 0, 3, 4,  6,   0 },	/* WME_AC_BE */
1012fb533d55SDamien Bergamini 	{ 0, 3, 4, 10,   0 },	/* WME_AC_BK */
1013fb533d55SDamien Bergamini 	{ 0, 2, 3,  4,  94 },	/* WME_AC_VI */
1014fb533d55SDamien Bergamini 	{ 0, 2, 2,  3,  47 }	/* WME_AC_VO */
1015fb533d55SDamien Bergamini };
1016fb533d55SDamien Bergamini 
1017ec01dc2bSDamien Bergamini static int
1018ec01dc2bSDamien Bergamini iwi_wme_update(struct ieee80211com *ic)
1019ec01dc2bSDamien Bergamini {
1020fb533d55SDamien Bergamini #define IWI_EXP2(v)	htole16((1 << (v)) - 1)
1021fb533d55SDamien Bergamini #define IWI_USEC(v)	htole16(IEEE80211_TXOP_TO_US(v))
1022fb533d55SDamien Bergamini 	struct iwi_softc *sc = ic->ic_ifp->if_softc;
1023fb533d55SDamien Bergamini 	struct iwi_wme_params wme[3];
1024fb533d55SDamien Bergamini 	const struct wmeParams *wmep;
1025fb533d55SDamien Bergamini 	int ac;
1026ec01dc2bSDamien Bergamini 
1027fb533d55SDamien Bergamini 	/*
1028fb533d55SDamien Bergamini 	 * We shall not override firmware default WME values if WME is not
1029fb533d55SDamien Bergamini 	 * actually enabled.
1030fb533d55SDamien Bergamini 	 */
1031fb533d55SDamien Bergamini 	if (!(ic->ic_flags & IEEE80211_F_WME))
1032ec01dc2bSDamien Bergamini 		return 0;
1033fb533d55SDamien Bergamini 
1034fb533d55SDamien Bergamini 	for (ac = 0; ac < WME_NUM_AC; ac++) {
1035fb533d55SDamien Bergamini 		/* set WME values for current operating mode */
1036fb533d55SDamien Bergamini 		wmep = &ic->ic_wme.wme_chanParams.cap_wmeParams[ac];
1037fb533d55SDamien Bergamini 		wme[0].aifsn[ac] = wmep->wmep_aifsn;
1038fb533d55SDamien Bergamini 		wme[0].cwmin[ac] = IWI_EXP2(wmep->wmep_logcwmin);
1039fb533d55SDamien Bergamini 		wme[0].cwmax[ac] = IWI_EXP2(wmep->wmep_logcwmax);
1040fb533d55SDamien Bergamini 		wme[0].burst[ac] = IWI_USEC(wmep->wmep_txopLimit);
1041fb533d55SDamien Bergamini 		wme[0].acm[ac]   = wmep->wmep_acm;
1042fb533d55SDamien Bergamini 
1043fb533d55SDamien Bergamini 		/* set WME values for CCK modulation */
1044fb533d55SDamien Bergamini 		wmep = &iwi_wme_cck_params[ac];
1045fb533d55SDamien Bergamini 		wme[1].aifsn[ac] = wmep->wmep_aifsn;
1046fb533d55SDamien Bergamini 		wme[1].cwmin[ac] = IWI_EXP2(wmep->wmep_logcwmin);
1047fb533d55SDamien Bergamini 		wme[1].cwmax[ac] = IWI_EXP2(wmep->wmep_logcwmax);
1048fb533d55SDamien Bergamini 		wme[1].burst[ac] = IWI_USEC(wmep->wmep_txopLimit);
1049fb533d55SDamien Bergamini 		wme[1].acm[ac]   = wmep->wmep_acm;
1050fb533d55SDamien Bergamini 
1051fb533d55SDamien Bergamini 		/* set WME values for OFDM modulation */
1052fb533d55SDamien Bergamini 		wmep = &iwi_wme_ofdm_params[ac];
1053fb533d55SDamien Bergamini 		wme[2].aifsn[ac] = wmep->wmep_aifsn;
1054fb533d55SDamien Bergamini 		wme[2].cwmin[ac] = IWI_EXP2(wmep->wmep_logcwmin);
1055fb533d55SDamien Bergamini 		wme[2].cwmax[ac] = IWI_EXP2(wmep->wmep_logcwmax);
1056fb533d55SDamien Bergamini 		wme[2].burst[ac] = IWI_USEC(wmep->wmep_txopLimit);
1057fb533d55SDamien Bergamini 		wme[2].acm[ac]   = wmep->wmep_acm;
1058fb533d55SDamien Bergamini 	}
1059fb533d55SDamien Bergamini 
1060fb533d55SDamien Bergamini 	DPRINTF(("Setting WME parameters\n"));
1061fb533d55SDamien Bergamini 	return iwi_cmd(sc, IWI_CMD_SET_WME_PARAMS, wme, sizeof wme, 1);
1062fb533d55SDamien Bergamini #undef IWI_USEC
1063fb533d55SDamien Bergamini #undef IWI_EXP2
1064ec01dc2bSDamien Bergamini }
1065ec01dc2bSDamien Bergamini 
1066ceaec73dSDamien Bergamini /*
1067ceaec73dSDamien Bergamini  * Read 16 bits at address 'addr' from the serial EEPROM.
1068ceaec73dSDamien Bergamini  */
1069ceaec73dSDamien Bergamini static uint16_t
1070ceaec73dSDamien Bergamini iwi_read_prom_word(struct iwi_softc *sc, uint8_t addr)
1071ceaec73dSDamien Bergamini {
1072ceaec73dSDamien Bergamini 	uint32_t tmp;
1073ceaec73dSDamien Bergamini 	uint16_t val;
1074ceaec73dSDamien Bergamini 	int n;
1075ceaec73dSDamien Bergamini 
1076ceaec73dSDamien Bergamini 	/* clock C once before the first command */
1077ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, 0);
1078ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S);
1079ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_C);
1080ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S);
1081ceaec73dSDamien Bergamini 
1082ceaec73dSDamien Bergamini 	/* write start bit (1) */
1083ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_D);
1084ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_D | IWI_EEPROM_C);
1085ceaec73dSDamien Bergamini 
1086ceaec73dSDamien Bergamini 	/* write READ opcode (10) */
1087ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_D);
1088ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_D | IWI_EEPROM_C);
1089ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S);
1090ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_C);
1091ceaec73dSDamien Bergamini 
1092ceaec73dSDamien Bergamini 	/* write address A7-A0 */
1093ceaec73dSDamien Bergamini 	for (n = 7; n >= 0; n--) {
1094ceaec73dSDamien Bergamini 		IWI_EEPROM_CTL(sc, IWI_EEPROM_S |
1095ceaec73dSDamien Bergamini 		    (((addr >> n) & 1) << IWI_EEPROM_SHIFT_D));
1096ceaec73dSDamien Bergamini 		IWI_EEPROM_CTL(sc, IWI_EEPROM_S |
1097ceaec73dSDamien Bergamini 		    (((addr >> n) & 1) << IWI_EEPROM_SHIFT_D) | IWI_EEPROM_C);
1098ceaec73dSDamien Bergamini 	}
1099ceaec73dSDamien Bergamini 
1100ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S);
1101ceaec73dSDamien Bergamini 
1102ceaec73dSDamien Bergamini 	/* read data Q15-Q0 */
1103ceaec73dSDamien Bergamini 	val = 0;
1104ceaec73dSDamien Bergamini 	for (n = 15; n >= 0; n--) {
1105ceaec73dSDamien Bergamini 		IWI_EEPROM_CTL(sc, IWI_EEPROM_S | IWI_EEPROM_C);
1106ceaec73dSDamien Bergamini 		IWI_EEPROM_CTL(sc, IWI_EEPROM_S);
1107ceaec73dSDamien Bergamini 		tmp = MEM_READ_4(sc, IWI_MEM_EEPROM_CTL);
1108ceaec73dSDamien Bergamini 		val |= ((tmp & IWI_EEPROM_Q) >> IWI_EEPROM_SHIFT_Q) << n;
1109ceaec73dSDamien Bergamini 	}
1110ceaec73dSDamien Bergamini 
1111ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, 0);
1112ceaec73dSDamien Bergamini 
1113ceaec73dSDamien Bergamini 	/* clear Chip Select and clock C */
1114ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_S);
1115ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, 0);
1116ceaec73dSDamien Bergamini 	IWI_EEPROM_CTL(sc, IWI_EEPROM_C);
1117ceaec73dSDamien Bergamini 
111881e6343cSDamien Bergamini 	return val;
1119ceaec73dSDamien Bergamini }
1120ceaec73dSDamien Bergamini 
1121ceaec73dSDamien Bergamini /*
1122ceaec73dSDamien Bergamini  * XXX: Hack to set the current channel to the value advertised in beacons or
1123ceaec73dSDamien Bergamini  * probe responses. Only used during AP detection.
1124ceaec73dSDamien Bergamini  */
1125ceaec73dSDamien Bergamini static void
1126ceaec73dSDamien Bergamini iwi_fix_channel(struct ieee80211com *ic, struct mbuf *m)
1127ceaec73dSDamien Bergamini {
1128ceaec73dSDamien Bergamini 	struct ieee80211_frame *wh;
1129ceaec73dSDamien Bergamini 	uint8_t subtype;
1130ceaec73dSDamien Bergamini 	uint8_t *frm, *efrm;
1131ceaec73dSDamien Bergamini 
1132ceaec73dSDamien Bergamini 	wh = mtod(m, struct ieee80211_frame *);
1133ceaec73dSDamien Bergamini 
1134ceaec73dSDamien Bergamini 	if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) != IEEE80211_FC0_TYPE_MGT)
1135ceaec73dSDamien Bergamini 		return;
1136ceaec73dSDamien Bergamini 
1137ceaec73dSDamien Bergamini 	subtype = wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK;
1138ceaec73dSDamien Bergamini 
1139ceaec73dSDamien Bergamini 	if (subtype != IEEE80211_FC0_SUBTYPE_BEACON &&
1140ceaec73dSDamien Bergamini 	    subtype != IEEE80211_FC0_SUBTYPE_PROBE_RESP)
1141ceaec73dSDamien Bergamini 		return;
1142ceaec73dSDamien Bergamini 
1143ceaec73dSDamien Bergamini 	frm = (uint8_t *)(wh + 1);
1144ceaec73dSDamien Bergamini 	efrm = mtod(m, uint8_t *) + m->m_len;
1145ceaec73dSDamien Bergamini 
1146ceaec73dSDamien Bergamini 	frm += 12;	/* skip tstamp, bintval and capinfo fields */
1147ceaec73dSDamien Bergamini 	while (frm < efrm) {
1148ceaec73dSDamien Bergamini 		if (*frm == IEEE80211_ELEMID_DSPARMS)
1149ceaec73dSDamien Bergamini #if IEEE80211_CHAN_MAX < 255
1150ceaec73dSDamien Bergamini 		if (frm[2] <= IEEE80211_CHAN_MAX)
1151ceaec73dSDamien Bergamini #endif
115245f3f78cSJohn Baldwin 			ic->ic_curchan = &ic->ic_channels[frm[2]];
1153ceaec73dSDamien Bergamini 
1154ceaec73dSDamien Bergamini 		frm += frm[1] + 2;
1155ceaec73dSDamien Bergamini 	}
1156ceaec73dSDamien Bergamini }
1157ceaec73dSDamien Bergamini 
1158ceaec73dSDamien Bergamini static void
1159ceaec73dSDamien Bergamini iwi_frame_intr(struct iwi_softc *sc, struct iwi_rx_data *data, int i,
1160ceaec73dSDamien Bergamini     struct iwi_frame *frame)
1161ceaec73dSDamien Bergamini {
1162ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1163ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
116446c34436SDamien Bergamini 	struct mbuf *mnew, *m;
1165ceaec73dSDamien Bergamini 	struct ieee80211_frame *wh;
1166ceaec73dSDamien Bergamini 	struct ieee80211_node *ni;
1167ceaec73dSDamien Bergamini 	int error;
1168ceaec73dSDamien Bergamini 
1169ceaec73dSDamien Bergamini 	DPRINTFN(5, ("received frame len=%u chan=%u rssi=%u\n",
1170ceaec73dSDamien Bergamini 	    le16toh(frame->len), frame->chan, frame->rssi_dbm));
1171ceaec73dSDamien Bergamini 
1172acea4241SDamien Bergamini 	if (le16toh(frame->len) < sizeof (struct ieee80211_frame))
1173acea4241SDamien Bergamini 		return;
1174acea4241SDamien Bergamini 
117546c34436SDamien Bergamini 	/*
117646c34436SDamien Bergamini 	 * Try to allocate a new mbuf for this ring element and load it before
117746c34436SDamien Bergamini 	 * processing the current mbuf. If the ring element cannot be loaded,
117846c34436SDamien Bergamini 	 * drop the received packet and reuse the old mbuf. In the unlikely
117946c34436SDamien Bergamini 	 * case that the old mbuf can't be reloaded either, explicitly panic.
118046c34436SDamien Bergamini 	 */
118146c34436SDamien Bergamini 	mnew = m_getcl(M_DONTWAIT, MT_DATA, M_PKTHDR);
118246c34436SDamien Bergamini 	if (mnew == NULL) {
118346c34436SDamien Bergamini 		ifp->if_ierrors++;
118446c34436SDamien Bergamini 		return;
118546c34436SDamien Bergamini 	}
118646c34436SDamien Bergamini 
1187ceaec73dSDamien Bergamini 	bus_dmamap_unload(sc->rxq.data_dmat, data->map);
1188ceaec73dSDamien Bergamini 
118946c34436SDamien Bergamini 	error = bus_dmamap_load(sc->rxq.data_dmat, data->map,
119046c34436SDamien Bergamini 	    mtod(mnew, void *), MCLBYTES, iwi_dma_map_addr, &data->physaddr,
119146c34436SDamien Bergamini 	    0);
119246c34436SDamien Bergamini 	if (error != 0) {
119346c34436SDamien Bergamini 		m_freem(mnew);
119446c34436SDamien Bergamini 
119546c34436SDamien Bergamini 		/* try to reload the old mbuf */
119646c34436SDamien Bergamini 		error = bus_dmamap_load(sc->rxq.data_dmat, data->map,
119746c34436SDamien Bergamini 		    mtod(data->m, void *), MCLBYTES, iwi_dma_map_addr,
119846c34436SDamien Bergamini 		    &data->physaddr, 0);
119946c34436SDamien Bergamini 		if (error != 0) {
120046c34436SDamien Bergamini 			/* very unlikely that it will fail... */
120146c34436SDamien Bergamini 			panic("%s: could not load old rx mbuf",
120246c34436SDamien Bergamini 			    device_get_name(sc->sc_dev));
120346c34436SDamien Bergamini 		}
120446c34436SDamien Bergamini 		ifp->if_ierrors++;
120546c34436SDamien Bergamini 		return;
120646c34436SDamien Bergamini 	}
120746c34436SDamien Bergamini 
120846c34436SDamien Bergamini 	/*
120946c34436SDamien Bergamini 	 * New mbuf successfully loaded, update Rx ring and continue
121046c34436SDamien Bergamini 	 * processing.
121146c34436SDamien Bergamini 	 */
1212ceaec73dSDamien Bergamini 	m = data->m;
121346c34436SDamien Bergamini 	data->m = mnew;
121446c34436SDamien Bergamini 	CSR_WRITE_4(sc, data->reg, data->physaddr);
121546c34436SDamien Bergamini 
121646c34436SDamien Bergamini 	/* finalize mbuf */
1217ceaec73dSDamien Bergamini 	m->m_pkthdr.rcvif = ifp;
1218ceaec73dSDamien Bergamini 	m->m_pkthdr.len = m->m_len = sizeof (struct iwi_hdr) +
1219ceaec73dSDamien Bergamini 	    sizeof (struct iwi_frame) + le16toh(frame->len);
1220ceaec73dSDamien Bergamini 
1221ceaec73dSDamien Bergamini 	m_adj(m, sizeof (struct iwi_hdr) + sizeof (struct iwi_frame));
1222ceaec73dSDamien Bergamini 
1223ceaec73dSDamien Bergamini 	if (ic->ic_state == IEEE80211_S_SCAN)
1224ceaec73dSDamien Bergamini 		iwi_fix_channel(ic, m);
1225ceaec73dSDamien Bergamini 
1226ceaec73dSDamien Bergamini 	if (sc->sc_drvbpf != NULL) {
1227ceaec73dSDamien Bergamini 		struct iwi_rx_radiotap_header *tap = &sc->sc_rxtap;
1228ceaec73dSDamien Bergamini 
1229ceaec73dSDamien Bergamini 		tap->wr_flags = 0;
1230ceaec73dSDamien Bergamini 		tap->wr_rate = frame->rate;
1231ceaec73dSDamien Bergamini 		tap->wr_chan_freq =
1232ceaec73dSDamien Bergamini 		    htole16(ic->ic_channels[frame->chan].ic_freq);
1233ceaec73dSDamien Bergamini 		tap->wr_chan_flags =
1234ceaec73dSDamien Bergamini 		    htole16(ic->ic_channels[frame->chan].ic_flags);
1235ceaec73dSDamien Bergamini 		tap->wr_antsignal = frame->signal;
1236ceaec73dSDamien Bergamini 		tap->wr_antenna = frame->antenna;
1237ceaec73dSDamien Bergamini 
1238ceaec73dSDamien Bergamini 		bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_rxtap_len, m);
1239ceaec73dSDamien Bergamini 	}
1240ceaec73dSDamien Bergamini 
1241ceaec73dSDamien Bergamini 	wh = mtod(m, struct ieee80211_frame *);
1242ceaec73dSDamien Bergamini 	ni = ieee80211_find_rxnode(ic, (struct ieee80211_frame_min *)wh);
1243ceaec73dSDamien Bergamini 
1244ceaec73dSDamien Bergamini 	/* send the frame to the 802.11 layer */
1245acea4241SDamien Bergamini 	ieee80211_input(ic, m, ni, frame->rssi_dbm, 0);
1246ceaec73dSDamien Bergamini 
1247ceaec73dSDamien Bergamini 	/* node is no longer needed */
1248ceaec73dSDamien Bergamini 	ieee80211_free_node(ni);
1249ceaec73dSDamien Bergamini }
1250ceaec73dSDamien Bergamini 
1251ceaec73dSDamien Bergamini static void
1252ceaec73dSDamien Bergamini iwi_notification_intr(struct iwi_softc *sc, struct iwi_notif *notif)
1253ceaec73dSDamien Bergamini {
1254ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1255ceaec73dSDamien Bergamini 	struct iwi_notif_scan_channel *chan;
1256ceaec73dSDamien Bergamini 	struct iwi_notif_scan_complete *scan;
1257ceaec73dSDamien Bergamini 	struct iwi_notif_authentication *auth;
1258ceaec73dSDamien Bergamini 	struct iwi_notif_association *assoc;
1259ceaec73dSDamien Bergamini 
1260ceaec73dSDamien Bergamini 	switch (notif->type) {
1261ceaec73dSDamien Bergamini 	case IWI_NOTIF_TYPE_SCAN_CHANNEL:
1262ceaec73dSDamien Bergamini 		chan = (struct iwi_notif_scan_channel *)(notif + 1);
1263ceaec73dSDamien Bergamini 
1264ceaec73dSDamien Bergamini 		DPRINTFN(2, ("Scanning channel (%u)\n", chan->nchan));
1265ceaec73dSDamien Bergamini 		break;
1266ceaec73dSDamien Bergamini 
1267ceaec73dSDamien Bergamini 	case IWI_NOTIF_TYPE_SCAN_COMPLETE:
1268ceaec73dSDamien Bergamini 		scan = (struct iwi_notif_scan_complete *)(notif + 1);
1269ceaec73dSDamien Bergamini 
1270ceaec73dSDamien Bergamini 		DPRINTFN(2, ("Scan completed (%u, %u)\n", scan->nchan,
1271ceaec73dSDamien Bergamini 		    scan->status));
1272ceaec73dSDamien Bergamini 
1273acea4241SDamien Bergamini 		/* monitor mode uses scan to set the channel ... */
1274acea4241SDamien Bergamini 		if (ic->ic_opmode != IEEE80211_M_MONITOR) {
1275acea4241SDamien Bergamini 			sc->flags &= ~IWI_FLAG_SCANNING;
1276ceaec73dSDamien Bergamini 			ieee80211_end_scan(ic);
1277acea4241SDamien Bergamini 		} else
1278acea4241SDamien Bergamini 			iwi_set_chan(sc, ic->ic_ibss_chan);
1279ceaec73dSDamien Bergamini 		break;
1280ceaec73dSDamien Bergamini 
1281ceaec73dSDamien Bergamini 	case IWI_NOTIF_TYPE_AUTHENTICATION:
1282ceaec73dSDamien Bergamini 		auth = (struct iwi_notif_authentication *)(notif + 1);
1283ceaec73dSDamien Bergamini 
1284ceaec73dSDamien Bergamini 		DPRINTFN(2, ("Authentication (%u)\n", auth->state));
1285ceaec73dSDamien Bergamini 
1286ceaec73dSDamien Bergamini 		switch (auth->state) {
1287ceaec73dSDamien Bergamini 		case IWI_AUTHENTICATED:
1288e4918ecdSSam Leffler 			ieee80211_node_authorize(ic->ic_bss);
1289ceaec73dSDamien Bergamini 			ieee80211_new_state(ic, IEEE80211_S_ASSOC, -1);
1290ceaec73dSDamien Bergamini 			break;
1291ceaec73dSDamien Bergamini 
1292ceaec73dSDamien Bergamini 		case IWI_DEAUTHENTICATED:
1293ceaec73dSDamien Bergamini 			break;
1294ceaec73dSDamien Bergamini 
1295ceaec73dSDamien Bergamini 		default:
1296ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
1297ceaec73dSDamien Bergamini 			    "unknown authentication state %u\n", auth->state);
1298ceaec73dSDamien Bergamini 		}
1299ceaec73dSDamien Bergamini 		break;
1300ceaec73dSDamien Bergamini 
1301ceaec73dSDamien Bergamini 	case IWI_NOTIF_TYPE_ASSOCIATION:
1302ceaec73dSDamien Bergamini 		assoc = (struct iwi_notif_association *)(notif + 1);
1303ceaec73dSDamien Bergamini 
1304ceaec73dSDamien Bergamini 		DPRINTFN(2, ("Association (%u, %u)\n", assoc->state,
1305ceaec73dSDamien Bergamini 		    assoc->status));
1306ceaec73dSDamien Bergamini 
1307ceaec73dSDamien Bergamini 		switch (assoc->state) {
1308ceaec73dSDamien Bergamini 		case IWI_AUTHENTICATED:
1309ceaec73dSDamien Bergamini 			/* re-association, do nothing */
1310ceaec73dSDamien Bergamini 			break;
1311ceaec73dSDamien Bergamini 
1312ceaec73dSDamien Bergamini 		case IWI_ASSOCIATED:
1313ceaec73dSDamien Bergamini 			ieee80211_new_state(ic, IEEE80211_S_RUN, -1);
1314ceaec73dSDamien Bergamini 			break;
1315ceaec73dSDamien Bergamini 
1316ceaec73dSDamien Bergamini 		case IWI_DEASSOCIATED:
1317ceaec73dSDamien Bergamini 			ieee80211_begin_scan(ic, 1);
1318ceaec73dSDamien Bergamini 			break;
1319ceaec73dSDamien Bergamini 
1320ceaec73dSDamien Bergamini 		default:
1321ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
1322ceaec73dSDamien Bergamini 			    "unknown association state %u\n", assoc->state);
1323ceaec73dSDamien Bergamini 		}
1324ceaec73dSDamien Bergamini 		break;
1325ceaec73dSDamien Bergamini 
1326ceaec73dSDamien Bergamini 	default:
132784f55b29SDamien Bergamini 		DPRINTFN(5, ("Notification (%u)\n", notif->type));
1328ceaec73dSDamien Bergamini 	}
1329ceaec73dSDamien Bergamini }
1330ceaec73dSDamien Bergamini 
1331ceaec73dSDamien Bergamini static void
1332ceaec73dSDamien Bergamini iwi_rx_intr(struct iwi_softc *sc)
1333ceaec73dSDamien Bergamini {
1334ceaec73dSDamien Bergamini 	struct iwi_rx_data *data;
1335ceaec73dSDamien Bergamini 	struct iwi_hdr *hdr;
1336ceaec73dSDamien Bergamini 	uint32_t hw;
1337ceaec73dSDamien Bergamini 
1338ceaec73dSDamien Bergamini 	hw = CSR_READ_4(sc, IWI_CSR_RX_RIDX);
1339ceaec73dSDamien Bergamini 
1340ceaec73dSDamien Bergamini 	for (; sc->rxq.cur != hw;) {
1341ceaec73dSDamien Bergamini 		data = &sc->rxq.data[sc->rxq.cur];
1342ceaec73dSDamien Bergamini 
1343ceaec73dSDamien Bergamini 		bus_dmamap_sync(sc->rxq.data_dmat, data->map,
1344ceaec73dSDamien Bergamini 		    BUS_DMASYNC_POSTREAD);
1345ceaec73dSDamien Bergamini 
1346ceaec73dSDamien Bergamini 		hdr = mtod(data->m, struct iwi_hdr *);
1347ceaec73dSDamien Bergamini 
1348ceaec73dSDamien Bergamini 		switch (hdr->type) {
1349ceaec73dSDamien Bergamini 		case IWI_HDR_TYPE_FRAME:
1350ceaec73dSDamien Bergamini 			iwi_frame_intr(sc, data, sc->rxq.cur,
1351ceaec73dSDamien Bergamini 			    (struct iwi_frame *)(hdr + 1));
1352ceaec73dSDamien Bergamini 			break;
1353ceaec73dSDamien Bergamini 
1354ceaec73dSDamien Bergamini 		case IWI_HDR_TYPE_NOTIF:
1355ceaec73dSDamien Bergamini 			iwi_notification_intr(sc,
1356ceaec73dSDamien Bergamini 			    (struct iwi_notif *)(hdr + 1));
1357ceaec73dSDamien Bergamini 			break;
1358ceaec73dSDamien Bergamini 
1359ceaec73dSDamien Bergamini 		default:
1360ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev, "unknown hdr type %u\n",
1361ceaec73dSDamien Bergamini 			    hdr->type);
1362ceaec73dSDamien Bergamini 		}
1363ceaec73dSDamien Bergamini 
1364ceaec73dSDamien Bergamini 		DPRINTFN(15, ("rx done idx=%u\n", sc->rxq.cur));
1365ceaec73dSDamien Bergamini 
1366ceaec73dSDamien Bergamini 		sc->rxq.cur = (sc->rxq.cur + 1) % IWI_RX_RING_COUNT;
1367ceaec73dSDamien Bergamini 	}
1368ceaec73dSDamien Bergamini 
1369ceaec73dSDamien Bergamini 	/* tell the firmware what we have processed */
1370ceaec73dSDamien Bergamini 	hw = (hw == 0) ? IWI_RX_RING_COUNT - 1 : hw - 1;
1371ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RX_WIDX, hw);
1372ceaec73dSDamien Bergamini }
1373ceaec73dSDamien Bergamini 
1374ceaec73dSDamien Bergamini static void
1375ec01dc2bSDamien Bergamini iwi_tx_intr(struct iwi_softc *sc, struct iwi_tx_ring *txq)
1376ceaec73dSDamien Bergamini {
1377ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1378ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
1379ceaec73dSDamien Bergamini 	struct iwi_tx_data *data;
1380ceaec73dSDamien Bergamini 	uint32_t hw;
1381ceaec73dSDamien Bergamini 
1382ec01dc2bSDamien Bergamini 	hw = CSR_READ_4(sc, txq->csr_ridx);
1383ceaec73dSDamien Bergamini 
1384ec01dc2bSDamien Bergamini 	for (; txq->next != hw;) {
1385ec01dc2bSDamien Bergamini 		data = &txq->data[txq->next];
1386ceaec73dSDamien Bergamini 
1387ec01dc2bSDamien Bergamini 		bus_dmamap_sync(txq->data_dmat, data->map,
1388ceaec73dSDamien Bergamini 		    BUS_DMASYNC_POSTWRITE);
1389ec01dc2bSDamien Bergamini 		bus_dmamap_unload(txq->data_dmat, data->map);
1390ceaec73dSDamien Bergamini 		m_freem(data->m);
1391ceaec73dSDamien Bergamini 		data->m = NULL;
1392ceaec73dSDamien Bergamini 		ieee80211_free_node(data->ni);
1393ceaec73dSDamien Bergamini 		data->ni = NULL;
1394ceaec73dSDamien Bergamini 
1395ec01dc2bSDamien Bergamini 		DPRINTFN(15, ("tx done idx=%u\n", txq->next));
1396ceaec73dSDamien Bergamini 
1397ceaec73dSDamien Bergamini 		ifp->if_opackets++;
1398ceaec73dSDamien Bergamini 
1399ec01dc2bSDamien Bergamini 		txq->queued--;
1400ec01dc2bSDamien Bergamini 		txq->next = (txq->next + 1) % IWI_TX_RING_COUNT;
1401ceaec73dSDamien Bergamini 	}
1402ceaec73dSDamien Bergamini 
1403ceaec73dSDamien Bergamini 	sc->sc_tx_timer = 0;
140413f4c340SRobert Watson 	ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1405ceaec73dSDamien Bergamini 	iwi_start(ifp);
1406ceaec73dSDamien Bergamini }
1407ceaec73dSDamien Bergamini 
1408ceaec73dSDamien Bergamini static void
1409ceaec73dSDamien Bergamini iwi_intr(void *arg)
1410ceaec73dSDamien Bergamini {
1411ceaec73dSDamien Bergamini 	struct iwi_softc *sc = arg;
1412ceaec73dSDamien Bergamini 	uint32_t r;
1413ceaec73dSDamien Bergamini 
1414ceaec73dSDamien Bergamini 	IWI_LOCK(sc);
1415ceaec73dSDamien Bergamini 
1416ceaec73dSDamien Bergamini 	if ((r = CSR_READ_4(sc, IWI_CSR_INTR)) == 0 || r == 0xffffffff) {
1417ceaec73dSDamien Bergamini 		IWI_UNLOCK(sc);
1418ceaec73dSDamien Bergamini 		return;
1419ceaec73dSDamien Bergamini 	}
1420ceaec73dSDamien Bergamini 
1421ceaec73dSDamien Bergamini 	/* disable interrupts */
1422ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_INTR_MASK, 0);
1423ceaec73dSDamien Bergamini 
1424ceaec73dSDamien Bergamini 	if (r & (IWI_INTR_FATAL_ERROR | IWI_INTR_PARITY_ERROR)) {
1425ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "fatal error\n");
1426ceaec73dSDamien Bergamini 		sc->sc_ic.ic_ifp->if_flags &= ~IFF_UP;
1427ceaec73dSDamien Bergamini 		iwi_stop(sc);
1428ceaec73dSDamien Bergamini 	}
1429ceaec73dSDamien Bergamini 
1430ceaec73dSDamien Bergamini 	if (r & IWI_INTR_FW_INITED) {
1431ceaec73dSDamien Bergamini 		if (!(r & (IWI_INTR_FATAL_ERROR | IWI_INTR_PARITY_ERROR)))
1432ceaec73dSDamien Bergamini 			wakeup(sc);
1433ceaec73dSDamien Bergamini 	}
1434ceaec73dSDamien Bergamini 
1435ceaec73dSDamien Bergamini 	if (r & IWI_INTR_RADIO_OFF) {
1436ceaec73dSDamien Bergamini 		DPRINTF(("radio transmitter turned off\n"));
1437ceaec73dSDamien Bergamini 		sc->sc_ic.ic_ifp->if_flags &= ~IFF_UP;
1438ceaec73dSDamien Bergamini 		iwi_stop(sc);
1439ceaec73dSDamien Bergamini 	}
1440ceaec73dSDamien Bergamini 
1441ceaec73dSDamien Bergamini 	if (r & IWI_INTR_CMD_DONE)
1442ceaec73dSDamien Bergamini 		wakeup(sc);
1443ceaec73dSDamien Bergamini 
1444ceaec73dSDamien Bergamini 	if (r & IWI_INTR_TX1_DONE)
1445ec01dc2bSDamien Bergamini 		iwi_tx_intr(sc, &sc->txq[0]);
1446ec01dc2bSDamien Bergamini 
1447ec01dc2bSDamien Bergamini 	if (r & IWI_INTR_TX2_DONE)
1448ec01dc2bSDamien Bergamini 		iwi_tx_intr(sc, &sc->txq[1]);
1449ec01dc2bSDamien Bergamini 
1450ec01dc2bSDamien Bergamini 	if (r & IWI_INTR_TX3_DONE)
1451ec01dc2bSDamien Bergamini 		iwi_tx_intr(sc, &sc->txq[2]);
1452ec01dc2bSDamien Bergamini 
1453ec01dc2bSDamien Bergamini 	if (r & IWI_INTR_TX4_DONE)
1454ec01dc2bSDamien Bergamini 		iwi_tx_intr(sc, &sc->txq[3]);
1455ec01dc2bSDamien Bergamini 
1456ec01dc2bSDamien Bergamini 	if (r & IWI_INTR_RX_DONE)
1457ec01dc2bSDamien Bergamini 		iwi_rx_intr(sc);
1458ceaec73dSDamien Bergamini 
1459ceaec73dSDamien Bergamini 	/* acknowledge interrupts */
1460ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_INTR, r);
1461ceaec73dSDamien Bergamini 
1462ceaec73dSDamien Bergamini 	/* re-enable interrupts */
1463ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_INTR_MASK, IWI_INTR_MASK);
1464ceaec73dSDamien Bergamini 
1465ceaec73dSDamien Bergamini 	IWI_UNLOCK(sc);
1466ceaec73dSDamien Bergamini }
1467ceaec73dSDamien Bergamini 
1468ceaec73dSDamien Bergamini static int
1469ceaec73dSDamien Bergamini iwi_cmd(struct iwi_softc *sc, uint8_t type, void *data, uint8_t len, int async)
1470ceaec73dSDamien Bergamini {
1471ceaec73dSDamien Bergamini 	struct iwi_cmd_desc *desc;
1472ceaec73dSDamien Bergamini 
1473ceaec73dSDamien Bergamini 	desc = &sc->cmdq.desc[sc->cmdq.cur];
1474ceaec73dSDamien Bergamini 
1475ceaec73dSDamien Bergamini 	desc->hdr.type = IWI_HDR_TYPE_COMMAND;
1476ceaec73dSDamien Bergamini 	desc->hdr.flags = IWI_HDR_FLAG_IRQ;
1477ceaec73dSDamien Bergamini 	desc->type = type;
1478ceaec73dSDamien Bergamini 	desc->len = len;
1479ceaec73dSDamien Bergamini 	memcpy(desc->data, data, len);
1480ceaec73dSDamien Bergamini 
1481ceaec73dSDamien Bergamini 	bus_dmamap_sync(sc->cmdq.desc_dmat, sc->cmdq.desc_map,
1482ceaec73dSDamien Bergamini 	    BUS_DMASYNC_PREWRITE);
1483ceaec73dSDamien Bergamini 
1484ceaec73dSDamien Bergamini 	DPRINTFN(2, ("sending command idx=%u type=%u len=%u\n", sc->cmdq.cur,
1485ceaec73dSDamien Bergamini 	    type, len));
1486ceaec73dSDamien Bergamini 
1487ceaec73dSDamien Bergamini 	sc->cmdq.cur = (sc->cmdq.cur + 1) % IWI_CMD_RING_COUNT;
1488ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_CMD_WIDX, sc->cmdq.cur);
1489ceaec73dSDamien Bergamini 
1490ceaec73dSDamien Bergamini 	return async ? 0 : msleep(sc, &sc->sc_mtx, 0, "iwicmd", hz);
1491ceaec73dSDamien Bergamini }
1492ceaec73dSDamien Bergamini 
149328a38073SDamien Bergamini static void
149428a38073SDamien Bergamini iwi_write_ibssnode(struct iwi_softc *sc, const struct iwi_node *in)
149528a38073SDamien Bergamini {
149628a38073SDamien Bergamini 	struct iwi_ibssnode node;
149728a38073SDamien Bergamini 
149828a38073SDamien Bergamini 	/* write node information into NIC memory */
149928a38073SDamien Bergamini 	memset(&node, 0, sizeof node);
150028a38073SDamien Bergamini 	IEEE80211_ADDR_COPY(node.bssid, in->in_node.ni_macaddr);
150128a38073SDamien Bergamini 
150228a38073SDamien Bergamini 	CSR_WRITE_REGION_1(sc,
150328a38073SDamien Bergamini 	    IWI_CSR_NODE_BASE + in->in_station * sizeof node,
150428a38073SDamien Bergamini 	    (uint8_t *)&node, sizeof node);
150528a38073SDamien Bergamini }
150628a38073SDamien Bergamini 
1507ceaec73dSDamien Bergamini static int
15080b74a285SDamien Bergamini iwi_tx_start(struct ifnet *ifp, struct mbuf *m0, struct ieee80211_node *ni,
15090b74a285SDamien Bergamini     int ac)
1510ceaec73dSDamien Bergamini {
1511ceaec73dSDamien Bergamini 	struct iwi_softc *sc = ifp->if_softc;
1512ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
151328a38073SDamien Bergamini 	struct iwi_node *in = (struct iwi_node *)ni;
1514ec01dc2bSDamien Bergamini 	struct ieee80211_frame *wh;
1515acea4241SDamien Bergamini 	struct ieee80211_key *k;
1516ec01dc2bSDamien Bergamini 	const struct chanAccParams *cap;
15170b74a285SDamien Bergamini 	struct iwi_tx_ring *txq = &sc->txq[ac];
1518ceaec73dSDamien Bergamini 	struct iwi_tx_data *data;
1519ceaec73dSDamien Bergamini 	struct iwi_tx_desc *desc;
1520ceaec73dSDamien Bergamini 	struct mbuf *mnew;
1521ceaec73dSDamien Bergamini 	bus_dma_segment_t segs[IWI_MAX_NSEG];
152228a38073SDamien Bergamini 	int error, nsegs, hdrlen, i, noack = 0;
1523ceaec73dSDamien Bergamini 
1524ec01dc2bSDamien Bergamini 	wh = mtod(m0, struct ieee80211_frame *);
1525ec01dc2bSDamien Bergamini 
1526ec01dc2bSDamien Bergamini 	if (wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_QOS) {
1527ec01dc2bSDamien Bergamini 		hdrlen = sizeof (struct ieee80211_qosframe);
1528ec01dc2bSDamien Bergamini 		cap = &ic->ic_wme.wme_chanParams;
1529ec01dc2bSDamien Bergamini 		noack = cap->cap_wmeParams[ac].wmep_noackPolicy;
15300b74a285SDamien Bergamini 	} else
1531ec01dc2bSDamien Bergamini 		hdrlen = sizeof (struct ieee80211_frame);
1532ec01dc2bSDamien Bergamini 
153328a38073SDamien Bergamini 	/*
153428a38073SDamien Bergamini 	 * This is only used in IBSS mode where the firmware expect an index
153528a38073SDamien Bergamini 	 * in a h/w table instead of a destination address.
153628a38073SDamien Bergamini 	 */
153728a38073SDamien Bergamini 	if (ic->ic_opmode == IEEE80211_M_IBSS && in->in_station == -1) {
153828a38073SDamien Bergamini 		in->in_station = alloc_unr(sc->sc_unr);
153928a38073SDamien Bergamini 		if (in->in_station == -1) {	/* h/w table is full */
1540ec01dc2bSDamien Bergamini 			m_freem(m0);
15410b74a285SDamien Bergamini 			ieee80211_free_node(ni);
15420b74a285SDamien Bergamini 			ifp->if_oerrors++;
1543ec01dc2bSDamien Bergamini 			return 0;
1544ec01dc2bSDamien Bergamini 		}
154528a38073SDamien Bergamini 		iwi_write_ibssnode(sc, in);
15460b74a285SDamien Bergamini 	}
1547ec01dc2bSDamien Bergamini 
1548ec01dc2bSDamien Bergamini 	if (wh->i_fc[1] & IEEE80211_FC1_WEP) {
1549acea4241SDamien Bergamini 		k = ieee80211_crypto_encap(ic, ni, m0);
155082145663SSam Leffler 		if (k == NULL) {
155182145663SSam Leffler 			m_freem(m0);
1552acea4241SDamien Bergamini 			return ENOBUFS;
1553acea4241SDamien Bergamini 		}
1554ec01dc2bSDamien Bergamini 
1555ec01dc2bSDamien Bergamini 		/* packet header may have moved, reset our local pointer */
1556ec01dc2bSDamien Bergamini 		wh = mtod(m0, struct ieee80211_frame *);
155782145663SSam Leffler 	}
1558acea4241SDamien Bergamini 
1559ceaec73dSDamien Bergamini 	if (sc->sc_drvbpf != NULL) {
1560ceaec73dSDamien Bergamini 		struct iwi_tx_radiotap_header *tap = &sc->sc_txtap;
1561ceaec73dSDamien Bergamini 
1562ceaec73dSDamien Bergamini 		tap->wt_flags = 0;
1563acea4241SDamien Bergamini 		tap->wt_chan_freq = htole16(ic->ic_ibss_chan->ic_freq);
1564acea4241SDamien Bergamini 		tap->wt_chan_flags = htole16(ic->ic_ibss_chan->ic_flags);
1565ceaec73dSDamien Bergamini 
1566ceaec73dSDamien Bergamini 		bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m0);
1567ceaec73dSDamien Bergamini 	}
1568ceaec73dSDamien Bergamini 
1569ec01dc2bSDamien Bergamini 	data = &txq->data[txq->cur];
1570ec01dc2bSDamien Bergamini 	desc = &txq->desc[txq->cur];
1571ceaec73dSDamien Bergamini 
1572ec01dc2bSDamien Bergamini 	/* save and trim IEEE802.11 header */
1573ec01dc2bSDamien Bergamini 	m_copydata(m0, 0, hdrlen, (caddr_t)&desc->wh);
1574ec01dc2bSDamien Bergamini 	m_adj(m0, hdrlen);
1575ceaec73dSDamien Bergamini 
1576ec01dc2bSDamien Bergamini 	error = bus_dmamap_load_mbuf_sg(txq->data_dmat, data->map, m0, segs,
1577ceaec73dSDamien Bergamini 	    &nsegs, 0);
1578ceaec73dSDamien Bergamini 	if (error != 0 && error != EFBIG) {
1579ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not map mbuf (error %d)\n",
1580ceaec73dSDamien Bergamini 		    error);
1581ceaec73dSDamien Bergamini 		m_freem(m0);
1582ceaec73dSDamien Bergamini 		return error;
1583ceaec73dSDamien Bergamini 	}
1584ceaec73dSDamien Bergamini 	if (error != 0) {
1585ceaec73dSDamien Bergamini 		mnew = m_defrag(m0, M_DONTWAIT);
1586ceaec73dSDamien Bergamini 		if (mnew == NULL) {
1587ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
1588ceaec73dSDamien Bergamini 			    "could not defragment mbuf\n");
1589ceaec73dSDamien Bergamini 			m_freem(m0);
1590ceaec73dSDamien Bergamini 			return ENOBUFS;
1591ceaec73dSDamien Bergamini 		}
1592ceaec73dSDamien Bergamini 		m0 = mnew;
1593ceaec73dSDamien Bergamini 
1594ec01dc2bSDamien Bergamini 		error = bus_dmamap_load_mbuf_sg(txq->data_dmat, data->map,
1595ceaec73dSDamien Bergamini 		    m0, segs, &nsegs, 0);
1596ceaec73dSDamien Bergamini 		if (error != 0) {
1597ceaec73dSDamien Bergamini 			device_printf(sc->sc_dev,
1598ceaec73dSDamien Bergamini 			    "could not map mbuf (error %d)\n", error);
1599ceaec73dSDamien Bergamini 			m_freem(m0);
1600ceaec73dSDamien Bergamini 			return error;
1601ceaec73dSDamien Bergamini 		}
1602ceaec73dSDamien Bergamini 	}
1603ceaec73dSDamien Bergamini 
1604ceaec73dSDamien Bergamini 	data->m = m0;
1605ceaec73dSDamien Bergamini 	data->ni = ni;
1606ceaec73dSDamien Bergamini 
1607ceaec73dSDamien Bergamini 	desc->hdr.type = IWI_HDR_TYPE_DATA;
1608ceaec73dSDamien Bergamini 	desc->hdr.flags = IWI_HDR_FLAG_IRQ;
160928a38073SDamien Bergamini 	desc->station =
161028a38073SDamien Bergamini 	    (ic->ic_opmode == IEEE80211_M_IBSS) ? in->in_station : 0;
1611ceaec73dSDamien Bergamini 	desc->cmd = IWI_DATA_CMD_TX;
1612ceaec73dSDamien Bergamini 	desc->len = htole16(m0->m_pkthdr.len);
1613ceaec73dSDamien Bergamini 	desc->flags = 0;
1614ec01dc2bSDamien Bergamini 	desc->xflags = 0;
1615ceaec73dSDamien Bergamini 
1616ec01dc2bSDamien Bergamini 	if (!noack && !IEEE80211_IS_MULTICAST(desc->wh.i_addr1))
1617ceaec73dSDamien Bergamini 		desc->flags |= IWI_DATA_FLAG_NEED_ACK;
1618ceaec73dSDamien Bergamini 
1619acea4241SDamien Bergamini #if 0
1620ceaec73dSDamien Bergamini 	if (ic->ic_flags & IEEE80211_F_PRIVACY) {
1621ec01dc2bSDamien Bergamini 		desc->wh.i_fc[1] |= IEEE80211_FC1_WEP;
162284f55b29SDamien Bergamini 		desc->weptxkey = ic->ic_crypto.cs_def_txkey;
1623ceaec73dSDamien Bergamini 	} else
1624acea4241SDamien Bergamini #endif
1625ceaec73dSDamien Bergamini 		desc->flags |= IWI_DATA_FLAG_NO_WEP;
1626ceaec73dSDamien Bergamini 
1627ceaec73dSDamien Bergamini 	if (ic->ic_flags & IEEE80211_F_SHPREAMBLE)
1628ceaec73dSDamien Bergamini 		desc->flags |= IWI_DATA_FLAG_SHPREAMBLE;
1629ceaec73dSDamien Bergamini 
1630ec01dc2bSDamien Bergamini 	if (desc->wh.i_fc[0] & IEEE80211_FC0_SUBTYPE_QOS)
1631ec01dc2bSDamien Bergamini 		desc->xflags |= IWI_DATA_XFLAG_QOS;
1632ec01dc2bSDamien Bergamini 
1633ceaec73dSDamien Bergamini 	desc->nseg = htole32(nsegs);
1634ceaec73dSDamien Bergamini 	for (i = 0; i < nsegs; i++) {
1635ceaec73dSDamien Bergamini 		desc->seg_addr[i] = htole32(segs[i].ds_addr);
163681e6343cSDamien Bergamini 		desc->seg_len[i]  = htole16(segs[i].ds_len);
1637ceaec73dSDamien Bergamini 	}
1638ceaec73dSDamien Bergamini 
1639ec01dc2bSDamien Bergamini 	bus_dmamap_sync(txq->data_dmat, data->map, BUS_DMASYNC_PREWRITE);
1640ec01dc2bSDamien Bergamini 	bus_dmamap_sync(txq->desc_dmat, txq->desc_map, BUS_DMASYNC_PREWRITE);
1641ceaec73dSDamien Bergamini 
1642ec01dc2bSDamien Bergamini 	DPRINTFN(5, ("sending data frame txq=%u idx=%u len=%u nseg=%u\n",
164381e6343cSDamien Bergamini 	    ac, txq->cur, le16toh(desc->len), nsegs));
1644ceaec73dSDamien Bergamini 
1645ec01dc2bSDamien Bergamini 	txq->queued++;
1646ec01dc2bSDamien Bergamini 	txq->cur = (txq->cur + 1) % IWI_TX_RING_COUNT;
1647ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, txq->csr_widx, txq->cur);
1648ceaec73dSDamien Bergamini 
1649ceaec73dSDamien Bergamini 	return 0;
1650ceaec73dSDamien Bergamini }
1651ceaec73dSDamien Bergamini 
1652ceaec73dSDamien Bergamini static void
1653ceaec73dSDamien Bergamini iwi_start(struct ifnet *ifp)
1654ceaec73dSDamien Bergamini {
1655ceaec73dSDamien Bergamini 	struct iwi_softc *sc = ifp->if_softc;
1656ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1657ceaec73dSDamien Bergamini 	struct mbuf *m0;
1658ceaec73dSDamien Bergamini 	struct ether_header *eh;
1659ceaec73dSDamien Bergamini 	struct ieee80211_node *ni;
16600b74a285SDamien Bergamini 	int ac;
1661ceaec73dSDamien Bergamini 
1662ceaec73dSDamien Bergamini 	IWI_LOCK(sc);
1663ceaec73dSDamien Bergamini 
1664ceaec73dSDamien Bergamini 	if (ic->ic_state != IEEE80211_S_RUN) {
1665ceaec73dSDamien Bergamini 		IWI_UNLOCK(sc);
1666ceaec73dSDamien Bergamini 		return;
1667ceaec73dSDamien Bergamini 	}
1668ceaec73dSDamien Bergamini 
1669ceaec73dSDamien Bergamini 	for (;;) {
1670ceaec73dSDamien Bergamini 		IFQ_DRV_DEQUEUE(&ifp->if_snd, m0);
1671ceaec73dSDamien Bergamini 		if (m0 == NULL)
1672ceaec73dSDamien Bergamini 			break;
1673ceaec73dSDamien Bergamini 
1674ceaec73dSDamien Bergamini 		if (m0->m_len < sizeof (struct ether_header) &&
16750b74a285SDamien Bergamini 		    (m0 = m_pullup(m0, sizeof (struct ether_header))) == NULL) {
16760b74a285SDamien Bergamini 			ifp->if_oerrors++;
1677ceaec73dSDamien Bergamini 			continue;
16780b74a285SDamien Bergamini 		}
1679ceaec73dSDamien Bergamini 		eh = mtod(m0, struct ether_header *);
1680ceaec73dSDamien Bergamini 		ni = ieee80211_find_txnode(ic, eh->ether_dhost);
1681ceaec73dSDamien Bergamini 		if (ni == NULL) {
1682ceaec73dSDamien Bergamini 			m_freem(m0);
16830b74a285SDamien Bergamini 			ifp->if_oerrors++;
1684ceaec73dSDamien Bergamini 			continue;
1685ceaec73dSDamien Bergamini 		}
16860b74a285SDamien Bergamini 
16870b74a285SDamien Bergamini 		/* classify mbuf so we can find which tx ring to use */
1688ec01dc2bSDamien Bergamini 		if (ieee80211_classify(ic, m0, ni) != 0) {
1689ec01dc2bSDamien Bergamini 			m_freem(m0);
16900b74a285SDamien Bergamini 			ieee80211_free_node(ni);
16910b74a285SDamien Bergamini 			ifp->if_oerrors++;
1692ec01dc2bSDamien Bergamini 			continue;
1693ec01dc2bSDamien Bergamini 		}
16940b74a285SDamien Bergamini 
16950b74a285SDamien Bergamini 		/* no QoS encapsulation for EAPOL frames */
16960b74a285SDamien Bergamini 		ac = (eh->ether_type != htons(ETHERTYPE_PAE)) ?
16970b74a285SDamien Bergamini 		    M_WME_GETAC(m0) : WME_AC_BE;
16980b74a285SDamien Bergamini 
16990b74a285SDamien Bergamini 		if (sc->txq[ac].queued > IWI_TX_RING_COUNT - 8) {
17000b74a285SDamien Bergamini 			/* there is no place left in this ring */
17010b74a285SDamien Bergamini 			IFQ_DRV_PREPEND(&ifp->if_snd, m0);
17020b74a285SDamien Bergamini 			ifp->if_drv_flags |= IFF_DRV_OACTIVE;
17030b74a285SDamien Bergamini 			break;
17040b74a285SDamien Bergamini 		}
17050b74a285SDamien Bergamini 
1706ceaec73dSDamien Bergamini 		BPF_MTAP(ifp, m0);
1707ceaec73dSDamien Bergamini 
1708ceaec73dSDamien Bergamini 		m0 = ieee80211_encap(ic, m0, ni);
17090a5ae7ccSSam Leffler 		if (m0 == NULL) {
17100a5ae7ccSSam Leffler 			ieee80211_free_node(ni);
17110b74a285SDamien Bergamini 			ifp->if_oerrors++;
1712ceaec73dSDamien Bergamini 			continue;
17130a5ae7ccSSam Leffler 		}
1714ceaec73dSDamien Bergamini 
1715ceaec73dSDamien Bergamini 		if (ic->ic_rawbpf != NULL)
1716ceaec73dSDamien Bergamini 			bpf_mtap(ic->ic_rawbpf, m0);
1717ceaec73dSDamien Bergamini 
17180b74a285SDamien Bergamini 		if (iwi_tx_start(ifp, m0, ni, ac) != 0) {
1719ceaec73dSDamien Bergamini 			ieee80211_free_node(ni);
1720ceaec73dSDamien Bergamini 			ifp->if_oerrors++;
1721ceaec73dSDamien Bergamini 			break;
1722ceaec73dSDamien Bergamini 		}
1723ceaec73dSDamien Bergamini 
1724ceaec73dSDamien Bergamini 		sc->sc_tx_timer = 5;
1725ceaec73dSDamien Bergamini 		ifp->if_timer = 1;
1726ceaec73dSDamien Bergamini 	}
1727ceaec73dSDamien Bergamini 
1728ceaec73dSDamien Bergamini 	IWI_UNLOCK(sc);
1729ceaec73dSDamien Bergamini }
1730ceaec73dSDamien Bergamini 
1731ceaec73dSDamien Bergamini static void
1732ceaec73dSDamien Bergamini iwi_watchdog(struct ifnet *ifp)
1733ceaec73dSDamien Bergamini {
1734ceaec73dSDamien Bergamini 	struct iwi_softc *sc = ifp->if_softc;
1735ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1736ceaec73dSDamien Bergamini 
1737ceaec73dSDamien Bergamini 	IWI_LOCK(sc);
1738ceaec73dSDamien Bergamini 
1739ceaec73dSDamien Bergamini 	ifp->if_timer = 0;
1740ceaec73dSDamien Bergamini 
1741ceaec73dSDamien Bergamini 	if (sc->sc_tx_timer > 0) {
1742ceaec73dSDamien Bergamini 		if (--sc->sc_tx_timer == 0) {
1743ceaec73dSDamien Bergamini 			if_printf(ifp, "device timeout\n");
1744ceaec73dSDamien Bergamini 			ifp->if_oerrors++;
1745ceaec73dSDamien Bergamini 			ifp->if_flags &= ~IFF_UP;
1746ceaec73dSDamien Bergamini 			iwi_stop(sc);
1747ceaec73dSDamien Bergamini 			IWI_UNLOCK(sc);
1748ceaec73dSDamien Bergamini 			return;
1749ceaec73dSDamien Bergamini 		}
1750ceaec73dSDamien Bergamini 		ifp->if_timer = 1;
1751ceaec73dSDamien Bergamini 	}
1752ceaec73dSDamien Bergamini 
1753ceaec73dSDamien Bergamini 	ieee80211_watchdog(ic);
1754ceaec73dSDamien Bergamini 
1755ceaec73dSDamien Bergamini 	IWI_UNLOCK(sc);
1756ceaec73dSDamien Bergamini }
1757ceaec73dSDamien Bergamini 
1758ceaec73dSDamien Bergamini static int
1759ceaec73dSDamien Bergamini iwi_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
1760ceaec73dSDamien Bergamini {
1761ceaec73dSDamien Bergamini 	struct iwi_softc *sc = ifp->if_softc;
1762ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
1763ceaec73dSDamien Bergamini 	int error = 0;
1764ceaec73dSDamien Bergamini 
1765ceaec73dSDamien Bergamini 	IWI_LOCK(sc);
1766ceaec73dSDamien Bergamini 
1767ceaec73dSDamien Bergamini 	switch (cmd) {
1768ceaec73dSDamien Bergamini 	case SIOCSIFFLAGS:
1769ceaec73dSDamien Bergamini 		if (ifp->if_flags & IFF_UP) {
177013f4c340SRobert Watson 			if (!(ifp->if_drv_flags & IFF_DRV_RUNNING))
1771ceaec73dSDamien Bergamini 				iwi_init(sc);
1772ceaec73dSDamien Bergamini 		} else {
177313f4c340SRobert Watson 			if (ifp->if_drv_flags & IFF_DRV_RUNNING)
1774ceaec73dSDamien Bergamini 				iwi_stop(sc);
1775ceaec73dSDamien Bergamini 		}
1776ceaec73dSDamien Bergamini 		break;
1777ceaec73dSDamien Bergamini 
1778ceaec73dSDamien Bergamini 	default:
1779ceaec73dSDamien Bergamini 		error = ieee80211_ioctl(ic, cmd, data);
1780ceaec73dSDamien Bergamini 	}
1781ceaec73dSDamien Bergamini 
1782ceaec73dSDamien Bergamini 	if (error == ENETRESET) {
178313f4c340SRobert Watson 		if ((ifp->if_flags & IFF_UP) &&
1784e0454c26SDamien Bergamini 		    (ifp->if_drv_flags & IFF_DRV_RUNNING) &&
1785e0454c26SDamien Bergamini 		    (ic->ic_roaming != IEEE80211_ROAMING_MANUAL))
1786ceaec73dSDamien Bergamini 			iwi_init(sc);
1787ceaec73dSDamien Bergamini 		error = 0;
1788ceaec73dSDamien Bergamini 	}
1789ceaec73dSDamien Bergamini 
1790ceaec73dSDamien Bergamini 	IWI_UNLOCK(sc);
1791ceaec73dSDamien Bergamini 
1792ceaec73dSDamien Bergamini 	return error;
1793ceaec73dSDamien Bergamini }
1794ceaec73dSDamien Bergamini 
1795ceaec73dSDamien Bergamini static void
1796ceaec73dSDamien Bergamini iwi_stop_master(struct iwi_softc *sc)
1797ceaec73dSDamien Bergamini {
1798ceaec73dSDamien Bergamini 	uint32_t tmp;
1799ceaec73dSDamien Bergamini 	int ntries;
1800ceaec73dSDamien Bergamini 
1801ceaec73dSDamien Bergamini 	/* disable interrupts */
1802ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_INTR_MASK, 0);
1803ceaec73dSDamien Bergamini 
1804ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, IWI_RST_STOP_MASTER);
1805ceaec73dSDamien Bergamini 	for (ntries = 0; ntries < 5; ntries++) {
1806ceaec73dSDamien Bergamini 		if (CSR_READ_4(sc, IWI_CSR_RST) & IWI_RST_MASTER_DISABLED)
1807ceaec73dSDamien Bergamini 			break;
1808ceaec73dSDamien Bergamini 		DELAY(10);
1809ceaec73dSDamien Bergamini 	}
1810ceaec73dSDamien Bergamini 	if (ntries == 5)
1811ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "timeout waiting for master\n");
1812ceaec73dSDamien Bergamini 
1813ceaec73dSDamien Bergamini 	tmp = CSR_READ_4(sc, IWI_CSR_RST);
1814ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, tmp | IWI_RST_PRINCETON_RESET);
1815ceaec73dSDamien Bergamini 
1816ceaec73dSDamien Bergamini 	sc->flags &= ~IWI_FLAG_FW_INITED;
1817ceaec73dSDamien Bergamini }
1818ceaec73dSDamien Bergamini 
1819ceaec73dSDamien Bergamini static int
1820ceaec73dSDamien Bergamini iwi_reset(struct iwi_softc *sc)
1821ceaec73dSDamien Bergamini {
1822ceaec73dSDamien Bergamini 	uint32_t tmp;
1823ceaec73dSDamien Bergamini 	int i, ntries;
1824ceaec73dSDamien Bergamini 
1825ceaec73dSDamien Bergamini 	iwi_stop_master(sc);
1826ceaec73dSDamien Bergamini 
1827ceaec73dSDamien Bergamini 	tmp = CSR_READ_4(sc, IWI_CSR_CTL);
1828ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_CTL, tmp | IWI_CTL_INIT);
1829ceaec73dSDamien Bergamini 
1830ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_READ_INT, IWI_READ_INT_INIT_HOST);
1831ceaec73dSDamien Bergamini 
1832ceaec73dSDamien Bergamini 	/* wait for clock stabilization */
1833ceaec73dSDamien Bergamini 	for (ntries = 0; ntries < 1000; ntries++) {
1834ceaec73dSDamien Bergamini 		if (CSR_READ_4(sc, IWI_CSR_CTL) & IWI_CTL_CLOCK_READY)
1835ceaec73dSDamien Bergamini 			break;
1836ceaec73dSDamien Bergamini 		DELAY(200);
1837ceaec73dSDamien Bergamini 	}
1838ceaec73dSDamien Bergamini 	if (ntries == 1000) {
1839ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
1840ceaec73dSDamien Bergamini 		    "timeout waiting for clock stabilization\n");
1841ceaec73dSDamien Bergamini 		return EIO;
1842ceaec73dSDamien Bergamini 	}
1843ceaec73dSDamien Bergamini 
1844ceaec73dSDamien Bergamini 	tmp = CSR_READ_4(sc, IWI_CSR_RST);
1845ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, tmp | IWI_RST_SOFT_RESET);
1846ceaec73dSDamien Bergamini 
1847ceaec73dSDamien Bergamini 	DELAY(10);
1848ceaec73dSDamien Bergamini 
1849ceaec73dSDamien Bergamini 	tmp = CSR_READ_4(sc, IWI_CSR_CTL);
1850ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_CTL, tmp | IWI_CTL_INIT);
1851ceaec73dSDamien Bergamini 
1852ceaec73dSDamien Bergamini 	/* clear NIC memory */
1853ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_AUTOINC_ADDR, 0);
1854ceaec73dSDamien Bergamini 	for (i = 0; i < 0xc000; i++)
1855ceaec73dSDamien Bergamini 		CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, 0);
1856ceaec73dSDamien Bergamini 
1857ceaec73dSDamien Bergamini 	return 0;
1858ceaec73dSDamien Bergamini }
1859ceaec73dSDamien Bergamini 
1860ceaec73dSDamien Bergamini static int
1861408146edSDamien Bergamini iwi_load_ucode(struct iwi_softc *sc, const char *name)
1862ceaec73dSDamien Bergamini {
1863ceaec73dSDamien Bergamini 	uint32_t tmp;
1864ceaec73dSDamien Bergamini 	uint16_t *w;
1865408146edSDamien Bergamini 	char *uc;
1866e1000b36SScott Long 	size_t size;
1867e1000b36SScott Long 	int i, ntries, error;
1868408146edSDamien Bergamini 
1869408146edSDamien Bergamini 	IWI_UNLOCK(sc);
1870408146edSDamien Bergamini 	error = iwi_read_firmware(name, &uc, &size);
1871408146edSDamien Bergamini 	IWI_LOCK(sc);
1872408146edSDamien Bergamini 	if (error != 0) {
1873408146edSDamien Bergamini 		device_printf(sc->sc_dev, "could not read ucode image\n");
1874408146edSDamien Bergamini 		goto fail1;
1875408146edSDamien Bergamini 	}
1876408146edSDamien Bergamini 
1877408146edSDamien Bergamini 	if (size < sizeof (struct iwi_firmware_hdr)) {
1878408146edSDamien Bergamini 		error = EINVAL;
1879408146edSDamien Bergamini 		goto fail2;
1880408146edSDamien Bergamini 	}
1881408146edSDamien Bergamini 
1882408146edSDamien Bergamini 	uc += sizeof (struct iwi_firmware_hdr);
1883408146edSDamien Bergamini 	size -= sizeof (struct iwi_firmware_hdr);
1884ceaec73dSDamien Bergamini 
1885ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, CSR_READ_4(sc, IWI_CSR_RST) |
1886ceaec73dSDamien Bergamini 	    IWI_RST_STOP_MASTER);
1887ceaec73dSDamien Bergamini 	for (ntries = 0; ntries < 5; ntries++) {
1888ceaec73dSDamien Bergamini 		if (CSR_READ_4(sc, IWI_CSR_RST) & IWI_RST_MASTER_DISABLED)
1889ceaec73dSDamien Bergamini 			break;
1890ceaec73dSDamien Bergamini 		DELAY(10);
1891ceaec73dSDamien Bergamini 	}
1892ceaec73dSDamien Bergamini 	if (ntries == 5) {
1893ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "timeout waiting for master\n");
1894408146edSDamien Bergamini 		error = EIO;
1895408146edSDamien Bergamini 		goto fail2;
1896ceaec73dSDamien Bergamini 	}
1897ceaec73dSDamien Bergamini 
1898ceaec73dSDamien Bergamini 	MEM_WRITE_4(sc, 0x3000e0, 0x80000000);
1899ceaec73dSDamien Bergamini 	DELAY(5000);
1900ceaec73dSDamien Bergamini 
1901ceaec73dSDamien Bergamini 	tmp = CSR_READ_4(sc, IWI_CSR_RST);
1902ceaec73dSDamien Bergamini 	tmp &= ~IWI_RST_PRINCETON_RESET;
1903ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, tmp);
1904ceaec73dSDamien Bergamini 
1905ceaec73dSDamien Bergamini 	DELAY(5000);
1906ceaec73dSDamien Bergamini 	MEM_WRITE_4(sc, 0x3000e0, 0);
1907ceaec73dSDamien Bergamini 	DELAY(1000);
190884f55b29SDamien Bergamini 	MEM_WRITE_4(sc, IWI_MEM_EVENT_CTL, 1);
1909ceaec73dSDamien Bergamini 	DELAY(1000);
191084f55b29SDamien Bergamini 	MEM_WRITE_4(sc, IWI_MEM_EVENT_CTL, 0);
1911ceaec73dSDamien Bergamini 	DELAY(1000);
1912ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x200000, 0x00);
1913ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x200000, 0x40);
1914ceaec73dSDamien Bergamini 	DELAY(1000);
1915ceaec73dSDamien Bergamini 
1916ceaec73dSDamien Bergamini 	/* write microcode into adapter memory */
1917408146edSDamien Bergamini 	for (w = (uint16_t *)uc; size > 0; w++, size -= 2)
191881e6343cSDamien Bergamini 		MEM_WRITE_2(sc, 0x200010, htole16(*w));
1919ceaec73dSDamien Bergamini 
1920ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x200000, 0x00);
1921ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x200000, 0x80);
1922ceaec73dSDamien Bergamini 
1923ceaec73dSDamien Bergamini 	/* wait until we get an answer */
1924ceaec73dSDamien Bergamini 	for (ntries = 0; ntries < 100; ntries++) {
1925ceaec73dSDamien Bergamini 		if (MEM_READ_1(sc, 0x200000) & 1)
1926ceaec73dSDamien Bergamini 			break;
1927ceaec73dSDamien Bergamini 		DELAY(100);
1928ceaec73dSDamien Bergamini 	}
1929ceaec73dSDamien Bergamini 	if (ntries == 100) {
1930ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
1931ceaec73dSDamien Bergamini 		    "timeout waiting for ucode to initialize\n");
1932408146edSDamien Bergamini 		error = EIO;
1933408146edSDamien Bergamini 		goto fail2;
1934ceaec73dSDamien Bergamini 	}
1935ceaec73dSDamien Bergamini 
1936ceaec73dSDamien Bergamini 	/* read the answer or the firmware will not initialize properly */
1937ceaec73dSDamien Bergamini 	for (i = 0; i < 7; i++)
1938ceaec73dSDamien Bergamini 		MEM_READ_4(sc, 0x200004);
1939ceaec73dSDamien Bergamini 
1940ceaec73dSDamien Bergamini 	MEM_WRITE_1(sc, 0x200000, 0x00);
1941ceaec73dSDamien Bergamini 
1942408146edSDamien Bergamini fail2:	free(uc, M_DEVBUF);
1943408146edSDamien Bergamini fail1:
1944408146edSDamien Bergamini 	return error;
1945ceaec73dSDamien Bergamini }
1946ceaec73dSDamien Bergamini 
1947ceaec73dSDamien Bergamini /* macro to handle unaligned little endian data in firmware image */
1948ceaec73dSDamien Bergamini #define GETLE32(p) ((p)[0] | (p)[1] << 8 | (p)[2] << 16 | (p)[3] << 24)
1949ceaec73dSDamien Bergamini 
1950ceaec73dSDamien Bergamini static int
1951408146edSDamien Bergamini iwi_load_firmware(struct iwi_softc *sc, const char *name)
1952ceaec73dSDamien Bergamini {
1953ceaec73dSDamien Bergamini 	bus_dma_tag_t dmat;
1954ceaec73dSDamien Bergamini 	bus_dmamap_t map;
1955ceaec73dSDamien Bergamini 	bus_addr_t physaddr;
1956ceaec73dSDamien Bergamini 	void *virtaddr;
1957408146edSDamien Bergamini 	char *fw;
1958ceaec73dSDamien Bergamini 	u_char *p, *end;
1959ceaec73dSDamien Bergamini 	uint32_t sentinel, ctl, src, dst, sum, len, mlen, tmp;
1960e1000b36SScott Long 	size_t size;
1961e1000b36SScott Long 	int ntries, error;
1962408146edSDamien Bergamini 
1963408146edSDamien Bergamini 	/* read firmware image from filesystem */
1964408146edSDamien Bergamini 	IWI_UNLOCK(sc);
1965408146edSDamien Bergamini 	error = iwi_read_firmware(name, &fw, &size);
1966408146edSDamien Bergamini 	IWI_LOCK(sc);
1967408146edSDamien Bergamini 	if (error != 0) {
1968408146edSDamien Bergamini 		device_printf(sc->sc_dev, "could not read firmware image\n");
1969408146edSDamien Bergamini 		goto fail1;
1970408146edSDamien Bergamini 	}
1971408146edSDamien Bergamini 
1972408146edSDamien Bergamini 	if (size < sizeof (struct iwi_firmware_hdr)) {
1973408146edSDamien Bergamini 		error = EINVAL;
1974408146edSDamien Bergamini 		goto fail2;
1975408146edSDamien Bergamini 	}
1976408146edSDamien Bergamini 
1977408146edSDamien Bergamini 	fw += sizeof (struct iwi_firmware_hdr);
1978408146edSDamien Bergamini 	size -= sizeof (struct iwi_firmware_hdr);
1979ceaec73dSDamien Bergamini 
1980ceaec73dSDamien Bergamini 	/* allocate DMA memory for mapping firmware image */
1981ceaec73dSDamien Bergamini 	error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT,
1982ceaec73dSDamien Bergamini 	    BUS_SPACE_MAXADDR, NULL, NULL, size, 1, size, 0, NULL, NULL, &dmat);
1983ceaec73dSDamien Bergamini 	if (error != 0) {
1984ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
1985ceaec73dSDamien Bergamini 		    "could not create firmware DMA tag\n");
1986408146edSDamien Bergamini 		goto fail2;
1987ceaec73dSDamien Bergamini 	}
1988ceaec73dSDamien Bergamini 
1989ceaec73dSDamien Bergamini 	error = bus_dmamem_alloc(dmat, &virtaddr, BUS_DMA_NOWAIT, &map);
1990ceaec73dSDamien Bergamini 	if (error != 0) {
1991ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
1992ceaec73dSDamien Bergamini 		    "could not allocate firmware DMA memory\n");
1993408146edSDamien Bergamini 		goto fail3;
1994ceaec73dSDamien Bergamini 	}
1995ceaec73dSDamien Bergamini 
1996ceaec73dSDamien Bergamini 	error = bus_dmamap_load(dmat, map, virtaddr, size, iwi_dma_map_addr,
1997ceaec73dSDamien Bergamini 	    &physaddr, 0);
1998ceaec73dSDamien Bergamini 	if (error != 0) {
1999ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not load firmware DMA map\n");
2000408146edSDamien Bergamini 		goto fail4;
2001ceaec73dSDamien Bergamini 	}
2002ceaec73dSDamien Bergamini 
2003ceaec73dSDamien Bergamini 	/* copy firmware image to DMA memory */
2004ceaec73dSDamien Bergamini 	memcpy(virtaddr, fw, size);
2005ceaec73dSDamien Bergamini 
2006ceaec73dSDamien Bergamini 	/* make sure the adapter will get up-to-date values */
2007ceaec73dSDamien Bergamini 	bus_dmamap_sync(dmat, map, BUS_DMASYNC_PREWRITE);
2008ceaec73dSDamien Bergamini 
2009ceaec73dSDamien Bergamini 	/* tell the adapter where the command blocks are stored */
2010ceaec73dSDamien Bergamini 	MEM_WRITE_4(sc, 0x3000a0, 0x27000);
2011ceaec73dSDamien Bergamini 
2012ceaec73dSDamien Bergamini 	/*
2013ceaec73dSDamien Bergamini 	 * Store command blocks into adapter's internal memory using register
2014ceaec73dSDamien Bergamini 	 * indirections. The adapter will read the firmware image through DMA
2015ceaec73dSDamien Bergamini 	 * using information stored in command blocks.
2016ceaec73dSDamien Bergamini 	 */
2017ceaec73dSDamien Bergamini 	src = physaddr;
2018ceaec73dSDamien Bergamini 	p = virtaddr;
2019ceaec73dSDamien Bergamini 	end = p + size;
2020ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_AUTOINC_ADDR, 0x27000);
2021ceaec73dSDamien Bergamini 
2022ceaec73dSDamien Bergamini 	while (p < end) {
2023ceaec73dSDamien Bergamini 		dst = GETLE32(p); p += 4; src += 4;
2024ceaec73dSDamien Bergamini 		len = GETLE32(p); p += 4; src += 4;
2025ceaec73dSDamien Bergamini 		p += len;
2026ceaec73dSDamien Bergamini 
2027ceaec73dSDamien Bergamini 		while (len > 0) {
2028ceaec73dSDamien Bergamini 			mlen = min(len, IWI_CB_MAXDATALEN);
2029ceaec73dSDamien Bergamini 
2030ceaec73dSDamien Bergamini 			ctl = IWI_CB_DEFAULT_CTL | mlen;
2031ceaec73dSDamien Bergamini 			sum = ctl ^ src ^ dst;
2032ceaec73dSDamien Bergamini 
2033ceaec73dSDamien Bergamini 			/* write a command block */
2034ceaec73dSDamien Bergamini 			CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, ctl);
2035ceaec73dSDamien Bergamini 			CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, src);
2036ceaec73dSDamien Bergamini 			CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, dst);
2037ceaec73dSDamien Bergamini 			CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, sum);
2038ceaec73dSDamien Bergamini 
2039ceaec73dSDamien Bergamini 			src += mlen;
2040ceaec73dSDamien Bergamini 			dst += mlen;
2041ceaec73dSDamien Bergamini 			len -= mlen;
2042ceaec73dSDamien Bergamini 		}
2043ceaec73dSDamien Bergamini 	}
2044ceaec73dSDamien Bergamini 
2045ceaec73dSDamien Bergamini 	/* write a fictive final command block (sentinel) */
2046ceaec73dSDamien Bergamini 	sentinel = CSR_READ_4(sc, IWI_CSR_AUTOINC_ADDR);
2047ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_AUTOINC_DATA, 0);
2048ceaec73dSDamien Bergamini 
2049ceaec73dSDamien Bergamini 	tmp = CSR_READ_4(sc, IWI_CSR_RST);
2050ceaec73dSDamien Bergamini 	tmp &= ~(IWI_RST_MASTER_DISABLED | IWI_RST_STOP_MASTER);
2051ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, tmp);
2052ceaec73dSDamien Bergamini 
2053ceaec73dSDamien Bergamini 	/* tell the adapter to start processing command blocks */
2054ceaec73dSDamien Bergamini 	MEM_WRITE_4(sc, 0x3000a4, 0x540100);
2055ceaec73dSDamien Bergamini 
2056408146edSDamien Bergamini 	/* wait until the adapter reaches the sentinel */
2057ceaec73dSDamien Bergamini 	for (ntries = 0; ntries < 400; ntries++) {
2058ceaec73dSDamien Bergamini 		if (MEM_READ_4(sc, 0x3000d0) >= sentinel)
2059ceaec73dSDamien Bergamini 			break;
2060ceaec73dSDamien Bergamini 		DELAY(100);
2061ceaec73dSDamien Bergamini 	}
2062ceaec73dSDamien Bergamini 	if (ntries == 400) {
2063ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev,
2064ceaec73dSDamien Bergamini 		    "timeout processing command blocks\n");
2065ceaec73dSDamien Bergamini 		error = EIO;
2066408146edSDamien Bergamini 		goto fail5;
2067ceaec73dSDamien Bergamini 	}
2068ceaec73dSDamien Bergamini 
2069ceaec73dSDamien Bergamini 	/* we're done with command blocks processing */
2070ceaec73dSDamien Bergamini 	MEM_WRITE_4(sc, 0x3000a4, 0x540c00);
2071ceaec73dSDamien Bergamini 
2072408146edSDamien Bergamini 	/* allow interrupts so we know when the firmware is ready */
2073ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_INTR_MASK, IWI_INTR_MASK);
2074ceaec73dSDamien Bergamini 
2075ceaec73dSDamien Bergamini 	/* tell the adapter to initialize the firmware */
2076ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, 0);
2077ceaec73dSDamien Bergamini 
2078ceaec73dSDamien Bergamini 	tmp = CSR_READ_4(sc, IWI_CSR_CTL);
2079ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_CTL, tmp | IWI_CTL_ALLOW_STANDBY);
2080ceaec73dSDamien Bergamini 
2081ceaec73dSDamien Bergamini 	/* wait at most one second for firmware initialization to complete */
2082ceaec73dSDamien Bergamini 	if ((error = msleep(sc, &sc->sc_mtx, 0, "iwiinit", hz)) != 0) {
2083ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "timeout waiting for firmware "
2084ceaec73dSDamien Bergamini 		    "initialization to complete\n");
2085ceaec73dSDamien Bergamini 	}
2086ceaec73dSDamien Bergamini 
2087408146edSDamien Bergamini fail5:	bus_dmamap_sync(dmat, map, BUS_DMASYNC_POSTWRITE);
2088ceaec73dSDamien Bergamini 	bus_dmamap_unload(dmat, map);
2089408146edSDamien Bergamini fail4:	bus_dmamem_free(dmat, virtaddr, map);
2090408146edSDamien Bergamini fail3:	bus_dma_tag_destroy(dmat);
2091408146edSDamien Bergamini fail2:	free(fw, M_DEVBUF);
2092ceaec73dSDamien Bergamini fail1:
2093ceaec73dSDamien Bergamini 	return error;
2094ceaec73dSDamien Bergamini }
2095ceaec73dSDamien Bergamini 
2096ceaec73dSDamien Bergamini static int
2097ceaec73dSDamien Bergamini iwi_config(struct iwi_softc *sc)
2098ceaec73dSDamien Bergamini {
2099ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
2100ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
2101ceaec73dSDamien Bergamini 	struct iwi_configuration config;
2102ceaec73dSDamien Bergamini 	struct iwi_rateset rs;
2103ceaec73dSDamien Bergamini 	struct iwi_txpower power;
2104ceaec73dSDamien Bergamini 	struct ieee80211_key *wk;
2105ceaec73dSDamien Bergamini 	struct iwi_wep_key wepkey;
2106ceaec73dSDamien Bergamini 	uint32_t data;
2107ceaec73dSDamien Bergamini 	int error, i;
2108ceaec73dSDamien Bergamini 
2109ceaec73dSDamien Bergamini 	IEEE80211_ADDR_COPY(ic->ic_myaddr, IF_LLADDR(ifp));
2110ceaec73dSDamien Bergamini 	DPRINTF(("Setting MAC address to %6D\n", ic->ic_myaddr, ":"));
2111ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_MAC_ADDRESS, ic->ic_myaddr,
2112ceaec73dSDamien Bergamini 	    IEEE80211_ADDR_LEN, 0);
2113ceaec73dSDamien Bergamini 	if (error != 0)
2114ceaec73dSDamien Bergamini 		return error;
2115ceaec73dSDamien Bergamini 
2116ceaec73dSDamien Bergamini 	memset(&config, 0, sizeof config);
2117ceaec73dSDamien Bergamini 	config.bluetooth_coexistence = sc->bluetooth;
2118acea4241SDamien Bergamini 	config.antenna = sc->antenna;
2119ceaec73dSDamien Bergamini 	config.multicast_enabled = 1;
2120acea4241SDamien Bergamini 	config.answer_pbreq = (ic->ic_opmode == IEEE80211_M_IBSS) ? 1 : 0;
2121acea4241SDamien Bergamini 	config.disable_unicast_decryption = 1;
2122acea4241SDamien Bergamini 	config.disable_multicast_decryption = 1;
2123ceaec73dSDamien Bergamini 	DPRINTF(("Configuring adapter\n"));
2124ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_CONFIG, &config, sizeof config, 0);
2125ceaec73dSDamien Bergamini 	if (error != 0)
2126ceaec73dSDamien Bergamini 		return error;
2127ceaec73dSDamien Bergamini 
2128ceaec73dSDamien Bergamini 	data = htole32(IWI_POWER_MODE_CAM);
2129ceaec73dSDamien Bergamini 	DPRINTF(("Setting power mode to %u\n", le32toh(data)));
2130ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_POWER_MODE, &data, sizeof data, 0);
2131ceaec73dSDamien Bergamini 	if (error != 0)
2132ceaec73dSDamien Bergamini 		return error;
2133ceaec73dSDamien Bergamini 
2134ceaec73dSDamien Bergamini 	data = htole32(ic->ic_rtsthreshold);
2135ceaec73dSDamien Bergamini 	DPRINTF(("Setting RTS threshold to %u\n", le32toh(data)));
2136ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_RTS_THRESHOLD, &data, sizeof data, 0);
2137ceaec73dSDamien Bergamini 	if (error != 0)
2138ceaec73dSDamien Bergamini 		return error;
2139ceaec73dSDamien Bergamini 
2140acea4241SDamien Bergamini 	data = htole32(ic->ic_fragthreshold);
2141acea4241SDamien Bergamini 	DPRINTF(("Setting fragmentation threshold to %u\n", le32toh(data)));
2142acea4241SDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_FRAG_THRESHOLD, &data, sizeof data, 0);
2143acea4241SDamien Bergamini 	if (error != 0)
2144acea4241SDamien Bergamini 		return error;
2145acea4241SDamien Bergamini 
2146ceaec73dSDamien Bergamini 	if (ic->ic_opmode == IEEE80211_M_IBSS) {
2147ceaec73dSDamien Bergamini 		power.mode = IWI_MODE_11B;
2148ceaec73dSDamien Bergamini 		power.nchan = 11;
2149ceaec73dSDamien Bergamini 		for (i = 0; i < 11; i++) {
2150ceaec73dSDamien Bergamini 			power.chan[i].chan = i + 1;
2151ceaec73dSDamien Bergamini 			power.chan[i].power = IWI_TXPOWER_MAX;
2152ceaec73dSDamien Bergamini 		}
2153ceaec73dSDamien Bergamini 		DPRINTF(("Setting .11b channels tx power\n"));
2154ceaec73dSDamien Bergamini 		error = iwi_cmd(sc, IWI_CMD_SET_TX_POWER, &power, sizeof power,
2155ceaec73dSDamien Bergamini 		    0);
2156ceaec73dSDamien Bergamini 		if (error != 0)
2157ceaec73dSDamien Bergamini 			return error;
2158ceaec73dSDamien Bergamini 
2159ceaec73dSDamien Bergamini 		power.mode = IWI_MODE_11G;
2160ceaec73dSDamien Bergamini 		DPRINTF(("Setting .11g channels tx power\n"));
2161ceaec73dSDamien Bergamini 		error = iwi_cmd(sc, IWI_CMD_SET_TX_POWER, &power, sizeof power,
2162ceaec73dSDamien Bergamini 		    0);
2163ceaec73dSDamien Bergamini 		if (error != 0)
2164ceaec73dSDamien Bergamini 			return error;
2165ceaec73dSDamien Bergamini 	}
2166ceaec73dSDamien Bergamini 
2167ceaec73dSDamien Bergamini 	rs.mode = IWI_MODE_11G;
2168ceaec73dSDamien Bergamini 	rs.type = IWI_RATESET_TYPE_SUPPORTED;
2169ceaec73dSDamien Bergamini 	rs.nrates = ic->ic_sup_rates[IEEE80211_MODE_11G].rs_nrates;
2170ceaec73dSDamien Bergamini 	memcpy(rs.rates, ic->ic_sup_rates[IEEE80211_MODE_11G].rs_rates,
2171ceaec73dSDamien Bergamini 	    rs.nrates);
2172ceaec73dSDamien Bergamini 	DPRINTF(("Setting .11bg supported rates (%u)\n", rs.nrates));
2173ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_RATES, &rs, sizeof rs, 0);
2174ceaec73dSDamien Bergamini 	if (error != 0)
2175ceaec73dSDamien Bergamini 		return error;
2176ceaec73dSDamien Bergamini 
2177ceaec73dSDamien Bergamini 	rs.mode = IWI_MODE_11A;
2178ceaec73dSDamien Bergamini 	rs.type = IWI_RATESET_TYPE_SUPPORTED;
2179ceaec73dSDamien Bergamini 	rs.nrates = ic->ic_sup_rates[IEEE80211_MODE_11A].rs_nrates;
2180ceaec73dSDamien Bergamini 	memcpy(rs.rates, ic->ic_sup_rates[IEEE80211_MODE_11A].rs_rates,
2181ceaec73dSDamien Bergamini 	    rs.nrates);
2182ceaec73dSDamien Bergamini 	DPRINTF(("Setting .11a supported rates (%u)\n", rs.nrates));
2183ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_RATES, &rs, sizeof rs, 0);
2184ceaec73dSDamien Bergamini 	if (error != 0)
2185ceaec73dSDamien Bergamini 		return error;
2186ceaec73dSDamien Bergamini 
21870b74a285SDamien Bergamini 	/* if we have a desired ESSID, set it now */
21880b74a285SDamien Bergamini 	if (ic->ic_des_esslen != 0) {
21890b74a285SDamien Bergamini #ifdef IWI_DEBUG
21900b74a285SDamien Bergamini 		if (iwi_debug > 0) {
21910b74a285SDamien Bergamini 			printf("Setting desired ESSID to ");
21920b74a285SDamien Bergamini 			ieee80211_print_essid(ic->ic_des_essid,
21930b74a285SDamien Bergamini 			    ic->ic_des_esslen);
21940b74a285SDamien Bergamini 			printf("\n");
21950b74a285SDamien Bergamini 		}
21960b74a285SDamien Bergamini #endif
21970b74a285SDamien Bergamini 		error = iwi_cmd(sc, IWI_CMD_SET_ESSID, ic->ic_des_essid,
21987e47fb02SDamien Bergamini 		    ic->ic_des_esslen, 0);
21990b74a285SDamien Bergamini 		if (error != 0)
22000b74a285SDamien Bergamini 			return error;
22010b74a285SDamien Bergamini 	}
22020b74a285SDamien Bergamini 
2203ceaec73dSDamien Bergamini 	data = htole32(arc4random());
2204ceaec73dSDamien Bergamini 	DPRINTF(("Setting initialization vector to %u\n", le32toh(data)));
2205ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_IV, &data, sizeof data, 0);
2206ceaec73dSDamien Bergamini 	if (error != 0)
2207ceaec73dSDamien Bergamini 		return error;
2208ceaec73dSDamien Bergamini 
2209ceaec73dSDamien Bergamini 	for (i = 0; i < IEEE80211_WEP_NKID; i++) {
2210ceaec73dSDamien Bergamini 		wk = &ic->ic_crypto.cs_nw_keys[i];
2211ceaec73dSDamien Bergamini 
2212ceaec73dSDamien Bergamini 		wepkey.cmd = IWI_WEP_KEY_CMD_SETKEY;
2213ceaec73dSDamien Bergamini 		wepkey.idx = i;
2214ceaec73dSDamien Bergamini 		wepkey.len = wk->wk_keylen;
2215ceaec73dSDamien Bergamini 		memset(wepkey.key, 0, sizeof wepkey.key);
2216ceaec73dSDamien Bergamini 		memcpy(wepkey.key, wk->wk_key, wk->wk_keylen);
2217ceaec73dSDamien Bergamini 		DPRINTF(("Setting wep key index %u len %u\n", wepkey.idx,
2218ceaec73dSDamien Bergamini 		    wepkey.len));
2219ceaec73dSDamien Bergamini 		error = iwi_cmd(sc, IWI_CMD_SET_WEP_KEY, &wepkey,
2220ceaec73dSDamien Bergamini 		    sizeof wepkey, 0);
2221ceaec73dSDamien Bergamini 		if (error != 0)
2222ceaec73dSDamien Bergamini 			return error;
2223ceaec73dSDamien Bergamini 	}
2224ceaec73dSDamien Bergamini 
2225ceaec73dSDamien Bergamini 	/* enable adapter */
2226ceaec73dSDamien Bergamini 	DPRINTF(("Enabling adapter\n"));
2227ceaec73dSDamien Bergamini 	return iwi_cmd(sc, IWI_CMD_ENABLE, NULL, 0, 0);
2228ceaec73dSDamien Bergamini }
2229ceaec73dSDamien Bergamini 
2230ceaec73dSDamien Bergamini static int
2231acea4241SDamien Bergamini iwi_set_chan(struct iwi_softc *sc, struct ieee80211_channel *chan)
2232acea4241SDamien Bergamini {
2233acea4241SDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
2234acea4241SDamien Bergamini 	struct iwi_scan scan;
2235acea4241SDamien Bergamini 
2236acea4241SDamien Bergamini 	memset(&scan, 0, sizeof scan);
223771016a24SDamien Bergamini 	memset(scan.type, IWI_SCAN_TYPE_PASSIVE, sizeof scan.type);
223880e1a712SDamien Bergamini 	scan.passive = htole16(2000);
223980e1a712SDamien Bergamini 	scan.channels[0] = 1 |
224080e1a712SDamien Bergamini 	    (IEEE80211_IS_CHAN_5GHZ(chan) ? IWI_CHAN_5GHZ : IWI_CHAN_2GHZ);
2241acea4241SDamien Bergamini 	scan.channels[1] = ieee80211_chan2ieee(ic, chan);
2242acea4241SDamien Bergamini 
2243acea4241SDamien Bergamini 	DPRINTF(("Setting channel to %u\n", ieee80211_chan2ieee(ic, chan)));
2244acea4241SDamien Bergamini 	return iwi_cmd(sc, IWI_CMD_SCAN, &scan, sizeof scan, 1);
2245acea4241SDamien Bergamini }
2246acea4241SDamien Bergamini 
2247acea4241SDamien Bergamini static int
2248ceaec73dSDamien Bergamini iwi_scan(struct iwi_softc *sc)
2249ceaec73dSDamien Bergamini {
2250ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
2251ceaec73dSDamien Bergamini 	struct iwi_scan scan;
2252ceaec73dSDamien Bergamini 	uint8_t *p;
2253ceaec73dSDamien Bergamini 	int i, count;
2254ceaec73dSDamien Bergamini 
2255ceaec73dSDamien Bergamini 	memset(&scan, 0, sizeof scan);
225680e1a712SDamien Bergamini 
225780e1a712SDamien Bergamini 	if (ic->ic_des_esslen != 0) {
225880e1a712SDamien Bergamini 		scan.bdirected = htole16(sc->dwelltime);
225971016a24SDamien Bergamini 		memset(scan.type, IWI_SCAN_TYPE_BDIRECTED, sizeof scan.type);
226080e1a712SDamien Bergamini 	} else {
226180e1a712SDamien Bergamini 		scan.broadcast = htole16(sc->dwelltime);
226271016a24SDamien Bergamini 		memset(scan.type, IWI_SCAN_TYPE_BROADCAST, sizeof scan.type);
226380e1a712SDamien Bergamini 	}
2264ceaec73dSDamien Bergamini 
2265ceaec73dSDamien Bergamini 	p = scan.channels;
2266ceaec73dSDamien Bergamini 	count = 0;
2267ceaec73dSDamien Bergamini 	for (i = 0; i <= IEEE80211_CHAN_MAX; i++) {
2268ceaec73dSDamien Bergamini 		if (IEEE80211_IS_CHAN_5GHZ(&ic->ic_channels[i]) &&
2269ceaec73dSDamien Bergamini 		    isset(ic->ic_chan_active, i)) {
2270ceaec73dSDamien Bergamini 			*++p = i;
2271ceaec73dSDamien Bergamini 			count++;
2272ceaec73dSDamien Bergamini 		}
2273ceaec73dSDamien Bergamini 	}
2274ceaec73dSDamien Bergamini 	*(p - count) = IWI_CHAN_5GHZ | count;
2275ceaec73dSDamien Bergamini 
227684f55b29SDamien Bergamini 	p = (count > 0) ? p + 1 : scan.channels;
2277ceaec73dSDamien Bergamini 	count = 0;
2278ceaec73dSDamien Bergamini 	for (i = 0; i <= IEEE80211_CHAN_MAX; i++) {
2279ceaec73dSDamien Bergamini 		if (IEEE80211_IS_CHAN_2GHZ(&ic->ic_channels[i]) &&
2280ceaec73dSDamien Bergamini 		    isset(ic->ic_chan_active, i)) {
2281ceaec73dSDamien Bergamini 			*++p = i;
2282ceaec73dSDamien Bergamini 			count++;
2283ceaec73dSDamien Bergamini 		}
2284ceaec73dSDamien Bergamini 	}
2285ceaec73dSDamien Bergamini 	*(p - count) = IWI_CHAN_2GHZ | count;
2286ceaec73dSDamien Bergamini 
2287ceaec73dSDamien Bergamini 	DPRINTF(("Start scanning\n"));
2288ceaec73dSDamien Bergamini 	return iwi_cmd(sc, IWI_CMD_SCAN, &scan, sizeof scan, 1);
2289ceaec73dSDamien Bergamini }
2290ceaec73dSDamien Bergamini 
2291ceaec73dSDamien Bergamini static int
2292ceaec73dSDamien Bergamini iwi_auth_and_assoc(struct iwi_softc *sc)
2293ceaec73dSDamien Bergamini {
2294ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
2295ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
2296ceaec73dSDamien Bergamini 	struct ieee80211_node *ni = ic->ic_bss;
2297ec01dc2bSDamien Bergamini 	struct ieee80211_wme_info wme;
2298ceaec73dSDamien Bergamini 	struct iwi_configuration config;
2299ceaec73dSDamien Bergamini 	struct iwi_associate assoc;
2300ceaec73dSDamien Bergamini 	struct iwi_rateset rs;
2301acea4241SDamien Bergamini 	uint16_t capinfo;
2302ceaec73dSDamien Bergamini 	uint32_t data;
2303ceaec73dSDamien Bergamini 	int error;
2304ceaec73dSDamien Bergamini 
2305ceaec73dSDamien Bergamini 	if (IEEE80211_IS_CHAN_2GHZ(ni->ni_chan)) {
2306ceaec73dSDamien Bergamini 		memset(&config, 0, sizeof config);
2307ceaec73dSDamien Bergamini 		config.bluetooth_coexistence = sc->bluetooth;
2308acea4241SDamien Bergamini 		config.antenna = sc->antenna;
2309ceaec73dSDamien Bergamini 		config.multicast_enabled = 1;
2310ceaec73dSDamien Bergamini 		config.use_protection = 1;
2311acea4241SDamien Bergamini 		config.answer_pbreq =
2312acea4241SDamien Bergamini 		    (ic->ic_opmode == IEEE80211_M_IBSS) ? 1 : 0;
2313acea4241SDamien Bergamini 		config.disable_unicast_decryption = 1;
2314acea4241SDamien Bergamini 		config.disable_multicast_decryption = 1;
2315ceaec73dSDamien Bergamini 		DPRINTF(("Configuring adapter\n"));
2316ceaec73dSDamien Bergamini 		error = iwi_cmd(sc, IWI_CMD_SET_CONFIG, &config, sizeof config,
2317ceaec73dSDamien Bergamini 		    1);
2318ceaec73dSDamien Bergamini 		if (error != 0)
2319ceaec73dSDamien Bergamini 			return error;
2320ceaec73dSDamien Bergamini 	}
2321ceaec73dSDamien Bergamini 
2322ceaec73dSDamien Bergamini #ifdef IWI_DEBUG
2323ceaec73dSDamien Bergamini 	if (iwi_debug > 0) {
2324ceaec73dSDamien Bergamini 		printf("Setting ESSID to ");
2325ceaec73dSDamien Bergamini 		ieee80211_print_essid(ni->ni_essid, ni->ni_esslen);
2326ceaec73dSDamien Bergamini 		printf("\n");
2327ceaec73dSDamien Bergamini 	}
2328ceaec73dSDamien Bergamini #endif
2329ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_ESSID, ni->ni_essid, ni->ni_esslen, 1);
2330ceaec73dSDamien Bergamini 	if (error != 0)
2331ceaec73dSDamien Bergamini 		return error;
2332ceaec73dSDamien Bergamini 
233380e1a712SDamien Bergamini 	/* the rate set has already been "negotiated" */
2334ceaec73dSDamien Bergamini 	rs.mode = IEEE80211_IS_CHAN_5GHZ(ni->ni_chan) ? IWI_MODE_11A :
2335ceaec73dSDamien Bergamini 	    IWI_MODE_11G;
233680e1a712SDamien Bergamini 	rs.type = IWI_RATESET_TYPE_NEGOTIATED;
2337ceaec73dSDamien Bergamini 	rs.nrates = ni->ni_rates.rs_nrates;
2338ceaec73dSDamien Bergamini 	memcpy(rs.rates, ni->ni_rates.rs_rates, rs.nrates);
2339ceaec73dSDamien Bergamini 	DPRINTF(("Setting negociated rates (%u)\n", rs.nrates));
2340ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_RATES, &rs, sizeof rs, 1);
2341ceaec73dSDamien Bergamini 	if (error != 0)
2342ceaec73dSDamien Bergamini 		return error;
2343ceaec73dSDamien Bergamini 
2344ec01dc2bSDamien Bergamini 	if ((ic->ic_flags & IEEE80211_F_WME) && ni->ni_wme_ie != NULL) {
2345ec01dc2bSDamien Bergamini 		wme.wme_id = IEEE80211_ELEMID_VENDOR;
2346ec01dc2bSDamien Bergamini 		wme.wme_len = sizeof (struct ieee80211_wme_info) - 2;
2347ec01dc2bSDamien Bergamini 		wme.wme_oui[0] = 0x00;
2348ec01dc2bSDamien Bergamini 		wme.wme_oui[1] = 0x50;
2349ec01dc2bSDamien Bergamini 		wme.wme_oui[2] = 0xf2;
2350ec01dc2bSDamien Bergamini 		wme.wme_type = WME_OUI_TYPE;
2351ec01dc2bSDamien Bergamini 		wme.wme_subtype = WME_INFO_OUI_SUBTYPE;
2352ec01dc2bSDamien Bergamini 		wme.wme_version = WME_VERSION;
2353ec01dc2bSDamien Bergamini 		wme.wme_info = 0;
2354ec01dc2bSDamien Bergamini 
2355ec01dc2bSDamien Bergamini 		DPRINTF(("Setting WME IE (len=%u)\n", wme.wme_len));
2356ec01dc2bSDamien Bergamini 		error = iwi_cmd(sc, IWI_CMD_SET_WMEIE, &wme, sizeof wme, 1);
2357ec01dc2bSDamien Bergamini 		if (error != 0)
2358ec01dc2bSDamien Bergamini 			return error;
2359ec01dc2bSDamien Bergamini 	}
2360ec01dc2bSDamien Bergamini 
2361acea4241SDamien Bergamini 	if (ic->ic_opt_ie != NULL) {
2362acea4241SDamien Bergamini 		DPRINTF(("Setting optional IE (len=%u)\n", ic->ic_opt_ie_len));
2363acea4241SDamien Bergamini 		error = iwi_cmd(sc, IWI_CMD_SET_OPTIE, ic->ic_opt_ie,
2364acea4241SDamien Bergamini 		    ic->ic_opt_ie_len, 1);
2365acea4241SDamien Bergamini 		if (error != 0)
2366acea4241SDamien Bergamini 			return error;
2367acea4241SDamien Bergamini 	}
2368acea4241SDamien Bergamini 
2369ceaec73dSDamien Bergamini 	data = htole32(ni->ni_rssi);
2370ceaec73dSDamien Bergamini 	DPRINTF(("Setting sensitivity to %d\n", (int8_t)ni->ni_rssi));
2371ceaec73dSDamien Bergamini 	error = iwi_cmd(sc, IWI_CMD_SET_SENSITIVITY, &data, sizeof data, 1);
2372ceaec73dSDamien Bergamini 	if (error != 0)
2373ceaec73dSDamien Bergamini 		return error;
2374ceaec73dSDamien Bergamini 
2375ceaec73dSDamien Bergamini 	memset(&assoc, 0, sizeof assoc);
2376ceaec73dSDamien Bergamini 	assoc.mode = IEEE80211_IS_CHAN_5GHZ(ni->ni_chan) ? IWI_MODE_11A :
2377ceaec73dSDamien Bergamini 	    IWI_MODE_11G;
2378ceaec73dSDamien Bergamini 	assoc.chan = ieee80211_chan2ieee(ic, ni->ni_chan);
2379ceaec73dSDamien Bergamini 	if (ni->ni_authmode == IEEE80211_AUTH_SHARED)
2380ceaec73dSDamien Bergamini 		assoc.auth = ic->ic_crypto.cs_def_txkey << 4 | IWI_AUTH_SHARED;
2381ec01dc2bSDamien Bergamini 	if ((ic->ic_flags & IEEE80211_F_WME) && ni->ni_wme_ie != NULL)
2382ec01dc2bSDamien Bergamini 		assoc.policy |= htole16(IWI_POLICY_WME);
2383acea4241SDamien Bergamini 	if (ic->ic_opt_ie != NULL)
2384ec01dc2bSDamien Bergamini 		assoc.policy |= htole16(IWI_POLICY_WPA);
2385ceaec73dSDamien Bergamini 	memcpy(assoc.tstamp, ni->ni_tstamp.data, 8);
2386acea4241SDamien Bergamini 
2387acea4241SDamien Bergamini 	if (ic->ic_opmode == IEEE80211_M_IBSS)
2388acea4241SDamien Bergamini 		capinfo = IEEE80211_CAPINFO_IBSS;
2389acea4241SDamien Bergamini 	else
2390acea4241SDamien Bergamini 		capinfo = IEEE80211_CAPINFO_ESS;
2391acea4241SDamien Bergamini 	if (ic->ic_flags & IEEE80211_F_PRIVACY)
2392acea4241SDamien Bergamini 		capinfo |= IEEE80211_CAPINFO_PRIVACY;
2393acea4241SDamien Bergamini 	if ((ic->ic_flags & IEEE80211_F_SHPREAMBLE) &&
2394acea4241SDamien Bergamini 	    IEEE80211_IS_CHAN_2GHZ(ni->ni_chan))
2395acea4241SDamien Bergamini 		capinfo |= IEEE80211_CAPINFO_SHORT_PREAMBLE;
2396acea4241SDamien Bergamini 	if (ic->ic_flags & IEEE80211_F_SHSLOT)
2397acea4241SDamien Bergamini 		capinfo |= IEEE80211_CAPINFO_SHORT_SLOTTIME;
2398acea4241SDamien Bergamini 	assoc.capinfo = htole16(capinfo);
2399acea4241SDamien Bergamini 
2400ceaec73dSDamien Bergamini 	assoc.lintval = htole16(ic->ic_lintval);
2401ceaec73dSDamien Bergamini 	assoc.intval = htole16(ni->ni_intval);
2402ceaec73dSDamien Bergamini 	IEEE80211_ADDR_COPY(assoc.bssid, ni->ni_bssid);
2403ceaec73dSDamien Bergamini 	if (ic->ic_opmode == IEEE80211_M_IBSS)
2404ceaec73dSDamien Bergamini 		IEEE80211_ADDR_COPY(assoc.dst, ifp->if_broadcastaddr);
2405ceaec73dSDamien Bergamini 	else
2406ceaec73dSDamien Bergamini 		IEEE80211_ADDR_COPY(assoc.dst, ni->ni_bssid);
2407ceaec73dSDamien Bergamini 
2408ceaec73dSDamien Bergamini 	DPRINTF(("Trying to associate to %6D channel %u auth %u\n",
2409ceaec73dSDamien Bergamini 	    assoc.bssid, ":", assoc.chan, assoc.auth));
2410ceaec73dSDamien Bergamini 	return iwi_cmd(sc, IWI_CMD_ASSOCIATE, &assoc, sizeof assoc, 1);
2411ceaec73dSDamien Bergamini }
2412ceaec73dSDamien Bergamini 
2413ceaec73dSDamien Bergamini static void
2414ceaec73dSDamien Bergamini iwi_init(void *priv)
2415ceaec73dSDamien Bergamini {
2416ceaec73dSDamien Bergamini 	struct iwi_softc *sc = priv;
2417ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
2418ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
2419ceaec73dSDamien Bergamini 	struct iwi_rx_data *data;
2420408146edSDamien Bergamini 	const char *uc, *fw;
2421ceaec73dSDamien Bergamini 	int i;
2422ceaec73dSDamien Bergamini 
2423ceaec73dSDamien Bergamini 	iwi_stop(sc);
2424ceaec73dSDamien Bergamini 
2425ceaec73dSDamien Bergamini 	if (iwi_reset(sc) != 0) {
2426ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not reset adapter\n");
2427ceaec73dSDamien Bergamini 		goto fail;
2428ceaec73dSDamien Bergamini 	}
2429ceaec73dSDamien Bergamini 
2430408146edSDamien Bergamini 	switch (ic->ic_opmode) {
2431408146edSDamien Bergamini 	case IEEE80211_M_STA:
2432408146edSDamien Bergamini 		uc = "iwi-ucode-bss";
2433408146edSDamien Bergamini 		fw = "iwi-bss";
2434408146edSDamien Bergamini 		break;
2435408146edSDamien Bergamini 
2436408146edSDamien Bergamini 	case IEEE80211_M_IBSS:
2437408146edSDamien Bergamini 		uc = "iwi-ucode-ibss";
2438408146edSDamien Bergamini 		fw = "iwi-ibss";
2439408146edSDamien Bergamini 		break;
2440408146edSDamien Bergamini 
2441408146edSDamien Bergamini 	case IEEE80211_M_MONITOR:
2442408146edSDamien Bergamini 		uc = "iwi-ucode-monitor";
2443408146edSDamien Bergamini 		fw = "iwi-monitor";
2444408146edSDamien Bergamini 		break;
2445408146edSDamien Bergamini 
2446408146edSDamien Bergamini 	default:
2447408146edSDamien Bergamini 		uc = fw = NULL;	/* should not get there */
2448408146edSDamien Bergamini 	}
2449408146edSDamien Bergamini 
2450408146edSDamien Bergamini 	if (iwi_load_firmware(sc, "iwi-boot") != 0) {
2451ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not load boot firmware\n");
2452ceaec73dSDamien Bergamini 		goto fail;
2453ceaec73dSDamien Bergamini 	}
2454ceaec73dSDamien Bergamini 
2455408146edSDamien Bergamini 	if (iwi_load_ucode(sc, uc) != 0) {
2456ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not load microcode\n");
2457ceaec73dSDamien Bergamini 		goto fail;
2458ceaec73dSDamien Bergamini 	}
2459ceaec73dSDamien Bergamini 
2460ceaec73dSDamien Bergamini 	iwi_stop_master(sc);
2461ceaec73dSDamien Bergamini 
2462ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_CMD_BASE, sc->cmdq.physaddr);
2463ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_CMD_SIZE, sc->cmdq.count);
2464ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_CMD_WIDX, sc->cmdq.cur);
2465ceaec73dSDamien Bergamini 
2466ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX1_BASE, sc->txq[0].physaddr);
2467ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX1_SIZE, sc->txq[0].count);
2468ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX1_WIDX, sc->txq[0].cur);
2469ceaec73dSDamien Bergamini 
2470ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX2_BASE, sc->txq[1].physaddr);
2471ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX2_SIZE, sc->txq[1].count);
2472ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX2_WIDX, sc->txq[1].cur);
2473ceaec73dSDamien Bergamini 
2474ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX3_BASE, sc->txq[2].physaddr);
2475ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX3_SIZE, sc->txq[2].count);
2476ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX3_WIDX, sc->txq[2].cur);
2477ceaec73dSDamien Bergamini 
2478ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX4_BASE, sc->txq[3].physaddr);
2479ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX4_SIZE, sc->txq[3].count);
2480ec01dc2bSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_TX4_WIDX, sc->txq[3].cur);
2481ceaec73dSDamien Bergamini 
2482ceaec73dSDamien Bergamini 	for (i = 0; i < sc->rxq.count; i++) {
2483ceaec73dSDamien Bergamini 		data = &sc->rxq.data[i];
2484ceaec73dSDamien Bergamini 		CSR_WRITE_4(sc, data->reg, data->physaddr);
2485ceaec73dSDamien Bergamini 	}
2486ceaec73dSDamien Bergamini 
2487ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RX_WIDX, sc->rxq.count - 1);
2488ceaec73dSDamien Bergamini 
2489408146edSDamien Bergamini 	if (iwi_load_firmware(sc, fw) != 0) {
2490ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "could not load main firmware\n");
2491ceaec73dSDamien Bergamini 		goto fail;
2492ceaec73dSDamien Bergamini 	}
2493ceaec73dSDamien Bergamini 
2494ceaec73dSDamien Bergamini 	sc->flags |= IWI_FLAG_FW_INITED;
2495ceaec73dSDamien Bergamini 
2496ceaec73dSDamien Bergamini 	if (iwi_config(sc) != 0) {
2497ceaec73dSDamien Bergamini 		device_printf(sc->sc_dev, "device configuration failed\n");
2498ceaec73dSDamien Bergamini 		goto fail;
2499ceaec73dSDamien Bergamini 	}
2500ceaec73dSDamien Bergamini 
2501e0454c26SDamien Bergamini 	if (ic->ic_opmode != IEEE80211_M_MONITOR) {
2502e0454c26SDamien Bergamini 		if (ic->ic_roaming != IEEE80211_ROAMING_MANUAL)
2503acea4241SDamien Bergamini 			ieee80211_new_state(ic, IEEE80211_S_SCAN, -1);
2504e0454c26SDamien Bergamini 	} else
2505e0454c26SDamien Bergamini 		ieee80211_new_state(ic, IEEE80211_S_RUN, -1);
2506ceaec73dSDamien Bergamini 
250713f4c340SRobert Watson 	ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
250813f4c340SRobert Watson 	ifp->if_drv_flags |= IFF_DRV_RUNNING;
2509ceaec73dSDamien Bergamini 
2510ceaec73dSDamien Bergamini 	return;
2511ceaec73dSDamien Bergamini 
2512ceaec73dSDamien Bergamini fail:	ifp->if_flags &= ~IFF_UP;
2513ceaec73dSDamien Bergamini 	iwi_stop(sc);
2514ceaec73dSDamien Bergamini }
2515ceaec73dSDamien Bergamini 
2516ceaec73dSDamien Bergamini static void
2517ceaec73dSDamien Bergamini iwi_stop(void *priv)
2518ceaec73dSDamien Bergamini {
2519ceaec73dSDamien Bergamini 	struct iwi_softc *sc = priv;
2520ceaec73dSDamien Bergamini 	struct ieee80211com *ic = &sc->sc_ic;
2521ceaec73dSDamien Bergamini 	struct ifnet *ifp = ic->ic_ifp;
2522ceaec73dSDamien Bergamini 
252384f55b29SDamien Bergamini 	ieee80211_new_state(ic, IEEE80211_S_INIT, -1);
252484f55b29SDamien Bergamini 
2525ceaec73dSDamien Bergamini 	iwi_stop_master(sc);
2526ceaec73dSDamien Bergamini 
2527ceaec73dSDamien Bergamini 	CSR_WRITE_4(sc, IWI_CSR_RST, IWI_RST_SOFT_RESET);
2528ceaec73dSDamien Bergamini 
2529ceaec73dSDamien Bergamini 	/* reset rings */
2530ceaec73dSDamien Bergamini 	iwi_reset_cmd_ring(sc, &sc->cmdq);
2531ec01dc2bSDamien Bergamini 	iwi_reset_tx_ring(sc, &sc->txq[0]);
2532ec01dc2bSDamien Bergamini 	iwi_reset_tx_ring(sc, &sc->txq[1]);
2533ec01dc2bSDamien Bergamini 	iwi_reset_tx_ring(sc, &sc->txq[2]);
2534ec01dc2bSDamien Bergamini 	iwi_reset_tx_ring(sc, &sc->txq[3]);
2535ceaec73dSDamien Bergamini 	iwi_reset_rx_ring(sc, &sc->rxq);
2536ceaec73dSDamien Bergamini 
2537ceaec73dSDamien Bergamini 	sc->sc_tx_timer = 0;
2538ceaec73dSDamien Bergamini 	ifp->if_timer = 0;
253913f4c340SRobert Watson 	ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
2540ceaec73dSDamien Bergamini }
2541ceaec73dSDamien Bergamini 
2542408146edSDamien Bergamini /*
2543408146edSDamien Bergamini  * Read firmware image from the filesystem and load it into kernel memory.
2544408146edSDamien Bergamini  * Must be called from a process context.
2545408146edSDamien Bergamini  */
2546408146edSDamien Bergamini static int
2547408146edSDamien Bergamini iwi_read_firmware(const char *name, caddr_t *bufp, size_t *len)
2548408146edSDamien Bergamini {
2549408146edSDamien Bergamini 	char path[64];
2550408146edSDamien Bergamini 	struct thread *td = curthread;
2551408146edSDamien Bergamini 	struct nameidata nd;
2552408146edSDamien Bergamini 	struct vattr va;
2553408146edSDamien Bergamini 	struct iovec iov;
2554408146edSDamien Bergamini 	struct uio uio;
2555408146edSDamien Bergamini 	caddr_t buf;
2556408146edSDamien Bergamini 	int vfslocked, error;
2557408146edSDamien Bergamini 
2558a4f5ae8aSDamien Bergamini 	snprintf(path, sizeof path, "/boot/firmware/%s.fw", name);
2559408146edSDamien Bergamini 
2560408146edSDamien Bergamini 	NDINIT(&nd, LOOKUP, NOFOLLOW | LOCKLEAF | MPSAFE, UIO_SYSSPACE, path,
2561408146edSDamien Bergamini 	    td);
2562408146edSDamien Bergamini 	if ((error = namei(&nd)) != 0)
2563408146edSDamien Bergamini 		goto fail1;
2564408146edSDamien Bergamini 
2565408146edSDamien Bergamini 	vfslocked = NDHASGIANT(&nd);
2566408146edSDamien Bergamini 
2567408146edSDamien Bergamini 	if ((error = VOP_GETATTR(nd.ni_vp, &va, td->td_ucred, td)) != 0)
2568408146edSDamien Bergamini 		goto fail2;
2569408146edSDamien Bergamini 
2570408146edSDamien Bergamini 	/* limit firmware size to 256KB */
2571408146edSDamien Bergamini 	if (va.va_size > 256 * 1024) {
2572408146edSDamien Bergamini 		error = E2BIG;
2573408146edSDamien Bergamini 		goto fail2;
2574408146edSDamien Bergamini 	}
2575408146edSDamien Bergamini 
2576408146edSDamien Bergamini 	if ((buf = malloc(va.va_size, M_DEVBUF, M_NOWAIT)) == NULL) {
2577408146edSDamien Bergamini 		error = ENOMEM;
2578408146edSDamien Bergamini 		goto fail2;
2579408146edSDamien Bergamini 	}
2580408146edSDamien Bergamini 
2581408146edSDamien Bergamini 	/* read the whole image at once */
2582408146edSDamien Bergamini 	uio.uio_iov = &iov;
2583408146edSDamien Bergamini 	uio.uio_iovcnt = 1;
2584408146edSDamien Bergamini 	iov.iov_base = buf;
2585408146edSDamien Bergamini 	iov.iov_len = va.va_size;
2586408146edSDamien Bergamini 	uio.uio_offset = 0;
2587408146edSDamien Bergamini 	uio.uio_resid = va.va_size;
2588408146edSDamien Bergamini 	uio.uio_segflg = UIO_SYSSPACE;
2589408146edSDamien Bergamini 	uio.uio_rw = UIO_READ;
2590408146edSDamien Bergamini 	uio.uio_td = td;
2591408146edSDamien Bergamini 
2592408146edSDamien Bergamini 	if ((error = VOP_READ(nd.ni_vp, &uio, 0, NOCRED)) != 0)
2593408146edSDamien Bergamini 		goto fail3;
2594408146edSDamien Bergamini 
2595408146edSDamien Bergamini 	*bufp = buf;
2596408146edSDamien Bergamini 	*len = va.va_size;
2597408146edSDamien Bergamini 
2598408146edSDamien Bergamini 	vput(nd.ni_vp);
2599408146edSDamien Bergamini 	VFS_UNLOCK_GIANT(vfslocked);
2600408146edSDamien Bergamini 
2601408146edSDamien Bergamini 	return 0;
2602408146edSDamien Bergamini 
2603408146edSDamien Bergamini fail3:	free(buf, M_DEVBUF);
2604408146edSDamien Bergamini fail2:	vput(nd.ni_vp);
2605408146edSDamien Bergamini 	VFS_UNLOCK_GIANT(vfslocked);
2606408146edSDamien Bergamini fail1:
2607408146edSDamien Bergamini 	return error;
2608408146edSDamien Bergamini }
2609408146edSDamien Bergamini 
2610ceaec73dSDamien Bergamini static int
2611ceaec73dSDamien Bergamini iwi_sysctl_stats(SYSCTL_HANDLER_ARGS)
2612ceaec73dSDamien Bergamini {
2613ceaec73dSDamien Bergamini 	struct iwi_softc *sc = arg1;
2614ceaec73dSDamien Bergamini 	uint32_t size, buf[128];
2615ceaec73dSDamien Bergamini 
2616ceaec73dSDamien Bergamini 	if (!(sc->flags & IWI_FLAG_FW_INITED)) {
2617ceaec73dSDamien Bergamini 		memset(buf, 0, sizeof buf);
2618ceaec73dSDamien Bergamini 		return SYSCTL_OUT(req, buf, sizeof buf);
2619ceaec73dSDamien Bergamini 	}
2620ceaec73dSDamien Bergamini 
2621ceaec73dSDamien Bergamini 	size = min(CSR_READ_4(sc, IWI_CSR_TABLE0_SIZE), 128 - 1);
2622ceaec73dSDamien Bergamini 	CSR_READ_REGION_4(sc, IWI_CSR_TABLE0_BASE, &buf[1], size);
2623ceaec73dSDamien Bergamini 
2624ceaec73dSDamien Bergamini 	return SYSCTL_OUT(req, buf, sizeof buf);
2625ceaec73dSDamien Bergamini }
2626ceaec73dSDamien Bergamini 
2627ceaec73dSDamien Bergamini static int
2628ceaec73dSDamien Bergamini iwi_sysctl_radio(SYSCTL_HANDLER_ARGS)
2629ceaec73dSDamien Bergamini {
2630ceaec73dSDamien Bergamini 	struct iwi_softc *sc = arg1;
2631ceaec73dSDamien Bergamini 	int val;
2632ceaec73dSDamien Bergamini 
2633ceaec73dSDamien Bergamini 	val = (CSR_READ_4(sc, IWI_CSR_IO) & IWI_IO_RADIO_ENABLED) ? 1 : 0;
2634ceaec73dSDamien Bergamini 
2635ceaec73dSDamien Bergamini 	return SYSCTL_OUT(req, &val, sizeof val);
2636ceaec73dSDamien Bergamini }
2637